掃地機(jī)的智能控制系統(tǒng)設(shè)計(jì)畢業(yè)設(shè)計(jì)說(shuō)明書(shū)

1、本科畢業(yè)設(shè)計(jì)說(shuō)明書(shū)掃地機(jī)的智能控制系統(tǒng)設(shè)計(jì)sweeper intelligent controlsystem design 學(xué)院（部）： 電氣與信息工程學(xué)院 專(zhuān)業(yè)班級(jí)： 電氣# 學(xué)生姓名： # 指導(dǎo)教師： # 年 月 日掃地機(jī)的智能控制系統(tǒng)設(shè)計(jì)摘要摘要目前，各式各樣的服務(wù)機(jī)器人越來(lái)越多應(yīng)用于人們的生活中，從事著與人們生活息息相關(guān)的服務(wù)工作，極大地提高和改善了人們的生活質(zhì)量。室內(nèi)智能掃地機(jī)器人就是在這種背景下誕生的一種家庭服務(wù)機(jī)器人。室內(nèi)智能掃地機(jī)器人的路徑規(guī)劃采用區(qū)域充滿的規(guī)劃方法，目標(biāo)是在設(shè)定區(qū)域內(nèi)尋找一條從始點(diǎn)到終點(diǎn)且經(jīng)過(guò)所有可達(dá)點(diǎn)的連續(xù)路徑。根據(jù)建立的掃地機(jī)器人平臺(tái)，提出清掃機(jī)器人隨機(jī)運(yùn)

2、動(dòng)路徑規(guī)劃算法。機(jī)器人利用其上安裝的紅外傳感器和攝像頭來(lái)識(shí)別和感知房間環(huán)境，機(jī)器人開(kāi)始以螺旋運(yùn)動(dòng)方式覆蓋房間的空白區(qū)域，當(dāng)遇到障礙物時(shí)，啟動(dòng)障礙物應(yīng)對(duì)策略，通過(guò)計(jì)算機(jī)軟件仿真和在房間環(huán)境中進(jìn)行實(shí)驗(yàn)驗(yàn)證了該算法的有效性。關(guān)鍵詞：掃地機(jī)器人，單片機(jī)，環(huán)境識(shí)別，路徑規(guī)劃sweeper intelligent controlsystem designabstractat present time,more and more various of service robots are designed and applied to peoples daily life.the application o

3、f these robots is promoting the quality of peoples life tremendously as they deal with the works related to peoples life closely.indoor automatic cleaning robot is one of these service robots developed to help people to carry out the troublesome room cleaning work.the path planning algorithm of indo

4、or automatic cleaning robot should spread over the room area using the area filling path planning algorithm to find a continuous path from start to end. a random moving path planning algorithm is put forward based on the platform. the cleaning robot identifies the room environment using the infrared

5、 transducer and the camera outfitted on its body.moving in the spiral motion mode with the gradually enlarging radius,the robot begins to explore and clean the blank area.while it encounters obstacles like wall or furniture,it will start the strategy of dealing with obstacles.this algorithm is valid

6、ated through computer simulation and robot experiment.keywords:cleaning robot,single chip microcomputer,environment identification,path planning1緒論1.1 引言自動(dòng)掃地機(jī)器人是當(dāng)今服務(wù)機(jī)器人領(lǐng)域的研究熱點(diǎn)。從理論和技術(shù)上講，自動(dòng)掃地機(jī)器人比較具體的體現(xiàn)了移動(dòng)機(jī)器人的多項(xiàng)關(guān)鍵技術(shù)，具有較強(qiáng)的代表性；從市場(chǎng)上前景講，自動(dòng)掃地機(jī)器人將大大降低勞動(dòng)強(qiáng)度，提高勞動(dòng)效率，適用于賓館酒店圖書(shū)館辦公場(chǎng)所和大眾家庭。因此開(kāi)發(fā)自動(dòng)掃地機(jī)器人既具有科研上的挑戰(zhàn)性又具有廣闊

7、的市場(chǎng)前景。1.2 研究現(xiàn)狀：自從1904年英國(guó)人發(fā)明了第一臺(tái)掃地機(jī)，至今為止掃地機(jī)的發(fā)展歷史已有近百年。而后日本、美國(guó)、德國(guó)、英國(guó)等國(guó)家就開(kāi)始了掃地機(jī)的批量生產(chǎn)。目前，國(guó)外先進(jìn)的掃地機(jī)都在不斷地提高智能水平。吸掃式小型掃地機(jī)是目前國(guó)內(nèi)外應(yīng)用最為廣泛的小型掃地機(jī)品種，通常有盤(pán)型刷和風(fēng)機(jī)、風(fēng)管道、吸塵嘴等部分。盤(pán)刷的設(shè)置加強(qiáng)了對(duì)馬路邊溝的清掃，增加了清掃寬度。盤(pán)型刷將側(cè)面的垃圾掃到吸塵嘴的工作區(qū)域，再由吸塵系統(tǒng)將垃圾吸入機(jī)內(nèi)的垃圾箱。吸掃式小型掃地機(jī)適合于任何道路環(huán)境的清掃，對(duì)污物、塵土都有很好的清掃效果，工作效率高。智能化掃地機(jī)不僅給企業(yè)帶來(lái)巨大的經(jīng)濟(jì)效益，同時(shí)也產(chǎn)生了顯著的社會(huì)效益。1.2.

8、1 路徑規(guī)劃技術(shù)路徑規(guī)劃就是根據(jù)機(jī)器人所感知到的工作環(huán)境信息, 按照某種優(yōu)化指標(biāo), 在起始點(diǎn)和目標(biāo)點(diǎn)規(guī)劃出一條與環(huán)境障礙無(wú)碰撞的路徑, 并且實(shí)現(xiàn)所需清掃區(qū)域的合理的路徑覆蓋,實(shí)質(zhì)就是掃地機(jī)運(yùn)動(dòng)過(guò)程中的導(dǎo)航和避碰。1.2.2 多傳感器融合技術(shù)為了讓吸塵機(jī)器人正常工作, 必須對(duì)機(jī)器人位置、姿態(tài)、速度和系統(tǒng)內(nèi)部狀態(tài)進(jìn)行監(jiān)控, 并感知機(jī)器人所處工作環(huán)境的靜態(tài)和動(dòng)態(tài)信息, 使得吸塵機(jī)器人相應(yīng)的工作順序和操作內(nèi)容能自然地適應(yīng)工作環(huán)境的變化。 吸塵機(jī)器人都采用了大量的傳感器, 有效地把大量的傳感器觀測(cè)信息融合處理, 使機(jī)器人獲得最大量的外部環(huán)境信息, 運(yùn)用多傳感器融合技術(shù)可以提高移動(dòng)機(jī)器人定位、障礙物識(shí)別、

9、環(huán)境建模、避障的精度。1.2.3 電源技術(shù)移動(dòng)電源需同時(shí)為移動(dòng)機(jī)構(gòu)提供動(dòng)力,為控制電路提供穩(wěn)定的電壓,為吸塵操作模塊及傳感觀測(cè)模塊提供能源等。電源在放電過(guò)程中具備: 保持恒定的電壓; 內(nèi)阻小以便快速放電; 可充電; 成本低等特點(diǎn)。依托以上關(guān)鍵技術(shù),可實(shí)現(xiàn)以下產(chǎn)品功能:1.自動(dòng)檢測(cè)垃圾并對(duì)較臟的區(qū)域重點(diǎn)清掃2.自動(dòng)尋找智能充電座回去充電3.定時(shí)清掃 4.當(dāng)機(jī)器被卡住能自動(dòng)擺脫5.支持遙控6.邊角清掃程序7.不重復(fù)清潔、不留死角和樓梯防跌落功能 1.3 研究?jī)?nèi)容：1.3.1 自動(dòng)返回充電功能啟動(dòng)機(jī)器人自動(dòng)充電模式，它在完成工作后會(huì)自動(dòng)返回充電并進(jìn)入待機(jī)狀態(tài)。用戶只要打開(kāi)機(jī)器人，剩下的清潔工作就不用

10、擔(dān)心了。1.3.2 具有預(yù)約定時(shí)自動(dòng)清掃功能可以預(yù)約一次和一周內(nèi)任意預(yù)約清掃時(shí)間，可以放心上班和出差，也可以自動(dòng)打掃。1.3.3 脫困功能可以順利跳過(guò)2cm高的電線等雜物，具有聰明的擺脫困境功能，入遇困境，機(jī)器人會(huì)自動(dòng)嘗試用各種辦法擺脫困境。1.3.4 防跌落功能在樓梯，會(huì)議桌等地方工作也不用擔(dān)心機(jī)器會(huì)跌落而造成順壞及危險(xiǎn)，機(jī)器人自動(dòng)感知到危險(xiǎn)而避開(kāi)。1.3.5 液晶顯示屏智能報(bào)警提醒智能識(shí)別系統(tǒng)能夠幫助您判斷機(jī)器人使用過(guò)程中出現(xiàn)的問(wèn)題，智能識(shí)別系統(tǒng)能夠自動(dòng)識(shí)別各種異常情況。1.3.6 靈巧邊刷單獨(dú)的邊刷控制邊刷高速旋轉(zhuǎn)，將墻角/墻邊的垃圾清掃出來(lái)并進(jìn)入塵盒，真正的有效清掃邊角灰塵。1.3.7

11、 解決智能掃地機(jī)反復(fù)清理一個(gè)地方的問(wèn)題1.4 論文主要完成的工作課題主要完成的工作包括清潔機(jī)器人結(jié)構(gòu)設(shè)計(jì)，驅(qū)動(dòng)電機(jī)選擇，傳感器的選擇，控制算法的研究，硬件電路設(shè)計(jì)和軟件編程及試驗(yàn)。1.4.1 機(jī)械結(jié)構(gòu)部分包括機(jī)器人構(gòu)成方案選擇、機(jī)器人本體機(jī)構(gòu)設(shè)計(jì)和驅(qū)動(dòng)電機(jī)的選擇。1.4.2 避障系統(tǒng)控制方案包括機(jī)器人障礙檢測(cè)系統(tǒng)、定位系統(tǒng)的確定和控制算法的選擇。1.4.3 控制系統(tǒng)硬件部分包括單片機(jī)控制系統(tǒng)硬件電路設(shè)計(jì)、電機(jī)驅(qū)動(dòng)電路設(shè)計(jì)和傳感器檢測(cè)硬件電路設(shè)計(jì)。1.4.4 控制系統(tǒng)軟件部分包括單片機(jī)控制系統(tǒng)的軟件設(shè)計(jì)。2 單片機(jī)2.1 單片機(jī)簡(jiǎn)介常用英文字母的縮寫(xiě)mcu表示單片機(jī)，單片機(jī)又稱(chēng)單片微控制器，它不

12、是完成某一個(gè)邏輯功能的芯片，而是把一個(gè)計(jì)算機(jī)系統(tǒng)集成到一個(gè)芯片上。單片機(jī)由運(yùn)算器，控制器，存儲(chǔ)器，輸入輸出設(shè)備構(gòu)成，相當(dāng)于一個(gè)微型的計(jì)算機(jī)（最小系統(tǒng)），和計(jì)算機(jī)相比，單片機(jī)缺少了外圍設(shè)備等。概括的講：一塊芯片就成了一臺(tái)計(jì)算機(jī)。它的體積小、質(zhì)量輕、價(jià)格便宜，為學(xué)習(xí)、應(yīng)用和開(kāi)發(fā)提供了便利條件?，F(xiàn)代人類(lèi)生活中所用的幾乎每件有電子器件的產(chǎn)品中都會(huì)集成有單片機(jī)。手機(jī)、電話、計(jì)算器、家用電器、電子玩具、掌上電腦以及鼠標(biāo)等電子產(chǎn)品中都含有單片機(jī)。汽車(chē)上一般配備40多片單片機(jī)，復(fù)雜的工業(yè)控制系統(tǒng)上甚至可能有數(shù)百片單片機(jī)在同時(shí)工作。2.1.1 硬件特性1、單片機(jī)包括cpu、4kb容量的rom、128 b容量的r

13、am、 2個(gè)16位定時(shí)/計(jì)數(shù)器、4個(gè)8位并行口、全雙工串口行口、adc/dac、spi、i2c、isp、iap。 2、系統(tǒng)結(jié)構(gòu)簡(jiǎn)單，使用方便，實(shí)現(xiàn)模塊化；3、單片機(jī)可靠性高；4、處理功能強(qiáng)，速度快。5、低電壓，低功耗，便于生產(chǎn)便攜式產(chǎn)品6、控制功能強(qiáng)7、環(huán)境適應(yīng)能力強(qiáng)。2.2 at89c51單片機(jī)本設(shè)計(jì)以at89c51單片機(jī)作為檢測(cè)和控制核心。at89c51是美國(guó)atmel公司生產(chǎn)的低電壓，高性能cmos 8位單片機(jī)，片內(nèi)含4kb的可反復(fù)擦寫(xiě)的只讀程序存儲(chǔ)器（perom）和128bytes的隨機(jī)存取數(shù)據(jù)存儲(chǔ)器（rom），器件采用atmel公司的高密度、非易失性存儲(chǔ)技術(shù)生產(chǎn)，兼容標(biāo)準(zhǔn)mcs-51

14、指令系統(tǒng)，片內(nèi)置通用8位中央處理器（cpu）和flash存儲(chǔ)單元。功能強(qiáng)大at89c51單片機(jī)可提供許多高性?xún)r(jià)比的應(yīng)用場(chǎng)合，可靈活應(yīng)用于各種控制領(lǐng)域。2.2.1 at89c51主要性能參數(shù)1.與mcs-51產(chǎn)品指令系統(tǒng)完全兼容2.有4k字節(jié)可重擦寫(xiě)flash閃速存儲(chǔ)器3.有1000次的擦寫(xiě)周期4.全靜態(tài)操作：0hz24mhz5.有1288字節(jié)的內(nèi)部ram6.有32個(gè)可編程i/o 口7.有2個(gè)16位定時(shí)/計(jì)數(shù)器8.有6個(gè)中斷源9.低功率空閑和掉電模式2.2.2 at89c51功能特性概述at89c51提供以下標(biāo)準(zhǔn)功能：4k字節(jié)flash閃速存儲(chǔ)器，128字節(jié)內(nèi)部ram，32個(gè)i/o 口線，兩個(gè)1

15、6位定時(shí)/計(jì)數(shù)器，一個(gè)5向量?jī)杉?jí)中斷結(jié)構(gòu)，一個(gè)全雙工串行通信口，片內(nèi)振蕩器及時(shí)鐘電路。同時(shí)，at89c51可將至0hz的靜態(tài)邏輯操作，并支持兩種軟件可選的節(jié)電工作模式。空閑方式停止cpu的工作，但允許ram，定時(shí)/計(jì)數(shù)器，串行通信口及中斷系統(tǒng)繼續(xù)工作。掉電方式保存ram中的內(nèi)容，但振蕩器停止工作并禁止其他所有部件工作直到下一個(gè)硬件復(fù)位。2.2.3 at89c51引腳vcc：電源電壓gnd：接地p0口：p0口是一組8位漏極開(kāi)路型雙向i/o，也即地址/數(shù)據(jù)總線復(fù)用口。作輸出口用時(shí)，每位能吸收電流的方式驅(qū)動(dòng)8個(gè)ttl邏輯門(mén)電路，對(duì)端口寫(xiě)“1”可作為高阻抗輸入端用在訪問(wèn)外部數(shù)據(jù)存儲(chǔ)器或程序存儲(chǔ)器時(shí)，這

16、組口線分時(shí)轉(zhuǎn)換地址（低8位）和數(shù)據(jù)總線復(fù)用，在訪問(wèn)期間激活內(nèi)部上拉電阻。p1口：p1口是一個(gè)攜帶內(nèi)部上拉電阻的8位雙向i/o口，p1的輸出緩沖級(jí)可驅(qū)動(dòng)（吸收或輸出電流）4個(gè)ttl邏輯門(mén)電路。對(duì)端口寫(xiě)“1”，通過(guò)內(nèi)部的上拉電阻把端口拉倒高電平，此時(shí)可作輸入口。作輸入口使用時(shí)，因?yàn)閮?nèi)部存在上拉電阻，某個(gè)引腳被外部信號(hào)拉低時(shí)會(huì)輸出一個(gè)電流（iil）。p2口：p2口是一個(gè)帶有內(nèi)部上拉電阻的8位雙向i/o口，p2的輸出緩沖級(jí)可驅(qū)動(dòng)（吸收或輸出電流）4個(gè)ttl邏輯門(mén)電路。對(duì)端口寫(xiě)“1”，通過(guò)內(nèi)部的上拉電阻把端口拉到高電平，此時(shí)可作輸入口，作輸入口使用時(shí)，因?yàn)閮?nèi)部存在上拉電阻，某個(gè)引腳被外部信號(hào)拉低時(shí)會(huì)輸出

17、一個(gè)電流（iil）。圖2.1 at89c51芯片p3口：p3口是一組帶有內(nèi)部上拉電阻的8位雙向i/o口，p3口輸出緩沖級(jí)可驅(qū)動(dòng)（吸收或輸出電流）4個(gè)ttl邏輯門(mén)電路。對(duì)p3口寫(xiě)入“1”時(shí)，它們被內(nèi)部上拉電阻拉高并可作為輸入端口。作輸入端時(shí)，被外部拉低的p3口將用上拉電阻輸出電流（iil）。p3口除了作為一般的i/o口線外，更重要的用途是它的第二功能，如表3.1所示：表2.1 端口引腳第二功能表端 口 引 腳第 二 功 能p3.0rxd （串行輸入口）p3.1txd （串行輸出口）p3.2 （外中斷0）p3,3 （外中斷1）p3.4t0 （定時(shí)/計(jì)數(shù)器0）p3.5t1 （定時(shí)/計(jì)數(shù)器1）p3.6

18、 （外部數(shù)據(jù)存儲(chǔ)器寫(xiě)選通）p3.7 （外部數(shù)據(jù)存儲(chǔ)器讀選通）3 智能掃地機(jī)各系統(tǒng)分析用紅外傳感器、光電傳感器、接觸傳感器完成自動(dòng)避障。用光電編碼器檢測(cè)電機(jī)的轉(zhuǎn)速。利用pwm技術(shù)來(lái)動(dòng)態(tài)控制電動(dòng)機(jī)的轉(zhuǎn)動(dòng)方向和轉(zhuǎn)速。通過(guò)軟件編程實(shí)現(xiàn)清掃機(jī)行進(jìn)、執(zhí)行清掃任務(wù)、繞障、停止的精確控制以及檢測(cè)數(shù)據(jù)的存儲(chǔ)、顯示。通過(guò)對(duì)電路的優(yōu)化組合最大限度地利用at89c51單片機(jī)的全部資源。p0口用于數(shù)碼管顯示，p1口用于電動(dòng)機(jī)的pwm驅(qū)動(dòng)控制，p2、p3口用于傳感器的數(shù)據(jù)采集與中斷控制。這樣做的優(yōu)點(diǎn)是：充分利用了單片機(jī)的內(nèi)部資源, 降低了總體設(shè)計(jì)的成本?？傁到y(tǒng)框圖如圖3.1所示。圖3.1硬件設(shè)計(jì)總框圖3.1 智能掃地機(jī)傳

19、感器系統(tǒng)傳感器系統(tǒng)是掃地機(jī)的感覺(jué)器官,負(fù)責(zé)采集環(huán)境障礙物和自身狀態(tài)的信息，是掃地機(jī)的重要組成部分，由多傳感器及相關(guān)信號(hào)處理電路組成。在非結(jié)構(gòu)化環(huán)境下，傳感器系統(tǒng)為掃地機(jī)的正常工作發(fā)揮著無(wú)可替代的作用。掃地機(jī)傳感器系統(tǒng)的性能越好，自動(dòng)避障和路徑規(guī)劃方案就越容易實(shí)現(xiàn)，控制系統(tǒng)的程序就更容易編寫(xiě)和執(zhí)行，掃地機(jī)系統(tǒng)的整體性能也就越好。移動(dòng)機(jī)器人傳感器系統(tǒng)常用的傳感器大致可以分為內(nèi)傳感器和外傳感器兩大類(lèi)。內(nèi)傳感器主要用于采集系統(tǒng)自身狀態(tài)的信息,比如速度、加速度、軌跡、位置等。這類(lèi)傳感器主要有測(cè)速發(fā)電機(jī)、加速度計(jì)、編碼器、陀螺儀、電子羅盤(pán)等。外傳感器負(fù)責(zé)采集系統(tǒng)外部環(huán)境信息,比如圖像、距離、受力等。這類(lèi)傳

20、感器包括ccd視覺(jué)傳感器、超聲波傳感器、紅外傳感器、力傳感器等。掃地機(jī)傳感器系統(tǒng)的主要任務(wù)是提供工作環(huán)境下的障礙物信息，以實(shí)現(xiàn)掃地機(jī)的自主避障。由此可見(jiàn)，傳感器的選擇直接關(guān)系到清掃機(jī)自動(dòng)避障策略的選擇和執(zhí)行質(zhì)量。對(duì)工作環(huán)境下的障礙物信息，可以通過(guò)外部傳感器獲得，移動(dòng)機(jī)器人上常用的探測(cè)障礙物的傳感器主要有超聲波傳感器、紅外光電傳感器、接觸傳感器和視覺(jué)傳感器等幾種。超聲波傳感器是利用超聲波的特性研制而成的傳感器。超聲波是一種振動(dòng)頻率高于聲波的機(jī)械波，由換能晶片在電壓的激勵(lì)下發(fā)生振動(dòng)產(chǎn)生的，它具有頻率高、波長(zhǎng)短、繞射現(xiàn)象小，特別是方向性好、能夠成為射線而定向傳播等特點(diǎn)。超聲波對(duì)液體、固體的穿透本領(lǐng)很

21、大，尤其是在陽(yáng)光不透明的固體中，它可穿透幾十米的深度。超聲波碰到雜質(zhì)或分界面會(huì)產(chǎn)生顯著反射形成反射成回波，碰到活動(dòng)物體能產(chǎn)生多普勒效應(yīng)。因此超聲波檢測(cè)廣泛應(yīng)用在工業(yè)、國(guó)防、生物醫(yī)學(xué)等方面。超聲波傳感器通過(guò)計(jì)算超聲波的發(fā)射接收時(shí)間間隔實(shí)現(xiàn)定量測(cè)距。超聲波傳感器波束較寬，方向性差，但是其環(huán)境適應(yīng)能力強(qiáng)，探測(cè)距離遠(yuǎn)，采集信息速度快，且比一般視覺(jué)傳感器和激光測(cè)距儀都要便宜，因此在許多方面得到廣泛應(yīng)用。紅外光電傳感器具有探測(cè)視角小、方向性好、信號(hào)處理簡(jiǎn)單和反映速度快等優(yōu)點(diǎn)，但是其受環(huán)境影響較大，當(dāng)探測(cè)頭被灰塵等污染后，其探測(cè)性能將大大下降。紅外光電傳感器是各種光電檢測(cè)系統(tǒng)中實(shí)現(xiàn)光電轉(zhuǎn)換的關(guān)鍵元件，它是把

22、光信號(hào)（紅外、可見(jiàn)及紫外光輻射）轉(zhuǎn)變成為電信號(hào)的器件。紅外光電傳感器是采用光電元件作為檢測(cè)元件的傳感器。它首先把被測(cè)量的變化轉(zhuǎn)換成光信號(hào)的變化，然后借助光電元件進(jìn)一步將光信號(hào)轉(zhuǎn)換成電信號(hào)。紅外光電傳感器一般由光源、光學(xué)通路和光電元件三部分組成。光電檢測(cè)方法具有精度高、反應(yīng)快、非接觸等優(yōu)點(diǎn)，而且可測(cè)參數(shù)多，傳感器的結(jié)構(gòu)簡(jiǎn)單，形式靈活多樣，它的探測(cè)距離比較近，從幾個(gè)毫米到幾十厘米不等。因此,光電式傳感器在檢測(cè)和控制中應(yīng)用非常廣泛。接觸傳感器通過(guò)與被測(cè)物體的接觸來(lái)確定被測(cè)物體的相關(guān)信息，如物體的存在與否、物體的形狀和位置、接觸面的壓力分布及大小等等。接觸傳感器主要有限位開(kāi)關(guān)、接觸開(kāi)關(guān)等，這些傳感器結(jié)

23、構(gòu)簡(jiǎn)單、信號(hào)易處理、適應(yīng)能力強(qiáng)且價(jià)格低廉。由于超聲波傳感器、紅外光電傳感器和接觸傳感器都具有價(jià)格低廉、工作可靠、速度快等優(yōu)點(diǎn),因此廣泛應(yīng)用于移動(dòng)機(jī)器人的局部導(dǎo)航。經(jīng)過(guò)對(duì)比分析，本設(shè)計(jì)方案采用超聲波傳感器、紅外光電傳感器和接觸開(kāi)關(guān)、三種傳感器來(lái)構(gòu)建清掃機(jī)器的傳感器系統(tǒng)。將這些傳感器合理布置在清掃機(jī)周邊位置上，通過(guò)相應(yīng)的信號(hào)處理電路與微處理器系統(tǒng)實(shí)現(xiàn)數(shù)據(jù)通訊，控制系統(tǒng)根據(jù)獲得的傳感器系統(tǒng)信息做出避障決策，實(shí)現(xiàn)自主避障。3.1.1 測(cè)速裝置模塊測(cè)速信號(hào)通過(guò)在電機(jī)的轉(zhuǎn)子上加裝帶有黑白條紋的圓盤(pán)，再利用光電開(kāi)關(guān)得到電機(jī)每轉(zhuǎn)一圈產(chǎn)生若干個(gè)脈沖信號(hào)，據(jù)此可以算出電機(jī)的實(shí)際轉(zhuǎn)速。這種簡(jiǎn)易的光電開(kāi)關(guān)測(cè)速法成本低

24、，性能可靠，可以在電機(jī)轉(zhuǎn)速不高，精度沒(méi)有嚴(yán)格要求的情況下使用，這種測(cè)速裝置可以構(gòu)成里程計(jì)。根據(jù)里程計(jì)的返回脈沖數(shù)可以計(jì)算出電機(jī)行走的距離，并間接得到行走速度。圖3.2 ew462內(nèi)部原理示意圖3.1.2 碰撞檢測(cè)碰撞檢測(cè)采用霍爾元件 ew462，芯片的內(nèi)部原理框圖如圖3-4所示，芯片的工作方式如圖3-5所示。芯片的供電電壓范圍為 4.5v18v，靈敏度高，阻抗低，工作的最大輸出電流為 15ma。當(dāng)芯片的正上方有s極磁場(chǎng)時(shí)，霍爾元件輸出高電平，當(dāng)元件偏離磁場(chǎng)后，元件輸出低電平。通過(guò)控制霍爾元件正上方的磁場(chǎng)極性，可以控制元件輸出信號(hào)的變化趨勢(shì)。當(dāng)極性相反時(shí)，元件在偏離磁場(chǎng)時(shí)為高電平，正對(duì)磁場(chǎng)時(shí)為低

25、電平。3.2 驅(qū)動(dòng)系統(tǒng)驅(qū)動(dòng)器就是驅(qū)動(dòng)掃地機(jī)的動(dòng)力部件，最常用的就是電機(jī)。掃地機(jī)最主要的控制量就是控制掃地機(jī)的移動(dòng)，掃地機(jī)驅(qū)動(dòng)器中最根本的問(wèn)題就是控制電機(jī)，控制電機(jī)轉(zhuǎn)的圈數(shù)就可以控制掃地機(jī)移動(dòng)的距離和方向、清掃機(jī)械的彎曲的程度或者移動(dòng)的距離等。所以，第一個(gè)要解決的問(wèn)題就是如何讓電機(jī)能根據(jù)自己的意圖轉(zhuǎn)動(dòng)。一般有專(zhuān)門(mén)的控制卡和控制芯片來(lái)進(jìn)行控制。有了這些控制卡和芯片，然后把微控制器與其連接起來(lái)就可以用程序來(lái)控制電機(jī)。第二個(gè)問(wèn)題是控制電機(jī)的速度，在掃地機(jī)上的實(shí)際表現(xiàn)就是它的實(shí)際運(yùn)動(dòng)速度，掃地機(jī)走的快慢全靠電機(jī)的轉(zhuǎn)速，這樣就要求控制卡對(duì)電機(jī)有速度控制。機(jī)器人的工作電機(jī)分為行走、吸塵和毛刷電機(jī)。機(jī)器人行走

26、結(jié)構(gòu)中前面有一個(gè)從動(dòng)轉(zhuǎn)向輪，兩側(cè)各有一個(gè)驅(qū)動(dòng)輪，由無(wú)刷直流電機(jī)進(jìn)行控制。清掃結(jié)構(gòu)主要使用真空吸塵器和由電機(jī)帶動(dòng)的旋轉(zhuǎn)毛刷。永磁無(wú)刷電動(dòng)機(jī)具有效率高，功率大，體積小，控制精度高等明顯特點(diǎn)在機(jī)器人領(lǐng)域有著廣泛的應(yīng)用。無(wú)刷直流電機(jī)具有良好的調(diào)速性能，由于它采用電子換向，脈寬調(diào)制脈沖調(diào)速，在進(jìn)一步提高直流電機(jī)性能的同時(shí)，又克服了直流電機(jī)傳統(tǒng)機(jī)械換向帶來(lái)的一系列問(wèn)題，從而大大延長(zhǎng)了電機(jī)的使用壽命。直流無(wú)刷電機(jī)控制電路主要有控制電路微處理器、數(shù)字信號(hào)處理器和專(zhuān)用集成電路等3種方式。使用單片機(jī)輔以外圍處理電路的方法，其測(cè)頻、換相、控制調(diào)節(jié)等均由軟件實(shí)現(xiàn)。選用單片機(jī)軟件編程的方法控制無(wú)刷直流電機(jī)。吸塵器內(nèi)的風(fēng)

27、機(jī)和帶動(dòng)毛刷的電機(jī)都使用直流電機(jī)，由于不需要調(diào)速、換向，因此控制方法比較簡(jiǎn)單。圖3.3 主從動(dòng)輪分布圖電機(jī)的運(yùn)動(dòng)系統(tǒng)結(jié)構(gòu)如圖3-2，它決定了機(jī)器人的運(yùn)動(dòng)空間，采用輪式結(jié)構(gòu)。其中左右輪為主動(dòng)輪，需要用可調(diào)速的電機(jī)控制，前面的轉(zhuǎn)向輪為從動(dòng)輪，便于機(jī)器人的轉(zhuǎn)向。 直流電動(dòng)機(jī)具有良好的線性調(diào)速特性、簡(jiǎn)單的控制性能、較高的效率、優(yōu)良的動(dòng)態(tài)特性，所以一直占據(jù)著調(diào)速控制的統(tǒng)治地位。雖然近年不斷受到其他電動(dòng)機(jī)如交流變頻電動(dòng)機(jī)、步進(jìn)電動(dòng)機(jī)的挑戰(zhàn)，但直流電動(dòng)機(jī)仍然是許多調(diào)速控制電動(dòng)機(jī)的最優(yōu)選擇，在生產(chǎn)、生活中仍有著廣泛的應(yīng)用。采用廣泛應(yīng)用的脈寬調(diào)制技術(shù)控制電動(dòng)機(jī)電樞的電壓。所謂 pwm 控制技術(shù)，就是通過(guò)控制半導(dǎo)

28、體開(kāi)關(guān)器件的導(dǎo)通與關(guān)斷，把直流電壓變成電壓脈沖序列并通過(guò)控制電壓脈沖寬度或周期以達(dá)到變壓的目的。產(chǎn)生pwm信號(hào)常用的 4 種方法如下：(1)分立電子元件組成的pwm信號(hào)發(fā)生器。這種方式是用分立的邏輯電子元件組成信號(hào)電路，是較早采用的方法，可靠性、可調(diào)性較差；(2)軟件模擬式。利用單片機(jī)的一個(gè)i/o引腳，通過(guò)軟件對(duì)該引腳輸出高低電平來(lái)模擬pwm波，該方法占用cpu的時(shí)間較多，控制軟件較復(fù)雜；(3)專(zhuān)用pwm集成電路。采用專(zhuān)用的 pwm 集成電路芯片，該方法功能強(qiáng)，但增加了調(diào)速系統(tǒng)的成本開(kāi)銷(xiāo)；(4)單片機(jī)的pwm口。新一代的許多單片機(jī)具有pwm調(diào)速功能。通過(guò)單片機(jī)的初始化設(shè)置，使其自動(dòng)發(fā)生脈沖波，

29、只有在改變脈沖寬度時(shí)才進(jìn)行干預(yù)，該方法控制直流電動(dòng)機(jī)轉(zhuǎn)速簡(jiǎn)單、可靠。所以使用單片機(jī)的pwm口作為電機(jī)的pwm調(diào)速控制。無(wú)刷直流電動(dòng)機(jī)簡(jiǎn)稱(chēng)bldc，學(xué)名是無(wú)換向器電機(jī)或無(wú)整流子電機(jī)，是一種新型的無(wú)級(jí)變速電機(jī)。它具有直流電機(jī)良好的調(diào)速特性，但由于沒(méi)有換向器，因而可做成無(wú)接觸式，具有結(jié)構(gòu)簡(jiǎn)單，制造方便，不需要經(jīng)常性維護(hù)等優(yōu)點(diǎn)，是一種理想的變速電機(jī)。選用的輪子驅(qū)動(dòng)電機(jī)即為無(wú)刷直流電機(jī)，其工作電壓是1015v，最大工作電流0.84a，正常工作電流0.4a，有專(zhuān)門(mén)的換向控制引腳，高低電平控制正反轉(zhuǎn)。該電機(jī)可以由pwm信號(hào)直接驅(qū)動(dòng)，允許的脈寬調(diào)制脈沖信號(hào)輸入?yún)?shù)為：允許輸入pwm的頻率最大為 50khz；高

30、電平的輸入電壓范圍為2.0v5.0v；低電平的輸入電壓為 0v1.0v；輸入開(kāi)路電壓為 4.5v5v。3.3 紅外遙控系統(tǒng)紅外遙控是目前使用最廣泛的一種通信和遙控手段。紅外遙控裝置具有體積小、功耗低、功能強(qiáng)、成本低等特點(diǎn)，繼彩電、錄像機(jī)之后，紅外線遙控在錄音機(jī)、音響設(shè)備、空調(diào)機(jī)以及玩具等其它小型電器裝置上也實(shí)現(xiàn)廣泛的應(yīng)用。工業(yè)設(shè)備中，在高壓、輻射、有毒氣體、粉塵等環(huán)境下，采用紅外線遙控能可靠且有效地隔離電氣干擾?；谝陨蟽?yōu)點(diǎn)，故采用紅外遙控裝置來(lái)控制智能掃地機(jī)的清掃方式及開(kāi)機(jī)與關(guān)機(jī)。遙控發(fā)射器遙控接收器圖3.4 紅外遙控系統(tǒng)通常紅外遙控系統(tǒng)由發(fā)射和接收兩大部分組成，應(yīng)用編碼/解碼專(zhuān)用集成電路芯

31、片來(lái)進(jìn)行控制操作，如圖3.2所示。發(fā)射部分包括鍵盤(pán)矩陣、編碼調(diào)制、led紅外發(fā)送器；接收部分包括光、電轉(zhuǎn)換放大器、解調(diào)、解碼電路。紅外接收芯片選用tfms5380。在遙控器上使用單片機(jī)進(jìn)行紅外功能編碼，在掃地機(jī)上，由于單片機(jī)處理任務(wù)很多，因此選用專(zhuān)用的解碼芯片。解碼芯片是realtek公司生產(chǎn)的一種用于遙控小卡車(chē)的cmos大規(guī)模集成電路rx6b，它有七個(gè)控制鍵來(lái)控制小卡車(chē)的移動(dòng) 。由于編碼和解碼的振蕩頻率必須一致，頻率的大小由osci和osco之間的電阻決定。四個(gè)紅外接收管的信號(hào)通過(guò)與門(mén)與芯片的輸入端si相連，使得解碼芯片在接收到任意方向的紅外線信號(hào)時(shí)都能正常工作 。圖3.5 imp813l芯

32、片3.4 浮動(dòng)開(kāi)關(guān)電路浮動(dòng)開(kāi)關(guān)是一個(gè)安裝在輪子內(nèi)側(cè)的機(jī)械開(kāi)關(guān)，輪子上有彈簧裝置，當(dāng)輪子浮起時(shí)，開(kāi)關(guān)斷開(kāi)掃地機(jī)停止前進(jìn)，實(shí)現(xiàn)了防跌落功能。防跌落功能有效的保護(hù)了掃地機(jī)各部位免遭摔壞，所以是必不可少的。3.5 看門(mén)狗幾乎所有的單片機(jī)都需要復(fù)位電路，對(duì)復(fù)位電路的基本要求是：在單片機(jī)上電時(shí)能可靠復(fù)位，在下電時(shí)能防止程序亂飛導(dǎo)致eprom中的數(shù)據(jù)被修改；另外，單片機(jī)系統(tǒng)在工作時(shí)，由于干擾等各種因素的影響，有可能出現(xiàn)死機(jī)現(xiàn)象導(dǎo)致單片機(jī)系統(tǒng)無(wú)法正常工作，為了克服這一現(xiàn)象，除了充分利用單片機(jī)本身的看門(mén)狗定時(shí)器(有些單片機(jī)無(wú)看門(mén)狗定時(shí)器)外，還需外加看門(mén)狗電路；除此以外，有些單片機(jī)系統(tǒng)還要求在掉電瞬間單片機(jī)能將

33、重要數(shù)據(jù)保存下來(lái)，因掉電的發(fā)生往往是根隨機(jī)的，因而此類(lèi)單片機(jī)系統(tǒng)需要電源監(jiān)控電路，在掉電剛發(fā)生時(shí)能告知單片機(jī)。imp813l剛好能滿足這些要求，下面具體介紹該芯片的性能特點(diǎn)及使用方法。imp813l有雙列直插和貼片封裝形式，其雙列直插如圖所示，引腳功能如下：第1腳為手動(dòng)復(fù)位輸入，低電平有效；第2、3腳分別為電源和地；第4腳為電源故障輸入；第5腳為電源故障輸出；第6腳為看門(mén)狗輸入，第7腳為復(fù)位輸出，第8腳為看門(mén)狗輸出。imp813l的性能特點(diǎn)：imp813l的內(nèi)部結(jié)構(gòu)框圖如圖3.5，具有以下主要性能特點(diǎn)：由圖可知該芯片具有以下主要性能特點(diǎn)：(1)復(fù)位輸出。系統(tǒng)上電、掉電以及供電電壓降低時(shí)，第7腳

34、產(chǎn)生復(fù)位輸出，復(fù)位脈沖寬度的典型值為200ms，高電平有效，復(fù)位門(mén)限的典型值為4.65v。(2)看門(mén)狗電路輸出。如果在1.6s內(nèi)沒(méi)有觸發(fā)該電路(即第6腳無(wú)脈沖輸入)，則第8腳輸出一個(gè)低電平信號(hào)。圖3.6 imp813l的典型應(yīng)用電路(3)手動(dòng)復(fù)位輸入，低電平有效，即第1腳輸入一個(gè)低電平，則第7腳產(chǎn)生復(fù)位輸出。(4)1.25v門(mén)限值檢測(cè)器，第4腳為輸入，第5腳為輸出。當(dāng)?shù)?腳電壓低于1.25v時(shí)，第5腳輸出一個(gè)低電平信號(hào)。imp813l的典型應(yīng)用電路：imp813l的典型應(yīng)用電路如圖3.6所示。圖中單片機(jī)以at89c51為例，imp813l的第1腳與第8腳相連。第7腳接單片機(jī)的復(fù)位腳(at89c

35、51的第9腳)；第6腳與單片機(jī)的p1.4相連。在軟件設(shè)計(jì)中，p1.4不斷輸出脈沖信號(hào)，如果因某種原因單片機(jī)進(jìn)入死循環(huán)，則p1.4無(wú)脈沖輸出。于是1.6s后在imp813l的第8引腳輸出低電平，該低電平加到第1腳，使imp813l產(chǎn)生復(fù)位輸出，使單片機(jī)有效復(fù)位，擺脫死循環(huán)的困境。另外，當(dāng)電源電壓低于門(mén)限值4.65v時(shí)，imp813l也產(chǎn)生復(fù)位輸出，使單片機(jī)處于復(fù)位狀態(tài)，不執(zhí)行任何指令，直至電源電壓恢復(fù)正常，可有效防止因電源電壓較低時(shí)單片機(jī)產(chǎn)生錯(cuò)誤的動(dòng)作。電源故障輸入pfi通過(guò)一個(gè)電阻分壓器監(jiān)測(cè)未穩(wěn)壓的直流電源。當(dāng)pfi低于125v時(shí)，電源故障輸出腳第5腳pf0變低，可引起at89c51中斷，進(jìn)行

36、電源故障處理，或?qū)⒅匾獢?shù)據(jù)保存下來(lái)。把分壓器接到未穩(wěn)壓的直流電源是為了更早地對(duì)電源故障告警。imp813l是一體積小、功耗低、性?xún)r(jià)比高的帶看門(mén)狗和電源監(jiān)控功能的復(fù)位芯片；它使用簡(jiǎn)單、方便，它所提供的復(fù)位信號(hào)為高電平，因而是應(yīng)用于復(fù)位信號(hào)為高電平場(chǎng)合的單片機(jī)系統(tǒng)的理想芯片。3.6 液晶顯示電路液晶顯示器以其微功耗、體積小、顯示內(nèi)容豐富、超薄輕巧的諸多優(yōu)點(diǎn)，在袖珍式儀表和低功耗應(yīng)用系統(tǒng)中得到越來(lái)越廣泛的應(yīng)用。這里采用2行16個(gè)字的dm-162液晶模塊，通過(guò)與單片機(jī)連接，編程，完成顯示時(shí)間及清掃機(jī)行進(jìn)速度的功能。圖3.7 液晶顯示系統(tǒng)電路dm-162液晶顯示模塊的字符顯示，可分為好幾種顯示模式，這主

37、要取決于對(duì)具體的應(yīng)用。如靜態(tài)的顯示，還是動(dòng)態(tài)的左移或者右移顯示。那么這個(gè)主要是在程序設(shè)計(jì)的過(guò)程中，進(jìn)行初始化所決定的。因此，在使用之前先確定使用的目的，選擇好顯示的方式，當(dāng)然得找出相應(yīng)的顯示字符的字符代碼及在dm-162液晶顯示模塊的相應(yīng)顯示位置的ram地址。然后進(jìn)行每個(gè)字符的寫(xiě)入顯示。在使用的過(guò)程中，還得注意的一點(diǎn)是，可能是顯示驅(qū)動(dòng)電壓的不穩(wěn)定性，或者是由于驅(qū)動(dòng)電壓的過(guò)高，會(huì)形成一種“鬼影”的現(xiàn)象，因此需要手動(dòng)對(duì)10k的電位器進(jìn)行對(duì)比度調(diào)整以達(dá)到顯示的良好效果。液晶顯示模塊電路如圖3.7。它由以下幾個(gè)部件組成：?jiǎn)纹瑱C(jī)at89c51、液晶字符顯示部件dm-162、電源供電部分。單片機(jī)部分：采用

38、at89c51芯片實(shí)現(xiàn)對(duì)dm-162的控制顯示字符顯示模塊: 選擇2行16個(gè)字的顯示容量.電源部分： +5v電壓供電，維持系統(tǒng)的正常工作,同時(shí)加載10k電位器以適應(yīng)不用亮度的顯示字符即對(duì)比度的調(diào)整。4 智能掃地機(jī)的設(shè)計(jì)4.1 自動(dòng)充電系統(tǒng) 自動(dòng)充電是用對(duì)接充電來(lái)實(shí)現(xiàn)的，對(duì)接充電過(guò)程主要用了紅外信號(hào)，在智能吸塵機(jī)器人的左側(cè)和后面都有紅外接收器，發(fā)射傳感器則安裝在充電座上，對(duì)接充電對(duì)掃地機(jī)是非常重要的，因?yàn)闄C(jī)器人自帶的充電電池電量有限，不一定能保證完成清掃工作，這就需要機(jī)器人能自動(dòng)對(duì)接充電。當(dāng)內(nèi)部電源檢測(cè)到電壓低于一定值是，掃地機(jī)器人將沿墻壁尋找充電座。一般掃地機(jī)器人按右手法則尋找充電座，所以在掃

39、地機(jī)器人貼墻的一側(cè)（選左側(cè)）和后部各裝有一個(gè)紅外接收傳感器，當(dāng)側(cè)面的一側(cè)在貼邊過(guò)程中收到紅外信號(hào)時(shí)，掃地機(jī)器人順時(shí)針旋轉(zhuǎn)90度，并沿著紅外光路靠近充電座，同時(shí)檢測(cè)充電座充電電壓即可確定是否已經(jīng)對(duì)接上。4.2 驅(qū)動(dòng)系統(tǒng)電路驅(qū)動(dòng)系統(tǒng)電路包括驅(qū)動(dòng)器、光電隔離模塊以及驅(qū)動(dòng)器保護(hù)電路等部分，如圖3.6所示。在具體電路中，由于單片機(jī)使用5v弱電，而電機(jī)的驅(qū)動(dòng)電壓為12v或者更高，考慮到單片機(jī)會(huì)受到驅(qū)動(dòng)部分的干擾，因此采用了光電耦合器tlp521，把控制部分和驅(qū)動(dòng)部分隔離開(kāi)來(lái)。單片機(jī)輸出端口的電流一般只有20ma左右，不足以或者不能穩(wěn)定地驅(qū)動(dòng)光電耦合器tlp521工作，因此采用芯片74hc245來(lái)增強(qiáng)驅(qū)動(dòng)能

40、力，為光電耦合器tlp521提供合適的驅(qū)動(dòng)電流。驅(qū)動(dòng)器保護(hù)電路由8個(gè)高速大電流肖恩特二極管1n5822（圖中d1d8）組成，用來(lái)消除電機(jī)在起停、制動(dòng)及換向時(shí)產(chǎn)生的反電勢(shì)。保護(hù)二極管最好采用高速大電流的開(kāi)關(guān)管，否則反向恢復(fù)時(shí)間太長(zhǎng)，l298n內(nèi)部h橋的上下兩個(gè)三極管會(huì)因?yàn)殚_(kāi)閉時(shí)序交叉，導(dǎo)致同時(shí)打開(kāi)而短路，長(zhǎng)期使用狀態(tài)下會(huì)造成l298n發(fā)熱或燒毀。按照?qǐng)D4.1所示電路，系統(tǒng)工作時(shí)，單片機(jī)p1口輸出的控制信號(hào)經(jīng)過(guò)驅(qū)動(dòng)器芯片74hc245和光電耦合器之后輸入電機(jī)驅(qū)動(dòng)芯片l298n，控制電機(jī)動(dòng)作。當(dāng)需要調(diào)速時(shí)只需改變pwm調(diào)速脈沖（本設(shè)計(jì)中由單片機(jī)p1.3和p1.6端口產(chǎn)生）的占空比即可，理論上可以實(shí)現(xiàn)

41、256級(jí)調(diào)速。4.3總體軟件流程總流程圖如圖4.1所示，是整個(gè)清掃機(jī)運(yùn)行過(guò)程的流程圖。其中包括初始化整個(gè)系統(tǒng)、啟動(dòng)各電路模塊、等待接收命令、啟動(dòng)驅(qū)動(dòng)系統(tǒng)、檢測(cè)障礙、啟動(dòng)清掃避障系統(tǒng)、結(jié)束清掃等過(guò)程。(1) 首先，啟動(dòng)清掃機(jī)電源，使各模塊持續(xù)供電。圖4.2 總流程圖(2) 啟動(dòng)各電路模塊，啟動(dòng)液晶顯示系統(tǒng)，以便顯示清掃機(jī)行進(jìn)速度及運(yùn)行時(shí)間。此過(guò)程通過(guò)軟件編程控制液晶顯示系統(tǒng)及驅(qū)動(dòng)系統(tǒng)向單片機(jī)控制系統(tǒng)反饋實(shí)現(xiàn)。啟動(dòng)清掃機(jī)傳感器系統(tǒng)，此項(xiàng)內(nèi)容主要作用是使清掃機(jī)對(duì)周?chē)h(huán)境有一個(gè)了解，通過(guò)對(duì)周?chē)h(huán)境的感知來(lái)實(shí)現(xiàn)測(cè)距、清掃、避障。本過(guò)程主要是通過(guò)單片機(jī)控制各傳感器及傳感器向單片機(jī)反饋來(lái)實(shí)現(xiàn)。啟動(dòng)紅外接收系

42、統(tǒng)，等待接收紅圖4.3紅外發(fā)射電路流程圖外信號(hào)。(3) 當(dāng)接收到前進(jìn)指令時(shí)，啟動(dòng)驅(qū)動(dòng)系統(tǒng)。(4) 當(dāng)遇到障礙時(shí)啟動(dòng)清掃系統(tǒng)及避障系統(tǒng)，此過(guò)程是整個(gè)清掃系統(tǒng)的關(guān)鍵，此過(guò)程包括清掃命令接收判斷及是否遇到障礙物判斷。4.4紅外遙控系統(tǒng)流程圖4.4 驅(qū)動(dòng)系統(tǒng)流程發(fā)射電路主程序的流程圖如圖4.3所示主程序中設(shè)置串口工作方式1和定時(shí)器t1方式2是為了發(fā)射按鍵代碼時(shí)產(chǎn)生2000b/s的波特率；定時(shí)器t0工作方式2是用來(lái)在p3.7引腳上輸出38khz的載波信號(hào)。有按鍵下時(shí)產(chǎn)生外部中斷0，寄存器r5和r4中存放的數(shù)據(jù)是用來(lái)控制1 min 的定時(shí)時(shí)間。1 min之內(nèi)無(wú)按鍵，則遙控器進(jìn)入低功耗狀態(tài)。定時(shí)器t0中斷程

43、序是將p3.7引腳取反產(chǎn)生38khz的載波信號(hào)，此信號(hào)為方波信號(hào)。外部中斷0的中斷程序用于判斷按鍵并發(fā)射按鍵代碼，同時(shí)還包括按鍵去抖動(dòng)和檢查設(shè)置相關(guān)標(biāo)志位。4.5 驅(qū)動(dòng)系統(tǒng)流程首先是系統(tǒng)初始化工作,即設(shè)置寄存器、配置gpio、定時(shí)器、a/d轉(zhuǎn)換器和外部中斷、啟動(dòng)a/d轉(zhuǎn)換。然后檢測(cè)gpio有沒(méi)有啟動(dòng)信號(hào),檢測(cè)到啟動(dòng)信號(hào)后,從另一個(gè)gpio發(fā)出控制信號(hào)給直流電機(jī)加電。從a/d轉(zhuǎn)換器里讀取電流信號(hào)數(shù)據(jù),再通過(guò)求平均值得到電機(jī)的電流值;對(duì)輸出脈沖信號(hào)的數(shù)據(jù)進(jìn)行fft變換,求出基波的頻率,再根據(jù)電機(jī)的具體型號(hào)乘以一個(gè)系數(shù)得到電機(jī)的轉(zhuǎn)速。最后把測(cè)試電流和轉(zhuǎn)速送給液晶顯示系統(tǒng)顯示清掃機(jī)行進(jìn)速度,啟動(dòng)總線傳輸，把測(cè)試結(jié)果傳輸?shù)絾纹瑱C(jī),以對(duì)數(shù)據(jù)進(jìn)行保存和分析。軟件流程如圖4.4所示。4.6 清掃避障系統(tǒng)流程清掃壁障流程圖如圖4.5，該流程是智能清掃機(jī)執(zhí)行清掃命令及躲避障礙的流程。圖4.5清掃避障流程圖(1)紅外光電傳感器的紅外發(fā)光管發(fā)射紅外光，光波在遇到障礙物后反射，被紅外接收管接收，產(chǎn)生一個(gè)與光強(qiáng)相對(duì)應(yīng)的電流，電流經(jīng)lm358組成的兩極放大電路放大后，輸出一個(gè)模擬電壓，經(jīng)a