Implementation of a Low-Cost Navigation System Using Data Fusion of a Micro-Electro-Mechanical System Inertial Sensor and an Ultra Short Baseline on a Microcontroller

In this work, a low-cost low-power navigation solution for autonomous underwater vehicles is introduced utilizing a Micro-Electro-Mechanical System (MEMS) inertial sensor and an ultra short baseline (USBL) system. The complete signal processing is implemented on a cheap 16-bit fixed-point arithmetic microcontroller. For data fusion and calibration, an error state Kalman filter in square root form is used, which preserves stability in case of rounding errors. To further reduce the influence of rounding errors, a stochastic rounding scheme is applied. The USBL measurements are integrated using tightly coupled data fusion by deriving the observation functions separately for range, elevation, and azimuth angles. The effectiveness of the fixed point implementation with stochastic rounding is demonstrated on a simulation, and the the complete setup is tested in a field test. The results of the field test show an improved accuracy of the tightly coupled data fusion in comparison with loosely coupled data fusion. It is also shown that the applied rounding schemes can bring the fixed-point estimates to a near floating point accuracy.