清潔機器人之吸塵機器人控制系統的設計

　　引言

　　隨著(zhù)人口的老齡化和社會(huì )福利制度的完善，導致勞動(dòng)力成本的急劇上升，一些簡(jiǎn)單的重復性的體力勞動(dòng)為服務(wù)機器人提供了廣闊的市場(chǎng)。清潔機器人是服務(wù)機器人的一種，可以代替人進(jìn)行清掃房間、車(chē)間、墻壁等。提出一種應用于室內的移動(dòng)清潔機器人的設計方案。其具有實(shí)用價(jià)值。室內清潔機器人的主要任務(wù)是能夠代替人進(jìn)行清掃工作，因此需要有一定的智能。清潔機器人應該具備以下能力：能夠自我導航，檢測出墻壁，房間內的障礙物并且能夠避開(kāi)；能夠走遍房間的大部分空間，可以檢測出電池的電量并且能夠自主返回充電，同時(shí)要求外形比較緊湊，運行穩定，噪音??；要具有人性化的接口，便于操作和控制。結合清潔機器人主要功能探討其控制系統的硬件設計。

　　1測控系統及功能

　　為了使吸塵機器人運動(dòng)更加流暢，防止出現卡死的現象，把吸塵機器人外觀(guān)設計成扁圓柱形的，扁圓形的設計可以使其自由進(jìn)入沙發(fā)、床和家具底下，把一些邊角都能夠清掃干凈。與地面平行的圓形底盤(pán)由三個(gè)輪子共同支撐，左右兩側的為驅動(dòng)輪，分別由兩個(gè)微型直流電機直接驅動(dòng)，前面的支撐輪為萬(wàn)向輪。機器人的這種外形和車(chē)輪布局可使其方便地實(shí)現原地轉彎，大大提高了行走的靈巧性，這在空間范圍較小的地方更為突出。采用碰撞、超聲波和紅外傳感器組成多傳感器系統，在機器人的上方裝有紅外接收裝置；在機器人的底部邊緣．每隔45°裝有接近傳感器，用來(lái)檢測臺階，防止跌落；在機器人的前方裝有碰撞傳感器，前方和左右裝有超聲波傳感器，用來(lái)檢測周?chē)h(huán)境。機器人上裝有電源管理系統，如果電壓過(guò)低會(huì )停止清掃，并且去自動(dòng)充電。

　　1．1微控制器

　　傳統的微處理器如51系列雖然開(kāi)發(fā)周期短，成本低，但其實(shí)時(shí)性不好，難以實(shí)現復雜的控制算法；另外，增加的外圍電路數據轉換速度慢，使機器人的性能得不到充分的發(fā)揮。高速DSP的出現雖然使得系統模塊化和全數字化，但其開(kāi)發(fā)成本高。與DSP具有同等性能的ARM微處理器資源豐富，具有很好的通用性，其主要技術(shù)優(yōu)點(diǎn)是高性能，低價(jià)格，低功耗，廣泛地應用于各個(gè)領(lǐng)域，因此將ARM應用于機器人控制系統不失為一種好的策略。LPC2210是飛利浦帶有一個(gè)支持實(shí)時(shí)仿真和跟蹤的ARM7TDMI-S微處理器，其采用3級流水線(xiàn)技術(shù)，能夠并行處理指令。由于具有非常小的尺寸和極低的功耗，多個(gè)32位定時(shí)器、PWM輸出和32個(gè)GPIO使它特別適用于工業(yè)控制和小型機器人系統，滿(mǎn)足了機器人對控制器運算速度的要求。以L(fǎng)PC2210為核心。設計結構簡(jiǎn)單，性能穩定的清潔機器人車(chē)體系統。

　　機器人控制系統主要完成的任務(wù)：接收傳感器和編碼器傳來(lái)的數據，綜合處理進(jìn)行清掃路徑規劃；驅動(dòng)左右輪前進(jìn)行走，控制清掃、吸塵機構，完成各種底層控制動(dòng)作；設計合適的人機接口，在LCD上顯示機器人狀態(tài)和運行時(shí)間。因此，機器人控制系統包括傳感器模塊，電機驅動(dòng)模塊.

　　這一款超聲波傳感器有以下優(yōu)點(diǎn)：適應各種環(huán)境，不受灰塵和光線(xiàn)的影響；盲區為2．5cm?？梢园褌鞲衅靼惭b在合適的位置就可以避開(kāi)盲區；探測發(fā)散角度為15°，反應距離2．5m以?xún)?，該課題的檢測距離為0．5m。超聲波傳感器的基本原理是測量從聲波發(fā)射和回到接收器所用的時(shí)間。這一款傳感器的的發(fā)射端口和接收端口是一個(gè)管腳，首先由控制器發(fā)射一個(gè)5μs寬度的高電平脈沖來(lái)激發(fā)傳感器發(fā)射40kHz的超聲波，脈沖發(fā)出750μs后，管腳電平置高；當傳感器接收到回波時(shí)，管腳的電平被拉低。由信號端高電平的寬度就可以知道由發(fā)射到返回需要的時(shí)間，寬度為115μs～18．5ms之間。公式s＝vt／2，其中s表示傳感器與目標的距離；t表示發(fā)射到回收的時(shí)間；v是聲波速度，v=340m／s。由此可以知道傳感器與障礙物之間的距離。一次探測時(shí)間最多是20ms，5個(gè)傳感器查詢(xún)完畢，用時(shí)l00ms，因此兩個(gè)相鄰傳感器采用分時(shí)段進(jìn)行使能，就會(huì )避免相互干擾，而不會(huì )影響機器人速度。

　　1．2．2紅外接近傳感器

　　反射式光電開(kāi)關(guān)是由紅外LED光源和光敏二極管或光敏晶體管等光敏元件組成，當有障礙物阻攔時(shí)光線(xiàn)能夠反射回來(lái)，輸出為低電平信號；當沒(méi)有障礙物阻攔時(shí)，光線(xiàn)不能反射回來(lái)，輸出為高電平信號。

　　吸塵機器人的近距離紅外接近傳感器由兩組相同的紅外發(fā)射、接收電路組成。每一組電路可分為高頻脈沖信號產(chǎn)生、紅外發(fā)射調節與控制、紅外發(fā)射驅動(dòng)、紅外接收等幾個(gè)部分。通過(guò)38kHz晶振和非門(mén)電路得到一個(gè)38kHz的調制脈沖信號；利用三極管驅動(dòng)紅外發(fā)射管(TSAL6200)的發(fā)射。發(fā)射管發(fā)出的紅外光經(jīng)物體反射后被紅外接收模塊接收。通過(guò)接收頭(HS0038B)內部自帶的集成電路處理后返回一個(gè)數字信號，輸入到微控制器的I／O口，如圖3所示。接收頭如果接收到38kHz的紅外脈沖就會(huì )返回輸出低電平，否則就會(huì )輸出高電平。通過(guò)對I／0口的檢測，便可以判斷物體的有無(wú)。

　　1．2．3碰撞開(kāi)關(guān)傳感器

　　兩個(gè)槽型對射光電開(kāi)關(guān)均布在機器人左前和右前辦。如此的布局可以使機器人感知來(lái)自前方、左前、右前三個(gè)方向的障礙物，從而根據障礙物方向的不同做出不同的反應。當機器人碰到障礙物時(shí)，彈簧在障礙物的作用下，向內壓迫碰撞開(kāi)關(guān)擺臂，促使簧片擋住光電開(kāi)關(guān)的光線(xiàn)，輸出低電平。當沒(méi)有障礙物作用時(shí)，簧片在彈簧的作用下恢復，光電開(kāi)關(guān)的光線(xiàn)沒(méi)有被遮擋，輸出高電平，如圖4所示。

　　這三個(gè)傳感器中，超聲波傳感器用來(lái)探測前方和左右的墻壁、障礙。左邊和右邊的兩個(gè)超聲波傳感器垂直于行走方向放置，用于機器人的沿邊行走規劃；設定機器人行走時(shí)與墻邊的距離值，調節機器人的行走方向，使兩個(gè)超聲波與墻邊的距離近似等于設定值，保持機器人沿墻行走時(shí)保持適當的距離，不會(huì )撞到或者遠離墻壁。前方兩個(gè)碰撞傳感器和一個(gè)超聲波配合用來(lái)用來(lái)探測前半部分的環(huán)境；接觸傳感器具有檢測范圍大、信號無(wú)需調理、占用資源少的優(yōu)點(diǎn)，通過(guò)接觸碰撞，檢測那些未能被超聲波傳感器檢測到的桿狀障礙比如家具腿等，傳感器之間的位置如圖5所示。