JPH09251309A - Handling position/posture correction device for mobile robot - Google Patents

Handling position/posture correction device for mobile robot

Info

Publication number
JPH09251309A
JPH09251309A JP5970496A JP5970496A JPH09251309A JP H09251309 A JPH09251309 A JP H09251309A JP 5970496 A JP5970496 A JP 5970496A JP 5970496 A JP5970496 A JP 5970496A JP H09251309 A JPH09251309 A JP H09251309A
Authority
JP
Japan
Prior art keywords
threshold value
mobile robot
handling position
orientation
handling
Prior art date
Legal status (The legal status 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 status listed.)
Granted
Application number
JP5970496A
Other languages
Japanese (ja)
Other versions
JP3351228B2 (en
Inventor
Masanori Onishi
正紀 大西
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shinko Electric Co Ltd
Original Assignee
Shinko Electric Co Ltd
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 Shinko Electric Co Ltd filed Critical Shinko Electric Co Ltd
Priority to JP05970496A priority Critical patent/JP3351228B2/en
Publication of JPH09251309A publication Critical patent/JPH09251309A/en
Application granted granted Critical
Publication of JP3351228B2 publication Critical patent/JP3351228B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Numerical Control (AREA)
  • Manipulator (AREA)
  • Closed-Circuit Television Systems (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide the handling position/posture correction device of a mobile robot capable of stably and precisely recognizing a mark for correction under any illumination conditions. SOLUTION: At the time of teaching, a CPU 5 gradually changes a threshold value and writes the intermediate value of the threshold value at the point of time when a graphic on the mark for the correction becomes recognizable and the threshold value at the point of time when it becomes unrecognizable in a correction data table 6 as an optimum threshold value corresponding to illuminance on the mark for the correction for each semiconductor manufacture device. At the time of a carrying operation, when the mobile robot arrives at the semiconductor manufacture device, the CPU 5 reads the optimum threshold value corresponding to the semiconductor manufacture device from the correction data table 6 and binarizes data inside a video RAM 4 by the optimum threshold value. Then, the CPU 5 corrects handling position and posture at present based on the binarized data.

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【発明の属する技術分野】この発明は、ハンドリング部
を搭載した移動ロボットについて、カメラを用いてハン
ドリング位置・姿勢補正用マーク(以下、「補正用マー
ク」と称する)を認識することにより、ハンドリング位
置および姿勢を補正するハンドリング位置・姿勢補正装
置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a mobile robot equipped with a handling section by recognizing a handling position / orientation correction mark (hereinafter referred to as "correction mark") using a camera. And a handling position / orientation correction device for correcting the attitude.

【0002】[0002]

【従来の技術】半導体クリーンルーム内のウェーハカセ
ット搬送用移動ロボットは、半導体製造装置から出てく
るウェーハカセットを、該移動ロボットに搭載されたハ
ンドリング部でハンドリングし、該移動ロボットの荷台
に載せ、次の製造装置まで運ぶ作業を行っている。上記
移動ロボットの走行停止時における停止精度は10mm
程度であるため、該移動ロボットは、ウェーハカセット
のハンドリングにおいて必要となる1mm程度の精度を
保証することができない。そこで、上記ハンド部にCC
Dカメラを設置し、半導体製造装置上のウェーハカセッ
ト取出口付近に設置した補正用マークに基づいた位置補
正を行うことにより、1mm程度のハンドリング精度を
実現している。以下、上記技術の詳細について説明す
る。
2. Description of the Related Art A mobile robot for transporting a wafer cassette in a semiconductor clean room handles a wafer cassette coming out of a semiconductor manufacturing apparatus with a handling section mounted on the mobile robot and places it on a carrier of the mobile robot. I am carrying it to the manufacturing equipment. The stopping accuracy when the mobile robot stops traveling is 10 mm.
However, the mobile robot cannot guarantee the accuracy of about 1 mm required for handling the wafer cassette. Therefore, CC in the hand part
By installing a D camera and performing position correction based on a correction mark installed near the wafer cassette outlet on the semiconductor manufacturing apparatus, a handling accuracy of about 1 mm is realized. The details of the above technique will be described below.

【0003】図4は、半導体クリーンルーム内における
搬送システムの一例を示す説明図である。この図におい
て、移動ロボット101は、半導体製造装置102−1
〜102−6で製造されたウェーハカセットを、該移動
ロボット101に搭載されたハンドリング部でハンドリ
ングし、該移動ロボット101の荷台に載せ、カセット
ストッカ103−1,103−2まで運搬する。
FIG. 4 is an explanatory view showing an example of a transfer system in a semiconductor clean room. In this figure, the mobile robot 101 is a semiconductor manufacturing apparatus 102-1.
The wafer cassettes manufactured in Nos. 102 to 6 are handled by a handling unit mounted on the mobile robot 101, placed on the carrier of the mobile robot 101, and transported to the cassette stockers 103-1 and 103-2.

【0004】図5は、上記移動ロボット101の一例を
示す説明図である。移動ロボット101は、走行を行う
ための走行部201と、アーム202aおよびハンド2
02bからなるハンドリング部202と、荷物を載せる
ための荷台203とから構成される。そして、上記ハン
ド202bには、CCDカメラ1が設けられている。
FIG. 5 is an explanatory diagram showing an example of the mobile robot 101. The mobile robot 101 includes a traveling unit 201 for traveling, an arm 202a, and a hand 2.
The handling unit 202 is composed of 02b, and the loading platform 203 for loading luggage. The CCD camera 1 is provided on the hand 202b.

【0005】また、半導体クリーンルームには、半導体
製造装置がn台(ただし、nは自然数、図4に示す例で
は6台)設けられており、各半導体製造装置には装置番
号m(ただし、1≦m≦n)が付けられている。そし
て、各半導体製造装置のウェーハカセット取出口付近に
は、補正用マークが貼り付けられている。
Further, in the semiconductor clean room, n semiconductor manufacturing apparatuses (where n is a natural number, 6 in the example shown in FIG. 4) are provided, and each semiconductor manufacturing apparatus has an apparatus number m (where 1 is a number). ≦ m ≦ n) is attached. A correction mark is attached near the wafer cassette outlet of each semiconductor manufacturing apparatus.

【0006】図6は、補正用マークの一例を示す説明図
である。補正用マークは、フィルム状のシートであり、
図6に示すように、白地に黒の円形マークが6個印刷し
てある。
FIG. 6 is an explanatory view showing an example of the correction mark. The correction mark is a film-like sheet,
As shown in FIG. 6, six black circular marks are printed on a white background.

【0007】図7は、従来の移動ロボットのハンドリン
グ位置・姿勢補正装置の構成例を示すブロック図であ
る。この図において、CCDカメラ1は、上述したよう
に、移動ロボット101のハンド202bに設けられて
いる。そして、CCDカメラ1は、上記補正用マークを
撮影し、その画像データを出力する。
FIG. 7 is a block diagram showing a configuration example of a conventional handling position / orientation correction device for a mobile robot. In this figure, the CCD camera 1 is provided on the hand 202b of the mobile robot 101 as described above. Then, the CCD camera 1 photographs the correction mark and outputs the image data.

【0008】カメラモジュール2は、CCDカメラ1が
出力する画像データを、ビデオ信号に変換して出力す
る。ここで、上記ビデオ信号は、所定の諧調(例えば、
0〜255)で変化する多値のデータである。ビデオ入
力回路3は、カメラモジュール2が出力するビデオ信号
を、ビデオRAM・4に書き込む。
The camera module 2 converts the image data output from the CCD camera 1 into a video signal and outputs it. Here, the video signal has a predetermined gradation (for example,
It is multi-valued data that changes from 0 to 255). The video input circuit 3 writes the video signal output from the camera module 2 in the video RAM4.

【0009】CPU(中央処理装置)・5は、本装置の
各部を制御すると共に、補正用マークの重心位置(x,
y,z)および姿勢(φ,θ,ψ)を算出する。ここ
で、補正用マークの姿勢とは、該補正用マークを含む平
面の傾き(すなわち、x,y,z軸周りの回転角度)の
ことである。
A CPU (Central Processing Unit) 5 controls each part of the apparatus and also controls the center of gravity (x,
y, z) and the posture (φ, θ, ψ) are calculated. Here, the attitude of the correction mark is the inclination of the plane including the correction mark (that is, the rotation angle around the x, y, and z axes).

【0010】補正データテーブル6’は、リード/ライ
トが可能な不揮発性メモリ(具体的には、E2PRO
M,フラッシュROM,バッテリバックアップされたR
AM等)であり、CPU・5が算出した補正用マークの
重心位置(x,y,z)および姿勢(φ,θ,ψ)を、
該補正用マークが貼り付けられている半導体製造装置に
対応して記憶する。図8は、上記補正データテーブル
6’の一例を示す説明図である。
The correction data table 6'is a readable / writable nonvolatile memory (specifically, E 2 PRO).
M, flash ROM, battery-backed R
AM, etc.), and the barycentric position (x, y, z) and posture (φ, θ, ψ) of the correction mark calculated by the CPU.
It is stored in correspondence with the semiconductor manufacturing apparatus to which the correction mark is attached. FIG. 8 is an explanatory diagram showing an example of the correction data table 6 ′.

【0011】次に、上記構成による移動ロボットのハン
ドリング位置・姿勢補正装置の動作を説明する。 (1)教示時 オペレータが、図示しない操作装置(一例としては、テ
ィーチングペンダント)を用いて、移動ロボット101
を装置番号mの半導体製造装置の前に移動させ、該移動
ロボット101に搭載されたハンドリング部202のハ
ンド202bを、ウェーハカセットのハンドリング位置
および姿勢へ移動させた後、該ハンドリング位置に貼り
付けられた補正用マークの位置および姿勢の記憶指令を
入力すると、該ハンド202bに設けられたCCDカメ
ラ1(図7参照)は、補正用マークを撮影し、その画像
データを出力する。そして、カメラモジュール2は、C
CDカメラ1が出力する画像データを、ビデオ信号に変
換して出力する。
Next, the operation of the handling position / orientation correction device for a mobile robot having the above-mentioned configuration will be described. (1) At the time of teaching The operator uses the operation device (not shown) (teaching pendant as an example) to move the mobile robot 101.
Is moved in front of the semiconductor manufacturing apparatus with the apparatus number m, the hand 202b of the handling unit 202 mounted on the mobile robot 101 is moved to the handling position and posture of the wafer cassette, and then the hand is attached to the handling position. When a command to store the position and orientation of the correction mark is input, the CCD camera 1 (see FIG. 7) provided in the hand 202b photographs the correction mark and outputs the image data. The camera module 2 is C
The image data output by the CD camera 1 is converted into a video signal and output.

【0012】ビデオ入力回路3は、カメラモジュール2
が出力するビデオ信号を、ビデオRAM・4に書き込
む。CPU・5は、ビデオRAM・4に格納されたビデ
オ信号を、固定のスレショルド値で2値化し、白または
黒を表す2値化データに分離する。図9は、図6のライ
ンA−A’上の画像を示すビデオ信号を2値化した例を
示す説明図である。次に、CPU・5は、上記2値化デ
ータに基づいて、補正用マークの重心位置(x,y,
z)および姿勢(φ,θ,ψ)を算出する。CPU・5
は、算出した補正用マークの重心位置(x,y,z)お
よび姿勢(φ,θ,ψ)を、補正データテーブル6の装
置番号mの欄に書き込む(図8参照)。
The video input circuit 3 includes a camera module 2
Write the video signal output by the video RAM4. The CPU 5 binarizes the video signal stored in the video RAM 4 with a fixed threshold value and separates it into binarized data representing white or black. FIG. 9 is an explanatory diagram showing an example in which the video signal showing the image on the line AA ′ in FIG. 6 is binarized. Next, the CPU 5 determines, based on the binarized data, the barycentric position (x, y,
z) and the posture (φ, θ, ψ) are calculated. CPU-5
Writes the calculated barycentric position (x, y, z) and posture (φ, θ, ψ) of the correction mark in the column of the device number m of the correction data table 6 (see FIG. 8).

【0013】図7に示す装置は、上記動作を繰り返すこ
とにより、各半導体製造装置に対応する補正用マークの
重心位置(x,y,z)および姿勢(φ,θ,ψ)を、
補正データテーブル6の各装置番号の欄に書き込む。
By repeating the above operation, the apparatus shown in FIG. 7 determines the barycentric position (x, y, z) and the posture (φ, θ, ψ) of the correction mark corresponding to each semiconductor manufacturing apparatus.
It writes in the column of each device number of the correction data table 6.

【0014】(2)搬送作業時 搬送作業時において、移動ロボット101が、装置番号
mの半導体製造装置からウェーハカセットを取り出すた
めに、該半導体製造装置の前に移動すると、CPU・5
は、該装置番号mに対応する補正用マークの重心位置
(x,y,z)および姿勢(φ,θ,ψ)を、補正デー
タテーブル6から読み出す。移動ロボット101に搭載
されたハンドリング部202のハンド202bが、ウェ
ーハカセットのハンドリング位置および姿勢へ移動する
と、該ハンド202bに設けられたCCDカメラ1は、
該ウェーハカセットをハンドリングする前に、補正用マ
ークを撮影し、その画像データを出力する。以下、図7
に示すハンドリング位置・姿勢補正装置は、「(1)教
示時」で示したのと同じ動作を行い、現在の補正用マー
クの重心位置(x’,y’,z’)および姿勢(φ’,
θ’,ψ’)を算出する。
(2) During Transfer Operation During transfer operation, when the mobile robot 101 moves to the front of the semiconductor manufacturing apparatus in order to take out the wafer cassette from the semiconductor manufacturing apparatus with the apparatus number m, the CPU 5
Reads the barycentric position (x, y, z) and posture (φ, θ, ψ) of the correction mark corresponding to the device number m from the correction data table 6. When the hand 202b of the handling unit 202 mounted on the mobile robot 101 moves to the handling position and posture of the wafer cassette, the CCD camera 1 provided on the hand 202b
Before handling the wafer cassette, the correction mark is photographed and its image data is output. Below, FIG.
The handling position / orientation correction device shown in (1) performs the same operation as shown in “(1) Teaching”, and the current barycentric position (x ′, y ′, z ′) and attitude (φ ′ of the correction mark) ,
θ ', ψ') is calculated.

【0015】CPU・5は、算出した補正用マークの重
心位置(x’,y’,z’)と、読み出した補正用マー
クの重心位置(x,y,z)とを比較し、教示位置に対
する現在位置の位置ズレを算出する。そして、CPU・
5は、上記位置ズレがゼロになる方向へ、ハンド202
bの位置を補正する。同様に、CPU・5は、算出した
補正用マークの姿勢(φ’,θ’,ψ’)と、読み出し
た補正用マークの姿勢(φ,θ,ψ)とを比較し、教示
姿勢に対する現在姿勢の姿勢ズレを計算する。そして、
CPU・5は、上記姿勢ズレがゼロになる方向へ、ハン
ド202bの姿勢を補正する。そして、上記位置ズレお
よび姿勢ズレがゼロになると、移動ロボット101に搭
載されたハンドリング部202はハンドリングを行う。
The CPU 5 compares the calculated barycentric position (x ', y', z ') of the correction mark with the read barycentric position (x, y, z) of the correction mark to determine the teaching position. The positional deviation of the current position with respect to is calculated. And CPU
5 is the hand 202 in the direction in which the positional deviation becomes zero.
Correct the position of b. Similarly, the CPU 5 compares the calculated correction mark attitude (φ ′, θ ′, ψ ′) with the read correction mark attitude (φ, θ, ψ), and compares it with the current teaching attitude. Calculate the posture deviation of the posture. And
The CPU 5 corrects the posture of the hand 202b in the direction in which the posture shift becomes zero. Then, when the positional deviation and the attitude deviation become zero, the handling unit 202 mounted on the mobile robot 101 performs the handling.

【0016】以上で、上記構成による移動ロボットのハ
ンドリング位置・姿勢補正装置の動作説明を終了する。
なお、上述した補正用マークの重心位置および姿勢の算
出方法、および、ハンド202bの位置および姿勢の補
正方法の詳細は、以下に示す公報に記載されている。 1)特開平6−259536号公報(出願番号 特願平
3−312048号)「撮像位置、姿勢の三次元補正方
法およびロボットの三次元位置補正方法」 2)特開平4−349797号公報(出願番号 特願平
3−123359号)「視覚装置の幾何学的撮像特定較
正方法」
This is the end of the description of the operation of the handling position / orientation correction device for a mobile robot having the above configuration.
The details of the method of calculating the center of gravity position and orientation of the correction mark and the method of correcting the position and orientation of the hand 202b described above are described in the following publications. 1) Japanese Patent Application Laid-Open No. 6-259536 (application number Japanese Patent Application No. 3-312048) “3D correction method of imaging position and posture and 3D position correction method of robot” 2) Japanese Patent Application Laid-Open No. 4-349797 No. Japanese Patent Application No. 3-123359) "Geometric imaging specific calibration method for visual device"

【0017】[0017]

【発明が解決しようとする課題】ところで、半導体製造
装置に貼り付けられた補正用マーク上の照度は、各半導
体製造装置毎に異なっており、照度が十分ある場合や照
度が足りない場合等、様々である。また、該補正用マー
クに対して斜めから光があたっている場合等では、ある
一つの補正用マーク上においても、照度が均一とは限ら
ない。
By the way, the illuminance on the correction marks attached to the semiconductor manufacturing apparatus is different for each semiconductor manufacturing apparatus, and when the illuminance is sufficient or the illuminance is insufficient, There are various. Further, when the correction mark is obliquely illuminated, the illuminance is not always uniform even on one correction mark.

【0018】図10(a)は、補正用マーク上の照度が
足りない場合における上記ビデオ信号の一例を示す説明
図であり、図10(b)は、補正用マーク上の照度が不
均一である場合における上記ビデオ信号の一例を示す説
明図である。図10(a)に示すように、補正用マーク
上の照度が足りない場合には、ビデオRAM・4に格納
されるビデオ信号の値は全体的に小さくなり、該ビデオ
信号は全て黒を示すデータに2値化されてしまい、補正
用マーク上の図形(円)が全く認識されなくなってしま
う。また、図10(b)に示すように、補正用マーク上
の照度が不均一である場合には、実際の補正用マーク上
では同じ濃度であるはずの図形(円)部分が、場所によ
り異なる色(すなわち白と黒)を示すデータに2値化さ
れてしまい、該図形の形状や個数が誤って認識されてし
まう。
FIG. 10A is an explanatory diagram showing an example of the video signal when the illuminance on the correction mark is insufficient, and FIG. 10B shows that the illuminance on the correction mark is not uniform. It is explanatory drawing which shows an example of the said video signal in a certain case. As shown in FIG. 10A, when the illuminance on the correction mark is insufficient, the value of the video signal stored in the video RAM 4 is generally small, and the video signal shows all black. The data is binarized, and the figure (circle) on the correction mark cannot be recognized at all. Further, as shown in FIG. 10B, when the illuminance on the correction mark is non-uniform, the figure (circle) portion that should have the same density on the actual correction mark differs depending on the location. The data indicating the colors (that is, white and black) is binarized, and the shape and the number of the figures are erroneously recognized.

【0019】このため、上述した従来の移動ロボットの
ハンドリング位置・姿勢補正装置においては、補正用マ
ークを認識することができない場合や、補正用マークの
重心位置および姿勢の計算結果に誤差が現れる場合があ
る、という課題があった。
Therefore, in the above-described conventional handling position / orientation correction device for a mobile robot, when the correction mark cannot be recognized or when an error appears in the calculation result of the center of gravity and the attitude of the correction mark. There was a problem that there was.

【0020】上記課題を解決する一方法としては、各半
導体製造装置毎の補正用マーク上の照度に応じて、CC
Dカメラのレンズの絞りを自動的に調整する装置(自動
絞り調整器)を該CCDカメラに付加することが考えら
れる。しかし、この方法では、CCDカメラに上記自動
絞り調整機を取り付けなくてはならないため、装置全体
の構成が高価になると共に、該自動絞り調整機の分だけ
CCDカメラが大きくかつ重くなる。CCDカメラが大
きくなると、狭い場所でのハンドリングにおける制限が
増える。また、CCDカメラの重量増加は、ハンドを動
かす際の速度低下や振動増加を招く。さらに、CCDカ
メラの重量増加により、アームを駆動する駆動用モータ
を大きなものにする必要が生じる。
As a method for solving the above-mentioned problem, CC is adjusted in accordance with the illuminance on the correction mark of each semiconductor manufacturing apparatus.
It is conceivable to add a device (automatic aperture adjuster) for automatically adjusting the aperture of the lens of the D camera to the CCD camera. However, in this method, since the automatic aperture adjuster must be attached to the CCD camera, the configuration of the entire apparatus becomes expensive, and the CCD camera becomes large and heavy by the amount of the automatic aperture adjuster. Larger CCD cameras have more restrictions on handling in tight spaces. In addition, the increase in weight of the CCD camera causes a decrease in speed and an increase in vibration when moving the hand. Further, due to the increased weight of the CCD camera, it is necessary to make the drive motor for driving the arm large.

【0021】この発明は、このような背景の下になされ
たもので、カメラに(自動絞り調整機等の)付加装置を
追加しなくても、いかなる照度下および照明条件下でも
補正用マークを安定かつ正確に認識することができる移
動ロボットのハンドリング位置・姿勢補正装置を提供す
ることを目的とする。
The present invention has been made under such a background, and a correction mark can be provided under any illuminance and under any illumination condition without adding an additional device (such as an automatic aperture adjuster) to the camera. An object of the present invention is to provide a handling position / orientation correction device for a mobile robot that can be stably and accurately recognized.

【0022】[0022]

【課題を解決するための手段】請求項1記載の発明は、
ハンドリング部を有する移動ロボットのハンドリング位
置・姿勢補正装置において、前記移動ロボットの各移動
先に対応するスレショルド値を記憶する記憶手段と、前
記記憶手段に記憶された各スレショルド値の中から、前
記移動ロボットの現在の移動位置に対応するスレショル
ド値を読み出す読出手段と、前記ハンドリング部の現在
のハンドリング位置に設けられたハンドリング位置・姿
勢補正用マークを撮影するカメラと、前記カメラが出力
したデータを、前記読出手段が読み出したスレショルド
値で2値化する2値化手段と、前記2値化手段が2値化
したデータに基づいて、前記ハンドリング部の現在のハ
ンドリング位置および姿勢を算出する算出手段と、予め
教示されたハンドリング位置および姿勢と、前記算出手
段が算出した現在のハンドリング位置および姿勢との比
較に基づいて、前記ハンドリング部のハンドリング位置
および姿勢を補正する補正手段とを具備することを特徴
とする。
According to the first aspect of the present invention,
In a handling position / orientation correction device for a mobile robot having a handling unit, the movement is performed from a storage unit that stores a threshold value corresponding to each destination of the mobile robot, and each threshold value stored in the storage unit. Reading means for reading a threshold value corresponding to the current movement position of the robot, a camera for photographing a handling position / posture correction mark provided at the current handling position of the handling section, and data output by the camera, Binarizing means for binarizing the threshold value read by the reading means, and calculating means for calculating the current handling position and attitude of the handling section based on the data binarized by the binarizing means. , The handling position and posture taught in advance, and the current calculated by the calculating means. Based on a comparison between the handling position and orientation, characterized by comprising a correction means for correcting the handling position and orientation of the handling portion.

【0023】請求項2記載の発明は、請求項1記載の移
動ロボットのハンドリング位置・姿勢補正装置におい
て、前記記憶手段における記憶内容(すなわち、前記移
動ロボットの各移動先に対応するスレショルド値)を設
定する設定手段を具備することを特徴とする。
According to a second aspect of the present invention, in the handling position / orientation correction device for a mobile robot according to the first aspect, the contents stored in the storage means (that is, the threshold value corresponding to each destination of the mobile robot) is stored. It is characterized by comprising setting means for setting.

【0024】請求項3記載の発明は、請求項2記載の移
動ロボットのハンドリング位置・姿勢補正装置におい
て、前記予め教示されたハンドリング位置および姿勢
は、前記設定手段が設定したスレショルド値に基づいて
算出されたものであることを特徴とする。
According to a third aspect of the present invention, in the handling position / orientation correcting device for a mobile robot according to the second aspect, the previously taught handling position and orientation are calculated based on a threshold value set by the setting means. It is characterized by being

【0025】請求項4記載の発明は、請求項2または請
求項3のいずれかに記載の移動ロボットのハンドリング
位置・姿勢補正装置において、前記設定手段は、前記ス
レショルド値を徐々に変化させる変化手段と、前記カメ
ラが出力したデータを、前記変化手段が変化させたスレ
ショルド値で2値化する第2の2値化手段と、前記第2
の2値化手段が2値化したデータに基づく画像におい
て、前記ハンドリング位置・姿勢補正用マークが正しく
認識され始めた時点のスレショルド値と、該マークが正
しく認識されなくなった時点のスレショルド値との中間
値を算出するスレショルド値算出手段と、前記スレショ
ルド値算出手段が算出した中間値を、前記移動ロボット
の現在位置に対応するスレショルド値として、前記記憶
手段に書き込む書込手段とからなることを特徴とする。
According to a fourth aspect of the present invention, in the handling position / orientation correction device for a mobile robot according to the second or third aspect, the setting means is a changing means for gradually changing the threshold value. And second binarizing means for binarizing the data output by the camera with the threshold value changed by the changing means, and the second binarizing means.
In the image based on the data binarized by the binarizing means, the threshold value at the time when the handling position / orientation correction mark starts to be correctly recognized and the threshold value at the time when the mark is not correctly recognized. And a writing unit that writes the intermediate value calculated by the threshold value calculating unit to the storage unit as a threshold value corresponding to the current position of the mobile robot. And

【0026】請求項5記載の発明は、請求項2または請
求項3のいずれかに記載の移動ロボットのハンドリング
位置・姿勢補正装置において、前記設定手段は、前記ス
レショルド値を徐々に変化させる変化手段と、前記カメ
ラが出力したデータを、前記変化手段が変化させたスレ
ショルド値で2値化する第2の2値化手段と、前記第2
の2値化手段が2値化したデータに基づく画像を表示す
る表示手段と、前記表示手段が表示する画像において、
前記ハンドリング位置・姿勢補正用マークが正しく認識
され始めた時点で操作される第1の操作手段と、前記表
示手段が表示する画像において、前記ハンドリング位置
・姿勢補正用マークが正しく認識されなくなった時点で
操作される第2の操作手段と、前記第1の操作手段が操
作された時点のスレショルド値と、前記第2の操作手段
が操作された時点のスレショルド値との中間値を算出す
るスレショルド値算出手段と、前記スレショルド値算出
手段が算出した中間値を、前記移動ロボットの現在位置
に対応するスレショルド値として、前記記憶手段に書き
込む書込手段とからなることを特徴とする。
According to a fifth aspect of the present invention, in the handling position / orientation correcting device for a mobile robot according to the second or third aspect, the setting means changes the threshold value gradually. And second binarizing means for binarizing the data output by the camera with the threshold value changed by the changing means, and the second binarizing means.
The display means for displaying an image based on the data binarized by the binarizing means and the image displayed by the display means,
First operation means operated at the time when the handling position / orientation correction mark starts to be correctly recognized, and when the handling position / orientation correction mark is not correctly recognized in the image displayed by the display means. A threshold value for calculating an intermediate value between a threshold value at a time when the second operation means is operated, a threshold value at a time when the first operation means is operated, and a threshold value at a time when the second operation means is operated. It is characterized by comprising a calculating means and a writing means for writing the intermediate value calculated by the threshold value calculating means into the storage means as a threshold value corresponding to the current position of the mobile robot.

【0027】[0027]

【発明の実施の形態】BEST MODE FOR CARRYING OUT THE INVENTION

§1.第1実施形態 以下、図面を参照して、この発明の第1実施形態につい
て説明する。図1は、この発明の第1実施形態による移
動ロボットのハンドリング位置・姿勢補正装置の構成例
を示すブロック図である。この図において、図7の各部
に対応する部分には同一の符号を付け、その説明を省略
する。この図に示す移動ロボットのハンドリング位置・
姿勢補正装置が図7のものと異なる点は、補正データテ
ーブル6’の代わりに補正データテーブル6が設けられ
ている点である。
§1. First Embodiment Hereinafter, a first embodiment of the present invention will be described with reference to the drawings. FIG. 1 is a block diagram showing a configuration example of a handling position / orientation correction device for a mobile robot according to a first embodiment of the present invention. In this figure, parts corresponding to the respective parts in FIG. 7 are denoted by the same reference numerals, and description thereof will be omitted. The handling position of the mobile robot shown in this figure
The attitude correction apparatus differs from that shown in FIG. 7 in that a correction data table 6 is provided instead of the correction data table 6 ′.

【0028】図2は、補正データテーブル6の一例を示
す説明図である。この図に示すように、補正データテー
ブル6は、補正用マークの重心位置(x,y,z)およ
び姿勢(φ,θ,ψ)の他に、各半導体製造装置毎に、
該半導体製造装置に貼り付けられた補正用マーク上の照
度に対応した最適なスレショルド値(以下、「最適スレ
ショルド値」と称する)を記憶する。
FIG. 2 is an explanatory diagram showing an example of the correction data table 6. As shown in this figure, the correction data table 6 includes, in addition to the barycentric position (x, y, z) and posture (φ, θ, ψ) of the correction mark, for each semiconductor manufacturing apparatus,
An optimum threshold value (hereinafter, referred to as “optimum threshold value”) corresponding to the illuminance on the correction mark attached to the semiconductor manufacturing apparatus is stored.

【0029】次に、上記構成による移動ロボットのハン
ドリング位置・姿勢補正装置の動作を説明する。 (1)教示時 オペレータが、図示しない操作装置(一例としては、テ
ィーチングペンダント)を用いて、移動ロボット101
を装置番号mの半導体製造装置の前に移動させ、該移動
ロボット101に搭載されたハンドリング部202のハ
ンド202bを、ウェーハカセットのハンドリング位置
および姿勢へ移動させた後、該ハンドリング位置に貼り
付けられた補正用マークの位置および姿勢の記憶指令を
入力すると、本装置は、補正用マークの重心位置(x,
y,z)および姿勢(φ,θ,ψ)の算出・記憶に先立
って、以下に述べる動作で、最適スレショルド値の決定
・記憶を行う。
Next, the operation of the handling position / orientation correction device of the mobile robot having the above-mentioned configuration will be described. (1) At the time of teaching The operator uses the operation device (not shown) (teaching pendant as an example) to move the mobile robot 101.
Is moved in front of the semiconductor manufacturing apparatus with the apparatus number m, the hand 202b of the handling unit 202 mounted on the mobile robot 101 is moved to the handling position and posture of the wafer cassette, and then the hand is attached to the handling position. When a command to store the position and orientation of the correction mark is input, the apparatus determines the barycentric position (x,
(y, z) and the posture (φ, θ, ψ) are calculated and stored, and the optimum threshold value is determined and stored by the operation described below.

【0030】すなわち、まず、CPU・5は、2値化の
ためのスレショルド値を、該スレショルド値の上限値
(一例としては255)から下限値(一例としては0)
へ向かって徐々に変化させる。そして、CPU・5は、
所定図形(図6に示す補正用マーク例では円)が所定個
数(図6に示す補正用マーク例では6個)正しく認識さ
れ始めた時点のスレショルド値を、第1スレショルド値
として、該CPU・5の内蔵レジスタに記憶する。その
後、CPU・5は、上記スレショルド値をさらに変化さ
せ、上記所定図形が上記所定個数だけ正しく認識されな
くなった時点のスレショルド値を、第2スレショルド値
として、該CPU・5の他の内蔵レジスタに記憶する。
最後に、CPU・5は、第1スレショルド値と第2スレ
ショルド値との中間値を求め、該中間値を最適スレショ
ルド値として、補正データテーブル6の装置番号mの欄
に書き込む。
That is, first, the CPU 5 sets the threshold value for binarization from the upper limit value (255 as an example) to the lower limit value (0 as an example) of the threshold value.
Gradually change toward. And the CPU-5
A predetermined figure (a circle in the correction mark example shown in FIG. 6), a predetermined number (six in the correction mark example shown in FIG. 6), is recognized as a first threshold value, and the threshold value at the time when the correct recognition is started. Stored in the internal register of No. 5. After that, the CPU 5 further changes the threshold value, and the threshold value at the time when the predetermined figure is not correctly recognized by the predetermined number is stored in another internal register of the CPU 5 as the second threshold value. Remember.
Finally, the CPU 5 finds an intermediate value between the first threshold value and the second threshold value, and writes the intermediate value as the optimum threshold value in the column of the device number m of the correction data table 6.

【0031】なお、上記動作例では、スレショルド値を
上限値から下限値へ向かって変化させたが、これとは逆
に、スレショルド値を下限値から上限値へ向かって変化
させても良い。
In the above operation example, the threshold value is changed from the upper limit value to the lower limit value, however, conversely, the threshold value may be changed from the lower limit value to the upper limit value.

【0032】上述した動作により最適スレショルド値の
決定・記憶が終了すると、次に、本装置は、従来技術と
同様の動作を行って、補正用マークの重心位置(x,
y,z)および姿勢(φ,θ,ψ)を算出し、該重心位
置(x,y,z)および姿勢(φ,θ,ψ)を補正デー
タテーブル6の装置番号mの欄に書き込む。ただし、従
来のハンドリング位置・姿勢補正装置では、ビデオRA
M・4に格納されたビデオ信号を2値化する際に、固定
のスレショルド値を用いたのに対して、本実施形態によ
るハンドリング位置・姿勢補正装置では、ビデオRAM
・4に格納されたビデオ信号を2値化する際に、先に算
出した最適スレショルド値を用いる。
When the determination and storage of the optimum threshold value are completed by the above-described operation, the present apparatus then performs the same operation as in the prior art to perform the barycentric position (x,
y, z) and the posture (φ, θ, ψ) are calculated, and the barycentric position (x, y, z) and the posture (φ, θ, ψ) are written in the column of the device number m of the correction data table 6. However, in the conventional handling position / orientation correction device, the video RA
While a fixed threshold value was used when binarizing the video signal stored in M.4, the handling position / orientation correction apparatus according to the present embodiment uses a video RAM.
Use the previously calculated optimal threshold value when binarizing the video signal stored in 4.

【0033】(2)搬送作業時 第1実施形態によるハンドリング位置・姿勢補正装置の
搬送作業時の動作は、従来のハンドリング位置・姿勢補
正装置の搬送作業時の動作と基本的に同じものである。
ただし、以下に示す各点において異なる。 第1実施形態では、移動ロボット101が装置番号
mの半導体製造装置の前に移動すると、CPU・5は、
該装置番号mに対応する補正用マークの重心位置(x,
y,z)および姿勢(φ,θ,ψ)の他に、該装置番号
mに対応する最適スレショルド値を、補正データテーブ
ル6から読み出す。 第1実施形態では、ビデオRAM・4に格納された
ビデオ信号を2値化する際に、CPU・5は、上記に
おいて補正データテーブル6から読み出した最適スレシ
ョルド値を用いて該2値化を行う。以上で、上記構成に
よる移動ロボットのハンドリング位置・姿勢補正装置の
動作説明を終了する。
(2) At the time of carrying work The operation of the handling position / orientation correcting apparatus according to the first embodiment at the time of carrying work is basically the same as the operation of the conventional handling position / orientation correcting apparatus at the time of carrying work. .
However, the following points are different. In the first embodiment, when the mobile robot 101 moves to the front of the semiconductor manufacturing apparatus with the apparatus number m, the CPU 5
The position of the center of gravity of the correction mark corresponding to the device number m (x,
In addition to y, z) and posture (φ, θ, ψ), the optimum threshold value corresponding to the device number m is read from the correction data table 6. In the first embodiment, when the video signal stored in the video RAM 4 is binarized, the CPU 5 performs the binarization by using the optimum threshold value read from the correction data table 6 in the above. . This is the end of the description of the operation of the mobile robot handling position / orientation correction device having the above-described configuration.

【0034】§2.第2実施形態 次に、この発明の第2実施形態について説明する。図3
は、この発明の第2実施形態による移動ロボットのハン
ドリング位置・姿勢補正装置の構成例を示すブロック図
である。この図において、図1の各部に対応する部分に
は同一の符号を付け、その説明を省略する。この図に示
す移動ロボットのハンドリング位置・姿勢補正装置が図
1のものと異なる点は、画像表示装置7およびコントロ
ールパネル8が追加された点である。
§2. Second Embodiment Next, a second embodiment of the present invention will be described. FIG.
FIG. 9 is a block diagram showing a configuration example of a handling position / orientation correction device for a mobile robot according to a second embodiment of the present invention. In this figure, parts corresponding to the respective parts in FIG. 1 are denoted by the same reference numerals, and description thereof will be omitted. The handling position / orientation correction device of the mobile robot shown in this figure differs from that of FIG. 1 in that an image display device 7 and a control panel 8 are added.

【0035】画像表示装置7は、CPU・5が求めた2
値化データに基づいて、CCDカメラ1の現在の撮影画
像を表示するもの(具体的には、CRTモニタ,液晶表
示装置等)である。コントロールパネル8は、スレショ
ルド値を変化させるためのアップスイッチおよびダウン
スイッチと、最適スレショルド値を決定するためのセッ
トスイッチを有する。なお、コントロールパネル8は、
移動ロボット101の操作装置(図示略、一例として
は、ティーチングペンダント)と共用にしても良い。
The image display device 7 has 2
It is a device for displaying a current captured image of the CCD camera 1 based on the binarized data (specifically, a CRT monitor, a liquid crystal display device, etc.). The control panel 8 has an up switch and a down switch for changing the threshold value, and a set switch for determining the optimum threshold value. The control panel 8
The mobile robot 101 may be shared with an operating device (not shown, as an example, a teaching pendant).

【0036】次に、上記構成による移動ロボットのハン
ドリング位置・姿勢補正装置の動作を説明する。 (1)教示時 第2実施形態によるハンドリング位置・姿勢補正装置の
教示時の動作は、第1実施形態によるハンドリング位置
・姿勢補正装置の教示時の動作と基本的に同じものであ
る。ただし、第1実施形態と第2実施形態とでは、最適
スレショルド値の決定・記憶動作が異なる。
Next, the operation of the handling position / orientation correction device for a mobile robot having the above configuration will be described. (1) Teaching The operation of the handling position / orientation correction apparatus according to the second embodiment during teaching is basically the same as the operation of the handling position / orientation correction apparatus according to the first embodiment during teaching. However, the first embodiment and the second embodiment differ in the operation of determining and storing the optimum threshold value.

【0037】すなわち、まず、オペレータが、コントロ
ールパネル8に設けられたダウンスイッチを操作する
と、CPU・5は、2値化のためのスレショルド値を、
該スレショルド値の上限値から下限値へ向かって徐々に
変化させる。CPU・5は、刻々と変化する上記スレシ
ョルド値を用いて、CCDカメラ1が現在撮影している
画像に基づくビデオ信号を2値化し、該2値化された画
像(以下、「2値化画像」と称する)を画像表示装置7
に表示する。オペレータは、上記画像表示装置7に表示
された2値化画像を見ながら、補正用マークに印刷され
ている図形がハッキリと認識され始めた時点で、コント
ロールパネル8に設けられたセットスイッチを操作す
る。オペレータが上記セットスイッチを操作すると、C
PU・5は、その時点のスレショルド値を、第1スレシ
ョルド値として、該CPU・5の内蔵レジスタに記憶す
る。
That is, first, when the operator operates the down switch provided on the control panel 8, the CPU 5 sets the threshold value for binarization,
The threshold value is gradually changed from the upper limit value to the lower limit value. The CPU 5 binarizes the video signal based on the image currently captured by the CCD camera 1 by using the above-mentioned threshold value that changes every moment, and the binarized image (hereinafter, "binarized image"). Image display device 7
To be displayed. While looking at the binarized image displayed on the image display device 7, the operator operates the set switch provided on the control panel 8 when the graphic printed on the correction mark starts to be clearly recognized. To do. When the operator operates the set switch, C
The PU-5 stores the threshold value at that point in the internal register of the CPU-5 as the first threshold value.

【0038】その後、CPU・5は、上記スレショルド
値をさらに変化させ、該スレショルド値に基づく2値化
画像を画像表示装置7に表示する。オペレータは、補正
用マークに印刷されている図形がハッキリとは認識され
なくなった時点で、コントロールパネル8に設けられた
セットスイッチを再び操作する。オペレータが上記セッ
トスイッチを操作すると、CPU・5は、その時点のス
レショルド値を、第2スレショルド値として、該CPU
・5の他の内蔵レジスタに記憶する。
After that, the CPU 5 further changes the threshold value and displays the binarized image based on the threshold value on the image display device 7. The operator operates the set switch provided on the control panel 8 again when the graphic printed on the correction mark is no longer clearly recognized. When the operator operates the set switch, the CPU 5 uses the threshold value at that time as the second threshold value,
・ Store in the other 5 internal registers.

【0039】最後に、CPU・5は、第1スレショルド
値と第2スレショルド値との中間値を求め、該中間値を
最適スレショルド値として、補正データテーブル6の装
置番号mの欄に書き込む。
Finally, the CPU 5 finds an intermediate value between the first threshold value and the second threshold value, and writes the intermediate value as the optimum threshold value in the column of the device number m of the correction data table 6.

【0040】なお、第2実施形態の場合も、第1実施形
態と同様に、スレショルド値を下限値から上限値へ向か
って変化させても良い。この場合、オペレータは、コン
トロールパネル8に設けられたダウンスイッチの代わり
に、同コントロールパネル8に設けられたアップスイッ
チを用いる。
In the second embodiment, the threshold value may be changed from the lower limit value to the upper limit value, as in the first embodiment. In this case, the operator uses the up switch provided on the control panel 8 instead of the down switch provided on the control panel 8.

【0041】(2)搬送作業時 第2実施形態によるハンドリング位置・姿勢補正装置の
搬送作業時の動作は、第1実施形態によるハンドリング
位置・姿勢補正装置の搬送作業時の動作と同じものであ
るので、その説明を省略する。以上で、上記構成による
移動ロボットのハンドリング位置・姿勢補正装置の動作
説明を終了する。
(2) During Transfer Operation The operation of the handling position / orientation correction apparatus according to the second embodiment during transfer operation is the same as the operation of the handling position / orientation correction apparatus according to the first embodiment during transfer operation. Therefore, the description thereof is omitted. This is the end of the description of the operation of the mobile robot handling position / orientation correction device having the above-described configuration.

【0042】次に、請求項記載の発明と本実施形態との
対応関係を説明する。 記憶手段……補正データテーブル6 読出手段……CPU・5 カメラ……CCDカメラ1 2値化手段,算出手段,補正手段……CPU・5 変化手段……CPU・5(第1実施形態) CPU・5,コントロールパネル8(第2実施形態) 第2の2値化手段,スレショルド値算出手段,書込手段……CPU・5 表示手段……画像表示装置7 第1の操作手段,第2の操作手段……コントロールパネル8
Next, the correspondence between the claimed invention and this embodiment will be described. Storage means ... Correction data table 6 Read-out means ... CPU-5 camera ... CCD camera 1 Binarization means, calculation means, correction means ... CPU.5 changing means ... CPU.5 (first embodiment) CPU 5, control panel 8 (second embodiment) second binarizing means, threshold value calculating means, writing means ... CPU, 5 display means ... image display device 7 first operating means, second Operating method: Control panel 8

【0043】以上、この発明の実施形態を図面を参照し
て詳述してきたが、具体的な構成はこの実施形態に限ら
れるものではなく、この発明の要旨を逸脱しない範囲の
設計の変更等があってもこの発明に含まれる。例えば、
上述した第1実施形態および第2実施形態では、補正用
マーク上の図形および該図形の個数として、図6に示す
ものを用いたが、補正用マーク上の図形および該図形の
個数はこれに限定されず、該補正用マークの重心位置お
よび姿勢が算出できるならば、どのようなものであって
も構わない。
Although the embodiment of the present invention has been described in detail above with reference to the drawings, the specific configuration is not limited to this embodiment, and the design change and the like without departing from the gist of the present invention. Even this is included in this invention. For example,
In the first and second embodiments described above, the figures and the numbers of the figures on the correction mark are those shown in FIG. 6, but the figures and the numbers of the figures on the correction mark are not limited to this. The present invention is not limited to any particular one, as long as the center of gravity position and orientation of the correction mark can be calculated.

【0044】また、上述した第1実施形態および第2実
施形態では、図1または図3に示すように、カメラ系の
構成をCCDカメラ1,カメラモジュール2,ビデオ入
力回路3からなるものとしたが、カメラ系の構成はこれ
に限定されず、最終的にビデオRAM・4内にビデオ信
号が書き込まれるものであれば、どのようなものであっ
ても構わない。
In the above-described first and second embodiments, as shown in FIG. 1 or 3, the camera system is composed of a CCD camera 1, a camera module 2 and a video input circuit 3. However, the configuration of the camera system is not limited to this, and may be any configuration as long as the video signal is finally written in the video RAM.

【0045】また、上述した第1実施形態および第2実
施形態では、ハンドリング作業として半導体製造装置か
らウェーハカセットを取り出す作業を例にとり説明した
が、本発明が適用可能なハンドリング作業は、図4に示
す半導体クリーンルーム内での搬送作業に限定されず、
例えば一般の工場内の搬送作業等、どのようなものであ
っても構わない。
In the above-described first and second embodiments, the operation of taking out the wafer cassette from the semiconductor manufacturing apparatus has been described as an example of the handling work, but the handling work to which the present invention is applicable is shown in FIG. Not limited to the transfer work in the semiconductor clean room shown,
For example, any work such as a transfer work in a general factory may be used.

【0046】[0046]

【発明の効果】以上説明したように、この発明によれ
ば、いかなる照度下および照明条件下でも補正用マーク
を安定かつ正確に認識することができる。また、カメラ
に付加装置を追加することがないため、低価格化・小型
化・計量化が行え、ハンドリング部の負荷・占有容積を
低減することができる。
As described above, according to the present invention, the correction mark can be recognized stably and accurately under any illuminance and under any illumination condition. Further, since no additional device is added to the camera, cost reduction, size reduction, and weight measurement can be performed, and the load and occupied volume of the handling unit can be reduced.

【図面の簡単な説明】[Brief description of drawings]

【図1】この発明の第1実施形態による移動ロボットの
ハンドリング位置・姿勢補正装置の構成例を示すブロッ
ク図である。
FIG. 1 is a block diagram showing a configuration example of a handling position / orientation correction device for a mobile robot according to a first embodiment of the present invention.

【図2】同実施形態による補正データテーブルの一例を
示す説明図である。
FIG. 2 is an explanatory diagram showing an example of a correction data table according to the same embodiment.

【図3】この発明の第2実施形態による移動ロボットの
ハンドリング位置・姿勢補正装置の構成例を示すブロッ
ク図である。
FIG. 3 is a block diagram showing a configuration example of a handling position / orientation correction device for a mobile robot according to a second embodiment of the present invention.

【図4】半導体クリーンルーム内における搬送システム
の一例を示す説明図である。
FIG. 4 is an explanatory diagram showing an example of a transfer system in a semiconductor clean room.

【図5】移動ロボットの一例を示す説明図である。FIG. 5 is an explanatory diagram showing an example of a mobile robot.

【図6】補正用マークの一例を示す説明図である。FIG. 6 is an explanatory diagram showing an example of a correction mark.

【図7】従来の移動ロボットのハンドリング位置・姿勢
補正装置の構成例を示すブロック図である。
FIG. 7 is a block diagram showing a configuration example of a conventional handling position / orientation correction device for a mobile robot.

【図8】従来の補正データテーブルの一例を示す説明図
である。
FIG. 8 is an explanatory diagram showing an example of a conventional correction data table.

【図9】図6のラインA−A’上の画像を示すビデオ信
号の一例を示す説明図である。
9 is an explanatory diagram showing an example of a video signal showing an image on the line AA ′ in FIG.

【図10】(a)は、補正用マーク上の照度が足りない
場合における上記ビデオ信号の一例を示す説明図であ
り、(b)は、補正用マーク上の照度が不均一である場
合における上記ビデオ信号の一例を示す説明図である。
FIG. 10A is an explanatory diagram showing an example of the video signal in the case where the illuminance on the correction mark is insufficient, and FIG. 10B is a diagram showing the case where the illuminance on the correction mark is nonuniform. It is explanatory drawing which shows an example of the said video signal.

【符号の説明】[Explanation of symbols]

1……CCDカメラ、 2……カメラモジュール、3…
…ビデオ入力回路、 4……ビデオRAM、 5……C
PU、6……補正データテーブル、 7……画像表示装
置、8……コントロールパネル
1 ... CCD camera, 2 ... camera module, 3 ...
… Video input circuit, 4 …… Video RAM, 5 …… C
PU, 6 ... Correction data table, 7 ... Image display device, 8 ... Control panel

Claims (5)

【特許請求の範囲】[Claims] 【請求項1】 ハンドリング部を有する移動ロボットの
ハンドリング位置・姿勢補正装置において、 前記移動ロボットの各移動先に対応するスレショルド値
を記憶する記憶手段と、 前記記憶手段に記憶された各スレショルド値の中から、
前記移動ロボットの現在の移動位置に対応するスレショ
ルド値を読み出す読出手段と、 前記ハンドリング部の現在のハンドリング位置に設けら
れたハンドリング位置・姿勢補正用マークを撮影するカ
メラと、 前記カメラが出力したデータを、前記読出手段が読み出
したスレショルド値で2値化する2値化手段と、 前記2値化手段が2値化したデータに基づいて、前記ハ
ンドリング部の現在のハンドリング位置および姿勢を算
出する算出手段と、 予め教示されたハンドリング位置および姿勢と、前記算
出手段が算出した現在のハンドリング位置および姿勢と
の比較に基づいて、前記ハンドリング部のハンドリング
位置および姿勢を補正する補正手段とを具備することを
特徴とする移動ロボットのハンドリング位置・姿勢補正
装置。
1. A handling position / orientation correction device for a mobile robot having a handling section, wherein: storage means for storing threshold values corresponding to respective destinations of the mobile robot; and threshold values stored in the storage means. From the inside
Reading means for reading a threshold value corresponding to the current movement position of the mobile robot, a camera for photographing a handling position / orientation correction mark provided at the current handling position of the handling section, and data output by the camera A binarizing means for binarizing the above with the threshold value read by the reading means, and a calculation for calculating the current handling position and posture of the handling section based on the data binarized by the binarizing means. And a correction unit that corrects the handling position and orientation of the handling unit based on a comparison between a previously taught handling position and orientation and the current handling position and orientation calculated by the calculation unit. A handling position / orientation correction device for mobile robots.
【請求項2】 請求項1記載の移動ロボットのハンドリ
ング位置・姿勢補正装置において、 前記記憶手段における記憶内容(すなわち、前記移動ロ
ボットの各移動先に対応するスレショルド値)を設定す
る設定手段を具備することを特徴とする移動ロボットの
ハンドリング位置・姿勢補正装置。
2. The handling position / orientation correction device for a mobile robot according to claim 1, further comprising setting means for setting the stored contents of the storage means (that is, the threshold value corresponding to each destination of the mobile robot). A handling position / orientation correction device for a mobile robot, characterized by:
【請求項3】 請求項2記載の移動ロボットのハンドリ
ング位置・姿勢補正装置において、 前記予め教示されたハンドリング位置および姿勢は、前
記設定手段が設定したスレショルド値に基づいて算出さ
れたものであることを特徴とする移動ロボットのハンド
リング位置・姿勢補正装置。
3. The handling position / orientation correcting device for a mobile robot according to claim 2, wherein the pre-taught handling position and orientation are calculated based on a threshold value set by the setting means. A handling position / orientation correction device for mobile robots.
【請求項4】 請求項2または請求項3のいずれかに記
載の移動ロボットのハンドリング位置・姿勢補正装置に
おいて、 前記設定手段は、 前記スレショルド値を徐々に変化させる変化手段と、 前記カメラが出力したデータを、前記変化手段が変化さ
せたスレショルド値で2値化する第2の2値化手段と、 前記第2の2値化手段が2値化したデータに基づく画像
において、前記ハンドリング位置・姿勢補正用マークが
正しく認識され始めた時点のスレショルド値と、該マー
クが正しく認識されなくなった時点のスレショルド値と
の中間値を算出するスレショルド値算出手段と、 前記スレショルド値算出手段が算出した中間値を、前記
移動ロボットの現在位置に対応するスレショルド値とし
て、前記記憶手段に書き込む書込手段とからなることを
特徴とする移動ロボットのハンドリング位置・姿勢補正
装置。
4. The handling position / orientation correction device for a mobile robot according to claim 2, wherein the setting unit changes the threshold value gradually, and the camera outputs the change value. Second binarizing means for binarizing the generated data with the threshold value changed by the changing means, and an image based on the data binarized by the second binarizing means. A threshold value calculation means for calculating an intermediate value between the threshold value at the time when the posture correction mark starts to be correctly recognized and the threshold value at the time when the mark is not correctly recognized, and an intermediate value calculated by the threshold value calculation means. And a writing unit that writes the value in the storage unit as a threshold value corresponding to the current position of the mobile robot. Handling position and posture correction device of a mobile robot is characterized.
【請求項5】 請求項2または請求項3のいずれかに記
載の移動ロボットのハンドリング位置・姿勢補正装置に
おいて、 前記設定手段は、 前記スレショルド値を徐々に変化させる変化手段と、 前記カメラが出力したデータを、前記変化手段が変化さ
せたスレショルド値で2値化する第2の2値化手段と、 前記第2の2値化手段が2値化したデータに基づく画像
を表示する表示手段と、 前記表示手段が表示する画像において、前記ハンドリン
グ位置・姿勢補正用マークが正しく認識され始めた時点
で操作される第1の操作手段と、 前記表示手段が表示する画像において、前記ハンドリン
グ位置・姿勢補正用マークが正しく認識されなくなった
時点で操作される第2の操作手段と、 前記第1の操作手段が操作された時点のスレショルド値
と、前記第2の操作手段が操作された時点のスレショル
ド値との中間値を算出するスレショルド値算出手段と、 前記スレショルド値算出手段が算出した中間値を、前記
移動ロボットの現在位置に対応するスレショルド値とし
て、前記記憶手段に書き込む書込手段とからなることを
特徴とする移動ロボットのハンドリング位置・姿勢補正
装置。
5. The handling position / orientation correction device for a mobile robot according to claim 2, wherein the setting unit changes the threshold value gradually, and the camera outputs the change value. Second binarizing means for binarizing the converted data with the threshold value changed by the changing means, and display means for displaying an image based on the data binarized by the second binarizing means. In the image displayed by the display unit, a first operation unit that is operated when the handling position / orientation correction mark starts to be correctly recognized, and in the image displayed by the display unit, the handling position / orientation Second operation means that is operated when the correction mark is no longer correctly recognized, and a threshold value when the first operation means is operated, The threshold value calculation means for calculating an intermediate value with respect to the threshold value at the time when the second operation means is operated, and the intermediate value calculated by the threshold value calculation means for the threshold value corresponding to the current position of the mobile robot. A handling position / orientation correction device for a mobile robot, comprising: writing means for writing in the storage means.
JP05970496A 1996-03-15 1996-03-15 Mobile robot handling position / posture correction device Expired - Fee Related JP3351228B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP05970496A JP3351228B2 (en) 1996-03-15 1996-03-15 Mobile robot handling position / posture correction device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP05970496A JP3351228B2 (en) 1996-03-15 1996-03-15 Mobile robot handling position / posture correction device

Publications (2)

Publication Number Publication Date
JPH09251309A true JPH09251309A (en) 1997-09-22
JP3351228B2 JP3351228B2 (en) 2002-11-25

Family

ID=13120879

Family Applications (1)

Application Number Title Priority Date Filing Date
JP05970496A Expired - Fee Related JP3351228B2 (en) 1996-03-15 1996-03-15 Mobile robot handling position / posture correction device

Country Status (1)

Country Link
JP (1) JP3351228B2 (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6671574B1 (en) 2002-08-30 2003-12-30 Fujitsu Limited Position detecting apparatus and library apparatus
JP2016221622A (en) * 2015-05-29 2016-12-28 ファナック株式会社 Production system equipped with robot having position correction function
CN114340842A (en) * 2019-08-30 2022-04-12 Dmg森精机株式会社 Production system
US11325261B2 (en) 2019-03-29 2022-05-10 Fanuc Corporation Transfer device and delivery system

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6671574B1 (en) 2002-08-30 2003-12-30 Fujitsu Limited Position detecting apparatus and library apparatus
JP2016221622A (en) * 2015-05-29 2016-12-28 ファナック株式会社 Production system equipped with robot having position correction function
US10031515B2 (en) 2015-05-29 2018-07-24 Fanuc Corporation Production system including robot with position correction function that supplies or ejects workpieces to or from a machine tool
US11325261B2 (en) 2019-03-29 2022-05-10 Fanuc Corporation Transfer device and delivery system
CN114340842A (en) * 2019-08-30 2022-04-12 Dmg森精机株式会社 Production system

Also Published As

Publication number Publication date
JP3351228B2 (en) 2002-11-25

Similar Documents

Publication Publication Date Title
CN109940662B (en) Image pickup device provided with vision sensor for picking up workpiece
JP4296914B2 (en) Position teaching device and transport system including the same
JP4544796B2 (en) Component mounting method and component mounting apparatus
US4424588A (en) Method for detecting the position of a symmetrical article
JPH04233245A (en) System and method for inspection and alignment at semiconductor chip and conductor lead frame
JPH07122900A (en) Component-data recording device for electronic component and conveying and assembling device for electronic component using recording device thereof
JP3351228B2 (en) Mobile robot handling position / posture correction device
CN110853102A (en) Novel robot vision calibration and guide method, device and computer equipment
JP3310882B2 (en) Electronic component mounting device
JP2965362B2 (en) Electronic component recognition method
JP3819993B2 (en) Wafer inspection equipment
JPH03281182A (en) Coordinate correcting method for moving robot
JPWO2020100522A1 (en) Mark detection systems, signal processing circuits, computer programs and methods
JPH1047924A (en) 3-dimension position measuring device
JPH08285526A (en) Image recognition system
JP2885694B2 (en) Automatic visual inspection system for semiconductor substrate surface
JPH06270083A (en) Work position detector
JPH11274219A (en) Method and device for correcting bonding coordinate
CN111447366B (en) Transportation method, transportation device, electronic device, and computer-readable storage medium
JPH10227622A (en) Inspection method of lead and lead inspecting instrument
JP4531995B2 (en) Wafer ID reading mechanism and reading method
JP3003229B2 (en) Work posture determination method
JP2527233Y2 (en) Work position detector
JPH10279049A (en) Shift detection device for glass substrate
CN117985299A (en) Foam shell positioning method and device, storage medium and electronic equipment

Legal Events

Date Code Title Description
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20020820

S531 Written request for registration of change of domicile

Free format text: JAPANESE INTERMEDIATE CODE: R313531

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

LAPS Cancellation because of no payment of annual fees