Accurate and Efficient Self-Localization on Roads using Basic Geometric Primitives

Highly accurate localization with very limited amount of memory and computational power is one of the big challenges for next generation series cars. We propose localization based on geometric primitives which are compact in representation and further valuable for other tasks like planning and behavior generation. The primitives lack distinctive signature which makes association between detections and map elements highly ambiguous. We resolve ambiguities early in the pipeline by online building up a local map which is key to runtime efficiency. Further, we introduce a new framework to fuse association and odometry measurements based on robust pose graph optimization.We evaluate our localization framework on over 30 min of data recorded in urban scenarios. Our map is memory efficient with less than 8 kB/km and we achieve high localization accuracy with a mean position error of less than 10 cm and a mean yaw angle error of less than 0. 25° at a localization update rate of 50Hz.

[1]  Chen Feng,et al.  Point-plane SLAM for hand-held 3D sensors , 2013, 2013 IEEE International Conference on Robotics and Automation.

[2]  Markus Schreiber,et al.  Vehicle localization with tightly coupled GNSS and visual odometry , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

[3]  Markus Schreiber,et al.  LaneLoc: Lane marking based localization using highly accurate maps , 2013, 2013 IEEE Intelligent Vehicles Symposium (IV).

[4]  Wolfram Burgard,et al.  Monocular camera localization in 3D LiDAR maps , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[5]  Martin Lauer,et al.  Automatic Calibration of Multiple Cameras and Depth Sensors with a Spherical Target , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[6]  Sascha Wirges,et al.  Making Bertha Cooperate–Team AnnieWAY’s Entry to the 2016 Grand Cooperative Driving Challenge , 2018, IEEE Transactions on Intelligent Transportation Systems.

[7]  Raúl Rojas,et al.  Pole-based localization for autonomous vehicles in urban scenarios , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[8]  Martin Lauer,et al.  Mapping and localization using surround view , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[9]  Erik B. Dam,et al.  Quaternions, Interpolation and Animation , 2000 .

[10]  Myoungho Sunwoo,et al.  Interacting Multiple Model Filter-Based Sensor Fusion of GPS With In-Vehicle Sensors for Real-Time Vehicle Positioning , 2012, IEEE Transactions on Intelligent Transportation Systems.

[11]  Julius Ziegler,et al.  Urban localization with camera and inertial measurement unit , 2013, 2013 IEEE Intelligent Vehicles Symposium (IV).

[12]  Markus Schreiber,et al.  A Universal Approach to Detect and Classify Road Surface Markings , 2015, 2015 IEEE 18th International Conference on Intelligent Transportation Systems.

[13]  Gyu-In Jee,et al.  Vertical Corner Feature Based Precise Vehicle Localization Using 3D LIDAR in Urban Area , 2016, Sensors.

[14]  Richard Szeliski,et al.  Bundle Adjustment in the Large , 2010, ECCV.

[15]  Tsuyoshi Murata,et al.  {m , 1934, ACML.

[16]  Sebastian Thrun,et al.  Robust vehicle localization in urban environments using probabilistic maps , 2010, 2010 IEEE International Conference on Robotics and Automation.

[17]  M. Veloso,et al.  Depth Camera based Localization and Navigation for Indoor Mobile Robots , 2011 .

[18]  Achim Kampker,et al.  Improving vehicle localization using semantic and pole-like landmarks , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[19]  Lawrence Charles Paulson,et al.  Quaternions , 1873, Nature.

[20]  BERND EISSFELLER,et al.  Performance of GPS , GLONASS and Galileo , 2007 .

[21]  Sebastian Thrun,et al.  Map-Based Precision Vehicle Localization in Urban Environments , 2007, Robotics: Science and Systems.

[22]  Denis Pomorski,et al.  GPS/IMU data fusion using multisensor Kalman filtering: introduction of contextual aspects , 2006, Inf. Fusion.

[23]  Julius Ziegler,et al.  Calibrating multiple cameras with non-overlapping views using coded checkerboard targets , 2014, 17th International IEEE Conference on Intelligent Transportation Systems (ITSC).

[24]  Shichao Yang,et al.  Pop-up SLAM: Semantic monocular plane SLAM for low-texture environments , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[25]  Christoph Stiller,et al.  Efficient Multi-Drive Map Optimization towards Life-long Localization using Surround View , 2018, 2018 21st International Conference on Intelligent Transportation Systems (ITSC).

[26]  Christoph Stiller,et al.  Precise Localization in High-Definition Road Maps for Urban Regions , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).