劉家祺,謝曉方,王誠成,宋友凱,孫 濤
(海軍航空工程學院 1.兵器科學與技術(shù)系;2.接改裝訓練大隊,山東 煙臺 264001)
推力調(diào)節(jié)飛行距離最優(yōu)自適應滑??刂?/p>
劉家祺1,謝曉方1,王誠成1,宋友凱2,孫 濤1
(海軍航空工程學院 1.兵器科學與技術(shù)系;2.接改裝訓練大隊,山東 煙臺 264001)
為了準確控制巡航導彈在指定時間到達指定位置,提出了一種基于飛行距離和地速反饋的推力調(diào)節(jié)最優(yōu)自適應滑??刂品椒?。基于包含發(fā)動機推力動態(tài)特性的巡航狀態(tài)附近小擾動方程,采用反饋線性化方法設(shè)計指數(shù)趨近滑模變結(jié)構(gòu)控制律和狀態(tài)反饋系數(shù)自適應律,構(gòu)造李雅普諾夫函數(shù),證明了自適應滑??刂葡到y(tǒng)的穩(wěn)定性;根據(jù)控制律和滑模函數(shù)推導出飛行距離跟蹤誤差傳遞方程,并用線性二次型調(diào)節(jié)器最優(yōu)控制方法設(shè)計跟蹤誤差動態(tài)特性。對某型巡航導彈進行仿真,結(jié)果表明,在外界陣風干擾和空氣動力系數(shù)攝動情況下,該控制方法能精確地跟蹤以時間為自變量的參考地速和飛行距離信號,具有較好的抑制系統(tǒng)參數(shù)攝動和抗干擾能力。
巡航導彈;四維航跡控制;自適應滑??刂?反饋線性化;線性二次型調(diào)節(jié)器
Abstract:In order to make cruise missile arrive at specified location in the given time accurately,an optimal adaptive sliding-mode-control method of thrust adjustment was proposed based on ground speed and flight-distance feedback.The perturbation equation of cruise-state was written considering the dynamic characteristics of engine thrust.Index reaching sliding-mode-control law and adaptive law were designed by using feedback linearization,and the Lyapunov function was constructed to prove the stability of system.The error transfer equation was deduced according to the control law and the sliding mode function,and the dynamic characteristics of error were designed by solving the optimal linear quadratic regulator problem.Simulation results of cruise missile show that,under the conditions of wind disturbance and aerodynamic-coefficient perturbation,the reference signals of speed and distance can be tracked accurately by using this control-method,and the method can suppress system parameter perturbation and has good anti-interference ability.
Keywords:cruise missile;4D flight path control;adaptive sliding mode control;feedback linearization;linear quadratic regulator
目前巡航導彈典型飛行方式主要有:馬赫數(shù)保持巡航、高度保持巡航和發(fā)動機額定推力巡航等。其中馬赫數(shù)巡航保持可以根據(jù)空速估計飛行時間,但馬赫數(shù)和地速間換算比例受到高度、大氣密度和風速干擾等因素影響存在誤差,并不能根據(jù)時間準確控制飛行距離。四維航跡管理是一種先進的飛行航跡管理方法,主要用來協(xié)調(diào)飛機進場時間。巡航導彈的飛行控制方式和飛機相似,該方法也可以移植到巡航導彈上,以實現(xiàn)方案飛行階段的時間距離精確控制。四維航跡管理也稱為四維航跡控制。近年來國內(nèi)外對四維航跡控制技術(shù)進行了大量的研究,美國下一代航空運輸系統(tǒng)實驗表明到達機場測量點的時間誤差可以控制在10 s以內(nèi)[1],換算成飛行距離誤差約為2.5 km,但此精度尚不能滿足軍用飛行器協(xié)同作戰(zhàn)的要求。
考慮飛行穩(wěn)定性,傳統(tǒng)飛行控制以空速為基礎(chǔ),這恰恰是飛行時間難以進一步精確控制的根本原因。時間精確控制涉及速度控制和剩余航程估算,導航系統(tǒng)定位和目標點位置估計共同決定了剩余航程計算的準確度。慣性導航系統(tǒng)累積誤差隨飛行時間增加,目前采用卡爾曼濾波的GPS/INS組合導航系統(tǒng)的定位誤差可減小到100 m以內(nèi),隨著北斗衛(wèi)星導航技術(shù)的進步,精度有望進一步提高。飛行速度調(diào)節(jié)有以下2種方法:第一種通過升降舵來實現(xiàn),將誤差信號輸入自動駕駛儀,改變航跡傾角來改變導彈的速度,通常在巡航狀態(tài)下對速度的控制要求不嚴格時采用;第二種是通過控制發(fā)動機油門的方法實現(xiàn),將誤差信號反饋給自動油門控制系統(tǒng),通過改變推力來直接改變速度[2]。
滑模變結(jié)構(gòu)控制是一種具有較強抗干擾能力的非線性控制方法,通過選取合適的滑動控制參數(shù)可以得到需要的控制性能。自適應控制幾乎不需要先驗信息,對未知漸變參數(shù)具有學習適應能力。自適應滑??刂萍嬗卸邇?yōu)點,在機電控制、船舶駕駛和航空航天等領(lǐng)域得到了廣泛應用[3-4]。最優(yōu)滑??刂平鉀Q了滑動模態(tài)的設(shè)計問題,主要可分為兩大類:第一類針對最優(yōu)二次型調(diào)節(jié)器類型系統(tǒng)設(shè)計積分滑模面,滑??刂频牡刃Э刂祈椌褪钦{(diào)節(jié)器的最優(yōu)控制[5-6];第二類針對二級串聯(lián)形式的系統(tǒng)狀態(tài)方程,根據(jù)第一級方程的最優(yōu)控制律構(gòu)造滑模面,對滑模函數(shù)求導并帶入二級方程求解滑??刂坡蒣7-9]。本文研究的飛行距離自適應滑模控制屬于跟蹤問題,不能直接應用上述方法,因此考慮將跟蹤問題轉(zhuǎn)化為線性二次型調(diào)節(jié)器問題來解決。
假設(shè)用升降舵控制器保持高度不變,且忽略軸向和高度方向間交叉耦合作用,模型可以簡化成推力F到飛行距離R的二階系統(tǒng)。把發(fā)動機近似看作一階延遲系統(tǒng),慣性時間常數(shù)為tF,對應頻率fF=1/tF,k3為增益,發(fā)動機傳遞函數(shù)HF(s)=k3/(1+tFs),那么從油門位置δF到飛行距離R為三階系統(tǒng)。巡航速度附近小擾動狀態(tài)方程如下:
(1)
式中:vK為地速,vW為風速,Xv為空速阻力系數(shù),XF為推力加速慣性系數(shù)。輸出變量y,則有輸出方程:y=R。
1.1 指數(shù)趨近滑模變結(jié)構(gòu)控制律設(shè)計
(2)
飛行中燃油消耗使導彈質(zhì)量減小,參數(shù)XF將增大;位置跟蹤巡航中vK是受控變量,風速vW使空速vA變化從而導致參數(shù)Xv攝動;空速變化同時會對發(fā)動機推力造成擾動,k3也有一定的不確定性。令
(3)
(4)
(5)
式中:c1>0,c2>0;C=(c1c21),使得2+c2+c1為霍維茨多項式,為拉普拉斯算子為用來計算控制量時的參數(shù)λi的估計值,滑模控制參數(shù)k>0,ε>dmax,ν為中間控制變量,由反饋線性化理論中的等效控制方法和指數(shù)趨近律選擇滑模變結(jié)構(gòu)控制律:
(6)
1.2 狀態(tài)反饋系數(shù)自適應律設(shè)計
取自適應控制參數(shù)σi>0(i=1,2,3),定義李雅普諾夫函數(shù):
(7)
(8)
(9)
則有
即證明了系統(tǒng)在李雅普諾夫意義下是穩(wěn)定的,根據(jù)李雅普諾夫函數(shù)的具體形式,在滑??刂坡珊妥赃m應律的作用下,系統(tǒng)參數(shù)估計誤差和滑模函數(shù)漸進趨于0,控制算法具有較強的抑制參數(shù)攝動和抗干擾能力。
(10)
(11)
上述位置跟蹤誤差傳遞方程中,令
(12)
(13)
對稱非負矩陣P滿足黎卡提方程:
(14)
解出矩陣P,即可得到誤差反饋系統(tǒng)最優(yōu)控制律:
對比ue的定義式(12),可得:
(15)
根據(jù)矩陣方程(15),可以得到由3個方程構(gòu)成的方程組,恰好可以解出3個滑??刂茀?shù)c1,c2,k。
滑模控制具有很好的魯棒性和抗干擾性能,但這是以控制的小幅高頻抖動換來的,因此不能完全消除抖動,但可以通過選取合適大小的“邊界層”μ,用飽和函數(shù)sats代替符號函數(shù)sgns來消弱抖動。增大μ在降低控制抖動的同時會引起跟蹤誤差的增大,應根據(jù)具體需求在二者之間折中。sats定義為
(16)
按上述方法確定控制參數(shù)后,在限制范圍內(nèi)實時改變發(fā)動機推力來調(diào)整地速,進行精確位置跟蹤巡航,推力受限最優(yōu)滑模控制結(jié)構(gòu)如圖2所示。
可以看出控制指令可分為3個部分:帶誤差修正的參考信號導數(shù)前饋,系統(tǒng)狀態(tài)反饋和滑模趨近律。計算滑??刂屏啃栌玫礁櫿`差及其一階和二階導數(shù),可以對參考位置信號進行求導運算以得到參考速度和加速度信號,然后與導航設(shè)備實時測量的實際飛行參數(shù)作差。不同于傳統(tǒng)的空速保持巡航,位置跟蹤巡航需要控制地速,再加上未知的風干擾,空速將在一定范圍內(nèi)波動,這是導致氣動力參數(shù)攝動的重要因素??梢愿鶕?jù)當前工作點的氣動力系數(shù)計算得到控制參數(shù)λi的初始值,在自適應律的作用下λi將會很快收斂到實際氣動力系數(shù)所對應的值,從而保證了系統(tǒng)的穩(wěn)定性。
某型巡航導彈在巡航高度上的飛行速度v0=250 m/s,該狀態(tài)附近線性化空速阻力系數(shù)Xv=-0.007 s-1,加速慣性系數(shù)XF=9.8×10-4m·s-2·N-1。推力增量限制|ΔF|≤200 N,時間常數(shù)tF=0.1 s,增益k3=1×104。根據(jù)最優(yōu)二次型性能指標權(quán)重Q=diag(1,1,1),r=0.01,解出滑??刂茀?shù):c1=1,c2=1.7,k=10,自適應控制參數(shù):σ1=σ2=σ3=6×10-4。
3.1 自適應滑??刂旗o態(tài)性能仿真分析
假設(shè)風速vW為疊加白噪聲的正弦信號,白噪聲(t)的功率譜密度P0=16 m2/s,正弦信號振幅為10 m/s,周期為2πs,即vW=10sint+(t);氣動參數(shù)Xv攝動范圍為20%;參考地速信號vK,c=0.2cos(t/10),其振幅為0.2 m/s,周期為20πs。切換控制增益ε分別取0.2和1.5,并和PID控制結(jié)果對比,PID控制參數(shù)取kP=2,kI=0.05,kD=25。
圖3為風速vW的仿真結(jié)果,圖4為自適應滑模推力控制曲線,圖5為地速跟蹤曲線,圖6為飛行距離的控制誤差曲線。
為了抑制風速干擾,需要以近乎相同的頻率來調(diào)整推力,初始時刻參考速度與實際速度相差最大,推力也達到最大值。對比不同切換控制增益的控制效果,可以看出切換控制增益越大跟蹤誤差越小,需要控制的抖動幅度也越大,抗干擾能力也越強,因此,應該在充分估計最大干擾強度的基礎(chǔ)上,權(quán)衡跟蹤誤差要求和控制機構(gòu)的抖動執(zhí)行能力來選取滑模切換控制增益。
自適應滑??刂频厮僭? s后達到了穩(wěn)定狀態(tài),而PID控制穩(wěn)定時間約為20 s。自適應滑模控制距離誤差最大值為0.1 m,PID控制距離誤差最大值為1.7 m?;诘厮俜答伒淖赃m應滑??刂凭缺葌鹘y(tǒng)PID控制提高10倍以上。
3.2 最優(yōu)控制動態(tài)性能仿真分析
為了便于觀察不同控制參數(shù)的控制效果,此處仿真不考慮控制邊界限制和干擾。設(shè)置參考地速為100 s時刻幅值2 m/s階躍信號,即vc=2U(t-100)。采用式(3)計算λ1,λ2,λ3的初始值,以減少這3個參數(shù)自適應時間。改變滑模控制參數(shù),對比分析各個參數(shù)對控制性能的影響,采用4種控制方式:①c1=1,c2=1.7,k=10;②c1=5,c2=1.7,k=10;③c1=1,c2=6,k=10;④c1=1,c2=1.7,k=4。4種控制方式的推力F和飛行距離控制誤差e如圖7和圖8所示??刂品绞舰俚母鱾€參數(shù)是根據(jù)最優(yōu)二次型性能指標計算得到的,在推力和飛行距離控制誤差之間取得了相對均衡的結(jié)果,調(diào)節(jié)時間約50 s。c1增大的控制方式②,推力幅度明顯增加,而距離誤差波動范圍沒有明顯增加,只相對控制方式①整體向負方向移動,且振蕩次數(shù)增加。控制方式③增大了c2,推力最大值增加而持續(xù)時間縮短,對應距離誤差減小而調(diào)節(jié)時間增加至200 s??刂品绞舰軠p小了k值,推力減小而距離誤差增加,其他動態(tài)性能指標變化不大。在最優(yōu)控制基礎(chǔ)上可以適當增加k值以便充分利用可用控制量,以提高距離跟蹤精度。
實際飛行距離跟蹤誤差主要由控制誤差和導航定位誤差兩部分組成,仿真中強風干擾下理論控制誤差小于0.1 m,而目前導航定位誤差為10~100 m,控制誤差和導航誤差相比幾乎可以忽略不計。美國下一代航空運輸系統(tǒng)實驗表明,空速控制飛行距離誤差約為2.5 km。因此保守估計,地速反饋控制精度可比傳統(tǒng)四維航跡控制方法提高25倍。本文立足于當前導航定位技術(shù),控制方法適用于衛(wèi)星/慣性組合導航導彈的方案彈道段。本文方法能較準確定位導彈當前位置,也可確定目標點位置;通過預先計算出符合到達時間要求的參考地速和飛行距離信號,使導彈跟蹤該信號達到時間精確控制的目的。
實際動力系統(tǒng)比一階環(huán)節(jié)復雜得多,進氣口壓力、溫度、風扇轉(zhuǎn)速和壓縮比等因素都會影響輸出推力值,能否通過電子發(fā)動機控制系統(tǒng)來精確控制推力是減小跟蹤誤差的關(guān)鍵,另外,飛行狀態(tài)測量的實時性和準確度也是決定誤差大小的重要因素。
[1] WICHMAN K.4D-trajectory enabled continuous descent approaches[C]//FAA New Technologies Workshop III.Arlington Virginia:Smiths Aerospace,2007:81-90.
[2] HUESCHEN R M,KHONG T H.Vertical navigation control laws and logic for the next generation air transportation system:NASA-TM-218138[R].Boston:NASA,2013.
[3] 叢炳龍,劉向東,陳振.剛體航天器姿態(tài)跟蹤系統(tǒng)的自適應積分滑??刂芠J].航空學報,2013,34(3):620-628. CONG Bing-long,LIU Xiang-dong,CHEN Zhen.Adaptive integral sliding mode control for rigid spacecraft attitude tracking[J].Acta Aeronautica et Astronautica Sinica,2013,34(3):620-628.(in Chinese)
[4] 劉向杰,韓耀振.多輸入多輸出非線性不確定系統(tǒng)連續(xù)高階滑??刂芠J].控制理論與應用,2016,33(8):1-9. LIU Xiang-jie,HAN Yao-zhen.Continuous higher-order sliding mode control for multi-input multi-output nonlinear uncertain system[J].Control Theory & Applications,2016,33(8):1-9.(in Chinese)
[5] 徐志剛,楊明毅,賀云,等.六自由度氣浮仿真平臺位姿最優(yōu)滑模控制方法[J].科學通報,2013,32(增刊2):121-127. XU Zhi-gang,YANG Ming-yi,HE Yun,et al.Research on pose optimal sliding mode control method for six DOF air-bearing spacecraft simulator[J].Chinese Science Bulletin,2013,32(S2):121-127.(in Chinese)
[6] 唐功友,逄海萍,孫慧影.不確定時滯系統(tǒng)的全局魯棒最優(yōu)滑??刂芠J].控制理論與應用,2009,26(8):850-854. TANG Gong-you,PANG Hai-ping,SUN Hui-ying.Global robust optimal sliding-mode control for uncertain systems with time-delay[J].Control Theory & Applications,2009,26(8):850-854.(in Chinese)
[7] 逄海萍,劉成菊,莊克玉,等.同時含狀態(tài)和輸入時滯系統(tǒng)的最優(yōu)滑??刂芠J].系統(tǒng)仿真學報,2006,18(增刊2):727-730. PANG Hai-ping,LIU Cheng-ju,ZHUANG Ke-yu,et al.Optimal sliding mode control for linear systems with input and state delays[J].Journal of System Simulation,2006,18(S2):727-730.(in Chinese)
[8] 陳謀,姜長生,吳慶憲,等.一類串級不確定非線性系統(tǒng)的最優(yōu)滑??刂破髟O(shè)計[J].系統(tǒng)工程理論與實踐,2003,11(5):31-35. CHEN Mou,JIANG Chang-sheng,WU Qing-xian,et al.Design of optimal sliding model controller for a class of uncertain cascade nonlinear system[J].Systems Engineering Theory & Practice,2003,11(5):31-35.(in Chinese)
[9] 唐治理,雷虎民,劉代軍,等.BTT 導彈非線性自動駕駛儀最優(yōu)滑模設(shè)計[J].系統(tǒng)仿真學報,2009,21(4):1 087-1 090. TANG Zhi-li,LEI Hu-ming,LIU Dai-jun,et al.Design of optimal-sliding mode nonlinear autopilot for BTT missile[J].Journal of System Simulation,2009,21(4):1 087-1 090.(in Chinese)
OptimalAdaptiveSlidingModeControlofFlightDistanceonThrustRegulation
LIU Jia-qi1,XIE Xiao-fang1,WANG Cheng-cheng1,SONG You-kai2,SUN Tao1
(1.Department of Ordnance Science and Technology;2.Acceptance Remould and Training Battalion,Naval Aeronautical Engineering Institute,Yantai 264001,China)
2016-12-05
中國博士后科學基金項目(2013T60923)
劉家祺(1987- ),男,博士研究生,研究方向為武器系統(tǒng)建模與仿真。E-mail:ljq.sweet@163.com。
V249.1
A
1004-499X(2017)03-0001-06