A Fast Coordinated Motion Planning Method for Dual-Arm Robot Based on Parallel Constrained DDP
- 25 October 2023
- journal article
- research article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE/ASME Transactions on Mechatronics
- Vol. 29 (3) , 2350-2361
Abstract
Safe and efficient coordinated motion planning is crucial for the dual-arm robot's manipulation in the constrained environment. This article studies a fast optimization-based coordinated motion planning method for dual-arm robots based on a parallel differential dynamic programming (DDP) solver. First, the proposed method models the unstructured environment using swept sphere volumes and turns the safety and task constraints, including collision avoidance, path constraints, and closed kinematics constraints, into mathematical equalities and inequalities in an optimization problem. Second, to efficiently solve this high-dimensional and multiconstraint optimization problem, a parallel constrained differential dynamic programming (PC-DDP) solver is developed based on a new multiple shooting strategy. It utilizes the augmented Lagrangian method to handle various constraints and achieves high solving efficiency using the parallelization strategy with an approximation and the serial correction of the value function. Simulations and experiments of opening doors and transferring the box are conducted on the robot with dual 7-DOF manipulators. The results show that the proposed method works well in the motion planning of coordinated manipulations in constrained environments and that the PC-DDP is much faster than other DDP variants and large-scale optimization solvers.Keywords
Funding Information
- National Natural Science Foundation of China (U22B2079, 62103054, 62273049, U1913211, U2013602)
- Beijing Natural Science Foundation (4232054)
- Beijing Institute of Technology Research Fund Program for Young Scholars (XSQD-6120220298)
- Foundation of National Key Laboratory of Human Factors Engineering (HFNKL2023WW06)
This publication has 31 references indexed in Scilit:
- Generation of synchronized configuration space trajectories with workspace path constraints for an ensemble of robotsThe International Journal of Robotics Research, 2021
- Crocoddyl: An Efficient and Versatile Framework for Multi-Contact Optimal Control2020
- A multiple-shooting differential dynamic programming algorithm. Part 1: TheoryActa Astronautica, 2020
- Robotic Surgery in Gastrointestinal SurgeryCyborg and Bionic Systems, 2020
- ALTRO: A Fast Solver for Constrained Trajectory Optimization2019
- Julia: A Fresh Approach to Numerical ComputingSIAM Review, 2017
- Motion planning with sequential convex optimization and convex collision checkingThe International Journal of Robotics Research, 2014
- Single- and dual-arm motion planning with heuristic searchThe International Journal of Robotics Research, 2013
- Optimization-based approach to path planning for closed chain robot systemsInternational Journal of Applied Mathematics and Computer Science, 2011
- On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programmingMathematical Programming, 2005