文獻(xiàn)標(biāo)識(shí)碼: A
文章編號(hào): 0258-7998(2014)02-0132-03
隨著海洋資源開發(fā)向深遠(yuǎn)海的不斷推進(jìn),長(zhǎng)航程、多功能、智能化中大型無人水下航行器(UUV)成為水下救援機(jī)器人的一個(gè)非常重要的發(fā)展分支。中大型長(zhǎng)航程UUV在執(zhí)行長(zhǎng)距離的作業(yè)任務(wù)時(shí),海水密度的變化和任務(wù)載荷的變化是不可避免的,進(jìn)而打破了UUV的初始浮力平衡狀態(tài),改變了UUV的航行深度、浮心及重心位置。為了維持UUV的穩(wěn)定,通常采用3種方法來抵消密度及載荷改變所帶來變化: (1)利用水平舵所產(chǎn)生的舵效;(2)加裝垂向推進(jìn)裝置;(3)加裝可調(diào)壓載裝置。其中,方法(1)與方法(2)均需要長(zhǎng)時(shí)間消耗航行器能源以維持航速及垂向推力,對(duì)于以電池為主要?jiǎng)恿碓吹腢UV,這種長(zhǎng)時(shí)間的能量消耗會(huì)明顯縮短UUV的航程及任務(wù)壽命,其代價(jià)較高。方法(3)則只在密度和載荷發(fā)生變化時(shí),消耗一定的能量即可改變壓載裝置的重量或體積。與前兩種方法相比,方法(3)消耗能量較少,適合于以電池為主要?jiǎng)恿Φ腢UV使用,因而在國(guó)內(nèi)外得到了廣泛應(yīng)用。
根據(jù)調(diào)節(jié)手段的不同,可調(diào)壓載裝置分為油囊式和海水泵式兩種。油囊式浮力調(diào)節(jié)系統(tǒng)以液壓油為工作介質(zhì),通過向耐壓橡皮油囊抽取或泵入液壓油的方式改變UUV的排水量,達(dá)到浮力調(diào)節(jié)的目的。這種調(diào)節(jié)方式浮力調(diào)節(jié)精度高,但浮力調(diào)節(jié)范圍通常處于50L(50 kgf)之內(nèi),并且結(jié)構(gòu)比較復(fù)雜,適用于中小型作業(yè)型UUV。海水泵式浮力調(diào)節(jié)系統(tǒng)以海水作為工作介質(zhì),通過向耐壓艙內(nèi)泵入或抽出海水的方式改變UUV的重量,達(dá)到浮力調(diào)節(jié)的目的。這種調(diào)節(jié)系統(tǒng)的浮力調(diào)節(jié)范圍較大,可達(dá)數(shù)百升(數(shù)百千克力),同時(shí)安全可靠,不存在漏油風(fēng)險(xiǎn),屬于介質(zhì)友好型系統(tǒng),但系統(tǒng)的調(diào)節(jié)精度較低,同時(shí)對(duì)柱塞泵及海水管路的耐腐蝕性提出了較高的要求,適合于中大型長(zhǎng)航程UUV。目前國(guó)內(nèi)的浮力調(diào)節(jié)系統(tǒng)的研制起步于2000年左右,多集中于油囊式的浮力調(diào)節(jié)系統(tǒng)。2006年,中船重工第710研究所的谷軍等人研制了用于海洋監(jiān)測(cè)平臺(tái)的油氣囊組合式浮力調(diào)節(jié)系統(tǒng)[1],2007年,中科院沈陽(yáng)自動(dòng)化研究所的鄭榮等人研制了用于小型AUV上的油囊浮力調(diào)節(jié)系統(tǒng),除了可調(diào)節(jié)AUV的浮力外,還對(duì)AUV的縱傾與橫傾進(jìn)行調(diào)節(jié)[2]。2008年,華中科技大學(xué)的楊鋼等人研制了一種可工作于1 800 m的油囊式浮力調(diào)節(jié)系統(tǒng),其最大浮力調(diào)節(jié)能力為5 kgf[3]。2010年哈爾濱工程大學(xué)為自研的某水下機(jī)器人研制了一套油囊式浮力調(diào)節(jié)系統(tǒng),可提供21 kgf的調(diào)節(jié)能力[4]。上述公開文獻(xiàn)中所描述的浮力調(diào)節(jié)系統(tǒng)僅對(duì)用于中小型UUV的油囊式浮力調(diào)節(jié)系統(tǒng)進(jìn)行了研究,而對(duì)于中大型UUV的海水泵式浮力調(diào)節(jié)系統(tǒng)目前還未見國(guó)內(nèi)報(bào)道。
本文的目的是對(duì)應(yīng)用于中大型UUV的海水泵式浮力調(diào)節(jié)系統(tǒng)的構(gòu)成和控制方法進(jìn)行研究,得到了一種比較合理的設(shè)計(jì)方案,設(shè)計(jì)的原理樣機(jī)成功應(yīng)用于某大型長(zhǎng)航程UUV,并通過海試驗(yàn)證。
1 浮力自適應(yīng)調(diào)節(jié)系統(tǒng)總體結(jié)構(gòu)
浮力自適應(yīng)調(diào)節(jié)系統(tǒng)的總體結(jié)構(gòu)如圖1所示。UUV的艏部及艉部分別布置一套浮力調(diào)節(jié)機(jī)構(gòu),包括175 L水箱(內(nèi)含精密液位計(jì))、閥門、柱塞泵、海水管路及執(zhí)行控制器。主控制器的位置可根據(jù)結(jié)構(gòu)需要靈活調(diào)整。以艏部浮力調(diào)節(jié)機(jī)構(gòu)為例,柱塞泵為單向結(jié)構(gòu),海水的流動(dòng)方向?yàn)槟鏁r(shí)針。當(dāng)執(zhí)行控制器打開閥門A、D和電機(jī)M時(shí),艏部調(diào)節(jié)機(jī)構(gòu)處于排水狀態(tài),并在艏部產(chǎn)生正浮力;當(dāng)執(zhí)行控制器打開閥門B、C和電機(jī)M時(shí),艏部調(diào)節(jié)機(jī)構(gòu)處于進(jìn)水狀態(tài),在艏部產(chǎn)生負(fù)浮力。為了降低執(zhí)行機(jī)構(gòu)的響應(yīng)延遲時(shí)間,設(shè)計(jì)閥門為電磁閥門,耐壓≥6 MPa,響應(yīng)時(shí)間≤400 ms。電機(jī)采用了直流無刷電機(jī),最大功率為800 W,配合單向柱塞泵,單套調(diào)節(jié)機(jī)構(gòu)的最大調(diào)節(jié)速率為25 kgf/min。
浮力自適應(yīng)調(diào)節(jié)系統(tǒng)具有三種主要功能:自主下潛控制、自適應(yīng)密度補(bǔ)償及航行器姿態(tài)調(diào)整。自主下潛控制功能可使在水面靜止的UUV自主下潛至某一固定深度,并自主維持在此深度,直至UUV的舵機(jī)及推進(jìn)系統(tǒng)開始動(dòng)作。自適應(yīng)密度補(bǔ)償功能啟動(dòng)后,主控制器根據(jù)UUV上搭載的溫鹽深傳感器及國(guó)際海洋狀態(tài)方程計(jì)算當(dāng)前的海水密度,當(dāng)海水密度變化大于某一閾值時(shí)(原理樣機(jī)的閾值設(shè)置為10~3 g/cm3),主控制器計(jì)算出艏艉水箱的進(jìn)/排水質(zhì)量并發(fā)送相應(yīng)的執(zhí)行指令給艏艉執(zhí)行控制器單元,由艏艉執(zhí)行控制器控制相應(yīng)的閥門及電機(jī)動(dòng)作,完成自適應(yīng)密度補(bǔ)償。航行器姿態(tài)調(diào)整功能允許UUV的中央控制單元直接分別控制艏艉水艙的進(jìn)/排水動(dòng)作,以配合舵機(jī)完成UUV的姿態(tài)調(diào)整。
除了上述三種功能外,浮力自適應(yīng)調(diào)節(jié)系統(tǒng)還具備三種安全保護(hù)功能:水艙空?qǐng)?zhí)行保護(hù)、水艙滿執(zhí)行保護(hù)及控制艙漏水執(zhí)行保護(hù)。前兩種保護(hù)功能主要依賴于艏艉水艙內(nèi)置的精密液位計(jì)實(shí)現(xiàn),當(dāng)發(fā)現(xiàn)水艙即將全滿或全空時(shí)自動(dòng)停止調(diào)節(jié)機(jī)構(gòu)的進(jìn)/排水動(dòng)作,并向主控制器反饋相應(yīng)告警信息。漏水執(zhí)行保護(hù)則依賴于艏艉儀表艙內(nèi)的漏水傳感器,當(dāng)檢測(cè)到漏水時(shí),執(zhí)行控制器自動(dòng)向主控制器反饋漏水告警信息,并根據(jù)UUV中央控制單元的命令執(zhí)行相應(yīng)的動(dòng)作(例如可執(zhí)行排水動(dòng)作,實(shí)現(xiàn)緊急上浮)。
2 浮力自適應(yīng)調(diào)節(jié)系統(tǒng)控制器設(shè)計(jì)
考慮到大型UUV艏艉相距較遠(yuǎn)、結(jié)構(gòu)復(fù)雜且強(qiáng)電與弱電混合布置等特點(diǎn),浮力自適應(yīng)調(diào)節(jié)系統(tǒng)的控制器部分采用了2層控制結(jié)構(gòu):主控制器和執(zhí)行控制器,兩者間采用抗干擾能力較強(qiáng)的CAN總線[5-6]作為信息交互的通道。同時(shí)艏艉執(zhí)行控制器與電磁閥門、直流無刷電機(jī)之間的接口采用了光耦隔離措施,降低了大功率設(shè)備對(duì)控制器的干擾。圖2所示為控制器的結(jié)構(gòu)框圖。
2.1主控制器
主控制器以MSP430F5438A為核心CPU,內(nèi)含兩路CAN總線,分別對(duì)應(yīng)于UUV的中央控制單元和浮力調(diào)節(jié)系統(tǒng)的艏艉執(zhí)行控制器,同時(shí)預(yù)留了一個(gè)與UUV中央控制單元的RS485接口。其功能包括接收及解讀UUV中央控制單元發(fā)送的命令、執(zhí)行自主下潛控制算法、執(zhí)行自適應(yīng)密度補(bǔ)償算法、接收及解讀艏艉執(zhí)行控制器的反饋信息、發(fā)送自適應(yīng)浮力調(diào)節(jié)系統(tǒng)的狀態(tài)信息等。
主控制器使用的CPU為MSP430F5XX系列單片機(jī)沒有內(nèi)置CAN控制及收發(fā)模塊,因此使用Microchip公司的MCP2515作為CAN控制器,該控制器完全支持CAN V2.0B 技術(shù)規(guī)范,能發(fā)送接收標(biāo)準(zhǔn)和擴(kuò)展數(shù)據(jù)幀以及遠(yuǎn)程幀。自帶2個(gè)驗(yàn)收屏蔽寄存器和6個(gè)驗(yàn)收濾波寄存器,減少了主單片機(jī)(MCU)的開銷。與CPU的連接采用了SPI接口。CAN收發(fā)器則使用了隔離型收發(fā)器ISO1050,該器件為電流隔離式 CAN 收發(fā)器, 采用了二氧化硅隔離勢(shì)壘技術(shù),降低了傳輸時(shí)延并減少了外圍器件數(shù)量,可滿足或超過 ISO11898 標(biāo)準(zhǔn)的規(guī)格要求。當(dāng)與隔離式電源一起使用時(shí),可防止數(shù)據(jù)總線或其他電路上的噪聲電流進(jìn)入局部地干擾或損壞電路。
在主控制器端執(zhí)行的算法包括了密度值計(jì)算和自主下潛控制算法。密度值的計(jì)算主要依據(jù)國(guó)際海洋狀態(tài)方程,溫度、鹽度及深度信息由UUV的中央控制單元給出。自主下潛控制算法以UUV中央控制單元每5 s給出的深度值作為反饋信息,采用滑??刂频姆椒ㄓ?jì)算當(dāng)前艏艉水艙的進(jìn)排水量:
2.2執(zhí)行控制器
執(zhí)行控制器同樣采用了MSP430F5438A為核心的CPU,包含了1路CAN總線接口(與主控制器的CAN總線連接)、5路光耦輸出(分別連接閥門A、B、C、D及直流無刷電機(jī))、1路光耦輸入(連接漏水報(bào)警電路)及1路4~20 mA電流接收環(huán)路接口(連接水艙液位傳感器)。其功能包括:接收及執(zhí)行主控制器發(fā)送的執(zhí)行命令、反饋執(zhí)行控制器的狀態(tài)、液位傳感器信號(hào)處理及采集、動(dòng)作執(zhí)行保護(hù)、漏水報(bào)警檢測(cè)等。
在調(diào)節(jié)系統(tǒng)中,水艙內(nèi)的液位傳感器的誤差直接影響了調(diào)節(jié)誤差。為了盡可能地降低調(diào)節(jié)誤差,液位傳感器采用了磁傳感器,且精度達(dá)到0.05%。在UUV強(qiáng)弱混合的強(qiáng)干擾情況下,液位傳感器的輸出被強(qiáng)干擾噪聲污染,因此在執(zhí)行控制器端執(zhí)行了平均處理及液位升/降斜率限制2種算法,降低液位值抖動(dòng)和野值帶來的影響。
3 原理樣機(jī)聯(lián)調(diào)結(jié)果
根據(jù)前述的設(shè)計(jì)方案制作的調(diào)節(jié)系統(tǒng)原理樣機(jī)如圖3、圖4所示。圖5為現(xiàn)場(chǎng)調(diào)節(jié)系統(tǒng)控制器。
2012年3月,在某水庫(kù)對(duì)該浮力自適應(yīng)調(diào)節(jié)系統(tǒng)進(jìn)行了UUV搭載實(shí)驗(yàn),完成了自主下潛和姿態(tài)調(diào)整功能的湖上實(shí)驗(yàn)驗(yàn)證。自主下潛功能設(shè)定目標(biāo)深度分別為10 m、20 m、30 m,誤差均控制在2 m以內(nèi)。由水面下潛至30 m處所需時(shí)間約為800 s。2012年8月,浮力自適應(yīng)調(diào)節(jié)系統(tǒng)在某海域進(jìn)行了自主下潛和姿態(tài)調(diào)整功能的海上驗(yàn)證實(shí)驗(yàn)。由于受到海面風(fēng)浪的影響,當(dāng)自主下潛功能設(shè)定目標(biāo)深度為10 m、20 m、30 m時(shí),誤差控制在4 m以內(nèi),由水面下潛至30 m處并穩(wěn)定在此深度所需時(shí)間約為900 s。
參考文獻(xiàn)
[1] 谷軍.油氣囊組合式升降平臺(tái)技術(shù)[C].第五屆中國(guó)國(guó)際救撈論壇論文集,2008.
[2] 楊鋼,郭晨冰,李寶仁,等.浮力調(diào)節(jié)裝置實(shí)驗(yàn)研究[J].機(jī)床與液壓,2008,36(10):52-54.
[3] 鄭榮,常海龍.浮力調(diào)節(jié)系統(tǒng)在作業(yè)型AUV上的應(yīng)用研究[J].機(jī)器人技術(shù),2006,22(9-2):207-209.
[4] 李建明. 水下機(jī)器人浮力調(diào)節(jié)系統(tǒng)及其深度控制技術(shù)研究[D].哈爾濱:哈爾濱工業(yè)大學(xué), 2010.
[5] 丁忠林,劉堯猛,于秀麗.電梯控制系統(tǒng)CAN通信節(jié)點(diǎn)設(shè)計(jì)[J].微型機(jī)與應(yīng)用,2012,31(7):33-35.
[6] 趙永剛,張國(guó)義,劉曉霏,等. 基于CAN總線的大型殼體結(jié)構(gòu)分布式測(cè)量系[J].微型機(jī)與應(yīng)用,2013,32(9):71-73.