Walking Trajectory Estimation Using Multi-Sensor Fusion and a Probabilistic Step Model

This paper presents a framework for accurately and efficiently estimating a walking human's trajectory using a computationally inexpensive non-Gaussian recursive Bayesian estimator. The proposed framework fuses global and inertial measurements with predictions from a kinematically driven step model to provide robustness in localization. A maximum a posteriori-type filter is trained on typical human kinematic parameters and updated based on live measurements. Local step size estimates are generated from inertial measurement units using the zero-velocity update (ZUPT) algorithm, while global measurements come from a wearable GPS. After each fusion event, a gradient ascent optimizer efficiently locates the highest likelihood of the individual's location which then triggers the next estimator iteration.The proposed estimator was compared to a state-of-the-art particle filter in several Monte Carlo simulation scenarios, and the original framework was found to be comparable in accuracy and more efficient at higher resolutions. It is anticipated that the methods proposed in this work could be more useful in general real-time estimation (beyond just personal navigation) than the traditional particle filter, especially if the state is many-dimensional. Applications of this research include but are not limited to: in natura biomechanics measurement, human safety in manual fieldwork environments, and human/robot teaming.