【技术实现步骤摘要】
控制无人机进行避让操作的方法、装置、设备及存储介质
[0001]本专利技术涉及无人机协同控制
,特别涉及是一种控制无人机进行避让操作的方 法、装置、设备以及存储介质。
技术介绍
[0002]由于无人机具有非接触式操作的优点,且能够灵活完成许多与日常生活相关的运输、检 查和表演等任务,因此无人机的相关应用在当下越来越有吸引力。人们期望无人机能够进入 城市低空空域为城市居民的日常生活提供更多支撑。在城市低空空域复杂环境中广泛运用无 人机,需要解决的关键问题之一是无人机在空中运行时的空域冲突检测和消解,以保证多个 无人机在执行任务时保持安全间隔,高效完成任务。
[0003]当前研究人员在分散式冲突消解问题上的研究取得了很多富有成效的研究成果。目前的 方法主要有反应式方法与分布式协调优化方法,反应式方法是基于运动物体之间保持安全间 距的约束条件设计的飞行协调方法,较少考虑到无人机所执行的任务,基于这类方法生成的 冲突消解策略通常会使无人机航迹产生较大幅度的偏差,客观上导致无人机任务效率低,且 会造成空中交通混乱。分布式协调优化方法,主要有基于互惠式的速度障碍方法以及最优互 惠式避撞方法,虽然能够在单次调节中让无人机尽量减少机动幅度,但是当大量无人机发生 冲突时仍然会因为短视造成空中交通混乱的局面,因此当空中无人机数量较多时该方法仍然 无法有效降低无人机的总体避让消耗。
技术实现思路
[0004]基于此,本专利技术的目的在于,提供一种控制无人机进行避让操作的方法、装置、设备以 及存储介质,具体如下 ...
【技术保护点】
【技术特征摘要】
1.一种控制无人机进行避让操作的方法,其特征在于,包括以下步骤:获取目标无人机以及相邻无人机的状态信息,其中,所述状态信息包括飞行角度、飞行速度以及位置坐标;根据所述目标无人机和相邻无人机的状态信息,构建碰撞锥区域,并计算所述碰撞锥区域的边界值;根据所述目标无人机和相邻无人机的状态信息、边界值以及预设的运动模型,获取所述目标无人机与相邻无人机的冲突消解结果;根据所述冲突消解结果,控制所述目标无人机和相邻无人机进行避让操作。2.根据权利要求1所述的控制无人机进行避让操作的方法,其特征在于,所述根据所述目标无人机和相邻无人机的状态信息,构建碰撞锥区域,并计算所述碰撞锥区域的边界值,包括步骤:根据所述目标无人机与相邻无人机的位置坐标以及复合安全距离计算算法,获取复合安全距离,其中,所述安全距离约束方程为:r
s
‑
||P
i
(t)
‑
P
j
(t)||≤0式中,r
s
为所述复合安全距离,r
s
=max(r
i
,r
j
),r
i
与r
j
分别所述目标无人机与相邻无人机的安全半径;P
i
(t)、P
j
(t)分别为所述目标无人机与相邻无人机的位置坐标,||.||是欧几里得范数;根据所述目标无人机和相邻无人机的位置坐标、复合安全距离以及预设的边界值计算算法,获取所述碰撞锥区域的边界值,其中,所述边界值计算算法为:式中,k为所述边界值,包括第一边界值k1以及第二边界值k2;为所述目标无人机相对于所述相邻无人机的位置坐标的横向分量,为所述目标无人机相对于所述相邻无人机的位置坐标的纵向分量,r
s
为安全距离,r
s
=max(r
i
,r
j
),r
i
与r
j
分别所述目标无人机与相邻无人机的安全半径。3.根据权利要求1所述的控制无人机进行避让操作的方法,其特征在于,所述根据所述目标无人机和相邻无人机的状态信息、边界值以及预设的运动模型,获取所述目标无人机与相邻无人机的冲突消解结果,包括步骤:根据所述目标无人机和相邻无人机的状态信息,获取所述目标无人机和相邻无人机的机间关系标识,所述机间关系标识包括既有冲突以及潜在冲突,以及获取与所述既有冲突相关联的飞行权;根据所述目标无人机和相邻无人机的机间关系标识以及与所述既有冲突相关联的飞行权,将所述目标无人机和相邻无人机的状态信息和边界值输入至所述运动模型中的机动角度关系式,分别获取第一机动角度约束和第二机动角度约束,所述第一机动角度约束为与所述既有冲突相关联的目标无人机与相邻无人机的机动角度约束,所述第二机动角度约束为与所述潜在冲突相关联的目标无人机与相邻无人机的机动角度约束,其中,所述机动角度关系式为:
式中,k为所述边界值,v
i
为所述目标无人机的飞行速度,v
j
为所述相邻无人机的飞行速度,φ
i
为所述目标无人机的飞行角度,φ
j
为所述相邻无人机的飞行角度,为所述目标无人机的机动角度,为所述相邻无人机的机动角度;根据所述目标无人机和相邻无人机的第一机动角度约束以及第二机动角度约束,求解所述第一机动角度约束与第二机动角度约束的重合部分,获取所述目标无人机与相邻无人机的冲突消解结果,其中,所述冲突消解结果包括冲突消解成功结果以及冲突消解失败结果。4.根据权利要求1所述的控制无人机进行避让操作的方法,其特征在于:所述既有冲突包括汇合冲突、正面冲突以及超越冲突,所述与所述既有冲突相关联的飞行权包括第一飞行权以及第二飞行权,所述第一飞行权为与所述汇合冲突相关联的飞行权,所述第二飞行权为与所述超越冲突相关联的飞行权。5.根据权利要求4所述的控制无人...
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。