專利名稱:一種采用正弦偏航導(dǎo)引律的偏航機(jī)動(dòng)控制方法
技術(shù)領(lǐng)域:
本發(fā)明涉及一種采用正弦偏航導(dǎo)引律的偏航機(jī)動(dòng)控制方法,可以在星上實(shí)現(xiàn)正弦形式的偏航機(jī)動(dòng),主要在非太陽同步軌道的衛(wèi)星上使用。
背景技術(shù):
衛(wèi)星帆板上鋪設(shè)有太陽能電池片,伸展開的帆板可以大大增加衛(wèi)星獲取太陽能的面積,所以帆板是絕大多數(shù)衛(wèi)星獲取太陽能的必備設(shè)備,也是衛(wèi)星在軌飛行的主要能源來源。目前我國在軌運(yùn)行的衛(wèi)星除了使用固定翼帆板外,大部分采用單自由度的帆板。選用單自由度帆板的衛(wèi)星在選擇軌道時(shí),多是選擇太陽和軌道面夾角小的太陽同步軌道,從而帆板驅(qū)動(dòng)機(jī)構(gòu)在垂直軌道面方向旋轉(zhuǎn)帆板就可以令太陽直射帆板。在非太陽同步軌道下,太陽方向和軌道面夾角的變化很大,可以有90度的變化范圍。顯而易見,當(dāng)太陽垂直照射到軌道面時(shí),垂直軌道面的帆板無論怎樣轉(zhuǎn)動(dòng)都無法獲得能源。所以,配有單自由度的帆板 的非太陽同步軌道的衛(wèi)星,為了實(shí)現(xiàn)帆板法線指向太陽,需要進(jìn)行衛(wèi)星的姿態(tài)機(jī)動(dòng)。由于衛(wèi)星的任務(wù)多是對(duì)地球進(jìn)行觀測的,需要令衛(wèi)星的某一面(例如安裝有相機(jī)等設(shè)備的一側(cè))始終朝向地面,因此常采用偏航機(jī)動(dòng)模式。偏航機(jī)動(dòng)模式是采用單自由度帆板的非太陽同步軌道衛(wèi)星,在太陽方向與軌道面間的夾角較大時(shí),通過繞星體偏航軸機(jī)動(dòng)和帆板轉(zhuǎn)動(dòng),使得帆板法線與太陽方向平行,達(dá)到保證能源供應(yīng)和對(duì)地指向的一種飛行模式。在現(xiàn)有偏航機(jī)動(dòng)模式下,隨著太陽高度角的減小,偏航角的變化越來越集中在軌道的正午點(diǎn)(α為O度的點(diǎn))和午夜點(diǎn)(α為180度的點(diǎn))附近的一段范圍內(nèi),造成在正午點(diǎn)和午夜點(diǎn)附近偏航角速度較大,采用噴氣控制時(shí),推進(jìn)劑消耗量大,采用角動(dòng)量交換裝置控制(多采用此方式)時(shí)對(duì)角動(dòng)量容量需求大,衛(wèi)星需要配備較大容量的角動(dòng)量交換裝置,重量大的問題。
發(fā)明內(nèi)容
本發(fā)明所要解決的技術(shù)問題是克服現(xiàn)有技術(shù)的不足,提供了一種采用正弦偏航導(dǎo)引律的偏航機(jī)動(dòng)控制方法,實(shí)現(xiàn)了衛(wèi)星按照正弦形式進(jìn)行偏航機(jī)動(dòng),在保證能源供應(yīng)的條件下,降低了對(duì)衛(wèi)星角動(dòng)量交換裝容量的需求。本發(fā)明包括如下技術(shù)方案一種采用正弦偏航導(dǎo)引律的偏航機(jī)動(dòng)控制方法,步驟如下(I)根據(jù)太陽方向在軌道系的分量計(jì)算太陽高度角β ;(2)根據(jù)太陽方向在軌道系的分量計(jì)算太陽方位角α ;(3)根據(jù)星上注入數(shù)據(jù)判斷是按照頭對(duì)日方式進(jìn)行規(guī)劃,還是按照尾對(duì)日方式進(jìn)行規(guī)劃,頭對(duì)日方式進(jìn)入步驟(4),尾對(duì)日方式,進(jìn)入步驟(5);(4)按照頭對(duì)日的方式進(jìn)行偏航角正弦規(guī)劃,得到偏航角Vtl和偏航角速度轉(zhuǎn)入步驟⑶;(5)按尾頭對(duì)日的方式進(jìn)行偏航角正弦規(guī)劃,得到偏航角Vtl和偏航角速度Po,轉(zhuǎn)入步驟⑶;(6)根據(jù)得到的偏航角Ftl和偏航角速度^計(jì)算帆板轉(zhuǎn)速&/ ;(7)根據(jù)得到的偏航角Vtl、偏航角速度^、帆板轉(zhuǎn)速^^·進(jìn)行偏航角度跟蹤控制和帆板轉(zhuǎn)速控制。所述步驟(I)中根據(jù)太陽方向在軌道系的分量計(jì)算太陽高度角β按照如下公式進(jìn)行如果“Is?!埂礗)貝Ij: β = arcsin (-Soy/ Soy |) X Kdar否則β= arcsin (-Soy) XKdar其中Stjy為太陽方向在軌道系下Y軸的分量;Kto為從弧度轉(zhuǎn)化到度所乘的系數(shù)。所述步驟(2)中根據(jù)太陽方向在軌道系的分量計(jì)算太陽方位角α按照如下公式進(jìn)行a = arctan2(-S0X,-Sj XKdar ;其中Sax為太陽方向在軌道系下X軸的分量^為太陽方向在衛(wèi)星軌道系下Z軸的分量;arctan2(y,x)函數(shù)定義如下· (
arctan —if x>Q
f
arctan -\-\-π if x < Oandy > 0
(j;) arctan2(y9x) = ^arctan — -π if x< Qandy < 0。
J
π廣
—if X = Oandy > 0
π
if X = Oandy < 0所述步驟(4)中計(jì)算偏航角Ψ(ι和偏航角速度 按照如下公式進(jìn)行如果β> O. O則Ψ0= -90-(90-β) Xsin(KradX α )ψα = -Co0 X(90-β)χcos(Krad Xα);否則ψ0= 90+(90+β) Xsin(KradX α )Ψα=ωαχ (90 + β)χ cos(Krad χ α);其中Oci為軌道角速度的絕對(duì)值,單位為度/秒,KradS度轉(zhuǎn)化到弧度所乘的系數(shù)。所述步驟(5)中計(jì)算偏航角Ψ(ι和偏航角速度&按照如下公式進(jìn)行如果β> O. O貝IJ: Ψ0 = 90-(90-β) Xsin(KradX α )W0 = -CO0 χ (90-β)χcos(Krad χ a);否則ψ0= -90+(90+β) Xsin(KradX α )ψ0=ω0 χ (90 + β)χcos(Krad χ α);其中Otl為軌道角速度的絕對(duì)值,單位為度/秒,KradS度轉(zhuǎn)化到弧度所乘的系數(shù)。
所述步驟(6)中計(jì)算帆板轉(zhuǎn)速^^按照如下公式進(jìn)行Sbx = cos Ψ0Sox+sin Ψ0Soy
權(quán)利要求
1.一種采用正弦偏航導(dǎo)引律的偏航機(jī)動(dòng)控制方法,其特征在于步驟如下 (1)根據(jù)太陽方向在軌道系的分量計(jì)算太陽高度角β; (2)根據(jù)太陽方向在軌道系的分量計(jì)算太陽方位角α; (3)根據(jù)星上注入數(shù)據(jù)判斷是按照頭對(duì)日方式進(jìn)行規(guī)劃,還是按照尾對(duì)日方式進(jìn)行規(guī)劃,頭對(duì)日方式進(jìn)入步驟(4),尾對(duì)日方式,進(jìn)入步驟(5); (4)按照頭對(duì)日的方式進(jìn)行偏航角正弦規(guī)劃,得到偏航角Vtl和偏航角速度00,轉(zhuǎn)入步驟⑶; (5)按尾頭對(duì)日的方式進(jìn)行偏航角正弦規(guī)劃,得到偏航角Ψ(!和偏航角速度Wo,轉(zhuǎn)入步驟⑶; (6)根據(jù)得到的偏航角Vtl和偏航角速度Po計(jì)算帆板轉(zhuǎn)速 ,; (J)根據(jù)得到的偏航角Ψο、偏航角速度#ο、帆板轉(zhuǎn)速&/進(jìn)行偏航角度跟蹤控制和帆板轉(zhuǎn)速控制。
2.根據(jù)權(quán)利要求I所述的一種采用正弦偏航導(dǎo)引律的偏航機(jī)動(dòng)控制方法,其特征在于 所述步驟(I)中根據(jù)太陽方向在軌道系的分量計(jì)算太陽高度角β按照如下公式進(jìn)行如果(I Stjy I > I) 貝Ij : β = arcsin (-Soy/ Soy |) X Kdar 否則β = arcsin (-Soy) XKdar 其中Stjy為太陽方向在軌道系下Y軸的分量;Kdat為從弧度轉(zhuǎn)化到度所乘的系數(shù)。
3.根據(jù)權(quán)利要求I所述的一種采用正弦偏航導(dǎo)引律的偏航機(jī)動(dòng)控制方法,其特征在于所述步驟(2)中根據(jù)太陽方向在軌道系的分量計(jì)算太陽方位角α按照如下公式進(jìn)行 a = arctan2(-S0X, -Soz) XKdat ;其中Sox為太陽方向在軌道系下X軸的分量;S0Z為太陽方向在衛(wèi)星軌道系下Z軸的分量;arctan2(y,x)函數(shù)定義如下
4.根據(jù)權(quán)利要求I所述的一種采用正弦偏航導(dǎo)引律的偏航機(jī)動(dòng)控制方法,其特征在于所述步驟(4)中計(jì)算偏航角Vtl和偏航角速度#0按照如下公式進(jìn)行 如果β >0.0貝IJ :Ψ0 = -90-(90-β) Xsin(KradX α)Ψο = ~ω0 X(90-β)χcos(Krad XO); 否則Ψ0 = 90+(90+β) Xsin(KradX α) (90 + β)χ cos(Krad X a); 其中Otl為軌道角速度的絕對(duì)值,單位為度/秒,Krad為度轉(zhuǎn)化到弧度所乘的系數(shù)。
5.根據(jù)權(quán)利要求I所述的一種采用正弦偏航導(dǎo)引律的偏航機(jī)動(dòng)控制方法,其特征在于所述步驟(5)中計(jì)算偏航角Vtl和偏航角速度Wq按照如下公式進(jìn)行 如果β >0.0 則Ψ0 = 90-(90-β) Xsin(KradX α)Ψο = -ω0 X(90-β)χ cos(Krad χ ); 否則Ψ0 = -90+(90+β) Xsin(KradX α)Ψ0 = ω0χ (90 + β)χ cosd χ α); 其中Otl為軌道角速度的絕對(duì)值,單位為度/秒,Krad為度轉(zhuǎn)化到弧度所乘的系數(shù)。
6.根據(jù)權(quán)利要求I所述的一種采用正弦偏航導(dǎo)引律的偏航機(jī)動(dòng)控制方法,其特征在于所述步驟(6)中計(jì)算帆板轉(zhuǎn)速按照如下公式進(jìn)行
全文摘要
本發(fā)明公開了一種采用正弦偏航導(dǎo)引律的偏航機(jī)動(dòng)控制方法,在飛行器偏航軸機(jī)動(dòng)方法中設(shè)計(jì)了正弦偏航導(dǎo)引律,使偏航軸跟蹤一條正弦曲線,同時(shí)根據(jù)該曲線計(jì)算帆板轉(zhuǎn)速,保證在這種模式下太陽方向與帆板法線夾角最小。正弦偏航導(dǎo)引律的應(yīng)用,在保證飛行器能源的同時(shí),降低了原偏航機(jī)動(dòng)模式對(duì)角動(dòng)量交換裝置容量的需求,為航天器減小角動(dòng)量容量需求,降低控制系統(tǒng)重量提供了一種方法。
文檔編號(hào)G05D1/08GK102880059SQ20121038843
公開日2013年1月16日 申請(qǐng)日期2012年10月15日 優(yōu)先權(quán)日2012年10月15日
發(fā)明者董文強(qiáng), 張志方, 張錦江, 何英姿 申請(qǐng)人:北京控制工程研究所