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

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

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

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