再入飛行器魯棒自抗擾跟蹤律設計*

陳上上 何英姿，2 張 釗，2 孫明瑋

1.北京控制工程研究所，北京100190 2.空間智能控制技術國家級重點實驗室, 北京 100190 3.南開大學計算機與控制工程學院, 天津 300071

?

再入飛行器魯棒自抗擾跟蹤律設計*

陳上上1何英姿1，2張 釗1，2孫明瑋3

1.北京控制工程研究所，北京100190 2.空間智能控制技術國家級重點實驗室, 北京 100190 3.南開大學計算機與控制工程學院, 天津 300071

針對高超聲速飛行器再入過程中模型參數不確定性問題，提出一種魯棒自抗擾控制(ADRC)阻力加速度跟蹤方法。該方法利用圓判據得到閉環ADRC跟蹤系統所容忍的模型參數不確定性范圍，進而可以根據工程應用中對魯棒性的需求來設計控制參數。三自由度仿真結果表明，在考慮模型參數攝動情況下，跟蹤系統不僅穩定而且響應品質良好。 關鍵詞 高超聲速飛行器；自抗擾控制；跟蹤律；魯棒性

航天飛機再入過程采用了基于阻力加速度剖面的制導方法[1]，該方法事先設計滿足各種約束的參考剖面，當飛行過程中實際的阻力加速度-速度(D-V)關系偏離參考剖面時，制導系統按照設計的跟蹤律產生制導指令，驅動控制系統調整姿態，以保證飛行器跟蹤參考剖面。

這種制導方法簡單可靠，在歷次飛行任務中取得了巨大成功。目前該方法應用仍然十分廣泛，第二代可重復使用飛行器X-33、X-34和X-37B的再入制導都是以航天飛機制導律為基礎設計的。跟蹤律設計是這種制導方法的一個重要環節，關于該跟蹤系統的吸引域、魯棒性、飽和問題等方面都受到了國內外學者的關注。

文獻[2]對航天飛機再入阻力加速度跟蹤律進行了分析，指出這種PID跟蹤系統的原點平衡點只具有局部收斂性，該文還提出了一種反饋線性化的方法，保證了原點的全局收斂。文獻[3]引入滑模觀測器，估計了阻力加速度導數與建模誤差擾動，并結合反饋線性化研究了火星再入問題。文獻[4]設計了LQR跟蹤律，當飛行軌跡變化時不需調整控制參數就能保證跟蹤性能良好。文獻[5]考慮火星大氣密度與氣動參數的不確定性影響，分別設計了反饋線性化與H∞魯棒跟蹤律。文獻[6]與[7]分別設計了非線性預測跟蹤律，解決了小升阻比飛行器的飽和問題。

國內學者也對再入制導跟蹤律進行了研究：文獻[8]提出了一種H∞魯棒動態逆軌跡跟蹤律設計方法，以抑制模型不確定性和外部擾動的影響，實現對標稱軌跡的精確跟蹤。為了解決傳統阻力加速度跟蹤方法依賴于模型精度的問題，文獻[9]提出一種基于特征模型的自適應再入制導方法。文獻[10]采用反饋線性化實現對速度信號和航跡角信號的穩定跟蹤，同時采用切換控制消除系統不確定性影響，從而提高了系統的魯棒性。

當故障、再入條件大幅更改等異常事件發生時，常需要調整飛行軌跡，此時對模型依賴程度較大的各種跟蹤律已不再適用；而采用傳統魯棒理論設計的跟蹤律通常比較保守，當模型參數不確定性較大時，難以兼顧魯棒性與性能指標。文獻[11]與[12]指出：模型參數不確定性對ADRC[13]系統的穩定性以及動態性能等影響都很小。本文基于再入飛行器運動模型，首先設計ADRC阻力加速度跟蹤律，并根據魯棒理論設計控制參數，從理論上保證存在時變參數攝動情況下閉環非自治跟蹤系統的穩定性，最后通過三自由度仿真驗證設計方法的有效性。

1 運動模型

忽略地球自轉角速度及地球扁率等影響，無動力再入飛行器縱向運動方程為

(1)

式中，h為飛行高度，γ為航跡傾角，r為地心距，g為地球引力加速度，u=(L/D)cosσ，σ為傾側角，而阻力加速度與升力加速度為

(2)

(3)

式中，M為飛行器的質量，S為參考面積，CD為阻力系數，CL為升力系數。采用指數大氣密度模型

ρ=ρ0e-h/hs

(4)

式中，ρ0為海平面大氣密度，hs為大氣歸一化高度。

2 自抗擾跟蹤律設計

對式(4)兩邊求導得

(5)

(6)

兩邊求導得

(7)

式中，

另外，標稱狀態下有

(8)

本文用(·)0表示(·)的標稱值。標稱狀態通過參考剖面得到，所有標稱狀態均為已知量，顯然

將式(7)與(8)相減得

(9)

文中Δ(·)=(·)-(·)0。

(10)

由于z1，z2，z3分別用來估計x1和x2以及系統內部與外部擾動的總和f[13]，當估計達到穩態時期望

z1→x1

z2→x2

z3→f

因此設計控制律為

u=u0+(K1z1+K2z2-z3)/b0

(11)

控制原理如圖 1所示。

圖1 控制原理圖

3 魯棒性分析與設計

令

類似文獻[2]的處理過程，把對象誤差模型(9)在原點處泰勒展開，再把ESO式(10)與控制律式(11)代入后得到非自治閉環系統

(12)

式中，

O(X,t)為含X高階項。假設

(13)

考慮線性時變系統

(14)

令

Α(t)=Αm+E∑(t)F

式中，

∑(t)=diag{ε1(t),ε2(t)}，

令

G(s)=F(sI-Am)-1Ε

(15)

證明 系統式(14)等效于一線性定常模型與一線性時變反饋組成的閉環系統(見圖 2)。

圖2 等效系統方框圖

而

Φ(jω)+ΦT(-jω)=

[I+G(jω)][I-G(jω)]-1+

[I-GT(-jω)]-1[I+GT(-jω)]=

[I-GT(-jω)]-1[I-GT(-jω)]×

[I+G(jω)][I-G(jω)]-1+

[I-GT(-jω)]-1[I+GT(-jω)]×

[I-G(jω)][I-G(jω)]-1=

[I-GT(-jω)]-1{2[I-GT(-jω)G(jω)]}×

[I-G(jω)]-1={[I-G(jω)]-1}H·

{2[I-GT(-jω)G(jω)]}·[I-G(jω)]-1

顯然

Φ(jω)+ΦT(-jω)?[I-GT(-jω)G(jω)]

由于

故

[I-GT(-jω)G(jω)]>0

即對于所有ω∈R，Φ(jω)+ΦT(-jω)正定。

由式(15)可知,G(s)嚴格正則，因此Φ(∞)=I，即Φ(∞)+ΦT(∞)正定。

由此可知Φ(s)嚴格正實，進而由多變量系統的圓判據[14]可知，系統(14)絕對穩定，即原點是其全局一致漸近穩定平衡點。由李雅普諾夫間接法可知，原點也是系統(12)的局部一致漸近穩定平衡點。證畢。

取控制參數

(16)

容易驗證Αm赫爾維茲，閉環系統(12)能夠容忍的時變參數攝動范圍邊界見圖 3。

圖3 參數攝動范圍邊界

4 仿真分析

針對某大升阻比無動力軌道再入飛行器模型，首先采用航天飛機制導方法設計滿足各種過程約束與終端約束的參考剖面(D0-V)，接著采用本文方法設計跟蹤律，考慮大氣密度誤差與氣動參數攝動，進行三自由度仿真。仿真初始高度為60km，初始速度5km/s，初始航跡傾角-0.5°，終端高度30km，終端速度780m/s。大氣密度誤差模型

(17)

氣動參數攝動模型

ΔCx=0.1cos(0.2πMa)Cx

(18)

ΔCy=0.1sin(0.2πMa)Cy

(19)

式中，Cx為軸向氣動力系數，Cy為法向氣動力系數，Ma為飛行馬赫數。

阻力加速度跟蹤、控制量變化以及ESO估計結果如圖 4～ 7所示。由仿真結果可以看出：存在時變參數攝動情況下，設計的跟蹤律能夠保證閉環系統穩定；超調量、過渡時間和穩態誤差等響應品質較好；控制量變化較為平緩，未出現飽和情況；設計的ESO估計性能良好。

圖4 阻力加速度跟蹤結果

圖5 傾側角

圖6 升阻比

圖7 ESO的估計結果

5 結 論

針對高超聲速飛行器再入過程中模型參數不確定性問題，提出了一種魯棒自抗擾阻力加速度跟蹤方法。該方法將魯棒控制與自抗擾控制相結合，兼顧閉環系統的魯棒性與動態響應品質。三自由度仿真結果表明，該方法能夠滿足工程需求，具有一定的應用價值。

[1] Harpold J C, Graves C A. Shuttle Entry Guidance [J]. Journal of the Astronautical Sciences, 1979, 27(3): 239-268.

[2] Mease K D, Kremer J P. Shuttle Entry Guidance Revisited Using Nonlinear Geometric Methods [J]. Journal of Guidance, Control, and Dynamics, 1994, 17(6): 1350-1356.

[3] Talole S E, Benito J, Mease K D. Sliding Mode Observer for Drag Tracking in Entry Guidance[C]// AIAA Guidance, Navigation, and Control Conference and Exhibit. Hilton Head, South Carolina, USA:AIAA, 2007.

[4] Dukeman G A. Profile-Following Entry Guidance Using Linear Quadratic Regulator Theory[C]//AIAA Guidance, Navigation, and Control Conference and Exhibit. Monterey, USA: AIAA,2002.

[5] LU W M, Bayard D S. Guidance and Control for Mars Atmospheric Entry: Adaptivity and Robustness [R]// NASA Report (20060040643), 1999.

[6] LU P. Entry Guidance and Trajectory Control for Reusable Launch Vehicle [J]. Journal of Guidance, Control, and Dynamics, 1997, 20(1): 143-149.

[7] Joel B, Mease K D. Nonlinear Predictive Controller for Drag Tracking in Entry Guidance[C]// AIAA/AAS Astrodynamics Specialist Conference and Exhibit. Honolulu, Hawaii, USA:AIAA, 2008.

[8] 鄭總準, 王永驥, 謝富強，等.基于H∞魯棒動態逆的飛行器軌跡跟蹤方法[J].系統工程與電子技術, 2010, 32(6):1309-1313.(Zheng Zongzhun, Wang Yongji, Xie Fuqiang, et al. Trajectory Tracking Law for Hypersonic Vehicles Based on H∞Robust Dynamic Inversion[J].Systems Engineering and Electronics, 2010, 32(6): 1309-1313.)

[9] 張釗, 胡軍, 王勇.基于特征模型的再入飛行器制導律設計[J].空間控制技術與應用, 2010, 36(4):12-17. (Zhang Zhao, Hu Jun, Wang Yong. Characteristic Model-Based Reentry Vehicle Guidance Law Design [J]. Aerospace Control and Application, 2010, 36(4): 12-17.)

[10] 路遙, 王青, 董朝陽.輸出重定義的高超聲速飛行器魯棒自適應控制律設計[J].宇航學報, 2014, 35(3):331-339. (Lu Yao，Wang Qing，Dong Chao yang. A Study on Output Redefinition Robust Adaptive Control Method for Hypersonic Vehicle [J]. Journal of Astronautics, 2014, 35(3): 331-339.)

[11] Tian G, Gao Z Q. Frequency Response Analysis of Active Disturbance Rejection Based Control System[C]//The 16thIEEE International Conference on Control Applications. Singapore：IEEE，2007.

[12] Csank J, Gao Z Q. Uncertainty Reduction through Active Disturbance Rejection[C]//American Control Conference. Washington D.C, USA: AACC, 2008:3689-3694.

[13] Han J Q. From PID to Active Disturbance Rejection Control [J]. IEEE Transactions on Industrial electronics, 2009, 56(3):900-906.

[14] Khalil H K. Nonlinear Systems[M]. New Jersey: Prentice Hall, 200.

Tracking Law Design for Entry Vehicle Based on Robust Active Disturbance Rejection Control

Chen Shangshang1, He Yingzi1,2, Zhang Zhao1,2, Sun Mingwei3

1. Beijing Institute of Control Engineering, Beijing 100190, China 2. National Key Laboratory of Science and Technology on Space Intelligent Control, Beijing 100190, China 3. College of Computer and Control Engineering, Nankai University, Tianjin 300071, China

Arobustactivedisturbancerejectioncontrol(ADRC)lawisdevelopedfordragaccelerationtracking.Inordertodealwithmodelparameteruncertaintiesduringthereentryphaseofahypersonicvehicle,ananalysisapproachisderivedfromthecirclecriterion.Withtheproposedanalysisapproach,theallowableboundsformodelparameteruncertaintiescanbedetermined.Bycomparingtheboundswiththerobustrequirementsoftheengineeringapplications,controlparametersaredesigned.Three-degree-of-freedomsimulationresultsdemonstratetherobuststabilityandtheresponsequalityofthetrackingsysteminthepresenceofmodelparameterperturbation.

Hypersonicvehicle; ADRC;Trackinglaw;Robust

*總裝重點實驗室基金(9140C590108130C59212)；國家自然科學基金(61403030)

2013-03-12

陳上上 (1982-)，男，河北人，博士，主要研究方向為再入飛行器制導與控制；何英姿(1970-)，女，湖南人，博士，研究員，主要研究方向為空間操作控制技術和空天飛行器GNC技術等；張 釗(1981-)，男，河北人，博士，高級工程師，主要研究方向為航天器制導與控制；孫明瑋(1972-)，男，北京人，博士，副教授，主要研究方向為自抗擾控制、模型預測控制、飛行器制導與控制和非線性優化。

V448.2

A

1006-3242(2016)02-0049-05