黃遠燦,陳冬方
(北京理工大學(xué)機電學(xué)院,北京100081)
在空間飛行器軌道轉(zhuǎn)移任務(wù)中,飛行器受到導(dǎo)航誤差、軌道攝動、推力誤差、入軌狀態(tài)誤差等各種誤差因素的影響,將會偏離設(shè)計軌道,無法準確地按照設(shè)定的軌道達到目標位置。尤其在遠距離轉(zhuǎn)移時,必須在軌道轉(zhuǎn)移機動過程中進行中途多次修正,從而使飛行器準確到達目標范圍。為了防止飛行器最終軌跡偏離目標點太大,在飛行過程中要求實際軌跡逼近目標軌跡,但因飛行器攜帶燃料質(zhì)量有限(即軌道機動能力有限),所以軌道修正需要結(jié)合燃料和狀態(tài)誤差問題,進行綜合優(yōu)化控制。
針對軌道轉(zhuǎn)移或攔截的優(yōu)化控制問題,一些國內(nèi)外學(xué)者已進行了相關(guān)研究[1-7]。所應(yīng)用的優(yōu)化方法一般根據(jù)飛行器推進方式進行設(shè)計。一種為大推力脈沖控制,另一種為有限推力或小推力的連續(xù)型推進方式。文獻[1]中設(shè)計了一種受限的二次型優(yōu)化脈沖控制,其方法主要以最小能量的指標優(yōu)化控制軌道交會。文獻[2]將優(yōu)化能量的脈沖控制用于軌道攔截中。針對固定時間的軌道中段攔截問題,文獻[3]設(shè)計了一種連續(xù)的二次型調(diào)節(jié)器優(yōu)化控制。針對深空軌道小推力優(yōu)化設(shè)計,文獻[6]給出了基于偽光譜方法的有限推力軌道轉(zhuǎn)移優(yōu)化設(shè)計。上述文獻優(yōu)化控制指標主要是針對能量最小化,但未對軌跡誤差指標進行優(yōu)化。如果在飛行任務(wù)中,對飛行軌道進行適當(dāng)?shù)男拚罱K能減小飛行器與終端目標的偏差。故對軌跡誤差的優(yōu)化控制,是值得繼續(xù)探討的問題,本文主要考慮以大推力脈沖推進系統(tǒng)進行優(yōu)化控制。文獻[8]提出了一種固定時間間隔的二次型脈沖控制策略,其發(fā)展了離散二次型優(yōu)化方法設(shè)計調(diào)節(jié)器,簡化控制器計算,使得工程應(yīng)用化加強。因此本文利用該方法進行了軌道轉(zhuǎn)移優(yōu)化策略設(shè)計。
對于空間飛行器控制模型選擇,主要有用于近圓軌道交會控制的CW(Clohessy-Wiltshire)模型[9];用于橢圓軌道交會攔截控制的TH(Tschauner-Hempel)模型[10]。本文考慮地球非球形攝動因素的影響,基于攝動方法建立線性控制模型,通過控制使得跟蹤軌跡更接近于目標軌跡。為方便計算,同時對控制模型進行了簡化。
為此,本文通過分析軌道轉(zhuǎn)移中各種誤差因素,利用攝動法建立控制模型,考慮地球非球形攝動因素建立目標軌跡。然后綜合控制輸入和最小化狀態(tài)誤差的優(yōu)化指標,采用固定時間間隔的線性二次型離散脈沖優(yōu)化控制方法。最后,針對空間兩點位置的軌道轉(zhuǎn)移任務(wù),仿真驗證了方法的有效性。
在空間飛行器軌道轉(zhuǎn)移運行中,如果考慮轉(zhuǎn)移時間固定,則空間兩點之間存在一條飛行軌道。僅考慮空間飛行器與地球之間的運動,那么可以簡化為二體問題模型,但實際運行中飛行器受外部多種攝動因素的影響,其中主要有地球非球形攝動、日月引力、大氣阻力、太陽光壓的影響。根據(jù)Cowell的攝動力公式[11],系統(tǒng)方程如下:
式中:anon為地球非球形攝動;a3SL為日月引力攝動;aAD為大氣阻力;aSR為太陽光壓;aoth為其他影響因素。
與此同時,從現(xiàn)有的工程經(jīng)驗可知,為了達到較好的控制目標,空間飛行器在實際飛行中還需要考慮飛行器自身的一些影響因素。如自身導(dǎo)航測量誤差、姿態(tài)控制發(fā)動機、軌道控制發(fā)動機的攝動、入軌狀態(tài)誤差等各種誤差。通常將這類誤差分為兩種:一種為常值偏差或量測值偏差,如慣導(dǎo)量測偏差;另一種為基于白噪聲的隨機干擾,如飛行器工作時發(fā)動機的開關(guān)機擾動等。所以實際計算模型如下:
式中:athr為發(fā)動機干擾;ab為量測偏差;aON為其他噪聲干擾。
對于部分已知的攝動(如地球非球形攝動等),在計算目標軌道時,可考慮列入目標實際軌道求解,得出一條較為精確的目標軌道。
對于控制方式,本文采用脈沖控制方式,即大推力脈沖式機動轉(zhuǎn)移。發(fā)動機在非常短暫的時間內(nèi)產(chǎn)生大推力,使空間飛行器獲得脈沖速度。
式中:r(t),r(t+τ)分別為脈沖控制前、后的位置;v(t),v(t+τ)分別為控制前、后的速度;Δv為速度變化量的大小。
為方便控制策略的應(yīng)用,本文采用了線性控制模型??紤]軌道轉(zhuǎn)移的一般性,參照文獻[12]的攝動制導(dǎo)方法,建立控制模型方程。
依據(jù)二體問題模型,建立慣性地心坐標系[13],系統(tǒng)模型方程如下:
假定以實際軌跡與目標軌跡的狀態(tài)之差作為控制狀態(tài)變量,有:
其中:
式中:r,v為實際位置和實際速度;ro,vo為目標位置和目標速度。
從上式線性化可得,系統(tǒng)方程可寫為如下形式:
其中:
考慮到f1~f6<2×10-6,隨距離地心越遠系數(shù)變得越小。將A陣簡化為:
控制輸入u(t)為:
從而得到本文中的線性控制系統(tǒng)方程式(6)。
根據(jù)線性脈沖控制系統(tǒng)理論[14]可知,本文考慮如下類型的脈沖線性系統(tǒng):
式中:k=1,…,N;A為n×n陣;Bδ為n×m陣;σ為脈沖時間間隔。
在本系統(tǒng)中,假定采樣間隔時間為σ,因此將式(9)離散化可得:
根據(jù)優(yōu)化性能指標,該優(yōu)化問題可以看作線性調(diào)節(jié)器問題??紤]狀態(tài)參數(shù)和控制參數(shù)的最優(yōu)值函數(shù)定義如下:
簡化得:
假設(shè)(A,Bδ)穩(wěn)定,且(A,Q)可測,則離散時間的調(diào)節(jié)器為:
其中:
根據(jù)終端條件可得:
故求得最優(yōu)反饋控制率為:
如果基于二體理論假設(shè),忽略攝動影響,在固定時間內(nèi)的轉(zhuǎn)移,則可以用Lambert方法求解目標軌道。而實際上因為攝動因素的存在,會造成與目標軌道的偏移。為了減少實際轉(zhuǎn)移軌道與目標軌道的偏差控制,減少飛行中控制燃料的消耗,需要對目標軌道進行較為精確的定軌。
分析各項攝動力的影響,在空間中高空軌道上攝動影響因素最大的為地球非球形攝動力。目標軌道定軌則可以根據(jù)軌道的攝動因素精確分析軌道的受力情況,進而求得軌道的飛行軌跡。
求解方法為:已知空間兩點的位置和軌道轉(zhuǎn)移時間,則該問題為非線性方程兩點邊值問題求解??紤]地球非球形攝動J2項的影響,使用打靶法,設(shè)置給定誤差限制|r*-ro|<ε,ε>0,通過 Lambert算法解出初值和末端值。以該初值作為飛行軌道的初值進行數(shù)值迭代求解,從而獲得較為精確的目標參考軌跡。如要求更高的目標軌跡的精度,可根據(jù)實際工程需求,考慮多種攝動的影響因素,進行精確定軌。
本仿真以式(2)為模型,考慮系統(tǒng)中各種誤差、攝動因素的影響,驗證脈沖控制策略的正確和有效性。首先通過建立地心直角坐標系,假定空間中轉(zhuǎn)移位置兩點為:x0[3.201×106m,6.073×106m,3.402 ×106m],xf[-2.185 ×107m,3.616 ×107m,2.442×104m],以及固定轉(zhuǎn)移時間t=15 000 s。
根據(jù)給定的位置和時間,求解目標軌跡的位置和速度。首先利用Lambert方法求出初速度和末速度,根據(jù)打靶法,加入地球攝動J2項,反求出目標軌跡。仿真中加入日月引力、大氣阻力攝動的影響。發(fā)動機的影響為執(zhí)行控制時,加入的干擾為athr=1×10-3m/s2;加入隨機噪聲干擾為 aON=1 ×10-4m/s2;慣導(dǎo)測量誤差為ab=1×10-4m/s2;位置測量誤差為±300 m;速度測量誤差為±2 m/s。
控制策略為每2 000 s執(zhí)行一次控制,控制中系數(shù)矩陣 R,Q 分別為:R=10I(3×3),Q=I(6×6)。
根據(jù)文獻[14]可知,線性脈沖系統(tǒng)控制可達的最小脈沖控制次數(shù)為p=[m/n]。在本系統(tǒng)中m=6,n=3,通過計算可得p=2,所以在仿真計算中,每次脈沖間隔執(zhí)行兩次控制。相比文獻[5]中的方法,本文提出的周期脈沖控制方法在控制器的計算上不需每步均進行計算,從而減少了計算時間,簡化了工程計算量。仿真結(jié)果如圖1~圖3所示。
圖1 轉(zhuǎn)移參考軌跡與實際軌跡Fig.1 Trajectory of actual and target orbit
圖1 顯示實際軌跡和目標參考軌跡的運行圖??梢钥闯觯w行過程中受到各種干擾的影響,控制器能有效地修正運行軌跡。圖2中顯示實際運行軌跡和目標軌跡的位置和速度狀態(tài)差值,在末位置較好地跟蹤了目標軌跡。在末端時刻與終點的狀態(tài)位置和速度三個方向的偏差為:[585.9 m,-17.9 m,-447.4 m,0.463 m/s,0.243 m/s,- 0.643 m/s],距離終點位置為732 m,飛行器達到了預(yù)定目標區(qū)域。圖3顯示飛行中速度控制改變量的大小。
圖2 位置和速度的變化Fig.2 Change graph with position and velocity
圖3 脈沖速度控制變化Fig.3 Control of impulsive velocity
對于空間軌道轉(zhuǎn)移的修正問題,本文提出了一種簡化的二次型脈沖優(yōu)化控制方法。在考慮攝動和測量誤差等因素條件下,利用攝動制導(dǎo)的方法建立系統(tǒng)控制模型,同時對系統(tǒng)進行線性簡化。文中給出的仿真驗證測試說明,最終誤差達到遠程軌道轉(zhuǎn)移中段要求的控制范圍??刂撇呗院喕擞嬎懔?,提高了飛行器控制實時計算性能,可用于軌道轉(zhuǎn)移任務(wù)中間段的修正控制。
[1] Lantoine G,Epenoy R.Quadratically constrained linearquadratic regulator approach for finite-thrust orbital rendezvous[J].Journal of Guidance,Control,and Dynamics,2012,35(6):1787-1797.
[2] Prussing JE,Wellnitz L J,Heckathorn W G.Optimal impulsive time-fixed direct-ascent interception[J].Journal of Guidance,Control,and Dynamics,1989,12(4):487-494.
[3] Massoumnia M A.Optimal midcourse guidance law for fixed-interval propulsive maneuvers[J].Journal of Guid-ance,Control,and Dynamics,1995,18(3):465-470.
[4] Tarzi Z,Speyer J,Wirz R.Fuel optimum low-thrust elliptic transfer using numerical averaging[J].Acta Astronautica,2013,86:95-118.
[5] 湯一華,陳士櫓,萬自明.基于零控脫靶量的大氣層外攔截中制導(dǎo)研究[J].飛行力學(xué),2007,25(3):34-37.
[6] 涂良輝,袁建平,羅建軍.基于偽光譜方法的有限推力軌道轉(zhuǎn)移優(yōu)化設(shè)計[J].宇航學(xué)報,2008,29(4):1189-1193.
[7] 陳統(tǒng),徐世杰.基于遺傳算法的最優(yōu)Lambert雙脈沖轉(zhuǎn)移[J].北京航空航天大學(xué)學(xué)報,2007,33(3):273-277.
[8] Huang Y C,Zhang Y Q,Xia H,et al.LQ-based optimization for linear impulsive control systems mixed with continuous-time controls and fixed-time impulses[C]//The 51st IEEE Conference on Decision and Control.Maui,Hawaii,USA:IEEE,2012:6144-6150.
[9] Miele A,Weeks M W,Ciarcia M.Optimal trajectories for spacecraft rendezvous[J].Journal of Optimization Theory and Applications,2007,132(3):353-376.
[10] Carter T,Humi M.Fuel-optimal rendezvous near a point in general keplerian orbit[J].Journal of Guidance,Control,and Dynamics,1987,10(6):567-573.
[11] Vallado D A.Fundamentals of astrodynamics and applications[M].2nd Ed.California:Microcosm Press,2001:462-602.
[12]徐延萬.控制系統(tǒng)[M].北京:中國宇航出版社,2009:254-263.
[13] Jesus G F,Miguel A G.Optimal guidance of low-thrust trajectories[J].Journal of Guidance,Control,and Dynamics,2010,33(6):1913-1917.
[14] Yang T.Impulsive control theory[M].Berlin Heidelberg:Springer Verlag,2001:20-33.
[15] Kwakernaak H,Sivan R.Linear optimal control systems[M].New York:Wiley-Interscience,1972:270-281.