JP2005117832A - 電動機制御装置の非常停止方法 - Google Patents
電動機制御装置の非常停止方法 Download PDFInfo
- Publication number
- JP2005117832A JP2005117832A JP2003351103A JP2003351103A JP2005117832A JP 2005117832 A JP2005117832 A JP 2005117832A JP 2003351103 A JP2003351103 A JP 2003351103A JP 2003351103 A JP2003351103 A JP 2003351103A JP 2005117832 A JP2005117832 A JP 2005117832A
- Authority
- JP
- Japan
- Prior art keywords
- motor control
- emergency stop
- control device
- communication
- electric motor
- 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
Images
Landscapes
- Control Of Electric Motors In General (AREA)
- Stopping Of Electric Motors (AREA)
- Control Of Multiple Motors (AREA)
Abstract
【課題】 同期制御で通信異常時の安全停止、異常解除時の簡単復帰方法を提供する。
【解決手段】 通信異常が発生しない場合の非常停止は同期停止方法で行い、通信異常が発生した場合の非常停止はあらかじめ設定された所定の停止方法に切り替え、通信異常が発生する直前の電動機の位置情報や非常停止情報を記憶し、通信異常が解除された場合は非常停止情報を復帰情報に処理するという手順で処理するので通信異常が発生した場合でも安全に停止できる。
【選択図】 図1
Description
第1の従来技術を図6により説明する。図6において601、602はサーボ制御装置で、603、604は電動機に結合されたエンコーダであり、複数のサーボ制御装置間を通信回線で接続して、同期する側のサーボ制御装置が、自ら駆動するモータの位置と、同期される側のサーボ制御装置のモータの位置とをモニタし、検出した両モータ間の位置の差に基づく補正量を求めて自らの位置を補正し同期するというものであるが、非常停止に関する記述はない。
第2の従来技術を図7により説明する。図7(a)は複数のロボットを通信で接続したシステムのブロック図で、図7(b)はロボットの主要部を表したブロック図であり、701はロボット制御装置、702はロボット機構部、703は表示部である。第2の従来技術は複数ロボットのロボット制御装置であり、同期、協調制御として複数のロボット間が通信路で接続され、動作を停止させる要因が発生した場合の停止方法としてロボット間であらかじめ設定してある優先順位から停止要因で優先させる停止方法、あるいは同一の停止方法で各ロボットを停止させ、同期、協調動作の相対関係の位置ずれを少なくする手順をとっている。
また、電動機制御装置間の通信異常はノイズや内部通信処理の遅れなど過渡的な状態が原因となることが多く、一度発生しても短時間の間に異常原因がなくなり、再び通常状態に戻る場合が多い。このような場合いままでは通信異常も電動機制御装置内部の制御的な異常も同列に異常処理され、電動機制御装置はダイナミックブレーキなどの非通電による急速停止方で停止することになり、この結果短期間に正常復帰できないというような問題も抱えていた。
本発明はこのような様々な問題点に鑑みてなされたものであり、同期制御をしている状態で通信異常が発生した場合にできるだけ安全に停止し、通信異常が解除され通常運転に復帰した場合は、復帰動作を簡単に行う方法を提供することを目的とする。
請求項2記載の本発明は、請求項1記載の電動機制御装置の非常停止方法において、複数の電動機制御装置の軸で、減速器、動力伝達機構、連結機構など複数の部位で構成される機械に対しては、通信異常による非常停止方法が、個々の電動機制御装置で固有であるので通信異常が発生した場合でも安全に停止できる。
請求項3記載の本発明は、請求項1記載の電動機制御装置の非常停止方法において、上位装置と電動機制御装置間の通信異常の場合は、電動機制御装置が固有の停止方法で停止するので通信異常が発生した場合でも安全に停止できる。
次に動作について説明する。第1位置検出装置および第2位置検出装置はそれぞれ第1電動機と第2電動機の位置を検出している。さらに、上位指令装置から第1電動機制御装置と第2電動機制御装置へ位置または速度、トルク指令がパルス列、アナログ電圧、あるいはネットワーク通信などの方法で与えられ、第1電動機制御装置と第2電動機制御装置から上位装置へ現在位置、速度などのフィードバック信号を返している。
通信異常を検出し、非常停止を実行する場合は。位置補償器に入力される上位装置の位置指令に切り替え、同期制御から通常追従制御に切り替える。ここで第2電動機制御装置は位置制御器の出力である内部速度指令に位置指令の場合と同様第1電動機制御装置の速度フィードバック信号を速度補償器のゲインを調整し、必要ならフィルタ処理で補正を行い第2電動機制御装置の速度指令に加える。
第2電動機制御装置の速度制御器の出力信号であるトルク指令に位置指令の場合と同様に第1電動機駆動装置の速度フィードバック信号をトルク補償器でゲイン調整をし、必要ならフィルタ処理で補正を行い第2電動機制御装置のトルク指令に加える。
これらの位置補正装置、速度補正装置、トルク補正装置は第1電動機制御装置、第2電動機制御装置のどちらで処理をおこなっても機能上に差はないので図5ではどちらかとは明示していない。
このような構成で電動機装置間通信の処理、伝送路などに何らか原因による異常が発生した場合の処理シーケンスを図3に示す。図3において、ステップST1で異常処理を開始し、ステップST2で第1電動機制御装置と第2電動機制御装置の位置POSe1、POSe2をRAMに記憶、ステップST3で通信異常が発生しているかどうかを判別し、異常が発生していればステップST4にうつり、異常が発生していなければステップST9で通常非常停止処理を実行し、終了すれば異常処理終了に移る。ステップST4で同期運転を中止し、ステップST5で非同期運転指令処理を実行、ステップST6で電動機補正位置を不揮発性メモリに記憶し、ステップST7で仮想同期運転指令処理を実行し、ST8で仮想同期停止処理を実行して異常処理終了となる。ステップST3では電動機制御装置間通信の異常によるものかを判定し通信異常ではない異常の場合は、電動機制御装置への致命的異常の場合があり得るので、保護のため非通電等の緊急停止処理を行う。通信が確保できる場合は、異常が発生した軸に合わせて正常な軸が追従停止することにより機械の破損を最小限に抑えることができる。
通信異常が発生した場合、各軸が正常であっても同期運転はできない確率が高いので、同期運転中止処理で同期運転用指令から同期時の第1電動機制御装置と第2電動機制御装置へのそれぞれの上位位置指令POSr1とPOSr2を取り込み、各軸の異常発生直前の同期運転時位置との差で計算される電動機位置補正値POSd1、POSd2を式(1)、式(2)により求める。
POSd2=POSr2−POSe2 ・・・(2)
これにより同期運転のための補正した状態で、異常検出する直前に各軸が持つ位置偏差量を保持し、
これらの電動機位置補正値POSd1、POSd2、および上位位置指令POSr1とPOSr2を電源遮断後の復帰で使用するのでEEPROM等の不揮発性メモリに記憶する。
これらの処理後に同期運転指令から通信異常が発生した後の各軸の同期時の第1電動機制御装置と第2電動機制御装置へのそれぞれの上位位置指令POSr1xとPOSr2xとすると仮想同期指令POSv1、POSv2を式(3)、式(4)から決める。
POSv2=POSr2x+POSd2 ・・・(4)
これにより仮想指令POSv1、POSv2を使うことによって同期運転のための補正した各軸が持つ位置偏差量を保持し、機械の同期精度をできるだけ保持しながら上位装置からの指令を維持しながら非常停止処理に従って仮想的に同期しながら安全に停止させる。
通信異常で停止した場合、ほとんどが電源遮断をしなくても異常の原因となるノイズなどの外的要因や内部通信同期処理が改善された場合、電動機制御装置間通信同期が確立し復帰することが多い。
102 第1電動機M
103 第2電動機制御装置S
104 第2電動機
105 上位装置
106 電動機制御装置間通信路
107 機械締結部
108 ボールネジ
109 上位位置指令
110 第1位置検出装置
111 第2位置検出装置
201 CPU
202 ROM
203 RAM
204 不揮発記憶装置
205 電動機制御装置間通信部
206 非常停止処理部
207 PWMアンプ
208 電動機制御装置間通信経路
209 電動機制御装置
210 電動機電流
211 電動機制御部
212 位置検出信号
501 第1位置制御装器
502 第1速度制御装器
503 第1トルク制御器
504 第1電動機
505 第1位置検出器
506 第1速度計算器
511 第2位置制御装器
512 第2速度制御装器
513 第2トルク制御器
514 第2電動機
515 第2電動機位置検出器
516 第2速度計算器
520 位置補償装置
521 速度補償器
522 トルク補償器
531 上位指令装置
532 機械締結部
533 第1電動機制御装置
534 第2電動機制御装置
Claims (3)
- 同期駆動する電動機の角度を制御する比例積分形の位置制御手段を持つ電動機制御装置と、前記電動機制御装置間で位置、速度、トルクなどの制御情報を相互交換する通信装置と、通信状態を常時監視し、通信異常を検出する通信異常検出手段と、通信異常が発生した場合に前記電動機制御装置にあらかじめ設定された非常停止方法で停止し、異常発生直前の電動機位置を不揮発性メモリに記憶する記憶手段手段とを備えた電動機制御装置の非常停止方法において、
通信異常が発生しない場合の非常停止は同期停止方法で行い、
前記通信異常が発生した場合の非常停止はあらかじめ設定された所定の停止方法に切り替え、
前記通信異常が発生する直前の電動機の位置情報や非常停止情報を記憶し、
前記通信異常が解除された場合は前記非常停止情報を復帰情報として処理する
という手順で処理することを特徴とする電動機制御装置の非常停止方法。 - 複数の前記電動機制御装置の軸で、減速器、動力伝達機構、連結機構など複数の部位で構成される機械に対しては、前記通信異常による非常停止方法が、個々の電動機制御装置で固有であることを特徴とする請求項1記載の電動機制御装置の非常停止方法。
- 上位装置と前記電動機制御装置間の通信異常の場合は、前記電動機制御装置が固有の停止方法で停止することを特徴とする請求項1記載の電動機制御装置の非常停止方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003351103A JP2005117832A (ja) | 2003-10-09 | 2003-10-09 | 電動機制御装置の非常停止方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003351103A JP2005117832A (ja) | 2003-10-09 | 2003-10-09 | 電動機制御装置の非常停止方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2005117832A true JP2005117832A (ja) | 2005-04-28 |
Family
ID=34542470
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2003351103A Pending JP2005117832A (ja) | 2003-10-09 | 2003-10-09 | 電動機制御装置の非常停止方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2005117832A (ja) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005176493A (ja) * | 2003-12-11 | 2005-06-30 | Yaskawa Electric Corp | モータ駆動装置の非常停止方法 |
JP2007089331A (ja) * | 2005-09-22 | 2007-04-05 | Fanuc Ltd | 同期制御システム |
JP2007282460A (ja) * | 2006-04-12 | 2007-10-25 | Yaskawa Electric Corp | 同期制御システム |
CN104070412A (zh) * | 2013-03-29 | 2014-10-01 | 发那科株式会社 | 同步控制多个电动机的电动机控制装置 |
JP2014191727A (ja) * | 2013-03-28 | 2014-10-06 | Fanuc Ltd | 二つの軸を互いに同期させる同期制御装置 |
CN109450297A (zh) * | 2018-12-19 | 2019-03-08 | 四川虹美智能科技有限公司 | 一种控制电机的方法及装置 |
JP2021511004A (ja) * | 2018-01-26 | 2021-04-30 | ダンフォス・エディトロン・オーワイ | 並列運転装置を制御する方法及び制御システム |
-
2003
- 2003-10-09 JP JP2003351103A patent/JP2005117832A/ja active Pending
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005176493A (ja) * | 2003-12-11 | 2005-06-30 | Yaskawa Electric Corp | モータ駆動装置の非常停止方法 |
JP4565312B2 (ja) * | 2003-12-11 | 2010-10-20 | 株式会社安川電機 | サーボ制御装置と非常停止方法 |
JP2007089331A (ja) * | 2005-09-22 | 2007-04-05 | Fanuc Ltd | 同期制御システム |
JP4498250B2 (ja) * | 2005-09-22 | 2010-07-07 | ファナック株式会社 | 同期制御システム |
JP2007282460A (ja) * | 2006-04-12 | 2007-10-25 | Yaskawa Electric Corp | 同期制御システム |
JP2014191727A (ja) * | 2013-03-28 | 2014-10-06 | Fanuc Ltd | 二つの軸を互いに同期させる同期制御装置 |
US9136781B2 (en) | 2013-03-28 | 2015-09-15 | Fanuc Corporation | Synchronous control unit for synchronizing two shafts with each other |
CN104070412A (zh) * | 2013-03-29 | 2014-10-01 | 发那科株式会社 | 同步控制多个电动机的电动机控制装置 |
JP5628954B2 (ja) * | 2013-03-29 | 2014-11-19 | ファナック株式会社 | 複数のモータを同期制御するモータ制御装置 |
US9401669B2 (en) | 2013-03-29 | 2016-07-26 | Fanuc Corporation | Motor controller for synchronously controlling multiple motors |
JP2021511004A (ja) * | 2018-01-26 | 2021-04-30 | ダンフォス・エディトロン・オーワイ | 並列運転装置を制御する方法及び制御システム |
JP7372924B2 (ja) | 2018-01-26 | 2023-11-01 | ダンフォス・エディトロン・オーワイ | 並列運転装置を制御する方法及び制御システム |
CN109450297A (zh) * | 2018-12-19 | 2019-03-08 | 四川虹美智能科技有限公司 | 一种控制电机的方法及装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3530423B1 (en) | Method and device for detecting abnormality of encoder, and robot control system | |
JP6772887B2 (ja) | サーボシステム | |
US7183739B2 (en) | Synchronous control device | |
CN102710183B (zh) | 多电机交叉耦合同步控制系统及方法 | |
US10606234B2 (en) | Controller for a plurality of motors based on provided torque | |
JP4760912B2 (ja) | サーボ制御装置 | |
CN106549608B (zh) | 马达控制装置 | |
CN112147507B (zh) | 一种基于闭环控制的电机抱闸状态检测方法及系统 | |
JP2005117832A (ja) | 電動機制御装置の非常停止方法 | |
EP3588210A1 (en) | Motor control device | |
JP5326222B2 (ja) | 永久磁石型同期電動機の制御装置 | |
US9622201B2 (en) | Synchronization of control device | |
CN110187670B (zh) | 数值控制装置 | |
EP3617037A1 (en) | Vehicle control apparatus | |
WO2002048811A1 (fr) | Organe de commande numerique et procede de commande de l'arbre de cet organe | |
JP2011104740A (ja) | 力制御装置 | |
JP2000218577A (ja) | ロボット制御装置 | |
JP5423982B2 (ja) | 複数軸駆動装置、複数軸駆動機械、及び複数軸駆動装置の駆動制御方法 | |
US20190386594A1 (en) | Motor control apparatus driving one main axis switchingly by two motors | |
KR20150091655A (ko) | 공작기계의 열변형에 의한 직각도 오차 보정 방법 및 이를 이용한 수치제어장치 | |
JP4565312B2 (ja) | サーボ制御装置と非常停止方法 | |
JP5252999B2 (ja) | 数値制御装置および位置ずれ補正方法 | |
JP2005176493A5 (ja) | ||
JP6612866B2 (ja) | サーボモータ駆動装置 | |
JP4385404B2 (ja) | モータ駆動装置、およびモータ駆動装置の非常停止方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060906 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20091202 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20091207 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100126 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20100302 |