An Analytical Approach for Comparing Linearization Methods in EKF and UKF

The transformation of the mean and variance of a normally distributed random variable was considered through three different nonlinear functions: sin(x), cos(x), and xk, where k is a positive integer. The true mean and variance of the random variable after these transformations is theoretically derived within, and verified with respect to Monte Carlo experiments. These statistics are used as a reference in order to compare the accuracy of two different linearization techniques: analytical linearization used in the Extended Kalman Filter (EKF) and statistical linearization used in the Unscented Kalman Filter (UKF). This comparison demonstrated the advantage of using the unscented transformation in estimating the mean after transforming through each of the considered nonlinear functions. However, the variance estimation led to mixed results in terms of which linearization technique provided the best performance. As an additional analysis, the unscented transformation was evaluated with respect to its primary scaling parameter. A nonlinear filtering example is presented to demonstrate the usefulness of the theoretically derived results.

[1]  S. T. Buckland,et al.  An Introduction to the Bootstrap. , 1994 .

[2]  Antonios Tsourdos,et al.  Sensor based robot localisation and navigation: using interval analysis and unscented Kalman filter , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[3]  Bjarne A. Foss,et al.  Applying the unscented Kalman filter for nonlinear state estimation , 2008 .

[4]  Jie Li,et al.  An overview of the simultaneous localization and mapping on mobile robot , 2012, 2012 Proceedings of International Conference on Modelling, Identification and Control.

[5]  John B. Moore,et al.  Optimal State Estimation , 2006 .

[6]  Luca Benini,et al.  Design and validation of an attitude and heading reference system for an aerial robot prototype , 2012, 2012 American Control Conference (ACC).

[7]  Suk-Gyu Lee,et al.  An enhanced CSLAM for multi-robot based on unscented kalman filter , 2012 .

[8]  Ting-wen Xing,et al.  The Unscented Kalman Filter for State Estimation of 3-Dimension Bearing-Only Tracking , 2009, 2009 International Conference on Information Engineering and Computer Science.

[9]  A. Bos.  Parameter Estimation for Scientists and Engineers , 2007 .

[10]  G. Reinsel,et al.  Introduction to Mathematical Statistics (4th ed.). , 1980 .

[11]  Kuo-Chu Chang,et al.  Comparison of nonlinear estimation for ballistic missile tracking , 2003, SPIE Defense + Commercial Sensing.

[12]  A. Tsourdos,et al.  Sensor based robot localisation and navigation: using interval analysis and extended Kalman filter , 2004, 2004 5th Asian Control Conference (IEEE Cat. No.04EX904).

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

[14]  D. Gingras,et al.  Comparison between the unscented Kalman filter and the extended Kalman filter for the position estimation module of an integrated navigation information system , 2004, IEEE Intelligent Vehicles Symposium, 2004.

[15]  Miguel Ángel Sotelo,et al.  Vision-based adaptive cruise control for intelligent road vehicles , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[16]  Jr. J.J. LaViola,et al.  A comparison of unscented and extended Kalman filtering for estimating quaternion motion , 2003, Proceedings of the 2003 American Control Conference, 2003..

[17]  M. C. VanDyke,et al.  UNSCENTED KALMAN FILTERING FOR SPACECRAFT ATTITUDE STATE AND PARAMETER ESTIMATION , 2004 .

[18]  Yongyin Qu,et al.  An SLAM algorithm based on improved UKF , 2012, 2012 24th Chinese Control and Decision Conference (CCDC).

[19]  Fredrik Gustafsson,et al.  Particle filters for positioning, navigation, and tracking , 2002, IEEE Trans. Signal Process..

[20]  Markus Vincze,et al.  Simultaneous Motion and Structure Estimation by Fusion of Inertial and Vision Data , 2007, Int. J. Robotics Res..

[21]  Marcello R. Napolitano,et al.  A Comparison of Extended Kalman Filter, Sigma-Point Kalman Filter, and Particle Filter in GPS/INS Sensor Fusion , 2010 .

[22]  Smita Sadhu,et al.  Sigma point Kalman filter for bearing only tracking , 2006, Signal Process..

[23]  Marcello R. Napolitano,et al.  Sensitivity Analysis of Extended and Unscented Kalman Filters for Attitude Estimation , 2013, J. Aerosp. Inf. Syst..

[24]  F. Orderud,et al.  Comparison of Kalman Filter Estimation Approaches for State Space Models with Nonlinear Measurements , 2005 .

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

[26]  Robert V. Hogg,et al.  Introduction to Mathematical Statistics. , 1966 .

[27]  J.L. Crassidis,et al.  Sigma-point Kalman filtering for integrated GPS and inertial navigation , 2005, IEEE Transactions on Aerospace and Electronic Systems.

[28]  Markus Vincze,et al.  Multi-rate fusion with vision and inertial sensors , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[29]  Huosheng Hu,et al.  Vision and Laser Data Fusion for Tracking People with a Mobile Robot , 2006, 2006 IEEE International Conference on Robotics and Biomimetics.

[30]  Costanzo Manes,et al.  Comparative Study of Unscented Kalman Filter and Extended Kalman Filter for Position/Attitude Estimation in Unmanned Aerial Vehicles , 2008 .

[31]  Jan Wendel,et al.  A Performance Comparison of Tightly Coupled GPS/INS Navigation Systems based on Extended and Sigma Point Kalman Filters , 2005 .

[32]  A. Ersak,et al.  State estimation of induction motor using unscented Kalman filter , 2003, Proceedings of 2003 IEEE Conference on Control Applications, 2003. CCA 2003..

[33]  Markus Vincze,et al.  Fast Ego-motion Estimation with Multi-rate Fusion of Inertial and Vision , 2007, Int. J. Robotics Res..

[34]  Eugene A. Morelli,et al.  Aircraft system identification : theory and practice , 2006 .

[35]  M. Vasak,et al.  Kalman filter theory based mobile robot pose tracking using occupancy grid maps , 2005, 2005 International Conference on Control and Automation.

[36]  K. Gulez,et al.  Evaluations of different Simultaneous Localization and Mapping (SLAM) algorithms , 2012, IECON 2012 - 38th Annual Conference on IEEE Industrial Electronics Society.

[37]  Kirtland Afb,et al.  Comparison of the Extended and Unscented Kalman Filters for Angles Based Relative Navigation , 2008 .

[38]  Blake Hannaford,et al.  Application of Unscented Kalman Filter to a cable driven surgical robot: A simulation study , 2012, 2012 IEEE International Conference on Robotics and Automation.

[39]  F. Azizi,et al.  Mobile robot position determination using data from gyro and odometry , 2004, Canadian Conference on Electrical and Computer Engineering 2004 (IEEE Cat. No.04CH37513).

[40]  Marcello R. Napolitano,et al.  Flight-Test Evaluation of Sensor Fusion Algorithms for Attitude Estimation , 2012, IEEE Transactions on Aerospace and Electronic Systems.

[41]  Huosheng Hu,et al.  Computationally efficient solutions for tracking people with a mobile robot: an experimental evaluation of Bayesian filters , 2010, Auton. Robots.

[42]  R. V. Jategaonkar,et al.  Aerodynamic parameter estimation from flight data applying extended and unscented Kalman filter , 2006 .

[43]  Jonathan P. How,et al.  Nonlinearity in Sensor Fusion: Divergence Issues in EKF, modified truncated SOF, and UKF , 2007 .

[44]  Neil J. Gordon,et al.  A tutorial on particle filters for online nonlinear/non-Gaussian Bayesian tracking , 2002, IEEE Trans. Signal Process..