許 淼方一鳴 李建雄 趙曉東

(1.燕山大學(xué)工業(yè)計算機控制工程河北省重點實驗室,河北秦皇島 066004;2.燕山大學(xué)智能控制系統(tǒng)與智能裝備教育部工程研究中心,河北秦皇島 066004)

1 引言

與傳統(tǒng)大型航天器相比,一組小而經(jīng)濟的航天器具有更高的靈活性、更強的魯棒性和更低的成本[1–4].由于分布式合成孔徑雷達、三維立體成像等多航天器對地觀測任務(wù)需要各航天器指向地球上的特定位置,這就必須保證各航天器能跟蹤上預(yù)設(shè)的姿態(tài)軌跡[5].因此,多航天器協(xié)同控制技術(shù)作為對大型航天器技術(shù)的必要擴展和補充,具有重要的研究價值.

滑?？刂谱鳛橐环N特殊的非線性控制,被應(yīng)用于多航天器姿態(tài)協(xié)同控制[6–8].滑模面可以獨立于參數(shù)和干擾進行設(shè)計,因此滑模控制具有響應(yīng)速度快、對參數(shù)變化和干擾不敏感、物理實現(xiàn)簡單等優(yōu)點.然而,傳統(tǒng)的滑?？刂茣a(chǎn)生影響系統(tǒng)性能的抖振.文獻[9]用“sigmoid”或者飽和函數(shù)代替不連續(xù)控制項來抑制抖振.然而,這種近似控制是以犧牲系統(tǒng)的性能為代價.文獻[10–11]提出的super-twisting算法是一種典型的二階滑模控制算法,該算法在保持傳統(tǒng)滑模魯棒性的同時,可以提高系統(tǒng)的精度,削弱抖振的影響.文獻[12]基于齊次性方法設(shè)計了一個有限時間supertwisting 控制器,但不能計算系統(tǒng)的收斂時間.文獻[13]將Lyapunov方法應(yīng)用于不確定系統(tǒng)的super-twisting算法的性能分析,克服了收斂時間無法計算的問題.文獻[14]提出一種無模型自適應(yīng)分?jǐn)?shù)階supertwisting滑?？刂苼韺崿F(xiàn)機器人在不確定性和外部干擾下的軌跡跟蹤問題.文獻[15]針對一類帶有非匹配干擾的非線性系統(tǒng),設(shè)計一種自適應(yīng)super-twisting滑模控制器,提高了系統(tǒng)的魯棒性.文獻[16]將supertwisting滑模與模糊系統(tǒng)相結(jié)合,設(shè)計了一種魯棒控制器,利用super-twisting滑模的概念來削弱抖振問題.

上述研究都是基于單輸入單輸出系統(tǒng),不適用于多輸入多輸出系統(tǒng).文獻[17–19]針對帶有未知干擾和不確定性的多機器人系統(tǒng)編隊控制問題,基于領(lǐng)導(dǎo)–跟隨結(jié)構(gòu),設(shè)計了super-twisting滑?？刂破?在所設(shè)計的控制器下,系統(tǒng)領(lǐng)導(dǎo)–跟隨誤差可以在有限時間內(nèi)收斂.文獻[20]針對多機器人協(xié)調(diào)控制問題,提出了一種新的super-twisting神經(jīng)網(wǎng)絡(luò)及其外部干擾抑制模型,以提高協(xié)調(diào)控制的有限時間收斂性和對外界干擾的魯棒性.上述文獻中,每個航天器的控制器設(shè)計都是基于各自的領(lǐng)導(dǎo)–跟隨誤差,并未考慮與鄰居的交互信息.并且當(dāng)領(lǐng)導(dǎo)者與第i個跟隨者之間沒有信息交互時,該控制器的設(shè)計方法將不再適用.為了實現(xiàn)具有雙積分動力學(xué)的多智能體系統(tǒng)有限時間編隊控制和目標(biāo)跟蹤,基于多輸入多輸出super-twisting算法,文獻[21]提出了一種由觀測器和非光滑反饋控制律組成的算法.在所設(shè)計的控制器下,系統(tǒng)狀態(tài)在有限時間內(nèi)快速收斂.然而,控制器設(shè)計是集中式的,集中控制方式的系統(tǒng)結(jié)構(gòu)較為簡單,但由于控制器設(shè)計時需要系統(tǒng)的全局變量,因此,對系統(tǒng)的通訊要求較高.

此外,實際航天器系統(tǒng)中通常存在多種影響因素,包括由重力和太陽輻射等外作用力產(chǎn)生的干擾力矩以及執(zhí)行器故障等.這些干擾和故障會對系統(tǒng)性能產(chǎn)生影響.針對帶有外部干擾的一組航天器,文獻[28]提出了一種分布式自適應(yīng)姿態(tài)協(xié)同控制方案,由于采用有限時間控制方法,提高了系統(tǒng)的響應(yīng)速度.本文針對存在外界干擾和執(zhí)行器故障的多航天器姿態(tài)分布式協(xié)同控制問題,設(shè)計了基于多航天器姿態(tài)一致性誤差的super-twisting分布式協(xié)同控制器.首先,對每個航天器設(shè)計有限時間自適應(yīng)滑模干擾觀測器來估計系統(tǒng)外界干擾和執(zhí)行器故障構(gòu)成的集總干擾.其次,將積分滑模與super-twisting算法相結(jié)合,提出一種分布式協(xié)同控制器.由于所設(shè)計的控制器不需要包含系統(tǒng)的全局信息,因此該控制器可以實現(xiàn)分布式控制.再次,利用Lyapunov穩(wěn)定性理論證明了多航天器姿態(tài)可以在有限時間內(nèi)收斂到平衡點附近的鄰域內(nèi).最后,仿真及對比結(jié)果表明,本文所提出的分布式控制器具有更快的收斂速度和更高的控制精度.

2 系統(tǒng)描述與控制問題提出

2.1 符號定義

給定向量x=[x1x2··· xn]T及常數(shù)α>0,定義sigα(x)=[|x1|αsgnx1|x2|αsgnx2··· |xn|αsgnxn]T,其中sgn(·)為符號函數(shù).對于向量q=[q1q2q3]T,定義向量q的反對稱矩陣q×為

2.2 引理及定義

引理1[29]若在包含原點的鄰域?(? ?Rn)內(nèi),存在連續(xù)可微函數(shù)V(x)和實數(shù)l0>0,?>0,μ∈(0,1),對于滿足

V(x0)為V(x)的初始值,0<ρ≤1,0<ρ0<1.

引理2[23]若在包含原點的鄰域U(U ?Rn)內(nèi),存在連續(xù)可微函數(shù)V(x,t)和實數(shù)l1>0,l2>0,θ ∈(0,1),ξ >0,對于滿足:

V(x0,0)為V(x,t)的初始值,0<κ

引理3[24]對于任意正實數(shù)m,n,w和實數(shù)變量φ和ψ,有如下不等式

2.3 通訊拓?fù)?/h3>

2.4 系統(tǒng)描述

本文采用修正的Rodrigues參數(shù)(MPRs)[26]來描述各航天器的剛體姿態(tài)運動.第i(i=1,2,···,n)個航天器的動力學(xué)方程如下

根據(jù)文獻[26],得到Euler-Lagrange形式的多航天器運動學(xué)方程如下

由性質(zhì)1可知,Mi(qi)有界.根據(jù)di的定義,假設(shè)2是合理的.

本文的主要目的是設(shè)計分布式協(xié)同控制器uci(i=1,2,···,n),使得多航天器的姿態(tài)在具有外界干擾及執(zhí)行器故障的情況下,在有限時間內(nèi)快速跟蹤參考軌跡.

3 自適應(yīng)滑模干擾觀測器設(shè)計

為了估計系統(tǒng)的集總干擾di,本文使用了一個自適應(yīng)滑模干擾觀測器.

定義一個滑模面

定理1在假設(shè)2下,針對第i個航天器系統(tǒng)(6),在所設(shè)計的滑模干擾觀測器(8)及自適應(yīng)律(9)下,觀測誤差可以在有限時間內(nèi)收斂到平衡點附近的鄰域內(nèi).

根據(jù)引理1,觀測誤差可以在有限時間收斂到平衡點附近的鄰域內(nèi).

4 基于super-twisting和積分滑模面的分布式協(xié)同控制器設(shè)計

定義一致性誤差

可以在有限時間內(nèi)有界穩(wěn)定.由于χ2可以在有限時間內(nèi)有界穩(wěn)定,故狀態(tài)χ1也可以在有限時間內(nèi)有界穩(wěn)定.即:多航天器的姿態(tài)可以在有限時間內(nèi)收斂到平衡點附近的鄰域內(nèi).

注1將文獻[22]中的滑模面

將第1項中的χi,2變?yōu)閤i,2,可以避免在控制器設(shè)計時引入全局的拉普拉斯矩陣H,從而實現(xiàn)了分布式控制.即:當(dāng)領(lǐng)導(dǎo)航天器與第i個航天器有信息交互時,第i個航天器僅根據(jù)自身信息、鄰居航天器的信息及領(lǐng)導(dǎo)航天器信息進行姿態(tài)調(diào)整.當(dāng)領(lǐng)導(dǎo)航天器與第i個航天器沒有信息交互時,第i個航天器僅根據(jù)自身信息及鄰居航天器的信息進行姿態(tài)調(diào)整.與集中式控制器相比,本文所設(shè)計的分布式控制器僅采用自身信息及鄰居航天器信息,具有更低的通訊要求和更高的靈活性.

注2由于引入super-twisting算法,加快了系統(tǒng)的收斂速度.控制器設(shè)計包含快速趨近律和指數(shù)趨近律Si兩部分.當(dāng)系統(tǒng)狀態(tài)離滑模面較遠(yuǎn)時,指數(shù)趨近項Si保證系統(tǒng)的快速收斂.當(dāng)系統(tǒng)狀態(tài)離滑模面較近時,快速趨近項保證系統(tǒng)的快速收斂.

5 仿真研究

為了驗證本文所提方法的有效性,針對1個虛擬領(lǐng)導(dǎo)者和4個跟隨者的多航天器模型,將本文所提方法與文獻[28]方法進行仿真對比研究.

4個跟隨者的慣性矩陣為

虛擬領(lǐng)導(dǎo)者的姿態(tài)為q0=[0.5 0 0]T.系統(tǒng)的外部干擾為

執(zhí)行器故障的效率因子為

偏差故障為

其中? ∈[?1,1]為一個隨機數(shù).

自適應(yīng)滑模干擾觀測器參數(shù)選取ri=0.05,γi=0.5,ηi=0.1,?i,1=0.2.

控制器參數(shù)選取

圖1為多航天器的通訊拓?fù)鋱D.圖2為有限時間姿態(tài)跟蹤曲線.qij和為第i個航天器的第j個姿態(tài)及其導(dǎo)數(shù).圖2(a)–2(b)表示4個航天器姿態(tài)及其導(dǎo)數(shù)的第1個狀態(tài).圖2(c)–2(d)表示4個航天器姿態(tài)及其導(dǎo)數(shù)的第2個狀態(tài).圖2(e)–2(f)表示4個航天器姿態(tài)及其導(dǎo)數(shù)的第3個狀態(tài).圖3表示了式(8)所示的系統(tǒng)在文獻[28]提出的控制器下4個航天器姿態(tài)及其導(dǎo)數(shù)的有限時間跟蹤曲線.從圖2和圖3(a)–3(b)等可以看出多航天器的姿態(tài)可以在有限時間收斂到達穩(wěn)定狀態(tài).

圖1 多航天器通訊拓?fù)浣Y(jié)構(gòu)圖Fig.1 Communication topology of multi spacecraft

圖2 本文控制器下的多航天器姿態(tài)及其導(dǎo)數(shù)跟蹤曲線Fig.2 Multi spacecraft attitude and its derivative tracking curve under this paper

將圖2和圖3做對比可以看出,本文提出的控制器具有更快的瞬態(tài)響應(yīng)和更強的魯棒性.在本文提出的控制器下,4個航天器姿態(tài)在5秒左右到達穩(wěn)定;而在文獻[28]提出的控制器下,4個航天器姿態(tài)在10 s左右到達穩(wěn)定.在文獻[28]提出的控制器下要達到穩(wěn)定狀態(tài)還需要多5 s的時間.與文獻[28]所設(shè)計的分布式有限時間姿態(tài)協(xié)同控制器相比,由于引入了super-twisting算法,本文提出的有限時間分布式協(xié)同控制器具有更快的收斂速度.從圖2和圖3對比可以看出,本文所提出的控制器具有更高的控制精度.

圖3 文獻[28]控制器下的多航天器姿態(tài)及其導(dǎo)數(shù)跟蹤曲線Fig.3 Multi spacecraft attitude and its derivative tracking curve under reference[28]

6 結(jié)論

本文研究了基于super-twisting算法和自適應(yīng)滑模干擾觀測器的多航天器姿態(tài)協(xié)同控制問題.首先,通過對每個航天器構(gòu)造自適應(yīng)滑模干擾觀測器來估計系統(tǒng)外界干擾及執(zhí)行器故障構(gòu)成的集總干擾;然后,基于多航天器姿態(tài)的一致性誤差將super-twisting算法與積分滑?？刂葡嘟Y(jié)合設(shè)計了分布式協(xié)同控制器,有效地避免了控制器設(shè)計中全局信息的引入,實現(xiàn)了分布式控制,簡化了控制器的設(shè)計過程;最后,通過Lyapunov穩(wěn)定性理論證明了多航天器姿態(tài)可以在有限時間內(nèi)收斂到平衡點附近的鄰域內(nèi).通過仿真及對比,結(jié)果表明:本文所設(shè)計的控制器具有更快的收斂速度和更高的控制精度.