该项目旨在实现捷联惯性导航系统(SINS)在静止基座条件下的高精度精对准过程模拟。项目核心在于利用卡尔曼滤波(Kalman Filter)技术,在粗对准提供的初始姿态基础上,进一步抑制传感器噪声并修正姿态误差角。
具体实现过程中,程序建立了包含姿态误差(phi)、速度误差、陀螺仪零漂及加速度计零偏等状态量的线性化误差模型。通过将惯导系统结算出的速度与静基座下的理论速度(零速度)之差作为观测值,实时更新滤波器状态。
该仿真涵盖了捷联更新算法、状态转移矩阵的构建、系统噪声协方差阵(Q)与测量噪声协方差阵(R)