Sensor Fusion for Compliant Robot Motion Control

Force feedback is necessary for accurate force control in robotic manipulators, and thus far, wrist force/torque (F/T) sensors have been used. But an important problem arises when only these types of sensors are used. In a dynamic situation where the manipulator moves in either free or constrained space, the interaction forces and moments at the contact point and also the noncontact ones are measured by the mentioned sensor. In this paper, an estimator based on a sensor fusion strategy integrating the measurements of three different sensors (a wrist F/T sensor, an inertial sensor, and joint sensors) was developed to determine the contact force and torque exerted by the manipulator to its environment. The resulting observer helps to overcome some difficulties of uncertain world models and unknown environments since it reduces the high-frequency and low-frequency spectral contents, i.e., the low-frequency component due to inertia of a heavy tool mass and the high-frequency component due to impacts. The new improvement was experimentally validated in a force/position impedance control loop applied to a Staubli RX60 industrial robotic platform.