專利名稱:輪式運(yùn)動(dòng)機(jī)器人位置與角度的實(shí)時(shí)檢測(cè)裝置的制作方法
技術(shù)領(lǐng)域:
輪式運(yùn)動(dòng)機(jī)器人位置與角度的實(shí)時(shí)檢測(cè)裝置技術(shù)領(lǐng)域[0001]本實(shí)用新型涉及一種輪式運(yùn)動(dòng)機(jī)器人位置與角度檢測(cè)裝置,具體為基于攝像頭的輪式運(yùn)動(dòng)機(jī)器人位置與角度的實(shí)時(shí)檢測(cè)裝置。
背景技術(shù):
[0002]現(xiàn)有的輪式運(yùn)動(dòng)機(jī)器人位置與角度的實(shí)時(shí)檢測(cè),多是由硬件傳感器完成,如在電機(jī)輪軸上安裝伺服電機(jī)和編碼器以檢測(cè)輪軸轉(zhuǎn)動(dòng)角度,角度乘以輪徑得到轉(zhuǎn)動(dòng)的距離,通過疊加,得到了每一個(gè)輪子的總的行進(jìn)距離,與初始坐標(biāo)比對(duì),就得到了機(jī)器人的位置坐標(biāo)。同樣的,在角度信息獲取的過程中,需要在機(jī)器人內(nèi)部安裝電子羅盤或者GPS導(dǎo)航組件。這些方法雖然可以獲得我們想要的信息,但是存在較大的缺點(diǎn)。[0003]這種方法在應(yīng)用中需要精確的知道機(jī)器人的幾何參數(shù)(如輪徑,軸距),而且在角度測(cè)量時(shí),有時(shí)由于受到信號(hào)屏蔽的干擾和組件精度等影響,測(cè)量結(jié)果不是很精確,也不是很穩(wěn)定。但是,這種方法最大的缺點(diǎn)卻是增加了整個(gè)系統(tǒng)的復(fù)雜程度,使得系統(tǒng)的穩(wěn)定性降低,同時(shí)也增加了成本。發(fā)明內(nèi)容[0004]本實(shí)用新型是要提供一種輪式運(yùn)動(dòng)機(jī)器人位置與角度的實(shí)時(shí)檢測(cè)裝置。該裝置結(jié)構(gòu)簡(jiǎn)單,測(cè)量數(shù)據(jù)準(zhǔn)確穩(wěn)定,只需要一個(gè)安裝在天棚上的攝像頭,就能夠獲得所有需要的信息,取代了以往需要硬件傳感器的方法,節(jié)約了成本,提高了精度。[0005]為實(shí)現(xiàn)上述目的,本實(shí)用新型的技術(shù)方案是:一種輪式運(yùn)動(dòng)機(jī)器人位置與角度的實(shí)時(shí)檢測(cè)裝置,包括輪式運(yùn)動(dòng)機(jī)器人、圖形采集卡、攝像頭、上位機(jī),其特點(diǎn)是:攝像頭固定在天花板上,俯瞰地面,攝像頭通過視頻信號(hào)線與圖像采集卡連接,圖像采集卡的輸出端與上位機(jī)連接,通過上位機(jī)控制輪式運(yùn)動(dòng)機(jī)器人左右電機(jī)轉(zhuǎn)動(dòng)。[0006]本實(shí)用新型的有益效果是:[0007]該裝置結(jié)構(gòu)簡(jiǎn)單,布置容易,可以在光照強(qiáng)度不均勻的場(chǎng)合很好的工作,有較強(qiáng)的適應(yīng)能力和魯棒性。這種方法改進(jìn)了以往依靠傳感器判斷機(jī)器人位置與角度的方法,簡(jiǎn)化了系統(tǒng)結(jié)構(gòu),提聞了系統(tǒng)穩(wěn)定性。
[0008]圖1是本實(shí)用新型的安裝示意圖;[0009]圖2是本實(shí)用新型的結(jié)構(gòu)示意圖;[0010]圖3是輪式機(jī)器人的示意圖;[0011]圖4是算法結(jié)構(gòu)流程圖。
具體實(shí)施方式
[0012]
以下結(jié)合附圖與實(shí)施例對(duì)本實(shí)用新型作進(jìn)一步說明。[0013]如圖1,2所示,本實(shí)用新型的輪式運(yùn)動(dòng)機(jī)器人位置與角度的實(shí)時(shí)檢測(cè)裝置,包括輪式運(yùn)動(dòng)機(jī)器人2、圖形采集卡、攝像頭1、上位機(jī)。[0014]攝像頭I固定在天花板上,俯瞰地面,攝像頭I通過視頻信號(hào)線與圖像采集卡連接,圖像采集卡的輸出端與上位機(jī)連接,通過上位機(jī)控制輪式運(yùn)動(dòng)機(jī)器人左右電機(jī)轉(zhuǎn)動(dòng)。[0015]一種輪式運(yùn)動(dòng)機(jī)器人位置與角度的檢測(cè)方法,首先在被檢測(cè)的輪式運(yùn)動(dòng)機(jī)器人I表面做能夠體現(xiàn)出其方向的顏色標(biāo)記,如與輪式運(yùn)動(dòng)機(jī)器人2正向平行的黑色長(zhǎng)條,通過攝像頭I實(shí)時(shí)采集圖像,應(yīng)用閾值法進(jìn)行色彩處理或灰度處理,通過辨識(shí)標(biāo)記物,得到輪式運(yùn)動(dòng)機(jī)器人2在圖像中的位置信息和角度信息。[0016]在檢測(cè)中通過攝像頭實(shí)時(shí)采集得到輪式運(yùn)動(dòng)機(jī)器人2上兩個(gè)點(diǎn),且兩個(gè)點(diǎn)的連線與輪式運(yùn)動(dòng)機(jī)器人正向平行,通過比對(duì)兩個(gè)點(diǎn)在圖像中的信息,可以得到輪式運(yùn)動(dòng)機(jī)器人的正方向。[0017]本實(shí)用新型應(yīng)用多種算法。包括CAMShift圖像運(yùn)動(dòng)物體跟蹤算法,自適應(yīng)算法,目標(biāo)提取算法,輪廓檢測(cè)算法,角度計(jì)算算法。其中在目標(biāo)提取算法中涵蓋多種情況,如彩色目標(biāo)提取,黑白目標(biāo)提取等,不同類型的標(biāo)記物,所采用的算法也不一樣。在角度計(jì)算算法部分也是一樣,要視具體情況采用不同的算法,這部分算法主要由標(biāo)記物的形狀,擺放方式等決定。[0018]下面以黑白條形標(biāo)記物為例對(duì)內(nèi)部算法進(jìn)行詳細(xì)說明:[0019]如圖3所示,一個(gè)輪式運(yùn)動(dòng)機(jī)器人的示意圖,采用的是黑色長(zhǎng)條狀標(biāo)記物。圖中箭頭方向?yàn)檩喪竭\(yùn)動(dòng)機(jī)器人的正方向;方框代表輪式運(yùn)動(dòng)機(jī)器人輪子3 ;圓形為輪式運(yùn)動(dòng)機(jī)器人2 ;方塊為輪式運(yùn)動(dòng)機(jī)器人上的標(biāo)記物4 ;黑圓點(diǎn)為機(jī)器人幾何中心P ;白色圓點(diǎn)為標(biāo)記物幾何中心,白色方框?yàn)榘j(luò)標(biāo)記物的最大外接矩形A。[0020]內(nèi)部算法大體上可分七大塊,如圖4所示:[0021]S1、對(duì)當(dāng)前幀調(diào)用CAMShift跟蹤算法,得到包絡(luò)輪式運(yùn)動(dòng)機(jī)器人的最小外接矩形A[0022]S2、以最小外接矩形A為參數(shù),提取視頻圖像的R0I,并計(jì)算出機(jī)器人幾何中心P[0023]S3、將彩色圖像的ROI轉(zhuǎn)換成灰度圖像[0024]S4、提取圖像中一些特征點(diǎn)的灰度值,得到閾值B[0025]S5、以B為閾值,將灰度圖像二值化,得到二值圖[0026]S6、對(duì)二值圖進(jìn)行形態(tài)學(xué)處理,得到輪式運(yùn)動(dòng)機(jī)器人上標(biāo)識(shí)物的輪廓C[0027]S7、根據(jù)C的特征,計(jì)算得到輪式運(yùn)動(dòng)機(jī)器人的角度D[0028]S8、用P、D進(jìn)行計(jì)算,得到相關(guān)指令,控制輪式運(yùn)動(dòng)機(jī)器人運(yùn)動(dòng)[0029]S9、機(jī)器人實(shí)時(shí)得到含有輪式運(yùn)動(dòng)機(jī)器人的圖片E[0030]S10、采集卡得到圖片E,輸送給上位機(jī)[0031]如此循環(huán)下去。
權(quán)利要求1.一種輪式運(yùn)動(dòng)機(jī)器人位置與角度的實(shí)時(shí)檢測(cè)裝置,包括輪式運(yùn)動(dòng)機(jī)器人、圖形采集卡、攝像頭、上位機(jī),其特征在于:所述攝像頭固定在天花板上,俯瞰地面,攝像頭通過視頻信號(hào)線與圖像采集卡連接,圖像采集卡的輸 出端與上位機(jī)連接,通過上位機(jī)控制輪式運(yùn)動(dòng)機(jī)器人左右電機(jī)轉(zhuǎn)動(dòng)。
專利摘要本實(shí)用新型涉及一種輪式運(yùn)動(dòng)機(jī)器人位置與角度的實(shí)時(shí)檢測(cè)裝置,攝像頭固定在天花板上,俯瞰地面,攝像頭通過視頻信號(hào)線與圖像采集卡連接,圖像采集卡的輸出端與上位機(jī)連接,通過上位機(jī)控制輪式運(yùn)動(dòng)機(jī)器人左右電機(jī)轉(zhuǎn)動(dòng)。首先在被檢測(cè)的輪式運(yùn)動(dòng)機(jī)器人表面做能夠體現(xiàn)出其方向的顏色標(biāo)記,通過攝像頭實(shí)時(shí)采集圖像,應(yīng)用閾值法進(jìn)行色彩處理或灰度處理,通過辨識(shí)標(biāo)記物,得到輪式運(yùn)動(dòng)機(jī)器人在圖像中的位置信息和角度信息。該裝置結(jié)構(gòu)簡(jiǎn)單,布置容易,可以在光照強(qiáng)度不均勻的場(chǎng)合很好的工作,有較強(qiáng)的適應(yīng)能力和魯棒性。這種方法改進(jìn)了以往依靠傳感器判斷機(jī)器人位置與角度的方法,簡(jiǎn)化了系統(tǒng)結(jié)構(gòu),提高了系統(tǒng)穩(wěn)定性。
文檔編號(hào)B25J13/08GK203077301SQ201320035760
公開日2013年7月24日 申請(qǐng)日期2013年1月24日 優(yōu)先權(quán)日2013年1月24日
發(fā)明者王朝立, 付振宇 申請(qǐng)人:上海理工大學(xué)