《電子技術應用》
您所在的位置:首頁 > 嵌入式技術 > 設計應用 > 基于CAN通信的UUV浮力調(diào)節(jié)系統(tǒng)
基于CAN通信的UUV浮力調(diào)節(jié)系統(tǒng)
來源:電子技術應用2014年第2期
姚 嫚
(咸陽市公安消防支隊, 陜西 咸陽 712000)
摘要: 針對中大型長航程UUV的內(nèi)部強電磁干擾的特點及浮力姿態(tài)調(diào)節(jié)需求,給出了一種基于CAN通信的海水泵式浮力調(diào)節(jié)系統(tǒng)設計方案。采用CAN總線連接調(diào)節(jié)系統(tǒng)的主控制層和從執(zhí)行層,有效降低了強電磁干擾對調(diào)節(jié)系的影響。該系統(tǒng)具備自主下潛控制、自適應密度補償及航行器姿態(tài)調(diào)整三種功能。原理樣機搭載某大型UUV,并通過了全功能的試驗驗證。
中圖分類號: TP273.2
文獻標識碼: A
文章編號: 0258-7998(2014)02-0132-03
UUV buoyancy adaptive control system based on the CAN communication
Yao Man
Xianyang Municipal Detachment of Public Security of Fire Control,Xianyang 712000,China
Abstract: Aiming at the demand for medium and large long range UUV internal electromagnetic interference characteristics and buoyancy,this paper presents a CAN-based communication seawater pump buoyancy control system. The main control layer uses CAN bus to connec the control system and the execution level, which effectively reduces the effects of electromagnetic interference on the regulation system. The system has three functions, self-dive control, adaptive density compensation and aircraft attitude adjustment. The prototype is equipped with a large UUV, and passed the test to verify full functionality.
Key words : UUV; CAN; long-range; multi-function; intelligent

    隨著海洋資源開發(fā)向深遠海的不斷推進,長航程、多功能、智能化中大型無人水下航行器(UUV)成為水下救援機器人的一個非常重要的發(fā)展分支。中大型長航程UUV在執(zhí)行長距離的作業(yè)任務時,海水密度的變化和任務載荷的變化是不可避免的,進而打破了UUV的初始浮力平衡狀態(tài),改變了UUV的航行深度、浮心及重心位置。為了維持UUV的穩(wěn)定,通常采用3種方法來抵消密度及載荷改變所帶來變化: (1)利用水平舵所產(chǎn)生的舵效;(2)加裝垂向推進裝置;(3)加裝可調(diào)壓載裝置。其中,方法(1)與方法(2)均需要長時間消耗航行器能源以維持航速及垂向推力,對于以電池為主要動力來源的UUV,這種長時間的能量消耗會明顯縮短UUV的航程及任務壽命,其代價較高。方法(3)則只在密度和載荷發(fā)生變化時,消耗一定的能量即可改變壓載裝置的重量或體積。與前兩種方法相比,方法(3)消耗能量較少,適合于以電池為主要動力的UUV使用,因而在國內(nèi)外得到了廣泛應用。
 根據(jù)調(diào)節(jié)手段的不同,可調(diào)壓載裝置分為油囊式和海水泵式兩種。油囊式浮力調(diào)節(jié)系統(tǒng)以液壓油為工作介質(zhì),通過向耐壓橡皮油囊抽取或泵入液壓油的方式改變UUV的排水量,達到浮力調(diào)節(jié)的目的。這種調(diào)節(jié)方式浮力調(diào)節(jié)精度高,但浮力調(diào)節(jié)范圍通常處于50L(50 kgf)之內(nèi),并且結構比較復雜,適用于中小型作業(yè)型UUV。海水泵式浮力調(diào)節(jié)系統(tǒng)以海水作為工作介質(zhì),通過向耐壓艙內(nèi)泵入或抽出海水的方式改變UUV的重量,達到浮力調(diào)節(jié)的目的。這種調(diào)節(jié)系統(tǒng)的浮力調(diào)節(jié)范圍較大,可達數(shù)百升(數(shù)百千克力),同時安全可靠,不存在漏油風險,屬于介質(zhì)友好型系統(tǒng),但系統(tǒng)的調(diào)節(jié)精度較低,同時對柱塞泵及海水管路的耐腐蝕性提出了較高的要求,適合于中大型長航程UUV。目前國內(nèi)的浮力調(diào)節(jié)系統(tǒng)的研制起步于2000年左右,多集中于油囊式的浮力調(diào)節(jié)系統(tǒng)。2006年,中船重工第710研究所的谷軍等人研制了用于海洋監(jiān)測平臺的油氣囊組合式浮力調(diào)節(jié)系統(tǒng)[1],2007年,中科院沈陽自動化研究所的鄭榮等人研制了用于小型AUV上的油囊浮力調(diào)節(jié)系統(tǒng),除了可調(diào)節(jié)AUV的浮力外,還對AUV的縱傾與橫傾進行調(diào)節(jié)[2]。2008年,華中科技大學的楊鋼等人研制了一種可工作于1 800 m的油囊式浮力調(diào)節(jié)系統(tǒng),其最大浮力調(diào)節(jié)能力為5 kgf[3]。2010年哈爾濱工程大學為自研的某水下機器人研制了一套油囊式浮力調(diào)節(jié)系統(tǒng),可提供21 kgf的調(diào)節(jié)能力[4]。上述公開文獻中所描述的浮力調(diào)節(jié)系統(tǒng)僅對用于中小型UUV的油囊式浮力調(diào)節(jié)系統(tǒng)進行了研究,而對于中大型UUV的海水泵式浮力調(diào)節(jié)系統(tǒng)目前還未見國內(nèi)報道。
    本文的目的是對應用于中大型UUV的海水泵式浮力調(diào)節(jié)系統(tǒng)的構成和控制方法進行研究,得到了一種比較合理的設計方案,設計的原理樣機成功應用于某大型長航程UUV,并通過海試驗證。
1 浮力自適應調(diào)節(jié)系統(tǒng)總體結構
    浮力自適應調(diào)節(jié)系統(tǒng)的總體結構如圖1所示。UUV的艏部及艉部分別布置一套浮力調(diào)節(jié)機構,包括175 L水箱(內(nèi)含精密液位計)、閥門、柱塞泵、海水管路及執(zhí)行控制器。主控制器的位置可根據(jù)結構需要靈活調(diào)整。以艏部浮力調(diào)節(jié)機構為例,柱塞泵為單向結構,海水的流動方向為逆時針。當執(zhí)行控制器打開閥門A、D和電機M時,艏部調(diào)節(jié)機構處于排水狀態(tài),并在艏部產(chǎn)生正浮力;當執(zhí)行控制器打開閥門B、C和電機M時,艏部調(diào)節(jié)機構處于進水狀態(tài),在艏部產(chǎn)生負浮力。為了降低執(zhí)行機構的響應延遲時間,設計閥門為電磁閥門,耐壓≥6 MPa,響應時間≤400 ms。電機采用了直流無刷電機,最大功率為800 W,配合單向柱塞泵,單套調(diào)節(jié)機構的最大調(diào)節(jié)速率為25 kgf/min。

    浮力自適應調(diào)節(jié)系統(tǒng)具有三種主要功能:自主下潛控制、自適應密度補償及航行器姿態(tài)調(diào)整。自主下潛控制功能可使在水面靜止的UUV自主下潛至某一固定深度,并自主維持在此深度,直至UUV的舵機及推進系統(tǒng)開始動作。自適應密度補償功能啟動后,主控制器根據(jù)UUV上搭載的溫鹽深傳感器及國際海洋狀態(tài)方程計算當前的海水密度,當海水密度變化大于某一閾值時(原理樣機的閾值設置為10~3 g/cm3),主控制器計算出艏艉水箱的進/排水質(zhì)量并發(fā)送相應的執(zhí)行指令給艏艉執(zhí)行控制器單元,由艏艉執(zhí)行控制器控制相應的閥門及電機動作,完成自適應密度補償。航行器姿態(tài)調(diào)整功能允許UUV的中央控制單元直接分別控制艏艉水艙的進/排水動作,以配合舵機完成UUV的姿態(tài)調(diào)整。
 除了上述三種功能外,浮力自適應調(diào)節(jié)系統(tǒng)還具備三種安全保護功能:水艙空執(zhí)行保護、水艙滿執(zhí)行保護及控制艙漏水執(zhí)行保護。前兩種保護功能主要依賴于艏艉水艙內(nèi)置的精密液位計實現(xiàn),當發(fā)現(xiàn)水艙即將全滿或全空時自動停止調(diào)節(jié)機構的進/排水動作,并向主控制器反饋相應告警信息。漏水執(zhí)行保護則依賴于艏艉儀表艙內(nèi)的漏水傳感器,當檢測到漏水時,執(zhí)行控制器自動向主控制器反饋漏水告警信息,并根據(jù)UUV中央控制單元的命令執(zhí)行相應的動作(例如可執(zhí)行排水動作,實現(xiàn)緊急上浮)。
2 浮力自適應調(diào)節(jié)系統(tǒng)控制器設計
    考慮到大型UUV艏艉相距較遠、結構復雜且強電與弱電混合布置等特點,浮力自適應調(diào)節(jié)系統(tǒng)的控制器部分采用了2層控制結構:主控制器和執(zhí)行控制器,兩者間采用抗干擾能力較強的CAN總線[5-6]作為信息交互的通道。同時艏艉執(zhí)行控制器與電磁閥門、直流無刷電機之間的接口采用了光耦隔離措施,降低了大功率設備對控制器的干擾。圖2所示為控制器的結構框圖。

 

2.1主控制器
    主控制器以MSP430F5438A為核心CPU,內(nèi)含兩路CAN總線,分別對應于UUV的中央控制單元和浮力調(diào)節(jié)系統(tǒng)的艏艉執(zhí)行控制器,同時預留了一個與UUV中央控制單元的RS485接口。其功能包括接收及解讀UUV中央控制單元發(fā)送的命令、執(zhí)行自主下潛控制算法、執(zhí)行自適應密度補償算法、接收及解讀艏艉執(zhí)行控制器的反饋信息、發(fā)送自適應浮力調(diào)節(jié)系統(tǒng)的狀態(tài)信息等。
    主控制器使用的CPU為MSP430F5XX系列單片機沒有內(nèi)置CAN控制及收發(fā)模塊,因此使用Microchip公司的MCP2515作為CAN控制器,該控制器完全支持CAN V2.0B 技術規(guī)范,能發(fā)送接收標準和擴展數(shù)據(jù)幀以及遠程幀。自帶2個驗收屏蔽寄存器和6個驗收濾波寄存器,減少了主單片機(MCU)的開銷。與CPU的連接采用了SPI接口。CAN收發(fā)器則使用了隔離型收發(fā)器ISO1050,該器件為電流隔離式 CAN 收發(fā)器, 采用了二氧化硅隔離勢壘技術,降低了傳輸時延并減少了外圍器件數(shù)量,可滿足或超過 ISO11898 標準的規(guī)格要求。當與隔離式電源一起使用時,可防止數(shù)據(jù)總線或其他電路上的噪聲電流進入局部地干擾或損壞電路。
     在主控制器端執(zhí)行的算法包括了密度值計算和自主下潛控制算法。密度值的計算主要依據(jù)國際海洋狀態(tài)方程,溫度、鹽度及深度信息由UUV的中央控制單元給出。自主下潛控制算法以UUV中央控制單元每5 s給出的深度值作為反饋信息,采用滑模控制的方法計算當前艏艉水艙的進排水量:

2.2執(zhí)行控制器
    執(zhí)行控制器同樣采用了MSP430F5438A為核心的CPU,包含了1路CAN總線接口(與主控制器的CAN總線連接)、5路光耦輸出(分別連接閥門A、B、C、D及直流無刷電機)、1路光耦輸入(連接漏水報警電路)及1路4~20 mA電流接收環(huán)路接口(連接水艙液位傳感器)。其功能包括:接收及執(zhí)行主控制器發(fā)送的執(zhí)行命令、反饋執(zhí)行控制器的狀態(tài)、液位傳感器信號處理及采集、動作執(zhí)行保護、漏水報警檢測等。
    在調(diào)節(jié)系統(tǒng)中,水艙內(nèi)的液位傳感器的誤差直接影響了調(diào)節(jié)誤差。為了盡可能地降低調(diào)節(jié)誤差,液位傳感器采用了磁傳感器,且精度達到0.05%。在UUV強弱混合的強干擾情況下,液位傳感器的輸出被強干擾噪聲污染,因此在執(zhí)行控制器端執(zhí)行了平均處理及液位升/降斜率限制2種算法,降低液位值抖動和野值帶來的影響。
3 原理樣機聯(lián)調(diào)結果
    根據(jù)前述的設計方案制作的調(diào)節(jié)系統(tǒng)原理樣機如圖3、圖4所示。圖5為現(xiàn)場調(diào)節(jié)系統(tǒng)控制器。

 

 

    2012年3月,在某水庫對該浮力自適應調(diào)節(jié)系統(tǒng)進行了UUV搭載實驗,完成了自主下潛和姿態(tài)調(diào)整功能的湖上實驗驗證。自主下潛功能設定目標深度分別為10 m、20 m、30 m,誤差均控制在2 m以內(nèi)。由水面下潛至30 m處所需時間約為800 s。2012年8月,浮力自適應調(diào)節(jié)系統(tǒng)在某海域進行了自主下潛和姿態(tài)調(diào)整功能的海上驗證實驗。由于受到海面風浪的影響,當自主下潛功能設定目標深度為10 m、20 m、30 m時,誤差控制在4 m以內(nèi),由水面下潛至30 m處并穩(wěn)定在此深度所需時間約為900 s。
參考文獻
[1] 谷軍.油氣囊組合式升降平臺技術[C].第五屆中國國際救撈論壇論文集,2008.
[2] 楊鋼,郭晨冰,李寶仁,等.浮力調(diào)節(jié)裝置實驗研究[J].機床與液壓,2008,36(10):52-54.
[3] 鄭榮,常海龍.浮力調(diào)節(jié)系統(tǒng)在作業(yè)型AUV上的應用研究[J].機器人技術,2006,22(9-2):207-209.
[4] 李建明. 水下機器人浮力調(diào)節(jié)系統(tǒng)及其深度控制技術研究[D].哈爾濱:哈爾濱工業(yè)大學, 2010.
[5] 丁忠林,劉堯猛,于秀麗.電梯控制系統(tǒng)CAN通信節(jié)點設計[J].微型機與應用,2012,31(7):33-35.
[6] 趙永剛,張國義,劉曉霏,等. 基于CAN總線的大型殼體結構分布式測量系[J].微型機與應用,2013,32(9):71-73.

此內(nèi)容為AET網(wǎng)站原創(chuàng),未經(jīng)授權禁止轉(zhuǎn)載。