论文部分内容阅读
Visual-Inertial Odometry (VIO) fuses measurements from camera and Inertial Measure-ment 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 track-ing 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. Fur-thermore, 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 solu-tion 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 commu-nity.