王震宇 吳漢松 吳瑤
(海軍工程大學(xué)電氣與信息工程學(xué)院,武漢430033)
為了在最短的時(shí)間里到達(dá)目的地和減少燃油的消耗,總是力求使船舶以一定速度直線航行[1]。對(duì)船舶進(jìn)行直線航跡控制具有非常強(qiáng)的針對(duì)性和實(shí)踐性,也因此引起人們極大的關(guān)注,并很快成為當(dāng)今船舶運(yùn)動(dòng)控制研究中的一個(gè)熱點(diǎn)[2]。目前,隨著海軍現(xiàn)代化建設(shè)的需要,海軍艦船的操控性直接影響到艦船的戰(zhàn)斗力,實(shí)現(xiàn)艦船在各種干擾情況下的航跡跟蹤,其意義非常重要[3]。
在通常意義下,魯棒控制就是要試圖描述被控對(duì)象模型的不確定性,并估計(jì)在某些特定界限下達(dá)到控制目標(biāo)所留有的自由度。魯棒控制一直是一個(gè)非常活躍且具有挑戰(zhàn)性的研究領(lǐng)域。經(jīng)歷了眾多學(xué)者二十幾年的努力,魯棒控制理論得到了長足的發(fā)展,并取得了令人矚目的成果,逐漸形成了相對(duì)完整的理論體系[4-6]。閉環(huán)增益成形的控制算法是利用H∞控制的混合靈敏度控制算法的結(jié)果,用具有工程意義的參數(shù)直接構(gòu)造出補(bǔ)靈敏度函數(shù),其核心是直接用構(gòu)造的系統(tǒng)閉環(huán)傳遞函數(shù)矩陣的表示式設(shè)計(jì)控制器,用于構(gòu)造補(bǔ)靈敏度函數(shù)的四個(gè)參數(shù):最大奇異值、帶寬頻率、關(guān)門斜率和閉環(huán)頻譜峰值都是具有實(shí)際的工程意義。其理論的物理概念清晰,求解過程簡(jiǎn)單,故可以說閉環(huán)增益成形控制算法是一種工程意義簡(jiǎn)化的H∞魯棒控制算法[7]。
本文將 H∞控制中的閉環(huán)增益成形魯棒控制算法與輸入狀態(tài)精確反饋線性化相結(jié)合,針對(duì)船舶航跡系統(tǒng)的非線性數(shù)學(xué)模型,給出一種魯棒控器的設(shè)計(jì)方法,在加入擾動(dòng)后,控制該控制器也能有效使船舶行駛在預(yù)設(shè)航跡上,有效保證船舶航跡非線性系統(tǒng)的魯棒穩(wěn)定性和魯棒性能。
圖1為船舶航跡控制示意圖:
圖1 船舶航跡控制坐標(biāo)圖
其中:x, y為船舶重心相對(duì)于坐標(biāo)系XOY的坐標(biāo),?為航向角,U為船舶前進(jìn)速度。假定設(shè)定的直線航跡與X軸重合,則艏偏角就等于航向角?,船舶直線航跡控制的非線性數(shù)學(xué)模型:
其中:r為艏搖角速度,δ為輸入舵角,T, k, α為船舶操作性能參數(shù)[8]。船舶航跡控制的目標(biāo)就是在全局范圍內(nèi)保證橫偏位移y、艏偏角?和艏搖角速度r都趨近于零。
在船舶運(yùn)動(dòng)控制非線性系統(tǒng)中:
向量場(chǎng)
顯然rank(A)=3,矩陣A滿足對(duì)合條件,所以系統(tǒng)(1)是可以輸入—狀態(tài)線性化的。
定義z=(z1z2z3)T,z1可由以下條件獲得:
方程(3)最簡(jiǎn)單的解為 z1= y,則可以得到z2=Usin φ,z3=Ucosφ?r,得到的線性控制系統(tǒng)為:
通過狀態(tài)變換和輸入變換,利用原控制輸入δ來鎮(zhèn)定原非線性系統(tǒng)的問題已經(jīng)轉(zhuǎn)化為使用新控制輸入v來鎮(zhèn)定新系統(tǒng)的問題。
與該控制規(guī)律相對(duì)應(yīng)的原控制輸入為[8]:
在該系統(tǒng)中n=3,所以有:
采用Nomoto船舶模型:G=K/[s(Ts+1)]為被控對(duì)象,該模型被廣泛應(yīng)用與船舶自動(dòng)舵的控制器設(shè)計(jì)中,用該模型設(shè)計(jì)出的控制器階次較低易于實(shí)現(xiàn),同時(shí),補(bǔ)靈敏度函數(shù)T的奇異值曲線近似構(gòu)造為奇異值為一的三階慣性系統(tǒng)的頻譜曲線T,利用基于閉環(huán)增益成形算法的控制器。
則有:
計(jì)算得:
控制量v為:
將式(6)、式(7)和式(8)代入式(5)可得新的控制律為:
針對(duì)某實(shí)習(xí)船進(jìn)行仿真研究,參數(shù)如下[5]:船長126 m,船寬20.8 m,滿載吃水為8.0 m,方形系數(shù)為0.681,航速V=7.7 m/s,通過計(jì)算得K=k=0.48,T=216,取α=30,T1=5。假設(shè)設(shè)定橫偏位移y=200,艏偏角? =pi/18,輸入舵角δ=0,利用本文提出的控制算法進(jìn)行仿真。
在標(biāo)稱參數(shù)的情況下,其仿真結(jié)果如圖2、圖3和圖4所示:
圖2 標(biāo)稱參數(shù)下舵角的輸出曲線
圖3 標(biāo)稱參數(shù)下的橫偏位移的輸出曲線
圖2、圖3和圖4表明,在無干擾的環(huán)境下,H∞控制中的閉環(huán)增益成形魯棒控制算法與輸入狀態(tài)精確反饋線性化相結(jié)合得到的控制律能夠使橫偏位移y和艏偏角?很快收斂到零,舵角的變化較小,很快趨于穩(wěn)定,具有較好的控制效果。
圖4 標(biāo)稱參數(shù)下的航向角的輸出曲線
下面對(duì)存在擾動(dòng)的情況進(jìn)行仿真。設(shè)計(jì)參數(shù)T1=5,取幅值為0.0155頻率為0.3的正弦干擾加入到?,相當(dāng)于風(fēng)浪流擾動(dòng)對(duì)船舶產(chǎn)生8°的等效舵角。
由圖5、圖6和圖7可以看出,在風(fēng)浪干擾下,該控制器也可以使控制對(duì)象較快趨向與合理的范圍之內(nèi),操舵的頻率和幅度都很小,偏航量和航向角都在很小幅度內(nèi)變化。該魯棒控制器對(duì)船舶的航跡跟蹤有較好的控制效果,具有很好的魯棒穩(wěn)定性。
圖5 擾動(dòng)下舵角的輸出曲線
圖6 擾動(dòng)下橫偏位移的輸出曲線
圖7 擾動(dòng)下航向角的輸出曲線
本文針對(duì)船舶直線航跡控制系統(tǒng)的非線性數(shù)學(xué)模型,將H∞控制中的閉環(huán)增益成形魯棒控制算法與輸入狀態(tài)精確反饋線性化相結(jié)合,得到一個(gè)新的反饋控制規(guī)律,能夠使系統(tǒng)能夠較快趨于穩(wěn)定。
以某貨船為對(duì)象,在Matlab/Simulink環(huán)境下進(jìn)行仿真研究,仿真結(jié)果表明,由H∞控制中的閉環(huán)增益成形魯棒控制算法與輸入狀態(tài)精確反饋線性化相結(jié)合的控制規(guī)律可以使船舶直線航跡控制全局漸進(jìn)穩(wěn)定,具有較好的穩(wěn)定性,對(duì)存在干擾的情況下也能夠使橫偏位移y和艏偏角?收斂到零,且魯棒性較好,設(shè)計(jì)的控制律具有比較理想的控制效果。
[1]彭秀艷, 李小軍, 沈艷, 趙希人. 大型船舶航跡多變量隨機(jī)最優(yōu)控制[J]. 船舶工程, 2003, 25(3): 41-45.
[2]李鐵山, 楊鹽生, 洪碧光. 船舶直線航跡控制的魯棒自適應(yīng)非線性設(shè)計(jì)[J]. 大連海事大學(xué)學(xué)報(bào), 2003,30(4): 1-5.
[3]DO K D,JIANG Z P, PAN J. Robust global stabilization of under actuated ships on linear course:state and output feedback [J], Int. J. Control, 2003, 76(1): 11-17.
[4]Kharitonov V.L.Asymptotic stability of an equilibrium position of a family of systems of linear differential equations [J]. Differential Uarvneniyu,1978, 14: 2086-2088.
[5]Zames G. Feedback and optimal sensitivity: model reference transformations, multiplicative seminorms,and approximate inverses. IEEE Trans. Automat,Contr.1981, 26(2): 303-32.
[6]Doyel J C. Analysis of control systems with structured uncertainty. IEEE Proc. Part D.1982, 129: 242-250.
[7]賈欣樂, 張顯庫. 船舶運(yùn)動(dòng)智能控制與H∞魯棒控制[M]. 大連: 大連海事大學(xué)出版社, 2002: 273-277.
[8]周崗, 姚瓊薈, 陳永冰, 周永余, 李文魁. 不完全驅(qū)動(dòng)船舶直線航跡控制穩(wěn)定性研究. 自動(dòng)化學(xué)報(bào)[J],2007, 33(4): 379-383.
[9]Jean-Jacques E. Slotine, Weiping Li. Applied Nonlinear control[M]. 北京: 機(jī)械工業(yè)出版社.