一种具有全局收敛性的水下航行器单信标定位方法
摘要:
本发明涉及水下定位技术领域,特别涉及一种水下航行器的单信标定位方法。一种具有全局收敛性的水下航行器单信标定位方法,水下航行器搭载有水听器、多普勒测速仪、深度计、姿态航向参考系统及GPS;水声信标周期性广播水声信号;本发明通过状态增广,将离散状态的非线性单信标定位模型转化为线性时变模型;在获得的随体坐标系下水下航行器与水相对速度以及航行器姿态航向时,进行Kalman滤波预测;在获得海流速度观测、深度计观测、水声信号传递时间时,分别通过Kalman滤波进行海流速度、深度、水声信号传递时间更新。在满足定位模型可观测的前提下,本方法具有全局指数收敛性。
0/0