针对惯性导航的雷达高度表辅助方法

摘要

本发明提供一种针对惯性导航的雷达高度表辅助方法，该方法中量测量的构建方法是，根据惯性导航输出的位置矢量计算得到飞行器地心高度，减去地球椭球半径获得飞行器计算海拔高度，雷达高度表测量值结合其它算法获得观测海拔高度，计算海拔高度减去观测海拔高度得到的差值作为量测量，并推导出量测量的全微分方程。本发明给出了一个具体实施方式，基于该量测量组成捷联惯导/雷达高度表组合导航系统，利用间接法带反馈校正的卡尔曼滤波实现了对位置误差状态量的估计，抑制了位置误差的发散，提高了定位精度。

主权项

针对惯性导航的雷达高度表辅助方法，其特征在于：根据惯性导航输出的位置矢量计算得到飞行器地心高度，减去地球椭球半径获得飞行器计算海拔高度，雷达高度表测量值结合其它算法获得观测海拔高度，计算海拔高度减去观测海拔高度得到的差值作为量测量。