State estimation using multibody models and non-linear Kalman filters

Abstract The aim of this work is to provide a thorough research on the implementation of some non-linear Kalman filters (KF) using multibody (MB) models and to compare their performances in terms of accuracy and computational cost. The filters considered in this study are the extended KF (EKF) in its continuous form, the unscented KF (UKF) and the spherical simplex unscented KF (SSUKF). The MB formulation taken into consideration to convert the differential algebraic equations (DAE) of the MB model into the ordinary differential equations (ODE) required by the filters is a state-space reduction method known as projection matrix-R method. Additionally, both implicit and explicit integration schemes are used to evaluate the impact of explicit integrators over implicit integrators in terms of accuracy, stability and computational cost. However, state estimation through KFs is a closed-loop estimation correcting the model drift according to the difference between the predicted measurement and the actual measurement, what limits the interest in using implicit integrators despite being commonly employed in MB simulations. Performance comparisons of all the aforementioned non-linear observers have been carried out in simulation on a 5-bar linkage. The mechanism parameters have been obtained from an experimental 5-bar linkage and the sensor characteristics from off-the-shelf sensors to reproduce a realistic simulation. The results should highlight useful clues for the choice of the most suitable filters and integration schemes for the aforementioned MB formulation.

[1]  Javier Cuadrado,et al.  Automotive observers based on multibody models and the extended Kalman filter , 2010 .

[2]  H.F. Durrant-Whyte,et al.  A new approach for filtering nonlinear systems , 1995, Proceedings of 1995 American Control Conference - ACC'95.

[3]  R. E. Kalman,et al.  New Results in Linear Filtering and Prediction Theory , 1961 .

[4]  R. E. Kalman,et al.  A New Approach to Linear Filtering and Prediction Problems , 2002 .

[5]  Daniel Dopico,et al.  INFLUENCE OF THE SENSORED MAGNITUDE IN THE PERFORMANCE OF OBSERVERS BASED ON MULTIBODY MODELS AND THE EXTENDED KALMAN FILTER , 2009 .

[6]  Simon J. Julier,et al.  The spherical simplex unscented transformation , 2003, Proceedings of the 2003 American Control Conference, 2003..

[7]  Niels Kjølstad Poulsen,et al.  New developments in state estimation for nonlinear systems , 2000, Autom..

[8]  Jeffrey K. Uhlmann,et al.  Reduced sigma point filters for the propagation of means and covariances through nonlinear transformations , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[9]  Zhiqiang Gao,et al.  A survey of state and disturbance observers for practitioners , 2006, 2006 American Control Conference.

[10]  Rudolph van der Merwe,et al.  The square-root unscented Kalman filter for state and parameter-estimation , 2001, 2001 IEEE International Conference on Acoustics, Speech, and Signal Processing. Proceedings (Cat. No.01CH37221).

[11]  Roberto Caracciolo,et al.  Design and experimental validation of piecewise-linear state observers for flexible link mechanisms , 2006 .

[12]  Mohinder S. Grewal,et al.  Kalman Filtering: Theory and Practice Using MATLAB , 2001 .

[13]  Roberto Caracciolo,et al.  Experimental validation of a model-based robust controller for multi-body mechanisms with flexible links , 2008 .

[14]  Javier García de Jalón,et al.  Kinematic and Dynamic Simulation of Multibody Systems: The Real Time Challenge , 1994 .

[15]  Jeffrey K. Uhlmann,et al.  New extension of the Kalman filter to nonlinear systems , 1997, Defense, Security, and Sensing.

[16]  Jeffrey K. Uhlmann,et al.  Unscented filtering and nonlinear estimation , 2004, Proceedings of the IEEE.

[17]  Daniel Dopico,et al.  Real-time state observers based on multibody models and the extended Kalman filter , 2009 .

[18]  Roberto Caracciolo,et al.  Robust Piecewise-Linear State Observers for Flexible Link Mechanisms , 2008 .