测试科学与仪器2024，Vol.15Issue(1)：83-94,12.DOI:10.62756/jmsi.1674-8042.2024009
平面环境约束辅助的单目视觉惯性里程计
Planar environmental constraints aided monocular visual inertial odometry
摘要
Abstract
Motivated by the goal of enhancing the accuracy and robustness of visual inertial navigation systems(VINSs) across a wide spectrum of dynamic scenarios, protracted missions and expansive navigation ranges, we designed a monocular visual inertial odometry (VIO) augmented by planar environmental constraints. To attain efficient feature extraction and precise feature tracking, we employed a methodology that involved the extraction and tracking of uniformly distributed using features from accelerated segment test(FAST) feature points from video images, with the subsequent removal of outliers through symmetric optical flow. Additionally, we outlined the process of identifying coplanar feature points from the sparse feature set, enabling efficient plane detection and fitting. This approach constructed spatial geometric constraints on the three-dimensional coordinates of visual feature points without resorting to computationally expensive dense depth mapping. The heart of this method lied in the formulation of a comprehensive cost function, which integrated the reprojection error of visual feature points, the coordinate constraints derived from coplanar feature points, and the inertial measurement unit (IMU) pre-integration error. These integrated measurements were then utilized to estimate the system states through a nonlinear optimization methodology. To validate the accuracy and effectiveness of the proposed approach, extensive experiments were conducted using publicly available datasets and large-scale outdoor scenes. The experimental results conclusively demonstrate that compared to VINS-Mono and ORB-SLAM3, the proposed method achieves higher positioning accuracy. It can deliver precise and stable navigation results even in challenging conditions, thereby imparting significant practical value to the fields of robotics and unmanned driving.关键词
视觉惯性里程计/平面环境约束/状态估计/非线性优化Key words
visual inertial odometry(VIO)/planar environmental constraint/state estimation/nonlinear optimization引用本文复制引用
多靖赟,赵毅琳,赵龙,李俊韬..平面环境约束辅助的单目视觉惯性里程计[J].测试科学与仪器,2024,15(1):83-94,12.基金项目
This work was supported by Beijing Tongzhou District Science and Technology Innovation Talent Foundation(No.JCQN2023030) （No.JCQN2023030）
National Science Foundation of China(No.42274037) （No.42274037）
Aeronautical Science Foundation of China(No.2022Z022051001) （No.2022Z022051001）
Beijing Wuzi University Youth Research Foundation(No.2022XJQN22) （No.2022XJQN22）
