Vehicle Dynamics State Estimation and Localization for High Performance Race Cars

Abstract Autonomous driving requires accurate information about the vehicle pose and motion state in order to achieve precise tracking of the planned trajectory. In this paper we propose a robust architecture to localize a high performance race car and show experimental results with speeds up to 150 km h-1 and utilizing approximately 80% of the available friction level. The concept has been applied using the development vehicle DevBot taking part in the Roborace competition. To achieve robust and reliable performance, we use two independent localization pipelines, one based on GPS and one on LIDARs. We propose to fuse them via a Kalman Filter based on a purely kinematic model and show, that it can outperform a high fidelity model under realistic race conditions. An outstanding property of this concept is that it does not depend on any of the vehicles parameter and is therefore robust to varying tire and track conditions. Further we present an adaption method for the measurement covariances based on the track layout. This allows to combine the strengths of each localization method.

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

[2]  Philippe Bonnifait,et al.  Data fusion of four ABS sensors and GPS for an enhanced localization of car-like vehicles , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[3]  Markus Lienkamp,et al.  What can we learn from autonomous level-5 motorsport? , 2018, Proceedings.

[4]  Mehrdad Dianati,et al.  A Survey of the State-of-the-Art Localization Techniques and Their Potentials for Autonomous Vehicle Applications , 2018, IEEE Internet of Things Journal.

[5]  Keith J. Burnham,et al.  Dual extended Kalman filter for vehicle state and parameter estimation , 2006 .

[6]  Hong Chen,et al.  Estimation of Vehicle Yaw Rate and Side Slip Angle using Moving Horizon Strategy , 2006, 2006 6th World Congress on Intelligent Control and Automation.

[7]  Dominique Gruyer,et al.  A cooperative fusion architecture for robust localization: Application to autonomous driving , 2016, 2016 IEEE 19th International Conference on Intelligent Transportation Systems (ITSC).

[8]  Andreas Kugi,et al.  Unscented Kalman filter for vehicle state estimation , 2011 .

[9]  Tobias Ortmaier,et al.  State estimation of vehicle's lateral dynamics using unscented Kalman filter , 2014, 53rd IEEE Conference on Decision and Control.

[10]  Evangeline Pollard,et al.  On line mapping and global positioning for autonomous driving in urban environment based on evidential SLAM , 2015, 2015 IEEE Intelligent Vehicles Symposium (IV).

[11]  Hong Chen,et al.  Vehicle dynamic state estimation: state of the art schemes and perspectives , 2018, IEEE/CAA Journal of Automatica Sinica.

[12]  Ho Gi Jung,et al.  Sensor Fusion-Based Low-Cost Vehicle Localization System for Complex Urban Environments , 2017, IEEE Transactions on Intelligent Transportation Systems.

[13]  Chung Choo Chung,et al.  Lane estimation using a vehicle kinematic lateral motion model under clothoidal road constraints , 2014, 17th International IEEE Conference on Intelligent Transportation Systems (ITSC).

[14]  P. Wellstead,et al.  Estimation of vehicle lateral velocity , 1996, Proceeding of the 1996 IEEE International Conference on Control Applications IEEE International Conference on Control Applications held together with IEEE International Symposium on Intelligent Contro.

[15]  J. M. M. Montiel,et al.  ORB-SLAM: A Versatile and Accurate Monocular SLAM System , 2015, IEEE Transactions on Robotics.

[16]  John J. Leonard,et al.  Past, Present, and Future of Simultaneous Localization and Mapping: Toward the Robust-Perception Age , 2016, IEEE Transactions on Robotics.

[17]  Zhiyuan Liu,et al.  Design of a Nonlinear Observer for Vehicle Velocity Estimation and Experiments , 2011, IEEE Transactions on Control Systems Technology.

[18]  Jörg Stückler,et al.  Reconstructing Street-Scenes in Real-Time from a Driving Car , 2015, 2015 International Conference on 3D Vision.

[19]  Kyungjae Ahn,et al.  A study on integration of particle filter and dead reckoning for efficient localization of automated guided vehicles , 2015, 2015 IEEE International Symposium on Robotics and Intelligent Sensors (IRIS).