Adaptive Weighted Factor Graph Optimized Positioning Algorithm Based on Joint GNSS/INS/Vision Residual Detection
Sensors · 2026-06-14 · 26 (12) · 3783
DOI: 10.3390/s26123783 ↗At a glance
Journal article in Sensors, published online on 2026-06-14. Written by Jin Wang and 5 co-authors. Institution: School of Communications and Information Engineering, Xi'an University of Posts and Telecommunications, Xi'an 710121, China. 26 references. The full text is freely available (open access, CC BY 4.0). Funded by: Natural Science Basic Research Program of Shaanxi Province, Xi’an Science and Technology Program Project of China.
Abstract (original language)
Multi-sensor fusion of GNSS, IMU, and vision sensors has been extensively applied in urban Internet of Things systems and automated driving to improve positioning accuracy in complex environments. However, conventional FGO algorithms are based on fixed sensor weights, which limit their adaptability to fluctuations in sensor errors caused by environmental changes, thereby compromising positioning performance. To overcome this limitation, a novel multi-sensor adaptive weighted localization algorithm based on joint residuals detection was proposed in this study. The algorithm computes joint residuals by the sliding window accumulation of GNSS, IMU, and vision sensor measurements. By integrating a global weight decay factor into the M-estimation framework, the weights of each sensor were dynamically adjusted, thereby suppressing the effects of outliers on the state estimation. This approach enables high-precision and robust estimation of position, velocity, and attitude. Experimental results demonstrate that, based on validation with the GNSS–Visual–Inertial Navigation System (GVINS) public datasets sports field and complex environments, the proposed method exhibits superior performance in challenging low-altitude economic scenarios such as weak GNSS signals and significant IMU drift—specifically, it improves positioning accuracy by 32.3% and reduces velocity error by 32% compared to traditional FGO algorithms. In scenarios with GNSS signal interference, the system effectively mitigates error accumulation and maintains the stability of position and velocity estimation. The proposed algorithm demonstrates exceptional positioning accuracy and robustness in complex and dynamic environments, making it highly suitable for advanced urban IoT and automated driving applications.
Subjects
Author keywords
Authors and institutions
- School of Communications and Information Engineering, Xi'an University of Posts and Telecommunications, Xi'an 710121, China.
- National Time Service Center, Chinese Academy of Sciences, Xi'an 710600, China.
ORCID profiles: Jin Wang, Yan Xing, Jin Lu, Pengwu Wan, Jianbo Du
Funding
- Natural Science Basic Research Program of Shaanxi Province
- Xi’an Science and Technology Program Project of China
Cite
APA
Wang, J., Zou, J., Xing, Y., Lu, J., Wan, P., & Du, J. (2026). Adaptive Weighted Factor Graph Optimized Positioning Algorithm Based on Joint GNSS/INS/Vision Residual Detection. Sensors, 26(12), 3783. https://doi.org/10.3390/s26123783
Vancouver
Wang J, Zou J, Xing Y, Lu J, Wan P, Du J. Adaptive Weighted Factor Graph Optimized Positioning Algorithm Based on Joint GNSS/INS/Vision Residual Detection. Sensors. 2026;26(12):3783. doi:10.3390/s26123783
BibTeX
@article{Wang2026,
author = {Wang, Jin and Zou, Jun and Xing, Yan and Lu, Jin and Wan, Pengwu and Du, Jianbo},
title = {Adaptive Weighted Factor Graph Optimized Positioning Algorithm Based on Joint GNSS/INS/Vision Residual Detection},
journal = {Sensors},
year = {2026},
volume = {26},
number = {12},
pages = {3783},
doi = {10.3390/s26123783}
}
EUVIMED