沈陽理工大學(xué)自動化與電氣工程學(xué)院 曹 帥 董慧穎
?
一款便攜式AUV的遙控裝置設(shè)計(jì)
沈陽理工大學(xué)自動化與電氣工程學(xué)院曹帥董慧穎
該文提出了一種基于MOOS-IvP結(jié)構(gòu)體系的便攜式AUV遙控裝置設(shè)計(jì)方案。該遙控裝置以樹莓派微型計(jì)算機(jī)為主控制器,游戲手柄為按鍵模塊,通過無線網(wǎng)橋?qū)崿F(xiàn)與AUV的通信,并由鋰電池經(jīng)過分壓模塊集中供電。軟件方面基于MOOS-IvP結(jié)構(gòu)體系,采用ubuntu操作系統(tǒng),并在code::block編譯環(huán)境下通過C語言編寫程序,完成遙控手柄按鍵數(shù)字信號的解析和控制指令的發(fā)送等功能。該遙控裝置實(shí)現(xiàn)了便攜式AUV的前進(jìn)、后退、轉(zhuǎn)彎、調(diào)速等遙控功能。實(shí)驗(yàn)表明該遙控裝置實(shí)現(xiàn)了設(shè)計(jì)目標(biāo),且性能良好。
MOOS-IVP;遙控裝置;AUV;樹莓派控制器
便攜式AUV代表了未來水下機(jī)器人技術(shù)的發(fā)展方向,是當(dāng)前世界各國研究工作的熱點(diǎn)[1]。傳統(tǒng)的AUV作業(yè)通過計(jì)算機(jī)與AUV航行控制計(jì)算機(jī)建立通信實(shí)現(xiàn)對AUV進(jìn)行控制。一方面,由于岸上計(jì)算機(jī)與AUV距離較遠(yuǎn),在AUV完成使命回收過程中,不能有效的確定水面航行環(huán)境的安全性,可能發(fā)生安全事故。另一方面,考慮到AUV能源的有限,要求AUV盡可能高效的返回以節(jié)省能源。針對以上情況,該文提出了一種基于樹莓派微型計(jì)算機(jī)的AUV遙控裝置設(shè)計(jì)方案,通過手持式遙控手柄實(shí)現(xiàn)對AUV的控制。該裝置可穩(wěn)定運(yùn)行于工作環(huán)境中,減少安全事故的發(fā)生,全面提升AUV的工作效率。
AUV遙控裝置的總體結(jié)構(gòu)如圖1所示,主要由手持式游戲手柄,樹莓派微型計(jì)算機(jī),無線網(wǎng)橋收發(fā)器等組成。遙控裝置的設(shè)計(jì)目標(biāo)為:遙控裝置根據(jù)按鍵決定AUV的運(yùn)行模式,通過無線發(fā)射接收裝置發(fā)射指令,并由AUV本體接收指令后實(shí)現(xiàn)相應(yīng)的啟動/停止、轉(zhuǎn)向和調(diào)速等操作。針對以上設(shè)計(jì)目標(biāo)遙控裝置分為按鍵模塊、控制器模塊、無線發(fā)射模塊及電源模塊等幾個(gè)模塊[2]。
2.1遙控手柄模塊
按鍵模塊由一個(gè)北通游戲手柄組成。主要包括四個(gè)方向鍵和六個(gè)按鈕鍵,通過usb接口與樹莓派控制器模塊進(jìn)行連接。四個(gè)方向鍵用來實(shí)現(xiàn)對AUV方向的控制,六個(gè)按鈕鍵所實(shí)現(xiàn)的功能分別包括啟動/停止按鍵、100轉(zhuǎn)/秒、200轉(zhuǎn)/秒、300轉(zhuǎn)/秒、400轉(zhuǎn)/秒四個(gè)速度檔位按鍵。
2.2控制器模塊
樹莓派是一款基于ARM的微型電腦主板,以SD卡為內(nèi)存硬盤,卡片主板周圍有40個(gè)GPIO引腳,四個(gè)USB接口和一個(gè)網(wǎng)口,可連接鍵盤、鼠標(biāo)和網(wǎng)線,同時(shí)擁有視頻模擬信號的電視輸出接口和HDMI高清視頻輸出接口[3],以上部件全部整合在一張僅比信用卡稍大的主板上,具備所有PC的基本功能。將裝有ubuntu操作系統(tǒng)的SD卡插入樹莓派的SD卡槽上,HDMI視頻輸出接口連接到顯示器,供電后即可自動啟動樹莓派圖形界面,并可在codeblocks編譯環(huán)境下進(jìn)行軟件程序編譯。
2.3通信模塊
由于一般遙控裝置的使用需要操作人員在橡皮艇上手動操作遙控裝置對AUV進(jìn)行控制,遙控的有效距離為300米-400米,故采用無線網(wǎng)橋進(jìn)行通信即可以滿足要求。無線網(wǎng)橋采用點(diǎn)對多點(diǎn)的通訊模式,實(shí)現(xiàn)AUV主控制倉與上位機(jī)和遙控裝置的通信。在這種模式下工作的所有AP設(shè)備都一樣,都選擇點(diǎn)對多點(diǎn)橋接模式,所有AP使用相同的SSID。各AP的IP地址位于同IP段,在信道設(shè)置上,點(diǎn)對多點(diǎn)橋接模式下的所有AP必須使用相同的信道[4]。
2.4電源模塊
遙控裝置采用12V、6A的鋰電池進(jìn)行供電。由于12V的供電電壓滿足無線網(wǎng)橋的工作電壓,可以通過鋰電池直接對其供電。而樹莓派的工作電壓為5V,可通過一個(gè)電壓轉(zhuǎn)換模塊將12V電壓轉(zhuǎn)換一路5V的電壓來對樹莓派進(jìn)行供電。
在整個(gè)AUV遙控裝置中,控制任務(wù)的最終實(shí)現(xiàn)是靠軟件程序完成的,程序設(shè)計(jì)的好壞,將直接決定整個(gè)遙控裝置的質(zhì)量和效率。程序設(shè)計(jì)的基本要求和原則主要是實(shí)時(shí)性、可靠性、簡潔性和易修改性?;谝陨显瓌t,設(shè)計(jì)了遙控裝置軟件部分。
3.1MOOS結(jié)構(gòu)體系
MOOS是一種分布式控制體系結(jié)構(gòu)。其核心思想是將水下機(jī)器人的不同子系統(tǒng)抽象為功能相對獨(dú)立的軟件模塊,為運(yùn)行在水下機(jī)器人上的各個(gè)軟件模塊提供一個(gè)統(tǒng)一、高效、穩(wěn)定的信息交互環(huán)境[5]。所有的信息交互以MOOSDB為中心,呈現(xiàn)星型通信結(jié)構(gòu),MOOSDB在整個(gè)體系結(jié)構(gòu)中處于核心地位,負(fù)責(zé)協(xié)調(diào)各種信息在不同模塊之間的交換。MOOSDB負(fù)責(zé)信息的統(tǒng)一分發(fā),從而保證了信息的一致性。每個(gè)基本功能抽象為一個(gè)獨(dú)立的模塊,功能模塊之間沒有直接的聯(lián)系,只能通過MOOSDB獲得運(yùn)算所必須的其他模塊的信息。IvP實(shí)質(zhì)上是一個(gè)MOOS進(jìn)程,它的主要功能是使用多目標(biāo)值最優(yōu)化的方式來實(shí)現(xiàn)行為的自主控制[6][7]。
3.2遙控裝置主程序
軟件程序設(shè)計(jì)在ubuntu操作系統(tǒng)的code::blocks開發(fā)環(huán)境下,采用C語言編程實(shí)現(xiàn)。遙控裝置的軟件程序主要完成遙控手柄的初始化和循環(huán)檢測按鍵是否按下[8],當(dāng)有按鍵按下時(shí),打開節(jié)點(diǎn)并判斷是何種類型按鍵,若為坐標(biāo)按鍵類型,將其設(shè)定為控制AUV方向的按鍵,再根據(jù)不同按鍵的不同數(shù)字信號值決定分別為上、下、左、右四個(gè)方向鍵;若為按鈕按鍵類型,則將其設(shè)定為啟動鍵、停止鍵和速度鍵。將各按鍵解析出來的數(shù)字信號映射成命令語句發(fā)射到主控制器的MOOSDB中。
3.3客戶端程序
為了實(shí)現(xiàn)用遙控裝置對AUV進(jìn)行控制,需要在主控制器中添加一個(gè)客戶端程序,用來訂閱打包發(fā)送到主控制器MOOSDB中的數(shù)據(jù),并解析成相應(yīng)的控制指令,最后發(fā)送給電機(jī)實(shí)現(xiàn)對AUV的控制。為了避免誤操作,只有先接收到啟動鍵指令其他按鍵指令才會對AUV起到控制作用。在控制AUV過程中,首先需要接收到方向鍵信息指令,再根據(jù)接收到的不同檔位速度信息指令控制AUV航行,若未接收到方向鍵指令則無論接收到何種速度指令均不執(zhí)行,很好的避免誤操的問題。
通過調(diào)試與試驗(yàn),由樹莓派、無線網(wǎng)橋、遙控手柄等硬件設(shè)備,ubuntu操作系統(tǒng),code::blocks編譯環(huán)境等軟件配置組成的便攜式AUV遙控裝置具有成本低,體積小,功耗低及性能穩(wěn)定等特點(diǎn)。該裝置可以實(shí)現(xiàn)對便攜式AUV的啟動、停止、前進(jìn)、后退、轉(zhuǎn)彎、調(diào)速等功能,在一定程度上提升了AUV的工作效率。
[1]蔣新松,封錫盛,王棣棠.水下機(jī)器人[M].沈陽:遼寧科學(xué)技術(shù)出版社,2000:304-311.
[2]吳立成,李霞麗,楊國勝等.一種水上行走機(jī)器人紅外遙控器的設(shè)計(jì)與實(shí)現(xiàn)[J].東南大學(xué)學(xué)報(bào)2013,43(z1).
[3]汪鑫,彭雨薇.基于樹莓派的網(wǎng)絡(luò)監(jiān)控系統(tǒng)的研究與實(shí)現(xiàn)[J].高科技產(chǎn)品研發(fā),2014,(14).
[4]范海英.無線網(wǎng)橋的應(yīng)用和安全[J].科技信息2010,(9).
[5]Paul M. Newman,“MOOS- A Mission Oriented Operating Suite,”MIT Department of Ocean Engineering, Tech. Rep. OE-2003-07,2003.
[6]M.R.Benjamin,“Interval Programming:A Multi-Objective Optimization Model for Autonomous Vehicle Control,” Ph.D. dissertation,Brown University, Providence, RI, May 2002.
[7]M.R.Benjamin, M. Ground, P.Newman,“Multi-objective Optimization of Sensor Quality with Efficient Marine Vehicle Task Execution,”in International Conference on Robotics and Automation(ICRA), Orlando,pp.3226-3232,2006.
[8]曹恒林.用JoyStick游戲手柄控制LED顯示屏視頻處理器及專用播放軟件[J].現(xiàn)代顯示2010,(11).