A Reactive Synchronized Motion Controller for Dual-Arm Cooperation with Closed-Chain Constraints

When a rigid object is manipulated by dual arms to form a closed chain, the dual-arm motion must satisfy closed-chain constraints. Although synchronized motion can be achieved by strictly tracking predefined global trajectories, the presence of dynamic obstacles necessitates reactive local planning. However, existing local planning methods designed for single-arm manipulators cannot guarantee synchronization between dual arms. To address this limitation, we propose a dual-arm reactive synchronized motion controller (SMC) by incorporating closed-chain constraints on dual-arm slack velocities based on spherical geometric velocity constraints, and by implementing a flexible master-slave arm switching strategy. As a result, the proposed controller achieves synchronized dual-arm control while preserving excellent motion performance, including manipulability enhancement, obstacle avoidance, and compliance with joint angle and velocity constraints. Simulations and experiments on a humanoid upper-body robot validate the effectiveness of the proposed approach.