SLAM With Joint Sensor Bias Estimation: Closed Form Solutions on Observability, Error Bounds and Convergence Rates

Notable problems in Simultaneous Localization and Mapping (SLAM) are caused by biases and drifts in both exteroceptive and proprioceptive sensors. The impacts of sensor biases include inconsistent map estimates and inaccurate localization. Unlike Map Aided Localisation with Joint Sensor Bias Estimation (MAL-JSBE), SLAM with Joint Sensor Bias Estimation (SLAM-JSBE) is more complex as it encompasses a state space, which increases with the discovery of new landmarks and the inherent map to vehicle correlations. The properties such as observability, error bounds and convergence rates of SLAM-JSBE using an augmented estimation theoretic, state space approach, are investigated here. SLAM-JSBE experiments, which adhere to the derived constraints, are demonstrated using a low cost inertial navigation sensor suite.

[1]  Mario Ignagni,et al.  Optimal and suboptimal separate-bias Kalman estimators for a stochastic bias , 2000, IEEE Trans. Autom. Control..

[2]  Wolfram Burgard,et al.  Monte Carlo Localization: Efficient Position Estimation for Mobile Robots , 1999, AAAI/IAAI.

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

[4]  S. Challa,et al.  Joint sensor registration and track-to-track fusion for distributed trackers , 2004, IEEE Transactions on Aerospace and Electronic Systems.

[5]  Hugh F. Durrant-Whyte,et al.  A solution to the simultaneous localization and map building (SLAM) problem , 2001, IEEE Trans. Robotics Autom..

[6]  Sinpyo Hong,et al.  A car test for the estimation of GPS/INS alignment errors , 2004, IEEE Transactions on Intelligent Transportation Systems.

[7]  O.A. Stepanov,et al.  Nonlinear filtering methods application in INS alignment , 1997, IEEE Transactions on Aerospace and Electronic Systems.

[8]  Charles R. Johnson,et al.  Matrix analysis , 1985, Statistical Inference for Engineers and Data Scientists.

[9]  Mohinder S. Grewal,et al.  Global Positioning Systems, Inertial Navigation, and Integration , 2000 .

[10]  Bingbing Liu,et al.  Multi-aided Inertial Navigation for Ground Vehicles in Outdoor Uneven Environments , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[11]  Juan Andrade-Cetto,et al.  The effects of partial observability when building fully correlated maps , 2005, IEEE Transactions on Robotics.

[12]  Martin Adams,et al.  Sensor bias correction in simultaneous localization and mapping , 2003, Sixth International Conference of Information Fusion, 2003. Proceedings of the.

[13]  Y. Bar-Shalom.  Mobile radar bias estimation using unknown location targets , 2000, Proceedings of the Third International Conference on Information Fusion.

[14]  Martin David Adams,et al.  The Estimation Theoretic Sensor Bias Correction Problem in Map Aided Localization , 2006, Int. J. Robotics Res..

[15]  Thia Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation: Theory, Algorithms and Software , 2001 .

[16]  Hugh F. Durrant-Whyte,et al.  Initial calibration and alignment of low-cost inertial navigation units for land vehicle applications , 1999, J. Field Robotics.

[17]  H. Durrant-Whyte,et al.  A closed form solution to the single degree of freedom simultaneous localisation and map building (SLAM) problem , 2000, Proceedings of the 39th IEEE Conference on Decision and Control (Cat. No.00CH37187).

[18]  Mark Koifman,et al.  Inertial navigation system aided by aircraft dynamics , 1999, IEEE Trans. Control. Syst. Technol..

[19]  John A. Marchant,et al.  Controllability and Observability: Tools for Kalman Filter Design , 1998, BMVC.