王獻忠,張 肖,張麗敏
(1.上海市空間智能控制技術重點實驗室,上海 201109; 2.上海航天控制技術研究所,上海 201109)
?
低軌偏置動量衛(wèi)星氣動干擾力矩補償控制研究
王獻忠1, 2,張 肖1, 2,張麗敏1, 2
(1.上海市空間智能控制技術重點實驗室,上海 201109; 2.上海航天控制技術研究所,上海 201109)
針對低軌衛(wèi)星由于氣動干擾力矩較大導致偏置動量控制精度較低的問題,理論分析了氣動干擾力矩并進行建模,討論了基于角動量與角速率作用產生陀螺力矩的影響。固定偏置動量衛(wèi)星X、Z軸基于磁力矩器控制,氣動干擾力矩嚴重時又處于磁不可控區(qū),為確保姿態(tài)控制精度,考慮增加1臺反作用飛輪抑制氣動干擾力矩,反作用飛輪可與偏置動量輪組成單自由度偏置動量控制,反作用飛輪用作補償輪,沿X軸安裝。采用飛輪角動量補償和磁補償方法提高固定偏置動量控制精度:為防止赤道上空X軸處于磁不可控區(qū)時補償輪角動量變化對X軸的干擾,對補償輪角動量輸出進行限幅,給出了補償算法;為防止反作用飛輪限幅后角動量對Z軸產生干擾,設計了磁補償控制策略。仿真結果表明:在同時采用角動量補償和磁補償后三軸姿態(tài)控制精度0.2°,較無補償時有大幅提高。
低軌衛(wèi)星; 姿態(tài)控制; 偏置動量控制; 飛輪; 磁力矩器; 氣動干擾; 力矩補償; 對日定向
偏置動量控制分為固定偏置動量控制、單自由度偏置動量控制和雙自由度偏置動量控制,其中固定偏置動量控制和單自由度偏置動量控制只需測量滾動與俯仰姿態(tài),不用測量偏航姿態(tài),也無需陀螺角速率[1-5]。固定偏置動量控制飛輪只對俯仰軸進行主動控制,滾動和偏航軸基于磁控制,固定偏置動量控制精度與干擾力矩的大小相關。干擾力矩較大時,為提高控制精度需要增加偏置角動量,偏置角動量增大導致偏置動量輪的重量和功耗增加。單翼帆板的低軌衛(wèi)星所受氣動干擾力矩較嚴重,為降低硬件配置,同時提高固定偏置動量控制的抗干擾能力和控制精度,本文基于固定偏置動量加單個反作用飛輪配置進行低軌衛(wèi)星干擾力矩補償控制研究。
因偏置動量控制系統(tǒng)可靠性較高,國內外一些衛(wèi)星姿控系統(tǒng)采用偏置動量控制方案,且對偏置動量控制系統(tǒng)的研究較多。文獻[6]提出在滾動-偏航回路中利用滾動信息,采用基于偏航觀測器的滑??刂铺岣咝l(wèi)星的控制精度,但要求在滾動/偏航軸上各安裝一個反作用飛輪實現(xiàn)控制且實現(xiàn)較復雜;文獻[7]提出由安裝在衛(wèi)星滾動、偏航軸上的反作用飛輪對干擾力矩進行補償,但僅針對周期性干擾力矩進行了分析,且需要對星體的干擾力矩較精確建模;文獻[8]通過對大量在軌數(shù)據(jù)的分析,找出了偏置動量控制精度較差的部分原因并對提出的修正方法進行仿真驗證,但未對干擾力矩引起的姿態(tài)誤差進行分析和修正;文獻[9]從理論上分析了常值和周期性兩種干擾對姿態(tài)的影響,并采用飛輪前饋補償提高姿態(tài)的控制精度,但其同樣要求對干擾力矩較精確已知;文獻[10]在三軸零動量控制基礎上提出了基于飛輪角動量正反饋的外干擾力矩補償技術,但需要基于最小二乘法對干擾力矩進行估計;文獻[11]在周期干擾力矩未知條件下,基于衛(wèi)星的穩(wěn)態(tài)輸出數(shù)據(jù)用特征系統(tǒng)法辨識周期干擾力矩的頻率,并結合控制系統(tǒng)的閉環(huán)傳遞函數(shù)估計干擾的幅值進而獲得周期干擾的完整模型,但并未給出詳細的補償方法;文獻[12]基于建立的衛(wèi)星姿態(tài)動力學模型,研究了高精度遙感衛(wèi)星有效載荷工作時載荷運動產生的干擾力矩及其對衛(wèi)星姿態(tài)的影響,提出了反饋控制加力矩前饋補償?shù)姆椒?,但同樣依賴于載荷運動模型建立的準確性,魯棒性較差,難以實現(xiàn)較高精度的補償控制。
本文分析了低軌衛(wèi)星二維對日定向下氣動干擾力矩,基于角動量與角速率作用產生陀螺力矩的影響分析,針對氣動干擾力矩設計飛輪加磁補償控制算法,提出增加單個反作用飛輪作為補償輪,采用飛輪角動量補償和磁補償?shù)姆椒ㄌ岣吖潭ㄆ脛恿靠刂凭?,并對提出的干擾力矩補償控制算法進行了仿真驗證。
1.1 剛體動力學方程
衛(wèi)星剛體動力學模型可表示為
(1)
式中:I為衛(wèi)星本體的轉動慣量;ω為衛(wèi)星本體坐標系相對慣性空間的角速率;H為飛輪角動量;Tc為姿控力矩;Td為干擾力矩。
1.2 地磁場模型
北東地坐標系中三軸地磁場可近似表示為
(2)
(3)
(4)
式中:r為地心距;Re為地球半徑;
根據(jù)北東地坐標系中三軸磁場強度可算出衛(wèi)星本體中三軸磁場強度,定義為
(5)
式中:Bx,By,Bz為磁場強度三軸分量。
2.1 太陽矢量
太陽在慣性系和軌道系中指向如圖1所示。
太陽矢量在慣性系中坐標可表示為
(6)
式中:αs為太陽赤經;βs為太陽赤緯。
將rsi轉換至軌道坐標系,則有
(7)
式中:Aoi為慣性系至軌道系的轉換矩陣,且
此處:i,u,Ω分別為衛(wèi)星的軌道傾角、緯度輻角和升交點赤經。
2.2 二維對日定向時帆板法線方向
帆板在星體上安裝方式及零位位置如圖2所示。其中:帆板可繞偏置軸最大70°偏置,能繞旋轉角360°旋轉。
二維對日定向時帆板先繞Yb軸旋轉,使太陽矢量位于YsOsZs平面內,再繞偏置軸偏置一定的角度使帆板法線指向太陽。
不考慮衛(wèi)星對地定向時星體姿態(tài)偏差(下同),衛(wèi)星在軌時相對慣性空間按一定的軌道角速率繞軌道面法向(-Yo軸)旋轉,太陽相對慣性空間靜止,帆板需繞軌道面負法向(Yo軸)旋轉才能保持帆板對日定向。
升交點處帆板二維對日定向先繞Yb軸旋轉角度u0,再繞Xb軸偏置角β實現(xiàn)對日定向;衛(wèi)星按軌道角速率ω0飛行到緯度幅角u處,帆板繞Yb軸旋轉u0+u,再繞Xb軸偏置β實現(xiàn)對日定向。帆板法線在軌道坐標系中坐標為
(8)
式中:Aos,rns分別為帆板系至軌道系的轉換矩陣和帆板系中帆板法線指向,且
對日定向狀態(tài)下帆板法線指向太陽,有
(9)
由式(9)可得
u0=
(10)
β=arctan(yso/zso)
(11)
式中:xso,yso,zso為帆板法線在軌道坐標系三軸分量。
對傾角為42°的近地軌道,考慮太陽南北回歸23.5°影響,帆板最大偏置角度約65.5°,一般要求帆板具備70°的偏置能力。
2.3 氣動干擾力矩
氣動干擾力Fa和氣動干擾力矩Tda可表示為
(12)
(13)
式中:cd為氣動阻力系數(shù),取值為2.2~2.4;ρ為衛(wèi)星所在高度的大氣密度;v為飛行器相對大氣的速度;A為帆板受氣動影響的等效面積;La為迎風面壓力中心相對飛行器質心的矢量。
氣動干擾力矩作用于星體的Z軸,設帆板面積為S,則帆板二維對日定向時等效氣動面積
(14)
由式(14)可得Z軸氣動干擾力矩
(15)
式中:Tdaz0為氣動干擾力矩幅值[14]。
近地衛(wèi)星單翼帆板氣動干擾力矩較嚴重。采用雙翼對稱安裝帆板,氣動干擾力矩可相互抵消。
3.1 飛輪補償
由式(15)可知:氣動干擾力矩具有正弦絕對值波形,波動周期為軌道周期。當u+u0=90°或u+u0=270°時,氣動干擾力矩最大。以下氣動干擾力矩控制考慮u0=0°情況。
基于磁力矩器輸出磁矩計算磁控力矩
Tm=M×B
(16)
式中:M為磁力矩器輸出磁矩;B為地磁場強度。
考慮太陽矢量基本在衛(wèi)星赤道面附近,近地衛(wèi)星對日定向時氣動干擾力矩峰值一般出現(xiàn)在高緯度區(qū),此區(qū)域Z軸磁場強度較強,X、Y軸磁場強度較弱。則由式(16)可知Z軸姿態(tài)處于磁不可控區(qū)。
固定偏置動量衛(wèi)星X、Z軸基于磁力矩器控制,氣動干擾力矩嚴重時又處于磁不可控區(qū),為確保姿態(tài)控制精度,考慮增加1臺反作用飛輪抑制氣動干擾力矩。反作用飛輪可與偏置動量輪組成單自由度偏置動量控制,考慮氣動干擾力矩作用于Z軸,采用單自由度偏置動量控制需要測量偏航姿態(tài),因此將反作用飛輪用作補償輪,沿X軸安裝。
基于X軸補償輪角動量與軌道角速率叉乘產生的陀螺力矩控制氣動干擾,為防止赤道上空X軸處于磁不可控區(qū)時補償輪角動量變化對X軸的干擾,對補償輪角動量輸出進行限幅,得補償控制算法為
(17)
式中:Hxm為飛輪補償控制輸出角動量幅值;u為衛(wèi)星緯度幅角,并歸一化至[-π,π);u0為赤道上空X軸磁不可控區(qū)確定的緯度幅角。
飛輪補償控制力矩為
(18)
式中:ω0為軌道角速度。
3.2 磁控制算法
固定偏置動量常規(guī)磁章動、進動控制算法為
(19)
式中:Myc為y軸磁力矩器控制量;Bx,Bz分別為磁場強度在衛(wèi)星本體坐標系中X、Z軸的分量;kmx,kmz分別為滾動角和角速度控制增益;φ為星體滾動角。
在赤道上空反作用飛輪限幅后的角動量與軌道角速率叉乘對Z軸產生干擾,導致Z軸角速率波動,而Z軸角速率與偏置動量叉乘又影響X軸姿態(tài),赤道上空X軸處于磁不可控區(qū)。因此,基于磁控抑制Z軸角速率波動,設計磁補償控制策略為
式中:kmybu為磁補償控制增益。則得磁控制算法為
(20)
令對衛(wèi)星偏航軸加幅值為10g·cm的正弦絕對值氣動干擾力矩,俯仰軸加1g·cm重力梯度常值干擾力矩,固定偏置角動量60N·m·s,X軸補償輪角動量1 N·m·s,最大磁矩100 A·m2。用仿真對僅基于飛輪角動量補償、同時基于飛輪和磁補償,以及不考慮補償三種控制的固定偏置動量控制精度進行對比分析。
仿真所得不考慮補償固定偏置動量姿態(tài)角穩(wěn)態(tài)控制精度如圖3所示。其中,姿態(tài)控制精度約0.55°。
仿真所得采用飛輪抑制氣動干擾補償輪角動量輸出如圖4所示,補償輪補償控制姿態(tài)角穩(wěn)態(tài)控制精度如圖5所示。其中,姿態(tài)控制精度約0.3°。
仿真所得飛輪加磁補償姿態(tài)控制精度如圖6所示。其中,姿態(tài)控制精度約0.2°。
仿真結果表明:在增加飛輪補償后,在相同氣動干擾力矩作用下,姿態(tài)角控制精度由0.55°提高至0.3°,且補償輪角動量最大值約0.55 N·m·s,小于補償輪的允許角動量輸出范圍;再考慮磁補償后,姿態(tài)角控制精度進一步提高至0.2°。
低軌衛(wèi)星氣動干擾力矩較大,采用常規(guī)的固定偏置動量控制精度較低。本文基于固定偏置動量加單個反作用飛輪進行低軌衛(wèi)星干擾力矩補償控制研究,基于角動量與角速率作用產生陀螺力矩的影響分析,設計了角動量和磁補償算法,仿真結果表明在相同干擾力矩作用下基于角動量和磁補償后控制精度優(yōu)于常規(guī)固定偏置動量控制。本方法算法簡單,無需對干擾力矩精確建?;蚬烙?,易于工程實現(xiàn)。目前研究主要根據(jù)普遍情況針對Z軸干擾力矩進行補償控制研究和仿真分析,后續(xù)將對其它軸干擾力矩較大情況下的補償控制進行研究。
[1] 章仁為. 衛(wèi)星軌道姿態(tài)動力學與控制[M]. 北京: 北京航空航天大學出版社, 2006.
[2] 屠善澄. 衛(wèi)星姿態(tài)動力學與控制[M]. 北京: 宇航出版社, 2002.
[3] 王曙光, 張偉. 偏置動量衛(wèi)星偏航姿態(tài)估計與控制研究[J]. 上海航天, 2006, 23(6): 18-21.
[4] 宋斌, 馬廣富, 李傳江, 等. 基于偏航觀測器的偏置動量衛(wèi)星姿態(tài)控制[J]. 哈爾濱工程大學學報, 2007, 28(1): 15-20.
[5] BARKER L, PRICE X, RODDEN J. Three axis authority momentum spacecraft attitude control: AIAA Guidance, Navigation, and Control Conference and Exhibit[C]// Monterey: 2002.
[6] 呂建婷, 馬廣富, 宋斌. 偏置動量輪控衛(wèi)星姿態(tài)控制[J]. 控制工程, 2007, 14(6): 569-571.
[7] 宋斌, 馬廣富, 李傳江, 等. 基于飛輪的偏置動量衛(wèi)星周期干擾補償方法[J]. 控制工程, 2007, 14(2): 143-146.
[8] 柯旗, 王勇, 魏春嶺. 一種在軌改善偏置動量衛(wèi)星控制精度的方法[J]. 空間控制技術與應用, 2011, 37(4): 41-44.
[9] 王曙光, 張偉. 偏置動量衛(wèi)星耦合通道外干擾力矩補償方法[J]. 上海航天, 2007, 24(3): 20-25.
[10] 王禹, 朱文山, 牛睿. 一種基于飛輪角動量正反饋的外干擾力矩補償技術研究[J]. 上海航天, 2016, 33(3): 23-29.
[11] 雷靜, 劉瑩瑩, 周鳳岐, 等. 衛(wèi)星在軌周期干擾力矩辨識與補償方法的研究[J]. 西北工業(yè)大學學報,2009, 27(3): 397-400.
[12] 俞潔, 廖瑛, 劉偉. 高精度遙感衛(wèi)星力矩補償技術[J]. 上海航天, 2011, 28(1): 12-17.
[13] 黃圳圭. 航天器姿態(tài)動力學[M]. 長沙: 國防科技大學出版社, 2002.
[14] 王獻忠, 張肖, 張麗敏. 近地零動量衛(wèi)星干擾力矩飛輪補償控制[J]. 航天控制, 2016, 34(2): 60-64.
Study on Atmosphere Disturbance Moment Control for Momentum-Biased Low-Orbit Satellites
WANG Xian-zhong1, 2, ZHANG Xiao1, 2, ZHANG Li-min1, 2
(1. Shanghai Key Laboratory of Aerospace Intelligent Control Technology, Shanghai 201109, China;2. Shanghai Institute of Spaceflight Control Technology, Shanghai 201109, China)
Aiming at the problem that the control precision of bias momentum low-orbit satellite was inferior because of the atmosphere disturbance, the atmosphere disturbance was analyzed and modeled. The gyro moment effect based on the action momentum and velocity was discussed. TheXaxis andYaxis were controlled by magnetic torquers for momentum-biased satellite. And the satellite was in the area not controlled by magnetic torquers when disturbance moment of atmosphere was big. To improve attitude control accuracy, it could add one reaction wheel to suppress the disturbance moment of atmosphere. The wheel added as a compensation wheel could combine with biased momentum wheel to form momentum-biased control with single freedom. The accuracy of fixed momentum-biased control was improved by wheel angular momentum compensation and magnetic compensation. The amplitude of angular momentum output of the compensation wheel was limited to avoid the change of the compensation wheel disturbingXaxis when the satellite was above equator and in the area ofXaxis not controlled. The compensation algorithm was given. The magnetic compensation strategy was designed to avoid the angular momentum disturbingZaxis after the output amplitude was limited. The simulation results showed that the control precision was 0.2° by compensating method proposed which was much higher than that of without compensation.
low-orbit satellite; attitude control; momentum-biased control; wheel; magnetic torquers; disturbance moment of atmosphere; moment compensating; points to sun
1006-1630(2017)02-0074-05
2016-11-29;
2017-01-22
國防預研究項目(30504040304)
王獻忠(1971—),男,博士,研究員,主要從事飛行器控制系統(tǒng)研究與設計。
V448.22
A
10.19328/j.cnki.1006-1630.2017.02.007