JPS6284986A - ロボツトの関節角度設定方法 - Google Patents

Abstract

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

Description

【発明の詳細な説明】 〔発明の利用分野〕 本発明は関節形ロボットの関節角度設定方法に係り、特
に、関節形ロボットの位置姿勢の制御上の原点位置を設
定する「原点合せ」に用いることのできる、関節形ロボ
ットの関節角度を精度良く設定するロボット関節角度設
定方法に関する。

〔発明の背素〕

従来の「原点合せ］はロボットの関節部にリミットスイ
ッチ等の検出器を取付け、この検出信号を基に、ロボッ
トの位置姿勢の制御上の原点位置を求めている。すなわ
ち、第４図に示すように、第１のアーム１と第２のアー
ム２とで形成する関節１２の近傍に、図示例では第１の
アーム１側にレバー６を、第２のアーム２側にリミット
スイッチを設け、これらの５．４を位置検出器として用
いて、関節１２ヲ回転させ、その回転位置に応じて検出
器出力信号がオン・オフするのを検知することで関節角
度を設定するものである。

しかしながら、上記し念従米方法では、ロボットの個体
差によりまたはロボットの分解等によリミットスイッチ
の信号の発生位置が変動することになり、ロボットのア
ーム間の絶対的な位置関係を検出することは、一般に、
できない。さらに、第４図かられかるように、関節１２
の軸近傍に検出器が配置される方式であることから、検
出器のヒステリシスや取付誤差により角度検出にΔθの
検出誤差があると、アーム先端では、アームの長さをｌ
としてΔθ・ｌだけの位置誤差となり、アームが長けれ
ば長いほどアーム先端では大きな位置誤差となってしま
うという問題がある。

そこで従来は、ロボットを組立て完成させた後、特開昭
６０−２０８７８．特開昭６０−９６８７等に記載され
ているように、ロボットの絶対位置を測定し、「原点合
せ」した位置とのデータの差を補正量として制御プログ
ラム上に記憶させて原点を求める方式、または、特開昭
５９−２０５２８２　、特開昭６０−２５６８０．特開
昭６０−２５６８１に記載されているように、外部に基
準点を設はロボットをそこに位置決めし、本来あるべき
位置データとそこで示された位置検出器のデータから誤
差量を推定し原点を補正する方式等が採用されていた。

しかし、実際には、外部からの正確な位置測定ができて
ロボット機構の基準点となり得るような部分が外部に露
出していないことなどから、上記方法の実施は困難であ
り、したがって補正量が正確でなかった。また、ロボッ
トはその使用現場において誤動作や誤操作などにより受
けた外力により生じる伝達機構の歪みや分解修理などに
よりその組立時に求めた補正量が無効になる場合が多く
、このような場合にはロボットの動作を再教示しなけれ
ばならないが、その場合、ロボットの実際の位置姿勢を
表すデータに対して誤差を含んだ補正量を基にしてロボ
ットを動かすと、その絶対精度は悪くなり、直交座標系
での軌跡精度や偏差移動、視覚フィードバック等の精度
安定性に悪影響を与え、ロボットの性能を落とすと共に
、故障時に代替ロボットを使用する際に代替前のデータ
が使えないなどの問題が生じていた。

〔発明の目的〕

本発明の目的は、上記した従来技術での問題点を解決し
、関節形ロボットの各関節の位置関係を精度良く検出、
設定でき、それにより関節形ロボットの絶対空間におけ
る位置を正確に把握制御できるようにし、ロボットの性
能向上を可能とするロボット関節角度設定方法を提供す
ることにある。

〔発明の概要〕

本発明では、上記目的を達成するために、設定すべき関
節を形成する＠１アームと第２アームのうちの、第１ア
ーム側には平行光を発生する発光器を、第２アーム側に
は上記平行光を受ける受光器を、各アーム先端の軸心と
上記関節の細心とを結ぶ線上の位置にそれぞれのアーム
製作時に固定状に取付けておき、ロボットとして組立て
後に、上記関節の軸心位置に配置し九プリズムまたはミ
ラーを介してあるいは介することなく上記発光器からの
平行光が上記受光器に入射するように関節角度を設定す
る方法を採用する。

すなわち、本発明では、従来用いられてきたリミットス
イッチ等の検出手段に代えて、光の直進性を利用して各
関節における両アーム間の角度が１８０度、９０度など
になる位置を検出しそれにより各関節の位置関係のデー
タを決定し、機構的に正確な位置を求める方法であり、
光学系はロボットの動力伝達系や減速機構部に設置され
るものではなく、アーム製造時にアーム自体に位置精度
を保障して設置しておいてロボットを組立てる方式によ
ることから、それ以降の精度が保障され、高精度の関節
角度の設定が可能となる。

〔発明の実施例〕

以下、本発明の実施例を図面により説明する。

第１図は本発明の第一の実施例を示す平面図である。第
１図において、１は第１のアーム。

２は第２のアーム、１２は第１のアーム１と第２のアー
ム２とで形成する関節を示している。１２′は関節１２
の軸心、１′は第１のアーム１の先端の軸心、２′は第
２のアーム２の先端の軸心である１゜５、’６Ｉｉ本実
施例において設けられる発光器。

受光器を示し、発光器５はレーザ光を発生する発光部と
このレーザ光を平行光に変換する変換部とを持っており
、第１のアーム１を製作する時に軸心１２′　と細心１
′とを結ぶ線上の位置で、かつ軸心１２′からできるだ
け離れた位置に固定され、受光器６は上記レーザ光を受
けてこれを電気信号Ｉこ変換する機能を持つもので、同
じく第２のアーム２を製作する時に細心１２′　と細心
２′とを結ぶ線上の位置で、かつ、軸心１２′からでき
るだけ離れた位置に、さらに、ロボットとして組立てた
時に発光器５から発生したレーザ光が途中で遮られるこ
となく入射する位置に固定される。このようにすること
により、第４図従来例の場合と異なジ、アームの長さが
長くなればなるほど、角度に対して精度良く検出が可能
であり、アーム先端での位を精度は保障される。第１図
で、８は軸心２’　、　１２’間を結ぶ線、９は発光器
５から発生する平行光を示しており、図示のようにこの
平行光９が受光器６の入口側スリット（図示省略）を通
過し、受光器６内の本体を構成する光電変換素子を照射
して出力電気信号が例えばオンに変わることで、５つの
軸心１’、１２’、　　２’が一直線上にあることが検
知され、関節１２の角度が正確に１８０度に設定される
ことになる。この場合、受光器６に２分割受光素子等を
用い、単なるオン・オフ信号ではなく、アナログ的に変
化する信号を出力させるようにすれば、検出精度はなお
一層向上する。本実施例における検出および設定の精度
は、組立時の測定による補正ではなく、アーム製作時の
位置出し精度により決ま′す、これは例えば治具使用に
より極めて高い精度の位置出しが可能であることから、
第１のアーム１と第２のアーム２とが一直線であること
、すなわち関節角度が１８０度。

アーム回転角度が零度であることが、絶対角度として保
障可能となる。

第２図は本発明の第二の実施例を示す平面図で、これは
、可動範囲などの条件により両アームを一直線にできな
い場合に、関節１２の軸心位置に配置したプリズム７を
用いることにより、第１図実施例での発光器５．受光器
６をそのまま用いて、同様の検出、設定が可能になるこ
とを示している。プリズム７として反射が９０度のもの
を用いる場合、プリズム７は、発光器５が取付けられて
いる第１のアーム１の回転軸上に、すなわち関節１２の
軸心１２′とプリズム７の光反射点とが一致するように
、配置される。このようにすれば、受光器６がプリズム
の反射面に対して図示Ａ方向に振れて垂直ｌこなった時
、受光器出力信号が発生し、第１のアーム１と第２のア
ーム２との間の回転角が正確に９０度であることになる
。

第３図は本発明の第三の実施例図で、これは、９０度の
ねじり角をもつ対偶である場合で、第２のアーム２が図
示Ｂ方向に回転する場合であるが、これも反射角９０度
のプリズム７を用いることにより、同様に検出、設定が
可能である。

関節形ロボットの作業空間での絶対精度が出ない一番大
きな原因は、駆動伝達機構のガタは別に１〜て、各関節
の回転対偶の角度の割出しが精度良くできていないこと
にあることが知られているが、第３図実施例方式を採用
して原点検出を行った関節形ロボットはその絶対峯１す
度を著しく向上させることが可能である。またロボット
の持つ−Ｃいる座標空間と外部の作業空間との関係の設
定誤差は、ロボットの座標空間が正確であることから、
作業空間の規準点をロボット１牙で計測することにより
容易に補正することができる。、 〔発明の効果〕 本発明によれば、ロボットの「原点合せ」が精度よ〈実
施できることにより、作業空間円におけるロボットの絶
対位置姿勢が保障できるようになり （１）直線移動の軌跡精度が向上する （２）上位コンピュータによるオフライン動作が可能に
なる （３）　　パレタイジング時、位置の移動量が教示では
なく数値データによって正確に行えるようになる。

（４）視覚等のデータが偏差量ではなく位置量として扱
えるようになる。

（５）　　センサフィードバック時各種データをロボッ
トの位置姿勢によって変換する場合、位置姿勢のデータ
が正確であることから、正確に変換が行われ制御の安定
性、正確性が増す。

（６）　　ロボット故障時、別のロボットがその教示デ
ータを流用できるようになり、生産ラインの稼動率が増
す。

等の効果が得られる。

【図面の簡単な説明】

第１図は本発明の一実施例平面図、第２図はねじり角が
ない回転軸を持つ場合の本発明実施例配置図、第３図は
ねじり角が９０度の場合の本発明実施例の配置図、第４
図は従来方法の検出器の配置を示す図である。 〔符号の説明〕 １・・・第１のアーム　　２・・・第２のアーム３・・
・レバー　　　　　４・・・リミットスイッチ５・・・
発光器　　　　　６・・・受光器７・・・プリズム　　
　　９・・・平行光１２・・・関節 、・′−゛

Claims (2)

【特許請求の範囲】
1. （１）関節形ロボットの原点合せに用いる関節角度設定
   方法において、設定すべき関節を形成する第１アームと
   第２アームのうちの、第１アーム側には平行光を発生す
   る発光器を、第２アーム側には上記平行光を受ける受光
   器を、各アーム先端の軸心と上記関節の軸心とを結ぶ線
   上の位置にそれぞれのアーム製作時に固定状に取付けて
   おき、ロボットとして組立て後に、上記関節の軸心位置
   に配置したプリズムまたはミラーを介してあるいは介す
   ることなく上記発光器からの平行光が上記受光器に入射
   するように関節角度を設定することを特徴とするロボッ
   トの関節角度設定方法。
2. （２）前記発光器が、レーザ光を発生する発光部とそれ
   を平行光に変換する手段を持つ受光器であることを特徴
   とする特許請求の範囲第１項記載のロボットの関節角度
   設定方法。