Trajectory tracking control of flexible-joint robots

Inverse dynamics control of flexible-joint robots is addressed. It is shown that, in a flexible-joint robot, the acceleration level inverse dynamic equations are singular because the control torques do not have an instantaneous effect on the end-effector accelerations due to the elastic media. Implicit numerical integration methods that account for the higher order derivative information are utilized for solving the singular set of differential equations. The trajectory tracking control law presented linearizes and decouples the system and yields an asymptotically stable fourth order error dynamics for each end-effector degree of freedom. A 3R spatial robot with all joints flexible is simulated to illustrate the performance of the proposed algorithm.