一种融合长基线与单信标定位的海底飞行节点定位方法

摘要

本发明属于水声定位技术领域，涉及一种海底飞行节点定位方法。本发明利用4个位置已知且固定的水声信标按照固定周期同时发射水声信号，水声信标与海底飞行节点实现时钟同步；海底飞行节点接收水声信号并记录信号到达时间，计算出水声信号传递时间；海底飞行节点未接收到水声信号时通过自身携带的低成本惯性测量单元进行惯性导航；海底飞行节点接收到水声信号后通过扩展Kalman滤波进行单信标定位位置校准；同一时刻发射的多个水声信号均被接收后，海底飞行节点通过最小二乘法进行长基线定位位置校准。本发明通过融合水下长基线定位与单信标定位，克服了长基线定位实时性差及单信标定位精度低的缺点，满足了海底飞行节点高精度实时定位的需求。