JP2016193473A - 駆動制御装置および安全制御システム - Google Patents
駆動制御装置および安全制御システム Download PDFInfo
- Publication number
- JP2016193473A JP2016193473A JP2015074970A JP2015074970A JP2016193473A JP 2016193473 A JP2016193473 A JP 2016193473A JP 2015074970 A JP2015074970 A JP 2015074970A JP 2015074970 A JP2015074970 A JP 2015074970A JP 2016193473 A JP2016193473 A JP 2016193473A
- Authority
- JP
- Japan
- Prior art keywords
- safety
- danger
- distance
- danger source
- source
- 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
Abstract
【課題】 工場や港湾等において、産業用機械の処理能力の低下を抑えつつ、産業用機械に起因する危険の発生を未然に回避し、安全を維持するための技術的手段を提供する。
【解決手段】 アクチュエータ50−kは、危険源である産業用機械を動作させる装置である。危険源と保護対象である人体との距離が閾値以内になったことを安全センサ60が検出すると、安全コントローラ20は、危険源に危険回避のための安全動作を行わせる。安全空間監視装置10は、監視対象エリア内を監視し、危険源および人体の所在を示す空間情報を生成してコントローラ30へ送信する。コントローラ30は、空間情報に基づいて危険源と人体との距離を監視し、危険源と人体との距離の閾値への接近に応じて、危険源に危険回避動作を行わせる。
【選択図】図1
【解決手段】 アクチュエータ50−kは、危険源である産業用機械を動作させる装置である。危険源と保護対象である人体との距離が閾値以内になったことを安全センサ60が検出すると、安全コントローラ20は、危険源に危険回避のための安全動作を行わせる。安全空間監視装置10は、監視対象エリア内を監視し、危険源および人体の所在を示す空間情報を生成してコントローラ30へ送信する。コントローラ30は、空間情報に基づいて危険源と人体との距離を監視し、危険源と人体との距離の閾値への接近に応じて、危険源に危険回避動作を行わせる。
【選択図】図1
Description
本発明は、産業用機械等を駆動制御する駆動制御装置およびその駆動制御装置を含む安全制御システムに関する。
工場の機械室や港湾等では、巻き取り機、クレーン、多関節ロボットなどの産業用機械と、作業者などの人体とが接触して事故が発生する虞がある。従って、産業用機械は、人体等の保護対象にとっての危険源であるということができる。なお、作業者などの人体の他、鳥や動物、危険源である産業用機械を制御する制御手段の制御下にない他の機械等が保護対象となる場合もある。
危険源である産業用機械が設置される機械室や港湾(以下、機械室等という)には、一般に、安全を維持するための安全制御システムが適用される。安全制御システムの一例としては、危険源である産業用機械の周囲に設定された境界(以下、安全境界という)の内側に人体が侵入したこと、すなわち、危険源と保護対象との距離が所定の閾値以内になったことをセンサにより検出し、産業用機械に非常停止等の安全動作を行わせるものがある。このような安全制御システムは、例えば、特許文献1に開示されている。
ところで、上述した従来の安全制御システムでは、安全動作が起動される危険源と保護対象との距離の閾値を十分に大きな値に設定し、危険源から十分離れた位置に安全境界を設けていた。これは、危険源と保護対象との接近を早期に検出して、安全動作を早期に開始させ、危険を未然にかつ確実に回避するためである。しかし、このような安全制御システムでは、危険源から安全境界までの距離(すなわち、閾値)が長く、安全境界内のエリアが広いため、人体が安全境界内へ頻繁に侵入し、安全動作が頻発する虞がある。
ここで、安全動作により産業用機械が非常停止すると、危険は回避されるものの、産業用機械が非常停止した分だけ稼働率(=稼働時間/全運転時間)が低下し、その結果、産業用機械の単位時間当たりの処理能力(スループット)が低下する。そして、安全境界内のエリアを広くした場合には、産業用機械の非常停止が頻繁に行われるため、産業用機械の単位時間当たりの処理能力、稼働率の低下は、著しいものとなる。
本発明は以上に説明した課題に鑑みて為されたものであり、産業用機械の処理能力の低下、稼働率の低下を抑えつつ、産業用機械に起因する危険の発生を未然に回避し、安全を維持するための技術的手段を提供することを目的とする。
上記課題を解決するために本発明による安全制御システムは、安全動作制御手段と空間情報出力手段と駆動制御装置とを有している。安全動作制御手段は、危険源と保護対象との距離が閾値以下になった場合に前記危険源に危険回避のための安全動作を行わせる。空間情報出力手段は、前記危険源および前記保護対象の所在を示す空間情報を生成する。駆動制御装置は、前記空間情報に基づいて前記危険源と前記保護対象との距離を監視し、前記危険源と前記保護対象との距離の前記閾値への接近に応じて、前記危険源に危険回避動作を行わせる。
本発明による安全制御システムの駆動制御装置は、安全動作が行われる危険源と保護対象との距離の閾値に対して、危険源と保護対象との距離が接近することに応じて、危険源に危険回避動作を行わせる。従って、安全動作が行われる頻度を少なくすることができる。また、安全動作に先立って危険回避動作が行われるため、安全動作が行われる危険源と保護対象との距離の閾値を小さくしても、安全動作が成功する可能性を高くすることができる。
本発明によれば、産業用機械の処理能力の低下、稼働率の低下を抑えつつ、産業用機械に起因する危険の発生を未然に回避し、安全を維持することができる。
以下、図面を参照しつつ本発明の実施形態を説明する。
(第1実施形態)
図1は、この発明の第1実施形態による安全制御システム1の構成を示すブロック図である。図2は、安全制御システム1の各構成要素の機能を示す図である。安全制御システム1は、安全空間監視装置10、安全コントローラ20、コントローラ30、安全ドライブ機器40−k(k=1〜n、nは1以上の整数、図示の例ではn=3)、アクチュエータ50−k(k=1〜n、nは1以上の整数、図示の例ではn=3)、安全センサ60および安全バス70を含んでいる。安全空間監視装置10、安全コントローラ20、コントローラ30、安全ドライブ機器40−kおよび安全センサ60は、Ethernet(登録商標)やRS−485等の産業用ネットワークをベースとした安全通信方式(以下、安全バス70)を介して接続されている。
(第1実施形態)
図1は、この発明の第1実施形態による安全制御システム1の構成を示すブロック図である。図2は、安全制御システム1の各構成要素の機能を示す図である。安全制御システム1は、安全空間監視装置10、安全コントローラ20、コントローラ30、安全ドライブ機器40−k(k=1〜n、nは1以上の整数、図示の例ではn=3)、アクチュエータ50−k(k=1〜n、nは1以上の整数、図示の例ではn=3)、安全センサ60および安全バス70を含んでいる。安全空間監視装置10、安全コントローラ20、コントローラ30、安全ドライブ機器40−kおよび安全センサ60は、Ethernet(登録商標)やRS−485等の産業用ネットワークをベースとした安全通信方式(以下、安全バス70)を介して接続されている。
安全制御システム1は、例えば、危険源である産業用機械が設置される工場の機械室や港湾などに適用される。産業用機械は、例えば、巻き取り機やクレーンや多関節ロボットなどである。安全制御システム1は、このような危険源の存在する機械室等において安全を維持するためのシステムである。
安全制御システム1のアクチュエータ50−kは、危険源である産業用機械を動作させる装置である。例えば危険源が紙を紙管にロール状に巻き取る巻き取り機である場合、アクチュエータ50−kは、紙管を回転させるモータなどである。
安全センサ60は、監視対象エリア内を監視し、監視対象エリア内において危険源から所定距離だけ隔たった安全境界を越えて危険源に保護対象たる人体が接近したこと、すなわち、危険源と保護対象との距離が所定の閾値以内になったことを検知する手段である。この安全センサ60の一例としては、産業用機械の周囲に設置された安全境界の役割を果たす安全柵の開閉を検知するセンサなどが挙げられる。安全センサ60は、検出結果に基づいて安全信号を生成して、生成した安全信号を安全バス70を介して安全コントローラ20へ出力する。また、安全センサ60は、操作に応じて安全信号を出力する操作子(例えば、非常停止ボタンなど)を含んでいても良い。
図3は、安全信号の構成例を示す図である。図4は、安全機能の内容を示す図である。図3に示すように、安全信号は、安全機能の起動を指示する複数の安全コマンドを時間多重した信号である。図3に示す例では、1個の安全コマンドは8ビット(bit)からなり、各ビットは各々安全機能に対応している。具体的には、8ビットの先頭ビットは、安全トルクオフ(STO)に対応し、8ビットの先頭から2番目のビットは、安全停止1(SS1)に対応し、8ビットの先頭から3番目のビットは、安全速度制限(SLS)に対応する、という具合である。そして、この安全コマンドでは、起動を指示された安全機能に対応したビットのみが“1”とされ、他の安全機能に対応したビットは“0”とされる。なお、いずれの安全機能の起動も指示されていない状態では、安全コマンドは、8ビットのすべてが“0”とされる。また、危険源が複数ある場合には、安全信号は、各危険源に対応する安全コマンドを含む。
安全センサ60は、ある危険源と保護対象たる人体との距離が所定の閾値以内になったことを検知すると、当該危険源に安全動作を行わせるための安全コマンドを生成する。以下では、この安全動作を行わせる危険源と保護対象との距離の閾値を第1の閾値という。この第1の閾値は、危険源から見た保護対象の方角によらず一定の値としてもよいが、方角により異なった値としてもよい。安全コマンドにおいて起動する安全機能は、予め設定されていても良い。そして、安全センサ60は、この安全コマンドを組み込んだ安全信号を安全バス70に出力する。
安全コントローラ20は、安全信号に応じて危険源に危険回避のための安全動作を行わせる安全動作制御手段である。安全コントローラ20は、安全センサ60が出力する安全信号を安全バス70を介して取得する。安全コントローラ20は、取得した安全信号の中から安全機能の起動を指示している安全コマンドを取り出す。そして、取り出した安全コマンドが例えばアクチュエータ50−kにより駆動される危険源に安全動作を行わせる安全コマンドである場合、その安全コマンドの指示に従って安全指令を生成し、安全バス70を介して安全ドライブ機器40−kへ出力する。また、安全コントローラ20は、安全機能の起動を指示する安全コマンドを全く含まない安全信号を取得した場合、安全を維持している旨の情報を安全バス70を介してコントローラ30へ出力する。
安全空間監視装置10は、監視対象エリア内を監視し、危険源および保護対象たる人体の所在を示す空間情報を生成して送信する空間情報出力手段である。より詳細には、安全空間監視装置10は、機械室等の床から上の空間を監視対象エリアとし、その監視対象エリアにおける危険源および人体を監視する。そして、安全空間監視装置10は、監視結果に基づいて空間情報を生成して、生成した空間情報を安全バス70を介してコントローラ30へ出力する。
図5は、空間情報の内容を例示する図である。空間情報には、例えば、三次元空間内の人体(図5では作業者)の位置、人体(図5では作業者)のサイズ、三次元空間内の危険源の位置および危険源のサイズを示す情報が人体および危険源毎に含まれている。このように、空間情報は、監視対象エリア内の危険源および人体の所在を示している。
安全空間監視装置10の構成について、より詳細に説明する。図1に示すように、安全空間監視装置10は、撮像機器11、画像処理装置12、異常検出部13、安全信号出力部14、外部通信インターフェース(以下、インターフェースをI/Fと表記する)装置15を含んでいる。
撮像機器11は、監視対象エリア内の危険源や人体などの監視対象を撮像する装置である。撮像機器11は、例えば、ステレオカメラや三次元レーザースキャナや赤外線スキャナなどである。例えば、撮像機器11がステレオカメラである場合、撮像機器11は2台のカメラである。撮像機器11は、2台のカメラの撮像結果を示す各撮像データを画像処理装置12に引き渡す。
画像処理装置12は、撮像機器11から引き渡される撮像データを用いた画像処理を行う集積回路である。画像処理装置12は、撮像データから危険源の抽出および人体の抽出を行い、危険源や作業者の表面各部の三次元位置座標を求める。具体的には、画像処理装置12は、撮像機器11を構成する2台のカメラによって撮像された危険源および人体の像の各部の撮像画面内での位置に基づいて、三角測量の原理により、撮像機器11から危険源および人体の表面各部までの距離dを算出する。次いで、画像処理装置12は、撮像機器11の撮像面における危険源および人体の像の各位置(uv座標)と各位置に対応付けられた距離dとから、危険源および人体の表面各部の三次元位置座標(xyz座標)を求める。そして、画像処理装置12は、このようにして求めた危険源および人体の表面各部の三次元位置座標データを用いて、危険源および人体の三次元空間内の位置(代表点の位置)およびサイズを含む空間情報を生成する。この際、画像処理装置12は、外部へ出力可能なデータ形式で空間情報を生成する。
異常検出部13は、安全空間監視装置10内の各機器の故障や同各機器における異常処理を検出し、安全信号を生成する装置である。例えば、異常検出部13は、撮像機器11によって取得される撮像データの欠落(具体的には、撮像素子の画素の常時点灯もしくは常時消灯、画素ラインの喪失、ブラックアウト、ホワイトアウトなど)、入出力配線の切断、入出力の際の応答なし、入出力の際の巡回冗長検査(CRC)エラー、入出力データの順番の入り違い、メモリに格納されるデータの損傷、演算装置の故障(具体的には、演算エラー)などを検出する。図6は、故障個所と故障検出方法を例示する図である。故障検出方法は、従来と同様であるため、説明を省略する。
異常検出部13は、上記の故障や異常処理を検出した場合、その故障や異常処理の内容に応じて動作させるべき安全機能を選択する。この故障や異常処理の内容と動作させるべき安全機能とは、予め設定によって対応付けられている。そして、異常検出部13は、その安全機能が選択された安全信号を生成する。安全信号は、安全センサ60が生成する安全信号と同様のものである。
安全信号出力部14は、異常検出部13が生成した安全信号を安全バス70へ送出可能なデータ形式へ加工する処理を行う装置である。具体的には、安全信号出力部14は、異常検出部13から引き渡された安全信号をフレーム化し、さらにそのフレームに巡回冗長検査(CRC)符号や特定の識別子(ID)や送受信番号等を付与するソフトウェア処理を行う。
外部通信I/F装置15は、安全バス70に接続されている。外部通信I/F装置15は、例えば、Ethernet(登録商標)の通信ASIC(Application Specificated Integrated Circuit;特定用途向集積回路)などである。外部通信I/F装置15は、空間情報(より正確には、画像処理装置12が生成した空間情報)と、安全信号(より正確には、安全信号出力部14においてソフトウェア処理された安全信号)とを安全空間監視装置10外へ出力する装置である。具体的には、外部通信I/F装置15は、当該安全信号を安全バス70を介して安全コントローラ20に出力し、当該空間情報を安全バス70を介してコントローラ30へ出力する。
以上が、安全空間監視装置10の構成である。
以上が、安全空間監視装置10の構成である。
安全コントローラ20は、安全空間監視装置10から図4に示した安全機能が選択された安全信号を取得した場合も、その安全機能に対応する安全指令を安全ドライブ機器40−kへ出力する。
コントローラ30は、アクチュエータ50−k(k=1〜n)を制御する制御指令を安全バス70を介して安全ドライブ機器40−k(k=1〜n)へ出力する装置である。制御指令は、例えば、アクチュエータ50−k(k=1〜n)の速度を示す速度指令などである。すなわち、コントローラ30は、危険源を制御対象としてその危険源の駆動制御を行う駆動制御装置である。コントローラ30は、例えば、プログラマブルロジックコントローラである。
本実施形態のコントローラ30は、安全空間監視装置10が出力した空間情報を安全バス70を介して取得する。コントローラ30は、複数の危険源の各々について次の処理を行う。すなわち、駆動制御装置であるコントローラ30は、取得した空間情報から各危険源と保護対象たる人体(作業者)との安全距離を各々求め、その人体との安全距離が上述した第1の閾値よりも大きい第2の閾値以下である危険源を発見した場合、その安全距離に基づいて当該危険源に危険回避動作を行わせる。この危険回避動作とは、危険を低減し、あるいは危険を未然に回避する動作であり、本実施形態では、安全距離が短くなるに従って動作速度が低下する動作である。
図7は、コントローラ30が取得した空間情報に含まれる安全距離と、危険源を駆動するアクチュエータ50−kの動作速度との関係を示す図である。図8(A)および(B)は、監視対象エリアにおける作業者の移動に伴う安全距離の変化を示した図である。以下では、危険源が巻き取り機である場合を例にコントローラ30の制御内容を説明する。図8(A)および(B)に示すように、作業者が危険源たる巻き取り機に接近すると危険源と作業者との間の安全距離は短くなる。図7において、第1の閾値th1は、危険源から安全動作の行われる安全境界までの距離である。また、第2の閾値th2は、第1の閾値th1より大きな値となっている。図7に示すように、コントローラ30は、安全距離が第2の閾値th2よりも大きい場合、アクチュエータ50−kであるモータを予め設定されている通常の回転速度で回転させるように制御指令を出力する。この状態では、人体の安全が維持されている。
一方、コントローラ30は、安全距離が第2の閾値th2以下の場合、保護対象たる人体の安全境界への接近に応じて危険源に危険回避動作を行わせる。具体的には、危険源が巻き取り機である場合、コントローラ30は、巻き取り機の巻き取り部分の回転速度を小さくする動作を危険回避動作として決定し、アクチュエータ50−kであるモータの回転速度を小さくした制御指令を出力する。この際、コントローラ30は、危険源と保護対象たる人体との距離が短くなって第1の閾値th1に接近するに従ってモータの回転速度を低下させ、危険源の動作速度を低下させる危険回避動作を危険源に行わせる。
また、図7に示すように、コントローラ30は、安全距離がゼロと第2の閾値th2との間の適当な値、より好ましくは、安全距離が第2の閾値th2と第1の閾値th1との間の適当な値(図7では閾値th1−2)以下の場合にモータの回転速度が最低値となるように制御するのが好ましい。ここで、第1の閾値th1は、安全センサ60、具体的には、安全センサ60に含まれる各種センサの配置などによって決定される。安全制御システム1では、安全距離が第1の閾値th1以下になった場合、安全信号に基づいてアクチュエータ50−kに安全動作をさせる。そして、本実施形態では、安全距離が第1の閾値th1から第2の閾値th2の範囲内にある場合、安全距離が第1の閾値th1に近づくのに応じて、アクチュエータ50−kに速度を低下させる危険回避動作を行わせる。従って、安全距離が第1の閾値th1以下になった場合に実行される安全動作が成功して危険が回避される可能性を高めることができる。
安全距離の変化に対するアクチュエータ50−kの速度の変化の態様は、図7のA1のように、安全距離の変化に比例して速度が変化する態様であっても良いし、図7のA2のように、閾値th2付近では安全距離の変化に対して速度が大きく変化する一方、閾値th1−2付近では安全距離の変化に対して速度が小さく変化する態様であっても良いし、図7のA3のように、閾値th2付近では安全距離の変化に対して速度が小さく変化する一方、閾値th1−2付近では安全距離の変化に対して速度が大きく変化する態様であっても良い。ここで、安全距離の変化に対してアクチュエータ50−kの速度をA2のように変化させる場合とA3のように変化させる場合とを比較すると、前者は後者よりも安全性が高いが、後者は前者よりもアクチュエータ50−kの処理能力の低下の度合いが小さい。従って、危険源に要求される安全性と処理能力とを比較考量し、安全距離の変化に対するアクチュエータ50−kの速度の変化の態様を決定すればよい。また、コントローラ30は、速度計算のための計算式を複数記憶し、この複数の計算式の中から例えば操作子の操作等により指定された適切な計算式を選択し、安全距離に応じた速度を算出しても良い。
図9は、コントローラ30の構成を示すブロック図である。図9に示すように、コントローラ30は、制御部310、揮発性記憶部320、不揮発性記憶部330、入出力I/F340およびこれらの各構成要素間のデータの授受を媒介するバス350を含んでいる。
入出力I/F340は、バス350に接続されている。揮発性記憶部320は、例えば、RAM(Random Access Memory)である。揮発性記憶部320は、不揮発性記憶部330に記憶されている各プログラムを実行するためのワークエリアとして使用される。不揮発性記憶部330は、例えば、フラッシュROMなどである。不揮発性記憶部330には、制御プログラム331が予め格納されている。制御プログラム331は、空間情報に基づいて危険源と保護対象たる人体との距離を監視し、危険源と保護対象との距離が第1の閾値より長い場合に、危険源と保護対象との距離の第1の閾値への接近に応じて、危険源に危険回避動作を行わせるプログラムである。制御部310は、例えば、CPU(中央演算装置)である。制御部310は、不揮発性記憶部330に記憶されている各プログラムを実行することにより、コントローラ30の制御中枢として機能する。
以上が、コントローラ30の構成である。
以上が、コントローラ30の構成である。
図1に示すように、アクチュエータ50−kには、当該アクチュエータ50−kを動作させる安全ドライブ機器40−kがアクチュエータ50−k毎に接続されている。安全ドライブ機器40−kは、例えば、インバータである。安全ドライブ機器40−kは、安全バス70を介してコントローラ30から制御指令を受信し、その制御指令に応じてアクチュエータ50−kを動作させる装置である。従って、安全ドライブ機器40−kが危険回避動作を反映した制御指令(例えば、速度が小さい制御指令など)を受信すると、アクチュエータ50−kは、危険回避動作を行う。また、安全ドライブ機器40−kが安全動作を反映した安全指令を受信すると、アクチュエータ50−kは、安全動作を行う。また、安全ドライブ機器40−kは、制御指令に従ってアクチュエータ50−kを動作させた結果を示す状態信号を安全バス70を介してコントローラ30に出力する。
安全制御システム1では、安全コントローラ20がアクチュエータ50−kに安全動作をさせる制御を行うのに独立して、コントローラ30がアクチュエータ50−kに危険回避動作をさせる制御を行う。なお、安全バス70を介して安全制御システム1の各機器間を伝送するデータをまとめたものを図10に示す。
以上が、安全制御システム1の構成である。
以上が、安全制御システム1の構成である。
次に、危険源が巻き取り機である場合を例に、安全制御システム1の動作を説明する。
図11は、安全制御システム1における各装置の動作の流れを示すフローチャートである。安全制御システム1の安全空間監視装置10の撮像機器11は、常時、監視対象エリア内の監視対象である巻き取り機と作業者を監視する。これにより、安全空間監視装置10の画像処理装置12は、撮像機器11から撮像データを逐次取得する(S110)。次に、画像処理装置12は、取得した撮像データから作業者と危険源である巻き取り機の画像を抽出する(S120)。次に、安全空間監視装置10の異常検出部13は、画像処理装置12の撮像データの取得に同期して、安全空間監視装置10内の各機器やデータの異常の検出を行う(S130)。そして、画像処理装置12は、抽出した作業者と危険源の画像とから三次元空間内における作業者と危険源の所在を示す空間情報を生成し、異常検出部13は、異常の検出結果から安全信号を生成する(S140)。その後、安全空間監視装置10の外部通信I/F装置15は、異常検出部13が生成し、安全信号出力部14においてソフトウェア処理が行われた安全信号を安全コントローラ20へ出力するとともに、画像処理装置12が生成した空間情報をコントローラ30へ出力する(S150)。
図11は、安全制御システム1における各装置の動作の流れを示すフローチャートである。安全制御システム1の安全空間監視装置10の撮像機器11は、常時、監視対象エリア内の監視対象である巻き取り機と作業者を監視する。これにより、安全空間監視装置10の画像処理装置12は、撮像機器11から撮像データを逐次取得する(S110)。次に、画像処理装置12は、取得した撮像データから作業者と危険源である巻き取り機の画像を抽出する(S120)。次に、安全空間監視装置10の異常検出部13は、画像処理装置12の撮像データの取得に同期して、安全空間監視装置10内の各機器やデータの異常の検出を行う(S130)。そして、画像処理装置12は、抽出した作業者と危険源の画像とから三次元空間内における作業者と危険源の所在を示す空間情報を生成し、異常検出部13は、異常の検出結果から安全信号を生成する(S140)。その後、安全空間監視装置10の外部通信I/F装置15は、異常検出部13が生成し、安全信号出力部14においてソフトウェア処理が行われた安全信号を安全コントローラ20へ出力するとともに、画像処理装置12が生成した空間情報をコントローラ30へ出力する(S150)。
また、安全制御システム1の安全センサ60は、常時、危険源と保護対象たる作業者との距離が第1の閾値th1以内になったか否かを各種センサによって監視する。そして、安全センサ60は、各種センサの検出結果を示すセンサ情報を逐次取得する(S210)。次に、安全センサ60は、取得したセンサ情報から安全信号を生成する(S220)。具体的には、安全センサ60は、作業者が安全境界を越えて危険源に接近したことをセンサ情報から検知した場合に安全機能が起動された安全信号を生成する。次に、安全センサ60は、生成した安全信号を安全コントローラ20へ出力する(S230)。
次に、安全制御システム1の安全コントローラ20は、安全空間監視装置10および安全センサ60から安全信号を逐次取得する(S310)。次に、安全コントローラ20は、取得した安全信号に対する処理、具体的には、巡回冗長検査(CRC)符号を用いた誤り検出処理などを行う(S320)。次に、安全コントローラ20は、安全信号(より正確にはステップS320の後の安全信号)は安全機能が選択されたものであるか否かを判定する(S330)。安全信号が安全機能の起動を指示するものである場合、安全コントローラ20は、当該安全信号は危険を知らせているとして(S330:危険)、その安全機能を起動する安全指令を安全ドライブ機器40−kへ出力する(S340)。そして、安全ドライブ機器40−kは、安全指令に従ってアクチュエータ50−kに安全動作をさせる(S530)。具体的には、安全信号が安全トルクオフを起動するものである場合、安全ドライブ機器40−kは、アクチュエータ50−kに非常停止をさせる、という具合である。一方、安全信号が何ら安全機能の起動を指示するものでない場合、安全コントローラ20は、当該安全信号は安全を維持していることを知らせているとして(S330:安全)、安全を維持している旨の情報を安全バス70を介してコントローラ30へ出力する。
次に、安全制御システム1のコントローラ30の制御部310は、電源の投入を契機として制御プログラム310を実行する。制御プログラム310の実行を開始すると、コントローラ30は、安全空間監視装置10が出力する空間情報を逐次取得する(S410)。空間情報を取得すると、制御部310は、空間情報が所定の条件を満たしているか否かを判別する(S420)。具体的には、制御部310は、空間情報から安全距離(巻き取り機の例では、巻き取り機と作業者との間の距離)を算出し、安全距離が図7の第2の閾値th2以下であるか否かを判別する。
制御部310は、空間情報が所定の条件を満たしていない場合、具体的には、安全距離が第2の閾値th2よりも大きい場合、危険回避動作が不要であるとして(S420:不要)、ステップS430からステップS450の処理を行う。すなわち、この場合、制御部310は、危険源である巻き取り機を通常運転させるべく制御指令の生成を開始して(S430)、通常動作の演算を行う(S440)。その後、制御部310は、通常動作の演算によって生成された制御指令を安全ドライブ機器40−kへ出力する(S450)。そして、安全ドライブ機器40−kは、コントローラ30からの制御指令に従ってアクチュエータ40−kに通常運転をさせる(S510)。なお、制御部310は、安全制御システム1が安全を維持している際には、安全コントローラ20から安全を維持している旨の情報を受信する。
一方、制御部310は、空間情報が所定の条件を満たしている場合、具体的には、安全距離が第2の閾値th2以下の場合、危険回避動作が必要であるとして(S420:要)、ステップS460からステップS480の処理を行う。すなわち、この場合、制御部310は、危険源である巻き取り機を危険回避動作させるべく制御指令の生成を開始して(S460)、空間情報(具体的には安全距離)に基づいて危険回避動作の演算を行う(S470)。具体的には、制御部310は、図7に示すように、アクチュエータ50−kの動作速度を通常速度よりも小さくする演算を行う。この際、制御部310は、安全距離が第2の閾値th2に近いものであれば定格速度に近い速度でアクチュエータ50−kを回転させる演算を行い、安全距離が第2の閾値th2から離れており、第1の閾値th1に近いものであれば停止に近い速度でアクチュエータ50−kを回転させる演算を行う。その後、制御部310は、危険回避動作の演算によって生成された制御指令を安全ドライブ機器40−kへ出力する(S480)。そして、安全ドライブ機器40−kは、コントローラ30からの制御指令に従ってアクチュエータ40−kに危険回避動作をさせる。これにより、巻き取り機の紙管の回転速度が安全距離に応じて小さくなる。
以上が、安全制御システム1の動作である。
以上が、安全制御システム1の動作である。
以上のように、本実施形態による安全制御システム1は、危険源と保護対象との距離が閾値以下になった場合に危険源に危険回避のための安全動作を行わせる安全動作制御手段(安全センサ60と安全コントローラ20)と、危険源および保護対象の所在を示す空間情報を生成する空間情報出力手段(安全空間監視装置10)と、空間情報に基づいて危険源と保護対象との距離を監視し、危険源と保護対象との距離の当該閾値への接近に応じて、危険源に危険回避動作を行わせる駆動制御装置(コントローラ30)とを具備している。このため、安全制御システム1によれば、従来の安全制御システムのように危険源の処理能力を大幅に低下させることなく、また、稼働率を大幅に低下させることなく、人体に危険が及ぶのを回避することができる。
さらに詳述すると、従来の安全制御システムでは、安全動作を起動する危険源と保護対象との距離の閾値(図7の第1の閾値th1)を余裕をもって十分大きな値に設定し、安全境界内の領域を十分に広くしていた。このため、作業者が頻繁に安全境界を越えて安全動作が行われ、産業用機械の単位時間当たりの処理能力が低下する可能性が高かった。また、最悪の場合、安全動作によって危険源が稼働を停止し、この場合には稼働率の大幅な低下を招いた。これに対して、本実施形態の安全制御システム1では、危険源と保護対象との距離が第1の閾値th1に接近することに応じて危険源に危険回避動作(具体的には速度の低下)を行わせるので、従来よりも安全境界を危険源に近づけたとしても、作業者が安全境界を越えて危険源に接近したときに行われる安全動作が間に合って、危険を回避することができる。従って、危険源の処理能力の低下を抑えつつ、危険回避を行うことができる。また、従来よりも安全境界を危険源に近づけ、安全境界内の領域を狭くすることができるので、保護対象たる作業者が安全境界内に侵入する頻度を減らし、安全動作が行われる頻度を減らすことができる。また、危険回避動作が行われている間に危険源と保護対象との距離が長くなり、安全動作が回避される場合もある。従って、本実施形態では、危険源の稼働率の低下を抑えることができる。このように、安全制御システム1を適用することにより、危険源たる産業用機械の処理能力の低下、稼働率の低下を抑えつつ、産業用機械に起因する危険の発生を未然に回避し、安全を維持することができる。
なお、本実施形態の安全空間監視装置10の異常検出部13は、故障等を検出した場合に安全機能の起動を指示する安全信号を生成していた。しかし、異常検出部13は、画像処理装置12から空間情報を取得し、その空間情報から安全距離を算出し、安全距離がアクチュエータ50−kに安全動作をさせるべき第1の閾値th1以下となったか否かの判定をして、その判定結果が第1の閾値th1以下となった場合に、安全機能の起動を指示する安全信号を生成しても良い。さらに、異常検出部13は、故障等を検出した場合に安全機能の起動を指示する動作と、安全距離が第1の閾値th1以下となった場合に安全機能の起動を指示する動作の両方を行っても良い。
(第2実施形態)
第2実施形態では、クレーンが天井付近に設置された工場建屋内に安全制御システム1を適用した態様について説明する。本実施形態によるアクチュエータ50−kは、クレーンを例えば東西方向および南北方向へ移動させるモータやフックを巻き上げるモータなどである。このクレーンは、重量物の吊り荷を吊って移動するものである。このため、本実施形態では、クレーン本体および吊り荷が危険源となる。
第2実施形態では、クレーンが天井付近に設置された工場建屋内に安全制御システム1を適用した態様について説明する。本実施形態によるアクチュエータ50−kは、クレーンを例えば東西方向および南北方向へ移動させるモータやフックを巻き上げるモータなどである。このクレーンは、重量物の吊り荷を吊って移動するものである。このため、本実施形態では、クレーン本体および吊り荷が危険源となる。
図12は、クレーンの移動に従って移動する吊り荷の移動経路の途中に人体が侵入した場合の吊り荷および人体を側面から見た図である。図13は、図12の場合の吊り荷および人体を天井から見た図である。図12および図13に示すように、吊り荷の移動経路の途中に人体が侵入すると、吊り荷は、人体へ向かって接近する。
本実施形態の安全空間監視装置10は、クレーンおよび吊り荷と人体とを監視し、少なくとも吊り荷の三次元空間内の位置情報と人体の三次元空間内の位置情報を含む空間情報を逐次生成し、生成した空間情報をコントローラ30へ出力する。そして、コントローラ30は、取得した空間情報が所定の条件を満たすか否かを判定して、空間情報が所定の条件を満たした場合に(具体的には、安全距離が第2の閾値th2以下となった場合に)、危険源の動作を制限する。コントローラ30は、危険源の動作を制限する際、危険回避動作の内容を決定して、その危険回避動作の演算を行う。この際、コントローラ30は、空間情報から算出した安全距離、吊り荷の移動速度、吊り荷の質量に基づいて危険回避動作の内容を決定する。
図14は、空間情報が所定の条件を満たした場合に決定される危険回避動作のパターンを例示する図である。図14に示すように、コントローラ30の制御プログラム331には、例えば、「安全停止」、「移動速度制限」および「安全距離の保持」などの各種の危険回避動作のパターンに従ってアクチュエータ50−kを動作させるための制御指令を生成する演算式が記述されている。コントローラ30は、これらの危険回避動作のパターンの中から危険源に実行させるべき危険回避動作を決定してその危険回避動作を実現するための制御指令の演算を行う。このとき、コントローラ30は、空間情報に基づいて危険回避動作のパターンを選択しても良い。例えば、コントローラ30は、通常時の吊り荷の移動速度が所定の閾値よりも大きい場合には「移動速度制限」を選択し、通常時の吊り荷の移動速度が所定の閾値よりも小さい場合には「安全距離の保持」を選択する、という具合である。また、コントローラ30は、ユーザによって予め設定された危険回避動作のパターンを選択しても良い。
図15は、危険源に実行させるべき危険回避動作が「安全停止」である場合の安全距離に対する吊り荷の移動速度を示した図である。この「安全停止」では、コントローラ30は、安全距離の減少に応じてアクチュエータ50−kの速度を低下させる。その際、コントローラ30は、安全距離が第2の閾値th2に比較的近い閾値th1−2aになったときに吊り荷の移動速度がゼロになるように、安全距離の減少に対してアクチュエータ50−kの速度を滑らかに低下させる。この「安全停止」では、吊り荷が人体に接触する危険を未然に回避することができるだけでなく、クレーンを非常停止する態様に比べ、慣性によって吊り荷の内容物が外に飛び出すなどの危険も回避することができる。
図16は、危険源に実行させるべき危険回避動作が「移動速度制限」である場合の安全距離に対する吊り荷の移動速度を示した図である。「移動速度制限」は、通常動作時における吊り荷の移動速度に比べて、小さい値に制限した移動速度で吊り荷を移動させる危険回避動作である。より詳細には、図16に示すように、コントローラ30は、安全距離が第2の閾値th2以下となった場合に、通常動作時における吊り荷の移動速度v1よりも小さい値である移動速度v2で吊り荷が移動するように、クレーンを移動させるアクチュエータ50−kの回転速度を小さくさせる制御指令を出力する。なお、図16の態様では、コントローラ30は、安全距離が非常停止などの安全動作をさせるべき第1の閾値th1に近い閾値th1−2bにおいて吊り荷の移動速度がv2からゼロになるように制御指令を出力する。
また、図17は、危険源に実行させるべき危険回避動作が「移動速度制限」である場合の吊り荷の移動速度の時間変化を示した図である。図17に示すように、コントローラ30は、安全距離が第2の閾値th2と閾値th1−2bとの間に収まっている時間中、吊り荷を移動速度v2で移動させる制御を行っている。その後、人体が吊り荷の移動軌跡から外れるなどして、安全距離が閾値th2よりも大きくなると、コントローラ30は、吊り荷の移動速度をv2からv1に戻すべく、クレーンを移動させるアクチュエータ50−kの回転速度を通常の回転速度にする制御指令を出力する。このように、この「移動速度制限」では、吊り荷の移動速度が小さいため、事故が発生したとしてもその事故の程度を低減することができる。
図18は、危険源に実行させるべき危険回避動作が「安全距離の保持」である場合の安全距離に対する吊り荷の移動速度を示した図である。図19は、図18の場合における時間に対する安全距離を示した図である。「安全距離の保持」は、安全距離を所定の安全距離(すなわち、図19に示す安全距離ボーダーth1−2c)以上に保持しつつ吊り荷を移動させる危険回避動作である。「安全距離の保持」は、例えば、図13に示すように、吊り荷の移動経路を通常の移動経路から変えて、人体を避けて吊り荷を移動させる動作などである。さらに具体的には、図13に示すように、通常時に吊り荷が南から北へ移動する態様では、コントローラ30は、安全距離が第2の閾値th2以下となった場合に、クレーンを南から北へ移動させるアクチュエータ50−kの回転速度を小さくしつつクレーンを東から西へ移動させるアクチュエータ50−kの回転速度を大きくし、吊り荷が人体よりも北に位置した後に、クレーンを南から北へ移動させるアクチュエータ50−kの回転速度を大きくしつつクレーンを西から東へ移動させるアクチュエータ50−kの回転速度を大きくする、という具合である。これにより、吊り荷は、人体を中心とした弧を描くように人体の周囲を迂回する。このとき、例えば、図18に示すように、コントローラ30は、安全距離が第2の閾値th2よりも大きい場合の吊り荷の移動速度の大きさと、安全距離が第2の閾値th2よりも小さい場合の吊り荷の移動速度の大きさが同程度になるように各アクチュエータ50−kの回転速度を制御する。この「安全距離の保持」では、危険源が人体を避けて移動するため、危険を未然に回避しつつ、産業用機械の単位時間当たりの処理能力の低下を抑えることができる。特に、「安全距離の保持」では、安全距離が第2の閾値th2以下となった後において人体が吊り荷の通常の移動経路から外れることがないような態様において、吊り荷の移動を継続することができるため、「移動速度制限」の態様に比べ、産業用機械の単位時間当たりの処理能力の低下をより抑えることができる。
本実施形態において、危険回避動作のパターンは、図14に示すものに限られない。例えば、「移動速度制限」と「安全距離の保持」とを組み合わせた危険回避動作を危険源に行わせても良い。図20は、この場合の安全距離に対する吊り荷の移動速度を示す図である。この態様のコントローラ30は、安全距離が第2の閾値th2以下になった場合に、吊り荷の移動速度をv1からv2へ小さくさせるとともに、安全距離を所定の安全距離(安全距離ボーダーth1−2c)以上に保持しつつ吊り荷を移動させる制御を行う。この態様では、危険源が人体を避けて移動するため、危険を未然に回避しつつ、産業用機械の単位時間当たりの処理能力の低下を抑えることができるとともに、吊り荷の移動速度が小さいため、事故が発生したとしてもその事故の程度を低減することができる。
(第3実施形態)
第3実施形態では、多関節ロボットが設置された機械室に安全制御システム1を適用した態様について説明する。図21は、危険源である多関節ロボットと人体(例えば作業者)とを示す図である。図21に示す多関節ロボットは、ベルトコンベア上を流れる部品をアームにより搬送して製品を組み立てるロボットであり、人体と協調して製品を組み立てる。この態様では、アームが動くため、多関節ロボット、特にアームを危険源とする。また、この態様における危険源と人体との間の安全距離は、例えば、アームの先端と人体との間の距離である。本実施形態におけるアクチュエータ50−kは、例えば、アーム間の各関節に設置されて当該アームを動かすモータなどである。
第3実施形態では、多関節ロボットが設置された機械室に安全制御システム1を適用した態様について説明する。図21は、危険源である多関節ロボットと人体(例えば作業者)とを示す図である。図21に示す多関節ロボットは、ベルトコンベア上を流れる部品をアームにより搬送して製品を組み立てるロボットであり、人体と協調して製品を組み立てる。この態様では、アームが動くため、多関節ロボット、特にアームを危険源とする。また、この態様における危険源と人体との間の安全距離は、例えば、アームの先端と人体との間の距離である。本実施形態におけるアクチュエータ50−kは、例えば、アーム間の各関節に設置されて当該アームを動かすモータなどである。
図21には、多関節ロボットの通常可動範囲と最大可動範囲とが示されている。図21の通常可動範囲は、境界Bnの内側の空間であり、多関節ロボットが通常の組み立て動作を行う際に、そのアームが移動する範囲である。このため、多関節ロボットの通常可動範囲内に人体が侵入すると、通常の組み立て動作時にアームが人体に接触する虞があり、危険である。また、図21の最大可動範囲は、境界Bmの内側の空間であり、組み立て動作に関わらず、多関節ロボットがそのアームを最大限に伸ばすことが可能な範囲である。このため、多関節ロボットの最大可能範囲内に人体が侵入すると、多関節ロボットが予期せぬ動作を行ったときに、アームが人体に接触する虞があり、危険である。すなわち、本実施形態では、安全距離が十分であったとしても、人体の位置によっては人体に危険が及ぶ。このため、本実施形態の安全制御システム1では、安全距離に加え、人体の位置によっても、多関節ロボットに危険回避動作を実行させる。
本実施形態の安全空間監視装置10は、多関節ロボットと人体とを監視し、アームの位置(すなわち、多関節ロボットの姿勢)や人体の位置、アームのサイズや人体のサイズなどを含む空間情報を逐次生成し、生成した空間情報をコントローラ30へ出力する。本実施形態のコントローラ30は、空間情報に基づいて、人体の位置が多関節ロボットの最大可動範囲内であるか否か、人体の位置が多関節ロボットの通常可動範囲内であるか否か、安全距離が所定の閾値以下であるか否かなどを判定する。このような判定を行うために、コントローラ30には、この多関節ロボットの通常可動範囲の境界Bnの位置情報と最大可動範囲の境界Bmの位置情報が記憶されている。そして、コントローラ30は、これらの判定結果に応じて危険回避動作の内容を決定して、その危険回避動作の演算を行う。この際、コントローラ30は、空間情報から算出した安全距離(位置ベクトル)、アームの移動速度(速度ベクトル)、アームの質量に基づいて危険回避動作の内容を決定する。
図22は、本実施形態の危険回避動作のパターンを例示する図である。本実施形態のコントローラ30の制御プログラム331には、例えば、図22に示すような、「安全停止および軸ロック」、「パワー制限」、「移動速度制限」および「安全距離の保持」などの各種の危険回避動作を実現させる制御指令を生成するための演算式が記述されている。
「安全停止および軸ロック」は、多関節ロボットの動作を安全に停止して、アームが動かないように当該アームを固定する危険回避動作である。「パワー制限」は、通常動作時におけるアクチュエータ50−kを動かすパワーに比べて、小さい値に制限したパワーでアクチュエータ50−kを動かす危険回避動作である。「移動速度制限」は、通常動作時におけるアームの移動速度に比べて、小さい値に制限した移動速度でアームを移動させる危険回避動作である。「安全距離の保持」は、安全距離を所定の安全距離以上に保持しつつアームを移動させる危険回避動作である。
本実施形態のコントローラ30は、上述した人体の位置や安全距離の判定結果に応じて、図22に示す危険回避動作のパターンの中から危険源にさせるべき危険回避動作の内容を決定する。以下、この危険回避動作の内容の決定の一例を示す。
人体の位置が最大可動範囲外であった場合、コントローラ30は、アクチュエータ50−kに通常運転をさせる制御指令を出力する。人体が最大可動範囲外にいる場合には、多関節ロボットが予期せぬ動作を行ったとしても、アームが人体に接触する虞がないためである。
人体の位置が最大可動範囲内であり、かつ、通常可動範囲外であり、加えて、安全距離が所定の閾値(上記第1実施形態の第2の閾値に相当する閾値。以下、第4の閾値という)以内であった場合、コントローラ30は、例えば、「移動速度制限」を危険源に行わせるべき危険回避動作として決定する。人体の位置がこの範囲内にある場合には、多関節ロボットが通常運転している状態においては安全であるが、多関節ロボットが予期せぬ動作を行う可能性があり、人体の位置が通常可動範囲内にある場合に比べて程度は低いが、危険だからである。この危険回避動作によれば、多関節ロボットが予期せぬ動作を行ったとしても、コントローラ30が通常可動範囲外に伸びて人体に接近するアームの移動速度を制限するため、人体は、アームとの接触を回避し易くなる。なお、人体の位置がこの範囲内であった場合、コントローラ30は、「パワー制限」を危険源にさせるべき危険回避動作として決定しても良い。
人体の位置が通常可動範囲内であり、加えて、安全距離が所定の第4の閾値以下となった場合、コントローラ30は、例えば、「安全距離の保持」を危険源にさせるべき危険回避動作として決定する。人体の位置がこの範囲内にある場合には、多関節ロボットが通常運転している状態においても危険だからである。この危険回避動作によれば、コントローラ30は、多関節ロボットに安全距離を保持させてアームを人体に接近させないようにしつつ、多関節ロボットに作業を行わせる。このため、多関節ロボットの単位時間当たりの処理能力の低下を抑えつつ、多関節ロボットのアームが人体と接触するなどの危険を回避し、人体の安全を維持することができる。
人体の位置が通常可動範囲内であり、加えて、安全距離が第4の閾値よりも小さい第3の閾値(上記第1実施形態の第1の閾値に相当する閾値)以下となった場合、コントローラ30は、「安全停止および軸ロック」を危険源にさせるべき危険回避動作として決定する。人体の位置および安全距離がこのような場合、アームが人体に接触する可能性が高く、非常に危険だからである。この危険回避動作によれば、コントローラ30は、アームが人体に接触する前に多関節ロボットを安全に停止させてアームを固定させる。このため、人体の安全を維持することができる。
以上のように、本実施形態のコントローラ30は、安全距離に加え、危険源である産業用機械の可動範囲(具体的には、多関節ロボットの通常可動範囲および最大可動範囲)に対する人体の位置関係も考慮して危険回避動作の内容を決定している。このため、本実施形態の安全制御システム1では、危険の程度に応じた適切な危険回避動作を危険源にさせることができ、第1実施形態に比べ、より確実に人体の安全を維持することができる。
(第4実施形態)
図23は、この発明の第4実施形態による安全制御システム1Aの構成を示すブロック図である。図24は、安全制御システム1Aの各構成要素の機能を示すブロック図である。本実施形態の安全制御システム1Aは、安全空間監視装置10に代えて安全空間監視装置10Aを、安全コントローラ20に代えて安全コントローラ20Aを、安全センサ60に代えて安全センサ60Aを有する点において第1実施形態の安全制御システム1と異なる。加えて、安全制御システム1Aは、安全制御システム1A内の各機器間の接続態様が安全制御システム1と異なる。より詳細には、本実施形態の安全制御システム1Aにおいて、安全空間監視装置10、コントローラ30および安全ドライブ機器40−kは、これらの各構成要素間のデータの授受を媒介する安全バス70に接続されており、産業用ネットワークを形成している。一方、安全コントローラ20Aと安全空間監視装置10A(より正確には、安全空間監視装置10Aの安全信号出力部14A)とは、安全ワイヤ75によって接続されている。同様に、安全コントローラ20Aと安全センサ60Aとは、安全ワイヤ75によって接続されており、安全コントローラ20Aと各安全ドライブ機器40−kとは、安全ワイヤ75によって接続されている。
図23は、この発明の第4実施形態による安全制御システム1Aの構成を示すブロック図である。図24は、安全制御システム1Aの各構成要素の機能を示すブロック図である。本実施形態の安全制御システム1Aは、安全空間監視装置10に代えて安全空間監視装置10Aを、安全コントローラ20に代えて安全コントローラ20Aを、安全センサ60に代えて安全センサ60Aを有する点において第1実施形態の安全制御システム1と異なる。加えて、安全制御システム1Aは、安全制御システム1A内の各機器間の接続態様が安全制御システム1と異なる。より詳細には、本実施形態の安全制御システム1Aにおいて、安全空間監視装置10、コントローラ30および安全ドライブ機器40−kは、これらの各構成要素間のデータの授受を媒介する安全バス70に接続されており、産業用ネットワークを形成している。一方、安全コントローラ20Aと安全空間監視装置10A(より正確には、安全空間監視装置10Aの安全信号出力部14A)とは、安全ワイヤ75によって接続されている。同様に、安全コントローラ20Aと安全センサ60Aとは、安全ワイヤ75によって接続されており、安全コントローラ20Aと各安全ドライブ機器40−kとは、安全ワイヤ75によって接続されている。
安全空間監視装置10Aは、生成した空間情報を安全バス70を介してコントローラ30へ出力する点において安全空間監視装置10と同様である。しかし、安全空間監視装置10Aは、生成した安全信号を安全ワイヤ75を介して安全コントローラへ出力する点において安全空間監視装置10と異なる。安全センサ60Aは、安全信号を安全ワイヤ75を介して安全コントローラへ出力する点において安全センサ60と異なる。安全コントローラ20Aは、安全ワイヤ75を介して安全空間監視装置10Aおよび安全センサ60Aから安全信号を取得し、安全指令を安全センサ75を介して安全ドライブ機器40−kへ出力する点において安全コントローラ20と異なる。
安全ワイヤ75は、2本で1対の導線を複数対有するものである。安全ワイヤ75の1対の導線は、安全信号における1つの安全機能のオン/オフを示す信号(具体的には、ハイまたはローの2値の電圧による信号)の伝送に用いられる。このため、安全ワイヤ75は、安全機能の数だけ対の導線を有している。そして、各安全機能のオン/オフを示す信号は、安全ワイヤ75の複数対の導線によって並列に伝送される。安全ワイヤ75を介した安全信号の伝送が2値の電圧によって行われるため、安全空間監視装置10Aの安全信号出力部14Aは、フォトカプラを用いた回路や24ボルトの電圧信号に変換する回路などのハードウェアにより構成される。
このように、本実施形態の安全制御システム1Aは、安全信号の伝送態様が第1実施形態の安全制御システム1と異なるが、空間情報の伝送態様は第1実施形態の安全制御システム1と同様である。従って、本実施形態においても第1実施形態と同様の効果が得られる。
(変形)
以上本発明の第1〜第4実施形態について説明したが、これら実施形態に以下の変形を加えても勿論良い。
以上本発明の第1〜第4実施形態について説明したが、これら実施形態に以下の変形を加えても勿論良い。
(1)上記各実施形態におけるコントローラ30と安全コントローラ20は、別個の装置であった。しかし、コントローラ30の機能と安全コントローラ20の機能の両方を同一の装置により実現しても良い。
(2)上記各実施形態の安全空間監視装置10は、安全信号を出力していた。しかし、安全空間監視装置10は、安全信号を出力しなくても良い。安全制御システム1〜1Aでは、安全センサ60が安全境界を越えて危険源に人体が接近するのを検知して安全信号を出力しているからである。
(3)上記各実施形態において、コントローラ30の制御が及ばない産業用機械が保護対象となる場合が考えられる。例えば港湾において、安全制御システム1、1Aを運営している業者以外の他の業者の産業用機械がコントローラ30の制御下にある危険源に接近し得る場合である。かかる場合には当該他の業者の産業用機械を保護対象とし、危険源との接触を回避する必要がある。この場合、上記各実施形態のように、コントローラ30の制御下にある危険源に危険回避動作を行わせてもよいが、その代わりに、例えば危険源からその危険源に接近している他の業者の産業用機械に対して、危険回避動作を指示する指令を無線送信し、他の業者の産業用機械に危険回避動作を行わせてもよい。すなわち、危険源は、危険回避動作として、保護対象である他の業者の産業用機械に危険回避動作を指示する動作を行うのである。あるいは、危険源が他の産業用機械と協力して危険回避動作を行ってもよい。例えば危険源が動作速度を低下させる危険回避動作を行うとともに、保護対象である他の業者の産業用機械にも動作速度を低下させる危険回避動作を行う態様が考えられる。この場合、保護対象の協力が得られるか否かにより、危険源が行う危険回避動作の態様を変化させてもよい。例えば保護対象たる他の業者の産業用機械が危険源からの指令に従って危険回避動作を行う場合、図7のA3のように処理能力の低下の少ない態様で危険源に危険回避動作を行わせる。一方、例えば保護対象たる他の業者の産業用機械が危険源からの指令を受け取って危険回避動作を行う能力を有していない場合等、保護対象の協力が得られない場合には、図7のA2のように処理能力の低下が大きいが高い安全性の得られる態様で危険源に危険回避動作を行わせるのである。この態様によれば、可能な限り、危険源の処理能力の低下を抑えて、危険回避動作を行わせることができる。
1,1A…安全制御システム、10,10A…安全空間監視装置、11…撮像機器、12…画像処理装置、13…異常検出部、14,14A…安全信号出力部、15…外部通信I/F装置、20,20A…安全コントローラ、30…コントローラ、40−k…安全ドライブ機器、50−k…アクチュエータ、60,60A…安全センサ、70…安全バス、75…安全ワイヤ。
Claims (6)
- 危険源と保護対象との距離が閾値以下になった場合に前記危険源に危険回避のための安全動作を行わせる安全動作制御手段と、
前記危険源および前記保護対象の所在を示す空間情報を生成する空間情報出力手段と、
前記空間情報に基づいて前記危険源と前記保護対象との距離を監視し、前記危険源と前記保護対象との距離の前記閾値への接近に応じて、前記危険源に危険回避動作を行わせる駆動制御装置と
を具備することを特徴とする安全制御システム。 - 前記駆動制御装置は、前記危険源と前記保護対象との距離が短くなるに従って前記危険源の動作速度を低下させる危険回避動作を前記危険源に行わせることを特徴とする請求項1に記載の安全制御システム。
- 前記駆動制御装置は、前記危険源と前記保護対象との距離を維持しつつ前記危険源の動作を継続させる危険回避動作を前記危険源に行わせることを特徴とする請求項1に記載の安全制御システム。
- 前記駆動制御装置は、前記危険回避動作において、前記危険源と前記保護対象との距離を維持しつつ前記危険源の移動経路を変更させることを特徴とする請求項3に記載の安全制御システム。
- 前記駆動制御装置は、前記空間情報に応じて複数種の危険回避動作の中から1の種類の危険回避動作を決定することを特徴とする請求項1に記載の安全制御システム。
- 危険源の駆動制御を行う駆動制御装置であって、
前記危険源および保護対象の所在を示す空間情報に基づいて前記危険源と前記保護対象との距離を監視し、
前記危険源に安全動作を行わせる前記危険源と前記保護対象との距離の上限値を閾値とし、前記危険源と前記保護対象との距離の前記閾値への接近に応じて、前記危険源に危険回避動作を行わせる
ことを特徴とする駆動制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015074970A JP2016193473A (ja) | 2015-04-01 | 2015-04-01 | 駆動制御装置および安全制御システム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015074970A JP2016193473A (ja) | 2015-04-01 | 2015-04-01 | 駆動制御装置および安全制御システム |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2016193473A true JP2016193473A (ja) | 2016-11-17 |
Family
ID=57323318
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2015074970A Pending JP2016193473A (ja) | 2015-04-01 | 2015-04-01 | 駆動制御装置および安全制御システム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2016193473A (ja) |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2018103345A (ja) * | 2016-12-28 | 2018-07-05 | 川崎重工業株式会社 | ロボットシステム |
JP2018193205A (ja) * | 2017-05-19 | 2018-12-06 | 新明和工業株式会社 | 特装車両 |
JP2018192579A (ja) * | 2017-05-18 | 2018-12-06 | ファナック株式会社 | ロボットシステム |
JP2019127372A (ja) * | 2018-01-25 | 2019-08-01 | 株式会社日立プラントメカニクス | クレーン作業エリア安全確認装置 |
CN110116424A (zh) * | 2018-02-06 | 2019-08-13 | 丰田自动车株式会社 | 机器人 |
CN110231061A (zh) * | 2019-06-24 | 2019-09-13 | 天津帕比特科技有限公司 | 一种基于机器人的数据中心基础设施管理系统 |
JP2020007134A (ja) * | 2018-07-12 | 2020-01-16 | Ihi運搬機械株式会社 | クレーンの吊り荷監視システム |
WO2020144852A1 (ja) * | 2019-01-11 | 2020-07-16 | 株式会社Fuji | 制御装置、ワーク作業装置、ワーク作業システム及び制御方法 |
CN111496806A (zh) * | 2020-04-17 | 2020-08-07 | 成都时空穿梭智能科技有限公司 | 化学品仓、加油站安防机器人 |
JP2021035888A (ja) * | 2020-11-19 | 2021-03-04 | 新明和工業株式会社 | 塵芥収集車 |
CN112520606A (zh) * | 2020-10-21 | 2021-03-19 | 浙江大华技术股份有限公司 | 塔吊监控系统和塔吊监控方法 |
JP2021126767A (ja) * | 2017-02-07 | 2021-09-02 | ヴェオ ロボティクス, インコーポレイテッド | 作業空間安全監視および機器制御 |
WO2023135664A1 (ja) * | 2022-01-12 | 2023-07-20 | 株式会社Fuji | ロボットの安全装置およびロボットシステム |
-
2015
- 2015-04-01 JP JP2015074970A patent/JP2016193473A/ja active Pending
Cited By (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2018103345A (ja) * | 2016-12-28 | 2018-07-05 | 川崎重工業株式会社 | ロボットシステム |
JP2021126767A (ja) * | 2017-02-07 | 2021-09-02 | ヴェオ ロボティクス, インコーポレイテッド | 作業空間安全監視および機器制御 |
JP7122776B2 (ja) | 2017-02-07 | 2022-08-22 | ヴェオ ロボティクス, インコーポレイテッド | 作業空間安全監視および機器制御 |
JP2018192579A (ja) * | 2017-05-18 | 2018-12-06 | ファナック株式会社 | ロボットシステム |
US10525592B2 (en) | 2017-05-18 | 2020-01-07 | Fanuc Corporation | Robot system |
JP7146370B2 (ja) | 2017-05-19 | 2022-10-04 | 新明和工業株式会社 | 特装車両 |
JP2018193205A (ja) * | 2017-05-19 | 2018-12-06 | 新明和工業株式会社 | 特装車両 |
JP2019127372A (ja) * | 2018-01-25 | 2019-08-01 | 株式会社日立プラントメカニクス | クレーン作業エリア安全確認装置 |
JP7009691B2 (ja) | 2018-01-25 | 2022-01-26 | 株式会社日立プラントメカニクス | クレーン作業エリア安全確認装置 |
JP2019136790A (ja) * | 2018-02-06 | 2019-08-22 | トヨタ自動車株式会社 | ロボット |
CN110116424A (zh) * | 2018-02-06 | 2019-08-13 | 丰田自动车株式会社 | 机器人 |
CN110116424B (zh) * | 2018-02-06 | 2022-04-19 | 丰田自动车株式会社 | 机器人 |
US11027429B2 (en) | 2018-02-06 | 2021-06-08 | Toyota Jidosha Kabushiki Kaisha | Robot |
JP2020007134A (ja) * | 2018-07-12 | 2020-01-16 | Ihi運搬機械株式会社 | クレーンの吊り荷監視システム |
JPWO2020144852A1 (ja) * | 2019-01-11 | 2021-09-27 | 株式会社Fuji | 制御装置、ワーク作業装置、ワーク作業システム及び制御方法 |
WO2020144852A1 (ja) * | 2019-01-11 | 2020-07-16 | 株式会社Fuji | 制御装置、ワーク作業装置、ワーク作業システム及び制御方法 |
JP7145237B2 (ja) | 2019-01-11 | 2022-09-30 | 株式会社Fuji | 制御装置、ワーク作業装置、ワーク作業システム及び制御方法 |
CN110231061A (zh) * | 2019-06-24 | 2019-09-13 | 天津帕比特科技有限公司 | 一种基于机器人的数据中心基础设施管理系统 |
CN111496806A (zh) * | 2020-04-17 | 2020-08-07 | 成都时空穿梭智能科技有限公司 | 化学品仓、加油站安防机器人 |
CN112520606A (zh) * | 2020-10-21 | 2021-03-19 | 浙江大华技术股份有限公司 | 塔吊监控系统和塔吊监控方法 |
JP2021035888A (ja) * | 2020-11-19 | 2021-03-04 | 新明和工業株式会社 | 塵芥収集車 |
JP7016600B2 (ja) | 2020-11-19 | 2022-02-07 | 新明和工業株式会社 | 塵芥収集車 |
WO2023135664A1 (ja) * | 2022-01-12 | 2023-07-20 | 株式会社Fuji | ロボットの安全装置およびロボットシステム |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2016193473A (ja) | 駆動制御装置および安全制御システム | |
JP4817084B2 (ja) | モータ駆動システム及びモータ制御装置 | |
US9737989B2 (en) | Human cooperation robot system in which robot is caused to perform retreat operation | |
US10298166B2 (en) | Motor control system, motor controller, and method for setting safety function | |
US10836035B2 (en) | Operation control device for movable apparatus, operation control system, and method of controlling operations by movable apparatus | |
JP6879736B2 (ja) | ロボットシステム | |
US9682480B2 (en) | Teleoperation of machines having at least one actuated mechanism and a fault detection and recovery system | |
US20170225331A1 (en) | Systems and methods for safe robot operation | |
JP5892132B2 (ja) | 制御装置及びロボットシステム | |
US20170199299A1 (en) | Method of Configuring and of Operating a Monitored Automated Work Cell and Configuration Apparatus | |
JP6316909B1 (ja) | 協働動作領域を有するロボットシステム | |
WO2018091064A1 (en) | An industrial robot system comprising a plurality of robots and a plurality of safety sensors | |
US20210084224A1 (en) | Unmanned aerial vehicle control method and unmanned aerial vehicle | |
JP2018187754A5 (ja) | ロボットシステム及びロボットの制御方法 | |
CN110919627A (zh) | 机器人的控制方法及控制装置 | |
JP2018062026A (ja) | ロボットの速度や加速度を制限する機能を備えたロボット制御装置 | |
CN110168926B (zh) | 马达控制装置 | |
JP2018051686A (ja) | ロボット復旧支援装置及びそれを備えるロボットシステム | |
JP5619330B1 (ja) | 安全制御システム及び安全制御機器 | |
JP2019042871A (ja) | ロボットシステム | |
KR20230060860A (ko) | 스마트 팩토리 연동을 위한 릴레이 제어 모듈 | |
CN115674190A (zh) | 协作机械臂及其运动控制方法、碰撞检测方法、控制系统 | |
WO2019208228A1 (ja) | センサコントローラ、ロボットシステム、センサ制御方法、およびプログラム | |
US20200198148A1 (en) | Robot control device, robot control system, and robot control method | |
JP2022131424A (ja) | ロボット制御装置 |