【技术实现步骤摘要】
一种抗卫星信号干扰的实时高精度升沉测量方法及系统
[0001]本专利技术属于升沉测量
,具体涉及一种抗卫星信号干扰的实时高精度升沉测量方法及系统。
技术介绍
[0002]水面舰船、水下航行器等水中运载体在航行过程中,受到波浪、风力因素的影响,会出现周期性的往复运动,称为升沉运动。惯性导航系统能够测量载体的位移,但由于惯性传感器存在漂移,无法长期给出准确的测量结果。惯性/卫星组合升沉测量方法能够对惯性期间的误差进行估计和修正,提高惯导系统的长期精度,但由于卫星单点定位系统自身高度测量精度不高,仅能达到米级,且水面对电磁波的反射作用,或者桥梁对信号遮挡,卫星信号容易受到干扰而出现短期失效,惯性/卫星组合升沉测量方法的精度不高。
[0003]考虑到升沉运动属于简谐受迫运动,因此可以通过高通滤波的方式,将升沉运动与惯性漂移误差进行分离,但滤波方法会产生相位差,IIR滤波器的非线性相位难以补偿,FIR滤波器虽然是线性相位,但符合性能要求的FIR滤波器阶数可能达到上千级,对计算力需求较大。后处理方法无相位差,适用于水下建图等测量领域,但对于舰船减摇、舰载机起降等实时性要求较高的领域难以应对。
技术实现思路
[0004]针对以上问题,本专利技术设计了一种抗卫星信号干扰的实时高精度升沉测量方法及系统,考虑舰船、水下航行器等水中运载体升沉运动特性,利用多级正余弦函数对舰船等周期运动进行拟合,利用最小均方误差算法对误差进行迭代收敛,获取升沉运动主要频率,之后在主要频率附近再次滤波,进一步提高频率拟合准确性。 ...
【技术保护点】
【技术特征摘要】
1.一种抗卫星信号干扰的实时高精度升沉测量方法,其特征在于,包括如下步骤将惯导系统测量的载体坐标系加速度值进行坐标转换,获得导航坐标系的加速度值;计算惯导系统的实际垂向位移;利用多级正余弦函数对实际垂向位移进行第一次拟合;利用最小均方误差算法对实际垂向位移与第一拟合升沉之间的偏差进行迭代收敛,获得升沉运动拟合中心频率;以拟合中心频率为频率中心,选取通频带,在通频带内利用多级正余弦函数进行第二次拟合;利用最小均方误差算法对第一拟合升沉与第二拟合升沉之间的偏差进行迭代收敛,获得自适应权重系数,输出第二拟合升沉结果。2.根据权利要求1所述的实时高精度升沉测量方法,其特征在于,还包括实时监测卫星数据有效性,当卫星数据失效时,拟合相关系数采用上一时刻的输出值的步骤。3.根据权利要求1或2所述的实时高精度升沉测量方法,其特征在于,载体坐标系到导航坐标系之间的方向余弦阵为其中,为由b系转换到n系的方向余弦阵,k表示当前时刻,i系为惯性坐标系,为k
‑
1到k时刻导航坐标系变化对应的方向余弦阵,为k
‑
1时刻惯性坐标系到导航坐标系的方向余弦阵,为k
‑
1时刻载体坐标系到惯性坐标系的方向余弦阵,为k
‑
1时刻到k时刻载体坐标系变化对应的方向余弦阵的转置矩阵。4.根据权利要求3所述的实时高精度升沉测量方法,其特征在于,所述方向余弦阵中,的计算公式为其中,为k时刻惯导系统陀螺测量值,I为单位矩阵;的计算公式为其中,表示k时刻导航坐标系相对于惯性坐标系的角度变化;任意时刻导航坐标系相对于惯性坐标系的角度变化为为为地球自传角速率,为载体运动产生的导航坐标系旋转,其中,v
n
=[v
E v
N v
U
]
T
表示载体分别沿东、北、天的速度矢量,R、h、分别为地球半径、海拔高度和当前纬度。
5.根据权利要求3所述的实时高精度升沉测量方法,其特征在于,所述实际垂向位移计算方法为计算导航坐标系下加速度为计算速度为v
n
(k)=v
n
(k
‑
1)+Δv
...
【专利技术属性】
技术研发人员:周祖洋,庄广琛,郭玉胜,宋雅兰,邓继权,
申请(专利权)人:北京自动化控制设备研究所,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。