Abstract
Micro-electromechanical systems and inertial measurement units (MEMS-IMUs) show great advantages in terms of price and size. Nevertheless, due to limitations of technology, their observations are easily affected by the surrounding environment (temperature, vibration, and electronic noise). Most methods resist the effect of gross errors by adjusting covariance matrices in the integrated navigation of a global navigation satellite system (GNSS) and inertial navigation system (INS). We propose a motion model-assisted integrated navigation method on the basis of a constant yaw rate and velocity (CTRV) model, which serves as a constraint condition and detects gross errors by a Chi-squared test. The results of the CTRV are used to correct the carrier state from INS mechanization. A field test was carried out to verify the performance of the CTRV-assisted method. Compared with a robust Kalman filter, the method improves the horizontal accuracy of position and velocity by more than 87% and 68%, respectively, in a medium-precision loosely and tightly coupled system, and of the velocity and attitude by more than 52% and 20%, respectively, in a low-precision loosely and tightly coupled system. Therefore, the CTRV-assisted method can significantly enhance the performance of GNSS/MEMS-IMU integrated navigation systems.
Similar content being viewed by others
Data availability
The data supporting this research and used to obtain the reported results can be provided by the first author.
References
Barrios C, Motai Y, Huston D (2015) Trajectory estimations using smartphones. IEEE Trans Ind Electron 62(12):7901–7910. https://doi.org/10.1109/tie.2015.2478415
Bar-Shalom Y (1990) Multitarget-multisensor tracking: Advanced applications. Artech House, New York
Bar-Shalom Y, Li XR, Kirubarajan T (2004) Estimation with applications to tracking and navigation: theory, algorithms and Software. Wiley, New York
Berthelot A, Tamke A, Dang T, Breuel G (2011) Handling uncertainties in criticality assessment. In: IEEE intelligent vehicles symposium (IV). pp 571–576
Brown RG, Hwang P (1997) Introduction to random signals and applied Kalman filtering, 3rd edn. Wiley, New York
Cao H, Li H, Shao X, Liu Z, Kou Z et al (2018) Sensing mode coupling analysis for dual-mass MEMS gyroscope and bandwidth expansion within wide-temperature range. Mech Syst Signal Process 98:448–464. https://doi.org/10.1016/j.ymssp.2017.05.003
Chang G (2014) Robust Kalman filtering based on Mahalanobis distance as outlier judging criterion. J Geodesy 88(4):391–401. https://doi.org/10.1007/s00190-013-0690-8
Chang Y, Wang Y, Shen Y, Ji C (2021) A new fuzzy strong tracking cubature Kalman filter for INS/GNSS. GPS Solut 25(3):120. https://doi.org/10.1007/s10291-021-01148-5
Deng C, Tang W, Liu J, Shi C (2013) Reliable single-epoch ambiguity resolution for short baselines using combined GPS/BeiDou system. GPS Solut 18(3):375–386. https://doi.org/10.1007/s10291-013-0337-5
Du K, Wu Y, Li X, Ban X (2020) Dynamic vehicle perception using automotive radar. In: 13th Asia pacific transportation development conference. pp 689–696. https://doi.org/10.1061/9780784482902.081
Gao S, Zhong Y, Li W (2011) Robust adaptive filtering method for SINS/SAR integrated navigation system. Aerosp Sci Technol 15(6):425–430. https://doi.org/10.1016/j.ast.2010.08.007
Gao D, Wang C, Zhu H (2012) Geomagnetic/Dead Reckoning integrated navigation method considering geomagnetic error. In: 24th Chinese control and decision conference. pp 3613–3616. https://doi.org/10.1109/CCDC.2012.6243091
Guan H, Li L, Jia X (2013) Multi-sensor fusion vehicle positioning based on Kalman filter. In: IEEE third international conference on information science and technology. pp 296–299. https://doi.org/10.1109/ICIST.2013.6747554
Hampel FR, Ronchetti EM, Rousseeuw PJ, Stahel WA (2005) Robust statistics: the approach based on influence functions. Wiley, New York
Howard D, Dai D (2014) Public perceptions of self-driving cars: the case of Berkeley, California. In: Transportation research board 93rd annual meeting. pp 1–21
Hu G, Gao S, Zhong Y (2015) A derivative UKF for tightly coupled INS/GPS integrated navigation. ISA Trans 56:135–144. https://doi.org/10.1016/j.isatra.2014.10.006
Huber P (1981) Robust statistics. Wiley, New York
Jekeli C (2012) Inertial navigation systems with geodetic applications. De Gruyter, Berlin
Jiang C, Zhang S, Li H, Li Z (2021) Performance evaluation of the filters with adaptive factor and fading factor for GNSS/INS integrated systems. GPS Solut 25(4):130. https://doi.org/10.1007/s10291-021-01165-4
Kendrick JD (1981) Estimation of aircraft target motion using orientation. IEEE Trans Aerosp Electron Syst 17(2):254–260. https://doi.org/10.1109/TAES.1981.309153
Li Z, Chang G, Gao J, Wang J, Hernandez A (2016) GPS/UWB/MEMS-IMU tightly coupled navigation with improved robust Kalman filter. Adv Space Res 58(11):2424–2434. https://doi.org/10.1016/j.asr.2016.07.028
Li X, Wang H, Li S, Feng S, Wang X, Liao J (2021a) GIL: a tightly coupled GNSS PPP/INS/LiDAR method for precise vehicle navigation. Satell Navig 2(1):26. https://doi.org/10.1186/s43020-021-00056-w
Li Z, Liu Z, Zhao L (2021b) Improved robust Kalman filter for state model errors in GNSS-PPP/MEMS-IMU double state integrated navigation. Adv Space Res 67(10):3156–3168. https://doi.org/10.1016/j.asr.2021.02.010
Lim Y, Gardi A, Sabatini R, Ramasamy S, Kistan T et al (2018) Avionics human-machine interfaces and interactions for manned and unmanned aircraft. Prog Aerosp Sci 102:1–46. https://doi.org/10.1016/j.paerosci.2018.05.002
Liu J, Cai BG, Wen YH, Wang J (2015) Integrating DSRC and dead-reckoning for cooperative vehicle positioning under GNSS-challenged vehicular environments. Int J Ad Hoc Ubiquitous Comput 19(1–2):111–129. https://doi.org/10.1504/IJAHUC.2015.069500
Liu F, Han H, Cheng X, Li B (2020a) Performance of tightly coupled integration of GPS/BDS/MEMS-INS/Odometer for real-time high-precision vehicle positioning in urban degraded and denied environment. J Sensors 2020:1–15. https://doi.org/10.1155/2020/8670262
Liu X, Chen G, Sun X, Knoll A (2020b) Ground moving vehicle detection and movement tracking based on the neuromorphic vision sensor. IEEE Internet Things J 7(9):9026–9039. https://doi.org/10.1109/jiot.2020.3001167
Liu CY, Lin CA, Chiang KW, Huang SC, Chang CC, Cai JM (2012) Performance evaluation of real-time MEMS INS/GPS integration with ZUPT/ZIHR/NHC for land navigation. In: 12th international conference on ITS telecommunications. pp 578–582
Schubert R, Richter E, Wanielik G (2008) Comparison and evaluation of advanced motion models for vehicle tracking. In: 11th international conference on information fusion. pp 1–6
Shaeffer D (2013) MEMS inertial sensors: a tutorial overview. IEEE Commun Mag 51(4):100–109. https://doi.org/10.1109/MCOM.2013.6495768
Soken HE, Hajiyev C, Sakai S (2014) Robust Kalman filtering for small satellite attitude estimation in the presence of measurement faults. Eur J Control 20(2):64–72. https://doi.org/10.1016/j.ejcon.2013.12.002
Stoll H, Zimmer P, Hartmann F, Sax E (2017) GPS-independent localization for off-road vehicles using ultra-wideband(UWB). In: IEEE 20th international conference on intelligent transportation systems. pp 1–6. https://doi.org/10.1109/ITSC.2017.8317763
Sun R, Yang Y, Chiang KW, Duong TT, Lin KY, Tsai GJ (2020) Robust IMU/GPS/VO integration for vehicle navigation in GNSS degraded urban areas. IEEE Sens J 20(17):10110–10122. https://doi.org/10.1109/jsen.2020.2989332
Tamke A, Dang T, Breuel G (2011) A flexible method for criticality assessment in driver assistance systems. In: IEEE intelligent vehicles symposium (IV). pp 697–702.
Xu Y, Cao J, Shmaliy YS, Zhuang Y (2021) Distributed Kalman filter for UWB/INS integrated pedestrian localization under colored measurement noise. Satell Navig 2(1):22. https://doi.org/10.1186/s43020-021-00053-z
Yang Y, Cui X (2013) Adaptively robust filter with multi adaptive factors. Surv Rev 40(309):260–270. https://doi.org/10.1179/003962608x325330
Yang Y, Gao W (2006) An optimal adaptive ssKalman filter. J Geodesy 80(4):177–183. https://doi.org/10.1007/s00190-006-0041-0
Yang Y, He H, Xu G (2001) Adaptively robust filtering for kinematic geodetic positioning. J Geodesy 75(2–3):109–116. https://doi.org/10.1007/s001900000157
Yang Y, Gao W, Zhang X (2010) Robust Kalman filtering with constraints: a case study for integrated navigation. J Geodesy 84(6):373–381. https://doi.org/10.1007/s00190-010-0374-6
Zhou H, Kumar KSP (1984) A “current” statistical model and adaptive algorithm for estimating maneuvering targets. J Guid Control Dynam 7(5):596–602. https://doi.org/10.2514/3.19900
Acknowledgements
This work is supported by the Graduate Innovation Program of China University of Mining and Technology (Grant Number 2022WLJCRCZL259) and the National Natural Science Foundation of China (Grant Number 41874006).
Author information
Authors and Affiliations
Corresponding author
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
Springer Nature or its licensor holds exclusive rights to this article under a publishing agreement with the author(s) or other rightsholder(s); author self-archiving of the accepted manuscript version of this article is solely governed by the terms of such publishing agreement and applicable law.
About this article
Cite this article
Sun, Y., Li, Z., Yang, Z. et al. Motion model-assisted GNSS/MEMS-IMU integrated navigation system for land vehicle. GPS Solut 26, 131 (2022). https://doi.org/10.1007/s10291-022-01318-z
Received:
Accepted:
Published:
DOI: https://doi.org/10.1007/s10291-022-01318-z