This paper proposes an advanced solution to improve the inertial velocity estimation of a rigid body, for indoor navigation, through implementing a magnetic field gradient-based Extended Kalman Filter (EKF). The proposed estimation scheme considers a set of data from a triad of inertial sensors (accelerometer and gyroscope), as well as a determined arrangement of magnetometers array. The inputs for the estimation scheme are the spatial derivatives of the magnetic field, from the magnetometers array, and the attitude, from the inertial sensors. As shown in the literature, there is a strong relation between the velocity and the measured magnetic field gradient. However, the latter usually suffers from high noises. Then, the novelty of the proposed EKF is to develop a specific equation to describe the dynamics of the magnetic field gradient. This contribution helps to filter, first, the magnetic field and its gradient and second, to better estimate the inertial velocity. Some numerical simulations that are based on an open source database show the targeted improvements. At the end of the paper, this approach is extended to position estimation in the case of a foot-mounted application and the results are very promising.
Wireless 3D Surgical Navigation and Tracking System with 100lm Accuracy Using Magnetic-Field Gradient-Based Localization
