Mobile Robot 6-D Localization Using 3-D Gaussian Mixture Maps in GPS-Denied Environments

Abstract

The mobile robot 6D localization process in GPS-denied scenarios, e.g., in a cave or a mine, is a challenging problem. This paper presents the modification of a well-known literature method using Gaussian mixture maps to determine the robot pose in rough terrain and outdoor non-urbanized environment. To improve the accuracy in rough 3D terrain, I extended the terrain description from a 1D Gaussian mixture model (1DGMM) to a 3D Gaussian mixture model (3DGMM) combining terrain height and terrain inclination in two orthogonal directions. Using this approach, one can maintain centimeter accuracy even in the most demanding workspaces. Moreover, I replaced the 3D scan matching process combined with ground-based smoothing by 6D scan processing (therefore, the 3DGMM method is capable for both land vehicles and flying robots) using the point-by-point EKF based on [12]. Thanks to the point-by-point correction approach, it is possible to run the system in real-time and process a full point cloud without GPU-based computing up to 300 000 points per second using small computers dedicated to mobile robots.