[发明专利]三轴矢量传感器与安装载体间安装误差的标定补偿方法

权利要求书

1.一种三轴矢量传感器与安装载体间安装误差的标定补偿方法，其特征在于：设载体坐标系下三轴矢量传感器测量参数的理论值为而三轴矢量传感器于本身测量坐标系下的实测输出值为则有实测输出值S^m、理论值S^b的关系式：

S^m＝KS^b        (1-1)

即S^b＝K^-1S^m    (1-2)

其中，K为安装误差系数矩阵，K^-1为修正系数矩阵-安装误差系数矩阵K的逆矩阵；

所述安装误差系数矩阵K由如下方法得到：

三轴矢量传感器的本身测量坐标系-m系能通过转动载体坐标系-b系得到，如图1所示，首先将载体坐标系-b系绕z_b轴转动ψ角，得到坐标系ox₁y₁z_b；然后将坐标系ox₁y₁z_b绕x₁轴转动θ角，得到坐标系ox₁y_mz₁；最后将坐标系ox₁y_mz₁绕y_m轴转动γ角，得到坐标系ox_my_mz_m，即三轴矢量传感器的本身测量坐标系-m系；

则有安装误差系数矩阵

K=K3K2K1=cosγ0-sinγ010sinγ0cosγ1000cosθsinθ0-sinθcosθcosψ-sinψ0sinψcosψ0001---(1-3)]]>

修正系数矩阵

K-1=K1-1K2-1K3-1=cosψsinψ0-sinψcosψ00011000cosθ-sinθ0sinθcosθcosγ0sinγ010-sinγ0cosγ---(1-4)]]>

将式(1-3)代入式(1-1)，即可得到三轴矢量传感器实测输出值S^m与理论值S^b的关系式：

Sm=KSb=K3K2K1Sb]]>

=cosψcosγ+sinψsinθsinγ-sinψcosγ+cosψsinθsinγ-cosθsinγsinψcosθcosψcosθsinθcosψsinγ-sinψsinθcosγ-sinψsinγ-cosψsinθcosγcosθcosγSxbSybSzb---(1-5)]]>

即

Sxm=Sxb(cosψcosγ+sinψsinθsinγ)+Syb(-sinψcosγ+cosψsinθsinγ)+Szb(-cosθsinγ)Sym=Sxb(sinψcosθ)+Syb(cosψcosθ)+SzbsinθSzm=Sxb(cosψsinγ-sinψsinθcosγ)+Syb(-sinψsinγ-cosψsinθcosγ)+Szbcosθcosγ---(1-6)]]>

将式(1-4)代入式(1-2)，即可得到针对三轴矢量传感器与安装载体间安装角度误差的修正数学模型：

Sb=K-1Sm=K1-1K2-1K3-1Sm]]>

=cosψcosγ+sinψsinθsinγsinψcosθcosψsinγ-sinψsinθcosγ-sinψcosγ+cosψsinθsinγcosψcosθ-sinψsinγ-cosψsinθcosγ-cosθsinγsinθcosθcosγSxmSymSzm---(1-7)]]>

其中，三轴矢量传感器与安装载体间的安装角度误差-ψ角、θ角、γ角的标定方法如下：

1)、对三轴矢量传感器的封装外壳进行载体坐标系标定

三轴矢量传感器的封装外壳是三轴矢量传感器与安装载体间的固定媒介，其与安装载体固定时为同一坐标系-载体坐标系；依据安装载体的载体坐标系、三轴矢量传感器与安装载体固定时封装外壳的实际设置状态，标定出三轴矢量传感器封装外壳与载体坐标系对应的x_b轴、y_b轴、z_b轴；

2)、确定三轴矢量传感器与安装载体间的安装角度误差-θ角、γ角

将三轴矢量传感器以任意状态设置于测量空间内的任意位置处，并采集三轴矢量传感器相应状态下的实测输出值然后将三轴矢量传感器以其封装外壳的z_b轴旋转180°，并采集三轴矢量传感器相应状态下的实测输出值

与上述两种测量状态对应的载体坐标系下三轴矢量传感器测量参数的理论值满足：

Sx1b=-Sx2bSy1b=-Sy2bSz1b=Sz2b---(1-8)]]>

根据式(1-6)、式(1-8)可得到：

Sx1m+Sx2m=2Sz1b(-cosθsinγ)Sy1m+Sy2m=2Sz1bsinθSz1m+Sz2m=2Sz1bcosθcosγ---(1-9)]]>

由式(1-9)可得：

γ=arctan(-Sx1m-Sx2mSz1m+Sz2m)θ=arctan[cosγ(Sy1m+Sy2m)Sz1m+Sz2m]---(1-10)]]>

3)、确定三轴矢量传感器与安装载体间的安装角度误差-ψ角

保持三轴矢量传感器的设置位置不变，将三轴矢量传感器以其封装外壳的y_b轴或x_b轴旋转180°，并采集三轴矢量传感器相应状态下的实测输出值

该次测量状态对应的载体坐标系下三轴矢量传感器测量参数的理论值与前一次测量状态对应的载体坐标系下三轴矢量传感器测量参数的理论值满足：

A、以三轴矢量传感器封装外壳的y_b轴旋转时，

Sx2b=-Sx3bSy2b=Sy3bSz2b=-Sz3b---(1-11)]]>

B、以三轴矢量传感器封装外壳的x_b轴旋转时，

Sx2b=Sx3bSy2b=-Sy3bSz2b=-Sz3b---(1-12)]]>

根据式(1-6)、式(1-11)可得到：

Sx2m+Sx3m+2Sy2b(-sinψcosγ+cosψsinθsinγ)Sy2m+Sy3m=2Sy2b(cosψcosθ)Sz2m+Sz3m=2Sy2b(-sinψsinγ-cosψsinθcosγ)---(1-13)]]>

由式(1-13)可得：

Sx2m+Sx3mSz2m+Sz3m=tanψ-sinθtanγtanψtanγ+sinθ---(1-14)]]>

即ψ=arctan[(Sx2m+Sx3m)+tanγ(Sz2m+Sz3m)(Sz2m+Sz3m)-tanγ(Sx2m+Sx3m)sinθ]---(1-15)]]>

根据式(1-6)、式(1-12)可得到：

Sx2m+Sx3m+2Sx2b(cosψcosγ+sinψsinθsinγ)Sy2m+Sy3m=2Sy2b(sinψcosθ)Sz2m+Sz3m=2Sz2b(cosψsinγ-sinψsinθcosγ)---(1-16)]]>

由式(1-16)可得：

Sx2m+Sx3mSz2m+Sz3m=1+tanψsinθtanγtanγ-tanψsinθ---(1-17)]]>

即ψ=arctan[(Sx2m+Sx3m)tanγ-(Sz2m+Sz3m)(Sx2m+Sx3m)+(Sz2m+Sz3m)tanγ·1sinθ]---(1-18)]]>

将式(1-10)和式(1-15)或式(1-18)的计算结果代入式(1-7)，最终得到针对三轴矢量传感器与安装载体间安装角度误差的修正数学模型。