專利名稱：用于偏置動量微小衛(wèi)星章進(jìn)動控制的方法
技術(shù)領(lǐng)域：
本發(fā)明公布了一種用于偏置動量微小衛(wèi)星章進(jìn)動控制的方法，采用磁強(qiáng)計輸出作 為控制律的輸入，利用磁場的先驗信息實現(xiàn)實時補(bǔ)償，最終磁力矩器輸出控制衛(wèi)星的角動 量矩的指向收斂于軌道的法向。
背景技術(shù)：
“偏置動量輪+磁強(qiáng)計+磁力矩器”的衛(wèi)星控制系統(tǒng)配置具有成本低、可靠度高等 優(yōu)點，是微小衛(wèi)星、納衛(wèi)星、皮衛(wèi)星甚至大衛(wèi)星的較為常見的一種控制系統(tǒng)配置方式，該類 配置需要控制衛(wèi)星的章進(jìn)動，從而長期保持角動量矩矢量指向衛(wèi)星軌道的法向。現(xiàn)有的經(jīng) 典控制方法如下1)經(jīng)典方法1 這一類方法不但需要磁強(qiáng)計，甚至需要其余敏感器(如地球敏感器、陀 螺)直接測量出姿態(tài)角或者采用統(tǒng)計估計技術(shù)間接測量出姿態(tài)角。幾種較為常見的控制律其中，力Y軸的磁力矩器輸出的磁矩;豸為磁強(qiáng)計的X軸輸出；《為磁強(qiáng)計的Y軸的輸出的變化率；Ji為磁強(qiáng)計的X軸輸出；,為衛(wèi)星的滾動角；,為航向角；ii、J^、J^為控制參數(shù)。其優(yōu)點是控制律的設(shè)計中考慮了姿態(tài)角，能夠更有效地抑制章進(jìn)動，但是缺點也 很明顯，需要更多的硬件資源，如果采用統(tǒng)計估計算法，星上運算量也較大。2)經(jīng)典方法2 僅采用磁強(qiáng)計輸出實現(xiàn)衛(wèi)星的章動控制，并間接地控制衛(wèi)星的進(jìn) 動?？刂坡蔀槠渲?，為Y軸的磁力矩器輸出的磁矩為磁強(qiáng)計的Y軸的輸出的變化率；fc為控 制參數(shù)。其優(yōu)點是控制律設(shè)計非常簡單，僅需差分處理，運算極其簡便；缺點是控制精度 低，常在初始阻尼中使用，較少直接用來實現(xiàn)章進(jìn)動控制。

發(fā)明內(nèi)容
本發(fā)明目的是針對現(xiàn)有技術(shù)存在的缺陷提供一種用于偏置動量微小衛(wèi)星章進(jìn)動 控制的方法。本發(fā)明為實現(xiàn)上述目的，采用如下技術(shù)方案本發(fā)明用于偏置動量微小衛(wèi)星章進(jìn)動控制的方法包括如下步驟 1)初始化a)采集磁強(qiáng)計Y軸輸出，并記錄保存；b)根據(jù)時間、衛(wèi)星軌道，并結(jié)合地磁表計算衛(wèi)星在軌道坐標(biāo)系中的模型地磁c)記錄軌道坐標(biāo)系中的Y軸模型磁場值；2)采集當(dāng)前時刻磁強(qiáng)計Y軸輸出；3)根據(jù)當(dāng)前時間、衛(wèi)星軌道，并結(jié)合地磁表計算衛(wèi)星在軌道坐標(biāo)系中的模型地磁場；4)讀取上一控制周期記錄的磁強(qiáng)計Y軸輸出；5)將當(dāng)前時刻磁強(qiáng)計Y軸輸出，減去上一周期記錄的磁強(qiáng)計Y軸輸出，得到JJ；6)讀取上一周期記錄的軌道坐標(biāo)系中的Y軸模型磁場值；7)將當(dāng)前時刻軌道坐標(biāo)系中的Y軸模型磁場值，減去上一時刻軌道坐標(biāo)系中的Y軸模8)根據(jù)控制律，=-明《)’計算Y軸磁力矩器的輸出磁矩，并向磁力矩器發(fā)送控 制指令；9)記錄當(dāng)前時刻磁強(qiáng)計Y軸輸出；10)記錄當(dāng)前時刻軌道坐標(biāo)系中的Y軸模型磁場值；11)以控制周期T為間隔時間等間隔重復(fù)步驟2) 10)，所述控制周期T 為設(shè)定的指執(zhí)行步驟2) ^10)所用的時間。 本發(fā)明由于無需測量姿態(tài)角，具有運算量小，硬件依賴小等特點，同時因為采用了 先驗磁場信息補(bǔ)償，仍保持了較高的精度。適合故障大衛(wèi)星的搶救與延壽，以及硬件配置簡 單、運算能力不足的微衛(wèi)星、納衛(wèi)星和皮衛(wèi)星的控制系統(tǒng)選用。


圖1 章進(jìn)動控制原理圖。圖2 進(jìn)動角波形圖。圖3 :X軸的角速度波形圖。圖4 :Z軸的角速度波形圖。
具體實施例方式
本發(fā)明僅采用磁強(qiáng)計輸出實現(xiàn)衛(wèi)星的章動控制，并間接地控制衛(wèi)星的進(jìn)動。新控 制律為
權(quán)利要求
1. 一種用于偏置動量微小衛(wèi)星章進(jìn)動控制的方法，其特征在于包括如下步驟 初始化采集磁強(qiáng)計Y軸輸出，并記錄保存；根據(jù)時間、衛(wèi)星軌道，并結(jié)合地磁表計算衛(wèi)星在軌道坐標(biāo)系中的模型地磁場； 記錄軌道坐標(biāo)系中的Y軸模型磁場值； 采集當(dāng)前時刻磁強(qiáng)計Y軸輸出；根據(jù)當(dāng)前時間、衛(wèi)星軌道，并結(jié)合地磁表計算衛(wèi)星在軌道坐標(biāo)系中的模型地磁場； 讀取上一控制周期記錄的磁強(qiáng)計Y軸輸出；將當(dāng)前時刻磁強(qiáng)計Y軸輸出，減去上一周期記錄的磁強(qiáng)計Y軸輸出，得到讀取上一周期記錄的軌道坐標(biāo)系中的Y軸模型磁場值；將當(dāng)前時刻軌道坐標(biāo)系中的Y軸模型磁場值，減去上一時刻軌道坐標(biāo)系中的Y軸模型 磁場值，得到《；根據(jù)控制律，計算Y軸磁力矩器的輸出磁矩，并向磁力矩器發(fā)送控制指令； 記錄當(dāng)前時刻磁強(qiáng)計Y軸輸出； 記錄當(dāng)前時刻軌道坐標(biāo)系中的Y軸模型磁場值；以控制周期T為間隔時間等間隔重復(fù)步驟2廣10)，所述控制周期T為設(shè)定的指執(zhí)行步 驟2) 10)所用的時間。
全文摘要
本發(fā)明公布了一種用于偏置動量微小衛(wèi)星章進(jìn)動控制的方法，包括如下步驟初始化采集當(dāng)前時刻磁強(qiáng)計Y軸輸出并記錄，根據(jù)當(dāng)前時間、軌道參數(shù)，結(jié)合地磁表計算衛(wèi)星在軌道坐標(biāo)系中的模型地磁場并記錄；讀取上一周期記錄的磁強(qiáng)計Y軸輸出；將當(dāng)前時刻磁強(qiáng)計Y軸輸出，減去上一周期記錄的磁強(qiáng)計Y軸輸出，得到；將當(dāng)前時刻軌道坐標(biāo)系中的Y軸模型磁場值，減去上一時刻軌道坐標(biāo)系中的Y軸模型磁場值，得到；根據(jù)控制律，計算Y軸磁力矩器的輸出磁矩，并向磁力矩器發(fā)送控制指令；記錄當(dāng)前時刻磁強(qiáng)計Y軸輸出；記錄當(dāng)前時刻軌道坐標(biāo)系中的Y軸模型磁場值；以控制周期T等間隔重復(fù)步驟2)~9)。本發(fā)明無需測量姿態(tài)角，具有運算量小，硬件依賴小等優(yōu)點。
文檔編號G05D1/00GK102053622SQ201010519308
公開日2011年5月11日 申請日期2010年10月26日 優(yōu)先權(quán)日2010年10月26日
發(fā)明者華冰, 康國華, 熊智, 程月華, 郁豐, 陳衛(wèi)東 申請人:南京航空航天大學(xué)