An Extended Kalman Filter for Magnetic Field SLAM Using Gaussian Process Regression

Sensors

Frida Viset¹  Manon Kok¹  Rudy Helmons² 

[1] Delft Center for Systems and Control, Delft University of Technology, 2628 CD Delft, The Netherlands;Maritime and Transport Technology, Delft University of Technology, 2628 CD Delft, The Netherlands;

关键词: simultaneous localization and mapping;    Kalman filtering;    localization;    magnetic field;   

DOI  :  10.3390/s22082833

来源: DOAJ

【 摘 要 】

We present a computationally efficient algorithm for using variations in the ambient magnetic field to compensate for position drift in integrated odometry measurements (dead-reckoning estimates) through simultaneous localization and mapping (SLAM). When the magnetic field map is represented with a reduced-rank Gaussian process (GP) using Laplace basis functions defined in a cubical domain, analytic expressions of the gradient of the learned magnetic field become available. An existing approach for magnetic field SLAM with reduced-rank GP regression uses a Rao-Blackwellized particle filter (RBPF). For each incoming measurement, training of the magnetic field map using an RBPF has a computational complexity per time step of $O\left(N_p{N}_m^2\right)$, where $N_p$ is the number of particles, and $N_m$ is the number of basis functions used to approximate the Gaussian process. Contrary to the existing particle filter-based approach, we propose applying an extended Kalman filter based on the gradients of our learned magnetic field map for simultaneous localization and mapping. Our proposed algorithm only requires training a single map. It, therefore, has a computational complexity at each time step of $O\left(N_m^2\right)$. We demonstrate the workings of the extended Kalman filter for magnetic field SLAM on an open-source data set from a foot-mounted sensor and magnetic field measurements collected onboard a model ship in an indoor pool. We observe that the drift compensating abilities of our algorithm are comparable to what has previously been demonstrated for magnetic field SLAM with an RBPF.

【 授权许可】

Unknown