A Trident Quaternion Framework for Inertial-Based Navigation-Part II: Error Models and Application to Initial Alignment

被引:7
作者
Ouyang, Wei [1 ]
Wu, Yianxin [1 ]
机构
[1] Shanghai Jiao Tong Univ, Shanghai Key Lab Nav & Locat Based Serv, Sch Elect Informat & Elect Engn, Shanghai 200240, Peoples R China
基金
中国国家自然科学基金; 国家重点研发计划;
关键词
Quaternions; Mathematical models; Kinematics; Kalman filters; Earth; Position measurement; Land vehicles; Extended Kalman filtering; initial alignment; linearized kinematic model; odometer; trident quaternion; ATTITUDE DETERMINATION; COARSE ALIGNMENT; KALMAN FILTER; SDINS;
D O I
10.1109/TAES.2021.3133219
中图分类号
V [航空、航天];
学科分类号
08 ; 0825 ;
摘要
This article deals with error models for a trident quaternion framework proposed in the companion paper (Part I) and further uses them to investigate the odometer-aided static/in-motion inertial navigation attitude alignment for land vehicles. By linearizing the trident quaternion kinematic equation, the left- and right-trident-quaternion error models are obtained, which are found to be equivalent to those derived from profound group affine. The two error models are used to design their corresponding extended Kalman filters (EKFs), namely, the left-quaternion EKF (LQEKF) and the right-quaternion EKF (RQEKF). Simulations and field tests are conducted to evaluate their actual performances. Owing to the high estimation consistency, the LQEKF and the RQEKF converge much faster in the static alignment than the traditional error-model-based EKF, even under arbitrary large heading initialization. For the in-motion alignment, the LQEKF and the RQEKF possess much larger convergence region than the traditional EKF does, although they still require the aid of attitude initialization so as to avoid large initial attitude errors.
引用
收藏
页码:2421 / 2437
页数:17
相关论文
共 39 条
[1]  
Barrau A, 2020, IEEE INT CONF ROBOT, P5732, DOI [10.1109/ICRA40945.2020.9197492, 10.1109/icra40945.2020.9197492]
[2]   Extended Kalman Filtering With Nonlinear Equality Constraints: A Geometric Approach [J].
Barrau, Axel ;
Bonnabel, Silvere .
IEEE TRANSACTIONS ON AUTOMATIC CONTROL, 2020, 65 (06) :2325-2338
[3]   Invariant Kalman Filtering [J].
Barrau, Axel ;
Bonnabel, Silvere .
ANNUAL REVIEW OF CONTROL, ROBOTICS, AND AUTONOMOUS SYSTEMS, VOL 1, 2018, 1 :237-257
[4]   The Invariant Extended Kalman Filter as a Stable Observer [J].
Barrau, Axel ;
Bonnabel, Silvere .
IEEE TRANSACTIONS ON AUTOMATIC CONTROL, 2017, 62 (04) :1797-1812
[5]  
Barrau Axel., 2015, Non-Linear State Error Based Extended Kalman Filters with Applications to Navigation, P179
[6]   Non-Linear Symmetry-Preserving Observers on Lie Groups [J].
Bonnabel, Silvere ;
Martin, Philippe ;
Rouchon, Pierre .
IEEE TRANSACTIONS ON AUTOMATIC CONTROL, 2009, 54 (07) :1709-1713
[7]   Symmetry-Preserving Observers [J].
Bonnabel, Silvere ;
Martin, Philippe ;
Rouchon, Pierre .
IEEE TRANSACTIONS ON AUTOMATIC CONTROL, 2008, 53 (11) :2514-2526
[8]  
BrittingInertial K. R., 1971, NAVIGATION SYSTEMS A
[9]  
Brossard M, 2018, 2018 21ST INTERNATIONAL CONFERENCE ON INFORMATION FUSION (FUSION), P2021, DOI 10.23919/ICIF.2018.8455807
[10]   Optimization-Based Alignment for Strapdown Inertial Navigation System: Comparison and Extension [J].
Chang, Lubin ;
Li, Jingshu ;
Li, Kailong .
IEEE TRANSACTIONS ON AEROSPACE AND ELECTRONIC SYSTEMS, 2016, 52 (04) :1697-1713