利用ArUco码的单目VIO快速初始化算法

A Fast Initialization Algorithm for Monocular VIO Using ArUco Markers

  • 摘要: 针对目前单目视觉惯性里程计(Visual Inertial Odometry,VIO)算法初始化对设备运动状态和视觉观测条件要求较为严格,在工程应用中难以保证的问题,本文提出了一种利用ArUco码辅助的单目VIO快速初始化算法。所提出的方法结合ArUco码已知的边长信息,通过边长约束恢复深度信息并获取相机与ArUco码之间的空间关系。同时结合惯性测量单元(Inertial Measurement Unit,IMU)静止初始化流程与事先标定的相机与IMU之间的外参,实现全局坐标系与ArUco码之间空间关系的获取,完成初始化流程。实验结果表明,所提算法角点深度恢复误差平均值为0.75mm,而相比VINS-Fusion、OpenVINS及ORB-SLAM3的单目VIO方案的初始化方法,本文方法在效率、及对后续VIO的收敛帮助上有着更好的表现,初始化后小范围(2m)内VIO定位误差为0.009m,姿态精度为0.4° ,且对单目VIO整体轨迹精度带来一定程度的提升。

     

    Abstract: Objectives: Current monocular Visual Inertial Odometry (VIO) algorithms impose stringent requirements on device motion states and visual observation conditions during initialization, which are often challenging to meet in real-world engineering applications. A fast and stable initialization method is thus essential.Methods: The proposed method utilizes the known edge length of ArUco markers to recover depth information through edge length constraints, thereby estimating the spatial relationship between the camera and the ArUco markers. Concurrently, the Inertial Measurement Unit (IMU) is initialized under stationary conditions. By incorporating the pre-calibrated extrinsic transformation between the camera and IMU, the spatial relationship between the global coordinate system and the ArUco markers is established.Results: (1) The accuracy of depth recovery at corner points is verified by a profile of the difference between the distance between two points and the depth recovery. Several sets of experiments were conducted under well-lit and low-light conditions, respectively, the average value of the error of the difference is 0.75mm. (2) The VIO positioning accuracy of the device in a certain spatial range after initialization is analyzed, and several sets of experiments show that the positioning error is 0.009m, attitude error is 0.4°. (3) Experiments are designed to verify the stability and efficiency of the method, compared to the monocular VIO initialization method of VINS-Fusion, OpenVINS and ORB-SLAM3, our method has higher stability and efficiency, and the overall trajectory of the follow-up VIO was even better.Conclusions: The proposed method demonstrates high efficiency and robustness in initialization, with notable improvements in positioning accuracy during subsequent VIO tracking.

     

/

返回文章
返回