摘 要: 以ATMega128芯片為控制核心,,設(shè)計(jì)實(shí)現(xiàn)了智能偵查滅火機(jī)器人的相關(guān)功能。實(shí)驗(yàn)證明,,智能滅火機(jī)器人的尋光,、避障以及行走模塊系統(tǒng)工作,,使其能夠更快速、及時(shí)地發(fā)現(xiàn)并到達(dá)火源,,實(shí)現(xiàn)滅火,。
關(guān)鍵詞: ATMega128芯片;智能偵查滅火機(jī)器人,;火源
最近幾十年中,,大量的高層、地下建筑及大型的石化企業(yè)不斷涌現(xiàn),。由于這些建筑的特殊性,,發(fā)生火災(zāi)時(shí),不能快速高效地滅火,。比如,,高層建筑發(fā)生火災(zāi)時(shí),消防人員不可能在短時(shí)間內(nèi)到達(dá)高處的火災(zāi)發(fā)生地點(diǎn),,在地下建筑中,,由于環(huán)境比較潮濕,煙氣不易擴(kuò)散,,消防人員不容易快速判定火源位置,;而在石化企業(yè)發(fā)生火災(zāi)時(shí),將產(chǎn)生大量的毒氣,,消防人員在滅火時(shí)極易中毒,。為了解決這一問題,研制能夠用于這些場合的偵察滅火機(jī)器人,,協(xié)助消防人員進(jìn)行火災(zāi)的定位和滅火,,將有極大的社會(huì)意義。
作為一個(gè)智能化的機(jī)器,,機(jī)器人必須具有如下功能:(1)動(dòng)作機(jī)構(gòu)類似于人或其他生物體某些器官(肢體,、感官等)的功能;(2)有通用性,,工作種類多樣,,動(dòng)作程序靈活易變;(3)有一定程度的智能,,如記憶,、感知、推測,、決策和學(xué)習(xí)等,;(4)有獨(dú)立性,完整的機(jī)器人系統(tǒng)(機(jī)器)在工作中可以不依賴人的操縱。偵察滅火機(jī)器人是一個(gè)具有一定智能的機(jī)器,,要完成上述功能,,必須解決下述幾個(gè)問題[1]。
(1)路徑規(guī)劃和實(shí)施
為了進(jìn)行偵察,,偵察滅火機(jī)器人必須對偵察目標(biāo)進(jìn)行巡視,,必須能夠在偵察目標(biāo)內(nèi)安全行走。偵察滅火機(jī)器人要解決的首要問題就是如何行走,,也就是路徑規(guī)劃的問題,。第一,必須有全局的偵察路徑規(guī)劃,。對不同的目標(biāo),,必須制定不同的偵察路徑策略,以指導(dǎo)機(jī)器人對目標(biāo)進(jìn)行全局掃描偵察,。第二,,機(jī)器人必須知道當(dāng)前自身所處的位置。這一位置非常重要,,機(jī)器人根據(jù)當(dāng)前位置,,結(jié)合全局的偵察規(guī)劃,,確定下一步的行走計(jì)劃,;對發(fā)現(xiàn)的火源,機(jī)器人通過確定火源相對于機(jī)器人當(dāng)前位置的坐標(biāo)以確定火源在整個(gè)偵察目標(biāo)中的位置,。第三,,機(jī)器人必須識(shí)別行走中的障礙。機(jī)器人必須收集傳感器得到的信息,,確定行走中的各種障礙,。這些障礙包括臺(tái)階、墻壁等各種突起物,,地面的凹凸,,各種人為放置的障礙等。機(jī)器人必須能夠識(shí)別這些障礙物,,并對各種障礙進(jìn)行分類,。第四,確定避障的方案,。對識(shí)別的障礙,,機(jī)器人必須確定是否能夠直接越過障礙;對不能越過的障礙,,必須確定規(guī)避的方案[2],。
(2)火源識(shí)別和定位
偵察滅火機(jī)器人必須能夠識(shí)別火源,對火災(zāi)發(fā)生的地點(diǎn)定位。機(jī)器人在行走過程中對環(huán)境進(jìn)行偵察,,對傳感器得到的信息進(jìn)行分析,,在得到可疑信息處適當(dāng)?shù)赝A簦杉喔敿?xì)的數(shù)據(jù)進(jìn)行分析,,以判定火源的存在[3],。對確定存在的火源,必須對其定位,,確定火源相對機(jī)器人的位置,,以確定火源在整個(gè)目標(biāo)中的實(shí)際位置。
(3)滅火
當(dāng)機(jī)器人找到火源并且定好距離后,,啟動(dòng)滅火裝置進(jìn)行滅火,,當(dāng)火滅后,機(jī)器人退出火場[4],。
1 滅火機(jī)器人硬件設(shè)計(jì)
本系統(tǒng)主要由單片機(jī)模塊,、電機(jī)驅(qū)動(dòng)模塊、火源檢測模塊,、避障模塊及電源模塊等構(gòu)成,。采用了基于TWI總線規(guī)范的主從機(jī)控制方式,以AVR系列單片機(jī)ATMega128作為控制系統(tǒng)的主模塊,,ATMega8作為底層控制模塊,,實(shí)現(xiàn)控制偵察車動(dòng)作(如車體的前進(jìn)、后退,、拐彎等),,系統(tǒng)框圖如圖1所示。
1.1 電機(jī)驅(qū)動(dòng)模塊設(shè)計(jì)
直流電機(jī)控制和驅(qū)動(dòng)的硬件電路如圖2所示,。其中電機(jī)控制采用的是L298,。通過一個(gè)L298芯片驅(qū)動(dòng)兩個(gè)直流減速電機(jī),將EA/EB接PWM(高電平有效),,P1,、P2、P3,、P4接單片機(jī),,通過改變EA、EB以及PWM的占空比即可控制電動(dòng)機(jī)的啟動(dòng)停止,、加速減速和前進(jìn)倒退,。
1.2 火源檢測模塊設(shè)計(jì)
方案一:采用光敏電阻,利用其在不同的光強(qiáng)下阻值不同,,確定小車的轉(zhuǎn)向,,但檢測距離有限,,易受外界環(huán)境干擾。
方案二:采用光電三極管形成陣列,,在小車車頭排列成為半圓狀結(jié)構(gòu),。根據(jù)矢量合成原理,按照各個(gè)傳感器測量光強(qiáng)的不同,,確定小車相對于光的位置,。檢測距離較遠(yuǎn),受外界干擾小,。
方案選擇:采用方案二,,此方案實(shí)現(xiàn)相對復(fù)雜但能取得良好的效果。
小車尋光采用光敏三極管陣列,,每個(gè)光敏三極管的硬件電路如圖3所示,。
導(dǎo)航分系統(tǒng)通過接收均勻分布在圓周的八個(gè)光敏三極管采集的信號(hào),送給單片機(jī)的ADC模塊,,從而得到光強(qiáng)信息,,確定光源所在位置,引導(dǎo)小車導(dǎo)航,。傳感器陣列的位置分布見圖4,。
1.3 避障模塊設(shè)計(jì)
方案一:采用光電開關(guān),方向雜散小,,在距離障礙物一定距離時(shí)可測出障礙物,,價(jià)格低廉。
方案二:采用超聲波測距的方法,。利用超聲波傳感器,,監(jiān)視測量發(fā)射脈沖和接受脈沖的時(shí)間差,,計(jì)算超聲波和物體之間的距離,。
方案選擇:超聲波測距價(jià)格較高,且通過算法優(yōu)化,,光電開關(guān)完全可以滿足設(shè)計(jì)要求,,故采用方案一。
小車避障模塊采用的紅外光電接近開關(guān),,接收均勻分布在半圓周的五個(gè)光電開關(guān)采集的信號(hào)如圖4所示,,單片機(jī)通過讀取開關(guān)電平的高低即可確定障礙物的方向,引導(dǎo)小車躲避障礙,。本設(shè)計(jì)中采用的是E18-D80NK型光電開關(guān),。
2 滅火機(jī)器人軟件設(shè)計(jì)
可編程微控制器模塊使機(jī)器人實(shí)現(xiàn)下列功能[5]:(1)監(jiān)測傳感器以探測周邊環(huán)境;(2)基于傳感元件的檢測做出決策,;(3)控制機(jī)器人運(yùn)動(dòng),;(4)實(shí)現(xiàn)滅火功能,。
2.1 滅火機(jī)器人程序設(shè)計(jì)思路
(1)尋找火源:機(jī)器人在各個(gè)房間門口搜索房間是否有火,如果有火就停下,。
(2)滅火:檢測到房間有火,,利用光敏電阻尋找蠟燭,直接朝火焰前進(jìn),,到達(dá)火焰一定距離(由程序設(shè)定),,停下,啟動(dòng)滅火裝置,。
(3)返回:機(jī)器人救火任務(wù)完成,,從所處的位置回到起點(diǎn)。
程序流程圖如圖5所示,。
2.2 尋光,、避障導(dǎo)航算法
尋光算法:根據(jù)傳感器環(huán)路的結(jié)構(gòu),以小車左右方向作為X軸,,八個(gè)光敏三極管分別位于0°,、45°、90°,、135°,、180°、225°,、270°,、315°的位置。計(jì)算信號(hào)幅度最大的光敏三極管與位置90°的光敏三極管之間的夾角,,將小車轉(zhuǎn)動(dòng)這個(gè)夾角,,使位置90°的光敏三極管所接收的信號(hào)幅度最大,然后前進(jìn),。
避障算法:根據(jù)傳感器環(huán)路的結(jié)構(gòu),,以小車左右方向作為X軸,五個(gè)光電開關(guān)分別位于0°,、45°,、90°、135°,、180°的位置,。光電開關(guān)只能輸出TTL電平,可以轉(zhuǎn)換為二進(jìn)制分量,,當(dāng)傳感器分量為高電平時(shí),,表示探測到障礙物。
當(dāng)有三個(gè)以上光電開關(guān)分量為高電平時(shí),,表明障礙情況比較復(fù)雜,,此時(shí)將小車退后,,然后再向右一段距離,繼續(xù)前進(jìn),。
當(dāng)只有一到兩個(gè)光電開關(guān)分量為高電平時(shí),,表明障礙情況比較簡單,此時(shí)小車將沿著與高電平傳感器相反方向行進(jìn),,繼續(xù)前進(jìn),。
本設(shè)計(jì)是以ATMega128控制的輪式移動(dòng)機(jī)器人,兩輪采用直流伺服系統(tǒng)驅(qū)動(dòng),,后部球輪為隨動(dòng)支撐輪,。在移動(dòng)機(jī)器人車體前部安裝有光敏電阻、紅外線探測發(fā)射裝置,,用于采集環(huán)境信息的信息,,從而實(shí)現(xiàn)移動(dòng)機(jī)器人自身位置的感知。實(shí)驗(yàn)表明,,在路徑搜索過程中,,移動(dòng)機(jī)器人能夠較好地達(dá)到搜尋目的,對環(huán)境做出合理的反應(yīng),,達(dá)到一定的智能水平,。
參考文獻(xiàn)
[1] 張建中,李東民,,張陟峰. 轉(zhuǎn)臂式滅火機(jī)器人滅火技術(shù)研究與實(shí)現(xiàn)[J]. 現(xiàn)代制造工程,,2010(7):138-142.
[2] 徐國保,尹怡欣,,周美娟.智能移動(dòng)機(jī)器人技術(shù)現(xiàn)狀及展望[J].機(jī)器人技術(shù)與應(yīng)用,,2007(2):29-34.
[3] 丁偉,孫華,,曾建輝.基于多傳感器信息融合的移動(dòng)機(jī)器人導(dǎo)航綜述[J]. 傳感器與微系統(tǒng),,2006,25(7):1-3.
[4] 席文姣,,陳帝伊,,馬孝義.基于ARM9嵌入式系統(tǒng)智能滅火機(jī)器人控制器設(shè)計(jì)[J].現(xiàn)代電子技術(shù),,2010(10):114-117.
[5] 關(guān)為民,,陳帝伊,馬孝義.智能滅火機(jī)器人硬件電路的設(shè)計(jì)與實(shí)現(xiàn)[J].微型機(jī)與應(yīng)用,,2010(4):21-24.
[6] 程鶴鳴.智能偵查滅火機(jī)器人[J].控制工程,,2009(16):117-121.