無(wú)人機(jī)編隊(duì)的滾動(dòng)時(shí)域控制

2012-07-04 11:28:36華思亮

電光與控制 2012年3期

華思亮，尤優(yōu)，張紅，宋晗

(1.中航航空電子有限公司，北京 100086;2.北京航空航天大學(xué)，北京 100191)

0 引言

和單架無(wú)人機(jī)相比，無(wú)人機(jī)編隊(duì)在任務(wù)能力、靈活性、容錯(cuò)性等方面具有明顯優(yōu)勢(shì)，在區(qū)域搜索、環(huán)境監(jiān)測(cè)、協(xié)同作戰(zhàn)等民用和軍事領(lǐng)域得到了廣泛應(yīng)用［1－2］。

按照隊(duì)形描述，無(wú)人機(jī)編隊(duì)可分為固定編隊(duì)和群集編隊(duì)，固定編隊(duì)中無(wú)人機(jī)之間的相對(duì)位置不變，形成固定隊(duì)形;群集編隊(duì)沒有固定隊(duì)形，每架無(wú)人機(jī)只與鄰機(jī)保持適當(dāng)距離。根據(jù)是否存在氣動(dòng)耦合，固定編隊(duì)進(jìn)一步分為緊密編隊(duì)和松散編隊(duì)。緊密編隊(duì)控制對(duì)傳感器精度的要求非常苛刻以致難以滿足，因此在實(shí)際飛行中常結(jié)合不單純依靠理論模型的極值搜索方法，通過實(shí)時(shí)測(cè)量燃料流和性能函數(shù)梯度的變化控制僚機(jī)位于最優(yōu)氣動(dòng)位置［3］。松散編隊(duì)控制在理論研究和實(shí)際飛行中都取得了較多進(jìn)展，常見的松散編隊(duì)控制方法包括PID控制、非線性控制、智能控制、滾動(dòng)時(shí)域控制［4］等。位置關(guān)系描述是實(shí)現(xiàn)編隊(duì)控制的前提，包括長(zhǎng)機(jī)－僚機(jī)、廣義坐標(biāo)［5］、虛擬結(jié)構(gòu)等。位置關(guān)系描述與控制方法的組合形成了不同的編隊(duì)控制研究重點(diǎn)，本文研究應(yīng)用范圍較廣的基于長(zhǎng)機(jī)－僚機(jī)描述的松散編隊(duì)控制。

滾動(dòng)時(shí)域控制(Receding Horizon Control，RHC)是求解受約束優(yōu)化問題的有效方法［4］，在編隊(duì)控制問題中應(yīng)用RHC方法具有許多優(yōu)點(diǎn)，如代價(jià)函數(shù)可以綜合多種控制目標(biāo)，滾動(dòng)時(shí)域策略能夠適應(yīng)條件變化，具有處理控制輸入約束和系統(tǒng)狀態(tài)約束能力等。

本文采用二次規(guī)劃模型對(duì)編隊(duì)控制問題進(jìn)行描述，并基于此分別設(shè)計(jì)了標(biāo)準(zhǔn)RHC和雙模RHC編隊(duì)控制器，分析了設(shè)計(jì)中的關(guān)鍵問題，最后進(jìn)行了仿真實(shí)驗(yàn)和對(duì)比分析。

1 基于RHC的編隊(duì)控制問題描述

1.1RHC 原理

RHC將控制問題描述為有限時(shí)域上有約束的最優(yōu)化問題，具有在線處理控制約束和輸出約束的優(yōu)點(diǎn)。對(duì)于某個(gè)采樣時(shí)刻，在系統(tǒng)狀態(tài)約束和控制輸入約束下對(duì)代價(jià)函數(shù)進(jìn)行最優(yōu)求解，得到預(yù)測(cè)時(shí)域內(nèi)的最優(yōu)控制輸入序列;僅將其中第一項(xiàng)作用于系統(tǒng)，并將其余各項(xiàng)丟棄;系統(tǒng)狀態(tài)在該控制輸入的作用下變化;在采樣時(shí)刻，根據(jù)新的系統(tǒng)狀態(tài)重復(fù)以上過程，可得到該時(shí)刻的控制輸入;如此反復(fù)進(jìn)行即實(shí)現(xiàn)了系統(tǒng)的滾動(dòng)時(shí)域控制。RHC的一般結(jié)構(gòu)如圖1所示。

圖1 RHC的一般結(jié)構(gòu)Fig.1 General architecture of RHC

RHC中可采用數(shù)學(xué)規(guī)劃方法對(duì)編隊(duì)控制問題進(jìn)行建模。數(shù)學(xué)規(guī)劃模型的選取決定了問題描述精確度和在線求解的實(shí)時(shí)性，這二者往往是矛盾的，需要根據(jù)需求進(jìn)行權(quán)衡。非線性規(guī)劃具有最好的問題描述能力，但求解困難且實(shí)時(shí)性難以保證。二次規(guī)劃具有較好的問題描述能力，且當(dāng)代價(jià)函數(shù)的二次項(xiàng)參數(shù)矩陣是正半定陣時(shí)，二次規(guī)劃是凸優(yōu)化問題，具有很好的求解可行性和快速性。下面基于二次規(guī)劃模型在有限時(shí)域上對(duì)編隊(duì)控制問題進(jìn)行描述。

1.2 無(wú)人機(jī)預(yù)測(cè)模型

在基于RHC的編隊(duì)控制研究和飛行試驗(yàn)中，為了保證在線求解的實(shí)時(shí)性，常采用反饋線性化后的無(wú)人機(jī)模型或質(zhì)點(diǎn)模型，如 Honeywell公司 Organic Air Vehicle飛行器［4］以及 Boeing 公司 F-15A、T-33［6］的編隊(duì)控制。本文采用文獻(xiàn)［4］中的線性模型對(duì)無(wú)人機(jī)進(jìn)行建模。

假設(shè)各無(wú)人機(jī)飛行高度相同，無(wú)人機(jī)控制輸入有最大限幅，同時(shí)無(wú)人機(jī)受最大飛行速度約束。無(wú)人機(jī)模型為

迭代上式可得到系統(tǒng)狀態(tài)的預(yù)測(cè)值為

其中:Hx=(A，A2，…，AN)T;

1.3 代價(jià)函數(shù)設(shè)計(jì)

編隊(duì)控制的控制目標(biāo)是無(wú)人機(jī)間保持固定位置關(guān)系，同時(shí)所需的控制輸入較小，因此代價(jià)函數(shù)中應(yīng)包含系統(tǒng)狀態(tài)代價(jià)項(xiàng)和控制輸入代價(jià)項(xiàng)。RHC需要在當(dāng)前時(shí)刻后的固定時(shí)域內(nèi)進(jìn)行優(yōu)化解算，需在該時(shí)域內(nèi)設(shè)計(jì)代價(jià)函數(shù)。選取2范數(shù)作為代價(jià)函數(shù)的基本項(xiàng)，設(shè)固定時(shí)域長(zhǎng)度為N，則僚機(jī)RHC控制器的代價(jià)函數(shù)為

式中:xref，k+i+1為預(yù)期系統(tǒng)狀態(tài);uref，k+i為預(yù)期控制輸入;uk+i|k表示在k時(shí)刻對(duì)無(wú)人機(jī)k+i時(shí)刻控制輸入的預(yù)測(cè)。加權(quán)陣P，Q為正定矩陣，即 P=PT＞0，Q=QT＞0。為了得到較小的控制輸入，取預(yù)期控制輸入為零。將式(3)代入式(4)，可得

由上式可見，代價(jià)函數(shù)JQP是系統(tǒng)初始狀態(tài)xk和控制輸入序列的函數(shù)，其中是決策變量。對(duì)于每個(gè)確定的系統(tǒng)初始狀態(tài)xk，通過求解有約束的二次規(guī)劃問題可以得到一組最優(yōu)的控制輸入序列。

1.4 約束條件設(shè)計(jì)

編隊(duì)控制問題的約束條件是無(wú)人機(jī)的最大速度和最大控制輸入限幅，即

式中:Cx∈Rnv×n;nv為需要約束的分量數(shù)，Cx的元素僅包含0和1，Cx使轉(zhuǎn)化為中速度分量組合成的向量。

二次規(guī)劃只能處理僅包含決策變量的約束，因此式(7)需轉(zhuǎn)化為決策變量表達(dá)的形式。將式(3)代入式(7)，得到

從而得到狀態(tài)約束的決策變量表達(dá)。

1.5 編隊(duì)控制問題描述

由式(6)～式(9)，編隊(duì)控制的有限時(shí)域二次規(guī)劃模型為

優(yōu)化問題(10)中，ON(xk，)表示優(yōu)化問題 ON是xk，的函數(shù)，是時(shí)刻 k+i(i=0，1，…，N －1)時(shí)無(wú)人機(jī)控制輸入組成的序列，也是優(yōu)化問題的決策變量。xk是系統(tǒng)初始狀態(tài)，其值為xk0。對(duì)于某個(gè)確定的系統(tǒng)初始狀態(tài)xk0，通過求解優(yōu)化問題(10)，可以得到性能指標(biāo)的最小值，以及對(duì)應(yīng)的最優(yōu)決策變量，即有限時(shí)域內(nèi)系統(tǒng)的最優(yōu)控制輸入序列。

1.6 RHC編隊(duì)控制器

RHC編隊(duì)控制器的基本過程是:

1)在采樣時(shí)刻k，僚機(jī)狀態(tài)為x0，求解優(yōu)化問題(10)，得到未來(lái)N步的最優(yōu)控制輸入序列;

2)將最優(yōu)控制輸入序列的第1項(xiàng)作用于僚機(jī)，其余N－1項(xiàng)舍棄;

3)在控制輸入作用下，僚機(jī)在采樣時(shí)刻k+1到達(dá)新狀態(tài)x1;

4)將當(dāng)前時(shí)刻記為k，僚機(jī)狀態(tài)記為x0，返回步驟1)。

2 雙模RHC編隊(duì)控制器

2.1 設(shè)計(jì)思路

RHC中優(yōu)化問題存在可行解并不能保證閉環(huán)系統(tǒng)穩(wěn)定，例如預(yù)測(cè)時(shí)域過短時(shí)可能出現(xiàn)振蕩或發(fā)散的情況。雙模RHC是一種保證穩(wěn)定性的方案［7］，其基本思路是引入終端不變集 Ωf和對(duì)應(yīng)的控制器 uk=h(xk)，當(dāng)系統(tǒng)狀態(tài)在Ωf外時(shí)采用標(biāo)準(zhǔn)RHC算法，并限制預(yù)測(cè)狀態(tài)在時(shí)域終端進(jìn)入Ωf;當(dāng)實(shí)際狀態(tài)進(jìn)入Ωf時(shí)切換到控制器uk=h(xk)，由局部控制器保證Ωf內(nèi)系統(tǒng)穩(wěn)定。Limon證明雙模RHC可以用一個(gè)預(yù)測(cè)時(shí)域更長(zhǎng)的標(biāo)準(zhǔn)RHC等價(jià)［8］。

以上方案應(yīng)用于編隊(duì)控制問題存在一些不足。1)預(yù)測(cè)失配問題。長(zhǎng)機(jī)實(shí)際狀態(tài)和僚機(jī)對(duì)其預(yù)測(cè)狀態(tài)間的偏差隨著預(yù)測(cè)時(shí)域增加而增大，文獻(xiàn)［4］給出了預(yù)測(cè)時(shí)域過長(zhǎng)時(shí)編隊(duì)不穩(wěn)定的證明。2)雙模RHC設(shè)計(jì)方案保守，可行解的存在需要較長(zhǎng)的預(yù)測(cè)時(shí)域保證，此時(shí)采用標(biāo)準(zhǔn)RHC往往也閉環(huán)穩(wěn)定。

盡管存在以上問題，但雙模RHC編隊(duì)控制器對(duì)標(biāo)準(zhǔn)RHC的改進(jìn)和參數(shù)選取具有指導(dǎo)意義，如預(yù)測(cè)時(shí)域選取、終端加權(quán)設(shè)計(jì)等。

考慮長(zhǎng)機(jī)定常飛行時(shí)僚機(jī)雙模RHC控制器的設(shè)計(jì)。首先確定局部控制器和終端代價(jià)函數(shù)，然后求解此控制器對(duì)應(yīng)的不變集和終端代價(jià)。雙模控制器具有不同的設(shè)計(jì)方法，具體體現(xiàn)在局部控制器、終端不變集和終端代價(jià)函數(shù)的選擇以及不同的計(jì)算方法。本文以最優(yōu)控制器作為局部控制器，選取橢球描述的終端不變集以及二次加權(quán)形式的終端代價(jià)函數(shù)構(gòu)造控制器。

2.2 局部控制器與終端不變集設(shè)計(jì)

局部控制器為

選取橢球集作為終端不變集

若存在一個(gè)矩陣W=WT∈Rn×n滿足矩陣不等式

則橢球Ep={x∈Rn:xTWx≤1}是系統(tǒng)(11)關(guān)于控制器(12)的不變集［9］，即滿足不等式Wxk+1≤Wxk。

針對(duì)確定的局部控制器，若存在一個(gè)不變集，則該不變集的子集顯然也是該局部控制器的不變集，因此不變集的確定對(duì)控制器設(shè)計(jì)的保守性有較大影響。受約束線性時(shí)不變系統(tǒng)的最大不變集是一個(gè)多面體集，該集合計(jì)算和表示比較復(fù)雜［10］。

通過求解 MAXDET 問題(14)［11］，可得到橢球不變集xTWx≤1，該不變集是對(duì)最大不變集的一種近似。

其中:Y=W－1;Li是L的第i行。

2.3 終端加權(quán)設(shè)計(jì)

選擇終端加權(quán)為二次代價(jià)形式

其中:P=PT＞0，且滿足線性矩陣不等式［11］

式中:Q和R是前N－1項(xiàng)狀態(tài)和輸入的加權(quán)，選取合適的Q和R，由上式可得到終端加權(quán)P。

3 仿真分析

以Honeywell公司的 Organic Air Vehicle(OAV)飛行器編隊(duì)為仿真研究對(duì)象，基于內(nèi)環(huán)反饋線性化后的線性O(shè)AV模型，在外環(huán)進(jìn)行編隊(duì)控制。OAV的動(dòng)力學(xué)特性及坐標(biāo)系建立詳見文獻(xiàn)［4］。OAV數(shù)學(xué)模型為［4］

式中:xk=(xk，x，xk，y，xk，vx，xk，vy)T的分量為無(wú)人機(jī) x 和 y方向的位置和速度;uk=(uk，x，uk，y)T的分量為 x 和 y方向的控制輸入;B=diag(Ts，Ts)，Ts為采樣時(shí)間。只給出x方向的仿真結(jié)果和分析，y方向的情況與之類似。約束優(yōu)化問題求解采用Matlab優(yōu)化工具箱，MAXDET問題求解采用Sedumi軟件。

3.1 雙模RHC編隊(duì)控制

最優(yōu)控制器的狀態(tài)和輸入加權(quán)選取為單位陣，局部控制器為u= －(0.8410 1.6321)x，局部控制器對(duì)應(yīng)的橢球不變集為

令狀態(tài)加權(quán)Q=diag(1，1)，控制加權(quán)R=1，終端代價(jià)函數(shù)為

雙模RHC可以很好地控制僚機(jī)收斂于預(yù)期軌跡，同時(shí)有效地約束系統(tǒng)狀態(tài)和控制輸入。將預(yù)測(cè)時(shí)域減小到9時(shí)，盡管仍能得到優(yōu)化問題的可行解，但終端預(yù)測(cè)狀態(tài)未進(jìn)入不變集，不滿足雙模RHC的條件;預(yù)測(cè)時(shí)域等于或大于10時(shí)，終端狀態(tài)可以進(jìn)入不變集。然而在預(yù)測(cè)時(shí)域?yàn)?時(shí)，采用標(biāo)準(zhǔn)RHC控制器仍可得到與圖2同樣的控制效果，這體現(xiàn)了雙模RHC控制器設(shè)計(jì)的保守性。

圖2 基于雙模RHC的編隊(duì)控制(N=10)Fig.2 Formation control based on dualmode RHC(N=10)

優(yōu)化問題求解所需時(shí)間平均為0.032 s，由于Matlab是解釋性語(yǔ)言，若使用編譯后的優(yōu)化求解代碼，快速性還將進(jìn)一步提高。

3.2 標(biāo)準(zhǔn)RHC編隊(duì)控制:預(yù)測(cè)時(shí)域的影響

RHC中決策變量數(shù)與預(yù)測(cè)時(shí)域長(zhǎng)度成正比，較小的預(yù)測(cè)時(shí)域會(huì)降低優(yōu)化求解的復(fù)雜度，提高求解速度，然而預(yù)測(cè)時(shí)域過小會(huì)使控制器性能變差，甚至引起閉環(huán)系統(tǒng)不穩(wěn)定。將長(zhǎng)機(jī)運(yùn)動(dòng)擴(kuò)展到機(jī)動(dòng)飛行的情況。參數(shù)選取情況為:=2，=0.6，xk0=(0，0)T，Q=diag(1，0.2)，R=0.5，N=5，Ts=0.2。僚機(jī) x 方向的動(dòng)態(tài)響應(yīng)如圖3所示。

圖3 基于標(biāo)準(zhǔn)RHC的編隊(duì)控制(N=5)Fig.3 Formation control based on standard RHC(N=5)

標(biāo)準(zhǔn)RHC控制器有效地限制了系統(tǒng)控制輸入，控制在達(dá)到限幅時(shí)受到約束，但僚機(jī)位置始終在預(yù)期位置附近震蕩，無(wú)法跟蹤長(zhǎng)機(jī)。由于預(yù)測(cè)步長(zhǎng)較小，優(yōu)化問題僅考慮較短時(shí)域內(nèi)的情況，閉環(huán)系統(tǒng)不穩(wěn)定。將預(yù)測(cè)時(shí)域增加到10，其他參數(shù)不變，僚機(jī)x方向的動(dòng)態(tài)響應(yīng)如圖4所示。僚機(jī)的位置和速度均很好地跟蹤了長(zhǎng)機(jī)。由于狀態(tài)預(yù)測(cè)的作用，控制量會(huì)提前反應(yīng)以適應(yīng)控制目標(biāo)的未來(lái)變化。

圖4 基于標(biāo)準(zhǔn)RHC的編隊(duì)控制(N=10)Fig.4 Formation control based on standard RHC (N=10)

3.3 標(biāo)準(zhǔn)RHC編隊(duì)控制:終端加權(quán)的影響

終端代價(jià)函數(shù)的作用是使代價(jià)函數(shù)逼近無(wú)限時(shí)域時(shí)的情況，因此較大的終端加權(quán)可以改善系統(tǒng)的穩(wěn)定性。在第3.2節(jié)中預(yù)測(cè)時(shí)域N=5時(shí)閉環(huán)系統(tǒng)不穩(wěn)定，將終端權(quán)值 Qt=diag(1，0.2)增大為 Qt=diag(60，12)，其他參數(shù)不變，可得到穩(wěn)定的閉環(huán)系統(tǒng)，如圖5所示。

圖5 基于標(biāo)準(zhǔn)RHC的編隊(duì)控制(終端加權(quán)影響)Fig.5 Formation control based on standard RHC(with terminal penalty)

僚機(jī)在預(yù)期位置附近短暫震蕩后收斂到預(yù)期位置，并且能夠跟蹤長(zhǎng)機(jī)機(jī)動(dòng)，但軌跡收斂的時(shí)間長(zhǎng)于第3.2節(jié)中N=10的情況。

4 結(jié)束語(yǔ)

本文基于二次規(guī)劃模型設(shè)計(jì)了編隊(duì)控制的RHC控制器，該控制器具有良好的控制效果、約束處理能力和快速性。針對(duì)滾動(dòng)時(shí)域控制穩(wěn)定性問題，結(jié)合不變集理論設(shè)計(jì)了雙模RHC控制器，該控制器對(duì)標(biāo)準(zhǔn)RHC控制器的預(yù)測(cè)時(shí)域、終端加權(quán)等參數(shù)設(shè)計(jì)具有指導(dǎo)意義。通過仿真實(shí)驗(yàn)驗(yàn)證了RHC編隊(duì)控制器設(shè)計(jì)的有效性，并對(duì)比分析了不同參數(shù)選取對(duì)閉環(huán)系統(tǒng)性能的影響。下一步將重點(diǎn)在RHC編隊(duì)控制器的動(dòng)態(tài)環(huán)境適應(yīng)性方面開展研究。

［1］WANG X H，YADAV V，BALAKRISHNAN S N.Cooperative UAV formation flying with obstacle/collision avoidance［J］.IEEE Transactions on Control System Technology，2007，15(4):672-679.

［2］劉小雄，章衛(wèi)國(guó)，李廣文，等.無(wú)人機(jī)自主編隊(duì)飛行控制的技術(shù)問題［J］.電光與控制，2006，13(6):28-31.

［3］LAVRETSKY E，HOVAKIMYAN N，CALISE A，et al.Adaptive vortex seeking formation flight neuro control［C］//AIAA Guidance Navigation and Control Conference and Exhibit，2003:5726.

［4］KEVICZKY T，BORRELLI F，BALAS G J.Decentralized receding horizon control for large scale dynamically decoupled systems［J］.Automatica，2006，42:2105-2115.

［5］SPRY S，HEDRICK K.Formation control using generalized coordinates［C］//The 43rd IEEE Conference on Decision and Control.Atlantis.2004:2441-2446.

［6］SCHOUWENAARS T，VALENTI M，F(xiàn)ERON E，et al.Implementation and flight test results of MILP-based UAV guidance［C］//IEEE Aerospace Conference.2005:1-13.

［7］MAYNE D Q，RAWLINGS J B，RAO C V，et al.Constrained model predictive control:Stability and optimality［J］.Automatica，2000，36:789-814.

［8］LIMON A，ALAMO T，SALAS F，et al.On the stability of constrained MPC without terminal constraint［J］.IEEE Transactions on Automatic Control，2006，51(5):832-836.

［9］KERRIGAN E C.Robust constraint satisfaction:Invariant sets and predictive control［D］.Cambridge:University of Cambridge，U.K，2000.

［10］GILBERT E G，TAN K T.Linear systems with state and control constraints:The theory and application of maximal output admissible sets［J］.IEEE Transactions on Automatic Control，1991，36:1008-1020.

［11］LOFBERG J.Linear model predictive control stability and robustness［M］.Sweden:Linkopings University，2001.