基于卡尔曼滤波的轨迹规划高度修正仿真实现

摘要

综合地形跟随/地形回避(TF/TA)是新一代低空突防技术,其中的轨迹规划技术是飞行器低空突防飞行控制律设计的重要依据.针对飞行器实时飞行过程中存在各种误差因素影响规划轨迹性能的情况,设计卡尔曼滤波器在实时轨迹规划中对所获取的飞行器高度值进行修正,可以获得比较精确的离地高度信息提供给飞行器,从而增加飞行器的安全系数.建立系统的状态与观测数学模型,在给定初始值和噪声方差阵的情况下进行了仿真.仿真结果显示所设计的卡尔曼滤波器可行,大大减小了组合导航系统误差模型的作用效果.