State transformation multi-state constraint Kalman filter for visual-inertial integrated navigation

杜学禹,赵启超,吴文启,王茂松
DOI: https://doi.org/10.13695/j.cnki.12-1222/o3.2021.02.009
2021-01-01
Abstract:A new Kalman filter flow for visual-inertial integrated navigation, which is named as state transformation multi-state constraint Kalman filter (ST-MSCKF) is proposed to improve the accuracy of integrated navigation system. The difference between the standard multi-state constraint Kalman filter (MSCKF) and the ST-MSCKF is that the latter uses rigorous nonlinear velocity error definition. Based on the nonlinear velocity error, the system error model and measurement model of the visual-inertial navigation are reconstructed. As a result, the ST-MSCKF has better covariance consistency than the MSCKF, which leads to higher position and attitude estimation accuracy. Unlike the state-of-the-art observability constrained MSCKF (OC-MSCKF) to solve the inconsistency problem, the ST-MSCKF does not need to modify the state transition matrix and the measurement matrix in real time to maintain the observability of the visual-inertial navigation system, thus the computational cost is saved. The execution process of the ST-MSCKF is exactly the same as the standard MSCKF. Extensive land vehicle experimental results demonstrate that the ST-MSCKF has the same accuracy as OC-MSCKF and higher position and attitude accuracy than the MSCKF, which has good engineering application value.
What problem does this paper attempt to address?