Skip to main content
Log in

A Road-Matching Method for Precise Vehicle Localization Using Belief Theory and Kalman Filtering

  • Published:
Autonomous Robots Aims and scope Submit manuscript

Abstract

This paper describes a novel road-matching method designed to support the real-time navigational function of cars for advanced systems applications in the area of driving assistance. This method provides an accurate estimation of position for a vehicle relative to a digital road map using Belief Theory and Kalman filtering. Firstly, an Extended Kalman Filter combines the DGPS and ABS sensor measurements to produce an approximation of the vehicle’s pose, which is then used to select the most likely segment from the database. The selection strategy merges several criteria based on distance, direction and velocity measurements using Belief Theory. A new observation is then built using the selected segment, and the approximate pose adjusted in a second Kalman filter estimation stage. The particular attention given to the modeling of the system showed that incrementing the state by the bias (also called absolute error) of the map significantly increases the performance of the method. Real experimental results show that this approach, if correctly initialized, is able to work over a substantial period without GPS.

This is a preview of subscription content, log in via an institution to check access.

Access this article

Price excludes VAT (USA)
Tax calculation will be finalised during checkout.

Instant access to the full article PDF.

Similar content being viewed by others

References

  • Abbott, E. and Powell, D. 1999. Land-vehicle navigation using GPS. In Proc. of the IEEE, Vol. 87, No. 1.

  • Arulampalam, S., Maskell, S., Gordon, N., and Clapp, T. 2002. A tutorial on particle filters for on-line non-linear/non-gaussian bayesian tracking. IEEE Transactions on Signal Processing, 50(2): 174–188.

    Google Scholar 

  • Bernstein, D. and Kornhauser, A. 1998. Map Matching for personal navigation assistants. In 77th Annual Meeting, The Transport Research Board, Jan. 11–15, Washinton D.C.

  • Bétaille, D. and Bonnifait, Ph. 2000. Road maintenance vehicles location using DGPS, map-matching and dead-reckoning: Experimental results of a smoothed EKF. In IAIN World Congress in Association with the US ION Annual Meeting. San Diego, pp. 409–416.

  • Bonnifait, Ph., Bouron, P., Crubille, P., and Meizel, D. 2001. Data fusion of four abs sensors and GPS for an enhanced localization of car-like vehicles. In IEEE ICRA 2001 23-25, Séoul, pp. 1597–1602.

  • Borenstein, J., Everet, H.R., and Feng, L. 1996. Navigating mobile robots: Systems and techniques. A.K. Peters Ltd., Wellesley, MA.

    Google Scholar 

  • Dempster, A.P. 1976. Upper and lower probabilities induced by a multivalued mapping. Annals of Mathematical Statistics, Vol. 38.

  • Dissanayake, M.W.M.G., Newman, P., Clark, S., Durrant-Whyte, H.F., and Csorba, M. 2001. A solution to the simultaneous localization and map building (SLAM) problem. IEEE Transactions on Robotics and Automation, 17(3).

  • Dubois, D. and Prade, H. 1993. Fuzzy sets and system theory and application. Mathematics in Science and Engineering, Vol. 144, Academic Press, Inc.

  • El Najjar, M.E. and Bonnifait, Ph. 2002. Multi-criteria fusion for the selection of roads of an accurate map. In 15th IFAC World Congress, Barcelona, 21–27.

  • El Najjar, M.E. and Bonnifait, Ph. 2002. A road reduction method using multi-criteria fusion. In IEEE Intelligent Vehicle Symposium, Versailles, France.

  • Fabiani, P. 1996. Représentation dynamique de l’incertain et stratégie de prise d’information pour un système autonome en environnement evolutif. PhD. Thesis Ecole Nationale Supérieure de l’Aéronautique et de l’Espace.

  • Fox, D., Burgard, W., and Thrun, S. 1999. Markov localisation for mobile robots in dynamic environments, Journal of Artificial Intelligence Research, 11:391–394.

    Google Scholar 

  • Greenfeld, J. 2002. Matching GPS observations to locations on a digital map. 81th Annual Meeting of the Transportation Research Board, January, Washington, DC.

  • Gustafsson, F., Gunnarsson, F., Bergman, N., Forssell, U., Jansson, J., Karlsson, R., and Nordlund, P. 2002. Particle filters for positioning, navigation and tracking. In IEEE Transactions on Signal Processing. Special issue on Monte-Carlo Methods for Statistical Signal Processing.

  • Jensfelt, P. and Kristensen, S. 2001. Active global localisation for a mobile robot using multiple hypothesis tracking. IEEE Transactions on Robotics and Automation.

  • Kim, J.S., Lee, J.H., Kang, T.H., Lee, W.Y., and Kim, Y.G. 1996. Node based map matching algorithm for car navigation system. In Proceedings of the 29th ISATA Symposium, Florence, Vol. 10, pp. 121–126.

  • Krakiwsky, E.J., Harris, C.B., and Wong, R.V.C. 1988. A Kalman filter for integrating dead reckoning, map matching and GPS positioning. In Proceedings of IEEE Position Location and Navigation Symposium, pp. 39–46.

  • Ming Wang, C. 1988. Localisation estimation and uncertainty analysis for mobile robots. IEEE International Conference on Robotics and Automation, Philadelphia, pp. 1230–1235.

  • Scott, C.A. and Drane, C.R. 1994. Increased accuracy of motor vehicle position estimation by utilizing map data, vehicle dynamics and other information sources. In Proceedings of the Vehicle Navigation and Information Systems Conference, pp. 585– 590.

  • Shafer, G. 1976. Mathematical Theory of Evidence. Princeton University Press: Princeton.

    Google Scholar 

  • Tanaka, J., Hirano, K., Itoh, T., Nobuta, H., and Tsunoda, S. 1990. Navigation system with Map-matching method. In Proceedings of the SAE International Congress and Exposition, pp. 45–50.

  • Taylor, G. and Blewitt, G. 2000. Road reduction filtering using GPS. In 3th AGILE Conference on Geographic Information Science, Helsinki, Finland, pp. 114–120.

  • Thrun, S., Fox, D., Burgard, W., and Dellaert, F. 2000. Robust Monte-Carlo localisation for mobile robots. Journal of Artificial Intelligence (AI).

  • Zadeh, L.A. 1986. A simple view of dempster-shafer theory of evidence and its implication for the rule of combination. The AI Magazine.

  • Zhao, Y. 1997. Vehicle location navigation systems. Artech House, Inc.

Download references

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Maan E. El Najjar.

Additional information

Maan El Badaoui El Najjar was born in Tripoli-Lebanon in 1975. He received his engineer diploma and his M.S. degree in control system and automation from the Institut National Polytechnique de Grenoble, France, in 1999 and 2000 respectively and his Ph.D. degree in control system from the Université de Technologie de Compiègne, France, in 2003. He is research and teaching associate at the Heudiasyc laboratory of the Université de Technologie de Compiègne. His current research interests include robot localization, map-aided navigation techniques, sensor fusion and Bayesian estimation techniques.

Philippe Bonnifait graduated from the Ecole Superieure d’Electronique de l’Ouest, France, in 1992 and received the Ph.D. degree in automatic control and computer science from the Ecole Centrale de Nantes, France, in 1997. He joined the Institut de Recherche en Communications et Cybernétique de Nantes (IRCCyN UMR 6597), France, in 1993. Since September 1998, he is with Heudiasyc UMR 6599, France, and he is Assistant Professor at the Université de Technologie de Compiègne. His current research interests are in intelligent outdoor vehicles, with particular emphasis on applications to dynamic localisation.

Rights and permissions

Reprints and permissions

About this article

Cite this article

El Najjar, M.E., Bonnifait, P. A Road-Matching Method for Precise Vehicle Localization Using Belief Theory and Kalman Filtering. Auton Robot 19, 173–191 (2005). https://doi.org/10.1007/s10514-005-0609-1

Download citation

  • Issue Date:

  • DOI: https://doi.org/10.1007/s10514-005-0609-1

Keywords

Navigation