Kinematic state estimation for rigid-link multibody systems by means of nonlinear constraint equations

In the multibody field the design of state observers proves useful for several tasks, ranging from the synthesis of control schemes and fault detection strategies, to the identification of uncertain parameters. State observers are designed to obtain accurate estimates of unmeasurable or unmeasured variables. Their accuracy and performance depend on both the models used and the measurement sets. In multibody systems, if it is reasonable to neglect joint clearance and to assume that links are rigid, the estimates of kinematic variables (i.e. position, velocity and acceleration) can be carried out very effectively using kinematic models, i.e. models based on kinematic constraint nonlinear equations, which provide much less uncertain models than dynamic equations. Under the aforementioned assumptions, this paper proposes a general theory, valid for both open-chain and closed-chain multibody systems, to design observers based on nonlinear kinematic models. The concurrent use of kinematic models and nonlinear estimators is original in the multibody field and represents the chief contribution of the paper. The soundness of the proposed theory is proved through numerical and experimental tests on both open-chain and closed-chain multibody systems. Finally, a comparison is given between the kinematic estimations computed through two nonlinear observers (the extended Kalman filter, EKF, and the spherical simplex unscented Kalman filter, SS-UKF), in order to demonstrate the benefits of the SS-UKF in nonlinear estimation.

[1]  Javier García de Jalón,et al.  Kinematic and Dynamic Simulation of Multibody Systems , 1994 .

[2]  Alberto Trevisani,et al.  State estimation using multibody models and non-linear Kalman filters , 2012 .

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

[4]  Soo Jeon,et al.  State estimation based on kinematic models considering characteristics of sensors , 2010, Proceedings of the 2010 American Control Conference.

[5]  Anton J. Haug.  Bayesian Estimation and Tracking: A Practical Guide , 2012 .

[6]  Cong Wang,et al.  Robot end-effector sensing with position sensitive detector and inertial sensors , 2012, 2012 IEEE International Conference on Robotics and Automation.

[7]  Simon J. Julier,et al.  The scaled unscented transformation , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

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

[9]  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).

[10]  C. Lanczos.  Applied Analysis , 1961 .

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

[12]  Janko Slavič,et al.  Minimization of the positional errors for an accurate determination of the kinematic parameters of a rigid-body system with miniature inertial sensors , 2014 .

[13]  Soo Jeon,et al.  Kinematic Kalman Filter (KKF) for Robot End-Effector Sensing , 2009 .

[14]  Konrad Reif,et al.  Stochastic stability of the discrete-time extended Kalman filter , 1999, IEEE Trans. Autom. Control..

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

[16]  A. Krener,et al.  Nonlinear controllability and observability , 1977 .

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