TWI683197B - 移動平台圖資校正系統 - Google Patents

移動平台圖資校正系統 Download PDF

Info

Publication number
TWI683197B
TWI683197B TW108109230A TW108109230A TWI683197B TW I683197 B TWI683197 B TW I683197B TW 108109230 A TW108109230 A TW 108109230A TW 108109230 A TW108109230 A TW 108109230A TW I683197 B TWI683197 B TW I683197B
Authority
TW
Taiwan
Prior art keywords
mobile platform
image
map
module
collision
Prior art date
Application number
TW108109230A
Other languages
English (en)
Other versions
TW202036194A (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 TW108109230A priority Critical patent/TWI683197B/zh
Priority to US16/394,614 priority patent/US11221219B2/en
Application granted granted Critical
Publication of TWI683197B publication Critical patent/TWI683197B/zh
Publication of TW202036194A publication Critical patent/TW202036194A/zh

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/38—Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804—Creation or updating of map data
    • G01C21/3807—Creation or updating of map data characterised by the type of data
    • G01C21/383—Indoor data
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/38—Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804—Creation or updating of map data
    • G01C21/3833—Creation or updating of map data characterised by the source of data
    • G01C21/3848—Data obtained from both position sensors and additional sensors
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0227—Control of position or course in two dimensions specially adapted to land vehicles using mechanical sensing means, e.g. for sensing treated area
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00—Image analysis
    • G06T7/70—Determining position or orientation of objects or cameras
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/0088—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00—Indexing scheme for image analysis or image enhancement
    • G06T2207/10—Image acquisition modality
    • G06T2207/10004—Still image; Photographic image

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Theoretical Computer Science (AREA)
  • Multimedia (AREA)
  • Electromagnetism (AREA)
  • Navigation (AREA)

Abstract

一種移動平台圖資校正系統，係用以在一移動平台受到碰撞後，校正移動平台之一全區地圖，並包含一地圖建立模組、一定位模組、一碰撞偵測模組、一影像識別解析模組、一座標系重建模組與一圖資校正模組。地圖建立模組，係以一第一座標系建立對應於一導航區域之全區地圖。定位模組，用以定位移動平台之一碰撞前定位座標。碰撞偵測模組，係用以在偵測出移動平台被碰撞後產生一圖資重建信號，並利用影像識別解析模組，搜尋識別特徵物件之一識別影像。座標系重建模組，係用以定義出一碰撞後之第二座標系，並利用圖資校正模組據以校正全區地圖。

Description

移動平台圖資校正系統
本發明係有關於一種校正系統，尤其是指一種移動平台圖資校正系統。
機器人或自動導引車（Automatic Guided Vehicle；AGC）的定位技術，最早於西元1999年的國際機器人與自動化會議（International Conference on Robotics and Automation）中被提出。
隨著科技的進步，各式各樣的機器人或是自動導引車已漸漸普及，且已廣泛地應用於多個領域，例如：送餐機器人、服務機器人、掃地機器人、中國青島無人碼頭等。
然而，機器人或是自動導引車在移動的過程中，難免會受到一些接觸或碰撞，進而影響其定位的判定，導致定位偏差，造成機器人或是自動導引車的導航系統的定位錯誤，進而影響其系統效能。
有鑒於在先前技術中，機器人或是自動導引車受到接觸或是碰撞時，可能導致其定位偏差所衍生出的種種問題。本發明之一主要目的係提供一種移動平台圖資校正系統，用以解決上述問題。
本發明為解決先前技術之問題，所採用之必要技術手段為提供一種移動平台圖資校正系統，係用以在一移動平台受到碰撞後，校正移動平台之一碰撞後地圖，包含一地圖建立模組、一定位模組、一碰撞偵測模組、一影像識別解析模組、一座標系重建模組與一圖資校正模組。
一地圖建立模組，係用以在一具有一識別特徵物件之導航區域中，以一第一座標系建立一對應於導航區域之全區地圖，其中全區地圖包含識別特徵物件所在之一識別物件座標。定位模組，係電性連接地圖建立模組，用以定位移動平台而獲得移動平台被碰撞前之一碰撞前定位座標。碰撞偵測模組，係用以在偵測出移動平台被碰撞後產生一圖資重建信號。
影像識別解析模組，係電性連接碰撞偵測模組，用以在接收到圖資重建信號後，搜尋識別特徵物件，以擷取識別特徵物件之一識別影像，並解析識別影像而獲取移動平台與識別物件座標間之一相對座標。座標系重建模組，係電性連接地圖建立模組、定位模組與影像識別解析模組，接收識別物件座標、碰撞前定位座標與相對座標據以計算出移動平台被碰撞後之一碰撞後定位座標，藉以依據碰撞後定位座標定義出第二座標系。圖資校正模組，係電性連接座標系重建模組與地圖建立模組，且利用第二座標系校正全區地圖以產生一校正全區地圖。
在上述必要技術手段的基礎下，本發明所衍生之一附屬技術手段為使移動平台圖資校正系統中之該地圖建立模組，包含一紅外光掃描單元，且紅外光掃描單元係用以掃描導航區域，藉以建立全區地圖。
在上述必要技術手段的基礎下，本發明所衍生之一附屬技術手段為使移動平台圖資校正系統中之碰撞偵測模組，包含一振動偵測單元，且振動偵測單元係用以偵測移動平台之一振動值，並在振動值大於一振動臨界值時判斷出移動平台係受到碰撞。
在上述必要技術手段的基礎下，本發明所衍生之一附屬技術手段為使移動平台圖資校正系統中之碰撞偵測模組，包含一加速度偵測單元，且加速度偵測單元係用以偵測移動平台之一加速度值，並在加速度值大於一加速度臨界值時判斷出移動平台係受到碰撞。
在上述必要技術手段的基礎下，本發明所衍生之一附屬技術手段為使移動平台圖資校正系統中之碰撞偵測模組，包含一傾斜角度偵測單元，且傾斜角度偵測單元係用以偵測移動平台之一傾斜角度值，並在傾斜角度值大於一角度臨界值時判斷出移動平台係受到碰撞。
在上述必要技術手段的基礎下，本發明所衍生之一附屬技術手段為使移動平台圖資校正系統中之影像識別解析模組，包含一影像比例辨識單元，且影像比例辨識單元係用以判斷識別影像之一影像比例，藉以解析識別影像而獲取相對座標。
在上述必要技術手段的基礎下，本發明所衍生之一附屬技術手段為使移動平台圖資校正系統中之影像識別解析模組，包含一影像傾斜辨識單元，且影像傾斜辨識單元係用以判斷識別影像之一影像傾斜角度，藉以解析識別影像而獲取相對座標。
在上述必要技術手段的基礎下，本發明所衍生之一附屬技術手段為使移動平台圖資校正系統中之圖資校正模組，係利用碰撞後定位座標與碰撞前定位座標所形成之一向量以及第二座標系與第一座標系所形成之一夾角，校正全區地圖以產生校正地圖。
承上所述，本發明所提供之移動平台圖資校正系統，利用地圖建立模組、定位模組、碰撞偵測模組、影像識別解析模組、座標系重建模組與圖資校正模組，取得識別物件座標、碰撞前定位座標與相對座標，計算出被碰撞後的移動平台之一碰撞後定位座標，再依據碰撞後定位座標定義出第二座標系。最後，再利用第二座標系校正全區地圖以產生一校正地圖，藉以解決先前技術中，移動平台受到碰撞後產生定位偏差所衍生出的種種問題。
請參閱第一圖至第三圖，其中，第一圖係顯示本發明較佳實施例所提供之移動平台圖資校正系統之方塊圖；第二圖係顯示本發明較佳實施例所提供之移動平台圖資校正系統位於導航區域之立體示意圖；以及，第三圖係顯示本發明較佳實施例所提供之移動平台圖資校正系統建立全區地圖之示意圖。如圖所示，一種移動平台圖資校正系統1係用以在一移動平台100受到碰撞後，校正移動平台100，並包含一地圖建立模組11、一定位模組12、一碰撞偵測模組13、一影像識別解析模組14、一座標系重建模組15與一圖資校正模組16。
移動平台100係位於一導航區域SN，導航區域SN內具有一識別特徵物件PF，在本實施例中，導航區域SN係位於一餐廳內，識別特徵物件PF係一餐桌，但不以此為限。
地圖建立模組11係用以在移動平台100位於導航區域SN時，以一第一座標系C1建立一與導航區域SN對應之全區地圖MG，而全區地圖MG係包含識別特徵物件PF所在之一識別物件座標CPF。而在本實施例中，地圖建立模組11包含一紅外光掃描單元111，移動平台100在導航區域SN移動時，係利用紅外光掃描單元111掃描導航區域SN，藉以建立全區地圖MG。
定位模組12係電性連接地圖建立模組11，用以定位移動平台100而獲得移動平台100被碰撞前之一碰撞前定位座標C100。
碰撞偵測模組13係用以在偵測出移動平台100被碰撞後產生一圖資重建信號。在本實施例中，碰撞偵測模組13包含一振動偵測單元131、一加速度偵測單元132與一傾斜角度偵測單元133，但不以此為限。
影像識別解析模組14係電性連接碰撞偵測模組13，用以在接收到圖資重建信號後，搜尋識別特徵物件PF，以擷取識別特徵物件PF之一識別影像，並解析識別影像而獲取移動平台100與識別物件座標CPF間之一相對座標。
座標系重建模組15係電性連接地圖建立模組11、定位模組12與影像識別解析模組14接收識別物件座標、碰撞前定位座標與相對座標據以計算出移動平台100被碰撞後之一碰撞後定位座標，藉以依據碰撞後定位座標定義出第二座標系。
圖資校正模組16係電性連接座標系重建模組15與地圖建立模組11，且利用第二座標系校正上述全區地圖MG以產生一校正地圖MCG。
接著，請一併參閱第一圖至第十圖，其中，第四圖係顯示第二圖之移動平台受到碰撞後之立體示意圖；第五圖係顯示移動平台受到碰撞後的碰撞後地圖示意圖；第六圖係顯示移動平台搜尋碰撞後的全區地圖上識別物件座標之示意圖；第七圖係顯示移動平台搜尋導航區域上識別特徵物件之示意圖；第八圖係顯示本發明較佳實施例所提供之移動平台圖資校正系統校正全區地圖之示意圖；第九圖係顯示本發明較佳實施例所提供之移動平台圖資校正系統校正全區地圖之另一示意圖；以及，第十圖係顯示本發明較佳實施例所提供之移動平台圖資校正系統校正全區地圖形成校正地圖之示意圖。
如圖所示，移動平台100因為受到碰撞而沿一偏移方向D1產生位移與角度偏移。為了方便說明，以下將碰撞後的移動平台標示為移動平台100’，藉以與碰撞前的移動平台100做出區隔。
在移動平台100受到碰撞之前，其所建立的全區地圖MG係與導航區域SN相對應，也就是說，導航區域SN內的識別特徵物件PF在全區地圖MG上相對應的位置上會有識別物件座標CPF。
而當移動平台100受到碰撞位移一段距離或偏移一個角度形成移動平台100’後，全區地圖MG也會隨之變成一全區地圖MG’（碰撞後地圖）。在地圖尚未被校正前，移動平台100’會認為全區地圖MG’係對應導航區域SN，故會認為識別特徵物件PF仍然位於左前方，位於全區地圖MG’上的一識別物件座標CPF’。然而，全區地圖MG’沒有與導航區域SN相對應，故全區地圖MG’上識別物件座標CPF’並不會對應到導航區域SN內識別特徵物件PF的位置。實際上，識別特徵物件PF所在的位置係位於全區地圖MG上標示的識別物件座標CPF，如圖所示，識別特徵物件PF目前位於移動平台100’的左後方。
當移動平台100受到碰撞位移一段距離或偏移一個角度形成移動平台100’後，碰撞偵測模組13會偵測出移動平台100受到碰撞，而產生圖資重建信號。碰撞偵測模組13可利用控制迴路中的電流回授值進行判斷，當受到碰撞時，電流回授值會與正常運作時的電流回授值有著極大的差異，藉此判定移動平台100受到碰撞。此外，碰撞偵測模組13的振動偵測單元131、加速度偵測單元132與傾斜角度偵測單元133也都是用來偵測移動平台100是否受到碰撞。
振動偵測單元131，係用來偵測移動平台100之一振動值，當偵測出的振動值大於一內建之振動臨界值，表示移動平台100產生異常的振動時，係判定移動平台100係受到一外力碰撞，故會產生上述圖資重建信號。振動偵測單元131可為一振動規，或是其他可以偵測振動之單元、晶片等。
加速度偵測單元132，係用來偵測移動平台100之一加速度值，當偵測出的加速度值大於一內建之加速度臨界值，表示移動平台100產生異常的加速度時，係判定移動平台100係受到一外力碰撞，故會產生上述圖資重建信號。加速度偵測單元132可為一加速度規，或是其他可以偵測加速度之單元或晶片等。
同理，傾斜角度偵測單元133，係用來偵測移動平台100之一傾斜角度值，當偵測出的傾斜角度值大於一內建之角度臨界值，表示移動平台100形成異常的傾斜角度時，係判定移動平台100係受到一外力碰撞，故會產生上述圖資重建信號。傾斜角度偵測單元133可為一角度規，或是其他可以偵測傾斜角度之單元或晶片等。
實務上，加速度偵測單元132與傾斜角度偵測單元133可為一三軸感知器，或稱陀螺儀。利用x,y,z三軸的壓電係數偵測物體的加速度與傾斜角度。當物體產生位移時，可以直接計算取得速度值、加速度值與傾斜角度。
因為定位模組12會隨時定位移動平台100，故移動平台圖資校正系統1可以獲得被碰撞前的移動平台100之碰撞前定位座標C100。當影像識別解析模組14接收到圖資重建信號後，會開始搜尋識別特徵物件PF。如第六圖所示，移動平台100’會先依照碰撞後與導航區域SN不對應的全區地圖MG’，旋轉至錯誤的識別物件座標CPF’，並記錄所旋轉的一角度A1。
因座標點為一圓點，無法明確表示旋轉的方向，故在此將移動平台100’沿偏移方向D1發生位移與角度偏移後所對應全區地圖MG’上的一碰撞後定位座標C100’繪製成類似於移動平台100’的俯視圖，藉以明確表達影像識別解析模組14所朝向的方向與移動平台100’的旋轉方向。需說明的是，此時的碰撞後定位座標C100’的實際座標值尚未被計算出來。
接著，移動平台100’中的影像識別解析模組14會去搜尋實際的識別特徵物件PF，也就是全區地圖MG所標示的識別物件座標CPF，並在搜尋到實際的識別特徵物件PF時，記錄所旋轉的一角度A2，如第七圖所示。影像識別解析模組14搜尋到實際的識別特徵物件PF後，係擷取識別特徵物件PF的一識別影像，並解析識別特徵物件PF的識別影像，而獲取移動平台100’與識別物件座標CPF間之一相對座標。
在本實施例中，影像識別解析模組14包含一影像比例辨識單元141與一影像傾斜辨識單元142。影像比例辨識單元141係用以判斷識別特徵物件PF之識別影像之一影像比例，藉以解析識別特徵物件PF的識別影像而獲取相對座標。影像傾斜辨識單元142，則是用以判斷識別特徵物件PF之識別影像之一影像傾斜角度，藉以解析識別特徵物件PF的識別影像而獲取相對座標。
其中，影像比例辨識單元141可以利用比例尺、三角量測等方式，藉以解析識別特徵物件PF的識別影像而獲取相對座標，而影像傾斜辨識單元142則可以利用梯形修正、三角函數等方式，藉以解析識別特徵物件PF的識別影像而獲取相對座標。
實務上，影像識別解析模組14會先擷取辨識識別影像的比例，再檢測識別影像的邊緣特徵，後檢測識別影像的旋轉特徵，以解析出相對座標。普遍來說，上述過程都會搭配矩陣進行運算，有時為了方便運算，還會搭配灰階校正。
此時，座標系重建模組15，係接收識別特徵物件PF的識別物件座標CPF、受到碰撞前的移動平台100之碰撞前定位座標C100與相對座標，並據以計算出受到碰撞後之移動平台100’之碰撞後定位座標C100’，即移動平台100’所在的位置，進而定義出一第二座標系C2。而碰撞前的移動平台100之碰撞前定位座標C100、識別特徵物件PF的識別物件座標CPF與相對座標，又可以形成一角度A3。
移動平台100’，進行完上述步驟後，會依照旋轉出去的角度A1、A2而轉回原角度。接著，圖資校正模組16，會利用第二座標系C2校正碰撞後的全區地圖MG’。圖資校正模組16會先將角度A2與角度A3相減而得一角度A4，並將碰撞後的全區地圖MG’先行旋轉前述角度A4，形成另一全區地圖MG’a。而識別物件座標CPF’亦旋轉前述角度A4，形成另一識別物件座標CPF’a，如第八圖所示。需說明的是，將角度A2與角度A3相減而得的角度A4係表示受到碰撞後的移動平台100’與受到碰撞前的移動平台100相比所偏移的角度，同時也是第二座標系C2與第一座標系C1所形成的夾角角度。
接著，圖資校正模組16會計算受到碰撞後的移動平台100’的碰撞後定位座標C100’與受到碰撞前的移動平台100的碰撞前定位座標C100之間的一向量v與一距離d，並將全區地圖MG’a沿著向量v平移，以形成另一全區地圖MG’b。而識別物件座標CPF’a亦沿著向量v平移，形成另一識別物件座標CPF’b，如第九圖所示。需說明的是，向量v係表示受到碰撞後的移動平台100’與受到碰撞前的移動平台100相比所偏移的方向，而距離d係表示受到碰撞後的移動平台100’與受到碰撞前的移動平台100相比所偏移的距離。
當全區地圖MG’a沿著向量v平移距離d時，全區地圖MG’b會與全區地圖MG重合，識別物件座標CPF’b也會與識別物件座標CPF重合，又全區地圖MG係與導航區域SN相對應，故此時圖資校正模組16已利用第二座標系C2將碰撞後的全區地圖MG’校正完畢。
以碰撞後的移動平台100’的第二座標系C2的觀點來看，圖資校正模組16係校正碰撞後的全區地圖MG’，而形成一校正地圖MCG，如第十圖所示。而校正地圖MCG中的一識別物件座標CPCF係對應到導航區域SN內識別特徵物件PF的真實位置。。
綜上所述，本發明所提供之移動平台圖資校正系統，係利用地圖建立模組、定位模組、碰撞偵測模組、影像識別解析模組、座標系重建模組與圖資校正模組，藉以在移動平台受到碰撞後，依照受到碰撞前的移動平台的碰撞前定位座標、識別特徵物件座標與相對座標，計算出受到碰撞後的移動平台的碰撞後定位座標，進而定義出第二座標系，再依據第二座標系，將受到碰撞後的全區地圖校正成一對應導航區域的校正地圖。
相較於先前技術，本發明所提供之移動平台圖資校正系統，在移動平台受到碰撞後，並不會產生定位偏差，造成機器人或是自動導引車的導航系統的定位錯誤，甚至影響其系統效能。
藉由以上較佳具體實施例之詳述，係希望能更加清楚描述本發明之特徵與精神，而並非以上述所揭露的較佳具體實施例來對本發明之範疇加以限制。相反地，其目的是希望能涵蓋各種改變及具相等性的安排於本發明所欲申請之專利範圍的範疇內。
1‧‧‧移動平台圖資校正系統
11‧‧‧地圖建立模組
111‧‧‧紅外光掃描單元
12‧‧‧定位模組
13‧‧‧碰撞偵測模組
131‧‧‧振動偵測單元
132‧‧‧加速度偵測單元
133‧‧‧傾斜角度偵測單元
14‧‧‧影像識別解析模組
141‧‧‧影像比例辨識單元
142‧‧‧影像傾斜辨識單元
15‧‧‧座標系重建模組
16‧‧‧圖資校正模組
100、100’‧‧‧移動平台
A1、A2、A3、A4‧‧‧角度
C1‧‧‧第一座標系
C2‧‧‧第二座標系
C100‧‧‧碰撞前定位座標
C100’‧‧‧碰撞後定位座標
CPF、CPF’、 CPF’a、CPF’b、CPCF‧‧‧識別物件座標
D1‧‧‧偏移方向
d‧‧‧距離
MG、MG’、 MG’a、 MG’b‧‧‧全區地圖
MCG‧‧‧校正地圖
PF‧‧‧識別特徵物件
SN‧‧‧導航區域
v‧‧‧向量
第一圖係顯示本發明較佳實施例所提供之移動平台圖資校正系統之方塊圖； 第二圖係顯示本發明較佳實施例所提供之移動平台圖資校正系統位於導航區域之立體示意圖； 第三圖係顯示本發明較佳實施例所提供之移動平台圖資校正系統建立全區地圖之示意圖； 第四圖係顯示第二圖之移動平台受到碰撞後之立體示意圖； 第五圖係顯示移動平台受到碰撞後的碰撞後地圖示意圖； 第六圖係顯示移動平台搜尋碰撞後的全區地圖上識別物件座標之示意圖； 第七圖係顯示移動平台搜尋導航區域上識別特徵物件之示意圖； 第八圖係顯示本發明較佳實施例所提供之移動平台圖資校正系統之校正全區地圖之示意圖； 第九圖係顯示本發明較佳實施例所提供之移動平台圖資校正系統之校正全區地圖之另一示意圖；以及 第十圖係顯示本發明較佳實施例所提供之移動平台圖資校正系統校正全區地圖形成校正地圖之示意圖。
1‧‧‧移動平台圖資校正系統
11‧‧‧地圖建立模組
111‧‧‧紅外光掃描單元
12‧‧‧定位模組
13‧‧‧碰撞偵測模組
131‧‧‧振動偵測單元
132‧‧‧加速度偵測單元
133‧‧‧傾斜角度偵測單元
14‧‧‧影像識別解析模組
141‧‧‧影像比例辨識單元
142‧‧‧影像傾斜辨識單元
15‧‧‧座標系重建模組
16‧‧‧圖資校正模組

Claims (8)

  1. 一種移動平台圖資校正系統，係用以在一移動平台受到碰撞後，校正該移動平台之一碰撞後地圖，包含： 一地圖建立模組，係用以在一具有一識別特徵物件之導航區域中，以一第一座標系建立一對應於該導航區域之全區地圖，其中該全區地圖包含該識別特徵物件所在之一識別物件座標； 一定位模組，係電性連接該地圖建立模組，用以定位該移動平台而獲得該移動平台被碰撞前之一碰撞前定位座標； 一碰撞偵測模組，係用以在偵測出該移動平台被碰撞後產生一圖資重建信號； 一影像識別解析模組，係電性連接該碰撞偵測模組，用以在接收到該圖資重建信號後，搜尋該識別特徵物件，以擷取該識別特徵物件之一識別影像，並解析該識別影像而獲取該移動平台與該識別物件座標間之一相對座標； 一座標系重建模組，係電性連接該地圖建立模組、該定位模組與該影像識別解析模組，接收該識別物件座標、該碰撞前定位座標與該相對座標據以計算出該移動平台被碰撞後之一碰撞後定位座標，藉以依據該碰撞後定位座標定義出第二座標系；以及 一圖資校正模組，係電性連接該座標系重建模組與該地圖建立模組，且利用該第二座標系校正該全區地圖以產生一校正地圖。
  2. 如申請專利範圍第1項所述之移動平台圖資校正系統，其中，該地圖建立模組包含一紅外光掃描單元，且該紅外光掃描單元係用以掃描該導航區域，藉以建立該全區地圖。
  3. 如申請專利範圍第1項所述之移動平台圖資校正系統，其中，該碰撞偵測模組包含一振動偵測單元，且該振動偵測單元係用以偵測該移動平台之一振動值，並在該振動值大於一振動臨界值時判斷出該移動平台係受到碰撞。
  4. 如申請專利範圍第1項所述之移動平台圖資校正系統，其中，該碰撞偵測模組包含一加速度偵測單元，且該加速度偵測單元係用以偵測該移動平台之一加速度值，並在該加速度值大於一加速度臨界值時判斷出該移動平台係受到碰撞。
  5. 如申請專利範圍第1項所述之移動平台圖資校正系統，其中，該碰撞偵測模組包含一傾斜角度偵測單元，且該傾斜角度偵測單元係用以偵測該移動平台之一傾斜角度值，並在該傾斜角度值大於一角度臨界值時判斷出該移動平台係受到碰撞。
  6. 如申請專利範圍第1項所述之移動平台圖資校正系統，其中，該影像識別解析模組包含一影像比例辨識單元，且該影像比例辨識單元係用以判斷該識別影像之一影像比例，藉以解析該識別影像而獲取該相對座標。
  7. 如申請專利範圍第1項所述之移動平台圖資校正系統，其中，該影像識別解析模組包含一影像傾斜辨識單元，且該影像傾斜辨識單元係用以判斷該識別影像之一影像傾斜角度，藉以解析該識別影像而獲取該相對座標。
  8. 如申請專利範圍第1項所述之移動平台圖資校正系統，其中，該圖資校正模組係利用該碰撞後定位座標與該碰撞前定位座標所形成之一向量以及該第二座標系與該第一座標系所形成之一夾角，校正該全區地圖以產生該校正地圖。
TW108109230A 2019-03-19 2019-03-19 移動平台圖資校正系統 TWI683197B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
TW108109230A TWI683197B (zh) 2019-03-19 2019-03-19 移動平台圖資校正系統
US16/394,614 US11221219B2 (en) 2019-03-19 2019-04-25 System for calibrating map data configured for mobile platform

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW108109230A TWI683197B (zh) 2019-03-19 2019-03-19 移動平台圖資校正系統

Publications (2)

Publication Number Publication Date
TWI683197B true TWI683197B (zh) 2020-01-21
TW202036194A TW202036194A (zh) 2020-10-01

Family

ID=69942974

Family Applications (1)

Application Number Title Priority Date Filing Date
TW108109230A TWI683197B (zh) 2019-03-19 2019-03-19 移動平台圖資校正系統

Country Status (2)

Country Link
US (1) US11221219B2 (zh)
TW (1) TWI683197B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112643664B (zh) * 2019-10-10 2022-09-23 深圳市优必选科技股份有限公司 定位误差消除方法、装置、机器人及存储介质

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1242096A (zh) * 1996-12-25 2000-01-19 埃罗接触系统公司 用于声学触摸屏的光栅换能器
TW541255B (en) * 1999-12-15 2003-07-11 Automotive Tech Int Interactive vehicle display system
TW201334748A (zh) * 2012-02-16 2013-09-01 Micro Star Int Co Ltd 掃地機器人的控制方法
CN104027041A (zh) * 2013-03-05 2014-09-10 Lg电子株式会社 机器人清洁器
TW201622916A (zh) * 2014-12-26 2016-07-01 國立交通大學 機器人及其控制方法
TW201804950A (zh) * 2016-08-03 2018-02-16 Ｌｇ電子股份有限公司 移動式清掃機器人及其控制方法
TWM558927U (zh) * 2017-12-18 2018-04-21 Hua Chuang Automobile Information Technical Center Co Ltd 車道維持追隨系統
TW201815343A (zh) * 2016-10-25 2018-05-01 南韓商Ｌｇ電子股份有限公司 清掃機器人及其控制方法

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9534899B2 (en) * 2005-03-25 2017-01-03 Irobot Corporation Re-localization of a robot for slam
WO2008140070A1 (ja) * 2007-05-11 2008-11-20 Toyota Jidosha Kabushiki Kaisha 側面衝突用エアバッグ制御装置
JP5796751B2 (ja) * 2013-01-10 2015-10-21 株式会社デンソー 車両情報記録装置
WO2018038552A1 (ko) * 2016-08-25 2018-03-01 엘지전자 주식회사 이동 로봇 및 그 제어방법
US10571926B1 (en) * 2016-08-29 2020-02-25 Trifo, Inc. Autonomous platform guidance systems with auxiliary sensors and obstacle avoidance
US10762673B2 (en) * 2017-08-23 2020-09-01 Tusimple, Inc. 3D submap reconstruction system and method for centimeter precision localization using camera-based submap and LiDAR-based global map
EP3682305B1 (de) * 2017-09-12 2023-04-12 Robart GmbH Exploration einer unbekannten umgebung durch einen autonomen mobilen roboter

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1242096A (zh) * 1996-12-25 2000-01-19 埃罗接触系统公司 用于声学触摸屏的光栅换能器
TW541255B (en) * 1999-12-15 2003-07-11 Automotive Tech Int Interactive vehicle display system
TW201334748A (zh) * 2012-02-16 2013-09-01 Micro Star Int Co Ltd 掃地機器人的控制方法
CN104027041A (zh) * 2013-03-05 2014-09-10 Lg电子株式会社 机器人清洁器
TW201622916A (zh) * 2014-12-26 2016-07-01 國立交通大學 機器人及其控制方法
TW201804950A (zh) * 2016-08-03 2018-02-16 Ｌｇ電子股份有限公司 移動式清掃機器人及其控制方法
TW201815343A (zh) * 2016-10-25 2018-05-01 南韓商Ｌｇ電子股份有限公司 清掃機器人及其控制方法
TWM558927U (zh) * 2017-12-18 2018-04-21 Hua Chuang Automobile Information Technical Center Co Ltd 車道維持追隨系統

Also Published As

Publication number Publication date
US20200300631A1 (en) 2020-09-24
TW202036194A (zh) 2020-10-01
US11221219B2 (en) 2022-01-11

Similar Documents

Publication Publication Date Title
US11511421B2 (en) Object recognition processing apparatus and method, and object picking apparatus and method
KR102335353B1 (ko) 차량 레이더 검사 시스템 및 그 방법
US7106421B2 (en) Method of adjusting axial direction of monitoring apparatus
US10641617B2 (en) Calibration device and calibration method
JP4713048B2 (ja) 車両レーダシステムあるいは車両センサシステムにおける誤調整の認識方法及び装置。
US20140121836A1 (en) Object pickup device and method for picking up object
EP2096460A2 (en) Calibration device and calibration method for range image sensor
JP2018124787A (ja) 情報処理装置、データ管理装置、データ管理システム、方法、及びプログラム
KR102539287B1 (ko) 라이다 센서의 신뢰성에 따른 차량 제어 장치 및 방법
KR102094004B1 (ko) 탁구 로봇 제어 방법 및 이를 위한 시스템
CN105717499B (zh) 激光测距仪偏转角测量与校正系统及方法
TWI683197B (zh) 移動平台圖資校正系統
CN108801253B (zh) 机器人建图定位系统及机器人
JP2019056606A (ja) ステレオカメラ
CN112731451B (zh) 一种基于激光雷达检测地面障碍物的方法及系统
JP4397573B2 (ja) 画像処理装置
CN106276285A (zh) 组料垛位自动检测方法
US20240085448A1 (en) Speed measurement method and apparatus based on multiple cameras
JP2007333441A (ja) 移動体およびその環境認識センサ
CN114814865A (zh) 用于车辆测距的方法和系统、车辆及程序产品
WO2021145280A1 (ja) ロボットシステム
CN111750873A (zh) 移动平台图资校正系统
KR101207462B1 (ko) 영상 정보와 거리-각도 정보를 이용한 센서 보정 시스템
CN109579703B (zh) 测量坐标校正方法和系统
US10794696B2 (en) Method for identifying noise data of laser ranging device