基于角加速度计/陀螺/加速度计的惯性导航解算方法技术

本发明专利技术公开了基于角加速度计/陀螺/加速度计的惯性导航解算方法，设计了一种新的惯性导航方案，其采用角加速度计、陀螺、加速度计传感器对载体的角速度、姿态、速度、位置信息进行预测，通过卡尔曼滤波器对载体的角速度、姿态、速度、位置信息进行解算。其中，角加速度计、加速度计用于更新状态方程，陀螺用于更新量测方程。相对于传统的惯性导航方案，本发明专利技术通过引入角加速度计，可以提高载体高动态情况下的导航解算精度。

Inertial Navigation Solution Based on Angular Accelerometer/Gyro/Accelerometer

【技术实现步骤摘要】
基于角加速度计/陀螺/加速度计的惯性导航解算方法
本专利技术涉及基于角加速度计/陀螺/加速度计的惯性导航解算方法，属于惯性导航

技术介绍
惯性导航是一种常见的导航方式，其采用惯性器件，通过递推式的导航方式，对载体的姿态、速度、位置进行解算。惯性导航具有自主性强、不受外界干扰、输出信息全的优势，在航空、航天、航海中具有广泛的应用。传统的惯性导航方案采用的惯性器件为陀螺与加速度计，其中陀螺测量的是角速度信息，加速度计测量的是加速度信息。当载体进行高动态动作时，陀螺的带宽受限、采样延迟会带来误差，从而影响导航精度。
技术实现思路
本专利技术所要解决的技术问题是：提供基于角加速度计/陀螺/加速度计的惯性导航解算方法，通过引入角加速度计，形成一种新的惯性导航方案，并设计相应的惯性导航算法，提高载体在高动态环境下的导航精度。本专利技术为解决上述技术问题采用以下技术方案：基于角加速度计/陀螺/加速度计的惯性导航解算方法，包括如下步骤：步骤1，周期读取k时刻载体的传感器信息，包括三轴角加速度计输出三轴陀螺输出三轴加速度计输出步骤2，根据k时刻的传感器信息，预测k时刻载体的角速度、姿态、速度、位本文档来自技高网...

【技术保护点】
1.基于角加速度计/陀螺/加速度计的惯性导航解算方法，其特征在于，包括如下步骤：步骤1，周期读取k时刻载体的传感器信息，包括三轴角加速度计输出

【技术特征摘要】
1.基于角加速度计/陀螺/加速度计的惯性导航解算方法，其特征在于，包括如下步骤：步骤1，周期读取k时刻载体的传感器信息，包括三轴角加速度计输出三轴陀螺输出三轴加速度计输出步骤2，根据k时刻的传感器信息，预测k时刻载体的角速度、姿态、速度、位置信息；步骤3，通过卡尔曼滤波器，对k时刻载体的角速度进行校正。2.根据权利要求1所述基于角加速度计/陀螺/加速度计的惯性导航解算方法，其特征在于，所述步骤2的具体过程如下：1)采用如下公式预测载体角速度：其中，为k时刻机体系相对于惯性系的角速度在机体系X、Y、Z轴上的分量，为k-1时刻机体系相对于惯性系的角速度在机体系X、Y、Z轴上的分量，为k时刻机体系相对于惯性系的角加速度在机体系X、Y、Z轴上的分量，ΔT为离散采样周期；2)采用如下公式预测载体姿态：其中，a＝x,y,z，q0(k)、q1(k)、q2(k)、q3(k)为k时刻的姿态四元数，q0(k-1)、q1(k-1)、q2(k-1)、q3(k-1)为k-1时刻的姿态四元数，为k时刻机体系相对于导航系的角速度在机体系X、Y、Z轴上的分量，为k-1时刻的姿态转移矩阵，为k-1时刻导航系相对于惯性系的角速度在导航系X、Y、Z轴上的分量；3)采用如下公式预测载体速度：其中，为k时刻载体速度在导航系X、Y、Z轴上的分量，为k-1时刻载体速度在导航系X、Y、Z轴上的分量，L(k-1)、h(k-1)为k-1时刻载体的纬度、高度，RM、RN为地球的子午圈、卯酉圈半径，为k时刻三轴加速度计在X、Y、Z轴上的输出分量，ωie为地球自转角速度，g为重力加速度；4)采用如下公式预测载体位置：其中，λ(k)、L(k)、h(k)为k时刻载体的经度、纬度与高度，λ(k-1)为k-1时刻载体的经度。3.根据权利要求2所述基于角加速度计/陀螺/加速度计的惯性导航解算方法，其特征在于，所述k-1时刻的姿态转移矩阵为：其中，q0(k-...

【专利技术属性】
技术研发人员：吕品，白师宇，赖际舟，李志敏，刘士超，
申请(专利权)人：南京航空航天大学，
类型：发明
国别省市：江苏,32