研究一種智能掃地機器人,從硬件系統(tǒng)控制模塊設(shè)計到主要技術(shù)調(diào)試進行了較詳細的闡述。以 STM32 單片機為控制核心與電機驅(qū)動、紅外線路徑識別模塊等相互協(xié)調(diào)應用。進行電路搭建和程序編寫。實現(xiàn)了智能掃地機器人紅外線避障和自動掃地功能,其清掃面積能達到約 70%,清掃率約 60%,很大程度受到自身機械機構(gòu)的限制,后期將對小車的機械結(jié)構(gòu)進行完善。
1 引言
近年來,隨著 AI 技術(shù)的突破,核心零部件成本的下降,使越來越多的智能化設(shè)備進入人類的家居生活。智能掃地機器人無可厚非是最具代表的服務類機器人,并取得了爆發(fā)式的發(fā)展。都市繁忙的生活節(jié)奏讓最簡單的掃地成為生活累贅,掃地機器人的需求點在于解放繁忙的都市人群,用智能化的方式解放雙手,追求更高品質(zhì)的生活質(zhì)量[1-3]。
2 系統(tǒng)結(jié)構(gòu)
本智能掃地機器人控制系統(tǒng)硬件主要是以單片機 STM32F103 為核心,輔助其外圍各模塊在單片機的控制下,相互協(xié)調(diào)工作,保證智能掃地機器人各種功能的實現(xiàn)。該智能掃地機器人系統(tǒng)框圖如圖1 所示。
3 智能掃地機器人控制系統(tǒng)的硬件模塊
3.1 STM32F103 單片機
作為智能小車核心控制模塊,輸出 PWM 波以及紅外模塊所需的高、低電平。具備 72 MHz @1.25 MIPS/min 內(nèi)核,集成 32~51 KB 的 Flash 存儲器;6~64 KB 的 SRAM 存儲器等。其高性能、低功耗、外設(shè)豐富,能夠完成本課題所需所有功能。
3.2 紅外避障模塊
傳感器的紅外發(fā)射二極管不斷發(fā)射紅外線,當發(fā)射的紅外線沒有被反射回來或強度不夠大時,光敏三極管處于閉合狀態(tài),此時模塊的輸出端為高電平,指示二極管一直處于熄滅狀態(tài),被檢測物體出現(xiàn)在檢測范圍內(nèi)時,紅外線被反射回來且強度足夠大,光敏三極管飽和,此時模塊的輸出端為低電平,指示二極管被點亮。紅外發(fā)射反射接收原理如圖 2 所示。
本課題采用 4 個紅外漫反射式傳感器的有效距離范圍為 2~30 cm,從小車形態(tài)前方從左至右分別編號為探頭 1、探頭 2、探頭 3、探頭 4。
3.3 電機驅(qū)動模塊
本模塊采用 L298N 電機驅(qū)動板模塊,輸出高低電平給驅(qū)動電機,控制電機正轉(zhuǎn)、反轉(zhuǎn)或者停止。利用 STM32 單片機輸出 PWM 波原理來控制直流電機的轉(zhuǎn)動。
4 路徑規(guī)劃軟件的設(shè)計
開始,標志位置1,前進,兩側(cè)傳感器判斷是否有障礙,否,返回前進,是,判斷標志位是否為 0,是,右 S 彎且標志位置 1,返回前進,否,左 S彎 且標志位置 0,返回前進。
掃地機器人按照預定指令完成自動清掃功能。路徑規(guī)劃軟件流程圖如圖 3 所示。
5 技術(shù)調(diào)試及結(jié)果分析
5.1 路徑規(guī)劃
起點從平面左邊平行位置起,智能掃地機器人直行到達墻壁,當探頭 1 和探頭 4 同時感應到障礙物時小車停止,后退 10 cm,然后右轉(zhuǎn) 90o,而后直行 17 cm,若探頭 1 感應到障礙物,則右轉(zhuǎn) 90o 完成調(diào)頭,若未檢測到障礙物小車執(zhí)行避障程序。
同理,直行到達對側(cè)墻壁時,左轉(zhuǎn)完成調(diào)頭,路徑成 S 形。自動清掃路徑如圖 4 所示。
因為掃地機器人正面與障礙物接觸面積不同,所以在執(zhí)行避障時設(shè)置了不同的轉(zhuǎn)向角度。探頭 1 避障程序:探頭 1 檢測到障礙物時,表明當前機器人左側(cè)靠近障礙物,右轉(zhuǎn) 45o 避讓。同理,探頭 4 檢測到障礙物時,左轉(zhuǎn) 45o 避讓。
探頭 2 避障程序:當探頭 2 最先檢測到障礙物時,表明機器人左側(cè)遇到障礙物或家居的突出拐角,此時右轉(zhuǎn) 60o 避讓。同理,當探頭 3 最先檢測到障礙物時,此時左轉(zhuǎn) 60o 避讓。
探頭 2、探頭 3 避障程序:探頭 2 個探頭 3 同時遇到障礙物時,表明機器人正面遇到障礙物,此時右轉(zhuǎn) 90o 避讓。
5.2 模式調(diào)試
智能掃地機器人后輪由兩個電機驅(qū)動來控制,前方為一個萬向輪,能夠很好地實現(xiàn)左右的移動。小車移動過程中,電機驅(qū)動電壓的差異使驅(qū)動力大小不同,通過控制小車兩個后輪的速度來控制小車的移動方向。自動清掃模式時,以 S 路徑往返清掃。實驗時劃出一片矩形清掃區(qū)域,設(shè)置不同初始位置,適當在任意位置放置一些障礙物,觀察其清掃面積的大小。清掃效果如表 1 所示。
經(jīng)實驗結(jié)果分析,根據(jù)紅外反射傳感器檢測障礙物的位置,能夠自動避障。智能清潔機器人的清掃面積與初始位置有關(guān),清掃面積較大,但邊角處仍無法清掃到。智能掃地機器人清掃工作狀態(tài)如圖 5 所示。
6 結(jié)語
本課題完成的智能掃地機器人根據(jù)路徑規(guī)劃算法控制機器人的運動軌跡,執(zhí)行時不斷地檢測周圍環(huán)境中的障礙物信息,掃地模塊獨立設(shè)計。
實測表明機器人能夠?qū)崿F(xiàn)自動清掃、實時避障、耗時少又節(jié)能的目標。在實驗過程中發(fā)現(xiàn)依然有需要改進的地方,如使小車行動更加靈敏、清掃更大體積的垃圾、減小電機的噪聲等,使用戶有更好的使用體驗。
-
紅外
+關(guān)注
關(guān)注
8文章
732瀏覽量
94786 -
掃地機器人
+關(guān)注
關(guān)注
20文章
778瀏覽量
53327
原文標題:一種智能紅外避障自動掃地機器人的設(shè)計
文章出處:【微信號:appic-cn,微信公眾號:集成電路應用雜志】歡迎添加關(guān)注!文章轉(zhuǎn)載請注明出處。
發(fā)布評論請先 登錄
相關(guān)推薦
評論