陸檉堂 林桂鋒 林位龍 黃程懷 孫寶福
摘 要 隨著技術(shù)的不斷發(fā)展進(jìn)步,人工智能的大趨勢(shì)即將到來(lái),掃地機(jī)器人作為當(dāng)代智能型家居電器,它的應(yīng)用也越來(lái)越多。本文主要針對(duì)了基于單片機(jī)AT89C52RC的掃地機(jī)器人的清掃路徑設(shè)計(jì)以及算法,通過(guò)對(duì)機(jī)器人行走中碰撞的記錄以及障礙物的位置進(jìn)行定位,大致的把室內(nèi)地圖描繪出來(lái)儲(chǔ)存在存儲(chǔ)器中,進(jìn)而實(shí)現(xiàn)掃地機(jī)器人的掃地路徑優(yōu)化,擇優(yōu)選擇最佳清掃路徑,盡可能的消除掃地機(jī)器人清掃盲區(qū),提高掃地機(jī)器人的一次清掃率,降低重復(fù)率。
關(guān)鍵詞 掃地機(jī)器人 單片機(jī) 路徑規(guī)劃
中圖分類號(hào):TP242.6 文獻(xiàn)標(biāo)識(shí)碼:A DOI:10.16400/j.cnki.kjdkx.2018.05.032
On Optimizing Path Algorithm of Sweeper Robot
LU Chengtang, LIN Guifeng, LIN Weilong, HUANG Chenghuai, SUN Baofu
(College of Mechanical and Control Engineering, Guilin University of Technology, Guilin, Guangxi 541004)
Abstract With the development and progress of technology, the trend of artificial intelligence is about to come. As a modern intelligent home appliance, sweeping robot has more and more applications. This paper aims at the cleaning path design and algorithm of sweeping robot based on SCM AT89C52RC. By locating the collision records and the position of obstacles in walking robot, the indoor map is depicted and stored in memory.
Keywords sweeping robot; single chip microcomputer; path planning
1 前言
1.1 問題的提出
掃地機(jī)器人,又稱自動(dòng)打掃機(jī)、智能吸塵等,如今已成為廣大家庭需要的智能家用電器,一般采用刷掃和真空的方式進(jìn)行打掃,一般是通過(guò)紅外、超聲波等傳感器進(jìn)行探測(cè)。而如今市場(chǎng)上許多的掃地機(jī)器人的清掃路徑存在著許多的缺點(diǎn):當(dāng)感應(yīng)到前方存在著障礙物時(shí),就會(huì)進(jìn)行左或右的轉(zhuǎn)向,通常會(huì)使得掃地機(jī)器人反復(fù)清掃同一個(gè)地方,而其他的區(qū)域卻清掃不到,這樣的清掃方式費(fèi)時(shí)且效率低,所以如今迫切需要解決掃地機(jī)器人的清掃路徑的優(yōu)化。
1.2 研究的背景
進(jìn)入21世紀(jì)以來(lái),智能機(jī)器人的技術(shù)得到了全面的發(fā)展。掃地機(jī)器人最早起于歐美,國(guó)內(nèi)相較于歐美等發(fā)達(dá)國(guó)家和地區(qū)而言,對(duì)掃地機(jī)器人的研究起步較晚。2004年,重慶大學(xué)智能科學(xué)技術(shù)研究室與寧波波郎電器股份有限公司合作開發(fā)室內(nèi)清潔機(jī)器人,最新開發(fā)的BL001能根據(jù)前端左右兩側(cè)的紅外傳感器探測(cè)墻壁,沿墻壁行走清掃地面?,F(xiàn)如今市面上,國(guó)產(chǎn)品牌的掃地機(jī)器人如浦桑尼克藍(lán)天S、科沃斯DT85G、?,斕豘J-C1等很受歡迎。但是基于紅外傳感器與超聲波傳感器的掃地機(jī)器人測(cè)量精度較為低,而且干擾比較大,導(dǎo)致掃地機(jī)器人出現(xiàn)路徑混亂等情況。
2 技術(shù)概述
2.1 單片機(jī)技術(shù)概述
單片機(jī)(Microcontrollers)是一種集成電路芯片,是采用超大規(guī)模集成電路技術(shù)把具有數(shù)據(jù)處理能力的中央處理器CPU、隨機(jī)存儲(chǔ)器RAM、只讀存儲(chǔ)器ROM、多種I/O口和中斷系統(tǒng)、定時(shí)器/計(jì)數(shù)器等功能(可能還包括顯示驅(qū)動(dòng)電路、脈寬調(diào)制電路、模擬多路轉(zhuǎn)換器、A/D轉(zhuǎn)換器等電路)集成到一塊硅片上構(gòu)成的一個(gè)小而完善的微型計(jì)算機(jī)系統(tǒng),在工業(yè)控制領(lǐng)域廣泛應(yīng)用。從上世紀(jì)80年代,由當(dāng)時(shí)的4位、8位單片機(jī),發(fā)展到現(xiàn)在的300M的高速單片機(jī)。
本文中采用的是比較成熟而且價(jià)格相對(duì)低廉的AT89C52RC單片機(jī),此單片機(jī)編程較為簡(jiǎn)單,比起STM32系列有著十分大的優(yōu)勢(shì)。圖1為單片機(jī)AT89C52RC的管腳圖。
2.2 傳感器技術(shù)
掃地機(jī)器人避障時(shí)首先需要對(duì)障礙物進(jìn)行檢測(cè),而后將檢測(cè)到的訊息傳送到微機(jī)系統(tǒng)中進(jìn)行處理,再然后輸出信號(hào)給控制器,控制器才能夠知道控制量,執(zhí)行微機(jī)系統(tǒng)傳來(lái)的命令,從而改變掃地機(jī)器人的運(yùn)動(dòng)位姿。本文中同時(shí)采用紅外傳感器與超聲波傳感器。這兩個(gè)種類的傳感器造價(jià)便宜,易于應(yīng)用,結(jié)合使用它們并且合理分配好其位置分布能夠較為精確測(cè)出障礙物位置。
3 路徑及其算法設(shè)計(jì)
基于STC89C52RC的掃地機(jī)器人路徑規(guī)劃算法如下:
首先利用光電編碼器作為掃地機(jī)器人的傳感器,該傳感器用于記錄碰撞(驅(qū)動(dòng)輪一旦發(fā)生堵轉(zhuǎn)既認(rèn)為發(fā)生碰撞)和行走距離的數(shù)據(jù),遇到障礙物時(shí)驅(qū)動(dòng)輪堵轉(zhuǎn),將障礙物的地址存放在[x,y]數(shù)組中。
機(jī)器人從靠墻的一面開始(圖2),進(jìn)行第一次左(右)轉(zhuǎn)彎前進(jìn)試探,掃地機(jī)器人在碰到障礙(假如左側(cè))時(shí)相反方向一側(cè)(右側(cè))旋轉(zhuǎn)90度前進(jìn)一段距離A繞開障礙物,并向每前行走一小段吸塵器口徑的距離(b)后,此時(shí)總右行距離為(A+nb),向另一側(cè)(左側(cè))旋轉(zhuǎn)90度試探,如果機(jī)器人沒有碰到障礙物,則繼續(xù)向左行進(jìn)(A+nb)后轉(zhuǎn)向繼續(xù)前行清掃工作,障礙物的尺寸較小,此時(shí)掃地機(jī)器人可以避開繼續(xù)向前行走,并且在此處記錄一個(gè)清掃盲區(qū)。如果障礙物的尺寸大于吸塵器的口徑,此時(shí)掃地機(jī)器人無(wú)法通過(guò),則向同一側(cè)(左/右)旋轉(zhuǎn)90度,形成回頭清掃的方式,記錄這次清掃的距離記為y。
重復(fù)以上的清掃方法,將每一次清掃的距離都記為y,比較每一次清掃的距離y得出最大的清掃距離。對(duì)比障礙物的地址可以得到每次未清掃盲區(qū),對(duì)盲區(qū)進(jìn)行試探、清掃。
4 結(jié)語(yǔ)
本文提出了一種基于掃地機(jī)器人傳感器技術(shù)與單片機(jī)技術(shù)的結(jié)合,通過(guò)傳感器與碰撞來(lái)確定機(jī)器人所在位置以及需要做出得命令,與一般的掃地機(jī)器人相比,該模型能夠通過(guò)記錄行走距離與碰撞次數(shù)還有傳感器掃描結(jié)合,生成較為準(zhǔn)確的室內(nèi)地圖,從而選擇最優(yōu)路徑進(jìn)來(lái)清掃,提高掃地機(jī)器人的效率與覆蓋率。
參考文獻(xiàn)
[1] 唐如龍.基于單片機(jī)的掃地機(jī)器人調(diào)速系統(tǒng)設(shè)計(jì)[J]. 裝備制造技術(shù),2017(07):116-118.
[2] 李炫志,黃旭銘,等.基于光流定位的自動(dòng)路徑規(guī)劃清掃機(jī)器人[J].微型機(jī)與應(yīng)用,2017.36(5):57-59.
[3] 簡(jiǎn)毅,高斌,張?jiān)?一種室內(nèi)掃地機(jī)器人全遍歷路徑規(guī)劃方法研究[J].傳感器與微系統(tǒng),2018.37(1):32-34.
[4] 霍英杰,張奕櫻.基于2.4G無(wú)線通信的智能掃地機(jī)器人技術(shù)的研究與實(shí)現(xiàn)[J].黑龍江科技信息,2017(5):70.
[5] 王曉彤,黃魯.基于單目天花板視覺的掃地機(jī)器人定位算法設(shè)計(jì)及實(shí)現(xiàn)[J].微電子學(xué)與計(jì)算機(jī),2018.35(3):125-129+134.