蘇子康,李春濤,余躍,徐忠楠,王宏倫
(1.南京航空航天大學(xué) 自動化學(xué)院,南京 210016; 2.北京航天自動控制研究所,北京 100854;3.北京航空航天大學(xué) 自動化科學(xué)與電氣工程學(xué)院,北京 100083)
繩系拖曳飛行器是被拖曳飛機(jī)通過繩系拖曳飛行的一種特殊應(yīng)用飛行器[1-2],如機(jī)載拖曳天線[3-4]、繩系拖曳靶標(biāo)[5-7]、拖曳誘餌系統(tǒng)[8-10]、拖曳空中發(fā)射系統(tǒng)[11-12]、空中加油浮標(biāo)[13-14]、無人機(jī)空基回收對接浮標(biāo)[15-16]等。在這些應(yīng)用中,通常需要對柔性繩系拖曳飛行器的軌跡和姿態(tài)進(jìn)行控制[5]。例如,在空基回收中,受拖曳靶標(biāo)需要在多重氣流下實現(xiàn)位置穩(wěn)定,以為空中對接提供穩(wěn)定的目標(biāo)[16-17];而在繩系拖曳靶標(biāo)中,靶標(biāo)需要實現(xiàn)受拖曳機(jī)動軌跡跟蹤飛行,以便提高導(dǎo)彈等武器系統(tǒng)作戰(zhàn)效能試驗的可信度[6,8]。
目前,通常有2種策略實現(xiàn)對拖曳飛行器運(yùn)動軌跡的控制。一種為間接的被動控制方法,即通過拖曳母機(jī)的航路規(guī)劃和控制,以間接實現(xiàn)對無操縱面拖曳飛行器的被動控制[18-20],由于需要復(fù)雜的纜繩模型計算和母機(jī)規(guī)劃控制,該方法很難實現(xiàn)拖曳飛行器的高精度控制。另一種方法則直接用拖曳飛行器上配備的多個氣動操縱面,實現(xiàn)對拖曳飛行器運(yùn)動的主動控制[5],該方法已被應(yīng)用于空中加油拖曳浮標(biāo)穩(wěn)定[21-22]和繩系拖曳靶標(biāo)控制[3,5-6]等領(lǐng)域,其能實現(xiàn)更高精度和效率的軌跡控制,也避免了間接方法中的規(guī)劃與控制設(shè)計。因此,這種主動操縱面直接控制為拖曳飛行器軌跡控制提供了一種更高效的解決方案。
然而,當(dāng)前針對拖曳飛行器的抗干擾精確軌跡跟蹤控制的研究卻相對較少。國外學(xué)者Ro等[22-23]提出基于線性化的加油軟管-錐套模型,設(shè)計了軌跡控制器,但并未考慮未知?dú)饬骱筒豢蓽y纜繩拉力的干擾作用,其控制精度和抗干擾能力有待進(jìn)一步驗證。Sun等[24]將拖曳飛行器視為質(zhì)點(diǎn),提出了一種僅以浮標(biāo)阻力系數(shù)為唯一控制變量的位置穩(wěn)定控制器,但并未考慮拖曳飛行器的六自由度(6 DOF)模型。Bourmistrov等[5]提出了基于非線性動態(tài)逆的拖曳靶標(biāo)軌跡控制方法,但該方法同樣未考慮氣流擾動的影響,且缺少專門的抗干擾機(jī)制。國內(nèi)學(xué)者方曉星等[6]針對低空掠海拖曳飛行器,采用自抗擾技術(shù)設(shè)計了高度控制器,卻未充分考慮拖曳飛行器6 DOF模型。當(dāng)前,針對拖曳飛行器6 DOF模型的高抗擾軌跡精確跟蹤控制技術(shù)仍是一個有待深入研究的開放性問題。
拖曳飛行器軌跡控制器設(shè)計時需同時兼顧以下問題:①建立考慮氣流擾動影響的拖曳飛行器6 DOF運(yùn)動模型;②考慮未知擾流(母機(jī)尾渦、紊流和陣風(fēng)等)和不可測量瞬態(tài)纜繩拉力等多重干擾對拖曳飛行器運(yùn)動的影響;③兼顧整個纜繩-拖曳飛行器系統(tǒng)的穩(wěn)定;④軌跡控制需具有專門的抗干擾機(jī)制。
本文針對多重擾動下拖曳飛行器高抗擾機(jī)動軌跡跟蹤控制問題進(jìn)行了研究。首先,結(jié)合繩系拖曳系統(tǒng)多剛體動力學(xué)模型[14,23],構(gòu)建拖曳飛行器6 DOF非線性模型;然后,針對未知?dú)饬骱筒豢蓽y量瞬變纜繩拉力等擾動的綜合影響,構(gòu)建了基于最小學(xué)習(xí)參數(shù)神經(jīng)網(wǎng)絡(luò)(Minimal Learning Parameter Neural Network,MLPNN)的拖曳飛行器狀態(tài)/擾動在線估計器,該估計器依據(jù)飛行狀態(tài)對系統(tǒng)不可測量集總擾動進(jìn)行準(zhǔn)確重構(gòu),無需離線訓(xùn)練,重構(gòu)后的總擾動將在控制器設(shè)計中予以前饋補(bǔ)償,在此基礎(chǔ)上,結(jié)合反步動態(tài)面控制(Dynamic Surface Control,DSC)技術(shù),設(shè)計了一種基于最小學(xué)習(xí)參數(shù)神經(jīng)網(wǎng)絡(luò)狀態(tài)/擾動在線估計器的拖曳飛行器軌跡動態(tài)面控制方法,并分析了閉環(huán)系統(tǒng)的穩(wěn)定性;最后,通過拖曳飛行器位置穩(wěn)定和機(jī)動軌跡跟蹤飛行仿真,驗證MLPNN-DSC方法下的控制精度和抗風(fēng)擾性能。
為了完整描述拖曳飛行器系統(tǒng)受拖曳運(yùn)動特性,擬借鑒軟式空中加油拖曳軟管建模方法[14,23-24],采用長度可變的多段等長連桿-節(jié)點(diǎn)模型構(gòu)建拖曳纜繩-飛行器組合體多體動力學(xué)模型,同時考慮纜繩牽連拉力、重力、母機(jī)尾渦、大氣紊流、陣風(fēng)等因素的影響。
圖1為受拖曳飛行器系統(tǒng)示意圖。假設(shè)母機(jī)定高定速飛行;Og-XgYgZg為慣性坐標(biāo)系;OD-XDYDZD為拖曳坐標(biāo)系(也即建模參考坐標(biāo)系),其坐標(biāo)軸指向與母機(jī)航跡坐標(biāo)系OH-XHYHZH平行;OB-XBYBZB為拖曳飛行器機(jī)體坐標(biāo)系。
圖1 拖曳飛行器建模示意圖Fig.1 Schematic diagram of towed vehicle modeling
假設(shè)拖曳纜繩-浮標(biāo)組合體由N段等長連桿-節(jié)點(diǎn)單元構(gòu)成,連桿間由各自兩端可視為質(zhì)點(diǎn)的無摩擦球軸節(jié)點(diǎn)連接,每段質(zhì)量及載荷均集中于節(jié)點(diǎn)處;第1個節(jié)點(diǎn)為纜繩起始牽引點(diǎn),配備操縱面的拖曳飛行器為其第N個節(jié)點(diǎn)。由軟式空中加油拖曳軟管建模方法[14,23-24]可知,拖曳系統(tǒng)的運(yùn)動狀態(tài)(位置、偏轉(zhuǎn)姿態(tài)和拉力等)可以由各連桿相對拖曳坐標(biāo)系OD-XDYDZD的偏轉(zhuǎn)角度ξi和ζi(i=1,2,…,N)進(jìn)行描述。因此,通過纜繩-拖曳飛行器多剛體動力學(xué)建模,不僅可以對拖曳系統(tǒng)運(yùn)動狀態(tài)進(jìn)行準(zhǔn)確描述,還可以解算得到柔性纜繩對拖曳飛行器在其機(jī)體坐標(biāo)系下的拉力TN=[TNx,TNy,TNz]T,從而為無動力拖曳飛行器6 DOF非線性建模奠定基礎(chǔ)。需要強(qiáng)調(diào)的是,纜繩TN=[TNx,TNy,TNz]T通常為不可測量變量,后續(xù)設(shè)計中將其視為拖曳飛行器各子系統(tǒng)集總擾動的一部分予以重構(gòu)和補(bǔ)償。
結(jié)合固定翼飛機(jī)建模方法[25-28],構(gòu)建兼顧氣流擾動作用的拖曳飛行器6 DOF非線性運(yùn)動模型如下[5]:
式中:g為重力加速度;M =mN+mV,mN為第N節(jié)點(diǎn)質(zhì)量,mV為拖曳飛行器質(zhì)量;x、y、z為位置分量;V、χ、γ分別為空速、航跡偏航角、航跡傾角;Ix、Iy、Iz、Ixz為拖曳飛行器各軸轉(zhuǎn)動慣量;α、β、?分別為迎角、側(cè)滑角、滾轉(zhuǎn)角;p、q、r為三軸角速度;D、Y、L分別為阻力、側(cè)力、升力;L、M、N 為三軸力矩。
式中:Q為動壓;S為氣動截面積;b為拖曳飛行器翼展;ˉc為平均氣動弦長;cL、cD、cY分別為升力系數(shù)、阻力系數(shù)、側(cè)力系數(shù);cL、cM、cN分別為滾轉(zhuǎn)力矩系數(shù)、俯仰力矩系數(shù)、偏航力矩系數(shù);δa、δe、δr分別為副翼、升降舵、方向舵舵偏。
為便于非線性控制設(shè)計,需將式(1)~式(4)轉(zhuǎn)換成仿射非線性形式[5,27-28]。為簡便起見,定義如下:
式中:V0為母機(jī)期望拖曳飛行速度;ρ為大氣密度。則可得仿射非線性模型[27-28]為
式中:Fi(i=1,2,3,4)為各子系統(tǒng)集總擾動,后續(xù)將對其進(jìn)行重構(gòu)和補(bǔ)償;Bi(i=1,2,3,4)為子系統(tǒng)輸入矩陣。
徑向基函數(shù)神經(jīng)網(wǎng)絡(luò)(Radial Basis Function Neural Network,RBFNN)因其出色的全局逼近能力[29-31],已在非線性系統(tǒng)狀態(tài)/干擾逼近領(lǐng)域有了不少應(yīng)用。為了進(jìn)一步減少RBFNN的節(jié)點(diǎn)數(shù)和待調(diào)整參數(shù),最小學(xué)習(xí)參數(shù)(Minimal Learning Parameter,MLP)RBFNN被提出[31]。RBFNN的核心可以由引理1進(jìn)行概括。
引理1[30-32]對于初值為零的給定連續(xù)有界函數(shù)f(X)(f(0)=0),利用連續(xù)函數(shù)分離技術(shù)和RBFNN逼近技術(shù),則由RBFNN輸入X =[x1,x2,…,xn]T∈Rn與輸出y=W*Th(X)∈Rn之間的映射關(guān)系,可得
式中:c=[c1,c2,…,cn]T∈Rn為中心向量;bj為基函數(shù)的寬度。
鑒于拖曳飛行器是無動力的,根據(jù)反步控制分層設(shè)計思路[27-28,33-34],其軌跡跟蹤控制可以分為軌跡回路、航跡回路、姿態(tài)回路和角速度回路4個串級子系統(tǒng),如圖2所示。為了消除傳統(tǒng)反步控制中因連續(xù)求解虛擬控制量微分而產(chǎn)生的“微分爆炸”問題[35],本節(jié)擬采用動態(tài)面控制技術(shù)[35-36],來完成拖曳飛行器軌跡非線性跟蹤控制器設(shè)計。因此,通過結(jié)合MLPNN估計和動態(tài)面控制技術(shù),設(shè)計如圖2所示的拖曳飛行器高抗擾軌跡跟蹤控制方法。鑒于氣流擾動和纜繩拉力的影響不可測,采用MLPNN狀態(tài)/擾動在線估計器重構(gòu)各回路集總擾動,并予以前饋補(bǔ)償。各回路虛擬控制量的微分信號采用動態(tài)面控制器獲取。
圖2 拖曳飛行器軌跡跟蹤控制框圖Fig.2 Block diagram of towed vehicle trajectory tracking control
根據(jù)反步控制設(shè)計思路,拖曳飛行器軌跡跟蹤控制器的設(shè)計可通過如下步驟實現(xiàn)。
步驟1 定義軌跡跟蹤誤差e1=X1-X1c,X1c=[yc,zc]T/V0為拖曳飛行器期望的軌跡指令(yc和zc分別為拖曳飛行器橫側(cè)向和垂向軌跡指令)。則e1關(guān)于時間的微分為
注2 上述MLPNN估計器依據(jù)飛行狀態(tài)對系統(tǒng)不可測量集總擾動進(jìn)行準(zhǔn)確重構(gòu),無需離線訓(xùn)練。并且通過上述狀態(tài)/擾動在線估計器的構(gòu)建,權(quán)重量的估計(見式(26))將依賴于狀態(tài)估計誤差,避免了傳統(tǒng)權(quán)重更新律依賴于控制跟蹤誤差e1的問題[29-31],實現(xiàn)了狀態(tài)/擾動在線估計器和控制器參數(shù)的分離設(shè)計原則。
設(shè)計如下姿態(tài)回路控制律:
本節(jié)將對上述設(shè)計的拖曳飛行器軌跡跟蹤控制器閉環(huán)穩(wěn)定性進(jìn)行分析。
由式(43),可得
式中:λmin(·)、λmax(·)分別為某矩陣最小、最大特征值;Υ2=max{W*j,j=χ,γ,α,β,?,p,q,r}。
因此,式(51)可進(jìn)一步整理為
式中:μ=min{μ1,μ2,μ3,μ4}。
因此,當(dāng)μ>Ω/VL時,有V·L<0。即通過合適的控制參數(shù)選取,可以確保所有系統(tǒng)誤差最終一致有界。證畢
為分析檢驗本文設(shè)計軌跡跟蹤控制方法的有效性,基于拖曳飛行器6 DOF模型進(jìn)行仿真校驗。假設(shè)母機(jī)為定直平飛,飛行高度H0=7000 m,飛行速度V0=100 m/s。母機(jī)質(zhì)量為136000 kg,翼展為39.88 m。仿真校驗采用文獻(xiàn)[5]中的拖曳纜繩參數(shù)和拖曳飛行器參數(shù),并選取纜繩節(jié)點(diǎn)數(shù)目為N=10。
仿真中,控制器相關(guān)參數(shù)選取如下。
反饋增益:K1=3diag(1,1),K2=5diag(1,1),K3=8diag(1,1,1),K4=15diag(1,1,1);DSC時間常數(shù):τ2=0.06,τ3=0.05,τ4=0.03;MLPNN參數(shù):sn=100,ci=0,i=1,2,…,n,bj,j=1,2,…,sn,η2=30diag(1,1,1),Γ2=2diag(1,1,1),σ2=diag(1,1,1),η3=50diag(1,1,1),Γ3=2diag(1,1,1),σ3=0.5diag(1,1,1),η4=100diag(1,1,1),Γ4=4diag(1,1,1),σ4=0.2diag(1,1,1)。
本節(jié)將在以下2種情景下對所設(shè)計的控制方法進(jìn)行驗證:拖曳飛行器軌跡穩(wěn)定控制和拖曳飛行器機(jī)動軌跡跟蹤控制。
情景1考慮將拖曳飛行器穩(wěn)定控制于母機(jī)后方某給定空間位置點(diǎn),其潛在的應(yīng)用場景有空中對接(空中加油對接、空基回收對接等)、繩系拖曳陣列等。假設(shè)拖曳纜繩初始長度為L0=30 m。由纜繩-拖曳飛行器多體動力學(xué)模型可得無氣流擾動情況下拖曳飛行器穩(wěn)定位置為xc=(-14.74+V0t)m,yc=0 m,zc=(-H0+25.42)m。取該穩(wěn)定位置為期望位置,在圖3所示的氣流擾動(含母機(jī)尾渦、大氣紊流、陣風(fēng))下進(jìn)行驗證。
該情景下的仿真結(jié)果如圖4~圖11所示。圖4為采用MLPNN干擾估計器對各個回路干擾的估計效果??梢?,MLPNN干擾估計器可以準(zhǔn)確地近似估計各回路動態(tài)中的總擾動。為方便辨識和理解,采用拖曳飛行器在拖曳坐標(biāo)系 ODXDYDZD中的坐標(biāo)(xD,yD,zD)表示其位置,如圖5所示。由圖中結(jié)果可知,當(dāng)無穩(wěn)定控制器時,拖曳飛行器位置在較大范圍內(nèi)波動,其yD和zD方向波動范圍分別達(dá)到了[-1,2.5]m和[23.5,25.5]m,波動幅值分別達(dá)到了3.5 m和2.0 m。而采用本文方法可將yD和zD方向波動范圍分別精確限制在[-0.01,0.07]m和[25.40,25.44]m內(nèi),波動幅值分別控制在0.08 m和0.04 m內(nèi),相較于無穩(wěn)定控制器分別減少了97.7%和98%。該明顯效果也可由圖6和圖7直觀呈現(xiàn),圖6中,無穩(wěn)定控制器下垂直平面軌跡明顯在較大范圍內(nèi)波動,而在本文方法控制下,拖曳飛行器在鉛垂面軌跡運(yùn)動自始至終精確地維持在OD-XDYDZD坐標(biāo)系內(nèi)期望平衡位置點(diǎn)(0,25.42)m。可見,本文方法軌跡穩(wěn)定控制效果顯著,在圖3給定的多重擾流下仍能實現(xiàn)軌跡準(zhǔn)確的穩(wěn)定。
圖3 氣流擾動Fig.3 Airflow disturbances
圖4 情景1中MLPNN干擾估計效果Fig.4 Estimated disturbance approximations by MLPNN in Case 1
圖5 軌跡穩(wěn)定控制結(jié)果Fig.5 Control results of trajectory stabilization
圖6 無穩(wěn)定控制器下垂直平面軌跡Fig.6 Trajectory in vertical plane without stabilizer
圖7 本文方法控制下垂直平面軌跡Fig.7 Trajectory in vertical plane controlled by MLPNN-DSC method
圖8和圖9分別給出無穩(wěn)定控制器和本文方法控制下纜繩-拖曳飛行器部分時刻的歷史形態(tài)。無穩(wěn)定控制器時,纜繩-拖曳飛行器的形態(tài)在設(shè)定氣流擾動持續(xù)作用下會在較大范圍內(nèi)波動,處于不穩(wěn)定狀態(tài)。而采用本文方法在實現(xiàn)多重復(fù)雜擾流下保持拖曳飛行器位置穩(wěn)定的同時,也保證了整個柔性纜繩-拖曳飛行器形態(tài)始終穩(wěn)定。這也說明本文方法對于拖曳飛行器軌跡穩(wěn)定的有效性。
圖8 無穩(wěn)定控制器下纜繩-拖曳飛行器歷史形態(tài)Fig.8 Towed cable-vehicle system’s geometry history without stabilizer
圖9 本文方法控制下纜繩-拖曳飛行器歷史形態(tài)Fig.9 Towed cable-vehicle system’s geometry history controlled by MLPNN-DSC method
圖10為無穩(wěn)定控制器和本文方法控制下各角度變化曲線。由圖8和圖9可知,無穩(wěn)定控制器時航跡角變化幅值較大,而本文方法控制下航跡偏航角和航跡傾角基本維持在0附近,這也從航跡角度佐證了圖5~圖7的軌跡結(jié)果,間接說明了采用本文方法可以精確穩(wěn)定拖曳飛行器軌跡。圖10中同樣給出了氣流角(迎角和側(cè)滑角)及滾轉(zhuǎn)角的曲線,其中氣流角的波動是因為氣流擾動(尤其是紊流)的影響。圖11給出了本文方法軌跡穩(wěn)定控制對應(yīng)的操縱面偏轉(zhuǎn)量。需要說明的是,由于采用零滾轉(zhuǎn)角控制指令,拖曳飛行器的副翼偏轉(zhuǎn)基本為零。升降舵和方向舵的周期性波動變化是為抵抗周期性擾流所需付出的控制代價。
圖10 軌跡穩(wěn)定控制角度結(jié)果Fig.10 Control angle results of trajectory stabilization
圖11 軌跡穩(wěn)定控制舵面偏量Fig.11 Control surface deflections of trajectory stabilization
除了上述軌跡穩(wěn)定外,拖曳飛行器還有許多應(yīng)用情景,如引言所述拖曳飛行器航跡高抗擾精確機(jī)動飛行。假設(shè)拖曳纜繩初始長度為L0=300 m,則由拖曳多體動力學(xué)模型可得無氣流下拖曳飛行器平衡位置為xc0=(-265.53+V0t)m,yc0=0 m,zc0=(-H0+117.24)m。利用如式(64)和式(65)所示的螺旋機(jī)動軌跡,對本文方法進(jìn)行驗證。其中,時刻內(nèi)的軌跡是為兼顧拖曳飛行器由平衡位置(xc0,yc0,zc0)到螺旋機(jī)動軌跡的平滑切換。
圖12為MLPNN干擾軌跡效果。圖13和圖14給出了螺旋機(jī)動軌跡跟蹤結(jié)果和跟蹤誤差。由圖13可知,MLPNN方法能夠確保拖曳飛行器在給定擾流下實現(xiàn)對螺旋機(jī)動軌跡的精確跟蹤,其跟蹤精度可見于圖14,yD和zD方向?qū)C(jī)動軌跡跟蹤誤差分別控制在[-0.25,0.3]m 和[-0.15,0.15]m較小的范圍內(nèi),實現(xiàn)了較高的跟蹤精度。圖15為螺旋機(jī)動軌跡跟蹤結(jié)果隨時間變化的曲線。本文方法控制下的拖曳飛行器軌跡全程精確地跟蹤了給定的螺旋機(jī)動軌跡。
圖12 情景2中MLPNN干擾估計效果Fig.12 Estimated disturbance approximations by MLPNN in case 2
圖13 機(jī)動軌跡跟蹤結(jié)果Fig.13 Tracking results of maneuvering trajectory
圖14 機(jī)動軌跡跟蹤誤差Fig.14 Tracking errors of maneuvering trajectory
圖16為螺旋機(jī)動軌跡跟蹤對應(yīng)的各角度變化曲線。不同于軌跡穩(wěn)定情景,在螺旋機(jī)動軌跡跟蹤時,航跡偏航角和航跡傾角周期性變化,這也是為實現(xiàn)對螺旋機(jī)動軌跡跟蹤的必然要求。氣流角(迎角和側(cè)滑角)及滾轉(zhuǎn)角的曲線同樣可見于圖16。圖17為螺旋機(jī)動軌跡跟蹤控制對應(yīng)的舵面偏轉(zhuǎn)量。
圖16 機(jī)動軌跡跟蹤控制角度結(jié)果Fig.16 Control angle results of maneuvering trajectory tracking
圖17 機(jī)動軌跡跟蹤控制舵面偏量Fig.17 Control surface deflections of maneuvering trajectory tracking
1)結(jié)合繩系拖曳系統(tǒng)多剛體動力學(xué)模型,構(gòu)建拖曳飛行器6 DOF仿射非線性模型,為非線性控制設(shè)計奠定基礎(chǔ)。
2)構(gòu)建了基于MLPNN的拖曳飛行器狀態(tài)/擾動在線估計器,以便準(zhǔn)確重構(gòu)未知?dú)饬骱筒豢蓽y量瞬變纜繩拉力等組成的系統(tǒng)不可測量集總擾動。
3)結(jié)合MLPNN狀態(tài)/擾動在線估計器和反步動態(tài)面控制技術(shù),設(shè)計了一種基于MLPNN狀態(tài)/擾動在線估計器的拖曳飛行器軌跡動態(tài)面控制方法,并分析了閉環(huán)系統(tǒng)穩(wěn)定性。
4)在拖曳飛行器軌跡穩(wěn)定控制和機(jī)動軌跡跟蹤控制2種情景下,仿真驗證了多重位置擾流作用下MLPNN-DSC軌跡跟蹤控制方法具有較高的控制精度和較好的抗風(fēng)擾能力。