[论文解读] Scalable Magnetic Field SLAM in 3D Using Gaussian Process Maps

Manon Kok, Arno Solin|arXiv (Cornell University)|Apr 5, 2018

Robotics and Sensor-Based Localization被引用 8

一句话总结

本文提出了一种基于高斯过程地图和六边形区块铺砌的可扩展3D磁力场SLAM系统，利用智能手机实现高精度、无需基础设施的室内定位。通过结合低秩GP回归与Rao–Blackwellised粒子滤波，该方法实现了线性计算复杂度和紧凑的地图存储，从而在真实环境中实现大规模3D制图与漂移校正。

ABSTRACT

We present a method for scalable and fully 3D magnetic field simultaneous localisation and mapping (SLAM) using local anomalies in the magnetic field as a source of position information. These anomalies are due to the presence of ferromagnetic material in the structure of buildings and in objects such as furniture. We represent the magnetic field map using a Gaussian process model and take well-known physical properties of the magnetic field into account. We build local maps using three-dimensional hexagonal block tiling. To make our approach computationally tractable we use reduced-rank Gaussian process regression in combination with a Rao-Blackwellised particle filter. We show that it is possible to obtain accurate position and orientation estimates using measurements from a smartphone, and that our approach provides a scalable magnetic field SLAM algorithm in terms of both computational complexity and map storage.

研究动机与目标

• 实现利用建筑物中铁磁性材料产生的磁异常进行可扩展的全3D同步定位与地图构建（SLAM）。
• 解决在大规模环境中全3D高斯过程回归的计算不可行性问题。
• 开发一种紧凑、高效的地图表示方法，以最小化存储与计算成本，同时保持定位精度。
• 将磁力计与惯性里程计数据整合到单一概率框架中，实现鲁棒的6D位姿估计。

提出的方法

• 磁力场建模为高斯过程，其先验基于麦克斯韦方程组，以编码物理约束。
• 采用基函数的低秩近似方法，使大规模3D体积中的GP回归在计算上可行。
• 将地图划分为3D六边形区块瓦片，每个瓦片包含一个局部GP地图，以实现可扩展的局部推理。
• 仅当粒子进入某瓦片体积时才更新该瓦片，从而最小化计算负载并支持增量式地图构建。
• 使用Rao–Blackwellised粒子滤波（RBPF）联合估计位姿并更新局部地图，通过解耦位姿与地图估计实现高效性。
• 融合智能手机传感器（如ARKit）的航位推算数据与磁力计测量结果，以校正位姿估计中的漂移。

实验结果

研究问题

• RQ1 能否使全3D磁力场SLAM系统在大规模室内环境中具备计算可行性？
• RQ2 如何将麦克斯韦方程组的物理约束融入高斯过程先验，以改善磁力场建模？
• RQ3 与均匀网格或其他铺砌方案相比，六边形区块铺砌是否能降低地图存储与计算复杂度？
• RQ4 低秩GP近似在3D磁力场制图中能多大程度上保持精度？
• RQ5 基于RBPF的SLAM框架在仅使用磁力计与惯性里程计的情况下，对位姿漂移的校正效果如何？

主要发现

• 该算法在3D环境中成功实现了高精度的6D位姿（位置与朝向）估计，包括多楼层导航。
• 系统有效校正了智能手机航位推算中的显著漂移，如在重复 traversing 同一路径的实验中所验证。
• 每个六边形区块瓦片可覆盖约260 m³的空间，且状态维度仅为256，实现了紧凑的地图表示。
• 该方法可扩展至大规模环境，如在覆盖剑桥圣约翰学院的27个瓦片地图中实现，包括室内外过渡。
• 该算法的3D特性在一段楼梯上的实验中得到验证，系统在非平面运动中仍能保持一致的定位性能。
• 该方法是首个将低秩GP回归、六边形铺砌与RBPF结合用于3D磁力场SLAM的方法，实现了线性计算复杂度的扩展。