基于開關(guān)算法的欠驅(qū)動剛體航天器姿態(tài)控制

朱家興，孫兆偉，陳長春

（哈爾濱工業(yè)大學(xué) 衛(wèi)星技術(shù)研究所，黑龍江 哈爾濱 150001）

0 引言

可靠性、安全性和有效性是航天產(chǎn)品品質(zhì)的主要指標(biāo)。對衛(wèi)星等航天器來說，一旦發(fā)射入軌便成為不可維修系統(tǒng)，因此研究控制算法，保證航天器在部分執(zhí)行機構(gòu)發(fā)生故障時能全部或部分完成飛行任務(wù)，是挽救損失和提高系統(tǒng)可靠性的有效途徑［1］。理論上，欠驅(qū)動系統(tǒng)屬于二階非完整系統(tǒng)，即系統(tǒng)加速度具有不可積性。文獻［2］建立了二階非完整系統(tǒng)的動力學(xué)與控制的理論框架，并分析了系統(tǒng)的可控性和可鎮(zhèn)定性，為欠驅(qū)動控制領(lǐng)域的深入研究提供了基礎(chǔ)。欠驅(qū)動系統(tǒng)是指由控制輸入向量構(gòu)成空間的維數(shù)小于位形空間維數(shù)的系統(tǒng)，即指控制輸入數(shù)小于系統(tǒng)自由度的系統(tǒng)［3］。欠驅(qū)動航天器，是指姿態(tài)控制系統(tǒng)中的執(zhí)行機構(gòu)是非完整配置的航天器，即執(zhí)行機構(gòu)不能提供三軸獨立的控制力矩［4］。由于研制、發(fā)射等費用巨大和幾乎不可維修的特點，當(dāng)部分執(zhí)行機構(gòu)發(fā)生故障時，設(shè)計者希望航天器控制系統(tǒng)仍具有令人滿意的性能。欠驅(qū)動控制可為此提供一種備份技術(shù)，欠驅(qū)動航天器姿態(tài)控制的研究對提高整個控制系統(tǒng)的可靠性、延長航天器的使用壽命，具有重要的意義。

目前，欠驅(qū)動航天器的姿態(tài)控制已成為研究熱點。文獻［5］的研究表明，采用角動量交換裝置作為執(zhí)行機構(gòu)的航天器，在系統(tǒng)總角動量不為零條件下，當(dāng)控制輸入的個數(shù)小于3時，系統(tǒng)將不可控；文獻［6］認(rèn)為僅有兩個控制輸入的剛體航天器，因不滿足文獻［7］的Brockett必要條件，不能由光滑狀態(tài)反饋實現(xiàn)欠驅(qū)動控制。文獻［8］針對欠驅(qū)動軸是否為對稱軸，通過開關(guān)控制，分別提出非連續(xù)的反饋控制策略。文獻［9、10］基于（w，z）參數(shù)，在欠驅(qū)動軸為對稱軸和欠驅(qū)動軸初始角速度為零的假設(shè)條件下，設(shè)計了非連續(xù)反饋控制律，實現(xiàn)了欠驅(qū)動航天器姿態(tài)的漸近穩(wěn)定。

本文利用開關(guān)算法，通過在不同控制律間的切換，研究了航天器姿態(tài)角速度和姿態(tài)角的欠驅(qū)動控制律設(shè)計。

1 剛體航天器姿態(tài)運動模型

1.1 姿態(tài)動力學(xué)方程

根據(jù)Euler方程，剛體航天器姿態(tài)動力學(xué)方程可表示為

式中：Ii（i＝1，2，3）為航天器的主轉(zhuǎn)動慣量；ωi為航天器相對慣性空間的角速度矢量在星體固聯(lián)坐標(biāo)系中的分量；Mi為外力矩矢量在星體固聯(lián)坐標(biāo)系中的分量。假設(shè)M3＝0，即第三軸為欠驅(qū)動軸，則成立

式中：uj（j＝1，2）為控制量，且uj＝Mj／Ij；α1，α2，α3為與航天器主轉(zhuǎn)動慣量有關(guān)的常數(shù)，且α1＝（I2－I3）／I1，α2＝（I3－I1）／I2，α3＝（I1－I2）／I3。

1.2 姿態(tài)運動學(xué)方程

根據(jù)歐拉有限轉(zhuǎn)動定理，將參考坐標(biāo)系轉(zhuǎn)動3次即可得星體固聯(lián)坐標(biāo)系，3次轉(zhuǎn)過的歐拉角分別為滾動角φ，俯仰角θ，偏航角ψ，如圖1所示。

圖1 3－2－1順序歐拉角Fig.1 Eulerian angles sequence 3－2－1

歐拉角（3－2－1順序）參數(shù)描述的姿態(tài)運動學(xué)方程為：

2 欠驅(qū)動航天器姿態(tài)穩(wěn)定控制

針對欠驅(qū)動軸是否為慣性對稱軸，利用開關(guān)算法和退步控制技術(shù)，本文設(shè)計了實現(xiàn)欠驅(qū)動航天器姿態(tài)漸近穩(wěn)定的控制律。剛體航天器的欠驅(qū)動控制較難處理的是對失控軸角速度的控制，因此本文先對姿態(tài)角速度進行穩(wěn)定控制，再對姿態(tài)角進行穩(wěn)定控制。

退步控制是一種基于李雅普諾夫穩(wěn)定理論的控制器遞推設(shè)計方法，一般用于控制量與被控量間存在一個或多個積分器的非線性系統(tǒng)［11］。退步控制設(shè)計過程如下：將一子系統(tǒng)（假設(shè)該子系統(tǒng)中不含直接控制量）中的其他狀態(tài)變量視作“虛擬控制量”，按李雅普諾夫設(shè)計方法設(shè)計“中間控制律”，使該子系統(tǒng)的狀態(tài)實現(xiàn)漸近穩(wěn)定；引入誤差變量，利用直接控制量設(shè)計誤差系統(tǒng)，使真實狀態(tài)變量與“虛擬控制量”間具有某種漸近特性，從而得到最終的退步控制律，實現(xiàn)整個系統(tǒng)的漸近鎮(zhèn)定或跟蹤。

設(shè)計欠驅(qū)動控制律需要用兩個函數(shù)。對雙積分系統(tǒng)

用退步控制算法，函數(shù)

具有性質(zhì)：在控制律u＝f（x1，x2，β）作用下，可使雙積分系統(tǒng)式（4）由任意初始狀態(tài)到達最終狀態(tài)（β，0）。此處：x1，x2分別為姿態(tài)角和姿態(tài)角速度；k1，k2，α均為大于0的控制參數(shù)；β為任意常數(shù)。不失一般性，令β＝0，利用李雅普諾夫定理分析系統(tǒng)，可得

在原點處的平衡狀態(tài)的穩(wěn)定性。取李雅普諾夫函數(shù)

則有

因V（x）正定，－V（x）半負(fù)定，故系統(tǒng)在原點處的平衡狀態(tài)是穩(wěn)定的。進一步分析可知，－V（x）＝0所包含的最大不變集中僅有1個點（x1，x2）＝（0，0），由LaSalle不變集定理可知，系統(tǒng)的狀態(tài)最終會收斂至原點，即系統(tǒng)在原點處的平衡狀態(tài)是漸近穩(wěn)定的。

設(shè)［ω10ω20ω30φ0θ0ψ0］為描述航天器全局運動的初始狀態(tài)，取控制目標(biāo)為

2.1 姿態(tài)角速度穩(wěn)定控制律設(shè)計

當(dāng)欠驅(qū)動軸為非對稱軸，即I1≠I2時，可通過姿態(tài)動力學(xué)之間的耦合進行三軸姿態(tài)角速度的控制。通過3次姿態(tài)機動，即可實現(xiàn)姿態(tài)角速度的穩(wěn)定控制。

考慮欠驅(qū)動軸為非對稱軸的航天器姿態(tài)動力學(xué)方程可表示為

機動1：執(zhí)行反饋控制律

式中：k3為大于0的控制參數(shù)；上標(biāo)表示控制律的切換次數(shù)。在此控制律作用下，ω1，ω2，很快衰減為零，且當(dāng)ω1＝ω2＝0時，將有ω3＝（常數(shù)）。此處：ω3為繞欠驅(qū)動軸旋轉(zhuǎn)的自旋角速度。

機動2：執(zhí)行反饋控制律

機動3：執(zhí)行反饋控制律

在此控制律作用下，經(jīng)過有限時間t＝／k3，將再次有ω1＝ω2＝0，積分可得，此時ω3＝0，即系統(tǒng)的姿態(tài)角速度收斂至狀態(tài)［ω1ω2ω3］＝［0 0 0］。

至此，實現(xiàn)了欠驅(qū)動剛體航天器姿態(tài)角速度的穩(wěn)定控制。

2.2 姿態(tài)角穩(wěn)定控制律設(shè)計

在姿態(tài)角速度收斂的基礎(chǔ)上，利用函數(shù)f（x1，x2，β），根據(jù)姿態(tài)運動學(xué)方程，每次只利用1個控制力矩，通過改變姿態(tài)角速度ω1，ω2，進而改變一個姿態(tài)角，5次機動后，即可實現(xiàn)姿態(tài)角穩(wěn)定控制。

考慮姿態(tài)運動學(xué)方程

機動4：執(zhí)行反饋控制律

直至φ＝0，ω＝0，即系統(tǒng)的狀態(tài)轉(zhuǎn)移至

該次機動僅用到控制力矩u1。前4次機動后，有。

機動5：執(zhí)行反饋控制律

直至θ＝0，ω2＝0，即系統(tǒng)的狀態(tài)轉(zhuǎn)移至

該次機動僅用控制力矩u2。在前5次機動的基礎(chǔ)上，再次有。

機動6：執(zhí)行反饋控制律

直至φ＝0.5π，ω1＝0，即系統(tǒng)的狀態(tài)轉(zhuǎn)移至

該次機動僅用到控制力矩u21。在前6次機動的基礎(chǔ)上，將有。

機動7：執(zhí)行反饋控制律

直至ψ＝0，ω2＝0，即系統(tǒng)的狀態(tài)轉(zhuǎn)移至

該次機動僅用到控制力矩u2。在7次機動的基礎(chǔ)上，又有。

機動8：執(zhí)行反饋控制律

直至φ＝0，ω1＝0，即系統(tǒng)的狀態(tài)轉(zhuǎn)移到了目標(biāo)狀態(tài)

根據(jù)精度要求決定是否重新執(zhí)行機動1。由此實現(xiàn)了欠驅(qū)動航天器姿態(tài)漸近穩(wěn)定控制。

2.3 欠驅(qū)動軸為對稱軸的航天器姿態(tài)穩(wěn)定

當(dāng)欠驅(qū)動軸為對稱軸，即I1＝I2時，姿態(tài)動力學(xué)方程式（2）變?yōu)?/p>

可知ω3恒為常值，且不可控。此時若假設(shè)ω3（0）＝0，可得簡化模型。文獻［6］證明簡化模型在任意平衡點是“短時間局部可控的”，從而可進行非連續(xù)控制律設(shè)計。

此時，只需經(jīng)過6次機動即可實現(xiàn)軸對稱欠驅(qū)動剛體航天器的姿態(tài)控制，其分析過程同欠驅(qū)動軸為非對稱軸情況類似。

3 仿真

3.1 非軸對稱欠驅(qū)動航天器姿態(tài)控制

采用控制律式（11）～（13）、（15）～（19）對系統(tǒng)式（10）、（14）進行穩(wěn)定。取控制參數(shù)k1＝k2＝0.25，α＝0.8，k3＝0.7；轉(zhuǎn)動慣量常數(shù)α1＝α2＝－1，α3＝－0.42857；姿態(tài)角速度的初值為ω（0）＝［0.05－0.04－0.03］rad／s，姿態(tài)角初值為φ0＝π／3，θ0＝π／6，ψ0＝π／4，仿真結(jié)果如圖2～4所示。

由仿真結(jié)果可知：在t＝20s左右時，姿態(tài)角速度收斂至零附近；在t＝50s左右時，控制律式（15）作用，滾動角φ收斂至零；在t＝75s左右時，控制律式（16）作用，俯仰角θ收斂至零；在t＝125s左右時，控制律式（17）作用，滾動角φ收斂至π／2；在t＝155s左右時，控制律式（18）作用，偏航角ψ收斂至零；在t＝225s左右時，控制律式（19）作用，滾動角φ再次收斂至零；在t＝350s左右時，姿態(tài)角速度和姿態(tài)角均收斂至零附近，姿態(tài)角的控制精度達到5×10－2（°），驗證了本文控制律的有效性。

圖2 姿態(tài)角速度Fig.2 Attitude angular velocity

圖3 姿態(tài)角Fig.3 Attitude angle

圖4 控制輸入Fig.4 Control input

3.2 軸對稱欠驅(qū)動航天器姿態(tài)控制

采用控制律式（11）、（15）～（19）對系統(tǒng)式（20）、（14）進行穩(wěn)定。取控制參數(shù)k1＝k2＝0.2，α＝0.5，k3＝0.5；慣量常數(shù)α1＝－0.2，α2＝0.2；姿態(tài)角速度初值ω（0）＝［0.001 2－0.001 25］rad／s，姿態(tài)角初值φ0＝π／2，θ0＝π／4，ψ0＝π／2，仿真結(jié)果 如 圖5～7。

圖5 姿態(tài)角速度Fig.5 Attitude angular velocity

圖6 姿態(tài)角Fig.6 Attitude angle

圖7 控制輸入Fig.7 Control input

由仿真結(jié)果可知：在t＝40s左右時，控制律式（15）作用，滾動角φ收斂至零；在t＝100s左右時，控制律式（16）作用，俯仰角θ收斂至零；在t＝150s左右時，控制律式（17）作用，滾動角φ收斂至π／2；在t＝230s左右時，控制律式（18）作用，偏航角ψ收斂至零；在t＝200s左右時，控制律式（19）作用，滾動角φ再次收斂至零；在t＝500s左右時，姿態(tài)角速度和姿態(tài)角均收斂至零附近，姿態(tài)角的控制精度達到5×10－3（°），驗證了本文控制律的有效性。

4 結(jié)束語

本文對執(zhí)行機構(gòu)只能提供兩軸獨立控制力矩的欠驅(qū)動航天器的姿態(tài)控制進行了研究。利用開關(guān)算法和退步控制技術(shù)，通過在不同控制律間的切換，分別設(shè)計了姿態(tài)角速度穩(wěn)定和姿態(tài)角穩(wěn)定的控制律，實現(xiàn)了欠驅(qū)動剛體航天器姿態(tài)漸近穩(wěn)定控制律的設(shè)計。數(shù)值仿真結(jié)果驗證了該控制律的有效性，以及良好的動態(tài)過程和控制精度。本文控制律的優(yōu)點是可在有限時間內(nèi)實現(xiàn)航天器姿態(tài)漸近穩(wěn)定，缺點主要是因采用不同控制律間的切換實現(xiàn)穩(wěn)定控制，魯棒性較差，對存在干擾和慣量積非零情況也需進一步研究。

［1］徐福祥.衛(wèi)星工程概論［M］.北京：宇航出版社，2003：352.

［2］REYHANOGLU M，Van Der SCHAFT A J，McCLAMROCHN H，etal.Nonlinear control of a class of underactuated systems［C］／／IEEE Conference on Decision and Control.Kobe：IEEE，1996：1682－1687.

［3］周祥龍，趙景波.欠驅(qū)動非線性控制方法綜述［J］.工業(yè)儀表與自動化裝置，2004（5）：10－13.

［4］王 芳，張洪華.欠驅(qū)動剛性航天器旋轉(zhuǎn)軸穩(wěn)定研究［J］.宇航學(xué)報，2007，28（5）：1133－1137.

［5］CROUCH，P E.Spacecraft attitude control and stabilization：application of geometric control theory to rigid body models［J］.IEEE Transactions on Automatic Control，1984，29（4）：321－331.

［6］BYRNES C I，ISIDORI A.On the attitude stabilization of a rigid spacecraft［J］.Automatica，1991，27（1）：87－95.

［7］BROCKETT R W.Asymptotic stability and feedback stabilization［J］.Differential Geometric Control Theory，1983，6（1）：181－191.

［8］KRISHNAN H，REYHANOGLU M，McCLAMROCH H.Attitude stabilization of a rigid spacecraft using gas jet actuators operating in a failure mode［C］／／Proceedings of the 31th Conference on Decision and Control.［s.l.］，IEEE：1992：1612－1617.

［9］TSIOTRAS P，LONGUSKI M.A new parameterization of the attitude kinematics［J］.Journal of the Astronautical Sciences，1995，43（3）：243－262.

［10］TSIOTRAS P，CORLESS M，LONGUSKI M.A novel approach to the attitude control of axi－symmetric spacecraft［J］.Automatica，1995，31（8）：1099－1112.

［11］鄭敏捷，徐世杰.欠驅(qū)動航天器姿態(tài)控制系統(tǒng)的退步控制設(shè)計方法［J］.宇航學(xué)報，2006，27（5）：947－951.