Six-DOF impedance control based on angle/axis representations

Impedance control is a well-established framework to manage the interaction of the end effector of a robot manipulator with the environment, For the e xecution of six-degree-of-freedom (DOF) tasks, both the end-effector positi on and orientation must be handled. The operational space control schemes t ypically utilize minimal representations of end-effector orientation; howev er, such representations do not lead to a physically meaningful definition of the rotational part of the impedance equation, and they suffer from the occurrence of representation singularities. In this work a new approach to six-DOF impedance control is proposed, where the end-effector orientation d isplacement is derived from the rotation matrix expressing the mutual orien tation between the compliant frame and the desired frame, An alternative Eu ler angles-based description is proposed which mitigates the effects of rep resentation singularities. Then, a class of angle/axis representations are considered to derive the dynamic equation for the rotational part of a six- DOF impedance at the end effector, using an energy-based argument. The unit quaternion representation is selected to further analyze the properties of the rotational impedance, The resulting impedance controllers are designed according to an inverse dynamics strategy with contact force and moment me asurements, where an inner loop acting on the end-effector position and ori entation error is adopted to confer robustness to unmodeled dynamics and ex ternal disturbances. Experiments on an industrial robot with open control a rchitecture and force/torque sensor have been carried out, and the results in a number of case studies are discussed.