葡萄采摘机器人终端作业路径规划方法研究

doi:10.3778/j.issn.1002-8331.2212-0133

摘要/Abstract

摘要： 葡萄采摘具有障碍物多、结构复杂的特点，为实现高效采摘和稳定避障，提出无碰撞双向扩展RRT（collisionless growth bidirectional RRT，CGB-RRT）算法进行避障路径规划。该算法双树节点相向扩展时，不发生碰撞直接向对方扩展，发生碰撞则转向自由节点扩展，加快扩展速度。针对复杂障碍物导致避障路径规划失败的情况，进一步提出基于CGB-RRT算法的柔性避障路径规划策略，通过引入标记关节，在终端避障路径输出机械臂与障碍物发生柔性接触的碰撞形位，采用“初始位置-中间位置-目标位置”分步规划的方式实现柔性避障路径规划。此外，设计了一种收集点位置已知的葡萄网格收集箱，通过CGB-RRT算法可提前规划得到收集作业路径，供收集作业直接调用。实验结果表明，避障路径规划中CGB-RRT算法与BI-RRT算法相比，运行时间减少27.61%，扩展节点减少24.32%；避障路径规划失败时，柔性避障路径规划策略结合不同算法均能实现路径规划，与CGB-RRT算法结合时表现出来的性能较好。

关键词: 路径规划, 柔性避障, RRT算法, 机器人, 葡萄采摘

Abstract: Grape picking has the characteristics of many obstacles and complex structure. In order to achieve efficient picking and stable obstacle avoidance, a collision free bidirectional RRT（CGB-RRT） algorithm is proposed for obstacle avoidance path planning. When the dual tree nodes expand towards each other, they expand directly to each other without collision, and when collision occurs, they expand to free nodes to speed up the expansion. When obstacle avoidance path planning fails, a flexible obstacle avoidance path planning strategy based on CGB-RRT algorithm is further proposed. By introducing marker joints, the collision shape of flexible contact between the robot arm and the obstacle is output in the terminal obstacle avoidance path, and then the flexible obstacle avoidance path planning is realized by using the step-by-step planning method of “initial position-intermediate position-target position”. In addition, a grape grid collection box with known collection point location is designed, and the collection job path can be planned in advance through CGB-RRT algorithm for direct call by the collection job. The experimental results show that CGB-RRT algorithm in obstacle avoidance path planning reduces the running time by 27.61% and the expansion node by 24.32% compared with BI-RRT algorithm. When obstacle avoidance path planning fails, the flexible obstacle avoidance path planning strategy combined with different algorithms can achieve path planning, and the performance is better when combined with CGB-RRT algorithm.

Key words: path planning, flexible obstacle avoidance, RRT algorithm, robot, grape picking

贾焦予, 袁杰, 李中华, 刘强, 高星健. 葡萄采摘机器人终端作业路径规划方法研究[J]. 计算机工程与应用, 2023, 59(14): 285-292.

JIA Jiaoyu, YUAN Jie, LI Zhonghua, LIU Qiang, GAO Xingjian. Research on Path Planning of Terminal Operation for Grape Picking Robot[J]. Computer Engineering and Applications, 2023, 59(14): 285-292.

参考文献

[1] 刘子豪，赵津，刘畅，等.基于改进A*算法室内移动机器人路径规划[J].计算机工程与应用，2021，57（2）：186-190.
LIU Z H，ZHAO J，LIU C，et al.Path planning of indoor mobile robot based on improved A* algorithm[J].Computer Engineering and Applications，2021，57（2）：186-190.
[2] 张恒，何丽，袁亮，等.基于改进双层蚁群算法的移动机器人路径规划[J].控制与决策，2022，37（2）：303-313.
ZHANG H，HE L，YUAN L，et al.Mobile robot path planning using improved double-layer ant colony algorithm[J].Control and Decision，2022，37（2）：303-313.
[3] 李艳生，万勇，张毅，等.基于人工蜂群-自适应遗传算法的仓储机器人路径规划[J].仪器仪表学报，2022，43（4）：282-290.
LI Y S，WAN Y，ZHANG Y，et al.Path planning for warehouse robot based on the artificial bee colony-adaptive genetic algorithm[J].Chinese Journal of Scientific Instrument，2022，43（4）：282-290.
[4] 程志，张志安，李金芝，等.改进人工势场法的移动机器人路径规划[J].计算机工程与应用，2019，55（23）：29-34.
CHENG Z，ZHANG Z A，LI J Z，et al.Mobile robots path planning based on improved artificial potential field[J].Computer Engineering and Applications，2019，55（23）：29-34.
[5] 张勤，刘丰溥，蒋先平，等.番茄串收机械臂运动规划方法与试验[J].农业工程学报，2021，37（9）：149-156.
ZHANG Q，LIU F P，JIANG X P，et al.Motion planning method and experiments of tomato bunch harvesting manipulator[J].Transactions of the Chinese Society of Agricultural Engineering，2021，37（9）：149-156.
[6] 王怀江，刘晓平，王刚，等.基于改进遗传算法的移动机械臂拣选路径优化[J].北京邮电大学学报，2020，43（5）：34-40.
WANG H J，LIU X P，WANG G，et al.Optimization of mobile manipulator sorting path based on improved genetic algorithm[J].Journal of Beijing University of Posts and Telecommunications，2020，43（5）：34-40.
[7] LAVALLE S M.Rapidly-exploring random trees：a new tool path planning[R].Ames，USA：Iowa State University，1998.
[8] 王硕，段蓉凯，廖与禾.机器人路径规划中快速扩展随机树算法的改进研究[J].西安交通大学学报，2022，56（7）：1-8.
WANG S，DUAN R K，LIAO Y H.Research on improvement of rapidly exploring random tree algorithm in robot path planning[J].Journal of Xi’an Jiaotong University，2022，56（7）：1-8.
[9] 杨英浩，刘晋浩，郑一力，等.林木联合采育机机械臂避障路径规划[J].林业科学，2021，57（2）：179-192.
YANG Y H，LIU J H，ZHENG Y L，et al.Obstacle avoidance path planning of manipulator of forestry felling & cultivation machine[J].Scientia Silvae Sinicae，2021，57（2）：179-192.
[10] 刘顿，王毅.改进Informed-RRT*算法的柑橘采摘机械臂运动路径规划[J].重庆理工大学学报（自然科学），2021，35（11）：158-165.
LIU D，WANG Y.Motion path planning of citrus picking robot arm based on improved informed-RRT* algorithm[J].Journal of Chongqing University of Technology（Natural Science），2021，35（11）：158-165.
[11] 崔永杰，王寅初，何智，等.基于改进RRT算法的猕猴桃采摘机器人全局路径规划[J].农业机械学报，2022，53（6）：151-158.
CUI Y J，WANG Y C，HE Z，et al.Global path planning of kiwifruit harvesting robot based on improved RRT algorithm[J].Transactions of the Chinese Society for Agricultural Machinery，2022，53（6）：151-158.
[12] CAO X M，ZOU X J，JIA C Y，et al.RRT-based path planning for an intelligent litchi-picking manipulator[J].Computers and Electronics in Agriculture，2019，156（1）：105-118.
[13] 张勤，乐晓亮，李彬，等.基于CTB-RRT*的果蔬采摘机械臂运动路径规划[J].农业机械学报，2021，52（10）：129-136.
ZHANG Q，YUE X L，LI B，et al.Motion planning of picking manipulator based on CTB-RRT* algorithm[J].Transactions of the Chinese Society for Agricultural Machinery，2021，52（10）：129-136.
[14] SUN Y X，ZHANG C R，SUN P C，et al.Safe and smooth motion planning for mecanum-wheeled robot using improved RRT and cubic spline[J].Arabian Journal for Science and Engineering，2020，45（4）：3075-3090.
[15] LI B H，CHEN B D.An adaptive rapidly-exploring random tree[J].IEEE/CAA Journal of Automatica Sinica，2022，9（2）：283-294.
[16] LAVALLE S M，KUFFNER J J.Randomized kinodynamic planning[J].The International Journal of Robotics Research，1999，20（5）：378-400.
[17] KUFFNER J J，LAVALLE S M.RRT-connect：an efficient approach to single-query path planning[C]//IEEE International Conference on Robotics and Automation，2002：995-1001.
[18] BLIN N，TAX M，FILLATREAU F，et al.I-RRT-C：interactive motion planning with contact[C]//2016 IEEE/RSJ International Conference on Intelligent Robotsand Systems（IROS），Daejeon，Korea，October 9-14，2016：4244-4249.
[19] 由弘扬，贺帅，刘宏伟，等.基于bi_RRT算法的九自由度机械臂路径规划[J].计算机仿真，2019，36（7）：308-313.
YOU H Y，HE S，LIU H W，et al.The mechanical arm of 9-dof path planning based on bi_RRT algorithm[J].Computer Simulation，2019，36（7）：308-313.
[20] 刘建宇，范平清.基于改进的RRT*-connect算法机械臂路径规划[J].计算机工程与应用，2021，57（6）：274-278.
LIU J Y，FAN P Q.Path planning of manipulator based on improved RRT*-connect algorithm[J].Computer Engineering and Applications，2021，57（6）：274-278.
[21] YE L，DUAN J L，ZHOU Y，et al.Collision-free motion planning for the litchi-picking robot[J].Computers and Electronics in Agriculture，2021，185（6）：106151.