JPS6344206A - スカラ型ロボットを較正する方法 - Google Patents

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 吸専分団 本発明はロボットを較正してその誤差を補正する方法に
関する。

発皿亘貨景 迅速かつ高精度で広い範囲にわたる作業を反復して実行
できるという能力の故にロボットの使用が種々の製造用
途で進みつつある。今や、複雑な組立作業でさえ、たと
えば、限られたスペースに小さな部品をすえ付けるとい
う作業さえロボットによって行なわれつつある。現在の
ところ、多くの組立作業をこなすえりぬきのロボットと
しては「スカシ（ＳＣＡＲＡ　）　Ｊ型ロボットがある
。この名称はロボットがロボット組立体用の選択的従順
アーム（Ｓｅｌｅｃｔｉｖｅｌｙ　Ｃｏｍｐｌｉａｎｔ
　Ａｒｍ　ｆｏｒ　ＲｏｂｏｔｉｃＡｓｓｅ＋＊ｂｌｙ
）を所持しているがために付けられたものである。

−Ｓには、スカシ型ロボットは２軸線に沿って上下に移
動できるように装着した垂直方向部材を有するベースを
有する。この垂直方向部材には第１のリンクが第１のジ
ヨイントまたは手首によってジャーナル止めしてあり、
この第１のジヨイントまたは手首はロボットのベースに
おける成る点でそれぞれ２軸線に対して直角にそれを交
差しているＸ軸線、Ｘ軸線によって定められた平面に対
して平行な水平方向平面において垂直方向部材のまわり
に回転できるｓＸｓ　ｙｓ２の軸線の交差点はロボット
の基準フレームを構成する。第２リンクの一端が第２の
ジヨイントまたは手首によって第１リンクの自由端に枢
着してあり、この第２のジヨイントまたは手首は同じ水
平方向平面内で回転できるようになっている。第２リン
クの反対端には１つまたはそれ以上の工具、たとえば、
グリッパあるいはテレビジョン・カメラが取り付けであ
る。スカシ型ロボットの垂直方向部材にはサーボモータ
が取り付けてあり、このサーボモータは第１リンクに回
転自在に連結しである。第１リンクには第２のサーボモ
ータが取り付けてあり、この第２サーボモータは第２リ
ンクに回転自在に連結しである。これらのサーボモータ
は、それぞれ、制御システムによって供給される制御信
号で付勢され、第１、第２のリンクを回転させて工具の
１つを所望位置に設置する。

スカシ型ロボットにプログラムを与えて成る特定の作業
を行なわせるのに現在使用されている技術では、工具を
設置しようとしている所望位置のｘ、ｙ、ｚ軸線に沿っ
た座標を制御システムに与えている。ロボットの各リン
クの現在の角度位置を示すフィードバック情報を制御シ
ステムに与えることにより、この制御システムはグリッ
パをその現在位置から所望位置まで変位させるに必要な
各リンクの回転量を決定する。

工具を現在位置から所望位置まで変位させるに必要なリ
ンク回転量を制御システムで決定できるようにするため
に、ロボットの運動学モデルが設けられる。この運動学
モデルはロボットの寸法によって決まる一組の数学的な
関係である。これらの数学的な関係は工具の所望位置を
表わすデカルト座標をロボットのリンクの対応した角度
位置に変換するのに役立つ。

スカシ型ロボットを高精度組立作業で使用するには、ロ
ボットを較正して運動学モデルにおける不精密値を補正
するのが望ましい、しかしながら、スカシ型ロボットの
運動学モデルが従来良く理解されていなかったので、模
型を調節することによってロボットを較正するという努
力はなされていなかった。

したがって、スカシ型ロボットを制御するのに用いる運
動学モデルをどのように較正するかという点で問題が存
在する。

光皿皇互！ 上記の問題は、回転自在の第１リンクと、第１リンクの
端に回転自在に取り付けてあってロボットの誤差を補正
する工具装填用第２リンクとを有するスカシ型ロボット
を較正する本発明の方法によってほぼ解決される。誤差
が存在するときにロボットを較正するには、両リンクを
第１の配置に置いて第２リンクの担持する工具を所定即
ち既知位置に置く０次に、これらのリンクを第２の配置
に置き、工具を同じ既知位置に一時的に置く。両リンク
を第１配置から第２配置に切り換えたならば、工具の既
知位置からの距離を測定する。工具の既知位置からの測
定距離からロボットの誤差を知り、この誤差に従ってロ
ボットを補正する。誤差がゼロに近づくまでこれらの段
階を繰り返す。

罷稚星設所 以下、添付図面を参照しながら本発明を一層詳しく説明
する。

第１図はスカラ型ロボット１０の斜視図である。

ロボフ）１０は固定表面１３にしっかり取り付けられた
ベース１２を有しており、そのベース１２内にはサーボ
駆動式のアクチュエータ（図示せず）が設けてあり、こ
れは垂直方向に延びる２軸線１５に沿って部材１４を進
退させる。軸１６の一端が手首１８によって部材１４に
回転自在に連結しある。軸１６の反対端はリンク２０の
一端に固定しである。したがって、リンク２０はＸ軸線
２３、ｙ軸線２４の定める平面２２から上方に平行に隔
たっている平面２１内で２軸線１５まわりに回転するこ
とができる。Ｘ軸線、ｙ軸線は、それぞれ、２軸線１５
と互いに直角である。これらＸ％　ｙ、ｚ’ｊｌａ線２
３、線速３１５はベース１２内の一点Ｆで交差している
。ベース１２はロボット１０の固定基準フレームを構成
している。

部材１４にはサーボモータ２６が取り付けてあり、この
サーボモータは軸１６に回転自在に連結してあってこの
軸に制御したトルクを与え、リンク２０を平面２１内で
精密に回転させ得るようになっている。サーボモータ２
６はエンコーダ２日に連結してあり、このエンコーダは
Ｘ軸線２３およびＺ軸！１５を通る平面（図示せず）に
対するリンク２０の角度位置を検出する。手首３０がリ
ンク３２の一端をリンク２０の手首を取り付けた端とは
反対の端に回転自在に連結している。リンク３２は２軸
線１５に平行ではあるが、そこからオフセットしている
軸線３４まわりに平面２１内で回転する。リンク２０に
はサーボモータ３６が取り付けてあり、このサーボモー
タ３６はリンク３２に回転自在に連結してあってそれに
制御したトルクを与え、平面２１内でこのリンク３２を
精密に回転させることができる。サーボモータ３６には
、リンク２０に対するリンク３２の角度位置を検出する
エンコーダ３８が連結しである。

工具４０（軸線３４に対してほぼ平行な長手軸線４１を
有する）がその一端でリンク３２に取り付けである。例
示した実施例では、工具４０は負圧ピックアップ装置の
形を採っており、この工具はリンク３２に取り付けた端
とは反対の端に先端部４２を有する。この先端部４２は
電子部品４３（説明のために第１図では寸法を誇張して
示しである）を拾い上げるようになっている。部品４３
に工具４０が係合したならば、リンク２０．３２を回転
させ、この部品を成る位置から別の位置（この位置は工
具の長さだけ平面２１に対して平行にオフセットした平
面４４にある）まで移動させる。実際には、部品４３は
拾い上げ点から図示しない手段で平面４４内に支持され
ている回路板４５上の所定位置までロボット２１によっ
て移される。

例示実施例では、リンク３２はテレビジョン・カメラ４
６も担持しており、このカメラは第２の工具と考えても
よい。このテレビジョン・カメラ４６は、光軸４７を有
し、リンク３２に取り付けて゛ある。このカメラはすぐ
下にある平面４４の部位を見ることができる。換言すれ
ば、カメラの光軸４７は軸線１６．３４に対してほぼ平
行である。

テレビジョン・カメラ４６の光学特性は、第１図に示す
鎖線で囲んだ平面４４の小さい領域４８内の像のみを捕
らえるように選んである。代表的には、この領域４８の
面積は３．　Ｉ　Ｘ　３．１平方ミリメートルである。

テレビジョン・カメラ４６で見た領域４８はカメラの非
常に貰い空間解像度を得るために意図的に小さくしであ
る。こうして、回路板４５上の非常に小さい対称物、た
とえば、基準マーク（図示せず）を視野４８内で軸線４
７と一致する中心に対して精密に位置決めすることがで
きる。

ロボット１０は制御システム５０で制御する。

入力データ（工具４０の先端部４２またはテレビジョン
・カメラ４６の軸線４７が平面４４内に置かれることに
なっている所望位置のデカルト座標の形を採る）は入力
端子５２を経て制御システム５０に送られる。エンコー
ダ２８．３８からのフィードバック情報（リンク２０．
３２の角度位置を示す）も制御システム５０に送り込ま
れる。

制御システム５０内にはロボットの運動学モデルが組み
込んであり、この運動学モデルはリンク２０．３２の角
度位置に対して平面４４内の工具軸線４１およびカメラ
軸線４７の位置を関係させる一連の数学的関係である。

これら数学的関係は制御システム５０にプログラムした
アルゴリズムに含まれている０Ｍ動動子モデルより、制
御システムム５０は平面４４における工具先端部４２ま
たはテレビジョン・カメラ４６の軸線４７の所望位置の
座標を、これらの座標に工具先端部またはカメラ軸線を
位置させるに必要なリンク２０．３２の角度位置に変換
することができる。

ロボット１０の運動学モデルを構成するには、軸線３４
．１５間の距離（以後、Ｌｌとする）を知らなければな
らない、運動学モデルにとって必要な別のデータは平面
４４における工具４０の軸線４１の位置（距離Ｌ２．に
よって与えられる）と第２図の角度λ、である。距ｆｉ
ｔ、２ｔは工具軸線４１と軸線３４が平面４４と交差す
る２点を通る平面４４内の線に沿って測定する。角度λ
、は線Ｌ２、と軸線３４およびリンク２０の中心を長手
方向に延びる線５３を通る平面（図示せず）との間で測
定する。

工具の軸線４１が軸線３４に対して平行であると仮定す
ると、λ１はλに等しいと仮定できる。

ここで、λはリンク２０．３２の水平方向中心線５３．
５４の間の角度である。第２図でわかるように、リンク
２０の中心線５３とＸ軸線２３および２軸線１５（第１
図参照）を通る平面（図示せず）のなす角はβとする。

工具先端部４２が平面４４内でＸ軸線およびＸ軸線に沿
った座標Ｘｏ、）’ｏのところに位置するとすれば、角
β、λは座標Ｘｏ　、）’ｏとの関係で次のように定義
される。

β＝　　［ｔａｎ−’　　（ｙｏ　／　Ｘｏ　）　　］
±ｔａｎ−’　　（［ｋ（ｋ−Ｌｌ）（ｋ−Ｌ２ｔ）（
ｋ−Ｌ）］　””／　［Ｌｌ”＋Ｌ”−Ｌ２％′λ＝π
±ｊａｎ−’　（４［ｋ（ｋ−ＬＬ）（ｋ−Ｌ２ｔ）（
ｋ−Ｌ）］　””／（Ｌｌ”−Ｌ２−Ｌは Ｌ＝　（Ｘｏ”　”：ｙｏすＩ／Ｚ　　　　　　　　　
　（３１であり、Ｋは に＝１／２（Ｌ　１　＋Ｌ２ｔ　＋Ｌ）　　　　　　　
（４）である。

第３図を参照して、式（１）〜（４）はテレビジョン・
カメラ４６の軸線４７の平面４４との交差点の所望位置
を表わす一対の座標ｘｃ、ｙｃをリンク２０．３２の対
応する角度位置に変換するのにも用いることができる。

この変換をなすべく式（１）〜（４）を用いるには、値
Ｌ２ＬをＬ２ｃと交換しなければならない。この値Ｌ２
ｃは、第３図でわかるように、軸線４７．３４がそれぞ
れ平面４４と交差する点間を延びる、平面４４内の線長
さに相当する。

Ｌ２ｃをｔ、２ｔの代りに用いた場合でも、式（２）か
ら得たλの値は平面４４における座標ｘｃ、ｙｃのとこ
ろに軸線４７を位置させるに必要な、リンク２０．３２
間の角度的な分離を忠実に表わすことにはならない。第
３図に示す実施例では、第３図のテレビジョン・カメラ
４６の軸線４７はリンク３２の水平方向中心線５４から
側方ヘオフセソトしている。したがって、リンク２０．
３２の中心線５３．５４間の角度λは、長さがＬ２．で
ある平面４４内の線と軸線３４およびリンク２０の中心
線５３を通る平面（図示せず）の間のλ。と異なること
になる。λ、７０間の差は一定であり、運動学モデルに
は既知の値である。角度λ、は、距離Ｌ２ｃと共に、軸
線４７の平面４４内の位置（軸線３４から測った値）を
定めるのに役立つ。

ロボット１０に対して高いアドレス指定精度を確保する
には、運動学モデルが確実に精密であるように多大の注
意を払わなければならない。しかしながら、種々の理由
のために不精密な値がしばしば存在する。第２図を参照
して、工具４０を初めからあるいは後になってリンク３
２上に誤って装着し、工具が実際に実線ではなくて仮想
線で示すようになり、その軸線４１が軸線３４に対して
傾くこともあり得る。

工具４０を第２図に仮想線で示すように誤って装着した
ときには、工具軸線４１、軸線３４がそれぞれ平面４４
と交差する点間の平面４４での距離Ｌ２ｔではなくてＬ
２ｔ−となる。同様に、長さＬ２□の線と軸線３４およ
びリンク２０の中心線５３を通る平面のなす角はλ、で
はなくてλｔ、となる。第１図のロボット１０が第１図
の工具先端部を第２図の平面４４における座標Ｘｏ　、
ｙｏに位置させるには、式（１）、（２）、（４）にお
けるＬ２．に代りにＬ２ｔ−を用いなければならないこ
とになる。

式（２）から計算したλの値にλ１、λＬ８間の代数差
だけ増大させなければならないことになる。

第３図を参照して、テレビジョン・カメラ４６も初めか
ら或は後になってリンク３２に誤って装着する可能性が
ある。すると、テレビジョン・カメラ４６は実際には実
線ではなく仮想線で示すようになり、その軸線４７が軸
線３４に対して傾くことがある。カメラ４６を誤装着し
た場合、軸′４ｉＡ３４に対する平面４４内の軸線４７
の位置は運動学モデルから得た値Ｌ２ｃ、λ０ではなく
て距ＭＬ２ｃ、および角度λｃ０によって与えられるこ
とになる。

第１図を参照して、ロボット１０は平面４４内の工具先
端部４２（よって、工具軸線４１）および軸線４７の既
知位置からの距離を検知する測定システム５５を備える
。この測定システム５５はテレビジョン・カメラ４６に
接続したビジョン・システム５６を有する。このビジョ
ン・システムはテレビジョン・カメラ４６の出力信号を
処理して平面２２内に固定したビン５８の、視野４８の
中心に対する平面４４内の位置を決定することができる
。

ビジョン・システム５６は、ピン５８および工具先端部
４２の視野４８．６２の中心に対する位置を示すデータ
を制御システム５０に与える。この情報から、制御シス
テム５０はリンク３２上の工具４０およびカメラ４６の
変位で生じ、軸線４１．４７を軸線３４に対して傾斜さ
せている運動学モデル内の誤差を計算し、それを補正す
る。

ロボット１０の運動学モデルにおける誤差を計算、補正
するのに制御システム５０で用いられる技術はすべての
スカラ型ロボットの、「マニピュレータ冗長度と呼ばれ
る特徴に依存する。このマニピュレータ冗長度というの
は、工具４０の先端部４２またはテレビジョン・カメラ
４６の軸線４７を平面４４の同じ位置に一時的に置くと
共に、第４図および第５図にそれぞれ示す「右」モード
、「左」モードと呼ばれる２つの別個の角度配置にリン
ク２０．３２を１くというロボット１０の能力を意味し
ている。

リンク２０．３２が第４図に示すような右モードにある
とき、工具先端部４２のベース１２にある基準フレーム
ｆ　（第１図参照）に関する角度位置は角ｒｔｒｃ第４
図には示さず）で表わすことができる。この角γ１．は
リンク２０とＸ軸線２３．２軸線１５を通る平面のなす
角β、とリンク２０．３２の中心線５３．５４間の角Ｔ
、の合計として与えられる。これらの角β１、γ１は、
式（１）、（２）の第２項がマイナスであるときにそれ
ぞれの式によって与えられる。

第５図に示す左モードにおける工具４０の角度位置はβ
、λの合計として与えられる角γ、（この図には示して
いない）として定められる。これらの角β、λは、式（
１）、（２）の第２項がプラスになったときにこれらの
式によって与えられる。右、左両モードにおけるカメラ
４６の角度位置はそれぞれｒ　ｃｒｓ、γＣ（第４図あ
るいは第５図には示していない）で表わすことができる
。これらの角ｒｃｒ、γ６はＴｔいＴｔと同じ要領で得
られるが、ただし、それぞれγｃｒ、γ、を計算するの
に用いたλ１、λの値を調整してカメラ４６の軸線４７
の、工具４０の軸線４１からの既知の側方オフセントを
考慮に入れなければならない。

ロボット１０の運動学モデルが工具４０の位置の変位に
より不正確となり、そして、リンク２０．３２を右モー
ドから左モードへ、あるいは逆の方向へ切り換えたとき
、平面４４における先端部４２の位置は変わる。リンク
３２上のテレビジョン・カメラ４６の位置が変位して運
動学モデルが不正確となった場合、リンク２０．３２が
右モードから左モードにあるいはその逆に切り換えられ
たときに平面４４におけるカメラ軸線４７の位置は同じ
ところに留まらない。

運動学モデルの精度とは無関係に、制御点６４（第１図
参照）として示すリンク３２上の成る点の位置は、ロボ
ット１０のリンク２０．３２が右モードあるいは左モー
ドにある間、平面４４におけるこの点の下方にある一定
位置から見て、物理的に常に同じ位置に留まることにな
る。説明のために、平面４４内の軸線４７の位置に関し
て運動学モデルに誤差が存在すると仮定する。したがっ
て、制御点６４が平面４４で示す位置は軸線４７の平面
の位置とは一致しないことになる。

平面４４内のテレビジョン・カメラ４６の軸線４７の位
置についての誤差をロボット１０の運動学モデルで補正
するには、制御点６４および軸線４７が表わす平面内の
位置が一致するように運動学モデルを調整するのである
。運動学モデルを調整して上記の一致を得るには、まず
、リンク２０゜３２を第６図で見て右モードに置き、カ
メラ４６をピン５８のすぐ上（仮想線で示す）に置く。

リンク２０．３２を回転させてテレビジョン・カメラ４
６をビン５８上で心合せするには、第１図の制御システ
ム５０はピンの視野４８の中心からの位置を示す、第１
図のビジョン・システム５６からのデータに依存する。

次に、リンク２０．３２を第６図に示すような右モード
から第７図に示す左モードに切り換える。

ピン５８の視野４８の中心に対する位置は第１図のビジ
ョン・システム５６に記録される。平面４４におけるカ
メラ軸！４７の位置に関して運動学モデルに誤差が存在
する場合には、リンク２０．３２を右モードと左モード
の間で切り換えるときに視野４８内のピン５８の位置が
変化する。

ピン５８が右モード、左モードの両方で視野４８内の同
じ位置に現われるようにするには、運動学モデルを補正
しなければならない、カメラ４６を誤差装着した場合、
第３図の平面４４における軸線４７の軸線３４に対する
位置を定める距離、角度は、それぞれ、Ｌ２ｅ、、λ。

、によって与えられる。したがって、それぞれ一対の値
ΔＬ２ｃ、Δλとして運動学モデルにとって既知である
値Ｌ２ｃ、λゎを補正してＬ２ｃ、、λ。、にに等しく
する必要がある。

値ΔＬ２ｃ、Δλはｙｃ１、γ。間の差から、そしてリ
ンク２０．３２を右モード、左モード間で切り換えたと
きの領域４８内のピン５８の位置の変位量から得ること
ができる。第８図を参照して、ここにはテレビジョン・
カメラ４６の視野４８（第１図参照）が拡大して示して
あり、リンク２０．３２を右モード、左モードに置いた
ときのピン５８の位置を示している。視野４８内のピン
５８の相対位置は一対の直交軸線Ｘｃｓ）’ｃ（原点は
視野の中心と一致する）に相対的に表わすことができる
。

第６図、第７図のロボット・リンク２０．３２がそれぞ
れ右モードと左モードにあるときの、軸線ｘｃ、ｙｃに
沿ったピン５８の座標位置は、それぞれ、（Ｘｃｒ、ｙ
　ｃｒ）、（Ｘｃ　、ｙｃ　）によって与えられる。第
１図のテレビジョン・カメラ４６が第６図で見て右モー
ドにおいてピン５８の上方に位置しているので、第８図
に示すような座標（Ｘｃｒ、ｙ　ｃｒ）は（０，０）で
ある。左モードにおけるピン５８の位置を表わす座標（
Ｘ　Ｃ１ｙｃ）は第１図のビジョン・システム５６によ
って送られたデータから第１図の制御システム５０によ
って決定される。

それぞれ右モード、左モードにおけるピン５８の位置を
示す座標（ｘｃい）’　ｃｒ）、（Ｘｃ　、Ｘｃ　）間
の距離（Ｄ、）は次のように表わすことができる。すな
わち、 ＤＩ　＝　［（ｘｃ）”＋　（ｙｃ）”］　””　　　
　（５１第８図を参照して、この距離り、は（ｘｃｒ、
ｙ　ｃ−）、（”ｃ　、）’ｃ　）および（Ｘｅｂａ　
、”１ｃｈａ　）のところに頂点を有する仮想二等辺三
角形６６（仮想線で示す）の底辺の長さに相当する。こ
れらの座標のうちの後一対の座標は第１図の制御点６４
と一致する点のＸ、　、ｙｃ　Ｍ線に沿った座標位置を
定める。

三角形６６の２つの辺の各々（長さＤ２である）は底辺
Ｄ１と角φ１をなし、 φ、＝（１８０−φｚ）／２（６） である、ここで、φ２はこれら２つの辺のなす角度であ
る。角φ２はＴｃｒ、ｒｃ　　（それぞれ、右モード、
左モードでのテレビジョン・カメラ４６の軸線４７（第
６図、第７図参照）の角度位置）間の差に等しい。γ、
ｒ、γ。の値は第１図のエンコーダ２８．３８の出力信
号から得ることのできる値β１、β、λ１およびλから
得ることができる。

正弦法則を用いて、三角形６６の各辺の長さＤ２は底辺
の長さり、および角φ１から次のようにして厚くことが
できる。

０、　＝ｓｉｎ（φ＋）　（Ｄｚ／５ｉｎ（φ２））　
　　　　（７）Ｘｃ　、）’ｃ軸軸線沿った制御点６４
の座標ＣＸＣ＆４　、’／ｃｈａ　）は次のように決定
することができる。

Ｘｃｈａ　　＝Ｄｚ　　　［ｃｏｓ　　（φ　１　　＋
　φ　、　）　コ　　　　　　（８）Ｙｃｂａ　　”Ｄ
ｚ　　［ｓｉｎ　　（φ、　＋φ：１　　）　　］　　
　　（９）ここで、φ、は次のように与えられる角であ
る。

φ３　＝ａ　　ｔａｎ２（ｙｃ／　ｘｃ）　　　　　　
　ＱＯ）座標（Ｘｃｂａ　、）’Ｃ４４）がわかったな
らば、ΔＬ２の値は次のようになる。

ΔＬ２〜Ｙ　ｃｈ４Ｑυ ６７項は次の通りである。

Δλ〜［（Ｘ＆４／　Ｌ　２）（１８０°／ｌ］　　Ｕ
（ａ）右モード、左モードにおける第１図のカメラ４６
で見えるピン５８（第１図）の位置の変位を測定する段
階と、（ｂ）ビンの測定変位量に従って計算したΔＬ２
、Δλの値によって運動学モデル補正する段階は、ΔＬ
２、Δλがゼロに近づ（まで繰り返される。ΔＬ２、Δ
λがゼロになったならば、そのときには、カメラ４６の
軸線４７の平面４４内の位置は制御点６４が示す平面内
の位置と一致する。

第１図を参照して、工具４０の位置における変位につい
ての運動学モデルの補正は、運動学モデルをカメラ４６
の位置の変化について補正したほとんど同じ要領で行な
われる。工具４０の位置の変化を補正するには、Ｌ２ｔ
、ｘｔの値（第２図参照）を一対の値ΔＬ２ｔ、Δλ、
によって調整し、Ｌ２ｔいλ１．に等しくしなければな
らない（第２図参照）。ΔＬ２ｔ、Δλ、の値は、リン
ク２０．３２を左モード、右モードに置いたときに、テ
レビジョン・カメラ６０の視野６２の中心のような固定
基準点からの工具先端４２の位置の側方変位を測定する
ことによって得ることができる。

第９図を参照して、リンク２０．３２をまず左モードに
置き、工具４０の軸線４１が視野６２の中心と一致する
ことになるように先端部４２（第１図参照）をカメラ６
０のすぐ上に位置させる（第１図参照）。工具先端部４
２（第１図参照）をカメラ６０のすぐ上に位置させるた
めには、制御システム５０（第１図参照）は視野６２の
中心からの工具先端部の位置を示す第１図のビジョン・
システム５６からのデータに依存する。その後、リンク
２０．３２を第１０図に示す左モードから右モードに切
り換え、視野６２内の工具先端部４２（第′１図参照）
の位置を第１図のビジョン・システム５６によって記録
する。工具先端部４２（第１図、第２図参照）の、それ
故、工具軸線４１の軸線３４の平面４４（第１図参照）
内位置に関して運動学モデルに誤差が存在する場合には
、リンク２０．３２を左モードから右モードに切り換え
たとき、テレビジョン・カメラ６０の見るような先端部
４２の位置は側方に変位することになる。

第１１図はテレビジョン・カメラ６０の視野６２の拡大
図であり、左モード、右モードにおける工具先端４２の
、一対の直交軸線Ｘｔｓ　ｙｔに対する座標位置（第１
図でのみわかる）を示している。なお、この直交軸線の
原点は視野の中心と一致している。左モード、右モード
における工具先端部４２の座標位置（第１図参照）はそ
れぞれ（ｘｔ、ｙｔ）と（ｘｔｒ、ｙ　ｔｒ）とによっ
て与えられる。第１図の工具先端部４２はリンク２０、
３２を左モードに置いたときに第１図のカメラ６０の上
方に位置しているので、座標（ＸＬ％ｙｔ）は（０，０
）である。左モードと右モードにおける工具先端部４２
の（第１図参照）の側方距離り、は次の通りである。

Ｄ！　＝　［（Ｘｔｒ）ｔ＋０’ｔｒ）”］　””　　
　α１第１１図でわかるように、距離り、は（Ｘｔｒ、
ｙ　ｔｒ）、（Ｘｔ　％　）’ｔ　）および（Ｘｔｂａ
　、７ｗ４）に頂点を有する仮想二等辺三角形６８の底
辺の長さを表わしている。これらの座標のうち後の２つ
の座標は第１図のリンク３２上の制御点６４と一致する
Ｘｔ、ｙｔ軸軸線沿った成る点の位置を定める。明らか
なように、三角形６８（その各側辺が長さＤ４である）
は第８図の三角形６６と同じ要領で構成される。したが
って、式（７）〜αυは、弐〇３を式（５）の代りに用
い、式（８）、（９）の各φ、の値が弐〇のではなくて φ、　＝ａ　　ｔａｎ２０ｒ／Ｘ）　　　　　　Ｑ船で
定められるならば、Ｘｔｈａ　、Ｙｔｂａを計算するの
にも利用できる。

こうして計算したＸｗ４、ｙｔｂａの値は第１図の制御
点６４と一致する点の、Ｘｔ、ｙｔ軸軸線沿った座標位
置を表わしている。運動学モデルを補正するのに必要な
ΔＬ２１、Δλ、の値は式ＱＯＩ、αυを用いて計算で
きるが、そうするには、ｘ　ｔｂａ、ｙい、の値をｘｃ
、ｙｃ軸軸線第７図参照）上の対応する座標位置に変換
しなければならない。この変換を行なうには次の弐〇９
、ａＩｉｌを用いる。

Ｘ　ｃｂａ　＝Ｘ　ｔｈａ　［Ｃ（１５（γｔｒ）］　
−Ｖ　ｔｂａ　［５ｉｎ（γｔｒ）ｉ　−Ｘｔ＆４Ｉｌ
り ｙｃｂａ＝　３’　ｔｂａ　［５ｉｎ（ｒ　ｔｒ）］　
−Ｘ　ｔ、ｈａ　［Ｃ０５（γｔｒ）］　−）’　Ｌ６
４ｅ ここで、γ、１は第４図に関連して先に説明したように
右モードにおける工具４０（第１図参照）の角度位置で
ある。

工具先端部４２（第１図参照）、シたがって、工具軸線
４１の左モード、次いで右モードでの視野６２の中心か
らの位置変化を測定し、次にこの測定値に従って運動学
モデルを補正する段階は、ΔＬ２Ｌ、Δλ、がゼロに近
づくまで繰り返される。ΔＬ２ｔ、Δλ、がゼロに近づ
いたならば、そのときには、運動学モデルは工具４０の
位置における誤差について較正される。

ここに説明した実施例が本発明の詳細な説明するだけの
ものであることは了解されたい。発明の原理を用いての
発明の精神、範囲内での種々の変更、修正は当業者にと
って明らかであろう。

【図面の簡単な説明】

第１図はスカラ型ロボットをそれが担持する各工具の位
置を決定するシステムに接続した状態を示す斜視図であ
る。 第２図は第１図のロボットの一部の拡大図であり、一対
のロボ−／　）・リンクの１つに取り付けた工具を示す
図である。 第３図は第１図のロボットの一部の拡大図であり、対に
なったリンクの１つに取り付けたテレビジョン・カメラ
を示す図である。 第４図および第５図はそれぞれ第１図のロボットの簡略
化した平面図であり、それぞれ右モード、左モードに位
置したリンクを示す図である。 第６図は第１図のロボットの簡略平面図であり、リンク
を右モードに置いたときの固定基準点に対する、ロボッ
ト・リンクの１つで担持したテレビジョン・カメラの側
方位置を示す図である。 第７図はロボットの簡略平面図であり、リンクを左モー
ドに置いたときの基準点に対する、カメラの側方位置を
示す図である。 第８図はロボットの担持したカメラの視界の拡大図であ
り、右モード、左モードのそれぞれにおける、カメラか
ら見た基準点の位置を示す図である。 第９図はロボットの簡略平面図であり、リンクを左モー
ドに置いたときの固定テレビジョン・カメラに対する、
ロボット・リンクの１つで担持された工具の位置を示す
図である。 第１０図はロボットの簡略平面図であり、リンクを右モ
ードに置いたときの固定テレビジョン・カメラに対する
工具の位置を示す図である。 第１１図は固定テレビジョン・カメラの視界の拡大図で
あり、リンクを右モード、左モードに１いたときにカメ
ラ側から見た工具の位置を示す図である。 図面において、 １０・・・・・・ロボット　　１２・・・・・・ベース
１４・・・・・・部材　　１５・・・・・・２軸線１６
・・・・・・軸線　　１８・・・・・・手首２０・・・
・・・リンク　　２３・・・・・・Ｘ軸線２４・・・・
・・ｙ＠’！ａ’Ａ　　　２６・・・・・・サーボモー
タ２８・・・・・・エンコーダ　　３０・・・・・・手
首３２・・・・・・リンク　　３６・・・・・・サーボ
モータ３８・・・・・・エンコーダ　　４０・・・・・
・工具　　・４２・・・・・・先端部　　４３・・・・
・・電子部品４５・・・・・・回路板 ４６・・・・・・テレビジョン・カメラ４７・・・・・
・光軸　　５０・・・・・・制御システム５５・・・・
・・測定システム ５６・・・・・・ビジョン・システム ６０・・・・・・テレビジョン・カメラ６１・・・・・
・光軸　　６２・・・・・・視野６４・・・・・・制御
点 より ＦＩＧ、　２ ＦＩＧ、　３

Claims (1)

1. 【特許請求の範囲】 １、回転自在の第１リンクと、この第１リンクに回転自
   在に装着した工具装填用第２リンクとを有するロボット
   を較正し、その誤差を補正する方法において、第１の角
   度配置に前記両リンクを置いて所定位置に工具を設置す
   る段階と、前記両リンクを第２の角度配置に置いて所定
   位置に再び工具を一時的に置く段階と、前記両リンクを
   第２角度配置に置いたならば前記所定位置からの工具の
   距離を測定する段階と、測定した距離に従ってロボット
   の誤差を決定してこの誤差に従ってロボットを調節する
   段階と、測定距離がゼロに近づくまで前記諸段階を反復
   する段階とから成ることを特徴とする方法。 ２、特許請求の範囲第１項記載の方法において前記所定
   位置が固定テレビジョン・カメラの視界の中心にあり、
   前記測定段階がこのカメラの出力信号を処理して、前記
   両リンクが第１配置から第２配置に切換えられたときの
   カメラの視界中心からの工具の変位量を決定する段階か
   ら成ることを特徴とする方法。 ３、特許請求の範囲第１項記載の方法において、工具装
   填用の第２リンクもテレビジョン・カメラを支持してお
   り、第１配置に前記両リンクを置いてテレビジョン・カ
   メラを或る一定の基準点のすぐ上に位置決めする段階と
   、前記両リンクを第２配置において前記基準点上方にカ
   メラを一時的に位置決めする段階と、カメラの出力信号
   を処理して、両リンクを第１配置から第２配置に切換え
   たときにカメラで見た基準点の変位量を決定する段階と
   、カメラで見た基準点の変位量に従ってロボットの誤差
   を決定し、この誤差に従ってロボットを補正する段階と
   、誤差がゼロに近づくまで前記諸段階を反復する段階と
   を実行することによってカメラの位置についてロボット
   の誤差を補正することを特徴とする方法。