[發明專利]無人機集群控制方法

有效

• 申請號: 201810178712.0
• 申請日: 2017-08-21
• 公開（公告）號: CN108196583B
• 公開（公告）日: 2020-09-01
• 發明（設計）人: 毛瓊;席雷平;馬彥恒;王正軍
• 申請（專利權）人: 中國人民解放軍陸軍工程大學
• 主分類號: G05D1/10
• 分類號: G05D1/10
• 代理公司: 石家莊輕拓知識產權代理事務所(普通合伙) 13128
• 代理人: 王占華

1.一種無人機集群控制方法，其特征在于包括如下步驟：

通過無人機集群群內部成員的空間位置、速度以及加速度構建無人機集群群內部成員模型；無人機集群是由N個個體組成的分布式系統，每個個體的運動可抽象為：

其中：P_i表示無人機i的空間位置，v_i表示速度，a_i表示加速度，表示對P_i求一階導數，表示對v_i求一階導數；

無人機飛行時存在以下約束：

加速度約束：

其中，A_max為無人機的最大加速度；

速度約束：

其中，V_max為無人機的最大速度；

構建無人機集群群內部成員的加速度控制函數；

對無人機集群群內部成員個體i的質量進行歸一化處理后其運動控制量加速度a_i表示為：

a_i＝γ₁·α·f_i^g+γ₂·f_i^o+γ₃·f_i^j+γ₁·(1-α)·f_i^G (4)

上式中γ₁·α·f_i^g為目標吸引產生的控制分量，γ₂·f_i^o為規避障礙所需的控制分量，γ₃·f_i^j為群內鄰居無人機j對無人機i產生的群聚作用力，γ₁·(1-α)·f_i^G為無人機個體G領導無人機個體i產生的控制分量；α為無人機個體i接收到航點信息的標志，α＝1表示無人機i能接收航點信息，此時(4)式等號右側的γ₁·(1-α)·f_i^G為0；α＝0則表示無人機i不能接收航點信息，(4)式等號右側的γ₁·α·f_i^g為0，γ₁·(1-α)·f_i^G不為0，個體i將從探測區域內選擇無人機G作為領導者進行跟隨，即接收不到目標航點的情況下把無人機G作為目標航點并朝向它運動；γ₁、γ₂和γ₃為各個控制分量的權重，f_i^g為目標g與無人機i之間的作用力，f_i^o為障礙O與無人機i之間的作用力，f_i^j為無人機j與無人機i之間的作用力，f_i^G為無人機i與選定的領導無人機G之間的作用力；

通過構建的所述加速度控制函數實現對無人機集群群內部成員的群聚運動、朝向目標運動以及規避障礙運動進行控制，設無人機i與障礙O之間的警戒距離為γ^β，其中γ^β＜d_a，則二者之間通過以下函數進行控制：

其中，

其中：f_i^o為障礙O與無人機i之間的作用力，由無人機i和障礙O的位置P_i、P_O和速度v_i、v_O決定，決定的方法：表示該作用力的作用方向，為單位方向矢量，F_i^O為該作用力的大小，由無人機i和障礙O的位置P_i、P_O根據(14)式求解，無人機i和障礙O之間的距離另由無人機i和障礙O的速度v_i、v_O產生的作用力為(13)式中等號右側的第二項；γ^β為無人機i與障礙物O之間的警戒距離，為距離調節參數，為無人機i和障礙O之間的斥力強度調節系數，為無人機i和障礙O之間的速度一致性控制系數，和γ^β可先給定一初值，再在系統實驗時進一步調節。