JP2753342B2 - ワーク位置検出装置 - Google Patents
ワーク位置検出装置Info
- Publication number
- JP2753342B2 JP2753342B2 JP23893489A JP23893489A JP2753342B2 JP 2753342 B2 JP2753342 B2 JP 2753342B2 JP 23893489 A JP23893489 A JP 23893489A JP 23893489 A JP23893489 A JP 23893489A JP 2753342 B2 JP2753342 B2 JP 2753342B2
- Authority
- JP
- Japan
- Prior art keywords
- work
- displacement
- robot
- sensor
- displacement meter
- 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.)
- Expired - Lifetime
Links
Landscapes
- Manipulator (AREA)
Description
【発明の詳細な説明】 発明の目的 [産業上の利用分野] 本発明はワーク位置検出装置に関し、詳しくは組立ラ
イン等に配置されたワークの位置ずれを検出するワーク
位置検出装置に関する。
イン等に配置されたワークの位置ずれを検出するワーク
位置検出装置に関する。
[従来の技術] 一般に、溶接や塗装等の各種作業に導入されている産
業用ロボット(以下、単にロボットと呼ぶ)は、ティー
チング(教示操作)によって座標値をデータとして記憶
させた複数の点を、指定された順序で動作するように構
成されている。そして、このようなロボットを用いる場
合には、組立ライン等に配置されるワークが、常に正確
な位置に配置されるか、あるいは、ワークの正確な位置
を検出して、予めティーチングしたデータを補正する必
要があった。
業用ロボット(以下、単にロボットと呼ぶ)は、ティー
チング(教示操作)によって座標値をデータとして記憶
させた複数の点を、指定された順序で動作するように構
成されている。そして、このようなロボットを用いる場
合には、組立ライン等に配置されるワークが、常に正確
な位置に配置されるか、あるいは、ワークの正確な位置
を検出して、予めティーチングしたデータを補正する必
要があった。
従来、ワークの位置を正確に検出するために、ワーク
に形成された穴等の特徴的な形状を有する3つの点の位
置をCCDカメラ等にて計測し、その3つの点の位置から
ワークの位置を特定するものがあった。そして、検出さ
れたワークの位置と予め設定された基準位置との差に基
づいて、座標変換により教示データを補正していた。
尚、ティーチングデータを補正する技術として特開昭60
−95605号公報に、予め定めた3つの基準点にロボット
を位置決めし、そのときの座標データに基づいてロボッ
トの位置ずれを補正する方法が開示されている。
に形成された穴等の特徴的な形状を有する3つの点の位
置をCCDカメラ等にて計測し、その3つの点の位置から
ワークの位置を特定するものがあった。そして、検出さ
れたワークの位置と予め設定された基準位置との差に基
づいて、座標変換により教示データを補正していた。
尚、ティーチングデータを補正する技術として特開昭60
−95605号公報に、予め定めた3つの基準点にロボット
を位置決めし、そのときの座標データに基づいてロボッ
トの位置ずれを補正する方法が開示されている。
[発明が解決しようとする課題] しかしながら、上述した特徴的な形状を有する3つの
点の位置を計測する方法では、その3点間の関係には製
造上の誤差が存在するため、3点間の相対位置がワーク
毎に異なってしまい、正確にワークの位置を検出できな
い場合があった。例えば、車両ボディの製造工程では、
スポット溶接やプレス加工の仕上げ等において、ワーク
がたわんでしまう場合があり、ワーク毎に3点の相対位
置に誤差が生じてしまうことがある。従って、ワークの
位置を正確に検出できず、ロボットとワークとの相対位
置関係にずれが生じてしまい、正確な作業ができなくな
ったり、あるいは作業が中断されたりしていた。また、
たとえこのような特徴的形状を有する穴等の部位が正確
に形成されていても、一定面積を有する穴からある一点
を特定するためには、穴の重心位置等を画像処理等の複
雑な処理を用いて算出しなければならず、そのため処理
時間が長くかかり、装置も大がかりなものとなってしま
っていた。
点の位置を計測する方法では、その3点間の関係には製
造上の誤差が存在するため、3点間の相対位置がワーク
毎に異なってしまい、正確にワークの位置を検出できな
い場合があった。例えば、車両ボディの製造工程では、
スポット溶接やプレス加工の仕上げ等において、ワーク
がたわんでしまう場合があり、ワーク毎に3点の相対位
置に誤差が生じてしまうことがある。従って、ワークの
位置を正確に検出できず、ロボットとワークとの相対位
置関係にずれが生じてしまい、正確な作業ができなくな
ったり、あるいは作業が中断されたりしていた。また、
たとえこのような特徴的形状を有する穴等の部位が正確
に形成されていても、一定面積を有する穴からある一点
を特定するためには、穴の重心位置等を画像処理等の複
雑な処理を用いて算出しなければならず、そのため処理
時間が長くかかり、装置も大がかりなものとなってしま
っていた。
本発明のワーク位置検出装置は上記課題を解決し、ワ
ークの位置ずれを簡単に精度良く検出することを目的と
する。
ークの位置ずれを簡単に精度良く検出することを目的と
する。
発明の構成 かかる目的を達成する本発明の構成について以下説明
する。
する。
[課題を解決するための手段] 本発明の教示データ補正装置は、第1図に例示するよ
うに、 産業用ロボットRに設けられ、該ロボットRに対して
位置決めされるワークWの位置ずれを検出するワーク位
置検出装置であって、 上記ロボットRに設けられ、上記ワークW表面までの
距離の変位量を測定する変位計Sと、 上記変位計Sと上記ワークW面に略平行で所定方向に
走査させると共に、上記走査中に上記変位計Sにより検
出された変位量が所定値以上になったとき上記ワークW
に端部,接続部等の段差部が存在するとして、そのとき
の上記変位計Sの位置を特定する段差部特定手段M1と、 上記変位計Sを上記走査方向と略直交した方向で、上記
特定された段差部から各々所定距離ずらした2つの線上
にて上記ワークW面に略平行に各々走査させると共に、
上記各々の走査毎に上記変位計Sにより検出された変位
量が所定値以上になったとき上記ワークWに段差部が存
在するとして、そのときの上記変位計Sの位置あるいは
該位置から一定距離ずらした位置を第1位置,第2位置
として特定する第1・第2位置特定手段M2と、 上記第1位置,第2位置から各々所定距離を隔てた位
置上において、上記ワークW面から所定距離隔てた位置
を第3位置として特定する第3位置特定手段M3と、 上記特定された第1,第2,第3位置と、予め設定した基
準位置としての3つの位置との偏差に基づいて、上記ワ
ークWの位置ずれを検出する位置ずれ検出手段M4と を備えたことを要旨とする。
うに、 産業用ロボットRに設けられ、該ロボットRに対して
位置決めされるワークWの位置ずれを検出するワーク位
置検出装置であって、 上記ロボットRに設けられ、上記ワークW表面までの
距離の変位量を測定する変位計Sと、 上記変位計Sと上記ワークW面に略平行で所定方向に
走査させると共に、上記走査中に上記変位計Sにより検
出された変位量が所定値以上になったとき上記ワークW
に端部,接続部等の段差部が存在するとして、そのとき
の上記変位計Sの位置を特定する段差部特定手段M1と、 上記変位計Sを上記走査方向と略直交した方向で、上記
特定された段差部から各々所定距離ずらした2つの線上
にて上記ワークW面に略平行に各々走査させると共に、
上記各々の走査毎に上記変位計Sにより検出された変位
量が所定値以上になったとき上記ワークWに段差部が存
在するとして、そのときの上記変位計Sの位置あるいは
該位置から一定距離ずらした位置を第1位置,第2位置
として特定する第1・第2位置特定手段M2と、 上記第1位置,第2位置から各々所定距離を隔てた位
置上において、上記ワークW面から所定距離隔てた位置
を第3位置として特定する第3位置特定手段M3と、 上記特定された第1,第2,第3位置と、予め設定した基
準位置としての3つの位置との偏差に基づいて、上記ワ
ークWの位置ずれを検出する位置ずれ検出手段M4と を備えたことを要旨とする。
[作用] 上記構成を有する本発明のワーク位置検出装置は、ま
ず、段差部特定手段M1によりロボットRに設けられた変
位計SをワークW面に略平行に走査させ、検出された変
位量が所定値以上になったときにワークWに段差部が存
在するとして、そのときの変位計Sの位置を特定し、次
に、第1・第2位置特定手段M2により上記走査方向と略
直交した方向で、しかも先に検出された段差部から所定
距離ずらした2つの線上にて変位計SをワークW面に略
平行に走査させ、検出された変位量が所定値以上になっ
たときにワークWに段差部が存在するとして、そのとき
の変位計Sの位置あるいはその位置から一定距離ずらし
た位置を第1位置,第2位置として特定する。更に、第
3位置特定手段M3により第1位置,第2位置から各々所
定距離隔てた位置上で、しかもワークW面から所定距離
隔てた位置を第3位置として特定し、位置ずれ検出手段
M4により、これら第1,第2,第3位置と予め設定した基準
位置としての3つの位置とを比べ、その偏差に基づいて
ワークWの位置ずれを検出する。即ち、ワークWに検出
された3つの段差部から第1,第2位置を特定し、その第
1,第2位置からの距離とワークW面からの距離とから第
3位置を特定することにより、ワークWの位置が特定さ
れるのである。
ず、段差部特定手段M1によりロボットRに設けられた変
位計SをワークW面に略平行に走査させ、検出された変
位量が所定値以上になったときにワークWに段差部が存
在するとして、そのときの変位計Sの位置を特定し、次
に、第1・第2位置特定手段M2により上記走査方向と略
直交した方向で、しかも先に検出された段差部から所定
距離ずらした2つの線上にて変位計SをワークW面に略
平行に走査させ、検出された変位量が所定値以上になっ
たときにワークWに段差部が存在するとして、そのとき
の変位計Sの位置あるいはその位置から一定距離ずらし
た位置を第1位置,第2位置として特定する。更に、第
3位置特定手段M3により第1位置,第2位置から各々所
定距離隔てた位置上で、しかもワークW面から所定距離
隔てた位置を第3位置として特定し、位置ずれ検出手段
M4により、これら第1,第2,第3位置と予め設定した基準
位置としての3つの位置とを比べ、その偏差に基づいて
ワークWの位置ずれを検出する。即ち、ワークWに検出
された3つの段差部から第1,第2位置を特定し、その第
1,第2位置からの距離とワークW面からの距離とから第
3位置を特定することにより、ワークWの位置が特定さ
れるのである。
[実施例] 以上説明した本発明の構成・作用を一層明らかにする
ために、以下本発明のワーク位置検出装置の好適な実施
例について説明する。
ために、以下本発明のワーク位置検出装置の好適な実施
例について説明する。
第2図は、一実施例としてのワーク位置検出装置の概
略システム構成図である。ワーク位置検出装置は、車両
(以下、ワークWと呼ぶ)のルーフパネルRPとクォータ
パネルQPとの溶接(プラズマ溶接)を行なうロボット1
と、ロボット1の動作制御部であるロボットコントロー
ラ3と、ロボット1の手先に溶接トーチ5と共に設けら
れワークWの表面状態を検出するセンサ7と、センサ7
からの信号を処理するセンサコントローラ9とを備え
る。また、ロボットコントローラ3は、作業者がロボッ
ト1に仕事を教示するティーチボックス11と、入出力手
段としてのキーボードおよびCRTからなるターミナル13
とを備える。
略システム構成図である。ワーク位置検出装置は、車両
(以下、ワークWと呼ぶ)のルーフパネルRPとクォータ
パネルQPとの溶接(プラズマ溶接)を行なうロボット1
と、ロボット1の動作制御部であるロボットコントロー
ラ3と、ロボット1の手先に溶接トーチ5と共に設けら
れワークWの表面状態を検出するセンサ7と、センサ7
からの信号を処理するセンサコントローラ9とを備え
る。また、ロボットコントローラ3は、作業者がロボッ
ト1に仕事を教示するティーチボックス11と、入出力手
段としてのキーボードおよびCRTからなるターミナル13
とを備える。
ロボットコントローラ3は、第3図に示すように、周
知のCPU31,RAM32,ROM33から算術論理演算回路を構成す
ると共に、ロボット1と情報の授受を行なうロボットイ
ンタフェース34,入出力手段としてのターミナル13と情
報の授受を行なうターミナルインタフェース35,ティー
チボックス11の操作状態を入力するティーチボックスイ
ンタフェース36、センサ7の出力する電気信号をセンサ
コントローラ9を介して入力するセンサインタフェース
37を備え、それらは、バス38により相互に接続されてい
る。
知のCPU31,RAM32,ROM33から算術論理演算回路を構成す
ると共に、ロボット1と情報の授受を行なうロボットイ
ンタフェース34,入出力手段としてのターミナル13と情
報の授受を行なうターミナルインタフェース35,ティー
チボックス11の操作状態を入力するティーチボックスイ
ンタフェース36、センサ7の出力する電気信号をセンサ
コントローラ9を介して入力するセンサインタフェース
37を備え、それらは、バス38により相互に接続されてい
る。
ロボット1の手先で溶接トーチ5から所定距離を隔て
て配置されたセンサ7には、レーザ式変位計が用いられ
る。このレーザ式変位計は、第4図に示すように、レー
ザ光を発射するレーザダイオード71と、発射されたレー
ザ光を平行光にするコリメーティングレンズ72と、ワー
クW上に形成されるレーザ光のスポットからの乱反射を
入光し光位置検出素子73に結像させる受光レンズ74と、
レーザ光の入射位置に応じた光電流l1,12を2つの電極
からセンサコントローラ9に出力する光位置検出素子73
とからなる。ワークW面が、基準位置Oから位置Aある
いは位置Bに変位すると、光位置検出素子の結像位置
は、位置O′から位置A′あるいは位置B′に移動し、
それに応じて光電流l1,12が変化する。そして、この光
電流l1,12に基づいてセンサコントローラ9で演算処理
によりワークW面までの距離の変位を算出する。
て配置されたセンサ7には、レーザ式変位計が用いられ
る。このレーザ式変位計は、第4図に示すように、レー
ザ光を発射するレーザダイオード71と、発射されたレー
ザ光を平行光にするコリメーティングレンズ72と、ワー
クW上に形成されるレーザ光のスポットからの乱反射を
入光し光位置検出素子73に結像させる受光レンズ74と、
レーザ光の入射位置に応じた光電流l1,12を2つの電極
からセンサコントローラ9に出力する光位置検出素子73
とからなる。ワークW面が、基準位置Oから位置Aある
いは位置Bに変位すると、光位置検出素子の結像位置
は、位置O′から位置A′あるいは位置B′に移動し、
それに応じて光電流l1,12が変化する。そして、この光
電流l1,12に基づいてセンサコントローラ9で演算処理
によりワークW面までの距離の変位を算出する。
次に、本実施例のワーク位置検出装置が実行するワー
ク位置検出処理について、第5図のワーク位置検出ルー
チンを示すフローチャートおよび第6図のセンサ7の走
査手順を示す説明図と共に説明する。
ク位置検出処理について、第5図のワーク位置検出ルー
チンを示すフローチャートおよび第6図のセンサ7の走
査手順を示す説明図と共に説明する。
第6図は、車両のルーフパネルPRとクォータパネルQP
との接続位置近傍を表すもので、この状態から以下の処
理によりワークWの位置を検出し、ティーチングデータ
を補正した後、ルーフパネルRPとクォータパネルQPとの
接続部(以下、ギャップGと呼ぶ)が溶接トーチ5にて
溶接されるのである。
との接続位置近傍を表すもので、この状態から以下の処
理によりワークWの位置を検出し、ティーチングデータ
を補正した後、ルーフパネルRPとクォータパネルQPとの
接続部(以下、ギャップGと呼ぶ)が溶接トーチ5にて
溶接されるのである。
まず、第6図(ア)に示すように、ロボット1を駆動
してセンサ7をルーフパネルRP面に平行で矢印X方向に
走査させると共に、センサコントローラ9の出力データ
である変位量αを監視しつつ、その変位量αが予め設定
されたスレショルド値K1以上になったときのロボット座
標を、図示しないエンコーダの出力から3次元位置情報
として取り込む(第5図ステップ100)。この処理によ
れば、走査線xとルーフ立て壁面RWとの交点である点A1
上をセンサ7が通過したときに、センサ7とルーフパネ
ルRP面との距離が変位することにより変位量αがスレシ
ョルド値K1以上の値となり、段差の存在するこの位置で
のロボット座標が取り込まれる。
してセンサ7をルーフパネルRP面に平行で矢印X方向に
走査させると共に、センサコントローラ9の出力データ
である変位量αを監視しつつ、その変位量αが予め設定
されたスレショルド値K1以上になったときのロボット座
標を、図示しないエンコーダの出力から3次元位置情報
として取り込む(第5図ステップ100)。この処理によ
れば、走査線xとルーフ立て壁面RWとの交点である点A1
上をセンサ7が通過したときに、センサ7とルーフパネ
ルRP面との距離が変位することにより変位量αがスレシ
ョルド値K1以上の値となり、段差の存在するこの位置で
のロボット座標が取り込まれる。
続いて、点A1と、予めマスターボディにティーチング
した設定点A0とのX方向のずれΔlを算出する(ステッ
プ110)。
した設定点A0とのX方向のずれΔlを算出する(ステッ
プ110)。
次に、第6図(イ)に示すように、矢印Y方向(ワー
クW面に平行でX方向に対して直行する方向)にセンサ
7をステップ100と同様に走査をするが、この走査は、
予めティーチングした走査線y01に対して、上記ずれΔ
lだけX方向にシフトさせた走査線y1上にて行なわれ
る。即ち、走査線y1上にてワークW面の変位量αを監視
しつつ、その変位量αが予め設定されたスレショルド値
K1以上になる位置を検出するのである。従って、この走
査がギャップGにまで達すると、変位量αはスレショル
ド値K1以上の値となり、このときの点B1が検出される
(ステップ120)。
クW面に平行でX方向に対して直行する方向)にセンサ
7をステップ100と同様に走査をするが、この走査は、
予めティーチングした走査線y01に対して、上記ずれΔ
lだけX方向にシフトさせた走査線y1上にて行なわれ
る。即ち、走査線y1上にてワークW面の変位量αを監視
しつつ、その変位量αが予め設定されたスレショルド値
K1以上になる位置を検出するのである。従って、この走
査がギャップGにまで達すると、変位量αはスレショル
ド値K1以上の値となり、このときの点B1が検出される
(ステップ120)。
続いて、第6図(ウ)に示すように、センサ7を点B1
を検知した位置から距離mだけ矢印Yの反対方向にシフ
トさせ、更に、矢印Z1方向(ワークW面に対して鉛直方
向)に移動させて、一旦センサ7の測定範囲外にまで移
し、次に、センサ7を逆にZ2方向(Z1と反対方向)に戻
しつつ、変位量αを監視する。そして、この変位量αが
予め設定された設定値K2と等しくなったときのロボット
座標を取り込み、センサ7の位置である点C1の3次元位
置情報を算出する(ステップ130)。センサコントロー
ラ9の出力する変位量αは、測定範囲内ではワークW面
の変位にリニアに対応するのに対し測定範囲外では急激
に変化するため、測定範囲の境界線上での変位量αの値
を設定値K2に定めることにより、センサ7がワークW面
から所定距離(測定範囲の境界線までの距離)隔てたと
きの位置を点C1として精度良く検出しているのである。
本実施例では、センサ7の測定範囲が35mm〜45mmである
ため、センサ7がワークW面から45mm離れた位置におい
てロボット座標が取り込まれるよう設定値K2が決められ
ている。
を検知した位置から距離mだけ矢印Yの反対方向にシフ
トさせ、更に、矢印Z1方向(ワークW面に対して鉛直方
向)に移動させて、一旦センサ7の測定範囲外にまで移
し、次に、センサ7を逆にZ2方向(Z1と反対方向)に戻
しつつ、変位量αを監視する。そして、この変位量αが
予め設定された設定値K2と等しくなったときのロボット
座標を取り込み、センサ7の位置である点C1の3次元位
置情報を算出する(ステップ130)。センサコントロー
ラ9の出力する変位量αは、測定範囲内ではワークW面
の変位にリニアに対応するのに対し測定範囲外では急激
に変化するため、測定範囲の境界線上での変位量αの値
を設定値K2に定めることにより、センサ7がワークW面
から所定距離(測定範囲の境界線までの距離)隔てたと
きの位置を点C1として精度良く検出しているのである。
本実施例では、センサ7の測定範囲が35mm〜45mmである
ため、センサ7がワークW面から45mm離れた位置におい
てロボット座標が取り込まれるよう設定値K2が決められ
ている。
同様に、第6図(イ),(ウ)に示すように、走査線
y2(走査線y02に対してX方向にΔlシフトさせた走査
線)上を走査して点B2を求め、更に、センサ7をその位
置から所定距離mシフトさせ、Z1,Z2方向に移動させて
変位量αと設定値K2とが等しくなったとき、即ち、セン
サ7がワークW面から所定距離離れたときのロボット座
標を取り込み、そのときのセンサ7の位置である点C2の
3次元位置情報を算出する(ステップ140,150)。
y2(走査線y02に対してX方向にΔlシフトさせた走査
線)上を走査して点B2を求め、更に、センサ7をその位
置から所定距離mシフトさせ、Z1,Z2方向に移動させて
変位量αと設定値K2とが等しくなったとき、即ち、セン
サ7がワークW面から所定距離離れたときのロボット座
標を取り込み、そのときのセンサ7の位置である点C2の
3次元位置情報を算出する(ステップ140,150)。
次に、点C1,C2から各々等距離nを隔てた位置上で、
センサ7を測定範囲外からワークW面(クォータパネル
QP面)に近づけていき、変位量αが設定値K2になったと
きのロボット座標を取り込み、そのときのセンサ7の位
置である点C3を算出する(ステップ160)。即ち、点C1,
C2を底辺とする二等辺三角計の頂点となる位置上で、し
かもワークW面から所定距離(本実施例では45mm)離れ
た点である点C3の3次元位置情報を算出するのである。
センサ7を測定範囲外からワークW面(クォータパネル
QP面)に近づけていき、変位量αが設定値K2になったと
きのロボット座標を取り込み、そのときのセンサ7の位
置である点C3を算出する(ステップ160)。即ち、点C1,
C2を底辺とする二等辺三角計の頂点となる位置上で、し
かもワークW面から所定距離(本実施例では45mm)離れ
た点である点C3の3次元位置情報を算出するのである。
以上のように算出した点C1,C2,C3と、予め設定された
基準点C01,C02,C03とに基づいて座標変換を行ない、ワ
ークWの位置ずれを算出し、ロボット1のティーチング
データを補正して(ステップ170)、本制御ルーチンを
終了する。尚、算出されたワークWの位置ずれに基づい
て、図示しない治具を備えたロボットのワークWの保持
位置も同時に補正される。
基準点C01,C02,C03とに基づいて座標変換を行ない、ワ
ークWの位置ずれを算出し、ロボット1のティーチング
データを補正して(ステップ170)、本制御ルーチンを
終了する。尚、算出されたワークWの位置ずれに基づい
て、図示しない治具を備えたロボットのワークWの保持
位置も同時に補正される。
以上説明した本実施例のワーク位置検出装置は、ワー
クWに形成された端部,接続部等の段差部を変位計であ
るセンサ7により検出して、まず、ワークのX方向のず
れ量Δlを求め、そのずれ量Δlに応じて他の段差部
(ギャップG)の検出用走査線の位置を補正して、ワー
ク位置を特定するための2点(C1,C2)を求めている。
そして、その2点から等距離で、且つ、ワークW面から
所定距離となる1点(C3)求め、それら3点からワーク
位置を検出するものである。従って、ワークWの位置が
X方向にずれていても、ワークWに対し予め設定された
走査位置にて決定されるため、段差部を検出する位置に
バラツキがなく、精度良くワークWの位置が検出でき
る。また、ギャップG位置から所定距離mシフトさせた
位置にて点C1,C2を求めているため、ギャップG近傍が
鏡面状態であってもセンサ7が誤動作することがない。
更に、センサ7の測定範囲境界上での変位量αの値を設
定値K2に定めているため、センサ7がワークW面から所
定距離隔てたときの位置を精度良く検出することができ
る。従って、高精度にワークWの位置を検出できるた
め、その位置ずれを補正することにより、ルーフパネル
RPとクォータパネルQP間のロー付けを精度良く行うこと
ができる。特に、本実施例のようにプラズマ溶接のため
熱集中が高く正確な位置制御が必要とされる場合には、
有効なものとなる。本実施例によれば、繰り返し精度は
±0.2mmとなり、要求精度を充分満たすものとなってい
る。加えて、従来のように画像処理等の複雑な演算処理
を行なうことなく、変位量αが所定値以上か否かを判断
するだけでワークの位置を特定する3点が求められるた
め、非常に簡易にシステムが構成できると共に、処理時
間も短縮できる。また、撮像装置を用いた場合に問題と
なる照明やワークの汚れ等による外乱の影響もない。
クWに形成された端部,接続部等の段差部を変位計であ
るセンサ7により検出して、まず、ワークのX方向のず
れ量Δlを求め、そのずれ量Δlに応じて他の段差部
(ギャップG)の検出用走査線の位置を補正して、ワー
ク位置を特定するための2点(C1,C2)を求めている。
そして、その2点から等距離で、且つ、ワークW面から
所定距離となる1点(C3)求め、それら3点からワーク
位置を検出するものである。従って、ワークWの位置が
X方向にずれていても、ワークWに対し予め設定された
走査位置にて決定されるため、段差部を検出する位置に
バラツキがなく、精度良くワークWの位置が検出でき
る。また、ギャップG位置から所定距離mシフトさせた
位置にて点C1,C2を求めているため、ギャップG近傍が
鏡面状態であってもセンサ7が誤動作することがない。
更に、センサ7の測定範囲境界上での変位量αの値を設
定値K2に定めているため、センサ7がワークW面から所
定距離隔てたときの位置を精度良く検出することができ
る。従って、高精度にワークWの位置を検出できるた
め、その位置ずれを補正することにより、ルーフパネル
RPとクォータパネルQP間のロー付けを精度良く行うこと
ができる。特に、本実施例のようにプラズマ溶接のため
熱集中が高く正確な位置制御が必要とされる場合には、
有効なものとなる。本実施例によれば、繰り返し精度は
±0.2mmとなり、要求精度を充分満たすものとなってい
る。加えて、従来のように画像処理等の複雑な演算処理
を行なうことなく、変位量αが所定値以上か否かを判断
するだけでワークの位置を特定する3点が求められるた
め、非常に簡易にシステムが構成できると共に、処理時
間も短縮できる。また、撮像装置を用いた場合に問題と
なる照明やワークの汚れ等による外乱の影響もない。
次に、本発明の第2の実施例として、ワーク位置検出
装置が実行するワーク位置検出処理について、第7図に
示すフローチャートと第8図のセンサ7の走査手順を示
す説明図と共に説明する。尚、上述した第1実施例の処
理と同じところは、簡単な説明にとどめる。
装置が実行するワーク位置検出処理について、第7図に
示すフローチャートと第8図のセンサ7の走査手順を示
す説明図と共に説明する。尚、上述した第1実施例の処
理と同じところは、簡単な説明にとどめる。
第8図は、車両のルーフパネルRPとクォータパネルQP
との接続位置近傍を表す側面図およびS−S線に沿う断
面図(第8図(イ)(ウ)(エ)のみ右側に記載する)
である。
との接続位置近傍を表す側面図およびS−S線に沿う断
面図(第8図(イ)(ウ)(エ)のみ右側に記載する)
である。
まず、第8図(ア)に示すように、ロボットを駆動し
てセンサ7をルーフパネルRP面に平行で矢印X方向(車
両後方向)に走査させると共に、変位量αを監視つつ、
変位量αがスレショルド値K1以上になったときのロボッ
ト座標を取り込む(第7図ステップ200)。即ち、ルー
フパネルRPの端部と走査線上の交点である点Aの位置を
検出するのである。
てセンサ7をルーフパネルRP面に平行で矢印X方向(車
両後方向)に走査させると共に、変位量αを監視つつ、
変位量αがスレショルド値K1以上になったときのロボッ
ト座標を取り込む(第7図ステップ200)。即ち、ルー
フパネルRPの端部と走査線上の交点である点Aの位置を
検出するのである。
次に、第8図(イ)に示すように、センサ7を点Aか
ら矢印Xの反対方向に距離lだけ平行移動させ、ワーク
W側面に平行で矢印Y方向に走査を行ない、変位量αが
スレショルドK1値以上となるギャップG上での点B1を検
出し(ステップ210)、更に、点B1を検出した位置から
センサ7を矢印Z方向(ワークW面に対して鉛直方向)
に移動させながら、変位量αを監視して、変位量αが設
定値K2と等しくなったときのロボット座標を取り込み、
センサ7の位置である点C1の3次元位置情報を算出する
(ステップ220)。即ち、点B1からZ方向に所定距離離
れた点C1の位置を算出する。
ら矢印Xの反対方向に距離lだけ平行移動させ、ワーク
W側面に平行で矢印Y方向に走査を行ない、変位量αが
スレショルドK1値以上となるギャップG上での点B1を検
出し(ステップ210)、更に、点B1を検出した位置から
センサ7を矢印Z方向(ワークW面に対して鉛直方向)
に移動させながら、変位量αを監視して、変位量αが設
定値K2と等しくなったときのロボット座標を取り込み、
センサ7の位置である点C1の3次元位置情報を算出する
(ステップ220)。即ち、点B1からZ方向に所定距離離
れた点C1の位置を算出する。
続いて、第8図(ウ)に示すように、ステップで走査
した位置から所定距離mだけX方向にずらした走査位置
にて、上述したステップ210の処理と同様にギャップG
上での点B2を検出し(ステップ230)、更に、センサ7
をZ方向に移動して変位量αが設定値K2と等しくなった
ときのロボット座標を取り込み、センサ7の位置である
点C2の3次元位置情報を算出する(ステップ240)。
した位置から所定距離mだけX方向にずらした走査位置
にて、上述したステップ210の処理と同様にギャップG
上での点B2を検出し(ステップ230)、更に、センサ7
をZ方向に移動して変位量αが設定値K2と等しくなった
ときのロボット座標を取り込み、センサ7の位置である
点C2の3次元位置情報を算出する(ステップ240)。
次に、第8図(エ)に示すように、センサ7を点B2を
検出した位置からワークW面に平行に矢印Y方向に所定
距離nだけ離れた位置(点B3)に移動し、更に、Z方向
に移動して変位量αが設定値K2と等しくなったときのロ
ボット座標を取り込み、センサ7の位置である点C3の3
次元位置情報を算出する(ステップ250)。
検出した位置からワークW面に平行に矢印Y方向に所定
距離nだけ離れた位置(点B3)に移動し、更に、Z方向
に移動して変位量αが設定値K2と等しくなったときのロ
ボット座標を取り込み、センサ7の位置である点C3の3
次元位置情報を算出する(ステップ250)。
以上のように算出した点C1,C2,C3と、予め設定された
基準点C01,C02,C03とに基づいて座標変換を行ない、ワ
ークWの位置ずれを算出し、ロボット1のティーチング
データを補正して(ステップ260)、本制御ルーチンを
終了する。
基準点C01,C02,C03とに基づいて座標変換を行ない、ワ
ークWの位置ずれを算出し、ロボット1のティーチング
データを補正して(ステップ260)、本制御ルーチンを
終了する。
以上説明した第2実施例のワーク検出装置は、第1実
施例の効果に加え、走査が簡易になり、一層処理時間が
短縮される。
施例の効果に加え、走査が簡易になり、一層処理時間が
短縮される。
以上本発明の実施例について説明したが、本発明はこ
うした実施例に何等限定されるものではなく、例えば、
レーザ式変位計に代えて超音波式あるいは渦電流式変位
形を用いた構成であっても良く、また、点C3の位置を、
点C1,C2を底辺とする二等辺三角計の頂点に限定する必
要もなく、本発明の要旨を逸脱しない範囲において、種
々なる態様で実施し得ることは勿論である。
うした実施例に何等限定されるものではなく、例えば、
レーザ式変位計に代えて超音波式あるいは渦電流式変位
形を用いた構成であっても良く、また、点C3の位置を、
点C1,C2を底辺とする二等辺三角計の頂点に限定する必
要もなく、本発明の要旨を逸脱しない範囲において、種
々なる態様で実施し得ることは勿論である。
発明の効果 以上詳述したように、本発明のワーク位置検出装置に
よれば、従来のように画像処理等の複雑な演算処理を行
なうことなく、変位量が所定値以上か否かを判断するだ
けでワークの位置を特定する3点が求められるため、非
常に簡易にシステムが構成できると共に、処理時間も短
縮できる。また、撮像装置を用いた場合に問題となる照
明やワークの汚れ等による外乱の影響もない。また、ワ
ークの段差部の位置を検出して、他の段差部の走査位置
を設定しているため、ワークの位置がずれていても、予
め設定されたワークの走査位置にて決定されるため、段
差部を検出する位置にバラツキがなく、精度良くワーク
位置が検出できる。また、段差部を検出した位置から一
定距離ずらした位置を特定することにより、例えば、段
差部が鏡面状態であってもワーク面からの距離検出が可
能となる。従って、高精度にワークの位置を検出できる
ためその位置を補正することにより、ワークの加工精度
が向上する。
よれば、従来のように画像処理等の複雑な演算処理を行
なうことなく、変位量が所定値以上か否かを判断するだ
けでワークの位置を特定する3点が求められるため、非
常に簡易にシステムが構成できると共に、処理時間も短
縮できる。また、撮像装置を用いた場合に問題となる照
明やワークの汚れ等による外乱の影響もない。また、ワ
ークの段差部の位置を検出して、他の段差部の走査位置
を設定しているため、ワークの位置がずれていても、予
め設定されたワークの走査位置にて決定されるため、段
差部を検出する位置にバラツキがなく、精度良くワーク
位置が検出できる。また、段差部を検出した位置から一
定距離ずらした位置を特定することにより、例えば、段
差部が鏡面状態であってもワーク面からの距離検出が可
能となる。従って、高精度にワークの位置を検出できる
ためその位置を補正することにより、ワークの加工精度
が向上する。
第1図は本発明の基本的構成を例示するブロック図、第
2図はワーク位置検出装置の概略システム構成図、第3
図はロボットコントローラの概略構成図、第4図はセン
サの原理を示す説明図、第5図はワーク位置検出ルーチ
ンを示すフローチャート、第6図(ア)ないし(エ)は
センサの走査手順を示す説明図、第7図は第2実施例と
してのワーク位置検出ルーチンを示すフローチャート、
第8図(ア)ないし(エ)は第2実施例としてのセンサ
の走査手順を示す説明図である。 1……ロボット、3……ロボットコントローラ 7……センサ(レーザ式変位計) 9……センサコントローラ W……ワーク
2図はワーク位置検出装置の概略システム構成図、第3
図はロボットコントローラの概略構成図、第4図はセン
サの原理を示す説明図、第5図はワーク位置検出ルーチ
ンを示すフローチャート、第6図(ア)ないし(エ)は
センサの走査手順を示す説明図、第7図は第2実施例と
してのワーク位置検出ルーチンを示すフローチャート、
第8図(ア)ないし(エ)は第2実施例としてのセンサ
の走査手順を示す説明図である。 1……ロボット、3……ロボットコントローラ 7……センサ(レーザ式変位計) 9……センサコントローラ W……ワーク
───────────────────────────────────────────────────── フロントページの続き (56)参考文献 特開 昭60−95605(JP,A) 特開 昭61−269706(JP,A) 特開 昭59−216006(JP,A)
Claims (1)
- 【請求項1】産業用ロボットに設けられ、該ロボットに
対して位置決めされるワークの位置ずれを検出するワー
ク位置検出装置であって、 上記ロボットに設けられ、上記ワーク表面までの距離の
変位量を測定する変位計と、 上記変位計を上記ワーク面に略平行で所定方向に走査さ
せると共に、上記走査中に上記変位計により検出された
変位量が所定値以上になったとき上記ワークに端部,接
続部等の段差部が存在するとして、そのときの上記変位
計の位置を特定する段差部特定手段と、 上記変位計を上記走査方向と略直交した方向で、上記特
定された段差部から各々所定距離ずらした2つの線上に
て上記ワーク面に略平行に各々走査させると共に、上記
各々の走査毎に上記変位計により検出された変位量が所
定値以上になったとき上記ワークに段差部が存在すると
して、そのときの上記変位計に位置あるいは該位置から
一定距離ずらした位置を第1位置,第2位置として特定
する第1・第2位置特定手段と、 上記第1位置,第2位置から各々所定距離を隔てた位置
上において、上記ワーク面から所定距離隔てた位置を第
3位置として特定する第3位置特定手段と、 上記特定された第1,第2,第3位置と、予め設定した基準
位置としての3つの位置との偏差に基づいて、上記ワー
クの位置ずれを検出する位置ずれ検出手段と を備えたことを特徴とするワーク位置検出装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP23893489A JP2753342B2 (ja) | 1989-09-13 | 1989-09-13 | ワーク位置検出装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP23893489A JP2753342B2 (ja) | 1989-09-13 | 1989-09-13 | ワーク位置検出装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH03104594A JPH03104594A (ja) | 1991-05-01 |
JP2753342B2 true JP2753342B2 (ja) | 1998-05-20 |
Family
ID=17037451
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP23893489A Expired - Lifetime JP2753342B2 (ja) | 1989-09-13 | 1989-09-13 | ワーク位置検出装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2753342B2 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009248229A (ja) * | 2008-04-04 | 2009-10-29 | Sii Nanotechnology Inc | 微小マニピュレータ、及びそれを備えた観察装置 |
-
1989
- 1989-09-13 JP JP23893489A patent/JP2753342B2/ja not_active Expired - Lifetime
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009248229A (ja) * | 2008-04-04 | 2009-10-29 | Sii Nanotechnology Inc | 微小マニピュレータ、及びそれを備えた観察装置 |
Also Published As
Publication number | Publication date |
---|---|
JPH03104594A (ja) | 1991-05-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US5987591A (en) | Multiple-sensor robot system for obtaining two-dimensional image and three-dimensional position information | |
EP1190818B1 (en) | Position-orientation recognition device | |
US20110029131A1 (en) | Apparatus and method for measuring tool center point position of robot | |
US7502504B2 (en) | Three-dimensional visual sensor | |
TWI667090B (zh) | 雷射加工裝置 | |
CN111421226B (zh) | 一种基于激光切管设备的管材识别方法及装置 | |
US6321139B1 (en) | Operation line searching method and robot/sensor system having operation line searching function | |
JPWO2009025271A1 (ja) | ロボットの制御装置および制御方法 | |
JPH06147863A (ja) | 曲げ加工機における曲げ角度検出装置 | |
JP2753342B2 (ja) | ワーク位置検出装置 | |
JP2001157951A (ja) | 逐次2点法による形状精度測定装置および逐次2点法による形状精度測定用レーザ変位計間隔測定方法 | |
JP2680460B2 (ja) | 折曲機の角度計測装置 | |
JP2017053793A (ja) | 計測装置、および物品の製造方法 | |
JPH03268818A (ja) | 折曲機の角度計測装置 | |
JP2502533B2 (ja) | センサ付溶接ロボツト | |
Chen et al. | A simple underwater video system for laser tracking | |
JPH07332927A (ja) | ワークの位置検出装置 | |
JPH0827183B2 (ja) | 三次元座標自動測定装置 | |
JP2899642B2 (ja) | 加工位置検出装置および加工位置検出方法 | |
JP2003126963A (ja) | 溶接ロボットの教示経路修正装置 | |
JP3204587B2 (ja) | 位置検出装置 | |
JPH0647540A (ja) | 溶接開先形状の検知方法及び装置 | |
JP3596095B2 (ja) | ロボット制御装置 | |
JP2613739B2 (ja) | ワイヤタッチセンシングによる位置検出方法およびその装置 | |
JP2007263638A (ja) | 3次元形状測定装置 |