[发明专利]一种双惯导联合旋转调制导航与在线相对性能评估方法

摘要

本发明针对惯导性能在线评估的问题，公开了一种双惯导联合旋转调制导航与在线相对性能评估方法。本发明通过坐标系定义、联合旋转调制策略编排、联合系统状态方程确定、量测方程确定和卡尔曼滤波的步骤，实现了惯导性能的在线评估，提高了多套惯导系统间信息融合的效果。本发明可用于长航时高精度导航条件下惯导系统相对性能的评估及惯导系统故障的诊断，对于长航时条件下导航精度的保证具有积极意义。

主权项

一种双惯导联合旋转调制导航与在线相对性能评估方法，其特征在于包括以下步骤：步骤一：坐标系定义，定义导航坐标系(n系)为当地水平地理坐标系，坐标轴分别指向北向‑东向‑地向(N‑E‑D)，载体坐标系(b系)坐标轴分别沿载体的横滚轴‑俯仰轴‑偏航轴(前‑右‑下)，惯导系统1、2的惯性测量单元(IMU)坐标系分别为s1、s2，坐标轴指向同载体坐标系定义；步骤二：联合旋转调制策略编排，惯导系统1、2分别绕方位轴进行4位置8次序旋转调制转位，转位规律不同；步骤三：联合系统状态方程确定，取惯导系统1与惯导系统2的姿态误差、速度误差、位置误差的状态差为联合系统状态，16个误差状态为：x＝[(φN1‑φN2) (φE1‑φE2) (φD1‑φD2) (δvN1‑δvN2) (δvE1‑δvE2)(δL1‑δL2) (δλ1‑δλ2) εx1 εy1 εx2 εy2 (εz1‑εz2) ▽x1 ▽y1 ▽x2 ▽y2]T   (1)即x＝[φN12 φE12 φD12 δvN12 δvE12 δL12 δλ12εx1 εy1 εx2 εy2 εz12 ▽x1 ▽y1 ▽x2 ▽y2]T其中，上标T表示向量或矩阵的转置，φN12＝(φN1‑φN2)、φE12＝(φE1‑φE2)、φD12＝(φD1‑φD2)分别为惯导系统1与惯导系统2的姿态误差向量的差值，δvN12＝(δvN1‑δvN2)、δvE12＝(δvE1‑δvE2)分别为惯导系统1与惯导系统2的北向、东向速度误差的差值，δL12＝(δL1‑δL2)、δλ12＝(δλ1‑δλ2)分别为惯导系统1与惯导系统2的纬度、经度误差的差值，εx1、εx2、εy1、εy2分别为惯导系统1与惯导系统2的IMU对应水平坐标轴的陀螺常值漂移，εz12＝(εz1‑εz2)为惯导系统1与惯导系统2的IMU对应天向坐标轴的陀螺常值漂移之差(绕方位轴单轴旋转时，水平加表零偏、陀螺常值漂移可分离，但天向的陀螺常值漂移不可分离)，▽x1、▽x2、▽y1、▽y2分别为惯导系统1与惯导系统2的IMU对应水平坐标轴的加表常值零偏，根据联合系统状态确定联合系统状态方程；步骤四：量测方程确定，扣除安装位置误差以及杆臂造成的速度误差，在缺少外界参考信息条件下，取1s更新一次的惯导系统1、2的速度和位置之差为相应的量测量，量测量为：z(t)＝[δvN1‑δvN2 δvE1‑δvE2 δL1‑δL2 δλ1‑δλ2]T   (2)其中，为惯导系统1、2的北向速度差值，为惯导系统1、2的东向速度差值，为惯导系统1、2的纬度差值，为惯导系统1、2的经度差值，根据量测状态确定量测方程；步骤五：卡尔曼滤波，根据联合系统状态方程、量测方程构建卡尔曼滤波器，1s进行一次量测更新，对两套惯导系统各自的陀螺、加表零偏进行估计；步骤六：惯导性能在线评估，根据陀螺、加表零偏的估计值对惯导系统1、2的相对性能进行评估，零偏小的系统作为优选系统。