CN116225064A - 一种密集无人机避障与冲突消解方法及装置 - Google Patents

一种密集无人机避障与冲突消解方法及装置 Download PDF

Info

Publication number
CN116225064A
CN116225064A CN202310294712.8A CN202310294712A CN116225064A CN 116225064 A CN116225064 A CN 116225064A CN 202310294712 A CN202310294712 A CN 202310294712A CN 116225064 A CN116225064 A CN 116225064A
Authority
CN
China
Prior art keywords
unmanned aerial
aerial vehicle
force
potential field
obstacle
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.)
Pending
Application number
CN202310294712.8A
Other languages
English (en)
Inventor
杨健
方璨琦
杨帆
韩家乐
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
South China University of Technology SCUT
Original Assignee
South China University of Technology SCUT
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by South China University of Technology SCUT filed Critical South China University of Technology SCUT
Priority to CN202310294712.8A priority Critical patent/CN116225064A/zh
Publication of CN116225064A publication Critical patent/CN116225064A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • G05D1/106Change initiated in response to external conditions, e.g. avoidance of elevated terrain or of no-fly zones
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/10Internal combustion engine [ICE] based vehicles
    • Y02T10/40Engine management systems

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)
  • Traffic Control Systems (AREA)

Abstract

本发明公开了一种密集无人机避障与冲突消解方法及装置,其中方法包括:确认初始信息,所述初始信息包括各无人机信息以及障碍物信息;建立空间均匀网格,将无人机信息和障碍物信息映射到空间均匀网格中;构建人工势场函数,根据人工势场函数获取人工势场力;引入核函数对人工势场力的影响进行加权调整;引入作用于无人机速度法线方向的调整力;引入一个无人机靠近目标时的调整系数,结合加权调整后的人工势场力和调整力计算合力。本发明能够在无人机数量足够大的前提下,保证无人机飞行安全和整体的计算效率,并满足各自的飞行任务要求。本发明可广泛应用于无人机协同控制技术领域。

Description

一种密集无人机避障与冲突消解方法及装置
技术领域
本发明涉及无人机协同控制技术领域,尤其涉及一种密集无人机避障与冲突消解方法及装置。
背景技术
现代无人机具有小巧、灵活、易于控制等特点,可以探索人类无法抵达或者存在危险的区域,在军事领域具有重要地位,而无人机负载能力的提升也为运输业、农业提供了一种崭新的发展方式,其中的无人机快递服务近些年一直是一个热门的话题。由于单一无人机续航、视野、负载等限制,相关科研工作的重点往往集中在无人机集群,而随着近些年无人机技术的高速发展,同一个空域下同时执行任务的无人机数量也在不断增加,从而使得集群进行障碍躲避以及无人机之间冲突消解的难度越来越大。目前常用的避障与冲突消解算法包括最优化理论、人工势场法和神经网络法。相比最优化方法的计算量大以及神经网络法的难以训练问题,人工势场法原理简单、易于理解、时效性高,而且路径光滑,在解决相应问题中往往处于首选地位。但传统的人工势场法存在容易陷入局部最优点以及无法达到目标两大问题,而且计算效率也会随着无人机数量的增加而快速降低。
发明内容
为至少一定程度上解决现有技术中存在的技术问题之一,本发明的目的在于提供一种密集无人机避障与冲突消解方法及装置。
本发明所采用的技术方案是:
一种密集无人机避障与冲突消解方法,包括以下步骤:
确认初始信息,所述初始信息包括各无人机信息以及障碍物信息;
建立空间均匀网格,将无人机信息和障碍物信息映射到空间均匀网格中;
构建人工势场函数,根据人工势场函数获取人工势场力;
引入核函数对人工势场力的影响进行加权调整;
引入作用于无人机速度法线方向的调整力;
引入一个无人机靠近目标时的调整系数,结合加权调整后的人工势场力和调整力计算合力。
进一步地,所述建立空间均匀网格,将无人机信息和障碍物信息映射到空间均匀网格中,包括:
构建空间均匀网格,将整个飞行空域分为N个独立的网格空间,每个网格空间的大小介于无人机的通讯范围与安全距离之间;
将无人机的实际空间坐标转换到网格坐标,计算得到所处网格的索引,并存入集合中。
进一步地,所述构建人工势场函数,根据人工势场函数获取人工势场力,包括:
构建无人机与目标点之间的引力势场函数;
构建无人机与障碍物之间的斥力势场函数;
构建无人机之间的斥力势场函数;
根据构建的势场函数,计算势场函数的负梯度得到对应的势场力。
进一步地,所述根据构建的势场函数,计算势场函数的负梯度得到对应的势场力,包括:
计算目标点对无人机的引力势场Uatt以及目标点对无人机的吸引力Fatt
Figure BDA0004142743390000021
Figure BDA0004142743390000022
式中,katt为引力系数,q为无人机的当前位置,qgoal表示无人机的目标位置,d*为目标点对无人机吸引力增加的有效距离;
计算障碍物对无人机的斥力势场Urep以及障碍物对无人机的斥力Frep
Figure BDA0004142743390000023
Figure BDA0004142743390000024
式中,krep为斥力系数,q为无人机的当前位置,qobs表示障碍物的位置,dr为障碍物对无人机有斥力影响的有效距离;
计算无人机之间的斥力势场Ui以及对应的斥力Fi
Figure BDA0004142743390000031
Figure BDA0004142743390000032
式中,kc为无人机间的斥力系数,qi为受力无人机的当前位置,qj表示邻居施力无人机的当前位置,T为设置的无人机的最大影响距离。
进一步地,所述引入核函数对人工势场力的影响进行加权调整,包括:
引入核函数对无人机之间的斥力进行加权调整,加权后所得到无人机所受的斥力Fc为:
Figure BDA0004142743390000033
/>
式中,αi为当前无人机位置的密集系数,αj为邻居施力无人机所处位置的密集系数,qi为受力无人机的当前位置,qj表示邻居施力无人机的当前位置,R为设置的无人机的最大影响距离,Wspiky(r,h)为计算所使用的核函数。
进一步地,形如W(r,h)的函数为加权使用的核函数,第一项输入为该输入离核函数中心的距离,第二项输入为核函数所使用的半径,大小应与无人机之间的最大影响距离相等。所述核函数Wspiky(r,h)与Wpoly6(r,h)分别为:
Figure BDA0004142743390000034
Figure BDA0004142743390000035
其中,r为输入到核函数中心的距离,h为核函数所使用的半径。
进一步地,密集系数α的表达式为:
Figure BDA0004142743390000036
式中,q为计算密集系数的目标位置,qi表示当前网格与邻居网格所有无人机的当前位置,R为设置的无人机的最大影响距离,Wpoly6(r,h)为计算所使用的核函数。
进一步地,所述引入作用于无人机速度法线方向的调整力,包括:
当无人机受到的吸引力与无人机受到的斥力满足相互平衡的条件,且此时速度减小为0时,系统陷入局部最优点。故引入一个沿原速度法线方向的调整力,使无人机脱离原有的局部最优点;
所述调整力Fadj的大小为:
Figure BDA0004142743390000041
式中,θ为吸引力Fatt与斥力Frep的夹角,此时的Frep为合斥力,ka为调整力大小的缩放系数,ks为调整力变化的敏感系数,ε为预设常量;
其中,取无人机弹道坐标系的Z轴方向作为调整力Fadj的所在方向。
进一步地,所述引入一个无人机靠近目标时的调整系数,求得合力,包括:
当无人机的目标位置与障碍物之间的距离非常小时,由于斥力的存在,无人机永远都无法抵达目标点。因此,引入一个调整系数μ,对斥力进行缩放处理,从而使无人机脱离障碍物的影响到达目标位置;
所述调整系数μ为:
Figure BDA0004142743390000042
式中,dμ为调整系数μ作用的有效距离,q为无人机的当前位置,qgoal表示无人机的目标位置
根据所述调整系数μ,获取应用到无人机上的最终合力F:
F=Fatt+Fc+μ(Frep+Fadj)
式中,Fatt为目标点对无人机的吸引力,Fc为无人机之间加权过的斥力,μ为调整系数,Frep为障碍物对无人机的斥力,Fadj为速度法线方向的调整力。
根据权利要求1所述的一种密集无人机避障与冲突消解方法,其特征在于,所述初始信息具体包括:总的无人机个数n,每一个无人机的初始位置q,每一个无人机的初始速度v0,每一个无人机的目标位置qgoal;所有障碍物的位置坐标qobs以及其作用范围dr
本发明所采用的另一技术方案是:
一种密集无人机避障与冲突消解装置,包括:
至少一个处理器;
至少一个存储器,用于存储至少一个程序;
当所述至少一个程序被所述至少一个处理器执行,使得所述至少一个处理器实现上所述方法。
本发明的有益效果是:本发明通过使用空间均匀网格,保证密集无人机空域下系统的计算效率;通过设计并利用人工势场提供的势场力,确保每一个无人机能够有效躲避障碍与其他无人机,前往目的地执行任务;通过使用核函数对无人机之间的斥力进行加权,可以缓解无人机过于密集时人工势场法轨迹不稳定的情况,实现更平滑稳定的效果;通过引入作用于速度法线方向的调整力、以及作用于斥力与调整力上的调整系数,解决人工势场法存在局部最优点以及目标不可达的问题。
附图说明
为了更清楚地说明本发明实施例或者现有技术中的技术方案,下面对本发明实施例或者现有技术中的相关技术方案附图作以下介绍,应当理解的是,下面介绍中的附图仅仅为了方便清晰表述本发明的技术方案中的部分实施例,对于本领域的技术人员而言,在无需付出创造性劳动的前提下,还可以根据这些附图获取到其他附图。
图1是本发明实施例中一种密集无人机避障与冲突消解方法的步骤流程图;
图2是本发明实施例中空间均匀网格法的示意图;
图3是本发明实施例中人工势场法原理示意图;
图4是本发明实施例中Poly6核函数、Spiky核函数的函数示意图;
图5是本发明实施例中人工势场法局部最优与目标不可达示意图;
图6是本发明实施例中无人机运行轨迹示意图;
图7是本发明实施例中无人机与障碍物的最小距离-时间曲线图;
图8是本发明实施例中无人机之间的最小距离-时间曲线图。
具体实施方式
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,仅用于解释本发明,而不能理解为对本发明的限制。对于以下实施例中的步骤编号,其仅为了便于阐述说明而设置,对步骤之间的顺序不做任何限定,实施例中的各步骤的执行顺序均可根据本领域技术人员的理解来进行适应性调整。
在本发明的描述中,需要理解的是,涉及到方位描述,例如上、下、前、后、左、右等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。
在本发明的描述中,若干的含义是一个或者多个,多个的含义是两个以上,大于、小于、超过等理解为不包括本数,以上、以下、以内等理解为包括本数。如果有描述到第一、第二只是用于区分技术特征为目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量或者隐含指明所指示的技术特征的先后关系。
本发明的描述中,除非另有明确的限定,设置、安装、连接等词语应做广义理解,所属技术领域技术人员可以结合技术方案的具体内容合理确定上述词语在本发明中的具体含义。
如图1所示,本实施例提供一种密集无人机避障与冲突消解方法,能够在无人机数量足够大的前提下,保证无人机飞行安全和整体的计算效率,并满足各自的飞行任务要求。该方法具体包括以下步骤:
S1、确认初始信息,初始信息包括各无人机信息以及障碍物信息。
确认初始信息,包括各无人机初始信息以及障碍物的信息。具体的初始信息包括为:总的无人机个数n,每一个无人机的初始位置q,每一个无人机的初始速度v0,每一个无人机的目标位置qgoal;所有障碍物的位置坐标qobs以及其作用范围dr。建立无人机集合{A1,A2,…An},每一个无人机Ai应包含其对应的实时位置、实时速度、以及无人机执行任务的目标位置,然后将所有的无人机的初始信息写入无人机集合中。
S2、建立空间均匀网格,将无人机信息和障碍物信息映射到空间均匀网格中。
建立空间均匀网格,将整个飞行空域分为N个独立的网格空间,每一个独立的网格空间大小不得超过无人机的通讯距离,同时也不能小于无人机之间的安全距离。如图2所示,中心区域的无人机进行查询计算时,虽然其通讯距离可以覆盖整个截取的区域,但是由于空间网格的存在,查询范围只需要在整个邻居网格即可,这在无人机飞行的密集空域情况下可以大幅提高系统的计算效率。每回合开始,将每一个无人机的实际空间坐标转换到网格坐标中,通过计算求得所处网格的索引,并存入对应集合中保存,完成对网格空间的一次更新。
S3、构建人工势场函数,根据人工势场函数获取人工势场力。
如图3所示,人工势场法的基本思想是将复杂的环境转化成一个假想的势场,目标点产生的吸引力Fatt与障碍物产生的斥力Frep共同作用在无人机上,总的合外力F控制无人机的运动状态。无人机在目标点吸引力的作用下朝着目标运动,并且在靠近障碍物时,由于斥力的存在,无人机会绕开障碍,实现避障目的。同时,无人机与无人机之间也存在势场,当无人机之间的间距小于斥力影响距离时,无人机会产生斥力来促使彼此相互远离,实现冲突消解的目的。在本实施例中,需要设计目标点、障碍物以及无人机之间的势场函数U,根据势场力的计算公式
Figure BDA0004142743390000075
计算其势场的负梯度,从而得到对应的势场力F。
其中,步骤S3具体包括步骤S31-S33:
S31、构建的无人机受到来自目标点的引力势场Uatt定义如下:
Figure BDA0004142743390000071
其中,katt为引力系数,q为无人机的当前位置,qgoal表示无人机的目标位置,d*为目标点对无人机吸引力增加的有效距离。
根据负梯度公式,求得目标点对无人机的吸引力Fatt如下:
Figure BDA0004142743390000072
当无人机与目标点之间的距离大小于等于有效距离d*时,无人机受到的吸引力与两者之间的距离成正比,距离越大,受到的吸引力也就越大;当无人机与目标点之间的距离大于有效距离d*时,无人机受到的力为一个常量,这可以有效避免无人机离目标较远时吸引力过大的问题。
S32、构建的无人机受到来自障碍物的斥力势场Urep定义如下:
Figure BDA0004142743390000073
其中,krep为斥力系数,q为无人机的当前位置,qobs表示障碍物的位置,dr为障碍物对无人机有斥力影响的有效距离。
根据负梯度公式,求得障碍物对无人机的斥力Frep如下:
Figure BDA0004142743390000074
当无人机进入障碍物斥力的影响范围dr时,彼此距离越接近,无人机受到的斥力就越大,极端情况下如果无人机撞上障碍物,其所受的斥力将会变得无穷大。
S33、构建的无人机之间的斥力势场Ui定义如下:
Figure BDA0004142743390000081
其中,kc为无人机间的斥力系数,qi为受力无人机的当前位置,qj表示邻居施力无人机的当前位置,R为设置的无人机的最大影响距离。
由于S2空间均匀网格的存在,qj只需要在邻居网格中进行查找,二维空间对应9个网格,三维则对应27个。无人机之间的斥力势场与障碍物对无人机的斥力势场大致相同,根据负梯度公式,求得无人机之间的斥力Fi如下:
Figure BDA0004142743390000082
/>
无人机之间的距离越小,对应受到的斥力就越大;当两个无人机无限接近或者相撞时,其所受的斥力同样会变得无穷大。
S4、引入核函数对人工势场力的影响进行加权调整。
为使得密集区域的无人机冲突消解效果更加平滑稳定,需要引入核函数对无人机之间的斥力进行加权调整。加权后所得到无人机所受的斥力Fc为:
Figure BDA0004142743390000083
其中,αi为当前无人机位置的密集系数,αj为邻居施力无人机所处位置的密集系数,qi为受力无人机的当前位置,qj表示邻居施力无人机的当前位置,R为设置的无人机的最大影响距离。Wspiky(r,h)为计算所使用的核函数。
所述密度系数α具体的计算方式为:
Figure BDA0004142743390000084
其中,q为计算密集系数的目标位置,qi表示当前网格与邻居网格所有无人机的当前位置,R为设置的无人机的最大影响距离,Wpoly6(r,h)为计算所使用的核函数。
与无人机之间的斥力计算只需要搜索邻居无人机不同,因为密度系数代表的是当前区域的密集程度,所以区域中心的无人机也要参与计算。计算出的密集系数越大,代表该区域的无人机的密集程度就越大,无人机继续前往该区域的安全隐患就越高。
加权得到的Fc总共由三个部分组成。第一个部分为所需要加权的斥力Fi;第二个部分为密集系数构成的权重项
Figure BDA0004142743390000091
如果安全范围内无人机j的密集系数αj要小于计算中心无人机的密集系数αi,那么无人机j所在的区域相对于中心无人机所在的区域是相对安全的,即存在向无人机j方向进行冲突消解的可能。相反,如果无人机j的密集系数αj要大于计算中心无人机的密集系数αi,那么继续前往无人机j所在的区域是不被鼓励的,所以需要对彼此间的斥力放大;第三个部分/>
Figure BDA0004142743390000092
则代表核函数所作用的具体权重值。将三个部分结合起来,即得到所述Fc
形如W(r,h)的函数为加权使用的核函数,第一项输入为该输入离核函数中心的距离,第二项输入为核函数所使用的半径,大小应与无人机之间最大影响距离相等。所述核函数Wspiky(r,h)与Wkoly6(r,h)分别为:
Figure BDA0004142743390000093
Figure BDA0004142743390000094
其中r为输入到核函数中心的距离,h为核函数所使用的半径。
Ws9iky(r,h)与Wpoly6(r,h)的函数图像如图4所示,其等效于一个中间突起概率密度函数。核函数Wpoly6(r,h)相较于Wspiky(r,h),不需要额外的平方根计算,梯度更加平滑,被广泛应用在除压力和粘滞力外的光滑粒子流体动力学中,故使用其计算区域的密集系数。而由于Wpoly6(r,h)的顶端中心梯度为0,若采用其对压力进行加权加算,无人机会发生聚集现象,故斥力的加权使用的是Wspiky(r,h)核函数,无人机之间越接近,权重增加的速度就越快,这些无人机进行冲突消解的优先级就越高。
S5、引入作用于无人机速度法线方向的调整力。
传统人工势场法存在的局部最优点和目标不可达问题如图5所示。当无人机受到的吸引力与无人机受到的斥力满足相互平衡的条件,且此时速度减小为0时,系统陷入局部最优。同样的,当无人机的目标位置与障碍物之间的距离非常小时,由于斥力的存在,无人机永远都无法抵达目标点。为解决这两个问题,本发明首先引入一个沿原速度法线方向的调整力,使无人机能旋转脱离原有的局部最优点。所述调整力Fadj的大小为:
Figure BDA0004142743390000101
其中,θ为吸引力Fatt与斥力Frep的夹角,此时的Frep为合斥力,ka为调整力大小的缩放系数,ks为调整力变化的敏感系数,ε为设定的一个极小常量。
同时,取无人机弹道坐标系的Z轴方向为调整力Fadj的所在方向。
因为脱离局部最优点需要调整力的大小足够大,且为了能够逃离凹陷的局部最优点,调整力大小的缩放系数ka需要大于1,调整力的大小与合斥力Frep成正比。同时为了防止调整力影响无人机正常情况下的运动轨迹,从而影响执行任务的效率,引入
Figure BDA0004142743390000102
对调整力的作用范围进行限制,只有当斥力与吸引力的夹角接近180°,且斥力足够大时,调整力才会正常生效。
S6、引入一个无人机靠近目标时的调整系数,结合加权调整后的人工势场力和调整力计算合力。
为解决目标不可达问题,引入一个调整系数μ,对斥力进行缩放处理,从而使无人机能够脱离障碍物的影响到达目标位置。所述调整系数μ为:
Figure BDA0004142743390000103
其中,dμ为调整系数μ作用的有效距离,q为无人机的当前位置,qgoal表示无人机的目标位置。
因为加入的调整力Fadj大小与斥力Frep相关,在遇到目标不可达问题时,同样需要使用调整系数μ对其进行调整。从而得到应用到无人机上的最终合力F为:
F=Fatt+Fc+μ(Frep+Fadj)
其中Fatt为目标点对无人机的吸引力,Fc为无人机之间加权过的斥力,μ为调整系数,Frep为障碍物对无人机的斥力,Fadj为速度法线方向的调整力。
使用最终得到的合力F作用于无人机,完成本回合的更新。不断重复上述步骤,直到无人机抵达目标点为止。
结合符合,下面通过介绍一个具有代表性的实施例,来进一步说明本实施例技术方案的相关设计。
大小为10×10的空间中存在6个无人机,其初始位置分别为(1,1)、(1,9)、(9,9)、(9,1)、(0,5)、(10,5),其对应的目标位置分别为(8,8)、(8,2)、(2,2)、(2,8)、(9,5)、(1,5),空间中还存在一个半径为0.5的圆形障碍物,位置为(5,5)。使用合力F控制无人机行动,具体计算步骤为:
步骤1:明确无人机与障碍物的初始信息。
步骤2:构建空间均匀网格。
步骤3:计算势场力。
其中,步骤3具体包括步骤3.1-3.3:
步骤3.1:计算目标点的吸引力Fatt,其中katt为1,d*为5。
步骤3.2:计算障碍物的斥力Frep,其中krep为10,dr为3。
步骤3.3:计算无人机之间的斥力Fi,其中kc为30,影响距离R为设置3。
步骤4:使用核函数计算加权后的无人机之间的斥力Fc
步骤5:计算速度法线方向的调整力Fadj,其中调整力大小的缩放系数ka为2,调整力变化的敏感系数ks为1。
步骤6:计算调整系数μ,其中dμ为2。
步骤7:计算合力F,并作用于无人机。重复以上步骤,直到无人机抵达目标点。
根据以上算法步骤,设计运行仿真实验,最终无人机的运行轨迹如图6所示。可以看到,由于无人机之间起始点与目标点的连线是相互对称的,无人机运动到中心障碍区域时,如果使用传统人工势场法,那么系统将陷入局部最优点,但由于调整力Fadj的存在,无人机在进行冲突消解的同时,完成了避障,最终到达目标点。运动过程中,无人机到障碍物的最小距离、无人机之间的最小距离如图7、图8所示。
综上所述,本实施例方法相对于现有技术,至少具有如下优点及有益效果:
(1)本实施例采用空间均匀网格对空域进行划分,在无人机密集区域计算势场时只需要对邻居网格中的无人机进行搜索,可以极大的加快运算效率。
(2)本实施例应用光滑粒子流体动力学原理,先使用Poly6核函数计算出无人机在当前位置的密集系数,密集系数越大,代表该处的无人机分布越密集,无人机越有可能发生冲突。获得密集系数后,再使用Spiky核函数根据无人机之间的分布进行加权,加权结果结合密集系数得出处理后的无人机之间的作用力,从而缓解无人机过于密集时人工势场法轨迹不稳定的情况,实现更平滑稳定的冲突消解效果。
(3)本实施例采用无人机处于人工势场局部最优点时作用在无人机速度法线方向上的调整力,使无人机拥有切向逃离原死区的能力,从而有效解决传统人工势场法存在的局部最优问题。
(4)本实施例采用无人机接近目标点时作用在障碍物斥力上的调整系数,减小障碍物对即将抵达目标的无人机的影响,从而有效解决传统人工势场法存在的目标不可达问题。
本实施例还提供一种密集无人机避障与冲突消解装置,包括:
至少一个处理器;
至少一个存储器,用于存储至少一个程序;
当所述至少一个程序被所述至少一个处理器执行,使得所述至少一个处理器实现图1所示方法。
本实施例的一种密集无人机避障与冲突消解装置,可执行本发明方法实施例所提供的一种密集无人机避障与冲突消解方法,可执行方法实施例的任意组合实施步骤,具备该方法相应的功能和有益效果。
在一些可选择的实施例中,在方框图中提到的功能/操作可以不按照操作示图提到的顺序发生。例如,取决于所涉及的功能/操作,连续示出的两个方框实际上可以被大体上同时地执行或所述方框有时能以相反顺序被执行。此外,在本发明的流程图中所呈现和描述的实施例以示例的方式被提供,目的在于提供对技术更全面的理解。所公开的方法不限于本文所呈现的操作和逻辑流程。可选择的实施例是可预期的,其中各种操作的顺序被改变以及其中被描述为较大操作的一部分的子操作被独立地执行。
此外,虽然在功能性模块的背景下描述了本发明,但应当理解的是,除非另有相反说明,所述的功能和/或特征中的一个或多个可以被集成在单个物理装置和/或软件模块中,或者一个或多个功能和/或特征可以在单独的物理装置或软件模块中被实现。还可以理解的是,有关每个模块的实际实现的详细讨论对于理解本发明是不必要的。更确切地说,考虑到在本文中公开的装置中各种功能模块的属性、功能和内部关系的情况下,在工程师的常规技术内将会了解该模块的实际实现。因此,本领域技术人员运用普通技术就能够在无需过度试验的情况下实现在权利要求书中所阐明的本发明。还可以理解的是,所公开的特定概念仅仅是说明性的,并不意在限制本发明的范围,本发明的范围由所附权利要求书及其等同方案的全部范围来决定。
所述功能如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
在流程图中表示或在此以其他方式描述的逻辑和/或步骤,例如,可以被认为是用于实现逻辑功能的可执行指令的定序列表,可以具体实现在任何计算机可读介质中,以供指令执行系统、装置或设备(如基于计算机的系统、包括处理器的系统或其他可以从指令执行系统、装置或设备取指令并执行指令的系统)使用,或结合这些指令执行系统、装置或设备而使用。就本说明书而言,“计算机可读介质”可以是任何可以包含、存储、通信、传播或传输程序以供指令执行系统、装置或设备或结合这些指令执行系统、装置或设备而使用的装置。
计算机可读介质的更具体的示例(非穷尽性列表)包括以下:具有一个或多个布线的电连接部(电子装置),便携式计算机盘盒(磁装置),随机存取存储器(RAM),只读存储器(ROM),可擦除可编辑只读存储器(EPROM或闪速存储器),光纤装置,以及便携式光盘只读存储器(CDROM)。另外,计算机可读介质甚至可以是可在其上打印所述程序的纸或其他合适的介质,因为可以例如通过对纸或其他介质进行光学扫描,接着进行编辑、解译或必要时以其他合适方式进行处理来以电子方式获得所述程序,然后将其存储在计算机存储器中。
应当理解,本发明的各部分可以用硬件、软件、固件或它们的组合来实现。在上述实施方式中,多个步骤或方法可以用存储在存储器中且由合适的指令执行系统执行的软件或固件来实现。例如,如果用硬件来实现,和在另一实施方式中一样,可用本领域公知的下列技术中的任一项或他们的组合来实现:具有用于对数据信号实现逻辑功能的逻辑门电路的离散逻辑电路,具有合适的组合逻辑门电路的专用集成电路,可编程门阵列(PGA),现场可编程门阵列(FPGA)等。
在本说明书的上述描述中,参考术语“一个实施方式/实施例”、“另一实施方式/实施例”或“某些实施方式/实施例”等的描述意指结合实施方式或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施方式或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施方式或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施方式或示例中以合适的方式结合。
尽管已经示出和描述了本发明的实施方式,本领域的普通技术人员可以理解:在不脱离本发明的原理和宗旨的情况下可以对这些实施方式进行多种变化、修改、替换和变型,本发明的范围由权利要求及其等同物限定。
以上是对本发明的较佳实施进行了具体说明,但本发明并不限于上述实施例,熟悉本领域的技术人员在不违背本发明精神的前提下还可做作出种种的等同变形或替换,这些等同的变形或替换均包含在本申请权利要求所限定的范围内。

Claims (10)

1.一种密集无人机避障与冲突消解方法,其特征在于,包括以下步骤:
确认初始信息,所述初始信息包括各无人机信息以及障碍物信息;
建立空间均匀网格,将无人机信息和障碍物信息映射到空间均匀网格中;
构建人工势场函数,根据人工势场函数获取人工势场力;
引入核函数对人工势场力的影响进行加权调整;
引入作用于无人机速度法线方向的调整力;
引入一个无人机靠近目标时的调整系数,结合加权调整后的人工势场力和调整力计算合力。
2.根据权利要求1所述的一种密集无人机避障与冲突消解方法,其特征在于,所述建立空间均匀网格,将无人机信息和障碍物信息映射到空间均匀网格中,包括:
构建空间均匀网格,将整个飞行空域分为N个独立的网格空间,每个网格空间的大小介于无人机的通讯范围与安全距离之间;
将无人机的实际空间坐标转换到网格坐标,计算得到所处网格的索引,并存入集合中。
3.根据权利要求1所述的一种密集无人机避障与冲突消解方法,其特征在于,所述构建人工势场函数,根据人工势场函数获取人工势场力,包括:
构建无人机与目标点之间的引力势场函数;
构建无人机与障碍物之间的斥力势场函数;
构建无人机之间的斥力势场函数;
根据构建的势场函数,计算势场函数的负梯度得到对应的势场力。
4.根据权利要求3所述的一种密集无人机避障与冲突消解方法,其特征在于,所述根据构建的势场函数,计算势场函数的负梯度得到对应的势场力,包括:
计算目标点对无人机的引力势场Uatt以及目标点对无人机的吸引力Fatt
Figure FDA0004142743370000011
Figure FDA0004142743370000012
式中,katt为引力系数,q为无人机的当前位置,qgoal表示无人机的目标位置,d*为目标点对无人机吸引力增加的有效距离;
计算障碍物对无人机的斥力势场Urep以及障碍物对无人机的斥力Frep
Figure FDA0004142743370000021
Figure FDA0004142743370000022
式中,krep为斥力系数,q为无人机的当前位置,qobs表示障碍物的位置,dr为障碍物对无人机有斥力影响的有效距离;
计算无人机之间的斥力势场Ui以及对应的斥力Fi
Figure FDA0004142743370000023
Figure FDA0004142743370000024
式中,kc为无人机间的斥力系数,qi为受力无人机的当前位置,qj表示邻居施力无人机的当前位置,R为设置的无人机的最大影响距离。
5.根据权利要求1所述的一种密集无人机避障与冲突消解方法,其特征在于,所述引入核函数对人工势场力的影响进行加权调整,包括:
引入核函数对无人机之间的斥力进行加权调整,加权后所得到无人机所受的斥力Fc为:
Figure FDA0004142743370000025
式中,αi为当前无人机位置的密集系数,αj为邻居施力无人机所处位置的密集系数,qi为受力无人机的当前位置,qj表示邻居施力无人机的当前位置,R为设置的无人机的最大影响距离,Wspiky(r,h)为计算所使用的核函数。
6.根据权利要求5所述的一种密集无人机避障与冲突消解方法,其特征在于,密集系数α的表达式为:
Figure FDA0004142743370000026
式中,q为计算密集系数的目标位置,qi表示当前网格与邻居网格所有无人机的当前位置,
R为设置的无人机的最大影响距离,Wpoly6(r,h)为计算所使用的核函数。
7.根据权利要求1所述的一种密集无人机避障与冲突消解方法,其特征在于,所述引入作用于无人机速度法线方向的调整力,包括:
引入一个沿原速度法线方向的调整力,使无人机脱离原有的局部最优点;
所述调整力Fadj的大小为:
Figure FDA0004142743370000031
式中,θ为吸引力Fatt与斥力Frep的夹角,此时的Frep为合斥力,ka为调整力大小的缩放系数,ks为调整力变化的敏感系数,ε为预设常量;
其中,取无人机弹道坐标系的Z轴方向作为调整力Fadj的所在方向。
8.根据权利要求1所述的一种密集无人机避障与冲突消解方法,其特征在于,所述引入一个无人机靠近目标时的调整系数,求得合力,包括:
引入一个调整系数μ,对斥力进行缩放处理,从而使无人机脱离障碍物的影响到达目标位置;
所述调整系数μ为:
Figure FDA0004142743370000032
式中,dμ为调整系数μ作用的有效距离,q为无人机的当前位置,qgoal表示无人机的目标位置
根据所述调整系数μ,获取应用到无人机上的最终合力F:
F=Fatt+Fc+μ(Frep+Fadj)
式中,Fatt为目标点对无人机的吸引力,Fc为无人机之间加权过的斥力,μ为调整系数,Frep为障碍物对无人机的斥力,Fadj为速度法线方向的调整力。
9.根据权利要求1所述的一种密集无人机避障与冲突消解方法,其特征在于,所述初始信息具体包括:总的无人机个数n,每一个无人机的初始位置q,每一个无人机的初始速度v0,每一个无人机的目标位置qgoal;所有障碍物的位置坐标qobs以及其作用范围dr
10.一种密集无人机避障与冲突消解装置,其特征在于,包括:
至少一个处理器;
至少一个存储器,用于存储至少一个程序;
当所述至少一个程序被所述至少一个处理器执行,使得所述至少一个处理器实现权利要求1-9任一项所述方法。
CN202310294712.8A 2023-03-23 2023-03-23 一种密集无人机避障与冲突消解方法及装置 Pending CN116225064A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310294712.8A CN116225064A (zh) 2023-03-23 2023-03-23 一种密集无人机避障与冲突消解方法及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310294712.8A CN116225064A (zh) 2023-03-23 2023-03-23 一种密集无人机避障与冲突消解方法及装置

Publications (1)

Publication Number Publication Date
CN116225064A true CN116225064A (zh) 2023-06-06

Family

ID=86587412

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310294712.8A Pending CN116225064A (zh) 2023-03-23 2023-03-23 一种密集无人机避障与冲突消解方法及装置

Country Status (1)

Country Link
CN (1) CN116225064A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116974297A (zh) * 2023-06-27 2023-10-31 北京五木恒润科技有限公司 基于多目标优化的冲突消解方法、装置、介质及电子设备

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116974297A (zh) * 2023-06-27 2023-10-31 北京五木恒润科技有限公司 基于多目标优化的冲突消解方法、装置、介质及电子设备
CN116974297B (zh) * 2023-06-27 2024-01-26 北京五木恒润科技有限公司 基于多目标优化的冲突消解方法、装置、介质及电子设备

Similar Documents

Publication Publication Date Title
CN110908373B (zh) 一种基于改进人工势场的智能车辆轨迹规划方法
CN108827312B (zh) 一种基于神经网络和人工势场的协同博弈路径规划方法
CN110456823B (zh) 一种针对无人机计算与存储能力受限的双层路径规划方法
Qiu et al. Receding horizon control for multiple UAV formation flight based on modified brain storm optimization
Zhang et al. An improved constrained differential evolution algorithm for unmanned aerial vehicle global route planning
CN109871031B (zh) 一种固定翼无人机的轨迹规划方法
CN110442129B (zh) 一种多智能体编队的控制方法和系统
Karafyllis et al. Lyapunov-based two-dimensional cruise control of autonomous vehicles on lane-free roads
CN108919818B (zh) 基于混沌种群变异pio的航天器姿态轨道协同规划方法
CN112000096A (zh) 一种基于麻雀搜索算法的差速agv轨迹跟踪控制方法
CN111024085B (zh) 一种具有端点方向和时间约束的无人机航迹规划方法
CN116225064A (zh) 一种密集无人机避障与冲突消解方法及装置
CN115993781B (zh) 抗网络攻击无人集群系统协同控制方法、终端及存储介质
CN107766793A (zh) 基于混合型方法的mems陀螺仪信号去噪处理方法
CN109932929A (zh) 船舶巡航模拟仿真方法、计算机可读存储介质及终端设备
Zheng et al. Electric sense based pose estimation and localization for small underwater robots
CN114578851A (zh) 一种基于差分加速度的无人机集群快速转向方法
Qiu et al. A decoupling receding horizon search approach to agent routing and optical sensor tasking based on brain storm optimization
Kim et al. A heuristic obstacle avoidance algorithm using vanishing point and obstacle angle
CN111007848B (zh) 一种基于有界空间的多智能体协同作业控制方法
Xiong et al. Multi-uav 3d path planning in simultaneous attack
Cui et al. Path planning of autonomous agricultural machineries in complex rural road
CN114545971A (zh) 一种通讯约束下多智能体分布式可飞路径规划方法、系统、计算机设备及介质
Yuan et al. A centralised training algorithm with D3QN for scalable regular unmanned ground vehicle formation maintenance
Li et al. An Improved grey wolf optimizer with weighting functions and its application to Unmanned Aerial Vehicles path planning

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