[发明专利]一种对惯性角速度传感器进行地球自转补偿的方法

权利要求书

1.一种对惯性角速度传感器进行地球自转补偿的方法，其特征是：

惯性角速度传感器安装在载体上，敏感轴指向r^b相对于载体坐标系是恒定不变的，测得载体所在地点的纬度为B，载体的姿态角，也就是从当地地理坐标系到载体坐标系的欧拉转动角分别为A、Φ、Θ，则对惯性角速度传感器进行地球自转补偿的计算公式如下：

ω_eb＝ω_ib-z_e (1)

式(1)中ω_eb是传感器载体在其敏感轴方向上相对于地球的角速度即补偿后的值，ω_ib是传感器载体在其敏感轴方向上相对于惯性参照系的角速度即为未补偿前的角速度测量值，z_e是地球自转角速度在传感器敏感轴方向上的分量；

地球自转角速度在传感器敏感轴方向上的分量z_e的计算公式如下：

式(2)中r^b是代表敏感轴方向的单位矢量在载体坐标系中的坐标向量，是地球自转角速度在载体坐标系中的坐标向量，符号“·”为点乘之意，上标b代表在载体坐标系中；载体坐标系是正交的右手坐标系，其X_b、Y_b、Z_b轴向分别沿安装有惯性角速度传感器的运载体的横滚轴、俯仰轴和偏航轴，其中横滚轴指向前进方向，俯仰轴在载体平面上指向横滚轴的右边；

地球自转角速度在载体坐标系中的坐标向量的计算模型如下：

式(3)中Ω为地球自转角速度的大小，一般取7.292115×10^-5rad/s；B为载体所在位置的纬度；A、Φ、Θ为载体姿态角：A为载体前进方向的真方位角，Φ为载体前进方向与水平面间的夹角，上坡为正，下坡为负；Θ为载体绕横滚轴从俯仰轴在水平位置起到当前位置所转过的角度，面朝前进方向观察，顺时针转角为正。