ロボットシステム
【課題】ロボットにはロボットの最大動作領域を全て含む安全防護柵（安全柵）が必要であるため、稼動範囲が狭くても広い領域の柵が必要となり柔軟な設備構築に支障がある。
【解決手段】ロボットの動作領域の監視をロボットの制御部と独立して設けることで制御部の異常（ノイズ、バグなど）においても確実にロボットの動作範囲の監視を行うことができ、また、独立が故にロボットの制御部の改良、改善を行っても動作領域の監視を行う機能に影響がないロボットシステムを提供することができる。
【解決手段】ロボットの動作領域の監視をロボットの制御部と独立して設けることで制御部の異常（ノイズ、バグなど）においても確実にロボットの動作範囲の監視を行うことができ、また、独立が故にロボットの制御部の改良、改善を行っても動作領域の監視を行う機能に影響がないロボットシステムを提供することができる。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、ロボットの動作範囲を多重監視し、確実に制限するロボット制御装置に関する。
【背景技術】
【０００２】
ロボットの可動範囲の制限を少なくして動作範囲を大きくすることは、ロボットを適用した設備への柔軟性が高くなるため、その可動範囲を広く大きくする努力が各ロボット製造メーカで行なわれ、実施されている。しかし、ロボットの可動範囲を拡大化すると、作業者の操作の誤りや外来の電気ノイズ等のために誤動作すると、ロボットの周辺の作業者への干渉や接触等で作業者に障害を与えるような危険な状態となることが考えられる。また、ロボットの周辺機器への干渉や衝突などでロボット本体又は周辺機器の破損を招くことも考えられる。
そのため、特に作業者を危険に曝さないために、ロボットの稼動中では、ロボットの可動範囲を含む領域を安全防護柵で囲い、作業者の故意又は過失でロボットの可動範囲に入らないような立ち入り制限を行なっている。また、ロボットの動作手順の教示中ではロボットの動作速度の制限や、操作しているときだけロボットが動作することができるイネーブル装置が備わる教示装置を備え、作業者が危険に曝される機会の削減が各規格で要請され、また実施されている。
【０００３】
図６は、一般的なロボットの動作する領域を説明する図である。図において、ロボットの可動部分によって掃引することができる、製造業者によって定められた領域に、エンドエフェクタ１１０及びワークによって掃引することができる領域を加えたものが最大領域１１２である。また、最大領域の一部で、ロボットシステムにどんな故障・誤動作が生じても越えることがない限界を設定するリミット装置（機構的な動作制限装置など）によって制限されたものが制限領域１１１である。また、最大領域１１２を含む安全防護装置１１４（安全防護柵など）によって、囲まれた領域を安全防護領域１１３という。（最大領域１１２、制限領域１１１及び安全防護領域１１３の各用語定義はＪＩＳ Ｂ８４３３−１９９３より抜粋。）
安全防護領域１１３を安全防護装置１１４（安全防護柵）などで囲い、ロボット１０１が稼動中には作業者がロボットの近傍に接近できなくすることと、教示中では作業者がロボットに接近するため、イネーブル装置が作動している時だけロボットの動作が許可され、かつ、誤動作など作業者の意図しないロボットの動作が生じても、作業者がイネーブル装置を非作動ととしてロボットの動作を停止する又は危険回避行動をとることのできる安全運転速度以下で動作するようになっている。
【０００４】
ロボットは、予め教示設定したプログラム（作業プログラム）に従ってロボットを動かすための軌道計算を行い、この計算に基づき動作予測位置（先読み位置）を算出し、ロボットが駆動制御されるものである。このような、ロボットの軌道計算及び動作の構成では、軌道計算及び動作予測位置計算の間違い（制御プログラムのバグ）や、作業プログラムが格納されるメモリの不良及び計算が行なわれるＣＰＵ等の演算装置の不良（製造不良）また、電気機器及び電気素子の偶発故障では、作業者に対する安全のために、例えば電源投入時又は定期的に自己診断を行ない、異常が検出されると即時ロボットの動作を停止するようにしている。また、ＣＰＵ等の半導体素子の不良（設計不良：エラッタ）並びにＣＰＵの制御プログラム作成時に利用されるコンパイラなどの制御プログラム開発環境の不良（開発用プログラムのバグ）に対しては、開発時に各種試験を実施し、可能の限りの間違いを排除しているが全ての場合についての試験（カバレッジ率１００％）は不可能である。よって、間違いや異常を検出する診断のタイミングによっては、ロボットがこれらを原因として異常な動作をする可能性を否定することは出来ない。
また、作業者により教示設定される作業プログラムの間違いによるロボットの動作では、これを間違いとして検出又は回避することは困難である。
【０００５】
以下に、ロボットの可動範囲を作業に必要とする領域（稼動範囲又は最大動作範囲）に制限しつつ、作業者の保護について説明する。
ロボットの稼動範囲を制限するものとして、複数の光電センサを利用して、検出信号に基づいてロボットの可動範囲を部分的に制限を行なう制御装置を備え、ロボットの設置スペースに合わせて可動範囲を任意に変更することができるロボットの可動範囲制限装置が提案されている（例えば、特許文献１）。
しかし、この提案では光電センサを使用しているため、設備設置時には動作領域を分割するために光軸調整が必要となり、使用中に光学系のズレが起こらないような確実な設置が必要とされ、また定期的に光学系の確認が必要となると共に、粉塵及びオイルミストの多い製品の生産工場雰囲気では、発行部及び受光部のレンズ等の集光器が汚れるための、定期的な清掃等の保守が必要となる。このように、光を利用する検出器はクリーンルームなどの特殊な環境以外には適していない。
【０００６】
光学系検出器ような定期的な保守点検の負荷を軽減するものとして、ロボットの可動範囲を制限する仮想安全柵を制御装置のメモリーに定義し、ツールを含むロボットの動作予測位置が該仮想安全柵を越えると判定されるとロボットアームの移動を停止制御するロボット動作規制装置が提案されている（例えば、特許文献２）。
また、特許文献２の動作予測位置の代りにロボットの各軸毎の位置を検出し、該検出した位置データが動作可能範囲にあるかを判定し、動作範囲より外れていると判定されるとロボットの動作を停止させるか警報を発するロボットの暴走防止装置の提案もある（例えば、特許文献３）。
【０００７】
ロボットの制御を行なうＣＰＵの他にロボットの状態を常に監視するＣＰＵを設け、特許文献２又は特許文献３で行なう動作可能範囲の監視を、この監視用ＣＰＵで行ない、ロボット制御ＣＰＵ及び監視用ＣＰＵの相互間で必要最低限の通信を行ない、異常が検出されるとロボットを停止させることが行なわれている（例えば、特許文献４）。このような構成では、ロボット制御ＣＰＵと監視用ＣＰＵの双方でロボット及び他方のＣＰＵの監視をすることができるので、ロボットの状態を、単一の部品故障などの発生があってもロボットを停止する安全方向にすることができるようになっている。
【０００８】
従来のロボット制御装置は、特許文献１乃至３の構成で、動作制限をより確かなものとする努力がなされている。しかし、ロボットの一般的設計要求事項として、「すべての構成要素（電気、電子、機械、空気圧及び油圧）の中でいずれか１個の部品が予測可能な範囲で故障しても、安全機能を影響を受けず、また、影響を受けた場合でもロボットシステムは安全な状態に保たれるように、ロボットシステムを設計、製作及び据付けすること」（日本工業規格Ｂ８４３−１９９３より抜粋）が要請されている。この要請に応えるために、構成要素の偶発故障及び不良（製造不良、動作不良、エラッタ等）並びに制御プログラム開発環境に潜む不良及び間違いを可能な限り排除しなければならない問題に対し、複数個所で監視を行なうことでこれらの問題を解決している。
【０００９】
【特許文献１】特開２０００−６０８３号公報
【特許文献２】特開２００４−３２２２４４号公報
【特許文献３】特開昭６３−１０２８９２号公報
【特許文献４】特開昭６０−２５６９３号公報
【発明の開示】
【発明が解決しようとする課題】
【００１０】
図７は、設置されたロボットの動作領域を説明する図である。ロボット１０１は、ペンダント１０３から作業者によって稼動前に作業プログラムが作られ、ロボット制御装置１０２に記憶されている。作業プログラムは、ロボット１０１の手首部に装着された作業ツール１０４でワーク１０５に対して所定の作業を行なうようになっている。このようにワーク１０５形状が小型であれば、ロボット１０１がワーク１０５に対する作業のときにロボット１０１の動作領域１０６は、ロボット１０１の最大領域内に納まり、動作領域１０６を安全防護柵で囲うことで、ロボット１０１の稼動中に作業者がロボット１０１の動作領域１０６内に立ち入ることを制限して作業者の安全を確保している。しかし、外来の電気的ノイズやロボット又はロボット制御装置の部品の故障によって動作領域１０６を越えて動作してしまうことが考えられる。
【００１１】
ロボットを導入する顧客及びロボットの供給者としては、ロボットを安心して使用することができるように、ロボットの安全性の証明手段として、第三者機関による認証を取得するものもある。この認証は取得には長期間を要し、また、例えば制御プログラムの改正やハードウェアの改良の度にも認証の更新に係る手続が面倒で、機能の確認等のための時間も要するので、早急な改版、改良が困難である問題がある。
本発明はこのような問題点に鑑みてなされたものであり、構成要素の偶発故障及び不良（製造不良、動作不良、エラッタ等）並びに制御プログラム開発環境に潜む不良及び間違いを可能な限り排除するとともに第三者機関による認証を更新に係る手間と時間を削減することができるロボット制御装置を提供することを目的とする。
【課題を解決するための手段】
【００１２】
上記問題を解決するため、本発明は、次のように構成したのである。
請求項１に記載の発明は、回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットの制御点が、予め設定された前記ロボットの動作領域からの逸脱を検出すると前記ロボットの動作を禁止する手段を備えたロボット制御装置を備えるロボットシステムにおいて、 前記エンコーダからの位置信号が接続され、前記ロボットの動作領域に基づいて予め設定された動作領域データと前記ロボットの各軸の位置を検出するエンコーダからの位置データに基づいて算出する前記ロボットの制御点の現在位置とを比較し、前記現在位置が前記ロボットの動作領域の逸脱を検出すると、前記ロボットの動作を禁止する位置監視部を備えたことを特徴とするものである。
また、請求項２に記載の発明は、前記ロボットの動作の禁止は、前記ロボットの駆動電源を遮断することを特徴とするものである。
【００１３】
また、請求項３に記載の発明は、回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットの制御点が、予め設定された前記ロボットの動作領域からの逸脱を検出すると前記ロボットの動作を禁止する手段を備えたロボット制御装置を備えるロボットシステムにおいて、前記ロボット制御装置は、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの制御点の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの制御点の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするものである。
【００１４】
また、請求項４に記載の発明は、回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットであって、前記ロボットは、設置された基部と、前記基部に回動自在に設けられモータで駆動する第１関節と、第１関節に取り付けられた第１アームと、前記第１アームの端部に回動自在に設けられモータで駆動する第２関節と、前記第２関節に垂直に取り付けられた第２アームと、前記第２アームの端部に回動自在に設けられモータで駆動する第３関節と、前記第３関節に取り付けられた第３アームと、前記第３アームの端部に取り付けられた２つ以上の関節からなり、前記ロボットを制御するロボット制御装置を備えるロボットシステムにおいて、前記ロボット制御装置は、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第３関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第３関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするものである。
【００１５】
また、請求項５に記載の発明は、回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットであって、前記ロボットは、設置された基部と、前記基部に回動自在に設けられモータで駆動する第１関節と、第１関節に取り付けられた第１アームと、前記第１アームの端部に回動自在に設けられモータで駆動する第２関節と、前記第２関節に垂直に取り付けられた第２アームと、前記第２アームの端部に回動自在に設けられモータで駆動する第３関節と、前記第３関節に取り付けられた第３アームと、前記第３アームの端部に取り付けられた２つ以上の関節からなり、前記ロボットを制御するロボット制御装置を備えるロボットシステムにおいて、前記ロボット制御装置は、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第４関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第４関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするものである。
【００１６】
また、請求項６に記載の発明は、前記第１監視部が駆動する前記第１遮断手段又は前記第２監視部が駆動する第２遮断手段は電磁接触器であることを特徴とするものである。
また、請求項７に記載の発明は、前記第１監視部又は前記第２監視部が駆動する前記電磁接触器は、少なくとも２つの常開主接点と少なくとも１つの常閉補助接点とを備え、前記電磁接触を駆動して前記常開主接点を閉路するときは、該常閉補助接点が閉路していることが検出された後であることを特徴とするものである。
また、請求項８に記載の発明は、前記第１監視手段又は前記第２監視手段はＣＰＵを備え、前記ＣＰＵは、エンコーダ選択信号を出力し、前記ロボットの複数の前記エンコーダからの位置信号を選択して該当する前記位置データを取得し、前記エンコーダ選択信号を切換え、前記ロボットに備わる複数のエンコーダの位置データを取得し、前記ロボットの制御点の現在位置を求めることを特徴とするものである。
【００１７】
また、請求項９に記載の発明は、前記第１監視手段及び前記第２監視手段は各々ＣＰＵを備え、前記第１監視装置に備わるＣＰＵと前記第２監視装置に備わるＣＰＵとは、異なるアーキテクチャのＣＰＵであることを特徴とするものである。
また、請求項１０に記載の発明は、前記ロボット制御装置は表示手段を備え、前記第１監視手段及び前記第２監視手段は、各々の状態を前記ロボット制御装置に出力し、前記ロボット制御装置は前記第１監視手段又は前記第２監視手段の状態を前記表示手段に表示することを特徴とするものである。
また、請求項１１に記載の発明は、前記第１監視手段は、第１動作領域監視手段を無効化又は第１遮断手段を接続状態とする無効入力を備え、前記第２監視手段第２動作領域監視手段を無効化又は第２遮断手段を接続状態とする無効入力を備えることを特徴とするものである。
【発明の効果】
【００１８】
請求項１乃至６に記載の発明によると、ロボットの制御とは独立した２つの監視部でロボットの制御点の監視を行ない、ロボットが動作領域を逸脱すると電磁接触器を開路して駆動部への電源供給を遮断するので、ロボットの制御上の問題でロボットが誤動作や暴走などで動作範囲を逸脱することを確実に検出し、その時には駆動電源を遮断し停止することができる。特に請求項４及び５に記載の発明では、垂直多関節ロボットにおいて、ロボットの姿勢により、最も動作領域が広い場合として第３関節又は第４関節となることがある。このような場合に、最も動作領域の広い部位が動作領域から逸脱すれば、ロボットの動作を禁止する。
また、請求項７に記載の発明によると、駆動部への電源供給をおこなう電磁接触器の接点が溶着していれば、動作範囲を逸脱していなくても電磁接触器接点の閉路をおこなわないので、接点溶着を検出することができる。
また、請求項８に記載の発明によると、ロボットの位置を検出する複数のエンコーダに対し、位置信号を順じスキャンして位置データを取得するようになっているので、位置信号を位置データへの変換する回路又は素子の数を削減でき、位置監視部の形状の縮小化ができ、またコストダウンもできる。
また、請求項９に記載の発明によると、２つの監視部に備わるＣＰＵのアーキテクチャが異なるので、ＣＰＵに固有のエラッタや制御プログラム開発装置の誤りが両監視部に入り込む事がなくなるので、位置監視の確実性が向上する。
また、請求項１０に記載の発明によると、監視部で検出した状態をロボット制御装置に接続されたペンダントに備わる表示手段に表示することができるので、ロボットが動作領域を逸脱した時の原因究明を支援することができ、原因解決までの時間の短縮に貢献することができる。
また、請求項１１に記載の発明によると、何らかの原因でロボットが動作領域を逸脱しても、無効入力へ入信している間は駆動電源を投入することができるので、ロボット制御部及び駆動部でロボットを正規の位置（動作領域内）に戻すことができる。
【発明を実施するための最良の形態】
【００１９】
以下、本発明の実施の形態について図を参照して説明する。
【実施例１】
【００２０】
図１は、本発明を適用したロボットシステムのブロック図である。図において、１はロボットであり、複数のモータ１０とエンコーダ１１の組みで、複数の関節を駆動しアームを動作させ、作業ツール１０４を目的の位置に動作させる（図では１組のみを記載している）。３はペンダントであり、教示のときには作業者が操作することでロボット１を目的の位置に動作させ位置の登録を行ない、ワーク１０５に対する作業プログラムを登録又は編集を行なう。また、ロボットの機構情報の入力や動作範囲１０６の設定を行なう。また、ペンダント３は図示しない表示器を備え、作業プログラムのリスト表示、機構情報である機構部データの表示、動作領域データの表示、異常表示その他のロボットの設置時に必要なデータの表示やロボットの状態表示を行なう。２はロボット制御装置であり、ロボット動作の制御を行なう制御部２０、制御部２０によって求められたモータ１０の動作司令に基づきモータ１０を駆動する駆動部２１、作業プログラム、機構部データ、動作領域データその他のロボット制御に必要な諸データまたはプログラムが格納される記憶部２２を主な要素として構成されている。本発明では、位置監視部２３が備わっている。
【００２１】
ロボット１０を動作するための駆動電源は、商用の電源２５から、制御部２０で開閉制御される電磁接触器２４−１及び位置監視部２３で開閉制御される電磁接触器２４−２、２４−３の各接点が直列接続され、駆動部２１へ接続されている。すなわち、制御部２０及び位置監視部２３の双方がロボット１０の動作を許可するときに電磁接触器２４−１、２４−２、２４−３の接点が閉じ、駆動部２３へ電源２５が供給され、ロボット１０の動作が許可されないときには、いずれかの電磁接触器２４−１、２４−２、２４−３の接点が開路して駆動部２３への電源供給が遮断されるようになっている。尚、電源２５と駆動部２３との間には電磁接触器２４−１、２４−２、２４−３の接点以外に、例えば非常停止の接点やその他のロボットの動作を禁止する要因となる接点が挿入されるが、本図では省略している。
【００２２】
制御部２０と位置監視部２３とはシリアル通信等の情報伝達路で接続されているが、機構部データ、動作領域データを位置監視部２３への設定と位置監視部２３の状態及び異常情報を制御部２０へ伝えることで、設備導入時及び異常時の復旧を速やかに行なうための情報伝達を目的としていて、ロボット１０の通常の稼動時（作業プログラムの再生時）にはロボットの動作制御に関する情報伝達の必要性はないようになっている。
【００２３】
図２は位置監視部２３のブロック図である。図において、３１は第１監視部、４１は第２監視部である。第１監視部３１と第２監視部４１とは同様の構成であるため第１監視部について説明する。尚、第１監視部３１と第２監視部４１とは異なるアーキテクチャのＣＰＵを採用することで、ＣＰＵのエラッタや制御プログラム開発装置の不具合（コンパイラのバグ等）を、双方の監視部の同一個所に入り込む機会をなくし、相互に独立して監視を行なうようにしている。また、第１監視部３１と第２監視部４１の各々は電磁接触器２４−２と２４−３の操作コイルを駆動するようになっている。
【００２４】
ロボット１０の各関節はモータ１０に備わるエンコーダ１１からの複数軸の位置信号は、駆動部２１に入力されサーボ制御されると共に、位置制御部２３へ並列接続されていて、第１監視部及び第２監視部にさらに並列分岐して入力される。
第１監視部３１に入力された複数のエンコーダ１１からの位置信号は、レシーバ３２を介してＣＰＵ３３に読み込まれる。ＣＰＵ３３は記憶部３４に記憶されているロボット１の機構部データ３７に基づいて、エンコーダ１１〜入力されるロボット１の各関節の位置データからロボット１の座標系の位置データへ順変換３５を行なう。この順変換でロボット１の制御点の座標系での位置データが求められる。
尚、制御点とは、作業ツールが取り付けられるエンドエフェクタの代表点（図５参照）又は取り付けられた作業ツーツの代表点（例えば、アーク溶接ではエンドエフェクタに取り付けられた溶接トーチのワイヤ先端（作業点））をいう。
尚、本図のレシーバ３２は、エンコーダからの位置信号を受け、位置データとしてカウンタ又はレジスタ等への一時格納を行なうインターフェース回路又は素子であるが、位置信号を受けるインターフェース回路又は素子とし、各軸の位置データをＣＰＵ３３で取得する構成であってもよい。
【００２５】
求められた座標系の位置データは、記憶部３４に記憶されている動作領域データ３８と比較され、位置データが動作領域データの内部であるなら電磁接触器２４−２の操作コイルを駆動して接点を閉路し、動作領域データの外部であるなら接点を開路する。
図３は、電磁接触器２４−２の駆動回路図である。電磁接触器は、操作コイル２４−５へ電流の通流と遮断を行なうことで、２つの常開主接点２４−６の開路／閉路と１つの常閉補助接点２４−７の閉路／開路が連動して動作する。第１監視部３１のＣＰＵ３３は、位置データが動作領域データの外部であると判断すると、出力インターフェース４０−１を介して操作コイル２４−５への通電を遮断し、主接点２４−６を開路する。主接点２４−６が開路している状態から、位置データが動作領域データの内部であると判断すると、出力インターフェース４０−１を介して操作コイル２４−５への通電を行ない、主接点２４−６の閉路と補助接点２４−７の開路を行うが、操作コイル２４−５への通電の前に補助接点２４−７の状態を入力インターフェース４０−２を介して読み込み、閉路していることを確認する。この補助接点２４−７の状態確認は、主接点２４−６に接点溶着が発生していないことの確認に相当する。
【００２６】
ロボットが稼動中に、何らかの原因でロボットが動作領域１０６から逸脱してしまったときのために、第１監視部は無効入力３９を備えている。この無効入力がアクティブになると、第１監視部は動作領域の監視を無効とし主接点２４−６を閉路とする又は監視を行っていても電磁接触器２４−２の主接点２４−６を閉路するようになっている。すなわち、ロボットが動作領域１０６から逸脱した位置から動作領域１０６の内部の位置に、ペンダントの操作で動作させるときに、この無効入力３９をアクティブとすると、動作領域１０６を逸脱していてもロボットの駆動電源を投入することができるようになっている。この無効入力３９は、例えばモーメンタリ型のスイッチで入力される。無効入力は制御部２０からの情報伝達路で状態を伝えられていてもかまわない。
【００２７】
第２監視部４１は、第１監視部３１と構成は同じであるため詳細な説明は省略する。
尚、動作領域データは、例えばロボット座標系の上で直方体を形成する。すなわち、Ｘ、Ｙ及びＺの各軸に対し各々最大値と最小値を予め情報伝達路を介して設定しておく。現在位置がＸ、Ｙ及びＺの各軸で最大値と最小値の間であれば動作領域の内部であると判定し、最大値と最小値の間から出ればロボットの動作領域を逸脱と判定する。
【００２８】
このようにロボット制御装置２の位置制御部２３は制御部２０及び駆動部２１から独立してロボットの位置を監視し、予め設定された動作領域１０６から逸脱すると、電磁接触器２４−２、２４−３の接点を開路して駆動部２１への電源を遮断することでロボット１の動作を禁止する。そして、この時の状態データを制御部２０に送り、制御部ではペンダント３に備わる図示しない表示器に状態データを適宜表示、又は図示しない出力部からロボット制御装置２の外部に出力することで、異常となった原因究明や保守作業に供する。
【００２９】
ロボット制御装置２では、制御部２０でロボット１の制御点の動作軌道を制御周期毎に求め、ロボット１を該動作軌道に沿って動作制御を行なっているが、求めた動作軌道が動作領域１０６の範囲内であることの確認が行なわれているため、例えば、記憶部２２の誤動作や故障で記憶されている作業プログラムの一部データに障害があるときには、この段階でロボット１の動作前に動作領域１０６の逸脱を検出することができ、電磁接触器２４−１の接点を開路する等でロボット１を動作禁止とすることができる。
【００３０】
このような構成であるため、特許文献２乃至４とは大きく異なり、制御部２０並びに位置監視部２３の第１監視部３１及び第２監視部４１で、ロボットの動作領域を３重に監視し確実に制限することができる。そして、位置監視部２３は制御部２０から独立しているのでロボットの動作制御に影響されずに位置監視を行うことができるので、確実なロボットの動作領域逸脱監視を行うことができる。そのため、特に、小型のワークへの作業等でロボットの動作領域が狭いときに、動作領域に見合う安全防護柵の設置を行なうことができ、また、例えば安全防護柵に代えてロープなどで動作領域を明示することも可能である。
【００３１】
位置監視部２３は制御部２０及び駆動部２１とは独立して位置監視を行なうため、第三者機関による認証を取得後に、制御部２０又は駆動部２１の改良事項があっても、位置監視部２３に影響しないので、認証の更新が不要となる。
【実施例２】
【００３２】
図４は第２実施例の第１監視部の構成を示す図である。図において、５１は第１監視部であって、図２の第１監視部３１に代わるものである。複数のエンコーダ１１からの位置信号は、第１監視部５１に導かれ、セレクタ５２に入力される。ＣＰＵ３３はセレクタにエンコーダ選択信号５３を出力して、複数のエンコーダ１１からの位置信号から１軸を選択してレシーバ３２に出力される。レシーバ３２は、選択されたエンコーダ１１の位置信号を入力して、該当する軸の位置データとし、ＣＰＵはこの位置データを取得し、次の軸のエンコーダ１１からの位置データを得るためにエンコーダ選択信号５３を歩進する。
この様にして、ロボット１の全軸の位置データを取得の後、ロボット１の座標系の位置データへ順変換３５を行なう。この順変換でロボット１の制御点の座標系での位置データが求められ、求められた座標系の位置データは、記憶部３４に記憶されている動作領域データ３８と比較され、位置データが動作領域データの内部であるなら電磁接触器２４−２の操作コイルを駆動して接点を閉路し、動作領域データの外部であるなら接点を開路する。
【００３３】
第２監視部も同様であるので、図示及び説明は省いている。尚、第２監視部の構成は第２実施例の構成に限定するものではなく、第１実施例の構成であってもかまわない。
尚、第２実施例の構成では、レシーバ３２では単軸単位で位置を得るために、このエンコーダ信号はエンコーダ１１からシリアル通信で送られるものである。
また、各々の軸についての位置データの取得タイミングが異なるが、位置データの取得が例えば１００マイクロ秒の違いは、ロボットの最大速度を２メートル／秒と仮定してもロボットの制御点で０．２ミリメートル程度の差異であるので、実質上問題とはならない。
【００３４】
このように、各々の軸の位置データを順じ取得するような構成をしているので、ロボットの制御点位置計算では実質上問題とならない範囲で、レシーバの数を削減することができるので、監視部形状の小型化の効果を奏し、更にはコストダウンの効果も期待することができる。
【実施例３】
【００３５】
図５は第３実施例の垂直多関節型のロボット２００の構成図である。図において、
ロボットアームは、水平面内で回転（旋回）する第１関節２０１と、この第１関節に接続された第１アーム２０２と、第１アーム２０２の端部に第２関節２０３が取り付けられている。
第２関節２０３に接続された第２アーム２０４と、第２アーム２０４の端部に第３関節２０５が取り付けられている。第３アーム２０６の端部には第４関節２０７を介して手首部２０８が取り付けられている。
このとき、水平面をＸＹ平面とし、上空方向を＋Ｚ方向とすると、第３アーム２０５は、ロボットの姿勢、動作によっては、この第３アーム２０５の端部が、もっとも動作領域が広い場合がある。
つまり、第３関節２０５または第４関節２０７の現在位置と動作領域を比較する必要がある。
第３関節２０５または第４関節２０７の現在位置は、順変換から求めることは可能であるので、詳述はしない。また、制御点２０９の位置から第４関節２０７または第３関節２０５までの逆変換によって求めることも可能である。
【産業上の利用可能性】
【００３６】
ロボットの制御とは独立して行なうようになっているので、ロボットの動作範囲の監視に関する第三者認定機関の認定が受けやすく、更にはロボットの動作制御に関する改善や改良を実施しても、取得済みの認定範囲に干渉しないので認定更新が不要となる。
本発明は、使用者を危険に曝さない有効なものであり、モータ等の駆動源で動作を行なう例えば数値制御機械等の自動機械に適用することができる。
【図面の簡単な説明】
【００３７】
【図１】本発明を適用したロボットシステムのブロック図
【図２】第１実施例の位置監視部のブロック図
【図３】電磁接触器の駆動回路図
【図４】第２実施例の第１監視部のブロック図
【図５】第３実施例の垂直多関節型のロボットの構成図
【図６】一般的なロボットの動作する領域を説明する図
【図７】設置されたロボットの動作領域を説明する図
【符号の説明】
【００３８】
１、１０１、２００ ロボット
２、１０２ ロボット制御装置
３、１０３ ペンダント
１０ モータ
１１ エンコーダ
２０ 制御部
２１ 駆動部
２２ 記憶部
２３ 位置監視部
２４ 電磁接触器
３１、５１ 第１監視部
３２ レシーバ
３３ ＣＰＵ
３４ 記憶部
３５ 順変換
３６ 比較
３７ 機構部データ
３８ 動作領域データ
４１ 第２監視部
５２ セレクタ
５３ エンコーダ選択信号
１０４ 作業ツール
１０５ ワーク
１０６ 動作領域
１１１ 制限領域
１１２ 最大領域
１１３ 安全防護領域
１１４ 安全防護装置
【技術分野】
【０００１】
本発明は、ロボットの動作範囲を多重監視し、確実に制限するロボット制御装置に関する。
【背景技術】
【０００２】
ロボットの可動範囲の制限を少なくして動作範囲を大きくすることは、ロボットを適用した設備への柔軟性が高くなるため、その可動範囲を広く大きくする努力が各ロボット製造メーカで行なわれ、実施されている。しかし、ロボットの可動範囲を拡大化すると、作業者の操作の誤りや外来の電気ノイズ等のために誤動作すると、ロボットの周辺の作業者への干渉や接触等で作業者に障害を与えるような危険な状態となることが考えられる。また、ロボットの周辺機器への干渉や衝突などでロボット本体又は周辺機器の破損を招くことも考えられる。
そのため、特に作業者を危険に曝さないために、ロボットの稼動中では、ロボットの可動範囲を含む領域を安全防護柵で囲い、作業者の故意又は過失でロボットの可動範囲に入らないような立ち入り制限を行なっている。また、ロボットの動作手順の教示中ではロボットの動作速度の制限や、操作しているときだけロボットが動作することができるイネーブル装置が備わる教示装置を備え、作業者が危険に曝される機会の削減が各規格で要請され、また実施されている。
【０００３】
図６は、一般的なロボットの動作する領域を説明する図である。図において、ロボットの可動部分によって掃引することができる、製造業者によって定められた領域に、エンドエフェクタ１１０及びワークによって掃引することができる領域を加えたものが最大領域１１２である。また、最大領域の一部で、ロボットシステムにどんな故障・誤動作が生じても越えることがない限界を設定するリミット装置（機構的な動作制限装置など）によって制限されたものが制限領域１１１である。また、最大領域１１２を含む安全防護装置１１４（安全防護柵など）によって、囲まれた領域を安全防護領域１１３という。（最大領域１１２、制限領域１１１及び安全防護領域１１３の各用語定義はＪＩＳ Ｂ８４３３−１９９３より抜粋。）
安全防護領域１１３を安全防護装置１１４（安全防護柵）などで囲い、ロボット１０１が稼動中には作業者がロボットの近傍に接近できなくすることと、教示中では作業者がロボットに接近するため、イネーブル装置が作動している時だけロボットの動作が許可され、かつ、誤動作など作業者の意図しないロボットの動作が生じても、作業者がイネーブル装置を非作動ととしてロボットの動作を停止する又は危険回避行動をとることのできる安全運転速度以下で動作するようになっている。
【０００４】
ロボットは、予め教示設定したプログラム（作業プログラム）に従ってロボットを動かすための軌道計算を行い、この計算に基づき動作予測位置（先読み位置）を算出し、ロボットが駆動制御されるものである。このような、ロボットの軌道計算及び動作の構成では、軌道計算及び動作予測位置計算の間違い（制御プログラムのバグ）や、作業プログラムが格納されるメモリの不良及び計算が行なわれるＣＰＵ等の演算装置の不良（製造不良）また、電気機器及び電気素子の偶発故障では、作業者に対する安全のために、例えば電源投入時又は定期的に自己診断を行ない、異常が検出されると即時ロボットの動作を停止するようにしている。また、ＣＰＵ等の半導体素子の不良（設計不良：エラッタ）並びにＣＰＵの制御プログラム作成時に利用されるコンパイラなどの制御プログラム開発環境の不良（開発用プログラムのバグ）に対しては、開発時に各種試験を実施し、可能の限りの間違いを排除しているが全ての場合についての試験（カバレッジ率１００％）は不可能である。よって、間違いや異常を検出する診断のタイミングによっては、ロボットがこれらを原因として異常な動作をする可能性を否定することは出来ない。
また、作業者により教示設定される作業プログラムの間違いによるロボットの動作では、これを間違いとして検出又は回避することは困難である。
【０００５】
以下に、ロボットの可動範囲を作業に必要とする領域（稼動範囲又は最大動作範囲）に制限しつつ、作業者の保護について説明する。
ロボットの稼動範囲を制限するものとして、複数の光電センサを利用して、検出信号に基づいてロボットの可動範囲を部分的に制限を行なう制御装置を備え、ロボットの設置スペースに合わせて可動範囲を任意に変更することができるロボットの可動範囲制限装置が提案されている（例えば、特許文献１）。
しかし、この提案では光電センサを使用しているため、設備設置時には動作領域を分割するために光軸調整が必要となり、使用中に光学系のズレが起こらないような確実な設置が必要とされ、また定期的に光学系の確認が必要となると共に、粉塵及びオイルミストの多い製品の生産工場雰囲気では、発行部及び受光部のレンズ等の集光器が汚れるための、定期的な清掃等の保守が必要となる。このように、光を利用する検出器はクリーンルームなどの特殊な環境以外には適していない。
【０００６】
光学系検出器ような定期的な保守点検の負荷を軽減するものとして、ロボットの可動範囲を制限する仮想安全柵を制御装置のメモリーに定義し、ツールを含むロボットの動作予測位置が該仮想安全柵を越えると判定されるとロボットアームの移動を停止制御するロボット動作規制装置が提案されている（例えば、特許文献２）。
また、特許文献２の動作予測位置の代りにロボットの各軸毎の位置を検出し、該検出した位置データが動作可能範囲にあるかを判定し、動作範囲より外れていると判定されるとロボットの動作を停止させるか警報を発するロボットの暴走防止装置の提案もある（例えば、特許文献３）。
【０００７】
ロボットの制御を行なうＣＰＵの他にロボットの状態を常に監視するＣＰＵを設け、特許文献２又は特許文献３で行なう動作可能範囲の監視を、この監視用ＣＰＵで行ない、ロボット制御ＣＰＵ及び監視用ＣＰＵの相互間で必要最低限の通信を行ない、異常が検出されるとロボットを停止させることが行なわれている（例えば、特許文献４）。このような構成では、ロボット制御ＣＰＵと監視用ＣＰＵの双方でロボット及び他方のＣＰＵの監視をすることができるので、ロボットの状態を、単一の部品故障などの発生があってもロボットを停止する安全方向にすることができるようになっている。
【０００８】
従来のロボット制御装置は、特許文献１乃至３の構成で、動作制限をより確かなものとする努力がなされている。しかし、ロボットの一般的設計要求事項として、「すべての構成要素（電気、電子、機械、空気圧及び油圧）の中でいずれか１個の部品が予測可能な範囲で故障しても、安全機能を影響を受けず、また、影響を受けた場合でもロボットシステムは安全な状態に保たれるように、ロボットシステムを設計、製作及び据付けすること」（日本工業規格Ｂ８４３−１９９３より抜粋）が要請されている。この要請に応えるために、構成要素の偶発故障及び不良（製造不良、動作不良、エラッタ等）並びに制御プログラム開発環境に潜む不良及び間違いを可能な限り排除しなければならない問題に対し、複数個所で監視を行なうことでこれらの問題を解決している。
【０００９】
【特許文献１】特開２０００−６０８３号公報
【特許文献２】特開２００４−３２２２４４号公報
【特許文献３】特開昭６３−１０２８９２号公報
【特許文献４】特開昭６０−２５６９３号公報
【発明の開示】
【発明が解決しようとする課題】
【００１０】
図７は、設置されたロボットの動作領域を説明する図である。ロボット１０１は、ペンダント１０３から作業者によって稼動前に作業プログラムが作られ、ロボット制御装置１０２に記憶されている。作業プログラムは、ロボット１０１の手首部に装着された作業ツール１０４でワーク１０５に対して所定の作業を行なうようになっている。このようにワーク１０５形状が小型であれば、ロボット１０１がワーク１０５に対する作業のときにロボット１０１の動作領域１０６は、ロボット１０１の最大領域内に納まり、動作領域１０６を安全防護柵で囲うことで、ロボット１０１の稼動中に作業者がロボット１０１の動作領域１０６内に立ち入ることを制限して作業者の安全を確保している。しかし、外来の電気的ノイズやロボット又はロボット制御装置の部品の故障によって動作領域１０６を越えて動作してしまうことが考えられる。
【００１１】
ロボットを導入する顧客及びロボットの供給者としては、ロボットを安心して使用することができるように、ロボットの安全性の証明手段として、第三者機関による認証を取得するものもある。この認証は取得には長期間を要し、また、例えば制御プログラムの改正やハードウェアの改良の度にも認証の更新に係る手続が面倒で、機能の確認等のための時間も要するので、早急な改版、改良が困難である問題がある。
本発明はこのような問題点に鑑みてなされたものであり、構成要素の偶発故障及び不良（製造不良、動作不良、エラッタ等）並びに制御プログラム開発環境に潜む不良及び間違いを可能な限り排除するとともに第三者機関による認証を更新に係る手間と時間を削減することができるロボット制御装置を提供することを目的とする。
【課題を解決するための手段】
【００１２】
上記問題を解決するため、本発明は、次のように構成したのである。
請求項１に記載の発明は、回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットの制御点が、予め設定された前記ロボットの動作領域からの逸脱を検出すると前記ロボットの動作を禁止する手段を備えたロボット制御装置を備えるロボットシステムにおいて、 前記エンコーダからの位置信号が接続され、前記ロボットの動作領域に基づいて予め設定された動作領域データと前記ロボットの各軸の位置を検出するエンコーダからの位置データに基づいて算出する前記ロボットの制御点の現在位置とを比較し、前記現在位置が前記ロボットの動作領域の逸脱を検出すると、前記ロボットの動作を禁止する位置監視部を備えたことを特徴とするものである。
また、請求項２に記載の発明は、前記ロボットの動作の禁止は、前記ロボットの駆動電源を遮断することを特徴とするものである。
【００１３】
また、請求項３に記載の発明は、回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットの制御点が、予め設定された前記ロボットの動作領域からの逸脱を検出すると前記ロボットの動作を禁止する手段を備えたロボット制御装置を備えるロボットシステムにおいて、前記ロボット制御装置は、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの制御点の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの制御点の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするものである。
【００１４】
また、請求項４に記載の発明は、回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットであって、前記ロボットは、設置された基部と、前記基部に回動自在に設けられモータで駆動する第１関節と、第１関節に取り付けられた第１アームと、前記第１アームの端部に回動自在に設けられモータで駆動する第２関節と、前記第２関節に垂直に取り付けられた第２アームと、前記第２アームの端部に回動自在に設けられモータで駆動する第３関節と、前記第３関節に取り付けられた第３アームと、前記第３アームの端部に取り付けられた２つ以上の関節からなり、前記ロボットを制御するロボット制御装置を備えるロボットシステムにおいて、前記ロボット制御装置は、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第３関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第３関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするものである。
【００１５】
また、請求項５に記載の発明は、回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットであって、前記ロボットは、設置された基部と、前記基部に回動自在に設けられモータで駆動する第１関節と、第１関節に取り付けられた第１アームと、前記第１アームの端部に回動自在に設けられモータで駆動する第２関節と、前記第２関節に垂直に取り付けられた第２アームと、前記第２アームの端部に回動自在に設けられモータで駆動する第３関節と、前記第３関節に取り付けられた第３アームと、前記第３アームの端部に取り付けられた２つ以上の関節からなり、前記ロボットを制御するロボット制御装置を備えるロボットシステムにおいて、前記ロボット制御装置は、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第４関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第４関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするものである。
【００１６】
また、請求項６に記載の発明は、前記第１監視部が駆動する前記第１遮断手段又は前記第２監視部が駆動する第２遮断手段は電磁接触器であることを特徴とするものである。
また、請求項７に記載の発明は、前記第１監視部又は前記第２監視部が駆動する前記電磁接触器は、少なくとも２つの常開主接点と少なくとも１つの常閉補助接点とを備え、前記電磁接触を駆動して前記常開主接点を閉路するときは、該常閉補助接点が閉路していることが検出された後であることを特徴とするものである。
また、請求項８に記載の発明は、前記第１監視手段又は前記第２監視手段はＣＰＵを備え、前記ＣＰＵは、エンコーダ選択信号を出力し、前記ロボットの複数の前記エンコーダからの位置信号を選択して該当する前記位置データを取得し、前記エンコーダ選択信号を切換え、前記ロボットに備わる複数のエンコーダの位置データを取得し、前記ロボットの制御点の現在位置を求めることを特徴とするものである。
【００１７】
また、請求項９に記載の発明は、前記第１監視手段及び前記第２監視手段は各々ＣＰＵを備え、前記第１監視装置に備わるＣＰＵと前記第２監視装置に備わるＣＰＵとは、異なるアーキテクチャのＣＰＵであることを特徴とするものである。
また、請求項１０に記載の発明は、前記ロボット制御装置は表示手段を備え、前記第１監視手段及び前記第２監視手段は、各々の状態を前記ロボット制御装置に出力し、前記ロボット制御装置は前記第１監視手段又は前記第２監視手段の状態を前記表示手段に表示することを特徴とするものである。
また、請求項１１に記載の発明は、前記第１監視手段は、第１動作領域監視手段を無効化又は第１遮断手段を接続状態とする無効入力を備え、前記第２監視手段第２動作領域監視手段を無効化又は第２遮断手段を接続状態とする無効入力を備えることを特徴とするものである。
【発明の効果】
【００１８】
請求項１乃至６に記載の発明によると、ロボットの制御とは独立した２つの監視部でロボットの制御点の監視を行ない、ロボットが動作領域を逸脱すると電磁接触器を開路して駆動部への電源供給を遮断するので、ロボットの制御上の問題でロボットが誤動作や暴走などで動作範囲を逸脱することを確実に検出し、その時には駆動電源を遮断し停止することができる。特に請求項４及び５に記載の発明では、垂直多関節ロボットにおいて、ロボットの姿勢により、最も動作領域が広い場合として第３関節又は第４関節となることがある。このような場合に、最も動作領域の広い部位が動作領域から逸脱すれば、ロボットの動作を禁止する。
また、請求項７に記載の発明によると、駆動部への電源供給をおこなう電磁接触器の接点が溶着していれば、動作範囲を逸脱していなくても電磁接触器接点の閉路をおこなわないので、接点溶着を検出することができる。
また、請求項８に記載の発明によると、ロボットの位置を検出する複数のエンコーダに対し、位置信号を順じスキャンして位置データを取得するようになっているので、位置信号を位置データへの変換する回路又は素子の数を削減でき、位置監視部の形状の縮小化ができ、またコストダウンもできる。
また、請求項９に記載の発明によると、２つの監視部に備わるＣＰＵのアーキテクチャが異なるので、ＣＰＵに固有のエラッタや制御プログラム開発装置の誤りが両監視部に入り込む事がなくなるので、位置監視の確実性が向上する。
また、請求項１０に記載の発明によると、監視部で検出した状態をロボット制御装置に接続されたペンダントに備わる表示手段に表示することができるので、ロボットが動作領域を逸脱した時の原因究明を支援することができ、原因解決までの時間の短縮に貢献することができる。
また、請求項１１に記載の発明によると、何らかの原因でロボットが動作領域を逸脱しても、無効入力へ入信している間は駆動電源を投入することができるので、ロボット制御部及び駆動部でロボットを正規の位置（動作領域内）に戻すことができる。
【発明を実施するための最良の形態】
【００１９】
以下、本発明の実施の形態について図を参照して説明する。
【実施例１】
【００２０】
図１は、本発明を適用したロボットシステムのブロック図である。図において、１はロボットであり、複数のモータ１０とエンコーダ１１の組みで、複数の関節を駆動しアームを動作させ、作業ツール１０４を目的の位置に動作させる（図では１組のみを記載している）。３はペンダントであり、教示のときには作業者が操作することでロボット１を目的の位置に動作させ位置の登録を行ない、ワーク１０５に対する作業プログラムを登録又は編集を行なう。また、ロボットの機構情報の入力や動作範囲１０６の設定を行なう。また、ペンダント３は図示しない表示器を備え、作業プログラムのリスト表示、機構情報である機構部データの表示、動作領域データの表示、異常表示その他のロボットの設置時に必要なデータの表示やロボットの状態表示を行なう。２はロボット制御装置であり、ロボット動作の制御を行なう制御部２０、制御部２０によって求められたモータ１０の動作司令に基づきモータ１０を駆動する駆動部２１、作業プログラム、機構部データ、動作領域データその他のロボット制御に必要な諸データまたはプログラムが格納される記憶部２２を主な要素として構成されている。本発明では、位置監視部２３が備わっている。
【００２１】
ロボット１０を動作するための駆動電源は、商用の電源２５から、制御部２０で開閉制御される電磁接触器２４−１及び位置監視部２３で開閉制御される電磁接触器２４−２、２４−３の各接点が直列接続され、駆動部２１へ接続されている。すなわち、制御部２０及び位置監視部２３の双方がロボット１０の動作を許可するときに電磁接触器２４−１、２４−２、２４−３の接点が閉じ、駆動部２３へ電源２５が供給され、ロボット１０の動作が許可されないときには、いずれかの電磁接触器２４−１、２４−２、２４−３の接点が開路して駆動部２３への電源供給が遮断されるようになっている。尚、電源２５と駆動部２３との間には電磁接触器２４−１、２４−２、２４−３の接点以外に、例えば非常停止の接点やその他のロボットの動作を禁止する要因となる接点が挿入されるが、本図では省略している。
【００２２】
制御部２０と位置監視部２３とはシリアル通信等の情報伝達路で接続されているが、機構部データ、動作領域データを位置監視部２３への設定と位置監視部２３の状態及び異常情報を制御部２０へ伝えることで、設備導入時及び異常時の復旧を速やかに行なうための情報伝達を目的としていて、ロボット１０の通常の稼動時（作業プログラムの再生時）にはロボットの動作制御に関する情報伝達の必要性はないようになっている。
【００２３】
図２は位置監視部２３のブロック図である。図において、３１は第１監視部、４１は第２監視部である。第１監視部３１と第２監視部４１とは同様の構成であるため第１監視部について説明する。尚、第１監視部３１と第２監視部４１とは異なるアーキテクチャのＣＰＵを採用することで、ＣＰＵのエラッタや制御プログラム開発装置の不具合（コンパイラのバグ等）を、双方の監視部の同一個所に入り込む機会をなくし、相互に独立して監視を行なうようにしている。また、第１監視部３１と第２監視部４１の各々は電磁接触器２４−２と２４−３の操作コイルを駆動するようになっている。
【００２４】
ロボット１０の各関節はモータ１０に備わるエンコーダ１１からの複数軸の位置信号は、駆動部２１に入力されサーボ制御されると共に、位置制御部２３へ並列接続されていて、第１監視部及び第２監視部にさらに並列分岐して入力される。
第１監視部３１に入力された複数のエンコーダ１１からの位置信号は、レシーバ３２を介してＣＰＵ３３に読み込まれる。ＣＰＵ３３は記憶部３４に記憶されているロボット１の機構部データ３７に基づいて、エンコーダ１１〜入力されるロボット１の各関節の位置データからロボット１の座標系の位置データへ順変換３５を行なう。この順変換でロボット１の制御点の座標系での位置データが求められる。
尚、制御点とは、作業ツールが取り付けられるエンドエフェクタの代表点（図５参照）又は取り付けられた作業ツーツの代表点（例えば、アーク溶接ではエンドエフェクタに取り付けられた溶接トーチのワイヤ先端（作業点））をいう。
尚、本図のレシーバ３２は、エンコーダからの位置信号を受け、位置データとしてカウンタ又はレジスタ等への一時格納を行なうインターフェース回路又は素子であるが、位置信号を受けるインターフェース回路又は素子とし、各軸の位置データをＣＰＵ３３で取得する構成であってもよい。
【００２５】
求められた座標系の位置データは、記憶部３４に記憶されている動作領域データ３８と比較され、位置データが動作領域データの内部であるなら電磁接触器２４−２の操作コイルを駆動して接点を閉路し、動作領域データの外部であるなら接点を開路する。
図３は、電磁接触器２４−２の駆動回路図である。電磁接触器は、操作コイル２４−５へ電流の通流と遮断を行なうことで、２つの常開主接点２４−６の開路／閉路と１つの常閉補助接点２４−７の閉路／開路が連動して動作する。第１監視部３１のＣＰＵ３３は、位置データが動作領域データの外部であると判断すると、出力インターフェース４０−１を介して操作コイル２４−５への通電を遮断し、主接点２４−６を開路する。主接点２４−６が開路している状態から、位置データが動作領域データの内部であると判断すると、出力インターフェース４０−１を介して操作コイル２４−５への通電を行ない、主接点２４−６の閉路と補助接点２４−７の開路を行うが、操作コイル２４−５への通電の前に補助接点２４−７の状態を入力インターフェース４０−２を介して読み込み、閉路していることを確認する。この補助接点２４−７の状態確認は、主接点２４−６に接点溶着が発生していないことの確認に相当する。
【００２６】
ロボットが稼動中に、何らかの原因でロボットが動作領域１０６から逸脱してしまったときのために、第１監視部は無効入力３９を備えている。この無効入力がアクティブになると、第１監視部は動作領域の監視を無効とし主接点２４−６を閉路とする又は監視を行っていても電磁接触器２４−２の主接点２４−６を閉路するようになっている。すなわち、ロボットが動作領域１０６から逸脱した位置から動作領域１０６の内部の位置に、ペンダントの操作で動作させるときに、この無効入力３９をアクティブとすると、動作領域１０６を逸脱していてもロボットの駆動電源を投入することができるようになっている。この無効入力３９は、例えばモーメンタリ型のスイッチで入力される。無効入力は制御部２０からの情報伝達路で状態を伝えられていてもかまわない。
【００２７】
第２監視部４１は、第１監視部３１と構成は同じであるため詳細な説明は省略する。
尚、動作領域データは、例えばロボット座標系の上で直方体を形成する。すなわち、Ｘ、Ｙ及びＺの各軸に対し各々最大値と最小値を予め情報伝達路を介して設定しておく。現在位置がＸ、Ｙ及びＺの各軸で最大値と最小値の間であれば動作領域の内部であると判定し、最大値と最小値の間から出ればロボットの動作領域を逸脱と判定する。
【００２８】
このようにロボット制御装置２の位置制御部２３は制御部２０及び駆動部２１から独立してロボットの位置を監視し、予め設定された動作領域１０６から逸脱すると、電磁接触器２４−２、２４−３の接点を開路して駆動部２１への電源を遮断することでロボット１の動作を禁止する。そして、この時の状態データを制御部２０に送り、制御部ではペンダント３に備わる図示しない表示器に状態データを適宜表示、又は図示しない出力部からロボット制御装置２の外部に出力することで、異常となった原因究明や保守作業に供する。
【００２９】
ロボット制御装置２では、制御部２０でロボット１の制御点の動作軌道を制御周期毎に求め、ロボット１を該動作軌道に沿って動作制御を行なっているが、求めた動作軌道が動作領域１０６の範囲内であることの確認が行なわれているため、例えば、記憶部２２の誤動作や故障で記憶されている作業プログラムの一部データに障害があるときには、この段階でロボット１の動作前に動作領域１０６の逸脱を検出することができ、電磁接触器２４−１の接点を開路する等でロボット１を動作禁止とすることができる。
【００３０】
このような構成であるため、特許文献２乃至４とは大きく異なり、制御部２０並びに位置監視部２３の第１監視部３１及び第２監視部４１で、ロボットの動作領域を３重に監視し確実に制限することができる。そして、位置監視部２３は制御部２０から独立しているのでロボットの動作制御に影響されずに位置監視を行うことができるので、確実なロボットの動作領域逸脱監視を行うことができる。そのため、特に、小型のワークへの作業等でロボットの動作領域が狭いときに、動作領域に見合う安全防護柵の設置を行なうことができ、また、例えば安全防護柵に代えてロープなどで動作領域を明示することも可能である。
【００３１】
位置監視部２３は制御部２０及び駆動部２１とは独立して位置監視を行なうため、第三者機関による認証を取得後に、制御部２０又は駆動部２１の改良事項があっても、位置監視部２３に影響しないので、認証の更新が不要となる。
【実施例２】
【００３２】
図４は第２実施例の第１監視部の構成を示す図である。図において、５１は第１監視部であって、図２の第１監視部３１に代わるものである。複数のエンコーダ１１からの位置信号は、第１監視部５１に導かれ、セレクタ５２に入力される。ＣＰＵ３３はセレクタにエンコーダ選択信号５３を出力して、複数のエンコーダ１１からの位置信号から１軸を選択してレシーバ３２に出力される。レシーバ３２は、選択されたエンコーダ１１の位置信号を入力して、該当する軸の位置データとし、ＣＰＵはこの位置データを取得し、次の軸のエンコーダ１１からの位置データを得るためにエンコーダ選択信号５３を歩進する。
この様にして、ロボット１の全軸の位置データを取得の後、ロボット１の座標系の位置データへ順変換３５を行なう。この順変換でロボット１の制御点の座標系での位置データが求められ、求められた座標系の位置データは、記憶部３４に記憶されている動作領域データ３８と比較され、位置データが動作領域データの内部であるなら電磁接触器２４−２の操作コイルを駆動して接点を閉路し、動作領域データの外部であるなら接点を開路する。
【００３３】
第２監視部も同様であるので、図示及び説明は省いている。尚、第２監視部の構成は第２実施例の構成に限定するものではなく、第１実施例の構成であってもかまわない。
尚、第２実施例の構成では、レシーバ３２では単軸単位で位置を得るために、このエンコーダ信号はエンコーダ１１からシリアル通信で送られるものである。
また、各々の軸についての位置データの取得タイミングが異なるが、位置データの取得が例えば１００マイクロ秒の違いは、ロボットの最大速度を２メートル／秒と仮定してもロボットの制御点で０．２ミリメートル程度の差異であるので、実質上問題とはならない。
【００３４】
このように、各々の軸の位置データを順じ取得するような構成をしているので、ロボットの制御点位置計算では実質上問題とならない範囲で、レシーバの数を削減することができるので、監視部形状の小型化の効果を奏し、更にはコストダウンの効果も期待することができる。
【実施例３】
【００３５】
図５は第３実施例の垂直多関節型のロボット２００の構成図である。図において、
ロボットアームは、水平面内で回転（旋回）する第１関節２０１と、この第１関節に接続された第１アーム２０２と、第１アーム２０２の端部に第２関節２０３が取り付けられている。
第２関節２０３に接続された第２アーム２０４と、第２アーム２０４の端部に第３関節２０５が取り付けられている。第３アーム２０６の端部には第４関節２０７を介して手首部２０８が取り付けられている。
このとき、水平面をＸＹ平面とし、上空方向を＋Ｚ方向とすると、第３アーム２０５は、ロボットの姿勢、動作によっては、この第３アーム２０５の端部が、もっとも動作領域が広い場合がある。
つまり、第３関節２０５または第４関節２０７の現在位置と動作領域を比較する必要がある。
第３関節２０５または第４関節２０７の現在位置は、順変換から求めることは可能であるので、詳述はしない。また、制御点２０９の位置から第４関節２０７または第３関節２０５までの逆変換によって求めることも可能である。
【産業上の利用可能性】
【００３６】
ロボットの制御とは独立して行なうようになっているので、ロボットの動作範囲の監視に関する第三者認定機関の認定が受けやすく、更にはロボットの動作制御に関する改善や改良を実施しても、取得済みの認定範囲に干渉しないので認定更新が不要となる。
本発明は、使用者を危険に曝さない有効なものであり、モータ等の駆動源で動作を行なう例えば数値制御機械等の自動機械に適用することができる。
【図面の簡単な説明】
【００３７】
【図１】本発明を適用したロボットシステムのブロック図
【図２】第１実施例の位置監視部のブロック図
【図３】電磁接触器の駆動回路図
【図４】第２実施例の第１監視部のブロック図
【図５】第３実施例の垂直多関節型のロボットの構成図
【図６】一般的なロボットの動作する領域を説明する図
【図７】設置されたロボットの動作領域を説明する図
【符号の説明】
【００３８】
１、１０１、２００ ロボット
２、１０２ ロボット制御装置
３、１０３ ペンダント
１０ モータ
１１ エンコーダ
２０ 制御部
２１ 駆動部
２２ 記憶部
２３ 位置監視部
２４ 電磁接触器
３１、５１ 第１監視部
３２ レシーバ
３３ ＣＰＵ
３４ 記憶部
３５ 順変換
３６ 比較
３７ 機構部データ
３８ 動作領域データ
４１ 第２監視部
５２ セレクタ
５３ エンコーダ選択信号
１０４ 作業ツール
１０５ ワーク
１０６ 動作領域
１１１ 制限領域
１１２ 最大領域
１１３ 安全防護領域
１１４ 安全防護装置
【特許請求の範囲】
【請求項１】
回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットの制御点が、予め設定された前記ロボットの動作領域からの逸脱を検出すると前記ロボットの動作を禁止する手段を備えたロボット制御装置を備えるロボットシステムにおいて、
前記エンコーダからの位置信号が接続され、前記ロボットの動作領域に基づいて予め設定された動作領域データと前記ロボットの各軸の位置を検出するエンコーダからの位置データに基づいて算出する前記ロボットの制御点の現在位置とを比較し、
前記現在位置が前記ロボットの動作領域の逸脱を検出すると、前記ロボットの動作を禁止する位置監視部を備えたことを特徴とするロボットシステム。
【請求項２】
前記ロボットの動作の禁止は、前記ロボットの駆動電源を遮断することを特徴とする請求項１記載のロボットシステム。
【請求項３】
回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットの制御点が、予め設定された前記ロボットの動作領域からの逸脱を検出すると前記ロボットの動作を禁止する手段を備えたロボット制御装置を備えるロボットシステムにおいて、
前記ロボット制御装置は、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの制御点の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの制御点の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、
前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするロボットシステム。
【請求項４】
回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットであって、前記ロボットは、設置された基部と、前記基部に回動自在に設けられモータで駆動する第１関節と、第１関節に取り付けられた第１アームと、前記第１アームの端部に回動自在に設けられモータで駆動する第２関節と、前記第２関節に垂直に取り付けられた第２アームと、前記第２アームの端部に回動自在に設けられモータで駆動する第３関節と、前記第３関節に取り付けられた第３アームと、前記第３アームの端部に取り付けられた２つ以上の関節からなり、前記ロボットを制御するロボット制御装置を備えるロボットシステムにおいて、
前記ロボット制御装置は、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第３関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第３関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、
前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするロボットシステム。
【請求項５】
回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットであって、前記ロボットは、設置された基部と、前記基部に回動自在に設けられモータで駆動する第１関節と、第１関節に取り付けられた第１アームと、前記第１アームの端部に回動自在に設けられモータで駆動する第２関節と、前記第２関節に垂直に取り付けられた第２アームと、前記第２アームの端部に回動自在に設けられモータで駆動する第３関節と、前記第３関節に取り付けられた第３アームと、前記第３アームの端部に取り付けられた２つ以上の関節からなり、前記ロボットを制御するロボット制御装置を備えるロボットシステムにおいて、
前記ロボット制御装置は、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第４関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第４関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、
前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするロボットシステム。
【請求項６】
前記第１監視部が駆動する前記第１遮断手段又は前記第２監視部が駆動する第２遮断手段は電磁接触器であることを特徴とする請求項３乃至５のいずれかに記載のロボットシステム。
【請求項７】
前記第１監視部又は前記第２監視部が駆動する前記電磁接触器は、少なくとも２つの常開主接点と少なくとも１つの常閉補助接点とを備え、前記電磁接触を駆動して前記常開主接点を閉路するときは、該常閉補助接点が閉路していることが検出された後であることを特徴とする請求項６記載のロボットシステム。
【請求項８】
前記第１監視手段又は前記第２監視手段はＣＰＵを備え、前記ＣＰＵは、エンコーダ選択信号を出力し、前記ロボットの複数の前記エンコーダからの位置信号を選択して該当する前記位置データを取得し、前記エンコーダ選択信号を切換え、前記ロボットに備わる複数のエンコーダの位置データを取得し、前記ロボットの制御点の現在位置を求めることを特徴とする請求項３乃至５のいずれかに記載のロボットシステム。
【請求項９】
前記第１監視手段及び前記第２監視手段は各々ＣＰＵを備え、前記第１監視装置に備わるＣＰＵと前記第２監視装置に備わるＣＰＵとは、異なるアーキテクチャのＣＰＵであることを特徴とする請求項３乃至５のいずれかに記載のロボットシステム。
【請求項１０】
前記ロボット制御装置は表示手段を備え、前記第１監視手段及び前記第２監視手段は、各々の状態を前記ロボット制御装置に出力し、前記ロボット制御装置は前記第１監視手段又は前記第２監視手段の状態を前記表示手段に表示することを特徴とする請求項３乃至５のいずれかに記載のロボットシステム。
【請求項１１】
前記第１監視手段は、第１動作領域監視手段を無効化又は第１遮断手段を接続状態とする無効入力を備え、前記第２監視手段第２動作領域監視手段を無効化又は第２遮断手段を接続状態とする無効入力を備えることを特徴とする請求項３乃至５のいずれかに記載のロボットシステム。
【請求項１】
回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットの制御点が、予め設定された前記ロボットの動作領域からの逸脱を検出すると前記ロボットの動作を禁止する手段を備えたロボット制御装置を備えるロボットシステムにおいて、
前記エンコーダからの位置信号が接続され、前記ロボットの動作領域に基づいて予め設定された動作領域データと前記ロボットの各軸の位置を検出するエンコーダからの位置データに基づいて算出する前記ロボットの制御点の現在位置とを比較し、
前記現在位置が前記ロボットの動作領域の逸脱を検出すると、前記ロボットの動作を禁止する位置監視部を備えたことを特徴とするロボットシステム。
【請求項２】
前記ロボットの動作の禁止は、前記ロボットの駆動電源を遮断することを特徴とする請求項１記載のロボットシステム。
【請求項３】
回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットの制御点が、予め設定された前記ロボットの動作領域からの逸脱を検出すると前記ロボットの動作を禁止する手段を備えたロボット制御装置を備えるロボットシステムにおいて、
前記ロボット制御装置は、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの制御点の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの制御点の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、
前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするロボットシステム。
【請求項４】
回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットであって、前記ロボットは、設置された基部と、前記基部に回動自在に設けられモータで駆動する第１関節と、第１関節に取り付けられた第１アームと、前記第１アームの端部に回動自在に設けられモータで駆動する第２関節と、前記第２関節に垂直に取り付けられた第２アームと、前記第２アームの端部に回動自在に設けられモータで駆動する第３関節と、前記第３関節に取り付けられた第３アームと、前記第３アームの端部に取り付けられた２つ以上の関節からなり、前記ロボットを制御するロボット制御装置を備えるロボットシステムにおいて、
前記ロボット制御装置は、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第３関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第３関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、
前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするロボットシステム。
【請求項５】
回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットであって、前記ロボットは、設置された基部と、前記基部に回動自在に設けられモータで駆動する第１関節と、第１関節に取り付けられた第１アームと、前記第１アームの端部に回動自在に設けられモータで駆動する第２関節と、前記第２関節に垂直に取り付けられた第２アームと、前記第２アームの端部に回動自在に設けられモータで駆動する第３関節と、前記第３関節に取り付けられた第３アームと、前記第３アームの端部に取り付けられた２つ以上の関節からなり、前記ロボットを制御するロボット制御装置を備えるロボットシステムにおいて、
前記ロボット制御装置は、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第４関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第４関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、
前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするロボットシステム。
【請求項６】
前記第１監視部が駆動する前記第１遮断手段又は前記第２監視部が駆動する第２遮断手段は電磁接触器であることを特徴とする請求項３乃至５のいずれかに記載のロボットシステム。
【請求項７】
前記第１監視部又は前記第２監視部が駆動する前記電磁接触器は、少なくとも２つの常開主接点と少なくとも１つの常閉補助接点とを備え、前記電磁接触を駆動して前記常開主接点を閉路するときは、該常閉補助接点が閉路していることが検出された後であることを特徴とする請求項６記載のロボットシステム。
【請求項８】
前記第１監視手段又は前記第２監視手段はＣＰＵを備え、前記ＣＰＵは、エンコーダ選択信号を出力し、前記ロボットの複数の前記エンコーダからの位置信号を選択して該当する前記位置データを取得し、前記エンコーダ選択信号を切換え、前記ロボットに備わる複数のエンコーダの位置データを取得し、前記ロボットの制御点の現在位置を求めることを特徴とする請求項３乃至５のいずれかに記載のロボットシステム。
【請求項９】
前記第１監視手段及び前記第２監視手段は各々ＣＰＵを備え、前記第１監視装置に備わるＣＰＵと前記第２監視装置に備わるＣＰＵとは、異なるアーキテクチャのＣＰＵであることを特徴とする請求項３乃至５のいずれかに記載のロボットシステム。
【請求項１０】
前記ロボット制御装置は表示手段を備え、前記第１監視手段及び前記第２監視手段は、各々の状態を前記ロボット制御装置に出力し、前記ロボット制御装置は前記第１監視手段又は前記第２監視手段の状態を前記表示手段に表示することを特徴とする請求項３乃至５のいずれかに記載のロボットシステム。
【請求項１１】
前記第１監視手段は、第１動作領域監視手段を無効化又は第１遮断手段を接続状態とする無効入力を備え、前記第２監視手段第２動作領域監視手段を無効化又は第２遮断手段を接続状態とする無効入力を備えることを特徴とする請求項３乃至５のいずれかに記載のロボットシステム。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【公開番号】特開２００８−２１３０５６（Ｐ２００８−２１３０５６Ａ）
【公開日】平成２０年９月１８日（２００８．９．１８）
【国際特許分類】
【出願番号】特願２００７−５１１９８（Ｐ２００７−５１１９８）
【出願日】平成１９年３月１日（２００７．３．１）
【出願人】（０００００６６２２）株式会社安川電機 (2,482)
【Ｆターム（参考）】
【公開日】平成２０年９月１８日（２００８．９．１８）
【国際特許分類】
【出願日】平成１９年３月１日（２００７．３．１）
【出願人】（０００００６６２２）株式会社安川電機 (2,482)
【Ｆターム（参考）】
[ Back to top ]