TW201925724A - 影像處理裝置、移動機器人之控制系統、移動機器人之控制方法 - Google Patents
影像處理裝置、移動機器人之控制系統、移動機器人之控制方法 Download PDFInfo
- Publication number
- TW201925724A TW201925724A TW107142270A TW107142270A TW201925724A TW 201925724 A TW201925724 A TW 201925724A TW 107142270 A TW107142270 A TW 107142270A TW 107142270 A TW107142270 A TW 107142270A TW 201925724 A TW201925724 A TW 201925724A
- Authority
- TW
- Taiwan
- Prior art keywords
- unit
- flag
- mobile robot
- detected
- information
- Prior art date
Links
- 238000012545 processing Methods 0.000 title claims abstract description 94
- 238000000034 method Methods 0.000 title claims description 38
- 238000003384 imaging method Methods 0.000 claims abstract description 96
- 238000001514 detection method Methods 0.000 claims abstract description 81
- 238000004364 calculation method Methods 0.000 claims abstract description 63
- 239000011159 matrix material Substances 0.000 claims abstract description 17
- 239000003550 marker Substances 0.000 claims description 40
- 239000000470 constituent Substances 0.000 claims description 2
- 238000012937 correction Methods 0.000 description 23
- 230000008859 change Effects 0.000 description 17
- 230000008569 process Effects 0.000 description 14
- 238000012986 modification Methods 0.000 description 13
- 230000004048 modification Effects 0.000 description 13
- 238000013519 translation Methods 0.000 description 11
- 238000010586 diagram Methods 0.000 description 10
- 238000005259 measurement Methods 0.000 description 10
- 230000009471 action Effects 0.000 description 9
- 230000006870 function Effects 0.000 description 9
- 238000003860 storage Methods 0.000 description 9
- 230000006872 improvement Effects 0.000 description 7
- 239000000463 material Substances 0.000 description 6
- 238000013459 approach Methods 0.000 description 5
- 238000009434 installation Methods 0.000 description 5
- 230000002093 peripheral effect Effects 0.000 description 4
- 230000004044 response Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 239000000203 mixture Substances 0.000 description 3
- 230000001678 irradiating effect Effects 0.000 description 2
- 238000012423 maintenance Methods 0.000 description 2
- 238000004091 panning Methods 0.000 description 2
- GWEVSGVZZGPLCZ-UHFFFAOYSA-N Titan oxide Chemical compound O=[Ti]=O GWEVSGVZZGPLCZ-UHFFFAOYSA-N 0.000 description 1
- 239000011358 absorbing material Substances 0.000 description 1
- XAGFODPZIPBFFR-UHFFFAOYSA-N aluminium Chemical compound [Al] XAGFODPZIPBFFR-UHFFFAOYSA-N 0.000 description 1
- 229910052782 aluminium Inorganic materials 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 238000009826 distribution Methods 0.000 description 1
- 239000011888 foil Substances 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 125000006850 spacer group Chemical group 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- OGIDPMRJRNCKJF-UHFFFAOYSA-N titanium oxide Inorganic materials [Ti]=O OGIDPMRJRNCKJF-UHFFFAOYSA-N 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0272—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising means for registering the travel distance, e.g. revolutions of wheels
-
- 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
- G06T7/73—Determining position or orientation of objects or cameras using feature-based methods
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
- G01C11/04—Interpretation of pictures
- G01C11/30—Interpretation of pictures by triangulation
-
- 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/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C3/00—Measuring distances in line of sight; Optical rangefinders
- G01C3/10—Measuring distances in line of sight; Optical rangefinders using a parallactic triangle with variable angles and a base of fixed length in the observation station, e.g. in the instrument
- G01C3/14—Measuring distances in line of sight; Optical rangefinders using a parallactic triangle with variable angles and a base of fixed length in the observation station, e.g. in the instrument with binocular observation at a single point, e.g. stereoscopic type
- G01C3/16—Measuring marks
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0234—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06K—GRAPHICAL DATA READING; PRESENTATION OF DATA; RECORD CARRIERS; HANDLING RECORD CARRIERS
- G06K7/00—Methods or arrangements for sensing record carriers, e.g. for reading patterns
- G06K7/10—Methods or arrangements for sensing record carriers, e.g. for reading patterns by electromagnetic radiation, e.g. optical sensing; by corpuscular radiation
- G06K7/14—Methods or arrangements for sensing record carriers, e.g. for reading patterns by electromagnetic radiation, e.g. optical sensing; by corpuscular radiation using light without selection of wavelength, e.g. sensing reflected white light
-
- 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
- G06—COMPUTING; CALCULATING OR COUNTING
- G06K—GRAPHICAL DATA READING; PRESENTATION OF DATA; RECORD CARRIERS; HANDLING RECORD CARRIERS
- G06K7/00—Methods or arrangements for sensing record carriers, e.g. for reading patterns
- G06K7/10—Methods or arrangements for sensing record carriers, e.g. for reading patterns by electromagnetic radiation, e.g. optical sensing; by corpuscular radiation
- G06K7/10544—Methods or arrangements for sensing record carriers, e.g. for reading patterns by electromagnetic radiation, e.g. optical sensing; by corpuscular radiation by scanning of the records by radiation in the optical part of the electromagnetic spectrum
- G06K7/10712—Fixed beam scanning
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06K—GRAPHICAL DATA READING; PRESENTATION OF DATA; RECORD CARRIERS; HANDLING RECORD CARRIERS
- G06K7/00—Methods or arrangements for sensing record carriers, e.g. for reading patterns
- G06K7/10—Methods or arrangements for sensing record carriers, e.g. for reading patterns by electromagnetic radiation, e.g. optical sensing; by corpuscular radiation
- G06K7/14—Methods or arrangements for sensing record carriers, e.g. for reading patterns by electromagnetic radiation, e.g. optical sensing; by corpuscular radiation using light without selection of wavelength, e.g. sensing reflected white light
- G06K7/1404—Methods for optical code recognition
- G06K7/1408—Methods for optical code recognition the method being specifically adapted for the type of code
- G06K7/1417—2D bar codes
-
- 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/10048—Infrared image
-
- 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/30—Subject of image; Context of image processing
- G06T2207/30204—Marker
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Electromagnetism (AREA)
- Automation & Control Theory (AREA)
- Theoretical Computer Science (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Aviation & Aerospace Engineering (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Toxicology (AREA)
- Artificial Intelligence (AREA)
- Multimedia (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Numerical Control (AREA)
- Image Processing (AREA)
Abstract
本發明係可實現進行小型標誌之識別及精度良好地距離計測,且廉價的系統。
該影像處理裝置10係包含有:被檢測體11,其係於二維平面上,將由正方形或長方形所形成的單元12、即可反射所被照射之光的第一單元12a及無法反射所被照射之光的第二單元12b,進行a×a、或a×b(其中,a、b=3、4、5、6、...)之矩陣配置而構成;以及檢測部22,其具備有:照射部23,其照射光;攝像部24、25,其於將自照射部23所照射之光照射至構成被檢測體11的第一單元12a及第二單元12b之後,利用相機拍攝自第一單元12a所被反射之光;及運算部26,其基於藉由攝像部24、25所拍攝之攝像資料,取得於被檢測體11所設定之資訊。
Description
本發明係關於一種影像處理裝置、移動機器人之控制系統、及移動機器人之控制方法。
一直以來,為了引導自主移動之移動機器人,使用信標(Beacon)等之發送器。例如,作為移動機器人之清掃機器人係基於自被設置於充電器的信標所發出之信號,進行朝向充電器移動並自充電器接受電力之供給的動作。又,下述專利文獻1中所記載之移動作業機器人係基於自信標所發出之信號,檢測成為基準之位置,並控制移動。
近年來,擴大了此種移動機器人之活用範圍。例如,在工廠內、物流倉庫等中所使用之無人搬送車、在設施、大廳(hall)、機場等之公共設施內的服務機器人係移動機器人活用之一例。
而且,於被使用在此種之移動機器人的信標中係可大致分為如上所述般之發出信號的類型,還有被稱為標誌之藉由特徵性形狀或花紋而進行識別的類型。此處,作為藉由特徵性形狀或花紋而進行識別之標誌之具體例,可列舉條碼或快速回應碼(quick response code)(註冊商標)等。
[專利文獻1]日本專利特開2002-073170號公報
然,如以上所揭示之專利文獻1所記載之移動作業機器人所代表般,於使用發出信號之信標進行移動控制之系統中,為了發送信號之信標需要電源,於設置複數個信標之情形時,需要多個配線工程。於此種系統之情形時,存在導入成本增大,並且用於維持.維護之運轉成本增大之課題。
另一方面,於使用藉由特徵性形狀或花紋而進行識別之標誌之系統構成之情形時,於其識別及距離計測中需要讀取精度較高之測定,但先前不存在有廉價且精度良好地進行此種測定的系統。例如,於將條碼或快速回應碼(註冊商標)用作標誌之情形時,必須使移動機器人接近至標誌並進行標誌識別,因此不適合在工廠內、物流倉庫等中所被使用之無人搬送車等之用途。又,作為於將條碼或快速回應碼(註冊商標)用於無人搬送車等之用途的情形時提高讀取精度之對策,可考慮使標記有條碼或快速回應碼(註冊商標)的標誌本身變大,但若為此種對策則於工廠內或物流倉庫等之現場中需要較廣之設置場所,因此考慮到對現場作業造成障礙的課題。
本發明係鑒於上述習知技術中存在之課題而完成者,其目的在於提供一種即便於使用無需較廣之設置場所之相對小型之標誌之情形時,亦可精度良好地進行其識別及距離計測,進而可廉價地實現系統的影像處理裝置、移動機器人之控制系統、及移動機器人之控制方法。又,本發明之進一步之目的在於提供一種即
便於使用發送信號之信標之情形時,亦可廉價地實現系統的影像處理裝置、移動機器人之控制系統、及移動機器人之控制方法。
本發明之影像處理裝置之特徵在於,其具備有:被檢測體,其係於二維平面上,將由正方形或長方形所形成的單元、即可反射所被照射之光的第一單元及無法反射所被照射之光的第二單元,進行a×a、或a×b(其中,a、b=3、4、5、6、…)之矩陣配置而所構成;以及檢測部,其具備有:照射部,其照射光;攝像部,其於將自上述照射部所照射之光照射至構成上述被檢測體的上述第一單元及上述第二單元之後,利用相機拍攝自上述第一單元所被反射之光;及運算部,其基於藉由上述攝像部所拍攝之攝像資料,取得於上述被檢測體所設定之資訊。
本發明之移動機器人之控制系統之特徵在於,其具備有:驅動部,其變更移動機器人之移動速度及行進方向;檢測部,其檢測沿至目標地點為止之移動路徑而所配置之複數個被檢測體;及控制部,其取得藉由上述檢測部所檢測出之至上述被檢測體為止之距離及方向,算出至上述被檢測體為止之距離及方向為滿足預先被規定之關係的行進方向,並基於所算出之行進方向對上述驅動部進行驅動控制;且上述被檢測體係構成為於二維平面上將由正方形或長方形所形成的單元、即可反射所被照射之光的第一單元及無法反射所被照射之光的第二單元,進行a×a、或a×b(其中,a、b=3、4、5、6、…)之矩陣配置而成的標誌,且上述檢測部係具備有:照射部,其照射光;攝像部,其於將自上述照射部所照射之光照射至構成上述標誌的上述第一單元及上述第二單元之後,利用相
機拍攝自上述第一單元所被反射之光;及運算部,其基於藉由上述攝像部所拍攝之攝像資料,算出與上述標誌之距離及方向。
本發明之移動機器人之控制方法係如下之移動機器人之控制方法,即,具備有:驅動部,其變更移動機器人之移動速度及行進方向;檢測部,其檢測沿至目標地點為止之移動路徑而所配置之複數個被檢測體;及控制部,其取得藉由上述檢測部所檢測出之至上述被檢測體為止之距離及方向;且上述被檢測體係構成為於二維平面上將由正方形或長方形所形成的單元、即可反射所被照射之光的第一單元及無法反射所被照射之光的第二單元,進行a×a、或a×b(其中,a、b=3、4、5、6、…)之矩陣配置而成的標誌;且上述檢測部係具備有:照射部,其照射光;攝像部,其於將自上述照射部所照射之光照射至構成上述標誌的上述第一單元及上述第二單元之後,利用相機拍攝自上述第一單元所被反射之光;及運算部,其基於藉由上述攝像部所拍攝之攝像資料,算出與上述標誌之距離及方向;且上述移動機器人之控制方法之特徵在於:使上述控制部,算出至上述被檢測體為止之距離及方向為滿足預先被規定之關係的行進方向,並基於所算出之行進方向對上述驅動部進行驅動控制。
根據本發明,可提供一種即便於使用無需較廣之設置場所之相對小型之標誌之情形時,亦可精度良好地進行其識別及距離計測,進而可廉價地實現系統的影像處理裝置、移動機器人之控制系統、及移動機器人之控制方法。又,本發明即便於使用發送信號之信標之情形時,亦可廉價地實現系統。
10‧‧‧影像處理裝置
11、11'、11"、111、11'-1、11'-2、11'-m、11'-(m+1)、111-0、111-1、
111-2、111-3、111-4‧‧‧標誌(被檢測體)
12‧‧‧單元
12a‧‧‧白色單元(第一單元)
12b‧‧‧黑色單元(第二單元)
21‧‧‧影像處理裝置本體
22‧‧‧標誌檢測部(檢測部)
23‧‧‧照射部
24、25‧‧‧攝像部
26‧‧‧運算部
27‧‧‧控制部
27a‧‧‧移動路徑記憶部
27b‧‧‧標誌選擇部
27c‧‧‧驅動控制部
21c1‧‧‧通過位置運算部
27c2‧‧‧修正角運算部
27c3‧‧‧指令值運算部
30‧‧‧移動機器人
31‧‧‧驅動部
32、33‧‧‧驅動輪
34、35‧‧‧馬達
36‧‧‧馬達控制部
40、40-1、40-2‧‧‧邊界
A、B‧‧‧符號
B1‧‧‧檢測開始位置
B2‧‧‧ID資訊賦予位置
B3‧‧‧檢測結束位置
L‧‧‧尺寸
Ppass‧‧‧位置
Vref‧‧‧移動機器人平移速度指令值
Xref‧‧‧標誌通過距離設定值
x‧‧‧所算出之標誌通過距離
Y1~Yn+5‧‧‧掃描
y‧‧‧所算出之至標誌側面之距離
z‧‧‧自標誌檢測部輸出之距離
θ‧‧‧自標誌檢測部輸出之方向
ωl‧‧‧左車輪之角速度指令
ωl'‧‧‧左車輪之角速度之測定值
ωr‧‧‧右車輪之角速度指令
ωr'‧‧‧右車輪之角速度之測定值
ωref‧‧‧移動機器人角速度指令值
△X‧‧‧差量
△θ‧‧‧修正角
圖1係表示本實施形態之影像處理裝置之系統構成例之方塊圖。
圖2表示對本實施形態之影像處理裝置所拍攝之標誌之攝像資料進行二值化處理而所獲得之二值化影像,並且用以說明用以對該二值化影像進行掃描而獲得於標誌所設定之ID(identification,識別)資訊之掃描方法的圖。
圖3係表示用以說明本實施形態之影像處理裝置之動作之影像處理步驟的流程圖。
圖4係表示本發明之標誌可採取之多種形態之一例之圖。
圖5係表示本實施例之移動機器人之移動例之圖。
圖6係表示本實施例之移動機器人之構成例之方塊圖。
圖7係表示本實施例之控制部之構成例之方塊圖。
圖8係表示本實施例之於移動路徑記憶部所記憶之表格之一例的圖。
圖9係表示本實施例之驅動控制部中之基於標誌資訊之控制之構成例的方塊圖。
圖10係表示本實施例之在驅動控制部中所算出之修正角△θ之圖。
圖11係表示本實施例之藉由控制部所進行之控制處理內容之流程圖。
圖12係表示在移動機器人所移動之通路中存在有交叉點之情形時之標誌之配置例的圖。
圖13係表示在移動機器人所移動之通路中存在有交叉點之情形時之標誌之配置例的圖。
圖14係表示對標誌賦予全部指令資訊之情形時之本發明之移動機器人之控制系統之構成例的圖。
圖15係表示變形形態中所使用之標誌之具體例之圖。
圖16係表示變形形態之於移動路徑記憶部所記憶之表格之一例的圖。
圖17係表示在移動機器人所移動之通路上配置有變形形態中所使用之標誌之一例、及變形形態之移動機器人之控制系統之動作例的圖。
圖18係表示藉由變形形態之攝像部所拍攝之攝像資料之一例之圖。
以下,使用圖式對用以實施本發明之較佳之實施形態進行說明。再者,以下之實施形態並非用於限定各請求項之發明,又,實施形態中所說明之特徵之組合之全部並非限定於發明之解決手段所必需的。
首先,使用圖1及圖2,對本實施形態之影像處理裝置之基本構成進行說明。此處,圖1係表示本實施形態之影像處理裝置之系統構成例之方塊圖。又,圖2表示對本實施形態之影像處理裝置所拍攝之標誌之攝像資料進行二值化處理而獲得的二值化影像,並且用以說明用以對該二值化影像進行掃描而獲得在標誌上所設定之ID資訊的掃描方法的圖。
如圖1所示,本實施形態之影像處理裝置10係構成
為具有作為被檢測體的標誌11、及藉由讀取該標誌11而取得所需之資訊並執行處理的影像處理裝置本體21。
標誌11係於二維平面上配置有由正方形所形成的複數個單元12而構成者。複數個單元12係例如包含有作為可反射紅外發光二極體(LED,Light Emitting Diode)光之第一單元的白色單元12a、及作為無法反射紅外LED光之第二單元的黑色單元12b。於圖1所示之本實施形態之情形時,14個白色單元12a、及26個黑色單元12b係以5行8列之矩陣配置方式配置於二維平面上。又,於該標誌11中,以包圍標誌11之外周部之方式所配置之22個黑色單元12b係不包含有資訊,而是作為用以將標誌11與空間進行區分而防止讀取之誤辨識的單純之邊界而發揮功能的部分。即,於圖1所示之標誌11中作為被檢測體而發揮功能的部位係藉由包含以符號A所表示之3行、及以符號B所表示之6列的3行6列、即18個單元12之矩陣配置所構成的部分。
在標誌11中作為被檢測體而發揮功能之3行6列之矩陣配置而所構成的部位,係例如位於最上段之第1列之以符號B1所表示的部位為構成為「檢測開始位置」,位於最下段之第6列之以符號B3所表示的部位為構成為「檢測結束位置」,在以該等檢測開始位置B1與檢測結束位置B3所夾的自第2列至第5列為止的4列所構成的以符號B2所表示的部位為構成為「ID資訊賦予位置」。
關於檢測開始位置B1及檢測結束位置B3,例如,自圖1之紙面左側朝向右側,以「白、黑、白」之順序配置有單元12,若利用將白設為「1」且將黑設為「0(零)」的二進位碼(binary code)來表現,則可表示為「1、0、1」。藉由使影像處理裝置本體21側
辨識該「1、0、1」之資訊,可辨識出成功讀取了標誌11之最初列及最終列。即,藉由辨識以「1、0、1」所表示之檢測開始位置B1及檢測結束位置B3,可準確地辨識可能存在於其間的4列之ID資訊賦予位置B2。
又,關於4列ID資訊賦予位置B2,自上方之列朝向下方之列以「白、黑、白」、「白、白、白」、「白、黑、白」、「白、白、白」之順序配置有單元12,若利用二進位碼表現其等則可表示為「1、0、1」、「1、1、1」、「1、0、1」、「1、1、1」。藉由使標誌11具有此種包含3位元×4列之構成的資訊,可對ID資訊賦予位置B2賦予合計12位元之ID資訊。而且,藉由使影像處理裝置本體21側辨識該12位元之資訊,可執行各種處理。
如上所述,藉由成功進行檢測開始位置B1及檢測結束位置B3之讀取,且讀取存在於其等之間之ID資訊賦予位置B2,能夠非誤辨識地取得ID資訊。
再者,複數個單元12中之白色單元12a係利用反射自下述之照射部23所照射的紅外LED光,且可使下述之攝像部24、25拍攝其之反射光的材料所構成。作為反射紅外LED光的材料,係使用鋁箔或氧化鈦之薄膜等。另一方面,黑色單元12b係利用不反射自下述之照射部23所照射的紅外LED光,且可使得於利用下述之攝像部24、25所拍攝的影像中黑色單元12b之部位成為暗部的材料所構成。作為不反射紅外LED光的材料,係使用紅外截止膜或偏光膜、紅外線吸收材、黑色毛氈等。亦即,於本實施形態中,利用標誌11之白色單元12a反射自作為投光部的照射部23所發出的紅外LED光,並利用作為受光部的攝像部24、25接受光
而拍攝影像。此時,於作為被檢測體的標誌11之黑色單元12b中,由於使對於作為受光部的攝像部24、25之反射光減少,故而採用捕捉該反射量之減少而進行檢測之所謂回歸反射型之影像取得構成。
本實施形態之影像處理裝置本體21係構成為具備有標誌檢測部22及控制部27。進而,標誌檢測部22係具備有照射部23、2個攝像部24、25、及運算部26。
照射部23係可對標誌11照射紅外LED光,並且使用於用以使自標誌11側所被反射的反射光藉由2個攝像部24、25讀取。自照射部23所照射的紅外LED光係即便於工廠內等之暗處或可見光之較強的場所等亦能進行標誌11之拍攝。
2個攝像部24、25係藉由配置於標誌檢測部22之左右的2個相機所構成。該等2個攝像部24、25係於將自照射部23所照射的紅外LED光照射至構成標誌11的白色單元12a及黑色單元12b之後,利用2個相機拍攝自白色單元12a所反射的光。再者,於2個攝像部24、25中,分別拍攝單獨之影像,使用2個攝像部24、25所取得的攝像資料被發送至運算部26。
運算部26藉由基於自2個攝像部24、25所發送的攝像資料並進行藉由三角測量所進行之運算,可算出標誌11相對於影像處理裝置本體21而位於何種之距離(相對距離)及方向(相對角度)。
此處,使用圖2對運算部26之掃描.運算方法進行說明。運算部26係在自2個攝像部24、25取得藉由2個攝像部24、25所拍攝的攝像資料之後,對所獲得之攝像資料進行二值化處理,
藉此獲得圖2所示之二值化影像。再者,於該二值化處理之階段,自白色單元12a所被反射的紅外LED光之反射光、與自黑色單元12b未被反射的部位係藉由白黑之二值化處理而被明確化。
進而,運算部26係對藉由二值化處理所獲得的二值化影像,自圖2中之紙面左上側起沿朝向右側之水平方向進行掃描。最初所被執行之掃描之情況係表示為符號Y1。此處,關於第1次之掃描即Y1,由於僅檢測出黑色單元12b,故而其之辨識結果為「黑」,成為僅有利用二進位碼所表示之「0」的檢測結果。於該情形時,由於可辨識在第1次之掃描中無法檢測出檢測開始位置B1,故繼而於朝二值化影像之下方側移動僅預先所設定之尺寸之表示為符號Y2的位置,執行第2次之掃描。於圖2之例中,關於第2次掃描即Y2,亦由於僅檢測出黑色單元12b,故而其之辨識結果為「黑」,成為僅有利用二進位碼所表現之「0」的檢測結果。即,由於可辨識在第2次之掃描中無法檢測出檢測開始位置B1,故進而朝二值化影像之下方側移動僅預先所設定之尺寸,繼續進行掃描。
於運算部26中,以上述順序繼續進行掃描,於執行第n次之掃描即Yn時,首先檢測出白色單元12a,其之辨識結果為「白、黑、白」,獲得利用二進位碼所表現之「1、0、1」的資訊。此時,運算部26係成為可辨識已檢測出檢測開始位置B1。進而,此時,於運算部26中,可算出被辨識為「白、黑、白」之單元12中之二值化影像上之尺寸。例如,如圖2所示般,可確認被辨識為「白、黑、白」之單元12之二值化影像上之尺寸係均為L。又,於該實施形態中,由於預先已知單元12為正方形,故而構成本實施形態之標誌11的白色單元12a及黑色單元12b之尺寸係可辨識為
由L×L之尺寸所形成的正方形。
於藉由執行第n次之掃描即Yn而辨識出已檢測出檢測開始位置B1的運算部26中,當執行第n+1次之掃描即Yn+1時,於自第n次之掃描位置朝二值化影像之下方側移動僅尺寸L的Yn+L之位置執行掃描Yn+1。亦即,運算部26係可藉由第n次之掃描辨識出檢測開始位置B1,並藉由算出二值化影像上之座標而辨識作為其次應掃描之部位的具有4列之ID資訊賦予位置B2的最初列之位置,因此成為可藉由使掃描位置移動至該位置並且進行1次之掃描,而執行具有4列之ID資訊賦予位置B2之最初列之掃描Yn+1。再者,於執行掃描Yn+1時,為了具有掃描位置之餘量,亦可設為於自第n次之掃描位置朝二值化影像之下方側移動僅加上微小之尺寸s至尺寸L的尺寸(L+s)的Yn+(L+s)之位置執行掃描Yn+1。藉由採用此種之控制,可尋求掃描精度之提高。
而且,其後,對具有4列之ID資訊賦予位置B2之第2列至第5列而與上述最初列之掃描Yn+1同樣地依序執行掃描Yn+2、Yn+3、Yn+4,藉此可藉由對各列執行1次之掃描來取得在具有4列之ID資訊賦予位置B2之全部上所設定之ID資訊。即,於執行第n+2次之掃描即Yn+2時,於自第n次之掃描位置朝二值化影像之下方側移動僅尺寸2L的Yn+L×2之位置執行掃描Yn+2,於執行第n+3次之掃描即Yn+3時,於自第n次之掃描位置朝二值化影像之下方側移動僅尺寸3L的Yn+L×3之位置執行掃描Yn+3,於執行第n+4次之掃描即Yn+4時,於自第n次之掃描位置朝二值化影像之下方側移動僅尺寸4L的Yn+L×4之位置執行掃描Yn+4。再者,於圖2中,關於4列之ID資訊賦予位置B2,自上方之列起以「白、
黑、白」、「白、白、白」、「白、黑、白」、「白、白、白」之順序配置有單元12,若利用二進位碼表現其等則可表示為「1、0、1」、「1、1、1」、「1、0、1」、「1、1、1」。於運算部26中,自具有4列之ID資訊賦予位置B2獲得該資訊。
進而,藉由在掃描Yn+4之後所執行之掃描Yn+5,於自第n次之掃描位置朝二值化影像之下方側移動僅尺寸5L的Yn+L×5之位置執行掃描Yn+5,藉此可獲得「白、黑、白」之辨識結果,從而獲得利用二進位碼所表現之「1、0、1」之資訊。此時,於運算部26中,預先已知該掃描Yn+5為檢測出檢測開始位置B1後之第5次之掃描,該位置為檢測結束位置B3。而且,藉由該掃描Yn+5所檢測出的資訊為「1、0、1」,由於該資訊係與表示檢測結束位置B3的資訊一致,故而可辨識正常地執行了該Y1至Yn+5的掃描且已結束。
藉由以上所說明之掃描順序,運算部26係成為能夠準確地取得標誌11上所設定之ID資訊。再者,於上述之操作順序中,於例如無法取得檢測開始位置B1、檢測結束位置B3之情形時,存在有自2個攝像部24、25所發送的攝像資料為缺失一部分或不完全的可能性,故而再次執行重新取得來自2個攝像部24、25之攝像資料的操作順序。又,於藉由2個攝像部24、25所拍攝的攝像資料存在有複數個之時,只要使運算部26執行基於所取得之ID資訊而選擇在現在時點所採用的標誌11等之處理即可。
又,作為用以尋求掃描精度之提高的方法,亦可設為於執行掃描Yn+2、Yn+3、Yn+4、Yn+5時,為了使具有掃描位置之餘量,於各個掃描中於自第n次之掃描位置朝二值化影像之下方側移
動的Yn+L×2+s之位置執行掃描Yn+2,於Yn+L×3+s之位置執行掃描Yn+3,於Yn+L×4+s之位置執行掃描Yn+4,於Yn+L×5+s之位置執行掃描Yn+5。
又,於以上所說明之掃描順序中,說明了如下實施形態之例,即,於辨識出檢測開始位置B1之後,對具有4列之ID資訊賦予位置B2之第2列至第5列進行掃描,最後掃描檢測結束位置B3。然而,關於藉由運算部26所進行之掃描之順序,並不限於上述者。例如,亦可於辨識出檢測開始位置B1之後,跳過具有4列之ID資訊賦予位置B2之第2列至第5列而對檢測結束位置B3進行掃描,首先先確實地檢測出檢測開始位置B1及檢測結束位置B3之後,對賦予有ID資訊的具有4列之ID資訊賦予位置B2之第2列至第5列進行掃描。藉由執行該掃描順序,可確實地檢測出所取得之影像資料為標誌11,進而,可尋求縮短針對於除標誌11以外之影像等之雜訊的處理時間。
再者,於圖1及圖2所示之標誌11中,以包圍標誌11之外周部之方式配置不包含有資訊的22個黑色單元12b。配置於該外周部的22個黑色單元12b係不僅作為與配置於其之內部之包含有資訊之3行6列、即18個單元12的交界而發揮功能,而且亦發揮吸收來自外部的光而使配置於內部之包含有資訊之3行6列、即18個單元12之檢測精度提高的功能。尤其是,於自攝像部24、25所觀察而標誌11成為逆光之環境之情形時,配置於外周部的22個黑色單元12b係吸收多餘之光,可抑制多餘之光之反射、進入至配置於內部之包含有資訊之3行6列、即18個單元12。藉由該構成,可獲得藉由影像處理裝置本體21所進行之標誌11之檢
測穩定效果。
已取得ID資訊的算出部26係可將該資訊發送至控制部27。獲得自算出部26所發送之資訊的控制部27係可使附加於影像處理裝置本體21的機構進行動作、或執行對於外部的動作指令等,而執行利用ID資訊的各種控制。作為該動作例,例如可假定為對針對在工廠內或物流倉庫內等所被利用之移動機器人的移動速度及行進方向進行變更的驅動部進行動作控制等。
以上,使用圖1及圖2,對本實施形態之影像處理裝置10之基本構成進行了說明。其次,藉由將圖3加入至參考圖式,而進行說明本實施形態之影像處理裝置10之動作。此處,圖3係表示用以進行本實施形態之影像處理裝置之動作說明的影像處理步驟之流程圖。
於藉由使本實施形態之影像處理裝置10進行動作而執行的影像處理步驟(步驟(Process)α)中,首先,照射部23係對標誌11照射紅外LED光(步驟S101)。自照射部23對標誌11所照射的紅外LED光,係照射至構成標誌11的單元12中之黑色單元12b之光不進行反射,僅將照射至白色單元12a之光作為反射光而反射至影像處理裝置本體21側。自白色單元12a所反射的光係根據藉由2個相機所構成的2個攝像部24、25進行拍攝(步驟S102)。此時,於攝像部24、25分別拍攝各1個攝像資料。於執行步驟S102之處理之後,將藉由2個攝像部24、25所拍攝之2個攝像資料發送至運算部26。
運算部26係自2個攝像部24、25取得藉由2個攝像部24、25所拍攝的攝像資料之後,對所獲得之攝像資料進行二值
化處理,藉此從而獲得圖2所示之二值化影像(步驟S103)。
進而,運算部26係對藉由二值化處理所獲得之二值化影像,執行使用圖2所說明之掃描(步驟S104)。再者,藉由運算部26所進行的有效率之掃描順序係已於上文說明,故此處省略說明。
若根據藉由運算部26所進行之對二值化影像的掃描而藉由運算部26正常地辨識出全部之檢測開始位置B1、具有4列之ID資訊賦予位置B2、檢測結束位置B3,則視為能檢測出標誌11,而朝步驟S105之是(YES)進行處理。另一方面,於藉由運算部26針對檢測開始位置B1、具有4列之ID資訊賦予位置B2、檢測結束位置B3中之一者亦無法辨識出之情形時,朝步驟S105之否(NO)進行處理。即,於無法檢測出標誌11之情形時,再次返回至步驟S101而重新執行處理。
若標誌11之檢測成功而朝步驟S105之是(YES)進行處理,繼而運算部26係基於來自具有4列之ID資訊賦予位置B2的資訊而取得ID資訊(步驟S106)。
取得了ID資訊的運算部26係藉由與所設定之ID進行對照,而選擇與ID資訊相關聯的標誌11,決定1個ID資訊(步驟S107)。此時,於所取得之ID資訊存在有複數個之情形時,當進行步驟S107之處理時,藉由自複數個ID資訊進行選擇與在現在時點應採用之ID資訊相關聯的標誌11,而決定1個ID資訊(步驟S107)。再者,作為自存在有複數個ID資訊之中選擇1個ID資訊之方法,可考慮例如選擇於標誌11之ID資訊賦予位置B2所被設定之ID資訊的手法,該標誌11係具有賦予每個標誌11之識別編號的最
小編號。
若於步驟S107之處理中與ID進行對照並選擇與ID資訊相關聯的標誌11,則根據藉由左右2個攝像部24、25拍攝該標誌11所獲得之左右2個攝像資料各者,算出標誌11之中心座標(步驟S108)。
運算部26係利用藉由步驟S108之處理而根據左右2個攝像資料各者所算出之標誌11之中心座標,執行基於三角測量的運算,算出與已獲得ID資訊的標誌11之距離及角度(步驟S109)。進而,運算部26係將所取得之ID資訊、及基於該ID資訊所算出之關於與標誌11之距離及角度的運算結果發送至控制部27(步驟S110)。執行該等步驟S101至步驟S110之處理,從而完成本實施形態之影像處理步驟(步驟α)。
藉由以上所說明之本實施形態之影像處理步驟(步驟α)之執行,運算部26係可準確地取得在標誌11上所設定的ID資訊。再者,對本發明之影像處理裝置之較佳之實施形態進行了說明,但本發明之技術性範圍並不限定於上述實施形態所記載之範圍。於上述實施形態中,可施加多種變更或改良。
例如,於上述實施形態之影像處理裝置10中,標誌11係使14個白色單元12a、及26個黑色單元12b以5行8列之矩陣配置方式配置於二維平面上。又,於該標誌11中,設置有以包圍標誌11之外周部之方式所配置的22個黑色單元12b,但該22個黑色單元12b並不包含有資訊,而是作為用以將標誌11與空間加以區分開而防止讀取之誤辨識之邊界而發揮功能的部分。即,圖1所示之標誌11中作為被檢測體而發揮功能的部位係藉由包含以
符號A所表示之3行、及以符號B所表示之6列之3行6列、即18個單元12之矩陣配置而所構成的部分。然而,關於本發明之標誌之形態,並不限於圖1所示者,可施加各種的變更。例如,關於以包圍標誌11之外周部之方式所配置的22個黑色單元12b,可省略。又,關於構成本發明之標誌之單元12之配置數,可採用例如如圖4所例示般之藉由3行3列、即9個單元12之矩陣配置而構成者等之各種的形態。另外,圖4係表示本發明之標誌可採取之多種形態之一例之圖,但就圖4所示之標誌11'之情況,ID資訊賦予位置B2為1列,可使標誌11'具有3位元構成的資訊。
又,例如,於上述之實施形態之影像處理裝置10中,構成標誌11之單元12係由正方形構成者,但關於本發明之單元,可採用長方形等之矩形形狀。只要預先已知單元之形狀,則可同樣地實施上述之實施形態中所說明之掃描或運算等的處理。
亦即,作為本發明之被檢測體的標誌係可藉由在二維平面上,將由正方形或長方形所構成的單元12、即可反射紅外LED光的白色單元12a及無法反射紅外LED光的黑色單元12b進行a×a、或a×b(其中,a、b=3、4、5、6、…)之矩陣配置而所構成從而實現。
又,例如,於上述之實施形態之影像處理裝置10中,例示了將紅外LED光用作於自照射部23所照射之光的情形。然而,本發明所使用之光並不限定於紅外LED光,亦可使用紫外線等之其他波長之光或來自LED以外之光源之光而獲得與上述之實施形態相同的效果。
又,例如,於上述之實施形態之影像處理裝置10中,
本發明之攝像部係藉由包含2個相機的攝像部24、25所構成,從而基於2個攝像資料而執行藉由三角測量所進行之運算處理。然而,關於本發明之攝像部,只要可進行與上述之實施形態相同的攝像資料處理即可,例如,可藉由1個相機中具備有1個鏡頭的相機而構成本發明之攝像部,或者亦可藉由1個相機中具備有2個頭的無線電相機(radio camera)而構成本發明之攝像部。
又,例如,於上述之實施形態之影像處理裝置10中,包含有2個相機的攝像部24、25、與照射紅外LED光的照射部23係以分別個體之方式所構成,但本發明之照射部與攝像部係亦可設為以一體之方式所構成的裝置。
又,例如,於上述之實施形態之影像處理裝置10中,藉由2個攝像部24、25所拍攝之攝像資料係藉由運算部26進行二值化處理者。然而,本發明之範圍並不限於該例,例如,亦可採用如下般之裝置構成或處理順序,即,2個攝像部24、25之各者係具備有與上述運算部26相同之功能即影像處理功能,攝像部24、25係拍攝自標誌11側所反射來的紅外LED光之後,立刻於攝像部24、25側進行二值化處理,並將經二值化處理的二值化影像之影像資料發送至運算部26。
又,例如,於上述之實施形態之影像處理裝置10中,於標誌檢測部22設置有運算部26,利用該運算部26進行ID資訊之取得、基於該ID資訊對於與標誌11的距離及角度進行運算,並將該運算結果發送至控制部27。然而,將運算部26與控制部27設為分開之構件為1個例示,該等之構件既可設為分別個體,亦可設為藉由1個微處理器所構成,進而還可以如下方式構成,即,配
置於影像處理裝置本體21之外,將運算部26、控制部27與影像處理裝置本體21,經由無線、網際網路線路而連接。
又,例如,於上述之實施形態之影像處理裝置10中,運算部26係對藉由二值化處理所獲得之二值化影像,自圖2中之紙面左上側起沿朝向右側之水平方向進行掃描。然而,運算部26對二值化影像進行之掃描的方向並不限於水平方向,亦可採用沿垂直方向進行掃描的處理。
根據申請專利範圍之記載可知,施加此種之變更或改良的形態亦可包含於本發明之技術性範圍內。
以上,對本實施形態之影像處理裝置10之基本構成及動作進行了說明。其次,對將上述之實施形態之影像處理裝置10應用於在工廠內、物流倉庫內等所被利用的移動機器人之情形之實施例進行說明。再者,於以下所記載之實施例中,針對與上述之實施形態相同或類似之構件或步驟,存在有標註相同之符號並省略說明的情況。
圖5係表示本實施例之移動機器人之移動例之圖。移動機器人30係檢測標誌11'(11'-1),並基於所檢測出的標誌11'之位置,一面與邊界40保持一定之距離,一面朝向目標地點移動,該標誌11'(11'-1)係作為沿著規定通路的邊界40(40-1、40-2)而所被配置的被檢測體。本實施例中所使用之標誌11'係假定以與移動機器人30面對面之方式所設置,且藉由圖4中所例示之3行3列、即9個單元12之矩陣配置所構成者,關於該標誌11',ID資訊賦予位置B2僅為1列,可使標誌11'具有3位元構成的資訊。而且,在該標誌11'上所設定之ID資訊係被分配有用以唯一地識別標誌
11'之各者的標誌ID。再者,規定通路的邊界40係例如為壁、間隔件、白色線條等之物體。
於圖5所示之移動例中,移動機器人30係相對於移動機器人30之行進方向而且左側之邊界40-1保持一定之距離而移動。移動機器人30係為了自邊界40-1保持一定之距離Xref,取得至所檢測出之標誌11'-1為止的距離Z及方向θ,算出滿足距離Z及方向θ預先被規定的條件的行進方向。移動機器人30朝所算出之行進方向移動。方向θ係移動機器人30之行進方向與所檢測出之標誌11'-1之方向所成的角。滿足預先被規定的條件之行進方向係方向θ成為arcsin(Xref/Z)的行進方向。移動機器人30係若至標誌11'-1為止的距離Z較預先被規定的切換閾值更近,則將目標切換至標誌11'-2而進行移動。將自移動機器人30的距離為較切換閾值更近的範圍稱為切換範圍。
其次,參照圖6,對本實施例之移動機器人30之具體構成例進行說明。此處,圖6係表示本實施例之移動機器人之構成例之方塊圖。本實施例之移動機器人30係具備有驅動部31、標誌檢測部22、及控制部27。
驅動部31係具備有驅動輪32、33、馬達34、35、及馬達控制部36。驅動輪32係相對於移動機器人30之行進方向而配備於左側。驅動輪33係相對於移動機器人30之行進方向而配備於右側。馬達34係配合馬達控制部36之控制而使驅動輪32旋轉。馬達35係根據馬達控制部36之控制而使驅動輪33旋轉。馬達控制部36係基於自控制部27所輸人之對於馬達34、35之各者的角速度指令值,對馬達34、35供給電力。
藉由使馬達34、35以與自馬達控制部36所供給之電力對應的角速度進行旋轉,而移動機器人30進行前進或後退。又,藉由使馬達34、35之角速度產生差異,而使移動機器人30之行進方向進行變更。例如,於前進時,藉由使左側之驅動輪32之角速度大於右側之驅動輪33之角速度,而使移動機器人30一面右迴轉,一面移動。又,藉由使驅動輪32、33各者朝相反方向進行旋轉,而移動機器人30係不改變位置而進行迴轉。再者,移動機器人30亦可具有驅動輪32、33以外之車輪而用以使移動機器人30之姿勢穩定。
標誌檢測部22係具備有照射部23、2個攝像部24、25、及運算部26。
照射部23係例如安裝於移動機器人30之前面之中央位置,可對標誌11'照射紅外LED光,且用以使得自標誌11'側所反射的反射光藉由2個攝像部24、25讀取。由於自照射部23所照射的紅外LED光即便於工廠內等之暗處、可見光較強之場所等亦可進行標誌11之拍攝,故而較佳。
2個攝像部24、25係藉由配置於標誌檢測部22之左右的2個相機所構成。攝像部24係安裝於移動機器人30之前面之左側,檢測並拍攝自位於移動機器人30之前面側的標誌11'所反射的紅外LED光。攝像部25係安裝於移動機器人30之前面之右側,檢測並拍攝自位於移動機器人30之前面側的標誌11'所反射的紅外LED光。攝像部24、25係相對於通過移動機器人30之中心的正面方向之直線而對稱地安裝於移動機器人30之殼體。對於攝像部24、25而使用例如組合有紅外線濾波器的相機。該等2個攝像部
24、25係可藉由在將自照射部23所照射之紅外LED光照射至構成標誌11'的白色單元12a及黑色單元12b之後,利用2個相機拍攝自白色單元12a所反射之光而獲得攝像資料的構成部位。將使用2個攝像部24、25而所獲得的攝像資料發送至運算部26。
運算部26係基於自2個攝像部24、25所發送的攝像資料進行二值化處理,從而形成由白黑所成的二值化影像資料,進而使用經被二值化的影像資料進行藉由三角測量所進行之運算,藉此可算出標誌11'相對於移動機器人30位於何種之距離(距離Z)及方向(角度θ)。運算部26係於藉由攝像部24、25所拍攝之影像中包含有複數個標誌11'之情形時,檢測標誌ID而選擇作為目標的標誌11',算出至作為目標的標誌11'為止之距離Z及角度θ。標誌ID之檢測係藉由針對標誌11'而取得在設有1列之ID資訊賦予位置B2上所被設定的資訊而進行。運算部26係將包含有所算出之距離Z及方向θ、以及標誌ID之標誌資訊輸出至控制部27。所被算出的距離Z係自連結攝像部24與攝像部25之線段上之中心的距離。若以連結攝像部24與攝像部25之線段為相對於移動機器人30之行進方向而正交之方式安裝有攝像部24、25,則可減輕在運算部26中之運算負載。
控制部27係基於自標誌檢測部22所取得的標誌資訊,控制驅動部31。圖7係表示本實施例之控制部之構成例之方塊圖。本實施例之控制部27係具備有移動路徑記憶部27a、標誌選擇部27b及驅動控制部27c。於移動路徑記憶部27a中,預先記憶有包含關於沿移動機器人30之移動路徑所配置之複數個標誌11'之屬性資訊的表格。標誌選擇部27b係基於記憶於移動路徑記憶部27a
的表格,將作為目標的標誌11'之標誌ID輸出至標誌檢測部22。標誌選擇部27b係基於自標誌檢測部22所輸入的標誌資訊,判定是否切換作為目標的標誌11'。標誌選擇部27b係於切換作為目標的標誌11'之情形時,自表格選擇作為現在之目標的標誌11'之下一之標誌11'。
驅動控制部27c係基於自標誌檢測部22所輸出的標誌資訊,自被記憶於移動路徑記憶部27a的表格而讀出屬性資訊及控制資訊。屬性資訊係關於作為目標的標誌11'之資訊。控制資訊係表示與作為目標的標誌11'相關聯之控制的資訊。與標誌11'相關聯的控制係例如為表示行進方向之變更的於標誌11'之附近進行迴轉的控制等。驅動控制部27c係基於標誌資訊、屬性資訊及控制資訊,而驅動控制驅動部31。
圖8係表示本實施例之於移動路徑記憶部所記憶之表格之一例的圖。表格係具備有「標誌ID」、「通路距離」、「設置側」、「方向轉換」、及「最終標誌」之項目之行。各列係在每個標誌11'上所存在的屬性資訊。表格中之各列係以移動機器人30沿移動路徑進行移動時所通過之標誌11'之順序而進行排列。於「標誌ID」之行中,包含有與列所對應之標誌11'的標誌ID。於「通路距離」之行中,包含有表示與列對應的標誌11'與移動機器人30之移動路徑為隔開多少距離的距離資訊。通路距離係設定為正值之值,且為表示自成為對象之標誌11'至移動機器人30之移動路徑為止之距離的值。又,該實施例中,通路距離係表示自標誌11'至移動機器人30之移動路徑中之位於相對於移動方向而大致正交之方向的目標地點為止的距離。
「設置側」之行係包含有表示於移動機器人30沿移動路徑移動之情形時,與列對應的標誌11'為配置於移動機器人30之右側或左側中之哪一側的資訊。「方向轉換」之行係包含有於移動機器人30相對於與列對應之標誌11'而接近至預先被規定的距離或切換閾值時,表示移動機器人30之行進方向之變更的旋轉資訊。於旋轉資訊為0(零)度之情形時,表示移動機器人30之行進方向無變更。於旋轉資訊為0度以外之情形時,以旋轉資訊所示之角度量,使移動機器人30之行進方向朝順時針方向或逆時針方向變更。「最終標誌」之行係包含有表示與列對應之標誌11'是否為表示移動路徑中之目標地點的標誌11'之資訊。於圖8所示之表格中,例如具有標誌ID「M」的標誌11'係表示目標地點之標誌。於該例之情形時,表示目標地點的標誌11'為1個。
圖9係表示本實施例之驅動控制部中之基於標誌資訊之控制之構成例的方塊圖。驅動控制部27c係具備有通過位置運算部27c1、修正角運算部27c2、及指令值運算部27c3。通過位置運算部27c1係輸入於標誌資訊所包含有之至標誌11'為止的距離Z及方向θ。通過位置運算部27c1係基於距離Z及方向θ,而算出以現在之移動機器人30之行進方向進行移動而最接近標誌11'時之至標誌11'為止的距離x、及至最接近標誌11'為止的移動距離y。移動機器人30最接近至標誌11'時之位置係相對於自移動機器人30之位置起沿行進方向延伸之移動直線而正交之直線即為通過標誌11'之位置的直線而與移動直線的交點。距離x係以(Z.sinθ)之方式而獲得。移動距離y係以(Z.cosθ)之方式而獲得。距離x亦稱為標誌通過距離。又,移動距離y亦稱為至標誌側面為止的距離。
修正角運算部27c2係輸入自通路之邊界至移動路徑為止的距離Xref減去距離x所獲得的差量△X、及移動距離y。修正角運算部27c2係基於差量△X及移動距離y而算出相對於移動機器人30之行進方向的修正角△θ。具體而言,修正角運算部27c2係將利用arctan(△X/y)所獲得的值,設為修正角△θ。
指令值運算部27c3係輸入有平移速度指令值Vref、角速度指令值ωref、角速度之測定值ωl'、ωr'、及修正角△θ。平移速度指令值Vref係對於移動機器人30之平移速度的指令值(目標值)。角速度指令值ωref係以行進方向為基準而向順時針方向或逆時針方向變更行進方向時之角速度。角速度指令值ωref既可將順時針方向之變化量規定為正值,亦可將逆時針方向之變化量規定為正值。角速度之測定值ωl'、ωr'係藉由設置於馬達34、35各者之編碼器所測定的角速度。指令值運算部27c3係基於平移速度指令值Vref、角速度指令值ωref、角速度之測定值ωl'、ωr'及修正角△θ,一面使移動機器人30以平移速度指令值Vref及角速度指令值ωref移動,一面算出使行進方向變更修正角△θ的角速度指令值ωl、ωr。指令值運算部27c3係將所算出之角速度指令值ωl、ωr輸出至驅動部31。
圖10係表示在本實施例之驅動控制部中所被算出之修正角△θ之圖。藉由標誌檢測部22檢測被配置於邊界40-1上的標誌11',而獲得自移動機器人30至標誌11'為止之距離Z、及以移動機器人30之行進方向為基準而標誌11'所位在的方向θ。通過位置運算部27c1係根據距離Z及方向θ而算出距離x及移動距離y。移動機器人30係為了通過自沿移動路徑所配置之標誌11'離開一定
之距離Xref的位置Ppass,必須變更行進方向。位置Ppass係基於標誌11'之屬性資訊中之表示「設置側」的資訊而規定。圖10係表示標誌11'被設定於移動路徑之左側的情形。
於圖10所示之例中,若一直維持現在之行進方向之狀態而移動機器人30進行移動,則移動機器人30通過自位置Ppass離開差量△X的位置。因此,修正角運算部27c2係基於差量△X及移動距離y,算出相對於行進方向的修正角△θ。指令值運算部27c3係一面使移動機器人30以平移速度指令值Vref及角速度指令值ωref移動,一面算出用以使行進方向朝逆時針方向變更修正角△θ量的角速度指令值ωl、ωr,而控制驅動部31。如此,藉由使驅動控制部27c控制驅動部31,可使移動機器人30於被規定在與通路之邊界40-1隔開一定之距離Xref之位置的移動路徑上移動。
再者,於圖10所示之例中,對標誌11'配置於邊界40-1上之情形進行了說明。但是,於在邊界40上無法配置標誌11'之情形時,將標誌11'所被配置之位置與邊界40的差量作為通路距離(D1、D2、…、DM)而記憶於表格。於該情形時,修正角運算部27c2係於算出修正角△θ時,使用通路距離而修正距離Xref或差量△X中之任一者。
若藉由以上所說明之驅動控制方法使移動機器人30沿移動路徑而進行移動,則最終移動機器人30接近至具有目標位置之標誌ID「M」的標誌11',並執行停止控制。
其次,使用圖11對本實施例之移動機器人30之控制系統中之具體的處理內容進行說明。圖11係表示進行本實施例之控制部所進行之控制處理內容之流程圖。
若移動機器人30開始移動,則首先,先執行於上述之實施形態中使用圖3所說明的影像處理步驟(步驟α)。藉由該影像處理步驟(步驟α)之執行,運算部26係取得在標誌11'上所設定之ID資訊,並發送至控制部27。本實施例中之ID資訊係用以唯一地識別各標誌11'的標誌ID。於接收了標誌ID的控制部27中,判定是否能檢測出在初始狀態所被設定之標誌ID(步驟S201)。於初始狀態下,標誌選擇部27b係將表格之最初列中所記憶之標誌ID選擇為作為目標之標誌11'的標誌ID。
於無法檢測出標誌11'之情形時(步驟S201之否),控制部27係輸出表示無法檢測出標誌11'的錯誤信號。驅動控制部27c係配合錯誤信號,使驅動部31停止驅動輪32、33(步驟S221)。標誌選擇部27b係配合錯誤信號,將表示無法檢測出標誌11'的錯誤資訊輸出至外部(步驟S222),從而使移動控制處理結束。再者,錯誤資訊之輸出係使用在移動機器人30所具備有之輸出裝置例如揚聲器、顯示器而進行。
於步驟S201中,於能檢測出標誌11'之情形時(步驟S201之是),標誌選擇部27b及驅動控制部27c係自標誌檢測部22之運算部26而取得標誌資訊(步驟S202)。標誌選擇部27b係基於表格而判定由標誌資訊所表示之標誌11'是否為最終標誌(步驟S203)。
於步驟S203中,於標誌11'為最終標誌之情形時(步驟S203之是),驅動控制部27c係判定至由標誌資訊所表示之標誌11'為止的距離Z是否為切換範圍內(步驟S231)。於至標誌11'為止的距離Z為切換範圍內之情形時(步驟S231之是),驅動控制部27c
係使驅動部31停止驅動輪32、33(步驟S232),從而使移動控制處理結束。
於步驟S231中,於至標誌11'為止的距離Z並非為切換範圍內之情形時(步驟S231之否),驅動控制部27c係使處理進行至步驟S208。
於步驟S203中,於標誌11'並非為最終標誌之情形時(步驟S203之否),驅動控制部27c係判定至由標誌資訊所表示之標誌11'為止的距離Z是否為切換範圍內(步驟S204)。於至標誌11'為止的距離Z並非為切換範圍內之情形時(步驟S104之否),驅動控制部27c係使處理進行至步驟S208。
於步驟S204中,於至標誌11'為止的距離Z為切換範圍內之情形時(步驟S204之是),驅動控制部27c係基於表格而判定標誌11'之屬性資訊中是否具有方向轉換之指示(步驟S205)。於無方向轉換之指示之情形時(步驟S205之否),驅動控制部27c係使處理進行至步驟S207。
於具有方向轉換之指示之情形時(步驟S205之是),驅動控制部27c係自表格取得標誌11'之旋轉資訊,並對驅動部31進行使移動機器人30之行進方向進行旋轉資訊所示之角度變更的控制(步驟S206)。標誌選擇部27b係自表格取得作為現在目標之標誌11'之下一而作為目標之標誌11'的標誌ID。標誌選擇部27b係將所取得之標誌ID之標誌11'輸出至標誌檢測部22,藉此將所取得之標誌ID之標誌11'選擇為新的目標(步驟S207),並使處理返回至影像處理步驟(步驟α)。
於步驟S208中,修正角運算部27c2係判定基於自標
誌檢測部22所取得的標誌資訊而所算出的差量△X是否為容許範圍內(步驟S208)。對於差量△X的容許範圍係基於對於移動機器人30而所被要求的移動之精度、在標誌檢測部22中之標誌11'之檢測之精度、馬達34、35之控制的精度等而預先被規定。於差量△X並非為容許範圍內之情形時(步驟S208之否),修正角運算部27c2係基於差量△X而算出修正角△θ(步驟S209)。於差量△X為容許範圍內之情形時(步驟S208之是),修正角運算部27c2係將修正角△θ設為0(步驟S210)。
指令值運算部27c3係取得驅動驅動輪32、33的馬達34、35各者之角速度的測定值ωl'、ωr'(步驟S211)。指令值運算部27c3係基於平移速度指令值Vref、角速度指令值ωref、角速度之測定值ωl'、ωr'、及修正角△θ,而算出對於馬達34、35的角速度指令值ωl、ωr(步驟S212)。指令值運算部27c3係將角速度指令值ωl、ωr輸出至驅動部31(步驟S213),並使處理返回至影像處理步驟(步驟α)。
藉由控制部27而進行包含有以上所說明之影像處理步驟(步驟α)至步驟S232為止之各處理的控制處理,藉此可逐次取得至標誌11'為止之距離Z及方向θ,並對行進方向進行修正。藉由以此種控制處理修正行進方向,移動機器人30係可於與邊界40隔開一定之距離Xref的移動路徑上移動,可削減基於複數個標誌11'而進行移動時之移動距離。
又,根據上述之本實施例之移動機器人30之控制系統,即便於採用無需較廣之設置場所之相對小型之標誌11'之情形時,亦可精度良好地進行其之識別及距離計測。進而,根據上述之
本實施例之移動機器人30之控制系統,可成為廉價之系統構成,故而可提供一種通用性較高之移動機器人之控制系統。
以上,對本發明之較佳之實施例進行了說明,但本發明之技術性範圍並不限定於上述實施例所記載之範圍。於上述實施例中,可施加多種變更或改良。
例如,圖12及圖13係表示在移動機器人所移動之通路存在有交叉點之情形時之標誌之配置例的圖。此處,圖12係表示於自移動機器人30觀察而在交叉點遠方側之2個角設置有標誌11'-m、11'-(m+1)之例。如圖12所示,於配置有2個標誌11'-m、11'-(m+1)之情形時,移動機器人30亦可移動至到2個標誌11'-m、11'-(m+1)為止之距離Z、Z'各者處於切換範圍內的位置,並藉由旋轉資訊所示之角度之迴轉而進行行進方向之變更。又,圖13係表示於自移動機器人30觀察而交叉點遠方側之2個角中之行進方向之變更目標側之1個角設置有標誌11'-m之例。如圖13所示,於設置有標誌11'-m之情形時,移動機器人30亦可移動至到1個標誌為止之距離Z處於切換範圍內的位置,並藉由以旋轉資訊所示之角度之迴轉而進行行進方向之變更。
又,例如,於上述之實施例中,對於標誌11'僅預先賦予有用以唯一地識別各標誌11'的標誌ID而來作為ID資訊,關於用以使移動機器人30進行動作之其他的指令,表示了構成為圖8所示之於移動路徑記憶部27a所記憶之表格之例。然而,關於用以使移動機器人30進行動作的指令資訊,亦可使標誌具有全部之指令資訊。例如,圖14係表示對標誌賦予了全部之指令資訊之情形時之本發明之移動機器人之控制系統之構成例的圖。於圖
14所示之構成例之情形時,標誌11"可除了包含用以唯一地識別各標誌11"之標誌ID以外,還包含圖8所示之「通路距離」、「設置側」、「方向轉換」、「最終標誌」等之指令資訊。再者,由於要使對標誌11"賦予之ID資訊之量增加,僅使ID資訊賦予位置B2之列數增加即可,故而可一面儘可能抑制標誌本身之大小之增大,一面使資訊量增加,從而無需在工廠內、物流倉庫等之現場中之較廣之設置場所。因此,亦不會產生對現場作業造成障礙等問題。又,藉由使每個標誌11"具有對於移動機器人30之全部之動作指令資訊,可使系統構成變得簡易。進而,由於只要變更圖14所示之標誌11"之設置位置,則可簡單地變更移動機器人30之移動路徑,故而與習知技術相比,可實現通用性較高之低成本系統。
又,例如,關於圖14所示之構成例,可例示進一步之變形形態。因此,使用圖15~圖18,對變形形態之移動機器人30之控制系統進行說明。圖15係表示變形形態中所使用之標誌之具體例之圖。又,圖16係表示變形形態之於移動路徑記憶部所記憶之表格之一例之圖。進而,圖17係表示在移動機器人所移動之通路上配置有變形形態中所使用之標誌之一例、及變形形態之移動機器人之控制系統之動作例的圖。又,進而,圖18係表示變形形態之藉由攝像部所拍攝之攝像資料之一例的圖。
於本變形形態中,預先針對每個標誌ID決定標誌111之單元配置。即,如圖15所示之例般,例如,關於標誌ID被設定為「0(零)」的標誌111-0,於中央位置以1列所設定之ID資訊賦予位置B2係以「黑、黑、黑」之順序配置有單元12,若利用二進位碼表現其等則可表示為「0、0、0」。與該標誌111-0同樣地,關於
標誌ID以「1」被設定的標誌111-1,ID資訊賦予位置B2係以「黑、黑、白」之順序配置有單元12,若以二進位碼表現則可表示為「0、0、1」,關於標誌ID以「2」被設定的標誌111-2,ID資訊賦予位置B2係以「黑、白、黑」之順序配置有單元12,若利用二進位碼表現則可表示為「0、1、0」,關於標誌ID以「3」被設定的標誌111-3,ID資訊賦予位置B2係以「黑、白、白」之順序配置有單元12,若利用二進位碼表現則可表示為「0、1、1」,關於標誌ID以「4」被設定的標誌111-4,ID資訊賦予位置B2係以「白、黑、黑」之順序配置有單元12,若利用二進位碼表現則可表示為「1、0、0」。
於圖15所示之標誌111中,設定有針對每個標誌ID之動作指令。該指令內容設定為圖16所示之表格。變形形態之表格係具備有「標誌ID」、「動作」、「標誌距離」、「旋轉」、及「平移距離」之項目之行。各列係標誌111上所設定之每個標誌ID中所存在之屬性資訊。表格中之各列係按標誌ID之數字順序進行排列,但於本變形形態中,該排列順序並無意義。「標誌ID」之行中包含有與列對應之標誌111之標誌ID。「動作」之行包含有與列對應之標誌111、及移動機器人30之動作內容。「標誌距離」之行包含有與列對應之標誌111、及表示使移動機器人30相對於該標誌111離開多少距離而移動的距離資訊。標誌距離係設定為正值之值,且為表示自成為對象之標誌111至移動機器人30之移動路徑為止之距離之值。又,該變形形態例中之標誌距離係表示標誌111設置於通路之左側,移動機器人30應相對於位於該通路之左側之標誌111向右側保留多少距離而移動。
「旋轉」之行係包含有表示移動機器人30於旋轉動作
時應以多少角度旋轉、或者移動機器人30於停止時應迴轉多少角度的資訊。又,「旋轉」之行亦包含有旋轉之方向為左右中之哪一者的資訊。「平移距離」之行係包含有於移動機器人30相對於與列對應之標誌111而接近至預先被規定之距離或切換閾值時,移動機器人30進一步繼續平移的距離資訊。於本變形形態例中,例如如圖17所示般,若移動機器人30相對於最初所被選擇之標誌111-2而接近至預先被規定之既定距離,則切換為相對於移動機器人30位於標誌111-2之後較近之位置的標誌111-3。但是,以如下方式設定,即,於進行該切換之瞬間,並非切換為於換後之標誌111-3所設定之表格之動作指令,而是針對於切換前之標誌111-2進行平移動作,並基於於切換後之標誌111-3所設定之表格之動作指令而執行動作。藉由進行此種標誌111之切換控制及移動機器人30之動作控制,從而實現順利之動作控制。
以上所說明之標誌111之具體配置例係表示於圖17。再者,本變形形態中所使用之標誌111-0~4係以與移動機器人30面對面之方式設置者,於圖17中,為了方便說明,以紙面上側成為標誌111-0~4之上方側之方式顯示。
於本變形形態之情形時,針對複數個標誌111-0~4之各者設定有標誌ID,針對每個該標誌ID預先藉由表格設定有動作指令資訊。因此,本系統之使用者只要以與移動機器人30之移動路徑對應之方式配置複數個標誌111-0~4即可。具體而言,於圖17所示之例中,假定了設定如下等動作,即,使移動機器人30自位於紙面之左側之開始位置朝向紙面右側直行,於在最初之交叉點右轉之後直行,其次沿遇到之左轉路徑左轉之後直行,並於最終之
停止位置右迴轉180度而變更移動機器人30之朝向並使其停止。於該情形時,為了使移動機器人30自最初之開始位置朝向紙面右側直行,將「標誌ID」為「2」之標誌111-2配置於最初之直線路徑之通路左側,其次為了於最初之交叉點右轉,將「標誌ID」為「3」之標誌111-3配置於交叉點之近前左側,其次為了於交叉點之右轉後直行,將「標誌ID」為「2」之標誌111-2配置於右轉後之直線路徑之通路左側,其次為了沿遇到之左轉路徑左轉,將「標誌ID」為「4」之標誌111-4配置於左轉路徑之近前左側,最後為了於左轉路徑之左轉後直行,並於最終之停止位置右迴轉180度而變更移動機器人30之朝向並使其停止,將「標誌ID」為「1」之標誌111-1配置於最後之直線路徑之通路左側且為停止位置附近。
於如以上般配置標誌111之情況,對用以實現假定之移動路徑中之移動機器人30之移動之控制內容進行說明。於本變形形態中,於路徑上設置有複數個之標誌111係以離地高度成為相同之方式設置。另一方面,移動機器人30所具備有之2個攝像部24、25係以成為較標誌111所被設置之離地高度更低之位置之方式構成。因此,關於藉由2個攝像部24、25所拍攝之攝像資料,係與移動機器人30之距離較近之標誌111位於攝像資料之上側,並且作為佔據更廣範圍之反射光而表示於攝像資料上。另一方面,與移動機器人30之距離較遠之標誌111係位於攝像資料之下側,並且作為佔據更窄之範圍之反射光而表示於攝像資料上。具體而言,於使移動機器人30自位於圖17中之紙面左側之開始位置朝向紙面右側直行之情形時,移動機器人30所具備有之2個攝像部24、25係拍攝近前側之標誌111-2、及裏側之標誌111-3。該情形時之攝像
資料係示於圖18,攝像資料之左下角所示之光之圖案係表示近前側之標誌111-2,其右下側以較窄範圍所示之光之圖案係表示裏側之標誌111-3。再者,該攝像資料係表示於工廠之建築物內使移動機器人30進行動作之情形之例,於攝像資料內映現為複數個細長之長方形之光者係設置於工廠內之天花板之螢光燈。
若使用圖18所示之攝像資料,執行圖2及圖3等所示之處理,則由運算部26辨識出近前側之標誌111-2之標誌ID即「2」、及裏側之標誌111-3之標誌ID即「3」。又,此時,自表格而選擇攝像資料上最上方位置所示之標誌111-2之標誌ID即「2」以作為移動機器人30應實施動作之指令資訊。因此,獲得圖18所示之攝像資料之移動機器人30係按照圖16所示之表格之標誌ID「2」,基於「動作」直行、「標誌距離」右1m、「旋轉」0度、「平移距離」1m之動作指令並由驅動部31接受動作指令,而移動至稍微超過標誌111-2之位置。再者,若移動機器人30相對於現在所選擇之標誌111-2而接近至預先被規定之既定距離,則切換為相對於移動機器人30位於標誌111-2之後較近之位置的標誌111-3。但是,於進行該切換之瞬間,並非切換為於切換後之標誌111-3所設定之表格之動作指令,而是針對於切換前之標誌111-2進行平移動作,並執行基於於切換後之標誌111-3所設定之表格之動作指令的動作。
藉由執行以上所說明之動作控制,而執行沿圖17所示之移動路徑之移動機器人30之移動動作。再者,於本變形形態中,於路徑上設置有複數個之標誌111係以離地高度成為相同之方式設置,另一方面,移動機器人30所具備有之2個攝像部24、25
係以成為較標誌111所被設置之離地高度更低之位置之方式構成。但是,於本發明中,於被檢測體設置有複數個之情形時,運算部只要以如下方式設置即可,即,當在藉由利用2個相機拍攝自作為第一單元之白色單元12a所反射之光的攝像部所拍攝之攝像資料內確認出複數個表示作為被檢測體之標誌之光時,選擇位於距檢測部最近之位置之被檢測體,並檢測所被選擇之該被檢測體之ID資訊賦予位置上所設定之ID資訊。又,藉由運算部所進行之位於距檢測部最近之位置之作為被檢測體之標誌的選擇係只要設為根據檢測部與所選擇之該標誌之距離而判斷即可。因此,於以在路徑上設置有複數個之標誌111之離地高度成為相同之方式設置,並且移動機器人30所具備有之2個攝像部24、25成為較標誌111所設置之離地高度更高之位置之情形時,藉由2個攝像部24、25所拍攝之攝像資料,係與移動機器人30之距離較近之標誌111位於攝像資料之下側,並且作為佔據更廣範圍之反射光而表示於攝像資料上。另一方面,與移動機器人30之距離較遠之標誌111係位於攝像資料之上側,並且作為佔據更窄範圍之反射光而表示於攝像資料上。即,可根據標誌111之離地高度與2個攝像部24、25之位置關係,並基於攝像資料上所示之光之位置或大小,進行藉由運算部所進行之位於距檢測部最近之位置之作為被檢測體之標誌之選擇。藉由採用此種構成,根據本發明,可廉價地實現移動機器人之控制系統。
以上,使用圖15~圖18,對變形形態之移動機器人30之控制系統進行了說明。於上述變形形態中,例示了使用標誌111作為被檢測體之情形,但相對於該變形形態,亦可使用發送基於既定之規則的信號之信標作為被檢測體。於該情形時,由於信標
以數msec單位進行發光信號之ON.OFF,故而2個攝像部24、25係拍攝與信標之發光信號對應之複數張攝像資料,並根據該等複數張攝像資料以時間序列確認發光信號之ON.OFF狀態,藉此可與上述之標誌111同樣地,檢測每個信標之ID資訊。
即,本發明之影像處理裝置係具備如下構件之影像處理裝置,即:被檢測體,其包含發送基於既定之規則之信號的信標;及檢測部,其接收自上述被檢測體所發送之信號,並基於所接收之信號取得於上述被檢測體所設定之信號資訊;且上述影像處理裝置可以如下方式構成,即,於設置有複數個上述被檢測體之情形時,上述檢測部係基於自複數個被檢測體所獲得之信號資訊,選擇位於距上述檢測部最近之位置之被檢測體,並檢測於所選擇之該被檢測體所設定之ID資訊。
又,本發明之移動機器人之控制系統係具備有:驅動部,其變更移動機器人之移動速度及行進方向;檢測部,其檢測沿至目標地點為止之移動路徑而所配置之複數個被檢測體;及控制部,其基於於藉由上述檢測部所檢測出之上述被檢測體所設定之ID資訊而對上述驅動部進行驅動控制;且上述被檢測體係送基於既定之規則之信號的信標所構成,且上述檢測部可以如下方式構成,即,於設置有複數個上述被檢測體之情形時,基於自複數個被檢測體所獲得之信號資訊,選擇位於距上述檢測部最近之位置之被檢測體,並檢測於所選擇之該被檢測體所設定之ID資訊。
進而,本發明之移動機器人之控制方法係如下之移動機器人之控制方法,即,具備:驅動部,其變更移動機器人之移動速度及行進方向;檢測部,其檢測沿至目標地點為止之移動路徑而
所配置之複數個被檢測體;及控制部,其取得於藉由上述檢測部所檢測出之上述被檢測體所設定之ID資訊;且上述被檢測體係發送基於既定之規則之信號的信標所構成,上述檢測部係於設置有複數個上述被檢測體之情形時,基於自複數個被檢測體所獲得之信號資訊,選擇位於距上述檢測部最近之位置之被檢測體,並檢測於所選擇之該被檢測體所設定之ID資訊,且上述移動機器人之控制方法可使上述控制部基於位於距上述檢測部最近之位置之被檢測體之ID資訊而對上述驅動部進行驅動控制。
以上,對本發明之較佳之實施例及變形形態例進行了說明,但本發明之技術性範圍並不限定於上述實施例及變形形態例中記載之範圍。於上述實施例及變形形態例中,可施加多種變更或改良。
例如,於本實施例中,對如下動作進行了說明,即,標誌檢測部22之運算部26係分別算出所檢測出之所有標誌11'之標誌資訊,並將所算出之各標誌資訊輸出至控制部27。於該情形時,控制部27之標誌選擇部27b係基於自標誌選擇部27b輸出之指示,自複數個標誌資訊而選擇目標標誌11'之標誌資訊者。然而,關於標誌檢測部22,亦可採用以檢測自標誌選擇部27b所輸入之標誌ID之標誌11'之方式實施動作之構成。於本發明之影像處理裝置及移動機器人之控制系統中,可於能獲得與上述之實施形態及實施例中所實現者相同之作用效果之範圍中,採用各種構成及動作順序之變形形態。
又,例如,上述移動機器人30亦可於內部具備有電腦系統。於該情形時,進行移動機器人30所具備有之控制部27的
處理之過程係以程式之形式記憶於電腦能夠讀取之記錄媒體,藉由使電腦讀出並執行該程式,而進行各功能部之處理。此處,所謂電腦能夠讀取之記錄媒體係指磁碟、磁光碟、唯讀光碟(CD-ROM,Compact Disc-Read Only Memory)、唯讀數位多功能光碟(DVD-ROM,Digital Versatile Disc-Read Only Memory)、半導體記憶體等。又,亦可設為藉由通信線路將該電腦程式配發至電腦,並使接受該配發之電腦執行該程式。
又,例如,關於上述之實施形態及實施例所示之標誌11、11'、11"中之白色單元12a及黑色單元12b之配置構成僅表示一例。本發明中能夠應用之標誌中之白色單元12a及黑色單元12b之配置之組合可採用任何圖案構成。尤其是,無需使檢測開始位置B1及檢測結束位置B3處之白色單元12a及黑色單元12b之配置之組合係兩者為相同,可採用預先針對各者所決定之圖案構成。
再者,上述實施例係作為示例而提出者,並不意圖限定發明之範圍。該等新穎之實施例可以其他各種形態實施,可於不脫離發明之主旨之範圍內,進行各種省略、替換、及變更。該等實施例或其變形係包含於發明之範圍或主旨,並且包含於申請專利範圍所記載之發明及其均等之範圍內。
根據申請專利範圍之記載可明確得知施加有此種變更或改良之形態亦可被包含於本發明之技術性範圍內。
Claims (12)
- 一種影像處理裝置,其特徵在於,其具備有:被檢測體,其係於二維平面上,將由正方形或長方形所形成的單元、即可反射所被照射之光的第一單元及無法反射所被照射之光的第二單元,進行a×a、或a×b(其中,a、b=3、4、5、6、…)之矩陣配置而所構成;以及檢測部,其具備有:照射部,其照射光;攝像部,其於將自上述照射部所照射之光照射至構成上述被檢測體的上述第一單元及上述第二單元之後,利用相機拍攝自上述第一單元所被反射之光;及運算部,其基於藉由上述攝像部所拍攝之攝像資料,而取得於上述被檢測體所設定之資訊。
- 如請求項1之影像處理裝置,其中,上述被檢測體係以如下之方式所構成:將構成矩陣配置之第1列或第1行之複數個上述單元設為檢測開始位置;將構成矩陣配置之最終列或最終行之複數個上述單元設為檢測結束位置;將構成位於上述檢測開始位置與上述檢測結束位置之間的1個或複數個列或行之複數個上述單元,設為1個或複數個ID資訊賦予位置;且上述檢測部所具備有之上述攝像部或上述運算部係設為:對藉由上述攝像部所拍攝之攝像資料進行二值化處理,針對藉由該二值化處理所獲得之二值化影像於水平方向或垂直方向進行掃描上述檢測開始位置而藉此算出上述單元之二值化影像上之尺寸,算出所被 算出之尺寸之倍數位置上所存在的1個或複數個上述ID資訊賦予位置及上述檢測結束位置之二值化影像上之座標,並基於該座標對1個或複數個上述ID資訊賦予位置及上述檢測結束位置分別進行1次掃描,藉此取得於1個或複數個上述ID資訊賦予位置所設定之ID資訊。
- 如請求項2之影像處理裝置,其中,藉由上述檢測部所具備有之上述攝像部或上述運算部而所進行之對於上述檢測開始位置、1個或複數個上述ID資訊賦予位置、及上述檢測結束位置的掃描係以上述檢測開始位置、上述檢測結束位置、1個或複數個上述ID資訊賦予位置之順序進行。
- 如請求項2或3之影像處理裝置,其中,上述運算部係於藉由利用2個相機拍攝自上述第一單元所被反射之光的上述攝像部而所拍攝之攝像資料存在有複數個之時,基於所取得之ID資訊,選擇在現在時點所採用之被檢測體。
- 如請求項2或3之影像處理裝置,其中,上述運算部係設為:於上述被檢測體設置有複數個之情形時,當在藉由利用2個相機拍攝自上述第一單元所被反射之光的上述攝像部而所拍攝之攝像資料內,被確認有複數個表示上述被檢測體的光之時,選擇位於距上述檢測部最近之位置之被檢測體,並檢測於所被選擇之該被檢測體之上述ID資訊賦予位置所設定之ID資訊。
- 如請求項5之影像處理裝置,其中,藉由上述運算部所進行之位於距上述檢測部最近之位置之被檢測體的選擇係根據上述檢測部與所被選擇之該被檢測體的距離而進行判斷。
- 如請求項6之影像處理裝置,其中,設置有複數個之上述被檢測體之離地高度係被設定為相同,上述運算部進行位於距上述檢測部最近之位置之被檢測體之選擇的判斷係基於於藉由上述攝像部所拍攝之攝像資料內所存在之表示上述被檢測體的複數個光之位置或大小而進行。
- 一種移動機器人之控制系統,其特徵在於,其具備有:驅動部,其變更移動機器人之移動速度及行進方向;檢測部,其檢測沿至目標地點為止之移動路徑而所配置之複數個被檢測體;及控制部,其取得藉由上述檢測部所檢測出之至上述被檢測體為止之距離及方向,算出至上述被檢測體為止之距離及方向為滿足預先被規定之關係的行進方向,並基於所算出之行進方向對上述驅動部進行驅動控制;上述被檢測體係構成為於二維平面上,將由正方形或長方形所形成的單元、即可反射所被照射之光的第一單元及無法反射所被照射之光的第二單元,進行a×g、或a×b(其中,a、b=3、4、5、6、…)之矩陣配置而成的標誌,且上述檢測部係具備有:照射部,其照射光;攝像部,其於將自上述照射部所照射之光照射至構成上述標誌的上述第一單元及上述第二單元之後,利用相機拍攝自上述第一單元所被反射之光;及運算部,其基於藉由上述攝像部所拍攝之攝像資料,算出與上述標誌之距離及方向。
- 一種移動機器人之控制方法,其係對如下之移動機器人之控制方法,即,具備有:驅動部,其變更移動機器人之移動速度及行進方向;檢測部,其檢測沿至目標地點為止之移動路徑而所配置之複數個被檢測體;及控制部,其取得藉由上述檢測部所檢測出之至上述被檢測體為止之距離及方向;上述被檢測體係構成為於二維平面上,將由正方形或長方形所形成的單元、即可反射所被照射之光的第一單元及無法反射所被照射之光的第二單元,進行a×a、或a×b(其中,a、b=3、4、5、6、…)之矩陣配置而成的標誌,且上述檢測部係具備有:照射部,其照射光;攝像部,其於將自上述照射部所照射之光照射至構成上述標誌的上述第一單元及上述第二單元之後,利用相機拍攝自上述第一單元所被反射之光;及運算部,其基於藉由上述攝像部所拍攝之攝像資料,算出與上述標誌之距離及方向;如此之移動機器人之控制方法,其特徵在於:使上述控制部算出至上述被檢測體為止之距離及方向為滿足預先被規定之關係的行進方向,並基於所算出之行進方向對上述驅動部進行驅動控制。
- 一種影像處理裝置,其係具備有如下之構件者,即:被檢測體,其由發送基於既定之規則之信號的信標所形成;及 檢測部,其接收自上述被檢測體所發送之信號,並基於所接收之信號而取得於上述被檢測體所設定之信號資訊;如此之影像處理裝置,其特徵在於:上述檢測部係設為:於設置有複數個上述被檢測體之情形時,基於自複數個被檢測體所獲得之信號資訊,選擇位於距上述檢測部最近之位置之被檢測體,並檢測於所被選擇之該被檢測體所設定之ID資訊。
- 一種移動機器人之控制系統,其特徵在於,其具備有:驅動部,其變更移動機器人之移動速度及行進方向;檢測部,其檢測沿至目標地點為止之移動路徑而所配置之複數個被檢測體;及控制部,其基於於藉由上述檢測部所檢測出之上述被檢測體所設定之ID資訊,對上述驅動部進行驅動控制;上述被檢測體係構成為發送基於既定之規則之信號的信標,上述檢測部係設為:於設置有複數個上述被檢測體之情形時,基於自複數個被檢測體所獲得之信號資訊,選擇位於距上述檢測部最近之位置之被檢測體,並檢測於所被選擇之該被檢測體所設定之ID資訊。
- 一種移動機器人之控制方法,其係對如下之移動機器人之控制方法,即,具備有:驅動部,其變更移動機器人之移動速度及行進方向;檢測部,其檢測沿至目標地點為止之移動路徑而所配置之複數個被檢測體;及控制部,其取得於藉由上述檢測部所檢測出之上述被檢測體所設 定之ID資訊;上述被檢測體係構成為發送基於既定之規則之信號的信標,且上述檢測部係設為:於設置有複數個上述被檢測體之情形時,基於自複數個被檢測體所獲得之信號資訊,選擇位於距上述檢測部最近之位置之被檢測體,並檢測於所被選擇之該被檢測體所設定之ID資訊,如此之移動機器人之控制方法,其特徵在於:使上述控制部基於位於距上述檢測部最近之位置之被檢測體之ID資訊,對上述驅動部進行驅動控制。
Applications Claiming Priority (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017227765 | 2017-11-28 | ||
JP2017-227765 | 2017-11-28 | ||
JP2018074860A JP2019102047A (ja) | 2017-11-28 | 2018-04-09 | 画像処理装置、移動ロボットの制御システム、移動ロボットの制御方法 |
JP2018-074860 | 2018-04-09 |
Publications (2)
Publication Number | Publication Date |
---|---|
TW201925724A true TW201925724A (zh) | 2019-07-01 |
TWI806933B TWI806933B (zh) | 2023-07-01 |
Family
ID=66977034
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
TW107142270A TWI806933B (zh) | 2017-11-28 | 2018-11-27 | 移動機器人之控制系統、移動機器人之控制方法 |
Country Status (5)
Country | Link |
---|---|
US (1) | US20200401158A1 (zh) |
JP (1) | JP2019102047A (zh) |
CN (1) | CN111417911B (zh) |
DE (1) | DE112018006048T5 (zh) |
TW (1) | TWI806933B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114008482A (zh) * | 2019-12-11 | 2022-02-01 | 计测技研株式会社 | 测量系统及测量方法 |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6760786B2 (ja) * | 2016-07-21 | 2020-09-23 | Thk株式会社 | 移動ロボット及び制御方法 |
US10078908B2 (en) * | 2016-08-12 | 2018-09-18 | Elite Robotics | Determination of relative positions |
JP6893230B2 (ja) * | 2019-09-26 | 2021-06-23 | ソフトバンク株式会社 | 受電装置、移動ロボット、システム、制御方法、及びプログラム |
JP7408334B2 (ja) | 2019-10-03 | 2024-01-05 | Thk株式会社 | 画像処理装置及び移動体制御システム |
DE112021003332T5 (de) * | 2020-06-23 | 2023-04-27 | Thk Co., Ltd. | System zur Verknüpfung eines autonomen Mobilroboters und autonomer Mobilroboter |
US11938960B1 (en) * | 2021-07-12 | 2024-03-26 | Amazon Technologies, Inc. | Systems and methods for controlling vehicles with navigation markers |
WO2023013052A1 (ja) * | 2021-08-06 | 2023-02-09 | ノリテックデザイン株式会社 | 自動走行体 |
Family Cites Families (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3340606B2 (ja) * | 1995-10-27 | 2002-11-05 | 新菱冷熱工業株式会社 | 移動ロボットの誘導方法と誘導システム |
JPH09307752A (ja) * | 1996-05-14 | 1997-11-28 | Oki Electric Ind Co Ltd | 画像分割方法、画像分割装置、文字認識装置 |
JP2000322574A (ja) * | 1999-05-10 | 2000-11-24 | Omron Corp | 画像認識装置 |
JP2002230564A (ja) * | 2001-01-29 | 2002-08-16 | Namco Ltd | 輪郭抽出装置、方法および輪郭抽出プログラム |
JP2004303137A (ja) * | 2003-04-01 | 2004-10-28 | Mitsubishi Heavy Ind Ltd | 自律走行型ロボットの特定位置誘導装置及び自律走行型ロボットの特定位置誘導制御方法 |
JP4262196B2 (ja) * | 2004-12-14 | 2009-05-13 | 本田技研工業株式会社 | 自律移動ロボット |
JP4319618B2 (ja) * | 2004-12-28 | 2009-08-26 | 株式会社東芝 | 移動ロボット装置 |
JP4300199B2 (ja) * | 2005-06-13 | 2009-07-22 | 株式会社東芝 | 移動ロボット、移動ロボットの位置姿勢算出方法、移動ロボットの自律走行システム |
JP2007010335A (ja) * | 2005-06-28 | 2007-01-18 | Fujitsu Ltd | 車両位置検出装置及びシステム |
JP5043133B2 (ja) * | 2007-03-13 | 2012-10-10 | リサーチ インスティチュート オブ インダストリアル サイエンス アンド テクノロジー | 移動ロボットの位置認識用ランドマーク、並びにこれを利用した位置認識装置及び方法 |
JP4487000B2 (ja) * | 2007-07-31 | 2010-06-23 | シャープ株式会社 | 画像処理装置、画像形成装置、画像処理方法、画像処理システム、画像処理プログラムおよびその記録媒体 |
WO2011013377A1 (ja) * | 2009-07-30 | 2011-02-03 | パナソニック株式会社 | 走行車およびベッド |
JP2011170486A (ja) * | 2010-02-17 | 2011-09-01 | Yashima Dengyo Co Ltd | 方向傾き検出装置、および搬送システム |
JP5755089B2 (ja) * | 2011-09-08 | 2015-07-29 | 株式会社Pfu | 画像処理装置、画像処理方法、画像処理プログラム及び画像処理システム |
JP2014021624A (ja) * | 2012-07-13 | 2014-02-03 | Sharp Corp | 自律走行装置、及び自律走行システム |
GB2513912B (en) * | 2013-05-10 | 2018-01-24 | Dyson Technology Ltd | Apparatus for guiding an autonomous vehicle towards a docking station |
JP6418961B2 (ja) * | 2015-01-28 | 2018-11-07 | シャープ株式会社 | 障害物検知装置、移動体、障害物検知方法、および障害物検知プログラム |
WO2016200792A1 (en) * | 2015-06-07 | 2016-12-15 | Barrows, Geoffrey, Louis | Localization method and apparatus |
JP2017120551A (ja) * | 2015-12-28 | 2017-07-06 | 株式会社リコー | 自律走行装置 |
US9908702B2 (en) * | 2016-02-05 | 2018-03-06 | Invia Robotics, Inc. | Robotic navigation and mapping |
US9513627B1 (en) * | 2016-04-25 | 2016-12-06 | inVia Robotics, LLC | Autonomous coordination of resources amongst robots |
US10725462B2 (en) * | 2016-04-25 | 2020-07-28 | Invia Robotics, Inc. | Optimizing robotic movements based on an autonomous coordination of resources amongst robots |
US10241514B2 (en) * | 2016-05-11 | 2019-03-26 | Brain Corporation | Systems and methods for initializing a robot to autonomously travel a trained route |
CN106595634A (zh) * | 2016-11-30 | 2017-04-26 | 深圳市有光图像科技有限公司 | 通过对比图像识别移动机器人的位置的方法及移动机器人 |
JP6475788B2 (ja) * | 2017-07-20 | 2019-02-27 | マツダエース株式会社 | 自動搬送装置 |
EP3929613A1 (en) * | 2020-06-22 | 2021-12-29 | Carnegie Robotics, LLC | A method for navigating a movable device along an inclined surface |
-
2018
- 2018-04-09 JP JP2018074860A patent/JP2019102047A/ja active Pending
- 2018-11-15 CN CN201880077035.1A patent/CN111417911B/zh active Active
- 2018-11-15 US US16/767,441 patent/US20200401158A1/en active Pending
- 2018-11-15 DE DE112018006048.9T patent/DE112018006048T5/de active Pending
- 2018-11-27 TW TW107142270A patent/TWI806933B/zh active
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114008482A (zh) * | 2019-12-11 | 2022-02-01 | 计测技研株式会社 | 测量系统及测量方法 |
Also Published As
Publication number | Publication date |
---|---|
US20200401158A1 (en) | 2020-12-24 |
CN111417911A (zh) | 2020-07-14 |
TWI806933B (zh) | 2023-07-01 |
JP2019102047A (ja) | 2019-06-24 |
DE112018006048T5 (de) | 2020-08-13 |
CN111417911B (zh) | 2023-09-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
TW201925724A (zh) | 影像處理裝置、移動機器人之控制系統、移動機器人之控制方法 | |
CN111989544B (zh) | 基于光学目标的室内车辆导航的系统和方法 | |
KR102291667B1 (ko) | 로봇 주행용 모듈 랜드마크,랜드마크 및 그 로봇 | |
US8508527B2 (en) | Apparatus and method of building map for mobile robot | |
US8196835B2 (en) | Method and apparatus for determining position and rotational orientation of an object | |
US20180089616A1 (en) | Path and load localization and operations supporting automated warehousing using robotic forklifts or other material handling vehicles | |
CN109373992B (zh) | 基于发光设备的地图纠正方法及装置 | |
JP2011150443A (ja) | ロボットおよびロボットシステム | |
CN106403926B (zh) | 一种定位方法和系统 | |
US20230418295A1 (en) | Mobile robot, mobile robot control system, and mobile robot control method | |
JP6688475B2 (ja) | 情報取得装置、情報取得システム、自律移動装置、自律移動装置システム及び移動体の位置測定方法 | |
CN112074706A (zh) | 精确定位系统 | |
WO2019107164A1 (ja) | 画像処理装置、移動ロボットの制御システム、移動ロボットの制御方法 | |
JP5187068B2 (ja) | 3次元形状測定装置および3次元形状測定方法 | |
KR101243848B1 (ko) | 무인 크레인 후크의 각도 산출 장치 | |
US20220215669A1 (en) | Position measuring method, driving control method, driving control system, and marker | |
TWI834828B (zh) | 移動機器人、移動機器人之控制系統及移動機器人之控制方法 | |
WO2024014529A1 (ja) | 自律移動ロボット及び自律移動ロボットの制御システム | |
JPH0542689B2 (zh) |