摘要
本发明公开了一种基于虚拟陀螺和加速度计的快速对准方法,包括:捷联惯导系统根据已装订的飞行器的初始位置信息,进行载体惯性导航系下的粗对准,构建捷联惯导系统初始的姿态矩阵;构建虚拟陀螺仪和虚拟加速度计的数学模型,利用已采集的陀螺仪和加速度计的输出值,通过所述数学模型得到陀螺仪和加速度计的虚拟输出值;捷联惯导系统利用陀螺仪和加速度计的虚拟输出值进行惯性导航解算,包括姿态矩阵、速度和位置的更新;利用卡尔曼滤波器进行精对准,利用精对准结果对所述姿态矩阵进行精修正;精修正后的姿态矩阵以及所述位置、速度用于捷联惯导系统后续的惯性导航。本发明方法可以大幅缩短精对准的时间,提高对准经度。
技术关键词
捷联惯导系统
导航坐标系
对准方法
虚拟加速度计
虚拟陀螺仪
矩阵
飞行器
数学模型
离散型卡尔曼滤波
卡尔曼滤波器
更新方法
随机噪声
方程
零偏误差
漂移误差