一種基于STM32的石化移動(dòng)作業(yè)機(jī)器人研制方法*

柯文德，陳揚(yáng)鑫，莊燦宇，姚秋平

（廣東石油化工學(xué)院計(jì)算機(jī)與電子信息學(xué)院，廣東茂名525000）

一種基于STM32的石化移動(dòng)作業(yè)機(jī)器人研制方法*

柯文德，陳揚(yáng)鑫，莊燦宇，姚秋平

（廣東石油化工學(xué)院計(jì)算機(jī)與電子信息學(xué)院，廣東茂名525000）

研制了一種石化移動(dòng)作業(yè)機(jī)器人，以STM32F103ZET6為核心控制器，搭載了紅外測(cè)距模塊、帶編碼器直流電機(jī)及驅(qū)動(dòng)模塊、攝像頭實(shí)時(shí)傳輸模塊、電子陀螺儀和加速度傳感器等，具有自主避障、調(diào)時(shí)預(yù)定、移動(dòng)模式控制等功能。機(jī)器人具有多種移動(dòng)方式，能自主構(gòu)建環(huán)境地圖和實(shí)時(shí)監(jiān)控，可通過(guò)Wireless Fidelity無(wú)線傳輸模塊將監(jiān)控視頻傳輸?shù)浇K端供決策。實(shí)驗(yàn)驗(yàn)證了設(shè)計(jì)的有效性。

石化；機(jī)器人；移動(dòng)；通信

0 引言

石油化工行業(yè)的生產(chǎn)過(guò)程具有高溫高壓、易燃易爆、有毒有害等特點(diǎn)，在其工藝流程中會(huì)釋放和產(chǎn)生各種有毒化學(xué)物質(zhì)，對(duì)職工身體健康造成較大危害。為提高生產(chǎn)安全性和工作效率，在石化廠區(qū)逐步引入了智能機(jī)器人開展作業(yè)［1－2］。輪式移動(dòng)機(jī)器人是在石化作業(yè)環(huán)境中較常用的機(jī)器人，主要涉及機(jī)電一體化、控制器、傳感器、計(jì)算機(jī)技術(shù)、人工智能等研究領(lǐng)域，其應(yīng)用廣泛、適應(yīng)性強(qiáng)，是當(dāng)今機(jī)器人研究的熱點(diǎn)［3－5］。許多學(xué)者對(duì)輪式移動(dòng)機(jī)器人進(jìn)行了研究，如文獻(xiàn)［6］對(duì)雙輪差速驅(qū)動(dòng)移動(dòng)式機(jī)器人的路徑規(guī)劃問(wèn)題進(jìn)行了研究，提出了融合偏差智能轉(zhuǎn)化評(píng)價(jià)函數(shù)法和指數(shù)穩(wěn)定控制的混合控制律，實(shí)現(xiàn)了移動(dòng)機(jī)器人精確、穩(wěn)定地跟蹤直線和圓弧導(dǎo)引路徑；文獻(xiàn)［7］為解決非完整移動(dòng)機(jī)器人的軌跡跟蹤控制問(wèn)題，提出了一種魯棒自適應(yīng)軌跡跟蹤控制器方法，實(shí)現(xiàn)了非完整移動(dòng)機(jī)器人的跟隨誤差任意??；文獻(xiàn)［8］為解決機(jī)器人目標(biāo)跟蹤過(guò)程中的遮擋和外觀改變等問(wèn)題，提出了一種分塊多特征描述子的方法；文獻(xiàn)［9］則提出了一種輪式移動(dòng)機(jī)器人混合路徑規(guī)劃的方法。

本研究基于輪式移動(dòng)機(jī)器人思想，設(shè)計(jì)了一種石化移動(dòng)作業(yè)機(jī)器人。該機(jī)器人以STM32F103ZET6作為核心控制板，采用了帶編碼器的直流電機(jī)來(lái)驅(qū)動(dòng)機(jī)器人的左右輪，由紅外避障模塊來(lái)檢測(cè)障礙物，內(nèi)部則搭載了電子陀螺儀及加速傳感器模塊以實(shí)現(xiàn)方向保持及速度控制，并通過(guò)軟件控制使其實(shí)現(xiàn)避障、監(jiān)控及地圖構(gòu)建等功能。

1 硬件架構(gòu)組成

當(dāng)石化移動(dòng)機(jī)器人的硬件材料確定后，可根據(jù)功能合理安排模塊位置，并設(shè)計(jì)機(jī)器人平臺(tái)底板。根據(jù)CAD軟件設(shè)計(jì)底板規(guī)格尺寸，并選用4mm厚的聚丙烯板進(jìn)行加工制作。機(jī)器人以STM32F103ZET6作為核心控制板，電機(jī)采用了帶編碼器的直流370電機(jī)，加載了L298N電機(jī)驅(qū)動(dòng)模塊來(lái)驅(qū)動(dòng)機(jī)器人左右輪；在底盤前端加置了萬(wàn)向輪，便于靈活變向。機(jī)器人左前端、中間和右前端各搭載了一個(gè)紅外避障模塊，用于移動(dòng)執(zhí)行任務(wù)過(guò)程中的避障；內(nèi)部搭載了電子陀螺儀及加速傳感器模塊，用于方向保持及速度控制。在機(jī)器人前端搭載了攝像頭模塊，并通過(guò)Wifi（Wireless Fidelity）模塊將數(shù)據(jù)進(jìn)行實(shí)時(shí)傳輸，便于監(jiān)控石化作業(yè)環(huán)境。此外，機(jī)器人的前底部以三角形位置搭載了三個(gè)測(cè)距模塊，以防機(jī)器人在特殊環(huán)境下作業(yè)發(fā)生的懸空摔損。

機(jī)器人的硬件結(jié)構(gòu)如圖1所示。硬件部分主要由六個(gè)模塊組成，即紅外測(cè)距模塊、帶編碼器直流電機(jī)及驅(qū)動(dòng)模塊、攝像頭實(shí)時(shí)傳輸模塊、STM32核心板控制模塊、電子陀螺儀以及藍(lán)牙模塊。

圖1 石化移動(dòng)機(jī)器人硬件結(jié)構(gòu)

1.1紅外測(cè)距模塊

采用日本夏普GP2Y0A21YK0F紅外測(cè)距傳感器作為測(cè)距模塊。該傳感器根據(jù)沿直線傳播和反射的性質(zhì)設(shè)計(jì)而成，其工作原理是“三角測(cè)距法”，即發(fā)射器以特定角度向外發(fā)射紅外光束，光束到達(dá)前方物體后將被反射回來(lái)，以CCD（Charge－coupled Device，電荷耦合元件）檢測(cè)單元捕獲反射回來(lái)的紅外光線，從而產(chǎn)生某一偏移值。根據(jù)光束的發(fā)射角度、偏移值、中心距離以及CCD焦距，就可以計(jì)算出傳感器到達(dá)物體的距離。

GP2Y0A21YK0F紅外測(cè)距傳感器的工作電源電壓為4.5～5.5 V，額定消耗電流為30mA，感應(yīng)測(cè)量范圍為10～80 cm，以模擬量輸出，在應(yīng)用前需要根據(jù)傳感器輸出曲線對(duì)探測(cè)距離進(jìn)行校正。當(dāng)探測(cè)距離小于10 cm時(shí)，輸出電壓會(huì)迅速下降。因此，需將傳感器安裝在移動(dòng)監(jiān)控平臺(tái)內(nèi)且到達(dá)平臺(tái)邊緣的距離大于最短距離（即10 cm）。在對(duì)紅外測(cè)距模塊上述特性的掌握下，通過(guò)程序算法完成石化移動(dòng)機(jī)器人作業(yè)過(guò)程的避障功能。

1.2 帶編碼器的直流電機(jī)及驅(qū)動(dòng)模塊

直流電機(jī)關(guān)聯(lián)編碼器可以實(shí)現(xiàn)準(zhǔn)確測(cè)速。光線通過(guò)光柵后被接收管接收，則輸出高電平；光線被遮擋，接收器無(wú)法接收，則輸出低電平。因此，電機(jī)主軸旋轉(zhuǎn)一圈，接收器接收到的高電平則等于碼盤光柵數(shù)量。帶編碼器直流電機(jī)的參數(shù)1∶34指的是電機(jī)軸轉(zhuǎn)動(dòng)34圈，電機(jī)輸出1圈。因此，1∶x表示x值越小，電機(jī)輸出轉(zhuǎn)速就越快，扭矩越?。环粗?，x值越大，則電機(jī)輸出轉(zhuǎn)速越慢，扭矩越大。

直流電機(jī)采用ASLONG JGA25－371減速電機(jī)334線碼盤，工作電壓為6～24 V，額定電壓為12 V，其空載轉(zhuǎn)速有977、463、201、126、95、55、41、25、19、11、8.6 r/min等類型。電機(jī)主軸轉(zhuǎn)一圈輸出334個(gè)脈沖，芯片上集成脈沖整形觸發(fā)電路并輸出矩形波。371減速電機(jī)模塊是六線制的，其中有兩條是電機(jī)的兩極接線，有兩條是編碼器電源接線，還有兩條是脈沖輸出線，分別接編碼器的兩個(gè)接收管。用一根接收管可以測(cè)得電機(jī)速度，同時(shí)兩根用則可以測(cè)出電機(jī)速度與轉(zhuǎn)向。

2路直流電機(jī)驅(qū)動(dòng)主要是通過(guò)NewWay298－M電機(jī)驅(qū)動(dòng)雙H橋來(lái)實(shí)現(xiàn)的。直流電機(jī)及驅(qū)動(dòng)模塊基于L298N芯片設(shè)計(jì)，集成了6路光耦控制器，其編碼器可實(shí)現(xiàn)關(guān)閉或打開光耦隔離功能，可保護(hù)控制端不受電機(jī)的影響，并完全隔離控制端與執(zhí)行端的電氣聯(lián)系。電機(jī)中5.08mm標(biāo)準(zhǔn)工業(yè)輸入輸出端口均采用旋接形式，并配置電流光耦模式開關(guān)、控制方向指示燈、上拉電阻選擇接口、邏輯部分板內(nèi)取電接口等。機(jī)器人可以通過(guò)電機(jī)驅(qū)動(dòng)模塊來(lái)驅(qū)動(dòng)直流電機(jī)，并通過(guò)編碼器完成行走距離的計(jì)算。

1.3 攝像頭實(shí)時(shí)傳輸模塊

為了實(shí)現(xiàn)對(duì)石化環(huán)境的實(shí)時(shí)監(jiān)控，在移動(dòng)平臺(tái)上搭載了Apple iMac一體機(jī)內(nèi)置攝像頭。該傳感器大小為76mm×8mm（長(zhǎng)×寬），配置有隨光線明暗變化的LED工作指示燈和散熱硅脂外殼，其內(nèi)部電路規(guī)格為50mm×8mm（長(zhǎng)×寬），支持最大分辨率為1 280×1 024 pixel，可實(shí)現(xiàn)720P高清效果。傳感器可通過(guò)SCCB總線控制實(shí)現(xiàn)8位視頻流數(shù)據(jù)操作，有幀輸出、子采樣與取窗口、視頻及圖像質(zhì)量、幀數(shù)據(jù)格式與傳輸控制等方式。

采用USR－C322a Wifi模塊，其網(wǎng)絡(luò)協(xié)議支持IPv4、TCP、UDP、DHCP、DNS、HTTP、ARP、ICMP等。TCP Serve最大TCP數(shù)為3，Wifi標(biāo)準(zhǔn)為802.11 b/g/n，網(wǎng)絡(luò)模式為AP/Station，AP模式接入終端數(shù)量為1。頻率范圍為2.412～2.484 GHz，802.116，802.11g，802.11n協(xié)議下的傳輸速度分別為11，54，54 Mbps，傳輸距離為200m，安全機(jī)制為WEP－A/WPA－PSK/WPA2－PSK，加密類型為WEP64/WEP128/TKIP/AES，采用TTL串口，數(shù)據(jù)位有5，6，7，8，停止位為1，2，校驗(yàn)位為None，Even，Odd，Space，Mark，波特率為300 bps～3M bps。搭載攝像頭模塊對(duì)機(jī)器人的作業(yè)環(huán)境進(jìn)行實(shí)時(shí)監(jiān)控，并通過(guò)Wireless Fidelity無(wú)線傳輸模塊將監(jiān)控視頻傳輸?shù)浇K端以供決策。

1.4 STM32核心板控制模塊

核心板采用正點(diǎn)原子STM32F103ZET6板，正點(diǎn)原子ALIENTEK的STM32F103控制器板載資源有：STM32F103ZET6CPU；1 MBytes SRAM，16 MBytes SPI FLASH；VS1053音頻編解碼模塊，支持wma/MP3/FLAC/ WAV/OGG/M4A/MIDI等音頻格式；DM9000網(wǎng)絡(luò)模塊，支持網(wǎng)絡(luò)通信功能，10 M/100 M自適應(yīng)，支持Web Server/TCP/UDP等，使用lwlp協(xié)議；RS232串口/RS485/CAN，USB Slave；支持UCOSIII/EMWIN/FATFS等；支持MPU6050六軸加速度創(chuàng)奇DMP姿態(tài)解算；支持觸摸屏操作。

1.5 電子陀螺儀

采用了MPU6050型號(hào)電子陀螺儀，內(nèi)部集成姿態(tài)解算器，以動(dòng)態(tài)卡爾曼濾波算法實(shí)現(xiàn)動(dòng)態(tài)環(huán)境下的當(dāng)前姿態(tài)計(jì)算，允許對(duì)底層測(cè)量數(shù)據(jù)訪問(wèn)，并采用數(shù)字濾波技術(shù)來(lái)降低測(cè)量噪聲并提高測(cè)量精度。該陀螺儀規(guī)格為15.24mm×15.24mm×2mm（長(zhǎng)×寬×高），工作電壓為3～6 V，焊盤間距為：上下2.54mm、左右15.24mm?？蓽y(cè)量三維加速度、角速度、姿態(tài)角，特性如下：加速度量程為±16 g，分辨率為6.1e－5m/s2，穩(wěn)定性為0.001m/s2；角速度量程為±11.11 πrad/s，分辨率為4.2πe－5 rad/s，穩(wěn)定性為1.11πe－4 rad/s；姿態(tài)測(cè)量穩(wěn)定度為5.55πe－5 rad/s。數(shù)據(jù)輸出頻率100 Hz（波特率為115 200）/20 Hz（波特率為9 600），數(shù)據(jù)接口為串口（TTL電平），波特率為115 200 kps/9 600 kps。通過(guò)電子陀螺儀模塊采集回來(lái)的加速度、角速度、姿態(tài)角等信息量，并結(jié)合編碼器，以航跡推算法完成機(jī)器人的定位與路徑規(guī)劃。

1.6 藍(lán)牙模塊

采用Risym cc2541低功耗4.0藍(lán)牙串口模塊，其規(guī)格大小為3.57 cm×1.52 cm（長(zhǎng)×寬），支持標(biāo)準(zhǔn)的藍(lán)牙BLE協(xié)議，內(nèi)置iBeacon協(xié)議，支持1對(duì)多廣播模式。支持Mesh組網(wǎng)，實(shí)現(xiàn)藍(lán)牙自組網(wǎng)絡(luò)，支持UART接口。以1.9～5.5 V單電源供電，響應(yīng)速度為0.4 s，無(wú)收發(fā)字節(jié)限制，支持8位數(shù)據(jù)位、1位停止位、無(wú)奇偶校驗(yàn)通信格式，最高可達(dá)到3 KB/s?？蓪?shí)現(xiàn)透?jìng)?、遠(yuǎn)控、PIO采集功能以及持電量檢測(cè)功能。實(shí)現(xiàn)配對(duì)后以全雙工串口方式進(jìn)行工作，允許設(shè)置波特率、名稱和配對(duì)密碼?？梢愿鶕?jù)藍(lán)牙模塊的特性，設(shè)置好配對(duì)密碼及波特率，將機(jī)器人采集到的數(shù)據(jù)返回到終端，以供外部工作人員做出下一步的指令決策。

2 軟件設(shè)計(jì)

2.1 系統(tǒng)控制功能

機(jī)器人系統(tǒng)主要控制臺(tái)為計(jì)算機(jī)客戶端，通過(guò)無(wú)線Wifi模塊讓計(jì)算機(jī)與移動(dòng)監(jiān)控平臺(tái)進(jìn)行通訊，隨后將采集到的環(huán)境信息反饋到客戶端。在計(jì)算機(jī)客戶端也能得到實(shí)時(shí)傳輸?shù)囊曨l信息已達(dá)到對(duì)環(huán)境的監(jiān)控這一功能系統(tǒng)實(shí)時(shí)視頻傳輸?shù)接?jì)算機(jī)客戶端，包括以下功能：（1）無(wú)線Wifi網(wǎng)絡(luò)下的視頻傳輸，實(shí)現(xiàn)機(jī)器人主控板STM32與終端設(shè)備（PC機(jī)/智能手機(jī)）通信功能；（2）機(jī)器人主控STM32平臺(tái)與其主控模塊之間的數(shù)據(jù)通信協(xié)議；（3）對(duì)機(jī)器人主控STM32平臺(tái)的系統(tǒng)裁剪；（4）路徑規(guī)劃的有效性；（5）移動(dòng)機(jī)器人的穩(wěn)定性與可靠性。

2.2 工作模式

1）延邊模式。當(dāng)前方三個(gè)紅外測(cè)距模塊均未檢測(cè)到障礙物時(shí)，機(jī)器人直走。當(dāng)中間的紅外檢測(cè)到與障礙物間的距離小于程序設(shè)定的閾值時(shí)，機(jī)器人協(xié)調(diào)另外兩個(gè)紅外檢測(cè)數(shù)值進(jìn)行判斷，選擇合適方向以完成轉(zhuǎn)彎。當(dāng)左邊的紅外檢測(cè)到與障礙物間的距離小于程序設(shè)定的閾值時(shí)，機(jī)器人右轉(zhuǎn)；當(dāng)右邊的紅外檢測(cè)到與障礙物間的距離小于程序設(shè)定的閾值時(shí)，機(jī)器人左轉(zhuǎn)完成避障。延邊控制流程如圖2所示。

2）來(lái)回模式。當(dāng)前方三個(gè)紅外測(cè)距模塊均未檢測(cè)到障礙物時(shí)，機(jī)器人直走。當(dāng)中間的紅外檢測(cè)到與障礙物間的距離小于程序設(shè)定的閾值時(shí)，機(jī)器人協(xié)調(diào)另外兩個(gè)紅外的檢測(cè)數(shù)值進(jìn)行判斷，選擇合適方向轉(zhuǎn)彎完成轉(zhuǎn)彎。簡(jiǎn)短延時(shí)后，再轉(zhuǎn)彎（與第一次轉(zhuǎn)向相同），隨后直接前進(jìn)，直到中間紅外再次檢測(cè)到障礙物，再轉(zhuǎn)彎（與第一次轉(zhuǎn)向相反）。簡(jiǎn)短延時(shí)后，再轉(zhuǎn)彎（與上一次轉(zhuǎn)向相同），隨后直接前進(jìn)。依次類推，轉(zhuǎn)向以每2次為一個(gè)周期，每個(gè)周期內(nèi)的2次轉(zhuǎn)彎轉(zhuǎn)向相同，但每個(gè)大周期轉(zhuǎn)向相反，進(jìn)而完成來(lái)回模式。來(lái)回模式控制流程如圖3所示。

3）螺旋模式。先記錄剛開始時(shí)陀螺儀的角度，機(jī)器人首先右轉(zhuǎn)，簡(jiǎn)短延時(shí)后前進(jìn)，再次簡(jiǎn)短延時(shí)后右轉(zhuǎn)。當(dāng)陀螺儀上讀出的角度在設(shè)定的范圍內(nèi)時(shí)，表示機(jī)器人已經(jīng)完成一圈螺旋。在機(jī)器人螺旋的過(guò)程中，經(jīng)過(guò)測(cè)試調(diào)整，不斷增加延時(shí)的時(shí)間，進(jìn)而擴(kuò)大螺旋的半徑，依次完成螺旋模式。

4）定點(diǎn)清掃模式。在小范圍的區(qū)域內(nèi)進(jìn)行清掃。在室內(nèi)定位及地圖構(gòu)建的技術(shù)下，對(duì)特定區(qū)域進(jìn)行一個(gè)重點(diǎn)清掃。

圖2 延邊控制流程

圖3 來(lái)回模式控制流程

3 實(shí)驗(yàn)驗(yàn)證

如圖4所示，機(jī)器人在模擬作業(yè)過(guò)程中，能通過(guò)搭載的紅外測(cè)距模塊準(zhǔn)確地判斷出前方是否有障礙物的存在以及檢測(cè)出障礙物的距離。當(dāng)機(jī)器人左側(cè)紅外測(cè)距模塊檢測(cè)到有障礙物的存在時(shí)，機(jī)器人右轉(zhuǎn)避障；當(dāng)機(jī)器人右側(cè)紅外測(cè)距模塊檢測(cè)到有障礙物的存在時(shí)，機(jī)器人左轉(zhuǎn)避障；當(dāng)中間的紅外測(cè)距模塊檢測(cè)到前方有障礙物時(shí)，機(jī)器人協(xié)調(diào)左右兩個(gè)紅外檢測(cè)數(shù)值進(jìn)行判斷，選擇合適方向轉(zhuǎn)彎從而完成避障功能。因此驗(yàn)證了硬件框架思路的設(shè)計(jì)和避障算法的可行性。

機(jī)器人根據(jù)航跡推算法進(jìn)行室內(nèi)定位。機(jī)器人室內(nèi)定位判斷回到原點(diǎn)（如圖5所示），并根據(jù)構(gòu)建的環(huán)境、已知條件和限定條件，規(guī)劃了一條滿足任務(wù)要求且安全有效的路徑。在室內(nèi)定位和環(huán)境構(gòu)建的基礎(chǔ)上，機(jī)器人能夠選擇延邊、來(lái)回、螺旋、定點(diǎn)等不同的工作模式，從而驗(yàn)證了工作模式實(shí)現(xiàn)思路的可行性。攝像頭能對(duì)周圍環(huán)境進(jìn)行實(shí)時(shí)監(jiān)測(cè)，并通過(guò)WiFi傳回終端以供決策。機(jī)器人攝像頭的實(shí)時(shí)監(jiān)控效果如圖6所示。

圖4 機(jī)器人行走避障

圖5 判斷回到原點(diǎn)

圖6 攝像頭實(shí)時(shí)監(jiān)控

4 結(jié)論

以STM32F103ZET6作為核心控制板和多傳感器系統(tǒng)，研制了一種石化移動(dòng)作業(yè)機(jī)器人，在硬件環(huán)境設(shè)計(jì)及軟件程序編寫的基礎(chǔ)上，對(duì)機(jī)器人的一系列問(wèn)題進(jìn)行了調(diào)試，其中涉及了機(jī)器人直線行走、攝像頭模塊供電電流穩(wěn)定性、紅外測(cè)距模塊閾值設(shè)置、移動(dòng)路徑定位過(guò)程中的累積誤差消除等。通過(guò)硬件設(shè)計(jì)和軟件上算法的改進(jìn)，最終解決了上述問(wèn)題，并通過(guò)模擬實(shí)驗(yàn)完成了對(duì)石化移動(dòng)作業(yè)機(jī)器人的可行性驗(yàn)證。

［1］謝在庫(kù)，劉志成，王仰東.面向資源和環(huán)境的石油化工技術(shù)創(chuàng)新與展望［J］.中國(guó)科學(xué)（化學(xué)），2014，44（9）：1394－1403.

［2］譚民，王碩.機(jī)器人技術(shù)研究進(jìn)展［J］.自動(dòng)化學(xué)報(bào)，2013，39（7）：963－972.

［3］柯文德，陳珂，李家蘭.一種基于A*算法的輪式機(jī)器人路徑規(guī)劃方法［J］.廣東石油化工學(xué)院學(xué)報(bào)，2012，22（1）：35－38.

［4］柯文德，蔡則蘇，李家蘭.機(jī)器人同時(shí)定位與地圖構(gòu)建技術(shù)研究［J］.計(jì)算機(jī)應(yīng)用研究，2010，27（4）：1216－1219.

［5］Cao L，Ji R.Robust Depth－Based Object Tracking From a Moving Binocular Camera［J］.Signal Processing，2015，112（7）：154－161.

［6］武星，朱琳軍，石陳陳，等.雙差速驅(qū)動(dòng)移動(dòng)機(jī)器人路徑跟蹤混合控制律研究［J］.農(nóng)業(yè)機(jī)械學(xué)報(bào)，2015，46（3）：51－58.

［7］陳罡，高婷婷，賈慶偉，等.帶有未知參數(shù)和有界干擾的移動(dòng)機(jī)器人軌跡跟蹤控制［J］.控制理論與應(yīng)用，2015，32（4）：491－496.

［8］王麗佳，賈松敏，李秀智，等.分塊多特征目標(biāo)描述子的移動(dòng)機(jī)器人目標(biāo)跟蹤［J］.控制與決策，2016，31（2）：337－342.

［9］柯文德，蔡則蘇，彭志平，等.一種混合路徑規(guī)劃方法在輪式機(jī)器人中的應(yīng)用［J］.計(jì)算機(jī)應(yīng)用研究，2011，28（2）：505－507，531.

Design of an Operation Platform of Petrochemical Mobile Robot

KE Wende，CHEN Yangxin，ZHUANG Canyu，YAO Qiuping
（College of Computer and Electronic Information，Guangdong University of Petrochemical Technology，Maoming 525000，China）

An operation platform of petrochemicalmobile robot is designed，in which STM32F103ZET6 is taken as the core controller，coupledwith the infrared distancemeasurementmodule，coded direct－current generator and its drivenmodule，electronic gyroscope and acceleration sensor.This platform can avoid obstacles automatically，preset time and provide severalmobilemodes.The platform has several kinds of workingmodes.It can also build the environmentalmap and send back the information of petrochemical operating condition for decision through Wifi（wireless fidelity）.The experiment proves the validity of the design.

Petrochemical；Robot；Mobile；Communication

TP18

A

2095－2562（2016）01－0090－05

（責(zé)任編輯：賀嫁姿）

2015－12－15；

2016－01－09

廣東省科技廳產(chǎn)學(xué)研合作項(xiàng)目（2015B090903084）；廣東省創(chuàng)新強(qiáng)校項(xiàng)目（650007）；廣東省科技廳工業(yè)高新技術(shù)領(lǐng)域（2014A010104016）；廣東省創(chuàng)新強(qiáng)校項(xiàng)目（650457）

柯文德（1976—），男，廣東茂名人，博士，教授，主要研究方向?yàn)槿斯ぶ悄堋C(jī)器人技術(shù)、計(jì)算機(jī)系統(tǒng)結(jié)構(gòu)等。