A Floating-point Extended Kalman Filter Implementation for Autonomous Mobile Robots

Localization and mapping are two of the most important capabilities for autonomous mobile robots and have been receiving considerable attention from the scientific computing community over the last 10 years. One of the most efficient methods to address these problems is based on the use of the extended Kalman filter (EKF). The EKF simultaneously estimates a model of the environment (map) and the position of the robot based on odometric and exteroceptive sensor information. As this algorithm demands a considerable amount of computation, it is usually executed on high end PCs coupled to the robot. In this work we present an FPGA-based architecture for the EKF algorithm that is capable of processing two-dimensional maps containing up to 1.8k features at real time (14 Hz) and is two orders of magnitude more power efficient than a general purpose processor.

[1]  Ki-Sang Hong,et al.  Vision-based simultaneous localization and mapping with two cameras , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  G. G. Stokes "J." , 1890, The New Yale Book of Quotations.

[3]  Bernhard P. Wrobel,et al.  Multiple View Geometry in Computer Vision , 2001 .

[4]  Randall Smith,et al.  Estimating uncertain spatial relationships in robotics , 1986, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[5]  Zoran Salcic,et al.  FPGA-based adaptive tracking estimation computer , 2001 .

[6]  Andrew Zisserman,et al.  Multiple View Geometry in Computer Vision (2nd ed) , 2003 .

[7]  Thomas Braunl Embedded Robotics , 2003 .

[8]  Paolo Pirjanian,et al.  Low-cost visual localization and mapping for consumer robotics , 2003, Ind. Robot.

[9]  Juan D. Tardós,et al.  Hierarchical SLAM: real-time accurate mapping of large environments , 2005, IEEE Transactions on Robotics.

[10]  Jon Rigelsford,et al.  Embedded Robotics: Mobile Robot Design and Applications with Embedded Systems , 2004 .

[11]  Eduardo Marques,et al.  An Embedded Multi-camera System for Simultaneous Localization and Mapping , 2006, ARC.

[12]  Dirk Schulz,et al.  Bayesian Filters for Location Estimation , 2003 .

[13]  J. Albukerque,et al.  Autonomous Satellite Navigation Using Optico-Inertial Instruments , 1985 .

[14]  Dieter Fox,et al.  Bayesian Filtering for Location Estimation , 2003, IEEE Pervasive Comput..

[15]  G. Muller,et al.  AUTONOMOUS SATELLITE NAVIGATION USING OPTICO-INERTIAL INSTRUMENTS , 1986 .

[16]  J.C. Chedjou,et al.  GSM RSSI-based positioning using extended Kalman filter for training artificial neural networks , 2004, IEEE 60th Vehicular Technology Conference, 2004. VTC2004-Fall. 2004.

[17]  Lina María Paz,et al.  Optimal local map size for EKF-based SLAM , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[18]  Yang Liu,et al.  Efficient Mapping of a Kalman Filter into an FPGA using Taylor Expansion , 2007, 2007 International Conference on Field Programmable Logic and Applications.

[19]  François Berry,et al.  Towards an Embedded Visuo-Inertial Smart Sensor , 2007, Int. J. Robotics Res..

[20]  Zoran Salcic,et al.  A fully-hardware-type maximum-parallel architecture for Kalman tracking filter in FPGAs , 1997, Proceedings of ICICS, 1997 International Conference on Information, Communications and Signal Processing. Theme: Trends in Information Systems Engineering and Wireless Multimedia Communications (Cat..

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

[22]  Eduardo Mario Nebot,et al.  Solving computational and memory requirements of feature-based simultaneous localization and mapping algorithms , 2003, IEEE Trans. Robotics Autom..

[23]  Sebastian Thrun,et al.  Probabilistic robotics , 2002, CACM.

[24]  Alex M. Andrew Embedded Robotics: Mobile Robot Design and Applications with Embedded Systems , 2004 .

[25]  Xinhua Zhu,et al.  Design of fpga-based kalman filter with CORDIC algorithm , 2002 .

[26]  Peter C. Cheeseman,et al.  Estimating uncertain spatial relationships in robotics , 1986, Proceedings. 1987 IEEE International Conference on Robotics and Automation.