一种海面小型目标升沉运动测量方法
阅读说明：本技术 一种海面小型目标升沉运动测量方法 (Method for measuring heave motion of small sea-surface target ) 是由 徐晓苏 张海旭 于 2021-01-30 设计创作，主要内容包括：本发明公开了一种海面小型目标升沉运动测量方法,其主要目的在于解决对海面小型目标回收之前,获取目标升沉运动轨迹以估计海况信息的问题。本发明的主要步骤包括：SINS和GNSS组合结果的求解、升沉运动轨迹的提取、波高以及有效波高的计算、波面时间历程的模拟、SINS和波面时间历程的组合计算。本发明在GNSS有效时,从SINS和GNSS的组合结果中提取升沉运动轨迹,当GNSS失效时,从前一个时间段的升沉运动轨迹中提取有效波高数据,结合波浪频谱模拟出下一个时间段内的波面时间历程,将SINS和模拟值组合计算,并提取目标升沉运动轨迹。本发明利用波浪谱模拟波面时程的方法,解决了SINS在GNSS长时间缺失的情况下导致的天向发散问题,在估计海况信息方面具有重要参考价值。(The invention discloses a method for measuring the heave motion of a small sea surface target, which mainly aims to solve the problem of acquiring a target heave motion track to estimate sea condition information before recovering the small sea surface target. The method mainly comprises the following steps: solving a combined result of the SINS and the GNSS, extracting a heave motion track, calculating wave height and effective wave height, simulating wave surface time course, and performing combined calculation of the SINS and the wave surface time course. When the GNSS is effective, the heave motion track is extracted from the combined result of the SINS and the GNSS, when the GNSS is invalid, effective wave height data is extracted from the heave motion track in the previous time period, the wave surface time history in the next time period is simulated by combining a wave frequency spectrum, the SINS and the simulation value are combined and calculated, and the target heave motion track is extracted. The method for simulating the wave surface time course by using the wave spectrum solves the problem of day-wise divergence caused by SINS under the condition of long-time loss of GNSS, and has important reference value in the aspect of estimating sea state information.)
技术领域
本发明属于海上小型目标状态测量技术领域，具体涉及一种利用SINS/GNSS组合运算且兼顾GNSS信号缺失的情况下，海面小型目标升沉运动测量方法。
背景技术
随着土地资源的逐渐枯竭，人类对海洋的开发步伐也在加快，越来越多的探测设备被投入海洋。作为探索海洋任务的最后也是最重要的一部分，设备的回收利用可能决定整个项目的成败。海洋勘探设备浮出水面后的回收工作，受海洋状态的影响很大。从工程实践的经验来看，由于船舶在恶劣海况下的晃动会严重威胁起重机的运行安全，所以对设备的回收工作经常是在良好的海况下进行。错过了最好的回收时间可能会导致设备因耗尽电能而失去联系，消失在茫茫的海洋中。波浪大小是影响回收工作的重要因素，从目标的升沉运动中提取的波高数据，可以用于估计其所处环境的海况信息，为回收工作的合理安排提供重要参考。
作为经典的组合的方式，SINS/GNSS组合导航技术不仅能够提供很高的定位精度，SINS的高频采样还可以保证非常高的实时性，GNSS在限制SINS发散方面效果显著。在工程实践中，一些小型设备在浮出水面后，因舱体内的GNSS天线距离水平面较近，卫星信号容易受到波浪的影响，在海况稍微差的中浪级情况下，偶有GNSS信号中断数分钟的情况发生。恶劣海况下GNSS信号的频繁缺失，将导致SINS/GNSS组合的测量结果不再可靠。在天向运动轨迹解算方面，模拟波面历程有助于解决天向发散问题。波浪是一种具有平稳性和各态历经性的随机现象，能够利用少数几个测点的波浪记录表征海浪的总体特征。在工程实践中，一般先要获得波浪的有效波高、周期等参数后，通过模拟靶谱法来获得一列不规则波面的时间历程。可用于靶谱模拟的波浪频谱有Neumann谱、Bretschneider谱、Mitsuyasu谱、ISSC谱、P-M谱、Jonswap谱和文氏谱等。其中单参数谱P-M谱，只有一个输入参数，即有效波高，十分适合应用于与SINS的组合运算。模拟波面时间历程用于填补GNSS缺失后的组合运算，于天向升沉运动测量方面具有重要研究意义。
发明内容
为解决上述问题，本发明公开了一种海面小型目标升沉运动测量方法，适用于对远处的海面目标回收前，通过测量目标的升沉运动轨迹，判断其所处环境的海况信息，为工作人员回收工作的合理安排提供参考。
为达到上述目的，本发明的技术方案如下：
一种海面小型目标升沉运动测量方法，包括以下步骤：
步骤1：判断GNSS是否有效，若有效则跳转至步骤2，否则跳转至步骤4；
步骤2：获取SINS和GNSS参量，并进行组合运算，计算出在东北天坐标系下的天向运动轨迹；
步骤3：根据步骤2计算出的天向运动轨迹，计算海面目标的升沉运动轨迹，跳转至步骤1；
步骤4：截取临近时间段内的升沉运动轨迹，计算波高序列，计算有效波高；
步骤5：根据有效波高和波浪频谱，模拟出下一个时间段内的波面时间历程；
步骤6：将SINS的参量和模拟的波面时程组合运算，计算出在东北天坐标系下的天向运动轨迹；
步骤7：根据步骤6计算出的天向运动轨迹，计算海面目标的升沉运动轨迹，跳转至步骤1。
进一步的，所述步骤3具体为：
从SINS/GNSS的组合结果中，选取天向运动轨迹数据，记为Hi(t)，i＝1,2,3,...,N。将该数据等分成若干个数据片段，取其中一个数据片段记为hi(t)，i＝1,2,3,...,n，n<N。以位移h为纵轴，时间t为横轴，建立直角坐标系，利用最小二乘法对该坐标系中数据片段的离散点进行拟合，得直线h＝at+b，该直线可视为本数据片段的虚拟水平线，计算所有离散点到该直线的距离，记为di(t)，i＝1,2,3,...,n，其中，若离散点位于直线上方，取距离为正值，视为高于水平线的波程；若离散点位于直线下方，取距离为负值，视为低于水平线的波程。对di(t)求平均值，记为da。在理想条件下，波面历程可视为无限多个正弦波组成的合成波的运动轨迹，其均值da应为零，但是在工程实践中，因误差的存在，da的值并不为零，为了消除该均值误差，令Di(t)＝di(t)-da，于是从该数据片段中得到了海面目标的以水平面为参考的升沉运动轨迹，即Di(t)。其它数据片段的处理方法以此类推。所有数据片段的升沉运动轨迹组成了海面目标的天向运动历程。
进一步的，所述步骤4具体为：
选取GNSS失效前的一段时间内的升沉运动数据，该段数据包含若干波程信息(D1、D2、D3...)，且持续时间较短(分钟量级)，记为
D(t)＝{D1 D2 D3 ... Dm}
令
Di(t)＝{U1(t) U2(t) ... Un(t)}
其中，n<m，且有
U1(t)＝{D1 D2 ... Dj},
U2(t)＝{Dj+1 Dj+2 ..., Dj+k},
...
Un(t)＝{Dl Dl+1 ... Dm}
其中，每个U(t)中的元素都同号，相邻两个U(t)中的元素异号。如果U1(t)中的元素是负号，在舍弃该组元素后，根据上跨零点法，各区间的波高可表示为
Wi＝max(U2i(t))-min(U2i+1(t))，i＝1,2,3,...,q，且q<n/2
如果U1(t)中的元素是正号，在舍弃该组元素后，根据下跨零点法，波高可表示为
Wi＝max(U2i+1(t))-min(U2i(t))，i＝1,2,3,...,q，且q<n/2
将波高数组中的所有元素按照数值大小降序排列，取前面三分之一大波的平均波高作为有效波高。
进一步的，所述步骤5具体为：
以有效波高值代入P-M频谱中得到的波浪谱为靶谱，模拟不规则波面的时间历程，其中，P-M谱为
其中ω为圆频率，Hs为有效波高，把频率分成M份，则波面时程可表示为
其中，m0是频谱的零阶矩，是随机初相位，另有
其中，ωi是边界频率。至此可以根据需求模拟任意时长和采样频率的波面时程，记为
η(t)＝{η1 η2 η3 ... ηn}
即可用于和SINS的天向位置组合计算。
本发明的有益效果是：
本发明所述的海面小型目标升沉运动测量方法，采用P-M波浪频谱模拟波面历程，可以应对GNSS缺失导致的天向发散问题，保证系统在恶劣海况导致的GNSS断断续续的情况下，能够持续稳定地输出升沉运动轨迹以用于估计海况信息。相比常规的使用快速傅里叶变换的频域分析方法，具有更高的实时性，无需在固定时间间隔截取数据用于计算，也避免了频域分析导致的失真问题。
附图说明
图1为本发明的计算原理图；
图2为从组合结果中提取波面历程示意图；
图3为上跨零点法计算波高示意图；
图4采用模拟波面组合和不采用其参与组合的结果对比图；
图5为该方法的计算结果的波高统计图。
具体实施方式
下面结合附图和具体实施方式，进一步阐明本发明，应理解下述具体实施方式仅用于说明本发明而不用于限制本发明的范围。
海洋探测设备浮出水面后，其升沉运动可以在一定程度上反应其所在环境的海况信息。如图1所示，本发明所述的一种海面小型目标升沉运动测量方法，实现方法具体步骤如下：
1)建立组合导航系统模型
以GNSS信号有效情况为例，建立基于卡尔曼滤波的组合导航系统模型为：
其中，
其中，φz、φy、φz为惯导失准角，为速度误差，δλ、δL、δh为位置误差，εx、εy、εz为陀螺随机常值漂移，为加速度计随机常值偏值。
测量向量Z为SINS和GNSS在天向的量测值之差，即
Z＝[hSINS-hGNSS]
矩阵W是陀螺仪和加速度计的测量噪声，矩阵V是GNSS在天向高度的测量噪声。
2)从SINS/GNSS组合中提取数据
在GNSS信号有效的情况下，则采用SINS和GNSS组合的结果作为升沉运动轨迹的数据来源。记所选天向运动轨迹数据为Hi(t)，i＝1,2,3,...,N。将该数据等分成若干个数据片段，取其中一个数据片段记为hi(t)，i＝1,2,3,...,n，n<N。以位移h为纵轴，时间t为横轴，建立直角坐标系，如图2所示。图中t1和t2是目标的天向运动轨迹中对应的时刻，vt1和vt2是其相对于虚拟水平线的时刻。利用最小二乘法对该坐标系中数据片段的离散点进行拟合，即求解下面目标函数的最优值：
J(θ)＝(B-Tθ)T(B-Tθ)
其中，
B＝[h1 h2 ... hn]T
n是数据片段中测量值的个数。
所得直线h＝at+b，即为虚拟水平线。计算所有离散点到该直线的距离，记为di(t)，i＝1,2,3,...,n，其中，若离散点位于直线上方，其距离为正值，若离散点位于直线下方，其距离为负值。对di(t)求平均值，记为da，令Di(t)＝di(t)-da，于是从该数据片段中得到了海面目标的以水平面为参考的升沉运动轨迹，即Di(t)。其它数据片段的处理方法以此类推。所有数据片段的升沉运动轨迹组成了海面目标的天向运动历程。
3)从SINS和模拟波面历程的组合中提取数据
当GNSS失效时，需要对波面时间历程模拟，以供SINS在天向位移组合之用。分为以下几个步骤：
步骤1：计算有效波高
选取GNSS失效前的一段时间内的升沉运动数据，该段数据包含足够多的波高信息，且持续时间较短(分钟量级)。记为
D(t)＝{D1 D2 D3 ... Dm}
令
D(t)＝{U1(t) U2(t) ... Un(t)}
其中，n<m，且有
U1(t)＝{D1 D2 ... Dj},
U2(t)＝{Dj+1 Dj+2 ..., Dj+k},
...
Un(t)＝{Dl Dl+1 ... Dm}
其中，每个U(t)中的元素都同号，相邻两个U(t)中的元素异号。如果U1(t)中的元素是负号，在舍弃该组元素后，根据图3所示上跨零点法，各区间的波高可表示为
Wi＝max(U2i(t))-min(U2i+1(t))，i＝1,2,3,...,q，且q<n/2
如果U1(t)中的元素是正号，在舍弃该组元素后，根据下跨零点法，波高可表示为
Wi＝max(U2i+1(t))-min(U2i(t))，i＝1,2,3,...,q，且q<n/2
将波高数组中的所有元素按照数值大小降序排列，取前面三分之一大波的平均波高作为有效波高。
步骤2：模拟波面历程
以有效波高值代入P-M频谱中得到的波浪谱为靶谱，模拟不规则波面的时间历程，其中，P-M谱为
其中ω为圆频率，Hs为有效波高，把频率分成M份，则波面时程可表示为
其中，m0是频谱的零阶矩，是随机初相位，另有
其中，ωi是边界频率。至此可以根据需求模拟任意时长和采样频率的波面时程，记为
η(t)＝{η1 η2 η3 ... ηn}
即可用于和SINS的天向位置组合计算。
步骤3：SINS和模拟值组合运算
使用模拟的波面历程数据和SINS的组合模型中，量测方程为
Zs＝HX+Vs
其中，Vs表示模拟波面历程数据的误差，量测向量为
Zs＝[hSINS-η(t)]
采用模拟波高程与SINS组合的方式，填补了恶劣海况下GNSS中断时的不足。而且可提供高动态性的实时输出。
步骤4：提取升沉运动信息
对组合结果的升沉运动信息提取方法与图2所示方法相同。
在GNSS有效的时候使用GNSS和SINS组合，在其组合结果的天向位移中提取目标的升沉轨迹。在GNSS无效的时候，使用模拟的波面历程和SINS组合，在其组合结果中提取目标的升沉轨迹。如此往复，可以持续输出目标在所处环境中的升沉信息，为回收设备的工作人员提供实时海况信息参考。
实施例1
本实施例设置GNSS中断时间为小于30分钟的随机值，连通时间为小于5秒的随机值，断断续续持续10小时，采用上述方法对目标的升沉轨迹进行计算。截取某一GNSS中断时间的组合片段，结果如图4所示。每五分钟计算一次该时间段的平均波高和有效波高，如图5所示，仿真结果验证了该发明的有效性。
本发明方案所公开的技术手段不仅限于上述实施方式所公开的技术手段，还包括由以上技术特征任意组合所组成的技术方案。
- 上一篇：一种医用注射器针头装配设备
- 下一篇：一种基于码伪距的秒级实时高精度定位方法与系统