1.一种适用于高动态飞行器的惯性/地磁/卫星组合导航系统,其特征在于,所述系统至少包括:
第一子系统滤波器,第二子系统滤波器和主滤波器;所述第一子系统滤波器用于获取惯性导航系统和磁测姿态系统的数据并进行一次滤波后将结果传递给主滤波器;所述第二子系统滤波器用于获取惯性导航系统和卫星导航系统的数据并进行二次滤波后将结果传递给主滤波器,所述主滤波器根据所述第一子系统滤波器和第二子系统滤波器的结果进行组合导航滤波计算;以及,
b
所述惯性导航系统的输入数据为三轴加速度计所测量的载体加速度f ,和角速率滤波器解算的状态变量X(k)最优滤波估计 所述角速率滤波器的输入数据为两轴陀螺实测值 和 和三轴地磁传感器的测量值b
所述磁测姿态系统的输入数据为三轴地磁传感器的测量值H。
2.根据权利要求1所述的系统,其特征在于,所述两轴陀螺包括分别安装于飞行器载体b b b
坐标系X YZ的X轴位置的单轴陀螺Gx和Z轴位置的单轴陀螺Gz;所述三轴地磁传感器的三b b b
轴敏感方向与所述三轴加速度计的计敏感方向均与飞行器载体坐标系XYZ三轴方向完全重合;所述卫星导航系统的接收机天线安装于飞行器壳体表面。
3.根据权利要求1所述的系统,其特征在于,所述所述主滤波器根据所述第一子系统滤波器和第二子系统滤波器的结果进行组合导航滤波计算,还包括以下步骤:S1:进行子滤波器的信息分配计算过程;
S2:进行子滤波器的时间更新计算过程;
S3:进行子滤波器的量测更新计算过程;
S4:进行主滤波器信息融合。
4.根据权利要求3所述的系统,其特征在于,所述S1中子滤波器的信息分配,采用计算公式为:
式中,P(k‑1)和Q(k‑1)分别表示为主滤波器的全局估计误差方差阵和系统噪声方差阵;Pi(k‑1)和Qi(k‑1)i=1,2表示子滤波器的估计误差方差阵和系统噪声方差阵,其中公式中下标i=1,2分别用于表示第一子系统滤波器和第二子系统滤波器;β1,β2为子滤波器的信息分配系数;X1(k‑1),X2(k‑1),X(k‑1)分别表示第一子系统滤波器,第二子系统滤波器和主滤波器的状态变量。
5.根据权利要求4所述的系统,其特征在于,所述第一子系统滤波器的状态变量,还包括:选取载体的三维姿态作为状态变量 以载体的姿态微分方程作为状态方程,公式为:
X1(k)=Φ1(k,k‑1)X1(k‑1)+w1(k);
其中,Φ1(k,k‑1)为状态转移矩阵,计算公式为:式中,w1(k)为系统量测噪声;T为滤波周期T(T=tk‑tk‑1);ωx,ωy,ωz为载体各轴角速率信息; γ,θ分别代表载体的偏航角、俯仰角和滚转角。
6.根据权利要求4所述的系统,其特征在于,所述第二子系统滤波器的状态变量,还包括:选取载体的姿态,速度和位置作为状态变量:以载体的姿态方程、速度和位置微分方程作为系统的状态方程,公式为:X2(k)=Φ2(k,k‑1)X2(k‑1)+w2(k);
其中,Φ2(k,k‑1)为状态转矩阵;计算公式为:式中,Φ2(k,k‑1)为雅可比矩阵, vx,vy,vz,x,y,z表示为方程组f2[X2(t),t]对各状态变量 的一阶偏导数; 为状态一步预测;
b n
所述f2[X2(t),t]计算公式为:w2(t)为系统噪声;f 为加速度计测量比力输出;g 为重力矢量; 为姿态变换阵;vx,vy,vz导航系下的载体速度;x,y,z导航系下的位置。
7.根据权利要求3所述的系统,其特征在于,所述S2中的子滤波器的时间更新,采用计算公式为:
式中, 为状态一步预测; 为k‑1时刻状态估计值;Pi(k,k‑1)为一步预测均方误差;Φi(k,k‑1)为状态转移矩阵;Qi(k)噪声方差阵。
8.根据权利要求3所述的系统,其特征在于,所述S3中的子滤波器的量测更新,采用计算公式为:
式中,Ki(k)表示滤波增益;Ri(k)为量测噪声阵;I为单位矩阵;Pi(k)为估计均方误差;Hi(k)为系统的观测矩阵; 为子滤波器状态估计;Zi(k)为系统的观测量。
9.根据权利要求8所述的系统,其特征在于,所述Zi(k)为系统的观测量,还包括:所述第一子系统滤波器的观测量为:选取所述三轴地磁传感器的测量输出作为观测变量 其观测方程为:
Z1(k)=H1(k)X1(k)+v1(k);
式中,v1(k)是量测噪声;观测阵 为雅可比矩阵;
其中:
分别表示为方程式h11,h12,h13对状态变量;
的一阶偏导数; 为状态一步预测;v1(k)为量测噪声;
所述第二子系统滤波器的观测量为:选取卫星导航系统速度和位置作为观测量Z2(t)=T
[vx,vy,vz,x,y,z],观测方程为:Z2(k)=H2(k)X2(k)+v2(k);
式中,观测阵H2(k)=I是单位矩阵;v2(k)是量测噪声。
10.根据权利要求3所述的系统,其特征在于,所述S4中的主滤波器信息融合,采用计算公式为:
式中,Pg为主滤波器的估计误差方差阵; 为主滤波的状态估计结果。