多剛體滑模姿態協調控制

高 岱，呂建婷，王本利

（1.哈爾濱工業大學衛星技術研究所，150080 哈爾濱;2.黑龍江大學 數學科學學院，150080 哈爾濱）

多剛體滑模姿態協調控制

高 岱1，呂建婷2，王本利1

（1.哈爾濱工業大學衛星技術研究所，150080 哈爾濱;2.黑龍江大學 數學科學學院，150080 哈爾濱）

本文研究了多剛體分布式姿態協調控制問題.基于圖論和滑模控制理論，針對修正羅德里格參數描述的姿態跟蹤控制系統，設計了滑模姿態協調控制律.首先引入圖拉普拉斯矩陣，采用Lyapunov穩定性分析方法設計了滑模面.然后在干擾存在時設計了滑模姿態控制算法，并在轉動慣量不確定存在時研究了控制算法的魯棒性.最后對給出的算法進行了數值仿真，其結果驗證了所提出的多剛體滑模姿態協調控制算法的可行的、有效的.

分布式控制;姿態協調;滑?？刂?/p>

多剛體分布式姿態協調控制問題是當前的一個研究熱點，已引起國內外的廣泛關注.典型的姿態協調控制目標是實現姿態同步和跟蹤，保證閉環系統的全局漸近穩定性.與傳統的集中式控制相比，分布式控制具有規模靈活、魯棒性強和便于維護等優點.

常用來研究一階或二階積分器系統的圖論方法最近已被用來分析多剛體的姿態協調控制問題.圖論中的拉普拉斯矩陣以及它的譜特征在一致性收斂分析中有重要的作用.與一階和二階積分器系統相比，非線性的多剛體姿態協調控制有著更實際的應用價值，同時也存在新的技術難題.文獻［1］在拓撲結構為無向圖時，進行了沒有絕對角速度和相對角速度反饋的姿態同步和跟蹤控制算法研究.文獻［2］考慮三種不同情況，在無向圖和有向圖情形進行了分布式姿態同步問題研究.文獻［3］考慮編隊航天器的相對軌道和姿態控制問題，設計了分布式姿態控制律.文獻［1－3］均使用四元數對姿態進行描述.文獻［4－6］采用修正羅德里格參數(MRP)進行姿態描述，進行了姿態協調控制問題的研究.文獻［4］分別考慮輸入受限、無角速度反饋及時變參考信號，給出了多剛體分布式姿態控制律，實現了姿態同步.文獻［5］研究了多剛體分布式姿態同步和跟蹤問題.文獻［6］在控制律中引入圖拉普拉斯矩陣，給出了主從式的多剛體姿態協調控制算法.除了研究全狀態反饋和輸出反饋姿態協調控制問題，文獻［7－10］給出了存在干擾和轉動慣量不確定時的分布式姿態控制算法.文獻［7］給出了魯棒分布式姿態調節協調控制算法.文獻［8］針對網絡Euler-Lagrange系統，給出了分布式自適應一致性算法.文獻［9］考慮了干擾抑制、轉動慣量不確定問題，針對主從式航天器編隊，進行了姿態控制的研究.文獻［10］給出了魯棒姿態協調控制律，在干擾和轉動慣量不確定存在時保證了閉環系統的全局漸近穩定性.

本文首先給出剛體動力學方程以及由修正羅德里格參數描述的運動學方程，以及誤差方程和Euler-Lagrange形式的等價方程.然后介紹了圖論的相關知識.之后針對多剛體的姿態協調控制問題，考慮網絡拓撲是無向的情況，在干擾和轉動慣量不確定存在時，采用滑模控制方法，設計了滑模面和分布式滑模姿態協調控制律.本文滑模面的選取沒有采用一般形式，在設計時考慮了相對姿態.通過Lyapunov穩定性分析，證明閉環系統是全局漸近穩定的.最后對提出的算法進行了數學仿真驗證，結果表明了所設計的控制算法是行之有效的.

1 數學模型

1.1 剛體姿態運動方程

考慮第i個剛體姿態運動的動力學方程為

由MRP描述的剛體非線性運動學方程為

1.2 誤差系統

定義誤差姿態δσi，即編隊中的每個剛體的當前姿態σi與期望姿態σdi間的偏差，和誤差姿態角速度 δωi為

這里 ωdi為期望姿態角速度，R(δσi)=R(σi)R(σdi)T為期望坐標系到本體坐標系的轉換矩陣.這里有

由式(1)、(2)和(4)得到剛體誤差動力學方程為

定義 Fi=Fi(δσi)=G(δσi)，將(4)代入(6)整理得到如下方程:

方程(7)具有如下兩個重要的性質:

2 圖論基礎

圖Gn是由非空的節點集N={1，2，…，n}與邊集E∈N×N組成，可記為Gn=(N，E).

有向圖，邊是有向的，邊(i，j)∈E表示第j個節點能夠得到第i個節點的信息，反之不必成立.

無向圖，邊(i，j)表示第i個節點和第個j節點能夠互相得到對方的信息，無向圖是有向圖的一個特例.

圖Gn的鄰接矩陣A=［aij］∈Rn×n定義為

對于帶權的鄰接矩陣A中的元素aij定義為:當(j，i)∈E時，aij＞ 0，否則aij=0.圖Gn的拉普拉斯矩陣L= ［lij］∈ Rn×n定義為

當圖為無向圖時，拉普拉斯矩陣L為對稱半正定的.

如果無向圖中任意兩個節點之間都有一條邊將其連通，則稱該圖是連通的.

3 姿態協調控制律設計

下面基于圖論和滑?？刂品椒ㄑ芯慷鄤傮w姿態協調控制.首先采用Lyapunov穩定性分析方法設計了滑模面.然后在干擾存在時設計了滑模姿態控制算法，并在轉動慣量不確定存在時研究了控制算法的魯棒性.剛體間的通信拓撲用圖Gn來表示，這里考慮網絡拓撲是無向的情況.為了說明下面的結果，令Ni?{1，…，n}{i}表示與剛體i通信的所有剛體的集合.

3.1 滑模面的設計

定理1 選擇滑模面si為

當 si→ 0，無向圖被連通時有 σi→ σdi，σi(t)－ σj(t)→σdij，ωi→ωdi，ωi(t)－ωj(t)→ωdij，t→∞.這里ki為大于0的標量，aij是圖Gn的鄰接矩陣A的元素，σdij和ωdij分別為期望的相對姿態和相對姿態角速度.

證明 選取Lyapunov函數

計算V對時間t的導數，得到

因為(L?I3)是半正定的，當(L?I3)δσ→0，有 Lδσ1→ Lδσ2→ Lδσ3，這里 δσ1，δσ2，δσ3∈Rn.當無向圖連通，有 δσi→ δσj.因此可以得到δσi(t)→ δσj(t)→ 0，t→ ∞ 時，即 σi→ σdi，σi(t)－σj(t)→σdij，進一步有ωi→ωdi，ωi(t)－ωj(t)→ ωdij.

3.2 滑?？刂坡稍O計

假設1 干擾是有界的‖di‖≤dmax.

定理2 考慮由式(4)、(6)描述的系統，在干擾存在下，設計滑?？刂坡蓇i為

其中ksij為三維對角正定陣Ksi對角線上的元素，滿足 Ksil＞ 2dmax，l=1，2，3.如果無向圖被連通，則有σi→σdi，σi(t)－σj(t)→σdij，ωi→ωdi，ωi(t)－ ωj(t)→ ωdij，當 t→ ∞.sgn(s)=［sgn(s1)sgn(s2)sgn(s3)］T，sgn(sl)為符號函數，aij是鄰接矩陣A的元素.

證明 對第i個剛體，選取Lyapunov函數

計算Vi對時間t的導數，得到

考慮性質2，并將控制律代入(16)，得

當ksil＞2dmax|時，有＜0.

在實際中，由于慣性的存在、控制受限及各種非理想因素，滑模運動存在抖振，這里用飽和函數代替符號函數來減小抖振，飽和函數定義如下

這里δ＞0.

3.3 魯棒性研究

設計滑?？刂破鱱i為

ksil＞|Δg|il，如果無向圖是連通的，對于式(4)、(6)描述的系統，有σi→σdi，σi(t)－σj(t)→σdij，ωi→ωdi，ωi(t)－ ωj(t)→ωdij，當t→∞.

這里

證明 對第i個剛體，選取Lyapunov函數

計算Vi對時間t的導數，得到

當條件ksil＞|Δgil|滿足時，可以看出，當有＜0成立.類似的，可以得到σi→σdi，σi(t)－σj(t)→ σdij，ωi→ωdi，ωi(t)－ ωj(t)→ ωdij，當t→∞.

4 數學仿真

為驗證本文所提出的控制算法的可行性和有效性，考慮6個剛體組成的系統進行數學仿真驗證，通信拓撲如圖1所示.

圖1 6個剛體間的拓撲關系

簡單起見，選取仿真參數如下所示.剛體的轉動慣量為

初始姿態和姿態角速度為

期望的角速度為

和 σdi= ［0 0 0］T.

三軸干擾力矩為

滑?？刂破鲄颠x取為

數學仿真結果如圖所示.第1，3，5個剛體的姿態σi、姿態角速度ωi和控制輸出力矩ui變化曲線分別如圖2～4所示.由仿真結果可以看出，干擾存在時，控制方案能很好地完成多剛體的姿態控制任務，實現了控制目標，保證了閉環系統的全局漸近穩定性.

圖2 MRP變化曲線

圖3 姿態角速度變化曲線

圖4 控制力矩變化曲線

當轉動慣量增大15%時，第1，3，5個剛體的姿態、姿態角速度曲線分別如圖5、6所示.

圖5 MRP變化曲線

圖6 姿態角速度變化曲線

由圖可以看出，所設計的滑模控制方案在干擾存在時能夠較好地完成多剛體的姿態控制任務，對轉動慣量參數變化具有魯棒性.

5 結論

本文研究了多剛體的分布式姿態協調控制問題.針對MRP描述的姿態跟蹤控制系統，給出了多剛體的滑模姿態協調控制算法.通過Lyapunov分析證明了多剛體的全局漸近穩定性.仿真結果表明所設計的控制方案很好地實現了多剛體的姿態同步和跟蹤.

［1］ABDESSAMEUD A，TAYEBI A.Attitude synchronization of a group of spacecraft without velocity measurements［J］.IEEE Transactions on Automatic Control.2009，54(11):2642－2648.

［2］REN Wei.Distributed attitude alignment in spacecraft formation flying［J］.International Journal of Adaptive Control and Signal Processing.2007，21(2－3):95－113.

［3］REN Wei.Formation keeping and attitude alignment for multiple spacecraft through local interactions［J］.Jour-nal of Guidance，Control and Dynamics.2007，30(2):633－638.

［4］REN Wei.Distributed attitude synchronization for multiple rigid bodies with Euler-Lagrange equations of motion［C］//Proceedings of the 46th IEEE Conference on Decision and Control.New Orleans，LA，USA:［s.n.］，2007，2363－2368.

［5］REN Wei.Distributed cooperative attitude synchronization and tracking for multiple rigid bodies［J］.IEEE Transactions on Control Systems Technology.2010，18(2):383－392.

［6］DIMAROGONAS D V，TSIOTRAS P，KYRIAKOPOULOS K J.Leader—follower cooperative attitude control of multiple rigid bodies［J］.Systems ＆ Control Letters，2009，58(6):429－435.

［7］JIN Erdong，JIANG Xiaolei，SUN Zhaowei.Robust decentralized attitude coordination control of spacecraft formation［J］.Systems＆ Control Letters，2008，57(7):567－577.

［8］MIN Haibo，SUN Fuchun，WANG Shicheng，LI Hongbo.Distributed adaptive consensus algorithm for networked Euler-Lagrange systems［J］.IET Control Theory and Applications，2011，5(1):145 －154.

［9］YUAN Changqing， LI Junfeng， WANG Tianshu，BAOYIN Hexi，Robust attitude control for rapid multitarget tracking in spacecraft formation［J］.Applied Mathematics and Mechanics，2008，29(2):185 －198.

［10］LIANG Haizhao，WANG Jianying，SUN Zhaowei.Robust decentralized coordinated attitude control of spacecraft formation［J］.Acta Astronautica，2011，69(5 －6):280－288.

［11］SLOTINE J-J E，LI Weiping.Applied nonlinear control［M］.Englewood Cliffs，New Jersey:Prentice Hall，1991:123.

Sliding mode coordinated attitude control for multiple rigid bodies

GAO Dai1，LU Jian-ting2，WANG Ben-li1

(1.Research Center of Satellite Technology，Harbin Institute of Technology，150080 Harbin，China;2.School of Mathematical Science，Heilongjiang University，150080 Harbin，China)

The problem of distributed coordinated attitude control for multiple rigid bodies is addressed in this paper.Based on graph theory and sliding mode control theory，a sliding mode coordinated attitude control law aiming at the attitude tracking control system described by the Modified Rodrigues Parameters is proposed.First the sliding surface is designed by introducing graph Laplacian matrix and using Lyapunov stability analysis method.Then the sliding mode attitude control algorithms for multiple rigid bodies with external disturbances are designed，and the robustness of the control algorithm is studied in the presence of uncertainty inertia.Finally，numerical simulations of the algorithms are given.The results show that the sliding mode coordinated attitude control algorithm for multiple rigid bodies is feasible and effective.

distributed control;attitude coordination;sliding mode control

V448.2

A

0367－6234(2012)09－0034－06

2011－07－16.

高 岱(1974—)男，博士;

王本利(1944—)男，教授，博士生導師.

高 岱，mackingtosh@gmail.com.

(編輯 苗秀芝)