In order to solve the problem of inaccurate scale optimization of visual inertial odometer (VIO) algorithm under uniform motion, this paper presents a Visual-Inertial-Encoder Tightly-Coupled Odometry (VIETO) algorithm, and describes VIETO initialization as an optimal estimation problem in the sense of maximum-a-posteriori (MAP) estimation. Firstly, the pre-integration theory of encoder is introduced in this paper so that the scale and velocity information can be obtained by using the encoder to measure the pre-integration during the visual MAP estimation, which provides a good initial value for the optimal estimation of IMU parameters. Secondly, the encoder error term and random plane constraint are introduced into the visual inertia optimization framework to further constrain pose estimation. Finally, we apply VIETO to the monocular inertial ORB-SLAM3 system. By comparing the algorithm with other similar algorithms on the DS dataset, the results prove the effectiveness of the system.
|