一种基于INS、DVL和USBL的水下组合定位方法和系统与流程

摘要: 本发明涉及水下导航定位,更具体的说是涉及一种基于ins、dvl和usbl的水下组合定位方法和系统,尤其涉及一种面向auv、rov及其它水下运载平台的超短基线定位...
一种基于INS、DVL和USBL的水下组合定位方法和系统与流程

本发明涉及水下导航定位,更具体的说是涉及一种基于ins、dvl和usbl的水下组合定位方法和系统,尤其涉及一种面向auv、rov及其它水下运载平台的超短基线定位系统(ultra short baseline,usbl)与惯性导航系统(ins)、多普勒测速计(dvl)超深组合定位方法及系统。

背景技术:

1、现有水下定位系统中,通常基于usbl利用布设于母船、平台或固定支架上的多个水声阵元,结合应答器返回信号的传播时间、相位差或距离差信息对水下目标进行定位。

2、但是,在复杂海况、低信噪比、多路径传播、姿态快速变化、气泡干扰或声速场变化等条件下,usbl直达波的峰值提取容易出现误峰、跳峰或漏检;具体而言,现有usbl峰值检测通常采用全局最大值、固定阈值或脉冲压缩的方式选取方式,在浅水或多路径反射下,难以在相关运算结果多峰并存、主瓣畸变或旁瓣抬升情况下稳定锁定真实声学到达峰,当usbl出现误峰或跳峰时,异常观测会直接进入导航滤波器,造成定位结果突跳,严重时甚至引起组合滤波发散,进而影响usbl方位计算的稳定性。

3、因此,如何克服上述问题,提升水下定位精度,是本领域技术人员亟需解决的问题。

技术实现思路

1、鉴于上述问题,本发明提出了一种基于ins、dvl和usbl的水下组合定位方法和系统;旨在利用ins和dvl提供的先验量反推声束传播路径、到达时间窗口和峰值可信度,进而构造伪usbl观测,对usbl设备常规输出观测进行校正。

2、为了实现上述目的,本发明采用如下技术方案:

3、第一方面,本发明实施例提供一种基于ins、dvl和usbl的水下组合定位方法,包括:

4、获取ins测量数据、dvl测量数据和usbl原始声学幅度曲线;

5、根据所述ins测量数据和dvl测量数据通过组合递推,得到载体的先验位姿信息;

6、根据所述先验位姿信息计算目标声信号到达各usbl阵元的理论传播时延,得到局部搜索窗;

7、在所述局部搜索窗内对所述usbl原始声学幅度曲线进行峰值搜索,以确定最优峰值,构造伪usbl观测数据;

8、将所述伪usbl观测数据与usbl设备解算的观测数据进行融合,并将融合所得usbl观测数据与所述ins测量数据、所述dvl测量数据进行组合滤波,得到载体的导航状态估计结果。

9、优选地,获取 usbl 原始声学幅度曲线后优先进行预处理,至少包括去均值、限幅、带通或平滑处理。

10、优选地,对获取的所述ins测量数据、dvl测量数据和usbl原始声学幅度曲线进行时间同步和空间坐标标定,以使各数据在统一的时间基准和空间坐标系下对齐。

11、优选地,所述先验位姿信息包括载体的预测位置、预测速度和预测姿态;

12、根据所述先验位姿信息按如下公式计算目标声信号到达各usbl阵元的理论传播时延:

13、

14、式中,为传播结构系数,为载体在第k历元的ins/dvl预测位置,为载体坐标系到导航坐标系的姿态转换矩阵,为载体上usbl应答器或声学发射中心相对于ins参考中心的安装杆臂,为载体在第k历元的ins/dvl预测速度,为运动补偿时间,为第i个usbl阵元在导航坐标系下的位置,为等效声速,为第i个通道的系统时延补偿项;采用滑动平均或一阶滤波在线修正:

15、

16、式中,为小于1的更新系数,为锁定的最优峰值时延,为理论传播距离。

17、优选地,所述局部搜索窗表示为:

18、

19、表示理论传播时延,表示第i个通道在第k历元的搜索窗半宽,

20、

21、式中,表示clip函数,为与置信概率对应的比例系数;表示ins/dvl预测位置不确定度换算得到的时延标准差;表示姿态不确定度经声学杆臂和阵元基线放大后换算得到的时延标准差;表示速度变化率或时间同步残差引起的运动补偿不确定度;表示声速不确定度引起的时延标准差;表示时钟同步残差或系统时延补偿残差,和分别表示工程允许的窗口半宽最小值和最大值。

22、优选地,在所述局部搜索窗内进行峰值搜索,以确定最优峰值,包括:

23、获取所述局部搜索窗口内的候选峰值的幅度、信噪比、峰尖锐度和时间连续性指标,并进行加权评分,得到评分结果;

24、根据所述评分结果确定最优峰值。

25、优选地,将所述伪usbl观测数据与usbl设备解算的观测数据进行融合,包括:

26、

27、

28、其中,表示融合后数据的观测值,表示融合后数据的协方差,表示调整后的伪usbl观测数据协方差,为调整后的usbl设备解算的观测数据协方差,为伪usbl观测数据,为usbl设备解算的观测数据。

29、第二方面,本发明实施例提供一种基于ins、dvl和usbl的水下组合定位系统,用于实现如上任一项所述的基于ins、dvl和usbl的水下组合定位方法,包括:

30、数据采集装置,用于获取ins测量数据、dvl测量数据和usbl原始声学幅度曲线;

31、ins/dvl先验估计模块,用于根据所述ins测量数据和dvl测量数据通过组合递推,得到载体的先验位姿信息;并根据所述先验位姿信息计算目标声信号到达各usbl阵元的理论传播时延,得到局部搜索窗;

32、声学峰值反推模块,用于在所述局部搜索窗内对所述usbl原始声学幅度曲线进行峰值搜索,以确定最优峰值,构造伪usbl观测数据;

33、自适应测量融合模块,用于将所述伪usbl观测数据与usbl设备解算的观测数据进行融合;

34、中央组合导航滤波模块,用于将融合所得usbl观测数据与所述ins测量数据、所述dvl测量数据进行组合滤波,得到载体的导航状态估计结果。

35、优选地,还包括时间同步与坐标标定模块,用于对获取的所述ins测量数据、dvl测量数据和usbl原始声学幅度曲线进行时间同步和空间坐标标定,以使各数据在统一的时间基准和空间坐标系下对齐。

36、优选地,还包括结果输出与故障判别模块,用于输出载体的导航状态估计结果,并进行误峰告警和失效判别。

37、本发明实施例提供了一种基于ins、dvl和usbl的水下组合定位方法和系统。首先利用ins和dvl建立载体的先验运动状态,反推出各声学基线对应的理论传播时延与局部搜索窗口;然后在usbl原始相关幅度曲线中进行约束峰值搜索,生成伪usbl观测;再将伪usbl观测与usbl设备常规输出观测进行自适应融合,得到更高可信度的校正usbl测量;最后将该校正usbl测量与ins、dvl进行中央深组合滤波,输出高精度位置、速度和姿态信息。

38、与现有技术相比,本技术有益效果至少包括:

39、1、首次将ins/dvl先验运动信息用于usbl原始相关计算幅度曲线的首达峰检测,使得声学直达波搜索由“全局盲搜”变为“带几何约束的局部锁定”,显著提升usbl直达波定位稳定性,提高usbl系统在浅水混响条件下的定位性能。

40、2、本发明融合的是“反推声学观测+设备观测+ins/dvl先验”三类信息,较传统仅融合usbl最终输出位置或伪距的方式具有更高的信息利用深度;

41、3、通过引入峰值幅度、尖锐度、旁瓣比、时间一致性和创新统计量,能够对usbl观测可信度进行在线评估,并动态调整测量协方差;

42、本发明提供的定位方法在多路径、噪声干扰、局部遮挡或usbl回波失真条件下,能够有效抑制误峰引起的定位跳变,提高组合导航输出的连续性和鲁棒性;所提供的定位系统模块化程度高,可部署于auv、rov、吊放体、水下作业平台及船载水声定位系统中,工程可实现性强。本技术既可输出校正后的usbl定位信息,也可进一步作为ins/dvl中央组合导航系统的高可信外部观测输入,便于工程系统扩展。