一种基于水声通信延迟的主从式多UUV协同定位方法

摘要

一种基于水声通信延迟的主从式多UUV协同定位方法，涉及一种协同定位方法。它解决了现有主从式多UUV协同定位系统的定位误差大的问题。其方法：主、从UUV进行时钟同步准备，主UUV通过水声测距测量主、从UUV之间的距离；主UUV通过水声设备向从UUV发送自身的定位信息、间距信息以及信息发送时刻的时间戳；从UUV接收到主UUV水声信息后计算本次水声通信的延迟时长，建立协同定位系统的状态方程；从UUV利用系统状态转移矩阵，建立协同定位系统量测方程；利用系统量测方程，完成协同定位系统量测更新；利用系统状态方程，完成协同定位系统状态更新；从UUV对状态估计误差进行补偿。本发明适用于主从式多UUV协同定位。