基于因子图的AUV集群速度估计和协同定位
李鑫滨1
袁蕊霞1
闫磊2
韩松3
1.燕山大学河北省工业计算机控制工程重点实验室,河北秦皇岛 0660042.东北大学秦皇岛分校计算机与通信工程学院,河北秦皇岛 0660043.燕山大学河北省工业计算机控制工程重点实验室,河北秦皇岛 066004;河北省智能康复及神经调控重点实验室,河北秦皇岛 066004
摘要:随着海洋科技发展,自主水下航行器(AUVs)协作执行任务技术被广泛应用,AUVs的准确定位是实现AUV集群协同作业的基础技术要求.然而,在协同定位系统中,AUVs间的异步时钟会影响测距精度,并且惯性测量系统推算的速度有较大误差.本文针对AUV集群系统中的协同定位问题,提出了利用距离测量和多普勒频移测量进行误差修正的方法.该方法首先针对时钟异步问题对距离测量的影响,利用泰勒算法对时钟参数进行估计,解决了异步时钟问题;然后,建立以位置和速度为变量节点和以距离测量和多普勒频移测量为函数节点的因子图模型,利用因子图的消息传递计算变量的边缘分布,得到位置和速度的估计;最后,针对线性化过程带来的误差,提出根据变量的协方差矩阵构造自适应因子调整置信度,从而改变对变量节点的估计.仿真结果表明,所提时钟参数能够得到良好估计,所提算法能够有效抑制惯性导航系统的累积误差.
关键词:自主水下航行器协同定位因子图速度估计异步时钟
论文发表日期:2023-12-28
在线出版日期:2025-08-15(本平台首次上网日期,不代表文献的发表时间)
页数:11( 2277-2287 )
英文信息
