G-EDF-Loc: 3D Continuous Gaussian Distance Field for Robust Gradient-Based 6DoF Localization
Organizations: The authors are with the Service Robotics Laboratory, Universidad Pablo de Olavide, Seville, Spain.
Abstract
This paper presents a robust 6-DoF localization framework based on a direct, CPU-based scan-to-map registration pipeline. The system leverages G-EDF, a novel continuous and memory-efficient 3D distance field representation. The approach models the Euclidean Distance Field (EDF) using a Block-Sparse Gaussian Mixture Model with adaptive spatial partitioning, ensuring continuity across block transitions and mitigating boundary artifacts. By leveraging the analytical gradients of this continuous map, which maintain Eikonal consistency, the proposed method achieves high-fidelity spatial reconstruction and real-time localization. Experimental results on large-scale datasets demonstrate that G-EDF-Loc performs competitively against state-of-the-art methods, exhibiting exceptional resilience even under severe odometry degradation or in the complete absence of IMU priors.
Figures & tables
| Dataset | Distance Error (m) | Gradient | |||
|---|---|---|---|---|---|
| MAE | Med. | Std | Mean | Std | |
| New College | 0.033 | 0.018 | 0.044 | 0.984 | 0.089 |
| Snail | 0.035 | 0.018 | 0.049 | 0.979 | 0.108 |
| Traj. | Method | Inertial | No IMU | Low | High | ||||||||
|---|---|---|---|---|---|---|---|---|---|---|---|---|---|
| Pos | Rot | Time | Pos | Rot | Time | Pos | Rot | Time | Pos | Rot | Time | ||
| bc | Ours | 0.084 | 1.133 | 76.9 | 0.215 | 1.204 | 95.2 | 0.084 | 1.133 | 107.3 | 0.118 | 1.207 | 118.5 |
| Fast-GICP | 0.082 | 1.129 | 67.7 | 2.884 | 38.900 | 1366.9 | 0.122 | 1.179 | 78.7 | 0.261 | 1.452 | 134.6 | |
| NDT | 0.084 | 1.138 | 94.7 | 0.308 | 3.349 | 81.5 | 0.087 | 1.134 | 98.9 | 0.169 | 1.241 | 134.7 | |
| sl | Ours | 0.157 | 1.049 | 61.8 | 0.217 | 0.985 | 63.3 | 0.158 | 1.048 | 70.6 | 0.192 | 1.089 | 83.9 |
| Fast-GICP | 0.153 | 1.043 | 63.5 | - | - | - | 0.169 | 1.045 | 75.2 | 0.320 | 1.306 | 148.9 | |
Map-Based Localization
Map-Based Localization estimates a device or robot’s position and orientation by matching sensor observations to stored maps.
See all 106 papers