[0007] 本发明的目的在于提供一种自主式无人机群目标跟随避障方法,本发明研究了在同一集群速度下短程斥力与长程速度跟随作用下的无人机集群的避障情况及运行状态,有益效果是无人机集群在飞行过程中在更远距离做出反应以更小的速度变化避开障碍。
[0008] 在无人机群的路径规划中,为达到上述目标,本发明提供了如下五个步骤的技术方案:
[0009] 步骤1:按照以集群所要到达的目标点为牵引,设置集群速度方向,其中将集群牵引定以恒定的大小;通过计算每个对象无人机到终点的坐标差值来设置对象无人机的目标牵引方向;
[0010] 步骤2:对于每个对象无人机,需要在每个时间帧中,对通信范围内所有其余无人机与对象无人机的斥力进行合力计算,计算结果则是对象无人机当前所受斥力总和;
[0011] 步骤3:利用无人机之间的速度跟随力,来保持集群速度大小和方向的一致性;对通信范围内所有满足速度跟随条件的无人机进行速度跟随运算,获取所有跟随作用的复合作用作为此对象的当前所受的跟随力作用;
[0012] 所述的满足速度跟随条件是指在通信范围内的任意两个无人机之间的速度差,保持在缓冲范围内,就能够维持集群的稳定;
[0013] 所述的通信范围是指根据需要设定的范围;
[0014] 步骤4:在障碍物上设置虚拟无人机,并赋予该虚拟无人机一定的虚拟速度,通过利用步骤3中的无人机之间的速度跟随力,来改变无人机群靠近障碍物时的速度方向,从而达成较好的避障效果;
[0015] 步骤5:为了计算每个对象无人机所需的速度,求取步骤1~4所有作用的矢量和;将无人机速度固定为集群速度,叠加之前所有作用力,得到所需的目标速度;
[0016] 所述的所有作用包括无人机的目标牵引力、无人机短距斥力、无人机之间的速度跟随力、无人机与障碍物之间的速度跟随力。
[0017] 步骤1按照以集群所要到达的目标点为牵引,设置集群速度方向,具体公式如下[0018]
[0019] 公式(1)中vatti为恒定大小的集群牵引速度;将对象无人机标记为i,ri表示对象无人机的中心坐标,ra表示目标点的中心坐标,ria表示无人机i到目标点的坐标差值,获取了无人机向终点的运动方向; 表示对象无人机i的目标牵引速度。
[0020] 步骤2具体实现如下:
[0021] 无人机间的相互排斥为短距斥力作用,只在一定范围内有效,其作用方程如下:
[0022]
[0023]rep
[0024] 公式(2)中, 表示两无人机短距斥力作用后的速度,p 是机间排斥大小的线性系数, 是斥力的截止距离,将两无人机标记为i、j,ri表示无人机i的中心坐标,rj表示无人机j的中心坐标,rij表示无人机i与无人机j之间的坐标差值,获取了无人机连线反方rep向作为斥力作用方向,斥力大小与无人机间距离大小相关,并以单位为时间倒数的系数p调整大小倍率;
[0025] 公式(3)表示在每个时间帧中,无人机需要对斥力截止范围内所有无人机单位进行斥力计算,并取其合力为当前对象无人机所受集群其它无人机的总斥力作用, 为此作用力后的速度。
[0026] 步骤3具体实现如下:
[0027] 设定在一定距离的无人机间速度差只要保持在缓冲范围内就能够维持集群的稳定,速度一致性要求由制动函数D(r,a,p)决定:
[0028]
[0029] 公式(4)中r是目标点与跟随的对象无人机之间的距离,p是线性增益,a是制动加速度;D(r,a,p)是以距离变化改变速度缓冲上限的 分段函数,速度缓冲上限的表达式如下:
[0030]
[0031] 公式(5)中, 是速度缓冲项,将两无人机标记为i、j,vij表示无人机i与无人机frict frictj之间的速度差值, 是无人机i与无人机j理想相对静止点的距离,a 和p 是跟随加速度参数以及跟随线性增益,在短程设置的速度缓冲上限内,将无人机的当前速度向参考对象无人机的速度变化,仅当超出速度缓冲上限后,无人机跟随作用使无人机速度向目标速度调整,具体调整公式如下:
[0032]
[0033]
[0034] 公式(6)中Cfrict为速度跟随作用强度的线性系数,越大表现为更强的阻尼作用以及更小的震荡,但是会使运动缓慢; 是速度缓冲项,vi表示无人机i的当前速度,vj表示无人机j的当前速度,vij表示无人机i与无人机j之间的速度差值, 为速度缓冲上限;
[0035] 公式(7)表示在每个时间帧中,无人机需要对通信范围范围内所有无人机单位进行速度跟随计算,并取其合力为当前对象无人机所受集群其它无人机的总速度跟随作用力, 为此作用力后的速度。
[0036] 步骤4具体实现如下:
[0037] 通过在障碍物上设置虚拟无人机单位,并赋予其一定的虚拟速度,通过利用无人机间速度跟随力,来实时改变无人机群靠近障碍物时的速度方向:
[0038]
[0039]
[0040] 首先获取距离无人机最近的障碍物点,并在该位置设置虚拟 shill单位,对多边障碍物或是多个障碍物的的每一边都要进行虚拟 shill单位的设置; 为无人机与障碍间的跟随速度缓冲上限, ris=|ri‑rs|,其中rs是多边形障碍物上获取的距离最近的点,即是获取最近点到无人机的距离, 是无人机与障碍物之间理想相对静止点的距shill shill离;a 是制动加速度,p 是跟随线性增益;
[0041] 由于跟随作用由对象无人机间的速度差产生,相对于其他牵引力,斥力等较弱,为了使其确实能在强作用产生效果,取消了由虚拟shill 单位速度产生的跟随作用的速度缓shill冲,并将对齐强度系数C 保持在 1以获取最强的对齐作用;
[0042] 将对象无人机标记为i,障碍物离无人机距离最近的一点标记为 s,vi表示无人机i的当前速度,vs是为虚拟shill单位设定的虚拟速度,其方向为垂直于障碍物墙体或是沿无人机至障碍物方向向障碍物外部延伸;速度vis=|vi‑vs|,表示无人机i与障碍物之间的速度差值, 为对象无人机与障碍物之间的跟随作用力后的速度。
[0043] 步骤5具体实现如下:
[0044] 为了得到每个对象的所有作用力之合力,对步骤1~4所有速度的矢量求和:
[0045]flock
[0046] 假定无人机以集群速度v 运动,vi为对象无人机的原始速度,通过 运算保留其自身的运动方向,将其速度固定为集群速度,叠加之前所有作用力,得到 为所需的每个对象的目标速度;
[0047]
[0048] 在期望集群中所有无人机按固定集群速度运动,且无人机本身有速度极限,故将max所得目标速度方向保留,大小限制为最大集群速度截止值v 。
[0049] 本发明有益效果如下:
[0050] 本发明将无人机群的运动分为一个个时间帧叠加的形式,在每个时刻每个无人机单位对当前环境进行分析,并通过步骤5将各个作用力以产生作用后的合力所得速度表示,最终获得当前时刻所需的加速度,已达到为无人机群规划出良好的自主协同避障路线。