DOI QR코드

DOI QR Code

Constraint-Based Motion Planning for Dual-Arm Collaborative Object Transport

듀얼암 매니퓰레이터의 협력 운반을 위한 말단 제약 기반 모션 플래닝 알고리즘

  • Kyungwoo Kim (Electric & Electronics Engineering, Konkuk University) ;
  • Gidon Han (Electronic Engineering, Sogang University) ;
  • Beomjoon Lee (Electronic Engineering, Sogang University) ;
  • Joonhwa Hong (Electronic Engineering, Sogang University) ;
  • Changjoo Nam (Electronic Engineering, Sogang University, Vertical Labs, Co., Ltd.)
  • Received : 2026.03.19
  • Accepted : 2026.08.11
  • Published : 2026.08.31

Abstract

Cooperative transport of large objects using dual manipulators in confined and complex workspaces is a challenging manipulation problem. This paper proposes a motion planning algorithm for two 6-DOF manipulators to cooperatively transport target objects safely while avoiding obstacles. To reduce the risk of deformation of the grasped object during transport, strict end-effector distance and orientation constraints are integrated into the motion planning pipeline. Furthermore, to address the joint space jump phenomenon that inevitably occurs during inverse kinematics computation with multiple solutions, the state validation process of the geometric planner is improved. This approach overcomes the critical workspace reduction problem caused by conventional joint range restriction methods. We evaluated the proposed algorithm in simulation through challenging environments, crossing two constrained environments (a narrow cabinet and a box-to-box fence) with two varying object types (a planar panel and a cube). The results demonstrate that, even under ±10 mm of robot base position randomness, the planner stably generates collision-free trajectories that strictly satisfy the constraints. Finally, physical experiments using both heterogeneous and homogeneous dual-arm setups verify the robustness and practical applicability of the proposed framework in real-world environments.

Keywords

Acknowledgement

This work was supported by the National Research Foundation of Korea (NRF) grant funded by the Korea government (MSIT) (No. RS-2024-00411007, No. 2022R1C1C1008476).

References

  1. D. Ortenzi, R. Muthusamy, A. Freddi, A. Monteriù, and V. Kyrki, "Dual-arm cooperative manipulation under joint limit constraints," Robotics and Autonomous Systems, vol. 99, pp. 110-120, Jan., 2018, DOI: 10.1016/j.robot.2017.10.005.
  2. M. Yang, E. Yang, R. C. Zante, and M. Post, "Collaborative mobile industrial manipulator: a review of system architecture and applications," International Conference on Automation and Computing, Lancaster, UK, pp. 1-6, 2019, DOI: 10.23919/iconac.2019.8895183.
  3. M. Stilman, "Task constrained motion planning in robot joint space," IEEE/RSJ International Conference on Intelligent Robots and Systems, San Diego, USA, pp. 3074-3081, 2007, DOI: 10.1109/iros.2007.4399305.
  4. F. Burget, M. Bennewitz, and W. Burgard, "BI²RRT*: An efficient sampling-based path planning framework for task-constrained mobile manipulation," IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Daejeon, South Korea, pp. 3714-3721, 2016, DOI: 10.1109/iros.2016.7759547.
  5. X. Li, L. Luo, H. Zhao, D. Ge, and H. Ding, "Inverse kinematics solution based on redundancy modeling and desired behaviors optimization for dual mobile manipulators," Journal of Intelligent & Robotic Systems, vol. 108, no. 37, Jun., 2023, DOI: 10.1007/s10846-023-01884-5.
  6. B. Cohen, S. Chitta, and M. Likhachev, "Single- and dual-arm motion planning with heuristic search," International Journal of Robotics Research, vol. 33, no. 2, pp. 305-320, 2014, DOI: 10.1177/0278364913507983.
  7. Y. Wang, Z. Li, Y. Li, and E. Dong, "An efficient constraint method for solving planning problems under end-effector constraints," Industrial Robot, vol. 51, no. 3, pp. 413-423, Mar., 2024, DOI: 10.1108/ir-10-2023-0251.
  8. S. S. Mirrazavi Salehian, N. Figueroa, and A. Billard, "A unified framework for coordinated multi-arm motion planning," International Journal of Robotics Research, vol. 37, no. 10, pp. 1205- 1232, Apr., 2018, DOI: 10.1177/0278364918765952.
  9. Y. Wang, Y. Li, Z. Li, H. He, S. Chen, and E. Dong, "A novel planner framework compatible with various end-effector constraints," Robotic Intelligence and Automation, vol. 44, no. 5, pp. 746-758, 2024, DOI: 10.1108/ria-02-2024-0043.
  10. J. J. Kuffner and S. M. LaValle, "RRT-connect: An efficient approach to single-query path planning," IEEE International Conference on Robotics and Automation, San Francisco, USA, pp. 995-1001, 2000, DOI: 10.1109/robot.2000.844730.
  11. A. Orthey, C. Chamzas, and L. E. Kavraki, "Sampling-based motion planning: A comparative review," Annual Review of Control, Robotics, and Autonomous Systems, vol. 7, no. 1, pp. 285-310, 2024, DOI: 10.1146/annurev-control-061623-094742.
  12. S. Liu and P. Liu, "Benchmarking and optimization of robot motion planning with motion planning pipeline," International Journal of Advanced Manufacturing Technology, vol. 118, pp. 949-958, 2022, DOI: 10.1007/s00170-021-07985-5.
  13. S. Hwang, J. Oh, J. Lee, and S. Hwang, "Real-time path planning based on nonlinear optimization for cooperative transport between heterogeneous mobile manipulators," Journal of Institute of Control, Robotics and Systems, 2025, DOI: 10.5302/j.icros.2025.25.0117.
  14. S. Chitta, I. Sucan, and S. Cousins, "MoveIt! [ROS Topics]," IEEE Robotics & Automation Magazine, vol. 19, no. 1, pp. 18-19, Mar., 2012, DOI: 10.1109/mra.2011.2181749.
  15. J. Pan, S. Chitta, and D. Manocha, "FCL: A general purpose library for collision and proximity queries," IEEE International Conference on Robotics and Automation, St. Paul, USA, pp. 3859-3866, 2012, DOI: 10.1109/icra.2012.6225337.