Contact Force Estimation of Robot Manipulators With Imperfect Dynamic Model: On Gaussian Process Adaptive Disturbance Kalman Filter

This paper is concerned with the contact force estimation problem of robot manipulators based on imperfect dynamic models of the manipulator and the contact force. To handle the imperfect dynamic information of the manipulator, a hybrid model, consisting of the nominal model and the residual dynamics, is established for the manipulator, and the Gaussian process regression (GPR) technique is employed to learn the mean and covariance of the residual dynamics. On this basis, a virtual measurement equation is established for contact force estimation and a Gaussian process adaptive disturbance Kalman filter (GPADKF) is developed where the variational Bayes technique is employed to achieve online identification of the noise statistics in the force dynamics. The GPADKF is capable of decoupling the contact force from residual dynamics and system noises, thereby reducing the dependence on accurate dynamic models of the manipulator and the contact force. Simulation and experimental results demonstrate that the proposed scheme outperforms the state-of-art methods.
Note to Practitioners
—Contact force estimation for robot manipulators can be achieved by fusing the dynamic models of the manipulator and the contact force. When both models are imprecise, the traditional inverse dynamics-based and disturbance Kalman filter-based approaches can no longer provide accurate force estimates. To handle this challenge, a computationally efficient hybrid dynamic model is established for the manipulator, which consists of the nominal model and a residual dynamics compensation term learned from offline data via the GPR. On this basis, an adaptive disturbance Kalman filter is constructed by using the variational Bayes technique to deal with the inaccurate noise covariance matrix in the force dynamic model. Compared with the existing approaches, the force estimate obtained via the proposed scheme is more accurate and reliable, as refined noise covariance matrices (provided by both the GPR and the variational Bayes procedure) have been adopted in the Kalman gain calculation. The proposed GPADKF method is the extension of the composite disturbance filtering (CDF) framework. With the proposed scheme, the dependency on the perfect dynamic models in contact force estimation can be significantly reduced, and this makes our approach especially suitable for contact force estimation problems under unfamiliar and complicated environments.