1.一种基于粒子群算法的无人机无冲突四维航迹规划方法,其特征在于,具体步骤如下:步骤一、输入需规划的无人机群体无冲突四维航迹规划的约束条件、初始位置以及到达目的地信息;约束条件包括:无人机最大速度限制、最大加速度限制、过点时间误差限制、最大转弯半径限制、与障碍物的安全距离限制,以及融合运行区域内的有人机位置平移不确定性区域 其中,无人机最大速度限制、最大加速度限制、过点时间误差限制、最大转弯半径限制、与障碍物的安全距离限制,具体限制范围根据实际情况人为设定;有人机位置平移不确定性区域 计算如下:通过对有人机的历史飞行数据进行贝叶斯统计均值,得到有人机位置分布的先验信息;在获取观测样本后,按照样本和参数的联合分布,通过贝叶斯理论对下一时刻有人机位置平移随机变量分布进行预测,根据预测分布的均值和协方差计算得到有人机位置分布的不确定区域;有人机的位置平移随机变量的期望 和协方差 通过概率模型表示,公式如下:其中,期望 和协方差 通过对有人机历史飞行数据进行贝叶斯统计得到;N(.)表示分布函数,k=1,2,3....M表示有人机可能运动模式的数量,t表示时间步长,j'表示管制区内的第j'个有人机;步骤二、基于输入的规划信息,生成该无人机群体初始的四维航迹;并在假设有限迭代次数的前提下基于粒子群算法进行无冲突航迹优化,得到全局最优位置;主要包括以下步骤:步骤3-1:构建包括约束条件的飞行距离最小的优化指标函数:a iξ <a max ,i=1,2,…N,ξ=X,Y,Zv iξ <v max ,i=1,2,…N,ξ=X,Y,Z其中,J表示飞行距离最小和过点时间误差最小的指标函数,L i 表示无人机i的最短飞行距离,e j 表示无人机j的过点时间误差,N表示无人机的数量,C ij 表示相邻无人机i和j之间的碰撞,一般用0和1表示,0表示无碰撞,1表示碰撞;a iξ 表示无人机i在X,Y,Z三个方向上的加速度,v iξ 表示无人机i在X,Y,Z三个方向上的速度,a max ,v max 分别表示无人机加速度和速度的最大值;步骤3-2:根据上述优化指标,结合约束条件,形成无人机四维航迹规划的代价函数f:其中,ω c ,ω a ,ω v 分别表示碰撞权值、加速度限制权值和速度限制权值,f c ,f a ,f v 是碰撞、加速度和速度限制的约束条件不满足时对应的惩罚函数;步骤3-3:对粒子群算法中粒子的位置和速度初始化,并对局部最优位置初始化;步骤3-4,当局部最优位置对应的代价函数小于全局最优位置对应的代价函数,更新全局最优位置;否则,结束;初始的全局最优位置人为规定;步骤3-5:遍历所有粒子,更新第l个粒子的位置和速度;X l (m+1)=X l (m)+V l (m+1),l=1,2,…Ll初始值为1;V l (m)表示第m次迭代中粒子的速度,ω是迭代权值, 分别表示认知系数,rand表示0~1的随机数,pBest l (m),gBest l (m)分别表示第l个粒子在最近m次迭代过程中的局部最优解和全局最优解,X l (m)是第m次迭代中粒子的位置,L表示粒子总数;ω max ω min 分别表示迭代权值的最大值和最小值,MaxIteration是最大迭代次数;步骤3-6:当第l个粒子更新后的位置对应的代价函数f(X l )小于局部最优解对应的代价函数,即满足f(X l )<f(pBest l ),则更新局部最优位置,返回步骤3-4;否则,保持局部最优解不变;返回步骤3-5进行下一次迭代,直至达到最大迭代次数;步骤三、判断全局最优位置的无人机群体是否存在航迹冲突,如果否,输出全局最优位置作为最优航迹规划集合;如果是,则基于延迟起飞时间算法进一步实现无人机群体的冲突解脱;步骤四、当延迟起飞算法达到最大迭代次数后,进一步判断无人机群体规划的航迹是否存在冲突;如果否,则输出最优化航迹集合和最优起飞时间;如果是则通过增加航路点到航迹的方法进一步实现无人机群体冲突解脱;步骤五、判断增加航路点算法达到最大迭代次数后,无人机群体规划的航迹是否存在冲突,如果否,则输出航路点的最优化坐标和航迹参数,得到最终的无人机群体对应的无冲突四维航迹规划;如果是,则返回步骤二重复上述步骤,直至融合运行区域内的无人机群体实现无冲突的四维航迹规划。
2.如权利要求1所述的一种基于粒子群算法的无人机无冲突四维航迹规划方法,其特征在于,所述基于延迟起飞时间算法实现无人机群体的冲突解脱,具体过程为:首先,从全局最优位置的无人机群体集合中,选取存在冲突的无人机,形成冲突集合;并按照冲突次数由多到少对无人机排序;依次选择冲突最多的无人机的计划起飞时间,将其推迟时间T;然后,更新冲突信息,再次判断更新后的无人机群体对应的航迹是否存在冲突,如果是,继续将冲突最多的无人机的计划起飞时间推迟,直至达到最大迭代次数或者所有无人机都实现无冲突的四维航迹规划。
3.如权利要求1所述的一种基于粒子群算法的无人机无冲突四维航迹规划方法,其特征在于,所述通过在航迹上增加航路点实现无人机群体冲突解脱,具体为:首先,初始化航路点数量;并找到所有未解决的冲突航迹,按照冲突次数由多到少将无人机进行排序;对于冲突最多的航迹增加航路点,基于PSO获取冲突最多的航迹的最优航路点坐标和航迹段参数;然后,更新所有无人机航迹的参数并再次进行航迹冲突探测,更新冲突信息,直至达到最大迭代次数或者所有无人机都实现无冲突的四维航迹规划。