李廣植，許林，張博

（南開大學(xué)機(jī)器人與信息自動化研究所，天津市智能機(jī)器人技術(shù)重點實驗室，天津 300071）

基于嵌入式Linux的微小型偵察機(jī)器人控制系統(tǒng)設(shè)計

李廣植，許林*，張博

（南開大學(xué)機(jī)器人與信息自動化研究所，天津市智能機(jī)器人技術(shù)重點實驗室，天津 300071）

摘 要:本文設(shè)計了一種基于嵌入式Linux的微小型偵察機(jī)器人控制系統(tǒng)。整個系統(tǒng)分為主控制器模塊、運(yùn)動執(zhí)行模塊、視覺模塊、無線通訊模塊和電源模塊。在S3C2440芯片上移植了Linux操作系統(tǒng)，開發(fā)了電機(jī)驅(qū)動程序，配置了MJPG-streamer視頻服務(wù)器，實現(xiàn)無線控制命令的傳輸和電機(jī)控制。用戶能夠在智能手機(jī)上查看目標(biāo)視頻，通過點擊視頻圖像中目標(biāo)點位置的方式對機(jī)器人發(fā)送控制命令。最后，通過實驗對系統(tǒng)功能和運(yùn)動精度進(jìn)行了測試。

關(guān)鍵詞:微小型偵察機(jī)器人；嵌入式Linux；無線通訊；電機(jī)控制

本文引用格式：李廣植，許林，張博.基于嵌入式Linux的微小型偵查機(jī)器人控制系統(tǒng)設(shè)計[J].新型工業(yè)化，2015，5(4)：11-17

0　引言

偵察機(jī)器人是指在危險場合以及人員不易進(jìn)入的場合中，能夠代替人類從事偵測、勘探、排險等工作的移動機(jī)器人。隨著機(jī)電、控制、傳感器等技術(shù)的飛速發(fā)展，各類偵察機(jī)器人正朝著智能化、微小化發(fā)展，應(yīng)用范圍擴(kuò)大到環(huán)境探測、偵測、救援、輔助作戰(zhàn)等多個方面。美國明尼蘇達(dá)大學(xué)分布式機(jī)器人實驗室在這方面進(jìn)行了大量研究，開發(fā)了以eROSI[1]為代表的一系列微小型偵察機(jī)器人。美國Recon Robotics公司研發(fā)的可拋投軍用微小型偵察機(jī)器人是美國海軍陸戰(zhàn)隊士兵的裝備之一。國內(nèi)的南京航空航天大學(xué)[2]、北京理工大學(xué)[3-4]和北京航空航天大學(xué)[5]等也在該領(lǐng)域做了深入研究。

微小型偵察機(jī)器人體積小、重量輕，其運(yùn)算能力和通信能力受到了限制，如何實現(xiàn)具有較好智能的微小型偵察機(jī)器人已經(jīng)成為研究熱點之一。目前的微小型偵察機(jī)器人為了滿足體積小、重量輕的特點，普遍采用單片機(jī)作為主控制芯片，存在處理數(shù)據(jù)有限、控制系統(tǒng)運(yùn)算速度低、人機(jī)交互方式單一等缺點。為此，本文設(shè)計了一種采用智能手機(jī)作為人機(jī)交互設(shè)備，基于嵌入式Linux的微小型偵察機(jī)器人控制系統(tǒng)。

嵌入式Linux是按照嵌入式操作系統(tǒng)的要求設(shè)計的小型操作系統(tǒng)。嵌入式Linux具有可裁剪、多線程、多任務(wù)的系統(tǒng)特征。與其他嵌入式操作系統(tǒng)相比，嵌入式Linux具有源代碼開放、易于移植、性能穩(wěn)定、支持多種嵌入式硬件、網(wǎng)絡(luò)功能強(qiáng)等優(yōu)點，更有利于偵察機(jī)器人的功能擴(kuò)展和任務(wù)級命令的實現(xiàn)。

本文的研究目的是設(shè)計和實現(xiàn)一種基于嵌入式Linux的微小型偵察機(jī)器人。該機(jī)器人具有雙輪驅(qū)動，圖像采集和無線遙控的能力，使用智能手機(jī)作為人機(jī)交互設(shè)備，具有較好的可擴(kuò)展性。

1　系統(tǒng)整體結(jié)構(gòu)

偵察機(jī)器人系統(tǒng)大體可以分為上位機(jī)和下位機(jī)兩部分，上位機(jī)為安卓智能手機(jī)，下位機(jī)為偵察機(jī)器人本體，兩者通過802.11g協(xié)議進(jìn)行無線通訊。系統(tǒng)結(jié)構(gòu)如圖1所示。

圖1　系統(tǒng)結(jié)構(gòu)Fig.1 The system structure

本文將下位機(jī)設(shè)置為Wifi熱點，上位機(jī)通過搜索下位機(jī)的Wifi網(wǎng)絡(luò)進(jìn)行無線連接，這種無線連接方式無需外部路由器，使偵察機(jī)器人結(jié)構(gòu)簡單、攜帶方便、連接快速。

偵察機(jī)器人本體采用兩輪獨立驅(qū)動結(jié)構(gòu)，由主控制器通過電機(jī)驅(qū)動器對電機(jī)進(jìn)行閉環(huán)的速度控制，通過霍爾傳感器計算位置和速度信息。

選用CMOS攝像頭作為獲取視頻數(shù)據(jù)的設(shè)備，在下位機(jī)中配置MJPG-streamer視頻服務(wù)器，上位機(jī)通過無線網(wǎng)絡(luò)連接到下位機(jī)后通過訪問服務(wù)器進(jìn)行視頻數(shù)據(jù)的獲取，在上位機(jī)中顯示視頻數(shù)據(jù)。

控制系統(tǒng)采用安卓智能手機(jī)作為人機(jī)交互設(shè)備，控制方式為用戶點擊上位機(jī)中顯示的視頻圖像，上位機(jī)計算用戶點擊位置對應(yīng)的實際地面位置，將地面目標(biāo)點對偵察機(jī)器人的相對坐標(biāo)作為控制命令發(fā)送到下位機(jī)。

2　控制系統(tǒng)硬件

下位機(jī)微小型偵察機(jī)器人的硬件部分主要由主控制器模塊，運(yùn)動執(zhí)行模塊，視覺模塊，無線通訊模塊以及電源模塊五部分組成，如圖2所示。

圖2　控制系統(tǒng)硬件結(jié)構(gòu)Fig.2 The hardware structure of control system

2.1主控制器模塊

本文選用可移植嵌入式Linux操作系統(tǒng)的S3C2440芯片作為主控制芯片，其采用ARM920T內(nèi)核，工作頻率400MHz，板載64MB SDRAM和256MB Nand Flash，具有豐富的硬件設(shè)備資源。

主控制器在整個機(jī)器人系統(tǒng)中處于核心地位，所有的模塊都由主控制器進(jìn)行控制。偵察機(jī)器人同時完成視頻數(shù)據(jù)、機(jī)器人狀態(tài)信息和控制命令的傳輸，主控制器需要有多任務(wù)的功能，兼顧運(yùn)算速度，網(wǎng)絡(luò)性能、體積和功耗等因素，選擇一種合適的主控制器對整個系統(tǒng)的影響至關(guān)重要。

2.2運(yùn)動執(zhí)行模塊

選用Maxon公司生產(chǎn)的EC 20 flat 5 Watt直流無刷電機(jī)、Maxon29/1減速器和DEC Module 24/2電機(jī)驅(qū)動器組成偵察機(jī)器人的運(yùn)動執(zhí)行模塊，設(shè)計外圍電路實現(xiàn)驅(qū)動器與電機(jī)和主控制器的連接。電機(jī)驅(qū)動器通過I/O引腳、PWM引腳與主控制器進(jìn)行通信。I/O引腳對應(yīng)電機(jī)的數(shù)字模式選擇，轉(zhuǎn)動方向以及使能位，通過修改PWM占空比實現(xiàn)對電機(jī)速度的控制。

2.3視覺模塊

視覺模塊的功能是圖像信息的采集和攝像頭光軸傾角的測量。選用CMOS攝像頭作為圖像信息采集設(shè)備，通過USB接口與主控制器連接。選用MPU6050加速度計作為光軸傾角測量裝置，將加速度計與攝像頭平行放置，通過測量靜止時與攝像頭光軸方向的重力加速度分量計算出攝像頭的光軸傾角，主控制器通過I2C總線獲取MPU6050的加速度數(shù)據(jù)。

2.4無線通訊模塊

無線通訊模塊使用的是LB-LINK無線網(wǎng)卡，采用802.11g通訊協(xié)議。802.11g協(xié)議工作在2.4GHz頻段，最高傳輸速率可達(dá)54Mbit/s。本文將無線網(wǎng)卡設(shè)置為Wifi熱點，這種無線連接方式無需外部路由器，使偵察機(jī)器人結(jié)構(gòu)簡單、攜帶方便、連接快速。

2.5電源模塊

選用鋰電池為機(jī)器人供電，電壓12V，容量3000mAh，尺寸為9cm×4.3cm×1.7cm。選用LM2596穩(wěn)壓模塊為機(jī)器人系統(tǒng)提供9V、5V以及3.3V的電壓輸出。

3　控制系統(tǒng)軟件

本文通過交叉編譯的模式對控制系統(tǒng)軟件進(jìn)行開發(fā)，選用的主機(jī)平臺為Red Hat 9.0虛擬機(jī)，交叉編譯器為arm-linux-gcc 4.1.2。

根據(jù)圖3中的嵌入式Linux系統(tǒng)的層次結(jié)構(gòu)可以將軟件系統(tǒng)分為Linux操作系統(tǒng)層，設(shè)備驅(qū)動程序?qū)右约坝脩魬?yīng)用層。根據(jù)軟件系統(tǒng)實現(xiàn)的功能，在用戶應(yīng)用層又可以分為MJPG-streamer服務(wù)器程序，無線通訊程序，電機(jī)控制程序，傾角測量程序。

圖3　Linux系統(tǒng)層次關(guān)系Fig.3 The relationship of Linux system layers

3.1嵌入式Linux操作系統(tǒng)的移植

根據(jù)嵌入式Linux操作系統(tǒng)的啟動過程可以將嵌入式Linux操作系統(tǒng)的移植分為Bootloader移植，Linux內(nèi)核移植和文件系統(tǒng)移植。

Bootloader作為嵌入式操作系統(tǒng)的引導(dǎo)程序，功能是初始化硬件設(shè)備，準(zhǔn)備軟件環(huán)境和調(diào)用操作系統(tǒng)內(nèi)核。本文選用u-boot作為系統(tǒng)的引導(dǎo)程序，實現(xiàn)Nand Flash啟動，引導(dǎo)zImage鏡像文件，支持yaffs文件系統(tǒng)。

Linux內(nèi)核是嵌入式Linux操作系統(tǒng)的核心部分，支持多種CPU架構(gòu)。本文選用較為成熟的Linux2.6.31版本，在進(jìn)行移植時修改內(nèi)核文件使內(nèi)核符合S3C2440芯片的ARM920T系統(tǒng)架構(gòu)。

本文選用yaffs文件系統(tǒng)作為嵌入式文件系統(tǒng)，適用于大容量的存儲設(shè)備，提供了損耗平衡和掉電保護(hù)，可以有效的避免意外掉電對文件系統(tǒng)一致性和完整性的影響。

3.2設(shè)備驅(qū)動程序開發(fā)

Linux操作系統(tǒng)將所有的設(shè)備都看作文件，以操作文件的方式訪問設(shè)備。由用戶編寫的應(yīng)用程序不能直接操作硬件，而是使用統(tǒng)一的接口函數(shù)調(diào)用硬件驅(qū)動程序 。這組接口被稱作系統(tǒng)調(diào)用，包括open、close、read、write等函數(shù)。Linux2.6.31版本內(nèi)核中含有V4L2攝像頭驅(qū)動、8192無線網(wǎng)卡驅(qū)動以及I2C總線驅(qū)動，本文主要對電機(jī)控制驅(qū)動進(jìn)行開發(fā)。

電機(jī)驅(qū)動程序中的函數(shù)可以分為接口函數(shù)和中斷函數(shù)兩部分。其中接口函數(shù)通過read、write等系統(tǒng)調(diào)用實現(xiàn)從應(yīng)用程序接收電機(jī)參數(shù)和向應(yīng)用程序提供電機(jī)信息的功能。中斷函數(shù)包括一個1ms的內(nèi)部中斷和兩個外部中斷，內(nèi)部中斷通過修改PWM引腳的寄存器，實現(xiàn)每1ms進(jìn)行一次電機(jī)的控制，外部中斷負(fù)責(zé)記錄兩個電機(jī)返回的霍爾傳感器脈沖數(shù)。

電機(jī)驅(qū)動程序的實現(xiàn)流程為：

1）通過write函數(shù)接收電機(jī)參數(shù)，包括左右電機(jī)轉(zhuǎn)速和方向；

2）根據(jù)電機(jī)參數(shù)在內(nèi)部中斷中修改PWM寄存器以及控制電機(jī)方向的I/O引腳寄存器；

3）根據(jù)外部中斷記錄的脈沖數(shù)每100次中斷計算一次電機(jī)轉(zhuǎn)速；

4）通過read函數(shù)將電機(jī)的轉(zhuǎn)速和記錄的脈沖數(shù)提供給用戶應(yīng)用程序。

3.3應(yīng)用程序開發(fā)

根據(jù)偵察機(jī)器人的功能可以將應(yīng)用程序分為MJPG-streamer服務(wù)器程序、無線通訊程序、電機(jī)控制程序、傾角測量程序根據(jù)程序中數(shù)據(jù)的共享情況將4個程序分成2個進(jìn)程。

MJPG-streamer服務(wù)器程序為視頻進(jìn)程，它是一個視頻服務(wù)器，需要很少的CPU和內(nèi)存資源就可以工作。本文在主機(jī)平臺上修改源碼，使用交叉編譯器編譯，獲得可執(zhí)行文件，配置偵察機(jī)器人無線網(wǎng)卡IP，通過安卓智能手機(jī)上的偵察機(jī)器人客戶端獲得視頻圖像。

電機(jī)進(jìn)程采用多線程技術(shù)分別創(chuàng)建無線通訊線程、電機(jī)控制線程和傾角測量線程，多線程并行處理。其程序流程如圖4。

圖4　應(yīng)用程序流程圖Fig.4 The flow chart of application program

無線通訊線程采用802.11g通訊協(xié)議將偵察機(jī)器人的無線網(wǎng)卡設(shè)置為熱點。8070端口作為控制命令的傳輸端口持續(xù)被監(jiān)聽將監(jiān)聽到的數(shù)據(jù)轉(zhuǎn)化為目標(biāo)點坐標(biāo)。在完成接收數(shù)據(jù)的任務(wù)后，將偵察機(jī)器人的運(yùn)動速度和攝像頭傾角信息返回給上位機(jī)。

本文中偵察機(jī)器人選擇直線路徑作為起始點到目標(biāo)點的移動路徑，如圖5所示，整個路徑分為三個階段：

圖5　偵察機(jī)器人移動路徑Fig.5 The moving path of recon robot

1）原地旋轉(zhuǎn)到目標(biāo)點方向；

2）直線移動到目標(biāo)點；

3）原地旋轉(zhuǎn)到初始方向。

電機(jī)控制線程首先對電機(jī)驅(qū)動器的數(shù)字模式和使能進(jìn)行初始化設(shè)置，然后讀取無線通訊線程獲得的目標(biāo)點坐標(biāo)。接收到目標(biāo)點后偵察機(jī)器人判斷當(dāng)前所處階段，通過write函數(shù)修改驅(qū)動中的電機(jī)轉(zhuǎn)速和轉(zhuǎn)動方向，通過read接口函數(shù)讀取的霍爾傳感器脈沖數(shù)來判斷階段是否完成，該階段完成后進(jìn)入下一階段，全部路徑完成后繼續(xù)讀取目標(biāo)點。

傾角測量線程通過I2C總線對MPU6050的寄存器的采樣頻率、地址等寄存器進(jìn)行初始化操作。本文由MPU6050的X軸重力分量計算出攝像頭光軸與水平方向夾角。由于受到機(jī)器人自身運(yùn)動加速度的影響，上位機(jī)在使用夾角數(shù)值時，只考慮靜止?fàn)顟B(tài)下的光軸傾角值。

在多個程序融合時根據(jù)數(shù)據(jù)的共享情況選擇多線程技術(shù)。將電機(jī)控制程序、傾角測量程序和無線通訊程序放在一個進(jìn)程下，可以有效的處理無線通訊程序調(diào)用數(shù)據(jù)的共享問題，使得程序的結(jié)構(gòu)清晰，且多線程并行處理，使CPU的使用效率提升，程序的運(yùn)行速度更快。

4　實驗和結(jié)果

本文對微小型偵察機(jī)器人控制系統(tǒng)進(jìn)行了實驗測試，包括上位機(jī)獲取機(jī)器人視頻信息和機(jī)器人狀態(tài)信息，上位機(jī)向機(jī)器人發(fā)送控制命令和偵察機(jī)器人的移動精度。

客戶端通過訪問機(jī)器人端MJPG-streamer服務(wù)器獲取視頻數(shù)據(jù)和機(jī)器人本體狀態(tài)信息，將其顯示在手機(jī)屏幕，如圖6為客戶端實現(xiàn)情況，偵察機(jī)器人系統(tǒng)可以有效的實現(xiàn)視頻圖像和機(jī)器人狀態(tài)信息的傳輸。

圖6　手機(jī)操作界面Fig.6 The operation interface of mobile phone

本文對偵察機(jī)器人的視頻數(shù)據(jù)傳輸時間進(jìn)行了測試，解碼時間為10~90ms，平均解碼時間為39.5ms，傳輸時間為70~460ms，平均傳輸時間為182.6ms，每幀圖像時間為120~500ms，平均每幀圖像時間為236ms，如圖7所示。

圖7　無線傳輸時間統(tǒng)計Fig.7 Time statistics of wireless transmission

用戶通過點擊屏幕上的地面位置指定目標(biāo)點坐標(biāo)，上位機(jī)將目標(biāo)點坐標(biāo)作為控制命令發(fā)送到機(jī)器人端，偵察機(jī)器人執(zhí)行控制命令運(yùn)動到目標(biāo)點。命令執(zhí)行情況如圖8，偵察機(jī)器人可以有效的移動到目標(biāo)點附近，移動的相對誤差小于2%。

圖8　目標(biāo)點坐標(biāo)與實際移動坐標(biāo)對比Fig.8 Comparison between the targets coordinates and actual coordinates

5　結(jié)論

本文設(shè)計一種基于嵌入式Linux操作系統(tǒng)的微小型偵察機(jī)器人控制系統(tǒng)，從用戶操作方式、硬件和軟件方面進(jìn)行了分析。本文提出的微小型偵察機(jī)器人系統(tǒng)具有體積小，重量輕，功能模塊化，接口豐富的特點?；谝曈X的用戶操作方式是任務(wù)級命令的實現(xiàn)，使得人機(jī)交互更簡潔明了。通過實驗測試了偵察機(jī)器人的移動精度，以及視頻數(shù)據(jù)和控制命令的傳輸能力。在此基礎(chǔ)上，S3C2440芯片豐富的外設(shè)接口為偵察機(jī)器人提供了強(qiáng)大的可擴(kuò)展性。

參考文獻(xiàn):

[1]Walter M, Anderson M, Burt I.The Design and Evolution of the ROSI Robot[J].Proceedings of the IEEE International Conference on Robotics and Automation, 2007: 2984-2989.

[2]陳 衛(wèi).微型便攜式偵察機(jī)器人設(shè)計與實現(xiàn)[D].南京航空航天大學(xué), 2009.

[3]鄭嫦娥, 黃 強(qiáng), 黃遠(yuǎn)燦.微小型自主偵察機(jī)器人控制系統(tǒng)設(shè)計[J].微計算機(jī)信息, 2008, 24(25): 6-7.Zheng Chang,e, Huang Qiang, Huang Yuancan.Design of The Control System for a Miniature Autonomous Surveillance Robot[J].CONTROL & AUTOMATION, 2008, 24(25): 6-7.

[4]Zhang L, Huang Q, Huang Y.Mechanical Designs and Control System of Throwable Miniature Reconnaissance Robot[A].Proceeding of the IEEE International Conference on Information and Automation[C].2011: 431-436.

[5]Gao H, Bi S, Zhang R.The Design of a Throwable Two-Wheeled Reconnaissance Robot[A].Proceedings of the 2012 IEEE International Conference on Robotics and Biomimetics[C].2012: 2150-2155.

[6]王文婧.基于ARM9的移動機(jī)器人系統(tǒng)設(shè)計[D].暨南大學(xué), 2013.

[7]趙九龍.基于嵌入式Linux系統(tǒng)的移動機(jī)器人無線控制技術(shù)[D].西安電子科技大學(xué), 2013.

[8]Min H J, Drenner A, Nikolaos Papanikolopoulos.Vision-based Leader-Follower Formations with Limited Information[A].Proceedings of IEEE International Conference on Robotics and Automation[C].2009: 351-356.

[9]劉建邦, 賴旭芝, 吳 敏, 等.嵌入式遙操作機(jī)器人系統(tǒng)設(shè)計[A].第27屆中國控制會議論文集[C].2008: 229-233.Liu Jianbang, Lai Xuzhi, Wu Min, et al.Design of Embedded Telerobotics System[A].Proceedings of the 27th Chinese Control Conference[C].2008: 229-233.

[10]陳曉鵬, 李成榮, 李功燕, 等.基于動力學(xué)模型的輪式移動機(jī)器人電機(jī)控制[J].機(jī)器人, 2008, 30(4): 326-332.CHEN Xiao-peng, LI Cheng-rong, LI Gong-yan, et al.Dynamic Model Based Motor Control for Wheeled Mobile Robots[J].ROBOT, 2008, 30(4): 326-332.

Design of Control System based on Embedded Linux for Micro Recon Robots

LI Guangzhi, XU Lin*, ZHANG Bo
(Institute of Robotics and Automatic Information System, Nankai University, Tianjin Key Laboratory of Intelligent Robotics, Tianjin 300071, China)

Abstract:This paper designs a control system based on embedded Linux for micro recon robots.In the system, the user sends control commands to the recon robots by clicking the screen of a smart phone.The robot system comprises the main controller module, the motion execution module, the vision module, the wireless communication module and the power supply module.Linux operating system is ported to S3C2440 processor to implement user application, motor driver development, MJPG-streamer video server configuration and wireless communication.The system functions and robot motion accuracy are verified by experiments.

Keywords:micro recon robots; embedded linux; wireless communication; motor control

DOI：10.3969/j.issn.2095-6649.2015.04.02

作者簡介：李廣植，男，碩士研究生；許林，男，博士，副教授；張博，男，碩士研究生。

*基金項目：此項工作得到國家自然科學(xué)基金資助，項目批準(zhǔn)號：61174019；機(jī)器人技術(shù)與系統(tǒng)國家重點實驗室資助，項目批準(zhǔn)號：SKLRS-2012-ZD-01。

Citation: LI Guangzhi, XU Lin, ZHANG Bo.Design of Control System based on Embedded Linux for Micro Recon Robots [J].The Journal of New Industrialization, 2015, 5(4): 11?17.