CN106873628B - 一种多无人机跟踪多机动目标的协同路径规划方法 - Google Patents
一种多无人机跟踪多机动目标的协同路径规划方法 Download PDFInfo
- Publication number
- CN106873628B CN106873628B CN201710234961.2A CN201710234961A CN106873628B CN 106873628 B CN106873628 B CN 106873628B CN 201710234961 A CN201710234961 A CN 201710234961A CN 106873628 B CN106873628 B CN 106873628B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- target
- aerial vehicles
- individual
- population
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 52
- 238000001514 detection method Methods 0.000 claims abstract description 17
- 238000005070 sampling Methods 0.000 claims abstract description 14
- 230000008569 process Effects 0.000 claims abstract description 13
- 230000002452 interceptive effect Effects 0.000 claims abstract description 8
- 239000011159 matrix material Substances 0.000 claims description 44
- 238000011156 evaluation Methods 0.000 claims description 18
- 238000004364 calculation method Methods 0.000 claims description 16
- 230000008901 benefit Effects 0.000 claims description 8
- 238000006243 chemical reaction Methods 0.000 claims description 6
- 230000035772 mutation Effects 0.000 claims description 5
- 238000013507 mapping Methods 0.000 claims description 2
- 238000001914 filtration Methods 0.000 description 6
- 230000007704 transition Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 4
- 230000003993 interaction Effects 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 238000010606 normalization Methods 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 230000004927 fusion Effects 0.000 description 2
- 230000004083 survival effect Effects 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000007935 neutral effect Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
- G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/12—Target-seeking control
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供一种多无人机跟踪多机动目标的协同路径规划方法,包括如下步骤:步骤1:初始化无人机和多机动目标的参数信息;步骤2:通过交互多模型滤波器对多个机动目标的轨迹进行跟踪,预测下一个采样时刻各个目标的运动状态信息,包括各个目标的位置坐标和速度;步骤3:综合考虑目标威胁度影响因素,利用层次分析法计算下一时刻各个目标的威胁度;步骤4:基于各目标的运动状态信息和威胁度,利用差分进化算法同时为多架无人机规划出下一时刻的位置。该方法考虑在无人机‑目标分配方案已经确定的前提下,为多个无人机规划出满足多无人机相互之间无碰撞、无人机最大转弯角约束并且使无人机群联合目标探测概率最大的较易执行路径。
Description
技术领域
本发明属于运动体路径规划研究技术领域,具体涉及一种多无人机跟踪多机动目标的协同路径规划方法,适用于解决无人机集群作战场景下的多个无人机跟踪多机动目标中的协同路径规划问题。
背景技术
多无人机协同控制问题可以分解为协同目标分配、协同路径规划问题、多无人机协同编队控制等多个子问题。其中协同路径规划问题是实现多无人机协同控制中的一个关键问题。多无人机协同航路规划是指在满足各种约束条件(空间约束、时间约束、环境约束、任务约束等)的前提下,为整个无人机群中的每架无人机规划出一条从起始点到目标点的航迹,并且使得无人机群的整体性能达到最优。一般的路径规划问题多考虑在起始位置和目标位置确定条件下的路径规划问题,且各个无人机的路径规划相互独立,针对目标的机动性、威胁度的实时计算以及密集的无人机群作战场景,是多无人机跟踪多机动目标路径规划问题的难点。
与无人机单机路径规划相比,无人机集群作战场景下的多无人机协同路径规划更加复杂化和智能化,可以以更小的代价合作完成更复杂的任务,灵活性更强,更能提高飞行器的生存能力和任务的成功率。
发明内容
本发明针对无人机集群作战场景下的多无人机跟踪多机动目标的路径规划问题,提出一种多无人机跟踪多机动目标的协同路径规划方法,该方法考虑在无人机-目标分配方案已经确定的前提下,为多个无人机规划出满足多无人机相互之间无碰撞、无人机最大转弯角约束并且使无人机群联合目标探测概率最大的较易执行路径。
实现本发明的技术方案如下:
一种多无人机跟踪多机动目标的协同路径规划方法,包括如下步骤:
步骤1:初始化无人机和多机动目标的参数信息;
步骤2:通过交互多模型滤波器对多个机动目标的轨迹进行跟踪,预测下一个采样时刻各个目标的运动状态信息,包括各个目标的位置坐标和速度;
步骤3:综合考虑目标威胁度影响因素,利用层次分析法计算下一时刻各个目标的威胁度;
步骤4:基于各目标的运动状态信息和威胁度,利用差分进化算法同时为多架无人机规划出下一时刻的位置。
进一步地,本发明步骤4利用差分进化算法同时为多架无人机规划出下一时刻的位置,具体包括如下步骤:
S401、初始化无人机位置种群;
根据多架无人机当前时刻的位置坐标及航向角,在满足无人机最大转弯角约束的前提下,为多架无人机随机生成下一时刻的位置;多架无人机在下一时刻的位置联合表示为一个个体,随机生成多个个体组成初始位置种群;
S402、对初始位置种群进行评价;
评价指标包括目标函数值和约束违反程度;所述目标函数综合考虑对多个目标的联合探测概率和多架无人机的转弯角之和;所述约束违反程度是指多无人机相互之间无碰撞约束的违反程度;
S403、记录当前种群的最佳个体;
若初始位置种群中存在约束违反程度为0的个体,则在约束违反程度为0的个体中选取目标函数值最小的个体作为初始位置种群的最佳个体;若初始位置种群所有个体的约束违反程度均大于0,则选取约束违反程度最小的个体作为初始种群的最佳个体;
S404、针对初始位置种群中的每一个体,通过变异、交叉操作产生新的个体;
S405、按照步骤S402的方式对新个体进行评价;
S406、通过选择操作在新个体和产生该新个体的旧个体中留下较优者,作为当前种群;选择操作的原则为:当两者的约束违反程度相等时,留下目标函数值较小的个体,当两者的约束违反程度不相等时,留下约束违反程度较小的个体;
S407、更新当前种群的最佳个体:将通过选择操作留下的个体与之前记录的种群最佳个体进行比较,比较方法与选择操作的原则相同,将两者中较优的个体作为当前种群的最佳个体;
S408、针对当前种群,按照S404-S407的方式进行变异、交叉和选择操作的循环,并更新当前种群的最佳个体,直到达到给定的最大进化代数,即完成路径规划。
进一步地,在执行步骤S401之前,对无人机当前位置进行编码,具体方法如下:
首先以第i(i=1,2,...N)架无人机在当前时刻的位置为极点,水平向右方向为极轴,逆时针为正方向,建立局部极坐标系;其次将第i架无人机在当前时刻的位置用变量极角θi,k表示,N架无人机在当前时刻的位置联合表示为θk=[θ1,k,θ2,k,...,θN,k];再次将N架无人机在当前时刻的位置的解范围映射到[0,1]区间,即将θk=[θ1,k,θ2,k,...,θN,k]转换为xk=[x1,k,x2,k,...,xN,k]。
进一步地,在S402中,所述无碰撞约束违反程度,具体的计算方法如下:
(1)根据N架无人机在当前时刻的位置θk=[θ1,k,θ2,k,...,θN,k],通过坐标转换计算得到N架无人机在笛卡尔坐标系下的位置:(xk,yk)=[(x1,k,y1,k),(x2,k,y2,k),...,(xN,k,yN,k)];
(2)求出两两无人机间的距离得到距离矩阵D=(dij)N×N;
(3)根据设定的安全距离dsd,计算碰撞程度矩阵G=(gij)N×N,计算方法如下:若dij≥dsd,则gij=0;若dij<dsd时,gij=(dsd-dij)/dsd。
进一步地,所述S401和S404中,为满足无人机最大转弯角约束,在生成无人机下一时刻的位置之前,先对无人机位置范围进行限定,方法为:
第i架无人机在当前时刻的位置θi,k须满足:θi,k∈[θi,k-1-θres,θi,k-1+θres],其中θres表示无人机转弯角最大值,θi,k-1表示第i架无人机上一时刻的位置;
在S401和S404中,生成无人机位置的相对编码位置xi,k之后且在个体评价之前,对无人机位置的相对编量进行解码,即将无人机位置相对编码值xi,k对应到具体的极角θi,k,xi,k∈[0,1];解码的方式为:θi,k=θi,k-1-θres+xi,k·2θres。
进一步地,用层次分析法计算威胁度,具体包括如下的步骤:
(1)基于目标威胁度的评价元素,建立目标威胁度单层次结构模型;
(2)基于所述结构模型,计算评价元素两两影响之比,构造两两比较判断矩阵;
(3)对判断矩阵一致性进行检验,通过一致性检验后得到各个评价元素的权重;
(4)计算各个评价元素的效益值;
(5)利用各个评价元素的权重和效益值,计算目标当前时刻的威胁度值。
进一步地,所述步骤3中的层次分析法中建立的目标威胁度单层次结构模型,具体包括如下的评价元素:
(1)目标敌我属性:分为我方、中方、敌方三种;
(2)目标类型:将目标类型按照威胁程度的顺序划分为战术弹道导弹、大
型机、小型机、武装直升机、诱饵这五类;
(3)目标径向距离:表示目标与无人机的径向距离;
(4)目标径向速度:表示目标与无人机的径向速度。
进一步地,所述步骤2的具体步骤为:
(1)建立目标运动模型,初始化模型参数;
(2)模型条件重新初始化:选取经过参数初始化处理的模型j(j=1,2,...,r),并输入k-1时刻的初始化状态,对模型j混合估计,得到重新初始化的状态和协方差阵按混合估计分别为:
其中,r为模型个数;pij是模型i转到模型j的转移概率,为归一化常数,Mi(k-1)是k-1时刻的匹配模型,μi(k-1)是k-1时刻模型i的概率,是k-1时刻模型i的状态估计,相应的协方差矩阵是Pi(k-1|k-1),Mi(k)是k时刻的模型,μij(k-1|k-1)表示模型i和模型j的混合概率;
(3)模型并行滤波:根据步骤(2)中计算得到的k-1时刻模型初始条件,利用卡尔曼滤波法,计算k时刻各个模型的状态估计和协方差矩阵
(4)模型概率更新:利用步骤(2)中求出的k-1时刻的预测模型概率μij(k-1|k-1),通过以下算式计算得到更新概率:
其中,c为归一化常数,且而Λj(k)为观测Z(k)的似然函数,
Sj(k)=H(k)Pj(k|k-1)HT(k)+R(k)
(5)估计融合(输出交互):利用组合各滤波器得到k时刻目标状态的最终总体估计及其协方差矩阵P(k|k)。
本发明的有益效果是:
第一、本发明采用了多无人机协同路径规划方式,综合考虑了多无人机无碰撞约束和无人机最大转弯角约束,为多无人机跟踪多机动目标任务实时规划出满足以上约束并且联合探测概率最大且较易执行的路径,使得无人机群对目标的整体跟踪价值最大化。
第二、本发明具有在线实时路径规划的优点,多无人机在执行任务的过程中可以根据外部环境的变化,适时调整路径重新规划,提高了任务完成的概率,具有更高的可靠性。
第三、本发明采用了角度编码的方式,通过角度(一个变量)代替坐标(两个变量)来表示无人机位置,既压缩了解空间,又便于路径表示和约束处理。
第四、本发明可以同时为多无人机规划出满足要求的路径,缩短了路径规划时间,提高了路径规划效率。
第五、本发明适用于复杂的无人机集群作战场景,可以改善无人机群在战场上的生存能力和任务完成能力。
附图说明
图1为协同路径规划方法的流程图;
图2为无人机与目标运动场景示意图;
图3为交互多模型滤波器示意图;
图4为目标层次结构模型图;
图5为差分进化算法流程图;
图6为位置的表示方法示意图。
具体实施方式
本发明是针对无人机集群作战场景下的多无人机跟踪多机动目标的路径规划问题的解决方法,在无人机-目标分配方案给定的前提下,为N架无人机跟踪M个目标规划出满足无人机最大转弯角约束和相互之间无碰撞约束的对多个目标联合探测概率最大且较易执行的路径;无人机集群作战是指一组具备部分自主能力的无人机系统通过有人/无人操作装置的辅助,在人的监控下,完成作战任务的过程,集群内无人机数量密集,各无人机接受任务请求自主飞向任务区域(指定的目标或者坐标),同时要避免与其他无人机发生碰撞。
本发明中设定无人机和目标在二维平面内运动,运动场景的示意图如图2所示,设共有N架无人机跟踪M个目标,假定目标分配方案给定;多无人机跟踪多机动目标的协同路径规划方法整体思路如下:首先参数初始化,然后建立目标运动模型,使用交互多模型滤波器对目标运动状态进行预测,估计目标在下个采样时刻的运动状态信息;接着利用估计目标的运动状态信息,综合考虑目标威胁度影响因素,采用层次分析法实时计算各个目标的威胁度;最后采用差分进化算法为多架无人机同时规划出下一时刻各自满足其最大转弯角约束和相互之间无碰撞约束的对多个目标联合探测概率最大且较易执行的路径;循环执行以上“预测目标运动状态-计算目标威胁度-无人机路径规划”过程,直至目标分配方案更新,输出无人机群在这段时间内的路径。
下面结合附图和实施例对本发明作详细说明。
本发明一种多无人机跟踪多机动目标的协同路径规划方法,如图1所示,包括以下步骤:
步骤1:初始化无人机和多机动目标的参数信息;
具体包括:目标的位置坐标和径向速度、无人机的位置坐标和航向角、无人机转弯角约束范围、无人机群无碰撞约束信息、目标敌我属性、目标类型、目标径向速度、目标径向距离信息、目标采样时间间隔、无人机之间的安全距离、无人机-目标分配方案信息;所述无人机转弯角约束范围是指无人机的转弯角不能超过其最大值θres;所述无人机转弯角是指无人机转弯前后航向角的差值;所述无人机群无碰撞约束信息是指两两无人机之间的距离不小于设定的安全距离dsd等等。
步骤2、采用交互多模型滤波器对多个机动目标的轨迹进行跟踪,预测下一时刻多个机动目标的位置和速度,具体包括如下步骤:
S201、目标建模及参数初始化;
本发明中设定目标在二维平面内运动,其状态由位置和速度组成,即设采样间隔为T,在采样时刻k,笛卡尔坐标系下目标的离散运动模型和观测模型为:
X(k+1)=FX(k)+Gv(k) (1)
测量方程为:
Z(k)=HX(k)+w(k) (2)
其中,X(k)为k时刻目标状态向量,Z(k)为k时刻观测向量,F为状态转移矩阵,G为输入矩阵,H为观测矩阵,v(k)和w(k)分别为k时刻状态噪声和量测噪声,且为互不相关的高斯白噪声序列,其协方差矩阵分别为R(k)和Q(k);并初始化所建模型的状态转移矩阵F,观测矩阵H,输入矩阵G,目标状态向量X(k),观测向量Z(k),状态噪声协方差矩阵Q(k),量测噪声协方差矩阵R(k),协方差矩阵P(k),模型概率μi(k)以及模型i转到模型j的转移概率矩阵pij;
构建匀速运动模型(CV模型)和匀速转弯运动模型(CT模型)两种运动模型,作为交互多模型滤波器的模型集;
1.CV:匀速运动模型
取CV模型的目标状态向量则状态转移矩阵F,输入矩阵G和观测矩阵H分别为:
2.CT:匀速转弯运动模型
只考虑运动角速度ω已知的CT模型。则状态转移矩阵F,输入矩阵G和观测矩阵H分别为:
S202、模型条件重新初始化(输入交互):选取经过参数初始化处理的模型j(j=1,2),并输入k-1时刻的初始化状态,对模型j混合估计,得到重新初始化的状态和协方差阵按混合估计分别为;
其中,为归一化常数,Mi(k-1)是k-1时刻的匹配模型,μi(k-1)是k-1时刻模型i的概率,是k-1时刻模型i的状态估计,相应的协方差矩阵是Pi(k-1|k-1),Mi(k)是k时刻的模型,μij(k-1|k-1)表示模型i和模型j的混合概率;
S203、模型并行滤波:对k时刻第j个并行滤波器以及Z(k)作为输入进行卡尔曼滤波,计算出各个模型的状态估计和协方差阵Pj(k|k),具体计算包括以下步骤:
(1)预测:
(2)预测误差方差阵:
(3)卡尔曼增益:
(4)滤波:
(5)滤波误差方差
S204、模型概率更新:
其中,c为归一化常数,且而Λj(k)为观测Z(k)的似然函数,
Sj(k)=HPj(k|k-1)HT+R(k) (13)
S205、估计融合(输出交互):利用组合各滤波器得到k时刻目标状态的最终总体估计及其协方差矩阵P(k|k),具体的计算公式如下:
k时刻,交互多模型滤波器算法流程示意图如图3所示。
步骤3、利用步骤2中得到的k时刻的目标状态信息其中包括k时刻x和y方向上目标位置估计值和跟踪速度的估计值计算目标径向速度和径向距离,采用层次分析法,求取各个威胁度影响因素的权重,然后计算当前影响因素值的效用值从而得到目标下一个采样时刻的威胁度值;所述层次分析法是将复杂的问题分解成按支配关系分组而形成有序低阶层次结构中的不同因素,通过两两比较的方式确定层次结构中各因素的相对重要性,然后综合判断比较判断结果以确定各个因素相对重要性的总顺序;具体包括如下步骤:
S301、建立目标层次结构模型如图4所示;设目标威胁度为P,目标威胁度受以下评价因素的影响:
(1)目标敌我属性C1:分为我方、中立、敌方三种,分别用0,1,2表示;
(2)目标类型C2:将目标类型按照威胁程度的顺序划分为战术弹道导弹、大型机、小型机、武装直升机、诱饵这五类,分别用量化值9、7、6、4、2表示;
(3)目标径向距离C3:表示目标与无人机径向距离,距离越近,威胁度越大;
(4)目标径向速度C4:表示目标与无人机的径向速度,所述径向速度是指无人机和目标的相对速度矢量在无人机目标连线上的分量;正值表示目标向无人机靠近,负值表示目标远离无人机,径向速度越大,威胁度越高。
S302、构造P-C判断矩阵:
采用1-9标度法构造P-C判断矩阵,矩阵中元素aij表示影响因素Ci和Cj对P的影响之比,其含义如表1所示;表2显示了本发明中所涉及的判断矩阵;
表1 P-C判断矩阵含义
表2判断矩阵
a<sub>ij</sub> | C<sub>1</sub> | C<sub>2</sub> | C<sub>3</sub> | C<sub>4</sub> |
C<sub>1</sub> | 1 | a<sub>12</sub> | a<sub>13</sub> | a<sub>14</sub> |
C<sub>2</sub> | 1/a<sub>12</sub> | 1 | a<sub>23</sub> | a<sub>24</sub> |
C<sub>3</sub> | 1/a<sub>13</sub> | 1/a<sub>23</sub> | 1 | a<sub>34</sub> |
C<sub>4</sub> | 1/a<sub>14</sub> | 1/a<sub>24</sub> | 1/a<sub>34</sub> | 1 |
S303、计算各个影响因素的权重;
令权重向量W=[w1 w2 w3…wn],采用行和归一法计算每个影响因素的权重wi:
其中,n为所有影响因素的个数。
得到每个影响因素的权重后,对判断矩阵进行一致性检验,首先计算最大特征根λmax:
然后计算一致性指标CI:
CI=(λmax-n)/(n-1) (18)
根据影响因素个数n查找对应的随机一致性指标RI,随机一致性指标RI的值如下表:
表3随机一致性指标
阶数 | 1 | 2 | 3 | 4 | 5 | 6 | 7 | 8 | 9 |
RI | 0 | 0 | 0.58 | 0.90 | 1.12 | 1.24 | 1.32 | 1.41 | 1.45 |
最后计算一致性比例CR:
CR=CI/RI (19)
如果CR<0.1,则认为此判断矩阵通过一致性检验,wi可作为各个影响因素的权重;否则重新构造P-C判断矩阵,再次求解权重并进行随机一致性检验,直到通过为止。
S304、计算各个影响因素的效益值;
令目标当前影响因素向量为C=[C1 C2 C3...Cn],定义效益向量U=[u1 u2u3...un],下面给出ui的具体计算公式:
(1)如果影响因素Ci越大,目标威胁度越大,则ui的效用函数为:
(2)如果影响因素Ci越小,目标威胁度越大,则ui的效用函数为:
上面两式中:
Cimin=min{Ci},Cimax=max{Ci} (22)
本发明中目标径向距离越小,目标威胁度越大,效用计算采用式(21),其余三个影响因素均是值越大,威胁度越大,效益计算采用式(20)。
S305、计算目标威胁度值;
利用各个影响因素的权重向量W和目标当前效用向量U,即能够计算每个目标当前时刻的威胁度值:
σ=W*UT (23)
步骤4、设无人机匀速运动且速度大小已知,无人机路径规划采样时间间隔与目标采样时间间隔一样都为T,利用差分进化算法同时为多个无人机规划出下一个采样时刻满足无碰撞和无人机最大转弯角约束并使得目标联合探测概率最大、转弯角之和最小的路径;算法流程图如图5所示,具体包括如下步骤:
S401、初始化无人机位置种群;
定义第i(i=1,2,...,N)架无人机在kT时刻的位置为无人机起点的位置已知,初始的航向角已知;一架无人机在第k个采样时间间隔内的路径由无人机在kT时刻的位置和(k+1)T时刻的位置连接而成,一架无人机在(k+1)T时刻的航向角为从kT时刻位置到(k+1)T时刻位置的矢量方向;位置的表示方法如图6所示,图中为k-1时刻的位置,为k时刻的位置;以位置为极点,水平向右方向为极轴,逆时针为正方向,建立局部坐标系,位置可以用极角θ和极径ρ表示,由于无人机的速度和采样时间间隔均已知,极径ρ很容易算得,所以位置可以用一个变量极角θ来表示,因此,第i架无人机在kT时刻的位置可以用极角表示为θi,k;由此,N架无人机在kT时刻的位置可以由位置极角联合表示为θk=[θ1,k,θ2,k,...,θN,k],根据给定的多架无人机在初始时刻的位置(针对初次计算时),或者根据优化得到的多架无人机在当前时刻的位置,在满足无人机最大转弯角约束的前提下,为多无人机随机生成下一时刻的位置,多架无人机在下一时刻的位置联合表示为一个个体,随机生成多个个体组成初始位置种群。本发明采用相对编码的方式,将N架无人机在kT时刻的位置的解范围映射到[0,1]区间,即将θk=[θ1,k,θ2,k,...,θN,k]转换为xk=[x1,k,x2,k,...,xN,k],xi,k∈[0,1](i=1,2,...N),其中xi,k在[0,1]区间内随机生成。
S402、考虑无人机最大转弯角约束,在生成无人机下一时刻的位置之前,先对无人机位置范围进行限定;如图6中的阴影范围所示,k时刻的航向角限制在以k-1时刻航向角为轴心,小于等于转弯角最大值θres的范围内;通过计算得到满足最大转弯角约束的位置极角范围,压缩了解空间,从而达到加快算法收敛速度的目的;第i架无人机在kT时刻的位置θi,k须满足:
θi,k∈[θi,k-1-θres,θi,k-1+θres] (26)
S403、对位置的相对编码值进行解码,即将位置相对编码值xi,k对应到具体的极角θi,k,xi,k∈[0,1](i=1,2,...N);解码的方法如下:
θi,k=θi,k-1-θres+xi,k·2θres (27)
S404、对初始种群进行评价:
评价指标为目标函数值f和约束违反程度fcv;所述目标函数综合考虑对多个目标的联合探测概率和多架无人机的转弯角之和;所述对多个目标的联合探测概率是指对多个目标的探测概率加权和,权重为单个目标的威胁度占所有目标威胁度之和的比重;所述约束违反程度是指多无人机相互之间无碰撞约束的违反程度,具体是指无人机群里两两无人机之间的碰撞程度的平均值;所述碰撞程度用gij表示,具体的计算方法如下:
(1)根据N架无人机在kT时刻的位置θk=[θ1,k,θ2,k,...,θN,k],通过坐标转换计算得到N架无人机在笛卡尔坐标系下的位置:(xk,yk)=[(x1,k,y1,k),(x2,k,y2,k),...,(xN,k,yN,k)];
(2)求出两两无人机间的距离得到距离矩阵D=(dij)N×N,其中dij的计算公式如下:
其中,i=1,2,...,N,j=1,2,...,N,当i=j时,dij=0;
(3)根据设定的安全距离dsd,计算碰撞程度矩阵G=(gij)N×N,计算方法如下:当两两无人机间的距离小于给定的安全距离dsd时,即dij<dsd,gij=(dsd-dij)/dsd,否则gij=0,表示两者之间无碰撞;
本发明中的最优路径规划问题考虑两个约束条件:最大转弯角约束和无碰撞约束,该带约束的路径优化问题模型表述如下:
其中,1-f1表示k时刻N个无人机雷达对M个目标的联合探测概率的归一化加权和,f2表示k时刻N个无人机平均转弯角;μj,k表示k时刻目标j(j=1,2,...,M)的威胁权重,σj,k表示k时刻目标j威胁度,通过步骤3求出;θi,k表示第i架无人机在k时刻的位置的极角,pi,j表示第i(i=1,2,...,N)个无人机雷达对第j个目标的探测概率,pd0表示雷达的最大探测范围处的探测概率,pfa表示虚警概率,Rimax表示无人机雷达i的最大探测距离,rij表示无人机i与目标j的相对距离。
雷达虚警概率pfa为设定值,一般取10-6,10-7等几个常用数值,这里取pfa=10-7;的取值一般是根据雷达的不同用途而确定的,一般本发明中主要用于目标跟踪,取雷达的最大探测距离Rimax的计算根据雷达的用途不同也有不同,一般用于跟踪的相控阵雷达的探测范围为60~300km,本发明中取Rimax=100km。
所述约束违反程度fcv考虑无碰撞约束的违反程度,计算方法如下:
S405、记录初始种群的最佳个体;
若初始位置种群中存在约束违反程度fcv=0的个体,则在约束违反程度fcv=0的个体中选取目标函数值f最小的个体作为初始位置种群的最佳个体;若初始位置种群所有个体的约束违反程度fcv均大于0,则选取约束违反程度最小的个体作为初始种群的最佳个体;
S406、判断种群进化代数是否达到给定的最大进化代数,若未达到转S407,否则转S413;
S407、针对当前位置种群,首先通过变异、交叉操作产生新的个体;
S408、考虑最大转弯角约束,计算位置的角度范围,具体方法同S402;
S409、对新的个体进行解码,既将相对编码的量对应到具体的角度范围,具体方法同S403;
S410、对新生成的个体进行评价,具体方法同S404;
S411、通过选择操作在新个体和旧个体中留下较优者,作为当前种群的个体;选择操作的原则为:当两个个体的约束违反程度fcv相等时,留下目标函数值f较小的那个个体,当两个个体的约束违反程度fcv不相等时,留下约束违反程度fcv较小的那个个体;
S412、更新当前种群的最佳个体:将通过选择操作留下的个体与之前记录的种群最佳个体进行比较,比较方法与选择操作的原则相同,将两者中较优的个体作为当前种群的最佳个体,转S406;
S413、输出当前种群的最优个体,作为无人机群下一时刻的位置。
循环执行步骤2-4,得到无人机群在连续的多个采样时间间隔内的高质量路径。
综上所述,以上仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (6)
1.一种多无人机跟踪多机动目标的协同路径规划方法,其特征在于,包括如下步骤:
步骤1:初始化无人机和多机动目标的参数信息;
步骤2:通过交互多模型滤波器对多个机动目标的轨迹进行跟踪,预测下一个采样时刻各个目标的运动状态信息,包括各个目标的位置坐标和速度;
步骤3:综合考虑目标威胁度影响因素,利用层次分析法计算下一时刻各个目标的威胁度;
步骤4:基于各目标的运动状态信息和威胁度,利用差分进化算法同时为多架无人机规划出下一时刻的位置;
所述步骤4利用差分进化算法同时为多架无人机规划出下一时刻的位置,具体包括如下步骤:
S401、初始化无人机位置种群;
根据多架无人机当前时刻的位置坐标及航向角,在满足无人机最大转弯角约束的前提下,为多架无人机随机生成下一时刻的位置;多架无人机在下一时刻的位置联合表示为一个个体,随机生成多个个体组成初始位置种群;
S402、对初始位置种群进行评价;
评价指标包括目标函数值和约束违反程度;所述目标函数综合考虑对多个目标的联合探测概率和多架无人机的转弯角之和;所述约束违反程度是指多无人机相互之间无碰撞约束的违反程度;
S403、记录当前种群的最佳个体;
若初始位置种群中存在约束违反程度为0的个体,则在约束违反程度为0的个体中选取目标函数值最小的个体作为初始位置种群的最佳个体;若初始位置种群所有个体的约束违反程度均大于0,则选取约束违反程度最小的个体作为初始种群的最佳个体;
S404、针对初始位置种群中的每一个体,通过变异、交叉操作产生新的个体;
S405、按照步骤S402的方式对新个体进行评价;
S406、通过选择操作在新个体和产生该新个体的旧个体中留下较优者,作为当前种群;选择操作的原则为:当两者的约束违反程度相等时,留下目标函数值较小的个体,当两者的约束违反程度不相等时,留下约束违反程度较小的个体;
S407、更新当前种群的最佳个体:将通过选择操作留下的个体与之前记录的种群最佳个体进行比较,比较方法与选择操作的原则相同,将两者中较优的个体作为当前种群的最佳个体;
S408、针对当前种群,按照S404-S407的方式进行变异、交叉和选择操作的循环,并更新当前种群的最佳个体,直到达到给定的最大进化代数,即完成路径规划。
2.根据权利要求1所述多无人机跟踪多机动目标的协同路径规划方法,其特征在于,所述在执行步骤S401之前,对无人机当前位置进行编码,具体方法如下:
首先以第i,i=1,2,...N架无人机在当前时刻的位置为极点,水平向右方向为极轴,逆时针为正方向,建立局部极坐标系;其次将第i架无人机在当前时刻的位置用变量极角θi,k表示,N架无人机在当前时刻的位置联合表示为θk=[θ1,k,θ2,k,...,θN,k];再次将N架无人机在当前时刻的位置的解范围映射到[0,1]区间,即将θk=[θ1,k,θ2,k,...,θN,k]转换为xk=[x1,k,x2,k,...,xN,k]。
3.根据权利要求2所述多无人机跟踪多机动目标的协同路径规划方法,其特征在于,所述在S402中,所述无碰撞约束违反程度,具体的计算方法如下:
(1)根据N架无人机在当前时刻的位置θk=[θ1,k,θ2,k,...,θN,k],通过坐标转换计算得到N架无人机在笛卡尔坐标系下的位置:(xk,yk)=[(x1,k,y1,k),(x2,k,y2,k),...,(xN,k,yN,k)];
(2)求出两两无人机间的距离得到距离矩阵D=(dij)N×N;
(3)根据设定的安全距离dsd,计算碰撞程度矩阵G=(gij)N×N,计算方法如下:若dij≥dsd,则gij=0;若dij<dsd时,gij=(dsd-dij)/dsd。
4.根据权利要求2所述多无人机跟踪多机动目标的协同路径规划方法,其特征在于,所述S401和S404中,为满足无人机最大转弯角约束,在生成无人机下一时刻的位置之前,先对无人机位置范围进行限定:
第i架无人机在当前时刻的位置θi,k须满足:θi,k∈[θi,k-1-θres,θi,k-1+θres],其中θres表示无人机转弯角最大值,θi,k-1表示第i架无人机上一时刻的位置;
在S401和S404中,生成无人机位置的相对编码位置xi,k之后且在个体评价之前,对无人机位置的相对编量进行解码,即将无人机位置相对编码值xi,k对应到具体的极角θi,k,xi,k∈[0,1];解码的方式为:θi,k=θi,k-1-θres+xi,k·2θres。
5.根据权利要求1所述多无人机跟踪多机动目标的协同路径规划方法,其特征在于,所述用层次分析法计算威胁度,具体包括如下的步骤:
(1)基于目标威胁度的评价元素,建立目标威胁度单层次结构模型;
(2)基于所述结构模型,计算评价元素两两影响之比,构造两两比较判断矩阵;
(3)对判断矩阵一致性进行检验,通过一致性检验后得到各个评价元素的权重;
(4)计算各个评价元素的效益值;
(5)利用各个评价元素的权重和效益值,计算目标当前时刻的威胁度值。
6.根据权利要求5所述多无人机跟踪多机动目标的协同路径规划方法,其特征在于,所述步骤3中的层次分析法中建立的目标威胁度单层次结构模型,具体包括如下的评价元素:
(1)目标敌我属性:分为我方、中方、敌方三种;
(2)目标类型:将目标类型按照威胁程度的顺序划分为战术弹道导弹、大型机、小型机、武装直升机、诱饵这五类;
(3)目标径向距离:表示目标与无人机的径向距离;
(4)目标径向速度:表示目标与无人机的径向速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710234961.2A CN106873628B (zh) | 2017-04-12 | 2017-04-12 | 一种多无人机跟踪多机动目标的协同路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710234961.2A CN106873628B (zh) | 2017-04-12 | 2017-04-12 | 一种多无人机跟踪多机动目标的协同路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106873628A CN106873628A (zh) | 2017-06-20 |
CN106873628B true CN106873628B (zh) | 2019-09-20 |
Family
ID=59163000
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710234961.2A Active CN106873628B (zh) | 2017-04-12 | 2017-04-12 | 一种多无人机跟踪多机动目标的协同路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106873628B (zh) |
Families Citing this family (53)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107807671B (zh) * | 2017-11-27 | 2018-08-14 | 中国人民解放军陆军工程大学 | 无人机集群危险规避方法 |
CN108009361B (zh) * | 2017-12-03 | 2021-03-30 | 中国直升机设计研究所 | 一种直升机生存力设计方法 |
CN108153328B (zh) * | 2017-12-18 | 2020-04-14 | 北京理工大学 | 一种基于分段贝塞尔曲线的多导弹协同航迹规划方法 |
CN108319132B (zh) * | 2018-01-11 | 2021-01-26 | 合肥工业大学 | 用于无人机空中对抗的决策系统及方法 |
CN108319285A (zh) * | 2018-02-26 | 2018-07-24 | 厦门大学嘉庚学院 | 一种基于摄像头的四旋翼飞行器跟踪控制系统及方法 |
CN108594645B (zh) * | 2018-03-08 | 2021-02-19 | 中国人民解放军国防科技大学 | 单场站多无人机分配与飞行路线的规划方法及系统 |
CN108536171B (zh) * | 2018-03-21 | 2020-12-29 | 电子科技大学 | 一种多约束下多无人机协同跟踪的路径规划方法 |
CN108613676B (zh) * | 2018-03-27 | 2019-07-12 | 中国民用航空飞行学院 | 一种无人机和有人机协同机制下的应急搜救航迹规划方法 |
CN108509728B (zh) * | 2018-04-04 | 2019-02-19 | 西北工业大学 | 一种对海协同作战飞机生存力权衡设计方法 |
CN108919640B (zh) * | 2018-04-20 | 2020-04-03 | 西北工业大学 | 无人机自适应多目标跟踪的实现方法 |
CN108614580A (zh) * | 2018-06-22 | 2018-10-02 | 中国人民解放军国防科技大学 | 一种无人机目标跟踪中的分层避障控制方法 |
CN109242886B (zh) * | 2018-09-06 | 2021-03-12 | 中国人民解放军63921部队 | 一种空间集群目标运动轨迹建模与预报方法 |
CN109213198A (zh) * | 2018-09-11 | 2019-01-15 | 中国科学院长春光学精密机械与物理研究所 | 多无人机协同控制系统 |
CN109144110B (zh) * | 2018-09-14 | 2020-11-24 | 北京领云时代科技有限公司 | 一种无人机集群目标跟踪系统 |
CN109269352B (zh) * | 2018-09-20 | 2021-03-30 | 北京机械设备研究所 | 一种基于地面探测的无人机跟踪目标方法及系统 |
CN109270512B (zh) * | 2018-10-31 | 2023-03-28 | 北京无线电测量研究所 | 分布式相参合成雷达的调度方法及系统 |
CN109491402B (zh) * | 2018-11-01 | 2020-10-16 | 中国科学技术大学 | 基于集群控制的多无人机协同目标监视控制方法 |
CN109490941A (zh) * | 2018-12-29 | 2019-03-19 | 苏州瑞派宁科技有限公司 | 飞行探测装置、成像系统及其辐射探测方法 |
CN109693774B (zh) * | 2018-12-29 | 2020-11-03 | 中国科学院声学研究所 | 一种水下航行器轨迹的控制方法和系统 |
CN110244756B (zh) * | 2019-04-29 | 2021-09-24 | 福州大学 | 无人机快速追踪协同避障方法 |
CN110876275A (zh) * | 2019-04-30 | 2020-03-10 | 深圳市大疆创新科技有限公司 | 一种瞄准控制方法、移动机器人及计算机可读存储介质 |
CN110398980B (zh) * | 2019-06-05 | 2020-11-24 | 西安电子科技大学 | 一种无人机群协同探测及避障的航迹规划方法 |
CN110308740B (zh) * | 2019-06-28 | 2022-02-22 | 天津大学 | 一种面向移动目标追踪的无人机群动态任务分配方法 |
CN110426039B (zh) * | 2019-07-04 | 2023-06-09 | 中国人民解放军陆军工程大学 | 基于任务完成时间最小化的多无人机路径规划方法 |
CN110243377B (zh) * | 2019-07-19 | 2022-09-30 | 南京航空航天大学 | 一种基于分层式结构的集群飞行器协同导航方法 |
CN110618701B (zh) * | 2019-08-26 | 2022-09-30 | 中国人民解放军国防科技大学 | 用于目标跟踪的多无人机协同优化方法及系统 |
CN110632941B (zh) * | 2019-09-25 | 2020-12-15 | 北京理工大学 | 一种复杂环境下无人机目标跟踪的轨迹生成方法 |
CN110751266A (zh) * | 2019-09-26 | 2020-02-04 | 北航(四川)西部国际创新港科技有限公司 | 一种无人机轨迹预测模块及其预测方法 |
CN110865650B (zh) * | 2019-11-19 | 2022-12-20 | 武汉工程大学 | 基于主动视觉的无人机位姿自适应估计方法 |
CN110825112B (zh) * | 2019-11-22 | 2022-10-28 | 渤海大学 | 基于多无人机的油田动态侵入目标追踪系统与方法 |
CN111024081B (zh) * | 2019-12-01 | 2020-09-11 | 中国人民解放军军事科学院评估论证研究中心 | 一种无人机群对单移动时敏目标侦察路径规划方法 |
CN111553601B (zh) * | 2020-04-30 | 2022-10-21 | 北京理工大学 | 一种城市环境下协同探测系统的目标分配优化方法 |
CN111256682B (zh) * | 2020-05-07 | 2020-08-07 | 北京航空航天大学 | 不确定条件下的无人机群路径规划方法 |
CN111766901B (zh) * | 2020-07-22 | 2022-10-04 | 哈尔滨工程大学 | 多无人机协同目标分配攻击方法 |
CN112148008B (zh) * | 2020-09-18 | 2023-05-02 | 中国航空无线电电子研究所 | 一种基于深度强化学习的实时无人机路径预测方法 |
CN112396298B (zh) * | 2020-11-03 | 2023-08-04 | 中国直升机设计研究所 | 一种无人直升机多机协同任务规划方法 |
CN112880685A (zh) * | 2021-01-19 | 2021-06-01 | 中国人民解放军陆军边海防学院 | 无人机群对探测目标的联合定位方法 |
CN112748746B (zh) * | 2021-04-02 | 2021-07-16 | 北京三快在线科技有限公司 | 获取飞行器的飞行信息的方法、装置、设备及存储介质 |
CN113536528B (zh) * | 2021-05-14 | 2022-05-17 | 中国人民解放军军事科学院评估论证研究中心 | 一种无护航编队情况下预警机战术行为模拟方法及系统 |
CN113311867B (zh) * | 2021-05-28 | 2024-01-16 | 沈阳航空航天大学 | 一种多无人机协同多目标追踪的运动控制方法 |
CN113689501B (zh) * | 2021-08-26 | 2023-05-23 | 电子科技大学 | 一种基于收敛点的双机协同目标机定位跟踪控制方法 |
CN113885562B (zh) * | 2021-10-08 | 2023-01-10 | 北京理工大学 | 一种基于速度障碍的感知约束下多无人机协同避碰方法 |
CN113866762B (zh) * | 2021-11-04 | 2022-10-18 | 济钢防务技术有限公司 | 一种基于雷达探测信息的无人机威胁判定方法 |
CN114326759B (zh) * | 2021-12-06 | 2023-12-22 | 中国农业大学 | 多智能体编队控制方法、装置及多智能体系统 |
CN113985909A (zh) * | 2021-12-07 | 2022-01-28 | 北京和德宇航技术有限公司 | 一种卫星轨迹预测方法、装置、设备及存储介质 |
CN114326810B (zh) * | 2021-12-29 | 2023-05-30 | 中山大学 | 一种无人机在复杂动态环境下的避障方法 |
CN114553290A (zh) * | 2022-01-07 | 2022-05-27 | 西安理工大学 | 基于mimo结构的无线紫外光通信跟踪保持方法 |
CN114545968B (zh) * | 2022-02-18 | 2023-09-26 | 南京理工大学 | 基于纯方位定位的无人机集群多目标跟踪轨迹规划方法 |
CN114721423B (zh) * | 2022-03-15 | 2023-06-06 | 北京理工大学 | 考虑避碰约束的多无人机协同到达预置目标的分配方法 |
CN115097865B (zh) * | 2022-06-27 | 2023-09-22 | 中国人民解放军海军航空大学 | 一种多机编队避障的航迹规划方法 |
CN116048119B (zh) * | 2023-01-06 | 2023-10-13 | 扬州宇安电子科技有限公司 | 基于人工智能的无人机巡航监测系统及方法 |
CN117928559A (zh) * | 2024-01-26 | 2024-04-26 | 兰州理工大学 | 一种基于强化学习的威胁规避下无人机路径规划方法 |
CN117666624B (zh) * | 2024-01-31 | 2024-04-30 | 四川腾盾科技有限公司 | 一种固定翼无人机集群目标跟踪队形排列方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6718236B1 (en) * | 2003-04-29 | 2004-04-06 | The Mitre Corporation | Method for conducting a moving vehicle along a trajectory of a coordinated maneuver based on state information broadcast by other vehicles participating in the coordinated maneuver |
CN101136081B (zh) * | 2007-09-13 | 2010-06-02 | 北京航空航天大学 | 基于蚁群智能的无人作战飞机多机协同任务分配方法 |
CN103913172B (zh) * | 2013-12-06 | 2016-09-21 | 北京航空航天大学 | 一种适用于复杂低空下飞行器的路径规划方法 |
US9671790B2 (en) * | 2014-05-20 | 2017-06-06 | Verizon Patent And Licensing Inc. | Scheduling of unmanned aerial vehicles for mission performance |
CN104155999B (zh) * | 2014-07-31 | 2017-03-29 | 海南大学 | 战场环境下多无人机时敏任务动态分配方法 |
CN106406346B (zh) * | 2016-11-01 | 2019-04-16 | 北京理工大学 | 一种多无人机协同快速覆盖搜索航迹规划方法 |
-
2017
- 2017-04-12 CN CN201710234961.2A patent/CN106873628B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN106873628A (zh) | 2017-06-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106873628B (zh) | 一种多无人机跟踪多机动目标的协同路径规划方法 | |
CN111240353B (zh) | 基于遗传模糊树的无人机协同空战决策方法 | |
CN110608743B (zh) | 基于多种群混沌灰狼算法的多无人机协同航路规划方法 | |
CN107504972B (zh) | 一种基于鸽群算法的飞行器航迹规划方法及装置 | |
Zhang et al. | An improved constrained differential evolution algorithm for unmanned aerial vehicle global route planning | |
Fu et al. | Phase angle-encoded and quantum-behaved particle swarm optimization applied to three-dimensional route planning for UAV | |
CN112880688A (zh) | 基于混沌自适应麻雀搜索算法的无人机三维航迹规划方法 | |
CN105700555A (zh) | 一种基于势博弈的多无人机协同搜索方法 | |
CN113791634A (zh) | 一种基于多智能体强化学习的多机空战决策方法 | |
CN114330115B (zh) | 一种基于粒子群搜索的神经网络空战机动决策方法 | |
CN112947541B (zh) | 一种基于深度强化学习的无人机意图航迹预测方法 | |
Li et al. | Search-evasion path planning for submarines using the artificial bee colony algorithm | |
CN114003059B (zh) | 运动学约束条件下基于深度强化学习的uav路径规划方法 | |
CN113848974A (zh) | 一种基于深度强化学习的飞行器轨迹规划方法及系统 | |
CN115143970B (zh) | 一种基于威胁度评估的水下航行器避障方法和系统 | |
CN112733251A (zh) | 一种多无人飞行器协同航迹规划方法 | |
CN115903896A (zh) | 一种基于代理模型优化的多无人机路径规划方法 | |
CN112305913A (zh) | 基于直觉模糊博弈的多uuv协同动态机动决策方法 | |
CN115270928A (zh) | 一种无人机集群目标的联合跟踪方法 | |
CN113625767A (zh) | 一种基于优选信息素灰狼算法的固定翼无人机集群协同路径规划方法 | |
CN117029827A (zh) | 风雨条件下无人机航迹规划的方法及装置 | |
CN116698032A (zh) | 基于多目标自组织松鼠觅食机制的无人机航迹规划方法 | |
Leung et al. | Evaluating set measurement likelihoods in random-finite-set slam | |
CN116774721A (zh) | 多无人机博弈对抗的目标分配方法和系统 | |
CN114326826A (zh) | 多无人机队形变换方法及系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |