现代制造工程 ›› 2026, Vol. 549 ›› Issue (6): 42-50.doi: 10.16731/j.cnki.1671-3133.2026.06.005

• 机器人技术 • 上一篇    下一篇

双工业机械臂协同作业的动态路径规划与优化算法*

丘宏岳, 唐晓鑫, 韩伟, 段海峰, 彭怡生, 陈宇姗   

  1. 广州城市理工学院机械工程学院,广州 510800
  • 收稿日期:2025-08-20 出版日期:2026-06-18 发布日期:2026-07-02
  • 作者简介:丘宏岳,实验师,主要研究方向为智能制造加工技术、人工智能。E-mail:154180428@qq.com
  • 基金资助:
    *2024年度广东省高等教育教学改革项目(J1225007);2025年度广东省教育科学规划课题项目(2025GXJK0689)

Dynamic path planning and optimization algorithm for collaborative operation of dual industrial manipulators

QIU Hongyue, TANG Xiaoxin, HAN Wei, DUAN Haifeng, PENG Yisheng, CHEN Yushan   

  1. School of Mechanical Engineering,Guangzhou City University of Technology, Guangzhou 510800,China
  • Received:2025-08-20 Online:2026-06-18 Published:2026-07-02

摘要: 针对双工业机械臂采用传统算法在高维动态场景中存在的搜索效率低、局部最优和避障迟滞现象,研究采用引力函数控制的快速扩展随机树(RRT)并结合动态窗口法(DWA),构建全局-局部双层路径优化框架;同时设计任务调度状态池,实现协同机械臂在共享空间中的路径互避与节拍同步。基于ROS 2与Gazebo平台,对双工业机械臂在高密度障碍与动态干扰环境下的协同作业进行了仿真评估;对比未优化路径,启用动态路径规化与优化算法后平均路径长度缩短了约18.0 %,平均能耗降低了约18.0 %,冲突次数由3 次降为0次,调度延迟也明显缩短。随后将算法部署于实际金属部件装配单元,完成为期两周的连续抓取-插配任务验证,平均规划时间保持在85 ms以内,平均姿态误差控制在±2.3 mm,未发生停机冲突,证明算法具备良好工程可行性与稳定性。研究表明,引力偏置与动态避障的耦合策略能够显著提高双工业机械臂协同作业的路径质量与系统鲁棒性,为智能制造生产线的柔性调度提供有效技术支撑。

关键词: 双机械臂协同, 路径规划, 快速扩展随机树, 动态窗口法, 动态避障, ROS 2平台

Abstract: Aiming at the problems of low search efficiency,local optimality and obstacle avoidance hysteresis in high-dimensional dynamic scenarios when traditional algorithms are applied to dual industrial manipulators,a global-local two-layer path optimization framework was constructed. Specifically,the Rapidly exploring Random Tree (RRT) controlled by a gravitational function was adopted and combined with the Dynamic Window Approach (DWA). Meanwhile,a task scheduling state pool was designed to realize path mutual avoidance and beat synchronization of cooperative manipulators in the shared space. A simulation evaluation of dual industrial manipulators cooperative operation in high-density obstacle and dynamic interference environments was conducted based on the ROS 2 and Gazebo platforms. Compared with the unoptimized path,after the dynamic path planning and optimization algorithm was enabled,the average path length was shortened by approximately 18.0 %,the average energy consumption was reduced by about 18.0 %,the number of conflicts decreased from 3 to 0,and the scheduling delay was also significantly shortened. Subsequently,the algorithm was deployed in an actual metal component assembly unit to complete a two-week continuous grasping and insertion task verification. The average planning time was maintained within 85 ms,the average pose error was controlled within ±2.3 mm,and no shutdown conflicts occurred. These results demonstrate that the algorithm has good engineering feasibility and stability. Studies have shown that the coupled strategy of gravity bias and dynamic obstacle avoidance can significantly improve the path quality and system robustness of dual industrial manipulators collaborative operations,and provide effective technical support for the flexible scheduling of intelligent manufacturing production lines.

Key words: dual manipulator collaboration, path planning, rapidly-exploring random tree, dynamic window approach, dynamic obstacle avoidance, ROS 2 platform

中图分类号: 

版权所有 © 《现代制造工程》编辑部 
地址:北京市东城区东四块玉南街28号 邮编:100061 电话:010-67126028 电子信箱:2645173083@qq.com
本系统由北京玛格泰克科技发展有限公司设计开发 技术支持:support@magtech.com.cn