arXivDaily arXiv每日学术速递 周一至周五更新
arXiv周末暂无论文更新,休息一下吧,周末愉快~~
arXiv 2311.04477cs.RO
收藏

PLV-IEKF:使用点、线和消失点的一致性视觉惯性里程计

PLV-IEKF: Consistent Visual-Inertial Odometry using Points, Lines, and Vanishing Points

Shanghai Jiao Tong University(上海交通大学);SLAMTEC company(思岚科技公司)

Tong Hua, Tao Li, Liang Pang, Guoqing Liu, Wencheng Xuanyuan, Chang Shu, Ling Pei

AI总结:

针对传统EKF基VIO的系统不一致与角漂移问题,提出融合点、线、消失点特征的右不变滤波VIO方案,证明相关误差定义的一致性及消失点的不可观测特性,实验验证其在人造环境中位姿估计的准确性与一致性。

摘要:

本文提出了一种基于不变扩展卡尔曼滤波(Invariant Extended Kalman Filter, IEKF)的多特征视觉惯性里程计(Visual-Inertial Odometry, VIO),适用于人造环境。传统基于EKF的VIO通常存在系统不一致性和角漂移问题,这是基于特征的方法中固有的问题。而在人造环境中,线、消失点等显著的结构规律为定位提供了有价值的线索。为有效利用这些结构特征并保持系统一致性,我们设计了一种融合点、线和消失点特征的右不变滤波VIO方案。我们通过证明数学上等价的测量模型,表明点特征的传统加性误差定义也能像不变误差定义一样保持系统一致性,并且对线特征也得出了类似结论。此外,我们开展了基于不变滤波的可观测性分析,证明消失点测量天然保持不可观测方向。我们通过仿真和真实世界测试验证了所提方法的位姿精度和一致性,实验结果证实了该方法的优异性能,凸显了其在人造环境中实现准确、一致位姿估计的能力。

英文摘要:

In this paper, we propose an Invariant Extended Kalman Filter (IEKF) based Visual-Inertial Odometry (VIO) using multiple features in man-made environments. Conventional EKF-based VIO usually suffers from system inconsistency and angular drift that naturally occurs in feature-based methods. However, in man-made environments, notable structural regularities, such as lines and vanishing points, offer valuable cues for localization. To exploit these structural features effectively and maintain system consistency, we design a right invariant filter-based VIO scheme incorporating point, line, and vanishing point features. We demonstrate that the conventional additive error definition for point features can also preserve system consistency like the invariant error definition by proving a mathematically equivalent measurement model. And a similar conclusion is established for line features. Additionally, we conduct an invariant filter-based observability analysis proving that vanishing point measurement maintains unobservable directions naturally. Both simulation and real-world tests are conducted to validate our methods' pose accuracy and consistency. The experimental results validate the competitive performance of our method, highlighting its ability to deliver accurate and consistent pose estimation in man-made environments.

机构、总结、中文摘要均由AI分析而来,可能存在错误,请以论文正文为准。

↑