王首喆,劉華清,張慶展,靳永強,*,盛英華.上海宇航系統(tǒng)工程研究所,上海009.上海衛(wèi)星工程研究所,上海009
撓性充液航天器超近程逼近段動力學(xué)建模與控制
王首喆1,劉華清2,張慶展1,靳永強1,*,盛英華1
1.上海宇航系統(tǒng)工程研究所,上海201109
2.上海衛(wèi)星工程研究所,上海201109
超近程逼近過程中,服務(wù)航天器為剛?cè)嵋厚詈系膹?fù)雜系統(tǒng),單擺等液體晃動模型不再適用,對這種工況下的航天器進行了動力學(xué)建模與控制的研究。采用虛功率原理推導(dǎo)了一種新的適用于三軸推力作用下的液體晃動等效模型,通過引入相對位置導(dǎo)引矢量與相對位置誤差矢量,建立了相對軌道誤差動力學(xué)模型,結(jié)合相對姿態(tài)動力學(xué)模型,得到超近程逼近段的剛?cè)嵋厚詈系南鄬壍雷藨B(tài)動力學(xué)模型。針對模型存在的不確定性和未知干擾,設(shè)計了基于滑模估計器的相對姿軌耦合控制律。通過數(shù)學(xué)仿真驗證了控制律的有效性,仿真中的晃動結(jié)果與Flow-3D結(jié)果能夠吻合,驗證了晃動模型的合理性。
在軌服務(wù);超近程逼近;軌跡導(dǎo)引;剛?cè)嵋厚詈希幌鄬ψ塑夞詈?;滑模估計?/p>
在軌服務(wù)是指服務(wù)航天器攜帶設(shè)備裝置與目標(biāo)航天器發(fā)生相互作用的過程,進而達到服務(wù)的目的。服務(wù)航天器一般安裝有大型撓性附件(如天線和太陽翼)、攜帶較多的液體推進劑,是一個剛?cè)嵋厚詈戏蔷€性系統(tǒng)。這種航天器用于推進劑補加、模塊更換、在軌維修、碎片捕獲清除等任務(wù)。超近程逼近是執(zhí)行以上操作的關(guān)鍵步驟,需控制服務(wù)航天器使其沿目標(biāo)被動對接口方向逼近,且主動對接口沿逼近方向指向被動對接口[1],使得服務(wù)航天器的相對位置與姿態(tài)也存在耦合。與軌道轉(zhuǎn)移的情況不同,超近程逼近過程中不存在某一方向的恒定推力,需要在服務(wù)航天器三軸方向頻繁噴氣來實施相對姿態(tài)和軌道的控制,貯箱內(nèi)推進劑的液體表面張力作用得到凸顯[2],常規(guī)的液體晃動單擺模型不再適用。因此,服務(wù)航天器在超近程逼近段的動力學(xué)復(fù)雜,存在較多不確定性,加上未知干擾的作用,建模難度大,對控制的魯棒性要求高。
針對以上問題,文獻[3]對編隊飛行中的相對姿軌耦合動力學(xué)建模與控制模型進行了研究;文獻[4]建立了剛體的姿軌耦合動力學(xué)模型,并設(shè)計了相應(yīng)的控制律;文獻[5]根據(jù)期望編隊點推導(dǎo)出相對軌道誤差動力學(xué)模型;文獻[6]將Twisting算法與線性補償項相結(jié)合,設(shè)計了相對位姿耦合控制律。上述文獻建立的均是剛體模型,未考慮撓性與液體晃動的影響。文獻[7]針對航天器撓性結(jié)構(gòu)持續(xù)振動問題,提出一種基于模糊控制原理的自抗擾控制方法;文獻[8]針對剛?cè)狁詈献藨B(tài)動力學(xué)模型,提出了基于直接自適應(yīng)的姿態(tài)穩(wěn)定控制律;文獻[9]對在恒定推力作用下的充液航天器建立了等效單擺模型,并設(shè)計了一種滑模觀測器來估計液體的晃動角。上述文獻考慮了撓性或液體晃動對姿態(tài)的影響,未考慮軌道受到的影響。文獻[10]對自動轉(zhuǎn)移飛行器的液體燃料建立晃動等效力學(xué)模型,通過數(shù)值仿真得到相關(guān)參數(shù)并進行了對比,未對與姿軌動力學(xué)結(jié)合的情況進行分析。
文章針對上述問題,采用一種新的適用于三軸推力作用下的液體晃動等效力學(xué)模型,建立了完整的剛?cè)嵋厚詈献藨B(tài)軌道動力學(xué)模型,將復(fù)雜的相對軌道跟蹤控制問題轉(zhuǎn)化為簡單的調(diào)節(jié)器設(shè)計問題,最后設(shè)計了基于滑模估計器的相對姿軌耦合控制律對模型進行仿真。
1.1 坐標(biāo)系定義
文章涉及的坐標(biāo)系有:1)J2000地心慣性坐標(biāo)系Oi-XiYiZi;2)相對軌道坐標(biāo)系Ot-XtYtZt;3)質(zhì)心軌道坐標(biāo)系Oo-XoYoZo;4)服務(wù)航天器本體坐標(biāo)系Ob-XbYbZb與目標(biāo)航天器本體坐標(biāo)系Od-XdYdZd,以上坐標(biāo)系與常規(guī)定義相同;5)服務(wù)航天器對接坐標(biāo)系Oq-XqYqZq與目標(biāo)航天器對接坐標(biāo)系Op-XpYpZp,根據(jù)對接裝置的具體安裝情況定義,文章假設(shè)對接坐標(biāo)系三軸方向與本體坐標(biāo)系三軸方向平行;6)貯箱固連坐標(biāo)系Oz-XzYzZz三軸與體坐標(biāo)系三軸平行,質(zhì)心Oz位于貯箱球心。
1.2 液體晃動等效模型
超近程逼近過程中,由于沒有恒定方向的推力作用,航天器貯箱中的液體無法沉底,而是包裹在貯箱壁面上,內(nèi)部產(chǎn)生空腔,在三軸推力作用下作小幅晃動。如圖1所示,假設(shè)貯箱為球形,將貯箱內(nèi)的液體分為靜止質(zhì)量和晃動質(zhì)量,用固連在球心的具有慣量的質(zhì)量塊表示靜止質(zhì)量,晃動質(zhì)量視為質(zhì)點,與4個在貯箱內(nèi)部均勻分布且與貯箱相連的彈簧阻尼器相連,平衡狀態(tài)下晃動質(zhì)量位于球心[2]。
圖1 液體晃動等效模型Fig.1 Spring-mass equivalent mechanical model
模型中,4個彈簧阻尼器的剛度和阻尼系數(shù)完全相同,假設(shè)4個彈簧阻尼器的總體剛度是K,總體阻尼系數(shù)是ξ,液體靜止質(zhì)量為m0,晃動質(zhì)量為mh,靜止質(zhì)量塊的質(zhì)點相對服務(wù)航天器本體坐標(biāo)系原點的位置矢量為r0,晃動質(zhì)點相對平衡點即球心的位置記為rh,晃動質(zhì)點相對服務(wù)航天器本體坐標(biāo)系原點的位置矢量為r0h=r0+rh,由于小幅振動,將rh視為小量。服務(wù)航天器質(zhì)心在慣性系下的位置矢量為rs。
利用虛功率原理建立模型的動力學(xué)方程:
式中:δPIh,δPKh,δPdh,δPgh,δPg0,δPI0分別為晃動質(zhì)量的慣性力虛功率、彈性力虛功率、阻尼力虛功率、地球引力虛功率及靜止質(zhì)量的地球引力虛功率、慣性力虛功率;δPa為晃動模型受到的外力虛功率。
通過速度變分的形式表示各個虛功率,分別得到液體的平動方程、轉(zhuǎn)動方程和振動方程為:
式中:mt為服務(wù)航天器的干質(zhì)量;us和ds分別為控制加速度和外力擾動速度;k為太陽翼板個數(shù);Jt為服務(wù)航天器干重的轉(zhuǎn)動慣量;Tc、Td為服務(wù)航天器受到的控制力矩和干擾力矩;Mj為航天器翼板的耦合矩陣;ηj為翼板的模態(tài)坐標(biāo);ζj為翼板的撓性模態(tài)振動阻尼比;Ωj為翼板的撓性模態(tài)振動頻率;BTj和BRj分別為撓性附件的平動及轉(zhuǎn)動耦合系數(shù)矩陣;a為航天器在非慣性外力作用下的加速度。
將式(2)與式(5)結(jié)合,(Jh+J0)·˙ωb與Jt˙ωb合并為J˙ωb,靜矩相關(guān)項合并后為零,Sh×{ωb×[ωb×(r0+rh) ]}可轉(zhuǎn)換為ωb×(Js·ωb) ,可以與ωb×(J0·ωb)、ωb× Jtωb合并為ωb×(J·ωb),J為服務(wù)航天器總轉(zhuǎn)動慣量。記mhi(r0+rhi)×(¨rhi+2ωb×˙rhi)為T′hi,服務(wù)航天器姿態(tài)動力學(xué)方程為:
1.3 相對軌道動力學(xué)模型
圖2為對接裝置之間相對位置關(guān)系,其中,rd為目標(biāo)航天器的質(zhì)心位置矢量,r1,r2分別為目標(biāo)航天器、服務(wù)航天器對接裝置的安裝矢量;~l為兩航天器對接裝置之間的位置導(dǎo)引矢量,
l為~l對應(yīng)的兩航天器質(zhì)心間相對位置路徑,
rds為兩航天器質(zhì)心間的實際相對位置,Δr為l與rds間的偏差。存在:
~l=l-r1+r2, rds=l+Δr(9)
結(jié)合式(3),服務(wù)航天器與目標(biāo)航天器的相對軌道動力學(xué)方程:
式中:ud、dd分別為目標(biāo)航天器受到的控制力加速度和擾動外力加速度。
式:ωti_t為Ot-XtYtZt相對Oi-XiYiZi的角速度在Ot-XtYtZt下的表示。
作用在組合體的控制力產(chǎn)生的加速度在Ob-XbYbZb下表示為:
對位置導(dǎo)引矢量l~進行設(shè)計。如圖3所示,S型速度曲線能對加速度的變化率進行控制,加速度曲線連續(xù),在速度銜接處可實現(xiàn)平穩(wěn)過渡,是一種能限制振動的速度控制方法[13],所以選用S型速度曲線對l~進行設(shè)計。逼近過程中,根據(jù)航天器推力器配置情況,對加速度進行限幅,使其滿足為推力器能提供的最大推力,m為航天器總質(zhì)量。
圖3 S型速度曲線示意Fig.3 S-shaped velocity curve
1.4 相對姿態(tài)運動學(xué)與動力學(xué)模型
采用四元數(shù)作為姿態(tài)描述參數(shù),結(jié)合式
由于姿態(tài)四元數(shù)各元素平方和為1,姿態(tài)
控制時只對四元數(shù)矢量部分qe進行控制,有
由于服務(wù)航天器的撓性附件、液體晃動及受到的干擾難以測量或估計,故Δ項難以確定。定義e=x-xd為系統(tǒng)狀態(tài)誤差,xd=0、為期望狀態(tài),設(shè)計的控制律要求使x→x即
針對未知干擾與系統(tǒng)的不確定性,設(shè)計基于滑模估計器的相對姿軌耦合控制律。在傳統(tǒng)滑模面s=˙e+ke的基礎(chǔ)上,增加輔助滑模變量η,設(shè)計滑模面sd=s+η,其中:
針對滑??刂浦蟹柡瘮?shù)高速切換引起的震顫問題,采用飽和函數(shù)代替的方法進行處理。
3.1 仿真條件
對服務(wù)航天器向目標(biāo)的逼近過程進行仿真,采用直線逼近策略。初始時刻,目標(biāo)航天器為圓軌道,軌道半徑rd=6 778 137m,軌道傾角id=51.6°,升交點赤經(jīng)Ωd=0°,近地點幅角ωd=0°,姿態(tài)為對地定向,Od-XdYdZd相對Oo-XoYoZo初始?xì)W拉角均為0°。在Ot-XtYtZt下服務(wù)航天器相對目標(biāo)的位置矢量為[0.5;150.5;0.5],各軸相對速度0.1m/s,Ob-XbYbZb相對Oo-XoYoZo初始?xì)W拉角[-1° 1.5° 0.5°],對地定向。S型速度規(guī)劃導(dǎo)引律設(shè)計加加速度0.000 01m/s3、最大加速度0.001m/s2、最大速度0.2m/s。兩航天器對接口距各自質(zhì)心距離均為1.5m,當(dāng)服務(wù)航天器對接口逼近至距離目標(biāo)航天器對接口1m(即質(zhì)心相距4m)時設(shè)置停泊點。
服務(wù)航天器相關(guān)參數(shù)有:轉(zhuǎn)動慣量J=diag([3 645,4 448,444 8])kg·m2,整星(含太陽翼板和推進劑)質(zhì)量m為3 500kg,推進劑質(zhì)量1 797kg,其中氧化劑四氧化二氮1 120kg,燃料MMH 677kg,航天器三軸可施加最大推力50N,最大力矩75N·m。
服務(wù)航天器撓性附件的模態(tài)頻率矩陣Λ=diag(0.31 0.83 1.33 1.56 4.66)Hz,阻尼比矩陣ζ=diag(0.05 0.05 0.05 0.05 0.05)。
液體晃動模型相關(guān)參數(shù):1)氧化劑N2O4靜止質(zhì)量711kg,晃動質(zhì)量409kg,充液比為86%,彈簧阻尼器剛度系數(shù)353.455N/m,阻尼系數(shù)20.20;2)燃燒劑甲基肼靜止質(zhì)量430kg,晃動質(zhì)量247kg,充液比為86%,彈簧阻尼器剛度系數(shù)42.880 0N/m,阻尼系數(shù)67.086 0??刂坡上嚓P(guān)參數(shù):k=diag(0.5 0.5 0.5 0.3 0.3 0.3),kr=diag(0.05 0.05 0.05 0.01 0.01 0.01),
kd=0.15,控制時將轉(zhuǎn)動慣量J作拉偏25%的
處理,并考慮干擾的影響。
3.2 仿真結(jié)果及分析
圖4為相對姿態(tài)跟蹤誤差曲線,約50s后服務(wù)航天器與目標(biāo)的姿態(tài)同步,姿態(tài)角跟蹤精度5× 10-5(°),姿態(tài)角速度跟蹤精度2×10-9(°)/s。圖5為相對軌跡變化曲線,在S型速度曲線導(dǎo)引律下,服務(wù)航天器在1 090s時到達指定停泊點,且服務(wù)航天器對接口距目標(biāo)對接口保持1m的停泊距離;在360~790s,服務(wù)航天器以最大相對速度0.2m/s接近目標(biāo)。圖6為相對軌跡跟蹤誤差曲線,約45s后服務(wù)航天器位置、速度與規(guī)劃的位置、速度同步,位置跟蹤精度1×10-4m,速度跟蹤精度2×10-6m/s。圖7給出了撓性翼板前三階模態(tài)的坐標(biāo)值,穩(wěn)態(tài)時坐標(biāo)均小于1×10-7。圖8以甲基肼為例,將液體晃動等效模型與Flow-3D結(jié)果進行對比,圖7(a)~(c)為力對比,圖7(d)~(f)為力矩對比,除一些明顯毛刺外,等效模型能較好地預(yù)測晃動力與力矩的幅值。圖9為控制力與控制力矩曲線,由于初始姿態(tài)、位置誤差的存在,使得控制力與力矩在開始階段較大,由于服務(wù)航天器沿體坐標(biāo)x軸逼近目標(biāo),所以x軸方向控制力與S型速度規(guī)劃的加速度變化相匹配。
仿真結(jié)果表明,所建的剛?cè)嵋厚詈蟿恿W(xué)模型是正確的,設(shè)計的控制律能夠使航天器沿著預(yù)定軌跡,按照設(shè)計的S型速度曲線運動規(guī)律完成對目標(biāo)的逼近,具有較高的控制精度?;蝿拥刃ЯW(xué)模型能夠與Flow-3D的結(jié)果較好地吻合,即能夠較好地預(yù)測超近程逼近過程中液體晃動的狀態(tài)。
圖4 相對姿態(tài)跟蹤誤差曲線Fig.4 Curve of relative attitude tracking errors
圖5 服務(wù)航天器與目標(biāo)間相對軌跡曲線Fig.5 Curve of relative trajectorybetween servicing spacecraft and object
圖6 相對軌跡跟蹤誤差曲線Fig.6 Curve of relative trajectory tracking errors
圖7 撓性模態(tài)變量隨時間收斂曲線Fig.7 Curve of flexible modal
圖8 晃動作用對比(等效模型vs.Flow-3d)Fig.8 Slosh force comparison
圖9 控制力與控制力矩Fig.9 Control force and control torque
文章對服務(wù)航天器與目標(biāo)交會對接的超近程逼近段動力學(xué)建模與控制問題進行了研究。動力學(xué)建模中,考慮逼近過程中液體晃動的特殊性,采用新的液體晃動等效力學(xué)模型,給出了剛?cè)嵋厚詈系南鄬恿W(xué)模型??紤]模型的不確定性與未知干擾,設(shè)計了基于滑模估計器的相對姿軌耦合控制律并進行了穩(wěn)定性分析。仿真結(jié)果表明控制律的控制性能較好,具有一定的魯棒性。通過將仿真中的晃動結(jié)果與在相同激勵下的Flow-3D結(jié)果進行對比,表明建立的晃動模型符合超近程逼近段液體晃動的規(guī)律,具有一定的適用性。文章的研究對在軌服務(wù)技術(shù)的發(fā)展提供了一定的參考。
(
)
[1] 張慶展,靳永強,康志宇,等.服務(wù)航天器超近程逼近目標(biāo)的相對姿軌耦合控制[J].系統(tǒng)工程與電子技術(shù),2015,37(1):141-147.ZHANG Q Z,JIN Y Q,KANG Z Y,et al.Coupled control of relative position and attitude for servicing spacecraft approaching the target in close proximity[J].Systems Engineering and Electronics,2015,37(1):141-147(in Chinese).
[2] 王天舒,苗楠,李俊峰.航天器交會對接中液體燃料晃動等效模型研究[J].空間控制技術(shù)與應(yīng)用,2015,41(3):1-7.WANG T S,MIAO N,LI J F.Liquid sloshing equivalent mechanical model during rendezvous and docking[J].Aerospace Control and Application,2015,41(3):1-7(in Chinese).
[3] PAN H Z,KAPILA V.Adaptive nonlinear control for spacecraft formation flying with coupled translational and attitude dynamics[C]∥Proceedings of the IEEE Conference on Decision and Control,Orlando,F(xiàn)L.,USA,4-7December,2001,IEEE Xplore:2057-2062.
[4] 盧偉,耿云海,陳雪芹,等.在軌服務(wù)航天器對目標(biāo)的相對位置和姿態(tài)耦合控制[J].航空學(xué)報,2011,32(5):857-865.LU W,GENG Y H,CHEN X Q,et al.Coupled control of relative position and attitude for on-orbit servicing spacecraft with respect to target[J].Acta Aeronautica et Astronautica Sinica,2011,32(5):857-865(in Chinese).
[5] XING G Q,PARVEZ S A.Implementation of autonomous GPS guidance and control for the spacecraft formation flying[J].Frontier Science,2008,2(5):56-66.
[6] 耿云海,陳炳龍,梁海朝.改進Twisting算法的相對位姿耦合控制[J].哈爾濱工業(yè)大學(xué)學(xué)報,2015,47(11):6-14.GENG Y H,CHEN B L,LIANG H C.Relative position and attitude coupled control based on modified twisting algorithm[J].Journal of Harbin Institute of Technology,2015,47(11):6-14(in Chinese).
[7] 劉福才,陳鑫,賈亞飛,等.模糊自抗擾控制器在撓性航天器振動抑制中的應(yīng)用[J].振動與沖擊,2015(9):9-14.LIU F C,CHEN X,JIA Y F,et al.Application of fuzzy auto disturbance rejection controller in flexible spacecraft vibration suppression[J].Journal of Vibration and Shock,2015(9):9-14(in Chinese).
[8] 劉敏,徐世杰,韓潮.基于直接自適應(yīng)的撓性航天器姿態(tài)穩(wěn)定控制[J].中國空間科學(xué)技術(shù),2012,32(4):1-7.LIU M,XU S J,HAN C.Flexible spacecraft attitude stabilization control based on direct adaptive algorithm[J].Chinese Space Science and Technology,2012,32(4):1-7(in Chinese).
[9] 史星宇,齊瑞云.基于滑模觀測器的充液航天器姿態(tài)控制[J].航天控制,2015,33(4):11-16.SHI X Y,QI R Y.Attitude control of spacecraft with fuel slosh based on sliding mode observer[J].Aerospace Control,2015,33(4):11-16(in Chinese).
[10] BAYLE O,L′HULLIER V,GANET M,et al.Influence of the ATV propellant sloshing on the GNC performance[C]∥AIAA Guidance,Navigation,and Control Conference and Exhibit.Washington D.C.:AIAA,2002.
[11] 屠善澄.衛(wèi)星姿態(tài)動力學(xué)與控制[M].北京:宇航出版社,2001.TU S C.Satellite attitude dynamics and control[M].Beijing:Aerospace Publishing house,2001(in Chinese).
[12] 宋斌,顏根廷,李波,等.基于自抗擾技術(shù)的撓性航天器高精度指向控制[J].上海航天,2014,31(2):1-7.SONG B,YAN G T,LI B,et al.Active disturbance rejection control for flexible spacecraft high-accuracy attitude pointing[J].Aerospace Shanghai,2014,31(2):1-7(in Chinese).
[13] 劉蕾,曾輝,柳賀,等.六自由度機器人S型曲線速度規(guī)劃[J].計算技術(shù)與自動化,2015(2):42-45.LIU L,ZENG H,LIU H,et al.S-curve velocity planning for 6-DOF robot[J].Computing Technology and Automation,2015(2):42-45(in Chinese).
[14] BROWN M D J.Finite reaching time continuous sliding mode control with enhanced robustness[C].AIAA Guidance,Navigation,and Control Conference and Exhibit,Denver,CO,U.S.A.,14-17August,2000:1-12.
(編輯:車曉玲)
Modelingand control for a liquid-filled spacecraft with flexible appendages in close proximity
WANG Shouzhe1,LIU Huaqing2,ZHANG Qingzhan1,JIN Yongqiang1,*,SHENG Yinghua1
1.Aerospace System Engineering Shanghai,Shanghai 201109,China
2.Shanghai Institute of Satellite Engineering,Shanghai 201109,China
In close proximity,the servicing spacecraft is a complex system with rigidflexible-liquid coupled,and the liquid sloshing model,such as pendulum,isn′t applicable.The dynamics modeling and control of this spacecraft were studied.Firstly,a kind of new liquid sloshing equivalent mechanical model was derived by virtual work principle,and it could be applied to the situation of tri-axial thrust.Secondly,a relative position guidance vector and a relative position error vector were defined,and a relative position error dynamics model was derived.Thirdly,combining the relative position error dynamics with the relative attitudedynamics,a coupled relative attitude-orbit dynamics model was established,which was suitable for the process of close proximity in rendezvous and docking.The model was also rigid-flexibility-liquid coupled.Finally,a control law based on the slide-mode-control was designed to estimate the unknown but bounded disturbances,system uncertainties and measurement noise.The effectiveness of the control law was validated by numerical simulation.The results of the sloshing in the simulation agree well with the Flow-3Dresults,which indicates that the liquid sloshing equivalent mechanical model is reasonable.
on-orbit servicing;close proximity;trajectory guidance;rigid-flexible-liquid coupled;relative attitude-orbit coupled;sliding mode estimator
V412.4
A
10.16708/j.cnki.1000-758X.2017.0041
2016-08-23;
2017-01-06;錄用日期:2017-06-29;網(wǎng)絡(luò)出版時間:2017-08-11 10:27:17
http:∥kns.cnki.net/kcms/detail/11.1859.V.20170811.1027.003.html
上海市科學(xué)技術(shù)委員會資助項目(14XD1423400)
王首喆(1992-),男,碩士研究生,wszlssb@163.com,研究方向為飛行器總體設(shè)計
*通訊作者:靳永強(1981-),男,高級工程師,jyq413@bit.edu.cn,研究方向為飛行器總體設(shè)計
王首喆,劉華清,張慶展,等.撓性充液航天器超近程逼近段動力學(xué)建模與控制[J].中國空間科學(xué)技術(shù),2017,37(4):
1-9.WANG S Z,LIU H Q,ZHANG Q Z,et al.Modeling and control for a liquid-filled spacecraft with flexible appendages in close proximity[J].Chinese Space Science and Technology,2017,37(4):1-9(in Chinese).