[发明专利]一种恒速偏频/机抖激光陀螺惯导系统导航方法

摘要

本发明属于惯性导航领域，针对正反转速率偏频方式激光陀螺惯导系统要求偏频机构瞬间反转、实现难度大，以及恒速偏频方式激光陀螺惯导系统无法克服与偏频旋转轴方向陀螺标度因数误差相关的等效漂移误差、纯惯性导航误差大的问题，公开了一种恒速偏频/机抖激光陀螺惯导系统导航方法。本发明通过机械抖动偏频激光陀螺安装、坐标系及安装关系定义、偏频旋转轴方向等效陀螺采样值计算、精确标校安装关系矩阵、精确标校机械抖动激光陀螺敏感轴的单位矢量、初始对准卡尔曼滤波器设计、纯惯导误差修正补偿的步骤，实现了快速高精度初始对准，减小了纯惯导的北向和东向位置误差，提高了导航精度。

主权项

1.一种恒速偏频/机抖激光陀螺惯导系统导航方法，其特征在于包含以下步骤：步骤一：机械抖动偏频激光陀螺安装：在三个陀螺g_x、g_y、g_z，三个石英挠性加速度计a_x、a_y、a_z构成的高精度激光陀螺恒速偏频寻北系统的基础上，安装一个不随偏频机构旋转的固定在基座上的机械抖动偏频激光陀螺g_dz，其敏感轴与旋转轴一致，提供偏频旋转轴方向的载体角运动信息；步骤二：坐标系及安装关系定义：定义n系为当地水平地理坐标系，N-E-D(北-东-地)方向；b_g系为斜装的恒速偏频IMU(惯性测量单元)坐标系，其轴与g_x陀螺敏感轴重合，轴在g_x陀螺与g_y陀螺敏感轴所确定的平面内且g_y陀螺敏感轴方向偏离轴一个小的安装偏差角，轴方向符合右手规则且g_z陀螺敏感轴方向偏离轴一个小的安装偏差角；b系为变换后的IMU坐标系，采用前-右-下方向，z_b轴与恒速偏频旋转轴重合，x_b轴、y_b轴与偏频旋转轴正交，x_b轴与轴及z_b轴在同一平面内，与n系间的方向余弦矩阵为b_g系、b系固联于旋转台面中并随转台连续转动，转速Ω，转台旋转轴指向下方，顺时针方向为正，周期T，t时刻与转台零位夹角α(t)；b_p系为转台台体坐标系，与b系在t＝0时刻重合，与n系间的方向余弦矩阵为为b系与b_p系之间的转换矩阵，可由α(t)表示为：步骤三：偏频旋转轴方向等效陀螺采样值计算：b系下偏频旋转轴方向敏感角速率可表示为，式中，是b系下载体角速度，b_p系中机械抖动激光陀螺敏感轴单位矢量为[k_dx k_dyk_dz]^T，其敏感角速率理论值为ω_dz，上标T表示向量或矩阵的转置，Δt是采样时间间隔；由式(2)积分可得相应的陀螺角增量采样值，根据b系中恒速偏频激光陀螺IMU提供的垂直于旋转轴的角增量固联于b_p系中的机抖陀螺的角增量偏频旋转机构的角位置α(t)和角增量Δα(t)，可计算出b系沿偏频旋转轴方向的角增量 步骤四：精确标校b_g系与b系之间的安装关系矩阵设置b_g系三个恒速偏频激光陀螺工作在机械抖动偏频模式下，利用水平姿态角的滚动角γ和俯仰角θ的计算结果对进行精确标校；步骤五：精确标校机械抖动激光陀螺敏感轴的单位矢量[k_dx k_dy k_dz]：设置三个恒速偏频激光陀螺工作在机械抖动偏频模式下，保持不变时有：式中，表示b_p系的旋转角速率；整个惯导系统按照不同的倾斜方式置于单轴转台上，单轴转台正反方向旋转，消除地球自转角速度及陀螺常值漂移误差影响，根据即可估计出参数[k_dx k_dy k_dz]；步骤六：初始对准卡尔曼滤波器设计：选取三个姿态误差φ_N、φ_E、φ_D和三个速度误差δV_N、δV_E、δV_D作为误差状态，器件误差中，选取三个加速度计零偏作为误差状态，选取偏频旋转轴方向等效陀螺采样值常值零偏偏差耦合造成的北向等效陀螺漂移ε_N作为误差状态，即构建系统状态方程如下：式中，x表示系统误差状态，表示系统误差状态微分，F表示系统误差矩阵，G表示系统噪声输入矩阵，w表示系统噪声：w＝[w_gx w_gy w_gz w_ax w_ay w_az]^T (6)式中，w_gx、w_gy和w_gz为陀螺测量噪声，w_ax、w_ay、w_az为加速度计测量噪声；选取n系下速度误差δV_N、δV_E和δV_D作为观测量，构建观测方程如下：z＝Hx+υ (7)式中，z为观测量，H为测量矩阵，υ为测量噪声；步骤七：纯惯导误差修正补偿：利用初始对准卡尔曼滤波对和ε_N的估计值，在纯惯导过程中进行修正补偿，完成导航解算，修正补偿方法如下：。