JPS6284303A - ロボツトの制御装置 - Google Patents
ロボツトの制御装置Info
- Publication number
- JPS6284303A JPS6284303A JP22353685A JP22353685A JPS6284303A JP S6284303 A JPS6284303 A JP S6284303A JP 22353685 A JP22353685 A JP 22353685A JP 22353685 A JP22353685 A JP 22353685A JP S6284303 A JPS6284303 A JP S6284303A
- Authority
- JP
- Japan
- Prior art keywords
- circuit
- pulse
- robot
- signal line
- encoder
- 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
Landscapes
- Transmission And Conversion Of Sensor Element Output (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
〔発明の利用分野〕
本発明は、ロボットの制御装置に係り、特に、パルス発
生器を位置決め手段とするロボットの安全性を高めるの
に好適なロボットの制御装置に関するものである。
生器を位置決め手段とするロボットの安全性を高めるの
に好適なロボットの制御装置に関するものである。
従来のロボットの動作制御装置としては、例えば、特開
昭59−169778号公報に記載されているように、
パルス発生器で生じたパルスをパルス検出器でカウント
することにより、ロボットアームの移動位置を検出して
動作制御を行っていた。
昭59−169778号公報に記載されているように、
パルス発生器で生じたパルスをパルス検出器でカウント
することにより、ロボットアームの移動位置を検出して
動作制御を行っていた。
しかし、パルス発生器の信号線が断線したときの安全対
策の点については、演算制御装置のマイクロコンピュー
タが暴走したときも含めての配慮がなされていなかった
。
策の点については、演算制御装置のマイクロコンピュー
タが暴走したときも含めての配慮がなされていなかった
。
本発明は、前述の従来技術の実状に鑑みてなされたもの
で、マイクロコンピュータが暴走している状況にあって
も、パルス発生器の信号線等の断線を検出し、すみやか
にロボットを停止させることにより、安価な手段でロボ
ットの安全性を高めうるロボットの制御装置の提供を、
その目的としている。
で、マイクロコンピュータが暴走している状況にあって
も、パルス発生器の信号線等の断線を検出し、すみやか
にロボットを停止させることにより、安価な手段でロボ
ットの安全性を高めうるロボットの制御装置の提供を、
その目的としている。
本発明に係るロボットの制御装置の構成は、ロボット駆
動用のアクチュエータと、ロボットの作動位置決めのた
めのパルスを発生するパルス発生器とを備えたロボット
の制御装置におけるアクチュエータ制御系に、前記パル
ス発生器の信号線等の断線検出回路を設けたものである
。
動用のアクチュエータと、ロボットの作動位置決めのた
めのパルスを発生するパルス発生器とを備えたロボット
の制御装置におけるアクチュエータ制御系に、前記パル
ス発生器の信号線等の断線検出回路を設けたものである
。
なお付記すると、断線検出回路は、パルス発生器に係る
差動伝送方式のパルスエンコーダのパルス信号を排他的
論理和にて処理する回路と、所定のパルス幅以下のパル
ス入力を無視するパルス幅弁別回路とを設けたものであ
る。
差動伝送方式のパルスエンコーダのパルス信号を排他的
論理和にて処理する回路と、所定のパルス幅以下のパル
ス入力を無視するパルス幅弁別回路とを設けたものであ
る。
以下、本発明の各実施例を第1図ないし第5図を参照し
て説明する。
て説明する。
まず第1図は、本発明の一実施例に係るロボットの制御
装置のアクチュエータ制御系のブロック図、第2図は、
第1図の断線検出回路の回路図、第3図は、第2図の回
路のタイミングチャート図、第4図は、第2図のパルス
幅弁別回路の一例を示す回路図である。
装置のアクチュエータ制御系のブロック図、第2図は、
第1図の断線検出回路の回路図、第3図は、第2図の回
路のタイミングチャート図、第4図は、第2図のパルス
幅弁別回路の一例を示す回路図である。
第1図において、lは、マイクロコンピュータ等の演算
制御装置、2はモータドライバ回−路、3は、ロボット
駆動用のアクチュエータに係るモータ、4は、ロボット
アームの作動位置決めのためのパルス発生器に係る差動
伝送方式のパルスエンコーダ、5はパルスカウンタ、6
は、前記差動伝送方式のパルスエンコーダ4のエンコー
ダ信号線断線検出回路、7は非常停止処理回路である。
制御装置、2はモータドライバ回−路、3は、ロボット
駆動用のアクチュエータに係るモータ、4は、ロボット
アームの作動位置決めのためのパルス発生器に係る差動
伝送方式のパルスエンコーダ、5はパルスカウンタ、6
は、前記差動伝送方式のパルスエンコーダ4のエンコー
ダ信号線断線検出回路、7は非常停止処理回路である。
ここに、差動伝送方式のパルスエンコーダ4は、第3図
で後述するように、A相のパルス信号に対し対称をなす
A相のパルス信号を送り、2つの信号で所望の目的の信
号を伝送する方式のもので、2つのA相、入相のパルス
信号は常に反転関係にあるものである。
で後述するように、A相のパルス信号に対し対称をなす
A相のパルス信号を送り、2つの信号で所望の目的の信
号を伝送する方式のもので、2つのA相、入相のパルス
信号は常に反転関係にあるものである。
第1図ないし第4図において、aS bは、差動伝送方
式のパルスエンコーダ4からのパルス信号で、常に反転
関係にある人相、入相あるいはB相、J相を示し、エン
コーダ信号線断線検出回路6に対する入力信号である。
式のパルスエンコーダ4からのパルス信号で、常に反転
関係にある人相、入相あるいはB相、J相を示し、エン
コーダ信号線断線検出回路6に対する入力信号である。
なお、第3図ではA相、A相の例を示す。
Cは、後述する第2図の排他的論理和口論8で処理され
た発生パルス、dは、エンコーダ(FQ[断線検出回路
6からの出力パルスである。
た発生パルス、dは、エンコーダ(FQ[断線検出回路
6からの出力パルスである。
第2図は、第1図に示したエンコーダ信号線断線検出回
路6の構成を示すもので、8は、常に反転関係(こある
。差動伝送方式のパルスエンコーダ4のパルス信号を、
排他的論理和で処理する排他的論理和回路を示し、9は
、所定のパルス幅以下の異常なパルス入力を無視するパ
ルス幅弁別回路である。
路6の構成を示すもので、8は、常に反転関係(こある
。差動伝送方式のパルスエンコーダ4のパルス信号を、
排他的論理和で処理する排他的論理和回路を示し、9は
、所定のパルス幅以下の異常なパルス入力を無視するパ
ルス幅弁別回路である。
このパルス幅弁別回路9は、例えば第4図に示すような
回路で構成されるものである。
回路で構成されるものである。
なお、図中、Vccは電源、CKは、正常なパルス信号
波形の幅を規定するクロック、PRはプリセット、CL
Rはクリア、Dはデータ入力、ぐは反転出力を示し、本
回路構成番こより、決められたパルス幅以下のパルス入
力を無視して、エンコーダ信号線の正常、断線を検出し
た必要な正常パルス信号のみを出力するCとができる。
波形の幅を規定するクロック、PRはプリセット、CL
Rはクリア、Dはデータ入力、ぐは反転出力を示し、本
回路構成番こより、決められたパルス幅以下のパルス入
力を無視して、エンコーダ信号線の正常、断線を検出し
た必要な正常パルス信号のみを出力するCとができる。
また、排他的論理和回路8の入力部には、図示しないが
、回路保護、誤動作防止のため、波形整形器として機能
するバッファを設けたり、エンコーダ信号線断線時の信
号レベルを確定するために、プルアップ抵抗あるいはプ
ルダウン抵抗を取付けることがある。
、回路保護、誤動作防止のため、波形整形器として機能
するバッファを設けたり、エンコーダ信号線断線時の信
号レベルを確定するために、プルアップ抵抗あるいはプ
ルダウン抵抗を取付けることがある。
ナオ、ココニ、プルアップ抵抗を設けたものは、断線時
のパルス信号レベルは山側すなわちHiレベルになり、
プルダウン抵抗を設けたものは、断線時のパルス信号レ
ベルは谷側すなわちLo レベルになるものである。
のパルス信号レベルは山側すなわちHiレベルになり、
プルダウン抵抗を設けたものは、断線時のパルス信号レ
ベルは谷側すなわちLo レベルになるものである。
前記のパルス幅弁別回路9は、排他的論理和回路8の出
力が信頼できる場合は不要であるが、実際には入力信号
a、b(例えば人相、入相)の変化に時間的な差がある
ことから、時間遅れで回路的に発生する異常パルス、い
わゆる「ひげ」が、処理された発生パルスCに生じるた
め、このパルス幅弁別回路9を設けている。
力が信頼できる場合は不要であるが、実際には入力信号
a、b(例えば人相、入相)の変化に時間的な差がある
ことから、時間遅れで回路的に発生する異常パルス、い
わゆる「ひげ」が、処理された発生パルスCに生じるた
め、このパルス幅弁別回路9を設けている。
このように構成されたロボットの制御装置の作用を第1
.2図に合わせて第3図を参照して説明する。
.2図に合わせて第3図を参照して説明する。
第3図は、第2図のエンコーダ信号線断線検出回路6の
タイミングチャート図で、第3図に実線矢印Rで示す区
間は、エンコーダ信号線に断線のないときを示し、Sで
示す区間は、片方の相のみが断線したとき、Tで示す区
間は、西方の相が断線したときを示す。
タイミングチャート図で、第3図に実線矢印Rで示す区
間は、エンコーダ信号線に断線のないときを示し、Sで
示す区間は、片方の相のみが断線したとき、Tで示す区
間は、西方の相が断線したときを示す。
a%b、c、dは、第1,2図に示した記号に合わせた
もので、先に説明したとおりである。
もので、先に説明したとおりである。
マイクロコンピュータ等の演算制御手段1の指令で、モ
ータドライバ回路2によりモータ3が回転すると、図示
しない産業用ロボットなどのロボットアームが移動する
。そ−夕3と一体的に、差動伝送方式のパルスエンコー
ダ4が作動して、ロボットアームの作動位置決めのため
のパルス信号を発生し、そのパルス信号はパルスカウン
タ5でカウントされて演算制御装置1に入力することに
よってフィードバック作用がなされる。
ータドライバ回路2によりモータ3が回転すると、図示
しない産業用ロボットなどのロボットアームが移動する
。そ−夕3と一体的に、差動伝送方式のパルスエンコー
ダ4が作動して、ロボットアームの作動位置決めのため
のパルス信号を発生し、そのパルス信号はパルスカウン
タ5でカウントされて演算制御装置1に入力することに
よってフィードバック作用がなされる。
一方、差動伝送方式のパルスエンコーダ4のパルス信号
は、エンコーダ信号線断線検出回路6に入力する。この
入力信号は、第3図のa、bに示すように、対称形状を
なし、常に反転関係にある。
は、エンコーダ信号線断線検出回路6に入力する。この
入力信号は、第3図のa、bに示すように、対称形状を
なし、常に反転関係にある。
例えばA相、人相として伝送されるもので、排他的論理
和回路8を経て処理された発生パルスCに示す波形とな
る。
和回路8を経て処理された発生パルスCに示す波形とな
る。
エンコーダ信号線に断線がないときは、A相、K相間の
時間差によって生じた異常パルスである「ひげ」や、外
部からのノイズが現われるが、これらは、パルス幅弁別
回路9のクロックCK、の幅以下なので無視され、第3
図の区間Rに示すような波形のパルスが発生し、非常停
止処理回路7へ非常停止の出力パルスが送信されること
はない。
時間差によって生じた異常パルスである「ひげ」や、外
部からのノイズが現われるが、これらは、パルス幅弁別
回路9のクロックCK、の幅以下なので無視され、第3
図の区間Rに示すような波形のパルスが発生し、非常停
止処理回路7へ非常停止の出力パルスが送信されること
はない。
エンコーダ信号線に断線が生じたとさで、まず、A相、
人相のいずれか片方の相のみが断線した場合は、第3図
の区間Sに示すように、入力信号a1bすなわちA相、
人相が排他的論理和回路8を経て同相、例えばパルス信
号レベルのLOlLOになったところで処理された発生
パルスCに示す波形となり、これはパルス幅弁別回路9
のクロック幅以上なので出力パルスdとして送信され、
非常停止処理回路7をONさせてロボットは非常停止す
る。
人相のいずれか片方の相のみが断線した場合は、第3図
の区間Sに示すように、入力信号a1bすなわちA相、
人相が排他的論理和回路8を経て同相、例えばパルス信
号レベルのLOlLOになったところで処理された発生
パルスCに示す波形となり、これはパルス幅弁別回路9
のクロック幅以上なので出力パルスdとして送信され、
非常停止処理回路7をONさせてロボットは非常停止す
る。
また、A相、A相の両方が断線した場合は、例えば排他
的論理和回路の入力部がTTL(トランジスタ・トラン
ジスタ・ロジック)の場合は、入力信号a、bの両相A
相、A相が、Hi レベルになるので排他的論理和か働
き、出力パルスdが非常停止処理回路7をONさせてロ
ボットは非常停止する。
的論理和回路の入力部がTTL(トランジスタ・トラン
ジスタ・ロジック)の場合は、入力信号a、bの両相A
相、A相が、Hi レベルになるので排他的論理和か働
き、出力パルスdが非常停止処理回路7をONさせてロ
ボットは非常停止する。
同様に、排他的論理和回路の入力部がTTLでない場合
は、例えば先に述べたプルアップ抵抗あるいはプルダウ
ン抵抗により両相か同相になり、排他的論理和が働き、
出力パルスdが非常停止処理回路7をONさせてロボッ
トは非常停止する。
は、例えば先に述べたプルアップ抵抗あるいはプルダウ
ン抵抗により両相か同相になり、排他的論理和が働き、
出力パルスdが非常停止処理回路7をONさせてロボッ
トは非常停止する。
本実施例によれば、ロボット制御装置のアクチュエータ
制御系、特に差動伝送方式のパルスエンコーダの出力側
にエンコーダ信号線断線検出回路、非常停止処理回路を
設けたので、演算側wJ装置に係るマイクロコンピュー
タが暴走している状況にあっても、マイクロコンピュー
タとは別口路でエンコーダ信号線の断線を検出し、すみ
やかにロボットを停止させることが可能で、安価な回路
構成によりロボットの運転を安全に行うことができる。
制御系、特に差動伝送方式のパルスエンコーダの出力側
にエンコーダ信号線断線検出回路、非常停止処理回路を
設けたので、演算側wJ装置に係るマイクロコンピュー
タが暴走している状況にあっても、マイクロコンピュー
タとは別口路でエンコーダ信号線の断線を検出し、すみ
やかにロボットを停止させることが可能で、安価な回路
構成によりロボットの運転を安全に行うことができる。
次に、本発明の他の実施例を第5図に示す。
ここに第5図は、本発明の他の実施例に係るロボットの
制御装置における断線検出回路の回路図で、図中、第2
図と同一符号、記号の部分は、先の実施例と同等部分で
あり、ロボットの制御装置の全体的な基本構成は第1図
と同等であるから、その説明を省略する。
制御装置における断線検出回路の回路図で、図中、第2
図と同一符号、記号の部分は、先の実施例と同等部分で
あり、ロボットの制御装置の全体的な基本構成は第1図
と同等であるから、その説明を省略する。
第5図の実施例は、エンコーダ信号線断線検出回路6′
へのパルス信号の入力を複数(ここでは2系統)にした
ものである。すなわち、入力信号a1bは排他的論理和
回路8−1へ、入力信号a′、b′は排他的論理和回路
8−2へ入り、排他的論理和回路8′を経た、処理され
た発生パルスCがパルス幅弁別回路9に入るように構成
されている。
へのパルス信号の入力を複数(ここでは2系統)にした
ものである。すなわち、入力信号a1bは排他的論理和
回路8−1へ、入力信号a′、b′は排他的論理和回路
8−2へ入り、排他的論理和回路8′を経た、処理され
た発生パルスCがパルス幅弁別回路9に入るように構成
されている。
このような実施例の場合も、先に説明した実施例と同様
の効果が期待でき、複数のロボット駆動用のアクチュエ
ータの制御が、マイクロコンビュ−夕とは別の回路構成
で行うことが可能となる。
の効果が期待でき、複数のロボット駆動用のアクチュエ
ータの制御が、マイクロコンビュ−夕とは別の回路構成
で行うことが可能となる。
なお、前述の各実施例では、エンコーダ信号線の断線検
出の例を説明したが、本発明は信号線のみに限るもので
はなく、パルスエンコーダへノミ源線やグランド線が断
線したとさも同等の対応により断線検出が行われロボッ
トの非常停止を行うことが可能である。
出の例を説明したが、本発明は信号線のみに限るもので
はなく、パルスエンコーダへノミ源線やグランド線が断
線したとさも同等の対応により断線検出が行われロボッ
トの非常停止を行うことが可能である。
以上述べたように、本実施例によれば、マイクロコンピ
ュータが暴走している状況にあっても、パルス発生器の
信号線等の断線を検出し、すみやかにロボットを停止さ
せることにより、安価な手段でロボットの安全性を高め
うるロボットの制御装置を提供することができる。
ュータが暴走している状況にあっても、パルス発生器の
信号線等の断線を検出し、すみやかにロボットを停止さ
せることにより、安価な手段でロボットの安全性を高め
うるロボットの制御装置を提供することができる。
第1図は、本発明の一実施例に係るロボットの制御装置
のアクチュエータ制御系のブロック図、第2図は、第1
図の断線検出回路の回路図、第3図は、第2図の回路の
タイミングチャート図、第4図は、第2図のパルス幅弁
別回路の一例を示す回路図、第5図は、本発明の他の実
施例に係るロボットの制御装置における断線検出回路の
回路図である。 2・・・モータドライバ回路、3・・・モータ、4・・
・差動伝送方式ノハルスエンコーダ、6.6′・・・エ
ンコーダ信号線断線検出回路、7・・・非常停止処理回
路、8.8′、8−1.8−2・・・排他的論理和回路
、9・・・パルス幅弁別回路。
のアクチュエータ制御系のブロック図、第2図は、第1
図の断線検出回路の回路図、第3図は、第2図の回路の
タイミングチャート図、第4図は、第2図のパルス幅弁
別回路の一例を示す回路図、第5図は、本発明の他の実
施例に係るロボットの制御装置における断線検出回路の
回路図である。 2・・・モータドライバ回路、3・・・モータ、4・・
・差動伝送方式ノハルスエンコーダ、6.6′・・・エ
ンコーダ信号線断線検出回路、7・・・非常停止処理回
路、8.8′、8−1.8−2・・・排他的論理和回路
、9・・・パルス幅弁別回路。
Claims (1)
- 【特許請求の範囲】 1、ロボット駆動用のアクチュエータと、ロボットの作
動位置決めのためのパルスを発生するパルス発生器とを
備えたロボット制御装置におけるアクチュエータ制御系
に、前記パルス発生器の信号線等の断線検出回路を設け
たことを特徴とするロボットの制御装置。 2、特許請求の範囲第1項記載のものにおいて、断線検
出回路は、パルス発生器に係る差動伝送方式のパルスエ
ンコーダのパルス信号を排他的論理和にて処理する回路
と、所定のパルス幅以下のパルス入力を無視するパルス
幅弁別回路とを設けたものであるロボットの制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP22353685A JPS6284303A (ja) | 1985-10-09 | 1985-10-09 | ロボツトの制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP22353685A JPS6284303A (ja) | 1985-10-09 | 1985-10-09 | ロボツトの制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS6284303A true JPS6284303A (ja) | 1987-04-17 |
Family
ID=16799690
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP22353685A Pending JPS6284303A (ja) | 1985-10-09 | 1985-10-09 | ロボツトの制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS6284303A (ja) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01199201A (ja) * | 1987-12-28 | 1989-08-10 | Matsushita Electric Ind Co Ltd | 安全装置 |
JP2009269720A (ja) * | 2008-05-08 | 2009-11-19 | Mitsubishi Electric Corp | エレベータのエンコーダ信号断線検出装置 |
JP2016112625A (ja) * | 2014-12-11 | 2016-06-23 | 株式会社ダイヘン | ロボット制御装置 |
-
1985
- 1985-10-09 JP JP22353685A patent/JPS6284303A/ja active Pending
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01199201A (ja) * | 1987-12-28 | 1989-08-10 | Matsushita Electric Ind Co Ltd | 安全装置 |
JP2009269720A (ja) * | 2008-05-08 | 2009-11-19 | Mitsubishi Electric Corp | エレベータのエンコーダ信号断線検出装置 |
JP2016112625A (ja) * | 2014-12-11 | 2016-06-23 | 株式会社ダイヘン | ロボット制御装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7911333B2 (en) | Motion monitoring | |
CN107895937B (zh) | 一种电机控制器冗余保护电路和电子设备 | |
JPH1153207A (ja) | 車両用制御装置 | |
JPH0333613A (ja) | エンコーダ | |
JP4525593B2 (ja) | シリアル通信による制御システム | |
JPS6284303A (ja) | ロボツトの制御装置 | |
JPH0425495B2 (ja) | ||
JPH0439707A (ja) | 数値制御装置の非常停止装置 | |
JP2605768B2 (ja) | 安全装置 | |
JP3354179B2 (ja) | 可動体の移動方向監視装置 | |
JP2633828B2 (ja) | エレベーターの端階減速監視装置 | |
JPH03159596A (ja) | 電動機の制御装置 | |
JPH03142192A (ja) | ロボットの速度異常検出装置 | |
JP2906790B2 (ja) | 複数のマイクロコンピュータの暴走監視回路 | |
SU1283922A1 (ru) | Регулируемый электропривод | |
JPH03102091A (ja) | エレベータのドア制御装置 | |
JPH01301093A (ja) | ロボット安全装置 | |
KR890001950Y1 (ko) | 로보트의 속도제어 감시회로 | |
JPH02107919A (ja) | エンコーダ欠相検出装置 | |
JPH10253393A (ja) | アブソリュートエンコーダ | |
JPH08137526A (ja) | 速度監視装置 | |
JP2761226B2 (ja) | 入出力装置 | |
JP2817336B2 (ja) | 光電スイッチ運転指令信号伝送異常判別方法 | |
JPS6025693A (ja) | ロボツト監視装置 | |
JPH01307620A (ja) | パルスエンコーダの異常検出回路 |