Dynamic sensing of 6-axis external force and moment applied to a robot end
A dynamic force sensing method is proposed for a robot manipulator. A 6-axis wrist force sensor which is commonly used for robot force sensing does not take the direct measurement of the force and moment applied to an end effector externally from the environment of the manipulator, but takes the resultant of the gravity, the inertial force and moment on the end effector, and the external force and moment. The separation of gravitational and inertial force and moment from the measurement of the force sensor is crucial to achieving dynamically accurate force sensing and fast manipulator motion under force feedback control. A mathematical model is derived for the force sensing process and the separation of the force and moment as a nonlinear optimal state estimation problem formulated. Then an approximate solution is given using extended Kalman filtering techniques.