一种无人船水下测量高精度导航定位方法及系统与流程

摘要: 本申请涉及无人船导航定位,具体而言,涉及一种无人船水下测量高精度导航定位方法及系统。背景技术:1、无人船在执行水下测量任务时,对导航定位的精度和可靠性要求极高。...
一种无人船水下测量高精度导航定位方法及系统与流程

本申请涉及无人船导航定位,具体而言,涉及一种无人船水下测量高精度导航定位方法及系统。

背景技术:

1、无人船在执行水下测量任务时,对导航定位的精度和可靠性要求极高。然而,在实际作业中,无人船的导航系统常常面临诸多挑战,其中一个突出问题是惯性测量单元(imu)的微小安装偏差。这种偏差可能在无人船经过维护后重新安装惯性测量单元时产生,例如安装面上存在微小异物或固定螺丝受力不均,导致惯性测量单元的实际物理位置和姿态与系统预设的理想位置和姿态之间产生一个微小但固定的角度偏差。这种偏差通常非常细微,其影响可能被传感器本身的随机波动所掩盖,或落在常规检查程序的误差范围内,导致在维护后的初步检查中难以被发现。

2、现有的导航系统内部误差修正程序,主要用于实时估算并修正惯性测量单元自身的随机漂移和固定零点偏差。然而,这些程序往往难以有效处理由物理安装偏差引起的系统性角度误差。这是因为安装偏差导致的误差模式与传感器自身的随机漂移或零点偏差有着本质不同。安装偏差会导致惯性测量单元在船体运动时,其测量到的角速度和加速度与船体真实运动的几何关系发生固定的偏离。例如,当船体只是左右摇晃时,一个微小的安装俯仰角偏差会导致惯性测量单元在前后摇晃的轴上测量到不为零的角速度分量,或在垂直方向上测量到额外的加速度分量。这种系统性的、与运动相关的误差,不是简单的随机波动或固定偏差,因此,传统的零点偏差估算或噪声过滤方法会错误地将其一部分归结为传感器波动或未能完全修正的零点偏差,但实际上无法从根本上消除其影响,导致修正效果不理想。

技术实现思路

1、本申请公开了一种无人船水下测量高精度导航定位方法及系统,旨在解决无人船在水下测量任务中,惯性测量单元微小安装偏差导致导航定位精度下降,尤其是在复杂水域环境和频繁机动航行时误差被放大,以及全球导航卫星系统信号质量下降时惯性推算误差累积过快,最终导致测量成果无效的技术问题。

2、本申请的技术方案如下:

3、第一方面,本申请公开了一种无人船水下测量高精度导航定位方法,包括以下步骤:

4、获取无人船的惯性测量单元的测量数据、无人船的运动响应信息和无人船的定位参考信息;

5、根据惯性测量单元的测量数据与无人船所处水域环境中的局部扰动信息,识别无人船的运动状态,并提取反映惯性测量单元的测量值与无人船运动状态之间系统性偏离的安装偏差运动特征;该安装偏差运动特征用于表征惯性测量单元相对于无人船的固定安装偏差;

6、对安装偏差运动特征与无人船的运动响应信息进行多源特征对齐与非线性时间对齐处理,得到与无人船运动状态在时间尺度上一致的对齐安装偏差运动特征;

7、基于对齐安装偏差运动特征,启动扰动模式自适应的状态估算过程;该扰动模式自适应的状态估算过程利用无人船的运动模型,结合惯性测量单元的测量数据进行状态预测,并根据局部扰动信息的扰动模式自适应调整状态估算参数;该状态预测包括无人船的运动状态和惯性测量单元的安装偏差参数;

8、当定位参考信息可用时,利用定位参考信息对状态预测进行校正,并通过迭代处理更新安装偏差参数的估算值;

9、根据估算出的安装偏差参数,生成修正变换关系;该修正变换关系用于将惯性测量单元的测量值从惯性测量单元的实际安装坐标系映射到无人船的标准坐标系;

10、在惯性测量单元的原始测量数据进入导航计算流程之前,利用修正变换关系对原始测量数据进行修正,并将修正后的惯性测量单元数据用于无人船的导航定位计算,得到无人船的导航定位结果;

11、其中,安装偏差运动特征的提取、对齐安装偏差运动特征的生成与修正变换关系的生成相互耦合,形成反馈式处理链;该反馈式处理链在无人船航行过程中持续运行,以使修正变换关系随无人船所处水域环境的变化自适应更新。

12、第二方面,本申请还公开了一种无人船水下测量高精度导航定位系统,该系统包括:

13、数据获取模块,用于获取无人船的惯性测量单元的测量数据、无人船的运动响应信息和无人船的定位参考信息;

14、运动状态识别与安装偏差运动特征提取模块,用于根据惯性测量单元的测量数据与无人船所处水域环境中的局部扰动信息,识别无人船的运动状态,并提取反映惯性测量单元的测量值与无人船运动状态之间系统性偏离的安装偏差运动特征;该安装偏差运动特征用于表征惯性测量单元相对于无人船的固定安装偏差;

15、特征对齐模块,用于对安装偏差运动特征与无人船的运动响应信息进行多源特征对齐与非线性时间对齐处理,得到与无人船运动状态在时间尺度上一致的对齐安装偏差运动特征;

16、自适应状态估算模块,用于基于对齐安装偏差运动特征,启动扰动模式自适应的状态估算过程;该扰动模式自适应的状态估算过程利用无人船的运动模型,结合惯性测量单元的测量数据进行状态预测,并根据局部扰动信息的扰动模式自适应调整状态估算参数;该状态预测包括无人船的运动状态和惯性测量单元的安装偏差参数;

17、校正更新模块,用于当定位参考信息可用时,利用定位参考信息对状态预测进行校正,并通过迭代处理更新安装偏差参数的估算值;

18、修正变换关系生成模块,用于根据估算出的安装偏差参数,生成修正变换关系;该修正变换关系用于将惯性测量单元的测量值从惯性测量单元的实际安装坐标系映射到无人船的标准坐标系;

19、数据修正与导航定位计算模块,用于在惯性测量单元的原始测量数据进入导航计算流程之前,利用修正变换关系对原始测量数据进行修正,并将修正后的惯性测量单元数据用于无人船的导航定位计算,得到无人船的导航定位结果。

20、本申请公开一种无人船水下测量高精度导航定位方法及系统,通过引入安装偏差运动特征的提取、多源特征对齐、扰动模式自适应状态估算以及反馈式修正变换关系生成等创新机制,有效解决了惯性测量单元安装偏差在复杂水域和机动航行条件下的导航定位精度问题,显著提升了无人船水下测量的可靠性和准确性。

1.一种无人船水下测量高精度导航定位方法,其特征在于,包括:

2.根据权利要求 1 所述的方法,其特征在于,所述利用所述定位参考信息对所述状态预测进行校正的步骤,包括:

3.根据权利要求 1 所述的方法,其特征在于,所述提取反映所述惯性测量单元的测量值与所述无人船运动状态之间系统性偏离的安装偏差运动特征的步骤,包括:

4.根据权利要求 2 所述的方法,其特征在于,所述调整所述定位参考信息在所述状态估算过程中的校正权重的步骤,包括:

5.根据权利要求 3 所述的方法,其特征在于,所述调整特征提取参数的步骤,包括:

6.根据权利要求 5 所述的方法,其特征在于,所述调整用于特征计算的数据时间窗口长度的步骤,包括:

7.根据权利要求 6 所述的方法,其特征在于,所述对所述运动响应动态范围信息和所述局部扰动信息的强度信息进行平滑处理的步骤,包括:

8.根据权利要求 6 所述的方法,其特征在于,所述计算建议的数据时间窗口长度的步骤,包括:

9.根据权利要求 8 所述的方法,其特征在于,所述对所述平滑处理后的运动响应动态范围信息进行时间尺度归一化处理的步骤,包括:

10.一种无人船水下测量高精度导航定位系统,其特征在于,所述系统包括: