Contact force estimation for serial manipulator based on weighted moving average with variable span and standard Kalman filter with automatic tuning

Sensorless contact force estimation methods facilitate the application of the serial manipulators to manufacturing as they enable robots to interact with unexpected collisions at low cost. In this paper, an external force estimation approach with no embedded sensors is proposed. The approach combines a Weighted Moving Average (WMA) with variable span, the standard Kalman filter (SKF), and its tuning routines. Improved confidence in the motor output torque is achieved due to the reduction of the measurement noise in the motor current by the WMA. The span of the filter adapts continuously to achieve optimal tradeoff between response time and precision of estimation in real time. With the comprehensive information of uncertainty in motor current noise and measurement errors of individual joints speed, an automatic tuning algorithm of the SKF is presented. Validation of the presented estimation approach in terms of estimation accuracy and response time was conducted on the Universal Robot 5 manipulator with differing end effector loads. It was found that the combined force estimation method leads to a reduction of the root-mean-square error and response time by 55.2% and 20.8% in comparison with the established method. The proposed method can be applied to any robotic manipulators as long as the motor information (current, joint position, and joint velocities) is available. Consequently, the cost of collision recognition could be reduced dramatically.