载人潜水器的组合导航定位方法
摘要:
一种载人潜水器的组合导航定位方法,取运动传感器和多普勒测速声纳的速度值,通过第一级卡尔曼滤波器综合,得最优载人潜水器速度值;由卡尔曼滤波器综合出载人潜水器最优速度值和航向角、纵倾角推算载人潜水器位置值;取超短基线定位声纳测量位置值,将超短基线定位声纳测量的位置值和推算出的载人潜水器位置值通过第二级卡尔曼滤波器综合,得最优载人潜水器位置值;采用延时超短基线测量数据融合方法,实现用过去的超短基线测量载人潜水器位置数据,对现在载人潜水器位置推算数据的矫正;不用投放固定水声信标确定载人潜水器在惯性坐标系中坐标。本发明可把多路导航设备测量得到的载人潜水器的位置和姿态信息,进行综合处理,得最优导航信息。
公开/授权文献
0/0