TWI665461B - 雷射定位系統及使用此系統之位置量測方法 - Google Patents

雷射定位系統及使用此系統之位置量測方法 Download PDF

Info

Publication number
TWI665461B
TWI665461B TW107125382A TW107125382A TWI665461B TW I665461 B TWI665461 B TW I665461B TW 107125382 A TW107125382 A TW 107125382A TW 107125382 A TW107125382 A TW 107125382A TW I665461 B TWI665461 B TW I665461B
Authority
TW
Taiwan
Prior art keywords
positioning
laser
label
item
patent application
Prior art date
Application number
TW107125382A
Other languages
English (en)
Other versions
TW201947253A (zh
Inventor
吳俊德
王傑智
王崇勳
Original Assignee
財團法人工業技術研究院
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 財團法人工業技術研究院 filed Critical 財團法人工業技術研究院
Priority to CN201810933500.9A priority Critical patent/CN110441734B/zh
Priority to US16/184,533 priority patent/US10739439B2/en
Application granted granted Critical
Publication of TWI665461B publication Critical patent/TWI665461B/zh
Publication of TW201947253A publication Critical patent/TW201947253A/zh

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/48Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/481Constructional features, e.g. arrangements of optical elements
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/89Lidar systems specially adapted for specific applications for mapping or imaging
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06Systems determining position data of a target
    • G01S17/42Simultaneous measurement of distance and other co-ordinates
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/16Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using electromagnetic waves other than radio waves
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/48Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/481Constructional features, e.g. arrangements of optical elements
    • G01S7/4817Constructional features, e.g. arrangements of optical elements relating to scanning

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Electromagnetism (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Length Measuring Devices By Optical Means (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

一種雷射定位系統,包括一雷射掃描器、一第一定位標籤、一第二定位標籤以及一處理單元。雷射掃描器設置於移動載具上,用以發射光束至一定位板,並接收定位板反射光束所產生的複數個反射光點訊號。第一定位標籤及第二定位標籤用以反射光束以產生第一定位訊號與第二定位訊號至雷射掃描器。處理單元用以尋找光束投射至第一定位標籤與第二定位標籤的位置資訊,並藉由過濾此些反射光點訊號以定義一參考座標,以供處理單元以參考座標,計算雷射掃描器與定位板的相對位置。

Description

雷射定位系統及使用此系統之位置量測方法
一種雷射定位系統及使用此系統之位置量測方法,且特別是有關於一種用以提高雷射定位精度的雷射定位系統及使用此系統之位置量測方法。
隨著時代演變,新的工業生產模式已由大量製造轉為少量多樣化的彈性製造,導致生產線換線頻繁且需要具靈活彈性之自動化運載系統。無軌導引式AGV(Automated Guided Vehicle)為自動化物料傳輸中之重要載具,其具有不佔空間、可彈性調整產線之優點。在技術方面,以雷射、磁柱或二維條碼標籤等方式來達成定位之目的。其中雷射地圖比對導引方式,在產線彈性調整方面有極大優勢,其定位算法可以分為兩部分:在整個環境中全域定位的算法和利用地標特徵的細定位算法。而目前的地標僅使用形狀來計算定位,但因為雷射掃描器訊號本身存在雜訊且雷射打到地標形狀邊緣也會有雜訊產生,想要達到定位精準度公厘級以下的定位不容易達成。
本發明係有關於一種雷射定位系統及其方法,主要是在雷射定位板上貼上定位標籤做為定位輔助標記,並透過演算法計算雷射掃描器與定位板之間的相對位置及距離,以提高雷射的定位精度。
根據本發明之一方面,提出一種雷射定位系統,用以定位一移動載具,雷射定位系統包括一定位板、一雷射掃描器、一第一定位標籤、一第二定位標籤以及一處理單元。雷射掃描器設置於移動載具上,用以發射一光束至定位板,並接收雷射掃描器由定位板的第一側掃描至第二側時,定位板反射光束所產生的複數個反射光點訊號。第一定位標籤設置於定位板的第一側處,用以反射光束以產生一第一定位訊號至雷射掃描器。第二定位標籤設置於定位板的第二側處,用以反射光束以產生一第二定位訊號至雷射掃描器。處理單元用以尋找光束投射至第一定位標籤的位置及光束投射至第二定位標籤的位置資訊,並藉由過濾此些反射光點訊號以定義一參考座標,以供處理單元以參考座標,計算雷射掃描器與定位板的相對位置。
根據本發明之一方面,提出一種位置量測方法,用以定位一移動載具,移動載具上設有一雷射掃描器,雷射定位方法包括下列步驟。雷射掃描器投射一光束在一第一定位標籤、一定位板以及一第二定位標籤上,以對應產生第一定位訊號、多個反射光點訊號以及第二定位訊號,其中第一定位標籤與第二定位標籤設置於定位板的相對兩側。以一處理單元尋找光束投射至第 一定位標籤及第二定位標籤的位置資訊,並藉由過濾此些反射光點訊號以定義一參考座標,以供處理單元以參考座標,計算雷射掃描器與定位板的相對位置。
為了對本發明之上述及其他方面有更佳的瞭解,下文特舉實施例,並配合所附圖式詳細說明如下:
100‧‧‧雷射定位系統
101、102、103‧‧‧位置量測方法
110、110’‧‧‧定位板
111、112‧‧‧二相對表面
120‧‧‧雷射掃描器
121‧‧‧發射中心位置
122‧‧‧第一定位標籤
124‧‧‧第二定位標籤
130‧‧‧處理單元
132‧‧‧光強度檢測單元
134‧‧‧雜訊過濾單元
136‧‧‧演算單元
M‧‧‧移動載具
L‧‧‧光束
S1‧‧‧第一側
S2‧‧‧第二側
B1‧‧‧第一定位訊號
B2‧‧‧第二定位訊號
B3‧‧‧反射光點訊號
L1‧‧‧回歸直線
L2‧‧‧第一直線
L3‧‧‧第二直線
C1‧‧‧第一交點
C2‧‧‧第二交點
O‧‧‧中點
H‧‧‧掃描光束
R‧‧‧區間
第1圖繪示依照本發明一實施例之雷射定位系統的示意圖。
第2圖繪示依照本發明一實施例之利用反射光點訊號及定位訊號定義參考座標的示意圖。
第3A及3B圖分別繪示對應本發明不同實施例之定位板的正面示意圖。
第4圖繪示依照本發明一實施例之位置量測方法的流程示意圖。
第5A及5B圖分別繪示依照本發明另一實施例之定位板的正面示意圖。
第6圖繪示依照本發明另一實施例之位置量測方法的流程示意圖。
以下係提出實施例進行詳細說明,實施例僅用以作為範例說明,並非用以限縮本發明欲保護之範圍。以下是以相同/類似的符號表示相同/類似的元件做說明。
依照本發明一實施例之雷射定位系統可用以定位一移動載具,移動載具例如是無人搬運車、無人飛機、自走式機器人或無人化運輸裝置等,透過本實施例的雷射定位系統,可使移動載具在路面上、工廠內行走或在三度空間中飛行時可精確測量移動載具相對於目標物的距離或座標,以確保移動載具能自主移動到工作站或停止在定位點上。
第1圖繪示依照本發明一實施例之雷射定位系統100的示意圖。第2圖繪示依照本發明一實施例之利用反射光點訊號B3及定位訊號B1、B2定義參考座標的示意圖。第3A至3B圖分別繪示對應本發明不同實施例之定位板110、110’的正面示意圖。
請參照第1及2圖,在一實施例中,雷射定位系統100包括一定位板110、一雷射掃描器120、一第一定位標籤122、一第二定位標籤124以及一處理單元130。雷射掃描器120設置於移動載具M上,用以發射一光束L至一定位板110,並接收雷射掃描器120由定位板110的第一側S1掃描至第二側S2時,定位板110反射光束L所產生的多個反射光點訊號B3。第一定位標籤122設置於定位板110的第一側S1處,用以反射光束L以產生一第一定位訊號B1至雷射掃描器120。第二定位標籤124設置於定位板110的第二側S2處,用以反射光束L以產生一第二定位訊號B2至雷射掃描器120。
如上所述,本實施例之雷射定位系統100係在定位板110的特定區域,例如是定位板110靠近邊緣的第一側S1與第二 側S2的區域,貼上具有反光或增強光反射訊號強度的反光標籤或貼紙,做為第一定位標籤122與第二定位標籤124,或者,在定位板110的特定區域貼上具有吸光或減弱光反射訊號強度的吸光標籤或貼紙,做為第一定位標籤122與第二定位標籤124,以使雷射定位系統100能根據光反射訊號強度判斷光束L是否投射在第一定位標籤122與第二定位標籤124上。
在一實施例中,經由測量光反射訊號強度,得知第一定位訊號B1及第二定位訊號B2的光強度大於反射光點訊號B3的光強度(例如大於反射光點訊號B3的光強度的兩倍以上),或小於反射光點訊號B3的光強度(例如小於反射光點訊號B3的光強度的一半),以供雷射定位系統100能清楚得知光束L投射在第一定位標籤122與第二定位標籤124的位置以及光束L投射在定位板110的各個反射光點的位置。
請參照第1及2圖,當雷射掃描器120由定位板110的第一側S1掃描至第二側S2時,光束L依序投射在第一定位標籤122、定位板110以及第二定位標籤124上,並依序產生第一定位訊號B1、多個反射光點訊號B3以及第二定位訊號B2。其中,第一定位訊號B1表示光束L投射至第一定位標籤122的位置資訊,透過計算光束L飛行時間及角度可得知雷射掃描器120相對於第一定位標籤122的距離及角度,且光束L投射至第一定位標籤122的位置必然位於第一定位標籤122與雷射掃描器120的發射中心位置121相連形成的一第一直線L2上,以確定第一定位標籤122與雷 射掃描器120的相對位置。此外,第二定位訊號B2表示光束L投射至第二定位標籤124的位置資訊,透過計算光束L飛行時間及角度可得知雷射掃描器120相對於第二定位標籤124的距離及角度,且光束L投射至第二定位標籤124的位置必然位於第二定位標籤124與雷射掃描器120的發射中心位置121相連形成的一第二直線L3上,以確定第二定位標籤124與雷射掃描器120的相對位置資訊。
另外,反射光點訊號B3表示光束L投射至定位板110的位置,透過計算光束L飛行時間及量角器可大概推估雷射掃描器120相對於定位板110上各個反射光點的距離及角度。若未設置第一定位標籤122與第二定位標籤124於定位板110上,僅透過反射光點訊號B3推估雷射掃描器120相對於定位板110的各個反射光點的距離及角度時,由於靠近第一側S1及第二側S2處的反射光點訊號B3在物件邊緣容易產生雜訊,因而無法精確地定位。本實施例之雷射定位系統100透過設置第一定位標籤122與第二定位標籤124於定位板110上做為輔助定位標記,可過濾雷射在邊緣地區產生的雜訊訊號,找出特定區間R內的反射光點訊號B3,以提高雷射的定位精度。
請參照第1及2圖,處理單元130用以尋找光束L投射至第一定位標籤122及第二定位標籤124的位置資訊,並藉由過濾此些反射光點訊號B3以定義參考座標。在一實施例中,處理單元130例如包括一光強度檢測單元132、一雜訊過濾單元134以及一演算單元136。光強度檢測單元132可根據第一定位訊號B1的光 強度及第二定位訊號B2的光強度分別尋找光束L投射至第一定位標籤122及第二定位標籤124的位置資訊。雜訊過濾單元134根據光束L投射至第一定位標籤122及第二定位標籤124的位置過濾此些反射光點訊號B3,以擷取在第一定位標籤122與第二定位標籤124之間的一區間R內的此些反射光點訊號B3。
也就是說,處理單元130可去除第一定位標籤122與第二定位標籤124外側的雜訊訊號,僅擷取第一定位標籤122與第二定位標籤124之間的反射光點訊號B3來尋找一回歸直線L1。在一實施例中,演算單元136例如根據區間R內的此些反射光點訊號B3的最小平方函數尋找回歸直線L1。本實施例採用的線性迴歸最小平方法,找出最適代表反射光點訊號B3的回歸直線L1方程式,請參照定義如下: 變數X的標準差:,其中為X的平均值
變數Y的標準差:,其中為Y的平均值
變數X與Y的相關係數:
回歸直線L1方程式為:
請參照第2圖,其繪示最適代表反射光點訊號B3的一回歸直線L1。接著,雷射定位系統100利用回歸直線L1與光束L投射至第一定位標籤122及第二定位標籤124的位置資訊定義出一座標軸,以供處理單元130以座標軸為參考座標,計算雷射掃描 器120與定位板110的相對位置。如第1及2圖所示,在一實施例中,演算單元136可根據已知的第一定位標籤122的位置資訊,找出第一定位標籤122與雷射掃描器120的發射中心位置121相連的一第一直線L2,且第一直線L2與回歸直線L1相交而得到一第一交點C1,並根據已知的第二定位標籤124的位置資訊,找出第二定位標籤124與雷射掃描器120的發射中心位置121相連的一第二直線L3,且第二直線L3與回歸直線L1相交而得到一第二交點C2,演算單元136再以第一交點C1與第二交點C2的一中點(以O表示)做為座標軸的原點計算雷射掃描器120與定位板110的相對位置。當然,本實施例不限定以中點O做為座標軸的原點,亦可以第一交點C1或第二交點C2做為座標軸的原點,本發明不以此為限。
請參照第3A圖,定位板110例如為一平板,平板具有一平面,第一定位標籤122與第二定位標籤124位於平面的相對兩側。第一定位標籤122與第二定位標籤124例如為反光條,沿著平板的縱向排列,然而,第一定位標籤122與第二定位標籤124亦可為塊狀,不限定為條狀。當雷射光束L由定位板110的第一側S1掃描至第二側S2時,形成一掃描光束H於定位板110上,再透過反光條可以找出雷射光束L投射至平面相對兩側的角度,如此處理單元130可以找出以雷射發射中心位置121為起點的兩射線(即第一直線L2與第二直線L3),並與先前求出的回歸直線L1相交找出兩 個交點(即第一交點C1與第二交點C2),以找出計算雷射掃描器120與定位板110的相對位置的參考座標。
雷射掃描器120不限定為形成單一條掃描光束L的二維掃描器,在另一實施例中,雷射掃描器120亦可為形成多條掃描光束H的三維掃描器或由至少兩個二維掃描器組成的三維掃描器。請參照第3B圖,雷射掃描器120可於定位板110上形成多條平行排列的掃描光束H,每一條掃描光束H透過上述的演算法找出回歸直線L1以及兩交點,進而找出計算雷射掃描器120與定位板110的相對位置在三維空間中的參考座標。
請參照第3B圖,以下介紹用於三維掃描及定位的另一實施例。定位板110例如為一平面。首先,將第一定位標籤122與第二定位標籤124設置於定位板110的相對兩側,並投射多條掃描光束H於定位板110上。此二定位標籤可以平行或不平行。處理單元130可根據第一定位標籤122與第二定位標籤124之間的反射光點訊號(即資料點Dlidar)的最小平方函數進行回歸分析,以找出平面方程式,其中平面方程式定義為:f(x,y)=z=ax+by+c,a,b,c為未知的係數,假設所取得的資料點Dlidar={(xk,yk,zk)|kє[0,n]and n,kє正整數},將資料點代入平面方程式並寫成矩陣型式:
將平面方程式乘上左邊的轉置矩陣,以便做最小平方差(linear least square):
接著,將算式整理過後可得到下列方程式:
如此便可以求出a,b,c三個係數。
當求出平面方程式之後,處理單元130透過定位標籤的位置資訊可以找出雷射光束L投射至平面相對兩側的角度,並以雷射發射中心為原點做兩射線(即第一直線L2與第二直線L3),利用此兩射線找出與先前求出的平面方程式上的定位標籤的位置相交的兩個交點。上述的交點取三組以上,即可定義一參考座標,以供處理單元130計算雷射掃描器120與定位板110的相對位置。
根據第3A圖所述的實施例,提出一種用以提高雷射定位精度的位置量測方法。請參照第1、2、3A及4A圖,其中第4A圖繪示依照本發明一實施例之位置量測方法101的流程示意圖。位置量測方法101包括下列步驟S11~S17。
在步驟S11中,投射光束L在第一定位標籤122、定位板110以及第二定位標籤124上,以對應產生第一定位訊號B1、多個反射光點訊號B3以及第二定位訊號B2。
在步驟S12中,透過光反射訊號強度,尋找光束L投射至第一定位標籤122及光束L投射至第二定位標籤124的位置資訊。
在步驟S13中,根據光束L投射至第一定位標籤122及第二定位標籤124的位置資訊過濾反射光點訊號B3,以擷取在第一定位標籤122與第二定位標籤124之間的一區間R內的反射光點訊號B3。
在步驟S14中,根據區間R內的反射光點訊號B3的最小平方函數尋找一回歸直線L1。
在步驟S15中,根據第一定位標籤122的位置資訊,找出第一定位標籤122與雷射掃描器120的發射中心位置121相連的一第一直線L2,且第一直線L2與回歸直線L1相交而得到一第一交點C1。
在步驟S16中,根據第二定位標籤124的位置資訊,找出第二定位標籤124與雷射掃描器120的發射中心位置121相連的一第二直線L3,且第二直線L3與回歸直線L1相交而得到一第二交點C2。
在步驟S17中,以第一交點C1與第二交點C2的一中點O做為座標軸的原點,計算雷射掃描器120與定位板110的相對位置。
根據第3B圖的實施例,提出另一種用以提高雷射定位精度的位置量測方法。請參照第1、2、3B及4B圖,其中第4B 圖繪示依照本發明一實施例之位置量測方法103的流程示意圖。位置量測方法103包括下列步驟S31~S35,其中步驟S31~S33與S11~S13的步驟相同,在此不再贅述。接著,請參照步驟S34,根據區間R內的反射光點訊號B3的最小平方函數進行迴歸分析,以找出一平面方程式。在步驟S35中,根據平面方程式與光束投射至第一定位標籤122及第二定位標籤124的位置的至少三組交點定義一參考座標,以供處理單元130根據參考座標計算雷射掃描器120與定位板110的相對位置。
定位板110不限定為一平板,在另一實施例中,定位板110亦可具有特定形狀,例如V形、W形(鋸齒形)、梯形、半圓形、弧形或波浪形等。在一實施例中,處理單元130採用點雲匹配算法可尋找出與定位板110表面形狀匹配的一組點雲,因此定位板110可為任意形狀。
請參照第5A圖,定位板110’例如具有呈V形的二相對表面111、112,第一定位標籤122與第二定位標籤124可分別位於呈V形的二相對表面111、112上,用來過濾反射光在物件邊緣產生雜訊。處理單元130可透過點雲匹配算法(例如迭代最近點(iterative closest point,ICP)算法)尋找一組匹配點雲,以計算雷射掃描器120與定位板110’的相對位置,因此不限定以線性迴歸最小平方法來實施本發明。在本實施例中,處理單元130能夠根據反射光點訊號B3的點雲資料找出與定位板110’表面形狀匹配的點雲,以定義雷射掃描器120與定位板110’之間的參考座標。
根據上述第5A圖的實施例,提出一種用以提高雷射定位精度的位置量測方法102。請參照第6圖,位置量測方法102包括下列步驟S21~S24。
在步驟S21中,投射光束L在第一定位標籤122、定位板110’以及第二定位標籤124上,以對應產生第一定位訊號B1、多個反射光點訊號B3以及第二定位訊號B2。
在步驟S22中,透過光反射訊號強度,尋找光束L投射至第一定位標籤122及第二定位標籤124的位置資訊。
在步驟S23中,根據光束L投射至第一定位標籤122及第二定位標籤124的位置資訊過濾反射光點訊號B3,以擷取在第一定位標籤122與第二定位標籤124之間的一區間R內的反射光點訊號B3。
在步驟S24中,根據區間R內的反射光點訊號B3尋找一組匹配點雲,以定義定位板110的參考座標,計算雷射掃描器120與定位板110的相對位置。
請參照第5B圖,在一實施例中,定位板110’還可具有一第三定位標籤126位於二相對表面111、112相交的邊界上。第三定位標籤126與第一及第二定位標籤的功能一樣,用以反射光束L以產生一第三定位訊號至雷射掃描器120。類似第4圖的位置量測方法101,第一定位標籤122與第三定位標籤126之間的位置量測方法與第二定位標籤124與第三定位標籤126之間的位置量測方法可分別根據反射光點訊號B3的最小平方函數尋找回 歸直線的方式進行,接著再以各自的回歸直線上的交點求出參考座標,以計算雷射掃描器120與定位板110’的相對位置。
本發明上述實施例所揭露之雷射定位系統及其方法,主要是在雷射定位板上貼上定位標籤做為定位輔助標記,並透過演算法精確計算雷射掃描器與定位板之間的相對位置或距離,以提高雷射的定位精度。
綜上所述,雖然本發明已以實施例揭露如上,然其並非用以限定本發明。本發明所屬技術領域中具有通常知識者,在不脫離本發明之精神和範圍內,當可作各種之更動與潤飾。因此,本發明之保護範圍當視後附之申請專利範圍所界定者為準。

Claims (27)

  1. 一種雷射定位系統,用以定位一移動載具,該雷射定位系統包括:一定位板;一雷射掃描器,設置於該移動載具上,用以發射一光束至該定位板,並接收該雷射掃描器由該定位板的第一側掃描至第二側時,該定位板反射該光束所產生的複數個反射光點訊號;一第一定位標籤,設置於該定位板的該第一側處,用以反射該光束以產生一第一定位訊號至該雷射掃描器;一第二定位標籤,設置於該定位板的該第二側處,用以反射該光束以產生一第二定位訊號至該雷射掃描器;以及一處理單元,用以尋找該光束投射至該第一定位標籤及該第二定位標籤的位置資訊,並藉由過濾該些反射光點訊號以定義一參考座標,以供該處理單元以該參考座標,計算該雷射掃描器與該定位板的相對位置。
  2. 如申請專利範圍第1項所述之雷射定位系統,其中該處理單元包括一光強度檢測單元,該光強度檢測單元根據該第一定位訊號的光強度及該第二定位訊號的光強度分別尋找該光束投射至該第一定位標籤及該第二定位標籤的位置資訊。
  3. 如申請專利範圍第2項所述之雷射定位系統,其中該第一定位標籤及該第二定位標籤為反光標籤或吸光標籤。
  4. 如申請專利範圍第2項所述之雷射定位系統,其中該第一定位訊號及該第二定位訊號的光強度大於該些反射光點訊號的光強度或小於該些反射光點訊號的光強度。
  5. 如申請專利範圍第1項所述之雷射定位系統,其中該處理單元包括一雜訊過濾單元,該雜訊過濾單元根據該光束投射至該第一定位標籤及該第二定位標籤的位置資訊過濾該些反射光點訊號,以擷取在該第一定位標籤與該第二定位標籤之間的一區間內的該些反射光點訊號。
  6. 如申請專利範圍第5項所述之雷射定位系統,其中該處理單元包括一演算單元,該演算單元根據該區間內的該些反射光點訊號的最小平方函數尋找一回歸直線,該回歸直線與該光束投射至該第一定位標籤及該第二定位標籤的位置的交點定義該參考座標。
  7. 如申請專利範圍第5項所述之雷射定位系統,其中該處理單元包括一演算單元,該演算單元根據該區間內的該些反射光點訊號尋找一組匹配點雲,以定義該參考座標。
  8. 如申請專利範圍第6項所述之雷射定位系統,其中該演算單元根據該第一定位標籤的位置資訊,找出該第一定位標籤與該雷射掃描器的發射中心位置相連的一第一直線,且該第一直線與該回歸直線相交而得到一第一交點,並根據該第二定位標籤的位置資訊,找出該第二定位標籤與該雷射掃描器的發射中心位置相連的一第二直線,且該第二直線與該回歸直線相交而得到一第二交點,該運算單元以該第一交點與該第二交點的一中點做為參考座標的原點,計算該雷射掃描器與該定位板的相對位置。
  9. 如申請專利範圍第1項所述之雷射定位系統,其中該定位板具有一平面,該第一定位標籤與該第二定位標籤位於該平面的相對兩側。
  10. 如申請專利範圍第1項所述之雷射定位系統,其中該定位板具有二相對表面,該第一定位標籤與該第二定位標籤分別位於二相對表面上。
  11. 如申請專利範圍第10項所述之雷射定位系統,更包括一第三定位標籤,位於該二相對表面相交的邊界上。
  12. 如申請專利範圍第1項所述之雷射定位系統,其中該雷射掃描器為二維掃描器,用以產生單一條掃描光束該定位板上。
  13. 如申請專利範圍第1項所述之雷射定位系統,其中該雷射掃描器為三維掃描器,用以產生複數條掃描光束於該定位板上。
  14. 一種位置量測方法,用以定位一移動載具,該移動載具上設有一雷射掃描器,該位置量測方法包括下列步驟:該雷射掃描器投射一光束在一第一定位標籤、一定位板以及一第二定位標籤上,以對應產生第一定位訊號、複數個反射光點訊號以及第二定位訊號,其中該第一定位標籤與該第二定位標籤設置於該定位板的相對兩側;以及以一處理單元尋找該光束投射至該第一定位標籤及該第二定位標籤的位置資訊,並藉由過濾該些反射光點訊號以定義一參考座標,以供該處理單元以該參考座標,計算該雷射掃描器與該定位板的相對位置。
  15. 如申請專利範圍第14項所述之位置量測方法,其中該處理單元包括一光強度檢測單元,該光強度檢測單元根據該第一定位訊號的光強度及該第二定位訊號的光強度分別尋找該光束投射至該第一定位標籤及該第二定位標籤的位置資訊。
  16. 如申請專利範圍第15項所述之位置量測方法,其中該第一定位標籤及該第二定位標籤為反光標籤或吸光標籤。
  17. 如申請專利範圍第15項所述之位置量測方法,其中該第一定位訊號及該第二定位訊號的光強度大於該些反射光點訊號的光強度或小於該些反射光點訊號的光強度。
  18. 如申請專利範圍第14項所述之位置量測方法,其中該處理單元包括一雜訊過濾單元,該雜訊過濾單元根據該光束投射至該第一定位標籤及該第二定位標籤的位置資訊過濾該些反射光點訊號,以擷取投射在該第一定位標籤與該第二定位標籤之間的一區間內的該些反射光點訊號。
  19. 如申請專利範圍第18項所述之位置量測方法,其中該處理單元包括一演算單元,該演算單元根據該區間內的該些反射光點訊號的最小平方函數尋找一回歸直線,該回歸直線與該光束投射至該第一定位標籤及該第二定位標籤的位置的交點定義該參考座標。
  20. 如申請專利範圍第18項所述之位置量測方法,其中該處理單元包括一演算單元,該演算單元根據該區間內的該些反射光點訊號的最小平方函數進行迴歸分析,以找出一平面方程式,並根據該平面方程式與該光束投射至該第一定位標籤及該第二定位標籤的位置的至少三組交點定義該參考座標。
  21. 如申請專利範圍第18項所述之位置量測方法,其中該處理單元包括一演算單元,該演算單元根據該區間內的該些反射光點訊號尋找一組匹配點雲,以定義該參考座標。
  22. 如申請專利範圍第19項所述之位置量測方法,其中該演算單元根據該第一定位標籤的位置資訊,找出該第一定位標籤與該雷射掃描器的發射中心位置相連的一第一直線,且該第一直線與該回歸直線相交而得到一第一交點,並根據該第二定位標籤的位置資訊,找出該第二定位標籤與該雷射掃描器的發射中心位置相連的一第二直線,且該第二直線與該回歸直線相交而得到一第二交點,該運算單元以該第一交點與該第二交點的一中點做為該參考座標的原點,計算該雷射掃描器與該定位板的相對位置。
  23. 如申請專利範圍第14項所述之位置量測方法,其中該定位板具有一平面,該第一定位標籤與該第二定位標籤位於該平面的相對兩側。
  24. 如申請專利範圍第14項所述之位置量測方法,其中該定位板具有二相對表面,該第一定位標籤與該第二定位標籤分別位於二相對表面上。
  25. 如專利範圍第23項所述之位置量測方法,更包括一第三定位標籤,位於該二相對表面相交的邊界上。
  26. 如申請專利範圍第14項所述之位置量測方法,其中該雷射掃描器為二維掃描器,用以產生單一條掃描光束於該定位板上。
  27. 如申請專利範圍第14項所述之位置量測方法,其中該雷射掃描器為三維掃描器,用以產生複數條掃描光束於該定位板上。
TW107125382A 2018-05-04 2018-07-23 雷射定位系統及使用此系統之位置量測方法 TWI665461B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201810933500.9A CN110441734B (zh) 2018-05-04 2018-08-16 激光定位系统及使用此系统的位置测量方法
US16/184,533 US10739439B2 (en) 2018-05-04 2018-11-08 Laser positioning system and position measuring method using the same

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
TW107115269 2018-05-04
??107115269 2018-05-04
CN107115269 2018-05-04

Publications (2)

Publication Number Publication Date
TWI665461B true TWI665461B (zh) 2019-07-11
TW201947253A TW201947253A (zh) 2019-12-16

Family

ID=68049547

Family Applications (1)

Application Number Title Priority Date Filing Date
TW107125382A TWI665461B (zh) 2018-05-04 2018-07-23 雷射定位系統及使用此系統之位置量測方法

Country Status (3)

Country Link
US (1) US10739439B2 (zh)
CN (1) CN110441734B (zh)
TW (1) TWI665461B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI808543B (zh) * 2021-11-22 2023-07-11 創奕能源科技股份有限公司 移動載具用精密定位/標誌參考裝置、辨識系統及方法

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI701423B (zh) * 2019-07-01 2020-08-11 東元電機股份有限公司 反射貼紙輔助定位系統
CN110865335B (zh) * 2019-11-20 2021-12-28 武汉科技大学 一种室内定位系统及控制方法
CN111044046B (zh) * 2019-12-09 2021-10-29 深圳市优必选科技股份有限公司 一种机器人定位精度的测试方法及装置
CN111413989B (zh) * 2020-04-13 2023-03-21 苏州华兴源创科技股份有限公司 基于agv的激光定位系统和方法
CN113051951A (zh) * 2021-04-01 2021-06-29 未来机器人(深圳)有限公司 标识码定位方法、装置、计算机设备和存储介质
CN114132736B (zh) * 2021-12-03 2023-08-08 四川东泉机械设备制造有限公司 板状底模运输用系统
CN116620079A (zh) * 2023-06-14 2023-08-22 北京博瑞智造科技有限公司 一种自动充电方法、装置、系统、可充电设备及存储介质

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TW200742600A (en) * 2006-05-05 2007-11-16 Pixart Imaging Inc Pointer positioning device and method
TW201044322A (en) * 2009-06-09 2010-12-16 Univ Nat Taiwan A 3D pointing apparatus and an orientation method for 3D pointing apparatus
US20140373369A1 (en) * 2013-05-10 2014-12-25 Leica Geosystems Ag Laser tracker with a target sensing unit for target tracking and orientation detection
US9395296B1 (en) * 2015-02-20 2016-07-19 The United States Of America, As Represented By The Secretary Of The Army Two-dimensional optical spot location using a one-dimensional detector array
TW201738986A (zh) * 2016-04-29 2017-11-01 Shanghai Micro Electronics Equipment (Group) Co Ltd 雙層對準裝置和雙層對準方法

Family Cites Families (36)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4846297A (en) 1987-09-28 1989-07-11 Tennant Company Automated guided vehicle
US4790402A (en) * 1987-09-28 1988-12-13 Tennant Company Automated guided vehicle
JPH02253116A (ja) * 1989-03-27 1990-10-11 Mitsubishi Electric Corp 車間距離検出装置
US5204731A (en) * 1989-12-04 1993-04-20 Sokkisha Co., Ltd. Method and apparatus for measuring the coordinates of a surveyed point
US5118191A (en) * 1990-05-29 1992-06-02 The United States Of America As Represented By The Secretary Of The Air Force High contrast switchable target discriminator
US5313262A (en) * 1992-09-30 1994-05-17 Imra America, Inc. Systems and methods for object detection using beam widening optics
TW370186U (en) * 1998-10-22 1999-09-11 Ind Tech Res Inst Alignment device
ATE299266T1 (de) * 1999-04-19 2005-07-15 Leica Geosystems Ag Indirekte positionsbestimmung mit hilfe eines trackers
KR100556612B1 (ko) * 2002-06-29 2006-03-06 삼성전자주식회사 레이저를 이용한 위치 측정 장치 및 방법
US7460250B2 (en) * 2003-10-24 2008-12-02 3Dm Devices Inc. Laser triangulation system
EP1659417A1 (de) * 2004-11-19 2006-05-24 Leica Geosystems AG Verfahren zur Bestimmung der Ausrichtung eines Ausrichtungsindikators
DE102005043912B4 (de) * 2005-05-18 2011-08-18 Steinbichler Optotechnik GmbH, 83115 Verfahren zum Bestimmen der 3D-Koordinaten der Oberfläche eines Objekts
WO2008145156A1 (en) * 2007-05-30 2008-12-04 Trimble Ab Target for use in measuring and surveying applications
WO2010021666A1 (en) * 2008-08-20 2010-02-25 Thomson Licensing Refined depth map
US20100157280A1 (en) * 2008-12-19 2010-06-24 Ambercore Software Inc. Method and system for aligning a line scan camera with a lidar scanner for real time data fusion in three dimensions
TW201025217A (en) * 2008-12-30 2010-07-01 Ind Tech Res Inst System and method for estimating state of carrier
EP2446300B1 (de) * 2009-06-23 2016-10-12 Leica Geosystems AG Tracking-verfahren und messsystem mit lasertracker
DE102010024014B4 (de) * 2010-06-16 2016-04-21 Trimble Jena Gmbh Ziel für ein geodätisches Gerät
US9686532B2 (en) * 2011-04-15 2017-06-20 Faro Technologies, Inc. System and method of acquiring three-dimensional coordinates using multiple coordinate measurement devices
WO2012167110A2 (en) * 2011-06-02 2012-12-06 Honda Motor Co., Ltd. Target recognition and localization methods using a laser sensor for wheeled mobile robots
EP2589982A1 (de) * 2011-11-03 2013-05-08 Leica Geosystems AG Laserdiode als Interferometer-Laserstrahlquelle in einem Lasertracker
EP2618175A1 (de) * 2012-01-17 2013-07-24 Leica Geosystems AG Lasertracker mit Funktionalität zur graphischen Zielbereitstellung
CN108095761B (zh) * 2012-03-07 2021-10-15 齐特奥股份有限公司 空间对准设备、空间对准系统及用于指导医疗过程的方法
CN102818568B (zh) * 2012-08-24 2016-12-21 中国科学院深圳先进技术研究院 室内机器人的定位与导航系统及方法
DE102013224381A1 (de) * 2012-12-20 2014-06-26 Dr. Johannes Heidenhain Gmbh Optische Positionsmesseinrichtung
EP2827099A1 (de) * 2013-07-16 2015-01-21 Leica Geosystems AG Lasertracker mit Zielsuchfunktionalität
CN103645733B (zh) * 2013-12-02 2014-08-13 江苏建威电子科技有限公司 自寻充电机器人及其自寻充电系统和方法
US9443311B2 (en) * 2014-06-12 2016-09-13 Topcon Positioning Systems, Inc. Method and system to identify a position of a measurement pole
CN104102222B (zh) * 2014-07-31 2017-03-01 广州大学 一种agv精确定位的方法
CN104750115B (zh) * 2015-04-09 2017-03-08 北京科技大学 一种移动设备的激光主动式导航系统及导航方法
CN104950892B (zh) * 2015-06-29 2017-10-31 厦门狄耐克物联智慧科技有限公司 一种机器人的行走控制系统及方法
US10408604B1 (en) * 2015-09-07 2019-09-10 AI Incorporated Remote distance estimation system and method
US10162058B2 (en) * 2016-12-23 2018-12-25 X Development Llc Detecting sensor orientation characteristics using marker-based localization
US10261183B2 (en) * 2016-12-27 2019-04-16 Gerard Dirk Smits Systems and methods for machine perception
CN107390679B (zh) * 2017-06-13 2020-05-05 合肥中导机器人科技有限公司 存储设备、激光导航叉车
US11614743B2 (en) * 2018-02-26 2023-03-28 The Boeing Company System and method for navigating a sensor-equipped mobile platform through an environment to a destination

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TW200742600A (en) * 2006-05-05 2007-11-16 Pixart Imaging Inc Pointer positioning device and method
TW201044322A (en) * 2009-06-09 2010-12-16 Univ Nat Taiwan A 3D pointing apparatus and an orientation method for 3D pointing apparatus
US20140373369A1 (en) * 2013-05-10 2014-12-25 Leica Geosystems Ag Laser tracker with a target sensing unit for target tracking and orientation detection
US9395296B1 (en) * 2015-02-20 2016-07-19 The United States Of America, As Represented By The Secretary Of The Army Two-dimensional optical spot location using a one-dimensional detector array
TW201738986A (zh) * 2016-04-29 2017-11-01 Shanghai Micro Electronics Equipment (Group) Co Ltd 雙層對準裝置和雙層對準方法

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI808543B (zh) * 2021-11-22 2023-07-11 創奕能源科技股份有限公司 移動載具用精密定位/標誌參考裝置、辨識系統及方法

Also Published As

Publication number Publication date
US20190339363A1 (en) 2019-11-07
TW201947253A (zh) 2019-12-16
CN110441734A (zh) 2019-11-12
CN110441734B (zh) 2023-01-31
US10739439B2 (en) 2020-08-11

Similar Documents

Publication Publication Date Title
TWI665461B (zh) 雷射定位系統及使用此系統之位置量測方法
CN106969768B (zh) 一种无轨导航agv的精确定位及停车方法
KR100578680B1 (ko) 검출된 각위치에 대한 아노니머스 반사기의 연관을 위한 방법 및 장치
US9454816B2 (en) Enhanced stereo imaging-based metrology
US20170161889A1 (en) Laser projection system and method
US9182763B2 (en) Apparatus and method for generating three-dimensional map using structured light
RU2720140C1 (ru) Способ оценки собственной позиции и устройство оценки собственной позиции
CN105446334A (zh) 一种引导车导航系统及一种引导车导航方法
CN108195377A (zh) 一种基于三角形周长匹配的反光板匹配算法
CN109991613B (zh) 定位方法、定位装置、车辆及可读存储介质
US10223793B1 (en) Laser distance measuring method and system
CN109143258A (zh) 无轨导航agv的定位方法
WO2014071834A1 (zh) 一种机器人定位系统及其反射装置的识别方法
JP2000009422A (ja) 走行車両の距離測定装置
CN112449164B (zh) 用于对车辆定位的方法以及用于执行该方法的车辆
JP2014006833A (ja) 自律移動装置、自律移動方法、標識、及び、自律移動システム
JP7173762B2 (ja) 反射体位置算出装置、反射体位置算出方法および反射体位置算出用プログラム
Kim et al. An active trinocular vision system of sensing indoor navigation environment for mobile robots
JPH05240940A (ja) 光計測システム
TWI701423B (zh) 反射貼紙輔助定位系統
Kurz et al. When geometry is not enough: using reflector markers in lidar SLAM
Godil et al. 3D ground-truth systems for object/human recognition and tracking
Rosinski et al. Terrain map building for a walking robot equipped with an active 2D range sensor
Tsukiyama RFID based navigation system for indoor mobile robots
Saarinen et al. Best-first branch and bound search method for map based localization