[发明专利]一种消除高精度惯导系统标定中转台抖动影响的方法

说明书

技术领域

本发明属于惯导标定技术领域，具体涉及一种消除高精度惯导系统标定中转台抖动影响的方法。

背景技术

在捷联惯导系统系统级标定方案中，通常需要在转台处于静止状态时进行对准，以获取静止状态结束时刻的惯导系统姿态。然而在实际工程应用中，电动转台锁定时通常处于一种微小抖动状态。此时经典的初始对准方法解算得到的姿态矩阵并不是最后时刻的惯导系统姿态矩阵，这将影响惯导系统、特别是高精度惯导系统的标定精度。

发明内容

本发明要解决的技术问题是提供一种适用于高精度惯导系统系统级标定过程中，消除转台抖动因素影响的对准方法。

本发明的技术方案如下所述：

一种消除高精度惯导系统标定中转台抖动影响的方法，该方法首先利用陀螺信息实时跟踪惯导系统由于转台抖动引入的姿态运动，建立实时载体坐标系与起始时刻载体坐标系之间的方向余弦矩阵；然后利用该矩阵将加速度计输出值进行投影并积分，同时利用已知的地球自转信息和纬度信息计算起始时刻地球坐标系下的重力加速度积分，构建起始时刻载体坐标系和起始时刻地球坐标系下的加速度积分矩阵，解算出两个坐标系之间的方向余弦矩阵；继而得到实时载体坐标系与地理坐标系之间的姿态矩阵，即静止状态结束时刻的姿态信息，消除转台抖动给高精度惯导系统系统级标定带来的不利影响。

作为优选方案，建立实时载体坐标系与起始时刻载体坐标系之间的方向余弦矩阵具体包括以下步骤：

首先跟踪惯导系统由于转台抖动以及地球自转引起的姿态运动，利用陀螺实时输出的角增量信息Δθ，更新实时载体坐标系bt与起始时刻载体坐标系b0之间的方向余弦矩阵

初始时刻I为维数是3×3的单位矩阵，对应的四元数Q₀为：

Q₀＝[q₀ q₁ q₂ q₃]＝[1 0 0 0]              (1)

利用四元数毕卡算法，求解实时四元数：

Qk+1=(I+Δθ2)Qk---(2)]]>

式中：