• 中国科技核心期刊
  • Scopus收录期刊
  • DOAJ收录期刊
  • JST收录期刊
  • Euro Pub收录期刊

留言板

尊敬的读者、作者、审稿人, 关于本刊的投稿、审稿、编辑和出版的任何问题, 您可以本页添加留言。我们将尽快给您答复。谢谢您的支持!

姓名
邮箱
手机号码
标题
留言内容
验证码

基于混合相关熵抗差FGO的多UUV协同导航与编队控制方法

黄长春,  胡友峰,  肖睿彬,  胡利民

黄长春, 胡友峰, 肖睿彬, 等. 基于混合相关熵抗差FGO的多UUV协同导航与编队控制方法[J]. 水下无人系统学报, 2026, 34(6): 1-12 doi: 10.11993/j.issn.2096-3920.2026-0150
引用本文: 黄长春, 胡友峰, 肖睿彬, 等. 基于混合相关熵抗差FGO的多UUV协同导航与编队控制方法[J]. 水下无人系统学报, 2026, 34(6): 1-12 doi: 10.11993/j.issn.2096-3920.2026-0150
HUANG Changchun, HU Youfeng, XIAO Ruibin, HU Limin. A Multi-UUV Cooperative Navigation and Formation Control Method Based on Robust FGO with Mixed Correntropy[J]. Journal of Unmanned Undersea Systems. doi: 10.11993/j.issn.2096-3920.2026-0150
Citation: HUANG Changchun, HU Youfeng, XIAO Ruibin, HU Limin. A Multi-UUV Cooperative Navigation and Formation Control Method Based on Robust FGO with Mixed Correntropy[J]. Journal of Unmanned Undersea Systems. doi: 10.11993/j.issn.2096-3920.2026-0150

基于混合相关熵抗差FGO的多UUV协同导航与编队控制方法

doi: 10.11993/j.issn.2096-3920.2026-0150
详细信息
    作者简介:

    黄长春(2002-), 男, 在读硕士, 助理工程师, 主要研究方向为多水下无人航行器编队控制技术

  • 中图分类号: U674.941;TJ630

A Multi-UUV Cooperative Navigation and Formation Control Method Based on Robust FGO with Mixed Correntropy

  • 摘要: 无人水下航行器(UUV)编队协同作业是海洋勘探与水下目标监视等任务执行的重要技术途径, 但水下环境中普遍存在的非高斯厚尾噪声、水声通信延迟与量测中断等问题严重制约着协同定位精度与编队控制稳定性。文中提出一种基于混合相关熵抗差因子图优化(FGO)的多UUV协同导航与编队控制方法, 用FGO滑动窗口批量处理机制, 引入双带宽高斯核凸组合构造混合相关熵代价函数、动态协方差缩放和自适应质量评估机制, 通过导航估计与编队控制的双向信息交互形成闭环协同。仿真结果表明, 该方法能有效提升多UUV编队在复杂水下环境下的定位精度与编队保持精度。

     

  • 图  1  领航跟随者编队队形图

    Figure  1.  Leader-follower formation diagram

    图  2  抗差算法流程图

    Figure  2.  Flow diagram of the robust estimation algorithm

    图  3  编队保持仿真图

    Figure  3.  Simulation results of formation keeping

    图  4  通信延迟误差分析图

    Figure  4.  Error analysis under communication delays

    图  5  量测中断误差分析图

    Figure  5.  Error analysis under measurement outages

    图  6  噪声异常误差分析图

    Figure  6.  Error analysis under noise anomalies

    图  7  全场景定位误差分析图

    Figure  7.  Positioning error analysis over all test scenarios

    图  8  FGO类抗差方法定位误差图

    Figure  8.  Positioning errors of FGO-based robust methods under different scenarios

    图  9  各方法定位误差累积分布

    Figure  9.  Cumulative distribution of positioning errors

    图  10  消融实验结果

    Figure  10.  Results of the ablation experiments

    表  1  蒙特卡洛统计结果(N=200, 均值±95%置信半宽)

    Table  1.   Monte Carlo statistical results (N=200, mean ± 95% confidence half-width) m

    场景指标EKFUKFFGO-StdFGO-HuberFGO-MCCFGO-Robust
    正常场景定位RMSE4.215±0.1572.712±0.08419.078±0.6831.809±0.0431.203±0.0260.678±0.013
    编队RMSE5.103±0.1783.280±0.09019.821±0.7111.984±0.0431.331±0.0260.743±0.013
    通信延迟定位RMSE3.945±0.1422.622±0.08418.574±0.6781.728±0.0381.148±0.0220.674±0.013
    编队RMSE4.783±0.1613.171±0.08919.296±0.7061.899±0.0381.272±0.0220.739±0.013
    量测中断定位RMSE3.193±0.1242.275±0.08713.801±0.6141.469±0.0350.965±0.0190.635±0.013
    编队RMSE3.829±0.1382.703±0.09314.358±0.6391.623±0.0351.081±0.0180.718±0.013
    噪声异常定位RMSE24.739±3.86517.871±3.63628.860±1.0963.822±0.1554.550±0.2380.694±0.011
    编队RMSE29.364±4.58920.991±4.28729.965±1.4434.040±0.1584.774±0.2460.763±0.011
    下载: 导出CSV

    表  2  抗差机制消融实验结果(定位平面RMSE)

    Table  2.   Ablation experiment results of the robust mechanism (horizontal positioning RMSE) m

    配置正常场景通信延迟量测中断噪声异常
    MCC1.1881.4021.0402.357
    DCS0.7740.9330.9290.863
    AW15.47912.12718.29918.585
    MCC+DCS0.6100.7820.7520.677
    MCC+DCS+AW0.6020.7810.7290.627
    下载: 导出CSV
  • [1] 袁蕊霞. 基于因子图的多AUV协同定位算法研究[D]. 秦皇岛: 燕山大学, 2024: 1-4.
    [2] 栾正琨. 基于因子图的多UUV协同定位方法研究[D]. 哈尔滨: 哈尔滨工程大学, 2024: 1-7.
    [3] 张继文, 徐博, 王储岩, 等. 基于神经动力学模型预测的多AUV编队自适应控制方案[J]. 中国舰船研究, 2025, 20(1): 326-339. doi: 10.19693/j.issn.1673-3185.04045

    Zhang J W, Xu B, Wang C Y, et al. A neural dynamics model prediction-based adaptive control system for AUV formation control[J]. Chinese Journal of Ship Research, 2025, 20(1): 326-339. doi: 10.19693/j.issn.1673-3185.04045
    [4] Xu B, Zuo Y B, Wang Z Y, et al. Event-driven metrology-communication joint framework based on LMPC multi-AUV formation control[J]. Chinese Journal of Ship Research, 2026, 21(2): 89-100.
    [5] 宁君, 王二月, 李铁山, 等. 带有事件触发和输入量化的无人船轨迹跟踪控制[J]. 控制理论与应用, 2026, 43(3): 530-540. doi: 10.7641/CTA.2024.30488

    Ning J, Wang E Y, Li T S, et al. Unmanned surface vehicle trajectory tracking control with event-triggered and input quantization[J]. Control Theory & Applications, 2026, 43(3): 530-540. doi: 10.7641/CTA.2024.30488
    [6] 宁君, 彭周华, 李铁山, 等. 带有输入量化的分布式多无人船舶自适应模糊编队控制[J]. 控制与决策, 2024, 39(8): 2588-2596. doi: 10.13195/j.kzyjc.2023.0007

    Ning J, Peng Z H, Li T S, et al. Fuzzy-adaptive distributed formation control of unmanned surface vehicles with input quantization[J]. Control and Decision, 2024, 39(8): 2588-2596. doi: 10.13195/j.kzyjc.2023.0007
    [7] Wibisono A, Piran M J, Song H K, et al. A survey on unmanned underwater vehicles: Challenges, enabling technologies, and future research directions[J]. Sensors, 2023, 23(17): 7321. doi: 10.3390/s23177321
    [8] Huber P J. Robust estimation of a location parameter[J]. The Annals of Mathematical Statistics, 1964, 35(1): 73-101. doi: 10.1214/aoms/1177703732
    [9] Liu W, Pokharel P P, Principe J C. Correntropy: Properties and applications in non-Gaussian signal processing[J]. IEEE Transactions on Signal Processing, 2007, 55(11): 5286-5298. doi: 10.1109/TSP.2007.896065
    [10] Li P, Sun X, Chen Z, et al. A robust and adaptive AUV integrated navigation algorithm based on a maximum correntropy criterion[J]. Electronics, 2024, 13(13): 2426. doi: 10.3390/electronics13132426
    [11] Ma X S, Li C L, Liu X X. Research on multi-source information fusion based on sliding window-factor graph for autonomous underwater vehicle[J]. Transactions of the Institute of Measurement and Control, 2025, 47(14): 2930-2939. doi: 10.1177/01423312241274573
    [12] 涂豫, 李国胜, 覃羡烘. 基于因子图结合卡方检测的多AUV协同定位方法[J]. 数据采集与处理, 2021, 36(5): 978-985. doi: 10.16337/j.1004-9037.2021.05.013

    Tu Y, Li G S, Qin X H. Multi-AUV cooperative localization method based on factor graph combined with Chi-Square detection[J]. Journal of Data Acquisition and Processing, 2021, 36(5): 978-985. doi: 10.16337/j.1004-9037.2021.05.013
    [13] Agarwal P, Tipaldi G D, Spinello L, et al. Robust map optimization using dynamic covariance scaling[C]//2013 IEEE International Conference on Robotics and Automation (ICRA), 2013: 62-69.
    [14] 杨旭升, 夏晓翠, 金宇强, 等. 基于广义最大相关熵准则的几何滤波方法[J]. 自动化学报, 2025, 51(7): 1612-1625. doi: 10.16383/j.aas.c240497

    Yang X S, Xia X C, Jin Y Q, et al. Geometric filtering method based on generalized maximum correntropy criterion[J]. Acta Automatica Sinica, 2025, 51(7): 1612-1625. doi: 10.16383/j.aas.c240497
    [15] Chen B, Wang X, Lu N, et al. Mixture correntropy for robust learning[J]. Pattern Recognition, 2018, 79: 318-327. doi: 10.1016/j.patcog.2018.02.010
    [16] Dellaert F, Kaess M. Factor graphs for robot perception[J]. Foundations and Trends in Robotics, 2017, 6(1-2): 1-145. doi: 10.1561/9781680833270
    [17] Kaess M, Johannsson H, Roberts R, et al. iSAM2: Incremental smoothing and mapping using the Bayes tree[J]. The International Journal of Robotics Research, 2012, 31(2): 216-235. doi: 10.1177/0278364911430419
  • 加载中
计量
  • 文章访问数:  9
  • HTML全文浏览量:  2
  • PDF下载量:  0
  • 被引次数: 0
出版历程
  • 收稿日期:  2026-09-04
  • 修回日期:  2026-11-09
  • 录用日期:  2026-11-10
  • 网络出版日期:  2026-11-16
图(10) / 表(2)

目录

    /

    返回文章
    返回
    服务号
    订阅号