Lightweight hybrid visual-inertial odometry with closed-form zero velocity update |
| |
Institution: | 1. School of Automation Science and Electrical Engineering, Beihang University, Beijing 100191, China;2. Science and Technology on Aircraft Control Laboratory, Beijing 100191, China;3. Science and Technology on Complex System Control and Intelligent Agent Cooperation Laboratory, Beijing 100074, China |
| |
Abstract: | Visual-Inertial Odometry (VIO) fuses measurements from camera and Inertial Measurement Unit (IMU) to achieve accumulative performance that is better than using individual sensors. Hybrid VIO is an extended Kalman filter-based solution which augments features with long tracking length into the state vector of Multi-State Constraint Kalman Filter (MSCKF). In this paper, a novel hybrid VIO is proposed, which focuses on utilizing low-cost sensors while also considering both the computational efficiency and positioning precision. The proposed algorithm introduces several novel contributions. Firstly, by deducing an analytical error transition equation, one-dimensional inverse depth parametrization is utilized to parametrize the augmented feature state. This modification is shown to significantly improve the computational efficiency and numerical robustness, as a result achieving higher precision. Secondly, for better handling of the static scene, a novel closed-form Zero velocity UPdaTe (ZUPT) method is proposed. ZUPT is modeled as a measurement update for the filter rather than forbidding propagation roughly, which has the advantage of correcting the overall state through correlation in the filter covariance matrix. Furthermore, online spatial and temporal calibration is also incorporated. Experiments are conducted on both public dataset and real data. The results demonstrate the effectiveness of the proposed solution by showing that its performance is better than the baseline and the state-of-the-art algorithms in terms of both efficiency and precision. A related software is open-sourced to benefit the community.① |
| |
Keywords: | Inverse depth parametrization Kalman filter Online calibration Visual-inertial odometry Zero velocity update |
本文献已被 ScienceDirect 等数据库收录! |
|