有效
一种胶囊机场部署与无人机区域扫描任务协同规划方法
石建迈、孙伟昌、黄金才、程光权、陈超、黄魁华
中国人民解放军国防科技大学
摘要
本发明实施例提供一种胶囊机场部署与无人机区域扫描任务协同规划方法,包括:根据扫描区域的形状规划无人机的飞行路径;将飞行路径划分为至少一条分段扫描路径;根据分段扫描路径集合中的各分段扫描路径与候选胶囊机场集合中的各胶囊机场之间的距离基于就近分配原则,将分段扫描路径分配给胶囊机场得到选中胶囊机场集合,将没有分配到分段扫描路径的胶囊机场组成未选中胶囊机场集合;根据所述选中胶囊机场集合、所述未选中胶囊机场集合和所述分段扫描路径集合基于邻域搜索方法确定出最终部署胶囊机场集合;根据所述最终部署胶囊机场集合部署胶囊机场,各胶囊机场分配得到分段扫描路径执行无人机区域扫描任务。
1.一种胶囊机场部署与无人机区域扫描任务协同规划方法,其特征在于,包括:根据扫描区域的形状规划无人机扫描所述扫描区域时的飞行路径;将所述飞行路径划分为至少一条分段扫描路径;其中,所有分段扫描路径构成分段扫描路径集合;根据所述分段扫描路径集合中的各分段扫描路径与候选胶囊机场集合中的各胶囊机场之间的距离基于就近分配原则,将分段扫描路径分配给胶囊机场得到选中胶囊机场集合,将没有分配到分段扫描路径的胶囊机场组成未选中胶囊机场集合;其中,所述候选胶囊机场集合由在所述扫描区域内部和/或外部的至少一个预设位置相应设置的胶囊机场构成;根据所述选中胶囊机场集合、所述未选中胶囊机场集合和所述分段扫描路径集合基于邻域搜索方法确定出最终部署胶囊机场集合;根据所述最终部署胶囊机场集合中的各胶囊机场部署所述扫描区域对应的胶囊机场,并根据所述最终部署胶囊机场集合中的各胶囊机场分配得到分段扫描路径执行无人机区域扫描任务。
2.如权利要求1所述的胶囊机场部署与无人机区域扫描任务协同规划方法,其特征在于,所述根据扫描区域的形状规划无人机扫描所述扫描区域时的飞行路径,包括:根据相机参数、相机视角和地面分辨率确定无人机的扫描宽度,根据所述无人机扫描宽度和预设的旁向重叠率得到无人机扫描间距;根据扫描区域的形状确定扫描方式,并根据所述扫描方式和所述无人机扫描间距规划出无人机扫描所述扫描区域时的飞行路径。
3.如权利要求2所述的胶囊机场部署与无人机区域扫描任务协同规划方法,其特征在于,所述根据相机参数、相机视角和地面分辨率确定无人机的扫描宽度,根据所述无人机扫描宽度和预设的旁向重叠率得到无人机扫描间距,包括:根据以下公式计算无人机飞行高度:其中:h为无人机飞行高度,f为镜头焦距,a为像元尺寸,GSD为地面分辨率;其中,所述相机参数包括镜头焦距和像元尺寸;根据无人机飞行高度和相机视角fov,并根据以下公式计算所述无人机扫描宽度W:其中:h为无人机飞行高度;通过所述无人机扫描宽度W以及所述旁向重叠率ω o ,根据以下公式计算出所述无人机扫描间距D:D=W(1-ω o )。
4.如权利要求1所述的胶囊机场部署与无人机区域扫描任务协同规划方法,其特征在于,所述将所述飞行路径划分为至少一条分段扫描路径,包括:按照预设的相等飞行距离将飞行路径划分为至少一条分段扫描路径。
5.如权利要求1所述的胶囊机场部署与无人机区域扫描任务协同规划方法,其特征在于,所述根据所述分段扫描路径集合中的各分段扫描路径与候选胶囊机场集合中的各胶囊机场之间的距离基于就近分配原则,将分段扫描路径分配给胶囊机场得到选中胶囊机场集合,包括:针对每个分段扫描路径,在所述候选胶囊机场集合中找到距离当前分段扫描路径最短的胶囊机场,并将当前分段扫描路径分配给找到的胶囊机场,由找到的胶囊机场构成第一胶囊机场集合;在所述分段扫描路径集合中找到距离各分段扫描路径各自分配到的胶囊机场最短的分段扫描路径j以及所述分段扫描路径j分配到的胶囊机场i,并解除所述胶囊机场i与除了分段扫描路径j之外的其他分段扫描路径之间的分配关系;在所述分段扫描路径集合中除了所述分段扫描路径j的其他分段扫描路径中找到距离所述胶囊机场i最短的的C-1条分段扫描路径,并将找到的C-1条分段扫描路径分配给所述胶囊机场i,将所述胶囊机场i加入到所述选中胶囊机场集合中,将所述胶囊机场i从所述第一胶囊机场集合中移除;重复执行以下步骤直到所述分段扫描路径集合中的分段扫描路径都分配给所述选中胶囊机场集合中的胶囊机场时停止:从所述第一胶囊机场集合中随机选择一个胶囊机场k,解除所有分段扫描路径与所述胶囊机场k的现有分配关系,从所述分段扫描路径集合中没有分配给所述选中胶囊机场集合中的胶囊机场的分段扫描路径中找出距离所述胶囊机场k最近的C条分段扫描路径,并将找到的C条分段扫描路径分配给所述胶囊机场k,将所述胶囊机场k加入选中胶囊机场集合中,将所述胶囊机场k从所述第一胶囊机场集合中移除;其中,C是每个胶囊机场能分配的分段扫描路径的最大数量。
6.如权利要求1所述的胶囊机场部署与无人机区域扫描任务协同规划方法,其特征在于,所述根据所述分段扫描路径集合中的各分段扫描路径与候选胶囊机场集合中的各胶囊机场之间的距离基于就近分配原则,将分段扫描路径分配给胶囊机场得到选中胶囊机场集合,包括:重复执行以下步骤直到所述分段扫描路径集合中的分段扫描路径都分配给所述选中胶囊机场集合中的胶囊机场时停止:针对在所述候选胶囊机场集合中但不在所述选中胶囊机场集合中的每个胶囊机场,从所述分段扫描路径集合中找到距离所述胶囊机场最近的C条分段扫描路径,并将找到的C条分段扫描路径分配给所述胶囊机场;在所述候选胶囊机场集合中找到胶囊机场与其分配的C条分段扫描路径的距离和值最小的胶囊机场,并将找到的胶囊机场添加到所述选中胶囊机场集合中。
7.如权利要求1所述的胶囊机场部署与无人机区域扫描任务协同规划方法,其特征在于,所述根据所述选中胶囊机场集合、所述未选中胶囊机场集合和所述分段扫描路径集合基于邻域搜索方法确定出最终部署胶囊机场集合,包括:计算所述选中胶囊机场集合的距离和值,作为初始和值,备份所述选中胶囊机场集合得到初始胶囊机场集合;从所述选中胶囊机场集合中随机选择一个胶囊机场P,从所述未选中胶囊机场集合中随机选择一个胶囊机场Q,将所述胶囊机场P从所述选中胶囊机场集合中移除,将所述胶囊机场Q加入所述选中胶囊机场集合;解除所述选中胶囊机场集合中的每个胶囊机场与其分段扫描路径的分配关系;针对所述分段扫描路径集合中的每条分段扫描路径,从所述选中胶囊机场集合中的已分配分段扫描路径条数小于C的胶囊机场中找到距离当前分段扫描路径最短的胶囊机场,将当前分段扫描路径分配给找到的胶囊机场;计算所述选中胶囊机场集合的距离和值,作为第一距离和值;如果所述第一距离和值小于所述初始和值,则将所述选中胶囊机场集合赋值给所述初始胶囊机场集合,将所述第一距离和值赋值给所述初始和值;否则,将所述初始胶囊机场集合赋值给所述选中胶囊机场集合,将所述初始和值赋值给所述第一距离和值;从所述选中胶囊机场集合中随机选择两个胶囊机场分别为胶囊机场S和胶囊机场T;相互交换分配给所述胶囊机场S和所述胶囊机场T的分段扫描路径;计算所述选中胶囊机场集合的距离和值,作为第二距离和值;如果所述第二距离和值小于所述初始和值,则将所述选中胶囊机场集合赋值给所述初始胶囊机场集合,将所述第二距离和值赋值给所述初始和值;否则,将所述初始胶囊机场集合赋值给所述选中胶囊机场集合,将所述初始和值赋值给所述第二距离和值;如果不满足预设的第一迭代终止条件,则回到所述从所述选中胶囊机场集合中随机选择两个胶囊机场分别为胶囊机场S和胶囊机场T的步骤执行;否则,如果不满足预设的第二迭代终止条件,则回到所述从所述选中胶囊机场集合中随机选择一个胶囊机场P,从所述未选中胶囊机场集合中随机选择一个胶囊机场Q,将所述胶囊机场P从所述选中胶囊机场集合中移除,将所述胶囊机场Q加入所述选中胶囊机场集合的步骤执行;否则,将所述初始胶囊机场集合作为所述最终部署胶囊机场集合;其中,选中胶囊机场集合的距离和值为将选中胶囊机场集合中的所有胶囊机场与其各自的分段扫描路径的距离求和。
8.如权利要求2所述的胶囊机场部署与无人机区域扫描任务协同规划方法,其特征在于,所述根据扫描区域的形状确定扫描方式,并根据所述扫描方式和所述无人机扫描间距规划出无人机扫描所述扫描区域时的飞行路径,包括:获取所述扫描区域的边界范围,计算所述扫描区域的周长和面积,并计算圆形度;若所述圆形度大于等于0.86,选择螺旋式扫描方式,以所述无人机扫描间距作为螺旋间距,计算得到螺旋式扫描路径的长度;若所述圆形度小于0.86,则选择割草式扫描方式;通过向量叉乘法判断覆盖区域的凸凹性,若为凹多边形,利用Graham-Scan算法,生成凹多边形的凸包,利用最小跨度法找到凸包的长轴,利用梯形分解法,沿与长轴平行方向将凹多边形分解为多个凸多边形子区域,沿每个凸多边形子区域长轴方向,采用割草式扫描方式遍历整个当前的凸多边形子区域,计算得到各凸多边形子区域内飞行路径的起点和终点,以就近方式依次连接各个凸多边形子区域飞行路径的起点和终点,得到无人机的所述飞行路径。



