三葉蟲掃地機(jī)器人設(shè)計(jì)

第一章緒論1.120世紀(jì)60年代機(jī)器人在工業(yè)基礎(chǔ)不斷的發(fā)展下而誕生，隨著科技與社會(huì)的不斷發(fā)展及進(jìn)步，機(jī)器人的功能不斷豐富。而服務(wù)型機(jī)器人也慢慢進(jìn)入大眾的視野與生活中。21世紀(jì)，隨著國(guó)內(nèi)經(jīng)濟(jì)的不斷發(fā)展，工業(yè)進(jìn)程逐步加快，原存在于發(fā)達(dá)國(guó)家中的智能掃地機(jī)器人也漸漸出現(xiàn)在國(guó)人的生活工作中，并慢慢被人們所接受；掃地機(jī)器人作為服務(wù)機(jī)器人大家庭中的一員，在經(jīng)歷不斷地更新?lián)Q代后，可以想象必將成為每個(gè)家庭不可或缺的一份子，甚至在未來(lái)會(huì)取代人工清潔。我們國(guó)家研究此類的專家說(shuō)，對(duì)于我們平時(shí)使用的吸塵器，在他使用過(guò)程中利用規(guī)劃的計(jì)算方法對(duì)他的清掃過(guò)程進(jìn)行計(jì)算，可以讓他排除掉人的因素，從而可以自己操作的器件。他有檢測(cè)面前障礙的開(kāi)關(guān)，檢測(cè)下一步環(huán)境的開(kāi)關(guān)和攝像頭等器件，這些東西可以讓它定位自己當(dāng)時(shí)的狀態(tài)同時(shí)也能讓它對(duì)下一步的運(yùn)動(dòng)軌跡做出判斷。它可以利用專門的檢測(cè)裝置來(lái)判斷這地面的干凈狀況，同時(shí)根據(jù)之前的記錄判斷已經(jīng)被清掃過(guò)的地方。另外因?yàn)樗脕?lái)充電的底座安裝了紅外線檢測(cè)裝置，當(dāng)電量較低時(shí)，它就開(kāi)始利用紅外線裝置尋找可以充電的插座。在這一設(shè)備運(yùn)行中由于地面不是固定的，因此需要在底部安裝防治跌到摔落的器件用來(lái)檢測(cè)地面的狀況，當(dāng)可以判斷出地面發(fā)生變化時(shí)，它可以暫停并且重新規(guī)劃線路。在用來(lái)掃地的機(jī)器人的持續(xù)發(fā)展中智能掃地機(jī)器人不斷發(fā)展的過(guò)程中，需要對(duì)它的是否可以隨處攜帶，價(jià)格的高低是否對(duì)得起它的功能，它使用過(guò)程中的安全性等有更高的要求，因此需要一種不改變其基本理論但是又更適應(yīng)于更多消費(fèi)者的掃地機(jī)器人是我們現(xiàn)在應(yīng)該研究和設(shè)計(jì)的。1.2國(guó)內(nèi)外發(fā)展現(xiàn)狀經(jīng)過(guò)幾十年計(jì)算機(jī)技術(shù)的狂飆發(fā)展，控制和感應(yīng)單位不斷更新?lián)Q代，機(jī)械裝置更加輕巧、簡(jiǎn)單，搭配中央微處理器外加感應(yīng)器件的各種外部裝置越來(lái)越趨于智能化和人性化。作為行業(yè)前端的日韓、歐美家電企業(yè)都把研究、研發(fā)目標(biāo)定于智能機(jī)器人這一新興領(lǐng)域，而智能掃地機(jī)器人，正是吸塵器與計(jì)算機(jī)技術(shù)的結(jié)合產(chǎn)物。圖1-1三葉蟲掃地機(jī)器人2001年11月，瑞典家電巨頭萊克斯高調(diào)發(fā)布了其公司最新推出的智能吸塵器機(jī)器人，公司稱“它”為“三葉蟲”。這也是全球第一款量產(chǎn)的智能掃地機(jī)器人。它被萊克斯公司寄予厚望，正如它的名字，希望它能像三葉蟲一樣遍布世界并在每一塊家庭的地板上完成自己的使命。三葉蟲主體為塑料材質(zhì)，經(jīng)典的圓桶的形狀仍然被現(xiàn)在的新款機(jī)器人采用。它出色的避障能力得益于其使用的超聲掃描技術(shù)，所以夜晚的黑暗完全不會(huì)影響他的正常工作。在單片機(jī)的控制下機(jī)器底部的車輪能夠主動(dòng)運(yùn)動(dòng)，同時(shí)采用滾掃與抽吸相結(jié)合的清潔方式也保證了其一定的清潔能力。由于智能化的編程，使其能在電量低時(shí)自動(dòng)返回基地進(jìn)行充電，并當(dāng)垃圾倉(cāng)裝滿后，會(huì)智能發(fā)出提示。在智能掃地機(jī)器人這個(gè)行業(yè)的發(fā)展初期，阻礙其發(fā)展的主要原因有三，1.大眾對(duì)于這一新鮮事物不能接受，2.MCU行業(yè)落后發(fā)展，3.價(jià)格居高不下的硬件成本。但這一情況從2002年開(kāi)始，已慢慢改善，美國(guó)Irobot和臺(tái)灣PROSCENIC都退出新款機(jī)器人。憑借其roomba780這一系列掃地機(jī)器人，榮獲紅點(diǎn)設(shè)計(jì)提名獎(jiǎng)的美國(guó)機(jī)器人專家公司irobot，最大的技術(shù)支撐就是實(shí)現(xiàn)了隊(duì)機(jī)器人處理器的算法優(yōu)化，其核心就是提高清掃效率，有效的避免了重復(fù)清掃。圖1-2RULO掃地機(jī)器人臺(tái)灣知名品牌PROSCENIC推出的RULO掃地機(jī)器人，其三角形的外觀讓他具有很高的辨識(shí)度，同時(shí)松下認(rèn)為三角形的外觀能夠更有效的提升對(duì)角落的清掃能力。RULO配備了更大的集灰盒，這表示擁有了更強(qiáng)的垃圾處理容量，即使客戶未在家中，也能通過(guò)“輔助遙控器”進(jìn)行清掃任務(wù)的制定。同時(shí)也配備了更強(qiáng)的供電系統(tǒng)，這是它擁有更長(zhǎng)的續(xù)航時(shí)間和更優(yōu)秀的電池壽命。另外，還有許多國(guó)外品牌諸如：德國(guó)KarcherRC4000、美國(guó)Neato、瑞典electrolux、LG、東芝等在對(duì)于掃地機(jī)器人的探索中，我們國(guó)家與其他的發(fā)達(dá)國(guó)家而言還比較遲，但是這些年來(lái)我們的研究技術(shù)有著很快的發(fā)展。二十年代初期，我們國(guó)家中某一大學(xué)的實(shí)驗(yàn)室和一公司進(jìn)行了合作，研究出了對(duì)生活環(huán)境內(nèi)進(jìn)行清掃的機(jī)器人bl001，在它前面的左面和右面都安裝了紅外線的檢測(cè)裝置，這增加的裝置可以對(duì)墻壁進(jìn)行探索，因此可以讓它順著房子的四維進(jìn)行清掃，這樣可以對(duì)它工作的房屋有準(zhǔn)確的信息，從而可以使每次工作時(shí)間一定。之后采用合適的方法對(duì)運(yùn)動(dòng)軌跡進(jìn)行更有效率的規(guī)劃。當(dāng)工作結(jié)束后可以自己返回到充電口充電。從二十年代初期到現(xiàn)在，更多的公司開(kāi)發(fā)出來(lái)了一個(gè)接一個(gè)的產(chǎn)品，功能也隨之越來(lái)越豐富。國(guó)內(nèi)生產(chǎn)的智能化的掃地機(jī)器人有科沃斯、益節(jié)等，它們有更多的功能，包括不是直接接觸的超聲波技術(shù)，不受線路控制的遙控等技術(shù)。國(guó)貨的掃地機(jī)器人如普桑尼克藍(lán)天s，科斯沃DT58G等比較受歡迎。小米公司生產(chǎn)的米家掃地機(jī)器人，具有地圖生成，路徑規(guī)劃，自動(dòng)回充，斷點(diǎn)續(xù)傳等先進(jìn)技術(shù)1.3論文研究的主要內(nèi)容由于現(xiàn)在生活水準(zhǔn)的提高和越來(lái)越快的生活節(jié)奏，人們對(duì)掃地機(jī)器人的需要越來(lái)越高，但同時(shí)也暴露出許多問(wèn)題和缺陷。在實(shí)際使用上，由于缺乏良好的路徑規(guī)劃方案，致使清掃效率底下，續(xù)航時(shí)間短等諸多問(wèn)題。本文先對(duì)國(guó)內(nèi)和國(guó)外的智能掃地機(jī)器人的發(fā)展和研究狀況的基礎(chǔ)上，對(duì)它提出了新的設(shè)計(jì)方案。也提出了對(duì)運(yùn)動(dòng)軌跡進(jìn)行更有效率的計(jì)算方法，探索并設(shè)計(jì)了一種花錢更少、更靠譜、使用更簡(jiǎn)單、后續(xù)維修和保護(hù)更方便的智能掃地機(jī)器人。（1）對(duì)現(xiàn)在各種智能掃地機(jī)器人工作過(guò)程的考慮，并且結(jié)合實(shí)際使用過(guò)程中的問(wèn)題分析它的優(yōu)點(diǎn)和缺點(diǎn)，發(fā)現(xiàn)沒(méi)有最合適的計(jì)算方法。因此這次設(shè)計(jì)以機(jī)器人工作的現(xiàn)實(shí)為基礎(chǔ)。同時(shí)，結(jié)合機(jī)器人的工作環(huán)境和特點(diǎn)，得到了一種有用的、穩(wěn)當(dāng)?shù)墓ぷ饔?jì)算方法。（2）對(duì)國(guó)內(nèi)外智能掃地機(jī)器人的結(jié)構(gòu)進(jìn)行了研究。根據(jù)本文的目標(biāo)要求，設(shè)計(jì)了一種基于stm32硬件的智能掃地機(jī)器人。對(duì)機(jī)器人的工作狀況和工作過(guò)程中遇到的情況進(jìn)行綜合的檢測(cè)裝置。對(duì)機(jī)器人進(jìn)行清潔的多驅(qū)動(dòng)電路，并設(shè)計(jì)了可以給它提供主動(dòng)充電的地點(diǎn)。（3）對(duì)超聲波、MPU-6050、光電編碼傳感器等進(jìn)行了在軟件層面的再次設(shè)計(jì)，并檢測(cè)了計(jì)算工作軌跡的方法。第２章系統(tǒng)總體方案2.1路徑規(guī)劃的意義及效果的衡量標(biāo)準(zhǔn)通過(guò)對(duì)文獻(xiàn)的理解并結(jié)合實(shí)際情況的觀察，對(duì)于掃地效果的本文提出五個(gè)參數(shù)以供衡量。（1）電量損耗率電量損耗率指執(zhí)行完全部目標(biāo)任務(wù)后機(jī)器人自身電量的損耗程度。因受掃地機(jī)器人體積、自身重量、承重能力、電池技術(shù)的制約，導(dǎo)致機(jī)器人執(zhí)行清掃任務(wù)時(shí)的電量消應(yīng)有所計(jì)劃，故在進(jìn)行路徑規(guī)劃時(shí)也應(yīng)該考慮如何降低電量損耗。執(zhí)行完全部目標(biāo)任務(wù)后機(jī)器人自身電量的損耗程度，（2）覆蓋率覆蓋率c是指機(jī)器人清掃的實(shí)際區(qū)域與目標(biāo)完成區(qū)域之比，這個(gè)比值越高證明清掃的越全面。S用于目標(biāo)完成區(qū)域的表示，用于清掃實(shí)際區(qū)域的表示（3）重復(fù)率根據(jù)既定算法執(zhí)行完成全部清掃任務(wù)后，重復(fù)執(zhí)行的區(qū)域面積與總區(qū)域之比，稱為重復(fù)率，其中用p表示重復(fù)率，用表示重復(fù)執(zhí)行的區(qū)域面積。（4）交叉率智能機(jī)器人工作的區(qū)域可以理解為一個(gè)二維平面，工作時(shí)所走過(guò)的可以類比為線段，當(dāng)線段的交叉點(diǎn)越多，證明智能機(jī)器人完成任務(wù)時(shí)重復(fù)經(jīng)過(guò)的次數(shù)越多，而交叉率即指交叉點(diǎn)的數(shù)量同執(zhí)行目標(biāo)總區(qū)域之比。用m來(lái)表示交叉點(diǎn)的數(shù)量（5）工作的時(shí)間效率指機(jī)器人完成全部清掃任務(wù)所耗費(fèi)的時(shí)間t，能夠體現(xiàn)出路徑規(guī)劃方案的規(guī)劃效果。為了高效的完成清掃任務(wù)，合理的路徑規(guī)劃是必不可少的，隨機(jī)清掃必然會(huì)導(dǎo)致重復(fù)清掃、清掃遺漏等諸多問(wèn)題，這是我們身為設(shè)計(jì)者所不愿意看到的。根據(jù)實(shí)際情況可知，我們要設(shè)計(jì)的智能掃地機(jī)器人的工作區(qū)域是固定的，即任務(wù)區(qū)域的面積，形狀，這就為路徑規(guī)劃提供了優(yōu)良的前提條件。在這固定的區(qū)域中同樣存在著許多變量，如障礙物的分布，這是一個(gè)動(dòng)態(tài)的、未知的、無(wú)法預(yù)測(cè)的變量，這也為路徑選擇提供了實(shí)際的意義。所以我選擇通過(guò)以上五個(gè)衡量標(biāo)準(zhǔn)來(lái)判定路徑規(guī)劃的效果。2.2路徑規(guī)劃技術(shù)根據(jù)任務(wù)可將機(jī)器人的路程計(jì)劃分為兩種：（1）任務(wù)點(diǎn)到任務(wù)點(diǎn)規(guī)劃；（2）全覆蓋規(guī)劃。而智能掃地機(jī)器人應(yīng)該選用后者，通過(guò)傳感器收集環(huán)境具體參數(shù)，在限定的空間范圍，盡可能低的重復(fù)率完成非障礙區(qū)的全覆蓋清掃。全覆蓋路徑規(guī)劃的應(yīng)用領(lǐng)域遠(yuǎn)不止智能掃地機(jī)器人，在執(zhí)行水下任務(wù)的水下機(jī)器人（auv）、建立三維地形的空中機(jī)器人、草地除草、路邊鋪裝、軍事探雷等均得到應(yīng)用。2.2.1全覆蓋路徑規(guī)劃方法（1）隨機(jī)法隨機(jī)法是市面上目前低端掃地機(jī)器人采用的路徑規(guī)劃方法，具體為機(jī)器人依據(jù)設(shè)定的遍歷路線如三角形、五邊形、Z字等嘗試性的進(jìn)行循環(huán)覆蓋，若遇到有預(yù)案障礙，便會(huì)跳轉(zhuǎn)到轉(zhuǎn)向函數(shù)進(jìn)行避障。前文中的roomba便是采用這一路徑規(guī)劃方法。這一方法是以消耗時(shí)間來(lái)?yè)Q取覆蓋效果的低成本方案，但其工作原理致使其擁有重復(fù)率高，面對(duì)復(fù)雜情況無(wú)法有效避障等缺陷。單元域分割法通過(guò)算法將工作區(qū)域分割為獨(dú)立且連續(xù)的單元域，掃地機(jī)器人以單元域?yàn)樽钚挝?，依照?yōu)先順序進(jìn)行逐個(gè)單元域的清掃。單元域分割法的主體即為分割邏輯，在理論最優(yōu)的情況下是工作區(qū)域中的障礙物均分布在域的邊緣，便可進(jìn)行連續(xù)的最優(yōu)覆蓋?？梢晥D法

首先將機(jī)器人、目標(biāo)位置和障礙物都化為“點(diǎn)”這一最小單位，然后將各點(diǎn)在二維平面上相連，如果線段未有相交即可認(rèn)為此時(shí)是可視的，最后在計(jì)算并找尋其中的最優(yōu)規(guī)劃。這一方法是建立在對(duì)環(huán)境要素的高度探測(cè)和大量的采集數(shù)據(jù)，在復(fù)雜條件下這便對(duì)機(jī)器人的處理能力，探測(cè)能力有很高的要求，致使難以達(dá)到預(yù)期效果。網(wǎng)格法將智能掃地機(jī)器人工作總區(qū)域分割為若干含有兩個(gè)值的單元網(wǎng)格，其中兩個(gè)值分別表示單元中包含障礙物的大小和有無(wú)，設(shè)計(jì)者依托這種原理使得環(huán)境地圖的收集建立更加簡(jiǎn)易，并使系統(tǒng)計(jì)算量減小。但其中技術(shù)關(guān)鍵在于網(wǎng)格大小的劃分，網(wǎng)格大，無(wú)法詳盡描述環(huán)境信息，網(wǎng)格小，就需要強(qiáng)悍的硬件來(lái)解決信息存儲(chǔ)量變大和傳感器探測(cè)環(huán)境需求增加的問(wèn)題。2.2.2全覆蓋方案選擇經(jīng)過(guò)智能掃地機(jī)器人這一領(lǐng)域的不斷發(fā)展與研究，越來(lái)越多的路徑規(guī)劃方案出現(xiàn)，可供設(shè)計(jì)人員采用的方案也越來(lái)越多，但市面上的成品機(jī)器人更多的仍是采用多種方案融合的路徑規(guī)劃方法。因?yàn)檫@些路徑規(guī)劃方案在原理實(shí)施方面并不矛盾，可以合成為總體方案，互補(bǔ)長(zhǎng)短，是最終的路徑規(guī)劃更加合理，更有效率。在經(jīng)過(guò)優(yōu)缺點(diǎn)與生產(chǎn)成本的互相對(duì)比后，本文中的路徑規(guī)劃選擇隨機(jī)法與單元域分割法相結(jié)合的設(shè)計(jì)方案，主要原因?yàn)椋弘S機(jī)法：（1）硬件計(jì)算量少，更易實(shí)現(xiàn)；（2）不會(huì)增加軟硬件系統(tǒng)方面的多余負(fù)擔(dān)；（3）在無(wú)法定位時(shí)，依靠系統(tǒng)算法仍可繼續(xù)規(guī)劃任務(wù)；（4）依托對(duì)智能掃地機(jī)器人的基礎(chǔ)移動(dòng)邏輯最優(yōu)選擇，能達(dá)到更強(qiáng)的覆蓋適應(yīng)性。單元域分割法：（1）由其原理決定，對(duì)于任務(wù)空間中環(huán)境特征明顯的區(qū)域，具有很強(qiáng)的適應(yīng)性；（2）通過(guò)其分割原理，可減少信息量，便于單片機(jī)的處理，減少軟硬件方面的壓力；（3）在執(zhí)行單元中清掃任務(wù)時(shí)可以使用隨機(jī)法，在執(zhí)行夸單元任務(wù)時(shí)可以使用預(yù)定模型處理。2.3路徑規(guī)劃方案探討2.3.1環(huán)境地圖的初期建立環(huán)境地圖是路徑規(guī)劃的基礎(chǔ)，只要掌握任務(wù)環(huán)境中的動(dòng)態(tài)、穩(wěn)態(tài)變化才能進(jìn)行路徑規(guī)劃。只有在環(huán)境地圖不斷地建立與更新中，才能實(shí)現(xiàn)路徑規(guī)劃。本文討論以下三種建立方法：拓?fù)涞貓D這是一種把環(huán)境信息表示為點(diǎn)和線段的表示方法，最早由Brooks等人提出，具有緊湊簡(jiǎn)介的優(yōu)點(diǎn)。用節(jié)點(diǎn)表示任務(wù)空間中關(guān)鍵點(diǎn)，如：充電樁、障礙、拐角、出發(fā)點(diǎn)等，再由線段連接。其地圖復(fù)雜程度取決于環(huán)境中具體的關(guān)鍵點(diǎn)數(shù)量和線段連接關(guān)系。以此原理建立的環(huán)境地圖，忽視了關(guān)鍵點(diǎn)的形狀和大小，對(duì)定位信息表示模糊。對(duì)于特征模糊的關(guān)鍵點(diǎn)不能很好地執(zhí)行任務(wù)，在全覆蓋路徑規(guī)劃中具有很強(qiáng)的局限性，僅適用于點(diǎn)對(duì)點(diǎn)的任務(wù)。特征地圖特征地圖又叫幾何特征地圖，通過(guò)傳感器來(lái)探測(cè)環(huán)境信息的幾何特征包括點(diǎn)、線。平面，如轉(zhuǎn)交、邊緣等。將幾何特征整合編碼后用于建立特征地圖。為了建立有效詳盡的地圖，就需要配備精度更高的傳感器，為了后期處理效率，我們一般選擇具有預(yù)處理功能的傳感器模塊。特征法與網(wǎng)格法相比較，具有預(yù)估位置簡(jiǎn)單，邏輯執(zhí)行緊湊，識(shí)別目標(biāo)輕松的特點(diǎn)。但由于當(dāng)環(huán)境復(fù)雜，幾何特征過(guò)多時(shí)，對(duì)傳感器和處理能力的要求很高，所以更適合應(yīng)用于高結(jié)構(gòu)化的環(huán)境。網(wǎng)格地圖這是一種數(shù)字化的創(chuàng)建方法，它將具體環(huán)境信息網(wǎng)格化，切割成一個(gè)個(gè)網(wǎng)格單元，每個(gè)單元都包含了位置信息和障礙物情況的基礎(chǔ)信息。雖然被行業(yè)廣泛應(yīng)用，但其局限主要體現(xiàn)在網(wǎng)格尺寸的規(guī)劃。尺寸越小，越能精確的表示真實(shí)情況，但同時(shí)會(huì)造成信息量增加，處理難度更大，硬件要求更高。尺寸越大，雖然會(huì)使信息量減小但其對(duì)障礙區(qū)域的判斷能力也會(huì)隨之減小，更易造成信息的漏除。因此網(wǎng)格單位的大小，要根據(jù)實(shí)際的環(huán)境信息選擇。本文經(jīng)過(guò)對(duì)比，環(huán)境地圖的建立將采取網(wǎng)格法。主要有以下原因：在后期設(shè)備調(diào)試修改中網(wǎng)格單元更便于操作；存儲(chǔ)信息全面，擁有足夠多的地圖信息供規(guī)劃時(shí)調(diào)用；基于數(shù)字化的優(yōu)勢(shì)，更利于與計(jì)算機(jī)層面相結(jié)合。2.3.2路徑規(guī)劃與環(huán)境地圖的中期建立針對(duì)常規(guī)隨機(jī)法重復(fù)率高，完成全覆蓋時(shí)效性低，電量消耗巨大的缺點(diǎn)，本文對(duì)常規(guī)隨機(jī)法進(jìn)行了一些改變，將采取內(nèi)螺旋式隨機(jī)法完成清掃任務(wù)。aHaH圖2-1內(nèi)螺旋隨機(jī)法示意圖經(jīng)過(guò)第一次最外圈的清掃，可知房間內(nèi)的L、H值，設(shè)機(jī)器清掃寬度為a，即用L和H與a的比值可以表達(dá)出需要清掃的次數(shù)，余數(shù)代表仍有未清掃區(qū)域。則可描述為：設(shè)α，β|α，β為已執(zhí)行清掃任務(wù)的次數(shù)}，g（α，β）為判斷是否完成清掃任務(wù)。g（α，β）=0說(shuō)明已完成全部清掃，g（α，β）=1則說(shuō)明未完成清掃任務(wù)。在利用隨機(jī)法達(dá)到路徑全覆蓋的前提下，為了建立詳細(xì)的環(huán)境地圖，提高清掃時(shí)效性，本文將繼續(xù)采用網(wǎng)格法進(jìn)行清掃的路徑優(yōu)化。<1?因網(wǎng)格法需要含有位置信息和障礙物情況兩種信息，故對(duì)其進(jìn)行設(shè)定（1）位置信息的設(shè)定：圖2-2分割示意圖首先將執(zhí)行區(qū)域按照由外到內(nèi)，分割為一個(gè)個(gè)閉合圈型，每個(gè)圈型分為四個(gè)網(wǎng)格單元，將最外圈記為，并由外到內(nèi)用依次i+1記錄，每圈內(nèi)的網(wǎng)絡(luò)單元，按順時(shí)針記為。單元網(wǎng)格的位置可表示為。障礙物信息的設(shè)定首先由機(jī)器人對(duì)網(wǎng)格中是否有障礙物進(jìn)行判斷，并將網(wǎng)格分類到無(wú)障網(wǎng)格和避障網(wǎng)格中，以便針對(duì)不同情況執(zhí)行相應(yīng)的高效清掃。當(dāng)判定為無(wú)障網(wǎng)格時(shí)，將會(huì)執(zhí)行預(yù)設(shè)的無(wú)障清掃預(yù)案，將適當(dāng)降低網(wǎng)格環(huán)境探測(cè)強(qiáng)度，在保證清掃質(zhì)量的前提下提高機(jī)器人的行進(jìn)速率以達(dá)到提高時(shí)效性的目的。然后由機(jī)器進(jìn)行網(wǎng)格的信息編碼，無(wú)障網(wǎng)格編碼為00，避障網(wǎng)格編碼為10。10101010101000000010101010101010100000001010002.3.3環(huán)境地圖的逐步完善因隨著智能掃地機(jī)器人不斷完成重復(fù)的清掃任務(wù)，故其建立的環(huán)境也會(huì)隨著動(dòng)態(tài)的變化不斷完善，所以本文再次引入兩個(gè)數(shù)值來(lái)判定。網(wǎng)格密度網(wǎng)格密度為避障網(wǎng)格數(shù)量與網(wǎng)格全部數(shù)量的比值，隨著執(zhí)行任務(wù)的次數(shù)增加，這一數(shù)值會(huì)逐步趨于穩(wěn)定，最終可表示這一任務(wù)區(qū)域內(nèi)障礙物密度的平均值。第n次的網(wǎng)格密度可表示為：（2-5）當(dāng)任務(wù)數(shù)量不斷增加，其平均值為：（2-6）網(wǎng)格占比n當(dāng)機(jī)器人判定網(wǎng)格為避障網(wǎng)格時(shí)，因需考慮障礙物面積，來(lái)選擇合適的避障方案，所以引入網(wǎng)格占比n。網(wǎng)格占比是表示障礙物面積與所在網(wǎng)格面積的比值。當(dāng)n>25％時(shí)，表示障礙面積過(guò)大或同時(shí)占有多個(gè)網(wǎng)格，即對(duì)當(dāng)前網(wǎng)格編碼10進(jìn)行加1操作，使其編碼變?yōu)?1。當(dāng)n≤25％時(shí)，表示障礙物面積很小，可以前期進(jìn)行快速行進(jìn)清掃，當(dāng)檢測(cè)到不合適物體時(shí)再進(jìn)行躲避。2.4避障方案2.4.1避障原理避障能力的強(qiáng)弱也是衡量機(jī)器人性能的關(guān)鍵，在實(shí)際任務(wù)中，對(duì)于障礙物類型的的判斷，避障方法的選擇也是應(yīng)當(dāng)著重研究的。首先在傳感器眼中障礙物與與墻壁的感知數(shù)據(jù)并無(wú)大差別，但在實(shí)際避障過(guò)程中方案的選擇缺天差地別，所以我們下面進(jìn)行判定障礙物是否為墻壁的研究。通過(guò)內(nèi)螺旋隨機(jī)法的原理可知，若任務(wù)邊長(zhǎng)為L(zhǎng)或H，我們可知第n次需行走長(zhǎng)度M為，通過(guò)光電編碼器可測(cè)得機(jī)器人已行走，通過(guò)傳感器可測(cè)得距障礙物距離，當(dāng)<時(shí)，表示機(jī)器人遇到障礙物而非墻壁，當(dāng)即執(zhí)行避障方案，當(dāng)=時(shí)，表示機(jī)器人遇到墻壁，當(dāng)即執(zhí)行內(nèi)螺旋隨機(jī)法任務(wù)覆蓋進(jìn)行轉(zhuǎn)彎操作。因考慮不同障礙物的各異，設(shè)計(jì)出匹配所有障礙物的算法將是一個(gè)巨大的工程，因此本文將障礙物統(tǒng)一為矩形以達(dá)到便于討論的目的。這時(shí)便可通過(guò)機(jī)身上的傳感器確定繞障位置。通過(guò)傳感器可測(cè)得機(jī)器人與障礙物之間的距離。設(shè)機(jī)器人的距障規(guī)避值為，則繞障判定值為，當(dāng)為1時(shí)進(jìn)行繞障處理，為0時(shí)保持速度不變，不然則進(jìn)行減速處理。在解決何時(shí)進(jìn)行繞障任務(wù)后，就需要解決如何讓機(jī)器人回到計(jì)劃位置。我們根據(jù)幾何原理，通過(guò)傳感器獲得的數(shù)據(jù)，將、記為兩邊動(dòng)力輪行駛距離，則可知轉(zhuǎn)彎角度。設(shè)為兩輪距離。2.4.2可能造成鎖死狀態(tài)的解決AAB圖2-4異常狀態(tài)示意圖當(dāng)機(jī)器人遭遇上圖A情況時(shí)，機(jī)身前部的超聲波傳感器探測(cè)結(jié)果無(wú)異常，可機(jī)身邊緣已經(jīng)解除障礙物，這時(shí)超聲波傳感器應(yīng)與分布在機(jī)身兩側(cè)的接觸傳感器共同進(jìn)行判斷，優(yōu)先接收接觸傳感器信號(hào)。當(dāng)機(jī)器人遭遇上圖B情況時(shí)，進(jìn)入半封閉區(qū)域的機(jī)器人必然會(huì)造成無(wú)限轉(zhuǎn)彎的循環(huán)狀態(tài)，此時(shí)就需要結(jié)合機(jī)身前側(cè)和左右兩側(cè)傳感器的信號(hào)共同判斷，當(dāng)皆檢測(cè)到距離較近的信號(hào)時(shí)，執(zhí)行倒退程序，直到有一側(cè)失去近距離信號(hào)時(shí)結(jié)束倒退程序。2.5硬件體系智能掃地機(jī)器人在本文中的硬件設(shè)計(jì)主要分為以下系統(tǒng)圖2-5智能掃地機(jī)器人硬件平臺(tái)動(dòng)力及供電系統(tǒng)：本文選用了一塊12V的鋰電池作為電力供應(yīng)主體，但根據(jù)各IC的供電標(biāo)準(zhǔn)，可知我們共需要5V、3.3V、1.8V這三種工作電壓，所以本文將鋰電池輸出的12v經(jīng)由DC/DC轉(zhuǎn)換電路輸出5V、3.3V、1.8V。動(dòng)力機(jī)械結(jié)構(gòu)主要包括：機(jī)體、電機(jī)、車輪、傳動(dòng)結(jié)構(gòu)等。動(dòng)力驅(qū)動(dòng)系統(tǒng)主要包括：電機(jī)驅(qū)動(dòng)電路、穩(wěn)壓電路。主體結(jié)構(gòu)采用具有轉(zhuǎn)向靈活、控制簡(jiǎn)單的三輪設(shè)計(jì)，前方兩輪作為動(dòng)力及轉(zhuǎn)向輪拖動(dòng)后方萬(wàn)向輪進(jìn)行移動(dòng)。由L298N作為電機(jī)驅(qū)動(dòng)核心，獨(dú)立控制兩個(gè)動(dòng)力及轉(zhuǎn)向輪，通過(guò)兩輪速度差進(jìn)行轉(zhuǎn)向。同時(shí)通過(guò)電機(jī)上的光電編碼器，可測(cè)算出兩輪的移動(dòng)距離。（1）控制系統(tǒng)：主控芯片選用STM32F103Z，它是以Cortex-M3為內(nèi)核的32位處理器芯片，它具有價(jià)格低、性能強(qiáng)、功耗低的特點(diǎn)，并集成了芯片集成\t"/item/STM32F103/_blank"定時(shí)器，\t"/item/STM32F103/_blank"CAN，\t"/item/STM32F103/_blank"ADC，\t"/item/STM32F103/_blank"SPI，\t"/item/STM32F103/_blank"I2C，USB，\t"/item/STM32F103/_blank"UART，等多種功能。（2）傳感器系統(tǒng)：超聲波傳感器選型為HC-SR04，紅外線傳感器選型為TCRT5000，三軸陀螺儀選用以MPU6050為核心的傳感器電路，其他還包括接觸式傳感器。2.6軟件體系智能掃地機(jī)器人在本文中的硬件設(shè)計(jì)主要分為以下系統(tǒng)：數(shù)據(jù)驅(qū)動(dòng)采集系統(tǒng)數(shù)據(jù)驅(qū)動(dòng)采集系統(tǒng)算法執(zhí)行系統(tǒng)數(shù)據(jù)整合系統(tǒng)圖2-6軟件體系數(shù)據(jù)驅(qū)動(dòng)采集系統(tǒng)作用為驅(qū)動(dòng)傳感器工作和采集傳感器數(shù)據(jù)，主要由底層驅(qū)動(dòng)組成，其具體工作為檢測(cè)障礙物及自身運(yùn)動(dòng)情況，控制PWM信號(hào)、定時(shí)器、使能信號(hào)等數(shù)據(jù)整合系統(tǒng)主要工作為通過(guò)傳感器的信號(hào)進(jìn)行單位網(wǎng)格的類型判斷并進(jìn)行編碼，對(duì)每次執(zhí)行任務(wù)后的單位網(wǎng)格信息進(jìn)行更新。算法執(zhí)行系統(tǒng)主要利用對(duì)采集、處理后的信息進(jìn)行對(duì)動(dòng)力裝置，清掃裝置的控制，其中包含地圖建立，路徑規(guī)劃。2.7本章小結(jié)本章主要介紹了系統(tǒng)的總體設(shè)計(jì)方案。首先提出提出電量損耗率、覆蓋率、重復(fù)率、交叉率、時(shí)間效率五個(gè)參數(shù)以供衡量掃地效果，然后通過(guò)對(duì)已知路徑規(guī)劃方法的分析與對(duì)比，總結(jié)出本文選用的內(nèi)螺旋隨機(jī)法與網(wǎng)格法相結(jié)合，并對(duì)障礙物信息的編號(hào)、環(huán)境地圖的建立做了一定介紹。對(duì)系統(tǒng)的硬件平臺(tái)進(jìn)行了初步設(shè)定，并對(duì)軟件系統(tǒng)的設(shè)計(jì)流程進(jìn)行了初步規(guī)劃。第三章系統(tǒng)硬件組成3.1主控模塊系統(tǒng)圖3-1硬件系統(tǒng)總體架構(gòu)本系統(tǒng)硬件電路主要由主控制核心模塊、數(shù)據(jù)采集模塊、執(zhí)行系統(tǒng)模塊三大模塊構(gòu)成。使用紅外線傳感器、接觸傳感器、超聲波傳感器進(jìn)行障礙物檢測(cè)，使用MPU-6050進(jìn)行自身旋轉(zhuǎn)角度測(cè)量，通過(guò)車輪上的光電編碼器對(duì)車輪的速度和距離進(jìn)行測(cè)量。由電機(jī)驅(qū)動(dòng)系統(tǒng)、穩(wěn)壓電路構(gòu)成執(zhí)行系統(tǒng)模塊。STM32F103ZRT6作為控制芯片主要執(zhí)行電機(jī)控制、傳感器控制和采集。3.1.1控制核心智能掃地機(jī)器人的主要控制系統(tǒng)采用STM32F103芯片，并和其他外圍電路共同構(gòu)成主控系統(tǒng)模塊。圖3-2STM32F103ZLQFP144的原理圖封裝STM32F103系列微處理器是第一個(gè)以ARMv7-M體系結(jié)構(gòu)為基礎(chǔ)的標(biāo)準(zhǔn)32位RISC

（精簡(jiǎn)指令集）處理器，它在編碼中有很高的工作效率，在8位和16位系統(tǒng)的存儲(chǔ)空間上將ARM的性能發(fā)揮的最強(qiáng)。作為嵌入式ARM處理器，它對(duì)MCU的實(shí)現(xiàn)的貢獻(xiàn)了更劃算的平臺(tái)、對(duì)引腳數(shù)目的減少、更低的消耗，同時(shí)提供了很高的計(jì)算能力和優(yōu)秀的中斷響應(yīng)系統(tǒng)。片上的多種資源讓STM32F103系列微處理器在電機(jī)驅(qū)動(dòng)、控制的即時(shí)性、設(shè)備的便攜、PC游戲外設(shè)和空調(diào)系統(tǒng)等領(lǐng)域有著不可估量的潛力REF_Ref5429\r\h錯(cuò)誤!未找到引用源。。本文采用STM32F103ZET6作為MCU，它的主要功能有：通過(guò)wifi模塊與上位機(jī)通訊，讀取傳感器的數(shù)據(jù)并根據(jù)獲得的環(huán)境信息進(jìn)行計(jì)算，最后通過(guò)pwm波對(duì)電機(jī)進(jìn)行控制驅(qū)動(dòng)。它主要包括：512K字節(jié)的Flash存儲(chǔ)器、64K字節(jié)SRAM，112個(gè)I/O端口、八個(gè)定時(shí)器，其中基本定時(shí)器、通用定時(shí)器、高級(jí)定時(shí)器的數(shù)量分別為2、4、2，五個(gè)串口、1個(gè)DAC（12位）、3個(gè)ADC（12位）、12通道的2個(gè)DMA、3個(gè)SPI、2個(gè)IIC、1個(gè)USB、1個(gè)SDIO、1個(gè)CAN。圖3-3主控模塊電路原理圖3.1.2程序下載模塊本系統(tǒng)選擇使用usb轉(zhuǎn)串口模式進(jìn)行程序下載，僅使用一根USB線，即可通過(guò)計(jì)算機(jī)新興程序下載。電路原理圖如圖3-4所示，通過(guò)CH340G轉(zhuǎn)接芯片實(shí)現(xiàn)USB轉(zhuǎn)串口功能。其中TXD和RXD為CH340G轉(zhuǎn)接芯片的數(shù)據(jù)口，并且PA9（TXD）和PA10(RXD)為主控芯片的兩個(gè)數(shù)據(jù)口。圖3-4CH340G模塊電路原理圖3.2數(shù)據(jù)采集3.2.1環(huán)境狀態(tài)采集機(jī)器人的環(huán)境信息采集主要利用：超聲波、紅外線和接觸的檢測(cè)裝置。利用超聲波檢測(cè)裝置收集環(huán)境網(wǎng)格中的不必要物體的信息。但是超聲波存在探測(cè)不到的地方，因此還裝有了接觸和紅外檢測(cè)裝置。超聲波傳感器圖3-5HC-SR04實(shí)物圖選用HC-SR04為本設(shè)計(jì)的超聲波傳感器，它具有高達(dá)3nm的測(cè)量精度，范圍為2cm-4.0m，可滿足機(jī)器人的測(cè)距要求。圖3-6HC-SR04引腳圖VCCGND是電源，TRIG是控制端（輸入），ECHO是返回端（輸出），大致過(guò)程是TRIG給個(gè)高電平脈沖，SR40開(kāi)始發(fā)送超聲波，當(dāng)收到反射波的時(shí)候，ECHO輸出有效信號(hào)。測(cè)量從TRIG觸發(fā)開(kāi)始到接收到ECHO的時(shí)間差，即可換算出距離。測(cè)距公式為：D為障礙物距離，T為從TRIG觸發(fā)開(kāi)始到接收到ECHO的時(shí)間差，（空氣中光的傳播速度）圖3-7超聲波模塊原理圖紅外傳感器圖3-8TCRT5000實(shí)物圖TCRT5000反射式紅外傳感器采用發(fā)射功率高的紅外光電二極管和靈敏度好的光電晶體管組成。信號(hào)經(jīng)施密特電路處理，經(jīng)過(guò)處理的信號(hào)具有波形好、驅(qū)動(dòng)能力強(qiáng)等特點(diǎn)。檢測(cè)裝置的紅外發(fā)射二極管不斷發(fā)射紅外線，當(dāng)發(fā)射的紅外線沒(méi)有被反射回來(lái)或被反射回來(lái)強(qiáng)度不夠大時(shí)，此時(shí)不使用光敏三極管，此時(shí)輸出端為低電平，指示二極管一直處于熄滅狀態(tài)；當(dāng)檢測(cè)的范圍內(nèi)出現(xiàn)了不必要的物體時(shí)，所有情況與之相反?；緟?shù)：外形尺寸：長(zhǎng)32mm~37mm;寬7.5mm；厚2mm工作電壓:DC3V~5.5V，一般為5V檢測(cè)距離：1mm~8mm，焦點(diǎn)距離為2.5mm圖3-9TCRT5000電路原理圖接觸傳感器接觸傳感器用作補(bǔ)充探測(cè)，當(dāng)機(jī)身與障礙物發(fā)生接觸時(shí)，由接觸傳感器發(fā)送碰撞信號(hào)給MCU。圖3-10接觸傳感器電路原理圖3.2.2自身狀態(tài)采集因?yàn)閽叩貦C(jī)器人執(zhí)行清掃任務(wù)過(guò)程是一個(gè)運(yùn)動(dòng)過(guò)程，故需要對(duì)機(jī)體自身的狀態(tài)進(jìn)行檢測(cè)。故此本系統(tǒng)采用了MPU-6050傳感器進(jìn)行自身狀態(tài)的檢測(cè)。圖3-11MPU-6050電路實(shí)物圖MPU‐6050是第一個(gè)整合性9軸運(yùn)動(dòng)處理組件。它的角速度全格感測(cè)范圍為±250、±500、±1000與±2000°/sec(dps)，可準(zhǔn)確追蹤動(dòng)作的快和慢，并且用戶可程式控制的加速器全格感測(cè)范圍為±2g、±4g±8g與±16g。產(chǎn)品傳輸可透過(guò)最高至400kHz的或最高達(dá)20MHz的SPI。MPU‐6050可在不同電壓下工作，VDD供電電壓介為2.5V±5V、3.0V±5V或3.3V±5V，邏輯接口VVDIO供電為1.8V±5V。包裝尺寸為4x4x0.9mm。圖3-12MPU-6050電路原理圖VDD供電電壓為2.5V±5V、3.0V±5V、3.3V±5V，VDDIO為1.8V±5V。陀螺儀需要5mA來(lái)運(yùn)行，它的待命電流為5μA；加速器的工作電流為350μA，它在省電模式下電流為20μA～10Hz。3.2.3運(yùn)動(dòng)信息采集由于需要在機(jī)器人工作過(guò)程中測(cè)量機(jī)器人的移動(dòng)距離及速度，所以在電機(jī)轉(zhuǎn)軸上配置了增量式光電編碼器。圖3-13光電編碼器碼盤示意圖光電編碼器主要由光網(wǎng)盤和光電探測(cè)裝置組成。在系統(tǒng)中，由于光電碼盤與電動(dòng)機(jī)同軸，當(dāng)電動(dòng)機(jī)旋轉(zhuǎn)時(shí)，光網(wǎng)盤與電動(dòng)機(jī)保持相同的速度進(jìn)行旋轉(zhuǎn)。經(jīng)\t"/item/%E6%89%8B%E8%BD%AE/_blank"發(fā)光二極管等檢測(cè)裝置檢測(cè)輸出若干脈沖信號(hào)。通過(guò)計(jì)算每秒光電編碼器輸出脈沖的個(gè)數(shù)就能得到當(dāng)前電動(dòng)機(jī)的轉(zhuǎn)速。為了判斷旋轉(zhuǎn)方向，碼盤還可提供相位相差90°的兩個(gè)通道的光碼輸出，通過(guò)雙通道光碼的狀態(tài)變化確定電機(jī)的轉(zhuǎn)向。3.3執(zhí)行系統(tǒng)3.3.1電機(jī)驅(qū)動(dòng)電路由于STM32單片機(jī)所提供的電流無(wú)法直接驅(qū)動(dòng)直流電動(dòng)機(jī)，所以需要外加放大電路來(lái)進(jìn)行功率放大。為了適應(yīng)任務(wù)環(huán)境復(fù)雜的機(jī)體運(yùn)動(dòng)，機(jī)器人本身需要不斷進(jìn)行換向和調(diào)速，所以本系統(tǒng)以L298N作為主芯片用來(lái)電路的驅(qū)動(dòng)。L298N是一種雙H橋電機(jī)驅(qū)動(dòng)芯片，其中每個(gè)H橋可以提供2A的電流，瞬間峰值可達(dá)3A，供電電壓范圍是2.5～48v，邏輯部分5v供電，接受5vTTL的電平。功率部分的電壓應(yīng)大于6V，否則芯片不能正常工作，額定功率最大為25W。圖3-14雙極性全橋驅(qū)動(dòng)如圖3-13所示，H橋式電機(jī)驅(qū)動(dòng)電路包括4個(gè)三極管和一個(gè)電機(jī)。要使電機(jī)運(yùn)轉(zhuǎn)，必須導(dǎo)通對(duì)角線上的一對(duì)三極管。根據(jù)不同三極管對(duì)的導(dǎo)通情況，電流可能會(huì)從左至右或從右至左流過(guò)電機(jī)，從而控制電機(jī)的轉(zhuǎn)向。要使電機(jī)運(yùn)轉(zhuǎn)，必須使對(duì)角線上的一對(duì)三極管導(dǎo)通。當(dāng)VF1管和VF4管導(dǎo)通時(shí)，電流就從電源正極經(jīng)VF1從左至右穿過(guò)電機(jī)，然后再經(jīng)VF4回到電源負(fù)極,該流向的電流將驅(qū)動(dòng)電機(jī)順時(shí)針轉(zhuǎn)動(dòng)。當(dāng)三極管VF2和VF3導(dǎo)通時(shí)，電流將從右至左流過(guò)電機(jī)，從而驅(qū)動(dòng)電機(jī)逆時(shí)針轉(zhuǎn)動(dòng)。ENA/ENB為使能端，通過(guò)輸入PWM信號(hào)，實(shí)現(xiàn)控制轉(zhuǎn)速的功能。IN1-IN4為邏輯輸入端，通過(guò)改變高電平的占空比來(lái)控制左右輪的轉(zhuǎn)向。為了防止轉(zhuǎn)換狀態(tài)時(shí)產(chǎn)生的反相電流，所以接入二極管，為了防止急停、制動(dòng)時(shí)的電流反竄接入光耦隔離模塊。圖3-15電機(jī)驅(qū)動(dòng)電路3.3.2穩(wěn)壓電路本文選用了一塊12V的鋰電池作為電力供應(yīng)主體，但根據(jù)各IC的供電標(biāo)準(zhǔn)，可知我們共需要5V、3.3V、1.8V這三種工作電壓，所以本文將鋰電池輸出的12v經(jīng)由DC/DC轉(zhuǎn)換電路輸出5V、3.3V、1.8V。LM2576集成電路可直接將12v直流電壓穩(wěn)定到5V直流。其輸出誤差可在給定輸入與輸出負(fù)載時(shí)，控制在的范圍內(nèi)，并具有優(yōu)秀的負(fù)載能力可驅(qū)動(dòng)3A的負(fù)載。LM2576中集成了頻率固定器和補(bǔ)償器，使外圍電路更加簡(jiǎn)化。圖3-1612V-5V電路圖

通過(guò)AMS11173.3和ASM11171.8將5V直流電壓轉(zhuǎn)換為3.3V和1.8V直流電壓。其自帶過(guò)熱保護(hù)，具有良好的穩(wěn)壓精度（％）。圖3-1712V-3.3V和12V-1.8V電路圖3.4電機(jī)底盤使用兩個(gè)驅(qū)動(dòng)輪與一個(gè)隨動(dòng)輪的設(shè)計(jì)，通過(guò)兩個(gè)驅(qū)動(dòng)輪的速度差進(jìn)行轉(zhuǎn)向動(dòng)作，當(dāng)兩輪速度相同，方向相反時(shí)進(jìn)行原地掉頭動(dòng)作。這種結(jié)構(gòu)具有實(shí)現(xiàn)簡(jiǎn)單，動(dòng)作靈活的特點(diǎn)。本系統(tǒng)選用直流減速電機(jī)，因其具有價(jià)格低廉、精度高、易于控制、電力驅(qū)動(dòng)容易的特點(diǎn)。在電力驅(qū)動(dòng)方面，可通過(guò)電池直接進(jìn)行供電。因直流電機(jī)具有高轉(zhuǎn)速但扭矩小的特點(diǎn)，所以本系統(tǒng)選擇了配備減速器的直流減速電機(jī)，使其滿足大扭矩、低轉(zhuǎn)速的設(shè)計(jì)要求。本系統(tǒng)設(shè)計(jì)的掃地機(jī)器人設(shè)計(jì)重量為1.5KG，設(shè)計(jì)車輪直徑為42.6mm，設(shè)計(jì)最高速度為0.16m/s。則電機(jī)扭矩T，功率P為：根據(jù)數(shù)據(jù)經(jīng)驗(yàn)，在實(shí)際傳動(dòng)中會(huì)存在功率損失，其傳動(dòng)效率應(yīng)在0.7左右，所以本次設(shè)計(jì)選用的電機(jī)應(yīng)滿足實(shí)際工作功率大于理論功率180％以上，故本次選用XD-42GA775型直流加速電機(jī)。圖3-18XD-42GA775直流減速電機(jī)實(shí)物圖3.4本章小結(jié)本章主要介紹了掃地機(jī)器人的硬件設(shè)計(jì)。STM32F103ZET6作為主控模塊，使用CH340G進(jìn)行程序下載，使用超聲波、紅外線和接觸檢測(cè)裝置作為對(duì)工作環(huán)境進(jìn)行收集的主要器件，使用MPU-6050、光電編碼器作為檢測(cè)自身狀態(tài)的主要傳感器，同時(shí)介紹了電機(jī)的驅(qū)動(dòng)電路和穩(wěn)壓電路。第四章系統(tǒng)軟件設(shè)計(jì)4.1信息采集程序設(shè)計(jì)4.1.1超聲波驅(qū)動(dòng)程序?yàn)闈M足機(jī)器人對(duì)距離的測(cè)量與躲避障礙物的能力，因此在機(jī)器人內(nèi)部安裝三部超聲波的檢測(cè)裝置，用于檢測(cè)三個(gè)方位的環(huán)境信息。圖4-1超聲波操作時(shí)序圖當(dāng)超聲波模塊輸入一個(gè)10us的TTL信號(hào)到Ting引腳時(shí)，模塊內(nèi)部發(fā)出8個(gè)40KHz的脈沖，經(jīng)過(guò)處理使距離信息轉(zhuǎn)化為ECHO的持續(xù)高電平時(shí)間（），利用定時(shí)器根據(jù)式4-1可計(jì)算出距離，具體測(cè)距流程如圖4-2所示。圖4-2超聲波測(cè)距流程圖4.1.2陀螺儀及加速度計(jì)驅(qū)動(dòng)程序本系統(tǒng)采用的是MPU-6050這一款數(shù)字傳感器。在實(shí)際應(yīng)用中，通過(guò)總線可得到角、線加速度。圖4-3MPU-6050框圖通過(guò)SCL和SDA與MCU進(jìn)行連接，使得MCU通過(guò)SCL和SDA控制MPU-6050。由于本系統(tǒng)未使用其他外部設(shè)備，所以并未使用另外的IIC接口。MPU-6050初始化的各步驟如下：（1）初始化IIC接口首先初始化與MCU連接的SCL和SDA數(shù)據(jù)線。（2）復(fù)位MPU-6050恢復(fù)內(nèi)部寄存器的默認(rèn)值，對(duì)電源寄存器1的bit7通過(guò)寫1使其由（0x6b）恢復(fù)到默認(rèn)值（0x40）。為了能夠正常喚醒設(shè)備，需要將寄存器設(shè)置為（0x00)。（3）設(shè)置傳感器滿量程范圍通過(guò)角速度傳感器配置寄存器（0x1b），設(shè)置其滿量程范圍為±2000dps。通過(guò)加速度傳感器配置寄存器（0X1C),設(shè)置其滿量程范圍為±2g。（4）設(shè)置其他參數(shù)陀螺儀采樣率通過(guò)采樣率分頻寄存器（0X19）控制，這個(gè)采樣率我們一般設(shè)置為50即可。數(shù)字低通濾波器（DLPF）則通過(guò)配置寄存器（0X1A）設(shè)置，一般設(shè)置DLPF為帶寬的1/2即可。由于本系統(tǒng)不采用中斷方式讀取數(shù)據(jù)，所以關(guān)閉中斷，然后也沒(méi)外接其他傳感器，所以也關(guān)閉AUXIIC接口。MPU6050可以使用FIFO存儲(chǔ)傳感器數(shù)據(jù)，不過(guò)本系統(tǒng)沒(méi)有用到，所以關(guān)閉所有FIFO通道，這個(gè)通過(guò)FIFO使能寄存器（0X23）控制，默認(rèn)都是0。（5）配置系統(tǒng)時(shí)鐘源通過(guò)電源管理寄存器1設(shè)置系統(tǒng)時(shí)鐘源，將最低三位由默認(rèn)值0設(shè)置為1，時(shí)鐘源選擇X軸的ppl。（6）使能角速度傳感器（陀螺儀）和加速度傳感器將電源管理器2對(duì)應(yīng)位設(shè)置為0即可使能角速度傳感器和加速度傳感器。當(dāng)完成初始化后便通過(guò)應(yīng)用層對(duì)數(shù)據(jù)進(jìn)行讀取和儲(chǔ)存。圖4-4MPU-6050流程圖通過(guò)MPU6050模塊測(cè)試機(jī)體偏移角度，可以修正由兩輪誤差產(chǎn)生的軌道脫離，當(dāng)檢測(cè)到偏移角度過(guò)大時(shí)，通過(guò)調(diào)整兩輪速度可使機(jī)體恢復(fù)原始軌道。4.1.3光電編碼驅(qū)動(dòng)程序本系統(tǒng)采用分布20個(gè)透光孔的輪盤，兩透光孔間隔，車輪直徑為42.6mm，周長(zhǎng)為133.83mm，則每次間隔輸出低電平時(shí)輪子移動(dòng)6.69mm。圖4-5光電編碼器檢測(cè)流程根據(jù)式4-2、4-3可以測(cè)得小車的行駛路徑L和機(jī)身轉(zhuǎn)角θ。其中179.3mm為兩輪間距，L1和L2為兩輪脈沖數(shù)。4.2信息的建立與整合4.2.1地圖網(wǎng)格信息建立網(wǎng)格地圖主要包含的信息有：地圖外圍輪廓、網(wǎng)格單元外部特征、網(wǎng)格單元編號(hào)、網(wǎng)格單元內(nèi)部信息等。由初次清掃任務(wù)可測(cè)出網(wǎng)格地圖的外圍輪廓L、H；由兩輪直徑與外圍輪廓可知網(wǎng)格單元外部特征；通過(guò)內(nèi)螺旋隨機(jī)法的遞減因子可對(duì)網(wǎng)格進(jìn)行編號(hào)；通過(guò)各傳感器可測(cè)定網(wǎng)格內(nèi)部障礙物信息。網(wǎng)格地圖建立步驟如下：初次清掃時(shí)，通過(guò)光電編碼器測(cè)得兩對(duì)向墻壁間的距離L、H。從任務(wù)起始點(diǎn)出發(fā)對(duì)網(wǎng)格單元進(jìn)行編號(hào)信息建立,將最外圈記為，并由外到內(nèi)用依次i+1記錄，每圈內(nèi)的網(wǎng)絡(luò)單元，按順時(shí)針記為。單元網(wǎng)格的位置可表示為。在執(zhí)行清掃任務(wù)中，由機(jī)器人通過(guò)傳感器信息進(jìn)行網(wǎng)格單元的障礙物信息編碼，無(wú)障網(wǎng)格編碼為00，避障網(wǎng)格編碼為10。當(dāng)網(wǎng)格占比大于設(shè)定值，即對(duì)當(dāng)前網(wǎng)格編碼10進(jìn)行加1操作，使其編碼變?yōu)?1。當(dāng)網(wǎng)格占比小于設(shè)定值，即不對(duì)編碼進(jìn)行變更。程序函數(shù)定義：IntL,H//網(wǎng)格外圍輪廓StructMapstatus//地圖全信息{IntNumber[800][4]//網(wǎng)格編號(hào)floatl,h//網(wǎng)格單元外部特征Intcontent//網(wǎng)格單元內(nèi)部特征StructMapstatus*next//建立鏈表}圖4-6網(wǎng)格地圖建立流程圖4.2.2地圖信息整合由于掃地機(jī)器人的外部地圖環(huán)境一直處于動(dòng)態(tài)變化之中，網(wǎng)格單元的網(wǎng)格信息也應(yīng)及時(shí)的更新。尤其是當(dāng)環(huán)境信息的更新積累到一定數(shù)量時(shí)，機(jī)器人便可獲得有用的環(huán)境變化信息。在持續(xù)的清掃任務(wù)時(shí)，機(jī)器人在使用前次地圖信息的同時(shí)進(jìn)行更新，主要的更新內(nèi)容為障礙物信息。本文提出的信息整合，即表示當(dāng)?shù)貓D信息更新累積到一定數(shù)量時(shí)，掃地機(jī)器人能對(duì)環(huán)境的動(dòng)態(tài)變化做出一定判斷。圖4-7地圖信息整合系統(tǒng)對(duì)網(wǎng)格密度進(jìn)行判斷，當(dāng)信息不斷累計(jì)更新，便可以得到平均網(wǎng)格密度m，這一平均值可以反映地圖中障礙物的