Homogeneous weighted motion planning for cooperated manipulator systems under position-torque constrained processing Environment

Abstract

Real-time motion planning under position and torque constraints is a critical challenge for cooperative manipulator efficiency and safety operation. Real-time motion planning at the velocity level improves computation efficiency, eliminates the complex derivative calculation of the Jacobian matrix, and the velocity planning solution can be used directly for robotic kinematic control. However, little research attention has been attached to handling the position and torque constraints simultaneously at velocity level for cooperative manipulator systems. In this paper, we introduce a novel homogeneous weighted least-norm method (HWLN) for joint velocity redistribution of cooperated manipulators. Within the coupled kinematics-dynamics model of cooperated manipulators, joint position and torque constraints are simultaneously homogenized and taken into account by the constraint performance index. To avoid joint's constraint saturations, two real-time weight updating laws are designed for the joint position and driving torque respectively. The joint velocities of cooperated manipulators are then adaptively redistributed using the pseudo-kinetic-energy minimum optimization criteria. When compared to single manipulator regulation, this strategy takes greater advantage of cooperative redundancy and significantly enhances the position-torque planning performance. Mathematical stability proof is presented. In the meanwhile, numerical experiment results under various joint position and torque constraints demonstrate the effectiveness of the proposed HWLN method. The experimental results for motion planning and control of two 6R ABD-20Kg robotic manipulators are provided.