JP6055014B2 - 物または人との接触を検知する機能を有するロボット制御装置 - Google Patents

Description

本発明は、ロボットを制御するロボット制御装置に関する。

近年では、人がロボットと協調して作業を行うロボットシステムが知られている。このロボットシステムでは、ロボットの周りに安全柵を設けない状態にて、ロボットおよび人が作業する。ロボット制御装置には、デッドマンスイッチと称されるスイッチが配置されている。例えば、ロボットを停止すべき時に作業者がデッドマンスイッチを押すと、ロボットを緊急停止することができる。デッドマンスイッチを備えることにより安全性を向上させることができる。

また、ロボットの動作中には、ロボットが周りの物や人に接触する場合がある。例えば、人がロボットと協調して作業を行っている時に、ロボットが周囲の機器に接触したり作業者に接触したりする場合がある。このような場合に、ロボットシステムは、外力を検知してロボットを停止したり、被接触物を避ける退避動作を行ったりするように制御することが知られている（例えば、特許文献１から特許文献３参照）。

特許第３３６７６４１号明細書 特許第３４５９９７３号明細書 特開２０１４−１８９０１号公報

ロボットは、予め生成された軌道に沿って移動するように制御される。ロボットの軌道は、作業者が指定した教示点および速度に基づいて生成することができる。教示点は、作業者が教示操作盤を操作することにより設定することができる。たとえば、教示操作盤を操作してロボットを所望の位置および姿勢にする。このときのロボットのツール先端点の位置を教示点として記憶させることができる。そして、ロボット制御装置は、教示点または教示点の近傍を通るように軌道を生成することができる。

ロボットに教示点を教示している期間中に、ロボットが周辺の機器に接触することが頻繁に生じる場合がある。例えば、ワークを作業台に置く動作を教示する場合には、ワークを作業台に近づけた状態でハンドを広げる。このときにハンドを広げる位置が高すぎると、ワークが傷つく可能性がある。このために、ハンドを広げる位置は、ワークが作業台に近接した位置であることが好ましい。

作業者は、ワークが作業台よりも僅かに上に配置されている位置を教示するために、ロボットを上下に動かせて調整する。作業者がワークを作業台に近づける操作をしている時にワークが作業台に接触してしまう場合がある。

ロボットが外部の物体と接触した場合には、適切な方法により退避することが好ましい。ロボットが外部の物体と接触した場合にロボットを停止させる方法では、接触状態が続くためロボットを動作させることができずに、教示を続けることができないという問題が生じる。

一方で、ロボットが自動的に退避動作を行う場合には、教示作業の効率が悪いという問題がある。例えば、ワークが下降して作業台に接触した場合に、ロボットを自動的に上昇させる制御が考えられる。そして、ロボットが自動的に上昇する動作は、安全性を考慮して大きく移動するように設定される。このために、ロボットを再び下降させてワークを作業台の近傍まで移動させる必要がある。ところが、操作が所望の通りに行われない場合には、再びワークが作業台に接触してしまう場合がある。すなわち、ワークが作業台に接触する状態と、ワークが作業台から離れた状態とが交互に繰り返される場合がある。同様の操作を繰り返す必要があるために、教示をする時間が長くなるという問題がある。

本発明のロボット制御装置は、ロボットがロボット以外の物体に接触しているか否かを判定する接触検出部と、ロボットが物体に接触した後のロボットの動作方向を検出し、ロボットの動作を監視する動作方向監視部とを備える。接触検出部は、ロボットと物体とが接触した時にロボットが退避する基準の方向となる基準方向を設定し、基準方向は、ロボットが物体から離れる方向であり、動作方向監視部は、基準方向に対する予め定められた角度の範囲を許容範囲に設定し、ロボットが物体に接触した後に、許容範囲内のロボットの動作を許可し、許容範囲から外れるロボットの動作を禁止する。

上記発明においては、作業者がロボットを手動にて操作してロボットの動作を教示する教示モードと、ロボットが教示された動作を自動的に再生する再生モードとの切替えが可能な切替えスイッチと、ロボットと物体とが接触した場合に、ロボットを物体から離れる方向に自動的に動作させる退避指令部とを備え、切替えスイッチにより再生モードが選択された場合に、ロボットと物体とが接触した時に退避指令部によりロボットを動作させ、切替えスイッチにより教示モードが選択された場合に、ロボットと物体とが接触した時に動作方向監視部によりロボットの動作を監視することができる。

上記発明においては、動作方向監視部は、ロボットの動作方向が許容範囲を外れた場合には、ロボットを停止することができる。

本発明のロボット制御装置は、ロボットが人や物に接触した時に、安全に接触を解消する動作を行うことができる。

実施の形態におけるロボットシステムの概略図である。 実施の形態における第１のロボットシステムのブロック図である。 実施の形態における退避動作の方向の許容範囲を説明する図である。 実施の形態における運転制御のフローチャートである。 実施の形態における第２のロボットシステムのブロック図である。

図１から図５を参照して、実施の形態におけるロボット制御装置について説明する。図１は、本実施の形態におけるロボットシステムの概略図である。ロボットシステムは、ワークＷの搬送を行うロボット１と、ロボット１を制御するロボット制御装置としての制御装置２とを備える。

本実施の形態のロボット１は、アーム１２と複数の関節部１３とを含む多関節ロボットである。ハンド１７は、ワークＷを把持したり解放したりする機能を有する。ロボット１は、アーム１２を支持するベース部１１を備える。ベース部１１は、設置面２０に固定されている。

ロボット１は、それぞれの関節部１３を駆動するアーム駆動装置を含む。アーム駆動装置は、関節部１３の内部に配置されているアーム駆動モータ１４を含む。アーム駆動モータ１４が駆動することにより、アーム１２を関節部１３にて所望の角度に曲げることができる。また、本実施の形態のロボット１は、アーム１２の全体が鉛直方向に延びる回転軸の周りを回転可能に形成されている。アーム駆動装置は、ベース部１１に配置され、アーム１２の全体を回転させる駆動モータを含む。

ロボット１は、ハンド１７を閉じたり開いたりするハンド駆動装置を備える。本実施の形態のハンド駆動装置は、空気圧によりハンド１７を駆動する。ハンド駆動装置は、ハンド１７に接続されたハンド駆動シリンダ１８と、ハンド駆動シリンダ１８に圧縮空気を供給するための空気ポンプおよび電磁弁を含む。

ロボット１は、制御装置２の動作指令に基づいて駆動する。アーム駆動装置およびハンド駆動装置は、制御装置２により制御されている。例えば、アーム駆動モータ１４の回転角度およびハンド駆動シリンダ１８の空気圧は制御装置２により制御されている。

図２に、本実施の形態における第１のロボットシステムのブロック図を示す。図１および図２を参照して、本実施の形態におけるロボット１は、動作プログラム４１に基づいてワークを搬送することができる。ロボット１は、自動的に初期の位置から目標の位置までワークＷを搬送することができる。制御装置２は、バスを介して互いに接続されたＣＰＵ（Central Processing Unit）、ＲＡＭ（Random Access Memory）、およびＲＯＭ（Read Only Memory）等を有する演算処理装置を含む。

制御装置２には、ロボット１の動作を行うために予め定められた動作プログラム４１が入力される。動作プログラム４１は、動作プログラム記憶部４２に記憶される。動作制御部４３は、動作プログラム４１に基づいてロボット１を駆動するための動作指令を送出する。動作制御部４３は、アーム駆動部４４にアーム駆動装置を駆動する動作指令を送出する。アーム駆動部４４は、アーム駆動モータ１４等を駆動する電気回路を含み、動作指令に基づいてアーム駆動モータ１４等に電力を供給する。アーム駆動モータ１４が駆動することにより、アーム１２の折れ曲がり角度やアーム１２の方向などが調整される。

また、動作制御部４３は、ハンド駆動部４５にハンド駆動装置を駆動する動作指令を送出する。ハンド駆動部４５は、空気ポンプ等を駆動する電気回路を含み、動作指令に基づいてハンド駆動シリンダ１８に圧縮空気が供給される。ハンド駆動シリンダ１８に供給する空気の圧力を調整することによりハンド１７が開閉する。

ロボット１は、関節部１３に作用する力を検出する力検出器１９を備える。本実施の形態では、それぞれの関節部１３ごとに力検出器１９が配置されている。力検出器１９は、関節部１３に加わる力の大きさと力の方向を検出可能に形成されている。力検出器１９としては、例えば、直交する３軸の方向の力及び直交する３軸の周りのモーメントを検出できる６軸力覚センサを採用することができる。また、アーム１２の先端とハンド１７との間にも力検出器が取り付けられていても構わない。

本実施の形態におけるロボット１は、ロボットの位置および姿勢を検出する状態検出器１６を含む。状態検出器１６は、ツール先端点等のアーム１２の基準点に関する位置、関節部１３におけるアーム１２の折れ曲がり状態、およびアーム１２が向いている方向等を検出する。状態検出器１６の出力は制御装置２に入力される。

本実施の形態における状態検出器１６は、それぞれのアーム駆動モータ１４に取り付けられた回転角検出器１５を含む。回転角検出器１５は、アーム駆動モータ１４が駆動するときの回転角度を検出する。それぞれのアーム駆動モータ１４の回転角度に基づいて、関節部１３における角度を検出することができる。また、状態検出器１６は、アーム１２のベース部１１に対する回転角度を検出する回転角検出器を含む。検出した回転角度に基づいてアーム１２が延びている方向を検出することができる。

本実施の形態の制御装置２は、ロボット１を停止した状態にするための指令を動作制御部４３に送出する停止指令部４６を含む。停止指令部４６は、ロボット１が駆動している期間および停止している期間のいずれの状態においても、駆動を停止する指令を送出できるように形成されている。動作制御部４３は、停止指令を受信すると動作プログラム４１の実行を停止する。そして、ロボット１の駆動が停止される。ロボット１が停止している期間中に停止指令が発信された場合は、動作制御部４３は、ロボット１の停止状態を維持する。

制御装置２は、判定値記憶部５６を有する。判定値記憶部５６には、後述するように、退避動作を行うときの角度の許容範囲を定める判定値５５が予め入力される。判定値記憶部５６は、角度の判定値を記憶する。停止指令部４６は、判定値記憶部５６から角度の判定値を読み込む。なお、動作プログラム記憶部４２および判定値記憶部５６等の記憶部は、１つの記憶部が共用されていても構わない。

制御装置２は、教示操作盤４９を備える。教示操作盤４９は、ティーチングペンダントとも称される。教示操作盤４９は、作業者がロボット１を任意の位置に動かした後に、その位置を教示点として制御装置２に記憶させるための操作盤である。教示操作盤４９には、ロボット１を操作するために必要なスイッチやボタンが配置されている。教示操作盤４９は、作業者の操作に対応する信号を動作制御部４３に送出する。動作制御部４３は、教示操作盤４９から受信した信号に基づいてアーム駆動モータ１４およびハンド駆動シリンダ１８を駆動する。

制御装置２は、教示操作盤４９の操作により指定された教示点を記憶する教示点記憶部５２を備える。教示点記憶部５２は、状態検出器１６の出力に基づいて教示点を記憶する。制御装置２は、記憶された教示点に基づいてロボット１の再生動作を実施する指令を送出する再生動作指令部５３を備える。再生動作指令部５３の出力は動作制御部４３に送出される。

本実施の形態のロボットシステムは、動作プログラム４１に基づいてロボット１を駆動することができるように形成されている。また、本実施の形態のロボットシステムは、作業者が手動にてロボット１を操作することができるように形成されている。はじめに、作業者がロボット１を手動で動作させる場合の制御について説明する。

制御装置２は、ロボット１がロボット１以外の物体（以下、単に「他の物体」と称する）に接触しているか否かを判定する接触検出部４７を備える。他の物体には、ロボット１の周りの機器や作業員等の人が含まれる。接触検出部４７には、力検出器１９の出力信号が入力される。ロボット１が動作している期間中に、ロボット１が外部からの力（以下、「外力」と称する）を受ける場合がある。接触検出部４７は、ロボット１に作用する外力を検出できるように形成されている。アーム１２に加わる力は、力検出器１９により検出することができる。

制御装置２には、ロボットを駆動するためのパラメータが入力される。パラメータには、質量パラメータが含まれる。質量パラメータは、ロボット１に作用する内力を推定するためのロボット１の各部位の質量やワークＷの質量に関連する情報を含む。

接触検出部４７は、ロボット１の質量およびロボット１の動作により生じる内力を推定する。内力は、ロボット１の外側から力が加えられていない状態で、ロボット１が動作した時に、自重によりロボット１に作用する力である。内力は、状態検出器１６により検出したロボット１の位置および姿勢と、質量パラメータとに基づいて算出することができる。

接触検出部４７は、力検出器１９により検出された力から推定した内力を減算することにより外力を算出することができる。接触検出部４７は、算出した外力を接触判定値と比較する。そして、接触検出部４７は、算出された外力が接触判定値よりも大きい場合には、ロボット１に他の物体が接触していると判定することができる。

なお、他の物体がロボットに接触しているか否かを判別する制御は、任意の制御を採用することができる。例えば、アーム駆動装置のモータの外乱電流に基づいて外乱トルクを推定することができる。そして、外乱トルクが予め定められた判定値を超える場合に、ロボット１が他の物体に接触していると判定することができる。または、アームおよび関節部の表面を、接触センサを有する覆い部材にて覆うことができる。他の物体がロボットに接触すると、接触センサから信号が発信されて、他の物体がロボットに接触したことを検出することができる。

本実施の形態の制御装置２は、ロボット１の動作を停止させるための停止指令部４６を備える。停止指令部４６は、ロボットが所定の状態になった場合に、ロボット１を停止させる信号を動作制御部４３に送出する。ロボット１が動作している場合には、動作制御部４３は、ロボット１の動作を停止する。ロボット１が停止している期間中には、動作制御部４３は、ロボット１の停止状態を維持する。

作業者は、ロボット１が他の物体に接触したことを認識した場合には、ロボット１の他の物体に接触している部分が、他の物体から退避するように教示操作盤４９の操作を行う。本実施の形態の制御装置２では、ロボット１が他の物体に接触した時のロボットの動作方向の許容範囲が予め定められている。すなわち、ロボットが退避する方向の許容範囲が予め定められている。

図３に、ロボットの動作方向の許容範囲を説明する概略図を示す。図３に示す例では、他の物体６１の表面に、ワークＷまたはロボット１の一部分が接触したときの図である。例えば、ロボット１のアーム１２が他の物体６１の接触点８１に接触する。他の物体６１に力の作用する方向は、矢印９２によって示されている。ロボット１に作用する外力の方向は、矢印９１に示すように、他の物体６１に力の作用する方向と反対向きになる。

図２および図３を参照して、本実施の形態の接触検出部４７は、ロボット１に外力が作用する作用点と外力が作用する方向を検出可能に形成されている。本実施の形態では、ロボット１が退避する時に退避の基準となる方向を基準方向と称する。この例では、基準方向は、矢印９１に示す他の物体６１から外力が作用する方向に設定される。接触検出部４７は、接触点８１の位置と外力が作用する方向とに基づいて基準方向を設定する。作業者は、ロボット１の接触点８１に接触した部分が他の物体６１から離れるようにロボット１を操作する。

停止指令部４６は、ロボット１の動作を監視する動作方向監視部４８を備える。ロボット１の動作方向に関する角度判定値θは、予め定められている。角度判定値θは、判定値５５として予め判定値記憶部５６に記憶されている。動作方向監視部４８は、基準方向に対して角度判定値θの範囲内の方向を許容範囲に設定する。このように、動作方向監視部４８は、角度判定値θおよび接触点８１の位置に基づいて、ロボットの動作方向の許容範囲を設定する。

また、動作方向監視部４８は、ロボット１が他の物体６１に接触した後のロボット１の動作方向を検出する。ロボット１の動作方向は、状態検出器１６の出力に基づいて検出することができる。状態検出器１６は、退避動作を行っているときのロボット１の状態を動作方向監視部４８に送出する。例えば、動作方向監視部４８は、回転角検出器１５等の出力により、実際のロボット１の位置および姿勢の変化を検出することができる。そして、動作方向監視部４８は、ロボット１の位置および姿勢の変化に基づいて、ロボットの動作方向を算出することができる。

ロボット１が実際に動作する方向の検出方法としては、この形態に限られず、任意の方法を採用することができる。たとえば、ロボット１が実際に動作する方向は、教示操作盤４９から動作制御部４３に送出される信号に基づいて検出しても構わない。または、ロボット１が実際に動作する方向は、動作制御部４３からアーム駆動部４４に送出される動作指令に基づいて検出しても構わない。

動作方向監視部４８は、ロボット１が許容範囲内にて動作している場合には、ロボットの動作を許可する。すなわち、停止指令部４６は、動作制御部４３にロボット１の停止指令を送出しない。一方で、動作方向監視部４８は、実際のロボット１の動作方向が、許容範囲から外れる場合にはロボット１の動作を禁止する。すなわち、停止指令部４６は、ロボット１を停止する指令を動作制御部４３に送出する。動作制御部４３は、停止指令に従ってロボット１の駆動を停止する。

このように、動作方向監視部４８は、ロボット１が他の物体に接触している場合に、他の物体から適切に離れる方向の動作を許可する。一方で、動作方向監視部４８は、他の物体から望ましくない方向に離れる動作を禁止する。このために、作業者は、他の物体を傷つけたり、ロボットに損傷を与えたりする動作を回避しながら安全に操作することができる。または、他の物体が人である場合には、人の安全性を確保することができる。

なお、ロボットが人に接触した場合には、人は速やかにロボットから離れる場合が多い。すなわち、短時間でロボット１が人から離れた状態になる。本実施の形態における動作方向監視部４８は、他の物体にロボットが接触している期間中に、ロボットの動作を監視する。一方で、動作方向監視部４８は、ロボット１の接触がない場合には、ロボット１の動作を監視しない。このために、ロボット１の接触が解消された直後には、ロボット１を自由に動作させることができる。

図４に、本実施の形態における運転制御のフローチャートを示す。図４に示す制御は、教示操作盤４９にて作業者がロボットを手動にて駆動している期間中に行うことができる。また、この制御は、所定の時間間隔ごとに繰り返して行うことができる。

図２および図４を参照して、ステップ７１において、接触検出部４７は、ロボット１が他の物体に接触しているか否かを判別する。ロボット１が他の物体に接触していない場合には、この制御を終了する。ロボット１が他の物体に接触している場合には、ステップ７２に移行する。

ステップ７２において、動作方向監視部４８は、ロボット１の実際の動作方向を検出する。次に、ステップ７３において、動作方向監視部４８は、検出した動作方向が許容範囲内であるか否かを判別する。ロボット１の動作方向が許容範囲内である場合には、ステップ７１に戻り、ロボット１の動作の監視を繰り返す。ステップ７３において、ロボット１の動作方向が許容範囲から外れた場合には、ステップ７４に移行する。

ステップ７４においては、ロボット１の動作を停止する。停止指令部４６は、動作制御部４３に対してロボット１の動作を停止する指令を送出する。

この制御により、ロボット１が他の物体に接触している期間中にロボット１の動作方向の監視を実施し、ロボット１が他の物体から離れると共に監視を終了することができる。なお、上記の実施の形態では、ロボットの動作方向の監視は他の物体との接触を検出すると共に開始しているが、この形態に限られず、ロボットの動作方向の監視は他の物体との接触を検出した後にロボットがはじめて停止した時に開始しても構わない。

本実施の形態の制御では、前述のように、ロボット１又はワークＷが他の物体に接触した時に、他の物体から離れるための基準方向を設定する。上記の制御装置では、外力の作用点および外力の方向を検出できるために、外力がロボットに作用する方向を基準方向に設定している。基準方向の設定方法としては、この形態に限られず、他の物体がロボットから離れる任意の方向を採用することができる。

例えば、ロボットが接触センサを有する覆い部材にて覆われている場合には、外力がロボットに作用する作用点を検出することができる。ところが、外力がロボットに作用する方向は検出されない。このため、基準方向としては、作用点における覆い部材の表面の法線方向のうち他の物体から離れる方向を設定することができる。すなわち、覆い部材の表面に垂直な方向をロボットが動作する適切な方向として基準方向に設定することができる。

または、ロボットを手動にて駆動しているときに、ロボットの軌跡を記憶部に記憶しておくことができる。例えば、記憶部は、予め定められた時間間隔ごとにロボットの位置および姿勢を記憶しておくことができる。ロボットが他の物体と接触した場合には、記憶した軌跡に沿って、逆方向に進む方向を基準方向に設定することができる。この場合には、基準方向が曲線になる場合がある。そして、記憶している軌跡に対して、予め定められた距離の範囲を許容範囲に設定することができる。

例えば、ロボット１のベース部１１に、力検出器を配置することができる。ロボットのベース部１１に力検出器を配置した場合には、ロボット１に加わる外力の方向は検出できるが、ロボット１に加わる外力の作用点を検出することができない。このような場合においても、記憶している軌跡に沿って退避させる方向を基準方向に採用することができる。この方法は、他の物体が停止している状態、または他の物体がロボットよりも遅く動く場合に効果的である。

または、ロボット１が他の物体が接触した時に、記憶した軌跡のうち直前の移動点を検出する。そして、接触した時の位置から接触する直前の位置に向かう方向を基準方向に設定することができる。このように、予め定められた時間間隔ごとにロボットの位置および姿勢が制御されている場合には、接触した時の位置から直前の位置に向かう方向を基準方向に設定することができる。そして、基準方向に基づいてロボットが離れる時の許容範囲を設定することができる。

上記の例では、教示操作盤４９によりロボットを手動にて操作する場合について説明した。ロボットを手動操作する方法は、この形態に限られず、任意の方法を採用することができる。例えば、ロボットの先端に作業者が操作可能なハンドル（ハンドガイド）を配置する。そして、ロボットシステムは、作業員がハンドルを操作すると共に教示点を記憶するダイレクトティーチング装置を備えることができる。ダイレクトティーチング装置では、作業員が直接的にロボットの動作を教示することができる。

次に、ロボットの自動運転における制御について説明する。図２を参照して、本実施の形態における制御装置２は、動作プログラム４１に基づいてロボットを駆動できるように形成されている。動作プログラム４１には、例えば、ロボットが自動的に駆動している期間中に他の物体に接触した場合には、接触点から退避する指令が含まれる場合がある。本実施の形態の動作方向監視部４８は、動作プログラムに基づいて退避動作を実行している期間中にも、ロボット１の動作が正常か否かを監視することができる。そして、ロボット１の退避方向が許容範囲を超える場合には、停止指令部４６は、ロボット１を停止させることができる。

図５に、本実施の形態における第２のロボットシステムのブロック図を示す。図５には、制御装置２の部分が記載されている。ロボットの構成は、第１のロボットシステムと同様である（図２参照）。第２のロボットシステムの制御装置２は、ロボットを手動にて操作して、ロボットの動作を教示する教示モードと、ロボット１が教示された動作を自動的に再生する再生モードとを切替え可能に形成されている。制御装置２は、教示モードと再生モードとを切り替える切替えスイッチ５０を含む。

切替えスイッチ５０において、作業者が教示モードを選択した場合には、ロボット１に教示点を教示する為に教示操作盤４９にてロボット１が操作される。教示点記憶部５２は、作業者により設定された教示点を記憶する。これに対して、切替えスイッチ５０において、作業者が再生モードを選択した場合には、再生動作指令部５３は、教示点記憶部５２に記憶された教示点に基づいて軌道を生成する。再生動作指令部５３は、生成された軌跡に沿ってロボット１が動作する指令を動作制御部４３に送出する。

制御装置２は、ロボット１と他の物体とが接触した場合に、ロボット１を他の物体から離れる方向に自動的に動作させる退避指令部５１を備える。退避指令部５１により指令されるロボット１の動作の方向としては、前述の様に、ロボット１が他の物体から離れる方向を採用することができる。ロボット１と他の物体との接触が検出された場合に、退避指令部５１は、ロボット１の退避動作を行う指令を動作制御部４３に送出することができる。

切替えスイッチ５０により再生モードが選択された場合には、停止指令部４６による制御を停止して、退避指令部５１による制御を実施する。一方で、切替えスイッチ５０により教示モードが選択された場合には、退避指令部５１による制御を停止して、停止指令部４６による制御を実施する。

このように、切替えスイッチ５０を設けて、ロボットが他の物体に接触したときのロボットの動作を切替えることができる。再生モードでは、他の物体にロボットが接触した場合に、他の物体から離れる方向にロボットが自動的に移動する。このために、他の物体を傷つけることを抑制することができる。また、教示モードでは、他の物体にロボットが接触した場合に、動作方向監視部がロボットの動作方向を監視する。このため、作業者が誤った操作をしても、他の物体を傷つけることを抑制することができる。そして、ロボットが他の物体に接触しない状態になると、自由にロボットを操作することができる。

本実施の形態のロボット制御装置は、人とロボットが協調して作業を行う協調ロボットを備えるロボットシステムに好適である。例えば、ロボットと作業者が１つの作業を行うロボットシステムに好適である。または、ロボットと作業者とが互いに異なる作業を行う状態で、作業者とロボットとの間に安全柵が設けられていないロボットシステムに好適である。

本実施の形態においては、多関節ロボットを例示して説明したが、この形態に限られず、任意のロボットを制御するロボット制御装置に本発明を適用することができる。

上述のそれぞれの制御においては、機能および作用が変更されない範囲において適宜ステップの順序を変更することができる。上記の実施の形態は、適宜組み合わせることができる。上述のそれぞれの図において、同一または相等する部分には同一の符号を付している。なお、上記の実施の形態は例示であり発明を限定するものではない。また、実施の形態においては、特許請求の範囲に示される実施の形態の変更が含まれている。

１ ロボット
２ 制御装置
１５ 回転角検出器
１６ 状態検出器
４７ 接触検出部
４８ 動作方向監視部
４９ 教示操作盤
５０ 切替えスイッチ
５１ 退避指令部
５５ 判定値
６１ 物体

Claims (3)

1. ロボットがロボット以外の物体に接触しているか否かを判定する接触検出部と、
   ロボットが前記物体に接触した後のロボットの動作方向を検出し、ロボットの動作を監視する動作方向監視部とを備え、
   接触検出部は、ロボットと前記物体とが接触した時にロボットが退避する基準の方向となる基準方向を設定し、
   前記基準方向は、ロボットが前記物体から離れる方向であり、
   動作方向監視部は、基準方向に対する予め定められた角度の範囲を許容範囲に設定し、ロボットが前記物体に接触した後に、許容範囲内のロボットの動作を許可し、許容範囲から外れるロボットの動作を禁止することを特徴とする、ロボット制御装置。
2. 作業者がロボットを手動にて操作してロボットの動作を教示する教示モードと、ロボットが教示された動作を自動的に再生する再生モードとの切替えが可能な切替えスイッチと、
   ロボットと前記物体とが接触した場合に、ロボットを前記物体から離れる方向に自動的に動作させる退避指令部とを備え、
   前記切替えスイッチにより再生モードが選択された場合に、ロボットと前記物体とが接触した時に退避指令部によりロボットを動作させ、
   前記切替えスイッチにより教示モードが選択された場合に、ロボットと前記物体とが接触した時に動作方向監視部によりロボットの動作を監視する、請求項１に記載のロボット制御装置。
3. 動作方向監視部は、ロボットの動作方向が前記許容範囲を外れた場合には、ロボットを停止する、請求項１または２に記載のロボット制御装置。

Images