王強(qiáng) 王國慶 楊康 梁思瑞 王明圣
摘要:針對室內(nèi)光照多變對機(jī)器視覺帶來的不良影響所造成的室內(nèi)機(jī)器人難定位的問題,提出了基于固定自發(fā)光特征物的雙目定位算法設(shè)計(jì),實(shí)現(xiàn)了機(jī)器人在室內(nèi)環(huán)境中的定位。針對視覺定位算法實(shí)時(shí)性不高、處理數(shù)據(jù)量大的問題,通過預(yù)先建立數(shù)據(jù)庫的方法避開復(fù)雜的計(jì)算,提高了視覺定位速度。具體而言,建立了固定特征物投影模型,實(shí)現(xiàn)了特征物模型的建立和對應(yīng)數(shù)據(jù)庫的生成,將特征點(diǎn)像素坐標(biāo)與投影平面坐標(biāo)進(jìn)行匹配,并將相機(jī)在環(huán)境坐標(biāo)系中的位姿轉(zhuǎn)換為運(yùn)動(dòng)平臺(tái)在環(huán)境坐標(biāo)系中的位姿,實(shí)現(xiàn)了運(yùn)動(dòng)平臺(tái)在室內(nèi)環(huán)境中的定位。最終經(jīng)過測試,證明該方法是可行的。
關(guān)鍵詞: 室內(nèi)移動(dòng)機(jī)器人; 雙目定位; 自發(fā)光特征物; 雙目定位算法
【Abstract】 Aiming at the problem that indoor robots are difficult to locate due to the adverse effects of indoor illumination on machine vision, a binocular localization algorithm based on fixed self-luminous features is proposed, which realizes the localization of robots in indoor environment. Aiming at the problem of low real-time performance and large amount of data processing of visual localization algorithm, the method of pre-establishment of database avoids complex calculation and improves the speed of visual localization. Specifically, the projection model of fixed feature is established, the establishment of feature model and the generation of corresponding database are realized, the pixel coordinates of feature points are matched with the projection plane coordinates, and the pose of camera in the environment coordinate system is converted to that of the motion platform in the environment coordinate system, thus realizing location of indoor environment of the motion platform in the environment coordinate system. Finally, the test results show that the method is feasible.
【Key words】 ?indoor mobile robot; binocular localization; self-luminous feature; binocular localization algorithm
0 引 言
自主移動(dòng)機(jī)器人是可依靠自身智能系統(tǒng)進(jìn)行自主導(dǎo)航的在地面運(yùn)動(dòng)的機(jī)器人。文獻(xiàn)[1]中提出如何解決移動(dòng)機(jī)器人“走”的問題一直是自主移動(dòng)機(jī)器人領(lǐng)域所存在的問題。文獻(xiàn)[2]提出移動(dòng)機(jī)器人實(shí)現(xiàn)自主運(yùn)動(dòng)的基礎(chǔ)就是實(shí)現(xiàn)其自身定位。文獻(xiàn)[3]提出在小型移動(dòng)機(jī)器人的發(fā)展下,對其自主運(yùn)動(dòng)系統(tǒng)應(yīng)該有更高的要求。文獻(xiàn)[4]提出大多數(shù)小型移動(dòng)機(jī)器人需要通過傳感器感知其所處環(huán)境及自身位置。文獻(xiàn)[5]所述的“愛家一號(hào)”通過重復(fù)路徑來記憶路徑。文獻(xiàn)[6]中的Botlr的機(jī)器人管家,使用激光雷達(dá)和攝像機(jī)進(jìn)行導(dǎo)航和定位。文獻(xiàn)[7]所述的移動(dòng)機(jī)器人監(jiān)控系統(tǒng)為機(jī)器人搭載多種模塊化傳感器,能感知機(jī)器人周圍環(huán)境。文獻(xiàn)[8]所述的CASIA-I輪式移動(dòng)機(jī)器人,是在多傳感器信息融合的基礎(chǔ)上實(shí)現(xiàn)了自主定點(diǎn)移動(dòng)和軌跡跟蹤的功能。
以上研究都取得了不同的進(jìn)展,但是依然存在定位不精確等問題。室內(nèi)環(huán)境的光照情況復(fù)雜,影響機(jī)器視覺的圖像采集和處理。所以,視覺定位在室內(nèi)環(huán)境中的應(yīng)用也受到了很大的限制。本次研究提出基于固定自發(fā)光特征物的雙目定位算法設(shè)計(jì),可以解決光照情況復(fù)雜的問題,將特征物圖像與預(yù)先建立的數(shù)據(jù)庫進(jìn)行數(shù)據(jù)匹配,確定機(jī)器人的實(shí)時(shí)位姿,以實(shí)現(xiàn)機(jī)器人在室內(nèi)環(huán)境中的定位。
1 整體方案
根據(jù)周圍環(huán)境進(jìn)行絕對定位,不存在累積誤差且精度高,并極力降低定位算法的復(fù)雜度。雙目攝像機(jī)安裝在運(yùn)動(dòng)平臺(tái)頂端,便于采集圖像。運(yùn)動(dòng)測試平臺(tái)機(jī)械結(jié)構(gòu)三維模型圖如圖1所示。其中,雙目定位系統(tǒng)位于平臺(tái)的最上方。
通過采用攝像機(jī)采集室內(nèi)自發(fā)光特征物圖像,并提取圖像中的特征物的特征,將特征與預(yù)先建立的數(shù)據(jù)庫進(jìn)行數(shù)據(jù)匹配,確定機(jī)器人的實(shí)時(shí)位姿。
基于室內(nèi)自發(fā)光特征物的雙目定位算法,可以解決室內(nèi)光照情況復(fù)雜的問題,研究時(shí)將涉及算法的理論支撐、模型建立、數(shù)據(jù)庫建立、圖像處理、特征提取、特征匹配以及平臺(tái)定位等?;谧园l(fā)光特征物的雙目定位算法流程如圖2所示。
首先根據(jù)左右攝像機(jī)得到周圍物體的圖像,將得到的圖像傳遞回來之后進(jìn)行圖像矯正,經(jīng)過左右兩個(gè)攝像機(jī)實(shí)現(xiàn)雙目定位。將攝像機(jī)得到的特征物上某些點(diǎn)的坐標(biāo)與自發(fā)光特征物投影數(shù)據(jù)庫進(jìn)行匹配,可以將左攝像機(jī)的坐標(biāo)系轉(zhuǎn)化為機(jī)器人坐標(biāo)系,進(jìn)而實(shí)現(xiàn)移動(dòng)機(jī)器人定位。