Obstacle Avoidance Path Planning of Manipulator Based on Proximity
LI Long1,2,3,4, CHEN Hewei1,3, WANG Tianhong1,2,3, ZHANG Quan1,3, ewline WANG Guopeng5,6, TIAN Yingzhong1,2, PENG Yan1,3, LUO Jun1
1. School of Mechatronic Engineering and Automation, Shanghai University, Shanghai 200444, China; 2. Shanghai Key Laboratory of Intelligent Manufacturing and Robotics, Shanghai 200444, China; 3. School of Artificial Intelligence, Shanghai University, Shanghai 200444, China; 4. Jiangsu Province Key Laboratory of Advanced Robot Technology, Suzhou 215123, China; 5. Shanghai Aerospace Control Technology Institute, Shanghai 201109, China; 6. Shanghai Key Laboratory of Aerospace Intelligent Control Technology, Shanghai 201109, China
Abstract:An obstacle avoidance path planning method of manipulator based on proximity is proposed. Firstly, the concept of “movement direction” of link is defined for the obstacle perception problem based on sparse distance information of proximity sensor array. The sensors in the movement direction of link are read preferentially to reduce the read period. The nearest obstacle surface is modeled as the “imaginary cone”, through whose vertex a “safety plane” is made. The link can't collide with the safety plane in the movement process. Secondly, an artificial potential field method based on potential function and joint space is applied to the obstacle avoidance path planning problem. According to the proposed obstacle perception method, an improved method based on “detour” is proposed to solve the local optimum problem of the artificial potential field method. Finally, the proposed method is verified on the forearm of a UR10 robot, and the experimental results show that the proposed method is effective, robust and real-time.
[1] Zhao X L, Zhang J, Tian J M, et al. Multiscale object detection in high-resolution remote sensing images via rotation invariant deep features driven by channel attention[J]. International Journal of Remote Sensing, 2021, 42(15): 5764-5783. [2] Giveki D. Robust moving object detection based on fusing Atanassov’s intuitionistic 3D fuzzy histon roughness index and texture features[J]. International Journal of Approximate Reasoning, 2021, 135: 1-20. [3] Ren S Q, He K M, Girshick R, et al. Faster R-CNN: Towards real-time object detection with region proposal networks[J]. IEEE Transactions on Pattern Analysis and Machine Intelligence, 2017, 39(6): 1137-1149. [4] 郭毓,苏鹏飞,吴益飞,等.基于Faster R-CNN的机器人目标检测及空间定位[J].华中科技大学学报(自然科学版), 2018, 46(12): 55-59. Guo Y, Su P F, Wu Y F, et al. Object detection and location of robot based on Faster R-CNN[J]. Journal of Huazhong University of Science and Technology (Natural Science Edition), 2018, 46(12): 55-59. [5] 杜学丹,蔡莹皓,鲁涛,等.一种基于深度学习的机械臂抓取方法[J].机器人, 2017, 39(6): 820-828,837. Du X D, Cai Y H, Lu T, et al. A robotic grasping method based on deep learning[J]. Robot, 2017, 39(6): 820-828,837. [6] Chao Y, Chen X C, Xiao N F. Deep learning-based graspdetection method for a five-fingered industrial robot hand[J]. IET Computer Vision, 2019, 13(1): 61-70. [7] Schwarz M, Milan A, Periyasamy A S, et al. RGB-D object detection and semantic segmentation for autonomous manipulation in clutter[J]. International Journal of Robotics Research, 2017, 37(4-5): 437-451. [8] 任亚冰.基于机器学习的机械臂运动规划研究[D].成都: 电子科技大学, 2019. Ren Y B. Research on trajectory planning of manipulator based on machine learning[D]. Chengdu: University of Electronic Science and Technology of China, 2019. [9] Tsuji S, Kohama T. Proximity and contact sensor for human cooperative robot by combining time-of-flight and selfcapacitance sensors[J]. IEEE Sensors Journal, 2020, 20(10): 5519-5526. [10] 宗成星,陆亮,雷新宇,等.一种基于A* 算法的空间多自由度机械臂路径规划方法[J].合肥工业大学学报(自然科学版), 2017, 40(2): 164-168. Zong C X, Lu L, Lei X Y, et al. A path planning approach for multi-DOF spatial manipulator via A* algorithm[J]. Journal of Hefei University of Technology (Natural Science), 2017, 40(2): 164-168. [11] 王伟,杨扬,原魁,等.机器人C―空间障碍边界建模与无碰路径规划[J].机器人, 1998, 20(4): 280-286. Wang W, Yang Y, Yuan K, et al. Robot C-obstacle boundary modeling and collision-free path planning[J]. Robot, 1998, 20(4): 280-286. [12] 刘晓磊,蒋林,金祖飞,等.非结构化环境中基于栅格法环境建模的移动机器人路径规划[J].机床与液压, 2016, 44(17): 1-7. Liu X L, Jiang L, Jin Z F, et al. Mobile robot path planning based on environment modeling of grid method in unstructured environment[J]. Machine Tool and Hydraulics, 2016, 44(17): 1- 7. [13] 李洋,徐达.基于引力自适应步长RRT的双臂机器人协同路径规划[J].机器人, 2020, 42(5): 606-616. Li Y, Xu D. Cooperative path planning of dual-arm robot based on attractive force self-adaptive step size RRT[J]. Robot, 2020, 42(5): 606-616. [14] 关英姿,宋春林,董惠娟.空间自由漂浮机器人对运动目标抓捕的路径规划[J].机器人, 2017, 39(6): 803-811. Guan Y Z, Song C L, Dong H J. Path planning of the freefloating manipulator for capturing a moving target[J]. Robot, 2017, 39(6): 803-811. [15] 李东方,李科伟,邓宏彬,等.基于人工势场与IB-LBM的机器蛇水中2D避障控制算法[J].机器人, 2018, 40(3): 346-359. Li D F, Li K W, Deng H B, et al. The 2D aquatic obstacle avoidance control algorithm of the snake-like robot based on artificial potential field and IB-LBM[J]. Robot, 2018, 40(3): 346-359. [16] 李晔,姜言清,张国成,等.考虑几何约束的AUV回收路径规划[J].机器人, 2015, 37(4): 478-485. Li Y, Jiang Y Q, Zhang G C, et al. AUV recovery path planning method considering geometrical constraints[J]. Robot, 2015, 37(4): 478-485. [17] Zhang Y T, Zhao G. Research on multi-service demand path planning based on continuous Hopfield neural network[M]// Lecture Notes in Electrical Engineering, Vol.286. Berlin, Germany: Springer, 2014: 417-430. [18] 李娜.面向人机协作安全保障的工业机器人路径规划研究与实现[D].武汉:武汉理工大学, 2018. Li N. Research and implementation on path planning of industrial robot towards safety assurance of human-robot collaboration[D]. Wuhan: Wuhan University of Technology, 2018. [19] 汪首坤,朱磊,王军政.基于导航势函数法的六自由度机械臂避障路径规划[J].北京理工大学学报, 2015, 35(2): 186-191. Wang S K, Zhu L, Wang J Z. Path plan of 6-DOF robot manipulators in obstacle environment based on navigation potential function[J]. Transactions of Beijing Institute of Technology, 2015, 35(2): 186-191. [20] Sang H Q, You Y S, Sun X J, et al. The hybrid path planning algorithm based on improved A* and artificial potential field for unmanned surface vehicle formations[J]. Ocean Engineering, 2021, 223. DOI: 10.1016/j.oceaneng.2021.108709. [21] 宋建辉,代涛,刘砚菊,等.基于改进人工势场法的移动机器人路径规划[J].计算机工程与科学, 2017, 39(7): 1328-1332. Song J H, Dai T, Liu Y J, et al. Path planning of mobile robots based on improved artificial potential field method[J]. Computer Engineering and Science, 2017, 39(7): 1328-1332. [22] 周自维,周冰,赵雪.基于改进人工势场的多机器人编队控制[J].科技创新与应用, 2015(33): 44-45. Zhou Z W, Zhou B, Zhao X. Formation control of multi robots with improved artificial potential field method[J]. Technology Innovation and Application, 2015(33): 44-45.