羅建軍，周 亮，蔣祺祺，張 博

(1.西北工業(yè)大學(xué)航天學(xué)院，西安710072;2.航天飛行動(dòng)力學(xué)技術(shù)重點(diǎn)實(shí)驗(yàn)室，西安710072; 3.深圳大學(xué)機(jī)電與控制工程學(xué)院，深圳518060)

航天器編隊(duì)的六自由度循環(huán)追蹤協(xié)同控制

羅建軍1，2，周 亮1，2，蔣祺祺1，2，張 博2，3

(1.西北工業(yè)大學(xué)航天學(xué)院，西安710072;2.航天飛行動(dòng)力學(xué)技術(shù)重點(diǎn)實(shí)驗(yàn)室，西安710072; 3.深圳大學(xué)機(jī)電與控制工程學(xué)院，深圳518060)

針對(duì)航天器編隊(duì)的姿軌協(xié)同控制問題，提出一種使用循環(huán)追蹤策略的六自由度(6-DOF)協(xié)同控制方法。首先，結(jié)合Lagrangian形式的姿態(tài)動(dòng)力學(xué)和軌道動(dòng)力學(xué)方程，建立航天器編隊(duì)的六自由度相對(duì)運(yùn)動(dòng)模型;然后，以線性雙積分系統(tǒng)的循環(huán)追蹤算法為基礎(chǔ)，分別設(shè)計(jì)可跟蹤動(dòng)態(tài)目標(biāo)的循環(huán)追蹤算法和航天器匹配自然周期相對(duì)運(yùn)動(dòng)的循環(huán)追蹤算法。綜合上述兩種算法，設(shè)計(jì)航天器編隊(duì)六自由度協(xié)同控制的循環(huán)追蹤算法。該算法可實(shí)現(xiàn)航天器編隊(duì)空間圓構(gòu)型初始化，跟蹤動(dòng)態(tài)的期望姿態(tài)和相對(duì)運(yùn)動(dòng)。仿真結(jié)果證明了所提出的航天器編隊(duì)六自由度協(xié)同控制的循環(huán)追蹤算法的有效性。

航天器編隊(duì);循環(huán)追蹤;六自由度;姿軌協(xié)同控制;Lagrangian方程

0 引 言

與傳統(tǒng)的單平臺(tái)航天器相比，分布式航天器系統(tǒng)具有結(jié)構(gòu)靈活、可靠性高、生命周期長(zhǎng)以及發(fā)射風(fēng)險(xiǎn)低等優(yōu)點(diǎn)，不僅可以實(shí)現(xiàn)傳統(tǒng)航天器無法實(shí)現(xiàn)的任務(wù)，如合成孔徑、長(zhǎng)基線任務(wù)，還具有傳統(tǒng)航天器所不具備的快速空間響應(yīng)能力和空間攻防對(duì)抗下的任務(wù)保護(hù)能力［1－3］。分布式自主協(xié)同控制(或稱多智能體協(xié)同控制)是航天器編隊(duì)自主協(xié)同飛行的重要研究方向和技術(shù)核心。實(shí)際任務(wù)往往要求對(duì)多個(gè)航天器的相對(duì)位置和相對(duì)姿態(tài)進(jìn)行協(xié)同控制［4－7］。

近年來很多學(xué)者開展了航天器六自由度(6 degree of freedom，6-DOF)協(xié)同控制的研究，并取得一定進(jìn)展。航天器六自由度的協(xié)同控制，目前主要采用的方法是將航天器相對(duì)姿態(tài)和軌道描述為L(zhǎng)agrangian方程形式的六自由度模型，借助Lagrangian方程的反對(duì)稱性等性質(zhì)設(shè)計(jì)協(xié)同控制律［4］。呂躍勇等［5］和Lv等［6］在考慮輸入受限和參數(shù)不確定情況下，基于退步控制設(shè)計(jì)了協(xié)同控制律，并通過加入指令濾波器，使控制信號(hào)滿足輸入約束。在此基礎(chǔ)上針對(duì)輸入受限和模型參數(shù)不確定，又設(shè)計(jì)了一種滿足輸入有界條件的自適應(yīng)L2增益干擾抑制控制器。張博［7］在多Lagrangian系統(tǒng)線性和非一致控制律基礎(chǔ)上，分別設(shè)計(jì)了航天器協(xié)同飛行交會(huì)對(duì)接任務(wù)和編隊(duì)構(gòu)型控制任務(wù)的兩個(gè)6-DOF協(xié)同控制算法，并研究了姿軌控制推力器配置與控制分配算法。畢鵬等［8］采用一致性理論，設(shè)計(jì)了一種非線性控制律。Chung等［9］將衛(wèi)星編隊(duì)相對(duì)軌道和姿態(tài)運(yùn)動(dòng)描述為L(zhǎng)agrangian系統(tǒng)，設(shè)計(jì)了一種分布式非線性協(xié)同控制律以實(shí)現(xiàn)衛(wèi)星編隊(duì)的六自由度協(xié)同控制。Kristiansen等［10］針對(duì)模型參數(shù)不確定，分別設(shè)計(jì)了基于無源方法的PD+控制器、滑?？刂破骷昂笸丝刂破?個(gè)控制器。Ren［11］在有向拓?fù)浣Y(jié)構(gòu)下研究了多星系統(tǒng)的相對(duì)軌道和相對(duì)姿態(tài)，但是將航天器相對(duì)運(yùn)動(dòng)建模為簡(jiǎn)單的線性二階積分系統(tǒng)。

循環(huán)追蹤策略是一種分布式協(xié)同控制策略，采用單向信息拓?fù)?，?shí)現(xiàn)n個(gè)智能體前后跟蹤，首尾相接。該方法在一致性問題基礎(chǔ)上，通過加入一個(gè)旋轉(zhuǎn)耦合矩陣使每個(gè)自主體的控制輸入通過旋轉(zhuǎn)角產(chǎn)生偏置，最終使所有自主體形成期望幾何構(gòu)型［7］。循環(huán)追蹤策略的基本原理是通過選擇不同的旋轉(zhuǎn)角，使閉環(huán)系統(tǒng)特征值配置在復(fù)平面的左半平面、虛軸或右半平面，實(shí)現(xiàn)以下3種基本的運(yùn)動(dòng)模式:共點(diǎn)模式、圓形編隊(duì)模式、對(duì)數(shù)螺旋線模式。Ren［12］針對(duì)一階系統(tǒng)和二階系統(tǒng)，設(shè)計(jì)了循環(huán)追蹤算法，并通過分析閉環(huán)系統(tǒng)狀態(tài)轉(zhuǎn)移矩陣的特征值來分析系統(tǒng)穩(wěn)定性，并研究信息拓?fù)?、阻尼增益及耦合矩陣?duì)集群運(yùn)動(dòng)的影響。Mier-Y-Teran-Romero等［13］考慮了時(shí)間延遲、噪聲的存在，采用循環(huán)追蹤方法研究了非線性自主體的編隊(duì)控制。Riberos等［14］對(duì)循環(huán)追蹤理論進(jìn)行了研究，探討了其在深空探測(cè)干涉儀成像、衛(wèi)星編隊(duì)飛行等空間任務(wù)的應(yīng)用。但是，現(xiàn)有文獻(xiàn)中循環(huán)追蹤策略主要應(yīng)用于航天器編隊(duì)軌道控制中，目前還沒有將其應(yīng)用于航天器編隊(duì)飛行六自由度協(xié)同控制的文獻(xiàn)。

本文基于線性雙積分系統(tǒng)的循環(huán)追蹤算法［14－15］，設(shè)計(jì)了可跟蹤動(dòng)態(tài)目標(biāo)的協(xié)同控制循環(huán)追蹤算法，并結(jié)合航天器近地環(huán)境自然周期相對(duì)運(yùn)動(dòng)特性，設(shè)計(jì)了與自然構(gòu)型匹配的循環(huán)追蹤算法。在此基礎(chǔ)上，設(shè)計(jì)了一種編隊(duì)飛行六自由度循環(huán)追蹤算法，同時(shí)跟蹤航天器編隊(duì)的期望姿態(tài)和相對(duì)運(yùn)動(dòng)軌跡，實(shí)現(xiàn)了航天器六自由度姿軌協(xié)同控制。

1 航天器編隊(duì)的六自由度相對(duì)運(yùn)動(dòng)模型

1.1 單個(gè)航天器的六自由度相對(duì)運(yùn)動(dòng)模型［7］

采用修正的羅德里格斯參數(shù) (Modified Rodriguez parameters，MRPs)描述航天器體坐標(biāo)系相對(duì)于慣性坐標(biāo)系的方位，可以避免求解復(fù)雜的約束方程，并且沒有冗余參數(shù)，同時(shí)能夠減少奇異性影響，其具體表示為

式中:e為歐拉軸，θ為繞e軸的旋轉(zhuǎn)角。

采用MRPs表示的姿態(tài)運(yùn)動(dòng)學(xué)方程為

航天器的姿態(tài)動(dòng)力學(xué)模型為

式中:J為對(duì)稱正定的航天器轉(zhuǎn)動(dòng)慣量陣，τ=［τ1，τ2，τ3］T，是作用于航天器上的控制力矩或干擾力矩，ω =［ω1，ω2，ω3］T，為航天器相對(duì)于慣性系的姿態(tài)角速度，［·］×表示叉乘矩陣。

聯(lián)立式(1)和式(2)可得采用MRPs描述的某個(gè)編隊(duì)航天器Si，i=1，…，N的姿態(tài)運(yùn)動(dòng)方程為

定義參考軌道坐標(biāo)系Oxyz，原點(diǎn)位于編隊(duì)參考中心，x軸沿矢徑方向，z軸沿垂直軌道面的角動(dòng)量方向，y軸由右手法則決定且Oxyz組成右手直角坐標(biāo)系。假設(shè)編隊(duì)中所有航天器同構(gòu)(質(zhì)量統(tǒng)一為m)，可得Lagrangian形式的相對(duì)軌道動(dòng)力學(xué)方程:

若參考航天器S0運(yùn)行在不受攝動(dòng)影響的圓參考軌道上，軌道半徑為r0，軌道角速度為n，編隊(duì)航天器Si，i=1，…，N的相對(duì)運(yùn)動(dòng)動(dòng)力學(xué)方程可采用如下的C-W方程描述

定義某個(gè)編隊(duì)航天器Si，i=1，…，N的六自由度運(yùn)動(dòng)狀態(tài)為，結(jié)合式(3)～(4)，可得

式中:

1.2 航天器編隊(duì)的六自由度相對(duì)運(yùn)動(dòng)模型

2 軌跡協(xié)同控制的循環(huán)追蹤算法

2.1 線性雙積分系統(tǒng)的循環(huán)追蹤算法［14］

設(shè)i∈{1，…，N}表示三維空間多智能體系統(tǒng)中第i個(gè)智能體，Xi(t)=［xi(t)，yi(t)，zi(t)］T∈R3，表示i在t≥0時(shí)刻的位置狀態(tài)，運(yùn)動(dòng)模型為線性雙積分系統(tǒng):

考慮如下線性雙積分系統(tǒng)的循環(huán)追蹤算法

式中:km∈R+，kn∈R，當(dāng)i=N時(shí)，XN+1與等效表示為X1與。Q(α)是旋轉(zhuǎn)角為α的三維旋轉(zhuǎn)矩陣，其旋轉(zhuǎn)軸為［0，0，1］T，則有

由式(9)可知，循環(huán)追蹤控制需要每個(gè)智能體相對(duì)于參考點(diǎn)的位置(kn≠0)和速度信息(kn≠－km)。

在循環(huán)追蹤算法(9)的作用下，N個(gè)智能體組成的多智能體系統(tǒng)可寫為

選擇適當(dāng)?shù)膮?shù)，在式(9)的作用下，多智能體系統(tǒng)在三維空間可形成3種典型的運(yùn)動(dòng)模式:聚集運(yùn)動(dòng)、圓構(gòu)型周期運(yùn)動(dòng)和對(duì)數(shù)螺旋線運(yùn)動(dòng)。關(guān)于參數(shù)和多智能體的運(yùn)動(dòng)特征有如下3個(gè)定理。

定理1.對(duì)閉環(huán)系統(tǒng)(10)，若 －km不是(α)的特征值，則系統(tǒng)狀態(tài)矩陣(α)的特征值由以下兩部分組成:

2)3 N個(gè)重根 －km。

定理2.對(duì)閉環(huán)系統(tǒng)(10)，假設(shè)kn＞0，若0≤＜π/N，則(α)的所有特征值都位于左半復(fù)平面內(nèi)(即(α)的所有特征值都位于左半復(fù)平面內(nèi))，收斂到原點(diǎn)上;若π/N≤＜2π/N，則有如下結(jié)論:

1)若kn＞2sin(π/N)sin(α－π/N)，所有特征值位于左半開復(fù)平面內(nèi);

2)若kn=2sin(π/N)sin(α－π/N)，有兩個(gè)非零特征值位于復(fù)平面虛軸上，其余特征值位于左半開平面內(nèi);

3)若kn＜2sin(π/N)sin(α－π/N)，兩個(gè)非零特征值位于右半開平面內(nèi)，其余非零特征值位于左半開平面內(nèi)。

定理3.對(duì)多智能體系統(tǒng)(10)，若 －km不是(α)的特征值，且kn＞0，則系統(tǒng)從非零初始狀態(tài)開始，在式(9)作用下指數(shù)收斂:

當(dāng)kn＞2sin(π/N)sin(α－π/N)，收斂到原點(diǎn);

當(dāng)kn=2sin(π/N)sin(α－π/N)，收斂為一個(gè)以原點(diǎn)為圓心的圓構(gòu)型上;

當(dāng)kn＜2sin(π/N)sin(α－π/N)，收斂到一個(gè)均勻分布的對(duì)數(shù)螺旋線編隊(duì)。

2.2 追蹤動(dòng)態(tài)目標(biāo)的循環(huán)追蹤算法

在線性雙積分系統(tǒng)循環(huán)追蹤算法(9)的基礎(chǔ)上，加入跟蹤的動(dòng)態(tài)目標(biāo)狀態(tài)，可設(shè)計(jì)如下的可追蹤動(dòng)態(tài)目標(biāo)的循環(huán)追蹤算法［7，14］:

由式(12)與式(10)的對(duì)比可見，可追蹤動(dòng)態(tài)目標(biāo)的線性雙積分系統(tǒng)循環(huán)追蹤算法(11)是式(9)的推廣，因此定理1、定理2、定理3也都適用于式(11)。

2.3 追蹤軌跡匹配自然構(gòu)型的循環(huán)追蹤算法

對(duì)于航天器的協(xié)同飛行，減少航天器編隊(duì)飛行過程中的燃料消耗，應(yīng)該充分利用航天器間的自然周期相對(duì)運(yùn)動(dòng)。為了實(shí)現(xiàn)航天器自然周期相對(duì)運(yùn)動(dòng)，減少燃料消耗，本文采用同胚映射將編隊(duì)航天器的追蹤軌跡轉(zhuǎn)換到航天器間的自然周期相對(duì)運(yùn)動(dòng)構(gòu)型，實(shí)現(xiàn)考慮自然周期相對(duì)運(yùn)動(dòng)幾何形態(tài)的相對(duì)運(yùn)動(dòng)協(xié)同控制［7，14］。

采用同胚映射的方法可以將循環(huán)追蹤的軌跡轉(zhuǎn)換到特定的幾何形狀。相似變換是一種常用的同胚映射方法。通過選擇合適的線性可逆變換 T∈ RN×N對(duì)循環(huán)追蹤算法的旋轉(zhuǎn)矩陣Q(α)進(jìn)行相似變換，可以使原來收斂的系統(tǒng)收斂到新的不變集［7，14］。這樣，狀態(tài)就會(huì)產(chǎn)生如下轉(zhuǎn)換

因此，循環(huán)追蹤算法產(chǎn)生的圓構(gòu)型在同胚映射作用下就能夠與航天器相對(duì)運(yùn)動(dòng)的橢圓形自然構(gòu)型相匹配，從而形成自然的周期相對(duì)運(yùn)動(dòng)。

假設(shè)參考航天器S0在近圓軌道運(yùn)行，即e0≈0，且不考慮J2項(xiàng)攝動(dòng)的影響，選取變換矩陣如下:

式中:z0和φz是兩個(gè)可調(diào)參數(shù)，決定了圓參考軌道周期構(gòu)型的法向振幅和相位角。

對(duì)線性雙積分系統(tǒng)的循環(huán)追蹤算法(9)的旋轉(zhuǎn)矩陣進(jìn)行相似變換，可設(shè)計(jì)如下的匹配自然構(gòu)型的航天器編隊(duì)循環(huán)追蹤算法:

式中:kc=n/［2sin(π/N)cos(α－π/N)］。其余參數(shù)的含義與式(9)相同。下面對(duì)控制性能進(jìn)行分析。

式(15)除去第一項(xiàng)的剩余部分如下:

N個(gè)航天器組成的編隊(duì)系統(tǒng)可寫為

由定理1，若 －km不是(α)的特征值，則式(16)中狀態(tài)矩陣A～(α)的特征值由以下兩部分組成:

由式(17)可得，當(dāng)kn＞0，π/N≤＜2π/N時(shí)，特別地，當(dāng)kn=2sin(π/N)sin(α－π/N)，有兩個(gè)位于虛軸的特征值λ1，2=±j2kcsin(π/N)cos(απ/N)，其余特征值均位于左半平面。虛軸上的特征值決定了圓編隊(duì)的角速度，即圓編隊(duì)角速度ωN= 2kcsin(π/N)cos(α－π/N)。

要實(shí)現(xiàn)匹配自然周期相對(duì)運(yùn)動(dòng)構(gòu)型，除了幾何形狀、尺寸外，還要匹配運(yùn)動(dòng)角速度(頻率)，即ωN=n，則kc=n/［2sin(π/N)cos(α－π/N)］。

根據(jù)文獻(xiàn)［14］中的命題3.4.1，以及定理2和定理3，式(15)能夠保證閉環(huán)系統(tǒng)穩(wěn)定。

當(dāng)t→∞ ，編隊(duì)系統(tǒng)中的航天器Si，i=1，…，N將收斂到以下構(gòu)型［14］:

式中:α0，i=2π(i－1)/N，aE為航天器相對(duì)運(yùn)動(dòng)橢圓形自然構(gòu)型的長(zhǎng)半軸，由所有航天器初始狀態(tài)決定。將式(14)代入式(18)，并對(duì)參考軌道坐標(biāo)系的方向分量進(jìn)行化簡(jiǎn)，可得

式(19)為由C-W方程描述的航天器相對(duì)運(yùn)動(dòng)的橢圓形自然構(gòu)型。將式(19)代入式(5)易得，當(dāng)Xi(t)→Xdi(t)，i=1，…，N，fi→0。

3 六自由度協(xié)同控制的循環(huán)追蹤算法

圓編隊(duì)構(gòu)型在實(shí)際中有著廣泛的應(yīng)用，根據(jù)定理3的情況2)，選擇適當(dāng)?shù)膮?shù)，使用可追蹤動(dòng)態(tài)目標(biāo)的循環(huán)追蹤算法(11)和追蹤軌跡匹配自然構(gòu)型的循環(huán)追蹤算法(15)，結(jié)合航天器編隊(duì)的六自由度相對(duì)運(yùn)動(dòng)模型，可以在得到匹配自然構(gòu)型圓編隊(duì)軌跡的同時(shí)實(shí)現(xiàn)姿態(tài)一致。

將式(20)～(21)代入式(6)可得:

根據(jù)定理3，選擇合適的參數(shù)α、km1、km2、kn1和kn2，就可以實(shí)現(xiàn)空間圓編隊(duì)任務(wù)。

4 仿真校驗(yàn)

4.1 仿真參數(shù)設(shè)置

應(yīng)用航天器編隊(duì)六自由度協(xié)同控制的循環(huán)追蹤算法(20)，實(shí)現(xiàn)5個(gè)在近地軌道飛行的航天器的姿態(tài)同步、編隊(duì)構(gòu)型初始化以及編隊(duì)構(gòu)型的保持控制。

初始條件如下:設(shè)5個(gè)航天器同構(gòu)，質(zhì)量均為50 kg，轉(zhuǎn)動(dòng)慣量均為

航天器編隊(duì)系統(tǒng)內(nèi)的信息拓?fù)鋱DG為單向循環(huán)追蹤環(huán)，如圖1所示。序號(hào)1～5表示航天器S1～S5，仿真結(jié)果如圖2～5所示。

5個(gè)航天器的初始姿態(tài)MRPs與初始角速度如表1所示。

設(shè)參考軌道是高度為679.9718 km的圓軌道，軌道傾角75°，5個(gè)航天器相對(duì)于參考軌道S0的初始位置與初始速度如表2所示。

表2 初始位置和初始速度Table 2 Initial position and velocity

追蹤角為α=1.5π/N，N=5為航天器數(shù)目。給出控制參數(shù):km1=0.01，km2= 0.01，kn1= 2sin(π/N)sin(α－π/N)+0.2，kn2=2sin(π/N)sin(α－π/N)－0.2，0＜t≤2T，kn2=2sin(π/N)sin(απ/N)，2T ＜t≤3T，kc=n/(2sin(π/N)cos(απ/N))。其中自然周期頻率。在變換矩陣Tc(式(14))中，選擇(空間圓構(gòu)型)， φz=0°。

5個(gè)航天器協(xié)同飛行的期望相對(duì)運(yùn)動(dòng)為等相位分布在半徑為1 km的空間圓構(gòu)型，并且期望姿態(tài)運(yùn)動(dòng)為:=0.3547，=0.0564，=0.2870。每個(gè)航天器上12個(gè)推力器，每個(gè)推力器的最大推力為1 N，具體配置方案參考文獻(xiàn)［16－17］。

4.2 仿真結(jié)果分析

從初始條件開始，在式(20)的作用下，實(shí)現(xiàn)5個(gè)航天器姿態(tài)的同步、編隊(duì)構(gòu)型的初始化與編隊(duì)保持，仿真時(shí)間為3個(gè)軌道周期3T(17700 s)。

圖2是5個(gè)航天器協(xié)同飛行的構(gòu)型建立過程，5個(gè)實(shí)心圓分別表示航天器的初始位置，5個(gè)五角星分別表示航天器的最終位置，可見5個(gè)航天器由初始狀態(tài)在式(20)的控制作用下可以等相位分布在空間圓構(gòu)型上。

圖3是5個(gè)航天器的姿態(tài)MRPs、角速度的同步過程及控制力矩變化曲線，曲線最終收斂到期望姿態(tài)。由圖3可知，在式(20)的作用下，約在500 s時(shí)，5個(gè)航天器姿態(tài)MRPs同步到期望姿態(tài)，角速度趨向0，控制力矩也趨向0，說明姿態(tài)同步已完成，因此僅繪制出前600 s的仿真曲線。

圖4為整個(gè)任務(wù)周期內(nèi)5個(gè)航天器在式(20)的控制作用下的相對(duì)位置、速度及控制力變化曲線。任務(wù)周期分為兩個(gè)階段:第一階段，在0＜t≤2T時(shí)間段內(nèi)，利用循環(huán)追蹤螺旋線運(yùn)動(dòng)模式，執(zhí)行編隊(duì)的初始化任務(wù);第二階段，在2T＜t≤3T時(shí)間段內(nèi)，利用循環(huán)追蹤圓構(gòu)型運(yùn)動(dòng)模式，使編隊(duì)保持空間圓相對(duì)運(yùn)動(dòng)。從控制力變化曲線來看，2T時(shí)刻(11800 s)是操作任務(wù)的切換點(diǎn)，控制力存在跳變，這是由于算法由螺旋線模式轉(zhuǎn)換到圓構(gòu)型模式導(dǎo)致的?？刂屏S持在10－3量級(jí)，符合燃料消耗需求。

由圖5可見，在式(20)的作用下，5個(gè)航天器之間的相對(duì)距離和相對(duì)速度呈周期變化，達(dá)到了穩(wěn)定的六自由度編隊(duì)協(xié)同運(yùn)動(dòng)狀態(tài)。

5 結(jié) 論

本文首先以Lagrangian形式的姿態(tài)動(dòng)力學(xué)和軌道動(dòng)力學(xué)為基礎(chǔ)，建立了航天器六自由度相對(duì)運(yùn)動(dòng)動(dòng)力學(xué)方程。然后，基于線性雙積分系統(tǒng)的循環(huán)追蹤算法，設(shè)計(jì)了可跟蹤動(dòng)態(tài)目標(biāo)的循環(huán)追蹤算法。然后結(jié)合航天器自然周期相對(duì)運(yùn)動(dòng)特性，使用同胚映射方法，設(shè)計(jì)了匹配自然構(gòu)型的循環(huán)追蹤算法。綜合上述兩種循環(huán)追蹤算法，進(jìn)一步設(shè)計(jì)了航天器編隊(duì)飛行六自由度協(xié)同控制的循環(huán)追蹤算法。仿真結(jié)果表明，所設(shè)計(jì)的使用循環(huán)追蹤的六自由度協(xié)同控制算法，可以使多個(gè)航天器同時(shí)準(zhǔn)確跟蹤期望姿態(tài)運(yùn)動(dòng)和相對(duì)軌跡運(yùn)動(dòng)，可實(shí)現(xiàn)航天器圓編隊(duì)構(gòu)型建立、航天器姿軌協(xié)同和編隊(duì)構(gòu)型的保持控制。

［1］ 楊震，孟新，牛文龍，等.多航天器協(xié)同探測(cè)星簇構(gòu)型探測(cè)效能的評(píng)價(jià)方法［J］.宇航學(xué)報(bào)，2015，36(9):981－987.［Yang Zhen，Meng Xin，Niu Wen-long，et al.A evaluation method for multi-spacecraft formation detection efficiency［J］.Journal of Astronautics，2015，36(9):981－987.］

［2］ 譚天樂.橢圓軌道交會(huì)、懸停與繞飛的全狀態(tài)反饋控制［J］.宇航學(xué)報(bào)，2016，37(7):811－818.［Tan Tian-le.Full state feedback control of rendezvous，hovering and fly-around in elliptical orbit［J］.Journal of Astronautics，2016，37(7):811－818.］

［3］ 張永合，梁旭文，周遠(yuǎn)強(qiáng)，等.無阻力雙星編隊(duì)的滿系數(shù)矩陣MIMO定量反饋控制［J］.宇航學(xué)報(bào)，2016，37(7):819－828.［Zhang Yong-he，Liang Xu-wen，Zhou Yuan-qiang，et al.Full-matrix MIMO QFT controller design for drag free satellites in dual formation［J］.Journal of Astronautics，2016，37(7):819－828.］

［4］ Accardo D，Aguttes J P，Al-berti G.Distributed space missions for Earth system monitoring［M］.New York:Springer Science＆Business Media，2012.

［5］ 呂躍勇，胡慶雷，馬廣富，等.帶有控制受限的衛(wèi)星編隊(duì)飛行六自由度自適應(yīng)協(xié)同控制［J］.控制理論與應(yīng)用，2011，28(3):321－328.［Lv Yue-yong，Hu Qing-lei，Ma Guang-fu， et al.Adaptive synchronized control with 6 degrees of freedom and bounded input for satellite formation flight［J］.Control Theory＆Applications，2011，28(3):321－328.］

［6］ Lv Y Y，Hu Q L，Ma G F，et al.6 DOF synchronized control for spacecraft formation flying with input constraint and parameter uncertainties［J］.ISA Transactions，2011，50(4):573－580.

［7］ 張博.多航天器協(xié)同飛行分布式控制研究［D］.西安:西北工業(yè)大學(xué)，2013.［Zhang Bo.Research on distributed control for multiple spacecraftcooperative flying［D］.Xi’an: Northwestern Polytechnical University，2013.］

［8］ 畢鵬，羅建軍，張博.一種基于一致性理論的航天器編隊(duì)飛行協(xié)同控制方法［J］.宇航學(xué)報(bào)，2010，31(1):70－74.［Bi Peng，Luo Jian-jun，Zhang Bo.A synchronized control method for spacecraft formation flying based on consensus theory［J］.Journal of Astronautics，2010，31(1):70－74.］

［9］ Chung S J， Ahsun U， Slotine J J E. Application of synchronization to formation flying spacecraft: Lagrangian approach［J］.Journal of Guidance，Control，and Dynamics，2009，32(2):512－526.

［10］ Kristiansen R，Nicklasson P J，Gravdahl J T.Spacecraft coordination controlin 6DOF: Integrator backstepping vs passivity-based control［J］.Automatica，2008，44(11):2896－2901.

［11］ Ren W.Formation keeping and attitude alignment for multiple spacecraft through local interactions［J］.Journal of Guidance，Control，and Dynamics，2007，30(2):633－638.

［12］ Ren W.Collective motion from consensuswith Cartesian coordinate coupling［J］.Automatic Control，IEEE Transactions on，2009，54(6):1330－1335.

［13］ Mier-Y-Teran-Romero L，F(xiàn)orgoston E，Schwartz I B.Coherent pattern prediction in swarms of delay-coupled agents［J］.Robotics，IEEE Transactions on，2012，28(5):1034－1044.

［14］ Riberos R，Luis J.New decentralized algorithms for spacecraft formation control based on a cyclic approach［R］.Cambridge，America:Massachusetts Institude of Technology，2010.

［15］ Yang H X，Yang T，Zhang W H.Review on cyclic pursuit in spacecraft formation flying［A］.International Conference on Recent Advances in Space Technologies，IEEE，2011:576－580.

［16］ Curti F，Romano M，Bevilacqua R.Lyapunov-based thrusters' selection for spacecraft control:analysis and experimentation［J］.Journal of Guidance，Control，and Dynamics，2010，33(4): 1143－1160.

［17］ 唐生勇，張世杰，陳閩.交會(huì)對(duì)接航天器推力分配算法研究［J］.宇航學(xué)報(bào)，2008，29(4):1120－1125.［Tang Shengyong，Zhang Shi-jie，Chen Min.Research on a thrust allocation algorithm of spacecraft in RVD［J］.Journal of Astronautics，2008，29(4):1120－1125.］

通信地址:西安市西北工業(yè)大學(xué)251信箱(710072)

電話:(029)88493685，(029)88493350

E-mail:jjluo@nwpu.edu.cn

(編輯:牛苗苗)

6 DOF Coordinated Control Using Cyclic Pursuit for Spacecraft Formation

LUO Jian-jun1，2，ZHOU Liang1，2，JIANG Qi-qi1，2，ZHANG Bo2，3
(1.School of Astronautics，Northwestern Polytechnical University，Xi’an 710072，China; 2.National Key Laboratory of Aerospace Flight Dynamics，Xi’an 710072，China; 3.College of Mechatronics and Control Engineering，Shenzhen University，Shenzhen 518060，China)

A 6 degree of freedom(6-DOF)attitude and orbit coordinated control method using cyclic pursuit is proposed for spacecraft formation flying.Firstly，a decentralized coordinated tracking cyclic pursuit algorithm is developed based on the linear second-order cyclic pursuit control algorithm.Then，a cyclic pursuit algorithm which can match the natural period configuration of satellites is improved based on a similarity transformation to the rotation matrix.Next，a proposed 6-DOF coordinated control method which uses cyclic pursuit algorithm is applied to both orbital and attitude dynamics formulated as the integrated Lagrangian equations.The three dimentional circular formation composed of multiple spacecraft can be realized by the proposed algorithm and the attitude of an arbitrary number of spacecraft can be synchronized to the constant reference states simultaneously.Numerical simulation results demonstrate the efficiency of the proposed algorithm.

Spacecraft formation flying;Cyclic pursuit;6 degree of freedom(6-DOF);Attitude and orbit coordinated control;Lagrangian equations

V448.2

A

1000-1328(2017)02-0166-10

10.3873/j.issn.1000-1328.2017.02.008

羅建軍(1965－)，男，博士，教授，主要從事航天飛行動(dòng)力學(xué)、導(dǎo)航、制導(dǎo)與控制等方面的研究。

2016-08-16;

2016-11-21

國(guó)家自然科學(xué)基金(11072194，61690211)