JPH08137528A - ロボットと回転テーブルのキャリブレーション方法 - Google Patents

ロボットと回転テーブルのキャリブレーション方法

Info

Publication number
JPH08137528A
JPH08137528A JP29403894A JP29403894A JPH08137528A JP H08137528 A JPH08137528 A JP H08137528A JP 29403894 A JP29403894 A JP 29403894A JP 29403894 A JP29403894 A JP 29403894A JP H08137528 A JPH08137528 A JP H08137528A
Authority
JP
Japan
Prior art keywords
robot
rotary table
axis
vector
coordinate system
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.)
Pending
Application number
JP29403894A
Other languages
English (en)
Inventor
Tatsuzo Nakazato
辰三 中里
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.)
Yaskawa Electric Corp
Original Assignee
Yaskawa Electric Corp
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 Yaskawa Electric Corp filed Critical Yaskawa Electric Corp
Priority to JP29403894A priority Critical patent/JPH08137528A/ja
Publication of JPH08137528A publication Critical patent/JPH08137528A/ja
Pending legal-status Critical Current

Links

Landscapes

  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

(57)【要約】 【目的】回転テーブルが2軸型の場合に適用できるロボ
ットと回転テーブルのキャリブレーションを行う方法を
提供する。 【構成】ロボットと回転テーブルを任意の位置で教示し
て、その位置データを記憶し、このデータから、ロボッ
ト座標系と2軸を有する回転テーブル座標系との相対的
位置関係を示す変換マトリクスを導き出す。

Description

【発明の詳細な説明】
【0001】
【産業上の利用分野】本発明は、ロボットと2軸回転テ
ーブルを有するシステムにおいて、精度良く協調動作を
行うために、特に簡単な方法で、ロボットと回転テーブ
ルの相対的位置関係を求めるキャリブレーション方法に
関するものである。
【0002】
【従来の技術】ロボットの加工時間を短縮するため、ワ
ークを1軸回転テーブルに載置し、ロボット制御装置か
ら、ロボットと1軸回転テーブルを同期して協調制御す
るシステムが知られている(特開平6−250714号
公報参照)。このようなシステムがうまく動作するため
には、回転テーブル座標系とロボットの座標系は同一の
座標系(ワールド座標系という)でなければならない
が、ロボット座標系=ワールド座標系とするのが一般的
である。すると、ロボット座標系原点から回転テーブル
座標原点までの位置・姿勢をfrpとし、回転テーブルの
位置・姿勢をfP とすると、ワールド座標系原点(=ロ
ボット座標系原点)からみた回転テーブルの位置・姿勢
wpは、次の1式で表される。 fwp=frp*fP ……(1) このfwpが求まればロボットと回転テーブルを協調制御
することができる。
【0003】
【発明が解決しようとする課題】ところが、従来の技術
は回転テーブルが2軸型の場合には適用できなかった。
そこで本発明は、回転テーブルが2軸型の場合に適用で
きるロボットと回転テーブルのキョリブレーションを行
う方法を提供することを目的とする。
【0004】
【課題を解決するための手段】この目的を達成するた
め、本発明は、ロボットと2軸を有する回転テーブルを
有するシステムにおける前記ロボットと前記回転テーブ
ルの相対的位置関係を求めるキョリブレーション方法お
いて、前記回転テーブルに教示補助具を取付けて、次の
5つの状態に回転テーブルを手動操作で動かす第1工
程、 回転テーブルの第1軸を0°、第2軸を0°とした状
態 回転テーブルの第2軸を0°、第1軸を0°以外の任
意の角度とした状態 回転テーブルの第2軸を0°、第1軸を0°以外の他
の任意の角度とした状態 回転テーブルの第1軸を0°、第2軸を0°以外の任
意の角度とした状態 回転テーブルの第1軸を0°、第2軸を0°以外の他
の任意の角度とした状態 その各状態で、ロボットを手動操作で動かして、ロボッ
トが保持するツールの先端を前記教示補助具の先端に接
触させるように位置決めしてその時のロボットの位置を
記憶する第2工程、これらのデータから、次の4項目か
らなる4行4列の変換マトリクスを求める第3工程、 (1) の3点をとおる円の中心座標O1 (2) 前記円の面に対する垂線ベクトルA1 (3) 前記円の中心座標O1 からに向かうベクトルB1 (4) 前記ベクトルA1 と前記ベクトルB1 の外積ベクト
ルC1 次の4項目からなる4行4列の変換マトリクスを求める
第4工程、 (1) の座標 (2) の3点をとおる円の面に対する垂線ベクトル
2 (3) の3点をとおる円の中心座標O2 からに向
かうベクトルB2 (4) 前記ベクトルA2 と前記ベクトルB2 の外積ベクト
ルC2 前記8項目を基にロボット座標系原点と回転テーブル座
標系原点間の相対的位置・姿勢関係と、前記回転テーブ
ル座標系原点と前記回転テーブル上の所定の点の間の相
対的位置・姿勢関係とを求める第5工程と、からなるこ
とを特徴とするものである。
【0005】
【作用】ロボットと回転テーブルを任意の位置で教示し
て、その位置データを記憶し、このデータから、ロボッ
ト座標系と2軸を有する回転テーブル座標系との相対的
位置関係を示す変換マトリクスを導き出すのである。
【0006】
【実施例】以下、本発明の具体的実施例を説明する。図
1は本発明を実施する装置の例を示すものであり、10
はロボット、20は回転テーブル、30はロボット制御
装置である。ロボット10はツール11を保持している
(ツール11の先端位置を制御点と呼ぶ)。回転テーブ
ル20は図示するようにZo 軸(第1軸)とXo 軸(第
2軸)回りに回転するものであり、教示の際は教示補助
具21を取りつける。ロボット制御装置30は教示箱3
1を備えており、この教示箱31からロボット10と回
転テーブル20の動作の教示(手動操作およびプログラ
ミング)が可能である。
【0007】以下、本発明の実施手順に沿って説明す
る。 (1)教示箱31の手動操作で、ロボット10を動か
し、ロボット10の制御点と回転テーブルの教示補助具
21の先端点を接触させる。このときのロボット10の
位置と回転テーブル20の位置(このときの回転テーブ
ルの1軸、2軸の回転角度をそれぞれ0°とする。つま
り0°とは初期角度という意味であって、それ自体は任
意の角度である)をP1としてロボット制御装置30に
記憶する。
【0008】(2)回転テーブル20の1軸目(Z
o 軸)のみ教示箱31の手動操作で任意の角度回転させ
た後、教示箱31の手動操作で、ロボット10を動か
し、ロボット10の制御点を回転テーブルの教示補助具
21の先端点に接触させる。このときのロボット10の
位置と回転テーブル20の位置をP2としてロボット制
御装置30に記憶する。
【0009】(3)回転テーブル20の1軸目(Z
o 軸)のみ教示箱31の手動操作でさらに任意の角度回
転させた後、教示箱31の手動操作で、ロボット10を
動かし、ロボット10の制御点を回転テーブルの教示補
助具21の先端点に接触させる。このときのロボット1
0の位置と回転テーブル20の位置をP3としてロボッ
ト制御装置30に記憶する。
【0010】(4)回転テーブル20の2軸目(X
o 軸)のみ教示箱31の手動操作で任意の角度回転させ
た後、教示箱31の手動操作で、ロボット10を動か
し、ロボット10の制御点を回転テーブルの教示補助具
21の先端点に接触させる。このときのロボット10の
位置と回転テーブル20の位置をP4としてロボット制
御装置30に記憶する。
【0011】(5)回転テーブル20の2軸目(X
o 軸)のみ教示箱31の手動操作でさらに任意の角度回
転させた後、教示箱31の手動操作で、ロボット10を
動かし、ロボット10の制御点を回転テーブルの教示補
助具21の先端点に接触させる。このときのロボット1
0の位置と回転テーブル20の位置をP5としてロボッ
ト制御装置30に記憶する。
【0012】以上でオペレータの作業は終わりである。
次にロボット制御装置30の内部処理を図2に示して説
明する。 (ステップ1)記憶された位置データの読み込む。この
ときの位置データは一般にロボットの動作軸と回転テー
ブルの回転軸に取りつけられた回転検出器からの出力パ
ルス数である。
【0013】(ステップ2)ロボットについては前記出
力パルス数を公知の座標変換によって、直交座標系に変
換して、ロボットの制御点位置を求める。ここで求まっ
た値をそれぞれ、RP1〜RP5する。回転テーブルに
ついては、角度データへの変換を行う。ここで求まった
値をそれぞれ、PP1〜PP5とし、PP1の第1軸の
角度はPP1.a1、第2軸の角度はPP1.a2とい
うように表すこととする。
【0014】(ステップ3)次の4項目を求める。 RP1〜RP3の3点をとおる円の中心座標CP1 その円の面に対する垂線ベクトルCZ1 CP1からRP1に向かうベクトルCX1 CX1とCZ1の外積ベクトルCY1 この〜を4行4列の行列化してfc1とする。
【0015】(ステップ4)frpは、回転テーブルの第
1軸が0°におけるfc1であるから、回転テーブルの第
1軸が0°におけるfc1を求めるために、Z軸回りにP
P1.a1分だけマイナス方向に回転させたfc1を求め
る。この回転させたfc1が、ロボット原点から回転テー
ブル原点までの位置・姿勢マトリクスfrpとなる(2式
参照)。 frp=fc1*Rot(Z,−PP1.a1)…(2)
【0016】(ステップ5)次の4項目を求める。 RP1,RP4,RP5の3点をとおる円の中心座標
CP2 その円の面に対する垂線ベクトルCZ2 CP2からRP1に向かうベクトルCX2 CX2とCZ2の外積ベクトルCY2 この〜とRP1の座標を4行4列の行列化してfc2
とする。
【0017】(ステップ6)回転テーブルの第1軸と第
2軸が0°におけるfc2を求めるために、Z軸回りにP
P3.a1分だけマイナス方向に回転させ、回転したf
c2のZ軸回りにPP3.a2分マイナス方向に回転させ
る。これをfc2a とする(3式参照)。 fc2a =Rot(CZ1,−PP3.a1)*fc2*Rot(Z,−PP3.a2)… (3)
【0018】次に次式の計算を行い、fq を求める。 fq =inv(frp) *fc2a …(4) ここで、inv(frp) は、frpの逆行列を意味する。以
下、fq とは、図2に示すX,Y,ZとTX (=β),
Y =(α),TZ(=0)からなる(X,Y,Z,T
X ,TY ,TZ )である。すなわち、θ1 =0°、θ2
=0°の時の回転テーブル座標原点から、教示補助具の
先端位置までの位置と姿勢の関係を示すベクトルとな
る。このfq は、2軸だから必要となるものである。そ
して、回転テーブルの制御点の演算は、回転テーブルの
第1軸の角度をθ1、第2軸の角度をθ2 とすると次式
で表される。 fp =Rot(Z,θ1 )*fq *Rot(Z,θ2 )…(5)
【0019】以上のとおり、(2)式によりfrpが、
(5)式よりfp が求まるので、これを(1)式に代入
することにより、ワールド座標系原点から見た回転テー
ブルの位置・姿勢fwpが求まる。
【0020】
【発明の効果】以上述べたように、本発明によれば、2
軸型の回転テーブルにおいても、簡単な教示作業のみで
ロボットとの相対位置関係が求められ、正確なキャリブ
レーションができる。
【図面の簡単な説明】
【図1】本発明の実施例を示す図
【図2】本発明のデータ処理手順を示すフローチャート
【符号の説明】
10…ロボット 11…ツール 20…回転テーブル 21…教示補助具 30…ロボット制御装置 31…教示箱31

Claims (1)

    【特許請求の範囲】
  1. 【請求項1】 ロボットと2軸を有する回転テーブルを
    有するシステムにおける前記ロボットと前記回転テーブ
    ルの相対的位置関係を求めるキャリブレーション方法お
    いて、 前記回転テーブルに教示補助具を取付けて、次の5つの
    状態に回転テーブルを手動操作で動かす第1工程、 回転テーブルの第1軸を0°、第2軸を0°とした状
    態 回転テーブルの第2軸を0°、第1軸を0°以外の任
    意の角度とした状態 回転テーブルの第2軸を0°、第1軸を0°以外の他
    の任意の角度とした状態 回転テーブルの第1軸を0°、第2軸を0°以外の任
    意の角度とした状態 回転テーブルの第1軸を0°、第2軸を0°以外の他
    の任意の角度とした状態 その各状態で、ロボットを手動操作で動かして、ロボッ
    トが保持するツールの先端を前記教示補助具の先端に接
    触させるように位置決めしてその時のロボットの位置を
    記憶する第2工程、 これらのデータから、次の4項目を求める第3工程、 (1) の3点をとおる円の中心座標O1 (2) 前記円の面に対する垂線ベクトルA1 (3) 前記円の中心座標O1 からに向かうベクトルB1 (4) 前記ベクトルA1 と前記ベクトルB1 の外積ベクト
    ルC1 次の4項目を求める第4工程、 (1) 3点をとおる円の中心座標O2 (2) 前記円の面に対する垂線ベクトルA2 (3) 前記円の中心座標O2 からに向かうベクトルB2 (4) 前記ベクトルA2 と前記ベクトルB2 の外積ベクト
    ルC2 前記8項目を基にロボット座標系原点と回転テーブル座
    標系原点間の相対的位置・姿勢関係と、前記回転テーブ
    ル座標系原点と前記回転テーブル上の所定の点の間の相
    対的位置・姿勢関係とを求める第5工程と、からなるロ
    ボットと回転テーブルのキャリブレーション方法。
JP29403894A 1994-11-02 1994-11-02 ロボットと回転テーブルのキャリブレーション方法 Pending JPH08137528A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP29403894A JPH08137528A (ja) 1994-11-02 1994-11-02 ロボットと回転テーブルのキャリブレーション方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP29403894A JPH08137528A (ja) 1994-11-02 1994-11-02 ロボットと回転テーブルのキャリブレーション方法

Publications (1)

Publication Number Publication Date
JPH08137528A true JPH08137528A (ja) 1996-05-31

Family

ID=17802472

Family Applications (1)

Application Number Title Priority Date Filing Date
JP29403894A Pending JPH08137528A (ja) 1994-11-02 1994-11-02 ロボットと回転テーブルのキャリブレーション方法

Country Status (1)

Country Link
JP (1) JPH08137528A (ja)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2007138756A1 (ja) * 2006-05-31 2007-12-06 Panasonic Corporation 回転中心点算出方法、回転軸線算出方法、プログラムの作成方法、動作方法およびロボット装置
CN103199022B (zh) * 2012-01-05 2015-05-13 沈阳新松机器人自动化股份有限公司 预对准机的标定方法
JP2016078173A (ja) * 2014-10-17 2016-05-16 本田技研工業株式会社 作業ロボットの設置状態検出方法
JP2016132049A (ja) * 2015-01-16 2016-07-25 矢崎総業株式会社 位置合わせ方法
JP2017513550A (ja) * 2014-03-17 2017-06-01 インテュイティブ サージカル オペレーションズ, インコーポレイテッド 遠隔手術台位置合わせのための方法及び装置
CN109382839A (zh) * 2017-08-14 2019-02-26 发那科株式会社 机器人***以及机器人控制装置
CN109968347A (zh) * 2017-12-28 2019-07-05 沈阳新松机器人自动化股份有限公司 一种七轴机器人的零位标定方法

Cited By (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPWO2007138756A1 (ja) * 2006-05-31 2009-10-01 パナソニック株式会社 回転中心点算出方法、回転軸線算出方法、プログラムの作成方法、動作方法およびロボット装置
JP4613955B2 (ja) * 2006-05-31 2011-01-19 パナソニック株式会社 回転軸線算出方法、プログラムの作成方法、動作方法およびロボット装置
US7957834B2 (en) 2006-05-31 2011-06-07 Panasonic Corporation Method for calculating rotation center point and axis of rotation, method for generating program, method for moving manipulator and positioning device, and robotic system
WO2007138756A1 (ja) * 2006-05-31 2007-12-06 Panasonic Corporation 回転中心点算出方法、回転軸線算出方法、プログラムの作成方法、動作方法およびロボット装置
CN103199022B (zh) * 2012-01-05 2015-05-13 沈阳新松机器人自动化股份有限公司 预对准机的标定方法
US10874467B2 (en) 2014-03-17 2020-12-29 Intuitive Surgical Operations, Inc. Methods and devices for tele-surgical table registration
US11173005B2 (en) 2014-03-17 2021-11-16 Intuitive Surgical Operations, Inc. Methods and devices for tele-surgical table registration
JP2017513550A (ja) * 2014-03-17 2017-06-01 インテュイティブ サージカル オペレーションズ, インコーポレイテッド 遠隔手術台位置合わせのための方法及び装置
JP2016078173A (ja) * 2014-10-17 2016-05-16 本田技研工業株式会社 作業ロボットの設置状態検出方法
JP2016132049A (ja) * 2015-01-16 2016-07-25 矢崎総業株式会社 位置合わせ方法
CN105811219A (zh) * 2015-01-16 2016-07-27 矢崎总业株式会社 位置对齐方法
CN109382839B (zh) * 2017-08-14 2020-09-01 发那科株式会社 机器人***以及机器人控制装置
CN109382839A (zh) * 2017-08-14 2019-02-26 发那科株式会社 机器人***以及机器人控制装置
CN109968347A (zh) * 2017-12-28 2019-07-05 沈阳新松机器人自动化股份有限公司 一种七轴机器人的零位标定方法
CN109968347B (zh) * 2017-12-28 2022-01-14 沈阳新松机器人自动化股份有限公司 一种七轴机器人的零位标定方法

Similar Documents

Publication Publication Date Title
US5590034A (en) Method for controlling the movement of an industrial robot at and near singularities
US4698572A (en) Kinematic parameter identification for robotic manipulators
US5020001A (en) Robot controller
JPS61173311A (ja) マニピユレ−タを制御する方法および装置
JPS59218513A (ja) 工業用ロボツトの円弧制御法
JPS60193016A (ja) ロボツト装置
US5189351A (en) Corrective positioning method in a robot
JP3207409B2 (ja) ロボットのツール姿勢制御方法
JPH08137528A (ja) ロボットと回転テーブルのキャリブレーション方法
US11036207B2 (en) Method, numerical control device and machine tool for machining a workpiece
Senft et al. Redundant motions of non-redundant robots a new approach to singularity treatment
JPH01267706A (ja) ロボットの制御方法
JPH0553590B2 (ja)
Josuet et al. An improved inverse kinematics solution of 6r-dof robot manipulators with euclidean wrist using dual quaternions
JPS62199383A (ja) ロボツトの制御方式
JPS60195611A (ja) ワ−ク移動対応ロボツトシステム
JPH0647689A (ja) 多関節形ロボットの制御方法
JP2649463B2 (ja) 回転外部軸を有する産業用ロボットの教示方法およびそれに用いる教示装置
JPS63118804A (ja) 多関節形ロボツトの軌跡制御方式
JPH05505893A (ja) ロボット・セルの経路の制御方法
Luh et al. Interactions and motions in human-robot coordination
JPH04259010A (ja) ロボットの逆変換方法
JP3098618B2 (ja) 産業用ロボットシステムの制御方法及び制御装置
Patel et al. 3 collision avoidance for a 7-DOF redundant manipulator
JPS63101907A (ja) 水平多関節ロボットの原点較正装置