李章俊 沈天怡 華嬌嬌 王婉雪

【摘要】災(zāi)害發(fā)生后廢墟空間環(huán)境復(fù)雜，通信中斷，大型搜救設(shè)備難以快速到達，搜救工作面臨諸多困難。本文介紹了一種基于WiFi技術(shù)的小型無線搜救機器人設(shè)計方案。該系統(tǒng)由具有WiFi功能的移動機器人和位于遠程的操作終端構(gòu)成，可以在沒有WiFi網(wǎng)絡(luò)或者3G網(wǎng)絡(luò)的區(qū)域，進行移動搜救，環(huán)境參數(shù)探測，視頻傳輸，數(shù)據(jù)傳輸和多機協(xié)同作業(yè)等多種功能。本文介紹了系統(tǒng)的硬件組成和軟件設(shè)計方案。移動機器人部分由微處理器控制模塊、底盤及設(shè)備運動驅(qū)動模塊、攝像頭及云臺控制模塊、無線模塊、環(huán)境參數(shù)感知模塊和電源模塊等組成。操作終端通過WiFi與機器人進行數(shù)據(jù)通信。實驗結(jié)果表明該機器人在無線網(wǎng)絡(luò)下的移動控制，數(shù)據(jù)及視頻傳輸有效。

【關(guān)鍵詞】搜救機器人;WiFi;數(shù)據(jù)采集;視頻傳輸;數(shù)據(jù)傳輸

引言

我國是世界上自然災(zāi)害最為嚴重的少數(shù)國家之一[1]，災(zāi)后救援中尤以地震救援最為復(fù)雜和危險。根據(jù)近幾年地震救援情況不難看出，由于地震發(fā)生后廢墟結(jié)構(gòu)極不穩(wěn)定，很容易對廢墟中的救援隊員造成危險。伴隨地震的還有爆炸，火災(zāi)，山體滑坡等等突發(fā)情況，救援工作困難重重。一部分傷亡在主震瞬間即刻發(fā)生，拯救生命，分秒必爭[2]。災(zāi)后的救援工作往往遇到廢墟極易坍塌，大型搜救設(shè)備無法快速到達，廢墟空間狹小且穩(wěn)定性差，存在有毒有害氣體等困難[3]。因此在危險及復(fù)雜環(huán)境下使用具有感知環(huán)境有害氣體、溫濕度等環(huán)境參數(shù)、感知生命信息，實現(xiàn)視頻回傳等功能，且行動平穩(wěn)，結(jié)構(gòu)穩(wěn)定，可遠程控制的搜救機器人具有重要的現(xiàn)實意義?？紤]受災(zāi)現(xiàn)場往往通信出現(xiàn)中斷等故障，搜救機器人盡量避免需要依靠外界通信設(shè)備，其本身就應(yīng)該具有通信功能。WiFi是目前廣泛采用的一種短距離無線通信協(xié)議[4]，具有成本低、使用方便等優(yōu)勢，可以接入因特網(wǎng)與各種終端進行數(shù)據(jù)傳送。

本文根據(jù)災(zāi)后救援中的各種問題，提出一種基于WiFi技術(shù)的小型無線搜救機器人設(shè)計方案。這種機器人體積較小，可以在狹小空間中自由移動，自帶無線通信設(shè)備，可以與遠在幾百米以外的搜救隊員進行視頻和數(shù)據(jù)交互，幫助搜救隊員掌握被困者位置和現(xiàn)場環(huán)境情況。搜救人員通過具有WiFi功能的操作終端（手持設(shè)備或PC機）連接和操縱機器人，根據(jù)回傳的視頻和環(huán)境數(shù)據(jù)進行實時分析，實時調(diào)整機器人的位置和行動情況，對搜救做出判斷。本文研究了搜救機器人的設(shè)計結(jié)構(gòu)，從硬件和軟件兩方面介紹了系統(tǒng)的設(shè)計，并給出了系統(tǒng)的測試結(jié)果。

1.系統(tǒng)框架設(shè)計

本系統(tǒng)由具有WiFi功能的移動機器人和位于遠程的操作終端構(gòu)成。移動機器人通過攝像裝置采集的現(xiàn)場視頻信息，搭載于機器人上的各種傳感器檢測到的環(huán)境參數(shù)，視頻和各種數(shù)據(jù)通過WiFi網(wǎng)絡(luò)傳送到操作終端。同時移動機器人接收操作終端發(fā)出的控制命令，調(diào)整機器人的運動狀態(tài)和攝像頭的位置，完成指定的任務(wù)。操作終端顯示當前的視頻和數(shù)據(jù)信息，通過對實時圖像和各類參數(shù)數(shù)據(jù)的分析，向機器人發(fā)出控制信號。移動機器人與操作終端之間應(yīng)用mipg、streamer，socket等技術(shù)，通過WiFi網(wǎng)絡(luò)實現(xiàn)數(shù)據(jù)的雙向通信，完成探測、搜救等任務(wù)。圖1為搜救機器人的系統(tǒng)結(jié)構(gòu)示意圖。

2.系統(tǒng)硬件設(shè)計

移動式機器人硬件主要包括處微理器模塊、底盤及設(shè)備運動驅(qū)動模塊、攝像頭及云臺控制模塊、無線模塊、環(huán)境參數(shù)感知模塊和電源模塊等幾部分構(gòu)成。

2.1 底盤及運動控制模塊

機器人底盤采用雙履帶式驅(qū)移動平臺，可以較好地適應(yīng)災(zāi)后復(fù)雜的地形變化，以提高機器人在非平坦地面上的越障能力和靈活性[5]。2個獨立的電機分別驅(qū)動車輪和履帶。為保證電源供電，采用雙電源供電形式。電源模塊1為可重復(fù)充電的移動電源，為微控器、攝像頭、WiFi模塊及傳感器提供DC5V電源。電源模塊2采用航模鋰電池，經(jīng)過LM2596穩(wěn)壓，將12V電壓降至9V電壓，為移動驅(qū)動模塊提供DC9V電源。

電機驅(qū)動采用恒壓恒流橋式2A驅(qū)動芯片L298N，驅(qū)動兩個直流電機。L298N接受標準TTL邏輯電平信號VSS，VSS可接4.5～7V電壓。4腳VS接電源電壓，VS電壓范圍VIH為+2.5～46V。L298可驅(qū)動2個電動機，OUT1，OUT2和OUT3，OUT4之間可分別接電動機，5，7，10，12腳接輸入控制電平，控制電機的正反轉(zhuǎn)。EnA，EnB接控制使能端，控制電機的停轉(zhuǎn)。微控器產(chǎn)生PMW信號可由微控器或操作終端根據(jù)機器人的現(xiàn)場環(huán)境情況調(diào)節(jié)和更改，當電機需要調(diào)速行駛時，就可以通過調(diào)用中斷函數(shù)實現(xiàn)正轉(zhuǎn)，反轉(zhuǎn)和左右差速轉(zhuǎn)彎的動態(tài)調(diào)速。電機驅(qū)動控制電路如圖2所示。

圖1 搜救機器人的系統(tǒng)結(jié)構(gòu)圖

2.2 攝像頭模塊及云臺控制模塊

視頻采集部分由高清網(wǎng)絡(luò)攝像頭和紅外攝像頭構(gòu)成?？紤]到災(zāi)后現(xiàn)場灰塵，煙霧，采光不好等干擾因素，光學攝像頭和紅外攝像頭同時捕捉現(xiàn)場圖像，增強黑暗情況下的圖像捕捉能力，提高對人體等生命信息的識別能力，幫助搜救隊員了解機器人前方路面情況，判別生命跡象。當機器人移動到特定位置時，云臺控制模塊工作，云臺由三自由度平臺和高度控制裝置構(gòu)成，通過PWM脈沖控制舵機轉(zhuǎn)向來調(diào)節(jié)攝像頭的上下高度位置，可以在360°內(nèi)自由旋轉(zhuǎn)，也可以小范圍調(diào)節(jié)攝像頭的仰角，控制攝像頭的攝像角度，實現(xiàn)多方位多角度的觀察。攝像頭如圖3所示。

圖3 攝像頭模塊

2.3 環(huán)境參數(shù)感知模塊

環(huán)境參數(shù)感知模塊主要包括溫濕度采集、煙霧探測和熱釋電紅外感應(yīng)等模塊。

溫濕度參數(shù)采集采用SH11溫濕度傳感器，它內(nèi)部將溫濕度傳感器、信號放大調(diào)理、A/D轉(zhuǎn)換、I2C總線接口集成于一個芯片內(nèi)，輸出為數(shù)字信號，傳送給微控器。

熱釋電紅外感應(yīng)模塊可以感知人體紅外信息，由熱釋電紅外傳感器P2288實現(xiàn)。P2288是一種能檢測人體發(fā)射的紅外線而輸出電信號的傳感器。當感測到人體熱釋紅外線的時候，P2288輸出端輸出一個很小的交流電流信號（約1.17毫安，0.3～10Hz的交流電流信號），經(jīng)放大、I/V變換和電壓比較后，輸入到微控器。

煙霧探測模塊由QM2實現(xiàn)，用于檢測現(xiàn)場是否還存在煙霧，判別結(jié)構(gòu)傳送到微控器。

微控器將感知模塊檢測到的環(huán)境參數(shù)通過WiFi傳送給操作終端并在終端上顯示，提供給搜救隊員以實時做出決策。

2.4 無線模塊

無線模塊負責構(gòu)建一個可以運行底層協(xié)議的局域網(wǎng)。處于局域網(wǎng)中的各種終端，通過WiFi聯(lián)網(wǎng)的移動機器人、通過以太網(wǎng)協(xié)議連網(wǎng)的上位機，都可在TCP/IP協(xié)議中的網(wǎng)絡(luò)層及其之上各層進行數(shù)據(jù)的傳輸。

本系統(tǒng)中WiFi無線模塊為GL.inet無線路由器，它具有150M無線速率，內(nèi)置DDNS，具有獨立訪問域名，經(jīng)Openwrt刷機后相當于一個Linux系統(tǒng)，支持連接USB攝像頭，應(yīng)用mipg.streamer，socket等可以很方便的實現(xiàn)PC機對移動機器人的控制。

WiFi模塊與微控器之間通過串口方式進行雙向數(shù)據(jù)通信，將攝像頭采集的視頻圖像以及檢測到的各種環(huán)境參數(shù)通過WiFi模塊傳送至控制終端。

3.軟件設(shè)計

軟件部分主要實現(xiàn)上位機與下位機的無線數(shù)據(jù)通信功能，上位機的操作界面，下位機與WiFi模塊之間的通信協(xié)議以及下位機的數(shù)據(jù)采集及狀態(tài)控制。

3.1 WiFi模塊部分

WiFi模塊實現(xiàn)構(gòu)建一個可以運行TCP/IP協(xié)議的局域網(wǎng)。移動機器人與操作終端通過WiFi進行視頻和各種檢測數(shù)據(jù)以及控制命令的互相傳送。本系統(tǒng)中無線通信采用TCP協(xié)議的Socket線程循環(huán)傳輸數(shù)據(jù)，具體過程如下：

機器人（服務(wù)器端）啟動守護進程創(chuàng)建套接字Socket，建立IP地址，監(jiān)聽有效Socket端口，調(diào)用accept函數(shù)從連接請求隊列中獲得連接信息，等待與操作終端（客戶端）建立連接。一旦連接成功，服務(wù)器端線程與客戶端進行數(shù)據(jù)通信，服務(wù)器根據(jù)不同的請求，做出相應(yīng)的處理，包括發(fā)送圖像及環(huán)境參數(shù)數(shù)據(jù)或接受控制命令?？蛻舳私邮軘?shù)據(jù)后，根據(jù)需要發(fā)送控制信號用來設(shè)置移動驅(qū)動信息給服務(wù)器端。數(shù)據(jù)通信完后關(guān)閉該線程，重新進入主線程循環(huán)建立發(fā)送線程。流程圖如圖5所示。

3.2 通訊協(xié)議包定義

由于單字符通信方式干擾較大，本系統(tǒng)下位機與上位機之間采用數(shù)據(jù)包格式傳送指令，包頭用0XFF，包尾用0XFF，無校驗位，以不同的類型位表示不同的控制或操作命令。上位機利用無線網(wǎng)卡通過Socket發(fā)送數(shù)據(jù)包到路由器，路由器通過解包機制把數(shù)據(jù)包解開，通過串口發(fā)送到單片機并通過控制模塊執(zhí)行相關(guān)操作。上位機和下位機接受到數(shù)據(jù)包后只需去掉包頭和包尾即可獲得相應(yīng)的指令信息。數(shù)據(jù)接收也是類似的方式。其協(xié)議規(guī)定如表1所示。

圖5 WITF通信流程圖

表1 通信協(xié)議包定義

圖6 視頻傳輸流程圖

3.3 視頻及環(huán)境參數(shù)數(shù)據(jù)傳送程序

當下位機接收上位機發(fā)送的需要傳送視頻或環(huán)境參數(shù)數(shù)據(jù)命令時，打開視頻設(shè)備，讀取設(shè)備信息，進行視頻采集，圖像傳送至上位機，流程如圖6所示。

3.4 上位機

上位機部分基于windows CE.net技術(shù)，采用Visual Studio 2010編寫C#上位機客戶端，首先利用編程器自帶的控件設(shè)置主視頻界面、按鈕和滾動條區(qū)域，再通過TCP/IP協(xié)議，創(chuàng)建Socket套接字的實例，對按鈕設(shè)置相應(yīng)的指令代碼。為保證數(shù)據(jù)發(fā)送的安全性和準確性，我們在每個數(shù)據(jù)包中設(shè)置0XFF的包頭和包尾，中間以6位16進制的數(shù)據(jù)位作為真實指令的內(nèi)容，分別控制機器人前后左右移動，舵機旋轉(zhuǎn)和各類傳感器的數(shù)據(jù)采集等。再通過connect的連接到路由器，以Send的方式向路由器發(fā)送Byte格式指令，當發(fā)送結(jié)束時，使用Close的方式釋放占用的資源。

3.5 下位機與WiFi的通信協(xié)議

WiFi模塊與微控器模塊之間通過串口進行數(shù)據(jù)通信，軟件部分主要設(shè)置串口通信的波特率、通信協(xié)議等，這里不再詳細論述。

4.系統(tǒng)運行實驗

經(jīng)試驗證明本搜救機器人的無線數(shù)據(jù)通信可達到50米，采用履帶式運z行機構(gòu)在復(fù)雜情況下具有較好的越障功能，運行穩(wěn)定可靠，實現(xiàn)了視頻回傳、環(huán)境參數(shù)檢測、遠程控制等功能，運行情況如圖7所示。

5.結(jié)束語

本文設(shè)計的一個WiFi小型搜救機器人實現(xiàn)了無線視頻傳輸，環(huán)境監(jiān)測，數(shù)據(jù)傳輸和多機協(xié)同作業(yè)等多種功能。采集的視頻、環(huán)境參數(shù)等信號可傳輸至任意可連接WiFi的上位機終端。因為WiFi無線模塊本身就是一個無線信號的發(fā)射源，所以即使在沒有WiFi網(wǎng)絡(luò)的區(qū)域仍可使用。當機器人與控制終端距離較遠或WiFi信號不足時，通過增加中繼節(jié)點，可以提高WiFi功率，提高傳輸距離。經(jīng)試驗證明，本系統(tǒng)可用于狹小空間內(nèi)的探測和搜救任務(wù)，完成環(huán)境參數(shù)檢測，地形勘測等任務(wù)，可以極大的減輕救援人員的負擔。

參考文獻

[1]孫祁祥，鄭偉，孫立明，等.中國巨災(zāi)風險管理：再保險的角色[J].財貿(mào)經(jīng)濟，2004（9）：3-10.

[2]易曉陽，劉學科.淺談地震救援衛(wèi)勤保障中應(yīng)把握的幾個重點[J].西南軍醫(yī)，2006，8.

[3]張策，趙國存，張國宏，等.地震廢墟搜救機器人控制系統(tǒng)開發(fā)與應(yīng)用[J].控制工程，2011，18（增刊）：76-77.

[4]杜毓聰，金連文.通過WiFi移動lP網(wǎng)絡(luò)操控家用機器人方案在PDA上的實現(xiàn)[J].計算機應(yīng)用，2009，29（7）：1865-1867.

[5]王鵬，李鑫，江文浩.地震搜救機器人構(gòu)型設(shè)計綜述[J].哈爾濱理工大學學報，2012（1）：15-19.

基金項目：本項目受河海大學常州校區(qū)2013年學生科技基金資助。

作者簡介：李章俊（1992—），男，貴州貴陽人，大學本科，研究方向：自動控制。