JP6200467B2 - ブレーキの異常を検出する機能を備えたモータ制御システム - Google Patents
ブレーキの異常を検出する機能を備えたモータ制御システム Download PDFInfo
- Publication number
- JP6200467B2 JP6200467B2 JP2015156885A JP2015156885A JP6200467B2 JP 6200467 B2 JP6200467 B2 JP 6200467B2 JP 2015156885 A JP2015156885 A JP 2015156885A JP 2015156885 A JP2015156885 A JP 2015156885A JP 6200467 B2 JP6200467 B2 JP 6200467B2
- Authority
- JP
- Japan
- Prior art keywords
- servo motor
- unit
- signal
- mechanical brake
- servo
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/416—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control of velocity, acceleration or deceleration
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
- B60T8/00—Arrangements for adjusting wheel-braking force to meet varying vehicular or ground-surface conditions, e.g. limiting or varying distribution of braking force
- B60T8/32—Arrangements for adjusting wheel-braking force to meet varying vehicular or ground-surface conditions, e.g. limiting or varying distribution of braking force responsive to a speed condition, e.g. acceleration or deceleration
- B60T8/88—Arrangements for adjusting wheel-braking force to meet varying vehicular or ground-surface conditions, e.g. limiting or varying distribution of braking force responsive to a speed condition, e.g. acceleration or deceleration with failure responsive means, i.e. means for detecting and indicating faulty operation of the speed responsive control means
- B60T8/885—Arrangements for adjusting wheel-braking force to meet varying vehicular or ground-surface conditions, e.g. limiting or varying distribution of braking force responsive to a speed condition, e.g. acceleration or deceleration with failure responsive means, i.e. means for detecting and indicating faulty operation of the speed responsive control means using electrical circuitry
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
- B60T17/00—Component parts, details, or accessories of power brake systems not covered by groups B60T8/00, B60T13/00 or B60T15/00, or presenting other characteristic features
- B60T17/18—Safety devices; Monitoring
- B60T17/22—Devices for monitoring or checking brake systems; Signal devices
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
- F16D—COUPLINGS FOR TRANSMITTING ROTATION; CLUTCHES; BRAKES
- F16D66/00—Arrangements for monitoring working conditions, e.g. wear, temperature
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B23/00—Testing or monitoring of control systems or parts thereof
- G05B23/02—Electric testing or monitoring
- G05B23/0205—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults
- G05B23/0218—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults characterised by the fault detection method dealing with either existing or incipient faults
- G05B23/0224—Process history based detection method, e.g. whereby history implies the availability of large amounts of data
- G05B23/0227—Qualitative history assessment, whereby the type of data acted upon, e.g. waveforms, images or patterns, is not relevant, e.g. rule based assessment; if-then decisions
- G05B23/0235—Qualitative history assessment, whereby the type of data acted upon, e.g. waveforms, images or patterns, is not relevant, e.g. rule based assessment; if-then decisions based on a comparison with predetermined threshold or range, e.g. "classical methods", carried out during normal operation; threshold adaptation or choice; when or how to compare with the threshold
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B23/00—Testing or monitoring of control systems or parts thereof
- G05B23/02—Electric testing or monitoring
- G05B23/0205—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults
- G05B23/0259—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults characterized by the response to fault detection
- G05B23/0286—Modifications to the monitored process, e.g. stopping operation or adapting control
- G05B23/0291—Switching into safety or degraded mode, e.g. protection and supervision after failure
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B9/00—Safety arrangements
- G05B9/02—Safety arrangements electric
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P25/00—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details
- H02P25/02—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details characterised by the kind of motor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
- B60T2270/00—Further aspects of brake control systems not otherwise provided for
- B60T2270/40—Failsafe aspects of brake control systems
- B60T2270/406—Test-mode; Self-diagnosis
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/34—Director, elements to supervisory
- G05B2219/34013—Servocontroller
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/42—Servomotor, servo controller kind till VSS
- G05B2219/42312—Compare feedback with upper and lower limit, store result as 0-1 if in tolerance
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/50—Machine tool, machine tool null till machine tool work handling
- G05B2219/50195—Emergency stop stops drives and spindle, stored program remains in memory
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- General Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Numerical Control (AREA)
- Control Of Electric Motors In General (AREA)
- Machine Tool Sensing Apparatuses (AREA)
- Control Of Presses (AREA)
- Control Of Position Or Direction (AREA)
Description
本発明は、サーボモータの励磁が解除されたときにサーボモータの出力軸を制動する機械式ブレーキ(以下、メカブレーキと略称する。)を備えたモータ制御システムに関する。特に、本発明は、そのようなメカブレーキの異常を検出する機能を備えたモータ制御システムに関する。
従前より、サーボモータによりボールねじを回転させることによりボールねじに沿って主軸ヘッドが移動する工作機械が知られている。主軸ヘッドにはエンドミルやドリル等の工具が取付けられており、工具を回転させながら主軸ヘッドをワークに向かって移動させることにより、ワークが加工される。
さらに、工作機械には、立形フライス盤のように、ボールねじを重力方向に延在させることにより主軸ヘッドを重力方向に上下動させるものがある。このような工作機械においては、電源オフ時や非常停止時にサーボモータの励磁が解除されてしまうと、ボールねじが自由に回転可能となり、主軸ヘッドが重力の影響によって落下する危険性がある。したがって、主軸ヘッドが上下動する工作機械においては、電源オフ時や非常停止時にサーボモータの出力軸を制動するメカブレーキが取付けられている。
また産業用ロボットにおいても、ロボットの軸を駆動するのにサーボモータが使用されているため、電源オフ時や非常停止時にサーボモータの励磁が解除されたときにロボットのアーム部が落下する危険性がある。そのため、産業用ロボットにおいても、サーボモータの出力軸を制動するメカブレーキが搭載されている。
また、上述したメカブレーキに異常が在るときも、電源オフ時や非常停止時に工作機械の主軸ヘッドあるいはロボットのアーム部が落下する危険性がある。そのため、特許文献1や特許文献2などに示されるように、上述したメカブレーキの異常を検出する方法が提案されている。
特許文献1は、モータの出力軸に連結されたブレーキディスクと、ブレーキディスクに押付けられるブレーキシューとからなるメカブレーキを開示している。そして、特許文献1に開示されるメカブレーキの故障検出方法においては、モータ回転軸の制動時に、モータに供給される電流を漸増しながらそのモータ回転開始時の電流値を検出する。同様に、モータ回転軸の非制動時にも、モータに供給される電流を漸増しながらそのモータ回転開始時の電流値を検出する。そして、これら検出電流値の差と、ブレーキトルクに相当する設定値とを比較することにより、メカブレーキの故障を検出している。
また、特許文献2に開示されるメカブレーキの異常検出方法においては、メカブレーキの摩擦制動部材の摩耗量が正常範囲にあるときに、メカブレーキを作動させずにモータを運転し、この運転時のモータ負荷電流値を予め測定して記憶する。メカブレーキを点検する場合には、摩擦制動部材の摩耗量が正常範囲にあるときと同様、メカブレーキを作動させずにモータを運転し、この運転時のモータ負荷電流の大きさを検出する。そして、検出されたモータ負荷電流検出値と予め記憶されたモータ負荷電流値とを比較することにより、メカブレーキの異常を検出している。
さらに、上述したメカブレーキの異常が検出された場合は、サーボモータの出力軸を制動する力は大幅に低下している。したがって、メカブレーキの点検または修理が完了するまでは、工作機械の主軸ヘッドあるいはロボットのアーム部が落下する危険性がある。そのため、メカブレーキの異常を検出した後、直ちに、サーボモータの出力軸に対する制動力の不足を何らかの方法によって補うことが望まれる。その方法例として、特許文献3は、ブレーキの異常時において摩擦制動力に加えて新たな制動力を生成して、十分な制動力を確保する、車両の動力伝達制御装置を開示している。
上述した特許文献1および特許文献2に開示されるようなメカブレーキの異常検出方法は、メカブレーキの点検プログラムを別途に実行して、メカブレーキに異常が有るか無いかを診断する方法である。そのため、特許文献1および特許文献2に開示されるメカブレーキの異常検出方法においては、メカブレーキの点検が実施される前にメカブレーキに既に異常が発生している場合があるという問題がある。したがって、メカブレーキの点検を実施しないときであっても、メカブレーキの異常またはその予兆を検出できる方法が望まれている。
また、特許文献3に開示される車両の動力伝達制御装置については、摩擦制動力の不足を補う機構に複数のクラッチを使用するため、サーボモータの出力軸に適用するには構造が複雑すぎるという問題がある。
そこで本発明は、上述した従来技術の課題に鑑み、サーボモータに備わるメカブレーキの異常を早期に検出し、なおかつ、異常の検出後に直ちに制動力の不足を補えるモータ制御システムを提供することを目的とする。
本発明の第一態様によれば、サーボモータと、サーボモータあるいはサーボモータにより駆動される軸に作用する機械式ブレーキと、サーボモータに電力を供給するサーボ給電部と、サーボモータ、機械式ブレーキおよびサーボ給電部を制御する制御装置と、サーボモータの回転位置または軸の位置を検出する位置検出器と、を備え、
制御装置は、
機械式ブレーキを作動させる信号を受信する信号受信部と、
位置検出器によってサーボモータの回転位置を監視し、信号受信部が信号を受信してからサーボモータの回転が止まるまでのサーボモータの回転位置の履歴を取得する位置監視部と、
信号受信部が信号を受信してからサーボモータの回転が止まるまでのサーボモータの回転変位量を履歴から算出する変位量算出部と、
算出された回転変位量が所定の第一閾値を超えている場合に機械式ブレーキに異常が在ると判断する異常判断部と、を備え、
信号受信部が信号を受信すると、制御装置はサーボ給電部を制御してサーボモータへの給電を停止させ、
さらに異常判断部が機械式ブレーキに異常が在ると判断すると、制御装置はサーボ給電部を制御してサーボモータへの給電を再開させるようになされている、モータ制御システムが提供される。
この第一態様により上述の課題が解決される。しかし、本発明は、第一態様に限られず、以下の第二態様ないし第四態様のいずれかを提供することもできる。
制御装置は、
機械式ブレーキを作動させる信号を受信する信号受信部と、
位置検出器によってサーボモータの回転位置を監視し、信号受信部が信号を受信してからサーボモータの回転が止まるまでのサーボモータの回転位置の履歴を取得する位置監視部と、
信号受信部が信号を受信してからサーボモータの回転が止まるまでのサーボモータの回転変位量を履歴から算出する変位量算出部と、
算出された回転変位量が所定の第一閾値を超えている場合に機械式ブレーキに異常が在ると判断する異常判断部と、を備え、
信号受信部が信号を受信すると、制御装置はサーボ給電部を制御してサーボモータへの給電を停止させ、
さらに異常判断部が機械式ブレーキに異常が在ると判断すると、制御装置はサーボ給電部を制御してサーボモータへの給電を再開させるようになされている、モータ制御システムが提供される。
この第一態様により上述の課題が解決される。しかし、本発明は、第一態様に限られず、以下の第二態様ないし第四態様のいずれかを提供することもできる。
本発明の第二態様によれば、第一態様のモータ制御システムであって、
制御装置は、信号受信部が信号を受信したとき、当該信号を受信した時のサーボモータの回転位置を記憶保持する記憶部をさらに備えており、
信号受信部が信号を受信した後に異常判断部が機械式ブレーキに異常が在ると判断すると、制御装置は、サーボ給電部を制御してサーボモータへの給電を再開させるとともに、サーボモータの回転位置を、記憶部に記憶保持されたサーボモータの回転位置に移動させるようになされている、モータ制御システムが提供される。
制御装置は、信号受信部が信号を受信したとき、当該信号を受信した時のサーボモータの回転位置を記憶保持する記憶部をさらに備えており、
信号受信部が信号を受信した後に異常判断部が機械式ブレーキに異常が在ると判断すると、制御装置は、サーボ給電部を制御してサーボモータへの給電を再開させるとともに、サーボモータの回転位置を、記憶部に記憶保持されたサーボモータの回転位置に移動させるようになされている、モータ制御システムが提供される。
本発明の第三態様によれば、第一態様のモータ制御システムであって、
制御装置は、サーボモータの回転位置に関して所定の位置が予め記憶されている記憶部をさらに備えており、
信号受信部が信号を受信した後に異常判断部が機械式ブレーキに異常が在ると判断すると、制御装置は、サーボ給電部を制御してサーボモータへの給電を再開させるとともに、サーボモータの回転位置を、記憶部に予め記憶されている所定の位置に移動させるようになされた、モータ制御システムが提供される。
制御装置は、サーボモータの回転位置に関して所定の位置が予め記憶されている記憶部をさらに備えており、
信号受信部が信号を受信した後に異常判断部が機械式ブレーキに異常が在ると判断すると、制御装置は、サーボ給電部を制御してサーボモータへの給電を再開させるとともに、サーボモータの回転位置を、記憶部に予め記憶されている所定の位置に移動させるようになされた、モータ制御システムが提供される。
本発明の第四態様によれば、第三態様のモータ制御システムであって、
制御装置は、サーボモータの回転位置を、記憶部に予め記憶されている所定の位置に移動させた後、サーボ給電部を制御してサーボモータへの給電を停止させるようになされた、モータ制御システムが提供される。
制御装置は、サーボモータの回転位置を、記憶部に予め記憶されている所定の位置に移動させた後、サーボ給電部を制御してサーボモータへの給電を停止させるようになされた、モータ制御システムが提供される。
本発明の第一態様によれば、機械式ブレーキを作動させる信号が受信されてからサーボモータの回転が止まるまでのサーボモータの回転位置の変位量を算出している。そして、算出された回転変位量が所定の第一閾値を超えているかどうかを判断することにより、機械式ブレーキの異常またはその予兆を検出することができる。つまり、本願発明によれば、例えば工作機械またはロボットなどによる作業を終了する時や、作業を非常停止させた時に機械式ブレーキの効力低下の程度が分かるようになる。よって、機械式ブレーキの点検を別途に実行することなく、機械式ブレーキの異常およびその予兆を検出することができる。言い換えれば、工作機械やロボットなどの故障につながる機械式ブレーキの異常またはその予兆を早期に検出して高度な予防保守を実現するモータ制御システムを提供できる。
さらに、本発明の第一態様によれば、メカブレーキの異常を検出した後に、サーボモータへの給電を再開させることにより、サーボモータの励磁によってサーボモータの回転子および回転軸部を固定することができる。つまり、メカブレーキの異常を検出した後、直ちに、サーボモータの出力軸に対する制動力の不足をサーボモータの励磁によって補うことができる。さらに、メカブレーキの異常を検出した後、主軸ヘッドの落下の危険性も迅速に取除かれることとなる。
また、本発明の第二態様によれば、メカブレーキの異常を検出した後に、サーボモータの回転位置を、ブレーキ信号を受信した時の位置に移動させることができる。それにより、メカブレーキの異常を検出したとき、主軸ヘッドに取付けられた工具とワークとが互いに干渉する状態であっても、その状態を迅速に取除くことができる。
本発明の第三態様によれば、メカブレーキに異常が在ったとしてもサーボモータおよび、それにより駆動される軸に対して過大な負荷が掛からないような安全な位置を記憶部に予め記憶しておくことができる。そのため、メカブレーキの異常を検出した後に、サーボモータの回転位置を、記憶部に予め記憶されている安全な位置に移動させることができる。
本発明の第四態様によれば、サーボモータの回転位置を、記憶部に予め記憶されている安全な位置に移動させた後、サーボモータの励磁は解除されることとなる。このため、メカブレーキの点検や修理が容易となる。
添付図面に示される本発明の典型的な実施形態の詳細な説明から、本発明のこれらの目的、特徴および利点ならびに他の目的、特徴および利点がさらに明確になるであろう。
次に、本発明の実施形態について図面を参照して説明する。以下の図面において、同様の部材には同様の参照符号が付けられている。理解を容易にするために、これらの図面は縮尺を適宜変更している。また、以下では、工作機械に適用されたモータ制御システムを例にして説明するが、本発明はこれに限られない。
(第一実施形態)
図1は第一実施形態のモータ制御システムの構成を示すブロック図である。
第一実施形態のモータ制御システムは、図1に示されるように、工作機械11に内蔵されたサーボモータ12と、サーボモータ12あるいはサーボモータ12により駆動される軸に作用するメカブレーキ13と、サーボモータ12およびメカブレーキ13を制御する制御装置14と、を備えている。
図1は第一実施形態のモータ制御システムの構成を示すブロック図である。
第一実施形態のモータ制御システムは、図1に示されるように、工作機械11に内蔵されたサーボモータ12と、サーボモータ12あるいはサーボモータ12により駆動される軸に作用するメカブレーキ13と、サーボモータ12およびメカブレーキ13を制御する制御装置14と、を備えている。
工作機械11は、例えば、立形マシニングセンタまたは立形フライス盤などである。工作機械11は、加工対象のワークWが載置される作業テーブル15と、作業テーブル15の上方に設けられ、作業テーブル15に載置されたワークWを加工する工具16が取付けられた主軸ヘッド17と、を備える。主軸ヘッド17は、重力方向に延びるボールねじ18に沿って移動可能である。そして、ボールねじ18はサーボモータ12の出力軸に連結されている。
工作機械11は、サーボモータ12の出力軸の位置(回転位置)を検出する位置検出器19、例えばエンコーダを備える。さらに、制御装置14は、工作機械11のサーボモータ12に接続されていてサーボモータ12を制御するサーボアンプ20と、メカブレーキ13に接続されていてメカブレーキ13を制御するブレーキ制御部21と、を備える。
サーボアンプ20およびブレーキ制御部21には指令部22が接続されている。指令部22は、サーボモータ12の回転速度、回転位置などの指令値をサーボアンプ20に与える。そして、サーボアンプ20は、指令部22の指令値と位置検出器19の出力値とに基づき、サーボモータ12をフィードバック制御する。
また、制御装置14は、指令部22からの指令に応じて、共通電源36の電力をサーボモータ12に供給したり遮断したりするサーボ給電部35を備えている。厳密に言えば、本実施形態においては、図1に示されるようにサーボ給電部35によって共通電源36の電力をサーボアンプ20に供給または停止することにより、サーボモータ12に対して電力が供給または停止される。また、共通電源36は、制御装置14の各構成部の動作に必要な電力を供給する電源であり、共通電源36には例えば無停電電源装置が使用される。なお、図1においては、図面の理解を容易にするため、サーボ給電部35以外の構成部と共通電源36との間の電気接続線は省略されている。
さらに、サーボ給電部35は、共通電源36の電力をサーボモータ12に供給する電源線上に設けられた電磁接触器(図示せず)を有するとよい。そして、指令部22からの信号に応じて電磁接触器の接点の開閉を切替えることにより、サーボモータ12への給電をオンまたはオフにすることが好ましい。なお、サーボアンプ20からサーボモータ12に電力を供給するとき、サーボ給電部35からの直流電圧、例えばバス電圧を、サーボアンプ20内のインバータ回路(不図示)によって所定の周波数の交流電圧に変換してサーボモータ12に供給している。
さらに、指令部22は、後述の電源オフ信号を受信すると、サーボ給電部35に電力遮断信号を出力するとともに、ブレーキ制御部21にブレーキ信号を出力する。そして、サーボ給電部35は、指令部22から電力遮断信号を受信すると、電磁接触器(図示せず)の接点を開いてサーボモータ12への給電を停止する。一方、ブレーキ制御部21は、ブレーキ信号によりメカブレーキ13を作動させる。また、サーボ給電部35は、後述する指令部22から給電再開信号を受信すると、電磁接触器(図示せず)の接点を閉じてサーボモータ12への給電を再開させる。
なお、本実施形態の工作機械11の主軸ヘッド17はボールねじ18に沿って重力方向に上下動するものである。そのため、ボールねじ18を回転駆動するサーボモータ12への給電が停止した時にメカブレーキ13を作動させることにより、主軸ヘッド17が重力の影響によって落下するのを防いでいる。
ここで、メカブレーキ13の一例を述べる。メカブレーキ13は、例えば、ソレノイド(図示せず)により駆動される摩擦制動部材(図示せず)と、摩擦制動部材をサーボモータ12の出力軸またはこれに結合された部材に付勢する弾性体(図示せず)と、を備える。そして、ソレノイドに給電することにより、摩擦制動部材が弾性体の付勢力に抗してサーボモータ12の出力軸から離れる。すなわち、メカブレーキ13が解除される。一方、上述したブレーキ信号に応じてソレノイドへの給電を停止することにより、摩擦制動部材が弾性体によってサーボモータ12の出力軸に押付けられる。すなわち、摩擦制動部材によってサーボモータ12の出力軸が固定される。なお、メカブレーキ13の一例として、サーボモータ12の出力軸に作用するものを示したが、本発明はこれに限定されない。つまり、メカブレーキ13は、サーボモータ12により駆動される軸、すなわちモータの出力軸の回転に従動して駆動される軸に作用するものであってもよい。
また、図1に示されるように、制御装置14は制御電源23をさらに備えている。この制御電源23は指令部22に接続されている。制御電源23は、停電発生時に電源オフ信号が入力される停電検出回路24と、制御装置14の外部に設けられた電源スイッチ25がオンからオフに切り換えられた時に電源オフ信号が入力される電源オフ検出回路26と、を備える。なお、電源スイッチ25は、工作機械11の運転中はオンの状態にされており、工作機械11による作業を終了する時や、工作機械11を非常停止する時にオフの状態にされる。また、電源スイッチ25の他に、例えば工作機械11内への人間の侵入を検知できるエリアセンサを設け、そのエリアセンサの検知信号を電源オフ信号として電源オフ検出回路26に入力してもよい。また、工作機械の不具合の発生を外部に報知させるときに音や光などを発生させる信号、すなわちアラーム信号を電源オフ信号として電源オフ検出回路26に入力してもよい。
電源スイッチ25がオフの状態にされた時、すなわち電源オフ時には、電源オフ検出回路26が電源オフ信号を検出して指令部22に出力する。また、停電時には、停電検出回路24が電源オフ信号を検出して指令部22に出力する。
指令部22は、制御電源23の停電検出回路24あるいは電源オフ検出回路26からの電源オフ信号に応じて、電力遮断信号をサーボ給電部35へ出力するとともにブレーキ信号をブレーキ制御部21へ出力するようになっている。また、指令部22がブレーキ信号を出力した後に、後述するように出力部32から異常検出信号を受信したとき、指令部22は、上述した給電再開信号をサーボ給電部35に出力するようになっている。言い換えれば、指令部22は、異常判断部30がメカブレーキ13に異常が在ると判断したとき、サーボモータ12への給電を再開させる指令をサーボ給電部35に与える。なお、指令部22は工作機械11の運転プログラムの異常を検知する信号を上記のブレーキ信号としてブレーキ制御部21へ出力してもよい。
サーボ給電部35は、指令部22から電力遮断信号を受信すると、工作機械11のサーボモータ12への給電を止める。この結果、サーボモータ12は無励磁の状態となる。その一方で、ブレーキ制御部21は、指令部22からブレーキ信号を受取ると、工作機械11のメカブレーキ13を作動させる。それにより、主軸ヘッド17は制動させられる。特に、主軸ヘッド17を上下動させる工作機械11においては、電源オフ時または停電時に主軸ヘッド17の位置がメカブレーキ13によって保持される。
さらに、本願において、ブレーキ制御部21は、メカブレーキ13に異常が在るかどうかを判断している。
ここで、「メカブレーキの異常」とは、メカブレーキ13の摩擦制動部材の表面に油が付着した、あるいは、摩擦制動部材の表面が変化し摩擦力が低下した、あるいは、摩擦制動部材を付勢する弾性部材が破損した、あるいは、摩擦制動部材が著しく摩耗した、などの要因により、意図した制動力が得られない状態をいう。
ここで、「メカブレーキの異常」とは、メカブレーキ13の摩擦制動部材の表面に油が付着した、あるいは、摩擦制動部材の表面が変化し摩擦力が低下した、あるいは、摩擦制動部材を付勢する弾性部材が破損した、あるいは、摩擦制動部材が著しく摩耗した、などの要因により、意図した制動力が得られない状態をいう。
より具体的には、ブレーキ制御部21は、図1に示されるように、ブレーキ信号受信部27、位置監視部28、変位量算出部29、異常判断部30、出力部32、第一記憶部31、および第二記憶部33を有する。以下に、これらを使用してメカブレーキ13の異常を検出する時の第一実施形態のモータ制御システムの動作を説明する。
図2は、メカブレーキ13の異常を検出する時の第一実施形態のモータ制御システムの動作を示すフローチャートである。
図1とともに図2を参照すると、まず、ブレーキ制御部21のブレーキ信号受信部27は、指令部22からブレーキ信号を受信する(図2のステップS11)。それに伴い、ブレーキ信号受信部27はメカブレーキ13を作動させ、サーボ給電部35はサーボモータ12への給電を停止する(図2のステップS12)。例えば、ブレーキ信号受信部27はブレーキ信号をメカブレーキ13のブレーキ回路(図示せず)に出力する。ブレーキ回路はブレーキ信号の入力によりメカブレーキ13のソレノイドへの給電を停止する。それにより、メカブレーキ13の摩擦制動部材が弾性体によってサーボモータ12の出力軸に押付けられる。つまり、メカブレーキ13が作動する。このとき、指令部22からサーボ給電部35に電力遮断信号が送られているため、サーボ給電部35はサーボモータ12への給電を停止している。言い換えれば、サーボモータ12の励磁が解除されている。
図1とともに図2を参照すると、まず、ブレーキ制御部21のブレーキ信号受信部27は、指令部22からブレーキ信号を受信する(図2のステップS11)。それに伴い、ブレーキ信号受信部27はメカブレーキ13を作動させ、サーボ給電部35はサーボモータ12への給電を停止する(図2のステップS12)。例えば、ブレーキ信号受信部27はブレーキ信号をメカブレーキ13のブレーキ回路(図示せず)に出力する。ブレーキ回路はブレーキ信号の入力によりメカブレーキ13のソレノイドへの給電を停止する。それにより、メカブレーキ13の摩擦制動部材が弾性体によってサーボモータ12の出力軸に押付けられる。つまり、メカブレーキ13が作動する。このとき、指令部22からサーボ給電部35に電力遮断信号が送られているため、サーボ給電部35はサーボモータ12への給電を停止している。言い換えれば、サーボモータ12の励磁が解除されている。
さらに、ブレーキ信号受信部27は、メカブレーキ13の作動と同時に、指令部22からのブレーキ信号を位置監視部28に出力する。
続いて、ブレーキ制御部21の位置監視部28は、位置検出器19、例えばエンコーダによって、サーボモータ12の出力軸の位置(回転位置)を監視する。特に、位置監視部28は、上述のブレーキ信号をトリガ信号としてサーボモータ12の回転位置の検出を開始し、その検出開始からサーボモータ12の回転が止まるまでの、サーボモータ12の回転位置の履歴を取得する(図2のステップS13)。
その後、ブレーキ制御部21の変位量算出部29は、位置監視部28により取得されたサーボモータ12の回転位置の履歴から、サーボモータ12の回転変位量を算出する(図2のステップS14)。このステップS14において算出される回転変位量は、サーボモータ12の出力軸の制動を開始してからサーボモータ12の回転が止まるまでの間にサーボモータ12の出力軸の位置が回転方向に変化した量である。このように算出された回転変位量は、メカブレーキ13の作動後の主軸ヘッド17の落下量に相当している。そのため、変位量算出部29により算出された回転変位量が大きいほど、メカブレーキ13の制動力の低下が大きいと推定できる。これにより、ブレーキ制御部21の異常判断部30は、変位量算出部29により算出された回転変位量が所定の第一閾値を超えている場合にメカブレーキ13に異常が在ると判断するようになっている(図2のステップS15)。所定の第一閾値は設定変更可能な値であって、第一記憶部31に予め記憶されている。
そして、ブレーキ制御部21の出力部32は、メカブレーキ13に異常が在ることを示す異常検出信号を指令部22に送信する(図2のステップS16)。なお、図1に示される構成においては、異常検出信号は、出力部32から第二記憶部33を通って指令部22に送信されるようになっているが、本実施形態はこの構成に限定されない。つまり、異常検出信号は、出力部32から指令部22に直接的に送信されてもよい。さらに、出力部32は、メカブレーキ13に異常が在ることを制御装置14の外部に出力することが好ましい。この出力方法としては、ディスプレイ表示、印刷表示、光や音でのアラームなどが考えられる。
続いて、指令部22が出力部32から異常検出信号を受信すると、指令部22は、給電再開信号をサーボ給電部35に出力する。それにより、サーボ給電部35は、電磁接触器(図示せず)の接点を閉じてサーボモータ12への給電を再開させる(図2のステップS17)。
つまり、メカブレーキ13の異常が検出された場合は、サーボモータ12の出力軸を制動する力は大きく低下していると考えられる。したがって、本願においては、メカブレーキ13の異常を検出した後に、サーボモータ12への給電を再開させてサーボモータ12の励磁を再び発生させることにより、サーボモータ12のロータおよびその回転軸部を固定することができる。つまり、メカブレーキ12の異常を検出した後、直ちに、サーボモータ12の出力軸に対する制動力の不足をサーボモータ12の励磁によって補うことができる。さらに、メカブレーキ12の異常検出後、主軸ヘッド17の落下の危険性も迅速に取除かれることとなる。
ここで、上述したメカブレーキ13の異常を検出する原理を説明する。
図3は、メカブレーキ13の作動後(例えば非常停止信号の入力後)の主軸ヘッド17の落下量を表したグラフである。このグラフにおいて、横軸は時間を、縦軸は主軸ヘッド17の位置を表している。また、グラフ内の実線は、メカブレーキ13が正常であるときの主軸ヘッド17の位置の変化を表している。さらに、グラフ内の一点鎖線は、メカブレーキ13に異常が在るときの主軸ヘッド17の位置の変化を表している。
図3は、メカブレーキ13の作動後(例えば非常停止信号の入力後)の主軸ヘッド17の落下量を表したグラフである。このグラフにおいて、横軸は時間を、縦軸は主軸ヘッド17の位置を表している。また、グラフ内の実線は、メカブレーキ13が正常であるときの主軸ヘッド17の位置の変化を表している。さらに、グラフ内の一点鎖線は、メカブレーキ13に異常が在るときの主軸ヘッド17の位置の変化を表している。
例えば、工作機械11の制御装置14に非常停止信号が入力されると、サーボモータ12への給電が停止するとともにメカブレーキ13が作動して、主軸ヘッド17は制動させられる。作動したメカブレーキ13が正常である場合は、図3に実線で示されるように、非常停止信号が入力されてからサーボモータ12の回転が止まったときの主軸ヘッド17の位置Xbは、非常停止信号入力時の主軸ヘッド17の位置Xaから僅かに落下した位置となる。メカブレーキ13が正常であっても微少な落下量が在るのは、摩擦制動方式のメカブレーキ13においては組立精度やギヤのバックラッシなどに起因した制動がかからない時間があるからである。
しかし、メカブレーキ13に異常が生じていると、メカブレーキ13の制動開始からサーボモータ12の回転が止まるまでの時間が上述の時間よりも長くなる。したがって、メカブレーキ13に異常が在る場合は、図3に一点鎖線で示されるように、非常停止信号が入力されてからサーボモータ12の回転が止まったときの主軸ヘッド17の位置Xcは、非常停止信号入力時の主軸ヘッド17の位置Xaから、ブレーキ正常時の位置Xbよりも大きく落下した位置となる。
以上の事から、本願発明による制御装置14は、図1に示される位置監視部28によって、図3に示されるような非常停止信号が入力されてからサーボモータ12の回転が止まるまでの主軸ヘッド17の位置の変化を取得する。そして、図1に示される変位量算出部29および異常判断部30によって、非常停止信号が入力されてからの主軸ヘッド17の落下量(変位量)を算出し、その算出された変位量から、メカブレーキ13に異常が在るかどうかを判断している。つまり、本願発明によれば、工作機械11による作業を終了する時や、工作機械11を非常停止する時にメカブレーキ13の効力低下の程度が分かる。よって、メカブレーキ13の点検を別途に実行することなく、メカブレーキ13の異常およびその予兆を検出することができる。
なお、上述した第一実施形態において、図1に示される第一記憶部31は、ブレーキ信号の受信の度に、すなわちメカブレーキ13の作動毎に、変位量算出部29により算出された回転変位量を逐次記憶していく機能を備えていてもよい。このような機能を備えた場合、異常判断部30は、ブレーキ信号の受信の度に、変位量算出部29により算出された回転変位量と、以前に第一記憶部31内に記憶した回転変位量とを比較することができる。そして、ブレーキ信号の受信の度に、変位量算出部29により算出された回転変位量が増加している場合には、異常判断部30は、メカブレーキ13の効力低下の兆しが在ると判断することが好ましい。
(第二実施形態)
次に第二実施形態について説明する。但し、ここでは、第一実施形態と同じ構成要素については同一の符号を使用して説明を割愛する。よって、第一実施形態の構成要素に対して異なる点のみを以下に述べる。
次に第二実施形態について説明する。但し、ここでは、第一実施形態と同じ構成要素については同一の符号を使用して説明を割愛する。よって、第一実施形態の構成要素に対して異なる点のみを以下に述べる。
上述した第一実施形態においては、異常判断部30がメカブレーキ13に異常が在ると判断すると、サーボモータ12への給電を再開させてサーボモータ12の回転軸部を動かないようにしている。そのため、メカブレーキ13の異常を検出してサーボモータ12の回転軸部を動かないようにしたときの主軸ヘッド17の位置は、ブレーキ正常時の位置よりも大きく落下した位置である。つまり、図3を使って説明すると、非常停止信号入力時の主軸ヘッド17の位置Xaからブレーキ正常時の位置Xbよりも大きく落下した位置Xcに、主軸ヘッド17が静止していることになる。このとき、主軸ヘッド17に取付けられている工具16がワークWに干渉していると、大きな負荷が工具16やワークWだけでなく、ボールねじ18、サーボモータ12などの回転機構部にも作用する。そして、工具16をワークWから隔離しない限り、その負荷は継続する。さらに、負荷の時間が長いほど、工作機械11の損害が大きくなると予想される。よって、そのような負荷は迅速に取除かれることが望ましい。
そのため、第二実施形態においては、メカブレーキ13の異常を検出したら、サーボモータ12の回転位置を、ブレーキ信号を受信した時のサーボモータ12の回転位置に移動させることにする。何故なら、ブレーキ信号は、工作機械11による作業を終了する時や、工作機械11を非常停止する時などにおいて出力されるからである。つまり、そのようなブレーキ信号を受信した時のサーボモータ12の回転位置は、大抵、工具16がワークWに干渉する前の位置にあるからである。
そこで、第二実施形態のモータ制御システムは、上述した第一実施形態のモータ制御システムにおいて、図1に示されるように第二記憶部33をさらに備えている。そして、第二記憶部33は、上述したようなブレーキ信号をブレーキ信号受信部27が受信した時の、サーボモータ12の回転位置を記憶保持するようになっている。さらに、指令部22が、ブレーキ信号を受信した時のサーボモータ12の回転位置に対応する位置指令値をサーボアンプ20に与えるようになっている。
以下に、メカブレーキ13の異常を検出する時の第二実施形態のモータ制御システムの動作を詳述することとする。
図4は、メカブレーキ13の異常を検出する時の第二実施形態のモータ制御システムの動作を示すフローチャートである。
図4は、メカブレーキ13の異常を検出する時の第二実施形態のモータ制御システムの動作を示すフローチャートである。
図1とともに図4を参照すると、まず、ブレーキ制御部21のブレーキ信号受信部27は、指令部22からブレーキ信号を受信する(図4のステップS21)。このとき、指令部22からサーボ給電部35に電力遮断信号が送られる。以上のことにより、ブレーキ信号受信部27はメカブレーキ13を作動させ、サーボ給電部35はサーボモータ12への給電を停止する(図4のステップS22)。なお、ステップS21、S22はそれぞれ、図2を参照して上述したステップS11、S12に相当する。
さらに、ブレーキ信号受信部27は、メカブレーキ13の作動と同時に、指令部22からのブレーキ信号を位置監視部28に出力する。
続いて、ブレーキ制御部21の位置監視部28は、位置検出器19、例えばエンコーダによって、サーボモータ12の出力軸の位置(回転位置)を監視する。特に、位置監視部28は、上述のブレーキ信号をトリガ信号としてサーボモータ12の回転位置の検出を開始し、その検出開始からサーボモータ12の回転が止まるまでの、サーボモータ12の回転位置の履歴を取得する(図4のステップS23)。このステップS23は、図2を参照して上述したステップS13に相当する。
また、ブレーキ信号受信部27がブレーキ信号を受信した時に、位置監視部28は、位置検出器19を用いてサーボモータ12の回転位置を取得し、当該回転位置のデータを第二記憶部33に出力する。それにより、第二記憶部33は、ブレーキ信号受信部22がブレーキ信号を受信した時の、サーボモータ12の回転位置を記憶保持する(図4のステップS24)。
その後、ブレーキ制御部21の変位量算出部29は、位置監視部28により取得されたサーボモータ12の回転位置の履歴から、サーボモータ12の回転変位量を算出する(図4のステップS25)。このステップS25は、図2を参照して上述したステップS14に相当する。
続いて、ブレーキ制御部21の異常判断部30は、変位量算出部29により算出された回転変位量が所定の第一閾値を超えている場合にメカブレーキ13に異常が在ると判断するようになっている(図4のステップS26)。このステップS26は、図2を参照して上述したステップS15に相当する。なお、所定の第一閾値は設定変更可能な値であって、第一記憶部31に予め記憶されている。
そして、ブレーキ制御部21の出力部32は、メカブレーキ13に異常が在ることを示す異常検出信号を第二記憶部33に送信する(図4のステップS27)。
第二記憶部33は、異常検出信号を受信すると、その異常検出信号と、ブレーキ信号を受信した時のサーボモータ12の回転位置とを指令部22に送信する(図4のステップS28)。
続いて、指令部22は、第二記憶部33から異常検出信号を受信すると、給電再開信号をサーボ給電部35に出力する。それにより、サーボ給電部35は、電磁接触器(図示せず)の接点を閉じてサーボモータ12への給電を再開させる(図4のステップS29)。このステップS26は、図2を参照して上述したステップS17に相当する。
さらに、指令部22は、ブレーキ信号を受信した時のサーボモータ12の回転位置を位置指令値としてサーボアンプ20に与える。それにより、サーボアンプ20は、サーボモータ12の回転位置を、ブレーキ信号を受信した時のサーボモータ12の回転位置に移動させる(図4のステップS30)。なお、この移動後もサーボモータ12の励磁を解除しないこととしている。
以上に説明した第二実施形態によれば、ブレーキ信号を受信してメカブレーキ13の異常を検出したら、サーボモータ12の回転位置を、ブレーキ信号を受信した時のサーボモータ12の回転位置に移動させている。それにより、メカブレーキ13の異常を検出したとき、主軸ヘッド17に取付けられた工具16とワークWとが互いに干渉する状態であっても、その状態を迅速に取除くことができる。
(第三実施形態)
次に第三実施形態について説明する。但し、ここでは、第一実施形態および第二実施形態と同じ構成要素については同一の符号を使用して説明を割愛する。よって、第一実施形態および第二実施形態の構成要素に対して異なる点のみを以下に述べる。
次に第三実施形態について説明する。但し、ここでは、第一実施形態および第二実施形態と同じ構成要素については同一の符号を使用して説明を割愛する。よって、第一実施形態および第二実施形態の構成要素に対して異なる点のみを以下に述べる。
上述した第二実施形態においては、ブレーキ信号を受信してメカブレーキ13の異常を検出すると、サーボモータ12への給電を再開し、サーボモータ12の回転位置を、ブレーキ信号を受信した時のサーボモータ12の回転位置に移動させている。しかし、本発明においては、メカブレーキ13の異常を検出した後にサーボモータ12の回転位置を移動させる位置は、ブレーキ信号を受信した時のサーボモータ12の回転位置に限定されない。つまり、本発明においては、主軸ヘッド17の落下による危険性がより低くなれば、メカブレーキ13の異常を検出した後に移動させるサーボモータ12の回転位置は、どこでも構わない。この点を考慮に入れた例が第三実施形態である。
以下に、メカブレーキ13の異常を検出する時の第三実施形態のモータ制御システムの動作を詳述する。
図5は、メカブレーキ13の異常を検出する時の第三実施形態のモータ制御システムの動作を示すフローチャートである。
図5は、メカブレーキ13の異常を検出する時の第三実施形態のモータ制御システムの動作を示すフローチャートである。
図1とともに図5を参照すると、まず、ブレーキ制御部21のブレーキ信号受信部27は、指令部22からブレーキ信号を受信する(図5のステップS31)。このとき、指令部22からサーボ給電部35に電力遮断信号が送られている。以上のことにより、ブレーキ信号受信部27はメカブレーキ13を作動させ、サーボ給電部35はサーボモータ12への給電を停止する(図5のステップS32)。なお、ステップS31、S32はそれぞれ、図2を参照して上述したステップS11、S12に相当する。
さらに、ブレーキ信号受信部27は、メカブレーキ13の作動と同時に、指令部22からのブレーキ信号を位置監視部28に出力する。
続いて、ブレーキ制御部21の位置監視部28は、位置検出器19、例えばエンコーダによって、サーボモータ12の出力軸の位置(回転位置)を監視する。特に、位置監視部28は、上述のブレーキ信号をトリガ信号としてサーボモータ12の回転位置の検出を開始し、その検出開始からサーボモータ12の回転が止まるまでの、サーボモータ12の回転位置の履歴を取得する(図5のステップS33)。このステップS33は、図2を参照して上述したステップS13に相当する。
その後、ブレーキ制御部21の変位量算出部29は、位置監視部28により取得されたサーボモータ12の回転位置の履歴から、サーボモータ12の回転変位量を算出する(図5のステップS34)。このステップS34は、図2を参照して上述したステップS14に相当する。
続いて、ブレーキ制御部21の異常判断部30は、変位量算出部29により算出された回転変位量が所定の第一閾値を超えている場合にメカブレーキ13に異常が在ると判断するようになっている(図5のステップS35)。このステップS35は、図2を参照して上述したステップS15に相当する。なお、所定の第一閾値は設定変更可能な値であって、第一記憶部31に予め記憶されている。
そして、ブレーキ制御部21の出力部32は、メカブレーキ13に異常が在ることを示す異常検出信号を第二記憶部33に送信する(図5のステップS36)。
第二記憶部33は、異常検出信号を受信すると、その異常検出信号と、第二記憶部33に予め記憶されているサーボモータ12の回転位置とを指令部22に送信する(図5のステップS37)。ここで、第二記憶部33に予め記憶されているサーボモータ12の回転位置は、主軸ヘッド17に取付けられた工具16がワークWに干渉しない位置であるとよい。例えば、図1に示されるように作業テーブル15に固定されたワークWの上方の空間を除いた任意の位置が、第二記憶部33に予め記憶される。また、そのように第二記憶部33に記憶される位置としては、例えば、工作機械に設置された自動工具交換装置(図示せず)の工具交換位置が考えられる。
つまり、工作機械においては、主軸ヘッド17に取付可能な複数の工具16を収容するタレットやマガジンなどの工具収容部(図示せず)と、主軸ヘッド17に取付けられている工具16を工具収容部に収容された他の工具16と交換する自動工具交換装置(図示せず)とを備える形態がある。この形態の工作機械は、工具16どうしを交換するとき、主軸ヘッド17に取付けられた工具16を、自動工具交換装置に予め設定された工具交換位置に移動させている。勿論、主軸ヘッド17は重力方向の移動に限られず、水平方向にも移動する構成であってもよい。そして、そのような工具交換位置は、主軸ヘッド17に取付けられた工具16がワークWに干渉しない位置である。さらに、主軸ヘッド17に取付けられた工具16は自動工具交換装置によって取外されるため、主軸ヘッド17の落下による危険度はより低くなる。したがって、本実施形態においては、自動工具交換装置の工具交換位置を第二記憶部33に予め記憶させておき、メカブレーキ13の異常を検出したら、その工具交換位置を第二記憶部33から指令部22に送信することが好ましい。
上述したステップS37に続いて、指令部22は、第二記憶部33から異常検出信号を受信すると、給電再開信号をサーボ給電部35に出力する。それにより、サーボ給電部35は、電磁接触器(図示せず)の接点を閉じてサーボモータ12への給電を再開させる(図5のステップS38)。このステップS38は、図2を参照して上述したステップS17に相当する。
さらに、指令部22は、第二記憶部33に予め記憶されているサーボモータ12の回転位置をサーボアンプ20に指令する。それにより、サーボアンプ20は、サーボモータ12の回転位置を、指令部22により指令されたサーボモータ12の回転位置に移動させる(図5のステップS39)。このとき、例えば、工具16が取付けられている主軸ヘッド17を、上述したような工作機械の自動工具交換装置の工具交換位置に移動させる。
その後、位置検出器19により検出されるサーボモータ12の回転位置が、上記ステップS39において指令されたサーボモータ12の回転位置、例えば工具交換位置になったとき、指令部22は、サーボモータ12への給電を停止させる指令をサーボ給電部35に出力する。それにより、サーボアンプ20はサーボモータ12への給電を停止する(図5のステップS40)。また、このステップS40により、主軸ヘッド17を移動させるサーボモータ12の励磁は解除されることとなる。このため、メカブレーキ13の点検や修理が容易となる。
なお、上記ステップS40において、指令部22は、位置検出器19により検出されるサーボモータ12の回転位置を、ブレーキ制御部21の位置監視部28を介して取得することが好ましい。
以上に説明した第三実施形態によれば、メカブレーキ13に異常が在ったとしてもサーボモータ12および、それにより駆動される軸に対して過大な負荷が掛からないような安全な位置が、第二記憶部33に予め記憶されている。言い換えれば、メカブレーキ13の異常により主軸ヘッド17が落下しても、主軸ヘッド17に取付けられた工具16とワークWとが互いに干渉しない位置、例えば自動工具交換装置の工具交換位置が第二記憶部33に予め記憶されている。それにより、ブレーキ信号を受信してメカブレーキ13の異常を検出したら、主軸ヘッド17を自動工具交換装置の工具交換位置に移動させることができる。つまり、メカブレーキ13の異常を検出したとき、主軸ヘッド17の落下による危険度をより低くすることができる。
(その他の実施形態)
さらに、上述した各実施形態のモータ制御システムは、メカブレーキ13の作動後の主軸ヘッド17の落下量(変位量)を取得するために、エンコーダといったパルスコーダによりサーボモータ12の回転方向の位置を検出している。しかし、そのようなエンコーダの代わりにリニアスケールを用いて、メカブレーキ13の作動後の主軸ヘッド17の落下量(変位量)を直接的に取得してもよい。
さらに、上述した各実施形態のモータ制御システムは、メカブレーキ13の作動後の主軸ヘッド17の落下量(変位量)を取得するために、エンコーダといったパルスコーダによりサーボモータ12の回転方向の位置を検出している。しかし、そのようなエンコーダの代わりにリニアスケールを用いて、メカブレーキ13の作動後の主軸ヘッド17の落下量(変位量)を直接的に取得してもよい。
また、上述した各三実施形態のモータ制御システムは、図1に示されるような工作機械11ではなく、産業用ロボットや電動プレス機などに適用されていてもよい。例えば、産業用ロボットに適用する場合には、サーボモータ12はロボットの軸を駆動し、位置検出器19はロボットの軸の変位量を監視するのに使用される。
また、図1に示されるようにサーボモータ12の外部にメカブレーキ13が設置されているが、サーボモータ12にメカブレーキ13が内蔵されて両者が一体として設けられていてもよい。つまり、メカブレーキ13は、サーボモータ12の出力軸またはその出力軸に連結されたボールねじ18のような駆動軸を制動するようになされていればよい。
以上では典型的な実施形態を示したが、本発明は上述の実施形態に限定されず、本発明の思想を逸脱しない範囲で上述の実施形態を様々な形、構造や材料などに変更可能である。
10 モータ制御システム
11 工作機械
12 サーボモータ
13 メカブレーキ
14 制御装置
15 作業テーブル
16 工具
17 主軸ヘッド
18 ボールねじ
19 位置検出器
20 サーボアンプ
21 ブレーキ制御部
22 指令部
23 制御電源
24 停電検出回路
25 電源スイッチ
26 電源オフ検出回路
27 ブレーキ信号受信部
28 位置監視部
29 変位量算出部
30 異常判断部
31 第一記憶部
32 出力部
33 第二記憶部
35 サーボ給電部
36 共通電源
W ワーク
11 工作機械
12 サーボモータ
13 メカブレーキ
14 制御装置
15 作業テーブル
16 工具
17 主軸ヘッド
18 ボールねじ
19 位置検出器
20 サーボアンプ
21 ブレーキ制御部
22 指令部
23 制御電源
24 停電検出回路
25 電源スイッチ
26 電源オフ検出回路
27 ブレーキ信号受信部
28 位置監視部
29 変位量算出部
30 異常判断部
31 第一記憶部
32 出力部
33 第二記憶部
35 サーボ給電部
36 共通電源
W ワーク
Claims (4)
- サーボモータ(12)と、
前記サーボモータ(12)あるいは前記サーボモータ(12)により駆動される軸に作用する機械式ブレーキ(13)と、
前記サーボモータ(12)に電力を供給するサーボ給電部(35)と、
前記サーボモータ(12)、前記機械式ブレーキ(13)および前記サーボ給電部(35)を制御する制御装置(14)と、
前記サーボモータ(12)の回転位置または前記軸の位置を検出する位置検出器(19)と、を備え、
前記制御装置(14)は、
前記機械式ブレーキ(13)を作動させる信号を受信する信号受信部(27)と、
前記位置検出器(19)によって前記サーボモータ(12)の回転位置を監視し、前記信号受信部(27)が前記信号を受信してから前記サーボモータ(12)の回転が止まるまでの前記サーボモータ(12)の回転位置の履歴を取得する位置監視部(28)と、
前記信号受信部(27)が前記信号を受信してから前記サーボモータ(12)の回転が止まるまでの前記サーボモータ(12)の回転変位量を前記履歴から算出する変位量算出部(29)と、
算出された前記回転変位量が所定の第一閾値を超えている場合に前記機械式ブレーキ(13)に異常が在ると判断する異常判断部(30)と、を備え、
前記信号受信部(27)が前記信号を受信すると、前記制御装置(14)は前記サーボ給電部(35)を制御して前記サーボモータ(12)への給電を停止させ、
さらに前記異常判断部(30)が前記機械式ブレーキ(13)に異常が在ると判断すると、前記制御装置(14)は前記サーボ給電部(35)を制御して前記サーボモータ(12)への給電を再開させるようになされている、モータ制御システム。 - 前記制御装置(14)は、前記信号受信部(27)が前記信号を受信したとき、当該信号を受信した時の前記サーボモータ(12)の回転位置を記憶保持する記憶部(33)をさらに備えており、
前記信号受信部(27)が前記信号を受信した後に前記異常判断部(30)が前記機械式ブレーキ(13)に異常が在ると判断すると、前記制御装置(14)は、前記サーボ給電部(35)を制御して前記サーボモータ(12)への給電を再開させるとともに、前記サーボモータ(12)の回転位置を、前記記憶部(33)に記憶保持された前記サーボモータ(12)の回転位置に移動させるようになされている、請求項1に記載のモータ制御システム。 - 前記制御装置(14)は、前記サーボモータ(12)の回転位置に関して所定の位置が予め記憶されている記憶部(33)をさらに備えており、
前記信号受信部(27)が前記信号を受信した後に前記異常判断部(30)が前記機械式ブレーキ(13)に異常が在ると判断すると、前記制御装置(14)は、前記サーボ給電部(35)を制御して前記サーボモータ(12)への給電を再開させるとともに、前記サーボモータ(12)の回転位置を、前記記憶部(33)に予め記憶されている前記所定の位置に移動させるようになされた、請求項1に記載のモータ制御システム。 - 前記制御装置(14)は、前記サーボモータ(12)の回転位置を、前記記憶部(33)に予め記憶されている前記所定の位置に移動させた後、前記サーボ給電部(35)を制御して前記サーボモータ(12)への給電を停止させるようになされた、請求項3に記載のモータ制御システム。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015156885A JP6200467B2 (ja) | 2015-08-07 | 2015-08-07 | ブレーキの異常を検出する機能を備えたモータ制御システム |
DE102016114165.8A DE102016114165B4 (de) | 2015-08-07 | 2016-08-01 | Mit Funktion zum Detektieren eines anormalen Bremsen versehenes Motorsteuerungssystem |
US15/227,175 US9772622B2 (en) | 2015-08-07 | 2016-08-03 | Motor control system provided with function to detect abnormal braking |
CN201610641219.9A CN106452264B (zh) | 2015-08-07 | 2016-08-05 | 电动机控制*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015156885A JP6200467B2 (ja) | 2015-08-07 | 2015-08-07 | ブレーキの異常を検出する機能を備えたモータ制御システム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2017038438A JP2017038438A (ja) | 2017-02-16 |
JP6200467B2 true JP6200467B2 (ja) | 2017-09-20 |
Family
ID=57854019
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2015156885A Active JP6200467B2 (ja) | 2015-08-07 | 2015-08-07 | ブレーキの異常を検出する機能を備えたモータ制御システム |
Country Status (4)
Country | Link |
---|---|
US (1) | US9772622B2 (ja) |
JP (1) | JP6200467B2 (ja) |
CN (1) | CN106452264B (ja) |
DE (1) | DE102016114165B4 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102001539B1 (ko) * | 2018-02-27 | 2019-07-19 | 주식회사 로펨솔루션 | 휴대용 무여자 작동형 자기 디스크의 브레이크 해제 장치 |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2566497B (en) * | 2017-09-15 | 2020-07-29 | Illinois Tool Works | Braking system for electromagnetic motors |
JP6876194B2 (ja) * | 2018-02-21 | 2021-05-26 | 日立Astemo株式会社 | 電動ブレーキおよび制御装置 |
KR102539406B1 (ko) * | 2019-04-22 | 2023-06-01 | 히다치 아스테모 가부시키가이샤 | 제어 장치 |
CN113598748B (zh) * | 2021-08-27 | 2023-07-28 | 明峰医疗***股份有限公司 | 一种用于诊断床的缓停控制***及方法 |
CN114571275B (zh) * | 2022-03-24 | 2023-07-07 | 新代科技(苏州)有限公司 | 一种车床主轴自动松夹刹车的控制方法 |
WO2024084709A1 (ja) * | 2022-10-21 | 2024-04-25 | ファナック株式会社 | 工作機械 |
WO2024084710A1 (ja) * | 2022-10-21 | 2024-04-25 | ファナック株式会社 | 工作機械 |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01295793A (ja) * | 1988-05-24 | 1989-11-29 | Kobe Steel Ltd | ロボットの制動監視装置 |
JPH0610183B2 (ja) | 1989-08-23 | 1994-02-09 | 日立化成工業株式会社 | 新規なドーパ誘導体 |
JP2506214B2 (ja) * | 1990-01-17 | 1996-06-12 | オークマ株式会社 | 数値制御工作機械の衝突検出装置 |
JP3081258B2 (ja) | 1991-02-19 | 2000-08-28 | 帝人製機株式会社 | ブレーキの故障検出方法 |
JP3192817B2 (ja) | 1993-03-30 | 2001-07-30 | 株式会社東芝 | ブレーキ付モータ |
FI120828B (fi) * | 2007-02-21 | 2010-03-31 | Kone Corp | Elektroninen liikkeenrajoitin ja menetelmä elektronisen liikkeenrajoittimen ohjaamiseksi |
JP2008236828A (ja) * | 2007-03-16 | 2008-10-02 | Yaskawa Electric Corp | サーボアンプおよびその通電復帰方法 |
CN101143670A (zh) * | 2007-09-20 | 2008-03-19 | 上海三意楼宇实业有限公司 | 变频电梯机械制动器失效时的电气保护方法和装置 |
FI121882B (fi) * | 2009-11-02 | 2011-05-31 | Kone Corp | Jarrutuslaitteisto, sähkökäyttö sekä hissijärjestelmä |
JP5522109B2 (ja) * | 2011-04-01 | 2014-06-18 | 株式会社安川電機 | 自動機械の制御装置 |
JP2013032825A (ja) | 2011-08-03 | 2013-02-14 | Aisin Ai Co Ltd | 車両の動力伝達制御装置 |
CN103303321A (zh) * | 2012-03-12 | 2013-09-18 | 中国北车股份有限公司大连电力牵引研发中心 | 用于控制车辆溜车的方法及牵引变流器、轨道车 |
TWI529117B (zh) * | 2012-04-26 | 2016-04-11 | 鄭坤豐 | 電梯安全故障即時檢出系統及其方法 |
-
2015
- 2015-08-07 JP JP2015156885A patent/JP6200467B2/ja active Active
-
2016
- 2016-08-01 DE DE102016114165.8A patent/DE102016114165B4/de active Active
- 2016-08-03 US US15/227,175 patent/US9772622B2/en active Active
- 2016-08-05 CN CN201610641219.9A patent/CN106452264B/zh active Active
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102001539B1 (ko) * | 2018-02-27 | 2019-07-19 | 주식회사 로펨솔루션 | 휴대용 무여자 작동형 자기 디스크의 브레이크 해제 장치 |
Also Published As
Publication number | Publication date |
---|---|
CN106452264A (zh) | 2017-02-22 |
US20170038768A1 (en) | 2017-02-09 |
DE102016114165B4 (de) | 2021-09-02 |
DE102016114165A1 (de) | 2017-02-09 |
JP2017038438A (ja) | 2017-02-16 |
US9772622B2 (en) | 2017-09-26 |
CN106452264B (zh) | 2020-03-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6200467B2 (ja) | ブレーキの異常を検出する機能を備えたモータ制御システム | |
US9694456B2 (en) | Motor control system provided with function to detect abnormal braking and method of detecting abnormal braking | |
JP5444421B2 (ja) | ブレーキ異常診断方法およびブレーキ異常診断装置 | |
KR101547411B1 (ko) | 로봇의 브레이크를 검사하기 위한 방법 및 로봇의 브레이크를 검사하기 위한, 토크센서에 의해 검출된 토크의 사용 방법 | |
JP6898079B2 (ja) | 工作機械およびその制御方法 | |
JP4218054B1 (ja) | 工作機械の制御装置及び方法 | |
JP4897632B2 (ja) | 衝突検出機能を有する工作機械の制御装置 | |
JP2011209936A (ja) | 停電時制御装置 | |
EP1820602A2 (en) | Machine tool | |
JP2007203353A (ja) | サーボプレス | |
CN111817642A (zh) | 检查制动装置的制动检查装置以及数值控制装置 | |
JP7012972B2 (ja) | クレーン誤動作防止システム | |
CN106476009B (zh) | 机械 | |
JP2001047342A (ja) | 工作機械 | |
JP5926782B2 (ja) | 工作機械およびブレーキチェック方法 | |
JP6309935B2 (ja) | 電動機のブレーキ機構を点検するための装置、および点検方法 | |
JP2009125907A (ja) | 締付診断システム及び締付診断方法 | |
JP2018099748A (ja) | ブレーキ付きモータのブレーキ診断システム及び方法 | |
JP2004009168A (ja) | 制御装置および機械装置システム | |
JP4001376B2 (ja) | 押し付け停止型電動シリンダ | |
JP2009045711A (ja) | 主軸監視装置 | |
US10924039B2 (en) | Motor control device and control method for motor control device | |
KR100707373B1 (ko) | 공작기계의 축 낙하방지장치 및 방법 | |
US10481591B2 (en) | Numerical controller | |
KR20140088633A (ko) | 공작기계의 이송축 브레이크 제어방법 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20170721 |
|
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: 20170801 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20170825 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6200467 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |