[发明专利]微惯导与DGPS和电子罗盘组合导航姿态测量方法

权利要求书

1.一种微惯导与DGPS和电子罗盘组合导航姿态测量方法，其特征是：

步骤1、利用微惯导、电子罗盘对组合系统进行初始对准，得到载体坐标系b到导航坐标系n的初始姿态矩阵

Cbn(0)=C11C12C13C21C22C23C31C32C33]]>

其中，Ci_j是姿态矩阵的元素，i,j=1,2,3；

步骤2、根据步骤1中的初始姿态矩阵计算出载体的初始姿态值

步骤3、利用微惯导系统的位置误差方程、速度误差方程、平台失准角方程及惯性传感器误差方程构成扩展卡尔曼滤波器的状态方程，其状态变量为15维：

其中，δL、δλ、δh分别为SINS解算得到的经度、纬度、高度误差，δv_E、δv_N、δv_U分别为SINS解算得到的东向、北向、天向速度误差，分别为SINS解算得到的东、北、天三个方向的平台失准角，ε_E、ε_N、ε_U分别为东、北、天向陀螺漂移，分别为东、北、天向加速度计零偏；

步骤4、利用电子罗盘输出的姿态γ_E、θ_E、ψ_E和微惯导系统输出的姿态γ_M、θ_M、ψ_M之间的差值δγ、δθ、δψ与平台失准角之间的关系建立电子罗盘部分的观测方程，即为

Z1=γM-γEθM-θEψM-ψE=δγδθδψ=H1δX+w1]]>

其中，γ_E、θ_E、ψ_E对应电子罗盘输出的东向、北向、天向姿态；γ_M、θ_M、ψ_M对应微惯导输出的东向、北向、天向姿态；w₁对应电子罗盘部分的观测噪声矩阵，H₁对应电子罗盘部分的观测矩阵、其表达形式为：

H1=01×6sinψEcosθE-cosψEcosθE001×601×6-cosψE-sinψE001×601×6-sinθEsinψEcosθEsinθEcosψEcosθE-101×6;]]>

步骤5、利用GPS接收机在t₁、t₂时刻接收到的l卫星和m卫星的载波相位信号，在地球坐标系下对其进行站际、星际双差过程，得到单位向量差q；

步骤6、根据步骤5得到GPS部分的观测方程：

Z₂=H₂δX+w₂

其中，w₂对应GPS部分的观测噪声矩阵，δX表示的是步骤3中扩展卡尔曼滤波器状态方程的15维状态变量，H₂对应的是观测转换矩阵，即

H2=01×301×3qCne01×601×3qCne01×301×6]]>

其中，表示的是由微惯导解算中得到的导航坐标系到地球坐标系的转换矩阵；

步骤7、根据步骤4得到的电子罗盘部分的观测方程和步骤6得到的GPS部分的观测方程建立组合系统的扩展卡尔曼滤波器观测方程为：

Z1Z2=H1H2δX+w1w2;]]>

步骤8、利用步骤3和步骤7提供的状态方程和观测方程构成扩展卡尔曼滤波器，实时估测出微惯导系统失准角

步骤9、利用步骤8估测出的微惯导系统失准角修正步骤1中微惯导系统的姿态矩阵，得到修正后的姿态矩阵，再利用步骤2中的计算方法实时地计算出微惯导系统的姿态值。

2.根据权利要求1所述的微惯导与DGPS和电子罗盘组合导航姿态测量方法，其特征是所述单位向量差q的计算方法为：

步骤1、计算GPS卫星位置到GPS接收机位置的单位向量u，计算公式如下：

-(X-x)R-(Y-y)R-(Z-z)R]]>

其中，(XYZ)表示是广播星历给出的GPS卫星在地球坐标下的位置坐标；(xyz)表示微惯导系统解算得到的GPS接收机在地球坐标系下的位置坐标；R表示GPS卫星位置到GPS接收机位置的距离：

R=(X-x)2+(Y-y)2+(Z-z)2;]]>

步骤2、计算l卫星和m卫星的位置到GPS接收机位置的单位向量之间的差值u^(lm)，

u^(lm)=u^l-u^m

其中，u^l表示卫星l到GPS接收机位置的单位向量；u^m表示卫星m到GPS接收机位置的单位向量；

步骤3、计算u^(lm)在t₁、t₂两时刻之间的差值

ut12lm=ut1lm-ut2lm]]>

其中，表示t₁时刻u^(lm)的值；表示t₂时刻u^(lm)的值；

得到单位向量差