Multi-Sensor Multi-Vehicle (MSMV) Localization and Mobility Tracking for Autonomous Driving

Vehicle localization and mobility tracking are important tasks in autonomous driving. Traditional methods either have insufficient accuracy or rely on additional facilities to reach the desired accuracy for autonomous driving. In this paper, a multi-sensor multi-vehicle localization and mobility tracking framework is developed for autonomous vehicles equipped with GPS, inertial measurement unit (IMU), and an integrated sensing system. Our algorithm fuse the information from local onboard sensors as well as the observations of other vehicles or existing intelligent transportation system infrastructure such as road side units (RSU) to improve the precision and stability of localization and mobility tracking. Specifically, this framework incorporates the dynamic model of vehicles to achieve better localization and tracking performance. The communication delays during the information sharing process are explicitly taken into account in our algorithm development. Simulations manifest that not only the accuracy of localization and mobility tracking could be greatly enhanced in general, but also the robustness can be guaranteed under circumstances where traditional localization and tracking devices fail.

[1]  Xiang Cheng,et al.  5G-Enabled Cooperative Intelligent Vehicular (5GenCIV) Framework: When Benz Meets Marconi , 2017, IEEE Intelligent Systems.

[2]  Hugh Durrant-Whyte.  Where am I? A tutorial on mobile vehicle localization , 1994 .

[3]  Peter Cheeseman,et al.  A stochastic map for uncertain spatial relationships , 1988 .

[4]  Ryan M. Eustice,et al.  Robust LIDAR localization using multiresolution Gaussian mixture maps for autonomous driving , 2017, Int. J. Robotics Res..

[5]  Han-You Jeong,et al.  An accurate vehicle positioning algorithm based on vehicle-to-vehicle (V2V) communications , 2012, 2012 IEEE International Conference on Vehicular Electronics and Safety (ICVES 2012).

[6]  Fakhri Karray,et al.  Vehicle localization in VANETs using data fusion and V2V communication , 2012, DIVANet@MSWiM.

[7]  T. Başar,et al.  A New Approach to Linear Filtering and Prediction Problems , 2001 .

[8]  Moe Z. Win,et al.  Network localization and navigation via cooperation , 2011, IEEE Communications Magazine.

[9]  Zheng Nanning,et al.  Cooperative Intelligence for Autonomous Driving , 2019 .

[10]  Xiang Cheng,et al.  Wireless Toward the Era of Intelligent Vehicles , 2019, IEEE Internet of Things Journal.

[11]  Albert Y. Zomaya,et al.  VLOCI2: improving 2D location coordinates using distance measurements in GPS-equipped VANETs , 2011, MSWiM '11.

[12]  Ramsey Michael Faragher,et al.  Understanding the Basis of the Kalman Filter Via a Simple and Intuitive Derivation [Lecture Notes] , 2012, IEEE Signal Processing Magazine.

[13]  Yasmine A. Fahmy,et al.  High Accuracy GPS-Free Vehicle Localization Framework via an INS-Assisted Single RSU , 2015, Int. J. Distributed Sens. Networks.

[14]  Xiang Cheng,et al.  OPTIMAL MULTI-SENSOR MULTI-VEHICLE (MSMV) LOCALIZATION AND MOBILITY TRACKING , 2018, 2018 IEEE Global Conference on Signal and Information Processing (GlobalSIP).

[15]  Ming Yang,et al.  Landmark Pair based Localization for Intelligent Vehicles using Laser Radar , 2007, 2007 IEEE Intelligent Vehicles Symposium.

[16]  Bijan Shirinzadeh,et al.  Multi-sensor optimal data fusion for INS/GPS/SAR integrated navigation system , 2009 .

[17]  Kok Kiong Tan,et al.  Vision-based approach towards lane line detection and vehicle localization , 2015, Machine Vision and Applications.

[18]  Antonio Pescapè,et al.  Quality of service statistics over heterogeneous networks: Analysis and applications , 2008, Eur. J. Oper. Res..

[19]  Siddharth Agarwal,et al.  Ground-Edge-Based LIDAR Localization Without a Reflectivity Calibration for Autonomous Driving , 2017, IEEE Robotics and Automation Letters.

[20]  Hirozumi Yamaguchi,et al.  Cooperative Vehicle Positioning via V2V Communications and Onboard Sensors , 2011, 2011 IEEE Vehicular Technology Conference (VTC Fall).

[21]  Holger Mielenz,et al.  Precise vehicle localization in dense urban environments , 2016, 2016 IEEE 19th International Conference on Intelligent Transportation Systems (ITSC).

[22]  Chin-Liang Wang,et al.  Decentralized target positioning and tracking based on a weighted extended Kalman filter for wireless sensor networks , 2013, Wirel. Networks.

[23]  Ding Zhao,et al.  Improving Localization Accuracy in Connected Vehicle Networks Using Rao–Blackwellized Particle Filters: Theory, Simulations, and Experiments , 2017, IEEE Transactions on Intelligent Transportation Systems.

[24]  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.

[25]  Brian L. Mark,et al.  Real-time mobility tracking algorithms for cellular networks based on Kalman filtering , 2005, IEEE Transactions on Mobile Computing.

[26]  Ryan M. Eustice,et al.  Visual localization within LIDAR maps for automated urban driving , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[27]  Fawzi Nashashibi,et al.  Cooperative Multi-Vehicle Localization Using Split Covariance Intersection Filter , 2013, IEEE Intelligent Transportation Systems Magazine.

[28]  Imad Mahgoub,et al.  Fuzzy logic based localization for vehicular ad hoc networks , 2014, 2014 IEEE Symposium on Computational Intelligence in Vehicles and Transportation Systems (CIVTS).

[29]  TanKok Kiong,et al.  Vision-based approach towards lane line detection and vehicle localization , 2016 .

[30]  N. Mattern,et al.  Co-operative vehicle localization algorithm — Evaluation of the CoVeL approach , 2012, International Multi-Conference on Systems, Sygnals & Devices.

[31]  Eduardo F. Nakamura,et al.  Information fusion for wireless sensor networks: Methods, models, and classifications , 2007, CSUR.

[32]  Fawzi Nashashibi,et al.  Multi-vehicle cooperative localization using indirect vehicle-to-vehicle relative pose estimation , 2012, 2012 IEEE International Conference on Vehicular Electronics and Safety (ICVES 2012).

[33]  Lindsay Kleeman,et al.  Optimal estimation of position and heading for mobile robots using ultrasonic beacons and dead-reckoning , 1992, Proceedings 1992 IEEE International Conference on Robotics and Automation.

[34]  Cedric Nishan Canagarajah,et al.  Mobility Tracking in Cellular Networks Using Particle Filtering , 2007, IEEE Transactions on Wireless Communications.

[35]  Denis Fernando Wolf,et al.  Feature Detection for Vehicle Localization in Urban Environments Using a Multilayer LIDAR , 2016, IEEE Transactions on Intelligent Transportation Systems.

[36]  Mario di Bernardo,et al.  Design, Analysis, and Experimental Validation of a Distributed Protocol for Platooning in the Presence of Time-Varying Heterogeneous Delays , 2016, IEEE Transactions on Control Systems Technology.

[37]  Shu-Li Sun,et al.  Multi-sensor optimal information fusion Kalman filter , 2004, Autom..

[38]  Moe Z. Win,et al.  Cooperative Localization in Wireless Networks , 2009, Proceedings of the IEEE.

[39]  Hyun Myung,et al.  Robust Vehicle Localization Using Entropy-Weighted Particle Filter-based Data Fusion of Vertical and Road Intensity Information for a Large Scale Urban Area , 2017, IEEE Robotics and Automation Letters.

[40]  Bin Dai,et al.  Vision-based precision vehicle localization in urban environments , 2013, 2013 Chinese Automation Congress.