Robocentric visual-inertial odometry

被引:54
作者
Huai, Zheng [1 ]
Huang, Guoquan [1 ]
机构
[1] Univ Delaware, Dept Mech Engn, Newark, DE 19716 USA
关键词
visual-inertial odometry; robocentric formulation; extended Kalman filter; observability analysis; estimation consistency; LOCALIZATION; CONSISTENCY; NAVIGATION; EKF; ENVIRONMENTS; FUSION;
D O I
10.1177/0278364919853361
中图分类号
TP24 [机器人技术];
学科分类号
080202 ; 1405 ;
摘要
In this paper, we propose a novel robocentric formulation of the visual-inertial navigation system (VINS) within a sliding-window filtering framework and design an efficient, lightweight, robocentric visual-inertial odometry (R-VIO) algorithm for consistent motion tracking even in challenging environments using only a monocular camera and a six-axis inertial measurement unit (IMU). The key idea is to deliberately reformulate the VINS with respect to a moving local frame, rather than a fixed global frame of reference as in the standard world-centric VINS, in order to obtain relative motion estimates of higher accuracy for updating global pose. As an immediate advantage of this robocentric formulation, the proposed R-VIO can start from an arbitrary pose, without the need to align the initial orientation with the global gravitational direction. More importantly, we analytically show that the linearized robocentric VINS does not undergo the observability mismatch issue as in the standard world-centric counterparts that has been identified in the literature as the main cause of estimation inconsistency. Furthermore, we investigate in depth the special motions that degrade the performance in the world-centric formulation and show that such degenerate cases can be easily compensated for by the proposed robocentric formulation, without resorting to additional sensors as in the world-centric formulation, thus leading to better robustness. The proposed R-VIO algorithm has been extensively validated through both Monte Carlo simulation and real-world experiments with different sensing platforms navigating in different environments, and shown to achieve better (or competitive at least) performance than the state-of-the-art VINS, in terms of consistency, accuracy, and efficiency.
引用
收藏
页码:667 / 689
页数:23
相关论文
共 45 条
[1]  
Agarwal S., 2010, Ceres Solver
[2]   Lucas-Kanade 20 years on: A unifying framework [J].
Baker, S ;
Matthews, I .
INTERNATIONAL JOURNAL OF COMPUTER VISION, 2004, 56 (03) :221-255
[3]  
Bar-Shalom Y., 2001, ESTIMATION APPL TRAC
[4]   Iterated extended Kalman filter based visual-inertial odometry using direct photometric feedback [J].
Bloesch, Michael ;
Burri, Michael ;
Omari, Sammy ;
Hutter, Marco ;
Siegwart, Roland .
INTERNATIONAL JOURNAL OF ROBOTICS RESEARCH, 2017, 36 (10) :1053-1072
[5]  
Bloesch M, 2015, IEEE INT C INT ROBOT, P298, DOI 10.1109/IROS.2015.7353389
[6]  
Breckenridge WG, 1979, TECHNICAL REPORT
[7]   The EuRoC micro aerial vehicle datasets [J].
Burri, Michael ;
Nikolic, Janosch ;
Gohl, Pascal ;
Schneider, Thomas ;
Rehder, Joern ;
Omari, Sammy ;
Achtelik, Markus W. ;
Siegwart, Roland .
INTERNATIONAL JOURNAL OF ROBOTICS RESEARCH, 2016, 35 (10) :1157-1163
[8]   Robocentric map joining:: Improving the consistency of EKF-SLAM [J].
Castellanos, J. A. ;
Martinez-Cantin, R. ;
Tardos, J. D. ;
Neira, J. .
ROBOTICS AND AUTONOMOUS SYSTEMS, 2007, 55 (01) :21-29
[9]  
Chen Z., 1990, IECON '90. 16th Annual Conference of IEEE Industrial Electronics Society (Cat. No.90CH2841-5), P100, DOI 10.1109/IECON.1990.149118
[10]   Inverse Depth Parametrization for Monocular SLAM [J].
Civera, Javier ;
Davison, Andrew J. ;
Montiel, J. M. Martinez .
IEEE TRANSACTIONS ON ROBOTICS, 2008, 24 (05) :932-945