Calibration and Improvement of an Odometry Model with Dynamic Wheel and Lateral Dynamics Integration

Localization is a key part of an autonomous system, such as a self-driving car. The main sensor for the task is the GNSS, however its limitations can be eliminated only by integrating other methods, for example wheel odometry, which requires a well-calibrated model. This paper proposes a novel wheel odometry model and its calibration. The parameters of the nonlinear dynamic system are estimated with Gauss–Newton regression. Due to only automotive-grade sensors are applied to reach a cost-effective system, the measurement uncertainty highly corrupts the estimation accuracy. The problem is handled with a unique Kalman-filter addition to the iterative loop. The experimental results illustrate that without the proposed improvements, in particular the dynamic wheel assumption and integrated filtering, the model cannot be calibrated precisely. With the well-calibrated odometry, the localization accuracy improves significantly and the system can be used as a cost-effective motion estimation sensor in autonomous functions.

[1]  Andreas Zell,et al.  Automated odometry self-calibration for car-like robots with four-wheel-steering , 2012, 2012 IEEE International Symposium on Robotic and Sensors Environments Proceedings.

[2]  Frank Gauterin,et al.  Odometry 2.0: A Slip-Adaptive EIF-Based Four-Wheel-Odometry Model for Parking , 2019, IEEE Transactions on Intelligent Vehicles.

[3]  Roland Siegwart,et al.  Simultaneous localization and odometry self calibration for mobile robot , 2007, Auton. Robots.

[4]  Rolf Isermann,et al.  Accurate local vehicle dead-reckoning for a parking assistance system , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[5]  Péter Gáspár,et al.  Identification of kinematic vehicle model parameters for localization purposes , 2020, 2020 IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems (MFI).

[6]  Rafael Arnay,et al.  Improving Odometric Accuracy for an Autonomous Electric Cart , 2018, Sensors.

[7]  Gianluca Antonelli,et al.  A calibration method for odometry of mobile robots based on the least-squares technique: theory and experimental validation , 2005, IEEE Transactions on Robotics.

[8]  Woojin Chung,et al.  Kinematic parameter calibration of a car-like mobile robot to improve odometry accuracy , 2010 .

[9]  Klaus Schilling,et al.  Calibration of a Car-Like Mobile Robot with a High-Precision Positioning System , 2010, TA.

[10]  Hannes Sommer,et al.  Online self-calibration for robotic systems , 2016, Int. J. Robotics Res..

[11]  José Luis Gordillo,et al.  Numerical comparison of steering geometries for robotic vehicles by modeling positioning error , 2007, Auton. Robots.

[12]  Ángel F. García-Fernández,et al.  Bayesian Road Estimation Using Onboard Sensors , 2014, IEEE Transactions on Intelligent Transportation Systems.

[13]  Sebastian Thrun,et al.  Online self-calibration for mobile robots , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[14]  Luca Martino,et al.  Cooperative parallel particle filters for online model selection and applications to urban mobility , 2015, Digit. Signal Process..

[15]  Woojin Chung,et al.  Accurate calibration of systematic errors for car-like mobile robots using experimental orientation errors , 2016 .

[16]  Gianluca Antonelli,et al.  Linear estimation of the physical odometric parameters for differential-drive mobile robots , 2007, Auton. Robots.

[17]  Mun-Ho Jeong,et al.  Simultaneous Calibration of Odometry and Head-Eye Parameters for Mobile Robots with a Pan-Tilt Camera , 2019, Sensors.

[18]  Roland Siegwart,et al.  Automated valet parking and charging for e-mobility , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

[19]  Raja Chatila,et al.  An Experimental System for Incremental Environment Modelling by an Autonomous Mobile Robot , 1989, ISER.

[20]  Péter Gáspár,et al.  Vehicle odometry model identification considering dynamic load transfers , 2020, 2020 28th Mediterranean Conference on Control and Automation (MED).

[21]  Michael J. Black,et al.  Modeling and decoding motor cortical activity using a switching Kalman filter , 2004, IEEE Transactions on Biomedical Engineering.

[22]  Alexander Rudolph,et al.  Quantification and Estimation of Differential Odometry Errors in Mobile Robotics with Redundant Sensor Information , 2003, Int. J. Robotics Res..

[23]  L. Ljung.  Approaches to identification of nonlinear systems , 2010, Proceedings of the 29th Chinese Control Conference.

[24]  Péter Gáspár,et al.  Model Based Vehicle Localization via an Iterative Parameter Estimation , 2019 .

[25]  R. Siegwart,et al.  Observability Properties and Optimal Trajectories for On-line Odometry Self-Calibration , 2006, Proceedings of the 45th IEEE Conference on Decision and Control.

[26]  Giuseppe Oriolo,et al.  Simultaneous Calibration of Odometry and Sensor Parameters for Mobile Robots , 2013, IEEE Transactions on Robotics.

[27]  J. Borenstein,et al.  Experimental results from FLEXnav: an expert rule-based dead-reckoning system for Mars rovers , 2004, 2004 IEEE Aerospace Conference Proceedings (IEEE Cat. No.04TH8720).

[28]  Hannu Tenhunen,et al.  A Survey on Odometry for Autonomous Navigation Systems , 2019, IEEE Access.

[29]  Roland Siegwart,et al.  Introduction to Autonomous Mobile Robots , 2004 .

[30]  Sebastian Thrun,et al.  Stanley: The robot that won the DARPA Grand Challenge , 2006, J. Field Robotics.

[31]  Andrew Fox,et al.  Multi-Lane Pothole Detection from Crowdsourced Undersampled Vehicle Sensor Data , 2017, IEEE Transactions on Mobile Computing.

[32]  Roland Siegwart,et al.  Robust visual inertial odometry using a direct EKF-based approach , 2015, IROS 2015.

[33]  Klaus-Dieter Kuhnert,et al.  Autonomous parking in subterranean garages-a look at the position estimation , 2003, IEEE IV2003 Intelligent Vehicles Symposium. Proceedings (Cat. No.03TH8683).

[34]  Lindsay Kleeman,et al.  A novel odometry model for wheeled mobile robots incorporating linear acceleration , 2017, 2017 IEEE International Conference on Mechatronics and Automation (ICMA).

[35]  Frank Gauterin,et al.  GNSS-shortages-resistant and self-adaptive rear axle kinematic parameter estimator (SA-RAKPE) , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[36]  A. Doucet,et al.  Particle Markov chain Monte Carlo methods , 2010 .

[37]  Giovanni Muscato,et al.  Localization and self-calibration of a robot for volcano exploration , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[38]  ThrunSebastian,et al.  Stanley: The robot that won the DARPA Grand Challenge , 2006 .

[39]  Ole Ravn,et al.  Location Estimation for an Autonomously Guided Vehicle using an Augmented Kalman Filter to Autocalib , 1998 .

[40]  Hyun Chul Roh,et al.  Complex Urban LiDAR Data Set , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[41]  Martin Brossard,et al.  Learning Wheel Odometry and IMU Errors for Localization , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[42]  Dongpu Cao,et al.  A Novel Online Approach for Drift Covariance Estimation of Odometries Used in Intelligent Vehicle Localization † , 2019, Sensors.

[43]  Matthias Becker,et al.  Benefits of Multi-Constellation/Multi-Frequency GNSS in a Tightly Coupled GNSS/IMU/Odometry Integration Algorithm † , 2018, Sensors.

[44]  Alonzo Kelly.  General solution for linearized systematic error propagation in vehicle odometry , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[45]  Liqiang Feng,et al.  Measurement and correction of systematic odometry errors in mobile robots , 1996, IEEE Trans. Robotics Autom..

[46]  Alonzo Kelly,et al.  Vehicle model identification by integrated prediction error minimization , 2013, Int. J. Robotics Res..

[47]  Lindsay Kleeman,et al.  Accurate odometry and error modelling for a mobile robot , 1997, Proceedings of International Conference on Robotics and Automation.

[48]  Agostino Martinelli,et al.  The odometry error of a mobile robot with a synchronous drive system , 2002, IEEE Trans. Robotics Autom..

[49]  David Alejo,et al.  A Robust Localization System for Inspection Robots in Sewer Networks † , 2019, Sensors.

[50]  Denis Pomorski,et al.  GPS/IMU data fusion using multisensor Kalman filtering: introduction of contextual aspects , 2006, Inf. Fusion.

[51]  Gail D. Baura,et al.  Nonlinear System Identification , 2002 .