KALMAN滤波源程序，已知条件是给出状态方程和量测方程，过程噪声和量测噪声都是零均值的高斯白噪声

姿态信息是飞行控制中最关键的参数之一,因此姿态测量成为飞行控制系统首要解决的问题。利用多MEMS传感器研制了一种微型姿态测量系统。利用三轴MEMS加速度计和三轴MEMS陀螺数据,由方向余弦矩阵的姿态表示形式推导了扩展Kalman滤波方程,解算出飞行器的俯仰角和横滚角 设计专家系统判断飞行器的运动状态,并根据该状态调整滤波算法中的测量噪声矩阵,使系统可同时满足静态情况和动态情况的使用 利用空速和高度数据对俯仰角进行修正,利用GPS解算航向角。将实验结果与国外最新 的商用自动驾驶仪的姿态结果进行

针对影响目标跟踪性能的关键因素——机动目标模型及其状态转移方程，探讨了基于Singer统计模型的卡尔曼滤波算法实现。(Aiming at the key factor that affects the performance of target tracking maneuvering target model and its state transition equation, the Calman filtering algorithm based on Singer statistical