Robot arm dynamics and control

Variations in total inertia and gravity loads at the joint outputs are treated along with the relative importance of gravity and acceleration-generated reaction torques or forces versus inertia torques or forces. The relation between the dynamical state equations in explicit terms and servoing the manipulator is briefly discussed in the framework of state variable feedback control which also forms the basis of adaptive manipulator control. Exact state equations were determined for total inertia and gravity loads at the joint outputs as a function of joint variables, using the constant inertial and geometric parameters of the individual links defined in the respective link coordinate frames. The range of maximum variations in total inertia and gravity loads at the joint outputs was calculated for both no load and load in the hand. The main result is the construction of a set of greatly simplified state equations which describe the total inertia and gravity load variations at the output of the six joints with an average error of less than 5%.