JPH0750409B2 - ロボツトの制御装置 - Google Patents
ロボツトの制御装置Info
- Publication number
- JPH0750409B2 JPH0750409B2 JP58110874A JP11087483A JPH0750409B2 JP H0750409 B2 JPH0750409 B2 JP H0750409B2 JP 58110874 A JP58110874 A JP 58110874A JP 11087483 A JP11087483 A JP 11087483A JP H0750409 B2 JPH0750409 B2 JP H0750409B2
- Authority
- JP
- Japan
- Prior art keywords
- command voltage
- speed command
- robot
- mode
- maximum speed
- 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.)
- Expired - Lifetime
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/19—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
- G05B19/21—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device
- G05B19/23—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control
- G05B19/231—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
- Safety Devices In Control Systems (AREA)
- Control Of Position Or Direction (AREA)
Description
【発明の詳細な説明】 〔発明の利用分野〕 本発明はロボツトの制御装置に係り、更に詳しくはプレ
イバツク方式の産業用ロボツトにおいて人間に対する安
全性を確保する様にしたロボツトの制御装置に関する。
イバツク方式の産業用ロボツトにおいて人間に対する安
全性を確保する様にしたロボツトの制御装置に関する。
従来のプレイバツク方式のロボツト制御装置において、
サーボ系がソフトウエアを介して構成されている場合、
位置指令信号や位置フイードバツク信号に異常が発生し
たことを位置偏差を監視することで検出し、駆動系を遮
断している。しかし、この場合、位置指令信号や位置フ
イードバツク信号の異常発生が検出されてから駆動系が
遮断されるまでの時間、ロボツトが高速で動作し、オペ
レータの安全を確保する事が難かしいという欠点があつ
た。
サーボ系がソフトウエアを介して構成されている場合、
位置指令信号や位置フイードバツク信号に異常が発生し
たことを位置偏差を監視することで検出し、駆動系を遮
断している。しかし、この場合、位置指令信号や位置フ
イードバツク信号の異常発生が検出されてから駆動系が
遮断されるまでの時間、ロボツトが高速で動作し、オペ
レータの安全を確保する事が難かしいという欠点があつ
た。
また、従来はロボツトの稼動実績も少なく、かつ専任の
オペレータが操作することもあつて、ロボツトの制御装
置の設計上も、安全に対する考慮が十分になされている
とは言えなかつた。
オペレータが操作することもあつて、ロボツトの制御装
置の設計上も、安全に対する考慮が十分になされている
とは言えなかつた。
本発明の目的は、オペレータがロボツトの近傍でロボツ
トを操作している時、仮りにロボツトが異常動作を行な
つた場合でも、オペレータが異常に気がついて安全に退
避できる様に、ロボツトの動作速度を制限し、監視する
ロボツトの制御装置を提供することにある。
トを操作している時、仮りにロボツトが異常動作を行な
つた場合でも、オペレータが異常に気がついて安全に退
避できる様に、ロボツトの動作速度を制限し、監視する
ロボツトの制御装置を提供することにある。
本発明のロボツトの制御装置は、位置指令信号を出力す
る位置演算部と、ロボツトの現在位置をフイードバツク
するパルスカウンタと、上記位置指令信号とパルスカウ
ンタの出力から位置偏差を演算し、所定の速度指令電圧
を出力する位置制御部と、ロボットを駆動する駆動モー
タの速度を制御する速度制御部とから構成されるロボッ
トの制御装置において、上記位置偏差を常時監視する手
段と、上記位置偏差を常時監視する手段からの出力に応
じて速度指令電圧を出力する手段と、上記ロボットの動
作モードに応じて異なる値に設定され、上記速度指令電
圧を出力する手段から出力される最大速度指令電圧を監
視する手段と、上記動作モードがプレイバックモードか
らティーチモードに切り換えられた後、上記最大速度指
令電圧を監視する手段によってプレイバックモード時の
最大速度指令電圧が、あらかじめ設定された時間継続し
たことを検出したときには、速度指令電圧をプレイバッ
クモード時の最大速度指令電圧からティーチモードの最
大速度指令電圧に切り換える手段とを備えていることを
特徴としている。
る位置演算部と、ロボツトの現在位置をフイードバツク
するパルスカウンタと、上記位置指令信号とパルスカウ
ンタの出力から位置偏差を演算し、所定の速度指令電圧
を出力する位置制御部と、ロボットを駆動する駆動モー
タの速度を制御する速度制御部とから構成されるロボッ
トの制御装置において、上記位置偏差を常時監視する手
段と、上記位置偏差を常時監視する手段からの出力に応
じて速度指令電圧を出力する手段と、上記ロボットの動
作モードに応じて異なる値に設定され、上記速度指令電
圧を出力する手段から出力される最大速度指令電圧を監
視する手段と、上記動作モードがプレイバックモードか
らティーチモードに切り換えられた後、上記最大速度指
令電圧を監視する手段によってプレイバックモード時の
最大速度指令電圧が、あらかじめ設定された時間継続し
たことを検出したときには、速度指令電圧をプレイバッ
クモード時の最大速度指令電圧からティーチモードの最
大速度指令電圧に切り換える手段とを備えていることを
特徴としている。
以下添付の図面に示す実施例により、更に詳細に本発明
について説明する。
について説明する。
第１図はロボツトのサーボ制御系を示すブロツク図であ
る。同図において、駆動用モータ１とタコジエネレータ
２とパルスジエネレータ３は、構造的に一体となつてい
る。又、４は位置演算部であり、５は位置制御部であ
り、６は速度制御部であり、７はパルスカウンタであ
り、８は記憶装置であり、９は動作モード指定等のI/O
制御部であり、10はシステムバスである。
る。同図において、駆動用モータ１とタコジエネレータ
２とパルスジエネレータ３は、構造的に一体となつてい
る。又、４は位置演算部であり、５は位置制御部であ
り、６は速度制御部であり、７はパルスカウンタであ
り、８は記憶装置であり、９は動作モード指定等のI/O
制御部であり、10はシステムバスである。
以上の構成において、位置演算部４は予め記憶装置８に
記憶されている位置情報によつて、次に動作すべき位置
データを演算し、その結果を位置指令信号として位置制
御部５に与える。位置制御部５は、上記位置指令信号と
パルスカウンタ７から出力される位置フイードバツク信
号とから位置偏差を演算により求め、速度制御部６に速
度指令電圧として出力する。速度制御部６は、上記速度
指令電圧とタコジエネレータ３からの速度フイードバツ
ク信号によつて、駆動用モータ１を速度制御する。
記憶されている位置情報によつて、次に動作すべき位置
データを演算し、その結果を位置指令信号として位置制
御部５に与える。位置制御部５は、上記位置指令信号と
パルスカウンタ７から出力される位置フイードバツク信
号とから位置偏差を演算により求め、速度制御部６に速
度指令電圧として出力する。速度制御部６は、上記速度
指令電圧とタコジエネレータ３からの速度フイードバツ
ク信号によつて、駆動用モータ１を速度制御する。
第２図は第１図に示す位置制御部５を示すブロツク図で
ある。同図において、11はマイクロプロセツサであり、
12は記憶装置であり、13は位置指令信号用のバツフアで
あり、14は位置フイードバツク信号用のバツフアであ
り、15は全体のタイミングをとる制御回路であり、16は
一時記憶装置であり、17はD/A変換器であり、18は増幅
器であり、19は接点22の切換回路である。
ある。同図において、11はマイクロプロセツサであり、
12は記憶装置であり、13は位置指令信号用のバツフアで
あり、14は位置フイードバツク信号用のバツフアであ
り、15は全体のタイミングをとる制御回路であり、16は
一時記憶装置であり、17はD/A変換器であり、18は増幅
器であり、19は接点22の切換回路である。
以上の構成において、バツフア13,14からそれぞれ入力
される位置指令信号と位置フイードバツク信号とが、一
定のタイミングでマイクロプロセツサ11に取り込まれ、
同時に記憶装置12に記憶される。マイクロプロセツサ11
は、これに基づいて位置偏差を計算し、位置偏差に対応
する操作量を一時記憶装置16に出力する。この操作量は
速度指令電圧となるもので、制御回路15からの信号によ
つてD/A変換器17に出力され、アナログ信号に変換され
た後増幅器18に入力される。増幅器18でゲイン調整され
た信号は速度指令電圧として速度制御部６に入力され
る。以上の動作によつて、位置偏差を常時監視すること
ができ、フイード信号の断線等の異常を検出することが
できる。
される位置指令信号と位置フイードバツク信号とが、一
定のタイミングでマイクロプロセツサ11に取り込まれ、
同時に記憶装置12に記憶される。マイクロプロセツサ11
は、これに基づいて位置偏差を計算し、位置偏差に対応
する操作量を一時記憶装置16に出力する。この操作量は
速度指令電圧となるもので、制御回路15からの信号によ
つてD/A変換器17に出力され、アナログ信号に変換され
た後増幅器18に入力される。増幅器18でゲイン調整され
た信号は速度指令電圧として速度制御部６に入力され
る。以上の動作によつて、位置偏差を常時監視すること
ができ、フイード信号の断線等の異常を検出することが
できる。
第３図は位置偏差と速度指令電圧の関係を示す図であ
り、23はテイーチモード時の位置偏差に対する最大速度
指令電圧を示し、24はプレイバツクモード時の位置偏差
に対する最大速度指令電圧を示している。この様な最大
速度指令電圧の切換は次の様に行なわれる。即ち、テイ
ーチモード時において、最大速度指令電圧24は一定時間
継続した場合、これを検出して、システムバス10を介し
て第１図に示すI/O制御部９に入力し、I/O制御部９から
の指令によつて第２図に示す切換回路19を動作させ、接
点22をオンさせる。
り、23はテイーチモード時の位置偏差に対する最大速度
指令電圧を示し、24はプレイバツクモード時の位置偏差
に対する最大速度指令電圧を示している。この様な最大
速度指令電圧の切換は次の様に行なわれる。即ち、テイ
ーチモード時において、最大速度指令電圧24は一定時間
継続した場合、これを検出して、システムバス10を介し
て第１図に示すI/O制御部９に入力し、I/O制御部９から
の指令によつて第２図に示す切換回路19を動作させ、接
点22をオンさせる。
接点22がオンすることにより、増幅器18から出力される
速度指令電圧がそれまでツエナーダイオード21で制限さ
れていたのが、ダイオード（又はツエナーダイオード）
20によつて制限される様になる。従つて、最大速度指令
電圧がプレイバツクモード時の最大速度指令電圧24から
テイーチモード時の最大速度指令電圧23に切換わる事に
なる。
速度指令電圧がそれまでツエナーダイオード21で制限さ
れていたのが、ダイオード（又はツエナーダイオード）
20によつて制限される様になる。従つて、最大速度指令
電圧がプレイバツクモード時の最大速度指令電圧24から
テイーチモード時の最大速度指令電圧23に切換わる事に
なる。
この様に、位置偏差を常時監視し、動作モードに応じて
最大速度指令電圧を制限することにより、テイーチモー
ド時にフイード信号の断線等の異常が発生し駆動モータ
電源断後のロボツト惰走速度を制限することができる。
従つて、ロボツトの近傍に人がいる場合に、位置制御系
に異常が発生しても、ロボツトの惰走速度を低速に制限
できるため、人が安全に退避することが可能になる。
最大速度指令電圧を制限することにより、テイーチモー
ド時にフイード信号の断線等の異常が発生し駆動モータ
電源断後のロボツト惰走速度を制限することができる。
従つて、ロボツトの近傍に人がいる場合に、位置制御系
に異常が発生しても、ロボツトの惰走速度を低速に制限
できるため、人が安全に退避することが可能になる。
以上の説明から明らかな様に、本発明によれば、オペレ
ータがロボットの近傍でプレイバックモードからティー
チモードに切り換えてティーチ操作しているとき、ロボ
ットが異常動作を行ったとしても、ティーチモードの最
大速度指令電圧に速度指令電圧が切り換えられるので、
ロボットの楕走速度が低速に制限され、これによって安
全に退避できる効果がある。
ータがロボットの近傍でプレイバックモードからティー
チモードに切り換えてティーチ操作しているとき、ロボ
ットが異常動作を行ったとしても、ティーチモードの最
大速度指令電圧に速度指令電圧が切り換えられるので、
ロボットの楕走速度が低速に制限され、これによって安
全に退避できる効果がある。
第１図は本発明に係るロボツトのサーボ制御系を示すブ
ロツク図、第２図は第１図に示す位置制御部の一例を示
すブロツク図、第３図は位置偏差と速度指令電圧の関係
を示す図である。 １……駆動用モータ、２……タコジエネレータ、３……
パルスジエネレータ、４……位置演算部、５……位置制
御部、６……速度制御部、７……パルスカウンタ、８…
…I/O制御部、11……マイクロプロセツサ、12……記憶
装置、13,14……バツフア、15……制御回路、16……一
時記憶回路、17……D/A変換器、18……増幅器、19……
切換回路、22……接点
ロツク図、第２図は第１図に示す位置制御部の一例を示
すブロツク図、第３図は位置偏差と速度指令電圧の関係
を示す図である。 １……駆動用モータ、２……タコジエネレータ、３……
パルスジエネレータ、４……位置演算部、５……位置制
御部、６……速度制御部、７……パルスカウンタ、８…
…I/O制御部、11……マイクロプロセツサ、12……記憶
装置、13,14……バツフア、15……制御回路、16……一
時記憶回路、17……D/A変換器、18……増幅器、19……
切換回路、22……接点
フロントページの続き (51)Int.Cl.6 識別記号 庁内整理番号 ＦＩ 技術表示箇所 Ｂ２５Ｊ 19/06 Ｇ０５Ｄ 3/00 Ｘ 9179−3Ｈ
Claims (1)
- 【請求項１】位置指令信号を出力する位置演算部と、ロ
ボットの現在位置をフィードバックするパルスカウンタ
と、上記位置指令信号とパルスカウンタの出力とから位
置偏差を演算し、所定の速度指令電圧を出力する位置制
御部と、ロボットを駆動する駆動モータの速度を制御す
る速度制御部とから構成されるロボットの制御装置にお
いて、 上記位置偏差を常時監視する手段と、 上記位置偏差を常時監視する手段からの出力に応じて速
度指令電圧を出力する手段と、 上記ロボットの動作モードに応じて異なる値に設定さ
れ、上記速度指令電圧を出力する手段から出力される最
大速度指令電圧を監視する手段と、 上記動作モードがプレイバックモードからティーチモー
ドに切り換えられた後、上記最大速度指令電圧を監視す
る手段によってプレイバックモード時の最大速度指令電
圧が、あらかじめ設定された時間継続したことを検出し
たときには、速度指令電圧をプレイバックモード時の最
大速度指令電圧からティーチモードの最大速度指令電圧
に切り換える手段と、 を備えていることを特徴とするロボットの制御装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP58110874A JPH0750409B2 (ja) | 1983-06-22 | 1983-06-22 | ロボツトの制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP58110874A JPH0750409B2 (ja) | 1983-06-22 | 1983-06-22 | ロボツトの制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPS603715A JPS603715A (ja) | 1985-01-10 |
| JPH0750409B2 true JPH0750409B2 (ja) | 1995-05-31 |
Family
ID=14546888
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP58110874A Expired - Lifetime JPH0750409B2 (ja) | 1983-06-22 | 1983-06-22 | ロボツトの制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPH0750409B2 (ja) |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS63276795A (ja) * | 1986-12-16 | 1988-11-15 | Mitsubishi Electric Corp | 可変長シフトレジスタ |
| JPS63266699A (ja) * | 1986-12-24 | 1988-11-02 | Mitsubishi Electric Corp | 可変遅延回路装置 |
| JPH02190292A (ja) * | 1989-01-18 | 1990-07-26 | Fanuc Ltd | ロボットのオーバライドによる安全対策方法 |
| JP4083767B2 (ja) | 2005-12-22 | 2008-04-30 | ファナック株式会社 | サーボモータを制御する数値制御装置 |
Family Cites Families (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS5090059A (ja) * | 1973-12-19 | 1975-07-18 | ||
| JPS50132386A (ja) * | 1974-03-08 | 1975-10-20 | ||
| JPS5674708A (en) * | 1979-11-26 | 1981-06-20 | Toyoda Mach Works Ltd | Numerical control device |
| JPS56113901U (ja) * | 1980-01-29 | 1981-09-02 | ||
| JPS56121109A (en) * | 1980-02-29 | 1981-09-22 | Tsubakimoto Chain Co | Position adjusting circuit |
-
1983
- 1983-06-22 JP JP58110874A patent/JPH0750409B2/ja not_active Expired - Lifetime
Also Published As
| Publication number | Publication date |
|---|---|
| JPS603715A (ja) | 1985-01-10 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP0540753A4 (en) | System for controlling industrial robot | |
| EP0909997B1 (en) | Method for operating controller for controlling industrial machine provided with processor | |
| JPH048190B2 (ja) | ||
| US4859920A (en) | Interface system for servo controller | |
| JP2954615B2 (ja) | モータ駆動制御装置 | |
| JPH0750409B2 (ja) | ロボツトの制御装置 | |
| JPS61203883A (ja) | サ−ボモ−タ制御方式 | |
| JP3994487B2 (ja) | ロボット制御装置の速度制御方法 | |
| JPH02266884A (ja) | 誘導電動機の制御方法 | |
| JPH08163883A (ja) | モータ制御装置 | |
| JPS61206007A (ja) | サ−ボモ−タ制御方式 | |
| JPH0644623Y2 (ja) | 産業用ロボットの安全装置 | |
| JP2735597B2 (ja) | サーボ制御装置 | |
| JPH01198286A (ja) | 回生処理装置 | |
| JPS6284993A (ja) | ロボツトの安全速度制御装置 | |
| JP2652977B2 (ja) | 数値制御装置 | |
| JP3209344B2 (ja) | 産業用ロボットの制御方法 | |
| JPH0421377A (ja) | 同期電動機のダイナミックブレーキ装置 | |
| JPH04310396A (ja) | ロボット制御装置 | |
| JPH01190281A (ja) | 電動モータの異常検出装置 | |
| JPH0641345U (ja) | 電源の保護装置 | |
| JP2917405B2 (ja) | 電動機の商用運転・インバータ運転切換制御方法 | |
| JP2797483B2 (ja) | バッテリ駆動による装置の動作保障方式 | |
| JPH07177774A (ja) | 電動機の回生制御方法 | |
| JPS58170388A (ja) | モ−タの駆動制御方式 |