Robust and Reliable State Estimation for a Five-Axis Robot Using Adaptive Unscented Kalman Filtering

Robust robot manipulation hinges on effective state estimation. The VRT 6 robot leverages an inertia measurement unit with triaxial gyroscopes, magnetometers, and accelerometers, as well as a position sensor, but these sensors are plagued by noise that demands rigorous filtering. To tackle this, an adaptively scaled unscented Kalman filter was employed. The filter’s scaling parameter was meticulously optimized using density- and moment-based techniques, as both system properties and estimated state impact this crucial parameter. A Maximum Likelihood Estimation (ML) substantiates the enhanced quality of the estimated velocity and acceleration, on par with the position estimate. Minimizing measurement prediction error (MMPE) also shows better results with less RMSE when compared to fixed-kappa values, and the quality of position estimates is higher with the increase in the domain of the scaling parameter. By carefully selecting the adaptive scaling parameters’ range to minimize sigma point weights and ensure the positive definiteness of the covariance matrix, this enhanced UKF method achieved markedly superior state estimates compared to standard UKF implementations.