一種衛星快速姿態機動及穩定控制方法

馮佳佳北京控制工程研究所，北京100190

一種衛星快速姿態機動及穩定控制方法

馮佳佳＊
北京控制工程研究所，北京100190

針對小衛星快速姿態機動要求，提出一種基于粒子群優化（PSO）算法的衛星快速姿態機動及穩定控制方法。該方法首先以粒子種群的初始位置為衛星機動加速階段終點時刻進行路徑規劃，然后針對規劃好的路徑利用維持跟蹤控制進行姿態機動，在路徑末端利用黃金分割和邏輯微分進行穩定控制，最后以衛星姿態到達目標角度且保持穩定的時間作為適配值，尋找出一條在該組合控制方法和限制條件下的最優路徑進行姿態機動及穩定控制。該控制方法能夠根據星體的實際動力學特性、環境特征、限制條件及控制性能進行最優機動及穩定控制。將該方法應用到小衛星的姿態機動控制中，仿真結果表明該方法有效。

姿態控制；快速機動；粒子群優化算法；撓性衛星；穩定

快速姿態機動及穩定控制作為小衛星的關鍵技術之一，日益為學者們所關注。但由于星體不僅具有大撓性附件或本身就是撓性結構，而且有液體晃動和消耗，有振動源，數學方程很復雜，具有非線性、高階、時變等特性［1］，使得衛星的姿態控制問題成為一個非線性控制問題［2］，這對大角度快速機動及快速穩定性產生了嚴重的影響［3－4］。

目前，關于衛星快速姿態機動及穩定控制方法已經有一些研究成果［5－12］。一般情況下，為了盡快完成衛星的大角度機動，在機動過程中希望星體以最大角速度運動，但衛星的機動速度受到執行機構提供的最大力矩和角動量限制，此外，在到達目標機動角度后，由于星體特征變化以及外部擾動，星體也很難快速穩定［3］。在執行機構能力受限和角速度測量受限的情況下，大角度快速機動運動路徑一般可以分為加速、勻速和減速3個運動階段；根據機動角度幅值和最大角速度幅值，可能不存在勻速階段。理想狀況下的運動路徑如圖1所示，設完整的機動時間為tf，在t∈（0，0.5tf）時，角速度v進行加速，其對應的力矩大小為umax，在t∈（0.5tf，tf）時，角速度v進行減速，其對應的力矩為－umax，在t＞tf時，角速度v＝0，對應的力矩u＝0，其中，角速度所圍成的面積為機動目標角度α。但實際過程中面臨3個主要問題需要解決：1）由于衛星所建模型不精確及其存在撓性結構，在機動及穩定過程中，如何設計控制律使星體快速機動并且保持穩定，文獻［13］指出，由于模型建立的不精確，如果存在外擾激發未建模動態，那么使用傳統的控制方法將使控制系統的性能大幅度下降，甚至失穩；2）在星體特征變化、外部擾動、執行機構能力受限等其他條件下，如何確定最優機動路徑，使其在所設計的控制律下能進行快速機動并且保持穩定；3）所設計的機動及穩定控制方法具有通用性，符合航天控制發展趨勢［14］。

圖1 理想狀況下的運動路徑Fig.1 Ideal path

本文以具有大角度快速機動要求的小衛星為對象，研究了具有多輸入－多輸出的非線性系統最優控制問題，提出了一種基于PSO算法［15－17］的衛星快速姿態機動及穩定控制方法。該方法首先以粒子種群的初始位置為衛星機動加速階段終點時刻進行路徑規劃，然后針對規劃好的路徑利用維持跟蹤控制進行姿態機動，在路徑末端利用黃金分割和邏輯微分進行穩定控制，最后以衛星姿態到達目標角度且保持穩定的時間作為適配值，尋找出一條在該組合控制方法和限制條件下的最優路徑進行姿態機動及穩定控制。

1 問題描述

具有撓性附件三軸穩定衛星的動力學模型可以描述為［18］：

式中：ω∈R3為航天器的角速度在本體坐標系下的描述；J∈R3×3為航天器的轉動慣量；η∈Rm為撓性附件模態向量；Fsj∈R3×m為撓性模態與航天器中心剛體的耦合系數矩陣；ξ為撓性附件的阻尼系數，工程上一般取0.005；Λ＝為撓性模態頻率向量，Λ2＝為作用于衛星的外力矩，包括控制力矩u和環境干擾力矩d；ω×為衛星角速度的反對稱陣。

定義衛星三軸歐拉姿態角q（t）＝［φ，θ，ψ］T，其中φ，θ，ψ分別為航天器的滾動、俯仰和偏航角，其角速度在星體坐標系中的表達式為：

其中，當q在一定區間變化時，B（q）是可逆陣，本文只研究B（q）可逆的情況。

當采用1－2－3轉序時，

控制任務是：衛星從初始姿態q（0）＝0，˙q（0）＝0快速機動到q（tf）＝α，˙q（tf）＝0，并且快速保持穩定，其中α為機動目標角度。

2 快速姿態機動及穩定控制實現

2.1 控制方法設計

由式（1）可知：

則式（7）可變為：

需要說明的是，當對式（8）進行離散時，采樣時間Ts需要滿足一定的條件，即滿足采樣定理、連續系統離散化保持原系統能控及控制精度要求，這樣由式（8）可以經過離散得到式（9），且性能保持不變［13］。

對式（9）進行變換得：

其中，遞推最小二乘公式為：

所以維持跟蹤控制為：

式中：qr（k）為星體機動規劃路徑；q（k）為星體機動過程中的實際機動路徑。

黃金分割控制為：

式中：l1＝0.382；l2＝0.618；e（k）為衛星機動角度和目標角度的差值。

邏輯微分控制為：

由于：

因此，可以實現穩定跟蹤控制。

事實上，由文獻［13］可知，式（11）滿足特征建模原理，因此，由式（11）可以推導出式（15）～式（17），并使其成立，且當控制器參數＾f1，＾f2，＾g0保持在一定的閉凸集內，所設計的控制器均能保持穩定。

由于維持跟蹤控制具有較強的跟隨控制能力，它能夠根據星體的實際動力學特性和機動路徑進行最優機動控制，因此選擇維持跟蹤控制作為姿態機動階段的控制方法，黃金分割控制和邏輯微分控制具有較強的穩定能力，它能夠有效克服星體特征變化及外部干擾，因此在機動路徑末端，選擇黃金分割和邏輯微分進行穩定控制。

則所設計的控制方法為：

式中：θ為機動角度；α為目標角度。

2.2 基于PSO算法的路徑規劃

由于星體在機動過程中受到外部擾動、星體特征變化以及其他限制條件，因此，在機動及穩定過程中，需要根據星體的實際情況進行最優路徑規劃。

粒子群優化算法（PSO）是一種基于種群的仿生隨機優化方法，是一種典型群智算法。其最大的優點是實現簡單，全局搜索能力強，應用廣泛，可以廣泛應用于非線性、不可微、多極值、高維函數的優化問題。

PSO算法為：

式中：i＝1，2，…，m，為粒子的編號；j＝1，2，…，n，為n維向量的第j個分量；xi（k）＝［xi1，xi2，…，xin］T，為n維位置向量；pi（k）＝［pi1，pi2，…，pin］T，為n維最優位置向量；vi（k）＝［vi1，vi2，…，vin］T為n維速度向量，fix（k）為相應的x適配值；pi（k）表示該粒子迄今所獲得的具有最優適配值fip（k）的位置；φ1、φ2分別為控制個體認知分量［pij（k）－xij（k）］和群體社會分量［pgj（k）－xij（k）］相對貢獻的學習率，g表示具有迄今全局最優適配值fp（k）的粒子編號；rand（0，a1）與rand（0，a2）分別產生［0，a1］、［0，a2］之間的隨機參數，其中a1、a2為相應的控制參數［19］。

在實際應用中，衛星機動受到多種物理限制，如控制輸入有界、星體角速度限制等，分別被描述為：

式中：umax為最大輸出力矩；vmax為最大星體角速度。

當星體角速度限制為主要限制條件時，理想情況下機動角速度滿足：

式中：t1為機動加速階段終點時刻；tf為完成機動路徑的總時間。且有：

此時，若機動目標角度為α，則滿足：

當控制輸入有界為主要限制條件時，理想情況下機動角速度滿足：

式中：vM為在控制輸入有界情況下星體機動過程中的最大角速度，且vM≤vmax；t1為機動加速階段終點時刻。

此時，若機動目標角度為α，則滿足：

因此，對于給定的機動目標角度α，根據式（22）～式（26）可知，每一個t1都對應著一條機動路徑，因此可以選取粒子種群的初始位置為衛星機動加速階段終點時刻t1進行路徑規劃。而對于每一條規劃出的路徑，在限制條件下，利用所設計的控制方法都會有一個完成姿態機動并且保持穩定的時間t，選擇f（k）＝t作為適配值，尋找出合適的t1使f（k）最小。

3 仿真校驗

為了驗證該方法的有效性，進行數學仿真。仿真軟件為MATLAB R2013a；衛星的轉動慣量為：

撓性翼板一階頻率為2.23Hz，阻尼為0.005，耦合系數矩陣為［0.000 41，3.833，0］；干擾力矩為：

該仿真控制的目的是將衛星從初始姿態q0＝［0，0，0］T，˙q0＝［0，0，0］T，機動到目標姿態qd＝［π／3，0，0］，˙qd＝［0，0，0］T。

采樣時間為t＝0.01s，控制力矩采用0.1N·m的限幅，最大星體角速度為0.05rad／s，姿態穩定精度為10－5rad。

取粒子種群數為m＝20，迭代次數n＝20，a1＝a2＝0.8，種群的初始位置隨機生成，個體認知和社會群體分量的權重為φ1＝φ2＝1。

仿真結果如圖2～圖8所示。

圖2 初始粒子群個體位置Fig.2 Initial particle swarm individual position

圖3 經20步迭代后粒子群的個體Fig.3 After 20steps iterative particle swarm of individuals

圖4 最優適配值分布曲線Fig.4 Optimal adaptation value distribution curve

圖5 衛星姿態角波形曲線Fig.5 Satellite attitude angle waveform curve

圖6 控制力矩曲線Fig.6 Control torque curve

圖7 衛星姿態角速度波形曲線Fig.7 Satellite attitude angular velocity waveform curve

圖2 為初始種群的位置，其中橫坐標表示粒子的序號，縱坐標表示粒子的位置，即衛星機動加速階段的終點時刻t1；圖3為經過20步迭代后的t1，可以看出經過20步迭代后，尋找出了合適的t1；圖4為最優適配值曲線，即衛星完成姿態機動并且保持完成的時間t，可以看出迭代6次后，時間t維持不變；圖5為衛星姿態角波形曲線；圖6為控制力矩曲線；圖7為衛星姿態角速度波形曲線；由圖5～圖7可以看出衛星機動過程與圖1所示的機動過程基本一致，因為衛星到達目標角度后需要進行穩定控制，因此控制力矩曲線在機動路徑末端會存在小波動；圖8為翼板模態坐標曲線，可以看出衛星機動過程中，翼板振動較小。

圖8 翼板模態坐標曲線Fig.8 Panel′s modal coordinates curve

由仿真結果可以得出，本文提出的控制方法能夠實現衛星姿態的快速機動以及穩定控制。該控制方法相對于常規的控制方法，由于它能夠根據系統的實際動力學特性和控制要求選擇最優的路徑進行姿態機動及穩定控制，因此，在機動時間和控制性能上均優于常規的控制方法。

4 結束語

維持跟蹤控制、黃金分割控制、邏輯微分控制和PSO算法均屬于智能算法，將它們有效的結合，能夠根據星體的實際動力學特性、環境特征和控制性能進行快速的姿態機動及穩定控制，同時，該方法具有通用性，可以將其應用于離線計算的衛星姿態機動及穩定控制中。

（

）

［1］ 吳宏鑫.工程實際中的控制理論和方法的研究與展望［J］.控制理論與應用，2014，31（12）：1626－1631.WU H X.Research and prospect on the control theory and method in the engineering［J］.Control Theory＆Applications，2014，31（12）：1626－1631（in Chinese）.

［2］ SCRIVENER S，THOMPSON R.Survey of time optimal attitude maneuver［J］.Journal of Guidance，Control，andDynamics，1994，17（2）：225－233.

［3］ 雷擁軍，談樹萍，劉一武.一種航天器姿態快速機動及穩定控制方法［J］.中國空間科學技術，2010，30（5）：48－53.LEI Y J，TAN S P，LIU Y W.Spacecraft control method for fast attitude maneuver and stabilization［J］.Chinese Space Science and Technology，2010，30（5）：48－53（in Chinese）.

［4］ 孫多青，吳宏鑫.多變量線性時變系統的特征模型及自適應模糊控制方法［J］.宇航學報，2005，26（6）：677－681.SUN D Q，WU H X.Characteristic modeling and adaptive fuzzy control method of MIMO higher－order linear time－varying systems［J］.Journal of Astronautics，2005，26（6）：677－681.

［5］ BONG W.Rapid multimarket acquisition and pointing control of agile spacecraft［J］.Journal of Guidance，Control，and Dynamics，2002，25（1）：96－104.

［6］ DYWER A W.Variable－structure control of spacecraft attitude maneuver［J］.Journal of Guidance，Control，and Dynamics，1988，11（3）：262－270.

［7］ GUAN P，LIU X J，LIU J Z.Adaptive fuzzy sliding model control for flexible satellite［J］.Engineering Application of Artificial Intelligence，2005，18：451－459.

［8］ KUSUDA Y，TAKAHASHI M.Feedback with nominal inputs for agile satellites using control moment gyros［J］.Journal of Guidance，Control，and Dynamics，2011，34（4）：1209－1218.

［9］ LEE B H.Time optimal attitude maneuver strategies for the agile spacecraft with reaction wheels and thrusters［J］.Journal of Mechanical Science and Technology，2005，19（9）：1695－1705.

［10］ BILIMORIA K D，WIE B.Time－optimal three－axis reorientation of a rigid spacecraft［J］.Journal of Guidance，Control，Dynamics，1993，16（3）：446－452.

［11］ 周偉敏，組立業，朱慶華.一種基于大力矩飛輪的敏捷衛星路徑規劃的姿態機動控制方法［J］.空間控制技術與應用，2014，40（2）：37－41.ZHOU W M，ZU L Y，ZHU Q H.Anattitude maneuver control method based on path planning for agile satellite with large torque flywheels［J］.Aerospace Control and Application，2014，40（2）：37－41（in Chinese）.

［12］ 王煥杰，金磊，賈英宏.基于混合執行機構的敏捷衛星姿態機動控制［J］.空間控制技術與應用，2015，41（6）：19－24.WANG H J，JIN L，JIA Y H.Agilesatellite attitude maneuver control using hybrid actuators［J］.Aerospace Control and Application，2015，41（6）：19－24（in Chinese）.

［13］ 吳宏鑫，劉一武，劉忠漢，等.特征建模與撓性結構的控制［J］.中國科學（E輯），2001，31（2）：137－149.WU H X，LIU Y W，LIU Z H，et al.Control of characteristic modeling and flexible structures［J］.Science in China（Series E），2001，31（2）：137－149（in Chinese）.

［14］ YANG J C.Development of intelligent autonomous control technology for the Chinese space program［C］.IFAC，International Conference on Intelligent Autonomous Control in Aerospace 95，Beijing，August 14－16，1995.

［15］ SUGANTHAN P N.Particle swarm optimizer with neighborhood operator［C］∥Proceedings of the 1999 Congress on Evolutionary Computation，1999.

［16］ LAZINICA A.Particle swarm optimization［M］.［s.l.］：Tech Education and Publishing，2009.

［17］ CARLISLE A，DOZIER G.An off－the－shelf PSO［C］∥Proceedings of the 2001Workshop on Particle Swarm Optimization，Indianapolis，2001：1－6.

［18］ 屠善澄.衛星姿態動力學與控制［M］.北京：宇航出版社，2005.TU S C.Satellite attitude dynamics and control［M］.Beijing：Aerospace Press，2005（in Chinese）.

［19］ 孫增圻，鄧志東，張再興.智能控制理論與技術［M］.北京：清華大學出版社，2011.SUN Z Q，DENG Z D，ZHANG Z X.Intelligent control theory and technology［M］.Beijing：Tsinghua University Press，2011（in Chinese）.

（編輯：高珍）

Satellite control method for fast attitude maneuver and stabilization

FENG Jiajia＊
Beijing Institute of Control Engineering，Beijing 100190，China

In view of the small satellite fast attitude maneuver，a satellite control method for fast attitude maneuver and stabilization based on particle swarm optimization（PSO）was proposed.First，this method does the path planning which the initial position of particle population is as the finish time for satellite maneuver acceleration period；then in this path planning the maintenance tracking control was used for tracking，and in the end of the maneuver path，the golden section control and logic differential control were used to make stability control；at last，the time of satellite attitude maneuver to target angle and stable was taken as adaptive value to find out an optimal path in the conditions of this combined control method and other limit to attitude maneuver and stability control.This control method can do optimal maneuver and stability control according to the actual dynamic characteristics，environmental characteristics of the astral，constraints and control performance.Applying this method to the small satellite attitude control，simulation results show the effectiveness of the method.

attitude control；fast maneuver；partical swarm optimization；flexible satellite；stabilize

TP373

A

10.16708／j.cnki.1000－758X.2017.0058

2016－12－19；

2017－03－13；錄用日期：2017－06－29；網絡出版時間：2017－08－11 13：18：22

http：∥kns.cnki.net／kcms／detail／11.1859.V.20170811.1318.008.html

國家自然科學基金（61333008）

＊通訊作者：馮佳佳（1986－），男，博士研究生，fengjiajia888＠163.com，研究方向為航天控制

馮佳佳.一種衛星快速姿態機動及穩定控制方法［J］.中國空間科學技術，2017，37（4）：34－40.FENG J J.

Satellite control method for fast attitude maneuver and stabilization［J］.Chinese Space Science and Technology，2017，37（4）：34－40（in Chinese）.