基于变积分长度的动基座初始对准方法、系统、设备及介质技术方案

本发明专利技术公开了一种基于变积分长度的动基座初始对准方法、系统、设备及介质，该方法包括步骤：获取惯性传感器数据及卫星导航接收机数据；构造变积分长度矢量观测器模型，并对观测器模型离散化得到离散化参考矢量和离散化观测矢量；基于离散化参考矢量和离散化观测矢量构造OBA姿态矩阵，进行姿态估计；基于姿态估计值进行校准，重复上述步骤，直至达到设定的校准时长。本发明专利技术在对矢量观测器进行计算的同时，采用变积分长度方法减小过往矢量对对准结果的影响，实现对准过程的优化，解决了动基座对准过程中误差随载体机动变化的问题。对准过程中误差随载体机动变化的问题。对准过程中误差随载体机动变化的问题。

【技术实现步骤摘要】
基于变积分长度的动基座初始对准方法、系统、设备及介质


[0001]本专利技术涉惯性导航系统初始对准领域，属于一种基于变积分长度的动基座初始对准方法、系统、设备及介质。

技术介绍

[0002]在动基座对准领域，采用卫星导航系统辅助惯性导航系统进行动基座对准是较为常用的方法。通过方向余弦矩阵链式法则，可以将对准问题转化成矢量观测器姿态估计问题。矢量观测器的构造采用传感器输出进行迭代计算，但由于对准误差与传感器零偏在导航系的映射有关，因此当载体机动运动时，其对准误差会随着机动变化呈现波动特性。
[0003]为克服传统方法对准误差受载体机动运动变化的问题，提出一种新的动基座初始对准方法具有重要意义。

技术实现思路

[0004]本专利技术的目的在于提供一种基于变积分长度的动基座初始对准方法、系统、设备及介质，弱化了载体机动运动对对准误差的影响，实现了动态对准过程的优化，提高了对准精度。
[0005]实现本专利技术目的的技术方案为：
[0006]一种基于变积分长度的动基座对准方法，包括以下几个步骤：
[0007]步骤1：获取惯性传感器数据及卫星导航接收机数据；
[0008]步骤2：构造变积分长度矢量观测器模型；
[0009]步骤3：设计OBA姿态估计算法，实现实时姿态估计；
[0010]步骤4：若当前对准时间k＝M，则输出对准结果，完成对准过程，M为设定的对准过程持续时间，若k&lt;M，表示对准过程未完成，则重复上述步骤一至步骤四，直至对准结束。<br/>[0011]一种初速度扰动消除极区动基座对准系统，包括数据获取单元、观测器模型构建单元、离散化单元、姿态估计单元和校准单元；其中：
[0012]数据获取单元用于获取惯性传感器数据及卫星导航接收机数据；
[0013]观测器模型构建单元用于构造变积分长度矢量观测器模型；
[0014]离散化单元用于对观测器模型离散化得到离散化参考矢量和离散化观测矢量；
[0015]姿态估计单元通过OBA姿态矩阵进行姿态估计；
[0016]校准单元通过姿态估计值进行校准。
[0017]一种初速度扰动消除极区动基座对准设备，包括：存储器、处理器和存储在所述存储器上的计算机程序，所述处理器执行所述计算机程序时实现所述的初速度扰动消除极区动基座对准方法。
[0018]一种计算机存储介质，所述计算机存储介质存储有可执行程序，所述可执行程序被处理器执行实现所述的初速度扰动消除极区动基座对准方法的步骤。
[0019]本专利技术的优点在于：
[0020](1)本专利技术采用卫星导航信息进行矢量观测器构造，具有对准精度高的优点；
[0021](2)本专利技术采用变积分长度方法进行矢量优化，减小了由于载体机动运动造成的对准误差波动，提高了对准精度。
附图说明
[0022]图1为本专利技术对准过程流程图。
[0023]图2为变积分长度图。
[0024]图3为纵摇角误差图。
[0025]图4为横摇角误差图。
[0026]图5为航向角误差图。
具体实施方式
[0027]下面结合附图和实施举例对本专利技术作进一步的详细说明：
[0028]本专利技术提出一种基于变积分长度的动基座初始对准方法，在对矢量观测器进行计算的同时，采用变积分长度方法减小过往矢量对对准结果的影响，实现对准过程的优化；如图1所示，具体包括以下几个步骤：
[0029]步骤1：获取惯性传感器数据及卫星导航接收机数据；
[0030]在进行动基座对准时，需要采集传感器数据。考虑到惯性传感器与卫星接收机数据输出不一致问题，先采集惯性传感器数据：
[0031][0032]式中，f
b
表示真实比力；b
a
表示加速度计零偏；η
a
表示加速度计随机噪声；表示加速度计测量比力；表示真实角速度；b
g
表示陀螺仪零偏；η
g
表示陀螺仪随机噪声；表示陀螺仪测量角速度；其中，陀螺仪量测常值漂移误差为b
g
＝[0.02 0.02 0.02]T
°
/h，陀螺仪量测随机游走误差为输出频率为200Hz；加速度计量测常值漂移误差为b
a
＝[500 500 500]T
μg，加速度计量测随机游走误差为输出频率为200Hz；卫星导航系统采样周期为1s。
[0033]在卫星数据未获取到时，利用惯性传感器数据进行加速度增量和角速度增量计算：
[0034][0035]8Δθ1×
Δv2+2Δv1×
Δθ
i
+2Δθ2xΔv2)
[0036][0037]式中，表示位置增量；表示速度增量；Δv1表示比力子样1；Δv2表示比力子样2；Δθ1表示旋转子样1；Δθ2表示旋转子样2；Δv1、Δv2、Δθ1、Δθ2分别为2个惯性
传感器数据的积分，其积分公式为本领域公知，在此不再累述
[0038]当卫星数据有效时，可以获取卫星定位信息：
[0039][0040]式中，表示卫星输出位置信息；p
n
表示真实位置信息；δp
n
表示位置误差；表示卫星输出速度信息；v
n
表示真实速度信息；δv
n
表示速度误差；
[0041]步骤2：构造变积分长度矢量观测器模型；
[0042]在获取到惯性传感器及卫星导航数据之后，结合图2所示的变积分长度对准示意图，再进行可以构造如下矢量观测器：
[0043][0044]式中，f
b
表示加速度计测量比力；表示σ时刻载体系相对初始载体系的方向余弦矩阵；表示参考矢量；表示距离微分；表示观测矢量，表示τ时刻导航系相对于初始导航系的方向余弦矩阵；表示地球自转角速度在导航系的映射；v
n
表示导航系速度；S表示窗口内矢量个数；Δt
G
表示卫星导航接收机数据采样周期；v
n
(t
m
)表示t
m
时刻导航系速度；g
n
表示地球重力；t
m
表示积分过程起始时间；t
M
表示积分过程终止时间；
[0045]对上式进行离散化，可得参考矢量如下式：
[0046][0047]式中，表示离散化参考矢量；表示速度增量；表示位置增量；Δt
G
表示卫星导航接收机数据采样周期；表示t
s
时刻载体系相对初始载体系的方向余弦矩阵；表示t
k
时刻载体系相对初始载体系的方向余弦矩阵；
[0048]同理，离散化观测矢量可以表示为：
[0049][0050]式中，表示离散化观测矢量；r
n
(t
M
)表示t
M
时刻运动距离；r
n...

【技术保护点】

【技术特征摘要】
1.一种变积分长度的动基座初始对准方法，其特征在于，包括以下几个步骤：获取惯性传感器数据及卫星导航接收机数据；构造变积分长度矢量观测器模型，并对观测器模型离散化得到离散化参考矢量和离散化观测矢量；基于离散化参考矢量和离散化观测矢量构造OBA姿态矩阵，进行姿态估计；基于姿态估计值进行校准，重复上述步骤，直至达到设定的校准时长。2.根据权利要求1所述的变积分长度的动基座初始对准方法，其特征在于，所述变积分长度矢量观测器模型为：式中，f
b
表示加速度计测量比力；表示σ时刻载体系相对初始载体系的方向余弦矩阵；表示参考矢量；表示距离微分；表示观测矢量，表示τ时刻导航系相对于初始导航系的方向余弦矩阵；表示地球自转角速度在导航系的映射；v
n
表示导航系速度；S表示窗口内矢量个数；Δt
G
表示卫星导航接收机数据采样周期；v
n
(t
m
)表示t
m
时刻导航系速度；g
n
表示地球重力；t
m
表示积分过程起始时间；t
M
表示积分过程终止时间。3.根据权利要求1所述的变积分长度的动基座初始对准方法，其特征在于，所述离散化参考矢量为：式中，表示离散化参考矢量；表示速度增量；表示位置增量；Δt
G
表示卫星导航接收机数据采样周期；表示t
s
时刻载体系相对初始载体系的方向余弦矩阵；表示t
k
时刻载体系相对初始载体系的方向余弦矩阵。4.根据权利要求3所述的变积分长度的动基座初始对准方法，其特征在于，所述速度增量和位置增量通过惯性传感器数据计算确定，具体为：通过惯性传感器数据计算确定，具体为：式中，Δv1、Δν2分别表示2个惯性传感器对应的比力子样；Δθ1、Δθ2分别表示2个惯性传感器对应的旋转子样。5.根据权利要求1所述的变积分长度的动基座初始对准方法，其特征在于，所述离散化
观测矢量为：式中，表示离散化观测矢量；r
n
(t
M
)表示t
M
时刻运动距离；r
n
(t
m
)表示t
m
时刻运动距离；表示t
M
时刻...

【专利技术属性】
技术研发人员：徐祥，程玉，陈帅，
申请(专利权)人：南京理工大学，
类型：发明
国别省市：