摇摆状态下低精度捷联惯导系统快速初始对准方法

摘要

本发明的目的在于提供摇摆状态下低精度捷联惯导系统快速初始对准方法。分以下步骤：确定载体的初始位置参数；采集加速度计和陀螺仪输出的数据，采用二阶调平和方位估计法完成捷联惯导系统的粗对准，初步确定载体的姿态；估计杆臂长度，计算杆臂效应引起的干扰加速度，对加速度计的输出进行补偿；建立卡尔曼滤波状态方程及卡尔曼滤波量测方程；估计出系统的失准角，并在精对准结束时刻用其来修正系统的捷联姿态矩阵，完成初始对准。本发明消除了杆臂效应误差对捷联惯导系统初始对准的影响；缩短了系统的对准时间，提高了系统的对准精度，从而全面提高了低精度捷联惯导系统初始对准的性能。