Acceleration and torque redistribution for a dual-manipulator system

Recent research has considered robotic machining as an alternative to traditional computer numerical control machining, particularly for prototyping applications. However, unlike traditional machine tools, robots are subject to relatively larger dynamic disturbances and operate closer to their torque limits. These factors, combined with inaccurate manipulator and machining process models, can cause joint actuator saturation during operation. This paper presents a trajectory planner that will reduce torques that are near saturation by generating trajectories with a weighted pseudoinverse. Using a relative Jacobian, the tool path is resolved into joint trajectories at the acceleration level. This paper presents a new method for selecting the weighting matrix based on the proximity of the joint torques to saturation limits. This weighting reduces the joint accelerations contributing the most to the torques near saturation, thereby reducing the joint torques. The accelerations of other joints increase to satisfy the increased demand. The effectiveness of the acceleration and torque re-distribution algorithm has been demonstrated via extensive simulations.