高超声速飞行器发射坐标系导航算法

针对高超声速飞行器弹道特点和导航参数的需求，提出基于发射坐标系(LCEF)的高超声速飞行器导航算法。首先，介绍发射坐标系下捷联惯导(SINS)算法编排，推导发射坐标系下姿态、速度和位置离散递推方程。然后，介绍地心地固系(ECEF)下的卫星位置和速度转换到发射坐标系的方法，推导发射坐标系的SINS/BDS组合导航滤波器状态方程和量测方程。最后，以助推-滑翔飞行器为对象，进行了发射坐标系下组合导航仿真，位置精度小于10 m，速度精度小于0.2 m/s。