張軍, 溫昊, 劉志林, 李國勝
(1.江蘇大學 電氣信息工程學院, 江蘇 鎮(zhèn)江 212013; 2.哈爾濱工程大學 智能科學與工程學院, 黑龍江 哈爾濱 150001)
高速多體船使用流線型支柱將排水體積與主體部分連接起來,具有甲板面積大、航行阻力小、耐波性好、運載能力強、橫向穩(wěn)定性好等優(yōu)點[1]。然而,在高海況航行時高速多體船的升沉和縱搖運動變化劇烈,這是因為多體船具有細長的側(cè)體,不同航速的水動力會對水下船體產(chǎn)生不同程度的縱向傾覆力矩,該力矩隨縱傾角的增大而增大,并且多體船的縱向恢復力矩非常小??v搖和升沉幅度過大,容易引起失速、艏部砰擊、乘員暈船等現(xiàn)象,嚴重影響適航性,因此需要采取合理的措施抑制升沉和縱搖運動幅度。目前在船體上安裝T型翼和壓浪板兩種附體可以實現(xiàn)協(xié)同減搖,T型翼安裝在船艏底部,可有效增加船體的附加質(zhì)量和阻尼,降低高速多體船的垂向運動幅度;壓浪板安裝在船尾,可以實現(xiàn)減阻[2-3]。
高速多體船的減搖控制是根據(jù)多體船航態(tài)的改變自動調(diào)節(jié)T型翼和壓浪板的攻角,增加附體的恢復力和力矩[2],從而減少升沉和縱搖運動幅度。然而,多體船的升沉和縱搖運動之間存在強耦合,并且水動力學系數(shù)具有較強的不確定性。針對多體船耦合的垂向運動模型,文獻[4]提出比例- 微分控制和傳遞函數(shù)解耦矩陣方法來減少升沉和縱搖運動幅度,但是解耦矩陣需要事先準確辨識多體船傳遞函數(shù),否則難以做到完全解耦,魯棒性較差。為了避免設(shè)計升沉和縱搖的解耦矩陣,文獻[5]設(shè)計線性高斯二次型控制器(LQG)實現(xiàn)減搖,但是沒有明確考慮水動力系數(shù)不確定性。為了提高減搖控制的魯棒性,文獻[6]提出模糊比例- 積分- 微分(PID)減搖控制,但是模糊規(guī)則選擇通常比較困難。文獻[7]在考慮最大海浪干擾下提出H∞控制來保證魯棒穩(wěn)定性,但是減搖性能比較保守。上述研究主要從升沉和縱搖運動的鎮(zhèn)定問題來考慮,并沒有考慮高速多體船減搖性能的優(yōu)化[8-9],而實際上減搖的目標是希望升沉和縱搖運動幅度盡可能地小,因此減搖控制尚需完善。
與H∞魯棒控制不同,預測控制不僅考慮鎮(zhèn)定控制,而且追求優(yōu)化控制性能。預測控制根據(jù)被控對象的歷史數(shù)據(jù)和模型信息來預測系統(tǒng)未來的輸出,采用滾動優(yōu)化方式獲得未來輸入,根據(jù)系統(tǒng)的輸出實時校正預測模型來減少魯棒控制的保守性,提高控制性能[10-12]。文獻[13]建立了高速多體船的狀態(tài)空間模型,采用預測控制與H∞魯棒控制進行減搖性能對比,結(jié)果表明預測控制的減搖性能明顯高于H∞魯棒控制,其原因在于:1)預測控制可以直接處理升沉和縱搖強耦合的多變量模型,不需要文獻[4]的復雜解耦矩陣設(shè)計;2)預測控制的滾動優(yōu)化提高了減搖性能和魯棒性,不需要文獻[7]保守地假設(shè)海浪干擾的最大值。但是,預測控制采用序列二次規(guī)劃(QP)在線求解控制量,計算量過大,嚴重影響了實際應用。因此,降低預測控制的計算量是必須解決的問題。顯式預測控制采用離線設(shè)計和在線增益調(diào)度相結(jié)合,計算量較少,但是當離線區(qū)域劃分過多時在線增益調(diào)度計算量也較大[14]。文獻[15]提出連續(xù)解析預測控制,不需要在線調(diào)度參數(shù),有效減少了預測控制的在線計算量,在高超聲速X-33驗證機的再入制導上得到驗證,取得了良好的效果,但是解析預測控制律中并沒有明確考慮模型不確性,以及風、浪、流等外部強干擾的影響,魯棒性有待進一步提高。
本文針對高速多體船的升沉和縱搖運動耦合以及減搖性能優(yōu)化問題,提出計算量少的解析預測控制。建立T型翼和壓浪板作為減搖附體的高速多體船垂向控制模型,基于誤差反饋校正的模型進行預測,采用數(shù)值積分方法獲得解析連續(xù)預測控制律,提高減搖控制的實時性,給出閉環(huán)系統(tǒng)的一致有界理論分析。最后,給出解析預測控制方法與廣義預測控制等其他方法的減搖性能仿真對比,通過實驗驗證了所提方法的有效性。
將T型翼和壓浪板作為減搖附體,利用T型翼和壓浪板翼面角度變化生成的恢復力和力矩來抑制減少升沉和縱搖變化幅度。建立高速多體船的運動坐標系如圖1所示。以船舶的重心位置為坐標原點O,x軸正方向由船尾指向船艏;y軸垂直于船舶縱剖面且指向船舶左舷;z軸與水平面相垂直,背向地心。圖1中w、φ分別為升沉位移和縱搖角。
假設(shè)多體船以穩(wěn)定航向和定常航速在無限深的水域行駛,忽略風和流等干擾,高速多體船的垂向運動模型[12]為
(1)
在模型(1)式中,縱搖和升沉運動存在加速度、速度、位移等變量強耦合,并且水動力學系數(shù)很難精確獲得,存在較強不確定性,給多體船的減縱搖控制帶來了困難。為便于控制器設(shè)計,將升沉和縱搖的耦合運動模型轉(zhuǎn)化為
(2)
式中:
為優(yōu)化高速多體船的減搖性能,提出連續(xù)解析預測控制減搖。定義減搖預測控制的連續(xù)優(yōu)化目標函數(shù)為
(3)
式中:t為當前時刻;T為控制時域,δc≤T<∞,δc為定義系統(tǒng)一致能控常數(shù);Q、R分別為狀態(tài)與控制的加權(quán)矩陣,Q≥0,R>0. 為了提高減搖控制的動態(tài)性,以及保證有限時域優(yōu)化的穩(wěn)定性,這里引入終端等式穩(wěn)定約束,
x(t+T|t)=0,
(4)
式中:x(t+T|t)表示基于t時刻對t+T時刻的預測狀態(tài)。則預測控制減搖轉(zhuǎn)化為如下優(yōu)化問題:
(5)
式中:u*(t)為最優(yōu)控制輸入。
文獻[15]中提出了解析快速預測控制方法,采用1階歐拉法近似描述預測模型,即
(6)
由于預測控制本身具有誤差反饋校正功能,這里將實際x(t)與預測x(t|t-h)進行比較、得出預測誤差,利用預測誤差對名義模型的預測值進行反饋校正,使得連續(xù)解析預測控制具有一定的抗擾動和克服系統(tǒng)不確定性的能力。
定義t時刻的誤差為
e(t)=x(t|t)-x(t|t-h),
(7)
式中:x(t|t)=x(t)。則基于誤差反饋校正的一步預測模型為
x(t+kh|t)=(I+hA)x(t+(k-1)h|t)+
Bu(t+(k-1)h|t)+ξe(t),
(8)
式中:ξ為反饋校正系數(shù)。進一步迭代,得
(9)
J≈h(0.5L(0)+L(1)+…+L(k)+
…+L(N-1)+0.5L(N)),
(10)
式中:L(k)=xT(t+kh|t)Qx(t+kh|t)+uT(t+kh|t)Ru(t+kh|t).令vT=[uT(t|t),uT(t+h|t),…,uT(t+(N-1)h|t)],將目標函數(shù)寫為如下緊湊形式:
(11)
由(4)式、(9)式可得到終端等式約為
(12)
式中:M(N,h)為關(guān)于N、h的矩陣函數(shù)。
(13)
對v和λ求偏導,根據(jù)泛函最優(yōu)的必要條件有(14)式[16]成立:
(14)
(14)式變換為如下形式:
(15)
若拉格朗日矩陣(15)式存在逆矩陣[17]
(16)
式中:E=H-1-H-1M(MTH-1M)-1MTH-1;F=H-1M(MTH-1M)-1;D=-(MTH-1M)-1。則可獲得如下解析形式的最優(yōu)控制序列:
(17)
由于預測控制只選取當前的控制序列,控制輸入為
(18)
式中:Km=[I2×2,02×2,…,02×2]。
2.2節(jié)提出的解析預測控制與顯式預測控制,以及文獻[17]的離散預測控制相比較,具有如下特點:
1)多體船的整個航行包絡(luò)空間較大,若采用顯示預測控制,離線需要劃分很多區(qū)域,進而導致在線增益調(diào)度花費很多時間。本文提出的解析預測控制律(17)式不需要在線調(diào)度參數(shù),減少了區(qū)域搜索時間。
2)預測模型(8)式是連續(xù)的,時間步長h可以動態(tài)調(diào)整,具有自適應性,h越小預測模型越準確,控制性能越好。基于離散模型的解析預測控制結(jié)構(gòu)是固定的[18],不具有自適應性,沒有考慮終端等式約束x(t+T|t)=0的情況,穩(wěn)定性通過調(diào)節(jié)預測時域和控制時域得到保證。
為分析控制律(17)式作用下閉環(huán)系統(tǒng)的穩(wěn)定性,本節(jié)分為兩個步驟證明:
1)對于無干擾系統(tǒng)的有限時域最優(yōu)控制可寫為
(19)
文獻[19]給出了對于任意控制時域T的穩(wěn)定控制律,即
(20)
(21)
Po(t+T,t+T)=0.
(22)
采用控制律(20)式系統(tǒng)是一致漸近穩(wěn)定的,并且存在Lyapunov函數(shù):
V=xTFo(t)x,
(23)
(24)
2)在最優(yōu)控制(20)式下的漸近穩(wěn)定基礎(chǔ)上,分析控制律(17)式作用下的閉環(huán)系統(tǒng)穩(wěn)定性為
(25)
由(17)式可知
(26)
對于(26)式中的第1項,文獻[15]給出證明:
u(t)-u*(t)=[K-K*]x(t)=
hΩ(t;N,h)x(t),
(27)
式中:
(28)
由(26)式可知,對于任意的正定QF>I4×4,總能找到h=T/N,使得
xT{[K-K*(t)]TBTFo+
FoB[K-K*(t)]+I4×4-QF}x=
xT{h[ΩT(t;N,h)BTFo+FoBΩ(t;N,h)]+
I4×4-QF}xT<0.
(29)
(30)
高速多體船在4級海浪中以40 kn的航速行駛,遭遇頻率取3.25 rad/s,遭遇角為180°迎浪航行,有義波高為2 m.海浪干擾選用國際拖曳水池會議(ITTC)單參數(shù)譜作為海浪仿真譜函數(shù)[20-21],即
(31)
式中:ω為海浪主導頻率;hw為海浪有義波高;g為重力加速度。高速多體船主要包括雙體船和三體船兩類,仿真中以三體船為例進行研究。三體船在航行時,對水線下部分進行切片計算可以得到船舶受到的海浪干擾力和力矩。求解三體船在不同頻率點下的海浪干擾力和干擾力矩分別為
(32)
式中:ζ為海浪波高;L為船體長度;n為波數(shù);d為船舶吃水;s為復變量;b為船寬;U為船速;ωe為海浪的遭遇頻率。由(32)式可得到多體船受到升沉力和縱搖力矩譜HF(ωe,β)和|HM(ωe,β)|。令ΦF(ωe,β)為干擾力功率譜,ΦM(ωe,β)為干擾力矩功率譜,Φζ(ωe,β)為遭遇海浪功率譜。根據(jù)
ΦF(ωe,β)=|HF(ωe,β)|2Φζ(ωe,β),
ΦM(ωe,β)=|HM(ωe,β)|2Φζ(ωe,β).
(33)
對(33)式進行逆傅里葉變換,采用數(shù)據(jù)擬合和疊加的方法,得到隨機海浪作用于三體船的干擾力和干擾力矩,分別如圖2、圖3所示。
圖2 海浪干擾力Fig.2 Wave disturbance force
圖3 海浪干擾力矩Fig.3 Wave disturbance moment
考慮多體船航速影響,依據(jù)切片理論對多體船運動參數(shù)求解,可以得到某三體船在某特定頻率下的一組三體船參數(shù)如下:A=
本文所提解析預測控制律結(jié)構(gòu)與預測步數(shù)N有關(guān)。預測步數(shù)越多,控制性能越好,但是控制器結(jié)構(gòu)復雜,實際中一般選為3或者4,這里N取4.當N固定時,時間步長h的選取將直接決定預測模型的精確性,影響控制效果。當時間步長h分別為0.4 s、0.5 s和0.6 s時仿真結(jié)果如圖4和圖5所示。從圖4和圖5中可以看出,時間步長h越小,升沉和縱搖減搖性能越好,其原因是h越小、預測模型越準確,控制量變大。實際中T型翼和壓浪板的輸入攻角有嚴格幅值約束,容易出現(xiàn)飽和現(xiàn)象,因此步長h需要折中選擇,這里h=0.5 s.
圖4 不同時間步長的三體船升沉運動Fig.4 Heaving motion of triple-hulled vessel at different time steps
圖5 不同時間步長的三體船縱搖運動Fig.5 Pitching motion of triple-hulled vessel at different time steps
分別進行沒有控制、文獻[9]的廣義預測控制、文獻[12]的解析預測控制、基于誤差反饋校正的解析預測控制4種情況下的多體船垂向運動對比(見圖6~圖9),減搖數(shù)據(jù)如表1所示,其中3種預測控制律的加權(quán)矩陣都選為Q=diag(1,1,1,1),R=diag(1,1),預測步數(shù)皆取為4.
圖6 三體船的升沉運動Fig.6 Heaving motion of triple-hulled vessel
表1 三體船升沉和縱搖運動的減搖仿真
圖6和圖7所示為無控和考慮誤差反饋校正的解析預測控制減搖控制對比,從中可以看出升沉和縱搖運動幅度明顯減少,升沉運動量減少60%左右,縱搖運動量減少80%左右,表明解析連續(xù)預測控制是有效的,不需要傳統(tǒng)預測控制的在線優(yōu)化。
圖7 三體船的縱搖運動Fig.7 Pitching motion of triple-hulled vessel
將文獻[9]的廣義預測控制與文獻[12]的解析預測控制進行對比,如圖8和圖9所示。從圖8和圖9中可以看出,文獻[12]的解析預測控制減搖效果更好,這是因為相對于文獻[9],該方法明確考慮了終端等式約束,提高了控制性能。但是,由于其預測模型沒有考慮隨機干擾和參數(shù)不確性,減搖性能還沒有達到理想效果。圖10和圖11所示為文獻[12]和本文所提基于誤差反饋校正解析預測控制減搖控制的對比,從中可以看出基于反饋校正的解析預測控制進一步減少升沉和縱搖運動幅度,對海浪干擾具有更強的抑制能力,其原因是誤差反饋校正提高預測模型的精度,減搖性能變好。
圖8 不同控制律的三體船升沉運動Fig.8 Heaving motions of triple-hulled vessel with different control methods
圖9 不同控制律的三體船縱搖運動Fig.9 Pitching motions of triple-hulled vessel with different control methods
設(shè)計一艘小型的實驗三體船,如圖12所示。三體船船體材料選為玻璃鋼,因為玻璃鋼具有耐腐蝕、質(zhì)量小、機械強度高等優(yōu)良特性。甲板部分材料選為鋁板,主要避免焊接時的變形。工控機和嵌入式底層控制板放在三體船艦島艙室,三體船內(nèi)部為相關(guān)傳感器、電源以及相關(guān)線路,三體船外形尺寸參數(shù)如表2所示。三體船的減搖附件選型為T型翼和壓浪板,在船艏底部安裝T型翼,用來降低多體船的垂向運動幅度,在船尾安裝壓浪板,用來減少航行阻力。T型翼和壓浪板為液壓驅(qū)動(見圖12),優(yōu)化后的附體參數(shù)見文獻[9]。
圖12 裝有T型翼和壓浪板的三體船F(xiàn)ig.12 Triple-hulled vessel with T-foil and flap
表2 三體船參數(shù)
實驗三體船的控制系統(tǒng)上位機選用工控機,工作平臺采用Windows XP系統(tǒng)和VC++6.0,實現(xiàn)三體船運動軌跡顯示和設(shè)置工作參數(shù),主要包括人工操作界面、串口通訊模塊、各傳感器檢測參數(shù)、升沉和縱搖顯示界面。實驗三體船的底層減搖穩(wěn)定控制系統(tǒng)選用 ARM7 架構(gòu)的 LPC2294 芯片作為主控芯片,內(nèi)嵌 UC/OS-II 操作系統(tǒng),微處理器接收升沉傳感器和縱搖傳感器量測的多體船運動信息,采用本文提出的解析預測控制算法實時解算T型翼和壓浪板的控制量,驅(qū)動液壓缸執(zhí)行機構(gòu),構(gòu)成閉環(huán)減搖控制系統(tǒng)。三體船升沉位移和縱搖角傳感器的數(shù)據(jù)采用串行通信方式與工控機通訊,工控機對傳送來的數(shù)據(jù)進行存儲和顯示,便于實時監(jiān)測和控制。
根據(jù)Froude縮放定律,實驗中采用10∶1的船舶模型,4級海況下波高為0.2 m,周期為2.06 s. 圖13所示為多體船實驗場景,船模航行速度為6.507 3 m/s. 實驗結(jié)果如圖14和圖15所示,從中可見在本文所提預測控制下升沉和縱搖運動幅度明顯下降,其中升沉運動幅度下降了40%左右,縱搖運動幅度下降了70%左右(0~70 s),減搖效果與仿真數(shù)據(jù)相比有一定差距。這是因為實驗三體船的水動力學參數(shù)與仿真模型數(shù)據(jù)有一定差距,并且升沉/縱搖傳感信號有較大的量測噪聲影響減搖效果,后續(xù)將對信號濾波和減搖的魯棒性進一步研究。
圖13 實驗驗證Fig.13 Experimental verification
圖14 實驗三體船的升沉運動Fig.14 Heaving motion of triple-hulled vessel
圖15 實驗三體船的縱搖運動Fig.15 Pitching motion of triple-hulled vessel
本文針對高速多體船在惡劣海況下縱搖和升沉運動幅度過大的特點,提出了計算量少的的解析預測控制減搖方法。得出主要結(jié)論如下:
1)基于誤差反饋校正和1階歐拉模型預測升沉和縱搖運動狀態(tài),提高預測模型精度;采用數(shù)值積分和最優(yōu)二次序列規(guī)劃理論獲得多體船減搖的解析預測控制律,減少預測控制在線優(yōu)化的復雜性。
2)基于Lyapunov穩(wěn)定性理論分析閉環(huán)系統(tǒng)的一致有界性,并與廣義預測控制等其他方法進行了性能對比,通過仿真和實驗驗證了所提方法的有效性。