[发明专利]一种余度惯性测量单元测量噪声估计和数据融合方法

权利要求书

1.一种余度惯性测量单元测量噪声估计和数据融合方法，其特征在于：具体包括以下几个步骤：

步骤一：获得载体轴的空间合成矢量ω；

通过由载体轴与余度传感器测量轴之间的空间关系，根据最小二乘法对惯性测量数据进行数据融合，得到沿载体轴的空间合成矢量ω；

余度传感器采用六单轴余度传感器对称配置，6个余度传感器的测量轴分别沿正十二面体的六个面法向配置，余度传感器惯性测量单元沿载体轴的空间合成矢量ω为：ω＝[ω_xω_yω_z]^T，其中ω_x、ω_y、ω_z分别表示空间合成矢量ω沿载体的x轴、y轴、z轴的分量；

根据空间几何关系得到六个余度传感器所测的惯性测量数据m为m＝Hω+Δm；

其中，m＝[m₁m₂m₃m₄m₅m₆]^T，m₁～m₆分别表示各个测量轴的惯性测量数据；

Δm＝[Δm₁Δm₂Δm₃Δm₄Δm₅Δm₆]^T，Δm₁～Δm₆分别表示各个测量轴惯性测量数据的测量噪声；H=sinα-sinαcosαcosα0000sinα-sinαcosαcosαcosαcosα00sinα-sinαT,]]>表示配置矩阵；通过最小二乘法对余度传感器的惯性测量数据m进行数据融合，得到ω＝(H^TH)^-1H^Tm；

步骤二：根据余度传感器载体轴与测量轴的空间关系，将沿载体轴的空间合成矢量向余度传感器的各个测量轴分别进行投影，得到空间投影数据ω_m为ω_m＝Hω，H为配置矩阵；

步骤三：根据步骤二中得到的空间投影数据ω_m与步骤一中的惯性测量数据m，得到空间投影数据与惯性测量数据间的投影残差δm，选择统计区间，对投影残差进行方差统计，得到余度传感器各轴上的投影残差的方差统计结果

1)获得空间投影数据ω_m与惯性测量数据m间的投影残差δm为投影残差：

δm＝ω_m-m

2)误差方差统计

采用窗口为n的连续滑动窗口法统计随机变量即投影残差δm的方差，对六个轴的投影残差δm_i分别进行方差统计，具体为：

E(δmji2)=Δ1nΣk=0n-1(δmj(i-k))2i≥n,j=1,2,...,6;]]>

其中，表示第j个测量轴、第i次测量的投影残差δm投影残差统计方差值；δm_ji表示第j个测量轴、第i次测量的投影残差，k表示累加的上下界；

令6个测量轴第i次测量的投影残差统计方差向量为：

E(δmi2)=E(δm1i2)E(δm2i2)E(δm3i2)E(δm4i2)E(δm5i2)E(δ6i2)T,]]>

6个测量轴第i次测量的真实测量误差方差向量为：

E(Δmi2)=E(Δm1i2)E(Δm2i2)E(Δm3i2)E(Δm4i2)E(Δm5i2)E(Δ6i2)T,]]>

根据测量轴与惯性空间的配置关系得到：

E(δm²)＝TE(Δm²)

其中，T表示真实测量误差与统计方差之间的传递关系，获得真实误差方差估计E(Δm²)：

E(Δm²)＝T^-1E(δm²)

实现对余度传感器各测量轴的真实噪声方差的估计；

步骤四：根据步骤三中得到的余度传感器各轴的真实测量误差方差的估计结果，对余度传感器各个轴向的惯性测量数据加权，求出加权阵，再利用加权最小二乘法合成载体的空间合成矢量ω_ji；

采用加权最小二乘法对余度传感器各轴测量误差的真实方差估计结果进行数据融合，得到空间合成矢量ω_ji为ω_ji＝(H^TW_iH)^-1H^TW_im_i；

其中，ω_ji表示j个载体轴、第i次测量的加权最小二乘融合的空间合成矢量；H表示配置矩阵；m_i表示第i次的测量值，

W=diag{1E(Δm1i2),1E(Δm2i2),1E(Δm3i2),1E(Δm4i2),1E(Δm5i2),1E(Δm6i2)},]]>表示加权阵。

2.根据权利要求1所述的一种余度惯性测量单元测量噪声估计和数据融合方法，其特征在于：所述的真实测量误差与统计方差之间的传递关系T为：

T=0.250.050.050.050.050.050.050.250.050.050.050.050.050.050.250.050.050.050.050.050.050.250.050.050.050.050.050.050.250.050.050.050.050.050.050.25.]]>