一種移動(dòng)機(jī)器人的定位系統(tǒng)及其定位方法
【專利摘要】一種移動(dòng)機(jī)器人的定位系統(tǒng)，包括若干已知反光件(M)、轉(zhuǎn)臺(tái)(T)、激光器(J)、角度編碼器(B)及中央處理單元；所述相鄰反光件之間的連線包圍形成機(jī)器人的工作區(qū)域；所述激光器具有發(fā)射部(J1)與接收部(J2)；中央處理單元包括對(duì)所述工作區(qū)域進(jìn)行柵格化的圖形處理程序，中央處理單元計(jì)算出每一交叉點(diǎn)連接各個(gè)反光件所形成的各條連接線(L3)之間的多個(gè)第二角度，該多個(gè)第二角度組成與每一交叉點(diǎn)對(duì)應(yīng)的第二角度組；所述接收部可同時(shí)接收到從多個(gè)反光件反射回來的激光反射線(L1)，中央處理單元通過運(yùn)算處理獲得各條激光反射線之間的一個(gè)第三角度組，然后將所述第三角度組與所述第二角度組進(jìn)行對(duì)比以獲得機(jī)器人在所述坐標(biāo)系內(nèi)的位置。
【專利說明】一種移動(dòng)機(jī)器人的定位系統(tǒng)及其定位方法
【技術(shù)領(lǐng)域】
[0001]本發(fā)明屬于一種機(jī)器人的定位【技術(shù)領(lǐng)域】，尤其涉及一種移動(dòng)機(jī)器人的定位系統(tǒng)與定位方法。
【背景技術(shù)】
[0002]在移動(dòng)機(jī)器人的應(yīng)用中，導(dǎo)航是指移動(dòng)機(jī)器人通過傳感器感知環(huán)境和自身狀態(tài)，實(shí)現(xiàn)在有障礙物的環(huán)境中面向目標(biāo)自主運(yùn)動(dòng)。導(dǎo)航的成功需要有四個(gè)模塊:感知，定位，認(rèn)知，運(yùn)動(dòng)控制。其中，定位是移動(dòng)機(jī)器人導(dǎo)航最基本的環(huán)節(jié)，所謂定位就是確定機(jī)器人在環(huán)境中的實(shí)時(shí)位姿。當(dāng)前應(yīng)用較多的定位技術(shù)有:視覺導(dǎo)航定位、全球定位系統(tǒng)(GPS,GlobalPositioning System)、差分GPS定位、超聲波定位等。其中,視覺導(dǎo)航定位方式的圖像處理計(jì)算量大，計(jì)算速度要求高，因而實(shí)時(shí)性差，此外，該種定位方式受外界環(huán)境的影響較大，因此不太適用于戶外移動(dòng)機(jī)器人的定位系統(tǒng)。全球定位系統(tǒng)是由美國國防部控制的，對(duì)非美國國防部授權(quán)的用戶，其所能獲得的定位導(dǎo)航精度較低，因此不適于定位精度較高的場合。差分GPS定位，是指用戶GPS接收機(jī)附近設(shè)置一個(gè)已知精度坐標(biāo)的差分基準(zhǔn)站，基準(zhǔn)站的接收機(jī)連續(xù)接收GPS導(dǎo)航信號(hào)，將測(cè)得的位置或距離數(shù)據(jù)與已知的位置、距離數(shù)據(jù)進(jìn)行比較，確定誤差，得出準(zhǔn)確改正值，然后將這些改正數(shù)據(jù)通過數(shù)據(jù)鏈發(fā)播給覆蓋區(qū)域內(nèi)的用戶，用以改正用戶的定位結(jié)果，這種定位方法雖然定位精度高，但成本也很高。對(duì)于超聲波定位方式，由于超聲波在空氣中衰減很大，因此只適用空間范圍較小的場合。針對(duì)上述各種定位技術(shù)存在的缺陷，有必要提出一種改進(jìn)的移動(dòng)機(jī)器人定位系統(tǒng)以解決上述問題。

【發(fā)明內(nèi)容】

[0003]本發(fā)明的目的在于提供一種移動(dòng)機(jī)器人通過角度對(duì)比來實(shí)現(xiàn)定位的定位系統(tǒng)與定位方法。
[0004]為了實(shí)現(xiàn)上述目的，本發(fā)明采用如下技術(shù)方案:一種移動(dòng)機(jī)器人的定位系統(tǒng)，該定位系統(tǒng)設(shè)于一坐標(biāo)系內(nèi)，且該定位系統(tǒng)包括若干已知坐標(biāo)值的反光件、安裝于機(jī)器人上可360°旋轉(zhuǎn)的轉(zhuǎn)臺(tái)、激光器、角度編碼器及中央處理單元，所述激光器與角度編碼器安裝于所述轉(zhuǎn)臺(tái)上；所述相鄰反光件之間的連線包圍形成機(jī)器人的工作區(qū)域；所述激光器具有發(fā)射部與接收部，該發(fā)射部發(fā)出激光發(fā)射線至所述反光件后經(jīng)反射形成的激光反射線被所述接收部接收，且所述反光件具備使該激光反射線平行于激光發(fā)射線的光線直反功能；所述角度編碼器用于測(cè)得機(jī)器人的機(jī)頭朝向線與所述激光反射線之間的第一角度；所述中央處理單元包括圖形處理程序，該圖形處理程序?qū)λ龉ぷ鲄^(qū)域進(jìn)行柵格化并得出各交叉點(diǎn)的坐標(biāo)值，中央處理單元計(jì)算出每一交叉點(diǎn)連接各個(gè)反光件所形成的各條連接線之間的多個(gè)第二角度，該多個(gè)第二角度組成與每一交叉點(diǎn)對(duì)應(yīng)的第二角度組，然后將每一第二角度組存儲(chǔ)起來；機(jī)器人在所述工作區(qū)域內(nèi)移動(dòng)時(shí)，所述接收部可同時(shí)接收到從多個(gè)反光件反射回來的激光反射線，所述角度編碼器可對(duì)應(yīng)測(cè)得多個(gè)所述第一角度，中央處理單元對(duì)這些第一角度進(jìn)行運(yùn)算處理以獲得各條激光反射線之間的一個(gè)第三角度組，然后將所述第三角度與所述第二角度進(jìn)行對(duì)比以獲得機(jī)器人在所述坐標(biāo)系內(nèi)的位置。。
[0005]優(yōu)選的，當(dāng)所述第三角度組與存儲(chǔ)的一個(gè)第二角度組中有至少兩個(gè)連續(xù)相等的角度值時(shí)，機(jī)器人的坐標(biāo)值即為該第二角度組對(duì)應(yīng)的交叉點(diǎn)的坐標(biāo)值。。
[0006]優(yōu)選的，當(dāng)所述第三角度組與存儲(chǔ)的任意一個(gè)第二角度組中僅有一個(gè)相等的角度值或沒有相等的角度值時(shí)，中央處理單元將尋找到與該第三角度組的各角度值最接近的另一個(gè)第二角度組，機(jī)器人在所述坐標(biāo)系內(nèi)的位置最接近該另一個(gè)第二角度組所對(duì)應(yīng)的交叉點(diǎn)。
[0007]優(yōu)選的，所述第二角度為所述各條連接線中相鄰兩條連接線之間的角度，所述第三角度為所述各激光反射線中相鄰兩條激光反射線之間的角度。
[0008]優(yōu)選的，所述第二角度為其中一條連接線與其他各條連接線之間的角度，所述第三角度為其中一條激光反射線與其他各條激光反射線之間的角度。
[0009]優(yōu)選的，所述移動(dòng)機(jī)器人為割草機(jī)器人。
[0010]優(yōu)選的，所述定位系統(tǒng)還包括設(shè)于機(jī)器人上的電子羅盤。
[0011]為了實(shí)現(xiàn)上述目的，本發(fā)明還可以采用如下技術(shù)方案:一種移動(dòng)機(jī)器人的定位方法，該機(jī)器人上安裝有可360°旋轉(zhuǎn)的轉(zhuǎn)臺(tái)、具有發(fā)射部與接收部的激光器、角度編碼器以及中央處理單元，所述激光器與角度編碼器設(shè)于所述轉(zhuǎn)臺(tái)上，所述定位方法包括如下步驟:
[0012]I)將多個(gè)已知坐標(biāo)值的反光件設(shè)置于機(jī)器人所在坐標(biāo)系內(nèi)；
[0013]2)所述中央處理單元的圖形處理程序?qū)@些反光件的連線包圍所形成的工作區(qū)域進(jìn)行柵格化并得出各交叉點(diǎn)的坐標(biāo)值；
[0014]3)所述中央處理單元計(jì)算出每一交叉點(diǎn)連接各個(gè)反光件所形成的各條連接線之間的多個(gè)第二角度，多個(gè)第二角度組成與每一交叉點(diǎn)對(duì)應(yīng)的第二角度組，然后將每一第二角度組存儲(chǔ)起來；
[0015]4)機(jī)器人在所述工作區(qū)域內(nèi)移動(dòng)時(shí)，所述發(fā)射部發(fā)出激光發(fā)射線至所述反光件后經(jīng)反射形成的激光反射線被所述接收部接收，所述反光件具備使該激光反射線平行于激光發(fā)射線的光線直反功能，且所述接收部可同時(shí)接收到從多個(gè)反光件反射回來的多條激光反射線，所述角度編碼器對(duì)應(yīng)測(cè)得機(jī)器人的機(jī)頭朝向線與所述多條激光反射線之間的多個(gè)第一角度；
[0016]5)中央處理單元對(duì)這些第一角度進(jìn)行運(yùn)算處理以獲得各條激光反射線之間的一個(gè)第三角度組；
[0017]6)中央處理單元將所述第三角度組與所述第二角度組進(jìn)行對(duì)比以獲得機(jī)器人在所述坐標(biāo)系內(nèi)的位置。
[0018]優(yōu)選的，當(dāng)中央處理單元在存儲(chǔ)的各個(gè)第二角度組中查找到一個(gè)第二角度組，且該第二角度組與所述第三角度組有至少兩個(gè)連續(xù)相等的角度值時(shí)，中央處理單元就判斷機(jī)器人所在位置為該第二角度組所對(duì)應(yīng)的所述交叉點(diǎn)的位置。
[0019]優(yōu)選的，當(dāng)中央處理單元未查找到與所述第三角度具有相等角度值的第二角度組時(shí)，中央處理單元判斷機(jī)器人所在位置的步驟如下:
[0020]I)將所述第三角度組與存儲(chǔ)的每一第二角度組內(nèi)的各個(gè)角度值對(duì)應(yīng)相減，并得出數(shù)量與第二角度組的數(shù)量相等的一系列第四角度組；[0021]2)將該一系列第四角度組中的各個(gè)角度值對(duì)應(yīng)相比并選出具有最小絕對(duì)值的第四角度組；
[0022]3)從選出的第四角度組中選出具有所述最小絕對(duì)值最多的第四角度組，從而獲得與該第四角度組相對(duì)應(yīng)的第二角度組；
[0023]4)中央處理單元判斷機(jī)器人所在位置最靠近步驟3中的第二角度組所對(duì)應(yīng)的所述交叉點(diǎn)的位置。
[0024]優(yōu)選的，當(dāng)中央處理單元從存儲(chǔ)的各個(gè)第二角度組中查找到多個(gè)第二角度組，且該多個(gè)第二角度組與所述第三角度組僅有一個(gè)相等的角度值時(shí)，中央處理單元判斷機(jī)器人所在位置的步驟如下:
[0025]I)將所述多個(gè)第二角度組從存儲(chǔ)的各個(gè)第二角度組篩選出來；
[0026]2)將所述第三角度組與該多個(gè)第二角度組內(nèi)的各個(gè)角度值對(duì)應(yīng)相減，并得出多個(gè)第五角度組；
[0027]3)將該多個(gè)第五角度組中的各個(gè)角度值對(duì)應(yīng)相比并選出具有最小絕對(duì)值的第五角度組；
[0028]4)從選出的第五角度組中選出具有所述最小絕對(duì)值最多的第五角度組，從而獲得與該第五角度組相對(duì)應(yīng)的第二角度組；
[0029]5)中央處理單元判斷機(jī)器人所在位置最靠近步驟4中的第二角度組所對(duì)應(yīng)的所述交叉點(diǎn)的位置。
[0030]優(yōu)選的，當(dāng)機(jī)器人按照中央處理單元設(shè)定的指定線路移動(dòng)時(shí)，中央處理單元按一定頻率對(duì)所述第二、第三角度組進(jìn)行角度對(duì)比，所述機(jī)器人按一定速度沿所述指定線路移動(dòng)，中央處理單元判斷機(jī)器人所在位置的步驟如下:
[0031]I)存儲(chǔ)中央處理單元在前一次進(jìn)行角度對(duì)比時(shí)機(jī)器人在所述坐標(biāo)系內(nèi)的前一時(shí)刻位置；
[0032]2)以前一時(shí)刻位置為圓心，所述頻率與速度的乘積為半徑所形成的圓確定為角度對(duì)比的范圍；
[0033]3)選出位于該圓內(nèi)或圓上的多個(gè)交叉點(diǎn)；
[0034]4)將所述第三角度組與該多個(gè)交叉點(diǎn)所對(duì)應(yīng)的多個(gè)第二角度組對(duì)比以獲得機(jī)器人在所述坐標(biāo)系內(nèi)的位置。
[0035]優(yōu)選的，機(jī)器人上安裝有可測(cè)得其航行方向的電子羅盤，中央處理器在所述多個(gè)交叉點(diǎn)中選出位于機(jī)器人航行方向上的一部分交叉點(diǎn)，然后將所述第三角度組與該一部分交叉點(diǎn)所對(duì)應(yīng)的一部分第二角度組對(duì)比以獲得機(jī)器人所在坐標(biāo)系內(nèi)的位置。
[0036]與現(xiàn)有技術(shù)相比，本發(fā)明定位方法通過角度對(duì)比來實(shí)現(xiàn)機(jī)器人定位，無需過于復(fù)雜的計(jì)算程序，因此不但可實(shí)現(xiàn)快速定位，而且成本低廉。
【專利附圖】

【附圖說明】
[0037]圖1是本發(fā)明定位系統(tǒng)中移動(dòng)機(jī)器人的部分結(jié)構(gòu)示意圖。
[0038]圖2是本發(fā)明定位系統(tǒng)中移動(dòng)機(jī)器人的機(jī)頭朝向線與激光反射線的示意圖，其中
顯示了第一角度與第二角度。
[0039]圖3是本發(fā)明定位系統(tǒng)中工作區(qū)域被柵格化后的示意圖，其中顯示一交叉點(diǎn)所對(duì)應(yīng)的所有第三角度。
[0040]圖4是本發(fā)明定位系統(tǒng)中接收部接收多條激光反射線時(shí)的示意圖，其中顯示多個(gè)
第一角度。
[0041]圖5是本發(fā)明定位系統(tǒng)中接收部接收多條激光反射線時(shí)的示意圖，其中對(duì)圖4中的多個(gè)第一角度進(jìn)行運(yùn)算所得出相鄰兩條激光反射線之間的多個(gè)第二角度。
[0042]圖6是本發(fā)明定位系統(tǒng)中工作區(qū)域被柵格化后的示意圖，其中顯示移動(dòng)機(jī)器人位于任意一位置時(shí)所測(cè)得的所有第二角度。
[0043]圖7是本發(fā)明定位系統(tǒng)中移動(dòng)機(jī)器人位于任一位置時(shí)測(cè)得兩個(gè)連續(xù)的第三角度時(shí)的示意圖。
[0044]圖8是本發(fā)明定位系統(tǒng)中工作區(qū)域被柵格化后的示意圖，其中移動(dòng)機(jī)器人沿指定直線移動(dòng)。
【具體實(shí)施方式】
[0045]參圖1與圖2所示，本發(fā)明提供了一種移動(dòng)機(jī)器人定位系統(tǒng)，該定位系統(tǒng)位于一平面坐標(biāo)系內(nèi)，且包括若干已知坐標(biāo)值的反光件M、安裝于該轉(zhuǎn)臺(tái)T上的激光器J和角度編碼器B以及中央處理單元(未圖示)。在本實(shí)施方式中，所述移動(dòng)機(jī)器人R為一割草機(jī)器人，該割草機(jī)器人在草坪上工作，因此整個(gè)草坪為所述坐標(biāo)系所在平面。此外，本實(shí)施方式中共
設(shè)置10個(gè)反光件，分別為M1、M2......M10，這些反光件為插設(shè)于草坪上的具有光線直反功
能的桿狀路標(biāo)。
[0046]參圖1與圖2所示，所述轉(zhuǎn)臺(tái)T可相對(duì)機(jī)器人R機(jī)身進(jìn)行360°旋轉(zhuǎn)運(yùn)動(dòng)，該轉(zhuǎn)臺(tái)T上安裝有激光器J，該激光器J具有發(fā)射部Jl與接收部J2。所述發(fā)射部Jl向外發(fā)出激光發(fā)射線，由于轉(zhuǎn)臺(tái)T作旋轉(zhuǎn)運(yùn)動(dòng)，因此所述激光器J也隨轉(zhuǎn)臺(tái)T 一起進(jìn)行360°旋轉(zhuǎn)，當(dāng)該激光發(fā)射線照射至所述反光件M上后會(huì)被該反光件反射而形成激光反射線LI。由于所述反光件M具備光線直反功能，此處所謂的光線直反是指反射光與入射光是平行的且兩者之間間隔甚小而可被忽略，因此所述激光反射線LI將大致沿所述激光發(fā)射線原路返回至機(jī)器人R，返回的激光反射線LI將被所述接收部J2接收。
[0047]參圖1與圖2所示，所述轉(zhuǎn)臺(tái)T上還設(shè)有角度編碼器B，該角度編碼器B是用來測(cè)得機(jī)器人R的機(jī)頭朝向線L2與所述激光反射線LI之間的第一角度α，該第一角度α的大小是指機(jī)器人R的機(jī)頭朝向線L2沿指定方向旋轉(zhuǎn)至所述接收部J2接收到所述激光反射線LI所轉(zhuǎn)過的角度，在本實(shí)施方式中規(guī)定該指定方向?yàn)轫槙r(shí)針方向。此外，由于轉(zhuǎn)臺(tái)T的轉(zhuǎn)速很快，因此在同一時(shí)刻，發(fā)射部Jl可同時(shí)照射到多個(gè)連續(xù)的反光件，接收部J2則可收到多條激光反射線LI，從而角度編碼器B可同時(shí)測(cè)得多個(gè)第一角度α，中央處理單元可對(duì)多個(gè)第一角度α進(jìn)行運(yùn)算處理并獲得相鄰兩條激光放射線LI之間的第三角度β。
[0048]參圖1至圖3所示，本發(fā)明還提供一種移動(dòng)機(jī)器人R的定位方法，包括如下步驟:
[0049]I)將多個(gè)已知坐標(biāo)值的反光件M設(shè)置于機(jī)器人R所在坐標(biāo)系內(nèi)；
[0050]2)所述中央處理單元的圖形處理程序?qū)@些反光件M的連線包圍所形成的工作區(qū)域進(jìn)行柵格化并得出各交叉點(diǎn)的坐標(biāo)值；
[0051]3)所述中央處理單元計(jì)算出每一交叉點(diǎn)連接各個(gè)反光件M所形成的各條連接線L3之間的多個(gè)第二角度Θ，多個(gè)第二角度Θ組成與每一交叉點(diǎn)對(duì)應(yīng)的第二角度組，然后將每一第二角度組存儲(chǔ)起來；
[0052]4)機(jī)器人R在所述工作區(qū)域內(nèi)移動(dòng)時(shí)，所述接收部J2可同時(shí)接收到從多個(gè)反光件M反射回來的多條激光反射線LI，所述角度編碼器B對(duì)應(yīng)測(cè)得多個(gè)所述第一角度α ；
[0053]5)中央處理單元對(duì)這些第一角度α進(jìn)行運(yùn)算處理已獲得各條激光反射線LI之間的一個(gè)第三角度組；
[0054]6)中央處理單元將所述第三角度組與所述第二角度組進(jìn)行對(duì)比以獲得機(jī)器人在所述坐標(biāo)系內(nèi)的位置。
[0055]以下將主要描述如何獲得機(jī)器人R在坐標(biāo)系內(nèi)的位置的。圖3中的草坪上的工作區(qū)域已被柵格化，柵格的邊長越小，精度越高，因此可以根據(jù)需要設(shè)定合適的精度。工作區(qū)域被柵格化的同時(shí)可得出各交叉點(diǎn)的坐標(biāo)值，現(xiàn)已其中一個(gè)交叉點(diǎn)A為例，由于各反光件的坐標(biāo)值均已知，因此相鄰兩個(gè)反光件與交叉點(diǎn)A的兩條連接線L3之間的第二角度Θ可通過計(jì)算得出，本實(shí)施方式中共有10個(gè)反光件Ml、M2......M10，因此共有10個(gè)第二角度
θ2......θ1(1，這10個(gè)第二角度組成與交叉點(diǎn)A對(duì)應(yīng)的一個(gè)第二角度組，從而交叉點(diǎn)A
可以由這一個(gè)第二角度組表示為Α(θ P θ2......θ1(1)。通過同樣的方式可獲得其他交叉
點(diǎn)所對(duì)應(yīng)的各個(gè)第二角度組。待程序計(jì)算完畢后，中央處理單元將每一交叉點(diǎn)所對(duì)應(yīng)的每一個(gè)第二角度組置于存儲(chǔ)單元內(nèi)。以上步驟結(jié)束后，機(jī)器人R開始工作，結(jié)合圖4與圖5所示，機(jī)器人R在所述工作 區(qū)域內(nèi)移動(dòng)時(shí)，所述激光器J的發(fā)射部Jl時(shí)刻向外發(fā)出激光發(fā)射線，由于接收部J2在同一時(shí)刻可收到多條激光反射線LI，在此以接收部J2可接收到反光件Ml~Μ5反射回來的5條激光放射線LI為例，此時(shí)角度編碼器B可同時(shí)獲得與之對(duì)應(yīng)的5個(gè)第一角度a 1、α 2、α 3、α 4、α 5。所述中央處理單元對(duì)這些第一角度進(jìn)行運(yùn)算處理可計(jì)算出相鄰兩條激光反射線LI之間的四個(gè)第三角度，大小分別為α2-αι、α3-α2> α4_α3、
α5_α4。
[0056]參圖3與圖6所示，通過上述分析可知，當(dāng)接收部J2可同時(shí)接收到從所有反光件
Ml、M2......MlO上反射回來的激光反射線LI時(shí)，中央處理單元?jiǎng)t可同時(shí)運(yùn)算獲得與所述
交叉點(diǎn)的一組第二角度相對(duì)應(yīng)的10個(gè)第三角度β 1、β 2......β 1(|，這10個(gè)第三角度組成
與機(jī)器人R實(shí)時(shí)位置相對(duì)應(yīng)的一個(gè)第三角度組，從而機(jī)器人R的實(shí)時(shí)位置可由所測(cè)得的這
一個(gè)第三角度組表示為R(i^、β2......β1(ι)。中央處理單元通過將實(shí)時(shí)測(cè)得的一個(gè)第三
角度組與存儲(chǔ)單元內(nèi)的第二角度組進(jìn)行對(duì)比來獲得機(jī)器人R當(dāng)前在坐標(biāo)系內(nèi)的位置。
[0057]以下具體描述中央處理單元如何將所述第三角度β與第二角度Θ對(duì)比而獲得機(jī)
器人R的當(dāng)前位置的。當(dāng)中央處理單元運(yùn)算獲得一個(gè)第三角度組PpP2......β1(ι后，該
第三角度組與存儲(chǔ)的每個(gè)第二角度組相比大致有以下幾種情形:1)該第三角度組與存儲(chǔ)單元內(nèi)的一個(gè)第二角度組至少有兩個(gè)連續(xù)相等的角度值；2)該第三角度組與存儲(chǔ)單元內(nèi)的任意一個(gè)第二角度組均沒有相等的角度值；3)該第三角度組與存儲(chǔ)單元內(nèi)的多個(gè)第二角度組只有一個(gè)相等的角度值。
[0058]對(duì)于情形1，參圖7所示，假設(shè)測(cè)得的第三角度組......β1(1中的兩個(gè)連續(xù)
的第三角度PpP2與存儲(chǔ)單元中一個(gè)第二角度組Θ P θ 2......θ10中對(duì)應(yīng)的兩個(gè)連續(xù)的
第二角度θρ θ2相等，對(duì)于已知反光件Μ1、Μ2、Μ3的坐標(biāo)值以及夾角βρ β2的兩個(gè)三角形AM1M2R和AM2M3R，即可運(yùn)算得出唯一的機(jī)器人所在點(diǎn)R的坐標(biāo)值，因此在該情形下，機(jī)器人R當(dāng)前的位置即為該第二角度組θ” θ2......θ1(ι所對(duì)應(yīng)的交叉點(diǎn)的位置，機(jī)器人R當(dāng)前的坐標(biāo)值即為該交叉點(diǎn)的坐標(biāo)值，而其他角度值互不相等主要是因誤差而引起。
[0059]對(duì)于情形2，參圖3與圖6所示，中央處理器將存儲(chǔ)單元中每一個(gè)第二角度組里的
角度值與所測(cè)得的第三角度組PpP2......β K1里的角度值對(duì)應(yīng)相減，以交叉點(diǎn)A為例，相
減后得出一個(gè)第四角度組Q1-P1, θ2-β2......θ10-β1(ι，假設(shè)共有η個(gè)交叉點(diǎn)，則共有η
個(gè)第四角度組，中央處理單元將這η個(gè)第四角度組中的各個(gè)角度值對(duì)應(yīng)相比并選出具有最小絕對(duì)值的第四角度組，從選出的第四角度組中再選出具有所述最小絕對(duì)值最多的第四角度組，從而獲得與該第四角度組相對(duì)應(yīng)的第二角度組，該第二角度組所對(duì)應(yīng)的所述交叉點(diǎn)的位置就是機(jī)器人R在坐標(biāo)系內(nèi)最接近的位置。
[0060]對(duì)于情形3，假設(shè)存儲(chǔ)單元中共有m個(gè)第二角度組有與所測(cè)得的第三角度組僅有一個(gè)相同的角度值，中央處理單元首先將這m個(gè)第二角度組篩選出來，然后運(yùn)用情形2中相同的判斷方式來確定機(jī)器人當(dāng)前的位置，即通過角度相減將得出m個(gè)第五角度組，中央處理單元將這m個(gè)第五角度組中的各個(gè)角度值對(duì)應(yīng)相比并選出具有最小絕對(duì)值的第五角度組，從選出的第五角度組中再選出具有所述最小絕對(duì)值最多的第五角度組，從而獲得與該第五角度組相對(duì)應(yīng)的第二角度組，該第二角度組所對(duì)應(yīng)的所述交叉點(diǎn)的位置就是機(jī)器人R在坐標(biāo)系內(nèi)最接近的位置。
[0061]通過對(duì)以上3中情形的描述可知，發(fā)生情形I時(shí)，中央處理單元判斷并得出機(jī)器人位置的時(shí)間最短；發(fā)生情形2時(shí)，由于需要對(duì)每一交叉點(diǎn)進(jìn)行對(duì)比，因此判斷時(shí)間最長；情形3無需對(duì)比所有交叉點(diǎn)，因此判斷時(shí)間小于情形2。在實(shí)際測(cè)量過程中，尤其是柵格精度越小即柵格邊長越長時(shí)， 發(fā)生情形I的可能性就越小，而發(fā)生情形2和情形3的可能性最大。盡管發(fā)生情形2和情形3的可能性大，中央處理單元也無需每次都將測(cè)得的第三角度組與所述η個(gè)或m個(gè)第二角度組進(jìn)行對(duì)比，因?yàn)樵谕ǔＧ闆r下，機(jī)器人R是按指定線路移動(dòng)的，如圖8所示，機(jī)器人沿直線L4移動(dòng)。假設(shè)機(jī)器人移動(dòng)速度為0.3米/秒，中央處理器進(jìn)行角度對(duì)比的頻率為I次/秒，柵格邊長為0.1米，機(jī)器人R前一秒的位置為直線上的C點(diǎn)，根據(jù)機(jī)器人R的移動(dòng)速度可以認(rèn)為機(jī)器人R當(dāng)前的位置一定在以C點(diǎn)為圓心，0.3米為半徑的圓內(nèi)或圓上，此時(shí)中央處理單元只需將位于該圓內(nèi)及圓上的交叉點(diǎn)所對(duì)應(yīng)的若干第二角度組與所測(cè)得的第三角度組進(jìn)行對(duì)比，對(duì)比方法則與以上所描述三種情形相同。如此，中央處理單元只需對(duì)幾個(gè)交叉點(diǎn)進(jìn)行對(duì)比即可，從而可實(shí)現(xiàn)快速定位。中央處理單元需對(duì)比的交叉點(diǎn)還可以進(jìn)一步減少，如增加電子羅盤，當(dāng)測(cè)得機(jī)器人航行方向時(shí)，只需對(duì)比在航行方向上的交叉點(diǎn)，而未在航行方向上的就無需再作對(duì)比了。真正需要將測(cè)得的第三角度組與所述η個(gè)或m個(gè)第二角度組進(jìn)行對(duì)比的情況僅發(fā)生在機(jī)器人R的前一秒位置未知的情形，如操作員將機(jī)器人R搬至另一位置，使其重新開始工作。
[0062]本發(fā)明定位系統(tǒng)與定位方法通過角度對(duì)比來實(shí)現(xiàn)機(jī)器人定位，從而無需編寫過于復(fù)雜的計(jì)算處理程序，因此具有簡化程序和降低成本的功效；此外，由于實(shí)際運(yùn)作過程中，中央處理單元僅需對(duì)比較小范圍內(nèi)的交叉點(diǎn)，因此可實(shí)現(xiàn)機(jī)器人的快速定位。
[0063]以上是為便于本領(lǐng)域技術(shù)人員更容易理解本發(fā)明所進(jìn)行的最佳實(shí)施方式的描述，本發(fā)明定位系統(tǒng)與定位方法還有其他實(shí)施方式，如在以上實(shí)施方式中所述的第二角度Θ為所述各條連接線L3中相鄰兩條連接線之間的角度，所述第三角度β為所述各激光反射線LI中相鄰兩條激光反射線之間的角度。第二角度也可以是其中一條連接線與其他各條連接線之間的角度，第三角度也可以是其中一條激光反射線與其他各條激光反射線之間的角度，角度對(duì)比方法相同，同樣可實(shí)現(xiàn)機(jī)器人定位。因此，只要是在本發(fā)明設(shè)計(jì)理念指導(dǎo)下采用等同或等效變換方式所獲得的技術(shù)方案都應(yīng)在本發(fā)明的保護(hù)范圍之內(nèi)。
【權(quán)利要求】
1.一種移動(dòng)機(jī)器人的定位系統(tǒng)，該定位系統(tǒng)設(shè)于一坐標(biāo)系內(nèi)，且該定位系統(tǒng)包括若干已知坐標(biāo)值的反光件、安裝于機(jī)器人上可360°旋轉(zhuǎn)的轉(zhuǎn)臺(tái)、激光器、角度編碼器及中央處理單元，所述激光器與角度編碼器安裝于所述轉(zhuǎn)臺(tái)上；所述相鄰反光件之間的連線包圍形成機(jī)器人的工作區(qū)域；所述激光器具有發(fā)射部與接收部，該發(fā)射部發(fā)出激光發(fā)射線至所述反光件后經(jīng)反射形成的激光反射線被所述接收部接收，且所述反光件具備使該激光反射線平行于激光發(fā)射線的光線直反功能；所述角度編碼器用于測(cè)得機(jī)器人的機(jī)頭朝向線與所述激光反射線之間的第一角度；其特征在于:所述中央處理單元包括圖形處理程序，該圖形處理程序?qū)λ龉ぷ鲄^(qū)域進(jìn)行柵格化并得出各交叉點(diǎn)的坐標(biāo)值，中央處理單元計(jì)算出每一交叉點(diǎn)連接各個(gè)反光件所形成的各條連接線之間的多個(gè)第二角度，該多個(gè)第二角度組成與每一交叉點(diǎn)對(duì)應(yīng)的第二角度組，然后將每一第二角度組存儲(chǔ)起來；機(jī)器人在所述工作區(qū)域內(nèi)移動(dòng)時(shí)，所述接收部可同時(shí)接收到從多個(gè)反光件反射回來的激光反射線，所述角度編碼器可對(duì)應(yīng)測(cè)得多個(gè)所述第一角度，中央處理單元對(duì)所述多個(gè)第一角度進(jìn)行運(yùn)算處理以獲得各條激光反射線之間的一個(gè)第三角度組，然后將所述第三角度組與所述第二角度組進(jìn)行對(duì)比以獲得機(jī)器人在所述坐標(biāo)系內(nèi)的位置。
2.如權(quán)利要求1所述的定位系統(tǒng)，其特征在于:當(dāng)所述第三角度組與存儲(chǔ)的一個(gè)第二角度組中有至少兩個(gè)連續(xù)相等的角度值時(shí)，機(jī)器人的坐標(biāo)值即為該第二角度組對(duì)應(yīng)的交叉點(diǎn)的坐標(biāo)值。
3.如權(quán)利要求2所述的定位系統(tǒng)，其特征在于:當(dāng)所述第三角度組與存儲(chǔ)的任意一個(gè)第二角度組中僅有一個(gè)相等的角度值或沒有相等的角度值時(shí)，中央處理單元將尋找到與該第三角度組的各角度值最接近的另一個(gè)第二角度組，機(jī)器人在所述坐標(biāo)系內(nèi)的位置最接近該另一個(gè)第二角度組所對(duì)應(yīng)的交叉點(diǎn)。
4.如權(quán)利要求3所述的定位系統(tǒng)，其特征在于:所述第二角度為所述各條連接線中相鄰兩條連接線之間的角度，所述第三角度為所述各激光反射線中相鄰兩條激光反射線之間的角度。
5.如權(quán)利要求3所述的定位系統(tǒng)，其特征在于:所述第二角度為其中一條連接線與其他各條連接線之間的角度，所·述第三角度為其中一條激光反射線與其他各條激光反射線之間的角度。
6.如權(quán)利要求1至5項(xiàng)中任一項(xiàng)所述的定位系統(tǒng)，其特征在于:所述移動(dòng)機(jī)器人為割草機(jī)器人。
7.如權(quán)利要求6所述的定位系統(tǒng)，其特征在于:所述定位系統(tǒng)還包括設(shè)于機(jī)器人上的電子羅盤。
8.一種移動(dòng)機(jī)器人的定位方法，該機(jī)器人上安裝有可360°旋轉(zhuǎn)的轉(zhuǎn)臺(tái)、具有發(fā)射部與接收部的激光器、角度編碼器以及中央處理單元，所述激光器與角度編碼器設(shè)于所述轉(zhuǎn)臺(tái)上，其特征在于:所述定位方法包括如下步驟: 1)將多個(gè)已知坐標(biāo)值的反光件設(shè)置于機(jī)器人所在坐標(biāo)系內(nèi)； 2)所述中央處理單元的圖形處理程序?qū)@些反光件的連線包圍所形成的工作區(qū)域進(jìn)行柵格化并得出各交叉點(diǎn)的坐標(biāo)值； 3)所述中央處理單元計(jì)算出每一交叉點(diǎn)連接各個(gè)反光件所形成的各條連接線之間的多個(gè)第二角度，該多個(gè)第二角度組成與每一交叉點(diǎn)對(duì)應(yīng)的第二角度組，然后將每一第二角度組存儲(chǔ)起來； 4)機(jī)器人在所述工作區(qū)域內(nèi)移動(dòng)時(shí)，所述發(fā)射部發(fā)出激光發(fā)射線至所述反光件后經(jīng)反射形成的激光反射線被所述接收部接收，所述反光件具備使該激光反射線平行于激光發(fā)射線的光線直反功能，且所述接收部可同時(shí)接收到從多個(gè)反光件反射回來的多條激光反射線，所述角度編碼器對(duì)應(yīng)測(cè)得機(jī)器人的機(jī)頭朝向線與所述多條激光反射線之間的多個(gè)第一角度； 5)中央處理單元對(duì)所述多個(gè)第一角度進(jìn)行運(yùn)算處理以獲得各條激光反射線之間的一個(gè)第三角度組； 6)中央處理單元將所述第三角度組與所述第二角度組進(jìn)行對(duì)比以獲得機(jī)器人在所述坐標(biāo)系內(nèi)的位置。
9.如權(quán)利要求8所述的定位方法，其特征在于:當(dāng)中央處理單元在存儲(chǔ)的各個(gè)第二角度組中查找到一個(gè)第二角度組，且該第二角度組與所述第三角度組有至少兩個(gè)連續(xù)相等的角度值時(shí)，中央處理單元就判斷機(jī)器人所在位置為該第二角度組所對(duì)應(yīng)的所述交叉點(diǎn)的位置。
10.如權(quán)利要求8所述的定位方法，其特征在于:當(dāng)中央處理單元未查找到與所述第三角度具有相等角度值的第二角度組時(shí)，中央處理單元判斷機(jī)器人所在位置的步驟如下: 1)將所述第三角度組與存儲(chǔ)的每一第二角度組內(nèi)的各個(gè)角度值對(duì)應(yīng)相減，并得出數(shù)量與第二角度組的數(shù)量相等的一系列第四角度組； 2)將該一系列第四角度組中的各個(gè)角度值對(duì)應(yīng)相比并選出具有最小絕對(duì)值的第四角度組； 3)從選出的第四角度組中選出具有所述最小絕對(duì)值最多的第四角度組，從而獲得與該第四角度組相對(duì)應(yīng)的第二角度組； 4)中央處理單元判斷機(jī)器人所在位置最靠近步驟3中的第二角度組所對(duì)應(yīng)的所述交叉點(diǎn)的位置。
11.如權(quán)利要求8所述的定位方法，其特征在于:當(dāng)中央處理單元從存儲(chǔ)的各個(gè)第二角度組中查找到多個(gè)第二角度組，且該多個(gè)第二角度組與所述第三角度組僅有一個(gè)相等的角度值時(shí)，中央處理單元判斷機(jī)器人所在位置的步驟如下: 1)將所述多個(gè)第二角度組從存儲(chǔ)的各個(gè)第二角度組篩選出來； 2)將所述第三角度組與該多個(gè)第二角度組內(nèi)的各個(gè)角度值對(duì)應(yīng)相減，并得出多個(gè)第五角度組； 3)將該多個(gè)第五角度組中的各個(gè)角度值對(duì)應(yīng)相比并選出具有最小絕對(duì)值的第五角度組； 4)從選出的第五角度組中選出具有所述最小絕對(duì)值最多的第五角度組，從而獲得與該第五角度組相對(duì)應(yīng)的第二角度組； 5)中央處理單元判斷機(jī)器人所在位置最靠近步驟4中的第二角度組所對(duì)應(yīng)的所述交叉點(diǎn)的位置。
12.如權(quán)利要求8所述的定位方法，其特征在于:當(dāng)機(jī)器人按照中央處理單元設(shè)定的指定線路移動(dòng)時(shí)，中央處理單元按一定頻率對(duì)所述第二、第三角度組進(jìn)行角度對(duì)比，所述機(jī)器人按一定速度沿所述指定線路移動(dòng)，中央處理單元判斷機(jī)器人所在位置的步驟如下:1)存儲(chǔ)中央處理單元在前一次進(jìn)行角度對(duì)比時(shí)機(jī)器人在所述坐標(biāo)系內(nèi)的前一時(shí)刻位置； 2)以前一時(shí)刻位置為圓心，所述頻率與速度的乘積為半徑所形成的圓確定為角度對(duì)比的范圍； 3)選出位于所述圓內(nèi)或圓上的多個(gè)交叉點(diǎn)； 4)將所述第三角度組與該多個(gè)交叉點(diǎn)所對(duì)應(yīng)的多個(gè)第二角度組對(duì)比以獲得機(jī)器人在所述坐標(biāo)系內(nèi)的位置。
13.如權(quán)利要求12所述的定位方法，其特征在于:機(jī)器人上安裝有可測(cè)得其航行方向的電子羅盤，中央處理器在所述多個(gè)交叉點(diǎn)中選出位于機(jī)器人航行方向上的一部分交叉點(diǎn)，然后將所述第三角度組與該一部分交叉點(diǎn)所對(duì)應(yīng)的一部分第二角度組對(duì)比以獲得機(jī)器人所在坐標(biāo)系內(nèi)的位置?！?br> 【文檔編號(hào)】G01C21/00GK103542846SQ201210245557
【公開日】2014年1月29日 申請(qǐng)日期:2012年7月16日 優(yōu)先權(quán)日:2012年7月16日
【發(fā)明者】孔釗, 宋強(qiáng), 姜飛 申請(qǐng)人:蘇州科瓴精密機(jī)械科技有限公司