【Paper】2017_水下潜航器编队海洋勘测的协调控制方法研究
友情鏈接:【paper】2019_Consensus Control of Multiple AUVs Recovery System Under Switching Topologies and Time D
文章目錄
- 2.4.2 水下潛航器反饋線性化模型
- 第4章 基于雙層 Markov 變換拓撲的潛航器編隊協(xié)調(diào)控制
- 4.1 引言
- 4.2 問題描述與預備知識
- 4.2.1 問題描述
- 4.2.2 預備知識
- 4.2.2.1 馬爾科夫隨機變換拓撲
- 4.3 不穩(wěn)定通信條件下無領(lǐng)航者隊形的潛航器編隊協(xié)調(diào)控制
- 4.3.1 相同時變時間延遲條件下潛航器編隊協(xié)調(diào)控制
- 4.3.2 不同時變時間延遲條件下潛航器編隊協(xié)調(diào)控制
- 4.3.3 不確定附加非線性因素作用下的潛航器編隊協(xié)調(diào)控制
- 4.4 負責海洋環(huán)境擾動下領(lǐng)航者跟隨隊形的潛航器編隊協(xié)調(diào)控制
- 4.4.1 未知海流擾動下的潛航器編隊協(xié)調(diào)控制
- 4.4.2 海洋噪聲環(huán)境下的潛航器編隊協(xié)調(diào)控制
- 4.5 仿真驗證
- 4.5.1 不穩(wěn)定通信條件下無領(lǐng)航者潛航器編隊協(xié)調(diào)控制
- 4.5.2 復雜海洋環(huán)境下領(lǐng)航者跟隨者潛航器編隊協(xié)調(diào)控制
2.4.2 水下潛航器反饋線性化模型
針對第 iii 個潛航器個體,可以有
z˙1i=z2iz˙2i=ui(2-54)\begin{aligned} \dot{z}_1^i =& z_2^i \\ \dot{z}_2^i =& u_i \\ \end{aligned} \tag{2-54}z˙1i?=z˙2i?=?z2i?ui??(2-54)
其中 z1i∈R5,z2i∈R5,ui∈R5z_1^i \in \R^5, z_2^i \in \R^5, u_i \in \R^5z1i?∈R5,z2i?∈R5,ui?∈R5。
第4章 基于雙層 Markov 變換拓撲的潛航器編隊協(xié)調(diào)控制
4.1 引言
4.2 問題描述與預備知識
4.2.1 問題描述
4.2.2 預備知識
4.2.2.1 馬爾科夫隨機變換拓撲
4.3 不穩(wěn)定通信條件下無領(lǐng)航者隊形的潛航器編隊協(xié)調(diào)控制
無領(lǐng)航者潛航器編隊的反饋線性化模型定義如式(2-54),設第 iii 個潛航器的控制輸入 ui(t)u_i(t)ui?(t) 如下所示
ui(t)=?Kp∑j∈Nixaij(t)(xi(t)?xj(t))?Kv∑j∈Nivbij(t)(vi(t)?vj(t))(4-16)u_i(t) = -K_p \sum_{j \in N_i^x} a_{ij}(t) (x_i(t) - x_j(t)) - K_v \sum_{j \in N_i^v} b_{ij}(t) (v_i(t) - v_j(t)) \tag{4-16}ui?(t)=?Kp?j∈Nix?∑?aij?(t)(xi?(t)?xj?(t))?Kv?j∈Niv?∑?bij?(t)(vi?(t)?vj?(t))(4-16)
其中 Kp,KvK_p, K_vKp?,Kv? 分別表示位置和速度通信拓撲下的控制增益,aij(t),bij(t)a_{ij}(t), b_{ij}(t)aij?(t),bij?(t) 分別表示在 ttt 時刻位置和速度通信拓撲的鄰接矩陣 Ap,AvA_p, A_vAp?,Av? 的 (i,j)(i,j)(i,j) 單元。
4.3.1 相同時變時間延遲條件下潛航器編隊協(xié)調(diào)控制
根據(jù)式(4-16)可得時延條件下的協(xié)調(diào)控制輸入為
ui(t)=?Kp∑j∈Nixaij(t)(xi(t?τ)?xj(t?τ))?Kv∑j∈Nivbij(t)(vi(t?τ)?vj(t?τ))(4-24)u_i(t) = -K_p \sum_{j \in N_i^x} a_{ij}(t) (x_i(t\red{-\tau}) - x_j(t\red{-\tau})) - K_v \sum_{j \in N_i^v} b_{ij}(t) (v_i(t-\red{\tau}) - v_j(t\red{-\tau})) \tag{4-24}ui?(t)=?Kp?j∈Nix?∑?aij?(t)(xi?(t?τ)?xj?(t?τ))?Kv?j∈Niv?∑?bij?(t)(vi?(t?τ)?vj?(t?τ))(4-24)
其中 τ\tauτ 表示時變時間延遲 τ(t)\tau(t)τ(t)。
4.3.2 不同時變時間延遲條件下潛航器編隊協(xié)調(diào)控制
根據(jù)式(4-16),取具有不同時間延遲的控制輸入為
ui(t)=?Kp∑j∈Nixaij(t)(xi(t?τ1)?xj(t?τ1))?Kv∑j∈Nivbij(t)(vi(t?τ2)?vj(t?τ2))(4-49)u_i(t) = -K_p \sum_{j \in N_i^x} a_{ij}(t) (x_i(t\green{-\tau_1}) - x_j(t\green{-\tau_1})) - K_v \sum_{j \in N_i^v} b_{ij}(t) (v_i(t-\blue{\tau_2}) - v_j(t\blue{-\tau_2})) \tag{4-49}ui?(t)=?Kp?j∈Nix?∑?aij?(t)(xi?(t?τ1?)?xj?(t?τ1?))?Kv?j∈Niv?∑?bij?(t)(vi?(t?τ2?)?vj?(t?τ2?))(4-49)
4.3.3 不確定附加非線性因素作用下的潛航器編隊協(xié)調(diào)控制
因附加非線性因素的存在,原模型(2-54)轉(zhuǎn)變成具有附加非線性項的二階積分模型,
x˙i(t)=vi(t)v˙i(t)=fv(xi(t),vi(t))+ui(t)(4-65)\begin{aligned} \dot{x}_i(t) =& v_i(t) \\ \dot{v}_i(t) =& \red{f_v(x_i(t), v_i(t)) +} u_i(t) \\ \end{aligned} \tag{4-65}x˙i?(t)=v˙i?(t)=?vi?(t)fv?(xi?(t),vi?(t))+ui?(t)?(4-65)
根據(jù)式(4-16),設存在不同時變延遲環(huán)節(jié)的潛航器編隊協(xié)調(diào)控制器為
ui(t)=?Kp∑j∈Nixaij(t)(xi(t?τ1)?xj(t?τ1))?Kv∑j∈Nivbij(t)(vi(t?τ2)?vj(t?τ2))(4-66)u_i(t) = -K_p \sum_{j \in N_i^x} a_{ij}(t) (x_i(t\green{-\tau_1}) - x_j(t\green{-\tau_1})) - K_v \sum_{j \in N_i^v} b_{ij}(t) (v_i(t-\blue{\tau_2}) - v_j(t\blue{-\tau_2})) \tag{4-66}ui?(t)=?Kp?j∈Nix?∑?aij?(t)(xi?(t?τ1?)?xj?(t?τ1?))?Kv?j∈Niv?∑?bij?(t)(vi?(t?τ2?)?vj?(t?τ2?))(4-66)
4.4 負責海洋環(huán)境擾動下領(lǐng)航者跟隨隊形的潛航器編隊協(xié)調(diào)控制
4.4.1 未知海流擾動下的潛航器編隊協(xié)調(diào)控制
海流是隨著海域、深度、時間、水文、鹽度等若干因素變化而變化,難以用具體函數(shù)描述。通常針對潛航器的任務區(qū)域以及時間等因素,在有限的時間和范圍內(nèi)構(gòu)建局部海流流速和方法。
在海流擾動 fc(x)f_c(x)fc?(x) 作用下,線性領(lǐng)航者潛航器的模型為
x˙l=vl+fc(t)(4-85)\dot{x}_l = v_l \red{+ f_c(t)} \tag{4-85}x˙l?=vl?+fc?(t)(4-85)
其中領(lǐng)航者的速度 vl(t)v_l(t)vl?(t) 是根據(jù)任務隨時間 ttt 發(fā)生變化。
在海流擾動 fc(x)f_c(x)fc?(x) 作用下,跟隨者的模型可以定位為
x˙i(t)=vi(t)+fc(t)v˙i(t)=ui(t)(4-86)\begin{aligned} \dot{x}_i(t) =& v_i(t) \red{+ f_c(t)} \\ \dot{v}_i(t) =& u_i(t) \\ \end{aligned} \tag{4-86}x˙i?(t)=v˙i?(t)=?vi?(t)+fc?(t)ui?(t)?(4-86)
取潛航器在領(lǐng)航者跟隨隊形結(jié)構(gòu)下 ttt 時刻的協(xié)調(diào)控制輸入為
ui(t)=?Kp∑j∈Nixaij(t)(xi(t?τ1)?xj(t?τ1))?Kv∑j∈Nivbij(t)(vi(t?τ2)?vj(t?τ2))?Kpcli(t)(xi(t?τ1)?xl(t?τ1))?Kvdli(t)(vi(t?τ2)?vl(t?τ2))(4-87)\begin{aligned} u_i(t) =& -K_p \sum_{j \in N_i^x} a_{ij}(t) (x_i(t\green{-\tau_1}) - x_j(t\green{-\tau_1})) - K_v \sum_{j \in N_i^v} b_{ij}(t) (v_i(t-\blue{\tau_2}) - v_j(t\blue{-\tau_2})) \\ & -K_p c_{li}(t) (x_i(t\green{-\tau_1}) - x_l(t\green{-\tau_1})) - K_v d_{li}(t) (v_i(t-\blue{\tau_2}) - v_l(t\blue{-\tau_2})) \\ \end{aligned} \tag{4-87}ui?(t)=??Kp?j∈Nix?∑?aij?(t)(xi?(t?τ1?)?xj?(t?τ1?))?Kv?j∈Niv?∑?bij?(t)(vi?(t?τ2?)?vj?(t?τ2?))?Kp?cli?(t)(xi?(t?τ1?)?xl?(t?τ1?))?Kv?dli?(t)(vi?(t?τ2?)?vl?(t?τ2?))?(4-87)
4.4.2 海洋噪聲環(huán)境下的潛航器編隊協(xié)調(diào)控制
在上文分析結(jié)果的基礎上,首先假設潛航器編隊在水下機動時會產(chǎn)生附加非線性因素,其次,將海流等外部擾動概括為未知外部擾動。
取外部海流擾動 ωi(t)\omega_i(t)ωi?(t) 為有界連續(xù)函數(shù)。在此約束條件下,反饋線性化后的跟隨者潛航器模型可以表示為
x˙i(t)=vi(t)+ωi(t)v˙i(t)=ui(t)+fv(xi(t),vi(t))(4-105)\begin{aligned} \dot{x}_i(t) =& v_i(t) \red{+ \omega_i(t)} \\ \dot{v}_i(t) =& u_i(t) \red{+ f_v(x_i(t), v_i(t))} \\ \end{aligned} \tag{4-105}x˙i?(t)=v˙i?(t)=?vi?(t)+ωi?(t)ui?(t)+fv?(xi?(t),vi?(t))?(4-105)
領(lǐng)航者潛航器的模型為
x˙l(t)=vl(t)+ωl(t)v˙l(t)=fv(xl(t),vl(t))(4-106)\begin{aligned} \dot{x}_l(t) =& v_l(t) \red{+ \omega_l(t)} \\ \dot{v}_l(t) =& \red{f_v(x_l(t), v_l(t))} \\ \end{aligned} \tag{4-106}x˙l?(t)=v˙l?(t)=?vl?(t)+ωl?(t)fv?(xl?(t),vl?(t))?(4-106)
其中,ωi(t),ωl(t)\omega_i(t), \omega_l(t)ωi?(t),ωl?(t) 表示外部海流擾動,fv(xi(t),vi(t))f_v(x_i(t), v_i(t))fv?(xi?(t),vi?(t)) 表示系統(tǒng)的附加非線性因素。
4.5 仿真驗證
4.5.1 不穩(wěn)定通信條件下無領(lǐng)航者潛航器編隊協(xié)調(diào)控制
4.5.2 復雜海洋環(huán)境下領(lǐng)航者跟隨者潛航器編隊協(xié)調(diào)控制
(1)海流干擾下的領(lǐng)航者跟隨編隊協(xié)調(diào)控制
假設定常海流為 uc=[0.25,0.25,0]m/su_c = [0.25, 0.25, 0]m/suc?=[0.25,0.25,0]m/s。
(2)海洋背景噪聲及外部擾動作用下的領(lǐng)航者跟隨編隊協(xié)調(diào)控制
海洋背景噪聲對水聲通信聲道的影響被定義為幅值為 1 的高斯白噪聲,且每個水聲通信聲道都存在任意的噪聲強度。
附加非線性因素定義為與潛航器速度狀態(tài)相關(guān)的飽和函數(shù),如式(4-152)所示,且滿足泊松分布:P(f(t,xi))=0.5P(f(t,x_i)) = 0.5P(f(t,xi?))=0.5。
f(t,xi)=0.01tanh?(vi(t))(4-152)f(t,x_i) = 0.01 \tanh(v_i(t)) \tag{4-152}f(t,xi?)=0.01tanh(vi?(t))(4-152)
其中 vi(t)v_i(t)vi?(t) 表示當前時刻第 iii 個潛航器的速度狀態(tài)向量。
總結(jié)
以上是生活随笔為你收集整理的【Paper】2017_水下潜航器编队海洋勘测的协调控制方法研究的全部內(nèi)容,希望文章能夠幫你解決所遇到的問題。
- 上一篇: 【Paper】2021_Observer
- 下一篇: 【Paper】2017_Distribu