(57)【要約】【課題】ロボットの胴体との接触によりキャリブレーション情報を得てロボットの運動部のオフセットを補正するロボットのキャリブレーション方法を提供する。【解決手段】ロボット軸に移動変位が制限されてロボットアームが連結されたロボットにおいて、前記移動変位内に基準位置を設定し、前記ロボットアームが前記基準位置に到達したときの実際変位と前もって設定された正常変位との差を算出し、前記算出された差に基づいて前記ロボットアームの位置を補正する。【選択図】　　　　図４
2004042245.tif 000002
【特許請求の範囲】
【請求項１】
ロボット軸に移動変位が制限されるようにロボットアームが連結されたロボットのキャリブレーション方法において、
前記移動変位内に基準位置を設定する段階と、
前記ロボットアームが前記基準位置に到達したときの実際変位と前もって設定された正常変位との差を算出する段階と、
前記算出された差に基づいて前記ロボットアームの位置を補正する段階とを含んでなることを特徴とするロボットのキャリブレーション方法。
【請求項２】
前記基準位置は、前記ロボットアームが前記ロボット軸と接触する位置であることを特徴とする請求項１記載のロボットのキャリブレーション方法。
【請求項３】
前記実際変位は前記ロボットアームの現在位置と前記基準位置との間の位置であることを特徴とする請求項１記載のロボットのキャリブレーション方法。
【請求項４】
前記前もって設定された正常変位は前記ロボットの正常位置と前記基準位置との間の位置であることを特徴とする請求項１記載のロボットのキャリブレーション方法。
【請求項５】
ロボット軸に移動変位が制限されてロボットアームが連結されたロボットのキャリブレーション方法において、
前記ロボットアームの正常位置と前記ロボットアームが前記ロボット軸と接触する接触位置との間の第１移動変位を得る段階と、
前記ロボットアームを前記接触位置に移動させることにより、前記ロボットアームの現在位置と前記接触位置との間の第２移動変位を得る段階と、
前記第１移動変位と前記第２移動変位との間の差に基づいて前記ロボットアームの現在位置を前記正常位置に補正する段階とを含んでなることを特徴とするロボットのキャリブレーション方法。
【請求項６】
使用者から命令を入力する入力部と、
モータを正回転及び逆回転してロボットのロボットアームを所望位置に移動させるモータ駆動部と、
前記モータの回転による前記ロボットアームの移動変位データを得るため、前記モータに連結されたエンコーダと、
前記エンコーダから出力されたデータを記憶する記憶部と、
前記記憶部に記憶されているデータに基づいてロボットのキャリブレーション動作を制御する制御部とを含むことを特徴とするロボットのキャリブレーション装置。
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】
本発明は、ロボットのキャリブレーション方法に係り、より詳しくは別途のキャリブレーション装置を備えずに、自体運動によりキャリブレーションを行うロボットのキャリブレーション方法およびキャリブレーション装置に関するものである。
【０００２】
【従来の技術】
ロボットの如く精密位置制御を要する機械又は器具を修理するか、あるいは部品交替のために分解してから再び組み立てると、ロボットアームなどの運動部の初期位置が以前の位置に対して変動するオフセットが頻繁に発生し得る。したがって、部品の交替などによりオフセットが生ずると、オフセットを補正するためにキャリブレーションを行って以前のキャリブレーションデータを修正しなければならない。
【０００３】
従来、ロボットの部品を交替してオフセットを補正する必要がある場合、専用のキャリブレーションジグを用いるか、ロボットに表示されているキャリブレーションマークに基づいてキャリブレーションを行ってきた。
図１は従来のキャリブレーションジグを用いるロボットのキャリブレーション方法の制御フローチャートである。同図に示すように、まずロボットの胴体に取り付けられている作業用ツールを取り外す（Ｓ１０）。そして、キャリブレーション専用ツールをロボットに取り付ける（Ｓ１１）。キャリブレーションツールを取り付けた後、キャリブレーション専用ツールを用いてキャリブレーションを行う（Ｓ１２）。
【０００４】
段階Ｓ１２でのキャリブレーションによるキャリブレーション結果を用いてキャリブレーションデータを得る（Ｓ１３）。オフセット補正のため、このキャリブレーションデータを用いて、前もって記憶されている既存のキャリブレーションデータを修正する（Ｓ１４）。
キャリブレーションデータが修正されると、キャリブレーション専用ツールを再び取り外す（Ｓ１５）。ついで、既存の作業用ツールを取り付ける（Ｓ１６）。
【０００５】
このように、キャリブレーションジグを用いる従来の方法においては、キャリブレーションジグの高精密度が要求される。特に、既存の作業用ツールとキャリブレーション専用のツールを交替する作業を２回も行わなければならないので、その作業が大変面倒であり、長時間がかかる問題点がある。また、実使用者が直接キャリブレーションを行わなければならない場合、専用ジグを備えていなければならない問題点がある。
【０００６】
一方、ロボットの胴体に表示されているマークに基づいてキャリブレーションを行う作業は、ロボット胴体に表示されたマークを基準マークの表示された位置に移動させ、キャリブレーションマークと基準マークを一致させた後、現在のロボット位置を用いてキャリブレーションデータを修正する。
このような基準マークを用いる従来の方法は、ツールを着脱する不便さはないが、キャリブレーション精度が相対的に低い問題点がある。
【０００７】
【発明が解決しようとする課題】
したがって、本発明は前記のような問題点を解決するためのもので、その目的はロボットの胴体との接触によりキャリブレーション情報を得てロボットの運動部のオフセットを補正することにある。
【０００８】
【課題を解決するための手段】
前記目的を達成するため、本発明は、ロボット軸に移動変位が制限されてロボットアームが連結されたロボットのキャリブレーション方法において、前記移動変位内に基準位置を設定する段階と、前記ロボットアームが前記基準位置に到達したときの実際変位と前もって設定された正常変位との差を算出する段階と、前記算出された差に基づいて前記ロボットアームの位置を補正する段階とを含んでなるロボットのキャリブレーション方法を提供する。
【０００９】
【発明の実施の形態】
以下、本発明の好ましい実施例を添付図面に基づいて詳細に説明する。　図２は、本発明の一実施例によるロボットの動作を示す図である。同図に示すように、ベース１０の上部に第１軸１１が回転可能に連結され、第１軸１１の上部には所定の角度に回動する第２軸１２が連結され、第２軸１２にはロボットアーム（作業ツール）１３が所定の角度に回動可能に連結される。
また、このようなロボットアーム１３と第２軸１２との間にはストッパー突出部（図示せず）が設けられているので、ロボットアーム１３が所定位置以上に運動することを防止する。ロボットアーム１３が所定角度以上に回転した場合、ロボットの軸と接触する。ロボットアーム１３はロボットのモータ（図示せず）の駆動により回動する。
【００１０】
図３は本発明によるロボットのキャリブレーションを説明する制御ブロック図である。同図に示すように、本発明によるロボットのキャリブレーション装置は、使用者から作業命令を入力するためのキー入力部１５０と、ロボットアーム１３を所望位置に移動させるため、モータ１２０を正回転又は逆回転させるモータ駆動部１１０と、モータ１２０側に設けられ、モータ１２０の回転によるロボットアーム１３の移動変位を得るためのエンコーダ１３０と、各種情報を記憶するための記憶部１４０と、エンコーダ１３０を通じてフィードバックされた移動変位を記憶部１４０に記憶し、記憶部１４０に記憶された各種情報によって全体キャリブレーション動作を制御する制御部１００とからなる。
【００１１】
図４は、本発明によるロボットのキャリブレーション方法の制御フローチャートである。同図に示すように、ロボットアームが第２軸１２に装着されると、制御部１００は記憶部１４０に記憶されているロボットアームの自己キャリブレーションプログラムを用いて初期キャリブレーションを行う（Ｓ１００）。
制御部１００は、初期キャリブレーションにより得た補正データを記憶部１４０に記憶する（Ｓ１０１）。
【００１２】
つぎに、制御部１００はモータ駆動部１１０を介してモータ１２０を作動させてロボットアーム１３を接触位置に移動させる（Ｓ１０２）。この際、制御部１００はエンコーダ１３０を通じてフィードバックされたロボットアーム１３の移動変位を受ける。
制御部１００は、エンコーダ１３０を通じて得たロボットアーム１３の移動変位に基づき、ロボットアーム１３がそれ以上回転しなくロボットの胴体に接触する接触位置に到達したかを判断する（Ｓ１０３）。接触位置に到達すると、ロボットアームがそれ以上回転しないので、モータ１２０の負荷が一時増加して、モータ１２０の回転速度が変化する。したがって、エンコーダ１３０の出力信号が変化し、制御部１００はこの変化したエンコーダ１３０の出力信号に応じて接触位置に到達したと判断する。
【００１３】
段階Ｓ１０３での判断結果、接触位置に到達した場合、制御部１００はモータ駆動部１１０によりモータ１２０を停止させてロボットアームの移動を停止させる（Ｓ１０４）。ついで、制御部１００はエンコーダ１３０により得たロボットアーム１３の移動変位を記憶部１００に第１移動変位として記憶する（Ｓ１０５）。
初期キャリブレーションを行って得たロボットアーム１３の初期位置データとロボットアーム１３の衝突時の移動変位を記憶部１４０に記憶した状態で、作業者から所望作業を行うための当該作業命令をキー入力部１５０を介して受ける（Ｓ１０６）。
【００１４】
作業命令が入力されると、制御部１００はモータ駆動部１１０によりモータ１２０を駆動し、ロボットを当該作業位置に移動させる（Ｓ１０７）。ロボットアーム１３が作業位置に移動すると、制御部１００はロボットアーム１３を用いて当該作業を行う（Ｓ１０８）。この際、制御部１００は、段階Ｓ１０５で得た移動変位に基づき、当該作業位置での接触時の第１移動変位を算出して記憶部１４０に記憶する（Ｓ１０９）。
【００１５】
作業の途中で、ロボットアーム１３の修理、交替などによりロボットアーム１３を分離してから取り付けることがあり得る。この場合、ロボットアームに対するキャリブレーションを再び行う必要がある。制御部１００は、再補正が必要であるかを点検するため、作業者がキー入力部１５０を通じてロボットアームを再びキャリブレーションするための命令が入力されるかを判断する（Ｓ１１０）。
【００１６】
段階Ｓ１１０での判断結果、再補正のための命令が入力されると、制御部１００は再補正が必要であると判断し、モータ駆動部１１０によりモータ１２０を作動させることで、ロボットアーム１３を接触位置に移動させる（Ｓ１１１）。この際、制御部１００はエンコーダ１３０を介してフィードバックされたロボットアーム１３の移動変位を受ける。
制御部１００は、エンコーダ１３０の出力信号に基づき、ロボットアーム１３が接触位置に到達するかを判断する（Ｓ１１２）。段階Ｓ１１２での判断結果、接触位置に到達した場合、制御部１００はモータ駆動部１１０によりモータ１２０を停止させ、ロボットアーム１３の移動を停止させる（Ｓ１１３）。
【００１７】
ついで、制御部１００はロボットアーム１３の接触時の第２移動変位を記憶する（Ｓ１１４）。制御部１００はエンコーダ１３０を通じてロボットアーム１３の第２移動変位を得る。
ロボットアーム１３の第２移動変位が記憶されると、段階Ｓ１０５でのロボットアーム１３の第１移動変位と第２移動変位との差を算出する（Ｓ１１５）。差が算出されると、制御部１００は算出された差に基づいてロボットアームの現在位置を補正する（Ｓ１１６）。
【００１８】
【発明の効果】
以上説明したように、本発明は、別途のキャリブレーション装置を備えなくても、ロボットアームの移動変位の基準位置に対してロボットアームを移動させて得たキャリブレーション位置データを用い、正確なキャリブレーションデータを迅速に得ることができる効果がある。
【図面の簡単な説明】
【図１】キャリブレーションジグを用いる従来のロボットのキャリブレーション方法の制御フローチャートである。
【図２】本発明の一実施例によるロボットの動作を示す図である。
【図３】本発明のロボットのキャリブレーションを示す制御ブロック図である。
【図４】本発明によるロボットのキャリブレーション方法の制御フローチャートである。
【符号の説明】
１０　ベース
１１　第１軸
１２　第２軸
１３　ロボットアーム
１００　制御部
１１０　モータ駆動部
１２０　モータ
１３０　エンコーダ
１４０　記憶部
１５０　キー入力部
【図１】
2004042245.tif 000003
【図２】
2004042245.tif 000004
【図３】
2004042245.tif 000005
【図４】
2004042245.tif 000006