A Robust Hybrid Multisource Data Fusion Approach for Vehicle Localization
- 1 The French Institute of Science and Technology for Transport, Development and Networks (IFSTTAR), COSYS Department, LIVIC Laboratory, 77 rue des Chantiers, Versailles, France.
- 2 The French Institute of Science and Technology for Transport, Development and Networks (IFSTTAR), COSYS Department, LIVIC Laboratory, 77 rue des Chantiers, Versailles, France.
- 3 The French Institute of Science and Technology for Transport, Development and Networks (IFSTTAR), COSYS Department, LIVIC Laboratory, 77 rue des Chantiers, Versailles, France.
Abstract
In this paper , an innovative collaborative data fusion approach to ego-vehicle localization is presented. This approach called Optimized Kalman Swarm (OKS) is a data fusion and filtering method, fusing data from a low cost GPS, an INS, an Odometer and a Steering wheel angle encoder. The OKS is developed addressing the challenge of managing reactiv ity and robustness during a real time ego-localization process. For ego-vehicle localization, especially for highly dy namic on-road maneuvers, a filter needs to be robust and reactive at the same time. In these situations, the balance be tween reactivity and robustness concepts is crucial. The OKS filter represents an intelligent cooperative-reactive local ization algorithm inspired by dynamic Particle Swarm Optimization (PSO). It combines advantages coming from two filters: Particle Filter (PF) and Extended Kalman filter (EKF). The OKS is tested using real embedded sensors data collected in the Satory’s test tracks. The OKS is also compared with both the well - known EKF and the Particle Filters (PF). The results show the efficiency of the OKS for a high dynamic driving scenario with damaged and low quality GPS data .
- J. Godoy, D. Gruyer, A. Lambert and J. Villagra, “Development of a Particle Swarm Algorithm for Vehicle Lo- calization,” IEEE Intelligent Vehicles Symposium, Alcala de Henares, 3-7 June 2012, pp. 1114-1119.
- E. Seignez, A. Lambert and T. Maurin, “Autonomous Parking Carrier for Intelligent Vehicle,” IEEE International Conference on Intelligent Vehicle, Nevada, 6-8 June 2005, pp. 411-416.
- A. Ndjeng, A. Lambert, D. Gruyer and S. Glaser, “Experimental Comparison of Kalman Filters for Vehicle Localization,” IEEE Intelligent Vehicles Symposium, Xi’an, 3-5 June 2009, pp. 441-446.
- P. S. Maybeck, “Stochastic Models, Estimation and Con- trol,” Academic Press, New York, 1982.
- F. L. Lewis, “Optimal Estimation: With an Introduction to Stochastic Control Theory,” John Wiley & Sons, New York, 1986.
- R. E. Kalman, “A New Approach to Linear Filtering and Prediction System,” Transactions of the ASME-Journal of Basic Engineering, Vol. 82, 1960, pp. 35-45.
- B. Mourllion, D. Gruyer, A. Lambert and S. Glaser, “Kalman Filters Comparison for Vehicle Localization Data Alignment,” IEEE/RSJ International Conference on Advanced Robotics, Seattle, 18-20 July 2005, pp. 178-185.
- J. Ali and M. R. Ullah Baig Mirza, “Performance Comparison among Some Nonlinear Filters for a Low Cost Sins/Gps Integrated Solution,” Nonlinear Dynamics, Vol. 61, No. 3, 2010, pp. 491-502.
- L. Bazzani, D. Bloisi and V. Murino, “A Comparison of Multi Hypothesis Kalman Filter and Particle Filter for Multi-Target Tracking,” Performance Evaluation of Tracking and Surveillance Workshop at CVPR, Miami, 25 June 2009, pp. 47-54.
- J. Laneurit, C. Blanc, R. Chapuis and L. Trassoudaine, “Multisensorial Data Fusion for Global Vehicle and Obstacles Absolute Positioning,” IEEE Intelligent Vehicles Symposium, Columbus, 9-11 June 2003, pp. 138-143.
- J. S. Gutmann, T. Weigel and B. Nebel, “A Fast, Accurate, and Robust Method for Self-Localization in Polygonal Environments Using Laser Range Finders,” Advanced Robotics Journal, Vol. 14, No. 8, 2001, pp. 651-668. http://dx.doi.org/10.1163/156855301750078720
- I. Abuhadrous, F. Nashashibi and C. Laurgeau, “3-d Land Vehicle Localization: A Real-Time Multi-Sensor Data Fusion Approach Using Rtmaps,” International Conference on Advanced Robotics, University of Coimbra, Portugal, June 30-July 3, 2003, pp. 71-76.
- Y. Shi and R. Eberhart, “A Modified Particle Swarm Optimizer,” IEEE International Conference on Evolutionary Computation, Anchorage, 4-9 May 1998, pp. 69-73.