屠園園 王大軼 李文博

1. 北京控制工程研究所, 北京100190 2. 北京空間飛行器總體設(shè)計部, 北京100094

執(zhí)行器故障衛(wèi)星的自適應(yīng)模糊滑模容錯控制*

屠園園1王大軼2李文博1

1. 北京控制工程研究所, 北京100190 2. 北京空間飛行器總體設(shè)計部, 北京100094

針對衛(wèi)星控制系統(tǒng)執(zhí)行器故障，考慮干擾與不確定性影響，設(shè)計了一種自適應(yīng)模糊滑模容錯控制器(AFSMC)。首先，將執(zhí)行器故障、干擾以及模型不確定性統(tǒng)一描述為系統(tǒng)的廣義總干擾；然后，為使系統(tǒng)能夠在有限時間內(nèi)快速穩(wěn)定且避免奇異，設(shè)計了非奇異快速終端滑?？刂破?NFTSMC)；其次，針對滑模系統(tǒng)固有的抖振現(xiàn)象，設(shè)計了自適應(yīng)算法對系統(tǒng)廣義總干擾進行補償，減小了切換增益，并以自適應(yīng)模糊系統(tǒng)逼近切換函數(shù)，柔化了輸入信號，從而有效削弱了系統(tǒng)抖振，大大提高了控制精度；最后，對所提方法進行了數(shù)值仿真驗證。

姿態(tài)跟蹤；滑?？刂?；干擾補償；自適應(yīng)模糊；Lyapunov穩(wěn)定性

隨著航天技術(shù)的發(fā)展，越來越多的衛(wèi)星在執(zhí)行相關(guān)任務(wù)時，需要在機動過程中保持高精度的姿態(tài)穩(wěn)定能力。結(jié)合實際工作環(huán)境，考慮運行過程中存在的干擾、噪聲等惡劣情況，衛(wèi)星的控制分系統(tǒng)不可避免地會發(fā)生故障[1-4]，尤其是長期處于高速運轉(zhuǎn)狀態(tài)的執(zhí)行機構(gòu)，其故障會嚴(yán)重影響控制精度[5-6]。為保證系統(tǒng)能夠高精度地順利完成既定任務(wù)，需提高其對執(zhí)行器故障的魯棒能力。因此，本文重點研究衛(wèi)星在姿態(tài)跟蹤過程中的容錯控制問題。

由于滑模變結(jié)構(gòu)控制技術(shù)在處理故障時無需故障診斷單元，具有良好的自主容錯性能,且能克服系統(tǒng)各種不確定性因素的影響，對干擾和未建模動態(tài)具有較強的魯棒性，近年來被廣泛應(yīng)用于航天器控制理論研究[7-10]。

然而，對滑模變結(jié)構(gòu)控制而言，當(dāng)系統(tǒng)軌跡到達切換面時，慣性使得運動點穿越切換面，產(chǎn)生抖振現(xiàn)象，不僅影響控制精度、增加能量消耗，還易激發(fā)系統(tǒng)中的高頻未建模動態(tài)，破壞系統(tǒng)性能，甚至導(dǎo)致系統(tǒng)振蕩或失穩(wěn)，損壞控制部件。 針對該問題，一些學(xué)者提出了模糊滑?？刂破鞯母拍頪11-13]，利用模糊系統(tǒng)對切換函數(shù)進行“模糊化”，以柔化控制信號，有效減弱系統(tǒng)由于不連續(xù)而引起的抖振現(xiàn)象。然而，由于模糊系統(tǒng)精度不高，自適應(yīng)能力有限，難以有效抑制系統(tǒng)的突發(fā)故障、干擾以及模型不確定性等復(fù)雜因素對姿態(tài)精度的影響，因此限制了控制精度的進一步提高。

1 衛(wèi)星運動建模

基于單位四元數(shù)，給出衛(wèi)星運動學(xué)方程為：

(1)

執(zhí)行器故障的衛(wèi)星動力學(xué)方程可以描述為：

(2)

其中，J∈3×3為衛(wèi)星轉(zhuǎn)動慣量，U∈3×m為執(zhí)行器安裝矩陣，Λ=diag{α1,α2,…,αm}為執(zhí)行器失效因子矩陣，αi∈[0, 1],i=1,2,…,m；τ∈m為執(zhí)行器輸出列陣，f∈m，d∈3分別為執(zhí)行器偏差故障和系統(tǒng)外部干擾。

qe=E(qd)q

(3)

基于誤差四元數(shù)，得到跟蹤誤差運動學(xué)方程：

(4)

可推得航天器跟蹤誤差動力學(xué)方程：

(5)

考慮參數(shù)不確定性,假設(shè)實際的系統(tǒng)慣量矩陣為J=J0+ΔJ，其中，J0為已建模標(biāo)稱慣量矩陣，ΔJ為不確定部分，則式(5)可改寫為：

(6)

(7)

(8)

2 自適應(yīng)模糊滑?？刂破髟O(shè)計

為使衛(wèi)星能夠在有限時間內(nèi)快速收斂，且有效避免奇異，本文選擇非奇異快速終端滑?？刂破鳛橄到y(tǒng)主控制器。相應(yīng)滑模面表示如下：

(9)

其中，α,β>0, 1

p/q。

2.1 常規(guī)NFTSM控制器

常規(guī)的變結(jié)構(gòu)控制器可以設(shè)計為：

u=ueq+uvss

(10)

若存在：

(11)

2.2 基于干擾補償?shù)腘FTSM控制器

2.2.1 控制器設(shè)計

假設(shè)G∈3是系統(tǒng)的廣義總干擾，包含執(zhí)行器偏差故障、參數(shù)不確定性以及各種干擾力矩，滿足若分別是G的估計值和理想觀測值，則估計誤差：

(12)

為使衛(wèi)星能對期望姿態(tài)進行有效跟蹤并加以保持，這里基于Lyapunov函數(shù)來設(shè)計控制器。選擇Lyapunov函數(shù)如下：

(13)

其中，W-1∈3×3是正定對稱矩陣。對上式求導(dǎo)：

(14)

結(jié)合式(9)和(14)可推得：

(15)

相應(yīng)的控制器設(shè)計如下：

(16)

其中，φ是基于雙曲正切的魯棒控制項，

(17)

引入該項是為了補償估計算法的近似誤差。由雙曲正切函數(shù)性質(zhì)可知φ滿足：STφ>0。

2.2.2 穩(wěn)定性證明

證明：選取Lyapunov函數(shù)如下：

對時間t求導(dǎo)，并帶入控制律式(16)得：

(18)

對比式(11)，可知引入干擾補償后切換增益項η大大降低，有效削弱了系統(tǒng)的振顫。

當(dāng)系統(tǒng)狀態(tài)在滑模面上時，S=0，由滑模面定義式(9)得：

(19)

2.3 自適應(yīng)模糊滑模控制器

控制律式(16)中的符號函數(shù)sign(S)是導(dǎo)致系統(tǒng)抖振的直接原因，非常不利于實際執(zhí)行。為了能夠既削弱系統(tǒng)抖振，又保持滑模變結(jié)構(gòu)控制對執(zhí)行器故障、模型不確定性以及干擾等實際因素的魯棒性，本小節(jié)采用自適應(yīng)模糊系統(tǒng)對符號函數(shù)進行逼近，該系統(tǒng)的輸入為滑模面S，輸出為符號函數(shù)的估計值。

設(shè)ufz=ηsign(S)，其各分量估計值為：

(20)

(21)

假設(shè)理想的調(diào)整參數(shù)向量為θ*，則實際調(diào)整參數(shù)的誤差向量可以定義為：

(22)

基于Lyapunov函數(shù)可以推導(dǎo)參數(shù)θ的自適應(yīng)律，建立如下Lyapunov函數(shù)：

(23)

對上式求導(dǎo)得：

(24)

(25)

(26)

由式(22)可得調(diào)整參數(shù)的自適應(yīng)變化律為：

(27)

對上述自適應(yīng)模糊系統(tǒng)，定義模糊集：NB=負大，NM=負中，NS=負小，ZE=零，PS=正小，PM=正中，PB=正大。

隸屬度響應(yīng)函數(shù)為：

μNB=1/{1+exp(10(x+5π/6))}，
μNM=exp(-2(x+2π/3)2)，
μNS=exp(-2(x+π/3)2)，
μZE=exp(-2x2)，
μPS=exp(-2(x-π/3)2)，
μPM=exp(-2(x-2π/3)2)，
μPB=1/{1+exp(10(x-5π/6))}。

3 數(shù)值仿真

下面對本文提出的自適應(yīng)模糊滑模容錯控制器(AFSMC)的有效性進行數(shù)值仿真驗證，并與常規(guī)NFTSMC、含干擾補償?shù)腘FTSMC進行對比分析。期望運動模型參考文獻[14]，衛(wèi)星及控制器參數(shù)分別由表1～2給出，仿真結(jié)果如圖1～4所示。

表1 衛(wèi)星參數(shù)

表2 控制器參數(shù)

觀察圖1～3可知，未發(fā)生故障時，在3種控制器作用下，系統(tǒng)均可于13s內(nèi)穩(wěn)定。采用常規(guī)NFTSMC的系統(tǒng)，受符號函數(shù)影響，存在明顯抖振現(xiàn)象，穩(wěn)定后控制力矩在0.0015N·m內(nèi)振蕩，誤差角速度精度為0.003(°)/s，滾動軸與俯仰軸存在1°左右的偏差。引入干擾補償以后，系統(tǒng)振顫現(xiàn)象明顯減弱，控制力矩減小到0.001N·m，而控制精度并未顯著提高。采用AFSMC的衛(wèi)星，相比前2種情況，抖振現(xiàn)象明顯削弱，誤差角速度和姿態(tài)偏差角精度分別達0.0008(°)/s和 0.001°。

圖1 常規(guī)NFTSMC仿真曲線

圖2 加干擾補償?shù)腘FTSMC仿真曲線

圖3 AFNFTSMC仿真曲線

因此，可以得出結(jié)論：常規(guī)NFTSMC方法能夠較好、較快地進行姿態(tài)跟蹤，但變結(jié)構(gòu)控制固有的抖振現(xiàn)象影響了系統(tǒng)實際性能、限制了姿態(tài)跟蹤精度。在此基礎(chǔ)之上，引入自適應(yīng)干擾補償器，可以減小切換增益，從而有效削弱系統(tǒng)振顫，但控制精度仍然沒有顯著提升。而本文所提AFSMC方法，進一步以自適應(yīng)模糊模塊逼近控制律中的切換項，不僅有效削弱了系統(tǒng)抖振，而且顯著提高了控制精度。

圖4 AFNFTSMC容錯曲線

4 結(jié)論

針對衛(wèi)星姿態(tài)跟蹤控制過程中可能發(fā)生的執(zhí)行器故障，考慮干擾和模型不確定性等影響，設(shè)計了具有容錯功能的自適應(yīng)模糊滑?？刂破鳌＝Y(jié)合數(shù)值仿真，得到以下結(jié)論：該方法通過對系統(tǒng)廣義干擾(執(zhí)行器故障、干擾以及模型不確定性)進行實時補償，減小了切換增益，并以自適應(yīng)模糊系統(tǒng)來逼近切換函數(shù)，柔化了輸入信號，有效削弱了滑模系統(tǒng)的固有抖振現(xiàn)象，大大提高了控制精度，無論是對于執(zhí)行器失效故障還是偏差故障，均具有較高魯棒性，能夠使系統(tǒng)在故障以后，仍然能夠維持在理想的精度范圍內(nèi)，具有一定的工程實際意義。

[1] Gao Z, Ding S X, Cecati C. Real-time Fault Diagnosis and Fault-tolerant Control [J]. IEEE Transactions on Industrial Electronics, 2015, 62(6):3752-3756.

[2] 李文博，王大軼，劉成瑞. 動態(tài)系統(tǒng)實際故障可診斷性的量化評價研究[J]. 自動化學(xué)報, 2014, 41(3):497-507.(Li Wenbo, Wang Dayi, Liu Chengrui. Quantitative Evaluation of Actual Fault Diagnosability for Dynamic Systems [J]. Acta Automatica Sinica, 2014, 41(3):497-507.)

[3] 段文杰，王大軼，劉成瑞．衛(wèi)星控制系統(tǒng)離散積分滑模容錯控制[J]．控制理論與應(yīng)用，2015，32(2)：133-141. (Duan Wenjie, Wang Dayi, Liu Chengrui. Discrete-Time Integral Sliding-Mode Fault-Tolerant Controller for Satellite Control System [J]. Control Theory and Applications, 2015, 32(2): 133-141.)

[4] 項昌毅,楊浩,程月華,姜斌,劉成瑞. 衛(wèi)星姿態(tài)控制系統(tǒng)的可重構(gòu)性指標(biāo)分配[J]. 航天控制, 2014,32(2):46-52. (Xiang Changyi, Yang Hao, Cheng Yuehua,et al. Reconfigurable Allocation of Satellite Attitude Control System[J]. Aerospace Control, 2014, 32(2):46-52.)

[5] 王世新, 邢琰, 王大軼. 基于能耗最優(yōu)的衛(wèi)星姿控系統(tǒng)推力器可重構(gòu)性設(shè)計[J]. 航天控制, 2015, 33(5):46-53. (Wang Shixin, Xing Yan, Wang Dayi, et al. Reconfigurability Design for Thrusters of Satellite Attitude Control System Based on Optimal Energy Consumption[J]. Aerospace Control, 2015, 33(5):46-53.)

[6] 徐赫嶼, 王大軼, 李文博. 衛(wèi)星姿態(tài)控制系統(tǒng)的可重構(gòu)性量化評價方法研究[J]. 航天控制, 2016, 34(4):29-35. (Xu Heyu, Wang Dayi, Li Wenbo. A Reconfigurability Evaluation Method for Satellite Control System Based on Gramian Matrix [J]. Aerospace Control, 2016, 34(4):29-35.)

[7] Vadali S R. Variable-structure Control of Spacecraft Large-Angle Maneuvers [J]. Journal of Guidance, Control and Dynamics, 1986, 9(2): 235-239.

[8] Wang B Q, Gong K, Yang D, Li J F. Fine Attitude Control by Reaction Wheels using Variable-Structure Controller [J]. Acta Astronautica, 2003, 52: 613-618.

[9] Ding S H, Li S H. Sliding Mode Control of Spacecraft Attitude with Finite-Time Convergence [C]. Proceedings of the 6th World Congress on Intelligent Control and Automation, Dalian, China. 2006: 830-834.

[10] 管萍，陳家斌．撓性衛(wèi)星的自適應(yīng)模糊滑?？刂芠J]. 航天控制, 2004, 22(4) :62-67.( Guan Ping, Chen Jiabin. The Adaptive Fuzzy Sliding Mode Control for Flexible Satellite [J]. Aerospace Control, 2004, 22(4) : 62-67).

[11] Chenga C H, Shua S L, Chengb P J. Attitude Control of a Satellite Using Fuzzy Controllers [J]. Expert Systems with Applications, 2009, 36: 6613-6620.

[12] 王蜀泉，尹遜和，趙光恒．用于衛(wèi)星姿態(tài)機動控制的一種自適應(yīng)模糊控制器 [J]．空間科學(xué)學(xué)報，2006，26(1):54-58．(Wang Shuquan, Yin Xunhe, Zhao Guanheng. An Adaptive Fuzzy Controller for Satellite Maneuver Control [J]. Chin. J. Space Sci., 2006, 26(1): 54-58.)

[13] Li J, Post M, Lee R．Real-Time Nonlinear Attitude Control System for Nanosatellite Applications [J]．Journal of Guidance Control，and Dynamics，2013，36(6):1661-1671.

[14] 葉東, 屠園園, 孫兆偉. 面向非沿軌跡成像的切比雪夫神經(jīng)網(wǎng)絡(luò)滑模姿態(tài)控制[J]. 航空學(xué)報, 2015, 36(9):3092-3104. (Ye Dong, Tu Yuanyuan, Sun Zhaowei. High-Precision Attitude Tracking Control System for Next-generation Smart Imaging Satellite Using Chebyshev Neural Network[J]. Acta Aeronautica et Astronautica Sinica, 2015, 36(9):3092-3104.)

AFaultTolerantControlSystembyUsingAdaptiveFuzzySlidingModeforSatelliteswithActuatorFaults

Tu Yuanyuan1, Wang Dayi2, Li Wenbo1

1. Beijing Institute of Control Engineering, Beijing 100190, China 2. Beijing Institute of Spacecraft System Engineering, Beijing 100094, China

Anadaptivefuzzyslidingmodecontroller(AFSMC)isdesignedforthesatelliteregardingtheactuatorfaults,disturbanceandmodeluncertaintyduringtheattitudetrackingprocess.Firstly,thetrackingerrordynamicandkinematicmodelsarebuiltbasedonquaternionerror,wheretheactuatorfaults,disturbanceandmodeluncertaintyarecombinedwithageneralinterference.Then,anonsingularandfastterminalslidingmodecontroller(NFTSMC)isderivedasthemaincontrollertoguaranteethesystemstabilityinlimitedtimeforavoidingthesingularity.Byconsideringthechatteringinherentinslidingmodestructure,anadaptivelawisintroducedtocompensatethegeneralinterferencewhichefficientlyweakensthechatteringbyreducingtheswitchgain.Inordertofurtherimprovetheprecisionofthesystem,anadaptivefuzzysystemisusedtoapproximatethesymbolicfunctionintheslidingmodecontrol.Finally,numericalsimulationsontheattitudetrackingcontrolofspacecraftinthepresenceofenvironmentaldisturbanceandparametersuncertaintiesareperformed,whoseresultsshowthesystemusingAFSMCcanstabilizewithin13-and

*國家杰出青年科學(xué)基金(6152530);國家自然科學(xué)基金(61690215, 61640304, 61573060, 61203093)

theprecisionofattitudeangleandangularvelocitycanbe0.001°and0.0008(°)/s,respectively.Inaddition,thismethodcanmeettherequirementsoffault-tolerancewithfasterconvergencespeedandbetterrobustnessbycomparingwiththeconventionalNFTSMC.

Attitudetracking;Slidingmodecontrol;Interferencecompensation;Adaptivefuzzy; Lyapunovstability

V467

A

1006-3242(2017)05-0051-07

2017-04-27

屠園園(1992-)，女，江蘇人，碩士研究生，主要研究方向為控制系統(tǒng)可重構(gòu)性研究；王大軼(1973-)，男，黑龍江人，博士，研究員，主要研究方向為航天器制導(dǎo)、導(dǎo)航與控制，衛(wèi)星可重構(gòu)性及可診斷性評價與設(shè)計;李文博(1984-)，男，天津人，博士，高級工程師，主要研究方向為航天器可診斷、可重構(gòu)性評價與設(shè)計。