JP2004074368A - ロボットオフライン教示システムにおけるケーブル表示装置 - Google Patents
ロボットオフライン教示システムにおけるケーブル表示装置 Download PDFInfo
- Publication number
- JP2004074368A JP2004074368A JP2002240968A JP2002240968A JP2004074368A JP 2004074368 A JP2004074368 A JP 2004074368A JP 2002240968 A JP2002240968 A JP 2002240968A JP 2002240968 A JP2002240968 A JP 2002240968A JP 2004074368 A JP2004074368 A JP 2004074368A
- Authority
- JP
- Japan
- Prior art keywords
- cable
- robot
- state
- arm
- screen
- 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
Links
Images
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
【課題】ロボットに装着されたケーブルの捩り状態もしくは巻き付き状態を正確に検出し、そのケーブル状態を画面上で容易に把握できるようにする。
【解決手段】上部アーム5およびハンド6等を備えるロボットに装着されたケーブル8の捩り状態もしくはそのケーブル8の上部アーム5周りへの巻き付き状態を検出し、この検出されたケーブル状態をオフライン教示のための画面に点の集合体10として描画する。
【選択図】 図5
【解決手段】上部アーム5およびハンド6等を備えるロボットに装着されたケーブル8の捩り状態もしくはそのケーブル8の上部アーム5周りへの巻き付き状態を検出し、この検出されたケーブル状態をオフライン教示のための画面に点の集合体10として描画する。
【選択図】 図5
Description
【0001】
【発明の属する技術分野】
本発明は、アームとそのアーム先端に装着されるハンドとを備えるロボットを画面に表示するとともに、このロボットを画面上で操作してそのロボットに所要の動作を教示するロボットオフライン教示システムにおいて、ロボットに装着されたケーブルの捩り状態もしくは巻き付き状態を表示するロボットオフライン教示システムにおけるケーブル表示装置に関するものである。
【0002】
【従来の技術】
従来、産業用ロボット(以下、単に「ロボット」という。)のハンドに溶接、塗装などのツールを把持させて、このツールを予め定めた作業線に沿って移動させて所要の作業を行うようにしたロボットシステムが知られている。この種のロボットシステムにおいて、ロボットに所要の動作データを教示する教示方法としては、CRT等の画面上でその動作をシミュレート(模擬実行)することにより、生産ラインを停止させることなくその動作実行のためのプログラムを作成する、所謂オフライン教示方法がある。すなわち、この教示方法は、実空間の実ロボットをコンピュータの仮想空間内に仮想ロボットモデルとして作成してCRT等の画面上に表示し、この画面上の仮想ロボットモデルに実ロボットの動作を模倣させることにより、実ロボットの動作確認や動作プログラムの作成を行うようにしたものである。
【0003】
ところで、通常、ロボットのハンドに把持させるツールには、ロボット本体側から延設される溶接ワイヤなどのケーブルや、ホース等(以下、単に「ケーブル」という。)の先端部が取着されていることから、前述のようなオフライン教示システムによってロボットの動作確認や動作プログラムの作成を行うに際しては、このケーブルの巻き付きや捩り状態を考慮しないと、実機において動作させた際にケーブルの送給抵抗が著しく大きくなったり、場合によってはケーブルを破損させてしまう恐れがある。
【0004】
このようなケーブルの巻き付き等をチェックすることを考慮した従来技術としては、特開平10−275007号公報に開示されたものがある。この公報に記載のロボットのシミュレーション方法では、ロボットの手首の回転軸に直交する平面に対するケーブルのアーム側固定点およびハンド側固定点の各投影点と前記平面内での回転中心とのなす角度を求め、この角度が予め設定された範囲内にあるか否かを判断することにより、ケーブルのアームへの巻き付きを検出するように構成されている。
【0005】
【発明が解決しようとする課題】
しかしながら、前記公報に記載された従来のシミュレーション方法では、ケーブルのアーム側固定点およびハンド側固定点の各投影点を求め、これら投影点に基づいてケーブルの回転角度を算出するように構成されているために、この方法は、アームに対してハンドが捩り(ツイスト)動作のみを行うタイプのロボットに対しては有効ではあるものの、この捩り(ツイスト)動作以外に、曲げ(ベンド)動作を行うタイプのロボットに対しては、この曲げ動作によってハンド側固定点の投影点が変わることになり、正確なケーブル回転角度を算出することができないという問題点がある。
【0006】
また、前記従来方法では、ケーブルの巻き付きチェック等の判定結果、言い換えれば巻き付きの有無のみをオペレータ(ユーザ)に報知するように構成されているために、オペレータはCRT等の画面上でケーブルの実際の配置状態を把握することができず、この配置状態に基づく動作プログラムの修正処理が容易に行えないという問題点がある。
【0007】
本発明は、このような問題点を解消するためになされたもので、ロボットに装着されたケーブルの捩り状態もしくは巻き付き状態を正確に検出することができ、かつそのケーブル状態を画面上で容易に把握することのできるロボットオフライン教示システムにおけるケーブル表示装置を提供することを目的とするものである。
【0008】
【課題を解決するための手段および作用・効果】
前記目的を達成するために、本発明によるロボットオフライン教示システムにおけるケーブル表示装置は、
アームとそのアーム先端に装着されるハンドとを備えるロボットを画面に表示するとともに、このロボットを画面上で操作してそのロボットに所要の動作を教示するロボットオフライン教示システムにおいて、
前記ロボットに装着されたケーブルの捩り状態もしくはそのケーブルの前記アーム周りへの巻き付き状態を検出するケーブル状態検出手段と、このケーブル状態検出手段により検出されたケーブル状態を前記画面に描画する描画手段を備えることを特徴とするものである。
【0009】
本発明においては、画面上に表示されたロボットをその画面上で操作してそのロボットに所要の動作をオフラインにて教示するに際し、アームの内部空間を通してケーブルを配線する場合におけるケーブルの捩り状態、もしくはアームの外周部を通してケーブルを配線する場合におけるケーブルの巻き付き状態が、ケーブル状態検出手段によって検出され、この検出されたケーブル状態が描画手段によって画面上に描画される。したがって、オフライン教示を実行するオペレータは、その教示操作時に画面を見るだけで、その画面を通して実際のケーブルの配線状態に近い状態を視認することができ、これに基づいて動作プログラムの修正処理等を容易に行うことができる。
【0010】
本発明において、前記ケーブル状態検出手段は、前記アームおよび/またはハンドの軸心周りの合計回転角度と、前記ケーブルの基端側および先端側の各固定部における取付角度とに基づいて前記ケーブルの捩り状態もしくは巻き付き状態を検出するものとするのが好ましい。こうすることで、アームに対してハンドが捩り動作のほかに曲げ動作を行う場合であっても、アームおよび/またはハンドの軸心周りの回転角度のみを抽出してケーブルの捩り角度が演算されるので、ハンドに装着されるツールの捩り角度を正確に得ることができ、これによってケーブルの捩り状態もしくは巻き付き状態を正確に把握することができる。
【0011】
前記各発明において、前記描画手段は、前記アームの周りに円弧状もしくは環状に連続する点の集合体または帯状体にて前記ケーブル状態を描画するものであるのが好ましい。このようにすれば、アームの位置が移動しても常にその周りにケーブルの捩りもしくは巻き付き状態を表示させることができ、利用者の利便性がより向上する。
【0012】
この場合、前記ケーブル状態検出手段は、前記ケーブルの捩り状態もしくは巻き付き状態が正常範囲を越えたことを判定する判定手段を含み、この判定手段により前記正常範囲を越えたことが判定されたときに、前記描画手段は、前記点の集合体または帯状体の色を変更することにより警告を発するようにするのが良い。こうすることで、オペレータはアームの周りに表示された点の集合体または帯状体の色の変化によって、一目瞭然にケーブルの捩り異常もしくは巻き付き異常を判断することができ、利用者の利便性が更に向上する。
【0013】
【発明の実施の形態】
次に、本発明によるロボットオフライン教示システムにおけるケーブル表示装置の具体的な実施の形態について、図面を参照しつつ説明する。
【0014】
図1(a)には、本発明の一実施形態に係る多関節型溶接ロボットの斜視図が示され、図1(b)には、同溶接ロボットの各軸動作説明図が示されている。
【0015】
本実施形態の溶接ロボット1は6軸の多関節型ロボットであって、固定ベース2上に鉛直軸周りに矢印J1方向に旋回自在に取り付けられる旋回ヘッド3と、この旋回ヘッド3の上部に左右軸周りに矢印J2方向に揺動自在に取り付けられる下部アーム4と、この下部アーム4の上部に左右軸周りに矢印J3方向に揺動自在で、かつ自身の軸心周りに矢印J4方向に捩り(ツイスト)動作可能に取り付けられる上部アーム5と、この上部アーム5の先端部に矢印J5方向に曲げ(ベンド)動作可能に、かつ自身の軸心周りに矢印J6方向に捩り(ツイスト)動作可能に取り付けられるハンド6とを備えて構成されている。
【0016】
前記ハンド6には溶接ツールとしての溶接ガン7が装着され、この溶接ガン7にケーブル8の先端部が接続されている。なお、このケーブル8の基端側は上部アーム5の基端部上面に固定されている。
【0017】
ところで、図2(b)に示されているように、前記溶接ロボット1に対してCRT等の画面9上でその動作をシミュレートさせて、この溶接ロボット1の動作プログラムの作成等を行うオフライン教示システムにおいては、通常、溶接ガン7に付設されるケーブル8は画面9上に表示されず、そのケーブル8の動きは無視されている。このため、図2(a)に示されるように、実機ではケーブル8がアーム(上部アーム5)の周りに巻き付いていてもその状態を教示してしまう場合がある。そして、このような教示がなされると、実機を実際に動作させた際にケーブル8を破損させることになってしまう。
【0018】
このような不具合を回避するために、本実施形態では、前記オフライン教示に際して、ケーブル8のアーム(本実施形態では上部アーム5)周りへの巻き付き状態を検出するとともに、そのケーブル状態を画面9上に表示するように構成したものである。以下、その巻き付き状態の判定および表示の具体的な処理内容について、図3に示されるフローチャートを参照しつつ説明する。これらの処理は本オフライン教示システム内に内蔵される演算処理装置(図示せず)によって行われる。なお、以下の説明において記号Sはステップを示す。
【0019】
本実施形態では、ケーブル8の先端部が溶接ガン7に固定されるとともに、このケーブル8の基端部が上部アーム5の基端部上面に固定された系を対象としていることから、図1(b)に示されるJ3〜J6軸のみを考慮すればいい。これらJ3〜J6軸をX,Y,Z軸座標系に変換すると、図4(a)に示されるようなX3−Y3−Z3軸、X4−Y4−Z4軸、X5−Y5−Z5軸、X6−Y6−Z6軸となり、この場合、回転軸はY3軸、X4軸、Y5軸およびX6軸の4軸となる。
【0020】
S1:前記XYZ軸座標系において、ツール部(溶接ガン7)におけるケーブル8の取り付け角度C6(図4(b)参照)を入力し、併せて固定部(上部アーム5)におけるケーブル8の取り付け角度C3(図4(c)参照)を入力する。ここで、これら角度C6,C3は、本実施形態では、Z軸からの回転角度として設定されている。
【0021】
S2〜S3:ロボットの全6軸におけるXYZ軸座標系でのロボット軸角度θ1〜θ6を取り込み、この取り込み値に基づいて溶接ロボット1を画面9上に描画する。
S4:溶接ロボット1のオフライン教示に際して、ケーブル8の上部アーム5周りへの巻き付きに係るX4軸周りの回転角度θ4およびX6軸周りの回転角度θ6、言い換えればツイスト動作を行う2軸のツイスト角度の加算値θ4+θ6を算出し、この加算値から、前記ケーブル8の先端部および基端部の取り付け角度C6を加算、C3を減算することにより、すなわち次式によってケーブル8の巻き付き角度αを算出する。
α=θ4+θ6−C3+C6
【0022】
S5:算出された巻き付き角度αの絶対値|α|が180°未満であるか否か、言い換えれば基準位置からのケーブル8の捩れ角度が左右に180°以内(合計360°以内)の範囲にあるか否かを判定する。なお、これらステップS4,S5にてなされる処理は、前記演算処理装置内のケーブル状態検出手段および判定手段によって行われる。
S6〜S7:|α|<180°を満たしている場合には、ケーブル8の画面上での色を標準色(例えば緑色)に指定する。一方、|α|≧180°となる場合には、ケーブル8の色を警告色(例えば黄色)に指定する。
【0023】
S8:算出された巻き付き角度αに基づき、前記演算処理装置内の描画手段によって上部アーム5の周りにケーブルを描画してステップS1へ戻る。ここで、画面上へのケーブルの描画は、図5(a)に示される実機におけるケーブル状態(矢印Pが回動状態を示す。)に対して、図5(b)に示されるように、上部アーム5’の周囲を取り囲むように円弧状に連続する点(球)の集合体10によりなされる。なお、これらの点のうち径の大きな点はケーブル8の固定位置(始点)を示しており、この始点に連続する径の小さな複数の点がケーブル8の回動角度、言い換えればケーブル8の上部アーム5への巻き付き状態を表わしている。この点の集合体10は、当然、上部アーム5が移動してもその動きに追従して常にその上部アーム5’の周りに表示されるようになっている。
【0024】
こうして、溶接ロボット1のオフライン教示を実行するオペレータは、画面9上における上部アーム5’の周りに表示された点の集合体10を見るだけで、実機におけるケーブル8の上部アーム5への巻き付き状態を容易に把握することができる。この場合、点の集合体10の色が緑色であるときには、ケーブルの破損の恐れはなく、この集合体10の色が黄色に変化すると、破損する危険性があることになり、オペレータは画面表示を見ることによってオフライン教示操作がより容易に行えることになる。
【0025】
本実施形態では、点の集合体10の色指定を緑色および黄色の2段階に設定したものを説明したが、この色指定は、巻き付き角度によって緑色、黄色、赤色の3段階に設定しても良い。また、本実施形態では、ケーブル状態を描画するのに、点の集合体を用いたものを説明したが、この描画は、帯状体や矢印表示を用いるなど他にいろいろな実施形態が可能である。また、描画を行わずに、巻き付き角度を単に数値表示するようにしても良い。
【0026】
本実施形態では、ケーブル8が上部アーム5の外周面に沿って配されるものについて説明したが、本発明は、ケーブル8が上部アーム5の内部空間を通すように配されるものに対しても適用することができる。ただし、この場合にはケーブルの巻き付き状態ではなく、ケーブルの捩り状態が問題になる。
【0027】
本実施形態においては、ケーブル8の基端部が上部アーム5の基端部上面に固定された系について説明したが、本発明は、ケーブル8の基端部が下部アーム4の基端部に固定されるものや、あるいは固定ベース2に固定されるものに対しても適用することができる。
【0028】
本実施形態では、溶接ロボットを例にして説明したが、本発明は、勿論、溶接ロボット以外の他のロボットに対しても適用できるのは言うまでもない。
【図面の簡単な説明】
【図1】図1(a)は、本発明の一実施形態に係る多関節型溶接ロボットの斜視図、図1(b)は、同溶接ロボットの各軸動作説明図である。
【図2】図2(a)(b)は、実機とオフライン教示システムとの比較を示す図である。
【図3】図3は、ケーブルの巻き付き状態の判定・表示処理のフローチャートである。
【図4】図4は、XYZ軸座標系での回転軸(a)とケーブル取付角度説明図(b)(c)である。
【図5】図5は、実機のケーブル状態(a)と画面上への描画状態(b)を示す図である。
【符号の説明】
1 溶接ロボット
2 固定ベース
3 旋回ヘッド
4 下部アーム
5 上部アーム
6 ハンド
7 溶接ガン
8 ケーブル
9 画面
10 点の集合体
【発明の属する技術分野】
本発明は、アームとそのアーム先端に装着されるハンドとを備えるロボットを画面に表示するとともに、このロボットを画面上で操作してそのロボットに所要の動作を教示するロボットオフライン教示システムにおいて、ロボットに装着されたケーブルの捩り状態もしくは巻き付き状態を表示するロボットオフライン教示システムにおけるケーブル表示装置に関するものである。
【0002】
【従来の技術】
従来、産業用ロボット(以下、単に「ロボット」という。)のハンドに溶接、塗装などのツールを把持させて、このツールを予め定めた作業線に沿って移動させて所要の作業を行うようにしたロボットシステムが知られている。この種のロボットシステムにおいて、ロボットに所要の動作データを教示する教示方法としては、CRT等の画面上でその動作をシミュレート(模擬実行)することにより、生産ラインを停止させることなくその動作実行のためのプログラムを作成する、所謂オフライン教示方法がある。すなわち、この教示方法は、実空間の実ロボットをコンピュータの仮想空間内に仮想ロボットモデルとして作成してCRT等の画面上に表示し、この画面上の仮想ロボットモデルに実ロボットの動作を模倣させることにより、実ロボットの動作確認や動作プログラムの作成を行うようにしたものである。
【0003】
ところで、通常、ロボットのハンドに把持させるツールには、ロボット本体側から延設される溶接ワイヤなどのケーブルや、ホース等(以下、単に「ケーブル」という。)の先端部が取着されていることから、前述のようなオフライン教示システムによってロボットの動作確認や動作プログラムの作成を行うに際しては、このケーブルの巻き付きや捩り状態を考慮しないと、実機において動作させた際にケーブルの送給抵抗が著しく大きくなったり、場合によってはケーブルを破損させてしまう恐れがある。
【0004】
このようなケーブルの巻き付き等をチェックすることを考慮した従来技術としては、特開平10−275007号公報に開示されたものがある。この公報に記載のロボットのシミュレーション方法では、ロボットの手首の回転軸に直交する平面に対するケーブルのアーム側固定点およびハンド側固定点の各投影点と前記平面内での回転中心とのなす角度を求め、この角度が予め設定された範囲内にあるか否かを判断することにより、ケーブルのアームへの巻き付きを検出するように構成されている。
【0005】
【発明が解決しようとする課題】
しかしながら、前記公報に記載された従来のシミュレーション方法では、ケーブルのアーム側固定点およびハンド側固定点の各投影点を求め、これら投影点に基づいてケーブルの回転角度を算出するように構成されているために、この方法は、アームに対してハンドが捩り(ツイスト)動作のみを行うタイプのロボットに対しては有効ではあるものの、この捩り(ツイスト)動作以外に、曲げ(ベンド)動作を行うタイプのロボットに対しては、この曲げ動作によってハンド側固定点の投影点が変わることになり、正確なケーブル回転角度を算出することができないという問題点がある。
【0006】
また、前記従来方法では、ケーブルの巻き付きチェック等の判定結果、言い換えれば巻き付きの有無のみをオペレータ(ユーザ)に報知するように構成されているために、オペレータはCRT等の画面上でケーブルの実際の配置状態を把握することができず、この配置状態に基づく動作プログラムの修正処理が容易に行えないという問題点がある。
【0007】
本発明は、このような問題点を解消するためになされたもので、ロボットに装着されたケーブルの捩り状態もしくは巻き付き状態を正確に検出することができ、かつそのケーブル状態を画面上で容易に把握することのできるロボットオフライン教示システムにおけるケーブル表示装置を提供することを目的とするものである。
【0008】
【課題を解決するための手段および作用・効果】
前記目的を達成するために、本発明によるロボットオフライン教示システムにおけるケーブル表示装置は、
アームとそのアーム先端に装着されるハンドとを備えるロボットを画面に表示するとともに、このロボットを画面上で操作してそのロボットに所要の動作を教示するロボットオフライン教示システムにおいて、
前記ロボットに装着されたケーブルの捩り状態もしくはそのケーブルの前記アーム周りへの巻き付き状態を検出するケーブル状態検出手段と、このケーブル状態検出手段により検出されたケーブル状態を前記画面に描画する描画手段を備えることを特徴とするものである。
【0009】
本発明においては、画面上に表示されたロボットをその画面上で操作してそのロボットに所要の動作をオフラインにて教示するに際し、アームの内部空間を通してケーブルを配線する場合におけるケーブルの捩り状態、もしくはアームの外周部を通してケーブルを配線する場合におけるケーブルの巻き付き状態が、ケーブル状態検出手段によって検出され、この検出されたケーブル状態が描画手段によって画面上に描画される。したがって、オフライン教示を実行するオペレータは、その教示操作時に画面を見るだけで、その画面を通して実際のケーブルの配線状態に近い状態を視認することができ、これに基づいて動作プログラムの修正処理等を容易に行うことができる。
【0010】
本発明において、前記ケーブル状態検出手段は、前記アームおよび/またはハンドの軸心周りの合計回転角度と、前記ケーブルの基端側および先端側の各固定部における取付角度とに基づいて前記ケーブルの捩り状態もしくは巻き付き状態を検出するものとするのが好ましい。こうすることで、アームに対してハンドが捩り動作のほかに曲げ動作を行う場合であっても、アームおよび/またはハンドの軸心周りの回転角度のみを抽出してケーブルの捩り角度が演算されるので、ハンドに装着されるツールの捩り角度を正確に得ることができ、これによってケーブルの捩り状態もしくは巻き付き状態を正確に把握することができる。
【0011】
前記各発明において、前記描画手段は、前記アームの周りに円弧状もしくは環状に連続する点の集合体または帯状体にて前記ケーブル状態を描画するものであるのが好ましい。このようにすれば、アームの位置が移動しても常にその周りにケーブルの捩りもしくは巻き付き状態を表示させることができ、利用者の利便性がより向上する。
【0012】
この場合、前記ケーブル状態検出手段は、前記ケーブルの捩り状態もしくは巻き付き状態が正常範囲を越えたことを判定する判定手段を含み、この判定手段により前記正常範囲を越えたことが判定されたときに、前記描画手段は、前記点の集合体または帯状体の色を変更することにより警告を発するようにするのが良い。こうすることで、オペレータはアームの周りに表示された点の集合体または帯状体の色の変化によって、一目瞭然にケーブルの捩り異常もしくは巻き付き異常を判断することができ、利用者の利便性が更に向上する。
【0013】
【発明の実施の形態】
次に、本発明によるロボットオフライン教示システムにおけるケーブル表示装置の具体的な実施の形態について、図面を参照しつつ説明する。
【0014】
図1(a)には、本発明の一実施形態に係る多関節型溶接ロボットの斜視図が示され、図1(b)には、同溶接ロボットの各軸動作説明図が示されている。
【0015】
本実施形態の溶接ロボット1は6軸の多関節型ロボットであって、固定ベース2上に鉛直軸周りに矢印J1方向に旋回自在に取り付けられる旋回ヘッド3と、この旋回ヘッド3の上部に左右軸周りに矢印J2方向に揺動自在に取り付けられる下部アーム4と、この下部アーム4の上部に左右軸周りに矢印J3方向に揺動自在で、かつ自身の軸心周りに矢印J4方向に捩り(ツイスト)動作可能に取り付けられる上部アーム5と、この上部アーム5の先端部に矢印J5方向に曲げ(ベンド)動作可能に、かつ自身の軸心周りに矢印J6方向に捩り(ツイスト)動作可能に取り付けられるハンド6とを備えて構成されている。
【0016】
前記ハンド6には溶接ツールとしての溶接ガン7が装着され、この溶接ガン7にケーブル8の先端部が接続されている。なお、このケーブル8の基端側は上部アーム5の基端部上面に固定されている。
【0017】
ところで、図2(b)に示されているように、前記溶接ロボット1に対してCRT等の画面9上でその動作をシミュレートさせて、この溶接ロボット1の動作プログラムの作成等を行うオフライン教示システムにおいては、通常、溶接ガン7に付設されるケーブル8は画面9上に表示されず、そのケーブル8の動きは無視されている。このため、図2(a)に示されるように、実機ではケーブル8がアーム(上部アーム5)の周りに巻き付いていてもその状態を教示してしまう場合がある。そして、このような教示がなされると、実機を実際に動作させた際にケーブル8を破損させることになってしまう。
【0018】
このような不具合を回避するために、本実施形態では、前記オフライン教示に際して、ケーブル8のアーム(本実施形態では上部アーム5)周りへの巻き付き状態を検出するとともに、そのケーブル状態を画面9上に表示するように構成したものである。以下、その巻き付き状態の判定および表示の具体的な処理内容について、図3に示されるフローチャートを参照しつつ説明する。これらの処理は本オフライン教示システム内に内蔵される演算処理装置(図示せず)によって行われる。なお、以下の説明において記号Sはステップを示す。
【0019】
本実施形態では、ケーブル8の先端部が溶接ガン7に固定されるとともに、このケーブル8の基端部が上部アーム5の基端部上面に固定された系を対象としていることから、図1(b)に示されるJ3〜J6軸のみを考慮すればいい。これらJ3〜J6軸をX,Y,Z軸座標系に変換すると、図4(a)に示されるようなX3−Y3−Z3軸、X4−Y4−Z4軸、X5−Y5−Z5軸、X6−Y6−Z6軸となり、この場合、回転軸はY3軸、X4軸、Y5軸およびX6軸の4軸となる。
【0020】
S1:前記XYZ軸座標系において、ツール部(溶接ガン7)におけるケーブル8の取り付け角度C6(図4(b)参照)を入力し、併せて固定部(上部アーム5)におけるケーブル8の取り付け角度C3(図4(c)参照)を入力する。ここで、これら角度C6,C3は、本実施形態では、Z軸からの回転角度として設定されている。
【0021】
S2〜S3:ロボットの全6軸におけるXYZ軸座標系でのロボット軸角度θ1〜θ6を取り込み、この取り込み値に基づいて溶接ロボット1を画面9上に描画する。
S4:溶接ロボット1のオフライン教示に際して、ケーブル8の上部アーム5周りへの巻き付きに係るX4軸周りの回転角度θ4およびX6軸周りの回転角度θ6、言い換えればツイスト動作を行う2軸のツイスト角度の加算値θ4+θ6を算出し、この加算値から、前記ケーブル8の先端部および基端部の取り付け角度C6を加算、C3を減算することにより、すなわち次式によってケーブル8の巻き付き角度αを算出する。
α=θ4+θ6−C3+C6
【0022】
S5:算出された巻き付き角度αの絶対値|α|が180°未満であるか否か、言い換えれば基準位置からのケーブル8の捩れ角度が左右に180°以内(合計360°以内)の範囲にあるか否かを判定する。なお、これらステップS4,S5にてなされる処理は、前記演算処理装置内のケーブル状態検出手段および判定手段によって行われる。
S6〜S7:|α|<180°を満たしている場合には、ケーブル8の画面上での色を標準色(例えば緑色)に指定する。一方、|α|≧180°となる場合には、ケーブル8の色を警告色(例えば黄色)に指定する。
【0023】
S8:算出された巻き付き角度αに基づき、前記演算処理装置内の描画手段によって上部アーム5の周りにケーブルを描画してステップS1へ戻る。ここで、画面上へのケーブルの描画は、図5(a)に示される実機におけるケーブル状態(矢印Pが回動状態を示す。)に対して、図5(b)に示されるように、上部アーム5’の周囲を取り囲むように円弧状に連続する点(球)の集合体10によりなされる。なお、これらの点のうち径の大きな点はケーブル8の固定位置(始点)を示しており、この始点に連続する径の小さな複数の点がケーブル8の回動角度、言い換えればケーブル8の上部アーム5への巻き付き状態を表わしている。この点の集合体10は、当然、上部アーム5が移動してもその動きに追従して常にその上部アーム5’の周りに表示されるようになっている。
【0024】
こうして、溶接ロボット1のオフライン教示を実行するオペレータは、画面9上における上部アーム5’の周りに表示された点の集合体10を見るだけで、実機におけるケーブル8の上部アーム5への巻き付き状態を容易に把握することができる。この場合、点の集合体10の色が緑色であるときには、ケーブルの破損の恐れはなく、この集合体10の色が黄色に変化すると、破損する危険性があることになり、オペレータは画面表示を見ることによってオフライン教示操作がより容易に行えることになる。
【0025】
本実施形態では、点の集合体10の色指定を緑色および黄色の2段階に設定したものを説明したが、この色指定は、巻き付き角度によって緑色、黄色、赤色の3段階に設定しても良い。また、本実施形態では、ケーブル状態を描画するのに、点の集合体を用いたものを説明したが、この描画は、帯状体や矢印表示を用いるなど他にいろいろな実施形態が可能である。また、描画を行わずに、巻き付き角度を単に数値表示するようにしても良い。
【0026】
本実施形態では、ケーブル8が上部アーム5の外周面に沿って配されるものについて説明したが、本発明は、ケーブル8が上部アーム5の内部空間を通すように配されるものに対しても適用することができる。ただし、この場合にはケーブルの巻き付き状態ではなく、ケーブルの捩り状態が問題になる。
【0027】
本実施形態においては、ケーブル8の基端部が上部アーム5の基端部上面に固定された系について説明したが、本発明は、ケーブル8の基端部が下部アーム4の基端部に固定されるものや、あるいは固定ベース2に固定されるものに対しても適用することができる。
【0028】
本実施形態では、溶接ロボットを例にして説明したが、本発明は、勿論、溶接ロボット以外の他のロボットに対しても適用できるのは言うまでもない。
【図面の簡単な説明】
【図1】図1(a)は、本発明の一実施形態に係る多関節型溶接ロボットの斜視図、図1(b)は、同溶接ロボットの各軸動作説明図である。
【図2】図2(a)(b)は、実機とオフライン教示システムとの比較を示す図である。
【図3】図3は、ケーブルの巻き付き状態の判定・表示処理のフローチャートである。
【図4】図4は、XYZ軸座標系での回転軸(a)とケーブル取付角度説明図(b)(c)である。
【図5】図5は、実機のケーブル状態(a)と画面上への描画状態(b)を示す図である。
【符号の説明】
1 溶接ロボット
2 固定ベース
3 旋回ヘッド
4 下部アーム
5 上部アーム
6 ハンド
7 溶接ガン
8 ケーブル
9 画面
10 点の集合体
Claims (4)
- アームとそのアーム先端に装着されるハンドとを備えるロボットを画面に表示するとともに、このロボットを画面上で操作してそのロボットに所要の動作を教示するロボットオフライン教示システムにおいて、
前記ロボットに装着されたケーブルの捩り状態もしくはそのケーブルの前記アーム周りへの巻き付き状態を検出するケーブル状態検出手段と、このケーブル状態検出手段により検出されたケーブル状態を前記画面に描画する描画手段を備えることを特徴とするロボットオフライン教示システムにおけるケーブル表示装置。 - 前記ケーブル状態検出手段は、前記アームおよび/またはハンドの軸心周りの合計回転角度と、前記ケーブルの基端側および先端側の各固定部における取付角度とに基づいて前記ケーブルの捩り状態もしくは巻き付き状態を検出するものである請求項1に記載のロボットオフライン教示システムにおけるケーブル表示装置。
- 前記描画手段は、前記アームの周りに円弧状もしくは環状に連続する点の集合体または帯状体にて前記ケーブル状態を描画するものである請求項1または2に記載のロボットオフライン教示システムにおけるケーブル表示装置。
- 前記ケーブル状態検出手段は、前記ケーブルの捩り状態もしくは巻き付き状態が正常範囲を越えたことを判定する判定手段を含み、この判定手段により前記正常範囲を越えたことが判定されたときに、前記描画手段は、前記点の集合体または帯状体の色を変更することにより警告を発する請求項3に記載のロボットオフライン教示システムにおけるケーブル表示装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002240968A JP2004074368A (ja) | 2002-08-21 | 2002-08-21 | ロボットオフライン教示システムにおけるケーブル表示装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002240968A JP2004074368A (ja) | 2002-08-21 | 2002-08-21 | ロボットオフライン教示システムにおけるケーブル表示装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2004074368A true JP2004074368A (ja) | 2004-03-11 |
Family
ID=32023599
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2002240968A Pending JP2004074368A (ja) | 2002-08-21 | 2002-08-21 | ロボットオフライン教示システムにおけるケーブル表示装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2004074368A (ja) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105583823A (zh) * | 2014-11-06 | 2016-05-18 | 发那科株式会社 | 机器人模拟装置 |
WO2016199200A1 (ja) * | 2015-06-08 | 2016-12-15 | 三菱電機株式会社 | 多回転軸表示装置および多回転軸表示方法 |
CN106404561A (zh) * | 2016-12-14 | 2017-02-15 | 大连德昌线缆有限公司 | 仿机器人手臂扭转试验机 |
CN111086017A (zh) * | 2018-10-24 | 2020-05-01 | 发那科株式会社 | 机器人*** |
JP2020075353A (ja) * | 2018-10-24 | 2020-05-21 | ファナック株式会社 | ロボットシステム |
CN112008716A (zh) * | 2019-05-31 | 2020-12-01 | 发那科株式会社 | 学习线缆的状态的机器学习装置、机器人***以及机器学习方法 |
KR20220142934A (ko) | 2021-04-15 | 2022-10-24 | 가부시키가이샤 고베 세이코쇼 | 다관절 로봇의 선형상 부재 형상 시뮬레이터, 해당 방법 및 해당 프로그램 |
JP7495500B2 (ja) | 2020-07-10 | 2024-06-04 | ファナック株式会社 | レーザ加工のための教示装置及び教示方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01237703A (ja) * | 1988-03-18 | 1989-09-22 | Hitachi Ltd | ロボツト教示装置 |
JPH07182017A (ja) * | 1993-12-24 | 1995-07-21 | Nissan Motor Co Ltd | 線条材のシミュレーション方法 |
JPH10275007A (ja) * | 1997-03-31 | 1998-10-13 | Nissan Motor Co Ltd | ロボット動作シミュレーション方法 |
JPH1199493A (ja) * | 1997-09-30 | 1999-04-13 | Tokico Ltd | 工業用ロボット |
-
2002
- 2002-08-21 JP JP2002240968A patent/JP2004074368A/ja active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01237703A (ja) * | 1988-03-18 | 1989-09-22 | Hitachi Ltd | ロボツト教示装置 |
JPH07182017A (ja) * | 1993-12-24 | 1995-07-21 | Nissan Motor Co Ltd | 線条材のシミュレーション方法 |
JPH10275007A (ja) * | 1997-03-31 | 1998-10-13 | Nissan Motor Co Ltd | ロボット動作シミュレーション方法 |
JPH1199493A (ja) * | 1997-09-30 | 1999-04-13 | Tokico Ltd | 工業用ロボット |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105583823A (zh) * | 2014-11-06 | 2016-05-18 | 发那科株式会社 | 机器人模拟装置 |
JP2016087750A (ja) * | 2014-11-06 | 2016-05-23 | ファナック株式会社 | ロボットシミュレーション装置 |
US10216874B2 (en) | 2014-11-06 | 2019-02-26 | Fanuc Corporation | Robot simulation device |
WO2016199200A1 (ja) * | 2015-06-08 | 2016-12-15 | 三菱電機株式会社 | 多回転軸表示装置および多回転軸表示方法 |
CN106404561A (zh) * | 2016-12-14 | 2017-02-15 | 大连德昌线缆有限公司 | 仿机器人手臂扭转试验机 |
CN111086017A (zh) * | 2018-10-24 | 2020-05-01 | 发那科株式会社 | 机器人*** |
JP2020075353A (ja) * | 2018-10-24 | 2020-05-21 | ファナック株式会社 | ロボットシステム |
CN112008716A (zh) * | 2019-05-31 | 2020-12-01 | 发那科株式会社 | 学习线缆的状态的机器学习装置、机器人***以及机器学习方法 |
JP2020196077A (ja) * | 2019-05-31 | 2020-12-10 | ファナック株式会社 | ケーブルの状態を学習する機械学習装置、ロボットシステム、及び機械学習方法 |
JP7260402B2 (ja) | 2019-05-31 | 2023-04-18 | ファナック株式会社 | ケーブルの状態を学習する機械学習装置、ロボットシステム、及び機械学習方法 |
JP7495500B2 (ja) | 2020-07-10 | 2024-06-04 | ファナック株式会社 | レーザ加工のための教示装置及び教示方法 |
KR20220142934A (ko) | 2021-04-15 | 2022-10-24 | 가부시키가이샤 고베 세이코쇼 | 다관절 로봇의 선형상 부재 형상 시뮬레이터, 해당 방법 및 해당 프로그램 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8532819B2 (en) | Manipulator with camera | |
CN111093903B (zh) | 机器人***及其运行方法 | |
JP6680752B2 (ja) | ロボットの速度を制限する制御装置 | |
JP5701055B2 (ja) | 7軸多関節ロボットの制御方法、制御プログラム及びロボット制御装置 | |
US9067321B2 (en) | System and method for visualization of process errors | |
CN109620410A (zh) | 机械臂防碰撞的方法及***、医疗机器人 | |
JP7155664B2 (ja) | シミュレーション装置、制御装置およびロボット | |
JP2004074368A (ja) | ロボットオフライン教示システムにおけるケーブル表示装置 | |
US20200156258A1 (en) | Robot system and method for operating same | |
US20220176555A1 (en) | Non-transitory computer-readable storage medium and teaching method for robot | |
JP2012192518A (ja) | 冗長関節部を有する冗長ロボットの制御装置および制御方法 | |
JP7260402B2 (ja) | ケーブルの状態を学習する機械学習装置、ロボットシステム、及び機械学習方法 | |
JPWO2019171516A1 (ja) | 垂直多関節ロボットの慣性パラメータ同定システム及び慣性パラメータ同定方法並びに垂直多関節ロボットの制御装置及び制御方法 | |
JP2006297405A (ja) | 曲げ加工シミュレーション装置 | |
CN112043396B (zh) | 手术机器人及其图形化控制装置、图形化显示方法 | |
JP3671694B2 (ja) | ロボットのティーチング方法およびその装置 | |
JP6836638B2 (ja) | ロボットシステム | |
JP2019063879A (ja) | シミュレーション装置、ロボット制御装置およびロボット | |
JP3357392B2 (ja) | ロボットのツール干渉防止装置 | |
JP4613752B2 (ja) | ロボットおよびロボットの情報表示方法 | |
JP2000039911A (ja) | ロボット制御装置 | |
WO2022157878A1 (ja) | 動作軌道の評価装置、動作軌道の評価方法 | |
JP2005293331A (ja) | ロボット付加非剛体物のシミュレーション方法およびロボット付加非剛体物の状態診断方法 | |
JPH1199493A (ja) | 工業用ロボット | |
WO2023238268A1 (ja) | ロボットの制御方法およびロボットシステム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20050606 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20061204 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20070109 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20070612 |