畢業(yè)論文基于單片機的清掃機器人設計

1、<p><b>　　畢業(yè)設計 (論文)</b></p><p>　　題 目 基于單片機的清掃機器人設計 </p><p>　　學 院 機電工程學院 </p><p>　　專業(yè)班級 </p><p>　　學生

2、姓名 </p><p>　　指導教師 </p><p>　　成 績 </p><p>　　2016年 06 月 10日</p><p><b>

3、;　　摘 要</b></p><p>　　智能家庭清掃機器人結合了傳感器、移動機器人技術等多個領域的關鍵技術，實現(xiàn)室內(nèi)環(huán)境（地面）的半自動或全自動清潔，替代了傳統(tǒng)的人工清潔工作，具有十分廣闊的市場前景。本文首先綜述了家庭清掃機器人的國內(nèi)外研究現(xiàn)狀，在綜合比較了國內(nèi)外多種典型產(chǎn)品的基礎上，提出適合中低端用戶使用的家庭清掃機器人整體設計方案。 智能家庭清掃機器人系統(tǒng)由清掃機器人和充電站組成。清掃機器

4、人是實現(xiàn)智能清掃的主體部分，本文介紹了清掃機器人的組成部分，并完成了其結構設計與硬件電路的實現(xiàn)。考慮到存儲、接口資源及可靠性能等，主控器選擇了Freescale公司的MC9S08GB60 單片機，所構成的單片機應用系統(tǒng)功能強、性價比高，完全滿足控制功能的要求。然后，詳細說明了紅外傳感器，塵倉檢測，碰撞檢測，里程計，貼邊行走檢測以及吸塵電機、 毛刷電機、主動輪驅動電機等控制原理。在軟件設計方面，通過分析底層與路徑規(guī)劃算法的銜接，實現(xiàn)了機器

5、人直行PID 校正算法、里程計返回值的坐標變換及計算等算法，為路徑覆蓋算法提供依據(jù)。并實現(xiàn)了紅外、碰撞傳感器檢測等子程序。 </p><p>　　最后，將機器人的全部功能整合進行聯(lián)合調(diào)試。完成 PID 直線校正和里程計誤差修正后，加入路徑覆蓋算法進行房間內(nèi)的全區(qū)域覆蓋和地圖創(chuàng)建的調(diào)試。實驗結果表明，該系統(tǒng)性能穩(wěn)定、可靠，覆蓋率高，可隨時參與人為控制，安全性高，達到了智能家庭清掃機器人的設計要求。</p>

6、;<p>　　關鍵詞：清掃機器人；智能控制；單片機系統(tǒng)；路徑規(guī)劃</p><p><b>　　Abstract</b></p><p>　　Intelligent domestic cleaning robot unifies many essential technologies such as sensor, mobile robot technol

7、ogy and etc. It has realized the semiautomatic or entire automatic cleaning for indoor environment (ground) and substituted the traditional manual cleaning. It has an expansive prospect on market.</p><p>　　T

8、he paper first summarizes the domestic and foreign research on the intelligent domestic cleaning robot. Based on the comparison among many typical products, a whole design scheme of intelligent domestic cleaning robot ad

9、apt to be used by low-cost product user is brought forward.</p><p>　　The robot system is composed of cleaning robot and the battery charging station. Cleaning robot is the main part to realize the intelligen

10、t cleaning. This article introduces the constituents of cleaning robot and has completed the hardware circuits and structure design. Considered the memory, the interface resources and the reliability performance and etc,

11、 the Freescale Corporation's MCU MC9S08GB60 has been chosen as master controller, which makes the MCU application system have strong function,</p><p>　　Finally, the robot integrated with entire functions

12、 is debugged as a whole system. After the PID adjustment of robot’s straight walking and the speedomete error correction, the robot completes the tests of full path coverage and map generation added into path coverage al

13、gorithm in domestic environments. The results indicate that this system has stable, reliable performance, high percentage of coverage, capability of participating in manual control when it’s necessary, high security and

14、has achie</p><p>　　Key words: cleaning robot, intelligent control, MCU system, path planning</p><p><b>　　目 錄</b></p><p><b>　　摘 要1</b></p><

15、;p>　　Abstract2</p><p>　　第 1 章 緒 論5</p><p>　　1.1 課題背景5</p><p>　　1.2 國內(nèi)外研究現(xiàn)狀綜述5</p><p>　　1.2.1 國外研究現(xiàn)狀5</p><p>　　1.2.2 國內(nèi)研究現(xiàn)狀10</p>

16、<p>　　1.2.3 清掃機器人存在的問題分析11</p><p>　　1.3 課題研究的目的與意義11</p><p>　　1.4 本章小結12</p><p>　　第 2 章 清掃機器人的總體設計方案13</p><p>　　2.1 設計目標13</p><p>　　2.2

17、 清掃機器人的組成部分13</p><p>　　2.3 清掃機器人的設計方案14</p><p>　　2.3.1 主控系統(tǒng)14</p><p>　　2.3.2 驅動電機部分15</p><p>　　2.3.3 傳感器系統(tǒng)15</p><p>　　2.3.4 紅外遙控部分16</p&

18、gt;<p>　　2.3.5 電源部分17</p><p>　　2.3.6 充電站部分17</p><p>　　2.4 本章小結17</p><p>　　第 3 章 清掃機器人的結構與硬件設計18</p><p>　　3.1 清掃機器人的總體設計18</p><p>　　3.2

19、 清掃機器人的結構設計18</p><p>　　3.2.1 外形設計18</p><p>　　3.2.2 行走機構設計19</p><p>　　3.2.3 清掃機構設計19</p><p>　　3.2.4 吸塵機構設計21</p><p>　　3.2.5 塵倉機構設計21</p>

20、<p>　　3.3 主控系統(tǒng)22</p><p>　　3.4 執(zhí)行電機控制25</p><p>　　3.4.1 輪子電機驅動原理25</p><p>　　3.4.2 吸塵與毛刷電機的驅動26</p><p>　　3.5 傳感器部分27</p><p>　　3.5.1 測速裝置模塊27&

21、lt;/p><p>　　3.5.2 碰撞檢測27</p><p>　　3.5.3 塵倉紅外發(fā)射和接收電路28</p><p>　　3.6 紅外遙控模塊29</p><p>　　3.7 電源模塊30</p><p>　　3.8 充電站設計31</p><p>　　3.9 本章小結

22、32</p><p>　　第 4 章 清掃機器人的主體設計33</p><p>　　4.1 電機選擇33</p><p>　　4.2 蝸輪蝸桿的選擇34</p><p>　　4.3 清掃機構的電機的選擇36</p><p>　　4.4 家庭清潔機器人電池的選用37</p><p

23、>　　4.5 清掃機構中蝸桿上軸承的壽命的計算38</p><p>　　4.6 清掃機構中渦輪軸的校核39</p><p>　　第 5 章 清掃機器人的軟件設計41</p><p>　　5.1 軟件結構框圖41</p><p>　　5.2 PID 校正算法設計41</p><p>　　5.2.1

24、 PID算法的設計思想42</p><p>　　5.2.2 電機速度控制方法43</p><p>　　5.3 坐標計算原理44</p><p>　　5.4 充電站導航對接程序45</p><p>　　5.5 主控程序的設計46</p><p>　　5.6 本章小結46</p><

25、p>　　第 6 章 總 結49</p><p>　　6.1 發(fā)展趨勢49</p><p>　　6.1.1 高度智能化需求49</p><p>　　6.1.2 功能擴展49</p><p>　　6.1.3 低成本化49</p><p>　　6.2 發(fā)展49</p>

26、<p><b>　　參考文獻51</b></p><p><b>　　致謝52</b></p><p>　　第 1 章 緒 論</p><p><b>　　1.1 課題背景</b></p><p>　　近年來，隨著計算機技術與人工智能科學的飛速發(fā)展

27、，智能機器人技術逐漸成為現(xiàn)代機器人研究領域的熱點。其中，服務機器人開辟了機器人應用的新領域。服務機器人的出現(xiàn)主要有三大原因：一是勞動力成本的上升；二是人類想擺脫枯燥乏味的體力勞動，如清潔、家務、照顧病人等；三是人口的老齡和社會福利制度的完善也為某些服務機器人提供了廣泛的市場應用前景。服務機器人區(qū)別于工業(yè)機器人的一個主要特征就是服務機器人是一種適用于具體的方式、環(huán)境及任務過程的機器人系統(tǒng)，其活動空間大，具有在非結構環(huán)境下的移動性，因此服務

28、機器人大多數(shù)是移動機器人。</p><p>　　自動進行房間地面清潔的自主吸塵式家庭服務機器人，集機械學、電子技 術、傳感器技術、計算機技術、控制技術、機器人技術、人工智能等諸多學科為一體。自主吸塵機器人作為智能移動機器人實用化發(fā)展的先行者，其研究始于 20 世紀 80 年代，到目前為止，已經(jīng)產(chǎn)生了一些概念樣機和產(chǎn)品。吸塵機器人的發(fā)展，帶動了家庭服務機器人行業(yè)的發(fā)展，也促進了移動機器人技術、圖像和語音識別、傳感器

29、等相關技術的發(fā)展。</p><p>　　1.2 國內(nèi)外研究現(xiàn)狀綜述</p><p>　　1.2.1 國外研究現(xiàn)狀</p><p>　　對于機器人大家可能不會太陌生，工業(yè)機器人在很多領域都得到了比較廣泛的應用，但是對于家庭機器人我們所了解的卻相當?shù)纳?，而日本，歐美等國家的研究則比較領先，有的都已經(jīng)投入市場，在實際中投入使用。</p><p&g

30、t;　　RC3000是世界上第一臺能夠自行完成所有家庭地面清潔工作的清潔機器人，如圖1-1所示，它有光電傳感器和芯片控制，當遇到障礙時，會隨機改變一個角度，然后繼續(xù)直走，直到遇到新的障礙物。內(nèi)置了四種清潔程序，保證在遇到不同污漬的地面時，可以調(diào)整其清潔程序；通過傳感器對于地板污漬的判斷，選擇合適的應用程序。內(nèi)置光敏傳感器，確保在遇到樓梯與臺階時，能夠自動避讓，不會掉落。扁平的設計使其能夠清潔床，沙發(fā)，茶幾等家具的下部位置。其相應的充電站

31、有紅外發(fā)射、工作時間設定、工作模式選擇、充電、垃圾處理五個功能。充電站一直發(fā)射紅外定位和導航信號來指引機器人回到充電站完成充電和垃圾處理的任務；同時能夠根據(jù)用戶設定的信息來控制機器人完成相應的操作。</p><p><b>　　如圖1-1所示。</b></p><p>　　圖1-1 智能機器人RC3000</p><p>　　在日本，東日本鐵路

32、公司、Shink電器公司和Howa工業(yè)有限公司聯(lián)合研制了車站地面清掃機器人，機器人可沿墻壁從任何一個位置自動啟動，利用不斷旋轉的刷子將廢棄物掃人自帶容器中。該機器人可采用 “磁導引方式”、“示教方式”或 “墻面復制方式”控制。東日本路公司、富士工業(yè)有限公司Subaru實驗室和JR東方設施管理有限公司聯(lián)合研制了車站地面擦洗機器人，該機器人工作時一面將清洗液噴灑到地面上，一面用旋轉刷不停地擦洗地面，并將臟水吸人所帶的容器中。機器人中的感知系

33、統(tǒng)采用光纖陀螺和超聲波傳感器，自動清洗系統(tǒng)有兩種，一種是“面積設定模式”，即將待清洗的面積分為若干個單位面積，按照其存儲器中的單位面積識別其行使路線，機器人還可利用其傳感器識別和躲避障礙物；另一種叫“路徑地圖模式”，機器人按照內(nèi)裝的路徑地圖行使，機器人可存９幅地圖，并可利用ＩＣ卡作為外存，在該模式下，機器人不會避障，僅適用于需要反復擦洗的指定地段。</p><p>　　東日本鐵路公司和東芝公司聯(lián)合研制的用于座椅布

34、局簡單的列車內(nèi)部地面清洗的機器人，其體積小、重量輕、易于出人車廂及在車廂之間運動，感知系統(tǒng)采用超聲波距離傳感器和光學、接觸式的接近傳感器；機器人采用推算定位法，利用編碼器中的數(shù)據(jù)，保持自己的位置和路徑，若探測到錯誤位置，機器人會通過距離傳感器自動修正；高級的列車地面清洗包括掃除垃圾、噴灑清洗液、擦洗、回收污水、用清水沖洗和給地面打蠟六個步驟。日本靜甲株式會社的清水工廠開發(fā)出一種自動清掃機器人，可用于各種工廠的清掃工作，機器人采用光纖陀螺

35、控制機器人的方向，采用編碼器和超聲波傳感器測距，采用光學探測器探測障礙物，機器人的四周裝有橡膠墊，橡膠墊內(nèi)部裝有觸覺傳感器，一旦機器人與人接觸，觸覺傳感器信號會使機器人停下來以保證人的安全。松下和日立公司也研制出了可清掃磚地木質地板和地毯地面的清潔機器人，該機器人采用蓄電池作為動力源，可自動去充電站充電，能夠自主避障和路徑規(guī)劃。</p><p>　　松下電器產(chǎn)業(yè)公司在2002年上半年推出了家庭用清潔機器人的試制機

36、。該機器人可以根據(jù)房間的形狀、地板狀況、垃圾量進行自動清掃，還配備有避開墻壁、爐子等熱源以及障礙的安全功能；該機器人配備有50個傳感器可一邊自動行走一邊進行清掃，工作時首先沿房間四周走一圈，記憶房間形狀，然后在避開障礙物的同時開始縱橫來回移動，清潔工作完成后會自動停止。該機器人清掃一般的日本式房間約需要9min，相當于人打掃同樣大房間所需時間的1-1.5倍，可清掃房間地板的92％－93％；機器人利用光及超聲波的測距傳感器及感壓傳感器來避

37、開障礙物，機器人的內(nèi)置回轉傳感器用來控制行走姿勢以保持既定的行進方向，但在地毯上行走時如果不采取措施則會受到 “地毯花紋”影響而彎曲前進，因此該公司在機器人中安裝了方向舵?zhèn)鞲衅鳎梢詸z測出由于地毯花紋影響而產(chǎn)生的行進方向偏差，因此即使在鋪有地毯的地板上也能夠直線前進，機器人體內(nèi)還安裝有防止從臺階等高處滾下的落差傳感器、感知暖爐等熱源的熱傳感器、檢測自身所受外力大小的重量傳感器及防滑傳感器、檢測添加動力的負載傳感器，機器人同普通的障礙物最

38、少保持10cm的距離，而在探測到熱源時，將會同熱源至少保</p><p>　　20世紀90年代，美國就推出了地面清潔機器人 RoboScrub，該機器人配有激光導航系統(tǒng)，采用超聲波測距和避障，用光碼條實現(xiàn)定位。2002年９月清潔機器人＂Roomba”在美國面市，它重約２ｋｇ，直徑為30英寸，具有高度自主能力，可以游走于房間各家具縫隙間，靈巧地完成清掃工作，據(jù)說這是將用于軍事的“躲避地雷的移動技術”應用到了吸塵器上

39、。Roomba的動作有點兒遲緩，但它卻能穩(wěn)定、安全地完成任務。由于能夠在完成任務后自動切斷電源，所以可以在外出期間讓Roomba在家進行清掃。如圖1-2所示。</p><p>　　圖1-2 智能清潔機器人Roomba</p><p>　　2002年10月１日，瑞典的拉克斯電子公司與日本東芝公司共同開發(fā)的清潔機器人 “特里洛巴伊特”上市銷售，“特里洛巴伊特”主要由清掃機器和超聲波傳感器構成，

40、在工作時可避開室內(nèi)擺放的各種家具用品。只要家庭主婦領著它搞過一次清掃后，它便可以按行走過的清掃線路進行自動清掃。這種機器人是充電式的，每一次充電可連續(xù)工作１小時。</p><p>　　瑞典家電制造商伊萊克斯（EIectoIux）研制生產(chǎn)的清潔機器人小“三葉蟲”高13ｍｍ，直徑35ｍｍ，表面光滑，呈圓形，內(nèi)置搜索雷達，可以迅速地探測到并避開桌腿、玻璃器皿、寵物或任何其它障礙物。一旦微處理器識別出這些障礙物，它可重新

41、選擇路線，并對整個房間做出重新判斷與計算，以保證房間的各個角落都被清掃。在樓梯的臺階等一些沒有天然障礙物的地方，只要有一條磁鐵，小“三葉蟲”便不會跨越。小“三葉蟲”開始啟動后，體內(nèi)的搜索雷達會探測出距離最近的墻壁，先順著墻壁把地板四周的灰塵及異物吸盡。這樣它便能探測出整個房間的格局，計算出清掃整個房間所需的時間。只要一接近一件障礙物，它便會重新設定行進路線，不會漏掉每一個角落。電線或地毯的邊緣不會被認作是</p><

42、p><b>　　圖1-3 三葉蟲 </b></p><p>　　障礙物。小“三葉蟲”的吸刷裝置中裝有一只專利設計滑輪，可以越過電線或地毯邊緣，不被絆住。電源不足時，小“三葉蟲”會自動回到充電卡座自行充電。如果此時房間還沒有清掃完畢，小“三葉蟲”還有記憶功能，充好電后自己回到原處繼續(xù)吸塵，如圖1-3所示。英國、法國和澳大利亞也都推出過清潔機器人產(chǎn)品。</p><p&g

43、t;　　英國Dyson公司最近推出一種型號為DC06的智能吸塵器。這是世界首次開發(fā)研制的全自動“吸塵機器人”。這種機器人具有一定的人工智能,只需輕按開關它就會為你解除每天打掃房間的煩惱。如圖1-4所示,吸塵機器人形狀呈50厘米長的模型汽車狀,重9.2公斤左右,配置了70多個傳感器,可隨時將發(fā)現(xiàn)的情況告訴由3臺內(nèi)置電腦組成的"大腦"。"大腦"每秒可發(fā)出16條命令來指揮吸塵器的工作。充電后一按開關,機

44、器人會在瞬間通過所搭載的三臺小型計算機和70個傳感器計算出自己所在位置、房間大小及臟亂程度、家具的配置等。要是小孩或狗等外來物體接近吸塵器,它就會自動停止工作。接近樓梯口時,吸塵器會自動采取保護措施,以防止?jié)L到樓下。使用時,只要打開電源、選好速度、按下"走"鍵,吸塵器就會自動工作,其它程序都由它自己獨立完成。不過該產(chǎn)品目前價格太高(4000美元左右一臺),要真正推向市場還有相當?shù)碾y度,如圖1-4所示。</p&g

45、t;<p>　　圖1-4 智能機器人DC06</p><p>　　澳大利亞的Floor Botics公司最近也研制出可自動行駛并打掃房間的V4型機器人,如圖1-5所示。這種全自動吸塵器表面光滑,體積很小,呈圓形,內(nèi)置搜索雷達,可以搜索各種房間里的每一處,不會碰撞家具或其它障礙物。微處理小電腦使它具備在拐至屋角處能探測方向、選擇前進路線的能力。只要一放在地面上,全自動吸塵器便可自動開始工作。其搜索雷達

46、會探測出距離最近的墻壁,先順著墻壁把地板四周的灰塵及異物吸盡;然后再不規(guī)則地來回于房間的其它位置,并且能在接近障礙物之前迅速轉向。該吸塵機器人由于在主機的周圍360度配備了障礙物傳感器,因此可以在檢測墻壁及障礙物的同時打掃地面。當打掃完可以行駛的場所后,機器人就自動關閉電源。在經(jīng)過4個小時充電后可以連續(xù)工作1個小時以上,通過更換配件還可以打掃地毯等。如果打掃沒有障礙物的地面時,1個小時可以打掃360平方米。不管房間的外形及面積的大小,

47、ARNA導航算法引導機器人在任何房間的所有無遮掩區(qū)域四處運動來進行清潔工作。因為機器人導航沿房間的周圍,所以它要創(chuàng)建自己的空間參考圖,機器人不需要任何編程"教它應該去哪里”。該機器人操作簡單,僅有三個按鈕:開始,結束以及暫停</p><p>　　圖1-5 V4智能吸塵機器人</p><p>　　2003年11月，三星公司推出一款代號為VC-RP30W的機器人吸塵器，如圖1-6所

48、示。VC-RP30W主要依靠3D地圖技術來進行定位，并能靈巧地躲避障礙物，能夠快速、高效地對房間每個角落進行吸塵。當遇到障礙物或者死角等情況，VC-RP30W會自動轉向繼續(xù)工作。其強大的智能判斷系統(tǒng)使得VC- RP30W能輕易地分辨出垃圾與其他日常生活用品，機器人也允許用戶定義它的工作時間及清</p><p>　　圖1-6 三星機器人VC- RP30W</p><p>　　掃區(qū)域等，從而

49、實現(xiàn)主人不在家時機器人也能進行自動清掃。事實上，用戶除了可以對它本身進行設置以外，還能通過計算機查看安裝在機器人前部的攝像頭進行遠程遙控。整個器人的電池能維持它連續(xù)工作50分鐘，而一旦電池處于即將耗盡的狀態(tài)時它自動回到充電座補充能源，非常地智能化。它回充電站使用的是已經(jīng)生成的3D地圖，而不是像RC3000那樣使用紅外的導航信號。</p><p>　　1.2.2 國內(nèi)研究現(xiàn)狀</p><p&

50、gt;　　在國內(nèi)的一些大學，如哈爾濱工業(yè)大學、華南理工大學、上海交通大學等單位也對清潔機器人進行了大量的研究并取得了一些成果，對清潔機器人相關技術如機器感知、機器人導航和定位與路徑規(guī)劃、機器人控制、電源與電源管理、動力驅動等技術的研究則更多，這些都為清潔機器人的研究開發(fā)和推廣奠定了物質基礎和技術基礎。</p><p>　　哈爾濱工業(yè)大學于90年代開始致力于這方面的研究，與香港中文大學合作，聯(lián)合研制開發(fā)出一種全方位

51、移動清掃機器人。該機器人具有如下特點：采用全方位移動技術，使機器人可執(zhí)行對狹窄區(qū)域等死區(qū)的清掃任務；采用開放式機器人鉸制結構，實現(xiàn)硬件可擴展，軟件可移植、可繼承，使機器人作為服務載體具有更好的功能適應性；在擁擠環(huán)境下的實時避障功能，能更好地適應不斷變化的清掃工作環(huán)境；遙控操作和自主運動兩種運行方式；吸塵機構可實現(xiàn)吸塵腔路的自動轉換，提高了吸塵效率。</p><p>　　浙江大學于1999年初在浙江大學機械電子研究

52、所開始進行智能吸塵機器人的研究，兩年后設計成功國內(nèi)第一個具有初步智能的自主吸塵機器人。這種智能吸塵機器人工作時，首先進行環(huán)境學習：利用超聲波傳感器測距，與墻保持一定距離行走，在清潔這些角落的同時獲得房間的尺寸信息，從而決定清掃時間；之后，利用隨機和局部遍歷規(guī)劃相結合的策略產(chǎn)生高效的清掃路徑；清掃結束以后，自行回到充電座補充電力。吸塵機器人在5.5×3.5m2的實際家庭環(huán)境中，工作10分鐘可以達到90%以上的覆蓋率。更大房間的清

53、掃試驗還沒有進行。目前，系統(tǒng)正在引入機器視覺和全局定位功能，力圖在多房間環(huán)境下，提高自定位能力、</p><p>　　圖1-7 國內(nèi)公司生產(chǎn)的機器人KV8</p><p>　　智能決策能力以及回歸充電效率，最終提高清掃效率。如圖1-7所示。KV8保潔機器人是今年在市場以低價位賣得比較火的一款產(chǎn)品，也是國內(nèi)首個產(chǎn)品化清掃機器人。它廣泛用于家庭、辦公和娛樂場所，以及其它一些人員不便進入的地方。

54、KV8能夠通過自身的碰撞傳感器來實現(xiàn)隨機的清掃和碰撞處理，需要人工對其電池進行充電，有三種工作模式可以選擇，在啟動時伴有音樂聲。</p><p>　　1.2.3 清掃機器人存在的問題分析</p><p>　　通過對市場上幾種典型產(chǎn)品進行比較：中低檔產(chǎn)品不具備路徑規(guī)劃功能，隨機清掃效率很低；國內(nèi)產(chǎn)品不具備自動返回充電的功能；高檔產(chǎn)品使用攝像頭等高端傳感器，不利于產(chǎn)品的廣泛普及。</p

55、><p>　　本課題研究的智能清掃機器人定位為中低檔產(chǎn)品，可以實現(xiàn)以下功能：</p><p>　　(1)具有路徑覆蓋算法，實現(xiàn)高覆蓋率，低重復地清掃；</p><p>　　(2)能夠有效避障及檢測臺階，卡住時會提醒用戶，實現(xiàn)自我保護功能；</p><p>　　(3)自主性高，電池續(xù)航能力強。電量低能夠自動返回充電；</p><

56、p>　　(4)具有良好的人機交互功能，可由用戶控制清掃路徑。</p><p>　　1.3 課題研究的目的與意義</p><p>　　吸塵機器人將移動機器人技術和吸塵器技術有機地融合起來，實現(xiàn)室內(nèi)環(huán)境（地面）的半自動或全自動清潔，替代傳統(tǒng)繁重的人工清潔工作，近年來已受到國內(nèi)外的研究人員重視。作為智能移動機器人的一個特殊應用，從技術方面講，智能化自主式吸塵器比較具體地體現(xiàn)了移動機器人

57、的多項關鍵技術，具有較強的代表性。從市場前景角度講，自主吸塵器將大大降低勞動強度、提高勞動效率，適用于家庭和公共場館的室內(nèi)清潔。因此，開發(fā)自主智能吸塵器既具有科研上的挑戰(zhàn)性，又具有廣闊的市場前景。</p><p>　　融合現(xiàn)代傳感器以及機器人領域的關鍵技術，本課題旨在開發(fā)一部價格便宜，全區(qū)域覆蓋，能夠充分滿足家庭需求且方便適用的智能家庭清掃機器人。使它可以替代傳統(tǒng)的家庭人工清掃方式，使家庭生活電氣化、智能化，使科

58、技更好地為人類服務。</p><p>　　1.4 本章小結</p><p>　　智能家庭清掃機器人包括兩個部分：機器人和充電站。本課題主要研究機器人部分，包括功能分析，方案設計，硬件實現(xiàn)以及底層軟件設計。機器人按照功能主要分為5部分：主控器、傳感器、執(zhí)行電機、輸入輸出和電源部分。其中，傳感器包括紅外傳感器，塵倉檢測，碰撞檢測，里程計，貼邊行走檢測等；執(zhí)行電機包括吸塵電機、毛刷電機和主動

59、輪驅動電機（也稱行走電機）；輸入輸出部分包括紅外遙控。</p><p>　　本文完成的主要工作如下：</p><p>　　(1)分析系統(tǒng)功能需求，確定設計目標。</p><p>　　(2)綜合考慮各種功能需求設計總體方案。</p><p>　　(3)設計整體硬件電路和部分模塊的結構：包括硬件電路設計，芯片選擇和可行性論證，并詳細分析了部分單元

60、電路的工作原理。</p><p>　　第 2 章 清掃機器人的總體設計方案</p><p><b>　　2.1 設計目標</b></p><p>　　智能家庭清掃機器人的總體設計目標是研究一個能夠在無人干預情況下自</p><p>　　主完成室內(nèi)清掃工作，也可以人為控制其狀態(tài)的機器人系統(tǒng)。</p>

61、<p>　　本課題設計的清掃機器人具有自主清掃，自動返回充電，避障，防跌落，</p><p>　　卡住報警，過流檢測，塵倉滿倉檢測等功能；同時，為使機器人高效、可靠地</p><p>　　完成作業(yè)，在其內(nèi)部嵌入路徑覆蓋算法，使它脫離隨機清掃的模式，能夠記憶</p><p>　　已走過的路徑和遇到的障礙物位置，以使機器人不遺漏地進行全區(qū)域清掃和不</p

62、><p>　　重復遇到同一個障礙物，實現(xiàn)了高覆蓋率，低重復率的清掃過程；為使機器人</p><p>　　在電量過低情況下能夠主動充電，通過自動尋找和對接算法程序實現(xiàn)自動對接；</p><p>　　用戶可以通過紅外遙控器控制機器人的行走路徑，也可以遙控其返回充電站停</p><p><b>　　止工作。</b></p&g

63、t;<p>　　2.2 清掃機器人的組成部分</p><p>　　智能家庭清掃機器人系統(tǒng)由機器人和基站兩部分組成。機器人主要負責清掃地面，同時具有遙控控制，自動避障，檢測臺階和樓梯，自動返回基站充電，定時工作，過流檢測等功能；基站主要負責與機器人的紅外通訊，可發(fā)射召回信號，實現(xiàn)對機器人的充電對接。</p><p>　　機器人由5部分組成：主控制系統(tǒng)部分、執(zhí)行電機部分、傳感器

64、部分、輸入輸出部分和電源部分。結構框圖如圖2-1所示。主控系統(tǒng)使用單片機控制，包括對輸入輸出器件的操作，對執(zhí)行電機的控制，以及對傳感器的響應等，同時內(nèi)部嵌入智能軟件，包括路徑覆蓋算法和返回充電站路徑規(guī)劃程序；執(zhí)行電機部分是吸塵機器人的主要構成部分，包括行走驅動子系統(tǒng)和吸塵子系統(tǒng)，它決定了吸塵器的運動軌跡和清掃效率。行走結構采用的是輪式結構，雙輪電機通過齒輪箱驅動左右雙輪，輪子電機、吸塵電機和毛刷電機使用的都是無刷直流電機；傳感器部分即檢

65、測子系統(tǒng)，主要為了保障機器人能夠安全地工作，包括霍爾元件、PTC保護、紅外傳感器等；輸入輸出部分包括遙控子系統(tǒng)，能夠較好地實現(xiàn)人機交互的功能；電源部分為機器人工作提供電能，保證機器人能夠獨立有效的工作。</p><p>　　圖2-1 家庭清掃機器人的機構框圖</p><p>　　2.3 清掃機器人的設計方案</p><p>　　2.3.1 主控系統(tǒng)</

66、p><p>　　控制系統(tǒng)在智能家庭清掃機器人系統(tǒng)中占有重要地位，是機器人的核心部分，它決定控制性能的優(yōu)劣，直接關系到機器人使用的方便程度和清掃效率。根據(jù)機器人需要實現(xiàn)的諸多功能，主控器既要方便地控制各個子系統(tǒng)，又要運行路徑覆蓋算法程序。因而主控器需要有多個中斷源，多個I/O口，多個PWM控制通道，同時程序存儲容量大，存儲內(nèi)容掉電不丟失，為方便機器人進行功能升級，還要留有可擴展的串行通訊口。</p>&l

67、t;p>　　由于Freescale公司的單片機性能可靠，在移動機器人和汽車領域都有廣泛的應用，因此選用了Freescale公司的8位MC9S08GB60微控制器，其存儲空間大，可以滿足算法的實現(xiàn)要求；使用3.3V電壓供電，在40MHz的工作頻率下，其功率消耗不到1mw；而且該微控制器具有多種省電模式可以選用。除此之外， MC9S08GB60還具有多種功能端口，可為外圍的傳感器件提供各種控制功能，而且便于編程。</p>

68、<p>　　主控器內(nèi)部嵌有智能軟件算法：覆蓋算法和返回充電站路徑規(guī)劃算法。覆蓋算法是在清掃過程中，按一定的路徑規(guī)劃進行清掃，并且可以記憶并標記已走過的路徑和遇到的障礙物位置，下次只清掃未標記的區(qū)域，實現(xiàn)全區(qū)域的路徑覆蓋；返回充電站路徑規(guī)劃是在機器人未收到充電站發(fā)出的導航信號時，根據(jù)已記錄的地圖信息中充電站的位置，按照一定的算法向充電站靠近，直到收到導航信號后，進入導航對接程序實現(xiàn)自動對接。</p><p&

69、gt;　　2.3.2 驅動電機部分</p><p>　　機器人的工作電機分為行走、吸塵和毛刷電機。機器人行走結構中前面有一個從動轉向輪，兩側各有一個驅動輪，由無刷直流電機進行控制。清掃結構主要使用真空吸塵器和由電機帶動的旋轉毛刷。</p><p>　　永磁無刷電動機具有效率高，功率大，體積小，控制精度高等明顯特點，在機器人領域有著廣泛的應用。無刷直流電機具有良好的調(diào)速性能，由于它采用電

70、子換向，脈寬調(diào)制脈沖調(diào)速，在進一步提高直流電機性能的同時，又克服了直電機傳統(tǒng)機械換向帶來的一系列問題，從而大大延長了電機的使用壽命。直流無刷電機控制電路在實現(xiàn)上主要有控制電路微處理器、數(shù)字信號處理器和專用集成電路等3種方式。使用單片機或DSP輔以外圍處理電路的方法，其測頻、換相、控制調(diào)節(jié)等均由軟件實現(xiàn)，本課題選用單片機軟件編程的方法控制無刷直流電機。</p><p>　　吸塵器內(nèi)的風機和帶動毛刷的電機都使用直流電

71、機，由于不需要調(diào)速、換向，因此控制方法比較簡單。</p><p>　　2.3.3 傳感器系統(tǒng)</p><p>　　傳感器是機器人環(huán)境感知的主要來源，是機器人智能化的一部分，在整個系統(tǒng)中占有重要的地位。機器人技術融合了多種傳感器技術，包括紅外傳感器，接觸和接近傳感器，編碼器，超聲波傳感器等。 </p><p>　　2.3.3.1 傳感器的選擇依據(jù) </p&g

72、t;<p>　　選擇機器人傳感器應當完全取決于機器人的工作需要和應用特點，對機器人感覺系統(tǒng)的要求是選擇機器人傳感器的基本依據(jù)。機器人對傳感器的一般要求是：</p><p>　　(1)精度高，重復性好。機器人傳感器的精度直接影響機器人的工作質量。</p><p>　　用于檢測和控制機器人運動的傳感器是控制機器人定位精度的基礎。機器人能否準確無誤地正常工作，很大程度上取決于傳感器

73、的測量精度。</p><p>　　(2)穩(wěn)定性好、可靠性高。機器人傳感器的穩(wěn)定性和可靠性是保證機器人能</p><p>　　夠長期穩(wěn)定可靠地工作的必要條件。</p><p>　　(3)抗干擾能力強。機器人的工作環(huán)境是不定和未知的，在運行中可能會有</p><p>　　來自外在的干擾存在。</p><p>　　2.3.3

74、.2 傳感器的選擇 </p><p>　　避障功能是智能家庭清掃機器人必備的功能，由于室內(nèi)環(huán)境復雜，在無人看管的情況下，機器人需要自動識別障礙物并繞開行走。目前同類產(chǎn)品中主要使用了兩種方式：非接觸式避障和接觸式避障。其中，應用較多的是非接觸避障，主要原理是利用超聲波測距。但是這種方法的缺點是波束較寬，其分辨力受到嚴重的限制，不能有效地確保機器人的安全。本課題選用接觸式避障，即先碰撞后避障，使用霍爾開關對磁場變化的

75、檢測判斷是否發(fā)生碰撞。</p><p>　　塵倉紅外檢測實現(xiàn)了塵倉滿倉自動提醒用戶除塵的功能。它是由紅外發(fā)射和接收管組成的，對管安裝在塵倉的上部。根據(jù)灰塵密度的不同，紅外光透過的強度不同，接收管的輸出電壓也不同。這個變化是模擬量，需要通過實驗確定滿倉電壓值，避免塵倉未滿或者過滿所造成的誤操作。為了檢測機器人在前進速度和轉角上的變化，在兩個主動輪上安裝了光電編碼式傳感器，簡稱里程計。它可以檢測機器人的行走距離和速度

76、，同時根據(jù)左右輪速差計算出機器人偏轉的角度。選用了非接觸式光電碼盤，為提高系統(tǒng)分辨率，將碼盤安裝在機器人行走電機的電機軸上，即高速端的轉子。</p><p>　　過流檢測是電子類產(chǎn)品必要的功能之一，用來防止工作發(fā)生異常燒壞電路板造成損失。使用PTC材料做成的電流保護元件，在電子電器、玩具、汽車、電機保護等方面都有廣泛的應用，被稱為自復式保險絲。這種材料的電阻率隨溫度升高而增加，同時溫度降低后可以自動恢復，可以檢測

77、系統(tǒng)運行時的過流現(xiàn)象。一般連接在電源的入口處，能夠有效地保護電路安全。</p><p>　　邊緣檢測傳感器也是一個機械開關，開關的觸發(fā)端設計成一個滑輪結構，在機器人的兩側各裝有一個，用于保證機器人可以始終貼著墻的邊緣走。</p><p>　　2.3.4 紅外遙控部分</p><p>　　智能家庭清掃機器人在創(chuàng)建地圖的清掃過程中，可以由用戶控制其行走路徑，同時在清

78、掃完畢時能夠通過遙控召回其返回充電站結束清掃。機器人上方裝有四個紅外接收芯片，角度覆蓋范圍接近 360°，接收來自遙控器和充電站的信號。紅外發(fā)送端和接收端使用統(tǒng)一的編碼格式，各種格式對應的功能可以自行定義，可實現(xiàn)前進、后退、加速、減速、充電站召回等多種功能。</p><p>　　2.3.5 電源部分</p><p>　　電源部分選用可充電的鎳氫電池，它相比傳統(tǒng)的鎳鎘電池，具有

79、電容量高、放電深度大、耐過充和過度放電、充電時間短等明顯的優(yōu)點。最重要的是鎳氫電池不再使用有毒的重金屬作為材料，可以消除對環(huán)境的污染。鎳氫電池的溫度特性較差，有效范圍為 0℃～45℃。但室內(nèi)的環(huán)境溫度比較穩(wěn)定且可以保證在一個范圍內(nèi)，因此選用鎳氫充電電池可以充分發(fā)揮它的優(yōu)點。</p><p>　　電池安裝在機器人的兩側中部，由于容量大的電池，重量也大，會影響機器人的行走速度，繼而消耗更多的電能。因此不能單一追求電池

80、的電能而忽視重量的適度，否則將嚴重影響機器人的工作效率。當機器人工作到電量過低時，可以通過單片機內(nèi)部的AD通道檢測電池電壓，發(fā)出觸發(fā)信號使機器人自動返回充電站充電。</p><p>　　2.3.6 充電站部分</p><p>　　充電站主要負責與機器人的紅外通信．發(fā)射召回信號，引導機器人自動返回充電站進行充電。機器人在電量充足時對充電站發(fā)出的信號不做響應，當檢測到自身電量不足時．機器人

81、通過充電站發(fā)射的紅外召回信號及相應算法自動返回充電站充電。</p><p><b>　　2.4 本章小結</b></p><p>　　本章介紹了智能家庭清掃機器人的總體設計目標，并按功能將結構分為 6個部分，結合其總體框圖分別闡述了每個部分需要實現(xiàn)的功能、選擇的器件以及初步的實現(xiàn)方法，為機器人的硬件和軟件設計提供了相關的依據(jù)。</p><p>

82、;　　第 3 章 清掃機器人的結構與硬件設計</p><p>　　3.1 清掃機器人的總體設計</p><p>　　整個硬件系統(tǒng)由主控系統(tǒng)、執(zhí)行電機控制、傳感器、輸入輸出模塊和電源部分組成。傳感器包括紅外傳感器、碰撞檢測模塊、沿邊行走檢測模塊和低電壓檢測模塊，另外還有記錄機器人行走路徑信息的里程計；執(zhí)行電機控制包括主動輪驅動電機調(diào)速控制，毛刷和吸塵電機驅動模塊；輸入輸出模塊包括紅外

83、遙控。以下詳細討論每個功能模塊的設計思想和硬件電路的實現(xiàn)。</p><p>　　3.2 清掃機器人的結構設計</p><p>　　3.2.1 外形設計 </p><p>　　根據(jù)家庭清潔機器人的設計要求，本次設計的機器人應該包括清掃機構、行走機構、吸塵機構、垃圾收集處理機構，其中清掃機構的設計尤為重要。通過在網(wǎng)上搜索一些相關資料以及在圖書館查閱的資料，初

84、步把機器人的外形設計為長寬均為400mm高為100mm的長方體，但是后來發(fā)現(xiàn)所設計的結構的不合理之處，周邊有棱角的機器人在躲避障礙物是很不便，非常容易碰到障礙物，而圓形物體則比較容易避開障礙物。因而最終把機器人的外形設計為圓盤形，其外部輪廓大體如圖所示：</p><p>　　3.2.2 行走機構設計 </p><p>　　為實現(xiàn)機器人的轉彎半徑為0，在機器人的行走機構中采用兩輪驅動

85、，兩個驅動輪對稱分布在清掃機構的后方，兩個輪子和刷子支撐機體工作和運動，這樣設計既節(jié)省材料，又可以使刷子和地面全面的接觸，從而利于更徹底的清掃。在機器人轉彎時，通過控制行走機構的兩個電機的轉速及旋轉方向，進而控制兩個輪子，通過輪子的前后差速運動實現(xiàn)機體的轉彎半徑為0。</p><p>　　3.2.3 清掃機構設計 </p><p>　　在清掃機構的設計中想到了四種方案：</

86、p><p>　　(1) 電機帶動斜齒輪1，斜齒輪1帶動斜齒輪2，斜齒輪2帶動斜齒輪3，斜齒輪上的軸連接滾刷，進而實現(xiàn)清掃；</p><p>　　圖3-1 清掃機構一</p><p>　　(2) 電機帶動錐齒輪1，錐齒輪1帶動錐齒輪2，由錐齒輪2上的軸連接滾刷，進而實現(xiàn)清掃；</p><p>　　圖3-2 清掃機構二</p><

87、p>　　(3) 電機帶動蝸桿，蝸桿兩端接蝸輪，兩個蝸輪的軸上分別接刷子，從而實現(xiàn)清掃；</p><p>　　圖3-3 清掃機構三</p><p>　　(4) 電機帶動蝸桿，蝸桿兩端接蝸輪，兩個蝸輪分別接皮帶輪，皮帶輪上的軸接刷子，從而實現(xiàn)清掃。</p><p>　　圖3-4 清掃機構四</p><p>　　以上四種方案通過對比以及由設計

88、的要求所限制，最終選擇方案四為清掃機構。其正面結構如下圖所示</p><p>　　圖3-5 清掃傳動機構</p><p>　　因為所設計的機器人它的體積有限制，在直徑為四百，高為一百的圓內(nèi)要放置有清掃機構、行走機構、吸塵機構、垃圾收集處理機構，同時還得留下放電池、控制中心、觀察中心的地方，而方案一雖然易于安裝，傳動平穩(wěn)，但是斜齒輪所占的面積非常大，如果選用它，則會占用大量的空間，使其它幾個

89、單元有些部分將放置不下，從而超出所要設計的尺寸，因而否定了這種方案；方案二中，錐齒輪傳動不如斜齒輪平穩(wěn)，同時錐齒輪一所占的體積也比較大，而清掃機構又是本次設計中最重要的部分，因而選用錐齒輪的弊端也很大，所以經(jīng)過計算及各個機構總體布局的綜合考慮，舍棄了方案二；方案三中通過電機帶動蝸桿旋轉，再有蝸桿帶動其兩端的蝸輪，由蝸輪上的軸帶動固定在其上的刷子旋轉，從而實現(xiàn)了清掃的目的。為了使機器人的外壁在靠近墻邊時刷子能夠掃到墻壁的邊緣，同時使它在清

90、掃過程中沒有工作盲區(qū)，開始設計時用兩個直徑都為200mm的刷子，這樣的話，蝸輪和蝸桿的中心距就必須為100mm,而在這種中心距的情況下，蝸輪蝸桿的尺寸都比較大，雖然能夠放置下，但是蝸輪蝸桿這個裝置就顯得比較笨重，所占的重量很大，這就加重了機器的人的總重量，因而這種方案也不是很合理；最后在方案三</p><p>　　3.2.4 吸塵機構設計 </p><p><b>　　圖3

91、-6 吸塵器</b></p><p>　　在吸塵機構的設計中將風扇固定在垃圾儲藏室上壁，在風扇上罩一個薄壁腔。在薄壁腔上方開一個圓孔，以便于空氣的排出。在垃圾儲藏室上壁開兩個小長方孔，在方孔下加上一個隔塵罩。（其大體圖形如圖3-6所示）通過風扇的旋轉帶動垃圾儲藏室內(nèi)的空氣流動，又通過儲藏室內(nèi)的管腔將刷子清掃引起的塵土吸附進來，帶塵土的空氣通過防塵罩將塵土擋到垃圾儲物室內(nèi)，較干凈的空氣則通過吸塵室上壁腔

92、的圓孔排帶大氣中去。從而實現(xiàn)吸塵的目的。</p><p>　　3.2.5 塵倉機構設計</p><p>　　在對垃圾收集處理機構進行設計時，開始想用如圖下所示的結構作為垃圾收集擋板。</p><p>　　圖3-7 吸塵器原理</p><p>　　通過電機帶動和電機相連的小齒輪，小齒輪通過帶動和其配對的大齒輪帶動軸2</p>&

93、lt;p>　　旋轉，從而使軸2另一端上固定的大齒輪帶動和其相連的小齒輪旋轉，進而使垃圾收集擋板作揚起動作，將垃圾倒入其后面的垃圾儲藏室。垃圾收集擋板的揚起放下動作通過控制電機的正反轉來控制。但是此種結構所占的空間比較大，所示設計的家庭清潔機器人空間有限，不允許用這種結構，因為如果采用此種結構，</p><p>　　圖3-8 垃圾箱局部</p><p>　　將導致其它一些機構無法放置，

94、因而此種方案不可行。后來將垃圾收集和儲倉的機構設置如圖3-8所示。垃圾儲藏室安放在機體的最后邊，其前端用銷釘連接一個可以繞著銷釘旋轉的垃圾收集擋板，擋板用厚度為1mm的鋼板制成，表面光滑，旋轉的刷子可以將垃圾直接通過垃圾收集擋板掃到垃圾儲物室里，在儲物室末端，做一個和儲物室相匹配的拉門，其上端用螺釘從外壁擰入掛住在里邊，當準備倒垃圾時，將螺釘擰下來，抽出拉門，傾斜機體即可倒出垃圾。</p><p><b&g

95、t;　　3.3 主控系統(tǒng)</b></p><p>　　主控單片機選用的是 MC9S08GB/GT 系列的 8 位單片機，這個系列的單片機具有低功耗，高性能等優(yōu)點，是 Freescale 公司 8 位單片機的主流產(chǎn)品，價格便宜，性價比高。表 3-9 列出了該系列單片機的幾款主流產(chǎn)品。</p><p>　　由于功能上對程序存儲器容量、外圍接口數(shù)量和端口功能的要求，本課題</

96、p><p>　　選擇MC9S08GB60，其主要特點如下：</p><p>　　(1)擁有60K FLASH，可以滿足程序存儲的要求；</p><p>　　(2)最多56個通用I/O腳，能夠滿足外圍傳感器和電路接口的需要；</p><p>　　(3)有內(nèi)部上拉電阻的RESET和IRQ腳，可以減少用戶系統(tǒng)外圍器件；</p><p

97、>　　(4)具有10位精度的8路 AD 轉換器；</p><p>　　(5)具有兩個串行通訊接口（SCI）；</p><p>　　(6)具有串行外圍接口（SPI）；</p><p>　　(7)具有最高通訊100kbps速率的IIC總線接口；</p><p>　　(8)具有一個三通道和一個五通道的16位時基或脈寬調(diào)制模塊，且每一個模塊都可

98、實現(xiàn)輸入捕捉、輸出比較和PWM信號輸出；</p><p>　　(9)有8個鍵盤中斷輸入口，可提供8路中斷源，但不能同時使用；</p><p>　　(10)可實現(xiàn)在線編程并調(diào)試。</p><p>　　圖3-9 MC9S08GB/GT系列的產(chǎn)品</p><p>　　主控單片機與外圍電路的接口電路如圖3-10所示。</p><

99、p>　　圖3-10 主控單片機與外圍接口連接電路圖</p><p>　　如圖3-10所示，單片機使用8M的外部晶振，產(chǎn)生4M的內(nèi)部總線頻率，復位管腳上接有按鍵，便于用戶復位操作，防止程序跑飛后機器人失控。單片機共有二路電源，模擬電源和數(shù)字電源，同時內(nèi)部的AD轉換器使用的參考電壓VREFL 和VREFH也可以有由外部提供，這里設計由一路電源統(tǒng)一提供，但是模擬電源和數(shù)字電源在設計印制電路板時需要分開布線，這樣

100、可以有效地防止模擬信號與數(shù)字信號互相產(chǎn)生干擾。</p><p>　　根據(jù)外圍傳感器和電路的功能分配單片機的I/O口如下：</p><p>　　(1)四個光敏傳感器的信號輸入分別接在PTF4-PTF7，同時四路信號通過或非門與不可屏蔽外部中斷IRQ相連，在機器人遇到臺階時，可以以最高優(yōu)先級的中斷信號觸發(fā)單片機做出反應。</p><p>　　(2)四個紅外傳感器返回信號

101、接在PTF0-PTF3。</p><p>　　(3)紅外通訊使用七種功能：前、后、左、右、TURBO、F1、F2，分別連接單片機的PTE6、PTE7、PTE5、PTE4、PTA7、PTA3、PTE1。其中，TURBO為遙控器召回機器人返回充電站信號，F(xiàn)1為遠距離導航信號，F(xiàn)2為近距離導航信號。由于召回需要機器人響應用戶操作，TURBO需要使用一路中斷，另外機器人在工作過程中可以隨時被用戶的遙控控制，因此對于前、后

102、、左、右四路信號需要通過一個或非門與一路中斷相連。</p><p>　　(4)霍爾元件的返回信號（EW1和EW2）與PTE2和PTE3 連接，同時兩路</p><p>　　信號通過二極管和電阻組成的或門連接到 PTA6，在發(fā)生碰撞時觸發(fā)中斷信號。</p><p>　　(5)左右輪的浮動開關返回信號接在PTG4和PTG5，同時兩路信號通過或門連接到PTA5，在中斷發(fā)生

103、后配合查詢識別哪個輪子浮起。</p><p>　　(6)吸塵和毛刷電機的驅動控制口接在 PTG6和PTG7， 由單片機通過功率開關器件控制電機的啟停。</p><p>　　(7)鍵盤模塊的行線接在PTA0-PTA2，列線接在PTB0-PTB1，通過改變列線的電平查詢行線的狀態(tài)來判斷哪個鍵被按下。</p><p>　　(8)單片機的PTB模塊是內(nèi)部的AD轉換器，PTB

104、2、PTB3、PTB6分別連接低電壓檢測端、吸塵電機保護端、紅外塵倉檢測端，單片機可以把這些模擬量轉換成數(shù)字量對其進行判斷并執(zhí)行相關操作。</p><p>　　(9)單片機的IIC接口與時鐘芯片相連，實現(xiàn)串行的數(shù)據(jù)通訊。</p><p>　　(10)單片機的PTD2-PTD7為TPM 模塊。分別連接左右輪子行走驅動電機的方向控制、調(diào)速控制和里程計返回值?？刂品较虻膬蓚€端口設為普通I/O 口

105、，調(diào)速端口設為PWM功能，里程計返回設為輸入捕捉功能。</p><p>　　(11)貼邊檢測開關（左和右）分別連接PTE0、PTE1。</p><p>　　(12)電機電源的控制端口連接PTC4，塵倉的紅外發(fā)射連接PTB7。</p><p>　　(13)液晶顯示器連接 PTC5-PTC7，使用普通I/O 口模擬LCD的通訊協(xié)議。</p><p&g

106、t;　　3.4 執(zhí)行電機控制</p><p>　　3.4.1 輪子電機驅動原理 </p><p>　　電機的運動系統(tǒng)結構如圖 3-11 所示，它決定了機器人的運動空間，采用輪式結構。其中左右輪為主動輪，需要用可調(diào)速的電機控制，前面的轉向輪為從動輪，便于機器人的轉向。</p><p>　　直流電動機以其良好的線性調(diào)速特性、簡單的控制性能、較高的效率、優(yōu)異的

107、動態(tài)特性，一直占據(jù)著調(diào)速控制的統(tǒng)治地位。雖然近年不斷受到其他電動機(如交流變頻電動機、步進電動機等)的挑戰(zhàn)，但直流電動機仍然是許多調(diào)速控制電動機的最優(yōu)選擇，在生產(chǎn)、生活中有著廣泛的應用。眾所周知，直流電動機轉速 n 可表示如下：</p><p><b>　?。?-1）</b></p><p>　　式中 U ——電樞端電壓；</p><p>&

108、lt;b>　　I ——電樞電流；</b></p><p>　　R ——電樞電路總電阻；</p><p><b>　　φ——每級磁通量；</b></p><p>　　k ——電動機結構參數(shù)。</p><p>　　由式(3-1)可知，改變U，φ，R等變量都可達到調(diào)速的目的，但最方便有效的調(diào)速方法是對電樞電壓