夏極,黃斌
1 海軍裝備部駐武漢地區(qū)第二軍事代表室,湖北武漢430064
2 海軍工程大學(xué)動力工程學(xué)院,湖北武漢430033
采用X 舵的潛艇,每個舵葉旋轉(zhuǎn)都會同時影響潛艇的深度、縱傾、橫傾和航向[1-2]。與十字舵相比,X 舵的操縱性更靈活,能夠?qū)崿F(xiàn)給定姿態(tài)的空間旋回機(jī)動,但也增加了操縱方法的復(fù)雜度。國內(nèi)外學(xué)者在潛艇X 舵的控制方面研究較多,內(nèi)容涵蓋X 舵的優(yōu)化布局[3]、安全操縱[4]、空間運動模型[5]等領(lǐng)域,但在潛艇X 舵的自動控制方法方面研究較少,X 舵在潛艇運動控制上的優(yōu)勢還有待深入研究。本文將通過建立某型潛艇的空間運動模型,分析X 舵的控制特點,采用智能模糊控制方法實現(xiàn)潛艇空間旋回運動控制,為潛艇的操縱控制方法提供理論參考。
X 舵的4 片舵葉正交布置,每片舵葉均能獨立偏轉(zhuǎn);舵軸中心與潛艇中線面的夾角為45°,葉片轉(zhuǎn)動引起潛艇的偏轉(zhuǎn)和潛浮。X 舵的布局如圖1所示。圖1 中,δ1~δ4分別為X 舵4 片舵葉的舵角。
潛艇在水中的運動可看作剛體在流體中的空間運動,包括6 個運動自由度,分別為沿艇體運動坐標(biāo)系x,y,z 方向的平動和轉(zhuǎn)動。文獻(xiàn)[1]給出了十字舵潛艇水下六自由度運動方程,若要建立X 舵潛艇的六自由度運動方程,只需要將方程中對應(yīng)的舵角系數(shù)進(jìn)行變換即可。定義X 舵施加給潛艇的操縱力為[6-7]
式中:X,Y,Z 分別為施加于潛艇的縱向、橫向和垂向作用力;K,M,N 分別為施加于潛艇的縱向、橫向和垂向作用力矩。式(1)中各力和力矩的表達(dá)式為
式中:Xδiδi,Yδi,Zδi,Kδi,Mδi,Nδi為操舵引起的流體水動力系數(shù),數(shù)值由拖曳水池實驗得到;u為航速在運動坐標(biāo)系x軸方向的分量;δi為X 舵的4 個舵角。將式(1)與操縱性方程[1]中艉舵和方向舵對應(yīng)的力和力矩替換為X 舵操縱力和力矩,并考慮操舵角與其他運動參數(shù)的耦合等因素,可得到X 舵潛艇六自由度運動模型,具體替換過程如表1所示。表中δs,δr分別為艉舵和方向舵舵角,X舵的水動力系數(shù)Xδsδs,Xδrδr,Yδr,Zδs,Kδr,Mδs,Nδr值由拖曳水池試驗得到。
表1 六自由度運動方程中X 舵與十字舵方程的替換項Table 1 Replacement items between X-rudder and Cross-rudder of 6-DOF
本文利用基于對話框的微軟基礎(chǔ)類庫(microsoft foundation class,MFC)程序框架編制X舵潛艇六自由度運動仿真軟件,采用三階龍格—庫塔法求解潛艇六自由度運動微分方程,得到潛艇的運動狀態(tài)。
旋回運動是潛艇水下機(jī)動的常見方式,對于常規(guī)十字舵潛艇來說,需要同時操縱方向舵和艏、艉升降舵,來實現(xiàn)水下定深或空間旋回。操縱過程為:方向舵角(δr)提供旋回的誘導(dǎo)力,一般在旋回過程中保持舵角不變;艏舵角(δb)控制潛艇深度;艉舵角(δs)控制潛艇的縱傾。因橫傾無法由操舵進(jìn)行直接控制,因此常規(guī)的十字型艉舵潛艇在旋回時都存在一定的橫傾。如前所述,X 舵每片舵葉的轉(zhuǎn)動可以同時影響潛艇的深度、縱傾、橫傾和航向,因此X 舵除了能控制縱傾和深度,還能控制橫傾,理論上為實現(xiàn)給定姿態(tài)空間旋回創(chuàng)造了條件。
首先,對單舵無控制時潛艇的空間旋回運動進(jìn)行分析。潛艇航速8 kn,在無控制條件下,δ1~δ4單舵滿舵30°空間旋回相關(guān)狀態(tài)參數(shù)如表2 所示。
表2 X 舵空間旋回狀態(tài)參數(shù)Table 2 Status parameters of space turning of X-rudder
由表2 可見,采用δ1和δ4進(jìn)行旋回控制時,橫傾角很小,旋回直徑較大;而采用δ2和δ3進(jìn)行旋回控制時,橫傾角較大,旋回直徑較小。在δ1~δ4這4種旋回控制方式下,縱傾角和深度速率的變化幅度較小。
采用δ1和δ4進(jìn)行旋回控制時,如圖2(a)所示,潛艇在Fx作用下會右旋回運動,使得艇體產(chǎn)生右橫傾[1](內(nèi)側(cè)傾斜),而δ1和δ4本身所受的作用力F又會使艇體左傾,可見采用δ1和δ4進(jìn)行旋回控制時,δ1和δ4本身的受力會對橫傾有抑制作用。而采用δ2和δ3進(jìn)行旋回時,如圖2(b)所示,潛艇在Fx的作用下會右旋回運動,使艇體產(chǎn)生右橫傾[1],而δ2和δ3本身所受的作用力F 也會使得艇體右傾,可見采用δ2和δ3進(jìn)行旋回時,δ2和δ3本身的受力會對橫傾有促成作用。從另一角度來看,δ2和δ3對橫傾有相對更好的控制作用。
圖2 X 舵旋回運動受力分析Fig.2 Force analysis of turning motion of X-rudder
在100 s 仿真時刻,分別給X 舵4 個舵角一個30°的階躍操舵信號,橫傾角和縱傾角對X 舵的階躍響應(yīng)如圖3 所示。由圖3 可見,X 舵4 片舵葉對縱傾的控制作用相當(dāng),而δ2和δ3對橫傾的控制作用明顯好于δ1和δ4,這也證實了前文的分析結(jié)果。
根據(jù)以上分析結(jié)果,可確定旋回過程的控制策略,即采用δ1或δ4或二者組合作為旋回舵;采用δ2和δ3控制縱傾和橫傾,采用δb控制深度。
采用Mamdani 方法[7]對X 舵模糊控制器進(jìn)行設(shè)計,即采用語言集的形式描述控制系統(tǒng)的控制規(guī)則。要實現(xiàn)旋回過程X 舵和艏舵的自動控制,需設(shè)計以下非線性映射關(guān)系:
式中:ΔH為深度誤差;ΔHc為深度誤差變化率;Δθ為縱傾誤差;Δθc為縱傾誤差變化率;Δφ為橫傾誤差;Δφc為橫傾誤差變化率。
圖3 橫傾角和縱傾角對X 舵的階躍響應(yīng)Fig.3 Step response of roll and pitch angle to X-rudder
輸入和輸出變量論域的選擇會影響模糊控制器的動態(tài)效果,論域過大,會導(dǎo)致控制器響應(yīng)遲緩,而論域太小,又會導(dǎo)致控制量出現(xiàn)較大的超調(diào)和波動。經(jīng)反復(fù)測試,確定控制器輸入變量及其論域如表3 所示。
將6 個輸入變量(ΔH,ΔHc,Δθ,Δθc,Δφ,Δφc)和3 個輸出變量(δb,δ2,δ3)的論域劃分為13 個標(biāo)準(zhǔn)模糊集(NB(負(fù)大)、NBM(負(fù)中大)、NM(負(fù)中)…PM(正中)、PBM(正中大)、PB(正大)),對于上述若干輸入和輸出變量,模糊集的中心xi(i=1,2,…,13)取值不同,但均滿足-E=x1<x2<…x12<x13=E(E 為誤差),模糊集均采用三角形隸屬度函數(shù),由式(4)表示:
表3 模糊控制器輸入和輸出變量及論域Table 3 Fuzzy controller input and output variables and their domains
式中:μk為誤差E 相對模糊集k 的隸屬度;Ek為模糊集k 的中心對應(yīng)的橫坐標(biāo)。
分析深度H、縱傾角θ、橫傾角φ等對艏舵和X 舵的響應(yīng)規(guī)律,得到艏舵和X 舵對應(yīng)于不同被控量的模糊推理規(guī)則。
3.2.1 艏舵控制規(guī)則
深度誤差ΔH以及誤差變化率ΔHc的定義為
式中:Haim為目標(biāo)深度;H(t)為實際深度;tin和tout為每次迭代的輸入與輸出時間,tout-tin為時間步長。根據(jù)操舵規(guī)律,對于艏舵來說,正舵角產(chǎn)生使?jié)撏细〉淖饔昧?,?fù)舵角產(chǎn)生使?jié)撏聺摰淖饔昧?,艏舵控制深度的?guī)則可表示為矩陣Uδb~H:
模糊推理語言可表示為:
式中:i=1,2,…,13;j=1,2,…,13;ΔH1=NB,…,ΔH13=PB;ΔHc1=NB,…,ΔHc13=PB。通過艏舵模糊控制規(guī)則Uδb~H,結(jié)合ΔH 和ΔHc的隸屬度,可以得到(Uδb~H)ij及其對應(yīng)的權(quán)值Kij。利用中心平均解模糊方法,得到艏舵角δb模糊控制器的輸出為
式中:Kij為ΔHi隸屬度(μ(ΔHi))和ΔHcj隸屬度(μ(ΔHcj))的代數(shù)積,即Kij=μ(ΔHi)·μ(ΔHcj)。
3.2.2 X 舵控制規(guī)則
X 舵的布局如圖1 所示,4 片舵葉按照圓周方向均勻分布,定義δ1~δ4的正負(fù)為:舵力沿y 方向分量為正時的舵角為正,反之為負(fù)。
1)X 舵對于縱傾的控制規(guī)則
縱傾誤差Δθ及誤差變化率Δθc的定義如式(9)所示,橫傾誤差Δφ及誤差變化率Δφc的定義與其類似。
式中:θaim為目標(biāo)縱傾角;θ(t)為實際縱傾角。
X 舵的4 片舵葉對于縱傾的控制規(guī)律:舵角為正時產(chǎn)生艏傾力矩(負(fù)縱傾),舵角為負(fù)時產(chǎn)生艉傾力矩(正縱傾)。通過分析,X 舵對縱傾的模糊控制規(guī)則Uδi~θ與Uδb~H相同,即Uδi~θ=Uδb~H。
2)X 舵對于橫傾的控制規(guī)則。
X 舵的4 片舵葉對橫傾的控制規(guī)律各不相同,其中:δ2正舵會產(chǎn)生正(右)橫傾,負(fù)舵會產(chǎn)生負(fù)(左)橫傾,即Uδ2~φ=-Uδi~θ,而δ3的控制規(guī)律正好與δ2對橫傾的控制規(guī)律相反,即Uδ3~φ=Uδi~θ。定義取反-Uδi~θ的算法為:將矩陣Uδi~θ中的N 和B互換。
3)X 舵控制力的分配。
為了實現(xiàn)自動分配X 舵對于縱傾和橫傾兩個狀態(tài)量的控制力,引入X 舵控制權(quán)值的概念,建立權(quán)值模糊控制器??刂破鬏斎霝椋海éう?,Δφ);控制器輸出為:(Qθ,Qφ=1-Qθ);其中Qθ為X 舵對于縱傾的控制權(quán)限,Qφ為X 舵對于橫傾的控制權(quán)限。輸入論域為:Δθ ∈[-6,6],Δφ ∈[-3,3];輸出論域為:Qθ∈[0,1],Qφ∈[0,1]。
三角形隸屬度函數(shù)如式(4)所示,將輸入和輸出論域劃分為7 個標(biāo)準(zhǔn)模糊集??刂茩?quán)值模糊控制規(guī)則矩陣可表示為
從權(quán)值模糊控制器的設(shè)計過程來看,當(dāng)某個被控量的誤差小而其他被控量的誤差大時,該被控量的權(quán)值也小,這符合權(quán)值的變化規(guī)律。加入權(quán)值后,X 舵模糊控制器可由式(11)表示:
潛艇的初始運動狀態(tài)設(shè)定為定常定深直線運動且潛艇處于完全均衡的狀態(tài)[1],初始運動參數(shù)設(shè)定為航速10 kn,初始航行深度100 m,初始航向、縱傾角和橫傾角均為0°,所有舵角初始位置為零位。對X 舵潛艇水平面和空間旋回運動形式進(jìn)行控制仿真。
設(shè) 定δ1=-δ4=30°,控 制 目 標(biāo) 為:θaim=φaim=0°,Haim=100 m,采用δb,δ2和δ3控制的仿真結(jié)果如圖4所示。圖中η和ξ為固定坐標(biāo)系的水平面坐標(biāo)。
圖4 δ1=-δ4=30°,無縱傾、無橫傾定深旋回控制結(jié)果Fig.4 δ1=-δ4=30°,no pitch& no roll depth-keeping turning control results
由圖4 可見,在初始回轉(zhuǎn)階段,橫傾角的波動峰值為1.50°并迅速回0,縱傾角波動峰值為0.75°,深度波動峰值為0.2 m。進(jìn)入定?;剞D(zhuǎn)階段后,潛艇能保持無縱傾、無橫傾,深度保持在100 m初始深度。由仿真結(jié)果可見,采用δ1和δ4旋回時,δb,δ2和δ3控制姿態(tài)的效果較好,能夠?qū)崿F(xiàn)無縱傾、無橫傾定深旋回。
4.2.1 無縱、橫傾變深旋回
設(shè) 定δ1=-δ4=30°,控 制 目 標(biāo) 為:θaim=φaim=0°,Haim=200 m,采用δb,δ2和δ3控制的仿真結(jié)果如圖5所示。圖中ζ為固定坐標(biāo)系的垂向坐標(biāo)。潛艇首先進(jìn)行空間旋回運動,深度由100 m變深至200 m,然后在200 m 深度定深旋回。
圖5 δ1=-δ4=30°,無縱傾、無橫傾變深旋回控制結(jié)果Fig.5 δ1=-δ4=30°,no pitch& no roll depth-changing turning control results
4.2.2 有縱、橫傾變深旋回
有縱、橫傾本質(zhì)上相當(dāng)于存在不均衡量的條件[1],設(shè)定δ1=-δ4=10°,控制目標(biāo)為:θaim=3°,φaim=2°,Haim=200 m,采用δb,δ2和δ3控制的仿真結(jié)果如圖6所示。潛艇首先進(jìn)行空間旋回運動,深度由100 m變深至200 m,在變深過程中,橫傾角和縱傾角很快穩(wěn)定在控制目標(biāo)值θaim=3°和φaim=2°,最終,潛艇穩(wěn)定在200 m 深度以設(shè)定的姿態(tài)旋回。
圖4~圖6 所示的各種旋回方式控制仿真結(jié)果表明:X 舵對于橫傾的控制能力可以優(yōu)化潛艇的水下旋回運動,在X 舵角允許范圍[-30°,30°]內(nèi),可以實現(xiàn)任意姿態(tài)定深/變深旋回運動,這大大提高了潛艇水下運動能力。另一方面,也驗證了本文設(shè)計的X 舵旋回智能模糊控制系統(tǒng)的有效性。
圖6 δ1=-δ4=10°,θaim=3°,φaim=2°,變深旋回控制結(jié)果Fig.6 δ1=-δ4=10°,θaim=3°,φaim=2°depth-changing turning control results
本文通過分析X 舵對潛艇旋回運動的控制特點,設(shè)計了X 舵潛艇空間旋回模糊控制系統(tǒng),并針對潛艇水平面定深和空間變深旋回運動進(jìn)行了仿真分析,結(jié)論如下:
1)建立了X 舵4 片舵葉的動態(tài)權(quán)限分配規(guī)則,為旋回過程中X 舵對于縱傾、橫傾的控制力分配提供了具體的解決方案。
2)控制系統(tǒng)對于潛艇定深旋回運動和空間旋回運動有著較好的控制效果,能夠較好地發(fā)揮X 舵優(yōu)越的操縱性能。
3)驗證了X舵對于橫傾的控制效果,實現(xiàn)了無縱傾、無橫傾定深旋回運動控制,這是十字舵無法實現(xiàn)的,對于潛艇實際操縱有一定的借鑒參考意義。