A simultaneous localization and mapping algorithm based on Kalman filtering

For automatic navigation of autonomous vehicles, localization in real time is a key issue. In this article, a simultaneous localization and mapping algorithm is proposed for an autonomous vehicle. We use a laser detection and ranging sensor to detect the operating environment. An environment map is plot out using the sensor output data. Then, with an odometer, the vehicle position is located on this map. Finally, these two sensor outputs are merged using a Kalman filter to correct the map as well as the vehicle position.

[1]  Bjørnar Vik,et al.  A Nonlinear Observer for Integration of GPS and Inertial Navigation Systems , 2000 .

[2]  Sebastian Thrun,et al.  FastSLAM: a factored solution to the simultaneous localization and mapping problem , 2002, AAAI/IAAI.

[3]  Sebastian Thrun,et al.  Robotic mapping: a survey , 2003 .

[4]  A. Walthelm.  A new approach to global self-localization with laser range scans in unstructured environments , 2002, Intelligent Vehicle Symposium, 2002. IEEE.

[5]  Zaher M. Kassas,et al.  Map-based land vehicle navigation system with DGPS , 2002, Intelligent Vehicle Symposium, 2002. IEEE.

[7]  Mohinder S. Grewal,et al.  Global Positioning Systems, Inertial Navigation, and Integration , 2000 .

[8]  Fawzi Nashashibi,et al.  /sup RT/m@ps: a framework for prototyping automotive multi-sensor applications , 2000, Proceedings of the IEEE Intelligent Vehicles Symposium 2000 (Cat. No.00TH8511).

[9]  Bernt Schiele,et al.  Position estimation using principal components of range data , 1998, Robotics Auton. Syst..

[10]  J Wang,et al.  SAFETY AT THE WHEEL : IMPROVING KGPS/INS PERFORMANCE AND RELIABILITY , 2003 .

[11]  Chris Rizos,et al.  Positioning Systems in Intelligent Transportation Systems , 1997 .

[12]  Mohinder S. Grewal,et al.  Kalman Filtering: Theory and Practice Using MATLAB , 2001 .

[13]  Bruno Steux,et al.  RTM@PS: A FRAMEWORK FOR PROTOTYPING AUTOMOTIVE MULTI-SENSOR APPLICATIONS , 2000 .

[14]  Nancy M. Amato,et al.  Localization based on visibility sectors using range sensors , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).