Learning and Generalization of Dual-Robot Cooperative Handling Trajectory Based on Dynamic Movement Primitives

Aiming at the problems of complex trajectory learning and lack of coordination constraint analysis when a dual-robot collaborative system performs humanoid tasks with strong coordination constraints, this paper proposed a dual-robot cooperative handling trajectory learning and generalization method based on dynamic movement primitives (DMPs). Firstly, starting from the dual-robot cooperative handling task, the coordination constraints of the dual-robot were analyzed, and the motion constraint model of the dual-robot was established. Then, the robot motion trajectory was decoupled into position trajectory and orientation trajectory, and the quaternion was used to realize the non-singular description of the orientation trajectory. And the dynamic movement primitives model of position trajectory and orientation trajectory were established respectively. They were combined with the dual robot motion constraint model and DMPs model, and the dual-robot movement trajectory was obtained, taking into account their respective task requirements and relative pose constraints. Finally, the simulation and experiments of the cooperative handling trajectory of the two robots were carried out. The results show that: using the learning and generalization method of the dual-robot cooperative handling trajectory, when the starting and ending states are changed, the position errors of start point and end point of the dual-robot cooperative handling with the fixed orientation are 0.0292 mm and 0.1127 mm respectively; the position errors of start point and end point of variable orientation coordinated handling are 0.0323 mm and 0.1131 mm respectively; and the quaternion orientation errors of the end point are 0.0014, 0.0027, 0.0018, 0.0030, indicating that the cooperative handling trajectory learning and generalization method has high motion control accuracy; even if the task parameters of the starting and ending are changed, the generalized trajectory can still ensure the accessibility of the target, which verified the scientificity and effectiveness of the proposed dual-robot coordination motion trajectory control strategy. The method proposed in this paper can effectively learn the human handling process and can accurately generalize new motion trajectories. It realizes the dual-robot coordinated motion and has important engineering application value.