Tightly-Coupled Stereo Visual-Inertial Navigation Using Point and Line Features

Sensors

Xianglong Kong²  Wenqi Wu¹  Lilian Zhang²  Yujie Wang² 

[1] College of Mechatronics and Automation, National University of Defense Technology, Changsha 410073, China;

关键词: vision-aided inertial navigation;    point and line features;    trifocal geometry;    tightly-coupled;   

DOI  :  10.3390/s150612816

来源: mdpi

【 摘 要 】

This paper presents a novel approach for estimating the ego-motion of a vehicle in dynamic and unknown environments using tightly-coupled inertial and visual sensors. To improve the accuracy and robustness, we exploit the combination of point and line features to aid navigation. The mathematical framework is based on trifocal geometry among image triplets, which is simple and unified for point and line features. For the fusion algorithm design, we employ the Extended Kalman Filter (EKF) for error state prediction and covariance propagation, and the Sigma Point Kalman Filter (SPKF) for robust measurement updating in the presence of high nonlinearities. The outdoor and indoor experiments show that the combination of point and line features improves the estimation accuracy and robustness compared to the algorithm using point features alone.

【 授权许可】

CC BY   
© 2015 by the authors; licensee MDPI, Basel, Switzerland.