[发明专利]一种基于非线性信息滤波的AUV协同导航方法

摘要

本发明公开一种基于非线性信息滤波的AUV协同导航方法。该方法中，采用分布式结构的无迹信息滤波器完成协同导航过程中的定位任务。在协同定位过程中，首先建立AUV导航系统的状态方程和量测方程；然后采用无迹信息滤波获得主AUV的状态信息，在数据包传递时刻进行状态信息的扩充，并通过无迹信息滤波完成对从AUV状态的估计，在数据包接收时刻对数据包信息进行处理；最后恢复主、从AUV通过信息滤波得到的导航信息。该发明解决了水声通信中信息延迟造成的AUV定位精度低的问题，充分考虑了AUV之间信息传递带来的信息相关性问题，并利用信息边缘化方法解决了该问题，避免了导航信息发散，实现了协同导航的高精度实时定位的目标。