賈永興,，朱瑩,，楊宇

　?。ń夥跑娎砉ご髮W 通信工程學院,，江蘇 南京 210007）

　　摘要：設(shè)計并實現(xiàn)了一套功能高度集成的無線遙控機器人平臺，由履帶排爆機器人和手持控制終端組成,。機器人自身搭載的傳感器可以對環(huán)境狀態(tài)進行偵測,，并發(fā)送給手持終端。手持終端則遠程控制機器人的動作,，實現(xiàn)危險爆炸物的排除和危險有害環(huán)境的監(jiān)測,，防止人員遭受傷害。該平臺實現(xiàn)方案具有成本低,、體積小,、功耗低、可移植性和擴展性強等特點,。

　　關(guān)鍵詞：履帶式機器人,；手持終端；遠程控制,；危險環(huán)境

0引言

　　近年來,，各種恐怖活動日益猖獗，為了維護社會穩(wěn)定,，研究開發(fā)反恐防爆技術(shù)和裝備的需求越來越大,。在軍事上，危險環(huán)境時刻存在,，如何保證人員的安全,，有效地保證戰(zhàn)斗力，也是亟需解決的問題,。隨著智能控制技術(shù)和傳感器技術(shù)［1］的不斷更新發(fā)展,，用機器來代替人在危險環(huán)境下工作成為研究熱點［23］，得到國內(nèi)外的廣泛重視,。本文設(shè)計和制作完成了一款履帶式機器人和與之配套的手持控制終端,，手持終端根據(jù)機器人回傳的視頻和傳感器信息，通過遠程控制,，驅(qū)動機器人完成環(huán)境信息的偵測和危險爆炸物排除,。

1系統(tǒng)框架

　　系統(tǒng)包括履帶排爆機器人和手持控制終端兩大部分，總體設(shè)計框圖如圖1所示,。履帶機器人由視頻采集傳輸模塊,、機械模塊、環(huán)境信息感知模塊,、無線通信模塊以及控制模塊構(gòu)成,。首先控制模塊通過無線通信模塊獲取手持設(shè)備發(fā)送的控制命令，當命令是讀取命令時,，通過傳感器讀取各類環(huán)境參數(shù)信息,，然后通過無線通信模塊將各類環(huán)境參數(shù)信息發(fā)給控制終端顯示。當控制命令是動作命令時,，則根據(jù)接收的參數(shù)控制機器人運動或機械臂抓取爆炸物,。考慮到帶寬原因和控制方面的需求,，圖像傳輸模塊與行動控制使用不同的無線信道,。視頻采集傳輸模塊采集到圖像后直接交給無線路由器，傳送給手持設(shè)備,，其過程不受主處理器控制,。

　　手控控制終端由控制模塊、搖桿數(shù)據(jù)采集模塊,、顯示模塊及無線通信模塊構(gòu)成,。手控終端首先檢查是否有搖桿狀態(tài)改變，若有就將相應(yīng)控制信息進行編碼,，并交由無線通信模塊發(fā)送給機器人執(zhí)行,。同時終端還會按照固定頻率向機器人發(fā)送環(huán)境信息讀取命令，并顯示回傳的視頻信息和傳感器信息,。

2硬件設(shè)計

　　2.1手持控制終端

　　手持終端主控核心芯片為STM32F103zet6,，它基于CortexM3架構(gòu)，主頻為72 MHz,，有豐富的外設(shè)資源［4］,。設(shè)計中主要使用了其A/D接口、GPIO接口,、串口,、SPI接口。其中A/D接口和GPIO接口與搖桿模塊相連,，采集搖桿狀態(tài)信息,；串口與無線模塊相連，發(fā)送命令給無線模塊,，并讀取無線模塊接收的傳感器數(shù)據(jù),；SPI接口與液晶模塊相連，以顯示傳感器數(shù)據(jù)。

　　搖桿模塊主要完成對機器人機械動作的控制,，包括前進,、后退等底盤運動和機器臂、云臺等舵機運動,。搖桿模塊具有兩路模擬輸出,。一路按鈕數(shù)字輸出。當搖桿上下左右搖動時,，兩路模擬信號可以輸出不同的電壓值,，主控板根據(jù)通過采集電壓值判讀搖桿的運動情況，以控制機器人動作,。一路數(shù)字輸出主要用來判斷搖桿是否按下（類似按鍵）,。實現(xiàn)中采用了四個搖桿模塊，以控制機器人底盤,、機械臂和攝像頭云臺的動作,。搖桿的模擬輸出與主控板CPU的A/D接口相連，數(shù)字輸出和CPU的GPIO口相連,，以采集搖桿狀態(tài)信息,。

　　無線通信模塊主要完成手持終端和機器人之間的數(shù)據(jù)傳輸，包括手持設(shè)備控制命令的發(fā)送和接收機器人返回的傳感器信息,。實現(xiàn)中采用HC11 無線串口模塊,，通信頻率為433 MHz。硬件上與主控板CPU的串口相連,，工作于半雙工的模式,，比特率為9 600 b/s，頻道為001,。

　　為了遠程監(jiān)測機器人所處的環(huán)境信息,，實現(xiàn)中設(shè)計了兩個顯示模塊。一個用來實時顯示機器人采集回傳的圖像信息,，以便觀察環(huán)境和危險物的位置,，控制機器人的動作。另一個用來顯示接收到的傳感器信息,，以觀察機器人所處環(huán)境信息,。實現(xiàn)中圖像顯示采用了安裝有火狐瀏覽器的手機，也可以采用平板電腦或PC,，接收和顯示W(wǎng)iFi傳輸過來的圖像,。傳感器狀態(tài)信息的顯示采用了一個TFT液晶屏，它與CPU的SPI接口相連,，顯示傳感器數(shù)據(jù),。

　　2.2履帶機器人

　　機器人上的主控板同樣采用基于STM32F103的控制板。通過串口讀取來自無線手持設(shè)備的數(shù)據(jù)，并進行解析,，以判斷是機械操作命令還是讀取傳感器命令,。如果是機械操作命令，則將給驅(qū)動模塊發(fā)送相應(yīng)的命令,，驅(qū)動機器人動作,。如果是讀取傳感器命令，則采集傳感器數(shù)據(jù),，并交付給無線發(fā)送模塊，發(fā)送給手持設(shè)備,。

　　機械部分由機器人底盤,、機械臂、攝像頭云臺等部分構(gòu)成［5］,。機器人底盤由兩個直流電機驅(qū)動,，機械臂設(shè)計采用了五自由度結(jié)構(gòu)，由五個舵機和連接件構(gòu)成,，并在機械臂的前端設(shè)計了一個抓手,，完成升降、抓取,、釋放等動作,，攝像頭云臺采用三個舵機，用于調(diào)整攝像頭的位置,。機械驅(qū)動模塊由STC11F32XE單片機與外圍驅(qū)動電路構(gòu)成,，接收主控板串口發(fā)送的命令，以產(chǎn)生不同占空比的PWM波,，或改變I/O口的輸出方向,，驅(qū)動底盤完成機器人前進、后退,、左轉(zhuǎn),、右轉(zhuǎn)動作，控制舵機改變轉(zhuǎn)角配合機械臂和云臺動作,。

　　視頻采集和傳輸模塊主要采集機器人附近的圖像信息［6］,，并回傳給手持設(shè)備。視頻采集使用了羅技USB攝像頭,，將采集到的圖像數(shù)據(jù)交給無線WiFi路由器,，由路由器發(fā)送出去。無線路由器采用了TPLINK的150M無線路由器TLTLWR703N,，工作于無線AP模式,。通過更新組件，將簡單的無線路由器刷成openwrt，并通過網(wǎng)絡(luò)配置和安裝相應(yīng)的模塊,，使得USB攝像頭數(shù)據(jù)可以直接通過WiFi發(fā)送,。

　　無線通信模塊主要接收手持設(shè)備傳來的控制命令，交付給機器人主控板,，同時接收主控板交付的傳感器信息,，發(fā)送給手持終端。采用與手持設(shè)備同類型模塊,，與主控板的串口相連,，工作于半雙工的模式。

　　為了感知機器人所處的環(huán)境狀態(tài),，機器人上安裝了多種傳感器,，包括數(shù)字式三軸陀螺儀、溫濕度傳感器,、一氧化碳,、有害煙塵濃度、甲烷濃度傳感器,。數(shù)字陀螺儀用于檢測機器人行進時自身的平衡狀態(tài),，采用了高精度陀螺加速度計MPU6050模塊，與主控板CPU通過串口進行通信,，波特率為115 200 b/s,。該模塊內(nèi)部集成了姿態(tài)解算器，配合動態(tài)卡爾曼濾波算法,，能夠在動態(tài)環(huán)境下準確輸出模塊的當前姿態(tài),。通過該模塊發(fā)送至上位機的角度包，以了解機器人當前姿態(tài),。溫濕度傳感器數(shù)據(jù)輸出與主控板CPU的GPIO口相連,，采用單總線串行數(shù)據(jù)格式，一次通信傳輸5個字節(jié)數(shù)據(jù),，包括2字節(jié)溫度數(shù)據(jù),，2字節(jié)濕度數(shù)據(jù)，1字節(jié)校驗和,。有害煙塵,、甲烷、一氧化碳傳感器主要基于氣敏元件對不同類型,、不同濃度的氣體有不同的電阻值,，并以電壓的方式輸出，檢測物濃度越高輸出值越高,。實現(xiàn)中將這些傳感器與主控板CPU的A/D接口,，通過采樣電壓值,，來獲得相應(yīng)的氣體濃度。

3軟件設(shè)計

　　軟件代碼完成系統(tǒng)各部份的控制和通信,，在Keil集成環(huán)境下采用C語言編寫,，并通過編譯、鏈接后,，生成目標代碼,，通過下載器下載到STM32F103上運行。

　　為保證機器人和控制終端之間數(shù)據(jù)通信的有序性,，采用主從機的工作方式,，當機器人開機以后始終處于等待狀態(tài)，等待手持控制終端發(fā)來指令,。

　　3.1手持控制終端軟件設(shè)計

　　手控終端軟件工作具體流程如圖2所示,。通過循環(huán)讀取A/D通道的轉(zhuǎn)換值，以確定控制搖桿是否有移動,。如果有移動，就將各個通道數(shù)據(jù)編碼為統(tǒng)一的控制數(shù)據(jù)格式,，發(fā)送給機器人執(zhí)行,。如果沒有，則確認定時器是否到時,，如圖2手持設(shè)備端控制軟件流程

　　果時間到,，則向機器人發(fā)送傳感器數(shù)據(jù)讀取指令。收到應(yīng)答數(shù)據(jù)包后,，對數(shù)據(jù)包進行校驗,，如確認接收正確，則對數(shù)據(jù)包分析,，并將攜帶的傳感器信息顯示在液晶屏上,。

　　3.2履帶機器人端軟件設(shè)計

　　機器人軟件設(shè)計流程如圖3所示。通過讀取串口判斷是否收到手控終端的命令包,。如果收到數(shù)據(jù)包,，則解析命令是機械操作命令還是讀取傳感器命令。為了準確地定位到每個機械電機和舵機,，與手控終端搖桿狀態(tài)對應(yīng),，實現(xiàn)中對每個電機和舵機進行了編號，并作為命令參數(shù)由手控終端發(fā)送,。如果是讀取傳感器命令,，則將傳感器信息編碼打包，通過無線通信模塊發(fā)送給手控終端進行顯示,?！?/p>

4系統(tǒng)功能實現(xiàn)

　　首先打開機器人電源,，等待機器人各個部分完成初始化。此時打開手機（或PAD）會出現(xiàn)一個名為wifirobotlivking的WiFi熱點,，再打開火狐瀏覽器,，輸入預(yù)先設(shè)置的網(wǎng)址，可在瀏覽器中實時顯示機器人采集回傳的視頻,。接著打開機器人控制終端,，液晶屏上會顯示機器人所采集到的傳感器信息，包括機器人當前橫向及側(cè)向傾角,、機器人所處環(huán)境的溫濕度值,、有害煙塵濃度值等。根據(jù)回傳的實時視頻,，操作者移動手持終端上的搖桿,，可以通過無線方式遠距離遙控機器人前進、后退,、左轉(zhuǎn),、右轉(zhuǎn)等運動，同時控制機械臂抓取和釋放物體,，以及調(diào)整機器人安裝的攝像頭云臺轉(zhuǎn)角及俯仰角度確保最佳觀測位置,。

5結(jié)論

　　本文設(shè)計并實現(xiàn)了一套功能高度集成的無線遙控機器人平臺，實現(xiàn)對機器人的遠程操控,。通過機器人自身搭載的傳感器可以對目標環(huán)境參數(shù)進行監(jiān)測,，可進行危險爆炸物的排除和對危險有害環(huán)境的監(jiān)測。該方案具有成本低,、體積小,、功耗低、可移植性和擴展性強等特點,。下一步可以完善平臺控制軟件,，增加地址識別功能，實現(xiàn)控制多臺機器人的協(xié)同工作,，同時加入GPS導航功能,，使機器人能夠記住自己的位置與行進路線，有一定的自主性,，即使與手控端丟失聯(lián)系,，也能夠自主返回。

參考文獻

　?。?］ 秦志強．先進機器人傳感器技術(shù)［M］. 北京：電子工業(yè)出版社,，2010.

　　［2］ 莫海軍,，吳少煒．排爆機器人及相關(guān)技術(shù)［J］．機器人技術(shù)與應(yīng)用,， 2005(4)：31 36.

　?。?］ 范路橋，姚錫凡,，祁亨年．排爆機器人的研究現(xiàn)狀及其關(guān)鍵技術(shù)［J］．機床與液壓,， 2008，36(6)：139 143.

　?。?］ 彭剛,，秦志強．基于ARM CortexM3的STM32系列嵌入式微控制器應(yīng)用實踐［M］. 北京：電子工業(yè)出版社，2011.

　?。?］ 李健,，許旻，楊杰．排爆機器人手臂的研制及運動學分析［J］．機械與電子,，2009,，27(3)：66 69.

　　［6］ 范路橋,，姚錫凡,，蔣梁中，等．排爆機器人視頻圖像系統(tǒng)的研究與實現(xiàn)［J］．科學技術(shù)與工程 ,，2007,，7(19)：4904 4908.