JPS58139201A - サ−ボ系用異常検出装置 - Google Patents

サ−ボ系用異常検出装置

Info

Publication number
JPS58139201A
JPS58139201A JP57021804A JP2180482A JPS58139201A JP S58139201 A JPS58139201 A JP S58139201A JP 57021804 A JP57021804 A JP 57021804A JP 2180482 A JP2180482 A JP 2180482A JP S58139201 A JPS58139201 A JP S58139201A
Authority
JP
Japan
Prior art keywords
drive motor
value
rotation angle
deviation
servo
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
Application number
JP57021804A
Other languages
English (en)
Inventor
Toshitaka Kuno
久野 敏孝
Hiroshi Moribe
森部 弘
Shojiro Miyamoto
庄二郎 宮本
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Central R&D Labs Inc
Original Assignee
Toyota Central R&D Labs Inc
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Toyota Central R&D Labs Inc filed Critical Toyota Central R&D Labs Inc
Priority to JP57021804A priority Critical patent/JPS58139201A/ja
Priority to US06/463,579 priority patent/US4524313A/en
Publication of JPS58139201A publication Critical patent/JPS58139201A/ja
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical 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/19Numerical 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/21Numerical 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/23Numerical 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/231Numerical 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/42Servomotor, servo controller kind till VSS
    • G05B2219/42318Using two, more, redundant measurements or scales to detect bad function

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)
  • Control Of Position Or Direction (AREA)
  • Control Of Electric Motors In General (AREA)
  • Safety Devices In Control Systems (AREA)

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 本発明はサーボループ系の断線、短絡および外乱ノ゛イ
ズなどの異常によって起る駆動モータのサーボ異常が防
止できるサーボ系用異常検出装置、七二□関する。
周知e様にサーボモータは位置計測制御などの分野4元
おいて広く利用されているが、その異常を防止する丸め
に従来よシサーボ系用に異常検出装置が用いられている
第1図には工業用ロボットのアーム、ハンドの関節部に
設けられそれら関節を駆動する駆動モータ10ぴ直流モ
ータロ二ついての従来のサーボ吊用異常検出装置が示さ
れている。
この種の装置は以下の様に、駆動モータの回動角を検出
本る回動角検出系12、駆動モー月0を駆動制御木るサ
ーボ系1,4、そして駆動モータ10のサーボ異常時に
これを非常停止する異常阻−正系16を有している。
第1図において上記回動角検出系12は一1駆勧モータ
10と同じくモータユニット内に納められ、駆動、モー
タ10の背後から突出し九回動輪に直結されて駆動モー
タ10の相対回動角を検出するエンコーダ18、そして
骸エンコーダ18から出力される出力パルス列10Gが
供給されこれをカウン卜するカウンタ20から構成され
ており、カウンタ20は工業用ロボットが始動する際に
そのアの後工業用ロボットの運転時にエンコーダ1−1
3の出力パルス列100をカウントすることができる。
また上記サーボ系14は、駆動モータ10の回動角を指
令する回動角指令回路22と、上記カウンタ20の相対
回動角検出値102と回動角指令回路22の回動角指令
値(目標回動角)104とを入力して回動角指令値10
4に対する相対回動角検出値102の偏差を求める比較
器24とを含み、この比較器24から出力される偏差値
106に基づいて駆動モータ10を駆動制御することが
できる。すなわちこの駆動モータ10のサーボ系14で
は、比較器24の偏差値106がDA変換器26によシ
アナログ化されて駆動モータlOを駆動するドライバ2
8に供給さ”れることによって行なわれ、この結果駆動
モータ10の回動角は前記回動角指令値104に対応し
た値にフィードバック制御される。
そしてこの従来の装置における上記異常阻止系16では
、前記比較器24の偏差値106が予め設定されたサー
ボ偏差許容値(閾値)を越えたとき′に駆゛動モータ1
0の非常停止が行なわれる様に構成されている。すなわ
ち第1図において、比較器24の偏差値106は、異常
阻止系16に設けられサーボ偏差の許容値108が記憶
されている非常停止制御回路30に供給されており、非
常停止制御回路30は偏差値106が許容値108を越
え九ときに開指令110ξ閉指令112とを同時:二出
力することができる。この開指令110によ)接点32
が開動作し、これによりドライバ28への電力供給が断
れて駆動モータ10の駆動が停止され、また閉指令11
2により接点34が閉動作し、これにより前述のモータ
ユニット内に設けられたブレーキ36への電力(交流)
供給が行なわれて駆動モータ10が非常停止される。
第1図従来装置は以上の構成からなり、以下その作用を
説明する。
工業用ロボットの始動時には前述し九様に、アームを基
準姿勢にして、カウンタ20がリセットされるので、そ
のアームの関節は回動角指令値104を初期値として回
−を開始し、との回動にンタ20でカウントされ、その
相対回動角検出値102が比較器24に供給される。こ
の比較器24の出力である偏差−1′o6は駆動モータ
10(7)回転角を指令値104に一致せしめるように
作用し、サーボ制御を行う。
上記のサーボ制御が行iわれている際に駆動モータ10
が異常を生じ偏差値106が非常停止側きには、非常停
止′制御回路30から出方される開指令110、閉指令
112によりドライバ28の動作が停止されると共にブ
レーキ36が動作するので、駆動モータ10は非常停止
する。
しかしながら、上記従来装置は、駆動モータ10のサー
ボ制御時にその異常をエンコーダ18の出力パルス列1
00のみを用いて監視していたので、エン゛コーダ18
が故゛障゛してサーボ系14へのフィードバック(相対
回動角検出値102)が断たれ九場合には、ドライバ2
8のドリフトによって駆動モータ10が回動しはじめて
異常が生じても偏差値106が変化しないので、非常停
止制御回路30が駆動モータ10の異常を検知すること
ができず、従って駆動モータ10の異常検出機能が喪失
されるおそれがあや、その信頼性:二問題があった。
本発明は上記従来の課題に鑑みて為されたものであり、
その目的とするとζろは、駆動モータのサー′ボ異常阻
止機能の信頼性を著しるしく高めることができるサーボ
系用異常検出装置を提供することにある。
上記目的を達成する。ために本発明は、−駆動モータの
回動軸に連結され駆動モータの相対、回動角を検出する
エンコーダ及び駆動モー、夕の絶対回転角を検出するポ
テンショメータを含む回動角、検出系と、駆動モータに
ついての回動角検出値の目標回転角に対する偏差値に基
づいて駆動モータを駆動制御するサーボ系と、サーボ系
の異常動作阻止を行々う異常阻止系と、を有し、異常阻
止系は、エンコーダによる相対回動角検出値とポテンシ
ョメータによる絶対回動角検出値との偏差が許容値を越
えたときに駆動モータを非常停止する非常停止制御回路
を備えたことを特徴とする。
以下図面に基づいて本発明に係るサーボ系用異常検出装
置の好適な実施例を説明する。
第2図には本発明に係わるサーボ系用異常検出装置が示
されており、前述の第1図と同一部材には同一符号を付
してそれらの説明は省略する。なお本装置は前記従来装
置と同様に工業用ロボットのアーム、ハンドの関節部を
駆動する駆動モータ10をサーボ制御している。
上述の様に本発明では、回動角検出系は駆動モータの駆
動軸に連結されその絶対回転角を検出するポテンショメ
ータを含み、異常阻止系はエンコーダによる出力パルス
列と該ポテンショメータによる絶対回動角との偏差が許
竺値を越えたときに駆動モータを非常停止する非常停止
制御回路を備えたことが特徴とされている。このため本
実施例では、ドライバユニット内に納められ駆動モータ
10の背後に突出し九回動輪に減速機構を介して連結さ
れ駆動モータ10の絶対回動角を検出するポテンショメ
ータ38′、このポテンショメータ38から出力される
アナログ検出値116をAD変換するAD変換器40が
異常阻止系16に設けられ、またさらに相対回動角検出
値102と絶対回動角検出値114とを比較する第2の
比較器42が異常阻止系16に設けられ、非常停止制御
回路30はカウンタ20の積算された相対回動角(出力
パルス)102とAD変換器40から出力された検出値
1−14とを比較する比較器42で得られた偏差値11
8が許容値109を越え九ときに接点32.34へ開指
令110、閉指令112を出力することができる。
第2図実施例装置は以上の構成から成り、以下その作用
を説明する。
本実施例装置のis ”1図従゛来装置と同様にして駆
動モータ10のサーボ制御が打込われ、その始動時ζ;
はカウンタ20がリセットされ、始動後は相対回動角検
出値102と回動角指令値104との偏差106に基づ
いて駆動モータ10の回動角がサーボ制御され、このと
き駆動モータ10が異常を生じて偏差値106が許容[
108を越えた場合には、従来と同様に非常停止制御回
路30によって駆動モータ10は非常停止される。
また本発明ではエンコーダ18が故障してサーボ系14
ヘフイードバツクが行なわれなくなった場合においては
、第2の比較器42の偏差値118が著しく増大して許
容値109を越えるので、非常停止制御回路30の開指
令110、閉指令112により駆動モータ10の非常停
止が行なわれる。
従って本発明ζ二よれば、エンコーダ1Bを含むフィー
ドバック系に異常が生じた場合においても、相対回動角
検出値102と絶対回動角検出値114の偏差値106
が増大して非常停止制御回路30により駆動モータ10
が非常停止されるので、駆動モータ10が畢走すること
はない。
なお本発明ではポテンショメータ38に異常を生じた場
合においても比較器42の偏差値118が増大するので
、駆動モータ10が非常停止される。
この様に本発明によれば、エンコーダ18またはポテン
ショメータ38が故障した場合に駆動モータ10が非常
停止されるので、駆動モータ10の異常検出機能につい
ての信頼性を極めて高くすることができる。
【図面の簡単な説明】
第1図は従来のサーボ系為異常検出装置の構成図、第2
図は本発明が適用されたサーボ系用異常検出装置の構成
図である。 10・・・駆動モータ、12・・・回動角検出系、14
・・・サーボ系、 16・・・異常阻止系、18・・・
エンコーダ、22・・・回動角指令回路、24・・・比
較器、  30・・・非常停止制御回路、38・・・ポ
テンショメータ、 42・・・比較器、102・・・出力パルス列、104
・・・回動角指令値、1o6・・・偏差値、109・・
・許容値、114・・・絶対回動角検出値、118・・
・偏差値。

Claims (1)

    【特許請求の範囲】
  1. (1)  駆動モータの回動軸に連結され駆動モータの
    相対回動角を検出するエンコーダ及び駆動モータの絶対
    回転角を検出するポテンショメータを含む回動角検出系
    と、駆動モータについての回動角検出値と目標回転角に
    対する偏差値に基づいて駆動モータを駆動制御するサー
    ボ系と、サーボ系の異常動作阻止を行壜う異常阻止系と
    、を有し、異常阻止系は、エンコーダによる相対回動角
    検出値とポテンショメータによる絶対回動角検出値との
    偏差が許容値を越えたときに駆動モータを非常停止する
    非常停止制御回路を備えたことを特徴とするサーボ系用
    異常検出装置。
JP57021804A 1982-02-12 1982-02-12 サ−ボ系用異常検出装置 Pending JPS58139201A (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP57021804A JPS58139201A (ja) 1982-02-12 1982-02-12 サ−ボ系用異常検出装置
US06/463,579 US4524313A (en) 1982-02-12 1983-02-03 Error detecting mechanism for servosystem

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP57021804A JPS58139201A (ja) 1982-02-12 1982-02-12 サ−ボ系用異常検出装置

Publications (1)

Publication Number Publication Date
JPS58139201A true JPS58139201A (ja) 1983-08-18

Family

ID=12065237

Family Applications (1)

Application Number Title Priority Date Filing Date
JP57021804A Pending JPS58139201A (ja) 1982-02-12 1982-02-12 サ−ボ系用異常検出装置

Country Status (2)

Country Link
US (1) US4524313A (ja)
JP (1) JPS58139201A (ja)

Families Citing this family (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4825376A (en) * 1986-04-17 1989-04-25 Glasstech International L.P. Controller for glass sheet processing system
JPS6330227A (ja) * 1986-07-24 1988-02-08 Fanuc Ltd 計量終了時におけるスクリュ−停止制御方式
JPS6330226A (ja) * 1986-07-24 1988-02-08 Fanuc Ltd 保圧から計量への切換制御方法
US4864206A (en) * 1986-11-20 1989-09-05 Westinghouse Electric Corp. Multiaxis robot control having improved energy monitoring system for protecting robots against joint motor overload
US5047700A (en) * 1988-03-23 1991-09-10 The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration Universal computer control system for motors
EP0385459A3 (en) * 1989-03-02 1990-11-14 Toyoda Koki Kabushiki Kaisha Synchronizing control apparatus
EP0658832B1 (de) * 1993-12-16 2000-04-26 Siemens Aktiengesellschaft Einrichtung zur Steuerung einer Werkzeugmaschine oder eines Roboters
DE69636230T2 (de) * 1995-09-11 2007-04-12 Kabushiki Kaisha Yaskawa Denki, Kitakyushu Robotersteuerung
US6700345B2 (en) * 2001-11-09 2004-03-02 Honeywell Inc. Position sensor and actuating system
JP4089663B2 (ja) * 2004-08-06 2008-05-28 双葉電子工業株式会社 ロボット用関節サーボ
ATE456080T1 (de) * 2005-12-16 2010-02-15 Siemens Ag Überwachungseinrichtung für eine antriebseinrichtung
FR2912375B1 (fr) * 2007-02-14 2009-12-18 Eurocopter France Verin electrique de commande de vol pour aeronef
TW200943016A (en) * 2008-04-10 2009-10-16 Wen-Liang Wang Control system for servo-type location/force detection and operation
CN101887252B (zh) * 2009-05-14 2012-02-01 王文亮 伺服式位置/力量检测运算控制系统
JP6053424B2 (ja) * 2012-09-25 2016-12-27 キヤノン株式会社 ロボット装置、ロボット制御方法、プログラム及び記録媒体
FR3051263B1 (fr) * 2016-05-10 2018-04-20 Safran Aircraft Engines Procede de commande d'un actionneur et dispositif de commande associe
JP7056367B2 (ja) * 2018-05-17 2022-04-19 トヨタ自動車株式会社 認識エラー検出装置、電動ブレーキ制御装置
CN114594716B (zh) * 2022-03-30 2024-08-16 四川航天烽火伺服控制技术有限公司 一种电动舵机监控方法及相关组件

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5528084A (en) * 1978-08-22 1980-02-28 Nippon Telegraph & Telephone Character display

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB1085729A (en) * 1965-07-26 1967-10-04 Ici Ltd Process control apparatus
DE2717178C3 (de) * 1977-04-19 1979-12-06 Eduard 7303 Neuhausen Hermle Elektronisches Schaltwerk
JPS5593849A (en) * 1978-12-30 1980-07-16 Toyoda Automatic Loom Works Timing setting method and apparatus in loom

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5528084A (en) * 1978-08-22 1980-02-28 Nippon Telegraph & Telephone Character display

Also Published As

Publication number Publication date
US4524313A (en) 1985-06-18

Similar Documents

Publication Publication Date Title
JPS58139201A (ja) サ−ボ系用異常検出装置
JPS61143803A (ja) ロボツトの制御装置
US4733148A (en) Method and device for brake control for a motion-monitored and controlled drive motor for a printing machine
JPH048190B2 (ja)
JPH0459586A (ja) エレベータのドア制御装置
JP2739512B2 (ja) バルブ用電動アクチュエータの停止位置異常検出機構
JP2667710B2 (ja) 産業用ロボットの安全装置
JPH03102091A (ja) エレベータのドア制御装置
JPS62163112A (ja) 産業用ロボツトの制御方法
JP2001212778A (ja) ロボットの制御装置
JPH0650004Y2 (ja) ロボツト駆動装置
JPS5985506A (ja) フイ−ドバツク制御装置
JPH087455Y2 (ja) 電動サーボモータ式調速機の制御装置
JPS603715A (ja) ロボツトの制御装置
JPS58146910A (ja) 遠隔制御装置
JPS5942521B2 (ja) 電気車保護装置
JPS5877488A (ja) 工業用ロボツトの暴走防止装置
JPS6066680A (ja) モ−タ駆動制御装置の異常検出回路
JP3057327U (ja) 電動モータによって駆動されるドアのための制御及び調整ユニット
JP2513978Y2 (ja) 速度制御装置の異常速度検出器
JPH04161095A (ja) エレベータのドア制御装置
JPS5940678B2 (ja) 船舶用操舵装置の故障検出装置
JP2006188892A (ja) ドア駆動制御装置及びドア駆動制御方法
JPH043599Y2 (ja)
JPH0350609A (ja) ロボットの制御装置