《電子技術應用》
您所在的位置:首頁 > 嵌入式技術 > 設計應用 > 滅火機器人控制技術研究
滅火機器人控制技術研究
2014年微型機與應用第16期
胡曉軍,蔡蘭蓉,王英杰
天津職業技術師范大學 機械工程學院,天津 300222
摘要: 介紹了一種自行研發與制作的比賽用滅火機器人。該機器人采用STC80C52單片機為主控芯片,結合使用步進電機和溫度傳感器來判斷火源位置,利用紅外測距傳感器與直流電機完成機器人的行走和自動避障等功能。在控制算法上,采用“左右手定則”和無火不入房的策略,提高了尋找火源的效率。
Abstract:
Key words :

  摘  要: 介紹了一種自行研發與制作的比賽用滅火機器人。該機器人采用STC80C52單片機為主控芯片,結合使用步進電機和溫度傳感器來判斷火源位置,利用紅外測距傳感器與直流電機完成機器人的行走和自動避障等功能。在控制算法上,采用“左右手定則”和無火不入房的策略,提高了尋找火源的效率。

  關鍵詞: 滅火機器人;STC80C52;紅外測距傳感器

  隨著機器人技術的飛速發展,工業機器人已廣泛應用于各個領域的工業現場,成為了先進制造技術和自動化裝備的典型代表。機器人技術涉及多個技術領域,如電子、機械、自動控制、傳感器、計算機等。隨著國民經濟的持續發展,近年來國內許多企業為應對人力資源緊張的局勢,積極與各大高校聯合,對機器人技術進行開發,這使得對機器人技術的研究達到了空前的高潮。本文所介紹的機器人裝備了信息處理系統、各種傳感器、運動裝置和滅火裝置,可以獨立實施火源的搜索和滅火任務[1]。

1 總體設計思想

  通過對比賽規則的分析(用蠟燭模擬火源,隨機分布在場地中,要求在最短的時間內找到火源并將其撲滅),為在最短的時間內完成比賽所規定的任務,對機器人完成整個動作要求做如下設計:機器人在直流電機的驅動下完成前后及轉彎等動作;在運動的過程中利用紅外傳感器和循跡模塊實現自動避障和房間定位功能;當機器人定位火源的房間后,由直流電機和循跡模塊共同工作,驅動機器人運動至滅火位置,隨后通過驅動強力風扇實現滅火任務;滅火完成后返回出發區域。

2 硬件及電路設計

  機器人的控制芯片采用MCS-51系列的80C52單片機,它內置8位中央處理單元,32個雙向輸入輸出口,是80C51的增強版本,工作電壓為3.3 V~5 V[2]。機器人硬件部分主要包括驅動模塊、傳感器模塊、滅火模塊和電源模塊,總體框圖如圖1所示。

001.jpg

  2.1 驅動模塊

  驅動模塊主要包括直流電機驅動和步進電機驅動兩部分。

  直流電機驅動模塊[3]主要用于控制直流電機運動,完成機器人向前向后及轉彎等功能??刂菩酒捎肔298N雙H橋直流電機驅動芯片,其邏輯供電電壓為5 V,與單片機工作電壓相匹配,驅動供電電壓為5 V~46 V,在此采用12 V的電壓輸入??刂圃韴D如圖2所示,其中VS和VSS分別為驅動控制電壓和邏輯控制電壓,ENA、ENB分別為直流電機1、2的使能端,OUT1、OUT2、OUT3、OUT4輸出PWM方波控制直流電機1、2的轉速。

002.jpg

  步進電機驅動主要用于帶動火焰傳感器旋轉進行火焰的定位??刂菩酒捎肁3955SB,該芯片是美國Allegro公司生產的,其工作電壓可達50 V,電流可達1.5 A。同時A3955SB芯片還提供過溫保護、過流保護及欠壓保護等功能[4]。A3955SB芯片為16引腳的芯片,其輸入為DAC的3個輸入端D0、D1、D2,通過設置REF端口的電壓和采樣電阻R0,可確定通過步進電機的最大電流Imax,其關系式為Imax=VREF/3R0;RC端口用來控制PWM的波形;輸出為OUTA和OUTB,用于控制步進電機的某一相,同時PHASE端口決定步進脈沖的方向。兩相步進電機的控制電路圖如圖3所示。

003.jpg

  2.2 傳感器模塊

  傳感器相當于人類的各種感官系統,幫助機器人識別路線、障礙、火源等一系列事物,是機器人完成特定任務的關鍵。該機器人所用傳感器主要包括紅外測距傳感器、循跡模塊和火焰傳感器。

  紅外測距傳感器可以精確地檢測距離,其測量范圍為0.2 m~1.5 m,測量信號可以模擬輸出。該機器人所使用的是Sharp公司生產的GP2Y0A02YK0F型紅外測距傳感器,它是基于三角測量原理,傳感器按照某一角度發射紅外光束,光束遇到障礙物后被反射,當CCD檢測器檢測到有紅外光束被反射后,會產生一個距離為L的偏移,運用三角形的原理,結合必要的數據(如發射角a,焦距f等)可以計算出物體到傳感器的距離,如圖4所示。當測量出距離后,傳感器會將距離轉換成電壓值輸出,如圖5所示。

004.jpg

  循跡模塊主要由碰撞開關和灰度傳感器組成,用來檢測碰撞和灰度,其工作原理比較簡單,在此不做過多介紹。

  火焰傳感器R2868可以檢測到波長在700 nm~1 000 nm范圍內的紅外光,檢測距離為0.8 m,當檢測到火焰信號后,輸出低電壓信號。

  2.3 滅火模塊

  滅火模塊主要依靠風扇產生強勁的風力將火源撲滅,由于其功率較大,需要采用繼電器對其進行輔助控制。在實際的滅火環境下,可將滅火裝置改為干粉滅火器火噴水裝置來完成。

  2.4 電源模塊

  機器人采用12 V的鋰電池供電,由于單片機及部分傳感器工作電壓為5 V,需要設計降壓電路。降壓電路的芯片采用LM7805,它具有體積小、使用方便的特點,控制電路如圖6所示。

005.jpg

3 系統軟件設計

  根據對比賽規則的分析,決定采用“左右手定則”來實現對機器人路徑的規劃。所謂左右手定則,就是根據比賽場地的實際地形分布,在某段時間內遇到岔路口向左(右)運動,以后都向右(左)運動的方式。在比賽中采用先右后左的策略,在每個房間的門口檢測,如果發現火源,則進入房間滅火,滅火后再次利用火焰傳感器對火源檢測以確定是否將火源撲滅,否則不進入該房間,繼續搜尋下一個房間。此外在機器人前進的過程中,由于某些原因(如控制電路的延時性、摩擦阻力不同、電機性能不同等)會導致左右兩側的直流電機不同步,致使機器人的運動路線產生偏移。在此需要設計前進位置偏移檢測程序來糾正機器人的位置偏差,主要原理是在前進過程中每隔很短的時間,利用紅外測距傳感器對兩側距離進行檢測,若發現兩次檢測的距離不同,則對偏離方向進行計算,并反饋給處理器對機器人的位置進行調整。機器人控制流程如圖7所示。

006.jpg

  主程序框架如下:

  #include<REG51.h>

  #include<absacc.h>

  #include<math.h>

  #include<intrins.h>

  void main(void)

  {

  TMOD=0x02;//設定T0的工作模式為2

  TH0=0x9B;

  TL0=0x9B;//裝入定時器的初值

  EA=1;

  ET0=1;

  TR0=1;

  init(); //程序初始化

  Walk();//開始運動

  While(num<=4||mh=0)

  {

  If (left==1)

  {

  Check_left();//左手定則

  left=0;

  }

  Else

  Check_right();//右手定則

  num=num+1;//房間數加1

  }

  huijia();//搜尋結束或滅火后回家

  }

  本機器人的設計目的是快速找到火源并將其撲滅之后安全回家,完成任務用時最短者獲勝。其中直線運動時位置調整次數、撞墻次數、房間搜尋安排、能否準確定位火源位置等制約著比賽時間。

  通過實際測驗,該機器人性能穩定,運行速度較快,能較好完成滅火任務并安全回家,具有一定的實用性。

  參考文獻

  [1] 關為民,陳帝伊,馬孝義.智能滅火機器人硬件電路的設計與實現[J].微型機與應用,2010,29(4):21-24.

  [2] 陸彬.21天學通51單片機開發[M].北京:電子工業出版社,2011.

  [3] 劉雄,林茂松,梁艷陽.特種機器人的低電壓大功率電機驅動系統設計[J].電子技術應用,2013,39(10):49-53.

  [4] 韓英桃,胡亞山.A3955SB步進電機驅動芯片及其應用[J].國外電子元器件,2003(2):58-60.


此內容為AET網站原創,未經授權禁止轉載。
热re99久久精品国产66热_欧美小视频在线观看_日韩成人激情影院_庆余年2免费日韩剧观看大牛_91久久久久久国产精品_国产原创欧美精品_美女999久久久精品视频_欧美大成色www永久网站婷_国产色婷婷国产综合在线理论片a_国产精品电影在线观看_日韩精品视频在线观看网址_97在线观看免费_性欧美亚洲xxxx乳在线观看_久久精品美女视频网站_777国产偷窥盗摄精品视频_在线日韩第一页
  • <strike id="ygamy"></strike>
  • 
    
      • <del id="ygamy"></del>
        <tfoot id="ygamy"></tfoot>
          <strike id="ygamy"></strike>
          一区二区亚洲欧洲国产日韩| 免费观看亚洲视频大全| 久久综合狠狠| 欧美一区2区视频在线观看| 西西人体一区二区| 欧美va亚洲va日韩∨a综合色| 国产欧美日韩精品a在线观看| 欧美成年网站| 国产区精品视频| 亚洲精品在线观看免费| 免费黄网站欧美| 久久成人18免费观看| 亚洲午夜一区二区| 国产精品网红福利| 国产一区二区日韩精品欧美精品| 亚洲日本va在线观看| 亚洲精品乱码久久久久久| 国产精品v亚洲精品v日韩精品| 宅男精品导航| 久久久五月天| 在线观看91精品国产入口| 欧美婷婷在线| 亚洲美女视频网| 国产综合在线视频| 亚洲人成在线观看一区二区| 国内外成人在线| 国产一区二区三区在线观看免费| 韩国视频理论视频久久| 狼狼综合久久久久综合网| 欧美午夜大胆人体| 亚洲国产精品一区二区第四页av| 亚洲视频免费在线观看| 欧美激情第五页| 亚洲最黄网站| 欧美激情导航| 欧美另类69精品久久久久9999| 欧美激情欧美狂野欧美精品| 国产精品v日韩精品v欧美精品网站| 欧美日韩一区二区三区四区五区| 国产精品亚洲综合久久| 欧美极品一区二区三区| 亚洲第一精品夜夜躁人人爽| 欧美99在线视频观看| 久久综合久久综合九色| 久久狠狠久久综合桃花| 一片黄亚洲嫩模| 欧美精品国产一区二区| 亚洲一区免费看| 亚洲精品欧美极品| 国外成人性视频| 国产精品午夜在线| 国产区在线观看成人精品| 在线成人激情黄色| 国产一区二区三区免费观看| 一区二区久久久久| 久久一区二区三区四区五区| 久久精品视频导航| 亚洲午夜久久久久久久久电影网| 久久一区国产| 亚洲黄色影片| 免费观看国产成人| 欧美日韩欧美一区二区| 在线观看国产一区二区| 国产精品毛片a∨一区二区三区|国| 亚洲欧美国产精品专区久久| 一区二区三区精品| 亚洲女与黑人做爰| 亚洲宅男天堂在线观看无病毒| 亚洲国产成人av好男人在线观看| 性欧美video另类hd性玩具| 国产欧美日韩亚洲一区二区三区| 欧美视频在线视频| 欧美黑人国产人伦爽爽爽| 亚洲精品你懂的| 影院欧美亚洲| 黄色成人在线观看| 久久久久久久一区二区| 欧美影院久久久| 麻豆成人在线观看| 久久蜜臀精品av| 国产亚洲精品久久久久动| 国产精品一区二区三区四区| 久久精品男女| 欧美美女日韩| 国产欧美精品日韩| 亚洲精品久久久蜜桃| 国产精品久久久爽爽爽麻豆色哟哟| 中国成人亚色综合网站| 久久久蜜桃精品| 欧美成人69| 国产婷婷色一区二区三区| 日韩亚洲成人av在线| 亚洲精品国精品久久99热| 亚洲精品国产无天堂网2021| 亚洲电影成人| 国产在线高清精品| 99国产精品99久久久久久| 国模私拍一区二区三区| 老司机aⅴ在线精品导航| 在线看不卡av| 亚洲欧美日韩网| 亚洲天堂av高清| 欧美日韩国产成人高清视频| 欧美一区二区三区另类| 国产精品国产三级国产专播品爱网| 一本久久综合亚洲鲁鲁五月天| 国产欧美日韩视频在线观看| 国产日韩精品一区二区浪潮av| 欧美大片网址| 久久成人亚洲| 亚洲精选成人| 国产精品视屏| 欧美精品成人91久久久久久久| 亚洲二区免费| 日韩一级视频免费观看在线| 欧美在线影院在线视频| 欧美亚洲成人精品| 国产精品女主播一区二区三区| 国产精品永久免费在线| 欧美一区二粉嫩精品国产一线天| 欧美一区二区视频在线观看2020| 影音先锋日韩有码| 亚洲国产精品成人| 国产精品毛片| 伊人影院久久| 欧美一区二区三区啪啪| 亚洲免费精彩视频| 国产一二三精品| 91久久精品国产91性色| 国产精品久久久久久久久久ktv| 久久久久久久久综合| 亚洲欧美国产精品va在线观看| 最新69国产成人精品视频免费| 亚洲国产成人久久综合一区| 国产精品99久久99久久久二8| 国产精品福利在线观看| 久久久久综合一区二区三区| 欧美一区激情视频在线观看| 亚洲专区在线视频| 久久免费视频网| 国语自产在线不卡| 一本一道久久综合狠狠老精东影业| 91久久精品日日躁夜夜躁欧美| 亚洲制服欧美中文字幕中文字幕| 亚洲高清一区二| 午夜精品网站| 老色鬼久久亚洲一区二区| 欧美色视频在线| 欧美日韩精品是欧美日韩精品| 欧美一级二级三级蜜桃| 欧美一区二区成人| 久久尤物视频| 一区二区三区视频在线| 国内一区二区在线视频观看| 亚洲女同精品视频| 亚洲人成网站色ww在线| 欧美少妇一区| 国产精品黄页免费高清在线观看| 久久综合伊人77777蜜臀| 亚洲日本电影| 国产精品精品视频| 亚洲精品久久久久久久久久久久久| 久久精品视频免费观看| 久久中文字幕一区| 欧美另类高清视频在线| 国产精品美女主播在线观看纯欲| 亚洲免费观看高清在线观看| 亚洲视频综合| 欧美一区深夜视频| 国产精品久久久一区二区| 国产精品多人| 欧美国产日本| 国产亚洲欧美日韩美女| 欧美精品一区二区蜜臀亚洲| 久久视频在线视频| 欧美国产大片| 可以免费看不卡的av网站| 99国产精品国产精品久久| 亚洲日本电影| 亚洲国产乱码最新视频| 夜夜狂射影院欧美极品| 欧美激情第五页| 伊人成人在线视频| 国产精品蜜臀在线观看| 激情一区二区三区| 欧美日韩国产欧| 欧美日韩一区在线播放| 欧美日韩一二区| 国产婷婷一区二区| 久久精品国产第一区二区三区最新章节| 亚洲精品国产拍免费91在线| 亚洲永久免费av| 国产精品视频不卡| 亚洲国产成人porn| 久久免费视频在线观看| 亚洲精品在线观看视频| 亚洲综合精品四区| 久久久久久亚洲精品杨幂换脸| 老色鬼久久亚洲一区二区| 亚洲免费一级电影| 久久婷婷亚洲| 夜夜狂射影院欧美极品| 精品99一区二区三区| 久久久91精品国产一区二区精品| 欧美日韩在线视频一区二区| 在线看欧美日韩| 亚洲综合大片69999| 午夜影视日本亚洲欧洲精品| 黄色亚洲精品| 欧美11—12娇小xxxx| 欧美性事在线| 欧美日韩在线精品| 羞羞漫画18久久大片| 国产精品欧美激情| 久久偷看各类wc女厕嘘嘘偷窃| 久久久久久久一区二区三区| 久久精品99| 91久久久精品| 久久久999成人| 免费中文字幕日韩欧美| 欧美刺激午夜性久久久久久久| 国产日本欧美一区二区| 99天天综合性| 好看的日韩视频| 欧美激情性爽国产精品17p| 亚洲国产另类久久精品| 欧美h视频在线| 国产日韩精品在线| 美女主播一区| 美女性感视频久久久| 亚洲欧美日韩精品综合在线观看| 久久久噜噜噜久久中文字幕色伊伊| 久久精品国产99精品国产亚洲性色| 亚洲国产黄色| 欧美国产日韩精品免费观看| 亚洲欧美日韩中文播放| 欧美精品入口| 香蕉久久夜色精品| 中文亚洲欧美| 亚洲国产精品第一区二区| 免费欧美视频| 一区二区动漫| 国产女人18毛片水18精品| 亚洲精品视频免费观看| 亚洲欧美电影院| 亚洲视频电影图片偷拍一区| 亚洲一区二区三区午夜| 国产日韩高清一区二区三区在线| 国产综合色在线视频区| 亚洲欧美综合精品久久成人| 美女啪啪无遮挡免费久久网站| 国产精品美女黄网| 久久天天躁狠狠躁夜夜爽蜜月| 国产精品v欧美精品v日韩精品| 亚洲人成啪啪网站| 欧美久久在线| 久久先锋资源| 国内精品视频一区| 亚洲精品免费在线播放| 一本到高清视频免费精品| 国产一区日韩二区欧美三区| 国产精品高清一区二区三区| 久久久久久久波多野高潮日日| 欧美激情亚洲综合一区| 国产精品自拍在线| 久久在精品线影院精品国产| 久久九九热re6这里有精品| 亚洲精品一线二线三线无人区| 欧美成人午夜剧场免费观看| 亚洲美女黄网| 国产免费观看久久黄| 亚洲网站啪啪| 免费在线亚洲欧美| 久久久久一区二区三区四区| 午夜精品电影| 国产欧美大片| 欧美国产激情二区三区| 亚洲网站在线看| 亚洲午夜久久久久久久久电影网| 香蕉乱码成人久久天堂爱免费| 国产精品日韩欧美综合| 久久精品视频在线| 久久一二三国产| 国产乱理伦片在线观看夜一区| 亚洲免费成人| 亚洲精品视频啊美女在线直播| 欧美了一区在线观看| 欧美日韩国产综合在线| 亚洲自拍偷拍麻豆| 国产精品一区三区| 一区二区三区久久网| 久久久午夜视频| 欧美风情在线观看| 在线观看成人av| 亚洲欧洲av一区二区三区久久| 韩国v欧美v日本v亚洲v| 精品不卡在线| 午夜精品亚洲一区二区三区嫩草| 一区二区视频免费完整版观看| 国内一区二区在线视频观看| 久久疯狂做爰流白浆xx| 激情文学综合丁香| 亚洲一二三区在线| 欧美性事免费在线观看| 在线观看日韩精品| 久久色在线观看| 亚洲第一在线视频| 欧美成人午夜免费视在线看片| 国内成+人亚洲| 亚洲大胆人体在线| 欧美日韩亚洲系列| 最近中文字幕mv在线一区二区三区四区| 国外成人在线| 亚洲激情视频在线观看| 亚洲激情第一区| 亚洲精品免费电影| 欧美日韩一区二区在线| 免费在线国产精品| 国产精品一区二区你懂的| 欧美日韩黄色一区二区| 欧美韩日一区二区三区| 国产精品国产三级国产普通话99| 国产精品yjizz| 日韩视频一区二区三区在线播放| 在线成人国产| 国内精品模特av私拍在线观看| 极品尤物av久久免费看| 亚洲四色影视在线观看|