JPH05134737A - ロボツトの教示装置 - Google Patents

ロボツトの教示装置

Info

Publication number
JPH05134737A
JPH05134737A JP29469191A JP29469191A JPH05134737A JP H05134737 A JPH05134737 A JP H05134737A JP 29469191 A JP29469191 A JP 29469191A JP 29469191 A JP29469191 A JP 29469191A JP H05134737 A JPH05134737 A JP H05134737A
Authority
JP
Japan
Prior art keywords
robot
teaching
point
vector
workpiece
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
JP29469191A
Other languages
English (en)
Other versions
JP3543329B2 (ja
Inventor
Shuichi Nakada
周一 中田
Katsumi Yamamoto
克己 山本
Tadashi Koyama
正 小山
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.)
Toyoda Koki KK
Original Assignee
Toyoda Koki KK
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 Toyoda Koki KK filed Critical Toyoda Koki KK
Priority to JP29469191A priority Critical patent/JP3543329B2/ja
Publication of JPH05134737A publication Critical patent/JPH05134737A/ja
Application granted granted Critical
Publication of JP3543329B2 publication Critical patent/JP3543329B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

(57)【要約】 [目的]画像処理装置を用いて簡単なロボットの教示装
置を提供することを目的とする。 [構成]CCDカメラ24によって工作物22を撮像す
ることにより、工作物22の輪郭の位置座標を求める。
この位置座標をロボット座標に変換するとともに、ロボ
ットの姿勢ベクトルを算出し、これらのデータを教示デ
ータとしてロボットを制御し、加工を行う。

Description

【発明の詳細な説明】
【0001】
【産業上の利用分野】本発明は、画像処理装置を用いて
ロボットの教示を自動的に行うロボットの教示装置に関
する。
【0002】
【従来の技術】従来、ティーチングプレイバック方式の
ロボットにおいては、あらかじめ作業者がティーチング
ボックスを操作しながら基準工作物上でロボットを動か
すことによって、加工軌跡の教示作業を行い、この教示
作業によって記憶された教示データを基にしてロボット
が加工軌跡を再現し、工作物の加工を行っている。
【0003】
【発明が解決しようとする課題】上述した教示データ
は、加工軌跡線上の所定の間隔毎の点である教示点の位
置座標と、この教示点におけるロボットの姿勢を示す姿
勢ベクトルから成っている。このため加工軌跡が長いも
のや、複雑な曲線のものは、教示点が膨大な数となり、
作業者に大変な負担となるという問題点があった。
【0004】本発明は以上の問題点を解決するためにな
されたものであり、作業者の負担を軽減する簡単なロボ
ットの教示装置を提供することを目的とする。
【0005】
【課題を解決するための手段】本発明は、上述した目的
を達成するためになされたものであり、図1に示される
ように、あらかじめ記憶された複数の教示点とこれらの
各教示点における姿勢ベクトルを基にして制御されるロ
ボットRの教示装置であって、工作物Wを撮像する撮像
手段1と、この撮像手段1より加工軌跡の位置座標を検
出する位置座標検出手段2と、位置座標検出手段2より
検出された加工軌跡の位置座標より教示点の位置座標を
算出する教示点座標算出手段3と、教示点座標算出手段
3より算出された教示点の連続性より各教示点における
姿勢ベクトルを算出する姿勢ベクトル算出手段4とを備
えたものである。
【0006】
【作用】上記のように構成されたロボットの教示装置
は、撮像手段1によって工作物Wを撮像し、この画像処
理データを位置座標検出手段2に出力する。位置座標検
出手段2は画像処理データを基に工作物W上の加工軌跡
の位置座標を検出し、この加工軌跡の位置座標から教示
点座標算出手段3は教示点を算出する。姿勢ベクトル算
出手段4は教示点の連続性を基に姿勢ベクトルを算出す
る。このようにして求まった教示点の位置座標と姿勢ベ
クトルよりロボットRは制御される。
【0007】
【実施例】本発明の実施例について図面を参照して説明
する。図2に示すように視覚装置20は、対象物体であ
る工作物22を撮像するCCDカメラ24と、CCDカ
メラ24から出力される画像信号を画像処理して対象物
体の輪郭を特定し、この輪郭を直線近似して視覚座標
X,Yの点群データとして定める画像処理装置26から
成り立っている。工作物22はその輪郭線上を加工軌跡
とするもので、半透明の基板21上に設置されて下方の
光源23から透過光が照射されるようになっている。C
CDカメラ24は、この光源23からの透過光による工
作物22と基板21との明暗状態を画像信号として画像
処理装置26に出力する。画像処理装置26はこの出力
信号を用いて工作物22は暗部としてデータ化するとと
もに、基板21は明部としてデータ化し、この暗部と明
部の境界を工作物22の輪郭として検出する。
【0008】ロボット60の制御を行うロボット制御装
置50は、視覚装置20とインタフェース51を介して
結ばれたCPU52と、ロボット60の位置制御プログ
ラム等を記憶したROM54、教示データ等を記憶した
RAM53、そしてロボット60の各駆動軸を駆動する
サーボモータを制御するサーボCPU55を有してい
る。
【0009】ロボット60は、6軸型の多関節ロボット
であり、各軸を駆動する図略のサーボモータがロボット
制御装置50によって制御されるようになっている。図
3に示すようにロボット60の手首部先端にはバリ取り
用のグラインダ71が取り付けられており、グラインダ
71はモータ71aによって回転駆動される。グライン
ダ71には工具座標系が設定され、RAM53内部に記
憶されている。工具座標系は図3においてグラインダ7
1の回転中心軸100から下方にオフセットした位置で
あるグラインダ71の加工点を原点OT として、回転中
心軸100と平行なグラインダ71の裏面から表面(加
工面)に向かう方向にXT 軸、左方向にYT 軸、下方向
にZT 軸が設定されている。これらの各軸は、後に算出
する3つの姿勢ベクトルと対応するようになっている。
即ち、グラインダ71が工作物に接近する方向であるア
プローチベクトルAvにはZT 軸、グラインダ71の向
き指定するオリエントベクトルOvにはYT 軸、これら
の2つのベクトルAv,Ovが右手系を成すように設定
されたノーマルベクトルNvにはXT 軸が対応する。
【0010】ロボット制御装置50は、後述する点Aか
らEの位置座標(教示点の位置座標)とこれらの点にお
ける姿勢ベクトルAv,Ov,Nvを教示データとし
て、目標とする点の位置座標と工具座標原点OT を一致
させるとともに、この点における姿勢ベクトルAv,O
v,Nvと工具座標系の各軸XT ,YT ,ZT との対応
関係が正しくなるようにロボット60を制御し、グライ
ンダ71による加工を行う。
【0011】次に本実施例のロボットの教示装置の説明
をする。図4に示されるようにCCDカメラ24によっ
て撮像された工作物22は、その輪郭を画像処理装置2
6によって直線近似されて、これらの直線の交点が点群
データ(X,Y)として出力される。これらの点群デー
タは実際にはかなり多くの数となるが、ここでは簡略化
するためにAからEの5つの点データから成るものと
し、以下の説明では、主に点Aにおける教示データの作
成手順を例にとって図7のフローチャートを基に説明す
る。
【0012】ロボット制御装置50は、上述した点群デ
ータAからEを入力することによって、教示データの作
成を開始する(ステップ100)。ステップ110で
は、図5に示すようにステップ100にて入力した点A
からEの視覚座標(X,Y)を原点Orとするロボット
座標に変換し、教示点の位置座標を求める。このときC
CDカメラ24から見た点Aの視覚座標A(X,Y)を
3次元化するためにPwc=(X,Y,0)として表
す。この位置座標Pwcと、あらかじめわかっているロ
ボット座標から見たCCDカメラ24の位置座標Pcr
=(x,y,z)とから、ロボット座標から見た点Aの
位置座標、即ち教示点Aの位置座標Pwr=(Xr,Y
r,Zr)は式1のように表される。但し、ここではP
wcにおいて点Aの高さ方向(Z方向)を0と設定して
あるので、CCDカメラ24の位置PcrのZ方向の値
zは、実際の工作物22の設置高さZrに設定する必要
があるためZr=zとなる。
【0013】 Pwr=PcrPwc ・・・・・式1 ステップ110では同様に点BからEまでの座標変換を
行い、教示点の位置座標を算出する。ステップ120か
らは、図6に示すように各教示点におけるロボットの姿
勢ベクトルを算出する。姿勢ベクトルは、上述したよう
にアプローチベクトルAv、オリエントベクトルOv、
およびノーマルベクトルNvの互いに直交する3つのベ
クトルから成る。
【0014】まずステップ120では工作物22に対し
て下向きのベクトルZvを求める。ベクトルZvは点E
から点Aに向かうベクトルVEAと点Aから点Bに向かう
ベクトルVABとの外積より式2のように求まる。 Zv=VEA×VAB ・・・・・式2 ステップ130では点Aにおけるロボットのアプローチ
ベクトルAvを求める。。ロボット60は工作物22の
外周に沿って点Aから点Eに向かって移動しながらバリ
取り作業を行うものであるから点Aにおけるアプローチ
ベクトルAvは、点Aから点Bに向かうベクトルVABと
なる(式3)。
【0015】 Av=VAB ・・・・・式3 ステップ140ではベクトルZvとアプローチベクトル
Avとの外積を用いてオリエントベクトルOvを式4の
ように求める。 Ov=Av×Zv ・・・・・式4 ロボットの基本姿勢ベクトルのうち残りのノーマルベク
トルNvは、以上のように求まったアプローチベクトル
AvとオリエントベクトルOvとの外積をとることによ
りロボット制御装置50内部で自動的に演算される。
【0016】以上の過程を点Bから点Eまで繰り返すこ
とにより工作物22を加工するのに必要な各点の姿勢ベ
クトルが求まったことになる(ステップ150)。これ
らの教示データを基にしてロボット60を制御すること
によりロボット60は工作物22上をなぞるようにして
工作物22のバリ取り作業を行う。本実施例ではロボッ
ト60の手首部先端に設けられたグラインダ71におけ
る工具座標系を図3のように設定してあるためにグライ
ンダ71は工作物22上をなぞるように移動して加工を
行うが、工具座標系の設定を所定に変化させることによ
り工作物22に所定の角度をもって接触し、加工を行う
等の種々の加工方法が可能である。また、アプローチベ
クトルAvとオリエントベクトルOvの設定の仕方は本
実施例の方法に限定されるものではなく、例えばベクト
ルZvの角度方向を工作物下方ではなく種々に変化させ
ることによりオリエントベクトルOv方向を変化させ、
各種の加工に対応した教示データを算出することができ
る。
【0017】以上述べた実施例では、工作物22の位置
座標を求めるのに、工作物22の輪郭を形成する多数の
点群データを直線近似しているが、この工作物の特定す
る方法は直線近似に限られるものではなく、輪郭を形成
する点群データをそのまま用いてもよく、また多数の点
群データを所定のピッチでサンプリングする方式、点群
データを曲線近似する方式等を用いてもよい。
【0018】また、本実施例においては加工軌跡として
工作物22の輪郭を用いているが、CCDカメラによっ
て加工軌跡が撮像できるようにすれば輪郭以外の加工も
行うことができる。例えば工作物の下地を白色、加工軌
跡を黒色に着色すれば加工軌跡を明確することができ、
これを撮像して工作物上での加工を行うことができる。
【0019】さらに本実施例のロボットの教示装置は、
上述したステップ110において、1台のCCDカメラ
から得た2次元の点群データと、あらかじめ設定されて
いる工作物の取り付け高さを用いて教示点の位置座標を
3次元データに変換しているが、従来から行われている
2台のCCDカメラを用いた画像処理によって工作物の
位置を3次元データとして求め、これを用いて教示デー
タを作成する構成としてもよい。このような構成を用い
ても、Z方向の値が各点毎に異なるのみで、教示データ
の算出方法は基本的に同じである。
【0020】
【発明の効果】以上述べたように本発明のロボット教示
装置は、撮像手段によって得た画像処理データを基にし
てロボットの制御に必要な教示点の位置座標と姿勢ベク
トルを算出できるようにしたために、加工軌跡の長い工
作物や、複雑な形状の工作物であっても撮像手段によっ
て加工軌跡を検出し、自動的に教示データを作成するこ
とができる。また、作業者がロボットを動かしながら教
示作業を行う必要がないために、教示作業による作業者
の負担を大幅に軽減でき、特に工作物が種々に変化する
多品種少量生産方式の工場では労力の削減に優れた効果
を発揮する。
【図面の簡単な説明】
【図1】本発明のロボット教示装置のクレーム対応図で
ある。
【図2】本実施例のロボット教示装置の全体構成図であ
る。
【図3】本実施例におけるロボット手首部の詳細図であ
る。
【図4】本実施例のロボット教示装置の作用を説明する
ための図である。
【図5】本実施例のロボット教示装置の作用を説明する
ための図である。
【図6】本実施例のロボット教示装置の作用を説明する
ための図である。
【図7】本実施例のロボット教示装置の作用を説明する
ためのフローチャートである。
【符号の説明】
1 撮像手段 2 位置座標検出手段 3 教示点座標算出手段 4 姿勢ベクトル算出手段 R,60 ロボット W,22 工作物 20 撮像装置 24 CCDカメラ 26 画像処理装置

Claims (1)

    【特許請求の範囲】
  1. 【請求項1】 あらかじめ記憶された複数の教示点とこ
    れらの各教示点における姿勢ベクトルを基にして制御さ
    れるロボットの教示装置であって、工作物を撮像する撮
    像手段と、この撮像手段より加工軌跡の位置座標を検出
    する位置座標検出手段と、位置座標検出手段より検出さ
    れた加工軌跡の位置座標より教示点の位置座標を算出す
    る教示点座標算出手段と、教示点座標算出手段より算出
    された教示点の連続性より各教示点における姿勢ベクト
    ルを算出する姿勢ベクトル算出手段とを備えたことを特
    徴とするロボットの教示装置。
JP29469191A 1991-11-11 1991-11-11 ロボットの教示装置 Expired - Fee Related JP3543329B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP29469191A JP3543329B2 (ja) 1991-11-11 1991-11-11 ロボットの教示装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP29469191A JP3543329B2 (ja) 1991-11-11 1991-11-11 ロボットの教示装置

Publications (2)

Publication Number Publication Date
JPH05134737A true JPH05134737A (ja) 1993-06-01
JP3543329B2 JP3543329B2 (ja) 2004-07-14

Family

ID=17811061

Family Applications (1)

Application Number Title Priority Date Filing Date
JP29469191A Expired - Fee Related JP3543329B2 (ja) 1991-11-11 1991-11-11 ロボットの教示装置

Country Status (1)

Country Link
JP (1) JP3543329B2 (ja)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009523281A (ja) * 2006-01-11 2009-06-18 シーメンス アクチエンゲゼルシヤフト 加工材の幾何学的形状を検知するためのシステム及び方法
JP2015212012A (ja) * 2009-02-03 2015-11-26 ファナック アメリカ コーポレイション ロボットツールの制御方法
CN106334836A (zh) * 2015-07-09 2017-01-18 富士重工业株式会社 机械加工装置以及机械加工方法
CN111781894A (zh) * 2020-07-23 2020-10-16 菲烁易维(重庆)科技有限公司 利用机器视觉进行装配工具空间定位及姿态导航的方法
WO2021181929A1 (ja) * 2020-03-09 2021-09-16 リンクウィズ株式会社 情報処理方法、情報処理システム、プログラム
US11338446B2 (en) 2016-12-28 2022-05-24 Subaru Corporation Machining robot and machining method
US11992909B2 (en) 2017-06-22 2024-05-28 Subaru Corporation Attachment for machining apparatus

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105014667B (zh) * 2015-08-06 2017-03-08 浙江大学 一种基于像素空间优化的相机与机器人相对位姿标定方法

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009523281A (ja) * 2006-01-11 2009-06-18 シーメンス アクチエンゲゼルシヤフト 加工材の幾何学的形状を検知するためのシステム及び方法
JP2015212012A (ja) * 2009-02-03 2015-11-26 ファナック アメリカ コーポレイション ロボットツールの制御方法
CN106994684A (zh) * 2009-02-03 2017-08-01 范努克机器人技术美国有限公司 控制机器人工具的方法
CN106334836A (zh) * 2015-07-09 2017-01-18 富士重工业株式会社 机械加工装置以及机械加工方法
KR20170007182A (ko) * 2015-07-09 2017-01-18 후지 주코교 카부시키카이샤 기계 가공 장치 및 기계 가공 방법
JP2017019042A (ja) * 2015-07-09 2017-01-26 富士重工業株式会社 機械加工装置及び機械加工方法
US11440110B2 (en) 2015-07-09 2022-09-13 Subaru Corporation Machining apparatus and machining method
US11338446B2 (en) 2016-12-28 2022-05-24 Subaru Corporation Machining robot and machining method
US11992909B2 (en) 2017-06-22 2024-05-28 Subaru Corporation Attachment for machining apparatus
CN113905856A (zh) * 2020-03-09 2022-01-07 凌威新科技有限公司 信息处理方法、信息处理***及程序
JP2021137940A (ja) * 2020-03-09 2021-09-16 リンクウィズ株式会社 情報処理方法、情報処理システム、プログラム
WO2021181929A1 (ja) * 2020-03-09 2021-09-16 リンクウィズ株式会社 情報処理方法、情報処理システム、プログラム
CN111781894A (zh) * 2020-07-23 2020-10-16 菲烁易维(重庆)科技有限公司 利用机器视觉进行装配工具空间定位及姿态导航的方法

Also Published As

Publication number Publication date
JP3543329B2 (ja) 2004-07-14

Similar Documents

Publication Publication Date Title
US11345042B2 (en) Robot system equipped with video display apparatus that displays image of virtual object in superimposed fashion on real image of robot
US11197730B2 (en) Manipulator system
JP7490349B2 (ja) 入力装置、入力装置の制御方法、ロボットシステム、ロボットシステムを用いた物品の製造方法、制御プログラム及び記録媒体
US4761596A (en) Method of detecting and controlling work start point of robot
CA1318954C (en) Vision seam tracking method and apparatus for a manipulator
JP5365379B2 (ja) ロボットシステム及びロボットシステムのキャリブレーション方法
CN111905983B (zh) 基于视觉跟随的点胶轨迹修正方法、装置、***及介质
JPH0435885A (ja) 視覚センサのキャリブレーション方法
JP2018167334A (ja) 教示装置および教示方法
CN114851209B (zh) 一种基于视觉的工业机器人工作路径规划优化方法及***
JP3543329B2 (ja) ロボットの教示装置
Krotkov et al. An agile stereo camera system for flexible image acquisition
CN115135466A (zh) 毛刺去除装置和控制***
US20230123629A1 (en) 3d computer-vision system with variable spatial resolution
JP2007171018A (ja) 物***置認識方法及び物***置認識装置
JP7093881B1 (ja) システム、及び自動搬送車
Tongloy et al. An image-based visual servo control system based on an eye-in-hand monocular camera for autonomous robotic grasping
JP2616225B2 (ja) 相対位置決め方式
JPH05108131A (ja) ロボツトの教示装置
JPH06218684A (ja) 操作型マニピュレータの教示装置および操作型マニピュレータによる自動作業方法
JP2770570B2 (ja) 溶接用ロボット
JPH04119405A (ja) 位置及び回転角検出装置、その指示具、並びに、それを用いたロボットの動作教示装置
Hu et al. Manipulator arm interactive control in unknown underwater environment
JPH02205494A (ja) マニピュレータ画像追従方法及び装置並びに該装置を備えたマニピュレータ装置
WO2021210514A1 (ja) ロボットの制御装置及び制御方法、ロボットシステム、ロボットの動作プログラムを生成する装置及び方法

Legal Events

Date Code Title Description
A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20031224

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20040220

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Effective date: 20040316

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Effective date: 20040329

Free format text: JAPANESE INTERMEDIATE CODE: A61

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313111

R371 Transfer withdrawn

Free format text: JAPANESE INTERMEDIATE CODE: R371

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313111

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

FPAY Renewal fee payment (prs date is renewal date of database)

Year of fee payment: 5

Free format text: PAYMENT UNTIL: 20090416

FPAY Renewal fee payment (prs date is renewal date of database)

Year of fee payment: 5

Free format text: PAYMENT UNTIL: 20090416

FPAY Renewal fee payment (prs date is renewal date of database)

Year of fee payment: 6

Free format text: PAYMENT UNTIL: 20100416

LAPS Cancellation because of no payment of annual fees