CAFGO: Confidence-Adaptive Factor Graph Optimization Algorithm for Fusion Localization | SpringerLink
Skip to main content

CAFGO: Confidence-Adaptive Factor Graph Optimization Algorithm for Fusion Localization

  • Conference paper
  • First Online:
PRICAI 2024: Trends in Artificial Intelligence (PRICAI 2024)

Abstract

Accurate positioning algorithms are crucial for autonomous vehicle navigation and robotics. The fusion of data from GNSS, INS, and odometers can provide comprehensive positioning results across various environments. However, effectively integrating data from sources with varying reliability levels remains a significant challenge. To address this challenge, we propose a fusion positioning framework that dynamically optimizes the weights of navigation sources. This framework leverages a plug-and-play factor graph algorithm and utilizes a padding mask to flexibly extract features from opportunistically acquired sensor data. It learns the relative fusion weights of different navigation systems based on these data features, thus offering more robust and accurate positioning results in complex and dynamic urban environments. Comprehensive experiments and evaluations demonstrate the effectiveness and superiority of our algorithm.

F. Wu and Z. Zhou—Equal contribution.

This is a preview of subscription content, log in via an institution to check access.

Access this chapter

Subscribe and save

Springer+ Basic
¥17,985 /Month
  • Get 10 units per month
  • Download Article/Chapter or eBook
  • 1 Unit = 1 Article or 1 Chapter
  • Cancel anytime
Subscribe now

Buy Now

Chapter
JPY 3498
Price includes VAT (Japan)
  • Available as PDF
  • Read on any device
  • Instant download
  • Own it forever
eBook
JPY 8465
Price includes VAT (Japan)
  • Available as EPUB and PDF
  • Read on any device
  • Instant download
  • Own it forever
Softcover Book
JPY 10581
Price includes VAT (Japan)
  • Compact, lightweight edition
  • Dispatched in 3 to 5 business days
  • Free shipping worldwide - see info

Tax calculation will be finalised at checkout

Purchases are for personal use only

Institutional subscriptions

Notes

  1. 1.

    https://github.com/brentyi/jaxfg.

References

  1. Niu, X., Tang, H., Zhang, T., Fan, J., Liu, J.: Ic-gvins: a robust, real-time, ins-centric gnss-visual-inertial navigation system. IEEE Rob. Autom. Lett. 8(1), 216–223 (2022)

    Article  Google Scholar 

  2. Boguspayev, N., Akhmedov, D., Raskaliyev, A., Kim, A., Sukhenko, A.: A comprehensive review of gnss/ins integration techniques for land and air vehicle applications. Appl. Sci. 13(8), 4819 (2023)

    Article  Google Scholar 

  3. Dong, Y., Wang, D., Zhang, L., Li, Q., Jie, W.: Tightly coupled gnss/ins integration with robust sequential kalman filter for accurate vehicular navigation. Sensors 20(2), 561 (2020)

    Article  Google Scholar 

  4. Wen, W., Pfeifer, T., Bai, X., Hsu, L.T.: Factor graph optimization for gnss/ins integration: a comparison with the extended kalman filter. NAVIGATION: J. Inst. Navig. 68(2), 315–331 (2021)

    Google Scholar 

  5. Clark, R., Wang, S., Wen, H., Markham, A., Trigoni, N.: Vinet: visual-inertial odometry as a sequence-to-sequence learning problem. In: Proceedings of the AAAI Conference on Artificial Intelligence, vol. 31 (2017)

    Google Scholar 

  6. Liu, Y., Luo, Q., Zhou, Y.: Deep learning-enabled fusion to bridge gps outages for ins/gps integrated navigation. IEEE Sens. J. 22(9), 8974–8985 (2022)

    Article  Google Scholar 

  7. Fan, W., et al.: Predicting the noise covariance with a multitask learning model for kalman filter-based gnss/ins integrated navigation. IEEE Trans. Instrum. Meas. 70, 1–13 (2020)

    Google Scholar 

  8. Liu, N., Hui, Z., Zhong, S., Qiao, L., Dong, Y.: Integrated navigation on vehicle based on low-cost sins/gnss using deep learning. Wireless Pers. Commun. 126(3), 2043–2064 (2022)

    Article  Google Scholar 

  9. Zhu, R., Yang, M., Liu, W., Song, R., Yan, B., Xiao, Z.: Deepavo: efficient pose refining with feature distilling for deep visual odometry. Neurocomputing 467, 22–35 (2022)

    Article  Google Scholar 

Download references

Acknowledgements

This work was supported in part by the Strategic Priority Research Program of Chinese Academy of Sciences under Grant XDA28040500, the National Natural Science Foundation of China under Grant 62261042, the Key Research Projects of the Joint Research Fund for Beijing Natural Science Foundation and the Fengtai Rail Transit Frontier Research Joint Fund under Grant L221003, the Beijing Natural Science Foundation under Grant 4232035 and 4222034, and the BUPT Excellent Ph.D. Students Foundation CX2022131.

Author information

Authors and Affiliations

Authors

Corresponding authors

Correspondence to Haiyong Luo or Fang Zhao .

Editor information

Editors and Affiliations

Rights and permissions

Reprints and permissions

Copyright information

© 2025 The Author(s), under exclusive license to Springer Nature Singapore Pte Ltd.

About this paper

Check for updates. Verify currency and authenticity via CrossMark

Cite this paper

Wu, F., Zhou, Z., Luo, H., Zhao, F., Zhou, B. (2025). CAFGO: Confidence-Adaptive Factor Graph Optimization Algorithm for Fusion Localization. In: Hadfi, R., Anthony, P., Sharma, A., Ito, T., Bai, Q. (eds) PRICAI 2024: Trends in Artificial Intelligence. PRICAI 2024. Lecture Notes in Computer Science(), vol 15281. Springer, Singapore. https://doi.org/10.1007/978-981-96-0116-5_28

Download citation

  • DOI: https://doi.org/10.1007/978-981-96-0116-5_28

  • Published:

  • Publisher Name: Springer, Singapore

  • Print ISBN: 978-981-96-0115-8

  • Online ISBN: 978-981-96-0116-5

  • eBook Packages: Computer ScienceComputer Science (R0)

Publish with us

Policies and ethics