(天津工業(yè)大學(xué) 機(jī)械工程學(xué)院 天津 300387)

海洋環(huán)境的復(fù)雜性、不可預(yù)知性和滑翔機(jī)自身模型的非線性對水下滑翔機(jī)的路徑跟蹤控制提出了較高的要求。目前水下滑翔機(jī)路徑跟蹤控制的主要方法有自抗擾控制[1]、模型參考控制[2]、滑?？刂芠3]等?，F(xiàn)有文獻(xiàn)中針對滑翔機(jī)多目標(biāo)點(diǎn)直線路徑跟蹤問題的考慮較少。本文在現(xiàn)有研究基礎(chǔ)上，針對水下滑翔機(jī)進(jìn)行多直線目標(biāo)路徑跟蹤控制。

一、水下滑翔機(jī)動力學(xué)建模

水下滑翔機(jī)PETREL-II 200是中國海洋大學(xué)孫秀軍團(tuán)隊(duì)推出的淺海型混合驅(qū)動水下滑翔機(jī)，其坐標(biāo)系賦予如圖1所示?；铏C(jī)的動力學(xué)方程可以表達(dá)為

圖1 PETREL-II 200坐標(biāo)系賦予

二、LOS導(dǎo)航與滑?？刂破髟O(shè)計

(一)LOS導(dǎo)航設(shè)計

LOS導(dǎo)航是路徑跟蹤導(dǎo)航領(lǐng)域中應(yīng)用廣泛的一種導(dǎo)航方法，該導(dǎo)航方法將航跡跟蹤控制問題轉(zhuǎn)換成一系列航向跟蹤控制問題。

滑翔機(jī)當(dāng)前的位置點(diǎn)pc(xc,yc)由機(jī)載GPS傳感器獲取，目標(biāo)路徑由N個目標(biāo)點(diǎn)組成，滑翔機(jī)在跟蹤pkpk+1目標(biāo)路徑時，位置點(diǎn)pc(xc,yc)，pk(xk,yk)，pk+1(xk+1,yk+1)作為LOS導(dǎo)航系統(tǒng)的輸入，則

(二)滑?？刂破髟O(shè)計

定義滑翔機(jī)航向角誤差

針對滑翔機(jī)航向控制系統(tǒng)

其中，w(k)為過程噪聲，v(k)為測量噪聲，ψk+1為滑翔機(jī)實(shí)際航向輸出，f(*)與滑翔機(jī)動力學(xué)模型相關(guān)。結(jié)合滑翔機(jī)實(shí)際采樣與控制規(guī)律，控制方法采用基于趨近律的離散滑?？刂?。設(shè)定切換函數(shù)為

基于指數(shù)趨近律的離散趨近律為

s(k+1)=s(k)+T(-εsgn(s(k))-qs(k))

由公式(6)和(7)，得到控制律為

(三)路徑跟蹤控制

路徑跟蹤控制具體流程如圖2所示，目標(biāo)點(diǎn)位置信息與滑翔機(jī)當(dāng)前位置信息的差值作為控制系統(tǒng)的輸入，LOS導(dǎo)航算法得到滑翔機(jī)期望航向角，滑?？刂破鬏斎牖铏C(jī)航向信息和期望航向信息，以得到航向控制舵角輸出。

圖2 路徑跟蹤控制原理圖

三、實(shí)驗(yàn)與驗(yàn)證

(一)仿真實(shí)驗(yàn)

圖3 LOS導(dǎo)航控制軌跡

圖4 航向角

四、結(jié)論

(1)針對混合驅(qū)動水下滑翔機(jī)的非線性動力學(xué)模型和外界工作環(huán)境的隨機(jī)性，結(jié)合LOS導(dǎo)航提出水下滑翔機(jī)路徑跟蹤滑?？刂破?，該控制器能控制滑翔機(jī)實(shí)現(xiàn)穩(wěn)定可靠的路徑跟蹤控制。

(2)通過設(shè)計滑模切換面使航向控制系統(tǒng)在受到參數(shù)攝動和外界干擾時具有不變性，提高了滑翔機(jī)航向控制過程中的魯棒性和可靠性。

【參考文獻(xiàn)】

[1]萬磊，張英浩，孫玉山，等.欠驅(qū)動智能水下機(jī)器人的自抗擾路徑跟蹤控制[J].上海交通大學(xué)學(xué)報,2014,48(12):1727-1738.

[2]張廣潔，嚴(yán)衛(wèi)生，高劍.基于模型預(yù)測控制的欠驅(qū)動AUV直線路徑跟蹤[J].水下無人系統(tǒng)學(xué)報,2017,25(1):82-88.

[3]王璐，張利軍，王紅濱，等.非線性迭代滑模的欠驅(qū)動AUV路徑跟蹤控制[J].計算機(jī)工程與應(yīng)用,2011,47(27):239-242.

[4]孫秀軍.混合驅(qū)動水下滑翔器動力學(xué)建模及運(yùn)動控制研究[D].天津：天津大學(xué),2011.