JP2005176493A - Emergency stop method for motor driving device - Google Patents
Emergency stop method for motor driving device Download PDFInfo
- Publication number
- JP2005176493A JP2005176493A JP2003412919A JP2003412919A JP2005176493A JP 2005176493 A JP2005176493 A JP 2005176493A JP 2003412919 A JP2003412919 A JP 2003412919A JP 2003412919 A JP2003412919 A JP 2003412919A JP 2005176493 A JP2005176493 A JP 2005176493A
- Authority
- JP
- Japan
- Prior art keywords
- drive device
- motor
- abnormality
- emergency stop
- controller
- 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.)
- Granted
Links
Images
Abstract
Description
本発明は機械的に複数軸の多軸機械を制御するモータ駆動装置の非常停止方法に関する。 The present invention relates to an emergency stop method for a motor drive device that mechanically controls a multi-axis multi-axis machine.
従来の機械的に結合された2軸を有する多軸機械を制御するモータ駆動装置の非常停止方法としては、特許文献1がある。
また、コントローラと多軸サーボ制御装置間の接続に伝送手段を用いた例として特許文献2がある。
従来例の非常停止方法について図6、図7を用いて説明する。図6は工作機械の同期駆動装置であるクランクピン研削装置の構成を示したものである。図6において左側の機械ブロックは左側チャック駆動装置、右側の機械ブロックは右側チャック駆動装置である。36R、36Lは主軸モータ、38R、38Lは 歯車、40R、40Lはエンコーダ、42R、42Lは電磁ブレーキ、48R、48Lはサーボアンプ、54はCNC装置、56はPLC装置、58R、58Lはダイナミックブレーキ機構である。工作物を固定した両側2つの油圧チャック22R、22Lを2台の主軸モータ36R、36Lの同期駆動することで実現している。従って同期がずれると2つの油圧チャック間にねじれが発生し、工作物に応力がかかり、場合によっては破損することもある。このため従来例では停電や故障などの非常時においても同期ずれを少なくなるように、工夫がされている。つまり、動作異常が発生すると、まず2つの主軸モータ36R、36Lをタイマで決められた一定時間ダイナミックブレーキ58R、58Lを動作させて減速し、その後、電磁ブレーキ42R、42Lを動作させて停止させる。
また、図9の従来例は、コンピュータとモータのモーション制御を行う複数のサーボコントローラとの間でシリアル通信を行うサーボ制御の構成を示したものである。図9で101はパソコン、102はパソコンの拡張ボードで高速シリアル通信インタフェース、103から105はサーボコントローラである。コンピュータ101とサーボコントローラ103から104を第1伝送106と第2伝送107の2本の伝送手段で接続する構成としている。つまり、第1伝送106はコンピュータ101からサーボコントローラ103〜105へ、第2伝送107はサーボコントローラ103〜105からコンピュータへ情報を伝送する。この従来例はサーボコントローラ103〜105で発生したアラーム情報を第2伝送107を通してアラーム情報や位置情報をコンピュータ101のメモリに書き込み、コンピュータ101はアラーム情報に応じた処理をして第1伝送106を介して各サーボコントローラ103〜105へ指令やアラームを発生したサーボコントローラの位置情報を伝送する。サーボコントローラ103〜105はコンピュータ101の指令に従って処理をする。
As an emergency stop method for a motor drive device for controlling a conventional multi-axis machine having two mechanically coupled two axes, there is
A conventional emergency stop method will be described with reference to FIGS. FIG. 6 shows a configuration of a crankpin grinding device which is a synchronous drive device of a machine tool. In FIG. 6, the left machine block is the left chuck drive device, and the right machine block is the right chuck drive device. 36R and 36L are spindle motors, 38R and 38L are gears, 40R and 40L are encoders, 42R and 42L are electromagnetic brakes, 48R and 48L are servo amplifiers, 54 is a CNC device, 56 is a PLC device, and 58R and 58L are dynamic brake mechanisms. It is. The two
Further, the conventional example of FIG. 9 shows a configuration of servo control that performs serial communication between a computer and a plurality of servo controllers that perform motion control of a motor. In FIG. 9, 101 is a personal computer, 102 is a personal computer expansion board, a high-speed serial communication interface, and 103 to 105 are servo controllers. The
しかしながら、特許文献1の従来例である工作機械の同期駆動装置の非常停止方法は、構成するハードウエアの、主軸モータ、負荷などのばらつきによりずれが生じることはさけられず、これ以上2軸の同期精度をあげることができないという問題があった。
また、特許文献2の従来例では、アラーム発生時に第2伝送で位置情報をコンピュータに返し、コンピュータで処理をした後に、第1伝送を介してサーボコントローラに指令やアラーム発生サーボコントローラの位置情報を各サーボコントローラに伝送するので、時間遅れが発生し、非常停止をする場合には追従動作に遅れが発生するという問題があった。
本発明は、上記問題を解決するためになされたものであり、コントローラと駆動装置間を第1伝送手段、駆動装置間は第2伝送手段で接続し、異常を発生した駆動装置は異常情報をコントローラと異常を発生していない駆動装置に伝送した後、所定の停止方法によってモータを停止させ、異常を発生していない駆動装置は異常情報に基づき異常を発生した駆動装置の位置情報を基に所定の方法で停止させる。このように本発明は、負荷などのばらつきが生じても軸間の同期精度を高め、機械のストレスを減少できるモータ駆動装置の非常停止方法と提供することを目的とする。
However, the conventional emergency stop method of the synchronous drive device of the machine tool disclosed in
In the conventional example of
The present invention has been made to solve the above-described problem. The controller and the drive device are connected by the first transmission means, and the drive device is connected by the second transmission means. After transmitting to the controller and the drive device that does not cause an abnormality, the motor is stopped by a predetermined stopping method, and the drive device that does not produce an abnormality is based on the position information of the drive device that has produced an abnormality based on the abnormality information. Stop in a predetermined way. Thus, an object of the present invention is to provide an emergency stop method for a motor drive device that can increase the accuracy of synchronization between shafts and reduce the stress of a machine even if variations such as loads occur.
請求項1記載の本発明は、機械的に結合された2軸を有する多軸の機械を駆動する多軸駆動装置で、2軸のうち1軸を駆動する第1モータと第1駆動装置と、2軸のうち他の1軸を駆動する第2モータと第2駆動装置と、2軸以外の第3モータから第nモータと、第3駆動装置から第n駆動装置と、第1伝送手段を介して第1サンプリング時間ごとに第1駆動装置から第n駆動装置までを制御するコントローラからなるサーボ制御装置の第1駆動装置または第2駆動装置のいずれかに異常を発生した場合の非常停止方法において、駆動装置はコントローラを介さずに、互いの位置、速度、異常状態などの状態情報を第2サンプリング時間ごとに伝送する第2伝送手段を有し、異常発生を検知した駆動装置は状態情報をコントローラと異常を発生していない他の駆動装置に伝送し、異常発生を検知した駆動装置は異常発生側のモータを所定の減速方法で停止させ、異常を発生していない他の駆動装置は異常発生駆動装置の状態情報をもとに所定の方法で停止するという手順で非常停止するので軸間の同期精度を高めることができ、機械のストレスを減少できる。
請求項2記載の本発明は、請求項1記載のサーボ制御装置の非常停止方法において、 異常発生駆動装置の減速方法はモータを正常に駆動できる場合は全ての駆動装置はコントローラからの位置指令によりモータを停止するので、軸間の同期精度を高めることができ、機械のストレスを減少できる。
請求項3記載の本発明は、請求項1記載のサーボ制御装置の非常停止方法において、異常発生駆動装置の減速方法はモータを正常に駆動できる場合はあらかじめ決められた減速曲線に沿って減速し、正常に駆動できない場合はモータを電気的に切り離し、モータ端子を抵抗で短絡するダイナミックブレーキ等の制動手段を使用して停止させ、異常を発生していない駆動装置は、異常発生駆動装置の状態情報の位置情報に追従して制御するので、軸間の同期精度を高めることができ、機械のストレスを減少できる。
請求項4記載の本発明は、請求項3記載のサーボ制御装置の非常停止方法において、異常を発生していない駆動装置の減速方法は異常発生駆動装置の状態情報の速度情報をフィードフォワードするので、軸間の同期精度を高めることができ、機械のストレスを減少できる。
請求項5記載の本発明は、請求項1記載のサーボ制御装置の非常停止方法において、第1伝送手段と第2伝送手段はシリアル通信であるので、配線数を少なくでき、低コスト化を図ることができる。
請求項6記載の本発明は、請求項1記載のサーボ制御装置の非常停止方法において、第1サンプリング周期と第2サンプリング周期は同期しているので軸間精度を高めることができ、機械のストレスを減少できる。
The present invention according to
According to a second aspect of the present invention, in the emergency stop method of the servo control device according to the first aspect, the deceleration method of the abnormality-generating drive device is such that when the motor can be driven normally, all the drive devices are controlled by position commands from the controller. Since the motor is stopped, the synchronization accuracy between the axes can be increased, and the mechanical stress can be reduced.
According to a third aspect of the present invention, in the emergency stop method of the servo control device according to the first aspect, the deceleration method of the abnormality-generating drive device decelerates along a predetermined deceleration curve when the motor can be driven normally. If the motor cannot be driven normally, the motor is electrically disconnected and stopped using a braking means such as a dynamic brake that short-circuits the motor terminal with a resistor. Since control is performed following the positional information of the information, the accuracy of synchronization between the axes can be increased, and the stress of the machine can be reduced.
According to a fourth aspect of the present invention, in the emergency stop method for the servo control device according to the third aspect, the speed reducing method for the drive device in which the abnormality has not occurred feeds forward speed information of the state information of the drive device in which the abnormality has occurred. , The synchronization accuracy between the axes can be increased, and the stress of the machine can be reduced.
According to a fifth aspect of the present invention, in the emergency stop method for the servo control device according to the first aspect, since the first transmission means and the second transmission means are serial communication, the number of wirings can be reduced and the cost can be reduced. be able to.
According to a sixth aspect of the present invention, in the emergency stop method of the servo control device according to the first aspect, since the first sampling period and the second sampling period are synchronized, the accuracy between the axes can be increased, and the stress of the machine is increased. Can be reduced.
本発明によれば、機械的に結合された2軸を有する多軸の機械と、2軸のうち1軸を駆動する第1モータと第1駆動装置と、2軸のうち他の1軸を駆動する第2モータと第2駆動装置と、2軸以外の第3から第nモータと、第3から第n駆動装置と、第1伝送手段を介して第1サンプリング周期ごとに第1駆動装置から第n駆動装置までを制御するコントローラと、駆動装置はコントローラを介さずに直接、互いの位置・速度・アラーム状態などの状態情報を第2サンプリング周期で伝送する第2伝送手段とからなるサーボ制御装置の第1駆動装置または第2駆動装置のいずれかに異常を発生した場合において、異常を発生した駆動装置は状態情報をコントローラと異常を発生していない他の駆動装置に伝送し、異常を発生した駆動装置はモータを所定の減速方法で停止させ、異常を発生していない駆動装置は異常を発生した駆動装置の状態情報をもとに所定の方法で停止するので、軸間の同期精度を高めることができ、機械のストレスを減少できる。 According to the present invention, a multi-axis machine having two axes mechanically coupled, a first motor and a first driving device for driving one of the two axes, and another one of the two axes. A second driving device and a second driving device to be driven, third to n-th motors other than two axes, third to n-th driving devices, and a first driving device every first sampling period via the first transmission means To the n-th driving device, and the driving device is a servo comprising a second transmission means for directly transmitting state information such as position, speed, alarm state, etc. at a second sampling period without going through the controller. When an abnormality occurs in either the first driving device or the second driving device of the control device, the driving device that has generated the abnormality transmits the status information to the controller and another driving device that has not generated the abnormality, The drive that generated the The drive is stopped by a predetermined deceleration method, and the drive device that does not generate an abnormality is stopped by a predetermined method based on the status information of the drive device in which the abnormality has occurred. , Can reduce the mechanical stress.
以下、本発明の実施例を図を用いて説明する。 Embodiments of the present invention will be described below with reference to the drawings.
図1は実施例1の構成を示したものである。図1において1はコントローラ、2〜5はそれぞれ、第1駆動装置、第2駆動装置、第3駆動装置、第n駆動装置、6〜9はそれぞれ、第1モータ、第2モータ、第3モータ、第nモータ、10〜13はそれぞれ、第1位置検出器、第2位置検出器、第3位置検出器、第n位置検出器、14〜17は機械可動部のスライダでそれぞれ、第1スライダ、第2スライダ、第3スライダ、第nスライダである。ここで第1スライダと第2スライダは締結部18で機械的に結合されている。第1モータと第2モータの2台のモータを同期制御をして1軸を駆動する、いわゆるツインドライブである。また、19はコントローラと各駆動装置を接続する第1伝送手段、20は各駆動装置を接続する第2伝送手段である。
FIG. 1 shows the configuration of the first embodiment. In FIG. 1, 1 is a controller, 2 to 5 are a first drive device, a second drive device, a third drive device, an nth drive device, and 6 to 9 are a first motor, a second motor, and a third motor, respectively. , N-
次に動作について説明する。コントローラ1はプログラムされたとおりサンプリング周期ごとに各軸の位置指令データを演算し、第1伝送手段19を介して各駆動装置2〜5に位置指令データを伝送する。各駆動装置2〜5は第1伝送手段19を通して各駆動装置内のメモリ等に書かれた位置指令データを読み込み、あらかじめ物理的に決められた同じ時刻に各軸一斉に位置指令データを有効にしモータを駆動する。図3は実施例1の機械的に結合された2軸の制御ブロック図である。図3において、21は第1位置制御部、22は第1速度制御部、23は第2トルク制御部、24は第1速度変換部、25は第2位置制御部、26は第2速度制御部、27は第2トルク制御部、28は第2速度変換部である。各駆動装置は位置指令19を読み取ると位置指令19を位置検出器で検出した実際位置とともに位置制御部へ入力する。位置制御部21、25は位置指令から実際位置を引き算して位置偏差をもとめPI又はPID演算等の位置制御処理を行って速度制御部へ速度指令を出力する。速度制御部は速度指令と実際速度の差をとって速度偏差をもとめ、速度偏差をPI又はPID演算等の制御処理を行ってトルク指令をトルク制御部へ出力する。トルク制御部はトルク指令を電流指令に変換し、電流指令と実際電流との差をとって電流偏差をもとめ、電流偏差をPID処理などの制御処理を行い電圧指令とし、電圧指令を図示しない電力変換部を介して電力増幅してモータを駆動する。さらに、各駆動装置は位置、速度、トルク、アラームなどの状態情報をリアルタイムでモニタし、モニタした情報を第1伝送手段19を通してコントローラへ伝送する。さらに、各駆動装置は第2伝送手段20を通して,伝送周期のなかの各駆動装置個別に割りあてられた時間に他の駆動装置へ伝送する。また第2伝送手段20の第2サンプリングとは第1伝送手段19の第2サンプリングは時間的に同期して動作させることにより、精度を上げることができる。
駆動装置に異常が発生すると異常情報はコントローラと各駆動装置に伝送され、各駆動装置は所定の動作で停止する。異常情報には、異常の内容を識別した異常信号コードを含んでおり、コントローラや異常を発生していない他の軸は、異常信号コードを読むことで異常内容を判別できる。駆動装置の異常には、モータ駆動を維持できる異常とモータ駆動を維持できない異常がある。過電流異常や過電圧異常などは、駆動装置内の部品が故障した場合やこのままモータ駆動を維持すると部品故障にいたるような異常であり、あらかじめ決められた異常検出レベルを超えると電力変換装置のパワー素子の駆動を即遮断し、異常発生信号を出力する。それに対し、過負荷警報やバッテリ電圧低下警報などの異常はモータ駆動を維持してもすぐ故障には至らないので、異常発生信号を出力するだけでパワー素子の駆動を遮断することはなくモータを正常に駆動できる。異常発生駆動装置がモータを正常に駆動できる場合は、最も精度よく停止できるように、コントローラの異常停止位置指令に基づき全軸により停止する。異常発生駆動装置がモータを正常に駆動できない場合はモータを電気的に切り離し、ユーザパラメータで設定された方法で停止する。例えばモータ端子を抵抗で短絡して制動トルクを得るダイナミックブレーキを使用することで惰走距離を最小にできる。異常を発生していない駆動装置は異常発生駆動装置がモータを正常に駆動できる場合は、コントローラの異常停止位置指令に基づき停止し、異常発生駆動装置がモータを正常に駆動できない場合は、異常発生駆動装置の状態情報の位置情報に基づいてスレーブ動作として追従動作をする。但し、異常発生駆動装置の状態情報の位置情報に基づいて追従動作をするのは、第1駆動装置と第2駆動装置だけである。図3は正常な状態のブロック図であるが、異常発生駆動装置がモータを正常に駆動できる場合にも適用でき、コントローラの位置指令どおりに停止する。このときのタイムチャートを図5に示す。
Next, the operation will be described. The
When an abnormality occurs in the drive device, the abnormality information is transmitted to the controller and each drive device, and each drive device stops in a predetermined operation. The abnormality information includes an abnormality signal code that identifies the content of the abnormality, and the controller and other axes that do not generate an abnormality can determine the abnormality content by reading the abnormality signal code. The abnormality of the drive device includes an abnormality that can maintain the motor drive and an abnormality that cannot maintain the motor drive. An overcurrent abnormality or overvoltage abnormality is an abnormality that results in a component failure if a component in the drive unit fails or if the motor drive is maintained as it is, and if the predetermined abnormality detection level is exceeded, the power of the power converter Immediately shuts off the drive of the element and outputs an abnormality occurrence signal. On the other hand, abnormalities such as overload warnings and low battery voltage alarms do not immediately cause a failure even if the motor drive is maintained. It can be driven normally. When the abnormality-generating drive device can drive the motor normally, it stops by all axes based on the abnormal stop position command of the controller so that it can be stopped with the highest accuracy. When the abnormality occurrence driving device cannot drive the motor normally, the motor is electrically disconnected and stopped by the method set by the user parameter. For example, the coasting distance can be minimized by using a dynamic brake that obtains braking torque by short-circuiting the motor terminal with a resistor. A drive device that has not caused an abnormality will stop based on the abnormal stop position command of the controller if the abnormality drive device can drive the motor normally, and an error will occur if the drive device that has failed cannot drive the motor normally The follow-up operation is performed as a slave operation based on the position information of the state information of the driving device. However, only the first driving device and the second driving device perform the tracking operation based on the position information of the state information of the abnormality-generating driving device. FIG. 3 is a block diagram in a normal state, but it can also be applied to a case where the abnormality occurrence driving device can drive the motor normally, and stops according to the position command of the controller. A time chart at this time is shown in FIG.
図4は異常発生駆動装置がモータを正常に駆動できない場合のブロック図を示したものである。異常を発生していない駆動装置が異常発生駆動装置の状態情報のなかの位置情報に基づいて追従動作をする。図4においてSW1は第1駆動装置の位置指令をコントローラか第2駆動装置の実際位置かを切替え、SW2は第2駆動装置の位置指令をコントローラか第1駆動装置の実際速度かを切替え、SW3は第1駆動装置の速度指令に第2駆動装置の実際速度を加えるかどうかを切替え、SW4は第2駆動装置の速度指令に第1駆動装置の実際速度を加えるかどうかを切替える。実際速度を他の駆動装置の速度指令として加えるフィードフォワード制御は追従精度を向上させる。
通常の場合、異常発生駆動装置はコントローラの位置指令データどおりには動作できなくなる確率が高く、電源ラインから主回路を開放し、ダイナミックブレーキをかけて停止する。このとき、異常を発生していない駆動装置を急速に減速停止をするとダイナミックブレーキのほうが減速停止よりも制動トルクが弱いので軸間に同期誤差を発生する。同期誤差を発生を抑えるために、異常を発生していない駆動装置を異常発生駆動装置の位置情報に追従して動作させ、同期誤差を少なくする。図4において正常な状態ではSW1とSW2はコントローラの位置指令を選択するので第1駆動装置と第2駆動装置はコントローラからの指令に従って同期動作を行う。ここで、例えば第1駆動装置に異常が発生すると第1駆動装置はコントローラの指令には関係なく第1モータにダイナミックブレーキをかけて停止させる。同時にSW2コントローラの位置指令を切り離し、第1駆動装置の実際速度を接続して、位置指令とする。さらに、SW4は閉じられ、第1駆動装置の実際速度を速度指令として加え速度フィードフォワード制御を行う。結果として、第2モータは第1モータの動作に追従して動作することになる。図6は第2駆動装置が第1駆動装置の追従動作をしているときのタイムチャートを示している。逆に第2駆動装置に異常が発生した場合も同様に第1駆動装置は第2駆動装置の動作に追従して動作する。上述の停止動作指令は上位のコントローラ1を介すことなく第1駆動装置と第2駆動装置との間で直接に伝送される。このため、上位コントローラが介在する場合に比べ高速に同期した減速停止動作ができる。
FIG. 4 shows a block diagram in a case where the abnormality occurrence driving device cannot drive the motor normally. A drive device in which no abnormality has occurred performs a follow-up operation based on position information in the state information of the abnormality-occurring drive device. In FIG. 4, SW1 switches the position command of the first drive device between the controller and the actual position of the second drive device, SW2 switches the position command of the second drive device between the controller and the actual speed of the first drive device, SW3 Switches whether to add the actual speed of the second drive device to the speed command of the first drive device, and SW4 switches whether to add the actual speed of the first drive device to the speed command of the second drive device. Feed-forward control in which the actual speed is added as a speed command for another drive device improves the tracking accuracy.
In a normal case, there is a high probability that the abnormality occurrence drive device cannot operate in accordance with the position command data of the controller, and the main circuit is released from the power supply line and stopped by applying a dynamic brake. At this time, if the drive device in which no abnormality has occurred is rapidly decelerated and stopped, the dynamic brake has a weaker braking torque than the decelerating stop, so that a synchronization error occurs between the shafts. In order to suppress the occurrence of the synchronization error, the drive device in which no abnormality has occurred is operated following the position information of the drive device in which the abnormality has occurred to reduce the synchronization error. In FIG. 4, SW1 and SW2 select a controller position command in a normal state, so that the first driving device and the second driving device perform a synchronous operation in accordance with the command from the controller. Here, for example, when an abnormality occurs in the first drive device, the first drive device applies a dynamic brake to the first motor and stops it regardless of a command from the controller. At the same time, the position command of the SW2 controller is disconnected and the actual speed of the first drive device is connected to obtain the position command. Further, SW4 is closed, and the actual speed of the first drive device is added as a speed command to perform speed feedforward control. As a result, the second motor operates following the operation of the first motor. FIG. 6 shows a time chart when the second driving device is following the first driving device. Conversely, when an abnormality occurs in the second drive device, the first drive device similarly operates following the operation of the second drive device. The stop operation command described above is directly transmitted between the first drive device and the second drive device without passing through the
図2は実施例3の構成を示したものである。図3においてコントローラ1からの指令は第1伝送手段を通して第1駆動装置、第3駆動装置に伝送され、第2駆動装置は第1駆動装置からの指令を第2伝送手段を通して伝送される。
駆動装置に異常が発生すると異常情報は第1伝送手段と第2伝送手段を通してコントローラと各駆動装置に伝送され、各駆動装置は所定の動作で停止する。この時、異常発生駆動装置がモータを正常に駆動できる場合は、コントローラの異常停止位置指令に基づき全軸停止する。但し、第2駆動装置は第1駆動装置からの指令で停止する。異常発生駆動装置がモータを正常に駆動できない場合はモータを電気的に切り離し、モータ端子を抵抗で短絡して制動トルクを得るダイナミックブレーキにより停止する。異常を発生していない駆動装置は異常発生駆動装置がモータを正常に駆動できる場合はコントローラの異常停止位置指令に基づき停止し、異常発生駆動装置がモータを正常に駆動できない場合は、異常発生駆動装置の状態情報の位置情報に基づいて追従動作をする。ここで異常発生駆動装置の状態情報の位置情報に基づいて追従動作をするのは、第1駆動装置と第2駆動装置だけである。つまり、第1駆動装置に異常が発生した場合は、第2駆動装置は第1モータの動作に追従して動作し、第2駆動装置に異常動作が発生した場合は第1駆動装置は第2モータの動作に追従して動作する。図6は正常駆動装置が異常発生駆動装置に追従して動作するときのタイムチャートである。
本実施例では2軸のスライダが機械的に結合されている例を述べたが、3軸以上の場合でも同様である。
FIG. 2 shows the configuration of the third embodiment. In FIG. 3, the command from the
When an abnormality occurs in the drive device, the abnormality information is transmitted to the controller and each drive device through the first transmission means and the second transmission means, and each drive device stops in a predetermined operation. At this time, if the abnormality occurrence drive device can drive the motor normally, all axes are stopped based on the abnormal stop position command of the controller. However, the second driving device stops in response to a command from the first driving device. When the abnormality driving device cannot normally drive the motor, the motor is electrically disconnected, and the motor terminal is short-circuited by a resistor and stopped by a dynamic brake that obtains a braking torque. A drive device that does not generate an abnormality stops based on the abnormal stop position command of the controller if the drive device that generates the abnormality can drive the motor normally. If the drive device that generates the error cannot drive the motor normally, the drive that generates the error A follow-up operation is performed based on the position information of the state information of the apparatus. Here, only the first drive device and the second drive device perform the tracking operation based on the position information of the state information of the abnormality occurrence drive device. That is, when an abnormality occurs in the first drive device, the second drive device operates following the operation of the first motor, and when an abnormal operation occurs in the second drive device, the first drive device is second. Operates following the motor operation. FIG. 6 is a time chart when the normal driving device operates following the abnormal driving device.
In the present embodiment, an example in which two-axis sliders are mechanically coupled has been described, but the same applies to the case of three or more axes.
本発明は、1台のモータでは駆動できない大形の機械やテーブル重心を駆動するために駆動軸を両側2軸以上に振り分けた精密機械など産業界の要求にこたえるためになされたものである。特に、2軸のうち1軸が異常を発生した場合、機械にストレスを加えないように、2軸の位置を同期させて停止する非常停止に関するものである。本発明は回転モータの例で記述したがリニアモータの駆動も同様である。 The present invention has been made to meet the demands of the industry, such as a large machine that cannot be driven by a single motor and a precision machine in which the drive shaft is divided into two or more on both sides in order to drive the center of gravity of the table. In particular, the present invention relates to an emergency stop in which the positions of the two axes are synchronized so that no stress is applied to the machine when an abnormality occurs in one of the two axes. Although the present invention has been described with an example of a rotary motor, the driving of a linear motor is similar.
1 コントローラ
2〜5 第1〜第n駆動装置
6〜9 第1〜第nモータ
10〜13 第1〜第n位置検出器
14〜17 第1〜第nスライダ
18 締結部
19 第1伝送手段
20 第2伝送手段
21 第1位置制御部
22 第1速度制御部
23 第1トルク制御部
24 第1速度変換部
25 第2位置制御部
26 第2速度制御部
27 第2トルク制御部
28 第2速度変換部
DESCRIPTION OF
Claims (6)
前記駆動装置は前記コントローラを介さずに、互いの位置、速度、異常状態などの状態情報を第2サンプリング時間ごとに伝送する第2伝送手段を有し、
異常発生を検知した駆動装置は前記状態情報を前記コントローラと異常を発生していない他の駆動装置に伝送し、
前記異常発生を検知した駆動装置は異常発生側のモータを所定の減速方法で停止させ、
前記異常を発生していない他の駆動装置は前記異常発生駆動装置の状態情報をもとに所定の方法で停止するという手順で非常停止することを特徴としたモータ駆動装置の非常停止方法。 A multi-axis drive device for driving a multi-axis machine having two axes mechanically coupled, a first motor and a first drive device for driving one of the two axes, and another of the two axes First sampling via a second motor and a second driving device for driving one axis, a third motor to an nth motor other than the two shafts, a third driving device to an nth driving device, and a first transmission means In an emergency stop method when an abnormality occurs in either the first drive device or the second drive device of a servo control device including a controller that controls the first drive device to the nth drive device every time. ,
The drive device has second transmission means for transmitting state information such as the position, speed, and abnormal state of each other every second sampling time without using the controller.
The drive device that has detected the occurrence of abnormality transmits the state information to the other drive device that has not produced an abnormality with the controller,
The drive device that has detected the occurrence of abnormality stops the motor on the abnormality occurrence side by a predetermined deceleration method,
An emergency stop method for a motor drive device, characterized in that the other drive device that does not generate the abnormality is emergency stopped by a procedure of stopping by a predetermined method based on the state information of the abnormality occurrence drive device.
The emergency stop method for a motor drive device according to claim 1, wherein the first sampling and the second sampling are synchronized in time.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003412919A JP4565312B2 (en) | 2003-12-11 | 2003-12-11 | Servo controller and emergency stop method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003412919A JP4565312B2 (en) | 2003-12-11 | 2003-12-11 | Servo controller and emergency stop method |
Publications (3)
Publication Number | Publication Date |
---|---|
JP2005176493A true JP2005176493A (en) | 2005-06-30 |
JP2005176493A5 JP2005176493A5 (en) | 2006-11-30 |
JP4565312B2 JP4565312B2 (en) | 2010-10-20 |
Family
ID=34733197
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2003412919A Expired - Fee Related JP4565312B2 (en) | 2003-12-11 | 2003-12-11 | Servo controller and emergency stop method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4565312B2 (en) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007282460A (en) * | 2006-04-12 | 2007-10-25 | Yaskawa Electric Corp | Synchronization control system |
JP2007288924A (en) * | 2006-04-17 | 2007-11-01 | Yaskawa Electric Corp | Motor driving device and emergency stop method therefor |
JP2009164422A (en) * | 2008-01-08 | 2009-07-23 | Canon Inc | Stage device and exposure device having the same |
EP2372478A3 (en) * | 2010-03-30 | 2012-04-18 | Kabushiki Kaisha Yaskawa Denki | Motor driving system and motor controller |
JP2013031234A (en) * | 2011-07-26 | 2013-02-07 | Fanuc Ltd | Control device for driving one driven body by two electric motors |
JP2018063585A (en) * | 2016-10-13 | 2018-04-19 | ファナック株式会社 | Motor controller in machine tool having plural shafts |
US10250170B2 (en) | 2016-08-24 | 2019-04-02 | Mitsubishi Electric Corporation | Motor control device |
WO2022190536A1 (en) * | 2021-03-12 | 2022-09-15 | オムロン株式会社 | Motor control system and motor control device |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS62181684A (en) * | 1986-02-05 | 1987-08-10 | Mitsubishi Electric Corp | Dynamic brake device for synchronous type ac servomotor |
JPH01228752A (en) * | 1988-03-10 | 1989-09-12 | Fanuc Ltd | Spindle synchronizing system |
JPH0284090A (en) * | 1988-09-20 | 1990-03-26 | Hitachi Kiden Kogyo Ltd | Device for detecting abnormality of deceleration of crane |
JPH03142131A (en) * | 1989-10-30 | 1991-06-17 | Mitsubishi Heavy Ind Ltd | Synchronous feed device |
JPH0490011A (en) * | 1990-03-02 | 1992-03-24 | S G:Kk | Servo control system |
JPH06143089A (en) * | 1992-11-10 | 1994-05-24 | Tsudakoma Corp | Synchronized operation method for attachment for machine tool |
JPH0866073A (en) * | 1994-08-12 | 1996-03-08 | Toshiba Corp | Method and apparatus for servo drive as well as servo drive system |
JPH10326107A (en) * | 1997-03-25 | 1998-12-08 | Mitsubishi Electric Corp | Method and system for servocontrol |
JPH11107621A (en) * | 1997-09-30 | 1999-04-20 | Ichikoh Ind Ltd | Flap-type automatic opening/shutting gate door |
JPH11300565A (en) * | 1998-04-22 | 1999-11-02 | Toyoda Mach Works Ltd | Braking method of synchronous drive device, and synchronous drive device |
JPH11341885A (en) * | 1998-05-25 | 1999-12-10 | Matsushita Electric Ind Co Ltd | Motor controller |
JP2003169497A (en) * | 2001-12-03 | 2003-06-13 | Mitsubishi Heavy Ind Ltd | Servo drive system, injection molding machine, method for controlling servomotor and method for operating the injection molding machine |
JP2005117832A (en) * | 2003-10-09 | 2005-04-28 | Yaskawa Electric Corp | Method for emergency stop for motor controller |
-
2003
- 2003-12-11 JP JP2003412919A patent/JP4565312B2/en not_active Expired - Fee Related
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS62181684A (en) * | 1986-02-05 | 1987-08-10 | Mitsubishi Electric Corp | Dynamic brake device for synchronous type ac servomotor |
JPH01228752A (en) * | 1988-03-10 | 1989-09-12 | Fanuc Ltd | Spindle synchronizing system |
JPH0284090A (en) * | 1988-09-20 | 1990-03-26 | Hitachi Kiden Kogyo Ltd | Device for detecting abnormality of deceleration of crane |
JPH03142131A (en) * | 1989-10-30 | 1991-06-17 | Mitsubishi Heavy Ind Ltd | Synchronous feed device |
JPH0490011A (en) * | 1990-03-02 | 1992-03-24 | S G:Kk | Servo control system |
JPH06143089A (en) * | 1992-11-10 | 1994-05-24 | Tsudakoma Corp | Synchronized operation method for attachment for machine tool |
JPH0866073A (en) * | 1994-08-12 | 1996-03-08 | Toshiba Corp | Method and apparatus for servo drive as well as servo drive system |
JPH10326107A (en) * | 1997-03-25 | 1998-12-08 | Mitsubishi Electric Corp | Method and system for servocontrol |
JPH11107621A (en) * | 1997-09-30 | 1999-04-20 | Ichikoh Ind Ltd | Flap-type automatic opening/shutting gate door |
JPH11300565A (en) * | 1998-04-22 | 1999-11-02 | Toyoda Mach Works Ltd | Braking method of synchronous drive device, and synchronous drive device |
JPH11341885A (en) * | 1998-05-25 | 1999-12-10 | Matsushita Electric Ind Co Ltd | Motor controller |
JP2003169497A (en) * | 2001-12-03 | 2003-06-13 | Mitsubishi Heavy Ind Ltd | Servo drive system, injection molding machine, method for controlling servomotor and method for operating the injection molding machine |
JP2005117832A (en) * | 2003-10-09 | 2005-04-28 | Yaskawa Electric Corp | Method for emergency stop for motor controller |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007282460A (en) * | 2006-04-12 | 2007-10-25 | Yaskawa Electric Corp | Synchronization control system |
JP2007288924A (en) * | 2006-04-17 | 2007-11-01 | Yaskawa Electric Corp | Motor driving device and emergency stop method therefor |
JP2009164422A (en) * | 2008-01-08 | 2009-07-23 | Canon Inc | Stage device and exposure device having the same |
EP2372478A3 (en) * | 2010-03-30 | 2012-04-18 | Kabushiki Kaisha Yaskawa Denki | Motor driving system and motor controller |
US8436570B2 (en) | 2010-03-30 | 2013-05-07 | Kabushiki Kaisha Yaskawa Denki | Motor driving system, motor controller, and safety function expander |
JP2013031234A (en) * | 2011-07-26 | 2013-02-07 | Fanuc Ltd | Control device for driving one driven body by two electric motors |
US10250170B2 (en) | 2016-08-24 | 2019-04-02 | Mitsubishi Electric Corporation | Motor control device |
JP2018063585A (en) * | 2016-10-13 | 2018-04-19 | ファナック株式会社 | Motor controller in machine tool having plural shafts |
US10189131B2 (en) | 2016-10-13 | 2019-01-29 | Fanuc Corporation | Motor control device for machine tool having plurality of axes |
DE102017123186B4 (en) | 2016-10-13 | 2021-09-23 | Fanuc Corporation | Motor control device for a multi-axis machine tool |
WO2022190536A1 (en) * | 2021-03-12 | 2022-09-15 | オムロン株式会社 | Motor control system and motor control device |
Also Published As
Publication number | Publication date |
---|---|
JP4565312B2 (en) | 2010-10-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102208888B (en) | Motor driving system, motor controller, and safety function expander | |
US8531149B2 (en) | Control device for machine tool | |
JPS5981094A (en) | Safety maintenance system of automatic machine | |
WO2002052715A1 (en) | Servo motor drive control system | |
JP4565312B2 (en) | Servo controller and emergency stop method | |
CN104076737B (en) | Make the sync control device of diaxon phase mutually synchronization | |
JP5092267B2 (en) | Motor drive device and emergency stop method thereof | |
JP2005176493A5 (en) | ||
EP0209604B1 (en) | Interface system for a servo controller | |
JP4025999B2 (en) | Automatic machine control device | |
US10606234B2 (en) | Controller for a plurality of motors based on provided torque | |
JP4604447B2 (en) | Numerical control device and axis control method of numerical control device | |
US10958205B2 (en) | Motor control device | |
JP4817116B2 (en) | Stage equipment | |
JP4385404B2 (en) | Motor drive device and method for emergency stop of motor drive device | |
JP4893075B2 (en) | Synchronous control system | |
US20190386594A1 (en) | Motor control apparatus driving one main axis switchingly by two motors | |
JPS61203883A (en) | Servo motor control system | |
JP2015231255A (en) | Servo motor drive device | |
JP2005117832A (en) | Method for emergency stop for motor controller | |
JP2005071086A (en) | Motion control system | |
JP5019175B2 (en) | Motor control device | |
US11086300B2 (en) | Control method, control device and program recording medium | |
US20230259093A1 (en) | Drive system | |
JP2004025294A (en) | Work conveyance system of press machine and controller for the same |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20061013 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20061013 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20100121 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100128 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100324 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20100708 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20100721 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130813 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140813 Year of fee payment: 4 |
|
LAPS | Cancellation because of no payment of annual fees |