月面巡視器太陽板對日定向規(guī)劃算法

劉書豪 彭松

(北京空間飛行器總體設(shè)計部, 北京 100094)

月面巡視器太陽板對日定向規(guī)劃算法

劉書豪 彭松

(北京空間飛行器總體設(shè)計部, 北京 100094)

針對月面巡視器太陽板對日定向問題，提出了一種規(guī)劃算法。分析了規(guī)劃指標與約束條件，約束條件包括太陽入射角約束和太陽板機械轉(zhuǎn)動約束；推導了在車體姿態(tài)不變情況下的定向算法，通過將太陽板運動轉(zhuǎn)換為平面上的矢量旋轉(zhuǎn)，實現(xiàn)對日定向；利用巡視器原地轉(zhuǎn)向運動彌補太陽板單自由度轉(zhuǎn)動的不足，將車體運動與太陽板法向矢量軌跡投影至球面，得到車體原地轉(zhuǎn)向時的定向規(guī)劃算法。仿真結(jié)果表明：文章提出的算法能夠?qū)崿F(xiàn)指定約束下的對日定向；對于無法實現(xiàn)理想對日定向的情況，算法也能夠獲得太陽板的次優(yōu)規(guī)劃。

月面巡視器；太陽板；對日定向；太陽入射約束

1 引言

月面巡視器是實現(xiàn)對月球近距離考察的重要途徑[1-2]。太陽板為月面巡視器提供能源，目前與之類似的太陽翼已經(jīng)在地球軌道衛(wèi)星上得到大量應(yīng)用，國內(nèi)外也針對太陽翼及其驅(qū)動技術(shù)開展了大量研究。文獻[3]分析了太陽翼技術(shù)發(fā)展趨勢，文獻[4]從控制器設(shè)計角度探討了太陽翼機構(gòu)的定向控制，文獻[5]詳細分析了各種工況下的衛(wèi)星太陽翼光照角度計算模型，文獻[6]針對傾斜軌道航天器提出慣性定向和對地定向兩種航天器太陽翼對日跟蹤的若干算法，文獻[7]提出雙自由度驅(qū)動機構(gòu)的軌跡規(guī)劃算法，文獻[8-9]通過合適的起始時刻驅(qū)動太陽翼勻速旋轉(zhuǎn)，保證太陽翼法線和太陽光線的夾角保持最佳位置。上述文獻解決問題的思路基本一致，均根據(jù)衛(wèi)星軌道與太陽位置的幾何關(guān)系來計算太陽翼轉(zhuǎn)動。但是，月面巡視器與地球軌道衛(wèi)星在太陽翼的應(yīng)用形式上存在較大差異，具體表現(xiàn)在：一方面，對于地球軌道衛(wèi)星，為了獲得充足的能源，應(yīng)保證太陽矢量與太陽翼法線夾角最小，達到最佳的太陽光照狀態(tài)；但對于月面巡視器而言，其在月面著陸后，將經(jīng)歷長時期惡劣的月球環(huán)境，過強的光照狀態(tài)可能會對熱控等系統(tǒng)產(chǎn)生不利影響，進而影響巡視任務(wù)[10-11]，考慮到能源供應(yīng)與熱控條件的雙重約束，應(yīng)保證巡視器太陽板的太陽入射角滿足一定的角度約束。另一方面，大多數(shù)地球軌道衛(wèi)星很少通過調(diào)整星體姿態(tài)達到提高太陽光照的目的；但月面巡視器可通過調(diào)整車體姿態(tài)獲得更合適的光照，這大大增加了巡視器對日定向的靈活性。

針對上述兩點，目前國內(nèi)幾乎沒有文獻開展相關(guān)研究。本文針對巡視器的特點，考慮了太陽入射角約束、機構(gòu)運動約束等條件，提出了一種對日定向的規(guī)劃算法。由于運動規(guī)劃結(jié)果與巡視器姿態(tài)密切相關(guān)，本文分別對車體姿態(tài)固定、車體原地轉(zhuǎn)向兩種工況進行分析，可用于月面巡視器系統(tǒng)任務(wù)設(shè)計與仿真驗證。

2 定義與約束

(1)巡視器本體坐標系：X軸位于結(jié)構(gòu)底板對月面內(nèi)，+X軸指向巡視器前進方向；Z軸沿結(jié)構(gòu)底板對月面法線方向，+Z軸指向月面；Y軸與Z軸和X軸構(gòu)成右手坐標系。坐標系定義如圖1所示。

圖1 巡視器坐標系

(2)太陽入射角φ：太陽方向矢量與+Y太陽板平面法線矢量的夾角。

(3)+Y太陽板運動：+Y太陽板指位于本體坐標系+Y側(cè)的太陽板。巡視器在月面巡視過程中，只有+Y太陽板具有運動自由度，因此只針對+Y太陽板開展研究。在巡視器本體坐標系下，太陽板處于收攏壓緊狀態(tài)時，基板平面與XOY面平行的位置為太陽板的零位，如圖2所示。在巡視器本體坐標系下，+Y太陽板具有一個自由度，其轉(zhuǎn)軸的正方向與巡視器的+X軸指向相同，然后按右手法則確定轉(zhuǎn)角的正負。+Y太陽板轉(zhuǎn)角θ可限制在圖2所示的紅色陰影區(qū)域內(nèi)，該區(qū)域張角記為Δ，Δ∈(0°,90°)。

圖2 +Y太陽板轉(zhuǎn)動定義

3 車體姿態(tài)固定時的對日定向規(guī)劃算法

3.1規(guī)劃目標

根據(jù)車體位置、姿態(tài)信息，計算+Y太陽板對日定向時所需的太陽板轉(zhuǎn)角θ，使得太陽板處于最優(yōu)光照條件，同時滿足如下約束。

(1)太陽入射角約束：為了適應(yīng)熱控的需要，太陽入射角φ應(yīng)滿足φ≥Ω，其中，Ω為固定常值，代表了太陽入射角的可達最優(yōu)狀態(tài)。

(2)太陽板運動范圍約束：當太陽板展開角度小于180°時，太陽板會對巡視器車體設(shè)備產(chǎn)生遮擋，因此本文要求太陽板轉(zhuǎn)角θ滿足θ∈[180°,180°+Δ]，對應(yīng)的太陽板轉(zhuǎn)動可行范圍如圖2中紅色陰影區(qū)域所示。

3.2問題分析

設(shè)太陽板轉(zhuǎn)角θ對應(yīng)的規(guī)劃太陽板法向矢量為P，太陽板對日定向規(guī)劃問題實質(zhì)為太陽板法向矢量的求解問題。不難發(fā)現(xiàn)，太陽板法向始終處于巡視器本體坐標系的YZ平面內(nèi)。考慮到太陽板轉(zhuǎn)動范圍限制在圖2所示的紅色陰影區(qū)域內(nèi)，因此，不考慮原地轉(zhuǎn)向時，太陽板對日定向問題實際上可轉(zhuǎn)換為在YZ平面紅色陰影區(qū)域內(nèi)的矢量求解問題。算法基本思路為：首先計算無入射角約束下太陽板的最優(yōu)光照狀態(tài)；然后對最優(yōu)狀態(tài)進行約束檢查；最后得到可行太陽板轉(zhuǎn)角θ，如果存在兩個解均滿足對日定向要求，則選取轉(zhuǎn)動幅度最小的轉(zhuǎn)角作為規(guī)劃解。

3.3算法說明

假設(shè)太陽矢量S在巡視器本體坐標系下的投影Sb的坐標為(sb，x，sb，y，sb，z)T，進而可得其在YZ平面的投影Sb_pro的坐標為(0，sb，y，sb，z)T。定義太陽矢量與巡視器本體坐標系YZ平面的夾角為φ0，則

(1)

顯然，如果不考慮太陽入射角約束和太陽板運動范圍，則φ0代表了太陽板所能達到的最優(yōu)光照狀態(tài)。下面將根據(jù)φ0的取值，分幾種情況確定可行的太陽板法線矢量。

1)φ0=90°

這代表了一種極限情況，表明太陽板對光照不可見；此時，無論太陽板如何旋轉(zhuǎn)，也無法接收太陽光。

2)Ω≤φ0<90°

此種情況如圖3所示，太陽入射角也無法達到Ω，則φ0為太陽入射角的可達最優(yōu)狀態(tài)。與φ0對應(yīng)的太陽板法向矢量Sb_pro，即為所求的太陽板法向矢量P，進而可得對應(yīng)的太陽板轉(zhuǎn)角θt為

(2)

圖3 Ω≤φ0<90°幾何關(guān)系示意

上述過程保證了太陽入射角滿足約束，還要對太陽板運動約束進行檢查。若180°<θt<Δ+180°，則規(guī)劃得到的太陽板轉(zhuǎn)角為θ=θt；否則，表明θt超出了太陽板運動范圍的限制，不可行，取θt轉(zhuǎn)動幅度最小的極限位置作為規(guī)劃結(jié)果。

3)φ0<Ω

如圖4所示，O為巡視器本體坐標系原點，太陽板理想對日定向后，φ0<Ω，不滿足約束要求，此時可將太陽板法向偏離太陽投影矢量一定的角度α，使所求得的矢量P1，P2與太陽光夾角為Ω。因此，問題最終轉(zhuǎn)換為求解矢量P1和P2，進而判斷矢量對應(yīng)的太陽板轉(zhuǎn)角是否滿足轉(zhuǎn)動約束即可。

圖4 2個可行法向矢量示意

從圖4中可看到，Sb，Sb_pro，P1在球面的投影點構(gòu)成了球面直角三角形，根據(jù)球面幾何可得

(3)

將矢量Sb_pro繞X軸分別旋轉(zhuǎn)角度α和-α，可得法線矢量的2個解P1和P2，進一步可求得對應(yīng)的太陽板轉(zhuǎn)角θ1和θ2，求解方法同式(2)。

最后，判斷θ1和θ2是否滿足運動限制，判斷規(guī)則如下。

(1)如果θ1,θ2?(180°,180°+Δ)，設(shè)當前太陽板轉(zhuǎn)角為θ0，如果|180°-θ0|<|(180°+Δ)-θ0|，則規(guī)劃的太陽板轉(zhuǎn)角為θ=180°，否則，θ=180°+Δ；

(2)如果θ1?(180°,180°+Δ)，θ2∈(180°,180°+Δ)，則規(guī)劃的太陽板轉(zhuǎn)角θ=θ2；

(3)如果θ1∈(180°,180°+Δ)，θ2?(180°,180°+Δ)，則規(guī)劃的太陽板轉(zhuǎn)角θ=θ1；

(4)如果θ1,θ2∈(180°,180°+Δ)，那么令Δθ1=min[|180°-θ1|,|(180°+Δ)-θ1|]，Δθ2=min[|180°-θ2|,|(180°+Δ)-θ2|]，如果Δθ1<Δθ2，則規(guī)劃的太陽板轉(zhuǎn)角為θ=θ1，否則，θ=θ2。

4 車體原地轉(zhuǎn)向時的對日定向規(guī)劃算法

利用第3節(jié)算法無法達到太陽入射角設(shè)計值Ω時，可考慮利用巡視器繞本體坐標系Z軸的原地轉(zhuǎn)向功能，使太陽板達到較為理想的光照狀態(tài)。本節(jié)將對這一問題進行探討。

4.1規(guī)劃目標

本節(jié)規(guī)劃目標與第3.1節(jié)類似，區(qū)別在于增加了車體原地轉(zhuǎn)向的自由度。規(guī)劃的指標為太陽板法向在空間的運動幅度最小，同時滿足太陽入射角約束和太陽板運動約束。

需要說明的是，由于地形的起伏，原地轉(zhuǎn)向過程可能會對俯仰、滾動姿態(tài)造成影響[12-13]，這類影響無法通過幾何手段建模，本文假設(shè)巡視器位于較為理想的水平面或斜面上。

4.2問題分析

增加車體運動的自由度后，太陽板法向矢量可在以Z軸為對稱軸的圓錐上運動，圓錐半張角為Δ。如圖5所示，記-Z軸在天球上的投影點為Zminus，將太陽矢量S投影到巡視器本體天球，投影點記為S，則滿足太陽入射角為Ω的法向矢量構(gòu)成了以點S為圓心、半徑大小為Ω的球面圓(圖5陰影所示)，該圓的圓周記為⊙S；記初始太陽板法向矢量為P0，它在巡視器本體天球上的投影點記為P0。如果能在球面圓S的邊界找到距離P0最近的點Ps，那么點Ps對應(yīng)的矢量即為待求的太陽板法向矢量，進而可求出對應(yīng)的車體原地轉(zhuǎn)向角與太陽板轉(zhuǎn)角。

4.3算法說明

(4)

(5)

法線矢量Pcross與-Z軸的夾角ε，以及太陽矢量S與-Z軸的夾角λ，計算公式如下。

(6)

(7)

式中：-Zaxis為單位矢量，其方向為本體坐標系Z軸的負方向。

圖5中包括考慮原地轉(zhuǎn)向時的3種幾何關(guān)系示意。下面根據(jù)ε進行具體判斷。

圖5 考慮原地轉(zhuǎn)向時幾何關(guān)系示意

1)ε≤Δ

對應(yīng)圖5(a)。Pcross位于太陽板轉(zhuǎn)動約束錐內(nèi)部，表明車體可通過原地轉(zhuǎn)向和太陽板旋轉(zhuǎn)達到該位置，Pcross即為規(guī)劃的太陽板法向矢量。記Pcross在本體坐標系投影的坐標為(px,py,pz)T，則所需的太陽板轉(zhuǎn)角θ與原地轉(zhuǎn)向角ρ為

(8)

(9)

2)ε>Δ，且λ<Δ+Ω

對應(yīng)圖5(b)。Pcross位于轉(zhuǎn)動約束錐外部，且⊙S與轉(zhuǎn)動約束錐存在2個交點。令轉(zhuǎn)動約束錐與⊙S的交點分別為Pcross1和Pcross2，對應(yīng)的矢量記為Pcross1和Pcross2，則太陽板法線矢量位于Pcross1或Pcross2時將達到最優(yōu)光照狀態(tài)，可從中選擇與P0夾角最小的矢量作為規(guī)劃結(jié)果。因此，問題歸結(jié)于求取交點Pcross1和Pcross2及其對應(yīng)的矢量。

將Zminus，S，Pcross1連接，可構(gòu)成球面三角形，如圖6所示。

圖6 球面三角形Pcross1ZminusS

根據(jù)球面三角形的余弦定理，記ZminusPcross1和ZminusS的夾角為x，可表示為

(10)

分別計算Pcross1，Pcross2與P0的夾角，取夾角最小的矢量作為規(guī)劃的太陽板法向矢量，從而可得所需的太陽板轉(zhuǎn)角與原地轉(zhuǎn)向角，計算過程同式(8)和式(9)。

3)λ≥Δ+Ω

5 仿真算例

為分析上述算法的有效性，選取三類場景仿真。首先，利用美國噴氣推進實驗室(JPL)的DE405星歷計算太陽方位，并將其轉(zhuǎn)換至巡視器本體坐標系下；然后，根據(jù)期望的光照狀態(tài)，利用本文算法對太陽板轉(zhuǎn)動進行規(guī)劃；最后，計算按規(guī)劃結(jié)果轉(zhuǎn)動后太陽板法向矢量與太陽光的夾角，判斷太陽板光照狀態(tài)是否滿足指標要求。假設(shè)太陽板轉(zhuǎn)動范圍為[180°，210°]，應(yīng)滿足的最小太陽入射角不小于20°，即Δ=30°，Ω=20°。

場景一：仿真時間為北京時間2013年9月19日12：00，假設(shè)巡視器位于月面(10.5°W，20.1°N)，巡視器本體坐標系與當?shù)乇睎|地系重合，得到太陽矢量在本體坐標系投影的坐標為(-0.341 132，0.329 058，-0.880 539)T。根據(jù)投影數(shù)據(jù)，采用本文給出的車體姿態(tài)固定時對日定向規(guī)劃算法進行求解，得到太陽板轉(zhuǎn)角為198.98°；然后，利用該轉(zhuǎn)角規(guī)劃結(jié)果，計算得到法向矢量與太陽光夾角為20°，表明規(guī)劃結(jié)果能夠滿足任務(wù)要求。

場景二：仿真時間為北京時間2013年10月17日00：50，巡視器位置、坐標與場景一相同，得到太陽矢量在本體坐標系投影的坐標為(-0.255 3，0.687 6，-0.679 6)T。根據(jù)投影數(shù)據(jù)，采用車體姿態(tài)固定時的對日定向規(guī)劃算法求解，得到太陽板轉(zhuǎn)角規(guī)劃值為210°；利用該規(guī)劃結(jié)果，計算法向矢量與太陽光夾角為21.19°，表明無法滿足任務(wù)要求，此時可考慮調(diào)整車體姿態(tài)以優(yōu)化太陽板光照狀態(tài)。考慮原地轉(zhuǎn)向后，本文算法得到的太陽板轉(zhuǎn)角為207.189°，原地轉(zhuǎn)向角為20.37°，進而得到太陽板法向矢量與太陽光夾角為19.99°，表明原地轉(zhuǎn)向后，太陽板的太陽入射角可滿足20°的要求。

場景三：仿真時間為北京時間2013年10月16日02：00，巡視器位置、坐標與場景一相同，得到太陽矢量在本體坐標系投影的坐標為(-0.203 462，0.819 269，-0.536 098)T。根據(jù)投影數(shù)據(jù)，采用車體姿態(tài)固定時對日定向規(guī)劃算法求解，得到太陽板轉(zhuǎn)角為210°；利用該結(jié)果計算得到法向矢量與太陽光夾角為29.08°，表明僅轉(zhuǎn)動太陽板無法滿足光照要求，此時可考慮調(diào)整車體姿態(tài)以優(yōu)化太陽板光照狀態(tài)。考慮原地轉(zhuǎn)向后，本文算法得到的太陽板轉(zhuǎn)角為210°，原地轉(zhuǎn)向角為13.943 9°，進而得到太陽板法向矢量與太陽光夾角為27.58°，表明原地轉(zhuǎn)向后，太陽板的太陽入射角最優(yōu)僅能達到27.58°，與20°的目標角度尚存在差距。

6 結(jié)束語

本文針對月面巡視器太陽板的入射角約束和機械轉(zhuǎn)動約束，分析了車體姿態(tài)固定和車體原地轉(zhuǎn)向時太陽板法向矢量與太陽光的空間幾何關(guān)系，將對日定向問題分別投影至一維平面和二維球面求解，得到了太陽板運動的規(guī)劃算法。三個仿真場景分別對應(yīng)三類典型的空間幾何關(guān)系，表明算法對各類工況處理的有效性。本文算法可用于月面巡視器在軌任務(wù)規(guī)劃的設(shè)計、驗證與分析。在推導原地轉(zhuǎn)向太陽板規(guī)劃算法的過程中，沒有考慮地形引起的俯仰和滾動方向姿態(tài)變化，由于地形起伏具有一定的隨機性，后續(xù)將對此開展深入研究。

References)

[1]賈陽，陳建新，張熇.月面巡視探測器關(guān)鍵技術(shù)分析[J].航天器工程，2006，15(3):16-22

Jia Yang， Chen Jianxin， Zhang He. Key technology analysis of lunar rover[J]. Spacecraft Engineering, 2006, 15(3):16-22 (in Chinese)

[2]李群智，寧遠明，申振榮，等.行星表面巡視探測器遙操作技術(shù)研究[J].航天器工程，2008，17(3):29-35

Li Qunzhi， Ning Yuanming， Shen Zhenrong， et al. Study on teleoperation of rover on planetary surface[J]. Spacecraft Engineering，2008，17(3):29-35 (in Chinese)

[3]Michael Piszczor．Trends in solar array technology development[C]//Proceedings of the 39th Aerospace Sciences Meeting and Exhibit, 2001. Washington D.C.：AIAA，2001：1-6

[4]Ali H ALmukhtar. Design of phase compensation for solar panel systems for tracking sun [C]//Proceedings of the TerraGreen 13 International Conference 2013-Advancements in Renewable Energy and Clean Environment. Amsterdam： Elsevier Ltd.，2013：9-23

[5]陳忠貴，張志，廖瑛.航天器太陽翼在軌光照角度建模及仿真分析[J].航天器工程，2012，21(1):35-39

Chen Zhonggui，Zhang Zhi，Liao Ying. Modeling and simulation analysis of solar illumination angle on spacecraft solar wing in-orbit[J]. Spacecraft Engineering，2012，21(1)：35-39 (in Chinese)

[6]王穎, 顧荃瑩. 傾斜軌道航天器太陽翼對日跟蹤方法探討[J], 航天器工程, 2009, 18(3):36-40

Wang Ying, Gu Quanying. Methods of solar array tracking for inclined-orbit satellite[J]. Spacecraft Engineering, 2009，18(3):36-40 (in Chinese)

[7]陶溢, 潘存云, 譚穎琦. 一種提高太陽能帆板受曬效率方法[J]. 上海航天, 2007, 24(5):23-26

Tao Yi, Pan Cunyun, Tan Yingqi. A method to improve sunshine efficiency of solar array[J]. Aerospace Shanghai, 2007, 24(5):23-26 (in Chinese)

[8]翟坤，楊滌，陳新龍，等. 太陽同步軌道衛(wèi)星的太陽帆板驅(qū)動律[J]. 上海航天, 2009, 26(1):20-23

Zhai Kun, Yang Di, Chen Xinlong,et al. Study on driving laws of sun synchronous orbit satellite’s solar arrays[J]. Aerospace Shanghai, 2009, 26(1):20-23 (in Chinese)

[9]朱軍年. 太陽同步軌道衛(wèi)星帆板對日定向控制與仿真[J]. 計算機仿真, 2011, 28(3):110-114

Zhu Junnian.Simulation of sun synchronous orbit sate-llite solar panel control[J]. Computer Simulation, 2011, 28(3):110-114 (in Chinese)

[10]EgonsRPodnieks,JohnASiekmeier.Miningtechno-logyforlunarresourceutilization[R].Minneapolis：USDepartmentoftheInteriorBureauofMines, 1990

[11]任德鵬, 賈陽, 劉強. 月面巡視探測器太陽帆板熱電耦合仿真計算[J]. 航天器環(huán)境工程, 2007, 24(5):278-282

RenDepeng,JiaYang,LiuQiang.Calculationofthermoelectriccogenerationonthesolarpanelsofalunarrover[J].SpacecraftEnvironmentEngineering, 2007, 24(5):278-282 (inChinese)

[12]張玥, 李清毅, 許曉霞. 月球表面地形數(shù)學建模方法[J]. 航天器環(huán)境工程, 2007, 24(6):341-343

ZhangYue,LiQingyi,XuXiaoxia.Mathematicalmodelingoflunarsurfaceterrain[J].SpacecraftEnvironmentEngineering, 2007, 24(6):341-343 (inChinese)

[13]李清毅. 巡視器對地指向受月表地形的影響分析[J]. 中國空間科學技術(shù), 2009, 29(6):39-44

LiQingyi.Influencesanalysisofmoonsurfaceterrainontheroverantennadirection[J].ChineseSpaceScienceandTechnology, 2009, 29(6):39-44 (inChinese)

(編輯：夏光)

Algorithm for Solar Panel Direction Planning of Lunar Rover

LIU Shuhao PENG Song

(Beijing Institute of Spacecraft System Engineering, Beijing 100094, China)

For directing to the sun of the lunar rover’s solar panel, an algorithm based on planning method is proposed. Firstly, the goal and constraints are introduced. Constraints contain the sunlight incident angle and the solar panel rotation limits. Secondly, a planning with the rover’s attitude preserved is researched. The panel motion is transferred into the vector rotation in a plane, which makes the planning easier. Thirdly， the planning considering zero radius steering is investigated, by projecting the motion of the rover and solar panel into rover body coordinate sphere. The additional rover freedom is helpful to direct to the sun. Finally, computer simulation results show that the proposed algorithm can achieve directing to the sun with specified constraints and a suboptimal planning can be acquired for the case of not ideally directing to the sun.

lunar rover; solar panel; directing to the sun; sunlight incident constraint

2013-08-01；

：2013-10-23

國家重大科技專項工程

劉書豪，男，工程師，研究方向為航天器總體仿真技術(shù)。Email:33151420@163.com。

V467.3

：ADOI：10.3969/j.issn.1673-8748.2014.03.008