With the development of intelligent devices such as drones and autonomous vehicles, high-precision navigation and positioning technology plays an important role in perception. However, the fixed integrated navigation architecture can no longer meet the high-precision navigation and positioning requirements in scenarios with varying navigation information sources. Therefore, this paper designs the multi-source sensors integrated navigation system framework that meets the ‘plug-and-play’ function. Firstly, building a high-precision inertial preintegration model. Then, establishing a factor node library model of multi-source sensors measurements built upon factor graph, and optimal system state is solved at a fixed frequency. Finally, considering the sensor fault, the residual chi-square method is used for detection, and the factor graph structure is adjusted according to detection results. Simulation results show that the method can combine information from various asynchronous navigation sensors successfully.

错误:搜索内容不能为空,请输入英文关键词
错误:关键词超出字数限制,请精简
高级检索

Multi-source Sensors Plug-and-Play Fault-Tolerant Integrated Navigation Method Based on Factor Graph Optimization

  • Yugui Shen,
  • Pin Lyu,
  • Jizhou Lai,
  • Bingqing Wang,
  • Juchang Du

摘要

With the development of intelligent devices such as drones and autonomous vehicles, high-precision navigation and positioning technology plays an important role in perception. However, the fixed integrated navigation architecture can no longer meet the high-precision navigation and positioning requirements in scenarios with varying navigation information sources. Therefore, this paper designs the multi-source sensors integrated navigation system framework that meets the ‘plug-and-play’ function. Firstly, building a high-precision inertial preintegration model. Then, establishing a factor node library model of multi-source sensors measurements built upon factor graph, and optimal system state is solved at a fixed frequency. Finally, considering the sensor fault, the residual chi-square method is used for detection, and the factor graph structure is adjusted according to detection results. Simulation results show that the method can combine information from various asynchronous navigation sensors successfully.