Real-Time Pose Graph SLAM based on Radar

This work presents a real-time pose graph based Simultaneous Localization and Mapping (SLAM) system for automotive Radar. The algorithm constructs a map from Radar detections using the Iterative Closest Point (ICP) method to match consecutive scans obtained from a single, front-facing Radar sensor. The algorithm is evaluated on a range of realworld datasets and shows mean translational errors as low as 0.62 m and demonstrates robustness on long tracks. Using a single Radar, our proposed system achieves state-of-the-art performance when compared to other Radar-based SLAM algorithms that use multiple, higher-resolution Radars.

[1]  P. Holland,et al.  Robust regression using iteratively reweighted least-squares , 1977 .

[2]  Wolfgang Hess,et al.  Real-time loop closure in 2D LIDAR SLAM , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[3]  Jean-Emmanuel Deschaud,et al.  IMLS-SLAM: Scan-to-Model Matching Based on 3D Data , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[4]  Wolfram Burgard,et al.  Robust map optimization using dynamic covariance scaling , 2013, 2013 IEEE International Conference on Robotics and Automation.

[5]  J. Dickmann,et al.  Real-Time Radar SLAM , 2017 .

[6]  Wolfram Burgard,et al.  A benchmark for the evaluation of RGB-D SLAM systems , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[7]  Christoph Gustav Keller,et al.  Robust localization based on radar signal clustering , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

[8]  Andrew Zisserman,et al.  MLESAC: A New Robust Estimator with Application to Estimating Image Geometry , 2000, Comput. Vis. Image Underst..

[9]  Paul J. Besl,et al.  A Method for Registration of 3-D Shapes , 1992, IEEE Trans. Pattern Anal. Mach. Intell..

[10]  Frank Dellaert,et al.  iSAM2: Incremental smoothing and mapping using the Bayes tree , 2012, Int. J. Robotics Res..

[11]  Roland Chapuis,et al.  Radar Scan Matching SLAM Using the Fourier-Mellin Transform , 2009, FSR.

[12]  Albert-Jan Baerveldt,et al.  Robot localization based on scan-matching - estimating the covariance matrix for the IDC algorithm , 2003, Robotics Auton. Syst..

[13]  Kai Oliver Arras,et al.  FLIRT - Interest regions for 2D range data , 2010, 2010 IEEE International Conference on Robotics and Automation.

[14]  Hugh F. Durrant-Whyte,et al.  Autonomous land vehicle navigation using millimeter wave radar , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[15]  Paul Newman,et al.  Precise Ego-Motion Estimation with Millimeter-Wave Radar Under Diverse and Challenging Conditions , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[16]  Simon Lacroix,et al.  ICP-based pose-graph SLAM , 2016, 2016 IEEE International Symposium on Safety, Security, and Rescue Robotics (SSRR).

[17]  Adrien Bartoli,et al.  Fast Explicit Diffusion for Accelerated Features in Nonlinear Scale Spaces , 2013, BMVC.

[18]  John Folkesson,et al.  Vehicle localization with low cost radar sensors , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

[19]  Klaus C. J. Dietmayer,et al.  Instantaneous ego-motion estimation using Doppler radar , 2013, 16th International IEEE Conference on Intelligent Transportation Systems (ITSC 2013).

[20]  John J. Leonard,et al.  Past, Present, and Future of Simultaneous Localization and Mapping: Toward the Robust-Perception Age , 2016, IEEE Transactions on Robotics.

[21]  Stefan Schaal,et al.  A Kalman filter for robust outlier detection , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[22]  Sven Hellbach,et al.  Large scale place recognition in 2D LIDAR scans using Geometrical Landmark Relations , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[23]  Christoph Gustav Keller,et al.  Landmark based radar SLAM using graph optimization , 2016, 2016 IEEE 19th International Conference on Intelligent Transportation Systems (ITSC).

[24]  Hugh F. Durrant-Whyte,et al.  A solution to the simultaneous localization and map building (SLAM) problem , 2001, IEEE Trans. Robotics Autom..