Dual Arm Coordinated Trajectory Helper Functions dual_robot Functions to form relative path and decompose into individual TCP speed redundancy_resolution_dual Redundancy resolution with QP for 5-dof / 6-dof constraints curve, with adjustable weights between 2 robots.