1.一种多约束下考虑定位误差校正的飞行器航迹规划方法,其特征在于,包括以下步骤:步骤1,给定垂直误差和水平误差校正点的空间分布,并设定飞行器的飞行条件和定位误差约束;
步骤2,规定飞行器从一个校正点飞行至下一个校正点为“一步”,利用贪心算法求解飞行器从起点开始按步搜寻能够正常飞行并且能进行水平校正或垂直校正的校正点,并优先选择距离终点最近的校正点作为下一步,然后依此继续搜寻直到抵达终点;
所述贪心算法包括如下步骤:
初始化:g1=0,g2=0,P={H,V},start,end,PATH={start};
式中:H为水平校正点集合,V为垂直校正点集合,g1为飞行器当前的垂直误差,g2为飞行器当前的水平误差,为误差增加量,L为欧式距离集合,P为下一步可行点的集合,PATH为搜寻过程中的路径集合,start为起点坐标,end为终点坐标;
步骤201:为了防止飞行器出现往复飞行的情况,将PATH中存在的校正点从P中删去,P=P\PATH;
步骤202:统计飞行器当前位置与P中所有校正点的欧式距离L,并计算误差增加量步骤203:删除因为误差过大而不能正常抵达的P中校正点;对于P中每个校正点i,如果或是则删去该校正点;
步骤204:删除不能进行校正的P中校正点;对于P中每个校正点i,如果i∈V,并且则能够进行垂直校正;如果i∈H,并且则能够进行水平校正;对于既不能进行垂直校正也不能进行水平校正的校正点,将它们从P中删去;
步骤205:假设飞行器飞行至P中校正点后直线飞向end,以飞行器不再进行校正直到误差达到θ时的位置与end的距离作为评价指标;对于P中每个校正点i,计算距离L1:该校正点与end的欧式距离;计算距离L2:飞行器在该校正点不再经过校正的最大飞行距离;如果L1≤L2,则航迹规划结束;否则,以L1-L2作为评价指标;
步骤206:选择评价指标最小值对应的校正点作为航迹的下一步,更新PATH;
步骤207:循环步骤201-206,直到循环在步骤205中停止;
步骤3,以贪心算法的结果为基础,采用精确剪枝-枚举法计算航迹长度与起始点之间直线长度的差值;然后从起点开始对所有可行航迹逐步进行穷举搜索,并在搜索过程中利用航迹长度与起始点之间直线长度的差值精确地剪除劣解对应的枝杈,从而保证求解的速度,以至最终找到最优解;
所述精确剪枝-枚举法步骤为:
初始化:P={H,V},start,end,贪心算法输出的PATH;
步骤301,计算偏移量,即
步骤302:统计飞行器当前位置与P中所有校正点的欧式距离L,并计算误差增加量步骤303:删除因为误差过大而不能正常抵达的P中校正点;对于P中每个校正点i,如果或是则删去该校正点;
步骤304:删除不能进行校正的P中校正点;对于P中每个校正点i,如果i∈V,并且则能够进行垂直校正;如果i∈H,并且则能够进行水平校正;对于既不能进行垂直校正也不能进行水平校正的校正点,将它们从P中删去;
步骤305,删除劣解对应的校正点;对于P中每个校正点i,计算从起点按照规划的航迹飞行到i的长度,并计算i到end的距离即Li-end,以两者的和与Lstart-end的差与做比较,如果大于则删去该校正点;
步骤306,对于P中每个校正点i,判断飞行器经过新的校正后,是否能直接飞至end;如果可以飞至end,则保存该航迹;否则,循环步骤302-303,直到P中不再存在校正点;
步骤307,对所有保存的航迹,以航迹长度和校正次数进行pareto排序,选择pareto第一前言对应的航迹作为输出。
2.根据权利要求1所述的一种多约束下考虑定位误差校正的飞行器航迹规划方法,其特征在于,所述飞行器的飞行条件包括:飞行器在起点的垂直误差和水平误差均为0;
起点和终点的距离较大,必须在途中经过若干次校正才能顺利抵达终点;
飞行器可以在任意两个校正点之间直线飞行;
飞行器在转向时,不考虑转弯半径;
飞行器的动力足够,且不会出现故障。
3.根据权利要求1所述的一种多约束下考虑定位误差校正的飞行器航迹规划方法,其特征在于,所述定位误差约束包括:在不进行任何校正时,飞行器每飞行1米,垂直误差和水平误差各增加δ个单位;
当垂直误差和水平误差均小于θ个单位时,飞行器可以正常飞行;否则,航迹规划任务失败;
在垂直校正点,且飞行器垂直误差小于α1个单位,水平误差小于α2个单位,将其垂直误差置零,水平误差保持不变;
在水平校正点,且飞行器垂直误差小于β1个单位,水平误差小于β2个单位,将其水平误差置零,垂直误差保持不变。