Robust 2D Vehicle Trajectory Estimation Under Intermittent/Outage GNSS Using a Low-Cost IMU and Motion Constraints

Xu Zhao, Yu Gao, Zijun Wang, Lianpeng Li, and Wen Liu

Peer Reviewed

Abstract: Reliable vehicle localization remains challenging when GNSS is intermittent, unavailable, or numerically present but corrupted. In garages, tunnels, and dense urban canyons, low-cost MEMS inertial sensors drift rapidly, while stale or jump-corrupted GNSS samples can destabilize a filter and produce physically inconsistent trajectories if they are fused without screening. This paper presents a lightweight 2D vehicle-centric extended Kalman filter for low-cost land-vehicle GNSS/IMU fusion under intermittent and corrupted GNSS. The filter operates in a local East-North-Up (ENU) plane and combines GNSS measurement-admissibility screening, conservative Joseph-form covariance updates, and condition-gated vehicle-motion constraints. During GNSS-denied intervals, the estimator continues inertial propagation while using a non-holonomic constraint, zero-velocity updates, and a gated turn-induced speed pseudo-measurement to limit unbounded drift. Corrupted GNSS is handled by rejecting physically inconsistent position samples through jump, implied-speed, and stale-position checks rather than treating all available GNSS as valid aiding. The evaluation combines three self-collected low-cost vehicle logs, reference-backed public KITTI-360 degraded-GNSS tests, Oxford RobotCar and UrbanNav admissibility audits, and Boreas and dual-antenna consistency checks for nominal validation. On the main long-duration field log, removing GNSS screening degrades RMSE on screening-admitted points from 3.11 m to 198.32 m and increases the maximum error from 38.19 m to 1030.91 m. On public KITTI-360 sequences with injected stale/mixed corruption, the full method also remains lower than a conventional loosely coupled EKF baseline under externally supplied georeferenced references. On a second outage-sensitive field log, removing the non-holonomic constraint increases RMSE from 5.47 m to 86.56 m. These results indicate that robust low-cost vehicle localization depends not only on how GNSS is fused, but also on whether GNSS measurements are admissible before they enter the filter.
Published in: Proceedings of the 39th International Technical Meeting of the Satellite Division of the Institute of Navigation (ION GNSS+ 2026)
September 14 - 18, 2026
Hyatt Regency Grand Cypress
Orlando, Florida
Pages: 923 - 937
Cite this article: Zhao, Xu, Gao, Yu, Wang, Zijun, Li, Lianpeng, Liu, Wen, "Robust 2D Vehicle Trajectory Estimation Under Intermittent/Outage GNSS Using a Low-Cost IMU and Motion Constraints," Proceedings of the 39th International Technical Meeting of the Satellite Division of the Institute of Navigation (ION GNSS+ 2026), Orlando, Florida, September 2026, pp. 923-937. https://doi.org/10.33012/2026.20649
Full Paper:

Sign in to download with your ION membership, download credits or subscription, or buy this article.

Sign In Buy this article: $12 for ION members, $35 for non-members
References:
Show 38 references
  1. Ahmadi, E., Elsanhoury, M., Selvan, K., Välisuo, P., & Kuusniemi, H. (2025). Robust multi-sensor fusion positioning based on gnss/imu using factor graph optimization. 2025 IEEE/ION Position, Location and Navigation Symposium (PLANS), 1247-1256. https://doi.org/10.1109/plans61210.2025.11028340
  2. Bai, S., Lai, J., Lyu, P., Cen, Y., & Ji, B. (2021). Improved preintegration method for gnss/imu/in-vehicle sensors navigation using graph optimization. IEEE Transactions on Vehicular Technology, 70(11), 11446-11457. https://doi.org/10.1109/tvt.2021.3115619
  3. Burnett, K., Yoon, D. J., Wu, Y., Li, A. Z., Zhang, H., Lu, S., Qian, J., Tseng, W.-K., Lambert, A., Leung, K. Y. K., Schoellig, A. P., & Barfoot, T. D. (2023). Boreas: A multi-season autonomous driving dataset. The International Journal of Robotics Research, 42(1-2), 33-42. https://doi.org/10.1177/02783649231160195
  4. Chen, H., & Sun, R. (2022). A gnss quality control based gnss/imu integrated navigation algorithm in urban environments. In China satellite navigation conference (csnc 2022) proceedings (pp. 426-436). Springer Nature Singapore. https://doi.org/10.1007/978-981-19-2588-7_40
  5. Cheng, J., Zhang, X., Zhu, F., Hu, J., Zhuo, D., & Freeshah, M. (2025). A tightly coupled integration of gnss/imu/lidar with parameterized semantic line and plane features to improve pose accuracy in complex environments. Measurement, 247, 116843. https://doi.org/10.1016/j.measurement.2025.116843
  6. Cheng, S., Cheng, J., Zang, N., Cai, J., Fan, S., Zhang, Z., & Song, H. (2023). Adaptive non-holonomic constraint aiding multignss ppp/ins tightly coupled navigation in the urban environment. GPS Solutions, 27(3). https://doi.org/10.1007/s10291-023-01475-9
  7. de Araujo, P. R. M., Dawson, E., Elhabiby, M., Givigi, S., & Noureldin, A. (2022). Evaluation of invariant extended kalman filters applied to multi-sensor land vehicle navigation in gnss challenging environments. Proceedings of the 35th International Technical Meeting of the Satellite Division of The Institute of Navigation (ION GNSS+ 2022), 1631-1649. https://doi.org/10.33012/2022.18472
  8. Deng, Z., Zhang, Z., Ding, Z., & Liu, B. (2025). Multi-source, fault-tolerant, and robust navigation method for tightly coupled gnss/5g/imu system. Sensors, 25(3), 965. https://doi.org/10.3390/s25030965
  9. Feng, Y., Huang, G., Jing, C., Li, X., & Li, Z. (2023). Gnss/mems imu vehicle integrated navigation algorithm constrained by displacement vectors in urban environment. Measurement Science and Technology, 34(12), 125157. https://doi.org/10.1088/1361-6501/acf9c2
  10. Gao, L., Xia, X., Zheng, Z., & Ma, J. (2023). Gnss/imu/lidar fusion for vehicle localization in urban driving environments within a consensus framework. Mechanical Systems and Signal Processing, 205, 110862. https://doi.org/10.1016/j.ymssp.2023.110862
  11. Gao, Y., Liu, Z., Wang, Y., & Noureldin, A. (2023). A hybrid riss/gnss method during gnss outage in the land vehicle navigation system. IEEE Sensors Journal, 23(8), 8690-8702. https://doi.org/10.1109/jsen.2023.3257046
  12. Ji, X., Long, C., Ju, L., Zhao, H., & Wei, D. (2024). Gnss/imu/odo integrated navigation method based on adaptive sliding window factor graph. Electronics, 14(1), 124. https://doi.org/10.3390/electronics14010124
  13. Jiang, C., Zhao, D., Zhang, Q., & Liu, W. (2023). A multi-gnss/imu data fusion algorithm based on the mixed norms for land vehicle applications. Remote Sensing, 15(9), 2439. https://doi.org/10.3390/rs15092439
  14. KITTI Vision Benchmark Suite. (2026a). Kitti raw data and sensor setup documentation [Accessed 2026-04-20]. https://www. cvlibs.net/datasets/kitti/raw_data.php
  15. KITTI Vision Benchmark Suite. (2026b). Kitti-360 dataset documentation [Accessed 2026-04-20]. https://www.cvlibs.net/ datasets/kitti-360/documentation.php
  16. Lee, J., Kim, M., Min, D., Pullen, S., & Lee, J. (2023). Navigation safety assurance of a kf-based gnss/imu system: Protection levels against imu failure. NAVIGATION: Journal of the Institute of Navigation, 70(4), navi.612. https://doi.org/10.33012/navi.612
  17. Leland, K., Taylor, C., & Graas, F. v. (2025). Factor-graph optimization for robust navigation via high-precision gnss/imu corroboration. 2025 IEEE/ION Position, Location and Navigation Symposium (PLANS), 97-104. https://doi.org/10.1109/plans61210.2025.11028303
  18. Li, H., Liu, Z., Li, C., Zheng, Y., Tong, S., Chen, S., & Gou, W. (2024). Non-holonomic constraint-assisted gnss/sins tight integration navigation method based on a left-invariant extended kalman filter. Measurement Science and Technology, 36(1), 016327. https://doi.org/10.1088/1361-6501/ad9161
  19. Li, X., Li, H., Huang, G., Zhang, Q., & Meng, S. (2023). Non-holonomic constraint (nhc)-assisted gnss/sins positioning using a vehicle motion state classification (vmsc)-based convolution neural network. GPS Solutions, 27(3). https://doi.org/10.1007/s10291-023-01483-9
  20. Lyu, X., Wang, X., Xu, G., & Hu, B. (2024). An inertial-based integrated navigation robust filtering algorithm based on vehicle model for gnss failure. IEEE Transactions on Instrumentation and Measurement, 73, 1-12. https://doi.org/10.1109/tim.2024.3484536
  21. Maddern, W., Pascoe, G., Gadd, M., Barnes, D., Yeomans, B., & Newman, P. (2020). Real-time kinematic ground truth for the oxford robotcar dataset. arXiv preprint arXiv:2002.10152. https://arxiv.org/abs/2002.10152
  22. Maddern, W., Pascoe, G., Linegar, C., & Newman, P. (2017). 1 Year, 1000km: The Oxford RobotCar Dataset. The International Journal of Robotics Research, 36(1), 3-15. https://doi.org/10.1177/0278364916679498
  23. Mahmoud, M., Abd Rabbou, M., & El Shazly, A. (2022). Land vehicle navigation using low-cost integrated smartphone gnss mems and map matching technique. Artificial Satellites, 57(3), 138-157. https://doi.org/10.2478/arsa-2022-0007
  24. Manes, C., & Pezzuti, D. (2025). Strategies for vehicle localization fusing imu/wss/sas measurements during gnss outages. 2025 IEEE 8th International Conference on Methods and Systems of Navigation and Motion Control (MSNMC), 1-6. https://doi.org/10.1109/msnmc61130.2025.11399730
  25. Nagai, K., Spenko, M., Henderson, R., & Pervan, B. (2022). Fault-free integrity and continuity for driverless urban vehicle navigation with multi-sensor integration: A case study in downtown chicago. Proceedings of the 35th International Technical Meeting of the Satellite Division of The Institute of Navigation (ION GNSS+ 2022), 1350-1365. https://doi.org/10.33012/2022.18319
  26. Pan, C., Li, Z., Zhang, Q., Soja, B., & Gao, J. (2024). Smartphone-based vision/mems-imu/gnss tightly coupled seamless positioning using factor graph optimization. Measurement, 229, 114420. https://doi.org/10.1016/j.measurement.2024.114420
  27. Shen, Z., Li, X., Li, X., Xu, Z., Wu, Z., & Zhou, Y. (2024). Precise and robust imu-centric vehicle navigation via tightly integrating multiple homogeneous gnss terminals. IEEE Transactions on Instrumentation and Measurement, 73, 1-14. https://doi.org/10.1109/tim.2023.3336725
  28. Sun, Y., Li, Z., Yang, Z., Shao, K., & Chen, W. (2022). Motion model-assisted gnss/mems-imu integrated navigation system for land vehicle. GPS Solutions, 26(4). https://doi.org/10.1007/s10291-022-01318-z
  29. Takanose, A., Kondo, K., Hoda, Y., Meguro, J., & Takeda, K. (2023). Localization system for vehicle navigation based on gnss/imu using time-series optimization with road gradient constrain. Journal of Robotics and Mechatronics, 35(2), 387-397. https://doi.org/10.20965/jrm.2023.p0387
  30. Vana, S., & Bisnath, S. (2023). Low-cost, triple-frequency, multi-gnss ppp and mems imu integration for continuous navigation in simulated urban environments. NAVIGATION: Journal of the Institute of Navigation, 70(2), navi.578. https://doi.org/10.33012/navi.578
  31. Wang, J., Chen, W., & Weng, D. (2025). Gnss/imu/map-matching feedback integration with adaptive gnss accuracy estimation by using low-quality sensors for vehicle localization in urban canyon. Measurement, 240, 115541. https://doi.org/10.1016/j.measurement.2024.115541
  32. Wang, P., Xu, Q., Yao, S., Wu, X., Zhang, Q., Lv, R., Liu, S., Li, Y., Fang, H., & Hu, Z. (2023). A robust online extrinsic calibration method for gnss-rtk and imu system and vehicle setups. 2023 IEEE 34th International Symposium on Software Reliability Engineering Workshops (ISSREW), 174-179. https://doi.org/10.1109/issrew60843.2023.00070
  33. Wen, W., Pfeifer, T., Bai, X., & Hsu, L.-T. (2021). Urbannav: An open-sourced multisensory dataset for benchmarking positioning algorithms designed for urban areas. Proceedings of the 34th International Technical Meeting of the Satellite Division of The Institute of Navigation (ION GNSS+ 2021), 226-256. https://doi.org/10.33012/2021.17895
  34. Xiao, Y., Luo, H., Zhao, F., Wu, F., Gao, X., Wang, Q., & Cui, L. (2021). Residual attention network-based confidence estimation algorithm for non-holonomic constraint in gnss/ins integrated navigation system. IEEE Transactions on Vehicular Technology, 70(11), 11404-11418. https://doi.org/10.1109/tvt.2021.3113500
  35. Yin, L., Guo, W., Sun, Y., Song, T., & Zhang, Q. (2024). Vehicle positioning and integrity monitoring based on gnss/5g/imu fusion system in urban environments. Proceedings of the 37th International Technical Meeting of the Satellite Division of The Institute of Navigation (ION GNSS+ 2024), 2474-2486. https://doi.org/10.33012/2024.19724
  36. Zhang, H., & Zhang, X. (2024). Study of tunnel vehicle gnss/ins/od combination position based on lateral distance measurement and lane line constraint. Applied Sciences, 14(10), 4309. https://doi.org/10.3390/app14104309
  37. Zhao, Y., & Pan, J. (2024). A combined gnss/imu localization method based on graph optimization. 2024 9th International Conference on Intelligent Computing and Signal Processing (ICSP), 608-611. https://doi.org/10.1109/icsp62122.2024.10743274
  38. Zuo, Y., Duan, X., Xia, H., & Zhou, J. (2024). Gnss/imu integrated navigation methods with nlos mitigation. CICTP 2024, 193-202. https://doi.org/10.1061/9780784485484.019