| Citation: |
CUI Xiaozhen, ZHOU Qi, WU Dongjie, WU Wenhong, CHEN Bushi, ZHONG Xunyu. Factor Graph Fusion Localization Method with Tight and Loose Coupling of GNSS/IMU and Odometry[J]. Geomatics and Information Science of Wuhan University, 2024, 49(10): 1911-1921. DOI: 10.13203/j.whugis20220321
|
We investigate the impact of information fusion at different depths on the accuracy of navigation systems composed of micro inertial navigation systems (M-INS) and global navigation satellite systems (GNSS), as well as indoor and outdoor integrated positioning.
First, based on the factor graph optimization (FGO) algorithm, a loosely coupled system of M-INS/single-point GNSS and a tightly coupled system of M-INS/pseudorange/Doppler velocity are established respectively, and the advantages of the tightly coupled design are verified by experiments. Then, the visual inertial odometry (VIO) factor is inserted into the factor structure of the tightly coupled M-INS/GNSS system in a loosely coupled manner, and a tight- loosely coupled multi-source fusion algorithm model based on FGO is proposed. Finally, the positioning accuracy and indoor and outdoor integrated positioning capability of the system are verified by experiments.
The experimental results show that:(1) When four satellites cannot be observed and the single-point positioning solution cannot be obtained, the positioning accuracy of the M-INS/GNSS tightly coupled system can reach twice that of the M-INS/GNSS loosely coupled system. (2) In the case of the sudden failure of either GNSS or VIO, the FGO-based M-INS/GNSS/VIO tight-loosely coupled system can continue to provide reliable positioning, and the average errors of the east and north directions are improved by 53.98% and 54.74% respectively compared with the M-INS/GNSS/VIO system based on the filtering method.
Compared with the loosely coupled M-INS/GNSS system, the M-INS/GNSS tightly coupled system effectively reduces the impact of GNSS signal instability on the system, and has higher accuracy and robustness. The proposed tightly-loosely coupled system can seamlessly respond to changes between indoor and outdoor environments.
| [1] |
Winkelmaier G, Battulwar R, Khoshdeli M, et al. Topographically Guided UAV for Identifying Tension Cracks Using Image-Based Analytics in Open-Pit Mines[J]. IEEE Transactions on Industrial Electronics, 2021, 68（6）： 5415-5424.
|
| [2] |
Ribeiro R G, Junior J R C, Cota L P, et al. Unmanned Aerial Vehicle Location Routing Problem with Charging Stations for Belt Conveyor Inspection System in the Mining Industry[J]. IEEE Transactions on Intelligent Transportation Systems, 2020, 21（10）： 4186-4195.
|
| [3] |
Erdelj M, Natalizio E, Chowdhury K R, et al. Help from the Sky： Leveraging UAVs for Disaster Management[J]. IEEE Pervasive Computing, 2017, 16（1）： 24-32.
|
| [4] |
Braverman A. Unmanned Aerial Systems （UAS） in Urban Search and Rescue-Methodology, Capacity Development, and Integration[J]. Journal of Emergency Management, 2021, 19（1）： 33-38.
|
| [5] |
杜学禹,王茂松,崔加瑞,等. 一种高精度自主式组合导航系统滤波算法[J].中国惯性技术学报, 2021, 29（1）： 55-61.
Du Xueyu, Wang Maosong, Cui Jiarui, et al. A High Accuracy Kalman Filtering Algorithm for Vehicle Self-contained Integrated Navigation[J]. Journal of Chinese Inertial Technology, 2021, 29（1）： 55-61.
|
| [6] |
龙腾,穆荣军,苏炳志,等.双天线GPS/MEMS-INS深组合导航方法研究[J].宇航学报,2021,42（1）：92-102.
Long Teng,Mu Rongjun,Su Bingzhi,et al. Research on Dual-Antenna GPS /MEMS-INS Deeply-Integrated Navigation Approach[J]. Journal of Astronautics, 2021,42（1）：92-102.
|
| [7] |
邓玥,余江,郭文飞,等.信号遮挡环境下融合TOA/AOD的5G/SINS组合导航算法模型与精度分析[J].武汉大学学报（信息科学版）,2022,47（7）：1133-1139.
Deng Yue,Yu Jiang,Guo Wenfei, et al. Modeling and Accuracy Analysis of TOA/AOD Based 5G/SINS Integrated Navigation in Case of Signal Blockage[J]. Geomatics and Information Science of Wuhan University, 2022,47（7）：1133-1139.
|
| [8] |
Reisdorf P, Pfeier T, Breler J, et al. The Problem of Comparable GNSS Results： An Approach for a Uniform Dataset with Low-Cost and Reference Data[C]//The 5th International Conference on Advances in Vehicular Systems, Technologies and Applications, Barcelona, Spain, 2016.
|
| [9] |
张小红,陶贤露,王颖喆,等.城市场景智能手机GNSS/MEMS融合车载高精度定位[J].武汉大学学报（信息科学版）,2022,47（10）：1740-1749.
Zhang Xiaohong,Tao Xianlu,Wang Yingzhe,et al.MEMS-Enhanced Smartphone GNSS High-Precision Positioning for Vehicular Navigation in Urban Conditions[J]. Geomatics and Information Science of Wuhan University, 2022, 47（10）： 1740-1749.
|
| [10] |
Nagui N, Attallah O, Zaghloul M S, et al. Improved GPS/IMU Loosely Coupled Integration Scheme Using Two Kalman Filter-Based Cascaded Stages[J]. Arabian Journal for Science and Engineering, 2021, 46（2）： 1345-1367.
|
| [11] |
Simanek J, Reinstein M, Kubelka V. Evaluation of the EKF-Based Estimation Architectures for Data Fusion in Mobile Robots[J]. IEEE Transactions on Mechatronics, 2015, 20（2）： 985-990.
|
| [12] |
Lange D,Rocadenbosch F,Tiana-Alsina J, et al. Atmospheric Boundary Layer Height Estimation Using a Kalman Filter and a Frequency-Modulated Continuous-Wave Radar[J]. IEEE Transactions on Geoscience and Remote Sensing,2015,53（6）：3338-3349.
|
| [13] |
Cot L D, Lozi R. Assessing the Security of Subsampling Process Using Modified EKF and Nonlinear Least Squares Methods[C]//The 7th International Conference for Internet Technology and Secured Transactions,London,UK, 2012.
|
| [14] |
楼益栋,王昱升,涂智勇,等.融合多棱镜式雷达/IMU/RTK的轨道车辆高精度实时定位与建图[J].武汉大学学报（信息科学版）,2021,46（12）：1802-1807.
Lou Yidong, Wang Yusheng, Tu Zhiyong, et al. Real Time Localization and Mapping Integrating Multiple Prism LiDARs/IMU/RTK on Railway Locomotive[J]. Geomatics and Information Science of Wuhan University, 2021,46（12）：1802-1807.
|
| [15] |
Groves P D. Principles of GNSS, Inertial, and Multisensor Integrated Navigation Systems[J].Industrial Robot, 2013, 67（3）： 191-192.
|
| [16] |
Wen W, Kan Y C, Hsu L T. Performance Comparison of GNSS/INS Integrations Based on EKF and Factor Graph Optimization[C]//The 32nd International Technical Meeting of the Satellite Division of The Institute of Navigation, Miami,USA, 2019.
|
| [17] |
Li W, Cui X W, Lu M Q. A Robust Graph Optimization Realization of Tightly Coupled GNSS/INS Integrated Navigation System for Urban Vehicles[J]. Tsinghua Science and Technology,2018,23（6）： 724-732.
|
| [18] |
崔晓珍, 周琪, 武东杰, 等. 可融合里程计的INS/GNSS组合导航系统设计与试验分析[J]. 航空科学技术, 2022, 33（2）： 84-89.
Cui Xiaozhen,Zhou Qi,Wu Dongjie,et al. Design and Experimental Analysis of INS/GNSS Integrated Navigation System with Odometer[J]. Aeronautical Science & Technology,2022,33（2）：84-89.
|
| [19] |
Yu Y, Gao W, Liu C, et al. A GPS-Aided Omnidirectional Visual-Inertial State Estimator in Ubiquitous Environments[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems,Macau, China, 2019.
|
| [20] |
Cao S, Lu X, Shen S. GVINS： Tightly Coupled GNSS-Visual-Inertial Fusion for Smooth and Consistent State Estimation[J]. IEEE Transactions on Robotics, 2022（1）： 1-18.
|
| [21] |
Forster C, Carlone L, Dellaert F, et al. On-Manifold Preintegration for Real-Time Visual-Inertial Odometry[J]. IEEE Transactions on Robotics, 2017, 33（1）： 1-21.
|
| [22] |
Wen W,Hsu LT.Towards Robust GNSS Positioning and Real-Time Kinematic Using Factor Graph Optimization[C]//IEEE International Conference on Robotics and Automation, Xi’an, China, 2021.
|
| [23] |
Tong Q, Shen S. Online Temporal Calibration for Monocular Visual-Inertial Systems[C]//IEEE/RSJ International Conference on Intelligent Robots & Systems,Madrid, Spain, 2018.
|
| [24] |
Qin T, Li P L, Shen S J. VINS-Mono： A Robust and Versatile Monocular Visual-Inertial State Estimator[J]. IEEE Transactions on Robotics, 2018, 34（4）： 1004-1020.
|
| [25] |
Wen W, Bai X, Zhang G, et al. Multi-agent Collaborative GNSS/Camera/INS Integration Aided by Inter-ranging for Vehicular Navigation in Urban Areas[J]. IEEE Access, 2020（8）： 124323-124338.
|
| [26] |
Umeyama S. Least-Squares Estimation of Transformation Parameters Between Two Point Patterns[J]. IEEE Transactions on Pattern Analysis and Machine Intelligence, 1991, 13（4）： 376-380.
|
| [1] | WANG Jian, LIU Gen, LIU Xu, HAN Houzeng. Methods and Progress for GNSS Multi-Source Fusion Monitoring of Deformation in Super-High-Rise Buildings[J]. Geomatics and Information Science of Wuhan University. DOI: 10.13203/j.whugis20240317 |
| [2] | GAO Zhiliang, XIE Mingli, JU Nengpan, HUANG Xichao, PENG Tao, HE Chaoyang. Multi-source Remote Sensing Dynamic Deformation Monitoring of Accumulation Landslide[J]. Geomatics and Information Science of Wuhan University, 2024, 49(8): 1482-1491. DOI: 10.13203/j.whugis20220149 |
| [3] | ZHAO Qingzhi, DU Zheng, WU Manyi, YAO Yibin, YAO Wanqiang. Establishment of PWV Fusion Model Using Multi-source Data[J]. Geomatics and Information Science of Wuhan University, 2022, 47(11): 1823-1831. DOI: 10.13203/j.whugis20200412 |
| [4] | TU Wei, CAO Jinzhou, GAO Qili, CAO Rui, FANG Zhixiang, YUE Yang, LI Qingquan. Sensing Urban Dynamics by Fusing Multi-sourced Spatiotemporal Big Data[J]. Geomatics and Information Science of Wuhan University, 2020, 45(12): 1875-1883. DOI: 10.13203/j.whugis20200535 |
| [5] | FANG Zhixiang, HUANG Shouqian, SU Rongxiang, XIAO Heping. Detecting Hierarchical Congestion Intervals Based on the Fusion of Multi-source Highway Data[J]. Geomatics and Information Science of Wuhan University, 2020, 45(5): 682-690. DOI: 10.13203/j.whugis20190117 |
| [6] | WEN Xuedong, CHEN Weimin, XIE Hong, YAN Li. A Method for Building Model Reconstruction Based on Multi-source Feature Fusion[J]. Geomatics and Information Science of Wuhan University, 2019, 44(5): 731-736, 764. DOI: 10.13203/j.whugis20180320 |
| [7] | SUN Wen, WU Xiaoping, WANG Qingbin, LIU Xiaogang, ZHU Zhida. Normalized Collocation Based on Variance Component Estimate and Its Application in Multi-source Gravity Data Fusion[J]. Geomatics and Information Science of Wuhan University, 2016, 41(8): 1087-1092. DOI: 10.13203/j.whugis20140159 |
| [8] | Huang Motao, Ouyang Yongzhong, Liu Min, ZHai Guojun, Deng Kailiang. Regularization of Point-Mass Model for Multi-Source Gravity Data Fusion Processing[J]. Geomatics and Information Science of Wuhan University, 2015, 40(2): 170-175. |
| [9] | LI Lianying, XU Xiaolan, WU Zhongheng, ZHOU Zuhao. Research on Integration and Updating Method of Multi-sources Electronic Map Data[J]. Geomatics and Information Science of Wuhan University, 2008, 33(4): 409-412. |
| [10] | Li Linhui, Wang Yu, Liu Yueyan, Li Lei, Huang Jincheng, Zhou Yi, Cao Songlin. A Fast Fusion Model for Multi-Source Heterogeneous Data Of Real Estate Based on Feature Similarity[J]. Geomatics and Information Science of Wuhan University. DOI: 10.13203/j.whugis20220742 |
Supported by: Beijing Renhe Information Technology Co., Ltd. 
DownLoad: