復(fù)雜路線下機(jī)器人的三點(diǎn)三輪尋跡系統(tǒng)
加入技術(shù)交流群
為了進(jìn)一步提高系統(tǒng)的安全性和可靠性，還需增加異常處理算法?？赡艹霈F(xiàn)的異常情況有：過(guò)小彎道或小角度折道時(shí)，機(jī)器人還來(lái)不及轉(zhuǎn)過(guò)彎來(lái)，就已經(jīng)完全偏離黑線。這種情況下，3個(gè)傳感器都輸出“1”，檢測(cè)不到黑線，若不及時(shí)處理，機(jī)器人將無(wú)法繼續(xù)尋跡。針對(duì)該情況，設(shè)計(jì)了原地旋轉(zhuǎn)動(dòng)作來(lái)找回預(yù)定路線，不過(guò)原地旋轉(zhuǎn)有順、逆時(shí)針之分，因此還得區(qū)分開來(lái)。改進(jìn)后編程的思路為：每次讀取P2口值之前，將其上一次的傳感器組合值存入某個(gè)寄存器，當(dāng)出現(xiàn)組合值為 “111”的情況時(shí)，立即查詢上一次的值，根據(jù)該值，可以判斷出機(jī)器人是從哪一側(cè)偏離黑線的，從而進(jìn)行順或逆時(shí)針原地旋轉(zhuǎn)。其主要程序如下：本文引用地址：http://www.ex-cimer.com/article/163567.htm
結(jié)語(yǔ)
根據(jù)上述設(shè)計(jì)思路，我們制作出尋跡機(jī)器人并進(jìn)行了測(cè)試。測(cè)試場(chǎng)地如圖4所示，黑色導(dǎo)引線寬度為3 cm，黑線周圍區(qū)域均為白紙覆蓋。測(cè)試結(jié)果表明：該尋跡機(jī)器人能在此復(fù)雜路線下平穩(wěn)、順利地沿著黑線走完全程，并在終點(diǎn)沿原路返回，達(dá)到了預(yù)期的目標(biāo)。這為進(jìn)一步研究復(fù)雜環(huán)境下的自動(dòng)行走機(jī)器人提供了參考。
本文的創(chuàng)新點(diǎn)為：使用3個(gè)自制的紅外光電傳感器，以簡(jiǎn)單的設(shè)計(jì)和較少的硬件實(shí)現(xiàn)了復(fù)雜路線下機(jī)器人的尋跡。而基于該機(jī)器人雙級(jí)轉(zhuǎn)彎的設(shè)計(jì)思想，可以增加傳感器數(shù)量、組成傳感器陣列來(lái)實(shí)現(xiàn)多級(jí)轉(zhuǎn)彎，從而對(duì)機(jī)器人的自主尋跡有著更為精確的控制。
評(píng)論