Robust manipulator controller specification and design

This paper suggests the use of a model based control law which uses joint rate feedback to stabilize the contact modes, and joint velocity feedforward to provide the required freespace performance throughout a task. An additional benefit of this controller is the capability to stiffen a soft manipulator. This provides an option for impedance control to provide any desired manipulator stiffness. Impedance control is implemented as an outer Cartesian loop which uses the dynamic relationship between manipulator commanded position and applied force to change the mechanical impedance through programmable filter coefficients. The impedance control discussed in this paper does not give the capability to specify the full impedance of the manipulator. However, it does give the capability to specify the manipulator Cartesian stiffness while maintaining stability in contact with the environment. This controller was designed for the Flight Telerobotic Servicer dextrous manipulator and has been validated experimentally on a single joint controller, as well as on 3 DOF planar arms.