JPH0417587A - Motor control device - Google Patents

Motor control device

Info

Publication number
JPH0417587A
JPH0417587A JP12071590A JP12071590A JPH0417587A JP H0417587 A JPH0417587 A JP H0417587A JP 12071590 A JP12071590 A JP 12071590A JP 12071590 A JP12071590 A JP 12071590A JP H0417587 A JPH0417587 A JP H0417587A
Authority
JP
Japan
Prior art keywords
speed
signal
motor
current
command signal
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
JP12071590A
Other languages
Japanese (ja)
Inventor
Toru Kitajima
徹 北島
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.)
NEC Corp
Original Assignee
NEC Corp
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 NEC Corp filed Critical NEC Corp
Priority to JP12071590A priority Critical patent/JPH0417587A/en
Publication of JPH0417587A publication Critical patent/JPH0417587A/en
Pending legal-status Critical Current

Links

Abstract

PURPOSE:To enable a motor to be stopped stably and readily by turning off a position command signal and a speed command signal in response to an emergency stop command and by reducing each gain at a speed control part and a current control part. CONSTITUTION:A position command signal B and a speed command signal D are turned off at a training timing of a limit signal A. At this time, since a speed feedback signal overshoots, a speed gain Kv at a speed control part 4 is reduced at a trailing edge of the limit signal A and is controlled as in E'. Also, since current feedback signal overshoots, a current gain KI at a current control part 6 is reduced at a trailing edge of the limit signal A and is controlled as in F', thus enabling a motor 2 to be subjected to emergency stop safely so that a flow needed for stop can be minimized.

Description

【発明の詳細な説明】 技術分野 本発明はモータ制御装置に関し、特にモータの停止制御
方式に関するものである。
DETAILED DESCRIPTION OF THE INVENTION Technical Field The present invention relates to a motor control device, and more particularly to a motor stop control system.

従来技術 NC工作機械や産業用ロボット等に使用されるモータの
制御では、モータ停止指令であるリミット信号が入力さ
れると、緊急停止をなすように制御することが必要とな
る。この場合、モータを安定に停止させかつ停止に要す
るいわゆる流れ量が最短となるように緊急停止制御がな
される。
BACKGROUND OF THE INVENTION In controlling motors used in NC machine tools, industrial robots, etc., it is necessary to control the motors to make an emergency stop when a limit signal, which is a motor stop command, is input. In this case, emergency stop control is performed to stably stop the motor and to minimize the so-called flow rate required for stopping.

第3図はこの様な従来の緊急停止制御装置のブロック図
である。位置制御部1はパルス列で与えられる位置指令
信号Bとモータ2のエンコーダ3からの位置フィードバ
ック信号Cとを用いて速度指令信号りを生成するもので
ある。
FIG. 3 is a block diagram of such a conventional emergency stop control device. The position control section 1 generates a speed command signal using a position command signal B given in the form of a pulse train and a position feedback signal C from an encoder 3 of the motor 2.

速度制御部4はパルス列で与えられる速度指令信号りと
モータ2の速度検出部5からの速度フィードバック信号
Eとを用いて電流指令信号Gを生成するものである。
The speed control section 4 generates a current command signal G using a speed command signal given in the form of a pulse train and a speed feedback signal E from the speed detection section 5 of the motor 2.

電流制御部6はパルス列で与えられる電流指令信号Gと
モータ2の電流検出部7からの電流フィ−ドパツク信号
Fとを用いてモータ駆動信号を生成するものである。
The current control section 6 generates a motor drive signal using a current command signal G given in the form of a pulse train and a current feed pack signal F from the current detection section 7 of the motor 2.

停止制御部8はリミット信号Aによりモータ2を緊急停
止するために位置指令信号Bを停止させるためのゲート
9を制御するものである。
The stop control section 8 controls a gate 9 for stopping the position command signal B in order to emergency stop the motor 2 based on the limit signal A.

第4図は第3図の回路ブロックの動作を示す各部信号波
形図であり、第4図(A)〜(E)は第3図の各部信号
A−Hの波形を夫々対応して示している。
FIG. 4 is a waveform diagram of each part of the circuit block showing the operation of the circuit block of FIG. There is.

リミット信号Aの立下りタイミングに応答して、位置指
令信号Bがゲート9によりオフとなり、位置制御部1に
対する位置指令か断となる。よって、位置フィードバッ
ク信号C1速度指令信号り及び速度フィードバック信号
Eか夫々次第に減少して、モータ停止制御を行うように
なっている。
In response to the fall timing of the limit signal A, the position command signal B is turned off by the gate 9, and the position command to the position control section 1 is cut off. Therefore, the position feedback signal C1, the speed command signal, and the speed feedback signal E are each gradually decreased to perform motor stop control.

この場合、リミット信号Aが立下ってがらモータ2が停
止するまでのいわゆる流れ量が小さいことが必要となる
In this case, it is necessary that the so-called flow amount from when the limit signal A falls until the motor 2 stops is small.

工作機械や産業用ロボット等のモータ応用システムでは
、可動範囲が限られているために、衝突防止の目的から
、有効可動範囲を当該可動範囲内に設定し、最大速度で
有効可動範囲を飛出しても、緊急停止指令により緊急停
止処理を行って可動範囲内で停止するように予め設計さ
れているのが普通である。
Motor application systems such as machine tools and industrial robots have limited movable ranges, so for the purpose of collision prevention, the effective movable range is set within the movable range, and the effective movable range is set at maximum speed. However, it is usually designed in advance to perform emergency stop processing in response to an emergency stop command and to stop within the movable range.

しかしながら、モータ応用システムの高速化、高機能化
に伴って、最大速度を更に大とし、また有効可動範囲を
拡大したいという要求が強くなっている。
However, as motor application systems become faster and more sophisticated, there is a growing demand to further increase the maximum speed and expand the effective movable range.

第3図に示したモータの緊急停止制御方式では、モータ
の流れ量が大きく、現状以上にモータ速度を上げること
は困難となっている。
In the motor emergency stop control system shown in FIG. 3, the flow rate of the motor is large, making it difficult to increase the motor speed beyond the current level.

発明の目的 本発明の目的は、モータ緊急停止時の流れ量を極力短縮
することができるモータ制御装置を提供することである
OBJECTS OF THE INVENTION An object of the present invention is to provide a motor control device that can reduce the flow rate as much as possible during an emergency motor stop.

発明の構成 本発明によるモータ制御装置は、位置指令信号とモータ
のエンコーダからの位置フィードバック信号とを用いて
速度指令信号を生成する位置制御部と、前記速度指令信
号と前記モータの速度検出部からの速度フィードバック
信号とを用いて電流指令信号を生成する速度制御部と、
前記電流指令信号と前記モータの電流検出部からの電流
フィトバック信号とを用いて前記モータの駆動信号を生
成する電流制御部と、モータ停止指令に応答して前記位
置指令信号及び前記速度指令信号を断制御する手段と、
前記位置指令信号に応答して前記速度制御部及び電流制
御部の各ゲインを減少制御する手段とを含むことを特徴
とする。
Composition of the Invention A motor control device according to the present invention includes a position control section that generates a speed command signal using a position command signal and a position feedback signal from an encoder of the motor, and a position control section that generates a speed command signal using a position command signal and a position feedback signal from an encoder of the motor; a speed control unit that generates a current command signal using the speed feedback signal of the
a current control unit that generates a drive signal for the motor using the current command signal and a current fitback signal from a current detection unit of the motor; and a current control unit that generates a drive signal for the motor using the current command signal and a current feedback signal from a current detection unit of the motor, and a current control unit that generates the position command signal and the speed command signal in response to a motor stop command. means for controlling the
The apparatus is characterized in that it includes means for decreasing each gain of the speed control section and the current control section in response to the position command signal.

実施例 次に、本発明の実施例を図面を参照して詳細に説明する
Embodiments Next, embodiments of the present invention will be described in detail with reference to the drawings.

第1図は本発明の実施例のブロック図であり、第3図と
同等部分は同一符号により示される。第3図と異なる部
分のみについて述べれば、速度制御部4の人力である速
度指令信号りをオフとするゲート10を設け、停止制御
部8によりこのゲート10をオフ制御するようになって
いる。
FIG. 1 is a block diagram of an embodiment of the present invention, and parts equivalent to those in FIG. 3 are designated by the same reference numerals. To describe only the differences from FIG. 3, a gate 10 is provided to turn off the speed command signal, which is the manual input of the speed control section 4, and this gate 10 is controlled to be turned off by the stop control section 8.

また、速度制御部4と電流制御部6との各ゲイン、すな
わち速度ゲインKVと電流ゲインKlとを、停止制御部
8により減少制御するようになっている。
Further, the respective gains of the speed control section 4 and the current control section 6, that is, the speed gain KV and the current gain Kl, are controlled to decrease by the stop control section 8.

第2図は第1図のブロックの動作を示す各部信号波形図
である。リミット信号Aの立下りタイミングで、位置指
令信号Bと速度指令信号りとを断とする。このとき、速
度フィードバック信号は第2図(E)に示す如くオーバ
シュートするので、リミット信号Aの立下りて速度制御
部4の速度ゲインKVを減少させ、(E−)に示す如く
制御する。
FIG. 2 is a signal waveform diagram of each part showing the operation of the blocks in FIG. 1. At the falling timing of the limit signal A, the position command signal B and the speed command signal are disconnected. At this time, the speed feedback signal overshoots as shown in FIG. 2(E), so the limit signal A falls and the speed gain KV of the speed control section 4 is decreased to perform control as shown in FIG. 2(E-).

同様に、電流フィードバック信号も第2図(F)の如く
オーバシュートするので、リミット信号への立下りで電
流制御部6の電流ゲインに1を減少させ、(F′)の様
に制御する。
Similarly, since the current feedback signal also overshoots as shown in FIG. 2 (F), the current gain of the current control section 6 is decreased by 1 at the fall to the limit signal, and control is performed as shown in (F').

こうすることにより、安定にかつ停止に要する流れ量を
最短になるように緊急停止が可能となるのである。
By doing this, it is possible to perform an emergency stop stably and with the flow amount required for stopping the flow in the shortest possible time.

発明の効果 斜上の如く、本発明によれば、緊急停止指令に応答して
、位置指令信号と速度指令信号とをオフとすると共に、
速度制御部と電流制御部との各ゲインを減少させるよう
にしたので、モータの安定かつ速やかな停止が可能とな
るという効果がある。
Effects of the Invention As shown above, according to the present invention, in response to an emergency stop command, the position command signal and the speed command signal are turned off, and
Since each gain of the speed control section and the current control section is reduced, there is an effect that the motor can be stopped stably and quickly.

【図面の簡単な説明】[Brief explanation of drawings]

第1図は本発明の実施例のシステムブロック図、第2図
は第1図のブロックの動作を示す各部信号波形図、第3
図は従来技術を示すシステムブロック図、第4図は第3
図のブロックの動作を示す各部信号波形図である。 主要部分の符号の説明 1・・・・・・位置制御部 2・・・・・・モータ      8・・・・・・停止
制御部3・・・・・・エンコーダ 9,10・・・・・
ゲート4・・・・・・速度制御部 5・・・・・速度検出部 6・・・・・・電流制御部 7・・・・・・電流検出部 (A)  リミットイgg (B) イ立置王1j4イ吉号 (F5を光フィード゛バック(g号 笛2図 一一シーーーー 皿皿正一一一一一
FIG. 1 is a system block diagram of an embodiment of the present invention, FIG. 2 is a signal waveform diagram of each part showing the operation of the blocks in FIG. 1, and FIG.
The figure is a system block diagram showing the conventional technology.
FIG. 4 is a signal waveform diagram of each part showing the operation of the blocks in the figure. Explanation of symbols of main parts 1... Position control section 2... Motor 8... Stop control section 3... Encoder 9, 10...
Gate 4...Speed control section 5...Speed detection section 6...Current control section 7...Current detection section (A) Limit trigger (B) Okio 1j4 Ikichi-go (F5 optical feedback (g-go whistle 2 fig.

Claims (1)

【特許請求の範囲】[Claims] (1)位置指令信号とモータのエンコーダからの位置フ
ィードバック信号とを用いて速度指令信号を生成する位
置制御部と、前記速度指令信号と前記モータの速度検出
部からの速度フィードバック信号とを用いて電流指令信
号を生成する速度制御部と、前記電流指令信号と前記モ
ータの電流検出部からの電流フィードバック信号とを用
いて前記モータの駆動信号を生成する電流制御部と、モ
ータ停止指令に応答して前記位置指令信号及び前記速度
指令信号を断制御する手段と、前記位置指令信号に応答
して前記速度制御部及び電流制御部の各ゲインを減少制
御する手段とを含むことを特徴とするモータ制御装置。
(1) A position control section that generates a speed command signal using a position command signal and a position feedback signal from an encoder of the motor, and a position control section that uses the speed command signal and a speed feedback signal from the speed detection section of the motor. a speed control unit that generates a current command signal; a current control unit that generates a drive signal for the motor using the current command signal and a current feedback signal from a current detection unit of the motor; and a current control unit that responds to a motor stop command. and means for controlling each gain of the speed control section and the current control section to decrease in response to the position command signal. Control device.
JP12071590A 1990-05-10 1990-05-10 Motor control device Pending JPH0417587A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP12071590A JPH0417587A (en) 1990-05-10 1990-05-10 Motor control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP12071590A JPH0417587A (en) 1990-05-10 1990-05-10 Motor control device

Publications (1)

Publication Number Publication Date
JPH0417587A true JPH0417587A (en) 1992-01-22

Family

ID=14793209

Family Applications (1)

Application Number Title Priority Date Filing Date
JP12071590A Pending JPH0417587A (en) 1990-05-10 1990-05-10 Motor control device

Country Status (1)

Country Link
JP (1) JPH0417587A (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102287199A (en) * 2011-06-24 2011-12-21 北京市三一重机有限公司 Current interruption inductive multistage abrasion detection tool for shield machine

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102287199A (en) * 2011-06-24 2011-12-21 北京市三一重机有限公司 Current interruption inductive multistage abrasion detection tool for shield machine

Similar Documents

Publication Publication Date Title
JP4075803B2 (en) Motor control device
JP2897333B2 (en) Servo control device
EP0108384A1 (en) Safety maintaining method and apparatus for automatic machines
JPH05118302A (en) Controller for servomotor
KR910017725A (en) Servo Motor Control Device
JPH0969013A (en) Control mode switching method of servo system using servomotor
JPH0417587A (en) Motor control device
JPS61203883A (en) Servo motor control system
JPS60116004A (en) Numerical controller of full-closed-loop control system
JPH0792702B2 (en) Control device
JP3556779B2 (en) Servo motor overshoot prevention method
JP3246559B2 (en) Servo control method
JPH05146989A (en) Control device for industrial robot
JPS6378206A (en) Following delay removal method using digital servo system in full close feedback nc system
JPS603715A (en) Controller for robot
JPH05250022A (en) Control system for motor
JP3301190B2 (en) Spindle operation switching method
JPH08132369A (en) Robot controller
JP2008253132A (en) Method of detecting and controlling abnormal load in servo motor and articulated robot
JPS6235918A (en) Detection of servo abnormality
JPS60216778A (en) Controller for drive motor
JPH09167023A (en) Servo control method
JPH077284B2 (en) Robot controller
JP2841558B2 (en) Torque control method that compensates for backlash of reduction gear
JP2020106930A (en) Control method, controller, and program