一種移動機器人的定位系統及其定位方法
【專利摘要】一種移動機器人的定位系統，包括若干已知反光件(M)、轉臺(T)、激光器(J)、角度編碼器(B)及中央處理單元；所述相鄰反光件之間的連線包圍形成機器人的工作區域；所述激光器具有發射部(J1)與接收部(J2)；中央處理單元包括對所述工作區域進行柵格化的圖形處理程序，中央處理單元計算出每一交叉點連接各個反光件所形成的各條連接線(L3)之間的多個第二角度，該多個第二角度組成與每一交叉點對應的第二角度組；所述接收部可同時接收到從多個反光件反射回來的激光反射線(L1)，中央處理單元通過運算處理獲得各條激光反射線之間的一個第三角度組，然后將所述第三角度組與所述第二角度組進行對比以獲得機器人在所述坐標系內的位置。
【專利說明】一種移動機器人的定位系統及其定位方法
【技術領域】
[0001]本發明屬于一種機器人的定位【技術領域】，尤其涉及一種移動機器人的定位系統與定位方法。
【背景技術】
[0002]在移動機器人的應用中，導航是指移動機器人通過傳感器感知環境和自身狀態，實現在有障礙物的環境中面向目標自主運動。導航的成功需要有四個模塊:感知，定位，認知，運動控制。其中，定位是移動機器人導航最基本的環節，所謂定位就是確定機器人在環境中的實時位姿。當前應用較多的定位技術有:視覺導航定位、全球定位系統(GPS,GlobalPositioning System)、差分GPS定位、超聲波定位等。其中,視覺導航定位方式的圖像處理計算量大，計算速度要求高，因而實時性差，此外，該種定位方式受外界環境的影響較大，因此不太適用于戶外移動機器人的定位系統。全球定位系統是由美國國防部控制的，對非美國國防部授權的用戶，其所能獲得的定位導航精度較低，因此不適于定位精度較高的場合。差分GPS定位，是指用戶GPS接收機附近設置一個已知精度坐標的差分基準站，基準站的接收機連續接收GPS導航信號，將測得的位置或距離數據與已知的位置、距離數據進行比較，確定誤差，得出準確改正值，然后將這些改正數據通過數據鏈發播給覆蓋區域內的用戶，用以改正用戶的定位結果，這種定位方法雖然定位精度高，但成本也很高。對于超聲波定位方式，由于超聲波在空氣中衰減很大，因此只適用空間范圍較小的場合。針對上述各種定位技術存在的缺陷，有必要提出一種改進的移動機器人定位系統以解決上述問題。
【發明內容】
[0003]本發明的目的在于提供一種移動機器人通過角度對比來實現定位的定位系統與定位方法。
[0004]為了實現上述目的，本發明采用如下技術方案:一種移動機器人的定位系統，該定位系統設于一坐標系內，且該定位系統包括若干已知坐標值的反光件、安裝于機器人上可360°旋轉的轉臺、激光器、角度編碼器及中央處理單元，所述激光器與角度編碼器安裝于所述轉臺上；所述相鄰反光件之間的連線包圍形成機器人的工作區域；所述激光器具有發射部與接收部，該發射部發出激光發射線至所述反光件后經反射形成的激光反射線被所述接收部接收，且所述反光件具備使該激光反射線平行于激光發射線的光線直反功能；所述角度編碼器用于測得機器人的機頭朝向線與所述激光反射線之間的第一角度；所述中央處理單元包括圖形處理程序，該圖形處理程序對所述工作區域進行柵格化并得出各交叉點的坐標值，中央處理單元計算出每一交叉點連接各個反光件所形成的各條連接線之間的多個第二角度，該多個第二角度組成與每一交叉點對應的第二角度組，然后將每一第二角度組存儲起來；機器人在所述工作區域內移動時，所述接收部可同時接收到從多個反光件反射回來的激光反射線，所述角度編碼器可對應測得多個所述第一角度，中央處理單元對這些第一角度進行運算處理以獲得各條激光反射線之間的一個第三角度組，然后將所述第三角度與所述第二角度進行對比以獲得機器人在所述坐標系內的位置。。
[0005]優選的，當所述第三角度組與存儲的一個第二角度組中有至少兩個連續相等的角度值時，機器人的坐標值即為該第二角度組對應的交叉點的坐標值。。
[0006]優選的，當所述第三角度組與存儲的任意一個第二角度組中僅有一個相等的角度值或沒有相等的角度值時，中央處理單元將尋找到與該第三角度組的各角度值最接近的另一個第二角度組，機器人在所述坐標系內的位置最接近該另一個第二角度組所對應的交叉點。
[0007]優選的，所述第二角度為所述各條連接線中相鄰兩條連接線之間的角度，所述第三角度為所述各激光反射線中相鄰兩條激光反射線之間的角度。
[0008]優選的，所述第二角度為其中一條連接線與其他各條連接線之間的角度，所述第三角度為其中一條激光反射線與其他各條激光反射線之間的角度。
[0009]優選的，所述移動機器人為割草機器人。
[0010]優選的，所述定位系統還包括設于機器人上的電子羅盤。
[0011]為了實現上述目的，本發明還可以采用如下技術方案:一種移動機器人的定位方法，該機器人上安裝有可360°旋轉的轉臺、具有發射部與接收部的激光器、角度編碼器以及中央處理單元，所述激光器與角度編碼器設于所述轉臺上，所述定位方法包括如下步驟:
[0012]I)將多個已知坐標值的反光件設置于機器人所在坐標系內；
[0013]2)所述中央處理單元的圖形處理程序對這些反光件的連線包圍所形成的工作區域進行柵格化并得出各交叉點的坐標值；
[0014]3)所述中央處理單元計算出每一交叉點連接各個反光件所形成的各條連接線之間的多個第二角度，多個第二角度組成與每一交叉點對應的第二角度組，然后將每一第二角度組存儲起來；
[0015]4)機器人在所述工作區域內移動時，所述發射部發出激光發射線至所述反光件后經反射形成的激光反射線被所述接收部接收，所述反光件具備使該激光反射線平行于激光發射線的光線直反功能，且所述接收部可同時接收到從多個反光件反射回來的多條激光反射線，所述角度編碼器對應測得機器人的機頭朝向線與所述多條激光反射線之間的多個第一角度；
[0016]5)中央處理單元對這些第一角度進行運算處理以獲得各條激光反射線之間的一個第三角度組；
[0017]6)中央處理單元將所述第三角度組與所述第二角度組進行對比以獲得機器人在所述坐標系內的位置。
[0018]優選的，當中央處理單元在存儲的各個第二角度組中查找到一個第二角度組，且該第二角度組與所述第三角度組有至少兩個連續相等的角度值時，中央處理單元就判斷機器人所在位置為該第二角度組所對應的所述交叉點的位置。
[0019]優選的，當中央處理單元未查找到與所述第三角度具有相等角度值的第二角度組時，中央處理單元判斷機器人所在位置的步驟如下:
[0020]I)將所述第三角度組與存儲的每一第二角度組內的各個角度值對應相減，并得出數量與第二角度組的數量相等的一系列第四角度組；[0021]2)將該一系列第四角度組中的各個角度值對應相比并選出具有最小絕對值的第四角度組；
[0022]3)從選出的第四角度組中選出具有所述最小絕對值最多的第四角度組，從而獲得與該第四角度組相對應的第二角度組；
[0023]4)中央處理單元判斷機器人所在位置最靠近步驟3中的第二角度組所對應的所述交叉點的位置。
[0024]優選的，當中央處理單元從存儲的各個第二角度組中查找到多個第二角度組，且該多個第二角度組與所述第三角度組僅有一個相等的角度值時，中央處理單元判斷機器人所在位置的步驟如下:
[0025]I)將所述多個第二角度組從存儲的各個第二角度組篩選出來；
[0026]2)將所述第三角度組與該多個第二角度組內的各個角度值對應相減，并得出多個第五角度組；
[0027]3)將該多個第五角度組中的各個角度值對應相比并選出具有最小絕對值的第五角度組；
[0028]4)從選出的第五角度組中選出具有所述最小絕對值最多的第五角度組，從而獲得與該第五角度組相對應的第二角度組；
[0029]5)中央處理單元判斷機器人所在位置最靠近步驟4中的第二角度組所對應的所述交叉點的位置。
[0030]優選的，當機器人按照中央處理單元設定的指定線路移動時，中央處理單元按一定頻率對所述第二、第三角度組進行角度對比，所述機器人按一定速度沿所述指定線路移動，中央處理單元判斷機器人所在位置的步驟如下:
[0031]I)存儲中央處理單元在前一次進行角度對比時機器人在所述坐標系內的前一時刻位置；
[0032]2)以前一時刻位置為圓心，所述頻率與速度的乘積為半徑所形成的圓確定為角度對比的范圍；
[0033]3)選出位于該圓內或圓上的多個交叉點；
[0034]4)將所述第三角度組與該多個交叉點所對應的多個第二角度組對比以獲得機器人在所述坐標系內的位置。
[0035]優選的，機器人上安裝有可測得其航行方向的電子羅盤，中央處理器在所述多個交叉點中選出位于機器人航行方向上的一部分交叉點，然后將所述第三角度組與該一部分交叉點所對應的一部分第二角度組對比以獲得機器人所在坐標系內的位置。
[0036]與現有技術相比，本發明定位方法通過角度對比來實現機器人定位，無需過于復雜的計算程序，因此不但可實現快速定位，而且成本低廉。
【專利附圖】
【附圖說明】
[0037]圖1是本發明定位系統中移動機器人的部分結構示意圖。
[0038]圖2是本發明定位系統中移動機器人的機頭朝向線與激光反射線的示意圖，其中
顯示了第一角度與第二角度。
[0039]圖3是本發明定位系統中工作區域被柵格化后的示意圖，其中顯示一交叉點所對應的所有第三角度。
[0040]圖4是本發明定位系統中接收部接收多條激光反射線時的示意圖，其中顯示多個
第一角度。
[0041]圖5是本發明定位系統中接收部接收多條激光反射線時的示意圖，其中對圖4中的多個第一角度進行運算所得出相鄰兩條激光反射線之間的多個第二角度。
[0042]圖6是本發明定位系統中工作區域被柵格化后的示意圖，其中顯示移動機器人位于任意一位置時所測得的所有第二角度。
[0043]圖7是本發明定位系統中移動機器人位于任一位置時測得兩個連續的第三角度時的示意圖。
[0044]圖8是本發明定位系統中工作區域被柵格化后的示意圖，其中移動機器人沿指定直線移動。
【具體實施方式】
[0045]參圖1與圖2所示，本發明提供了一種移動機器人定位系統，該定位系統位于一平面坐標系內，且包括若干已知坐標值的反光件M、安裝于該轉臺T上的激光器J和角度編碼器B以及中央處理單元(未圖示)。在本實施方式中，所述移動機器人R為一割草機器人，該割草機器人在草坪上工作，因此整個草坪為所述坐標系所在平面。此外，本實施方式中共
設置10個反光件，分別為M1、M2......M10，這些反光件為插設于草坪上的具有光線直反功
能的桿狀路標。
[0046]參圖1與圖2所示，所述轉臺T可相對機器人R機身進行360°旋轉運動，該轉臺T上安裝有激光器J，該激光器J具有發射部Jl與接收部J2。所述發射部Jl向外發出激光發射線，由于轉臺T作旋轉運動，因此所述激光器J也隨轉臺T 一起進行360°旋轉，當該激光發射線照射至所述反光件M上后會被該反光件反射而形成激光反射線LI。由于所述反光件M具備光線直反功能，此處所謂的光線直反是指反射光與入射光是平行的且兩者之間間隔甚小而可被忽略，因此所述激光反射線LI將大致沿所述激光發射線原路返回至機器人R，返回的激光反射線LI將被所述接收部J2接收。
[0047]參圖1與圖2所示，所述轉臺T上還設有角度編碼器B，該角度編碼器B是用來測得機器人R的機頭朝向線L2與所述激光反射線LI之間的第一角度α，該第一角度α的大小是指機器人R的機頭朝向線L2沿指定方向旋轉至所述接收部J2接收到所述激光反射線LI所轉過的角度，在本實施方式中規定該指定方向為順時針方向。此外，由于轉臺T的轉速很快，因此在同一時刻，發射部Jl可同時照射到多個連續的反光件，接收部J2則可收到多條激光反射線LI，從而角度編碼器B可同時測得多個第一角度α，中央處理單元可對多個第一角度α進行運算處理并獲得相鄰兩條激光放射線LI之間的第三角度β。
[0048]參圖1至圖3所示，本發明還提供一種移動機器人R的定位方法，包括如下步驟:
[0049]I)將多個已知坐標值的反光件M設置于機器人R所在坐標系內；
[0050]2)所述中央處理單元的圖形處理程序對這些反光件M的連線包圍所形成的工作區域進行柵格化并得出各交叉點的坐標值；
[0051]3)所述中央處理單元計算出每一交叉點連接各個反光件M所形成的各條連接線L3之間的多個第二角度Θ，多個第二角度Θ組成與每一交叉點對應的第二角度組，然后將每一第二角度組存儲起來；
[0052]4)機器人R在所述工作區域內移動時，所述接收部J2可同時接收到從多個反光件M反射回來的多條激光反射線LI，所述角度編碼器B對應測得多個所述第一角度α ；
[0053]5)中央處理單元對這些第一角度α進行運算處理已獲得各條激光反射線LI之間的一個第三角度組；
[0054]6)中央處理單元將所述第三角度組與所述第二角度組進行對比以獲得機器人在所述坐標系內的位置。
[0055]以下將主要描述如何獲得機器人R在坐標系內的位置的。圖3中的草坪上的工作區域已被柵格化，柵格的邊長越小，精度越高，因此可以根據需要設定合適的精度。工作區域被柵格化的同時可得出各交叉點的坐標值，現已其中一個交叉點A為例，由于各反光件的坐標值均已知，因此相鄰兩個反光件與交叉點A的兩條連接線L3之間的第二角度Θ可通過計算得出，本實施方式中共有10個反光件Ml、M2......M10，因此共有10個第二角度
θ2......θ1(1，這10個第二角度組成與交叉點A對應的一個第二角度組，從而交叉點A
可以由這一個第二角度組表示為Α(θ P θ2......θ1(1)。通過同樣的方式可獲得其他交叉
點所對應的各個第二角度組。待程序計算完畢后，中央處理單元將每一交叉點所對應的每一個第二角度組置于存儲單元內。以上步驟結束后，機器人R開始工作，結合圖4與圖5所示，機器人R在所述工作 區域內移動時，所述激光器J的發射部Jl時刻向外發出激光發射線，由于接收部J2在同一時刻可收到多條激光反射線LI，在此以接收部J2可接收到反光件Ml~Μ5反射回來的5條激光放射線LI為例，此時角度編碼器B可同時獲得與之對應的5個第一角度a 1、α 2、α 3、α 4、α 5。所述中央處理單元對這些第一角度進行運算處理可計算出相鄰兩條激光反射線LI之間的四個第三角度，大小分別為α2-αι、α3-α2> α4_α3、
α5_α4。
[0056]參圖3與圖6所示，通過上述分析可知，當接收部J2可同時接收到從所有反光件
Ml、M2......MlO上反射回來的激光反射線LI時，中央處理單元則可同時運算獲得與所述
交叉點的一組第二角度相對應的10個第三角度β 1、β 2......β 1(|，這10個第三角度組成
與機器人R實時位置相對應的一個第三角度組，從而機器人R的實時位置可由所測得的這
一個第三角度組表示為R(i^、β2......β1(ι)。中央處理單元通過將實時測得的一個第三
角度組與存儲單元內的第二角度組進行對比來獲得機器人R當前在坐標系內的位置。
[0057]以下具體描述中央處理單元如何將所述第三角度β與第二角度Θ對比而獲得機
器人R的當前位置的。當中央處理單元運算獲得一個第三角度組PpP2......β1(ι后，該
第三角度組與存儲的每個第二角度組相比大致有以下幾種情形:1)該第三角度組與存儲單元內的一個第二角度組至少有兩個連續相等的角度值；2)該第三角度組與存儲單元內的任意一個第二角度組均沒有相等的角度值；3)該第三角度組與存儲單元內的多個第二角度組只有一個相等的角度值。
[0058]對于情形1，參圖7所示，假設測得的第三角度組......β1(1中的兩個連續
的第三角度PpP2與存儲單元中一個第二角度組Θ P θ 2......θ10中對應的兩個連續的
第二角度θρ θ2相等，對于已知反光件Μ1、Μ2、Μ3的坐標值以及夾角βρ β2的兩個三角形AM1M2R和AM2M3R，即可運算得出唯一的機器人所在點R的坐標值，因此在該情形下，機器人R當前的位置即為該第二角度組θ” θ2......θ1(ι所對應的交叉點的位置，機器人R當前的坐標值即為該交叉點的坐標值，而其他角度值互不相等主要是因誤差而引起。
[0059]對于情形2，參圖3與圖6所示，中央處理器將存儲單元中每一個第二角度組里的
角度值與所測得的第三角度組PpP2......β K1里的角度值對應相減，以交叉點A為例，相
減后得出一個第四角度組Q1-P1, θ2-β2......θ10-β1(ι，假設共有η個交叉點，則共有η
個第四角度組，中央處理單元將這η個第四角度組中的各個角度值對應相比并選出具有最小絕對值的第四角度組，從選出的第四角度組中再選出具有所述最小絕對值最多的第四角度組，從而獲得與該第四角度組相對應的第二角度組，該第二角度組所對應的所述交叉點的位置就是機器人R在坐標系內最接近的位置。
[0060]對于情形3，假設存儲單元中共有m個第二角度組有與所測得的第三角度組僅有一個相同的角度值，中央處理單元首先將這m個第二角度組篩選出來，然后運用情形2中相同的判斷方式來確定機器人當前的位置，即通過角度相減將得出m個第五角度組，中央處理單元將這m個第五角度組中的各個角度值對應相比并選出具有最小絕對值的第五角度組，從選出的第五角度組中再選出具有所述最小絕對值最多的第五角度組，從而獲得與該第五角度組相對應的第二角度組，該第二角度組所對應的所述交叉點的位置就是機器人R在坐標系內最接近的位置。
[0061]通過對以上3中情形的描述可知，發生情形I時，中央處理單元判斷并得出機器人位置的時間最短；發生情形2時，由于需要對每一交叉點進行對比，因此判斷時間最長；情形3無需對比所有交叉點，因此判斷時間小于情形2。在實際測量過程中，尤其是柵格精度越小即柵格邊長越長時， 發生情形I的可能性就越小，而發生情形2和情形3的可能性最大。盡管發生情形2和情形3的可能性大，中央處理單元也無需每次都將測得的第三角度組與所述η個或m個第二角度組進行對比，因為在通常情況下，機器人R是按指定線路移動的，如圖8所示，機器人沿直線L4移動。假設機器人移動速度為0.3米/秒，中央處理器進行角度對比的頻率為I次/秒，柵格邊長為0.1米，機器人R前一秒的位置為直線上的C點，根據機器人R的移動速度可以認為機器人R當前的位置一定在以C點為圓心，0.3米為半徑的圓內或圓上，此時中央處理單元只需將位于該圓內及圓上的交叉點所對應的若干第二角度組與所測得的第三角度組進行對比，對比方法則與以上所描述三種情形相同。如此，中央處理單元只需對幾個交叉點進行對比即可，從而可實現快速定位。中央處理單元需對比的交叉點還可以進一步減少，如增加電子羅盤，當測得機器人航行方向時，只需對比在航行方向上的交叉點，而未在航行方向上的就無需再作對比了。真正需要將測得的第三角度組與所述η個或m個第二角度組進行對比的情況僅發生在機器人R的前一秒位置未知的情形，如操作員將機器人R搬至另一位置，使其重新開始工作。
[0062]本發明定位系統與定位方法通過角度對比來實現機器人定位，從而無需編寫過于復雜的計算處理程序，因此具有簡化程序和降低成本的功效；此外，由于實際運作過程中，中央處理單元僅需對比較小范圍內的交叉點，因此可實現機器人的快速定位。
[0063]以上是為便于本領域技術人員更容易理解本發明所進行的最佳實施方式的描述，本發明定位系統與定位方法還有其他實施方式，如在以上實施方式中所述的第二角度Θ為所述各條連接線L3中相鄰兩條連接線之間的角度，所述第三角度β為所述各激光反射線LI中相鄰兩條激光反射線之間的角度。第二角度也可以是其中一條連接線與其他各條連接線之間的角度，第三角度也可以是其中一條激光反射線與其他各條激光反射線之間的角度，角度對比方法相同，同樣可實現機器人定位。因此，只要是在本發明設計理念指導下采用等同或等效變換方式所獲得的技術方案都應在本發明的保護范圍之內。
【權利要求】
1.一種移動機器人的定位系統，該定位系統設于一坐標系內，且該定位系統包括若干已知坐標值的反光件、安裝于機器人上可360°旋轉的轉臺、激光器、角度編碼器及中央處理單元，所述激光器與角度編碼器安裝于所述轉臺上；所述相鄰反光件之間的連線包圍形成機器人的工作區域；所述激光器具有發射部與接收部，該發射部發出激光發射線至所述反光件后經反射形成的激光反射線被所述接收部接收，且所述反光件具備使該激光反射線平行于激光發射線的光線直反功能；所述角度編碼器用于測得機器人的機頭朝向線與所述激光反射線之間的第一角度；其特征在于:所述中央處理單元包括圖形處理程序，該圖形處理程序對所述工作區域進行柵格化并得出各交叉點的坐標值，中央處理單元計算出每一交叉點連接各個反光件所形成的各條連接線之間的多個第二角度，該多個第二角度組成與每一交叉點對應的第二角度組，然后將每一第二角度組存儲起來；機器人在所述工作區域內移動時，所述接收部可同時接收到從多個反光件反射回來的激光反射線，所述角度編碼器可對應測得多個所述第一角度，中央處理單元對所述多個第一角度進行運算處理以獲得各條激光反射線之間的一個第三角度組，然后將所述第三角度組與所述第二角度組進行對比以獲得機器人在所述坐標系內的位置。
2.如權利要求1所述的定位系統，其特征在于:當所述第三角度組與存儲的一個第二角度組中有至少兩個連續相等的角度值時，機器人的坐標值即為該第二角度組對應的交叉點的坐標值。
3.如權利要求2所述的定位系統，其特征在于:當所述第三角度組與存儲的任意一個第二角度組中僅有一個相等的角度值或沒有相等的角度值時，中央處理單元將尋找到與該第三角度組的各角度值最接近的另一個第二角度組，機器人在所述坐標系內的位置最接近該另一個第二角度組所對應的交叉點。
4.如權利要求3所述的定位系統，其特征在于:所述第二角度為所述各條連接線中相鄰兩條連接線之間的角度，所述第三角度為所述各激光反射線中相鄰兩條激光反射線之間的角度。
5.如權利要求3所述的定位系統，其特征在于:所述第二角度為其中一條連接線與其他各條連接線之間的角度，所·述第三角度為其中一條激光反射線與其他各條激光反射線之間的角度。
6.如權利要求1至5項中任一項所述的定位系統，其特征在于:所述移動機器人為割草機器人。
7.如權利要求6所述的定位系統，其特征在于:所述定位系統還包括設于機器人上的電子羅盤。
8.一種移動機器人的定位方法，該機器人上安裝有可360°旋轉的轉臺、具有發射部與接收部的激光器、角度編碼器以及中央處理單元，所述激光器與角度編碼器設于所述轉臺上，其特征在于:所述定位方法包括如下步驟: 1)將多個已知坐標值的反光件設置于機器人所在坐標系內； 2)所述中央處理單元的圖形處理程序對這些反光件的連線包圍所形成的工作區域進行柵格化并得出各交叉點的坐標值； 3)所述中央處理單元計算出每一交叉點連接各個反光件所形成的各條連接線之間的多個第二角度，該多個第二角度組成與每一交叉點對應的第二角度組，然后將每一第二角度組存儲起來； 4)機器人在所述工作區域內移動時，所述發射部發出激光發射線至所述反光件后經反射形成的激光反射線被所述接收部接收，所述反光件具備使該激光反射線平行于激光發射線的光線直反功能，且所述接收部可同時接收到從多個反光件反射回來的多條激光反射線，所述角度編碼器對應測得機器人的機頭朝向線與所述多條激光反射線之間的多個第一角度； 5)中央處理單元對所述多個第一角度進行運算處理以獲得各條激光反射線之間的一個第三角度組； 6)中央處理單元將所述第三角度組與所述第二角度組進行對比以獲得機器人在所述坐標系內的位置。
9.如權利要求8所述的定位方法，其特征在于:當中央處理單元在存儲的各個第二角度組中查找到一個第二角度組，且該第二角度組與所述第三角度組有至少兩個連續相等的角度值時，中央處理單元就判斷機器人所在位置為該第二角度組所對應的所述交叉點的位置。
10.如權利要求8所述的定位方法，其特征在于:當中央處理單元未查找到與所述第三角度具有相等角度值的第二角度組時，中央處理單元判斷機器人所在位置的步驟如下: 1)將所述第三角度組與存儲的每一第二角度組內的各個角度值對應相減，并得出數量與第二角度組的數量相等的一系列第四角度組； 2)將該一系列第四角度組中的各個角度值對應相比并選出具有最小絕對值的第四角度組； 3)從選出的第四角度組中選出具有所述最小絕對值最多的第四角度組，從而獲得與該第四角度組相對應的第二角度組； 4)中央處理單元判斷機器人所在位置最靠近步驟3中的第二角度組所對應的所述交叉點的位置。
11.如權利要求8所述的定位方法，其特征在于:當中央處理單元從存儲的各個第二角度組中查找到多個第二角度組，且該多個第二角度組與所述第三角度組僅有一個相等的角度值時，中央處理單元判斷機器人所在位置的步驟如下: 1)將所述多個第二角度組從存儲的各個第二角度組篩選出來； 2)將所述第三角度組與該多個第二角度組內的各個角度值對應相減，并得出多個第五角度組； 3)將該多個第五角度組中的各個角度值對應相比并選出具有最小絕對值的第五角度組； 4)從選出的第五角度組中選出具有所述最小絕對值最多的第五角度組，從而獲得與該第五角度組相對應的第二角度組； 5)中央處理單元判斷機器人所在位置最靠近步驟4中的第二角度組所對應的所述交叉點的位置。
12.如權利要求8所述的定位方法，其特征在于:當機器人按照中央處理單元設定的指定線路移動時，中央處理單元按一定頻率對所述第二、第三角度組進行角度對比，所述機器人按一定速度沿所述指定線路移動，中央處理單元判斷機器人所在位置的步驟如下:1)存儲中央處理單元在前一次進行角度對比時機器人在所述坐標系內的前一時刻位置； 2)以前一時刻位置為圓心，所述頻率與速度的乘積為半徑所形成的圓確定為角度對比的范圍； 3)選出位于所述圓內或圓上的多個交叉點； 4)將所述第三角度組與該多個交叉點所對應的多個第二角度組對比以獲得機器人在所述坐標系內的位置。
13.如權利要求12所述的定位方法，其特征在于:機器人上安裝有可測得其航行方向的電子羅盤，中央處理器在所述多個交叉點中選出位于機器人航行方向上的一部分交叉點，然后將所述第三角度組與該一部分交叉點所對應的一部分第二角度組對比以獲得機器人所在坐標系內的位置。·
【文檔編號】G01C21/00GK103542846SQ201210245557
【公開日】2014年1月29日 申請日期:2012年7月16日 優先權日:2012年7月16日
【發明者】孔釗, 宋強, 姜飛 申請人:蘇州科瓴精密機械科技有限公司