基于弹道先验知识的旋转弹飞行参数测量方法和系统

摘要

本发明所述的一种基于弹道先验知识的旋转弹飞行参数滤波方法及系统，通过选取由旋转弹姿态四元数q作为滤波器状态变量的系统状态方程和由磁测解算系统四元数qMR作为滤波器观测变量的系统观测方程，通过弹体姿态四元数矩阵解算所述磁测解算系统四元数qMR；进而构建弹体姿态滤波模型，采用卡尔曼滤波算法完成状态方程X(k)的最优滤波估计计算得旋转弹姿态四元数最优估计并代入弹体姿态四元数矩阵中，计算得最优弹体姿态四元数矩阵以及计算弹体速度Vn和弹体飞行位置Pn，完成旋转弹飞行实时参数测量，从而有效提高了测试旋转弹状态的精确度和可靠性。