李賀,王寧,薛皓原
大連海事大學(xué) 船舶電氣工程學(xué)院,遼寧 大連 116026
近些年,水面無(wú)人艇(Unmanned surface vehicle,USV)在軍民用領(lǐng)域扮演的角色越來(lái)越重要,其可遂行情報(bào)偵察、水域環(huán)境檢測(cè)、海圖繪制等任務(wù)[1]。但是,當(dāng)面臨復(fù)雜的水域環(huán)境以及多樣性的作業(yè)任務(wù)時(shí),單個(gè)USV顯得勢(shì)單力薄,而多USV協(xié)同控制因其具有效率高、覆蓋廣、魯棒性強(qiáng)等優(yōu)勢(shì),逐漸成為研究的熱點(diǎn)[2]。在多USV協(xié)同控制領(lǐng)域,研究熱點(diǎn)之一便是編隊(duì)控制,主要策略有:圖論[3]、基于行為的控制策略[4]、虛擬領(lǐng)航者[5]、神經(jīng)網(wǎng)絡(luò)[6]和領(lǐng)航—跟隨控制策略[7]等。在上述幾種策略中,領(lǐng)航—跟隨控制策略具有控制結(jié)構(gòu)簡(jiǎn)單、可擴(kuò)展性好等優(yōu)勢(shì),因而得到了更加廣泛的應(yīng)用。該策略中,跟隨USV只需接收領(lǐng)航USV的動(dòng)態(tài)信息,便能夠?qū)崿F(xiàn)穩(wěn)定的編隊(duì)隊(duì)形。
領(lǐng)航—跟隨USV編隊(duì)控制系統(tǒng)中,其穩(wěn)定性將會(huì)受到復(fù)雜的外界環(huán)境擾動(dòng)影響(主要為水域環(huán)境中的風(fēng)、浪、涌等干擾),這給USV編隊(duì)的穩(wěn)定控制帶來(lái)了極大的困難?;?刂萍夹g(shù)因其具有較強(qiáng)的抗不確定性和抗擾性,已經(jīng)在隨機(jī)系統(tǒng)、剛體系統(tǒng)、海洋裝備等領(lǐng)域得到了較為廣泛的應(yīng)用[8]。常見(jiàn)的滑模技術(shù)主要有傳統(tǒng)的漸進(jìn)收斂滑模[9]、積分滑模[10-11]、終端滑模[12]、非奇異終端滑模[13-14]等。為了進(jìn)一步處理復(fù)雜的外界擾動(dòng),以前的研究主要采用了如非線性擾動(dòng)觀測(cè)器[15]、降維擾動(dòng)觀測(cè)器[16]等。近些年,有限時(shí)間擾動(dòng)觀測(cè)器(finite-time distribute observer, FDO)技術(shù)逐漸成為研究熱點(diǎn),Wang等[17-24]對(duì)FDO進(jìn)行了嘗試應(yīng)用,取得了顯著的成果。相比于傳統(tǒng)的擾動(dòng)觀測(cè)器,F(xiàn)DO能夠?qū)_動(dòng)實(shí)現(xiàn)快速、精確的辨識(shí)。但是,F(xiàn)DO技術(shù)在USV編隊(duì)控制領(lǐng)域鮮有應(yīng)用,具有潛在的研究?jī)r(jià)值。
在領(lǐng)航—跟隨USV編隊(duì)控制中,為了更好地保證編隊(duì)系統(tǒng)的響應(yīng)特性,收斂速率是首要考慮的控制指標(biāo)。早期的文獻(xiàn)針對(duì)一階多智能體系統(tǒng)的線性一致性拓?fù)?,提出了代?shù)連通圖的概念,并運(yùn)用漸進(jìn)收斂算法證明了其有效的收斂性[25]。然而,漸進(jìn)收斂算法存在收斂時(shí)間不可預(yù)測(cè)的不足,導(dǎo)致了系統(tǒng)穩(wěn)定性的不可預(yù)測(cè)。鑒于此,隨后的文獻(xiàn)更多采用有限時(shí)間收斂算法,求解單智能體或者多智能體編隊(duì)的收斂性問(wèn)題[26-28],該算法極大改善了以往算法的跟蹤精度和收斂速度。近幾年,作為有限時(shí)間算法的擴(kuò)展,固定時(shí)間控制算法逐漸被引入多智能體編隊(duì)控制領(lǐng)域。固定時(shí)間控制算法由Polyakov[29]首次提出,該算法能夠?qū)崿F(xiàn)有限時(shí)間收斂,并且其收斂時(shí)間的上界可以通過(guò)數(shù)學(xué)方法計(jì)算得到。Zuo等[30-32]在隨后的研究中分別運(yùn)用固定時(shí)間算法在一階、二階以及高階多智能體系統(tǒng)中進(jìn)行了嘗試應(yīng)用,證明了其具有更好的精準(zhǔn)性和收斂性。
基于此,本文將針對(duì)復(fù)雜擾動(dòng)下的領(lǐng)航—跟隨無(wú)人艇編隊(duì)系統(tǒng),提出基于固定時(shí)間的編隊(duì)控制策略。首先,設(shè)計(jì)基于積分滑模的固定時(shí)間跟蹤控制(ISM-FTC)策略,將其應(yīng)用于跟蹤控制子系統(tǒng)中;然后,引入基于有限時(shí)間擾動(dòng)觀測(cè)器的固定時(shí)間編隊(duì)控制(FDO-FFC)策略,將其應(yīng)用于編隊(duì)控制子系統(tǒng)中,對(duì)復(fù)雜擾動(dòng)下的領(lǐng)航—跟隨編隊(duì)系統(tǒng)進(jìn)行精確控制;接著,通過(guò)Lyapunov函數(shù)證明所設(shè)計(jì)控制器的理論可行性;最后,通過(guò)仿真實(shí)驗(yàn),驗(yàn)證所提出設(shè)計(jì)方法的可行性。
引理1:對(duì)于非線性系統(tǒng):
本文旨在設(shè)計(jì)一種固定時(shí)間編隊(duì)控制器,在固定時(shí)間內(nèi),控制器不僅能夠驅(qū)動(dòng)跟蹤控制子系統(tǒng)精確跟蹤期望的軌跡,且能夠驅(qū)動(dòng)編隊(duì)控制子系統(tǒng)快速形成期望的隊(duì)形并保持隊(duì)形,從而實(shí)現(xiàn)USV領(lǐng)航—跟隨編隊(duì)快速、精確的控制。
領(lǐng)航—跟隨編隊(duì)控制方案框圖如圖2所示,為保證編隊(duì)系統(tǒng)設(shè)計(jì)的整體性,將編隊(duì)系統(tǒng)劃分為跟蹤控制子系統(tǒng)和編隊(duì)控制子系統(tǒng),分別設(shè)計(jì)控制器,從而保證編隊(duì)系統(tǒng)的有效性。
圖 2 領(lǐng)航—跟隨編隊(duì)控制方案框圖Fig. 2 The block diagram of the leader-follower control scheme
設(shè)計(jì)跟蹤控制子系統(tǒng)控制器,從而保證編隊(duì)系統(tǒng)對(duì)期望軌跡的精確跟蹤,同時(shí)為編隊(duì)控制子系統(tǒng)提供控制輸入信號(hào)。
為了驗(yàn)證固定時(shí)間控制策略的有效性,利用經(jīng)典的Cybership II試驗(yàn)?zāi)P瓦M(jìn)行仿真實(shí)驗(yàn)。設(shè)計(jì)1艘領(lǐng)航USV和2艘跟隨USV組成編隊(duì)系統(tǒng),進(jìn)行仿真驗(yàn)證。
表 1 模型的初值Table 1 The initial values of the model
表 2 各參數(shù)的取值Table 2 The values of each parameter
仿真結(jié)果如圖3~圖12所示。圖3顯示了跟蹤控制子系統(tǒng)精確跟蹤的期望軌跡,可見(jiàn)編隊(duì)控制子系統(tǒng)能夠精確形成和維持領(lǐng)航—跟隨編隊(duì)隊(duì)形;圖4~圖5分別顯示了編隊(duì)系統(tǒng)的位置和速度跟蹤隨時(shí)間的變化曲線,可見(jiàn)在5 s內(nèi)各個(gè)維度完成了期望的任務(wù),并且收斂時(shí)間小于設(shè)定時(shí)間的上限;圖6~圖8分別顯示了領(lǐng)航USV和2個(gè)跟隨USV 的控制輸入隨時(shí)間的變化曲線,驗(yàn)證了控制器能夠在固定時(shí)間內(nèi)趨于穩(wěn)定;圖9~圖10分別顯示了2個(gè)跟隨USV的外界擾動(dòng)曲線以及FDO
圖 3 USV編隊(duì)軌跡圖Fig. 3 The trajectories of USV formation
圖 12 有限時(shí)間和固定時(shí)間方法對(duì)比(2)Fig. 12 The contrast of methods of finite-time and fixed-time (2)
本文針對(duì)領(lǐng)航—跟隨USV編隊(duì)系統(tǒng)在復(fù)雜環(huán)境擾動(dòng)下的控制問(wèn)題,結(jié)合積分滑模和反步控制技術(shù),提出了FTC策略。在跟蹤控制子系統(tǒng)中,設(shè)計(jì)了ISM-FTC控制器,使得領(lǐng)航USV精確跟蹤期望軌跡;在編隊(duì)控制子系統(tǒng)中,設(shè)計(jì)了FDOFFC控制器,使得跟隨USV精確保持對(duì)領(lǐng)航USV的相對(duì)位置,尤其是存在外界擾動(dòng)的情況下,仍然能夠確保穩(wěn)定的領(lǐng)航—跟隨USV編隊(duì)隊(duì)形。采用Lyapunov穩(wěn)定性理論,證明了閉環(huán)編隊(duì)控制系統(tǒng)的穩(wěn)定性。仿真結(jié)果表明,在復(fù)雜外界擾動(dòng)下,所設(shè)計(jì)的USV編隊(duì)控制系統(tǒng)能夠精準(zhǔn)跟蹤期望的軌跡并快速形成和保持期望的編隊(duì)隊(duì)形。本文設(shè)計(jì)的固定時(shí)間控制策略為USV編隊(duì)控制提供了新的設(shè)計(jì)方案。