Global motion planning and redundancy resolution for large objects manipulation by dual redundant robots with closed kinematics

The multi-arm robotic systems consisting of redundant robots are able to conduct more complex and coordinated tasks, such as manipulating large or heavy objects. The challenges of the motion planning and control for such systems mainly arise from the closed-chain constraint and redundancy resolution problem. The closed-chain constraint reduces the configuration space to lower-dimensional subsets, making it difficult for sampling feasible configurations and planning path connecting them. A global motion planner is proposed in this paper for the closed-chain systems, and motions in different disconnected manifolds are efficiently bridged by two type regrasping moves. The regrasping moves are automatically chosen by the planner based on cost-saving principle, which greatly improve the success rate and efficiency. Furthermore, to obtain the optional inverse kinematic solutions satisfying joint physical limits (e.g., joint position, velocity, acceleration limits) in the planning, the redundancy resolution problem for dual redundant robots is converted into a unified quadratic programming problem based on the combination of two diff erent-level optimizing criteria, i.e. the minimization velocity norm (MVN) and infinity norm torque-minimization (INTM). The Dual-MVN-INTM scheme guarantees smooth velocity, acceleration profiles, and zero final velocity at the end of motion. Finally, the planning results of three complex closed-chain manipulation task using two Franka Emika Panda robots and two Kinova Jaco2 robots in both simulation and experiment demonstrate the effectiveness and efficiency of the proposed method.