原文地址：[1]林倩玉. 多無人機(jī)協(xié)同編隊(duì)控制算法研究[D].哈爾濱工業(yè)大學(xué),2018.

2018_多無人機(jī)協(xié)同編隊(duì)控制算法研究_林倩玉

• 第 3 章 多無人機(jī)協(xié)同編隊(duì)控制算法設(shè)計(jì)
• • 3.1 引言
  • 3.2 多無人機(jī)系統(tǒng)運(yùn)動的狀態(tài)控制
  • • 3.2.1 航向控制
    • 3.2.2 速度控制
    • 3.2.3 高度控制
  • 3.3 多無人機(jī)系統(tǒng)編隊(duì)的隊(duì)形控制算法
  • • 3.3.1 平面隊(duì)形控制
    • 3.3.2 縱向隊(duì)形控制
    • 3.3.3 三維空間隊(duì)形控制算法
  • 3.4 多無人機(jī)協(xié)同編隊(duì)的隊(duì)形保持
  • 3.5 多無人機(jī)協(xié)同編隊(duì)的隊(duì)形變化
  • 3.6 多無人機(jī)協(xié)同編隊(duì)算法仿真驗(yàn)證
  • • 3.6.1 狀態(tài)控制仿真驗(yàn)證
    • 3.6.2 隊(duì)形控制仿真驗(yàn)證
    • 3.6.4 隊(duì)形變換仿真驗(yàn)證

第 3 章 多無人機(jī)協(xié)同編隊(duì)控制算法設(shè)計(jì)

3.1 引言

---

3.2 多無人機(jī)系統(tǒng)運(yùn)動的狀態(tài)控制

---

3.2.1 航向控制

航向角的動態(tài)模型是
$${\dot{\psi }}_i=\frac{1}{{\tau }_{\psi }}({\psi }_i^c?{\psi }_i)\text{\hspace{1em}(3-1)}$$

${\psi }_i$：當(dāng)前航向角
${\psi }_i^c$：航向指令

航向角的一致性控制算法如下：
$$?\begin{array}{rl}& {\psi }_i^c={\psi }_i+\frac{1}{1+n_i}{u}_i\\ & u_i=?\sum _{j=1}^n{a}_{ij}({\psi }_i?{\psi }_j)\end{array}\text{\hspace{1em}(3-2)}$$

$n_i$ 是無人機(jī) $i$ 的鄰居無人機(jī)的個數(shù)。

指定航向角的一致性算法為：
$$?\begin{array}{rl}& {\psi }_i^c={\psi }_i+\frac{1}{1+n_i}{u}_i\\ & u_i=?b_i({\psi }_i?{\psi }^{?})?\sum _{j=1}^n{a}_{ij}({\psi }_i?{\psi }_j)\end{array}\text{\hspace{1em}(3-3)}$$

${\psi }^{?}$ 為指定航向角。

---

3.2.2 速度控制

速度動態(tài)模型為：
$${\dot{v}}_i={\alpha }_v(v_i^c?v_i)\text{\hspace{1em}(3-5)}$$

速度一致性控制算法為：
$$?\begin{array}{rl}& v_i^c=v_i+{\tau }_v{u}_i\\ & u_i=?\sum _{j=1}^n{a}_{ij}(v_i?v_j)\end{array}\text{\hspace{1em}(3-6)}$$

指定編隊(duì)收斂時(shí)的飛行速度控制算法為：
$$?\begin{array}{rl}& v_i^c=v_i+{\tau }_v{u}_i\\ & u_i=?c_i(v_i?v^{?})?\sum _{j=1}^n{a}_{ij}(v_i?v_j)\end{array}\text{\hspace{1em}(3-7)}$$

$c_i>0$ 時(shí)控制系數(shù)。

---

3.2.3 高度控制

無人機(jī)高度動態(tài)模型為：
$${\ddot{z}}_i=?\frac{1}{{\tau }_{\dot{z}}}{\dot{z}}_i?\frac{1}{{\tau }_z}(z_i^c?z_i)\text{\hspace{1em}(3-8)}$$

高度一致性控制算法：
$$?\begin{array}{rl}& z_i^c=z_i+\frac{{\tau }_z}{{\tau }_{\dot{z}}}{\dot{z}}_i+{\tau }_z{u}_i\\ & u_i=?k{\dot{z}}_i?\sum _{j=1}^n{a}_{ij}[(v_i?v_j)+\gamma ({\dot{z}}_i?{\dot{z}}_j)]\end{array}\text{\hspace{1em}(3-10)}$$

有外部參考輸入下的算法：
$$?\begin{array}{rl}& z_i^c=z_i+\frac{{\tau }_z}{{\tau }_{\dot{z}}}{\dot{z}}_i+{\tau }_z{u}_i\\ & u_i=?d_i(z_i?z^{?})?k{\dot{z}}_i?\sum _{j=1}^n{a}_{ij}[(v_i?v_j)+\gamma ({\dot{z}}_i?{\dot{z}}_j)]\end{array}\text{\hspace{1em}(3-12)}$$

---

3.3 多無人機(jī)系統(tǒng)編隊(duì)的隊(duì)形控制算法

---

3.3.1 平面隊(duì)形控制

當(dāng)編隊(duì)穩(wěn)定時(shí)，其橫側(cè)向平面內(nèi)有：
$$(x_i^{{}^{\prime }}?x_{iF}^{{}^{\prime }})?(x_j^{{}^{\prime }}?x_{jF}^{{}^{\prime }})=0$$$$(y_i^{{}^{\prime }}?y_{iF}^{{}^{\prime }})?(y_j^{{}^{\prime }}?y_{jF}^{{}^{\prime }})=0$$

即：
$$(x_i^{{}^{\prime }}?x_{iF}^{{}^{\prime }})?(x_j^{{}^{\prime }}?x_{jF}^{{}^{\prime }})=x_i^{{}^{\prime }}?x_j^{{}^{\prime }}?x_{ij}^{{}^{\prime }r}=0$$$$(y_i^{{}^{\prime }}?y_{iF}^{{}^{\prime }})?(y_j^{{}^{\prime }}?y_{jF}^{{}^{\prime }})=y_i^{{}^{\prime }}?y_j^{{}^{\prime }}?y_{ij}^{{}^{\prime }r}=0$$

$x_{ij}^{{}^{\prime }r},y_{ij}^{{}^{\prime }r}$ 分別表示無人機(jī)之間的預(yù)定機(jī)間距離。

多無人機(jī)協(xié)同編隊(duì)的控制算法如下：
$$?\begin{array}{rl}& v_i^c=v_i?\sum _{j=1}^n{a}_{ij}[{\tau }_v(v_i?v_j)+k_i^v(x_i^{{}^{\prime }}?x_j^{{}^{\prime }}?x_{ij}^{{}^{\prime }r})]\\ & {\psi }_i^c={\psi }_i?\sum _{j=1}^n{a}_{ij}[\frac{1}{1+n_i}({\psi }_i?{\psi }_j)+k_i^{\psi }\sum _{j\in N_i}(y_i^{{}^{\prime }}?y_j^{{}^{\prime }}?y_{ij}^{{}^{\prime }r})]\end{array}\text{\hspace{1em}(3-16)}$$

$k_i^v,k_i^{\psi }$ 分別用于調(diào)整無人機(jī)間隔的控制增益。

上式是進(jìn)行隊(duì)形控制的最基本算法。如果要指定編隊(duì)的某些飛行狀態(tài)，可由上式衍生出以下三種隊(duì)形控制算法：

1）指定飛行航向，${\psi }_i\to {\psi }^{?}$
$$?\begin{array}{rl}& v_i^c=v_i?\sum _{j=1}^n{a}_{ij}[{\tau }_v(v_i?v_j)+k_i^v(x_i^{{}^{\prime }}?x_j^{{}^{\prime }}?x_{ij}^{{}^{\prime }r})]\\ & {\psi }_i^c={\psi }_i?b_i({\psi }_i?{\psi }^{?})?\sum _{j=1}^n{a}_{ij}[\frac{1}{1+n_i}({\psi }_i?{\psi }_j)+k_i^{\psi }\sum _{j\in N_i}(y_i^{{}^{\prime }}?y_j^{{}^{\prime }}?y_{ij}^{{}^{\prime }r})]\end{array}\text{\hspace{1em}(3-17)}$$

2）指定飛行速度

3）指定飛行速度和飛行航向

---

3.3.2 縱向隊(duì)形控制

$$?\begin{array}{rl}& z_i^c=z_i+\frac{{\tau }_z}{{\tau }_{\dot{z}}}{\dot{z}}_i+{\tau }_z{u}_i\\ & u_i=?k{\dot{z}}_i?\sum _{j=1}^n{a}_{ij}[(z_i?z_j?z_{ij}^r)+\gamma ({\dot{z}}_i?{\dot{z}}_j)]\end{array}\text{\hspace{1em}(3-20)}$$

---

3.3.3 三維空間隊(duì)形控制算法

3.4 多無人機(jī)協(xié)同編隊(duì)的隊(duì)形保持

3.5 多無人機(jī)協(xié)同編隊(duì)的隊(duì)形變化

當(dāng)編隊(duì)穩(wěn)定收斂時(shí)，編隊(duì)成員之間的機(jī)間距離滿足式（3-22）時(shí)，則認(rèn)為隊(duì)形穩(wěn)定。

$$?\begin{array}{rl}& \underset{t\to \infty }{\lim }(x_i^{\prime }(t)?x_j^{\prime }(t))=x_{ij}^{\prime }(t)\\ & \underset{t\to \infty }{\lim }(y_i^{\prime }(t)?y_j^{\prime }(t))=y_{ij}^{\prime }(t)\\ & \underset{t\to \infty }{\lim }(z_i^{\prime }(t)?z_j^{\prime }(t))=z_{ij}^{\prime }(t)\\ & \underset{t\to \infty }{\lim }(v_i(t)?v_j(t))=0\\ & \underset{t\to \infty }{\lim }({\psi }_i(t)?{\psi }_j(t))=0\end{array}\text{\hspace{1em}(3-22)}$$

---

3.6 多無人機(jī)協(xié)同編隊(duì)算法仿真驗(yàn)證

3.6.1 狀態(tài)控制仿真驗(yàn)證

高度可能有錯誤，一直調(diào)不出來

---

3.6.2 隊(duì)形控制仿真驗(yàn)證

論文中的仿真結(jié)果圖如下：

---

指定航向角控制使用公式（3-1）和（3-3），結(jié)果如下：

3.6.4 隊(duì)形變換仿真驗(yàn)證

---

總結(jié)

以上是生活随笔為你收集整理的【Paper】2018_多无人机协同编队控制算法研究_林倩玉的全部內(nèi)容，希望文章能夠幫你解決所遇到的問題。

如果覺得生活随笔網(wǎng)站內(nèi)容還不錯，歡迎將生活随笔推薦給好友。