发明名称 带通信约束的多无人机协同搜索中的目标分配方法
摘要 本发明提供了一种带通信约束的多无人机协同搜索中的目标分配方法,控制多无人机对一片未知区域的目标进行搜索,在考虑通信约束条件影响的情况下,对搜索到的目标进行目标分配,并由分配目标的无人机飞至目标进行目标确认,使多无人机能够协同完成对多目标的搜索和确认任务。
申请公布号 CN103246289A 申请公布日期 2013.08.14
申请号 CN201310165113.2 申请日期 2013.05.07
申请人 西北工业大学 发明人 符小卫;李建;高晓光;刘学全
分类号 G05D1/12(2006.01)I 主分类号 G05D1/12(2006.01)I
代理机构 西北工业大学专利中心 61204 代理人 顾潮琪
主权项 1.一种带通信约束的多无人机协同搜索中的目标分配方法,其特征在于包括下述步骤:步骤1:设置无人机的初始位置为(x<sub>i</sub>,y<sub>i</sub>),i=1,2,…,n,其中n是无人机的数量;设置目标的初始位置为(x<sup>j</sup>,y<sup>j</sup>),j=1,2,…,m,其中m是目标的数量;设置无人机的最大探测距离r<sub>s</sub>、最大通信距离r<sub>c</sub>和通信角度约束θ<sub>c</sub>;设置无人机的初始状态设置为空闲,目标初始状态设置为空闲,发现目标数量初始值为0;步骤2:设定计数器初始值为1;步骤3:判断无人机i是否发现目标j,即<img file="FDA00003153662200011.GIF" wi="632" he="105" />若是,转到步骤4;若否,转到步骤6;步骤4:判断目标j状态是否为空闲,若是,转到步骤5;若否,转到步骤6;步骤5:判断无人机i状态是否为空闲,若是,转到步骤7;若否,转到步骤10;步骤6:无人机i继续执行搜索任务,前进一个算法的执行步长,转到步骤12;所述的执行搜索任务是以随机搜索的方式对任务区域内的目标进行搜索,无人机在任务区域内以航向角沿直线飞行,直到到达搜索边界时,无人机转弯,再次进入搜索区域,按照运动模型得到以一个新的航向角,继续沿直线飞行;所述的运动模型是在无人机的飞行速度和高度保持恒定的二维平面内:<img file="FDA00003153662200012.GIF" wi="515" he="612" />其中,v是无人机的速度,<img file="FDA00003153662200013.GIF" wi="49" he="58" />是无人机的航向角,<img file="FDA00003153662200014.GIF" wi="288" he="72" />g是重力加速度,n<sub>0</sub>是无人机的过载,n<sub>x</sub>、n<sub>y</sub>是n<sub>0</sub>在x方向和y方向的分量,无人机在飞行时所承受的过载不能超过额定最大值,无人机在转弯时始终以最小转弯半径R<sub>min</sub>转弯;步骤7:判断无人机i通信约束内是否有其他无人机,若是,向通信约束内的其他无人机发送数据串P,然后接收来自它们返回的数据串Q,转到步骤8;若否,转到步骤9;所述的通信约束是限定无人机间通信必须限制在通信距离r<sub>c</sub>和通信角度θ<sub>c</sub>范围内;所述的数据串P为<img file="FDA00003153662200021.GIF" wi="581" he="88" />其中,A<sub>i</sub>表示发现目标的无人机序号,T<sub>k</sub>表示发现的目标序号,包含目标的坐标信息,t为发现时间,<img file="FDA00003153662200022.GIF" wi="72" he="81" />为无人机i飞到目标k的代价,<img file="FDA00003153662200023.GIF" wi="991" he="230" />其中,d是搜索区域的宽度,α是距离和角度的权重系数;当无人机j接收到无人机i的信息后,将返回数据串<img file="FDA00003153662200024.GIF" wi="541" he="96" />步骤8:判断无人机i飞往发现目标j的代价是否最小,若是,转到步骤9;若否,将目标分配给代价最小的无人机,转到步骤6;步骤9:将发现的目标j分配给无人机i,无人机i和目标j的状态改为忙碌;步骤10:无人机i向目标j前进一个步长;步骤11:判断无人机i是否确认目标j,即<img file="FDA00003153662200025.GIF" wi="642" he="105" />若是,无人机i状态改为空闲,发现目标数量值加1,转到步骤12;若否,直接转到步骤12;其中,r<sub>0</sub>是允许到达误差;步骤12:计数器值加1,判断计数器值是否不大于n,若是,转到步骤3;若否,转到步骤13;步骤13:判断是否所有目标都被发现,即发现目标数量值是否等于目标数量m,若是,结束任务;若否,转到步骤2。
地址 710072 陕西省西安市友谊西路127号
您可能感兴趣的专利