基于交互式多模型因子图的AUV协同导航算法

AUV Cooperative Navigation Algorithm Based on Interactive Multiple Model Factor Graph

  • 摘要:目的】针对复杂海洋环境中洋流干扰导致的AUV协同导航精度下降问题,提出一种基于交互式多模型因子图的协同导航算法。【方法】结合因子图的灵活建模能力与交互式多模型的动态适应性,将洋流速度建模为多模式系统:通过生成多个洋流模型,并行运行因子图算法进行状态估计,再基于模型概率加权融合输出洋流速度及AUV位置的最优估计。【结果】仿真实验表明,在动态洋流环境下,交互式多模型因子图算法的平均定位误差较交互式多模型卡尔曼滤波算法和传统因子图算法分别降低17.04%和19.13%;洋流速度估计误差较交互式多模型卡尔曼滤波算法和传统因子图算法分别降低11.78%和32.08%。【结论】所提算法在动态海洋环境中具有鲁棒性与高精度优势。

     

    Abstract: Objective Aiming at the problem of degraded accuracy in Autonomous Underwater Vehicle (AUV) cooperative navigation caused by ocean current interference in complex marine environments, a cooperative navigation algorithm based on interactive multiple model factor graph is proposed.MethodCombining the flexible modeling capability of factor graph and the dynamic adaptability of interactive multiple models, the ocean current velocity is modeled as a multi-mode system. By generating multiple ocean current models, the factor graph algorithm is executed in parallel for state estimation, and then the optimal estimation of ocean current velocity and AUV position is output via weighted fusion based on model probabilities.Result Simulation results show that in dynamic ocean current environments, the average positioning error of the proposed interactive multiple model factor graph algorithm is reduced by 17.04% and 19.13% respectively compared with the interactive multiple model Kalman filter algorithm and the traditional factor graph algorithm. The ocean current velocity estimation error is decreased by 11.78% and 32.08% respectively compared with the two contrast algorithms.Conclusion The proposed algorithm has the advantages of strong robustness and high precision in dynamic marine environments.

     

/

返回文章
返回