JP2015126647A - Motor control system, and failure determination method for motor control system - Google Patents
Motor control system, and failure determination method for motor control system Download PDFInfo
- Publication number
- JP2015126647A JP2015126647A JP2013270891A JP2013270891A JP2015126647A JP 2015126647 A JP2015126647 A JP 2015126647A JP 2013270891 A JP2013270891 A JP 2013270891A JP 2013270891 A JP2013270891 A JP 2013270891A JP 2015126647 A JP2015126647 A JP 2015126647A
- Authority
- JP
- Japan
- Prior art keywords
- motor
- torque
- failure
- brake device
- determined
- 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
Landscapes
- Control Of Electric Motors In General (AREA)
- Stopping Of Electric Motors (AREA)
Abstract
Description
本発明は、ブレーキ装置を備えたモータを制御するモータ制御システム及びモータ制御システムの故障判断方法に関する。 The present invention relates to a motor control system for controlling a motor including a brake device and a failure determination method for the motor control system.
従来のモータ制御システムは、ブレーキ付きモータと、インバータ装置とを備える。ブレーキ付きモータとは、ブレーキ装置を備えたモータのことである。ブレーキ装置は、ブレーキライニングを備え、モータを制動する。インバータ装置内には、電流検出回路と、電流値記憶回路と、比較器と、異常信号発生回路とが設けられる。電流検出回路は、モータに流れるモータ負荷電流を検出する。電流値記憶回路は、ブレーキライニングの摩耗量が正常範囲にある場合における、モータ負荷電流値Ｉｃを記憶している。 A conventional motor control system includes a motor with a brake and an inverter device. A motor with a brake is a motor provided with a brake device. The brake device includes a brake lining and brakes the motor. In the inverter device, a current detection circuit, a current value storage circuit, a comparator, and an abnormal signal generation circuit are provided. The current detection circuit detects a motor load current flowing through the motor. The current value storage circuit stores the motor load current value Ic when the wear amount of the brake lining is in the normal range.
比較器は、電流検出回路からのモータ負荷電流検出信号Ｉと、電流値記憶回路に記憶されたモータ負荷電流値Ｉｃとを受けて、両者を比較する。ここで、ブレーキライニングの摩耗量が正常範囲を越えて異常範囲にある場合、これに起因して、ブレーキ装置は、モータの制動を完全に解除することができなくなる。この場合、モータに負荷がかかっている状態となるため、従来のモータ制御システムは、モータ負荷電流検出信号Ｉが大きくなる。このため、比較器は、両者の差（Ｉ−Ｉｃ）の大きさが予め決めた設定値以上となった場合、異常状態になったと判断し、ブレーキ異常検知信号を出力する。異常信号発生回路は、比較器からブレーキ異常検知信号を受けた場合、ブレーキ異常信号を外部へと出力する（特許文献１参照）。 The comparator receives the motor load current detection signal I from the current detection circuit and the motor load current value Ic stored in the current value storage circuit and compares them. Here, when the amount of wear of the brake lining exceeds the normal range and is in the abnormal range, the brake device cannot completely release the braking of the motor due to this. In this case, since a load is applied to the motor, the motor load current detection signal I increases in the conventional motor control system. For this reason, when the magnitude of the difference (I-Ic) between the two becomes equal to or greater than a predetermined set value, the comparator determines that an abnormal state has occurred and outputs a brake abnormality detection signal. When receiving the brake abnormality detection signal from the comparator, the abnormality signal generation circuit outputs the brake abnormality signal to the outside (see Patent Document 1).
従来の他のモータ制御システムは、ブレーキ付きサーボモータと、サーボアンプと、ブレーキ故障検出装置とを備える。ブレーキ付きサーボモータとは、ブレーキを備えたサーボモータのことである。また、ブレーキ故障検出装置は、比較・判断部を備える。 Another conventional motor control system includes a servo motor with a brake, a servo amplifier, and a brake failure detection device. A servo motor with a brake is a servo motor having a brake. The brake failure detection apparatus includes a comparison / determination unit.
従来の他のモータ制御システムにおいて、サーボモータに流れる電流は、サーボアンプにフィードバックされる。サーボアンプには、トルク検出回路が設けられている。トルク検出回路は、サーボアンプにフィードバックされた電流から、トルクを検出する。サーボアンプは、トルク検出信号を出力する。このトルク検出信号は、比較・判断部により設定値と比較される。 In another conventional motor control system, the current flowing through the servo motor is fed back to the servo amplifier. The servo amplifier is provided with a torque detection circuit. The torque detection circuit detects torque from the current fed back to the servo amplifier. The servo amplifier outputs a torque detection signal. This torque detection signal is compared with a set value by the comparison / determination unit.
加速時におけるトルクが設定値を超えた場合、従来の他のモータ制御システムは、ブレーキに故障が生じてブレーキがかかった状態で運転されていると判断する。なお、従来の他のモータ制御システムは、ブレーキが発生するトルクのみを検出し、これをトルク検出信号とする場合がある（特許文献２参照）。 If the torque during acceleration exceeds the set value, another conventional motor control system determines that the brake is operating and the brake is applied. Note that other conventional motor control systems may detect only the torque generated by the brake and use this as a torque detection signal (see Patent Document 2).
特許文献１の技術では、モータ（以下、電動機とする）に流れるモータ負荷電流が異常に大きくなった場合、ブレーキライニングの摩耗量が異常であり、ブレーキ装置に異常が発生したと判断している。また、特許文献２の技術では、サーボモータ（以下、電動機とする）に流れる電流から検出したトルクが設定値を超えた場合、ブレーキ（以下、ブレーキ装置とする）が故障したと判断している。このため、特許文献１または特許文献２の技術では、モータ制御システムに異常が発生した場合において、ブレーキ装置ではない部分の故障であっても、ブレーキ装置の故障と判断してしまう。よって、特許文献１または特許文献２の技術では、ブレーキ装置ではない部分の故障が発生した場合、故障原因を判断できないため、故障箇所の修理に時間を要するという課題があった。
In the technique of Patent Document 1, when the motor load current flowing to the motor (hereinafter referred to as an electric motor) becomes abnormally large, it is determined that the wear amount of the brake lining is abnormal and the brake device is abnormal. . In the technique of
本発明の目的は、モータ制御システムに異常が発生した場合において、故障原因を判断することにより、故障箇所の修理にかかる時間を削減できるモータ制御システム及びモータ制御システムの故障判断方法を提供することである。 An object of the present invention is to provide a motor control system and a motor control system failure determination method that can reduce the time required for repairing a failure location by determining the cause of the failure when an abnormality occurs in the motor control system. It is.
この発明に係るモータ制御システムは、トルクを発生させる電動機と、制動力を発生させ、この制動力により電動機を制動するブレーキ装置と、電動機を駆動させ、電動機に負荷がかかった場合、この負荷に基づく変動値を検出し、この変動値に基づいて、電動機に異常なトルクが発生したかどうかを判断し、電動機に異常なトルクが発生したと判断した場合、変動値とブレーキ装置の制動力の大きさとに基づいて、電動機に異常なトルクが発生した原因に関し、ブレーキ装置の故障か、あるいはブレーキ装置ではない部分の故障かを判断する第１の故障原因判断を行う駆動装置とを備える。 The motor control system according to the present invention includes an electric motor that generates torque, a brake device that generates a braking force and brakes the electric motor by the braking force, and drives the motor so that the load is applied to the motor. Based on this fluctuation value, it is determined whether or not abnormal torque has occurred in the motor, and if it is determined that abnormal torque has occurred in the motor, the fluctuation value and the braking force of the brake device And a drive device that performs a first failure cause determination that determines whether a failure of the brake device or a failure of a portion that is not the brake device is related to the cause of the abnormal torque generated in the electric motor based on the magnitude.
この発明に係るモータ制御システムの故障判断方法は、ブレーキ装置の制動力により制動される電動機に負荷がかかった場合、この負荷に基づく変動値を検出し、この変動値に基づいて、電動機に異常なトルクが発生したかどうかを判断する第１のステップと、第１のステップにおいて電動機に異常なトルクが発生したと判断された場合、変動値とブレーキ装置の制動力の大きさとに基づいて、電動機に異常なトルクが発生した原因に関し、ブレーキ装置の故障か、あるいはブレーキ装置ではない部分の故障かを判断する第２のステップとを備える。 In the motor control system failure determination method according to the present invention, when a load is applied to the motor braked by the braking force of the brake device, a fluctuation value based on the load is detected, and the motor is abnormally detected based on the fluctuation value. A first step for determining whether or not an abnormal torque has occurred, and when it is determined that an abnormal torque has occurred in the motor in the first step, based on the fluctuation value and the magnitude of the braking force of the brake device, A second step of determining whether the brake device is malfunctioning or a part of the motor that is not the brake device is related to the cause of the abnormal torque generated in the motor.
本発明のモータ制御システム及びモータ制御システムの故障判断方法は、モータ制御システムに異常が発生した場合において、故障原因を判断できるため、故障箇所の修理にかかる時間を削減できる。 According to the motor control system and the failure determination method for the motor control system of the present invention, the cause of the failure can be determined when an abnormality occurs in the motor control system, so that the time required for repairing the failed portion can be reduced.
実施の形態１．
実施の形態１におけるモータ制御システムについて説明する。図１は、実施の形態１におけるモータ制御システムの構成を示す図である。図１に示すように、モータ制御システムは、電磁ブレーキ１と、同期電動機２と、駆動装置３ａと、位置検出器４と、上位コントローラ５と、電磁ブレーキ制御装置６とを備える。実施の形態１のモータ制御システムにおいて、同期電動機２は、ブレーキ装置として電磁ブレーキ１を備える。図１において、同期電動機２は、電磁ブレーキ１により制動されている。
Embodiment 1 FIG.
A motor control system according to Embodiment 1 will be described. FIG. 1 is a diagram illustrating a configuration of a motor control system according to the first embodiment. As shown in FIG. 1, the motor control system includes an electromagnetic brake 1, a
電磁ブレーキ１は、同期電動機２の回転軸２１に組み付けられ、同期電動機２の制動を行う。電磁ブレーキ１は、図１に示すように、ヨーク１１、コイル１２、ボルト１３、プレート１４、アーマチュア１５、ブレーキライニング１６、及びばね１７を備える。
The electromagnetic brake 1 is assembled to the rotating
ヨーク１１は、図１に示すように、同期電動機２の一端面に設けられる。ヨーク１１は、鉄等の材料から形成される。ヨーク１１は、円柱形状である。ヨーク１１は、中心に穴が設けられ、この中心の穴に回転軸２１が挿入される。ヨーク１１は、周縁部にねじ穴が設けられる。
The
コイル１２は、図１に示すように、ヨーク１１内に埋め込まれるようにして設けられる。コイル１２は、円筒形状のボビンに、巻線を巻回して形成する。
As shown in FIG. 1, the
ボルト１３は、ヨーク１１の周縁部のねじ穴に挿入される。これにより、ボルト１３は、ヨーク１１に対して固定される。
The
プレート１４は、中心に穴が設けられ、この中心の穴に回転軸２１が挿入される。プレート１４は、円盤形状である。また、プレート１４は、周縁部にねじ穴が設けられる。この周縁部のねじ穴には、ボルト１３が挿入される。このため、プレート１４は、ボルト１３に対して固定される。これにより、プレート１４は、ヨーク１１に対して固定される。
The
アーマチュア１５は、中心に穴が設けられ、この中心の穴に回転軸２１が挿入される。アーマチュア１５は、円盤形状である。また、アーマチュア１５は、周縁部に穴が設けられる。この周縁部の穴には、ボルト１３が挿入される。このとき、アーマチュア１５は、ボルト１３に沿って移動可能に支持される。これにより、アーマチュア１５は、ヨーク１１及び回転軸２１に対して移動可能に支持される。
The armature 15 is provided with a hole in the center, and the
ブレーキライニング１６は、プレート１４とアーマチュア１５の間に設けられる。ブレーキライニング１６は、高い摩擦係数を持つように形成された摩擦材である。ブレーキライニング１６は、回転軸２１に固定される。
The
ばね１７は、同期電動機２の一端面とアーマチュア１５とに固定される。ばね１７は、図１に示す復元力ｆを発生させる。この復元力ｆは、図１に示すように、アーマチュア１５に対し、ブレーキライニング１６へと押し付ける方向に働く。
The spring 17 is fixed to one end surface of the
同期電動機２は、回転軸２１を有する。同期電動機２は、駆動装置３ａから電流が供給される。同期電動機２は、供給された電流を、駆動力に変換する。この駆動力は、回転軸２１を介して、回転軸２１に接続された図示しない外部負荷へと伝達する。
The
駆動装置３ａには、図１に示すように、電磁ブレーキ１、同期電動機２、位置検出器４、上位コントローラ５、及び電磁ブレーキ制御装置６が接続される。また、駆動装置３ａは、ＣＰＵ３１ａ、記憶装置３２、電流検出回路３３、及び表示部３４を備える。
As shown in FIG. 1, an electromagnetic brake 1, a
記憶装置３２は、ｎ回分の正常時のピークトルクＴｂ１、Ｔｂ２、・・・Ｔｂｎと、閾値Ｔｈと、前回運転時のピークトルク変動量ΔＴｂと、同期電動機２の定格トルクと、をあらかじめ記憶している。定格トルクとは、定格電圧、定格周波数で駆動した場合において、同期電動機２が出力するトルクのことをいう。なお、ｎ回分の正常時のピークトルクＴｂ１、Ｔｂ２、・・・Ｔｂｎと、閾値Ｔｈと、前回運転時のピークトルク変動量ΔＴｂとについては、後述する。
The
表示部３４は、例えば、ランプやディスプレイなどであり、ユーザに対し、異常が発生したこと、及び発生した異常の原因を通知する。
The
位置検出器４は、同期電動機２の回転軸２１に対して取り付けられる。位置検出器４は、同期電動機２の回転軸２１の回転位置を検出する。また、位置検出器４は、検出した回転軸２１の回転位置から、同期電動機２の回転軸２１の回転速度を算出する。
The
上位コントローラ５は、駆動装置３ａに対する指令を出力する。電磁ブレーキ制御装置６は、電磁ブレーキ１の制動を制御する。 The host controller 5 outputs a command to the drive device 3a. The electromagnetic brake control device 6 controls braking of the electromagnetic brake 1.
次に、実施の形態１におけるモータ制御システムの動作について説明する。図１において、電磁ブレーキ１は、ばね１７の復元力ｆにより、アーマチュア１５をブレーキライニング１６に押し付ける。電磁ブレーキ１は、アーマチュア１５とブレーキライニング１６間に発生する摩擦力により、同期電動機２を制動する。またこのとき、コイル１２には、電流が流れていない。このため、コイル１２は、磁束を発生しない。
Next, the operation of the motor control system in the first embodiment will be described. In FIG. 1, the electromagnetic brake 1 presses the armature 15 against the
図２は、実施の形態１における同期電動機２の駆動時について示す図である。同期電動機２の駆動時において、同期電動機２が駆動を開始する前に、電磁ブレーキ制御装置６は、駆動装置３ａのＣＰＵ３１ａに対し、ブレーキ制御指令１００を出力する。ブレーキ制御指令１００は、駆動装置３ａのＣＰＵ３１ａに対し、電磁ブレーキ１の制動を解除することを通知する信号のことである。
FIG. 2 is a diagram illustrating the driving of the
また、電磁ブレーキ制御装置６は、電磁ブレーキ制御信号１０１を出力する。電磁ブレーキ制御信号１０１は、電流検出回路３３を介して、コイル１２へ入力される。なお、電磁ブレーキ制御信号１０１とは、コイル１２を励磁するための電流のことである。
The electromagnetic brake control device 6 outputs an electromagnetic
電磁ブレーキ制御信号１０１が入力された場合、コイル１２は、電流が流れて励磁される。これにより、コイル１２は、磁束を発生させ、図２に示す吸着力Ｆを発生させる。コイル１２の発生させた吸着力Ｆがばね１７の復元力ｆを超えると、アーマチュア１５は、コイル１２へと吸着される。
When the electromagnetic
アーマチュア１５がコイル１２へと吸着された場合、アーマチュア１５とブレーキライニング１６との間には、ギャップが発生する。このため、両者の間には、摩擦力が働かなくなる。これにより、電磁ブレーキ１は、同期電動機２の制動を解除する。
When the armature 15 is attracted to the
また、電磁ブレーキ制御信号１０１が流れた時、電流検出回路３３は、電磁ブレーキ制御信号１０１を検出する。電磁ブレーキ制御信号１０１を検出した場合、電流検出回路３３は、電流検出信号１０２を、ＣＰＵ３１ａへと出力する。この電流検出信号１０２を受けて、ＣＰＵ３１ａは、電磁ブレーキ１が同期電動機２の制動を解除したと判断する。
When the electromagnetic
同期電動機２を駆動させる際、上位コントローラ５は、駆動装置３ａに対して位置指令１０３を出力する。位置指令１０３とは、同期電動機２を駆動させる際における、回転軸２１の目標の回転位置についての指令のことである。
When driving the
駆動装置３ａは、同期電動機２へ供給する電流を制御する。また、同期電動機２は、駆動装置３ａから供給された電流により駆動する。
The drive device 3 a controls the current supplied to the
同期電動機２の駆動時において、位置検出器４は、回転軸２１の回転位置を検出する。位置検出器４は、検出した回転軸２１の回転位置を、位置フィードバック値１０４として、駆動装置３ａへと出力する。また、位置検出器４は、検出した回転軸２１の回転位置から、回転軸２１の回転速度を算出する。位置検出器４は、算出した回転軸２１の回転速度を、速度フィードバック値１０５として、駆動装置３ａへと出力する。なお、以下において、同期電動機２の回転軸２１の位置情報とは、位置フィードバック値１０４のことである。
When the
駆動装置３ａのＣＰＵ３１ａには、上位コントローラ５から、位置指令１０３が入力される。また、駆動装置３ａのＣＰＵ３１ａには、位置検出器４から、位置フィードバック値１０４及び速度フィードバック値１０５が入力される。駆動装置３ａのＣＰＵ３１ａは、位置フィードバック値１０４及び速度フィードバック値１０５を用いて、電流指令１０６を算出する。電流指令１０６とは、位置指令１０３通りに同期電動機２を駆動させるための指令のことであり、駆動装置３ａから同期電動機２へと供給される電流のことである。
A position command 103 is input from the host controller 5 to the CPU 31a of the driving device 3a. Further, the position feedback value 104 and the velocity feedback value 105 are input from the
駆動装置３ａのＣＰＵ３１ａは、図２に示すように、電流指令１０６を同期電動機２へと出力する。これにより、同期電動機２は、電流指令１０６に従って駆動する。なお、以下において、同期電動機２が電流指令１０６に従って駆動することを、同期電動機２の運転という。
The CPU 31a of the drive device 3a outputs a current command 106 to the
次に、実施の形態１における駆動装置３ａについて説明する。図３は、実施の形態１における駆動装置３ａの構成を示す図である。なお、図３においては、説明の便宜上、電磁ブレーキ１、同期電動機２、位置検出器４、上位コントローラ５、及び電磁ブレーキ６についても図示している。
Next, the drive device 3a in Embodiment 1 will be described. FIG. 3 is a diagram showing a configuration of the driving device 3a in the first embodiment. In FIG. 3, for convenience of explanation, the electromagnetic brake 1, the
図３において、上位コントローラ５から出力された位置指令１０３は、ＣＰＵ３１ａの位置制御部１０７へと入力される。また、位置制御部１０７には、位置フィードバック値１０４が入力される。位置制御部１０７は、位置指令１０３と位置フィードバック値１０４とに基づいて、速度指令値１０８を算出する。位置制御部１０７は、速度指令値１０８を速度制御部１０９へと出力する。
In FIG. 3, the position command 103 output from the host controller 5 is input to the
速度制御部１０９には、速度指令値１０８と速度フィードバック値１０５とが入力される。速度制御部１０９は、速度指令値１０８と速度フィードバック値１０５とに基づいて、電流指令値１１０を算出する。速度制御部１０９は、電流指令値１１０を電流制御部１１１へと出力する。
A speed command value 108 and a speed feedback value 105 are input to the speed control unit 109. The speed control unit 109 calculates a
電流制御部１１１には、電流指令値１１０が入力される。また、電流制御部１１１には、電流指令１０６がフィードバックされ、入力される。電流制御部１１１は、電流指令値１１０とフィードバックされた電流指令１０６とに基づいて、電流指令１０６を算出する。
A
駆動装置３ａは、このようにして求めた電流指令１０６を、同期電動機２へと出力する。これにより、駆動装置３ａは、同期電動機２を駆動させる。
The drive device 3a outputs the current command 106 thus obtained to the
また、電流指令１０６は、ＣＰＵ３１ａのトルク推定部１１２に対しても入力される。トルク推定部１１２は、電流指令１０６から、同期電動機２の発生させるトルクを算出する。これにより、駆動装置３ａは、同期電動機２の発生させるトルクを検出する。
The current command 106 is also input to the torque estimation unit 112 of the CPU 31a. The torque estimation unit 112 calculates the torque generated by the
同期電動機２の駆動時において、電流指令１０６は、常にトルク推定部１１２へと入力される。このため、トルク推定部１１２は、算出したトルクから、同期電動機２のトルク波形を取得することができる。図４は、取得したトルク波形の一例を示す図である。
When the
ここで、同期電動機２は、駆動装置３ａに入力される位置指令１０３により、駆動する。このため、同期電動機２の１周期の動作は、既知である。よって、トルク推定部１１２は、図４に示すように、取得したトルク波形から、１周期分のトルク波形を求めることができる。
Here, the
トルク推定部１１２は、同期電動機２の駆動開始時から１周期分のトルク波形を取得する。また、トルク推定部１１２は、この取得した１周期分のトルク波形において、図４に示す最大のトルク（以下において、ピークトルクとする）を求める。
The torque estimation unit 112 acquires a torque waveform for one cycle from the start of driving of the
トルク推定部１１２は、求めたピークトルクを記憶装置３２へと出力する。記憶装置３２は、トルク推定部１１２から入力されたピークトルクを記憶する。
The torque estimation unit 112 outputs the obtained peak torque to the
電磁ブレーキ故障判断部１１３には、トルク推定部１１２により求められたピークトルクが入力される。また、電磁ブレーキ故障判断部１１３には、記憶装置３２に記憶された閾値Ｔｈが入力される。
The peak torque obtained by the torque estimation unit 112 is input to the electromagnetic brake failure determination unit 113. Further, the threshold value Th stored in the
ここで、同期電動機２に負荷がかかった場合、同期電動機２には、負荷トルクが発生する。この場合、同期電動機２は、回転軸２１を回転させるために、負荷トルクに応じたトルクを発生させる。同期電動機２にかかる負荷が大きいほど、同期電動機２は、大きなトルクを発生させる。また、電磁ブレーキ１の故障などにより、同期電動機２に大きな負荷がかかった場合、同期電動機２には、異常な負荷トルクが発生する。この場合、同期電動機２の発生させるトルクは、異常に増大する。このため、実施の形態１においては、同期電動機２が正常に運転しているときのピークトルクと、同期電動機２が発生させた異常なトルクとを判別するために、閾値Ｔｈを使用する。閾値Ｔｈの求め方については、後述する。なお、実施の形態１において、同期電動機２の発生させるトルクは、同期電動機２にかかった負荷に基づく変動値である。
Here, when a load is applied to the
電磁ブレーキ故障判断部１１３は、トルク推定部１１２から入力されたピークトルクと閾値Ｔｈとに基づいて、モータ制御システムに異常が発生したかどうかの判断を行う。なお、電磁ブレーキ故障判断部１１３は、同期電動機２が駆動を開始する前においても、モータ制御システムに異常が発生したかどうかの判断を行う。モータ制御システムに異常が発生したかどうかの判断については、後述にて説明する。
The electromagnetic brake failure determination unit 113 determines whether an abnormality has occurred in the motor control system based on the peak torque input from the torque estimation unit 112 and the threshold value Th. The electromagnetic brake failure determination unit 113 determines whether or not an abnormality has occurred in the motor control system even before the
モータ制御システムに異常が発生したと判断した場合、電磁ブレーキ故障判断部１１３は、異常検出信号１１４を表示部３４へと出力する。
When it is determined that an abnormality has occurred in the motor control system, the electromagnetic brake failure determination unit 113 outputs an abnormality detection signal 114 to the
表示部３４は、入力された異常検出信号１１４に基づいて、異常が発生したことを表示する。表示部３４は、例えばランプ等を備える場合、異常検出信号１１４に基づいて、発生した故障原因を示すランプを点灯等する。また、表示部３４は、例えばディスプレイ等を備える場合、異常検出信号１１４に基づいて、発生した故障原因を表す文字等をディスプレイ上に表示する。このようにして、表示部３４は、ユーザに対し、異常が発生したこと、及び発生した故障の原因を通知する。
The
なお、トルク推定部１１２は、同期電動機２が正常に運転しているときに、同期電動機２が駆動を開始してから１周期分のトルクに基づいて、正常時のピークトルクＴｂを算出する。トルク推定部１１２は、この正常時のピークトルクＴｂの算出を、任意のｎ回行う。つまり、トルク推定部１１２は、ｎ回分の正常時のピークトルクＴｂ１、Ｔｂ２、・・・Ｔｂｎを算出する。それから、トルク推定部１１２は、ｎ回分の正常時のピークトルクＴｂ１、Ｔｂ２、・・・Ｔｂｎを、記憶装置３２へと出力する。記憶装置３２は、ｎ回分の正常時のピークトルクＴｂ１、Ｔｂ２、・・・Ｔｂｎを記憶する。この場合において、同期電動機２が正常に運転しているときとは、例えば、モータ制御システムの新品を立ち上げた時のことである。このため、ｎ回分の正常時のピークトルクＴｂ１、Ｔｂ２、・・・Ｔｂｎは、例えば、モータ制御システムの新品の立ち上げ時において、算出する。
The torque estimating unit 112 calculates the peak torque Tb at the normal time based on the torque for one cycle after the
図５は、実施の形態１におけるモータ制御システムの故障の判断手順を示すフローチャートである。図５を参照して、実施の形態１におけるモータ制御システムの故障判断の手順について説明する。 FIG. 5 is a flowchart illustrating a failure determination procedure of the motor control system according to the first embodiment. With reference to FIG. 5, the failure determination procedure of the motor control system in the first embodiment will be described.
モータ制御システムの電源が投入された後、駆動装置３ａが同期電動機２を駆動させる前に、電磁ブレーキ制御装置６は、ブレーキ制御指令１００を出力する。ブレーキ制御指令１００は、ＣＰＵ３１ａの電磁ブレーキ故障判断部１１３へと入力される。電磁ブレーキ制御装置６は、電磁ブレーキ制御信号１０１を出力する場合、このブレーキ制御指令１００を出力する。
After the motor control system is turned on, the electromagnetic brake control device 6 outputs a
図５のステップＳ１において、ブレーキ制御指令１００が出力されていない場合、電磁ブレーキ故障判断部１１３は、電磁ブレーキ１が制動を行っていると判断する。そして、ステップＳ２へと進む。
In Step S1 of FIG. 5, when the
図５のステップＳ２において、電磁ブレーキ故障判断部１１３は、同期電動機２の回転軸２１の位置情報に変化があったかどうかを判断する。具体的には、電磁ブレーキ故障判断部１１３は、位置検出器４から出力される位置フィードバック値１０４に変化があったかどうか判断する。
In step S <b> 2 of FIG. 5, the electromagnetic brake failure determination unit 113 determines whether there has been a change in the position information of the
位置フィードバック値１０４に変化がない場合、電磁ブレーキ故障判断部１１３は、回転軸２１の回転位置に変化がないと判断する。この場合、同期電動機２は、電磁ブレーキ１により制動され、停止した状態が保たれている。このため、ステップＳ３において、電磁ブレーキ故障判断部１１３は、電磁ブレーキ１が正常に動作していると判断する。そして、ステップＳ１の判断へと戻る。
When the position feedback value 104 does not change, the electromagnetic brake failure determination unit 113 determines that there is no change in the rotational position of the
一方、ステップＳ２において、位置フィードバック値１０４に変化がある場合、電磁ブレーキ故障判断部１１３は、回転軸２１の回転位置が変化したと判断する。これにより、ステップＳ４において、電磁ブレーキ故障判断部１１３は、モータ制御システムにブレーキ性能劣化故障が発生したと判断する。
On the other hand, when there is a change in the position feedback value 104 in step S2, the electromagnetic brake failure determination unit 113 determines that the rotational position of the
ブレーキ性能劣化故障とは、電磁ブレーキ１の制動に関わる部品が劣化することにより、電磁ブレーキ１の制動力が低下する故障のことである。ブレーキ性能劣化故障は、例えば、ブレーキライニング１６に塗布された摩擦剤が磨耗したり、ボルト１３が緩んだりすることにより、発生する。ブレーキ性能劣化故障は、電磁ブレーキ１の故障である。
The brake performance deterioration failure is a failure in which the braking force of the electromagnetic brake 1 is reduced due to deterioration of components related to the braking of the electromagnetic brake 1. The brake performance deterioration failure occurs, for example, when the friction agent applied to the
なお、電磁ブレーキ１による制動中において、駆動装置３ａは、同期電動機２への指令を行わない。このため、ブレーキ制御指令１００が出力されていない場合、電磁ブレーキ１が正常に同期電動機２を制動しているならば、位置フィードバック値１０４に変化はない。しかし、ブレーキ性能劣化故障が発生した場合、電磁ブレーキ１は、制動力が低下する。このため、電磁ブレーキ１が制動を行っている場合であっても、同期電動機２の回転軸２１は、同期電動機２に働く外力や回転軸２１に接続された外部負荷の自重などにより、移動してしまう。
Note that the drive device 3 a does not issue a command to the
この場合、ステップＳ４において、電磁ブレーキ故障判断部１１３は、異常検出信号１１４を表示部３４へと出力する。このときの異常検出信号１１４は、ブレーキ性能劣化故障を示す信号である。この信号を受けて、表示部３４は、ブレーキ性能劣化故障が発生したことを表示する。
In this case, in step S <b> 4, the electromagnetic brake failure determination unit 113 outputs the abnormality detection signal 114 to the
ブレーキ制御指令１００が出力された場合、ステップＳ１において、電磁ブレーキ故障判断部１１３は、ブレーキ制御指令１００がＯＮであると判断する。この場合、電磁ブレーキ制御装置６は、電磁ブレーキ制御信号１０１を出力する。
If the
次に、図５のステップＳ５において、電磁ブレーキ故障判断部１１３は、電磁ブレーキ１に、ブレーキ電流が流れているかどうかを判断する。この判断は、電磁ブレーキ制御信号１０１が、電磁ブレーキ１へと流れているか否かを検出することにより行う。つまり、この判断は、電流検出回路３３が電磁ブレーキ制御信号１０１を検出することにより行う。
Next, in step S <b> 5 of FIG. 5, the electromagnetic brake failure determination unit 113 determines whether a brake current is flowing in the electromagnetic brake 1. This determination is made by detecting whether or not the electromagnetic
電磁ブレーキ制御信号１０１を検出しなかった場合、電流検出回路３３は、電流検出信号１０２を電磁ブレーキ故障判断部１１３へと出力しない。この場合、電磁ブレーキ故障判断部１１３は、電流検出信号１０２が入力されない。このため、ステップＳ５において、電磁ブレーキ故障判断部１１３は、ブレーキ電流が流れていないと判断する。これにより、ステップＳ６において、電磁ブレーキ故障判断部１１３は、モータ制御システムにブレーキ制御回路故障が発生したと判断する。ブレーキ制御回路故障とは、ブレーキ電流回路の断線や接続コネクタの接触不良などにより、電磁ブレーキ制御信号１０１の伝達経路に異常が発生し、電磁ブレーキ１にブレーキ電流が流れなくなる故障のことである。
When the electromagnetic
上記のとおり、ステップＳ１において、電磁ブレーキ故障判断部１１３は、ブレーキ制御指令１００がＯＮであると判断している。このため、電磁ブレーキ故障判断部１１３は、電磁ブレーキ制御信号１０１が出力されたと判断する。しかし、電磁ブレーキ制御信号１０１が電磁ブレーキ１に流れない場合、コイル１２は、励磁されない。この場合、電磁ブレーキ１は、制動を解除することができなくなる。ブレーキ制御回路故障は、電磁ブレーキ１の故障である。
As described above, in step S1, the electromagnetic brake failure determination unit 113 determines that the
なお、ブレーキ電流回路とは、電磁ブレーキ制御信号１０１が流れる接続線のことである。具体的には、ブレーキ電流回路は、電磁ブレーキ制御装置６と電流検出回路３３とを結ぶ電線、電流検出回路３３とコイル１２とを結ぶ電線、及びこれらの接続コネクタのことである。つまり、ブレーキ電流回路の断線とは、これらの電線または接続コネクタが、断線することをいう。また、接続コネクタの接触不良とは、上記の接続コネクタが、電磁ブレーキ制御装置６、電流検出回路３３、またはコイル１２との間で接触不良を起こすことをいう。
The brake current circuit is a connection line through which the electromagnetic
また、ステップＳ６において、電磁ブレーキ故障判断部１１３は、異常検出信号１１４を表示部３４へと出力する。このときの異常検出信号１１４は、ブレーキ制御回路故障を示す信号である。この信号を受けて、表示部３４は、ブレーキ制御回路故障が発生したことを表示する。
In step S <b> 6, the electromagnetic brake failure determination unit 113 outputs the abnormality detection signal 114 to the
一方、ステップＳ５において、電磁ブレーキ制御信号１０１を検出した場合、電流検出回路３３は、電流検出信号１０２を電磁ブレーキ故障判断部１１３へと出力する。電流検出信号１０２が入力された場合、電磁ブレーキ故障判断部１１３は、正常にブレーキ電流が流れていると判断し、ステップＳ７へと進む。
On the other hand, when the electromagnetic
このようにして、実施の形態１におけるモータ制御システムは、同期電動機２が駆動を開始する前に故障の判断を行う。これにより、実施の形態１におけるモータ制御システムは、同期電動機２が駆動を開始する前に判断できる故障を、あらかじめ判別する。
In this way, the motor control system in the first embodiment determines a failure before the
次に、同期電動機２が駆動を開始した時に行う故障判断について説明する。
Next, failure determination performed when the
図５のステップＳ５において、正常にブレーキ電流が流れていることを確認できた場合、電磁ブレーキ故障判断部１１３は、ステップＳ７において、同期電動機２の駆動の開始時であるかどうかを判断する。同期電動機２の駆動の開始時とは、同期電動機２が駆動を開始した後、１回目にステップＳ７の判断を行う時のことをいう。
In Step S5 of FIG. 5, when it is confirmed that the brake current is flowing normally, the electromagnetic brake failure determination unit 113 determines whether or not it is the start of driving of the
同期電動機２の駆動の開始時でない場合、すでにステップＳ８以降の判断手順を実施済みである。このため、電磁ブレーキ故障判断部１１３は、異常の発生はないと判断する。この場合、ステップＳ１の判断へと戻る。
If it is not at the start of driving of the
ステップＳ７において、同期電動機２の駆動の開始時であると判断した場合、モータ制御システムは、ステップＳ８以降の判断手順を実施する。
If it is determined in step S7 that it is time to start driving the
図５のステップＳ８において、トルク推定部１１２は、同期電動機２の発生させるトルクを、同期電動機２が駆動を開始してから１周期分算出する。トルク推定部１１２は、算出した１周期分のトルクから、ピークトルクＴａを算出する。トルク推定部１１２は、算出したピークトルクＴａを電磁ブレーキ故障判断部１１３へと出力する。
In step S8 of FIG. 5, the torque estimation unit 112 calculates the torque generated by the
ここで、記憶装置３２は、上記のとおり、事前にｎ回分の正常時のピークトルクＴｂ１、Ｔｂ２、・・・Ｔｂｎを記憶している。これらのピークトルクＴｂ１、Ｔｂ２、・・・Ｔｂｎは、過去の同期電動機２の正常運転時に算出した値である。電磁ブレーキ故障判断部１１３には、これらｎ回分のピークトルクＴｂ１、Ｔｂ２、・・・Ｔｂｎが入力される。電磁ブレーキ故障判断部１１３は、これらｎ回分のピークトルクＴｂ１、Ｔｂ２、・・・Ｔｂｎから、基準ピークトルクＴｃを算出する。基準ピークトルクＴｃは、例えば、ｎ回分のピークトルクＴｂ１、Ｔｂ２、・・・Ｔｂｎの平均値とする。
Here, as described above, the
また、電磁ブレーキ故障判断部１１３には、トルク推定部１１２が算出した、今回運転時におけるピークトルクＴａが入力される。電磁ブレーキ故障判断部１１３は、ピークトルクＴａと基準ピークトルクＴｃとの差を、ピークトルク変動量ΔＴａとして算出する。ピークトルク変動量ΔＴａは、次の（式１）で表される。 Further, the peak torque Ta at the time of the current operation calculated by the torque estimation unit 112 is input to the electromagnetic brake failure determination unit 113. The electromagnetic brake failure determination unit 113 calculates the difference between the peak torque Ta and the reference peak torque Tc as the peak torque fluctuation amount ΔTa. The peak torque fluctuation amount ΔTa is expressed by the following (Equation 1).
ステップＳ８において、電磁ブレーキ故障判断部１１３は、上記の（式１）により算出したピークトルク変動量ΔＴａを、記憶装置３２が記憶している閾値Ｔｈと比較する。
In step S <b> 8, the electromagnetic brake failure determination unit 113 compares the peak torque fluctuation amount ΔTa calculated by the above (Equation 1) with the threshold value Th stored in the
ここで、閾値Ｔｈの求め方について説明する。例えば、同期電動機２を定格トルクで運転している場合を考える。この場合、同期電動機２が正常に運転しているならば、同期電動機２が発生させるトルクは、定格トルク程度である。また、閾値Ｔｈは、同期電動機２が正常に運転しているときのピークトルクＴａと、異常時におけるトルクとを判別するための値である。このため、閾値Ｔｈは、同期電動機２が正常に運転しているときのピークトルクＴａよりも大きな値とする必要がある。そこで、閾値Ｔｈは、同期電動機２が発生させるトルクについて、例えば、１．２５倍した値とする。上記の例の場合、閾値Ｔｈは、例えば、同期電動機２の定格トルクを１．２５倍した値とする。このようにして求めた閾値Ｔｈについて、記憶装置３２は、あらかじめ記憶している。
Here, how to obtain the threshold Th will be described. For example, consider a case where the
ステップＳ８において、ピークトルク変動量ΔＴａが閾値Ｔｈよりも小さい場合、同期電動機２は、正常に運転している。このため、ステップＳ９において、電磁ブレーキ故障判断部１１３は、モータ制御システムが正常であると判断する。電磁ブレーキ故障判断部１１３は、このときのピークトルク変動量ΔＴａを記憶装置３２に記憶させる。
In step S8, when the peak torque fluctuation amount ΔTa is smaller than the threshold Th, the
なお、記憶装置３２は、前回運転時におけるピークトルク変動量ΔＴｂを記憶している。前回運転時とは、今回の運転より前に、ステップＳ７で同期電動機２の駆動の開始時であると判断された直近の運転時のことである。このため、記憶装置３２は、ピークトルク変動量ΔＴａを記憶する際、前回運転時のピークトルク変動量ΔＴｂを削除する。つまり、記憶装置３２は、前回運転時のピークトルク変動量ΔＴｂを削除するとともに、今回運転時に算出したピークトルク変動量ΔＴａを、新たなピークトルク変動量ΔＴｂとして記憶する。次回の運転時において、モータ制御システムは、この新たなピークトルク変動量ΔＴｂを、前回運転時のピークトルク変動量ΔＴｂとして使用する。
The
一方、ステップＳ８において、ピークトルク変動量ΔＴａが閾値Ｔｈよりも大きい場合、同期電動機２は、異常なトルクを発生させている。このため、電磁ブレーキ故障判断部１１３は、モータ制御システムに異常が発生し、同期電動機２に異常な負荷トルクが発生したと判断する。そして、ステップＳ１０へと進み、モータ制御システムの故障原因の判断を実施する。
On the other hand, when the peak torque fluctuation amount ΔTa is larger than the threshold value Th in step S8, the
図５のステップＳ１０において、電磁ブレーキ故障判断部１１３は、前回運転時のピークトルク変動量ΔＴｂと閾値Ｔｈとを比較して、前回運転時のピークトルク変動量ΔＴｂが閾値Ｔｈに近いかどうか判断する。具体的には、ステップＳ１０において、電磁ブレーキ故障判断部１１３は、前回運転時のピークトルク変動量ΔＴｂと閾値Ｔｈとの差｜ΔＴｂ−Ｔｈ｜を算出する。前回運転時のピークトルク変動量ΔＴｂは、上記のとおり、事前に記憶装置３２に記憶されている。
In step S10 of FIG. 5, the electromagnetic brake failure determination unit 113 compares the peak torque fluctuation amount ΔTb during the previous operation with the threshold Th to determine whether the peak torque fluctuation amount ΔTb during the previous operation is close to the threshold Th. To do. Specifically, in step S10, the electromagnetic brake failure determination unit 113 calculates a difference | ΔTb−Th | between the peak torque fluctuation amount ΔTb and the threshold Th during the previous operation. The peak torque fluctuation amount ΔTb at the previous operation is stored in advance in the
電磁ブレーキ故障判断部１１３は、前回運転時のピークトルク変動量ΔＴｂと閾値Ｔｈとの差｜ΔＴｂ−Ｔｈ｜を、閾値Ｔαと比較する。ここで、閾値Ｔαは、例えば、同期電動機２の定格トルクの１０％の値とする。なお、閾値Ｔαは、マージンを取って、同期電動機２の定格トルクの２０％、３０％等の値としても良い。
The electromagnetic brake failure determination unit 113 compares the difference | ΔTb−Th | between the peak torque fluctuation amount ΔTb and the threshold Th during the previous operation with the threshold Tα. Here, the threshold value Tα is, for example, a value that is 10% of the rated torque of the
差｜ΔＴｂ−Ｔｈ｜が閾値Ｔαよりも小さい場合、ステップＳ１０において、電磁ブレーキ故障判断部１１３は、前回運転時のピークトルク変動量ΔＴｂと今回運転時のピークトルク変動量ΔＴａとの変化が緩慢であると判断する。これにより、ステップＳ１１において、電磁ブレーキ故障判断部１１３は、モータ制御システムに機械劣化故障が発生したと判断する。 If the difference | ΔTb−Th | is smaller than the threshold value Tα, in Step S10, the electromagnetic brake failure determination unit 113 slowly changes the peak torque fluctuation amount ΔTb during the previous operation and the peak torque fluctuation amount ΔTa during the current operation. It is judged that. Thereby, in step S11, the electromagnetic brake failure determination unit 113 determines that a mechanical deterioration failure has occurred in the motor control system.
機械劣化故障とは、モータ制御システム自体の経年劣化により、同期電動機２が異常なトルクを発生させる故障のことである。例えば、回転軸２１に接続された外部負荷においては、時間の経過により、ギアのオイルが減少する。これにより、例えば、外部負荷は、このギア部分に発生する摩擦力が徐々に増大する。これにともない、同期電動機２が運転時に発生させるトルクは、徐々に増大する。このため、前回運転時において、ステップＳ８で異常が発生したと判断されなくても、同期電動機２の運転時に発生するトルクが前回運転時よりもさらに増大することにより、今回運転時において、ピークトルク変動量ΔＴａが閾値Ｔｈよりも大きくなる。機械劣化故障は、電磁ブレーキ１ではない部分の故障である。
The mechanical deterioration failure is a failure in which the
また、ステップＳ１１において、電磁ブレーキ故障判断部１１３は、異常検出信号１１４を表示部３４へと出力する。このときの異常検出信号１１４は、機械劣化故障を示す信号である。この信号を受けて、表示部３４は、機械劣化故障が発生したことを表示する。
In step S <b> 11, the electromagnetic brake failure determination unit 113 outputs the abnormality detection signal 114 to the
一方、差｜ΔＴｂ−Ｔｈ｜が閾値Ｔαよりも大きい場合、ステップＳ１０において、電磁ブレーキ故障判断部１１３は、前回運転時のピークトルク変動量ΔＴｂと今回運転時のピークトルク変動量ΔＴａとの変化が急激であると判断する。つまり、電磁ブレーキ故障判断部１１３は、同期電動機２の今回の運転時において、同期電動機２の発生させるトルクが突発的に増大したと判断する。そして、ステップＳ１２へと進み、同期電動機２の発生させるトルクが突発的に増大した場合における、モータ制御システムの故障原因の判断を実施する。なお、第１の故障原因判断とは、実施の形態１において、ステップＳ１０における判断のことである。
On the other hand, when the difference | ΔTb−Th | is larger than the threshold value Tα, in Step S10, the electromagnetic brake failure determination unit 113 changes the peak torque fluctuation amount ΔTb during the previous operation and the peak torque fluctuation amount ΔTa during the current operation. Is determined to be abrupt. That is, the electromagnetic brake failure determination unit 113 determines that the torque generated by the
図５のステップＳ１２において、電磁ブレーキ故障判断部１１３は、ピークトルク変動量ΔＴａと電磁ブレーキ１の制動力によるトルクＴｍとの差｜ΔＴａ−Ｔｍ｜を算出する。 In step S12 of FIG. 5, the electromagnetic brake failure determination unit 113 calculates a difference | ΔTa−Tm | between the peak torque fluctuation amount ΔTa and the torque Tm due to the braking force of the electromagnetic brake 1.
ここで、電磁ブレーキ１の制動力によるトルクＴｍの大きさは、一般的に、同期電動機２の定格トルク程度の値である。このため、電磁ブレーキ１の制動力によるトルクＴｍの大きさは、電磁ブレーキ１の設計仕様により決定される。なお、実施の形態１において、電磁ブレーキ１の制動力によるトルクＴｍの値としては、同期電動機２の定格トルクを用いる。
Here, the magnitude of the torque Tm due to the braking force of the electromagnetic brake 1 is generally a value about the rated torque of the
電磁ブレーキ故障判断部１１３は、ピークトルク変動量ΔＴａと事前に記憶装置３２に記憶された同期電動機２の定格トルクとの差異、すなわち差｜ΔＴａ−Ｔｍ｜を、閾値Ｔβと比較する。ここで、閾値Ｔβは、例えば、同期電動機２の定格トルクの１０％の値とする。なお、閾値Ｔβは、マージンを取って、同期電動機２の定格トルクの２０％、５０％等の値としても良い。
The electromagnetic brake failure determination unit 113 compares the difference between the peak torque fluctuation amount ΔTa and the rated torque of the
差｜ΔＴａ−Ｔｍ｜が閾値Ｔβよりも小さい場合、ステップＳ１２において、電磁ブレーキ故障判断部１１３は、ピークトルク変動量ΔＴａと電磁ブレーキ１の制動力によるトルクＴｍとが一致したと判断する。この場合、同期電動機２が発生させた異常なトルクは、電磁ブレーキ１の制動力によるものと判断できる。これにより、ステップＳ１３において、電磁ブレーキ故障判断部１１３は、モータ制御システムにブレーキメカ故障が発生したと判断する。
When the difference | ΔTa−Tm | is smaller than the threshold value Tβ, in step S12, the electromagnetic brake failure determination unit 113 determines that the peak torque fluctuation amount ΔTa and the torque Tm due to the braking force of the electromagnetic brake 1 coincide. In this case, it can be determined that the abnormal torque generated by the
ブレーキメカ故障とは、コイル１２の劣化や電磁ブレーキ１の溶着など、電磁ブレーキ１の機械部分の故障のことである。ブレーキメカ故障が発生すると、電磁ブレーキ１は、同期電動機２の制動を解除できなくなる。この場合、同期電動機２を駆動させたならば、電磁ブレーキ１の制動力は、同期電動機２に対し、負荷として働く。このとき、同期電動機２は、電磁ブレーキ１の制動力に応じたトルクを発生させる。つまり、同期電動機２が発生させるトルクは、基準ピークトルクＴｃよりも、電磁ブレーキ１の制動力によるトルクＴｍ程度増大する。よって、ブレーキメカ故障の場合、今回運転時のピークトルクＴａと基準ピークトルクＴｃとの差であるピークトルク変動量ΔＴａは、使用される電磁ブレーキ１の制動力によるトルクＴｍと一致する。
The brake mechanical failure is a failure of the mechanical part of the electromagnetic brake 1 such as deterioration of the
なお、コイル１２の劣化とは、コイル１２の発生する磁力が低下することをいう。コイル１２が劣化した場合、電磁ブレーキ制御信号１０１によりコイル１２が励磁されても、電磁ブレーキ１は、アーマチュア１５とブレーキライニング１６との間にギャップが発生しなくなる。このため、コイル１２が励磁されても、電磁ブレーキ１は、同期電動機２の制動を解除できなくなる。よって、同期電動機２は、異常なトルクを発生させる。
The deterioration of the
また、電磁ブレーキ１の溶着とは、ブレーキライニング１６が熱などにより溶け、ブレーキライニング１６とアーマチュア１５とが接合することをいう。電磁ブレーキ１の溶着は、例えば、電磁ブレーキ１の制動を解除し忘れたまま同期電動機２の運転を行ったような場合に、発生する。過去の運転時において電磁ブレーキ１の溶着が発生した場合、ブレーキライニング１６とアーマチュア１５とが接合したまま運転を行ったならば、同期電動機２は、異常なトルクを発生させる。
The welding of the electromagnetic brake 1 means that the
ステップＳ１３において、電磁ブレーキ故障判断部１１３は、異常検出信号１１４を表示部３４へと出力する。このときの異常検出信号１１４は、ブレーキメカ故障を示す信号である。この信号を受けて、表示部３４は、ブレーキメカ故障が発生したことを表示する。
In step S <b> 13, the electromagnetic brake failure determination unit 113 outputs the abnormality detection signal 114 to the
一方、ステップＳ１２において、差｜ΔＴａ−Ｔｍ｜が閾値Ｔβよりも大きい場合、電磁ブレーキ故障判断部１１３は、ピークトルク変動量ΔＴａと電磁ブレーキ１の制動力によるトルクＴｍとが一致しないと判断する。この場合、同期電動機２が発生させた異常なトルクは、電磁ブレーキ１の制動力では発生し得ないものと判断できる。これにより、ステップＳ１４において、電磁ブレーキ故障判断部１１３は、モータ制御システムにその他機械故障が発生したと判断する。
On the other hand, when the difference | ΔTa−Tm | is larger than the threshold value Tβ in step S12, the electromagnetic brake failure determination unit 113 determines that the peak torque fluctuation amount ΔTa and the torque Tm due to the braking force of the electromagnetic brake 1 do not match. . In this case, it can be determined that the abnormal torque generated by the
その他機械故障とは、障害物との接触や異物の挟み込みなど、電磁ブレーキ１ではない機械部分の故障のことである。障害物との接触とは、例えば、同期電動機２の回転軸２１に接続された外部負荷が、何かしらの障害物と接触することをいう。異物の挟み込みとは、例えば、回転軸２１に接続された外部負荷の持つギア等が、異物を噛み込んでしまうことをいう。このほか、その他機械故障とは、例えば、同期電動機２の内部において回転軸２１が傾いてしまうことにより、同期電動機２の内部で回転軸２１が回転できなくなることも指す。このように、その他機械故障においては、電磁ブレーキ１の制動力ではなく、外的要因により、同期電動機２の発生させるトルクが突発的に増大する。なお、その他機械故障が発生した場合、同期電動機２が発生させるトルクは、基準ピークトルクＴｃよりも、電磁ブレーキ１の制動力によるトルクＴｍの２、３倍程度増大する。
The other machine failure is a failure of a machine part that is not the electromagnetic brake 1, such as contact with an obstacle or pinching of a foreign object. The contact with an obstacle means, for example, that an external load connected to the
また、ステップＳ１４において、電磁ブレーキ故障判断部１１３は、異常検出信号１１４を表示部３４へと出力する。このときの異常検出信号１１４は、その他機械故障を示す信号である。この信号を受けて、表示部３４は、その他機械故障が発生したことを表示する。なお、第２の故障原因判断とは、実施の形態１において、ステップＳ１２における判断のことである。
In step S <b> 14, the electromagnetic brake failure determination unit 113 outputs the abnormality detection signal 114 to the
このようにして、実施の形態１におけるモータ制御システムは、同期電動機２の駆動の開始時に故障判断を実施する。
In this way, the motor control system in the first embodiment performs failure determination at the start of driving of the
以上において説明したように、実施の形態１における電磁ブレーキ故障判断部１１３は、ブレーキ制御指令１００が出力されていない場合に、位置検出器４から出力される位置フィードバック値１０４に変化があったかどうかを判断する。電磁ブレーキ故障判断部１１３は、ブレーキ制御指令１００が出力された場合に、電磁ブレーキ１にブレーキ電流が流れているかどうかを判断する。
As described above, the electromagnetic brake failure determination unit 113 in the first embodiment determines whether or not the position feedback value 104 output from the
また、同期電動機２の駆動の開始時において、電磁ブレーキ故判断部１１４は、今回運転時のピークトルク変動量ΔＴａを、閾値Ｔｈと比較する。ピークトルク変動量ΔＴａが閾値Ｔｈよりも大きい場合、電磁ブレーキ故障判断部１１３は、前回運転時のピークトルク変動量ΔＴｂを、閾値Ｔｈと比較する。前回運転時のピークトルク変動量ΔＴｂが閾値Ｔｈから遠い場合、電磁ブレーキ故障判断部１１３は、ピークトルク変動量ΔＴａと電磁ブレーキ１の制動力によるトルクＴｍとが一致するかどうかを判断する。
Further, at the start of driving of the
これにより、実施の形態１におけるモータ制御システムは、同期電動機２に異常な負荷トルクが発生した場合に、ブレーキ装置の故障とブレーキ装置ではない部分の故障とを区別して検知する。また、実施の形態１におけるモータ制御システムは、モータ制御システムに異常が発生した場合において、モータ制御システムの故障箇所及び故障原因を判断する。よって、故障箇所及び故障原因を判断する手間が省けるため、実施の形態１におけるモータ制御システムは、故障箇所の修理にかかる時間を削減できる。
As a result, the motor control system according to the first embodiment distinguishes and detects a failure of the brake device and a failure of a portion other than the brake device when an abnormal load torque is generated in the
なお、実施の形態１において、電磁ブレーキ制御装置６は、同期電動機２が駆動を開始する前に、電磁ブレーキ１の制動を解除することを通知するブレーキ制御指令１００を出力し、それから、コイル１２を励磁するための電磁ブレーキ制御信号１０１を出力するとした。また、図５のステップＳ１において、ブレーキ制御指令１００が出力されていない場合、電磁ブレーキ故障判断部１１３は、電磁ブレーキ１が制動を行っていると判断するとした。さらに、ブレーキ制御指令１００が出力された場合、図５のステップＳ１において、電磁ブレーキ故障判断部１１３は、ブレーキ制御指令１００がＯＮであると判断し、電磁ブレーキ制御装置６は、電磁ブレーキ制御信号１０１を出力するとした。そして、図５のステップＳ５において、電流検出回路３３が電磁ブレーキ制御信号１０１を検出しなかった場合、電磁ブレーキ故障判断部１１３は、電磁ブレーキ制御信号１０１が電磁ブレーキ１へと流れていないと判断し、モータ制御システムにブレーキ制御回路故障が発生したと判断することとした。しかし、実施の形態１におけるモータ制御システムは、これに限られるものではない。
In the first embodiment, the electromagnetic brake control device 6 outputs a
例えば、電磁ブレーキ制御装置６は、同期電動機２が駆動をしていない場合において、電磁ブレーキ１の制動中であることを通知する信号を出力し、同期電動機２が駆動を開始する前に、電磁ブレーキ１の制動中であることを通知する信号の出力を停止し、それから電磁ブレーキ制御信号１０１を出力するようにしても良い。この場合、図５のステップＳ１において、電磁ブレーキ故障判断部１１３は、電磁ブレーキ１の制動中であることを通知する信号が出力されている場合、電磁ブレーキ１が制動を行っていると判断する。また、電磁ブレーキ１の制動中であることを通知する信号の出力を停止した場合、図５のステップＳ１において、電磁ブレーキ故障判断部１１３は、電磁ブレーキ１の制動が解除されたと判断し、電磁ブレーキ制御装置６は、電磁ブレーキ制御信号１０１を出力する。そして、図５のステップＳ５において、電流検出回路３３が電磁ブレーキ制御信号１０１を検出しなかった場合、電磁ブレーキ故障判断部１１３は、電磁ブレーキ制御信号１０１が電磁ブレーキ１へと流れていないと判断し、モータ制御システムにブレーキ制御回路故障が発生したと判断する。この場合においても、電磁ブレーキ１の制動を解除することを通知するブレーキ制御指令１００を用いる場合と同等の効果を得ることができる。
For example, the electromagnetic brake control device 6 outputs a signal notifying that the electromagnetic brake 1 is being braked when the
なお、トルク推定部１１２は、同期電動機２が駆動を開始してから１周期分のトルクに基づいて、ピークトルクＴａを算出するとしたが、これに限られるものではない。例えば、トルク推定部１１２は、同期電動機２の駆動の開始後ｎ周期分のトルクに基づいて、ｎ周期分のピークトルクＴａ１、Ｔａ２、・・・Ｔａｎをそれぞれ算出しても良い。そして、電磁ブレーキ故障判断部１１３は、例えばこれらｎ周期分のピークトルクＴａ１、Ｔａ２、・・・Ｔａｎの平均値を、同期電動機２が駆動を開始してから１周期におけるピークトルクの代わりに用いても、同様の効果を得ることができる。
In addition, although the torque estimation part 112 calculated peak torque Ta based on the torque for 1 period after the
また、閾値Ｔｈは、同期電動機２が発生させるトルクについて、例えば、１．２５倍した値としたが、これに限られるものではない。１．２５倍ではなく、他の値であっても良い。
Further, the threshold value Th is a value obtained by multiplying the torque generated by the
このほか、電磁ブレーキ故障判断部１１３は、ｎ回分の正常時のピークトルクＴｂ１、Ｔｂ２、・・・Ｔｂｎに基づいて、これらのピークトルクＴｂ１、Ｔｂ２、・・・Ｔｂｎが取り得ない値を求め、この求めた値を閾値Ｔｈとしても良い。この場合、例えば、ｎ回分の正常時のピークトルクＴｂ１、Ｔｂ２、・・・Ｔｂｎの平均値と分散σ２を求める。そして、例えば、ｎ回分の正常時のピークトルクＴｂ１、Ｔｂ２、・・・Ｔｂｎの平均値に３σを加えた値を求め、この値をさらに１．２５倍する。このようにして算出した値を閾値Ｔｈとしても、同様の効果を得ることができる。 In addition, the electromagnetic brake failure determination unit 113 obtains values that these peak torques Tb1, Tb2,... Tbn cannot be obtained based on the normal peak torques Tb1, Tb2,. The obtained value may be used as the threshold Th. In this case, for example, an average value and variance σ 2 of peak torques Tb1, Tb2,. Then, for example, a value obtained by adding 3σ to the average value of the peak torques Tb1, Tb2,... Tbn at the normal time for n times is obtained, and this value is further multiplied by 1.25. Even if the value calculated in this way is set as the threshold Th, the same effect can be obtained.
電磁ブレーキ故障判断部１１３は、基準ピークトルクＴｃを、ｎ回分の正常時のピークトルクＴｂ１、Ｔｂ２、・・・Ｔｂｎの平均値として算出することとしたが、これに限られるものではない。例えば、電磁ブレーキ故障判断部１１３は、基準ピークトルクＴｃとして、１回分の正常時のピークトルクＴｂ１を使用しても良い。この場合においても、同様の効果を得ることができる。 The electromagnetic brake failure determination unit 113 calculates the reference peak torque Tc as an average value of n times of normal peak torques Tb1, Tb2,... Tbn, but is not limited thereto. For example, the electromagnetic brake failure determination unit 113 may use one normal peak torque Tb1 as the reference peak torque Tc. In this case, the same effect can be obtained.
ステップＳ９において、モータ制御システムが正常であると判断した場合、電磁ブレーキ故障判断部１１３は、ピークトルク変動量ΔＴｂを記憶装置３２に記憶させた。このとき、前回運転時のピークトルク変動量ΔＴｂは、削除することとした。しかし、ピークトルク変動量ΔＴｂは、これに限られるものではない。例えば、記憶装置３２は、算出したピークトルク変動量を、上記のように直前１回分だけでなく、任意の直近ｎ回分について記憶するようにしても良い。そして、例えば、電磁ブレーキ故障判断部１１３は、ステップＳ８において、任意の直近ｎ回分のピークトルク変動量ΔＴｂ１、ΔＴｂ２、・・・ΔＴｂｎの平均値を、前回運転時のピークトルク変動量の代わりに用いても良い。また、例えば、電磁ブレーキ故障判断部１１３は、ステップＳ８において、前回運転時のピークトルク変動量ΔＴｂ１を用いて判断を行った後、さらに前々回運転時のピークトルク変動量ΔＴｂ２を用いて判断を行い、この判断を任意のｎ回続けるようにしても良い。このような場合においても、前回運転時のピークトルク変動量を用いて判断を行う場合と同様の効果を得ることができる。
In Step S9, when it is determined that the motor control system is normal, the electromagnetic brake failure determination unit 113 stores the peak torque fluctuation amount ΔTb in the
実施の形態２．
実施の形態２におけるモータ制御システムについて説明する。実施の形態１と同一または同等の手段、構成に関しては、同一の名称と符号とを用いて説明を省略する。
A motor control system according to the second embodiment will be described. The same or equivalent means and configuration as in the first embodiment will be described using the same names and symbols.
実施の形態２における原理について説明する。実施の形態２における駆動装置３ｂは、実施の形態１の駆動装置３ａと同様に、同期電動機２に対し、位置指令１０３を出力する。これにより、駆動装置３ｂは、同期電動機２が発生させるトルクを制御する。
The principle in the second embodiment will be described. The drive device 3b in the second embodiment outputs a position command 103 to the
一方、実施の形態２における駆動装置３ｂは、実施の形態１の駆動装置３ａと異なる点として、トルク制限機能を持つ。このトルク制限機能により、駆動装置３ｂは、同期電動機２が発生させるトルクを、トルク制限値以上とならないように制御する。このため、実施の形態２においては、実施の形態１と同様なピークトルクが発生しない。よって、実施の形態２におけるモータ制御システムは、ピークトルクを用いた故障判断を行うことができない。そこで、実施の形態２においては、ピークトルクの代わりに、最大加速時間を用いる。
On the other hand, the driving device 3b in the second embodiment has a torque limiting function as a difference from the driving device 3a in the first embodiment. With this torque limiting function, the drive device 3b controls the torque generated by the
加速時間とは、同期電動機２の回転速度が、目標とする速度に達するまでに要する時間のことである。つまり、加速時間は、速度指令値１１０と速度フィードバック値１０５とが一致するまでに要した時間のことである。最大加速時間については、後述する。
The acceleration time is the time required for the rotational speed of the
図６は、目標とする速度と加速時間との関係の一例について示す図である。図６において、目標とする速度を回転速度Ｎとする。このとき、加速時間は、図６に示すＨ１、Ｈ２、及びＨ３のことである。 FIG. 6 is a diagram illustrating an example of the relationship between the target speed and the acceleration time. In FIG. 6, the target speed is a rotation speed N. At this time, the acceleration time is H1, H2, and H3 shown in FIG.
ここで、加速時間と同期電動機２にかかる負荷との関係について説明する。例えば、同期電動機２に負荷がかかった場合、同期電動機２には、負荷トルクが発生する。この場合、同期電動機２は、回転軸２１を回転させるために、負荷トルクに応じたトルクを発生させる。このとき、同期電動機２の発生させたトルクがトルク制限値に達していないならば、同期電動機２は、さらに大きなトルクを発生させる。
Here, the relationship between the acceleration time and the load applied to the
しかし、上記のとおり、実施の形態２における駆動装置３ｂは、トルク制限機能を持つ。このため、同期電動機２は、発生させるトルクが制限されている。例えば、同期電動機２に対して大きな負荷がかかり、同期電動機２に負荷トルクＴ１が発生したとする。この場合、同期電動機２は、回転軸２１を回転させるために、最大でトルク制限値Ｔ２のトルクを発生させる。このとき、同期電動機２から回転軸２１に接続された外部負荷へと出力されるトルクＴ３は、次の（式２）となる。
However, as described above, the driving device 3b according to the second embodiment has a torque limiting function. For this reason, the
（式２）に示すように、同期電動機２に大きな負荷がかかった場合、同期電動機２の発生させるトルクがトルク制限値Ｔ２に達したならば、外部負荷へと出力されるトルクＴ３は、減少する。また、外部負荷へと出力されるトルクが小さいほど、同期電動機２は、目標とする速度に達するまでに時間を要する。つまり、同期電動機２の発生させるトルクがトルク制限値Ｔ２に達した場合、同期電動機２にかかる負荷が大きいほど、その時の加速時間は、増大する。
As shown in (Expression 2), when a large load is applied to the
また、電磁ブレーキ１の故障などにより、同期電動機２に大きな負荷がかかった場合、同期電動機２には、異常な負荷トルクが発生する。この場合、実施の形態２においては、上記のように、同期電動機２の発生させるトルクがトルク制限値に達し、加速時間が異常に増大する。このときの異常な加速時間は、正常時には発生し得ないようなものである。つまり、加速時間の大きさを調べることで、モータ制御システムに発生した異常について検知することができる。以上が、実施の形態２における原理についての説明である。
Further, when a large load is applied to the
次に、実施の形態２におけるモータ制御システムの構成について説明する。実施の形態２におけるモータ制御システムは、実施の形態１におけるモータ制御システムに対し、駆動装置３ｂの構成が異なる。また、実施の形態２におけるモータ制御システムは、駆動装置３ｂ以外の構成については実施の形態１と同様である。 Next, the configuration of the motor control system in the second embodiment will be described. The motor control system in the second embodiment is different from the motor control system in the first embodiment in the configuration of the drive device 3b. The motor control system in the second embodiment is the same as that in the first embodiment with respect to the configuration other than the driving device 3b.
図７は、実施の形態２における駆動装置３ｂの構成を示す図である。なお、図７においては、説明の便宜上、電磁ブレーキ１、同期電動機２、位置検出器４、上位コントローラ５、及び電磁ブレーキ６についても図示している。
FIG. 7 is a diagram illustrating a configuration of the driving device 3b according to the second embodiment. In FIG. 7, for convenience of explanation, the electromagnetic brake 1, the
実施の形態２において、記憶装置３２は、ｎ回分の正常時の最大加速時間Ｈｂ１、Ｈｂ２、・・・Ｈｂｎと、閾値Ｈｈと、前回運転時の最大加速時間変動量ΔＨｂと、電磁ブレーキ１の制動力による加速時間の変動量ΔＨｍと、をあらかじめ記憶している。なお、ｎ回分の正常時の最大加速時間Ｈｂ１、Ｈｂ２、・・・Ｈｂｎと、閾値Ｈｈと、前回運転時の最大加速時間変動量ΔＨｂと、電磁ブレーキ１の制動力による加速時間の変動量ΔＨｍとについては、後述する。
In the second embodiment, the
実施の形態２において、駆動装置３ｂのＣＰＵ３１ｂは、図７に示すように、加速時間推定部１１５を備える。加速時間推定部１１５には、位置検出器４から、速度フィードバック値１０５が入力される。加速時間推定部１１５は、この速度フィードバック値１０５に基づいて、加速時間を算出する。なお、実施の形態２において、同期電動機２の速度は、同期電動機２にかかった負荷に基づく変動値である。このため、同期電動機２の速度から算出した加速時間も、同期電動機２にかかった負荷に基づく変動値である。
In the second embodiment, the CPU 31b of the driving device 3b includes an acceleration time estimation unit 115 as shown in FIG. A speed feedback value 105 is input from the
ここで、同期電動機２は、駆動装置３ｂに入力される位置指令１０３により、駆動する。このため、同期電動機２の１周期の動作は、既知である。よって、加速時間推定部１１５は、図６に示すように、１周期分の加速時間を求めることができる。
Here, the
図７において、加速時間推定部１１５は、同期電動機２の駆動の開始時から１周期分の加速時間を算出する。また、加速時間推定部１１５は、これらの加速時間の中から、最大の加速時間（以下において、最大加速時間とする）を選択する。
In FIG. 7, the acceleration time estimation unit 115 calculates an acceleration time for one cycle from the start of driving of the
加速時間推定部１１５は、求めた最大加速時間を記憶装置３２へと出力する。記憶装置３２は、加速時間推定部１１５から入力された最大加速時間を記憶する。
The acceleration time estimation unit 115 outputs the obtained maximum acceleration time to the
電磁ブレーキ故障判断部１１３には、加速時間推定部１１５により求められた最大加速時間が入力される。また、電磁ブレーキ故障判断部１１３には、記憶装置３２に記憶された閾値Ｈｈが入力される。この閾値Ｈｈについては、後述する。
The maximum acceleration time obtained by the acceleration time estimation unit 115 is input to the electromagnetic brake failure determination unit 113. Further, the threshold value Hh stored in the
電磁ブレーキ故障判断部１１３は、加速時間推定部１１５から入力された最大加速時間と閾値Ｈｈとに基づいて、モータ制御システムに異常が発生したかどうかの判断を行う。なお、電磁ブレーキ故障判断部１１３は、同期電動機２が駆動を開始する前においても、モータ制御システムに異常が発生したかどうかの判断を行う。モータ制御システムの異常の判断については、後述にて説明する。
The electromagnetic brake failure determination unit 113 determines whether an abnormality has occurred in the motor control system based on the maximum acceleration time and the threshold value Hh input from the acceleration time estimation unit 115. The electromagnetic brake failure determination unit 113 determines whether or not an abnormality has occurred in the motor control system even before the
なお、加速時間推定部１１５は、同期電動機２が正常に運転しているときに、同期電動機２が駆動を開始してから１周期分の加速時間に基づいて、正常時の最大加速時間Ｈｂを算出する。加速時間推定部１１５は、この正常時の最大加速時間Ｈｂの算出を、任意のｎ回行う。つまり、加速時間推定部１１５は、ｎ回分の正常時の最大加速時間Ｈｂ１、Ｈｂ２、・・・Ｈｂｎを算出する。それから、加速時間推定部１１５は、ｎ回分の正常時の最大加速時間Ｈｂ１、Ｈｂ２、・・・Ｈｂｎを、記憶装置３２へと出力する。記憶装置３２は、ｎ回分の正常時の最大加速時間Ｈｂ１、Ｈｂ２、・・・Ｈｂｎを記憶する。この場合において、同期電動機２が正常に運転しているときとは、例えば、モータ制御システムの新品を立ち上げた時のことである。このため、ｎ回分の正常時の最大加速時間Ｈｂ１、Ｈｂ２、・・・Ｈｂｎは、例えば、モータ制御システムの新品の立ち上げ時において、算出する。
The acceleration time estimation unit 115 calculates the normal maximum acceleration time Hb based on the acceleration time for one cycle after the
図８は、実施の形態２におけるモータ制御システムの故障の判断手順を示すフローチャートである。図８を参照して、実施の形態２におけるモータ制御システムの故障判断の手順について説明する。なお、実施の形態２において、図８のステップＳ２１からステップＳ２７までの判断は、実施の形態１における図６のステップＳ１からステップＳ７までの判断と同様である。このため、図８のステップＳ２８から説明する。 FIG. 8 is a flowchart showing a failure determination procedure of the motor control system according to the second embodiment. With reference to FIG. 8, the failure determination procedure of the motor control system in the second embodiment will be described. In the second embodiment, the determination from step S21 to step S27 in FIG. 8 is the same as the determination from step S1 to step S7 in FIG. For this reason, description will be made from step S28 of FIG.
同期電動機２が駆動の開始時である場合、図８のステップＳ２８において、加速時間推定部１１５は、同期電動機２の加速時間を、同期電動機２が駆動を開始してから１周期分算出する。加速時間推定部１１５は、算出した１周期分の加速時間から、最大加速時間Ｈａを算出する。加速時間推定部１１５は、算出した最大加速時間Ｈａを電磁ブレーキ故障判断部１１３へと出力する。
When the
ここで、記憶装置３２は、上記のとおり、事前にｎ回分の正常時の最大加速時間Ｈｂ１、Ｈｂ２、・・・Ｈｂｎを記憶している。これらの最大加速時間Ｈｂ１、Ｈｂ２、・・・Ｈｂｎは、過去の同期電動機２の正常運転時に算出した値である。電磁ブレーキ故障判断部１１３には、これらｎ回分の最大加速時間Ｈｂ１、Ｈｂ２、・・・Ｈｂｎが入力される。電磁ブレーキ故障判断部１１３は、これらｎ回分の最大加速時間Ｈｂ１、Ｈｂ２、・・・Ｈｂｎから、基準最大加速時間Ｈｃを算出する。基準最大加速時間Ｈｃは、例えば、ｎ回分の最大加速時間Ｈｂ１、Ｈｂ２、・・・Ｈｂｎの平均値とする。
Here, as described above, the
また、電磁ブレーキ故障判断部１１３には、加速時間推定部１１５が算出した、今回運転時における最大加速時間Ｈａが入力される。電磁ブレーキ故障判断部１１３は、最大加速時間Ｈａと基準最大加速時間Ｈｃとの差を、最大加速時間変動量ΔＨａとして算出する。最大加速時間変動量ΔＨａは、次の（式３）で表される。 Further, the electromagnetic brake failure determination unit 113 receives the maximum acceleration time Ha during the current operation calculated by the acceleration time estimation unit 115. The electromagnetic brake failure determination unit 113 calculates the difference between the maximum acceleration time Ha and the reference maximum acceleration time Hc as the maximum acceleration time fluctuation amount ΔHa. The maximum acceleration time fluctuation amount ΔHa is expressed by the following (Equation 3).
ステップＳ２８において、電磁ブレーキ故障判断部１１３は、上記の（式３）により算出した最大加速時間変動量ΔＨａを、記憶装置３２が記憶している閾値Ｈｈと比較する。
In step S <b> 28, the electromagnetic brake failure determination unit 113 compares the maximum acceleration time fluctuation amount ΔHa calculated by the above (Equation 3) with the threshold value Hh stored in the
ここで、閾値Ｈｈの求め方について説明する。例えば、同期電動機２を定格トルクで運転している場合を考える。この場合、同期電動機２が正常に運転しているならば、同期電動機２が発生させるトルクは、定格トルク程度である。よって、同期電動機２が正常に運転しているならば、同期電動機２の加速時間は、同期電動機２の定格トルクに基づいて、算出することができる。また、閾値Ｈｈは、同期電動機２が正常に運転しているときの最大加速時間Ｈａと、異常時における加速時間とを判別するための値である。このため、閾値Ｈｈは、同期電動機２が正常に運転しているときの最大加速時間Ｈａよりも大きな値とする必要がある。そこで、閾値Ｈｈは、同期電動機２が発生させるトルクに基づいて算出した加速時間について、例えば、１．２５倍した値とする。上記の例の場合、閾値Ｈｈは、例えば、同期電動機２の発生させるトルクを定格トルクとして算出した加速時間について、１．２５倍した値とする。このようにして求めた閾値Ｈｈについて、記憶装置３２は、あらかじめ記憶している。
Here, how to obtain the threshold value Hh will be described. For example, consider a case where the
ステップＳ２８において、最大加速時間変動量ΔＨａが閾値Ｈｈよりも小さい場合、同期電動機２は、正常に運転している。このため、ステップＳ２９において、電磁ブレーキ故障判断部１１３は、モータ制御システムが正常であると判断する。電磁ブレーキ故障判断部１１３は、このときの最大加速時間変動量ΔＨａを記憶装置３２に記憶させる。
In step S28, if the maximum acceleration time variation ΔHa is smaller than the threshold value Hh, the
なお、記憶装置３２は、前回運転時における最大加速時間変動量ΔＨｂを記憶している。このため、記憶装置３２は、最大加速時間変動量ΔＨａを記憶する際、前回運転時の最大加速時間変動量ΔＨｂを削除する。つまり、記憶装置３２は、前回運転時の最大加速時間変動量ΔＨｂを削除するとともに、今回運転時に算出した最大加速時間変動量ΔＨａを、新たな最大加速時間変動量ΔＨｂとして記憶する。次回の運転時において、モータ制御システムは、この新たな最大加速時間変動量ΔＨｂを、前回運転時の最大加速時間変動量ΔＨｂとして使用する。
The
一方、ステップＳ２８において、最大加速時間変動量ΔＨａが閾値Ｈｈよりも大きい場合、同期電動機２は、異常な加速時間を発生させている。このため、電磁ブレーキ故障判断部１１３は、モータ制御システムに異常が発生し、同期電動機２に異常な負荷トルクが発生したと判断する。そして、ステップＳ３０へと進み、モータ制御システムの故障原因の判断を実施する。
On the other hand, when the maximum acceleration time fluctuation amount ΔHa is larger than the threshold value Hh in step S28, the
図８のステップＳ３０において、電磁ブレーキ故障判断部１１３は、前回運転時の最大加速時間変動量ΔＨｂと閾値Ｈｈとを比較して、前回運転時の最大加速時間変動量ΔＨｂが閾値Ｈｈに近いかどうか判断する。具体的には、ステップＳ３０において、電磁ブレーキ故障判断部１１３は、前回運転時の最大加速時間変動量ΔＨｂと閾値Ｈｈとの差｜ΔＨｂ−Ｈｈ｜を算出する。前回運転時の最大加速時間変動量ΔＨｂは、上記のとおり、事前に記憶装置３２に記憶されている。
In step S30 of FIG. 8, the electromagnetic brake failure determination unit 113 compares the maximum acceleration time variation ΔHb during the previous operation with the threshold value Hh, and determines whether the maximum acceleration time variation ΔHb during the previous operation is close to the threshold value Hh. Judge whether. Specifically, in step S30, the electromagnetic brake failure determination unit 113 calculates a difference | ΔHb−Hh | between the maximum acceleration time fluctuation amount ΔHb and the threshold value Hh during the previous operation. The maximum acceleration time fluctuation amount ΔHb during the previous operation is stored in advance in the
電磁ブレーキ故障判断部１１３は、前回運転時の最大加速時間変動量ΔＨｂと閾値Ｈｈとの差｜ΔＨｂ−Ｈｈ｜を、閾値Ｈαと比較する。ここで、閾値Ｈαは、例えば、同期電動機２の発生させるトルクを定格トルクとして算出した加速時間の１０％の値とする。なお、閾値Ｈαは、マージンを取って、同期電動機２の発生させるトルクを定格トルクとして算出した加速時間の２０％、３０％等の値としても良い。
The electromagnetic brake failure determination unit 113 compares the difference | ΔHb−Hh | between the maximum acceleration time fluctuation amount ΔHb and the threshold value Hh during the previous operation with the threshold value Hα. Here, the threshold value Hα is, for example, a value of 10% of the acceleration time calculated by using the torque generated by the
差｜ΔＨｂ−Ｈｈ｜が閾値Ｈαよりも小さい場合、ステップＳ３０において、電磁ブレーキ故障判断部１１３は、前回運転時の最大加速時間変動量ΔＨｂと今回運転時の最大加速時間変動量ΔＨａとの変化が緩慢であると判断する。これにより、ステップＳ３１において、電磁ブレーキ故障判断部１１３は、モータ制御システムに機械劣化故障が発生したと判断する。 If the difference | ΔHb−Hh | is smaller than the threshold value Hα, in step S30, the electromagnetic brake failure determination unit 113 changes the maximum acceleration time variation ΔHb during the previous operation and the maximum acceleration time variation ΔHa during the current operation. Is determined to be slow. Thereby, in step S31, the electromagnetic brake failure determination unit 113 determines that a mechanical deterioration failure has occurred in the motor control system.
なお、回転軸２１に接続された外部負荷の持つギア等に働く摩擦力は、モータ制御システム自体の経年劣化により、徐々に増大する。これにともない、同期電動機２が運転時に発生させるトルクは、徐々に増大する。このため、同期電動機２の運転時において、同期電動機２の発生させるトルクがトルク制限値に達することにより、同期電動機２の加速時間が徐々に増大する。よって、前回運転時において、ステップＳ２８で異常が発生したと判断されなくても、同期電動機２の加速時間が前回運転時よりもさらに増大することにより、今回運転時において、最大加速時間変動量ΔＨａが閾値Ｈｈよりも大きくなる。
Note that the frictional force acting on the gear or the like of the external load connected to the
また、ステップＳ３１において、電磁ブレーキ故障判断部１１３は、異常検出信号１１４を表示部３４へと出力する。このときの異常検出信号１１４は、機械劣化故障を示す信号である。この信号を受けて、表示部３４は、機械劣化故障が発生したことを表示する。
In step S31, the electromagnetic brake failure determination unit 113 outputs the abnormality detection signal 114 to the
一方、差｜ΔＨｂ−Ｈｈ｜が閾値Ｈαよりも大きい場合、ステップＳ３０において、電磁ブレーキ故障判断部１１３は、前回運転時の最大加速時間変動量ΔＨｂと今回運転時の最大加速時間変動量ΔＨａとの変化が急激であると判断する。つまり、電磁ブレーキ故障判断部１１３は、同期電動機２の今回の運転時において、同期電動機２の発生させるトルクが突発的に増大したことにより、同期電動機２の発生させるトルクがトルク制限値に達し、異常な加速時間が発生したと判断する。そして、ステップＳ３２へと進み、同期電動機２の発生させるトルクが突発的に増大した場合における、モータ制御システムの故障原因の判断を実施する。なお、第１の故障原因判断とは、実施の形態２において、ステップＳ３０における判断のことである。
On the other hand, when the difference | ΔHb−Hh | is larger than the threshold value Hα, in step S30, the electromagnetic brake failure determination unit 113 determines that the maximum acceleration time variation ΔHb during the previous operation and the maximum acceleration time variation ΔHa during the current operation. It is judged that the change of is abrupt. In other words, the electromagnetic brake failure determination unit 113 causes the torque generated by the
図８のステップＳ３２において、電磁ブレーキ故障判断部１１３は、最大加速時間変動量ΔＨａと、電磁ブレーキ１の制動力による加速時間の変動量ΔＨｍとの差｜ΔＨａ−ΔＨｍ｜を算出する。 In step S32 of FIG. 8, the electromagnetic brake failure determination unit 113 calculates a difference | ΔHa−ΔHm | between the maximum acceleration time variation ΔHa and the acceleration time variation ΔHm due to the braking force of the electromagnetic brake 1.
ここで、電磁ブレーキ１の制動力は、一般的に、同期電動機２の定格トルク程度の値である。このため、電磁ブレーキ１の制動力による加速時間の変動量ΔＨｍは、既知の値である電磁ブレーキ１の制動力の大きさに基づいて、算出できる。また、記憶装置３２は、この算出された電磁ブレーキ１の制動力による加速時間の変動量ΔＨｍを記憶する。なお、実施の形態２において、電磁ブレーキ１の制動力は、同期電動機２の定格トルクを用いる。
Here, the braking force of the electromagnetic brake 1 is generally a value about the rated torque of the
電磁ブレーキ故障判断部１１３は、最大加速時間変動量ΔＨａと電磁ブレーキ１の制動力による加速時間の変動量ΔＨｍとの差異、すなわち差｜ΔＨａ−ΔＨｍ｜を、閾値Ｈβと比較する。ここで、閾値Ｈβは、例えば、同期電動機２の発生させるトルクを定格トルクとして算出した加速時間の１０％の値とする。なお、閾値Ｈβは、マージンを取って、同期電動機２の発生させるトルクを定格トルクとして算出した加速時間の２０％、５０％等の値としても良い。
The electromagnetic brake failure determination unit 113 compares the difference between the maximum acceleration time fluctuation amount ΔHa and the acceleration time fluctuation amount ΔHm due to the braking force of the electromagnetic brake 1, that is, the difference | ΔHa−ΔHm | with the threshold value Hβ. Here, the threshold value Hβ is, for example, a value of 10% of the acceleration time calculated using the torque generated by the
差｜ΔＨａ−ΔＨｍ｜が閾値Ｈβよりも小さい場合、ステップＳ３２において、電磁ブレーキ故障判断部１１３は、最大加速時間変動量ΔＨａと電磁ブレーキ１の制動力による加速時間の変動量ΔＨｍとが一致したと判断する。この場合、同期電動機２が発生させた異常な加速時間は、電磁ブレーキ１の制動力によるものと判断できる。これにより、ステップＳ３３において、電磁ブレーキ故障判断部１１３は、モータ制御システムにブレーキメカ故障が発生したと判断する。
When the difference | ΔHa−ΔHm | is smaller than the threshold value Hβ, the electromagnetic brake failure determination unit 113 matches the maximum acceleration time variation ΔHa and the acceleration time variation ΔHm due to the braking force of the electromagnetic brake 1 in step S32. Judge. In this case, it can be determined that the abnormal acceleration time generated by the
ステップＳ３３において、電磁ブレーキ故障判断部１１３は、異常検出信号１１４を表示部３４へと出力する。このときの異常検出信号１１４は、ブレーキメカ故障を示す信号である。この信号を受けて、表示部３４は、ブレーキメカ故障が発生したことを表示する。
In step S <b> 33, the electromagnetic brake failure determination unit 113 outputs the abnormality detection signal 114 to the
一方、ステップＳ３２において、差｜ΔＨａ−ΔＨｍ｜が閾値Ｈβよりも大きい場合、電磁ブレーキ故障判断部１１３は、最大加速時間変動量ΔＨａと電磁ブレーキ１の制動力による加速時間の変動量ΔＨｍとが一致しないと判断する。この場合、同期電動機２が発生させた異常な加速時間は、電磁ブレーキ１の制動力では発生し得ないものと判断できる。これにより、ステップＳ３４において、電磁ブレーキ故障判断部１１３は、モータ制御システムにその他機械故障が発生したと判断する。
On the other hand, when the difference | ΔHa−ΔHm | is larger than the threshold value Hβ in step S32, the electromagnetic brake failure determination unit 113 determines that the maximum acceleration time variation amount ΔHa and the acceleration time variation amount ΔHm due to the braking force of the electromagnetic brake 1 are calculated. Judge that they do not match. In this case, it can be determined that the abnormal acceleration time generated by the
また、ステップＳ３４において、電磁ブレーキ故障判断部１１３は、異常検出信号１１４を表示部３４へと出力する。このときの異常検出信号１１４は、その他機械故障を示す信号である。この信号を受けて、表示部３４は、その他機械故障が発生したことを表示する。なお、第２の故障原因判断とは、実施の形態２において、ステップＳ３
２における判断のことである。
In step S <b> 34, the electromagnetic brake failure determination unit 113 outputs the abnormality detection signal 114 to the
It is a judgment in 2.
このようにして、実施の形態２におけるモータ制御システムは、同期電動機２の駆動の開始時に故障判断を実施する。
In this way, the motor control system according to the second embodiment performs failure determination at the start of driving of the
以上のように、実施の形態２において、同期電動機２の駆動の開始時に、電磁ブレーキ故判断部１１４は、今回運転時の最大加速時間変動量ΔＨａを、閾値Ｈｈと比較する。最大加速時間変動量ΔＨａが閾値Ｈｈよりも大きい場合、電磁ブレーキ故障判断部１１３は、前回運転時の最大加速時間変動量ΔＨｂを、閾値Ｈｈと比較する。前回運転時の最大加速時間変動量ΔＨｂが閾値Ｈｈから遠い場合、電磁ブレーキ故障判断部１１３は、最大加速時間変動量ΔＨａと電磁ブレーキ１の制動力による加速時間の変動量ΔＨｍとが一致するかどうかを判断する。
As described above, in the second embodiment, at the start of driving of the
これにより、実施の形態２におけるモータ制御システムは、同期電動機２に異常な負荷トルクが発生した場合に、トルク制限機能を持つ駆動装置３ｂにより、ブレーキ装置の故障とブレーキ装置ではない部分の故障とを区別して検知する。また、実施の形態２におけるモータ制御システムは、モータ制御システムに異常が発生した場合において、トルク制限機能を持つ駆動装置３ｂにより、モータ制御システムの故障箇所及び故障原因を判断する。よって、故障箇所及び故障原因を判断する手間が省けるため、実施の形態２におけるモータ制御システムは、駆動装置３ｂがトルク制限機能を持つ場合において、故障箇所の修理にかかる時間を削減できる。
Thereby, in the motor control system according to the second embodiment, when an abnormal load torque is generated in the
なお、加速時間推定部１１５は、速度フィードバック値１０５から加速時間を算出し、同期電動機２が駆動を開始してから１周期分の加速時間に基づいて、最大加速時間Ｈａを求めるとしたが、これに限られるものではない。例えば、加速時間推定部１１５は、同期電動機２の駆動の開始後ｎ周期分の加速時間に基づいて、ｎ周期分の最大加速時間Ｈａ１、Ｈａ２、・・・Ｈａｎをそれぞれ算出しても良い。そして、電磁ブレーキ故障判断部１１３は、例えばこれらｎ周期分の最大加速時間Ｈａ１、Ｈａ２、・・・Ｈａｎの平均値を、同期電動機２が駆動を開始してから１周期における最大加速時間の代わりに用いても、同様の効果を得ることができる。
The acceleration time estimation unit 115 calculates the acceleration time from the speed feedback value 105 and calculates the maximum acceleration time Ha based on the acceleration time for one cycle after the
また、閾値Ｈｈは、同期電動機２が発生させるトルクに基づいて算出した加速時間について、例えば、１．２５倍した値としたが、これに限られるものではない。１．２５倍ではなく、他の値であっても良い。
The threshold value Hh is, for example, a value obtained by multiplying the acceleration time calculated based on the torque generated by the
このほか、電磁ブレーキ故障判断部１１３は、ｎ回分の正常時の最大加速時間Ｈｂ１、Ｈｂ２、・・・Ｈｂｎに基づいて、これらの最大加速時間Ｈｂ１、Ｈｂ２、・・・Ｈｂｎが取り得ない値を求め、この求めた値を閾値Ｈｈとしても良い。この場合、例えば、ｎ回分の正常時の最大加速時間Ｈｂ１、Ｈｂ２、・・・Ｈｂｎの平均値と分散σ２を求める。そして、例えば、ｎ回分の正常時の最大加速時間Ｈｂ１、Ｈｂ２、・・・Ｈｂｎの平均値に３σを加えた値を求め、この値をさらに１．２５倍する。このようにして算出した値を閾値Ｈｈとしても、同様の効果を得ることができる。 In addition, the electromagnetic brake failure determination unit 113 determines a value that these maximum acceleration times Hb1, Hb2,... Hbn cannot take based on the n normal maximum acceleration times Hb1, Hb2,. The obtained value may be used as the threshold value Hh. In this case, for example, an average value and variance σ 2 of n normal maximum acceleration times Hb1, Hb2,... Hbn are obtained. Then, for example, a value obtained by adding 3σ to the average value of n normal maximum acceleration times Hb1, Hb2,... Hbn is obtained, and this value is further multiplied by 1.25. Even if the value calculated in this way is set as the threshold value Hh, the same effect can be obtained.
電磁ブレーキ故障判断部１１３は、基準最大加速時間Ｈｃを、ｎ回分の正常時の最大加速時間Ｈｂ１、Ｈｂ２、・・・Ｈｂｎの平均値として算出することとしたが、これに限られるものではない。例えば、電磁ブレーキ故障判断部１１３は、基準最大加速時間Ｈｃとして、１回分の正常時の最大加速時間Ｈｂ１を使用しても良い。この場合においても、同様の効果を得ることができる。 The electromagnetic brake failure determination unit 113 calculates the reference maximum acceleration time Hc as an average value of n normal normal maximum acceleration times Hb1, Hb2,... Hbn, but is not limited thereto. . For example, the electromagnetic brake failure determination unit 113 may use one normal maximum acceleration time Hb1 as the reference maximum acceleration time Hc. In this case, the same effect can be obtained.
ステップＳ２９において、モータ制御システムが正常であると判断した場合、電磁ブレーキ故障判断部１１３は、最大加速時間変動量ΔＨｂを記憶装置３２に記憶させた。このとき、前回運転時の最大加速時間変動量ΔＨｂは、削除することとした。しかし、最大加速時間変動量ΔＨｂは、これに限られるものではない。例えば、記憶装置３２は、算出した最大加速時間変動量を、上記のように直前１回分だけでなく、任意の直近ｎ回分について記憶するようにしても良い。そして、例えば、電磁ブレーキ故障判断部１１３は、ステップＳ２８において、任意の直近ｎ回分の最大加速時間変動量ΔＨｂ１、ΔＨｂ２、・・・ΔＨｂｎの平均値を、前回運転時の最大加速時間変動量の代わりに用いても良い。また、例えば、電磁ブレーキ故障判断部１１３は、ステップＳ２８において、前回運転時の最大加速時間変動量ΔＨｂ１を用いて判断を行った後、さらに前々回運転時の最大加速時間変動量ΔＨｂ２を用いて判断を行い、この判断を任意のｎ回続けるようにしても良い。このような場合においても、前回運転時の最大加速時間変動量を用いて判断を行う場合と同様の効果を得ることができる。
In step S29, when it is determined that the motor control system is normal, the electromagnetic brake failure determination unit 113 stores the maximum acceleration time variation ΔHb in the
なお、実施の形態１または実施の形態２において、モータ制御システムには、電磁ブレーキ制御装置６を設けた。また、電磁ブレーキ制御装置６は、ブレーキ制御指令１００及び電磁ブレーキ制御信号１０１を出力し、電磁ブレーキ１の制動を制御するようにした。しかし、実施の形態１または実施の形態２におけるモータ制御システムは、これに限られるものではない。
In the first embodiment or the second embodiment, the electromagnetic brake control device 6 is provided in the motor control system. The electromagnetic brake control device 6 outputs a
図９は、駆動装置３ｃ内に電磁ブレーキ制御用ＣＰＵ３５を設けた場合における、モータ制御システムの構成を示す図である。図９において、モータ制御システムは、電磁ブレーキ制御装置６を備えない。また、図９において、モータ制御システムは、電磁ブレーキ制御用ＣＰＵ３５を備える。この場合、電磁ブレーキ制御用ＣＰＵ３５は、ブレーキ制御指令１００及び電磁ブレーキ制御信号１０１を、電磁ブレーキ制御装置６の代わりに出力する。これにより、電磁ブレーキ１は、同期電動機２に対する制動が解除される。図９に示す場合において、ＣＰＵ３１ｃの構成は、実施の形態１におけるＣＰＵ３１ａまたは実施の形態２におけるＣＰＵ３１ｂと同様とする。また、図９に示すモータ制御システムにおいて、このほかの構成、動作等に関しては、実施の形態１または実施の形態２において説明したモータ制御システムと同様である。この場合においても、電磁ブレーキ制御装置６を設ける場合と同様の効果を得ることができる。
FIG. 9 is a diagram showing the configuration of the motor control system when the electromagnetic brake control CPU 35 is provided in the drive device 3c. In FIG. 9, the motor control system does not include the electromagnetic brake control device 6. In FIG. 9, the motor control system includes an electromagnetic brake control CPU 35. In this case, the electromagnetic brake control CPU 35 outputs the
また、実施の形態１または実施の形態２において、モータ制御システムは、電磁ブレーキ制御装置６及び電磁ブレーキ制御用ＣＰＵ３５を、両方とも設けない構成としても良い。この場合、実施の形態１の駆動装置３ａのＣＰＵ３１ａは、ブレーキ制御指令１００及び電磁ブレーキ制御信号１０１を、電磁ブレーキ制御装置６または電磁ブレーキ制御用ＣＰＵ３５の代わりに出力する。あるいは、実施の形態２の駆動装置３ｂのＣＰＵ３１ｂは、ブレーキ制御指令１００及び電磁ブレーキ制御信号１０１を、電磁ブレーキ制御装置６または電磁ブレーキ制御用ＣＰＵ３５の代わりに出力する。これにより、電磁ブレーキ１は、同期電動機２に対する制動が解除される。この場合においても、電磁ブレーキ制御装置６または電磁ブレーキ制御用ＣＰＵ３５を設ける場合と同等の効果を得ることができる。
In the first embodiment or the second embodiment, the motor control system may be configured such that neither the electromagnetic brake control device 6 nor the electromagnetic brake control CPU 35 is provided. In this case, the CPU 31a of the drive device 3a of the first embodiment outputs the
なお、実施の形態１または実施の形態２において、同期電動機２の速度は、回転速度でなく、角速度を用いても良い。また、実施の形態１または実施の形態２におけるモータ制御システムは、同期電動機２を備えるとしたが、これに限られるものではない。実施の形態１または実施の形態２におけるモータ制御システムは、サーボ機構を有する電動機であれば、同期電動機２の代わりに、例えば、誘導電動機などを用いても良い。このような変更を行ったとしても、実施の形態１または実施の形態２において奏する効果を同様に得ることができる。
In the first embodiment or the second embodiment, the speed of the
１ 電磁ブレーキ、２ 同期電動機、２１ 回転軸、３ａ 駆動装置、３ｂ 駆動装置、３ｃ 駆動装置、３１ａ ＣＰＵ、３１ｂ ＣＰＵ、３１ｃ ＣＰＵ、３２ 記憶装置、３３ 電流検出回路、３４ 表示部、３５ 電磁ブレーキ制御用ＣＰＵ、４ 位置検出器、５ 上位コントローラ、６ 電磁ブレーキ制御装置、１１ ヨーク、１２ コイル、１３ ボルト、１４ プレート、１５ アーマチュア、１６ ブレーキライニング、１７ ばね、１００ ブレーキ制御指令、１０１ 電磁ブレーキ制御信号、１０２ 電流検出信号、１０３ 位置指令、１０４ 位置フィードバック値、１０５ 速度フィードバック値、１０６ 電流指令、１０７ 位置制御部、１０８ 速度指令値、１０９ 速度制御部、１１０ 電流指令値、１１１ 電流制御部、１１２ トルク推定部、１１３ 電磁ブレーキ故障判断部、１１４ 異常検出信号、１１５ 加速時間推定部 DESCRIPTION OF SYMBOLS 1 Electromagnetic brake, 2 Synchronous motor, 21 Rotating shaft, 3a drive device, 3b drive device, 3c drive device, 31a CPU, 31b CPU, 31c CPU, 32 Memory | storage device, 33 Current detection circuit, 34 Display part, 35 Electromagnetic brake control CPU, 4 position detector, 5 host controller, 6 electromagnetic brake control device, 11 yoke, 12 coil, 13 bolt, 14 plate, 15 armature, 16 brake lining, 17 spring, 100 brake control command, 101 electromagnetic brake control signal , 102 Current detection signal, 103 Position command, 104 Position feedback value, 105 Speed feedback value, 106 Current command, 107 Position control unit, 108 Speed command value, 109 Speed control unit, 110 Current command value, 111 Current control unit, 112 G Click estimating unit, 113 an electromagnetic brake failure determination unit, 114 the abnormality detection signal, 115 acceleration time estimating unit
Claims (14)
制動力を発生させ、この制動力により前記電動機を制動するブレーキ装置と、
前記電動機を駆動させ、前記電動機に負荷がかかった場合、この負荷に基づく変動値を検出し、この変動値に基づいて、前記電動機に異常なトルクが発生したかどうかを判断し、前記電動機に異常なトルクが発生したと判断した場合、前記変動値と前記ブレーキ装置の制動力の大きさとに基づいて、前記電動機に異常なトルクが発生した原因に関し、前記ブレーキ装置の故障か、あるいは前記ブレーキ装置ではない部分の故障かを判断する第１の故障原因判断を行う駆動装置と
を備えたことを特徴とするモータ制御システム。 An electric motor for generating torque;
A braking device that generates a braking force and brakes the electric motor by the braking force;
When the electric motor is driven and a load is applied to the electric motor, a fluctuation value based on the load is detected, and based on the fluctuation value, it is determined whether or not an abnormal torque is generated in the electric motor. If it is determined that an abnormal torque has occurred, a failure of the brake device or a brake related to the cause of the abnormal torque generated in the motor based on the fluctuation value and the magnitude of the braking force of the brake device. A motor control system comprising: a drive device that performs a first failure cause determination to determine whether a portion is not a device failure.
前記電動機に異常なトルクが発生したと判断した場合、前記第１の故障原因判断を行う前に、前記電動機を前回駆動した際に検出した前記変動値に基づいて、前記電動機に異常なトルクが発生した原因に関し、前記モータ制御システムの劣化による故障か否かを判断する第２の故障原因判断を行い、
前記第２の故障原因判断において前記モータ制御システムの劣化による故障でないと判断した場合、前記第１の故障原因判断を行う
ことを特徴とする請求項１に記載のモータ制御システム。 The driving device includes:
If it is determined that an abnormal torque has occurred in the motor, the abnormal torque is detected in the motor based on the fluctuation value detected when the motor was last driven before the first failure cause determination. Regarding the cause that has occurred, a second failure cause determination is made to determine whether or not the failure is due to deterioration of the motor control system,
2. The motor control system according to claim 1, wherein when it is determined in the second failure cause determination that the failure is not caused by deterioration of the motor control system, the first failure cause determination is performed.
前記電動機が駆動を開始する前に、前記電動機に異常なトルクが発生していない場合における前記ブレーキ装置の故障の有無を判断し、この判断において前記ブレーキ装置の故障が無いと判断した場合、前記電動機を駆動させ、
前記電動機が駆動を開始した直後に、前記電動機に異常なトルクが発生したかどうかを判断する
ことを特徴とする請求項２に記載のモータ制御システム。 The driving device includes:
Before starting the drive of the electric motor, to determine whether there is a failure of the brake device in the case where no abnormal torque has occurred in the electric motor, in this determination, if it is determined that there is no failure of the brake device, Drive the motor,
The motor control system according to claim 2, wherein immediately after the electric motor starts driving, it is determined whether or not an abnormal torque is generated in the electric motor.
前記駆動装置は、
前記電動機が駆動を開始する前に、前記ブレーキ装置の制動を通知する信号または前記ブレーキ装置の制動の解除を通知する信号が出力されているかどうかを判断し、前記信号の出力の有無に基づいて前記ブレーキ装置が前記電動機を制動していると判断した場合、前記位置検出器が検出した位置情報が変化したかどうかを判断し、この位置情報が変化したと判断した場合、前記ブレーキ装置が故障したと判断する
ことを特徴とする請求項３に記載のモータ制御システム。 A position detector for detecting position information of the electric motor;
The driving device includes:
Before the electric motor starts driving, it is determined whether a signal notifying braking of the brake device or a signal notifying braking release of the brake device is output, and based on the presence or absence of the output of the signal When it is determined that the brake device is braking the electric motor, it is determined whether the position information detected by the position detector has changed, and when it is determined that the position information has changed, the brake device has failed. The motor control system according to claim 3, wherein it is determined that the motor control has been performed.
前記電動機が駆動を開始する前に、前記ブレーキ装置の制動を通知する信号または前記ブレーキ装置の制動の解除を通知する信号が出力されているかどうかを判断し、前記信号の出力の有無に基づいて前記ブレーキ装置が前記電動機を制動していないと判断した場合、前記ブレーキ装置に電流が流れているかどうかを判断し、前記ブレーキ装置に電流が流れていないと判断した場合、前記ブレーキ装置が故障したと判断する
ことを特徴とする請求項３に記載のモータ制御システム。 The driving device includes:
Before the electric motor starts driving, it is determined whether a signal notifying braking of the brake device or a signal notifying braking release of the brake device is output, and based on the presence or absence of the output of the signal When it is determined that the brake device is not braking the electric motor, it is determined whether or not current is flowing through the brake device. When it is determined that current is not flowing through the brake device, the brake device has failed. The motor control system according to claim 3, wherein the motor control system is determined.
前記駆動装置は、
前記電動機が正常に駆動している場合における前記電動機のトルクを検出し、この検出した前記電動機のトルクに基づく基準値を算出し、
前記電動機が駆動を開始した直後において、前記変動値として前記電動機のトルクを検出し、このときに検出した前記電動機のトルクに基づいて、前記電動機に異常なトルクが発生したかどうかを判断し、
前記電動機に異常なトルクが発生したと判断した場合、このときに検出した前記電動機のトルクに基づいて、前記電動機が駆動を開始した後の最大のトルクを算出し、この最大のトルクと前記基準値との差を演算し、この差と前記ブレーキ装置の制動力の大きさとを比較して、前記電動機に異常なトルクが発生した原因に関し、前記ブレーキ装置の故障か、あるいは前記ブレーキ装置ではない部分の故障かを判断する前記第１の故障原因判断を行う
ことを特徴とする請求項１に記載のモータ制御システム。 The fluctuation value is a torque of the electric motor,
The driving device includes:
Detecting the torque of the motor when the motor is normally driven, calculating a reference value based on the detected torque of the motor;
Immediately after the motor starts driving, the torque of the motor is detected as the variation value, and based on the torque of the motor detected at this time, it is determined whether an abnormal torque has occurred in the motor,
When it is determined that an abnormal torque has occurred in the motor, the maximum torque after the motor starts driving is calculated based on the detected torque of the motor, and the maximum torque and the reference The difference between the values is calculated, and the difference is compared with the magnitude of the braking force of the brake device. The cause of the abnormal torque generated in the electric motor is the failure of the brake device or not the brake device. 2. The motor control system according to claim 1, wherein the first failure cause determination is performed to determine whether or not a partial failure has occurred.
前記駆動装置は、
前記電動機が正常に駆動している場合における前記電動機の速度を検出し、この検出した前記電動機の速度に基づいて、前記電動機が目標速度に達するまでに要する加速時間を算出し、このときに算出した加速時間を基準値として記憶し、
前記ブレーキ装置の制動力の大きさに基づいて、前記ブレーキ装置が前記電動機を制動している場合の加速時間を算出し、
前記電動機が駆動を開始した直後において、前記変動値として前記電動機の速度を検出し、このときに検出した前記電動機の速度から算出される加速時間に基づいて、前記電動機に異常なトルクが発生したかどうかを判断し、
前記電動機に異常なトルクが発生したと判断した場合、このときに検出した前記電動機の速度から算出される加速時間に基づいて、前記電動機が駆動を開始した後の最大の加速時間を算出し、この最大の加速時間と前記基準値との差を演算し、この差と前記ブレーキ装置が前記電動機を制動している場合の加速時間とを比較して、前記電動機に異常なトルクが発生した原因に関し、前記ブレーキ装置の故障か、あるいは前記ブレーキ装置ではない部分の故障かを判断する前記第１の故障原因判断を行う
ことを特徴とする請求項１に記載のモータ制御システム。 The fluctuation value is a speed of the electric motor,
The driving device includes:
The speed of the motor when the motor is normally driven is detected, and based on the detected speed of the motor, an acceleration time required for the motor to reach a target speed is calculated, and calculated at this time Memorized acceleration time as a reference value,
Based on the magnitude of the braking force of the brake device, calculate the acceleration time when the brake device is braking the motor,
Immediately after the motor starts driving, the speed of the motor is detected as the fluctuation value, and abnormal torque is generated in the motor based on the acceleration time calculated from the speed of the motor detected at this time. To determine whether
When it is determined that an abnormal torque has occurred in the motor, the maximum acceleration time after the motor starts driving is calculated based on the acceleration time calculated from the speed of the motor detected at this time, The difference between the maximum acceleration time and the reference value is calculated, and the difference is compared with the acceleration time when the brake device brakes the motor, thereby causing abnormal torque in the motor. 2. The motor control system according to claim 1, wherein the first failure cause determination is performed to determine whether the brake device is defective or a failure of a portion that is not the brake device.
前記第１のステップにおいて前記電動機に異常なトルクが発生したと判断された場合、前記変動値と前記ブレーキ装置の制動力の大きさとに基づいて、前記電動機に異常なトルクが発生した原因に関し、前記ブレーキ装置の故障か、あるいは前記ブレーキ装置ではない部分の故障かを判断する第２のステップと
を備えたことを特徴とするモータ制御システムの故障判断方法。 When a load is applied to the motor braked by the braking force of the brake device, a fluctuation value based on this load is detected, and based on this fluctuation value, it is determined whether or not an abnormal torque has occurred in the motor. And the steps
When it is determined that an abnormal torque is generated in the electric motor in the first step, the cause of the abnormal torque generated in the electric motor based on the fluctuation value and the magnitude of the braking force of the brake device, And a second step of determining whether the brake device is faulty or a failure of a portion that is not the brake device.
前記第２のステップは、
前記第３のステップにおいて前記モータ制御システムの劣化による故障と判断されなかった場合に行われる
ことを特徴とする請求項８に記載のモータ制御システムの故障判断方法。 If it is determined in the first step that an abnormal torque has occurred in the electric motor, before performing the second step, based on the fluctuation value detected when the electric motor was last driven, the electric motor A third step of determining whether or not a failure due to deterioration of the motor control system with respect to the cause of abnormal torque occurring in the
The second step includes
9. The motor control system failure determination method according to claim 8, wherein the failure determination method is performed when the failure is not determined in the third step due to deterioration of the motor control system.
前記第４のステップにおいて前記ブレーキ装置に故障が無いと判断された場合、前記電動機の駆動の開始時かどうかを判断する第５のステップとを備え、
前記第１のステップは、
前記第５のステップにおいて前記電動機の駆動の開始時であると判断された場合、前記電動機に異常なトルクが発生したかどうかを判断する
ことを特徴とする請求項９に記載のモータ制御システムの故障判断方法。 A fourth step of determining whether or not the brake device has failed when no abnormal torque is generated in the motor;
When it is determined in the fourth step that there is no failure in the brake device, a fifth step of determining whether or not the motor starts to be driven is provided,
The first step includes
10. The motor control system according to claim 9, wherein when it is determined in the fifth step that the driving of the electric motor is started, it is determined whether or not an abnormal torque is generated in the electric motor. Failure judgment method.
前記ブレーキ装置の制動を通知する信号または前記ブレーキ装置の制動の解除を通知する信号が出力されているかどうかを判断し、前記信号の出力の有無に基づいて前記ブレーキ装置が前記電動機を制動していると判断した場合、位置検出器が検出した位置情報が変化したかどうかを判断し、この位置情報が変化したと判断した場合、前記ブレーキ装置が故障したと判断する
ことを特徴とする請求項１０に記載のモータ制御システムの故障判断方法。 The fourth step includes
It is determined whether a signal for notifying the braking of the braking device or a signal for notifying the braking of the braking device is output, and the braking device brakes the electric motor based on the presence or absence of the output of the signal. When it is determined that the position information detected by the position detector has changed, it is determined whether the position information has changed, and if it is determined that the position information has changed, it is determined that the brake device has failed. 10. A failure determination method for a motor control system according to 10.
前記ブレーキ装置の制動を通知する信号または前記ブレーキ装置の制動の解除を通知する信号が出力されているかどうかを判断し、前記信号の出力の有無に基づいて前記ブレーキ装置が前記電動機を制動していないと判断した場合、前記ブレーキ装置に電流が流れているかどうかを判断し、前記ブレーキ装置に電流が流れていないと判断した場合、前記ブレーキ装置が故障したと判断する
ことを特徴とする請求項１０に記載のモータ制御システムの故障判断方法。 The fourth step includes
It is determined whether a signal for notifying the braking of the braking device or a signal for notifying the braking of the braking device is output, and the braking device brakes the electric motor based on the presence or absence of the output of the signal. When it is determined that there is no current, it is determined whether or not a current is flowing through the brake device, and when it is determined that no current is flowing through the brake device, it is determined that the brake device has failed. 10. A failure determination method for a motor control system according to 10.
前記第１のステップを行う前に、前記電動機の駆動の開始時かどうかを判断する第７のステップとを備え、
前記第１のステップは、
前記第７のステップにおいて前記電動機の駆動の開始時であると判断された場合に、前記変動値として前記電動機のトルクを検出し、このときに検出した前記電動機のトルクに基づいて、前記電動機に異常なトルクが発生したかどうかを判断し、
前記第２のステップは、
前記第１のステップにおいて前記電動機に異常なトルクが発生したと判断された場合に、このときに検出した前記電動機のトルクに基づいて、前記電動機が駆動を開始した後の最大のトルクを算出し、この最大のトルクと前記基準値との差を演算し、この差と前記ブレーキ装置の制動力の大きさとを比較して、前記電動機に異常なトルクが発生した原因に関し、前記ブレーキ装置の故障か、あるいは前記ブレーキ装置ではない部分の故障かを判断する
ことを特徴とする請求項８に記載のモータ制御システムの故障判断方法。 A sixth step of detecting a torque of the motor when the motor is normally driven, and calculating a reference value based on the detected torque of the motor;
Before performing the first step, comprising a seventh step of determining whether or not to start driving the electric motor,
The first step includes
When it is determined in the seventh step that the driving of the motor is started, the torque of the motor is detected as the variation value, and the motor is detected based on the detected torque of the motor. Determine if any abnormal torque has occurred,
The second step includes
When it is determined in the first step that an abnormal torque is generated in the electric motor, the maximum torque after the electric motor starts driving is calculated based on the electric motor torque detected at this time. The difference between the maximum torque and the reference value is calculated, and the difference is compared with the magnitude of the braking force of the brake device. The cause of the abnormal torque generated in the electric motor The failure determination method for a motor control system according to claim 8, wherein it is determined whether the failure is a portion that is not the brake device.
前記ブレーキ装置の制動力の大きさに基づいて、前記ブレーキ装置が前記電動機を制動している場合の加速時間を算出する第９のステップと、
前記第１のステップを行う前に、前記電動機の駆動の開始時かどうかを判断する第１０のステップとを備え、
前記第１のステップは、
前記第１０のステップにおいて前記電動機の駆動の開始時であると判断された場合に、前記変動値として前記電動機の速度を検出し、このときに検出した前記電動機の速度から算出される加速時間に基づいて、前記電動機に異常なトルクが発生したかどうかを判断し、
前記第２のステップは、
前記第１のステップにおいて前記電動機に異常なトルクが発生したと判断された場合に、このときに検出した前記電動機の速度から算出される加速時間に基づいて、前記電動機が駆動を開始した後の最大の加速時間を算出し、この最大の加速時間と前記基準値との差を演算し、この差と前記ブレーキ装置が前記電動機を制動している場合の加速時間とを比較して、前記電動機に異常なトルクが発生した原因に関し、前記ブレーキ装置の故障か、あるいは前記ブレーキ装置ではない部分の故障かを判断する
ことを特徴とする請求項８に記載のモータ制御システムの故障判断方法。 The speed of the motor when the motor is normally driven is detected, and based on the detected speed of the motor, an acceleration time required for the motor to reach a target speed is calculated, and calculated at this time An eighth step of storing the accelerated time as a reference value;
A ninth step of calculating an acceleration time when the brake device is braking the electric motor based on the magnitude of the braking force of the brake device;
Before performing the first step, comprising a tenth step of determining whether or not to start driving the electric motor,
The first step includes
When it is determined in the tenth step that the driving of the electric motor is started, the speed of the electric motor is detected as the fluctuation value, and the acceleration time calculated from the speed of the electric motor detected at this time is detected. Based on whether an abnormal torque has occurred in the electric motor,
The second step includes
When it is determined in the first step that an abnormal torque has occurred in the electric motor, after the electric motor starts driving based on the acceleration time calculated from the speed of the electric motor detected at this time The maximum acceleration time is calculated, the difference between the maximum acceleration time and the reference value is calculated, and the difference is compared with the acceleration time when the brake device brakes the motor. 9. The failure determination method for a motor control system according to claim 8, wherein a failure of the brake device or a failure of a portion that is not the brake device is determined with respect to a cause of an abnormal torque.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2013270891A JP5967072B2 (en) | 2013-12-27 | 2013-12-27 | Motor control system and motor control system failure determination method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2013270891A JP5967072B2 (en) | 2013-12-27 | 2013-12-27 | Motor control system and motor control system failure determination method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2015126647A true JP2015126647A (en) | 2015-07-06 |
| JP5967072B2 JP5967072B2 (en) | 2016-08-10 |
Family
ID=53536986
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2013270891A Expired - Fee Related JP5967072B2 (en) | 2013-12-27 | 2013-12-27 | Motor control system and motor control system failure determination method |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5967072B2 (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2020071795A (en) * | 2018-11-02 | 2020-05-07 | ファナック株式会社 | Rotation table device, rotation table controller, program, and rotation table control method |
Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH04265681A (en) * | 1991-02-19 | 1992-09-21 | Teijin Seiki Co Ltd | Brake failure detecting method |
| JPH0739190A (en) * | 1993-07-19 | 1995-02-07 | Yaskawa Electric Corp | Brake malfunction detecting method for automatic machine |
| JPH08310764A (en) * | 1995-05-10 | 1996-11-26 | Hitachi Building Syst Eng & Service Co Ltd | Abnormality diagnostic device for elevator brake |
| JP2000324885A (en) * | 1999-05-12 | 2000-11-24 | Amada Co Ltd | Method and apparatus for detecting brake failure of servo motor with brake |
| JP2002354860A (en) * | 2001-05-29 | 2002-12-06 | Toyo Electric Mfg Co Ltd | Motor controller provided with function of preventing damage to mechanical apparatus |
| JP2003032879A (en) * | 2001-07-19 | 2003-01-31 | Yaskawa Electric Corp | Method of detecting failure of retaining brake of motor drive apparatus |
| JP2006143085A (en) * | 2004-11-22 | 2006-06-08 | Toyota Motor Corp | Brake device and driving unit |
| JP2009220996A (en) * | 2008-03-18 | 2009-10-01 | Toshiba Elevator Co Ltd | Automatic diagnostic device for elevator |
| JP2013110923A (en) * | 2011-11-24 | 2013-06-06 | Iai:Kk | Actuator control device, actuator system, control method of actuator and control program |
-
2013
- 2013-12-27 JP JP2013270891A patent/JP5967072B2/en not_active Expired - Fee Related
Patent Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH04265681A (en) * | 1991-02-19 | 1992-09-21 | Teijin Seiki Co Ltd | Brake failure detecting method |
| JPH0739190A (en) * | 1993-07-19 | 1995-02-07 | Yaskawa Electric Corp | Brake malfunction detecting method for automatic machine |
| JPH08310764A (en) * | 1995-05-10 | 1996-11-26 | Hitachi Building Syst Eng & Service Co Ltd | Abnormality diagnostic device for elevator brake |
| JP2000324885A (en) * | 1999-05-12 | 2000-11-24 | Amada Co Ltd | Method and apparatus for detecting brake failure of servo motor with brake |
| JP2002354860A (en) * | 2001-05-29 | 2002-12-06 | Toyo Electric Mfg Co Ltd | Motor controller provided with function of preventing damage to mechanical apparatus |
| JP2003032879A (en) * | 2001-07-19 | 2003-01-31 | Yaskawa Electric Corp | Method of detecting failure of retaining brake of motor drive apparatus |
| JP2006143085A (en) * | 2004-11-22 | 2006-06-08 | Toyota Motor Corp | Brake device and driving unit |
| JP2009220996A (en) * | 2008-03-18 | 2009-10-01 | Toshiba Elevator Co Ltd | Automatic diagnostic device for elevator |
| JP2013110923A (en) * | 2011-11-24 | 2013-06-06 | Iai:Kk | Actuator control device, actuator system, control method of actuator and control program |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2020071795A (en) * | 2018-11-02 | 2020-05-07 | ファナック株式会社 | Rotation table device, rotation table controller, program, and rotation table control method |
| US11135695B2 (en) | 2018-11-02 | 2021-10-05 | Fanuc Corporation | Rotary table device, rotary table controller, program recording medium, and rotary table control method |
Also Published As
| Publication number | Publication date |
|---|---|
| JP5967072B2 (en) | 2016-08-10 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN108602182B (en) | Electric tool | |
| JP6856465B2 (en) | Brake inspection device and motor control device | |
| US10520054B2 (en) | Motor brake system | |
| JP2006238688A (en) | Open-phase detection for rotating magnetic field machine | |
| WO2017175845A1 (en) | Robot control device, and robot provided with control device | |
| US10744989B2 (en) | Brake device for vehicle | |
| CN106411182B (en) | Brake device | |
| JP2016213993A (en) | Servo control device including function to stop control senselessly | |
| JP5967072B2 (en) | Motor control system and motor control system failure determination method | |
| WO2012133066A1 (en) | Actuator monitoring system | |
| JP6309935B2 (en) | Apparatus for inspecting brake mechanism of electric motor, and inspection method | |
| JP6933517B2 (en) | Motor control device | |
| JP2007143311A (en) | Motor controller and motor with electromagnetic brake | |
| JP6432049B2 (en) | DC motor drive device and ceiling-embedded ventilator equipped with the same | |
| JP2018099748A (en) | Brake diagnosis system and method for motor with brake | |
| JP2005192375A (en) | Forcing stop type motor-driven cylinder | |
| JPWO2020044569A1 (en) | Brake diagnostic device and brake diagnostic system | |
| JP6357648B2 (en) | DC motor drive device and ceiling-embedded ventilator equipped with the same | |
| JP2006296114A (en) | Power frequency abnormality detecting apparatus and method of power converter | |
| JP5559955B2 (en) | Switching the supply voltage of an induction motor to a new supply voltage in a short time | |
| WO2016072003A1 (en) | Power converter and control method of power converter | |
| JP2010136583A (en) | Torque controller for electric motor | |
| JP2015180114A (en) | Abnormality determining method for industrial machine | |
| KR102010743B1 (en) | Method for Discriminating Initial Position of Brake by Wire System | |
| JP5827835B2 (en) | Electric parking brake device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20150820 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20160531 |
|
| 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: 20160607 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20160620 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 5967072 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
| LAPS | Cancellation because of no payment of annual fees |