Robust 3/6 DoF self-localization system with selective map update for mobile robot platforms

Mobile robot platforms capable of operating safely and accurately in dynamic environments can have a multitude of applications, ranging from simple delivery tasks to advanced assembly operations. These abilities rely heavily on a robust navigation stack, which requires stable and accurate pose estimations within the environment. To solve this problem, a modular localization system suitable for a wide range of mobile robot platforms was developed. By using LIDAR/RGB-D data, the proposed system is capable of achieving 1-2 cm in translation error and 1?-3??degrees in rotation error while requiring only 5-35?ms of processing time (in 3 and 6 DoF respectively). The system was tested in three robot platforms and in several environments with different sensor configurations. It demonstrated high accuracy while performing pose tracking with point cloud registration algorithms and high reliability when estimating the initial pose using feature matching techniques. The system can also build a map of the environment with surface reconstruction and incrementally update it with either the full field of view of the sensor data or only the unknown sections, which allows to reduce the mapping processing time and also gives the possibility to update a CAD model of the environment without degrading the detail of known static areas due to sensor noise. 3/6 DoF localization system capable to operate in cluttered/dynamic and challenging environments.Efficient C++ ROS implementation with multi-level point cloud registration and recovery.Robust initial pose estimation using geometric feature matching.2D/3D mapping with integration of full sensor data or only unknown areas.Fully configurable and modular processing pipeline, extensible to other tasks besides self-localization.