Observability-Constrained VINS for MAVs Using Interacting Multiple Model Algorithm

Abstract

This article presents the design of an interacting multiple model (IMM) filter for visual-inertial navigation (VIN) of MAVs. VIN of MAVs in practice typically uses a single system model for its state estimator design. However, microaerial vehicles (MAVs) can operate in different scenarios such as aggressive flights, hovering flights, and under high external disturbance requiring changing constraints imposed on the estimator model. This article proposes the use of a conventional VIN and a drag force VIN in an error-state IMM filtering framework to address the need for multiple models in the estimator. The work uses an epipolar geometry constraint for the design of the measurement model for both filters to realize computationally efficient state updates. Observability of the proposed modifications to VIN filters (drag force model and epipolar measurement model) are analyzed, and observability-based consistency rules are derived for the two filters of the IMM. Monte Carlo numerical simulations validate the performance of the observability constrained IMM, which improved the accuracy and consistency of the visual-inertial navigation system (VINS) for changing flight conditions and external wind disturbance scenarios. Experimental validation is performed using the EuRoC dataset to evaluate the performance of the proposed IMM filter design. The results show that the IMM outperforms stand-alone filters used in the IMM filtering bank by switching between the filters based on the residual likelihood of the models.