孫慶剛 ,鄭 榮 ,安家玉 ,楊 博 ,楊 斌
(1.中國(guó)科學(xué)院沈陽(yáng)自動(dòng)化研究所 機(jī)器人學(xué)國(guó)家重點(diǎn)實(shí)驗(yàn)室,遼寧 沈陽(yáng) 110016;2.中國(guó)科學(xué)院大學(xué),北京 100049)
隨著人類對(duì)海洋資源開(kāi)發(fā)利用的不斷加大,AUV(autonomous underwater vehicle)具有越來(lái)越廣泛的應(yīng)用前景,長(zhǎng)航時(shí)、低能耗是AUV的主要發(fā)展方向之一[1]。AUV的定深懸浮是無(wú)航速的深度和縱傾控制,能夠使AUV在某一深度實(shí)現(xiàn)無(wú)動(dòng)力懸停,達(dá)到虛擬錨泊,以便進(jìn)行長(zhǎng)時(shí)間的定點(diǎn)觀測(cè)[2]。AUV的定深懸浮可以通過(guò)艏、艉槽道推進(jìn)器和浮力調(diào)節(jié)系統(tǒng)兩種方式實(shí)現(xiàn)。依靠槽道推進(jìn)器實(shí)現(xiàn)定深具有動(dòng)態(tài)響應(yīng)快、結(jié)構(gòu)簡(jiǎn)單等優(yōu)點(diǎn),但是在定深過(guò)程中需要推進(jìn)器持續(xù)地工作,從而會(huì)消耗大量可貴的能源;依靠浮力調(diào)節(jié)實(shí)現(xiàn)定深能夠長(zhǎng)時(shí)間維持狀態(tài)穩(wěn)定,但是由于浮力改變需要一定的時(shí)間,導(dǎo)致動(dòng)態(tài)響應(yīng)較慢,同時(shí),浮力調(diào)節(jié)系統(tǒng)相比槽道推進(jìn)器,結(jié)構(gòu)相對(duì)復(fù)雜。依靠浮力調(diào)節(jié)系統(tǒng)定深相對(duì)于槽道推進(jìn)器方式,可減少用電量,增加了水下航行時(shí)間。因此,研究AUV基于浮力調(diào)節(jié)系統(tǒng)的定深懸浮具有重要的意義。
中科院沈陽(yáng)自動(dòng)化研究所鄭榮等提出了將浮力調(diào)節(jié)系統(tǒng)應(yīng)用于作業(yè)型AUV上,本文在此基礎(chǔ)上調(diào)整油囊的數(shù)量和分布,研究溫度對(duì)浮力調(diào)節(jié)系統(tǒng)的影響以及無(wú)模型定深控制策略等[3];韓志剛等人將無(wú)模型控制方法應(yīng)用于硝酸銨生產(chǎn)等大復(fù)雜時(shí)滯系統(tǒng)控制中,控制效果明顯優(yōu)于PID控制,本文借鑒其控制策略,將無(wú)模型控制方法應(yīng)用于AUV的定深懸浮控制[7-8]。
針對(duì)AUV的定深懸浮問(wèn)題,本文設(shè)計(jì)、開(kāi)發(fā)了一套浮力調(diào)節(jié)系統(tǒng)和定深懸浮控制程序,通過(guò)無(wú)模型反饋控制方法控制浮力調(diào)節(jié)單元,達(dá)到定深懸浮和實(shí)現(xiàn)姿態(tài)控制。湖上試驗(yàn)結(jié)果表明,設(shè)計(jì)的控制策略可以很好地實(shí)現(xiàn)AUV的定深懸浮。
浮力調(diào)節(jié)系統(tǒng)的基本原理:AUV浮力調(diào)節(jié)系統(tǒng)可分為容積式和重力式兩種。容積式浮力調(diào)節(jié)系統(tǒng)主要是在不改變AUV自身重量的條件下,改變AUV的排水體積使其浮力狀態(tài)發(fā)生變化,實(shí)現(xiàn)浮力調(diào)節(jié);重力式浮力調(diào)節(jié)系統(tǒng)主要是在不改變其排水體積的條件下,改變AUV自身的重量使其浮力狀態(tài)發(fā)生變化,實(shí)現(xiàn)浮力調(diào)節(jié)[3]。
本文采用的是容積式浮力調(diào)節(jié)系統(tǒng),由前后配置的兩個(gè)浮力調(diào)節(jié)單元組成。每個(gè)浮力調(diào)節(jié)單元在AUV的耐壓艙內(nèi)外各設(shè)置一個(gè)油囊,通過(guò)液壓回路實(shí)現(xiàn)內(nèi)、外油囊之間的傳油,液壓回路如圖1所示。液壓回路通過(guò)換向閥實(shí)現(xiàn)內(nèi)、外油囊之間的油量傳輸,所傳輸?shù)挠土客ㄟ^(guò)流量計(jì)獲得[4]。
當(dāng)油囊中的油液由內(nèi)油囊流向外油囊時(shí),AUV的重力不變,排水體積變大,浮力增加;反之重量不變,排水體積變小,浮力減小[5]。
圖1 浮力調(diào)節(jié)單元液壓系統(tǒng)原理圖
無(wú)模型控制理論與方法是指控制器的設(shè)計(jì)僅利用受控系統(tǒng)的I/O數(shù)據(jù),控制器中不包含受控過(guò)程教學(xué)模型的任何信息的控制理論與方法[6]。
無(wú)模型控制器是一種結(jié)構(gòu)自適應(yīng)控制器,打破了參數(shù)自適應(yīng)的限制,它的設(shè)計(jì)依賴的是“泛模型”:
式中:y(k)是系統(tǒng)的輸出;u(k)是系統(tǒng)的輸入;φ?(k)是特征參量;在此模型中能夠變化且實(shí)現(xiàn)自適應(yīng)的只有特征參量φ?(k),當(dāng)系統(tǒng)處于穩(wěn)定狀態(tài)時(shí),φ?(k)是 y(k)關(guān)于 u(k-1)的梯度。
無(wú)模型控制的控制規(guī)律為:
式中:α是小正常數(shù),限制了控制輸入的變化;ρ是控制的增益,也是靈敏度,它實(shí)際上是偏差y0-y(k)的放大或縮小倍數(shù),初始值一般取成1。
無(wú)模型控制律的基本算法是由“泛模型”式(1)的辨識(shí)算法和基本控制算法式(2)在線交互進(jìn)行而組成的,從而實(shí)現(xiàn)辨識(shí)與控制的一體化[7-8]。
在AUV入水后,調(diào)整AUV艏、艉外油囊的油量,使 AUV 處于負(fù)浮力狀態(tài),即:ΔB=B-P<0(B 為AUV浮力,P為AUV的重力),在此過(guò)程中,AUV以深度計(jì)作為反饋元件實(shí)時(shí)控制調(diào)整艏、艉外油囊的排油量以調(diào)整AUV在水中的姿態(tài),從而使AUV能夠在設(shè)定的深度實(shí)現(xiàn)定深懸浮,控制原理圖如圖2所示[9]。
圖2 定深控制策略原理圖
AUV定深懸浮的實(shí)現(xiàn)不僅需要控制AUV的深度,同時(shí)還需要調(diào)整AUV的姿態(tài)。如果只對(duì)深度進(jìn)行控制,由于水流的變化,或者外界環(huán)境因素的干擾,很可能會(huì)使AUV出現(xiàn)大的縱傾而下潛,從而無(wú)法實(shí)現(xiàn)定深懸浮,深度和縱傾角復(fù)合控制邏輯如圖3 所示[10]。
圖3 深度和縱傾角復(fù)合控制邏輯圖
在此控制中,理想的目標(biāo)深度誤差即為(2)式中的控制器設(shè)定值y,AUV在定深過(guò)程中的實(shí)際深度即為y(k),理想目標(biāo)深度即為系統(tǒng)輸入u(k),深度計(jì)實(shí)時(shí)反饋AUV的實(shí)際深度,控制器通過(guò)不斷控制浮力調(diào)節(jié)系統(tǒng)內(nèi)外油囊油量,使AUV在目標(biāo)深度誤差范圍內(nèi)實(shí)現(xiàn)定深。
浮力調(diào)節(jié)系統(tǒng)湖上試驗(yàn)的主要目的是驗(yàn)證浮力調(diào)節(jié)系統(tǒng)可靠性,溫度對(duì)流量的影響,定深控制策略以及控制程序可行性。
2016年12月在杭州千島湖進(jìn)行了湖上試驗(yàn),基于浮力調(diào)節(jié)系統(tǒng)的AUV是在在其艏艉配裝浮力調(diào)節(jié)艙段,浮力調(diào)節(jié)艙段的位置與原槽道推進(jìn)器位置相同,如圖4所示,AUV基本參數(shù)如表1。
表1AUV基本參數(shù)
圖4 AUV組成示意圖
環(huán)境水溫的大小、AUV工作時(shí)間的長(zhǎng)短、AUV的工作深度等會(huì)使浮力調(diào)節(jié)單元液壓系統(tǒng)內(nèi)油液的溫度發(fā)生變化,油液溫度等對(duì)浮力調(diào)節(jié)系統(tǒng)的排油量有很大的影響[11],液壓油的粘度對(duì)溫度的變化十分敏感,當(dāng)溫度升高時(shí),液壓油分子的內(nèi)聚力減小,會(huì)使其粘度變小[12]。
為實(shí)現(xiàn)良好的使命規(guī)劃,需要準(zhǔn)確掌握溫度與系統(tǒng)流量的對(duì)應(yīng)關(guān)系,圖5為不同溫度下對(duì)應(yīng)的浮力調(diào)節(jié)系統(tǒng)流量值,由此可知,隨著溫度的升高,浮力調(diào)節(jié)系統(tǒng)的流量不斷增大。通過(guò)所測(cè)得的溫度與流量對(duì)應(yīng)數(shù)據(jù)回歸出兩者之間的關(guān)系式為:
圖5 溫度與流量變化曲線
圖6為浮力調(diào)節(jié)系統(tǒng)在10.2℃下的流量變化曲線,圖7為浮力調(diào)節(jié)系統(tǒng)在14.6℃下的流量變化曲線。從兩種溫度下系統(tǒng)的流量變化曲線可以得知,溫度高時(shí),系統(tǒng)的流量會(huì)增大,但是流量均值與圖5顯示的值有所差別,這是因?yàn)锳UV在水下航行時(shí),深度會(huì)對(duì)浮力調(diào)節(jié)系統(tǒng)的流量大小產(chǎn)生一定的影響。
圖6 10.2℃下浮力調(diào)節(jié)系統(tǒng)流量
圖7 14.6℃下浮力調(diào)節(jié)系統(tǒng)流量
AUV在定深3 m,10 m的過(guò)程中,艏、艉浮力調(diào)節(jié)系統(tǒng)需要同時(shí)工作,通過(guò)內(nèi)、外油囊之間的傳油,調(diào)整AUV在水下的浮力狀態(tài),實(shí)現(xiàn)定深懸浮,圖8為定深3 m時(shí)AUV深度變化曲線;圖9為定深10 m時(shí)AUV深度變化曲線。
圖8 定深3 m時(shí)深度變化曲線
圖9 定深10 m時(shí)深度變化曲線
從定深3 m,10 m的深度變化曲線可以看出,定深3 m的過(guò)程中深度均值為3.20 m,均方差為0.45 m;定深10 m的過(guò)程中深度均值為10.40 m,均方差為0.40 m,兩種定深情況的誤差均在工程應(yīng)用允許的范圍之內(nèi),因?yàn)橄到y(tǒng)流量、水流等都會(huì)對(duì)AUV的姿態(tài)產(chǎn)生影響,同時(shí),由于AUV慣性大,從而影響定深的實(shí)現(xiàn),小的深度誤差不可避免。依靠無(wú)模型反饋控制能夠使AUV實(shí)現(xiàn)定深懸浮,滿足工程需要,但是在定深過(guò)程中艏艉浮力調(diào)節(jié)系統(tǒng)外油囊的油量一直在變化,還沒(méi)有達(dá)到最理想的效果,外油囊油量變化如圖10所示。
圖10 定深3 m時(shí)艏艉外油囊油量變化
湖上試驗(yàn)中,對(duì)配置槽道推進(jìn)器和浮力調(diào)節(jié)系統(tǒng)的AUV采用相同的控制方法分別進(jìn)行了定深懸停試驗(yàn)。試驗(yàn)結(jié)果表明浮力調(diào)節(jié)配置懸停精度低于槽道推進(jìn)器配置0.2 m左右,在工程允許范圍內(nèi)。
依靠浮力調(diào)節(jié)系統(tǒng)定深過(guò)程中主要的工作設(shè)備為液壓閥、電機(jī)和控制器;依靠槽道推進(jìn)器定深過(guò)程中主要的工作設(shè)備為推進(jìn)器和控制器。通過(guò)試驗(yàn)測(cè)得的這些設(shè)備的工作電壓電流等參數(shù),可以對(duì)比兩種定深方式的耗能情況,試驗(yàn)結(jié)果如表2所示。
表2 工作參數(shù)
由表2的相關(guān)數(shù)據(jù)可以得知,浮力調(diào)節(jié)系統(tǒng)所有工作設(shè)備的功率為120.96 W,小于槽道推進(jìn)器所有設(shè)備的功率194.4 W,因此,在相同的工作時(shí)間下,依靠浮力調(diào)節(jié)系統(tǒng)實(shí)現(xiàn)定深懸浮比依靠槽道推進(jìn)器更加節(jié)省能源。
本文主要討論了油囊式浮力調(diào)節(jié)系統(tǒng)、AUV定深懸浮、定深懸浮控制策略、溫度與流量關(guān)系以及湖上驗(yàn)證。湖上試驗(yàn)驗(yàn)證了油囊式浮力調(diào)節(jié)系統(tǒng)能夠取代槽道推進(jìn)器,AUV依靠艏、艉浮力調(diào)節(jié)系統(tǒng)能夠?qū)崿F(xiàn)定深懸浮,定深3 m的均方差為0.45 m,定深10 m的均方差為0.40 m,誤差均在合理范圍之內(nèi),滿足實(shí)際需要;同時(shí),通過(guò)試驗(yàn)可以驗(yàn)證溫度對(duì)浮力調(diào)節(jié)系統(tǒng)的流量具有一定的影響,為系統(tǒng)的工作提供了可靠的數(shù)據(jù)支持,具有很大的實(shí)用價(jià)值。
浮力調(diào)節(jié)系統(tǒng)相比槽道推進(jìn)器,可以一定程度上節(jié)約能源,符合AUV的發(fā)展方向,試驗(yàn)驗(yàn)證了依托浮力調(diào)節(jié)系統(tǒng)實(shí)現(xiàn)定深懸浮的可行性,對(duì)浮力調(diào)節(jié)系統(tǒng)的實(shí)用化具有很大的價(jià)值。從浮力調(diào)節(jié)單元外油囊油量變化曲線可以看到,此控制方法在實(shí)現(xiàn)定深的過(guò)程中仍在不斷地進(jìn)行油量調(diào)整,仍有繼續(xù)改進(jìn)和優(yōu)化的余地,在以后的工作中在滿足任務(wù)需求的基礎(chǔ)上,不斷優(yōu)化控制策略,最大限度地降低系統(tǒng)能耗,延長(zhǎng)工作時(shí)間,提高系統(tǒng)性能。
[1]蔣新松,封錫盛,王棣棠.水下機(jī)器人[M].遼寧:遼寧科學(xué)技術(shù)出版社,2000.
[2]齊宵強(qiáng).潛器懸浮運(yùn)動(dòng)模型及控制方法研究[D].哈爾濱:哈爾濱工程大學(xué),2008.
[3]鄭榮,常海龍.浮力調(diào)節(jié)系統(tǒng)在作業(yè)型AUV上的應(yīng)用研究[J].微計(jì)算機(jī)信息2006,22(9):207-212.
[4]Sekhar T,John D.A Variable Buoyancy Control System for a Large AUV[C]//IEEE Journal of Oceanic Engineering,2007,762-771.
[5]李建朋.水下機(jī)器人浮力調(diào)節(jié)系統(tǒng)及其深度控制技術(shù)研究[D].哈爾濱:哈爾濱工程大學(xué),2010.
[6]侯忠生.無(wú)模型自適應(yīng)控制的現(xiàn)狀與展望[J].控制理論與應(yīng)用,2006,23(4):586-592.
[7]薛荊巖,巫紅,韓志剛.無(wú)模型控制方法在復(fù)雜大時(shí)滯系統(tǒng)控制中的應(yīng)用研究[J].自動(dòng)化技術(shù)與應(yīng)用,2004,23(4):1-6.
[8] 薛荊巖,涂磊,韓志剛.無(wú)模型控制方法性能分析[J].控制工程,2009,16(5):531-534.
[9]王雨,鄭榮,武建國(guó).基于浮力調(diào)節(jié)系統(tǒng)的AUV深度控制研究[J].自動(dòng)化與儀表,專題研究(4):2015,6-10.
[10]張勛,邊信黔,唐旭東,等.AUV均衡系統(tǒng)設(shè)計(jì)及垂直面運(yùn)動(dòng)控制研究[J].中國(guó)造船,2012,53(1):28-36.
[11]趙文德,李建朋,張銘鈞,等.基于浮力調(diào)節(jié)的AUV升沉運(yùn)動(dòng)控制技術(shù)[J].南京航空航天大學(xué)學(xué)報(bào),2010,42(4):411-417.
[12]王榮林,殷勁松.基于液壓油油溫對(duì)液壓系統(tǒng)性能影響的研究[J].中國(guó)科技信息,2008,24:104.