[发明专利]一种自主式无人机群目标跟随避障方法

摘要

本发明公开了一种自主式无人机群目标跟随避障方法。本发明步骤：1：通过计算每个对象无人机到终点的坐标差值来设置对象无人机的目标牵引方向；2：对通信范围内所有其余无人机与对象无人机的斥力进行合力计算；3：对通信范围内所有满足速度跟随条件的无人机进行速度跟随运算，获取所有跟随作用的复合作用作为当前无人机所受的跟随力作用；4：在障碍物上设置虚拟无人机，并赋予其虚拟速度，通过无人机之间的速度跟随力，改变无人机群靠近障碍物时的速度方向；5：将所有作用的矢量和作为每个对象无人机所需的速度；将无人机速度固定为集群速度，叠加之前所有作用力，得到所需目标速度。本发明能够为无人机群规划出良好的自主协同避障路线。

主权项

1.一种自主式无人机群目标跟随避障方法，其特征在于包括如下步骤：步骤1：按照以集群所要到达的目标点为牵引，设置集群速度方向，其中将集群牵引定以恒定的大小；通过计算每个对象无人机到终点的坐标差值来设置对象无人机的目标牵引方向；步骤2：对于每个对象无人机，需要在每个时间帧中，对通信范围内所有其余无人机与对象无人机的斥力进行合力计算，计算结果则是对象无人机当前所受斥力总和；步骤3：利用无人机之间的速度跟随力，来保持集群速度大小和方向的一致性；对通信范围内所有满足速度跟随条件的无人机进行速度跟随运算，获取所有跟随作用的复合作用作为此对象的当前所受的跟随力作用；所述的满足速度跟随条件是指在通信范围内的任意两个无人机之间的速度差，保持在缓冲范围内，就能够维持集群的稳定；所述的通信范围是指根据需要设定的范围；步骤4：在障碍物上设置虚拟无人机，并赋予该虚拟无人机一定的虚拟速度，通过利用步骤3中的无人机之间的速度跟随力，来改变无人机群靠近障碍物时的速度方向，从而达成较好的避障效果；步骤5：为了计算每个对象无人机所需的速度，求取步骤1～4所有作用的矢量和；将无人机速度固定为集群速度，叠加之前所有作用力，得到所需的目标速度；所述的所有作用包括无人机的目标牵引力、无人机短距斥力、无人机之间的速度跟随力、无人机与障碍物之间的速度跟随力。