摘要
本发明公开了一种卫星测距辅助的飞行器轨迹末端定位方法,其包括S1、用惯性导航系统定位飞行器的当前位置,并计算其与目的地的间隔距离;之后基于蒙特卡洛的位置误差预估方法计算飞行器定位的预估误差;S2、根据间隔距离,判断飞行器是否进入目的地邻域范围,若是,则进入步骤S3,否则进入步骤S4;S3、判断预估误差是否大于终点阈值,若是,则进入步骤S5,否则返回步骤S1;S4、判断预估误差是否大于过程阈值,若是,则进入步骤S5,否则返回步骤S1;S5、采用基于无迹卡尔曼滤波的单星融合定位算法对飞行器进行定位,并在执行预设时长后,返回步骤S1。