[go: up one dir, main page]

TWI678065B - Motor control - Google Patents

Motor control Download PDF

Info

Publication number
TWI678065B
TWI678065B TW104114138A TW104114138A TWI678065B TW I678065 B TWI678065 B TW I678065B TW 104114138 A TW104114138 A TW 104114138A TW 104114138 A TW104114138 A TW 104114138A TW I678065 B TWI678065 B TW I678065B
Authority
TW
Taiwan
Prior art keywords
resonance frequency
frequency
mechanical abnormality
control device
motor control
Prior art date
Application number
TW104114138A
Other languages
Chinese (zh)
Other versions
TW201547178A (en
Inventor
井出勇治
Yuji Ide
北原通生
Michio Kitahara
山悟史
Satoshi Yamazaki
平出敏雄
Toshio Hiraide
Original Assignee
日商山洋電氣股份有限公司
Sanyo Denki Co., Ltd.
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 日商山洋電氣股份有限公司, Sanyo Denki Co., Ltd. filed Critical 日商山洋電氣股份有限公司
Publication of TW201547178A publication Critical patent/TW201547178A/en
Application granted granted Critical
Publication of TWI678065B publication Critical patent/TWI678065B/en

Links

Landscapes

  • Control Of Electric Motors In General (AREA)
  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)

Abstract

為了提供一種可檢測機械的異常之馬達控制裝置。 In order to provide a motor control device capable of detecting abnormality of a machine.

速度控制器(110)是根據速度指令和速度反饋的偏差來生成以及輸出第1轉矩指令。轉矩指令陷波過濾器(115)是從第1轉矩指令除去機械(300)之共振頻率的信號成分,藉此生成以及輸出第2轉矩指令。電力轉換器(125)是根據第2轉矩指令來驅動用來驅動機械(300)之馬達。共振頻率推定器(135)是根據速度反饋來推定機械(300)的共振頻率,藉此生成推定共振頻率。機械異常檢測部(150)是根據推定共振頻率來檢測機械異常。 The speed controller (110) generates and outputs a first torque command based on a deviation between the speed command and the speed feedback. The torque command notch filter (115) generates and outputs a second torque command by removing the signal component of the resonance frequency of the machine (300) from the first torque command. The power converter (125) drives a motor for driving the machine (300) based on the second torque command. The resonance frequency estimator (135) estimates a resonance frequency of the machine (300) based on speed feedback, thereby generating an estimated resonance frequency. The mechanical abnormality detection unit (150) detects a mechanical abnormality based on the estimated resonance frequency.

Description

馬達控制裝置 Motor control

本發明是關於馬達控制裝置。 The present invention relates to a motor control device.

具備藉由滾珠螺桿使其直線地移動的載台之工作機械是已知的。滾珠螺桿是透過聯結器安裝於馬達的輸出軸。當馬達旋轉時,載台會直線地移動。 A working machine equipped with a stage which is moved linearly by a ball screw is known. The ball screw is mounted on the output shaft of the motor through a coupling. When the motor rotates, the stage moves linearly.

聯結器具有剛性。工作機械受聯結器之剛性的影響會產生共振。工作機械產生共振時,會對工作機械的控制特性造成不良的影響。因此,讓用來控制工作機械的動作之轉矩指令通過陷波過濾器。使用通過陷波過濾器後的轉矩指令來控制工作機械的動作,藉此抑制共振的發生。 The coupling is rigid. The working machine is affected by the rigidity of the coupling and generates resonance. When resonance occurs in a work machine, it may adversely affect the control characteristics of the work machine. Therefore, a torque command for controlling the operation of the working machine is passed through a notch filter. The torque command after passing the notch filter is used to control the operation of the machine, thereby suppressing the occurrence of resonance.

在工作機械等的機械系統中,剛性等的物理特性可能參差不齊。當該參差變大時,共振頻率會大幅改變,要藉由通常的陷波過濾器來抑制共振變困難。縱使共振頻率大幅改變仍能抑制共振之適應性陷波過濾器已被開發出。適應性陷波過濾器可推定共振頻率,而自動設定陷波過濾器的頻率。 In mechanical systems such as work machines, physical characteristics such as rigidity may vary. When this variation becomes large, the resonance frequency changes greatly, and it is difficult to suppress resonance by a common notch filter. An adaptive notch filter capable of suppressing resonance even if the resonance frequency is greatly changed has been developed. The adaptive notch filter estimates the resonance frequency, and automatically sets the frequency of the notch filter.

然而,當共振頻率大幅偏離基準值時,可認為機械系統已發生異常,就那樣繼續進行作業的話會發生問題。例如,因為機械未正確地組裝而使固定部鬆脫時,共振頻率會降低,適應性陷波過濾器的推定頻率降低。當推定頻率降低時,起因於適應性陷波過濾器的相位遲延,會發生速度控制回應的駝峰(hump)增加等之與控制特性有關的不良影響。因此,導致加工精度降低、生產節拍(tact time)增加。結果,不僅生產效率惡化,在極端的情況對機械本身也會造成不良的影響。 However, when the resonance frequency greatly deviates from the reference value, it is considered that an abnormality has occurred in the mechanical system, and a problem may occur if the operation is continued as it is. For example, when the fixing portion is loosened due to incorrect assembly of the machine, the resonance frequency decreases and the estimated frequency of the adaptive notch filter decreases. When the estimated frequency decreases, the phase delay of the adaptive notch filter causes adverse effects related to the control characteristics such as an increase in the hump of the speed control response. As a result, the processing accuracy is lowered and the production tact time is increased. As a result, not only production efficiency is deteriorated, but also the machine itself may be adversely affected in extreme cases.

作為用來檢測機械異常的技術係包括:利用外部感測器來檢測異常的技術、根據馬達電流來檢測異常的技術、根據馬達位置來檢測異常的技術等之各種技術。 Techniques for detecting mechanical abnormalities include various techniques such as a technique for detecting an abnormality using an external sensor, a technique for detecting an abnormality based on a motor current, and a technique for detecting an abnormality based on a motor position.

利用外部感測器來檢測異常的技術,例如記載於日本特開2002-22617號公報。在該文獻所記載的技術,是利用設置於軸承部之加速度計來測定軸承部的振動加速度。對於測定的振動加速度進行FFT(高速傅利葉轉換)處理,藉此取出振動發生頻率的信號。藉此檢測異常。 A technique for detecting an abnormality using an external sensor is described in, for example, Japanese Patent Application Laid-Open No. 2002-22617. In the technique described in this document, the vibration acceleration of the bearing portion is measured using an accelerometer provided in the bearing portion. FFT (High-Speed Fourier Transform) processing is performed on the measured vibration acceleration, thereby extracting a signal of a frequency at which vibration occurs. This is used to detect anomalies.

根據馬達電流來檢測異常的技術,例如記載於日本特開平11-83686號公報。在該文獻所記載的技術,是對驅動機械設備的電動機之負載電流信號(電源頻率、以及其高頻的頻率)進行頻譜分析。根據頻譜分析的結果算出用來識別機械設備異常之診斷參數。將所算出的診斷參數和對每個診斷對象的機械設備事先設定的判定基 準值進行比較。當所算出的診斷參數比判定基準值更大時,判定為機械設備發生異常。 A technique for detecting an abnormality based on a motor current is described in, for example, Japanese Patent Application Laid-Open No. 11-83686. The technique described in this document is a spectrum analysis of a load current signal (a power source frequency and a high frequency thereof) of a motor driving a mechanical device. Calculate the diagnostic parameters used to identify mechanical equipment abnormalities based on the results of the spectrum analysis. The calculated diagnostic parameters and the judgment base set in advance for each machine and equipment to be diagnosed Comparison. When the calculated diagnostic parameter is larger than the determination reference value, it is determined that an abnormality has occurred in the mechanical equipment.

根據馬達位置檢測異常的技術,例如記載於日本特開2013-81282號公報。在該文獻所記載的技術,伺服系統係具備:馬達、檢測馬達的位置之位置檢測器、驅動馬達的伺服驅動器、以及控制伺服驅動器之伺服控制器。在該伺服系統,是檢測藉由馬達驅動之被驅動部的異常。亦即,系統係具有:輸入部、頻率轉換部以及比較判定部。輸入部是從位置檢測器取得馬達的位置資訊。頻率轉換部是將馬達以大致一定速度旋轉時的馬達之位置資訊進行頻率轉換。比較判定部,是將經由頻率轉換所獲得的既定頻率之振幅和用來判定被驅動部的異常之臨限值進行比較。根據具有比臨限值更大的振幅之頻率來檢測被驅動部的異常部位。 A technique for detecting an abnormality based on a motor position is described in, for example, Japanese Patent Application Laid-Open No. 2013-81282. In the technology described in this document, a servo system includes a motor, a position detector that detects the position of the motor, a servo driver that drives the motor, and a servo controller that controls the servo driver. In this servo system, an abnormality of a driven part driven by a motor is detected. That is, the system includes an input unit, a frequency conversion unit, and a comparison determination unit. The input unit obtains the position information of the motor from the position detector. The frequency conversion unit performs frequency conversion on the position information of the motor when the motor rotates at a substantially constant speed. The comparison determination unit compares the amplitude of a predetermined frequency obtained through frequency conversion with a threshold value for determining an abnormality of the driven unit. An abnormal part of the driven part is detected based on a frequency having a larger amplitude than a threshold value.

然而,日本特開2002-22617號公報、日本特開平11-83686號公報以及日本特開2013-81282號公報所記載的技術存在著下述問題。 However, the technologies described in Japanese Patent Application Laid-Open No. 2002-22617, Japanese Patent Application Laid-Open No. 11-83686, and Japanese Patent Application Laid-Open No. 2013-81282 have the following problems.

在日本特開2002-22617號公報的技術,必須在軸承部設置加速度計。此外,對於測定後的信號,必須實施複雜的運算處理。因此有成本增高的問題。 In the technique of Japanese Patent Application Laid-Open No. 2002-22617, an accelerometer must be provided in the bearing portion. In addition, it is necessary to perform complicated arithmetic processing on the measured signal. Therefore, there is a problem that the cost increases.

在日本特開平11-83686號公報的技術,機械 異常是利用電動機的負載電流信號來進行檢測。因此,只能在電動機的電源頻率及其高頻的頻率與機械系統的共振頻率一致之特定旋轉速度下才能檢測異常。 Technology, machinery in Japanese Patent Application Laid-Open No. 11-83686 The abnormality is detected using the load current signal of the motor. Therefore, the abnormality can be detected only at a specific rotation speed at which the power supply frequency of the motor and its high frequency coincide with the resonance frequency of the mechanical system.

在日本特開2013-81282號公報的技術,在檢測異常時,必須使馬達以大致一定的速度旋轉。因此,在根據來自控制器的指令而進行加減速運轉時,無法正確地檢測異常。此外,在利用高速傅利葉轉換或是小波轉換之頻率轉換,軟體所執行的處理量變多,必須採用可進行高速處理的CPU。因此,馬達控制裝置有成本增高的問題。 In the technique of Japanese Patent Application Laid-Open No. 2013-81282, when an abnormality is detected, the motor must be rotated at a substantially constant speed. Therefore, when an acceleration / deceleration operation is performed in accordance with a command from the controller, an abnormality cannot be accurately detected. In addition, in the frequency conversion using high-speed Fourier transform or wavelet transform, the amount of processing performed by the software increases, and a CPU capable of high-speed processing must be used. Therefore, there is a problem that the cost of the motor control device increases.

本發明是為了解決以上習知技術的問題點而開發完成的。本發明之目的在於提供一種馬達控制裝置,能在馬達運轉中檢測機械的異常。該馬達控制裝置,為了檢測異常不須設置特別的感測器,在進行異常的檢測時不須限制馬達的旋轉速度或是運轉模式,且在進行異常的檢測時不須實施複雜的運算處理,而能將對控制特性產生的不良影響抑制在一定範圍內。 The present invention has been developed to solve the problems of the conventional techniques. An object of the present invention is to provide a motor control device capable of detecting a mechanical abnormality during a motor operation. The motor control device does not need to be provided with a special sensor in order to detect abnormalities, does not need to limit the rotation speed or operation mode of the motor during abnormality detection, and does not need to perform complicated calculation processing when performing abnormality detection. However, the adverse effect on the control characteristics can be suppressed within a certain range.

為了達成上述目的,本發明的一實施形態之馬達控制裝置,係具有速度控制器、轉矩指令陷波過濾器、電力轉換器、共振頻率推定器以及機械異常檢測部;該速度控制器,是根據速度指令和速度反饋的偏差來生成第1轉矩指令;該轉矩指令陷波過濾器,是從前述第1轉矩指令除去機械的共振頻率之信號成分而生成第2轉矩指 令;該電力轉換器,是根據前述第2轉矩指令來驅動用來驅動前述機械之馬達;該共振頻率推定器,是根據前述速度反饋來推定前述機械的共振頻率,藉此生成推定共振頻率;該機械異常檢測部,是根據前述推定共振頻率來檢測機械異常。 In order to achieve the above object, a motor control device according to an embodiment of the present invention includes a speed controller, a torque command notch filter, a power converter, a resonance frequency estimator, and a mechanical abnormality detection unit. The speed controller is The first torque command is generated based on the deviation of the speed command and the speed feedback; this torque command notch filter is to remove the signal component of the resonance frequency of the machine from the first torque command to generate a second torque command Let; the power converter drive the motor for driving the machine according to the second torque command; the resonance frequency estimator estimates the resonance frequency of the machine based on the speed feedback, thereby generating an estimated resonance frequency This mechanical abnormality detection unit detects a mechanical abnormality based on the estimated resonance frequency.

依據具有以上構成之馬達控制裝置,為了檢測機械的異常不須設置特別的感測器,在進行機械異常的檢測時不須限制馬達的旋轉速度或是運轉模式,且在進行機械異常的檢測時不須實施複雜的運算處理,而能將對控制特性產生的不良影響抑制在一定範圍內。 According to the motor control device having the above structure, no special sensor is required to detect a mechanical abnormality, and it is not necessary to limit the rotation speed or operation mode of the motor when detecting a mechanical abnormality, and when detecting a mechanical abnormality It is not necessary to implement complicated arithmetic processing, and can suppress the adverse effect on the control characteristics within a certain range.

100‧‧‧馬達控制裝置 100‧‧‧ Motor control device

105‧‧‧速度算出器 105‧‧‧speed calculator

110‧‧‧速度控制器 110‧‧‧speed controller

115‧‧‧轉矩指令陷波過濾器 115‧‧‧Torque command notch filter

120‧‧‧轉矩控制器 120‧‧‧Torque controller

125‧‧‧電力轉換器 125‧‧‧ Power Converter

130‧‧‧高通濾波器 130‧‧‧High-pass filter

135‧‧‧共振頻率推定器 135‧‧‧Resonant frequency estimator

150‧‧‧機械異常檢測部 150‧‧‧Mechanical anomaly detection department

155‧‧‧上限極限檢測器 155‧‧‧ Upper limit detector

160‧‧‧下限極限檢測器 160‧‧‧ lower limit detector

165、170‧‧‧繼續狀態確認器 165, 170‧‧‧continue status confirmer

175‧‧‧OR回路 175‧‧‧OR circuit

180‧‧‧開關 180‧‧‧Switch

185‧‧‧初期動作檢測器 185‧‧‧Initial motion detector

圖1係本實施形態的馬達控制裝置之方塊圖。 FIG. 1 is a block diagram of a motor control device according to this embodiment.

圖2係本實施形態的馬達控制裝置之動作說明用圖。 Fig. 2 is a diagram for explaining the operation of the motor control device according to this embodiment.

接下來,針對本發明的實施形態之馬達控制裝置,根據圖式作說明。圖1係本實施形態的馬達控制裝置之方塊圖。 Next, a motor control device according to an embodiment of the present invention will be described with reference to the drawings. FIG. 1 is a block diagram of a motor control device according to this embodiment.

[馬達控制裝置的構造] [Configuration of Motor Control Device]

馬達控制裝置100係具有:速度算出器105、速度控制器110、轉矩指令陷波過濾器115、轉矩控制器120、電力轉換器125、高通濾波器130、共振頻率推定器135以及機械異常檢測部150。 The motor control device 100 includes a speed calculator 105, a speed controller 110, a torque command notch filter 115, a torque controller 120, a power converter 125, a high-pass filter 130, a resonance frequency estimator 135, and a mechanical abnormality. Detector 150.

馬達控制裝置100是與馬達200電氣性連接。馬達200是與機械300機械性連接,用來驅動機械300。編碼器210是與馬達200機械性連接。編碼器210輸出與馬達200位置有關的信號(馬達位置)。 The motor control device 100 is electrically connected to the motor 200. The motor 200 is mechanically connected to the machine 300 and is used to drive the machine 300. The encoder 210 is mechanically connected to the motor 200. The encoder 210 outputs a signal (motor position) related to the position of the motor 200.

速度算出器105,是取得從編碼器210輸出的馬達位置並將其微分,藉此生成以及輸出速度反饋。速度控制器110,是取得從未圖示控制器輸出之速度指令和速度反饋之偏差,根據該偏差來生成以及輸出第1轉矩指令。轉矩指令陷波過濾器115是取得第1轉矩指令,從該第1轉矩指令除去機械300的共振頻率之信號成分,藉此生成以及輸出第2轉矩指令。轉矩指令陷波過濾器115所設定的共振頻率,是藉由共振頻率推定器135推定之機械300的共振頻率(推定共振頻率)。亦即,轉矩指令陷波過濾器115是從第1轉矩指令除去推定共振頻率的信號成分,藉此生成第2轉矩指令。 The speed calculator 105 obtains and differentiates the motor position output from the encoder 210, thereby generating and outputting a speed feedback. The speed controller 110 obtains a deviation between a speed command and a speed feedback output from a controller (not shown), and generates and outputs a first torque command based on the deviation. The torque command notch filter 115 obtains a first torque command, removes the signal component of the resonance frequency of the machine 300 from the first torque command, and generates and outputs a second torque command. The resonance frequency set by the torque command notch filter 115 is the resonance frequency (estimated resonance frequency) of the machine 300 estimated by the resonance frequency estimator 135. That is, the torque command notch filter 115 generates a second torque command by removing a signal component of the estimated resonance frequency from the first torque command.

轉矩控制器120,是取得第2轉矩指令而輸出馬達驅動信號,該馬達驅動信號,是為了使對應於該第2轉矩指令之轉矩輸出到馬達200之信號。電力轉換器125取得該馬達驅動信號。電力轉換器125是根據該馬達驅動信號而生成為了使對應於第2轉矩指令之轉矩輸出到馬達200之 電壓及電流,並供應給馬達200。亦即,電力轉換器是根據第2轉矩指令而驅動用來驅動機械300之馬達200。 The torque controller 120 obtains a second torque command and outputs a motor drive signal. The motor drive signal is a signal for outputting a torque corresponding to the second torque command to the motor 200. The power converter 125 obtains the motor drive signal. The power converter 125 is generated based on the motor drive signal so that the torque corresponding to the second torque command is output to the motor 200. The voltage and current are supplied to the motor 200. That is, the power converter drives the motor 200 for driving the machine 300 in accordance with the second torque command.

高通濾波器130取得速度反饋,讓速度反饋所含之高頻率成分的信號(高頻反饋信號)通過,並讓除此以外的頻率成分的信號衰減。通過高通濾波器130之高頻反饋信號的頻率是比速度控制器110的回應頻率更高。亦即,高通濾波器130是讓速度反饋所含之具有比速度控制器110的回應頻率更高頻率之高頻率成分的信號通過,並讓除此以外的頻率成分的信號衰減。 The high-pass filter 130 obtains speed feedback, passes signals of high-frequency components (high-frequency feedback signals) included in the speed feedback, and attenuates signals of other frequency components. The frequency of the high-frequency feedback signal passing through the high-pass filter 130 is higher than the response frequency of the speed controller 110. That is, the high-pass filter 130 passes signals having a high frequency component higher in frequency than the response frequency of the speed controller 110 included in the speed feedback, and attenuates signals of other frequency components.

共振頻率推定器135,是根據高頻反饋信號來推定機械300的共振頻率。將藉由共振頻率推定器135所推定之機械300的共振頻率(推定共振頻率),設定於轉矩指令陷波過濾器115。機械異常檢測部150,是根據推定共振頻率來檢測機械300的異常。因此,共振頻率推定器135以及機械異常檢測部150,是發揮用來檢測機械300異常之感測器的作用。 The resonance frequency estimator 135 estimates a resonance frequency of the machine 300 based on a high-frequency feedback signal. The resonance frequency (estimated resonance frequency) of the machine 300 estimated by the resonance frequency estimator 135 is set in the torque command notch filter 115. The mechanical abnormality detection unit 150 detects an abnormality of the machine 300 based on the estimated resonance frequency. Therefore, the resonance frequency estimator 135 and the mechanical abnormality detection unit 150 function as sensors for detecting an abnormality of the machine 300.

機械異常檢測部150係具備:上限極限檢測器155、下限極限檢測器160、繼續狀態確認器165及170、OR回路175、開關180以及初期動作檢測器185。 The mechanical abnormality detection unit 150 includes an upper limit detector 155, a lower limit detector 160, continuity checkers 165 and 170, an OR circuit 175, a switch 180, and an initial operation detector 185.

上限極限檢測器155是檢測:藉由共振頻率推定器135所推定的推定共振頻率是否為在上限極限檢測器155所設定之圖2所示的上限極限之頻率以上。下限極限檢測器160是檢測:推定共振頻率是否為在下限極限檢測器160所設定之圖2所示的下限極限之頻率以下。作為 上限極限的頻率例如設定為:成為機械300的基準之共振頻率可容許的最大共振頻率。作為下限極限的頻率例如設定為:成為機械300的基準之共振頻率可容許的最小共振頻率。 The upper limit detector 155 detects whether or not the estimated resonance frequency estimated by the resonance frequency estimator 135 is higher than the frequency of the upper limit shown in FIG. 2 set by the upper limit detector 155. The lower limit detector 160 detects whether the estimated resonance frequency is lower than the frequency of the lower limit shown in FIG. 2 set by the lower limit detector 160. As The upper limit frequency is set, for example, as a maximum allowable resonance frequency that is a reference resonance frequency of the machine 300. The frequency serving as the lower limit limit is set, for example, as a minimum allowable resonance frequency that is a reference resonance frequency of the machine 300.

繼續狀態確認器165,當推定共振頻率持續一定時間以上為上限極限的頻率以上時,輸出機械異常。繼續狀態確認器170,當推定共振頻率持續一定時間以上為下限極限的頻率以下時,輸出機械異常。 The continuation state checker 165 outputs a mechanical abnormality when the estimated resonance frequency is maintained for a certain period of time or more and the frequency of the upper limit is exceeded. The continuation state checker 170 outputs a mechanical abnormality when the estimated resonance frequency is maintained for a certain period of time or more and the frequency of the lower limit limit or less.

OR回路175,當從繼續狀態確認器165及170之至少任一方輸出機械異常時,將該機械異常輸出到外部。初期動作檢測器185,取得運轉開始(例如,對應於運轉開始所輸出的信號(運轉開始信號))和速度指令,檢測共振頻率推定器135是否能適切地動作。開關180設置於繼續狀態確認器165及170的後段之OR回路175的輸出側。開關180是用來切換是否可將機械異常往外部輸出之切換器。 The OR circuit 175 outputs a mechanical abnormality to at least one of the continuation state confirmers 165 and 170, and outputs the mechanical abnormality to the outside. The initial operation detector 185 acquires the operation start (for example, a signal (operation start signal) outputted in response to the operation start) and a speed command, and detects whether the resonance frequency estimator 135 can operate appropriately. The switch 180 is provided on the output side of the OR circuit 175 at the subsequent stage of the continuation state confirmers 165 and 170. The switch 180 is used to switch whether a mechanical abnormality can be output to the outside.

初期動作檢測器185,當檢測出共振頻率推定器135無法適切地動作的情況,將開關180開啟,避免機械異常往外部輸出。初期動作檢測器185,當檢測出共振頻率推定器135可適切地動作的情況,將開關180關閉,使機械異常往外部的輸出成為可能。 When the initial operation detector 185 detects that the resonance frequency estimator 135 cannot operate properly, the switch 180 is turned on to prevent mechanical abnormalities from being output to the outside. When the initial operation detector 185 detects that the resonance frequency estimator 135 can operate appropriately, the switch 180 is turned off to enable external output of a mechanical abnormality.

依據上述般初期動作檢測器185的動作,可獲得以下的效果。亦即,當馬達200開始運轉時,速度指令為0,馬達200可能是停止的。這時,受到機械系統之 摩擦的影響,共振頻率推定器135可能無法推定共振頻率(亦即,共振頻率推定器135無法適切地動作)。在這種情況,藉由初期動作檢測器185之上述動作,可防止或是抑制機械異常被輸出。換言之,共振頻率推定器135無法適切地動作的情況是指,當機械300開始運轉時,根據速度指令的初期值所推定之推定共振頻率成為上限極限的頻率以上、或是下限極限的頻率以下的情況。在此情況,可防止或是抑制發生機械異常之錯誤檢測。 According to the operation of the initial motion detector 185 as described above, the following effects can be obtained. That is, when the motor 200 starts to run, the speed command is 0, and the motor 200 may be stopped. At this time, subject to the mechanical system Under the influence of friction, the resonance frequency estimator 135 may not be able to estimate the resonance frequency (that is, the resonance frequency estimator 135 may not operate properly). In this case, the above-mentioned operation of the initial motion detector 185 can prevent or suppress the output of a mechanical abnormality. In other words, the case where the resonance frequency estimator 135 cannot operate appropriately means that when the machine 300 starts to operate, the estimated resonance frequency estimated based on the initial value of the speed command is above the upper limit frequency or below the lower limit frequency. Happening. In this case, erroneous detection of a mechanical abnormality can be prevented or suppressed.

根據從未圖示的控制器輸出之速度指令而產生之馬達動作的頻率成分,是在速度控制器110的回應頻率的範圍內。設定於高通濾波器130之截止頻率,是比速度控制器110的回應頻率更高。因此,高通濾波器130的輸出中,根據速度指令之馬達動作的頻率成分不會出現。縱使根據來自控制器的指令而進行加減速運轉,仍能適切地檢測機械300的異常。 The frequency component of the motor operation generated according to a speed command output from a controller (not shown) is within the range of the response frequency of the speed controller 110. The cut-off frequency set in the high-pass filter 130 is higher than the response frequency of the speed controller 110. Therefore, in the output of the high-pass filter 130, the frequency component of the motor operation according to the speed command does not appear. Even if the acceleration / deceleration operation is performed in accordance with a command from the controller, the abnormality of the machine 300 can be appropriately detected.

將設定於上限極限檢測器155之上限極限的頻率及設定於下限極限檢測器160之下限極限的頻率設定為可防止或是抑制機械300破損的頻率,藉此可防止或是抑制機械300的破損於未然。 The frequency set at the upper limit of the upper limit detector 155 and the frequency set at the lower limit of the lower limit detector 160 are set to a frequency that prevents or suppresses damage to the machine 300, thereby preventing or suppressing damage to the machine 300 Yu Weiran.

此外,藉由將下限極限的頻率設定為不致使馬達控制裝置100的控制特性極端惡化(不致對加工造成不良影響)區域的頻率,縱使共振頻率降低,仍可防止或是抑制控制特性的惡化。 In addition, by setting the frequency of the lower limit to a frequency in a region that does not cause the control characteristics of the motor control device 100 to be extremely deteriorated (not to adversely affect the processing), the deterioration of the control characteristics can be prevented or suppressed even if the resonance frequency is reduced.

[馬達控制裝置的動作] [Motion of the motor control device]

接下來,參照圖1及圖2說明馬達控制裝置的動作。圖2係本實施形態的馬達控制裝置之動作說明圖。圖2,具體而言係顯示共振頻率推定器135所推定之機械300的推定共振頻率之增益和頻率的關係圖。 Next, the operation of the motor control device will be described with reference to FIGS. 1 and 2. Fig. 2 is an operation explanatory diagram of the motor control device according to this embodiment. FIG. 2 is a diagram showing the relationship between the gain and the frequency of the estimated resonance frequency of the machine 300 estimated by the resonance frequency estimator 135.

當開始運轉而從未圖示的控制器輸出速度指令時,初期動作檢測器185取得運轉開始以及速度指令,為了防止或是抑制機械異常檢測部150的錯誤檢測而將開關180開啟。另一方面,當開始運轉而使速度指令上昇時,共振頻率推定器135成為可適切地動作。這時,初期動作檢測器185為了使機械異常檢測部150檢測機械異常,而將開關180關閉。 When the operation is started without outputting a speed command from a controller (not shown), the initial motion detector 185 obtains the operation start and speed command, and turns on the switch 180 to prevent or suppress erroneous detection by the mechanical abnormality detection unit 150. On the other hand, when the operation is started and the speed command is raised, the resonance frequency estimator 135 can operate appropriately. At this time, the initial operation detector 185 turns off the switch 180 so that the mechanical abnormality detection unit 150 detects a mechanical abnormality.

速度控制器110,根據從速度算出器105輸出之速度反饋和從控制器輸出之速度指令的偏差而生成以及輸出第1轉矩指令。高通濾波器130是讓速度反饋所含之高頻率成分的信號(高頻反饋信號)通過。共振頻率推定器135是根據高頻反饋信號來推定機械300的共振頻率,藉此生成推定共振頻率。 The speed controller 110 generates and outputs a first torque command based on a deviation between the speed feedback output from the speed calculator 105 and the speed command output from the controller. The high-pass filter 130 passes a high-frequency component signal (high-frequency feedback signal) included in the speed feedback. The resonance frequency estimator 135 estimates a resonance frequency of the machine 300 based on a high-frequency feedback signal, thereby generating an estimated resonance frequency.

於轉矩指令陷波過濾器115設定推定共振頻率。轉矩指令陷波過濾器115,取得從速度控制器110輸出的第1轉矩指令,從該第1轉矩指令除去機械300之推定共振頻率的信號成分,藉此生成以及輸出第2轉矩指令。轉矩控制器120取得從轉矩指令陷波過濾器115輸出的第2轉矩指令而輸出馬達驅動信號,該馬達驅動信號是 為了使對應於該第2轉矩指令的轉矩輸出到馬達200之信號。電力轉換器125,根據從轉矩控制器120輸出之馬達驅動信號,生成為了使對應於第2轉矩指令之轉矩輸出到馬達200之電壓及電流,並供應給馬達200。 An estimated resonance frequency is set in the torque command notch filter 115. The torque command notch filter 115 obtains a first torque command output from the speed controller 110, and removes the signal component of the estimated resonance frequency of the machine 300 from the first torque command, thereby generating and outputting a second torque instruction. The torque controller 120 obtains the second torque command output from the torque command notch filter 115 and outputs a motor drive signal. The motor drive signal is A signal for outputting the torque corresponding to the second torque command to the motor 200. The power converter 125 generates a voltage and a current for outputting the torque corresponding to the second torque command to the motor 200 based on a motor drive signal output from the torque controller 120 and supplies the voltage and current to the motor 200.

馬達200,依照從電力轉換器125供給的電壓及電流進行旋轉,驅動機械300。表示馬達200的旋轉位置之馬達位置,是藉由編碼器210檢測而輸出到速度算出器105。 The motor 200 rotates in accordance with the voltage and current supplied from the power converter 125 to drive the machine 300. The motor position indicating the rotation position of the motor 200 is detected by the encoder 210 and output to the speed calculator 105.

當機械300的共振頻率(推定共振頻率)位於圖2所示之上限極限的頻率和下限極限的頻率之間時,上限極限檢測器155及下限極限檢測器160都不輸出機械異常。因此,從機械異常檢測部150不會輸出機械異常。 When the resonance frequency (estimated resonance frequency) of the machine 300 is between the frequency of the upper limit and the frequency of the lower limit shown in FIG. 2, neither the upper limit detector 155 nor the lower limit detector 160 outputs a mechanical abnormality. Therefore, the mechanical abnormality detection unit 150 does not output a mechanical abnormality.

另一方面,當機械300的共振頻率(推定共振頻率)成為圖2所示之上限極限的頻率以上或是下限極限的頻率以下時,上限極限檢測器155或下限極限檢測器160輸出機械異常。 On the other hand, when the resonance frequency (estimated resonance frequency) of the machine 300 becomes higher than the frequency of the upper limit limit or lower than the frequency of the lower limit limit shown in FIG. 2, the upper limit detector 155 or the lower limit detector 160 outputs a mechanical abnormality.

當繼續狀態確認器165確認從上限極限檢測器155持續一定時間以上輸出機械異常,或是當繼續狀態確認器170確認從下限極限檢測器160持續一定時間以上輸出機械異常時,繼續狀態確認器165或170會對OR回路175輸出機械異常。OR回路175透過開關180將機械異常往外部輸出。 When the continuation state confirmer 165 confirms that a mechanical abnormality is output from the upper limit detector 155 for a certain period of time, or when the continuation state confirmer 170 confirms that a mechanical abnormality is output from the lower limit detector 160 for a certain period of time, the continuation state confirmer 165 OR 170 outputs a mechanical error to the OR circuit 175. The OR circuit 175 outputs a mechanical abnormality to the outside through the switch 180.

此外,在機械異常的輸出後,當上限極限檢測器155或下限極限檢測器160並未持續一定時間以上輸 出機械異常時,將繼續狀態確認器165以及170往OR回路175之機械異常的輸出停止亦可。 In addition, after the output of the mechanical abnormality, when the upper limit detector 155 or the lower limit detector 160 does not continue to output for more than a certain time When a mechanical abnormality occurs, the mechanical abnormality output of the state checkers 165 and 170 to the OR circuit 175 may be stopped.

例如,當機械300的共振頻率位於圖2所示之上限極限(380Hz)和下限極限(210Hz)之間時,不輸出機械異常。另一方面,當機械300的共振頻率為380Hz以上或210Hz以下,且此狀態繼續一定時間以上時,輸出機械異常。 For example, when the resonance frequency of the machine 300 is between the upper limit (380 Hz) and the lower limit (210 Hz) shown in FIG. 2, no mechanical abnormality is output. On the other hand, when the resonance frequency of the machine 300 is more than 380 Hz or less than 210 Hz, and this state continues for more than a certain time, the output machine is abnormal.

如以上所說明,本實施形態的馬達控制裝置100,是對共振頻率推定器135設定上限極限及下限極限的頻率。當藉由共振頻率推定器135所推定之推定共振頻率持續一定時間以上的時間成為上限極限的頻率以上、或下限極限的頻率以下的情況,輸出機械異常。 As described above, the motor control device 100 according to this embodiment is a frequency that sets the upper limit limit and the lower limit limit to the resonance frequency estimator 135. When the estimated resonance frequency estimated by the resonance frequency estimator 135 continues for more than a certain time, the frequency becomes equal to or higher than the frequency of the upper limit or the frequency of the lower limit or lower, and a mechanical abnormality is output.

因此,縱使機械300未正確地組裝、以及/或是隨著機械零件的劣化而使機械300的共振頻率降低,仍可防止或是抑制馬達控制裝置100的控制特性的惡化。此外,也能防止或是抑制機械300的破損。 Therefore, even if the machine 300 is incorrectly assembled and / or the resonance frequency of the machine 300 is reduced as the mechanical parts deteriorate, it is possible to prevent or suppress the deterioration of the control characteristics of the motor control device 100. In addition, breakage of the machine 300 can be prevented or suppressed.

又在以上的實施形態,是在馬達控制裝置100(機械異常檢測部150)設置上限極限檢測器155以及下限極限檢測器160雙方。依機械300的共振特性,為了檢測機械異常,也會有只要檢測推定共振頻率成為上限極限的頻率以上、或是推定共振頻率成為下限極限的頻率以下之任一者即可的情況。在此情況,將上限極限檢測器155或下限極限檢測器160之任一方設置在馬達控制裝置100(機械異常檢測部150)亦可。 In the above embodiment, both the upper limit detector 155 and the lower limit detector 160 are provided in the motor control device 100 (mechanical abnormality detection unit 150). Depending on the resonance characteristics of the machine 300, in order to detect a mechanical abnormality, it may be sufficient to detect any one of the frequency where the estimated resonance frequency becomes the upper limit limit or the frequency where the estimated resonance frequency becomes the lower limit limit. In this case, either the upper limit detector 155 or the lower limit detector 160 may be provided in the motor control device 100 (mechanical abnormality detection unit 150).

本實施形態之馬達控制裝置100,為了檢測機械300的異常,係具備共振頻率推定器135及機械異常檢測部150。因此,為了檢測異常不須採用特別的感測器,即可檢測機械300的異常。 In order to detect an abnormality of the machine 300, the motor control device 100 of this embodiment includes a resonance frequency estimator 135 and a mechanical abnormality detection unit 150. Therefore, in order to detect the abnormality, an abnormality of the machine 300 can be detected without using a special sensor.

此外,在本實施形態的馬達控制裝置100,高通濾波器130是從速度反饋除去速度控制器110之回應頻率以下的頻率成分,藉此生成高頻反饋信號。而且,共振頻率推定器135是根據該高頻反饋信號來推定機械300的共振頻率。因此,為了檢測機械300的異常,可避免馬達200的旋轉速度以及運轉模式受限制。 In the motor control device 100 according to this embodiment, the high-pass filter 130 generates a high-frequency feedback signal by removing frequency components below the response frequency of the speed controller 110 from the speed feedback. The resonance frequency estimator 135 estimates the resonance frequency of the machine 300 based on the high-frequency feedback signal. Therefore, in order to detect an abnormality of the machine 300, it is possible to prevent the rotation speed and the operation mode of the motor 200 from being restricted.

此外,在馬達控制裝置100,是根據上限極限的頻率及下限極限的頻率來檢測機械異常。因此,在進行異常檢測時,不須實施複雜的運算處理。 The motor control device 100 detects a mechanical abnormality based on the frequency of the upper limit and the frequency of the lower limit. Therefore, it is not necessary to perform complicated arithmetic processing when performing abnormality detection.

以上是說明本發明的較佳實施形態。但這些只是用來說明本發明的例示,並不限定本發明的範圍。本發明在不脫離其要旨的範圍內,能以與上述實施形態不同的各種態樣來實施。 The foregoing is a description of a preferred embodiment of the present invention. However, these are merely examples for explaining the present invention, and do not limit the scope of the present invention. The present invention can be implemented in various aspects other than the above-described embodiments without departing from the scope of the invention.

又在本實施形態,共振頻率推定器135是根據高頻反饋信號來推定機械300的共振頻率。然而,馬達控制裝置100亦可不具備高通濾波器130。在此情況,共振頻率推定器135是根據速度反饋來推定機械300的共振頻率,藉此生成以及輸出推定共振頻率亦可。 In this embodiment, the resonance frequency estimator 135 estimates the resonance frequency of the machine 300 based on the high-frequency feedback signal. However, the motor control device 100 may not include the high-pass filter 130. In this case, the resonance frequency estimator 135 may estimate the resonance frequency of the machine 300 based on the speed feedback, thereby generating and outputting the estimated resonance frequency.

速度算出器105,將從編碼器210輸出的馬達位置輸入,將其微分而輸出速度反饋亦可。速度控制器110,將 未圖示的控制器所輸出之速度指令和速度反饋的偏差輸入,而輸出轉矩指令亦可。轉矩指令陷波過濾器115,輸入轉矩指令,將從該轉矩指令除去機械300的共振頻率之信號成分後的轉矩指令輸出亦可。於轉矩指令陷波過濾器115設定之共振頻率,亦可為共振頻率推定器135所推定的共振頻率。轉矩控制器120,將除去機械300的共振頻率之信號成分後的轉矩指令輸入,而輸出為了使馬達200輸出對應於該轉矩指令的轉矩之信號亦可。電力轉換器125,將為了輸出該轉矩的信號輸入,而對馬達200供給必要的電壓及電流亦可。 The speed calculator 105 may input the motor position output from the encoder 210, differentiate it, and output speed feedback. Speed controller 110, will The deviation input of the speed command and speed feedback output by the controller (not shown) can also be used to output the torque command. The torque command notch filter 115 may input a torque command and output a torque command after removing the signal component of the resonance frequency of the machine 300 from the torque command. The resonance frequency set in the torque command notch filter 115 may also be a resonance frequency estimated by the resonance frequency estimator 135. The torque controller 120 may input a torque command excluding the signal component of the resonance frequency of the machine 300 and output a signal for the motor 200 to output a torque corresponding to the torque command. The power converter 125 may input a signal for outputting the torque, and may also supply necessary voltage and current to the motor 200.

高通濾波器130,是將速度反饋輸入,讓速度反饋所含的高頻率成分的信號通過,讓除此以外的頻率成分之信號衰減亦可。通過高通濾波器130之高頻率成分的信號,是比速度控制器110之回應頻率更高頻率亦可。共振頻率推定器135,是從具有比速度控制器110的回應頻率更高頻率成分的速度反饋來推定機械300的共振頻率亦可。將共振頻率推定器135所推定的共振頻率,設定於轉矩指令陷波過濾器115亦可。機械異常檢測部150,是使用共振頻率推定器135所推定的共振頻率來檢測機械300的異常亦可。 The high-pass filter 130 is configured to input the speed feedback and pass the signals of the high frequency components included in the speed feedback, and attenuate the signals of the other frequency components. The signal passing the high-frequency component of the high-pass filter 130 may be a higher frequency than the response frequency of the speed controller 110. The resonance frequency estimator 135 may estimate the resonance frequency of the machine 300 from a speed feedback having a frequency component higher than the response frequency of the speed controller 110. The resonance frequency estimated by the resonance frequency estimator 135 may be set in the torque command notch filter 115. The mechanical abnormality detection unit 150 may detect an abnormality of the machine 300 using the resonance frequency estimated by the resonance frequency estimator 135.

初期動作檢測器185,在馬達200始運轉時,速度指令為0而使馬達200停止,受到機械系統之摩擦的影響而使共振頻率推定器135無法推定共振頻率的情況,防止或是抑制輸出機械異常亦可。換言之,初期動作檢測器 185,當機械300開始運轉前所推定的共振頻率成為上限極限的頻率以上的頻率、或下限極限的頻率以下的頻率的情況,防止或是抑制發生機械異常的錯誤檢測亦可。 The initial motion detector 185 prevents the resonance frequency estimator 135 from estimating the resonance frequency when the speed command is 0 and stops the motor 200 when the motor 200 starts to run. This prevents or suppresses the output of machinery. Abnormal can also be. In other words, the initial motion detector 185. When the estimated resonance frequency before the start of the operation of the machine 300 becomes a frequency higher than the frequency of the upper limit or a frequency lower than the frequency of the lower limit, erroneous detection of a mechanical abnormality may be prevented or suppressed.

上限極限的頻率,對於成為機械300的基準之共振頻率,設定成可容許的最大共振頻率亦可。下限極限的頻率,對於成為機械300的基準之共振頻率,設定成可容許的最小共振頻率亦可。未圖示的控制器所輸出之根據速度指令所產生之馬達動作的頻率成分,成為速度控制器110之回應頻率的範圍內亦可。當上限極限檢測器155或下限極限檢測器160持續一定時間以上的時間未輸出機械異常,使繼續狀態確認器165及170不對OR回路175輸出機械異常亦可。 The upper limit frequency may be set to the allowable maximum resonance frequency for the resonance frequency serving as a reference for the machine 300. The frequency of the lower limit may be set to a minimum allowable resonance frequency for the resonance frequency serving as a reference for the machine 300. The frequency component of the motor operation according to the speed command output by the controller (not shown) may be within the range of the response frequency of the speed controller 110. When the upper limit detector 155 or the lower limit detector 160 does not output a mechanical abnormality for a certain period of time or longer, the continuation state checkers 165 and 170 may not output a mechanical abnormality to the OR circuit 175.

本發明亦可為能檢測機械的異常之馬達控制裝置。 The present invention can also be a motor control device capable of detecting an abnormality of a machine.

第1馬達控制裝置,係具有速度控制器、轉矩指令陷波過濾器、電力轉換器、共振頻率推定器以及機械異常檢測部;該速度控制器,是根據速度指令和速度反饋的偏差來輸出轉矩指令;該轉矩指令陷波過濾器,是輸出從前述轉矩指令除去機械之共振頻率的信號成分後之轉矩指令;電力轉換器,是使用除去前述機械之共振頻率的信號成分後之轉矩指令來驅動馬達;共振頻率推定器,是使用前述速度反饋來推定馬達所驅動的前述機械之共振頻率;機械異常檢測部,是使用所推定的前述機械之共振頻率來檢測機械異常。 The first motor control device includes a speed controller, a torque command notch filter, a power converter, a resonance frequency estimator, and a mechanical abnormality detection unit. The speed controller outputs data based on the deviation of the speed command and speed feedback. Torque command; This torque command notch filter outputs the torque command after removing the signal component of the machine's resonance frequency from the aforementioned torque command; the power converter uses the signal component of the machine's resonance frequency after removing it The torque command is used to drive the motor; the resonance frequency estimator uses the speed feedback to estimate the resonance frequency of the machine driven by the motor; and the mechanical abnormality detection unit uses the estimated resonance frequency of the machine to detect a mechanical abnormality.

第2馬達控制裝置,是在第1馬達控制裝置中,前述 共振頻率推定器所推定的前述機械之共振頻率,設定於前述轉矩指令陷波過濾器。 The second motor control device is the first motor control device. The resonance frequency of the machine estimated by the resonance frequency estimator is set in the torque command notch filter.

第3馬達控制裝置,是在第1或第2馬達控制裝置中,前述機械異常檢測部係至少具備上限極限檢測器或下限極限檢測器之任一者;該上限極限檢測器,在前述推定之前述機械共振頻率為所設定之上限極限的頻率以上的頻率時輸出機械異常;該下限極限檢測器,在前述推定之前述機械的共振頻率為所設定之下限極限的頻率以下的頻率時輸出機械異常。 The third motor control device is the first or second motor control device, wherein the mechanical abnormality detection unit is provided with at least either an upper limit detector or a lower limit detector; the upper limit detector is based on the estimated When the mechanical resonance frequency is a frequency higher than the set upper limit frequency, a mechanical abnormality is output; the lower limit detector outputs a mechanical abnormality when the estimated resonance frequency of the machine is a frequency lower than the set lower limit frequency. .

第4馬達控制裝置,是在第3馬達控制裝置中,前述機械異常檢測部進一步具有繼續狀態確認器,該繼續狀態確認器,當確認從前述上限極限檢測器或前述下限極限檢測器持續一定時間以上的時間輸出機械異常時,將前述機械異常往外部輸出。 The fourth motor control device is the third motor control device, wherein the mechanical abnormality detection unit further includes a continuation state confirmer that confirms that the continuity condition continues from the upper limit detector or the lower limit detector for a certain period of time. When a mechanical abnormality is output during the above time, the mechanical abnormality is output to the outside.

第5馬達控制裝置,是在第4馬達控制裝置中,前述機械異常檢測部進一步具備開關及初期動作檢測器;該開關可切換成:避免前述機械異常往外部輸出、或使其輸出;該初期動作檢測器,是將運轉開始和前述速度指令輸入,檢測前述共振頻率推定器是否能適切地動作;該初期動作檢測器,當檢測出前述共振頻率推定器無法適切地動作的情況,將前述開關開啟,避免前述機械異常往外部輸出,當檢測出前述共振頻率推定器可適切地動作的情況,將前述開關關閉,使前述機械異常往外部輸出。 The fifth motor control device is the fourth motor control device, wherein the mechanical abnormality detection unit further includes a switch and an initial motion detector; the switch can be switched to prevent the mechanical abnormality from being output to the outside or output it; The motion detector detects whether the resonance frequency estimator can operate properly by inputting the start of operation and the speed command. The initial motion detector detects the situation where the resonance frequency estimator cannot operate properly and switches the switch. Turn on to prevent the mechanical abnormality from being output to the outside. When it is detected that the resonance frequency estimator can operate properly, turn off the switch to output the mechanical abnormality to the outside.

第6馬達控制裝置,是在第5馬達控制裝置中,前述 開關設置在前述繼續狀態確認器的後段。 The sixth motor control device is the fifth motor control device, wherein The switch is set at the rear of the aforementioned continuation state confirmer.

第7馬達控制裝置,是在第5或第6馬達控制裝置中,檢測出前述共振頻率推定器無法適切地動作的情況是指,在前述機械開始運轉時使用前述速度指令的初期值所推定之共振頻率,成為上限極限之頻率以上的頻率、或下限極限之頻率以下的頻率的情況。 The seventh motor control device is the case where the fifth or sixth motor control device detects that the resonance frequency estimator cannot operate properly, and is estimated by using the initial value of the speed command when the machine starts to operate. The resonance frequency is a frequency higher than the frequency of the upper limit or a frequency lower than the frequency of the lower limit.

第8馬達控制裝置,是在第1~第7中任一者之馬達控制裝置中,在前述共振頻率推定器的前段設置高通濾波器,該高通濾波器是讓前述速度反饋所含之比前述速度控制器的回應頻率更高的頻率、即高頻率成分的信號通過,並讓除此以外的頻率成分的信號衰減。 The eighth motor control device is a motor control device according to any one of the first to seventh. A high-pass filter is provided in front of the resonance frequency estimator. The high-pass filter allows the speed feedback The response frequency of the speed controller is higher, that is, signals with high frequency components pass through, and signals with other frequency components are attenuated.

Claims (11)

一種馬達控制裝置,係具有速度控制器、轉矩指令陷波過濾器、電力轉換器、共振頻率推定器以及機械異常檢測部;該速度控制器,是根據速度指令和速度反饋的偏差來生成第1轉矩指令;該轉矩指令陷波過濾器,是從前述第1轉矩指令除去機械的共振頻率之信號成分而生成第2轉矩指令;該電力轉換器,是根據前述第2轉矩指令來驅動用來驅動前述機械之馬達;該共振頻率推定器,是根據前述速度反饋來推定前述機械的共振頻率,藉此生成推定共振頻率;該機械異常檢測部,是根據前述推定共振頻率來檢測機械異常,前述機械異常檢測部進一步具備開關及初期動作檢測器;該開關,是用來切換是否將前述機械異常往外部輸出;該初期動作檢測器,是取得運轉開始和前述速度指令,檢測前述共振頻率推定器是否能適切地動作;前述初期動作檢測器,當檢測出前述共振頻率推定器無法適切地動作的情況,將前述開關開啟,避免前述機械異常往外部輸出,另一方面當檢測出前述共振頻率推定器可適切地動作的情況,將前述開關關閉,使前述機械異常能往外部輸出。A motor control device includes a speed controller, a torque command notch filter, a power converter, a resonance frequency estimator, and a mechanical abnormality detection unit. The speed controller generates a first 1 torque command; the torque command notch filter generates a second torque command by removing the signal component of the resonance frequency of the machine from the first torque command; the power converter is based on the second torque A command is used to drive a motor for driving the aforementioned machine; the resonance frequency estimator estimates the resonance frequency of the machine based on the speed feedback, thereby generating an estimated resonance frequency; and the mechanical abnormality detection unit is based on the estimated resonance frequency. Detects a mechanical abnormality. The mechanical abnormality detecting unit further includes a switch and an initial motion detector. The switch is used to switch whether to output the mechanical abnormality to the outside. The initial motion detector is to obtain the start of operation and the speed command to detect Whether the aforementioned resonance frequency estimator can operate properly; It is detected that the resonance frequency estimator cannot operate properly, and the switch is turned on to avoid external output of the mechanical abnormality. On the other hand, when it is detected that the resonance frequency estimator can operate properly, the switch is turned off. The aforementioned mechanical abnormality can be output to the outside. 如申請專利範圍第1項所述之馬達控制裝置,其中,前述轉矩指令陷波過濾器,是從前述第1轉矩指令除去前述推定共振頻率的信號成分,藉此生成前述第2轉矩指令。The motor control device according to item 1 of the scope of patent application, wherein the torque command notch filter generates the second torque by removing a signal component of the estimated resonance frequency from the first torque command. instruction. 如申請專利範圍第1項所述之馬達控制裝置,其中,前述機械異常檢測部至少具備上限極限檢測器或下限極限檢測器之任一者;該上限極限檢測器,在前述推定共振頻率為所設定之上限極限的頻率以上的頻率時輸出機械異常;該下限極限檢測器,在前述推定共振頻率為所設定之下限極限的頻率以下的頻率時輸出機械異常。The motor control device according to item 1 of the scope of patent application, wherein the mechanical abnormality detection unit is provided with at least either an upper limit detector or a lower limit detector; the upper limit detector is at the estimated resonance frequency. A mechanical abnormality is output at a frequency higher than the frequency set by the upper limit; the lower limit detector outputs a mechanical abnormality when the estimated resonance frequency is lower than the frequency set by the lower limit. 如申請專利範圍第2項所述之馬達控制裝置,其中,前述機械異常檢測部至少具備上限極限檢測器或下限極限檢測器之任一者;該上限極限檢測器,在前述推定共振頻率為所設定之上限極限的頻率以上的頻率時輸出機械異常;該下限極限檢測器,在前述推定共振頻率為所設定之下限極限的頻率以下的頻率時輸出機械異常。The motor control device according to item 2 of the scope of patent application, wherein the mechanical abnormality detection unit is provided with at least one of an upper limit detector and a lower limit detector; the upper limit detector is at the estimated resonance frequency. A mechanical abnormality is output at a frequency higher than the frequency set by the upper limit; the lower limit detector outputs a mechanical abnormality when the estimated resonance frequency is lower than the frequency set by the lower limit. 如申請專利範圍第3項所述之馬達控制裝置,其中,前述機械異常檢測部進一步具有繼續狀態確認器,該繼續狀態確認器,當確認從前述上限極限檢測器或前述下限極限檢測器持續一定時間以上輸出機械異常時,將前述機械異常輸出。The motor control device according to item 3 of the scope of the patent application, wherein the mechanical abnormality detection unit further includes a continuation state confirmer that confirms that the continuity from the upper limit detector or the lower limit detector continues to be constant. When a mechanical abnormality is output for more than time, the aforementioned mechanical abnormality is output. 如申請專利範圍第4項所述之馬達控制裝置,其中,前述機械異常檢測部進一步具有繼續狀態確認器,該繼續狀態確認器,當確認從前述上限極限檢測器或前述下限極限檢測器持續一定時間以上輸出機械異常時,將前述機械異常輸出。The motor control device according to item 4 of the scope of patent application, wherein the mechanical abnormality detection section further includes a continuation state confirmer, which confirms that the continuity from the upper limit detector or the lower limit detector is constant for a certain period When a mechanical abnormality is output for more than time, the aforementioned mechanical abnormality is output. 如申請專利範圍第5項所述之馬達控制裝置,其中,前述開關設置於前述繼續狀態確認器的後段。The motor control device according to item 5 of the scope of patent application, wherein the switch is disposed at a rear stage of the continuation state confirmer. 如申請專利範圍第6項所述之馬達控制裝置,其中,前述開關設置於前述繼續狀態確認器的後段。The motor control device according to item 6 of the scope of patent application, wherein the switch is disposed at a rear stage of the continuation state confirmer. 如申請專利範圍第1或7或8項所述之馬達控制裝置,其中,檢測出前述共振頻率推定器無法適切地動作的情況是指,在前述機械開始運轉時,根據前述速度指令的初期值所推定之共振頻率成為上限極限之頻率以上、或下限極限之頻率以下的情況。According to the motor control device described in item 1 or 7 or 8 of the scope of the patent application, wherein the case where the resonance frequency estimator cannot be properly operated is detected, when the machine starts to operate, the initial value according to the speed command When the estimated resonance frequency is above the frequency of the upper limit or below the frequency of the lower limit. 如申請專利範圍第1至8項中任一項所述之馬達控制裝置,其中,進一步具有設置在前述共振頻率推定器的前段之高通濾波器,該高通濾波器是讓前述速度反饋所含之比前述速度控制器的回應頻率更高的頻率、即高頻率成分的信號通過,並讓除此以外的頻率成分的信號衰減。The motor control device according to any one of claims 1 to 8, further comprising a high-pass filter provided at a front stage of the resonance frequency estimator, the high-pass filter is included in the speed feedback A frequency higher than the response frequency of the speed controller, that is, a signal of a high frequency component passes through, and a signal of other frequency components is attenuated. 如申請專利範圍第9項所述之馬達控制裝置,其中,進一步具有設置在前述共振頻率推定器的前段之高通濾波器,該高通濾波器是讓前述速度反饋所含之比前述速度控制器的回應頻率更高的頻率、即高頻率成分的信號通過,並讓除此以外的頻率成分的信號衰減。The motor control device according to item 9 of the scope of the patent application, further comprising a high-pass filter provided at a front stage of the resonance frequency estimator, the high-pass filter allows the speed feedback A signal with a higher response frequency, that is, a signal with a high frequency component passes, and attenuates signals of other frequency components.
TW104114138A 2014-05-07 2015-05-04 Motor control TWI678065B (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2014-096142 2014-05-07
JP2014096142A JP6312517B2 (en) 2014-05-07 2014-05-07 Motor control device

Publications (2)

Publication Number Publication Date
TW201547178A TW201547178A (en) 2015-12-16
TWI678065B true TWI678065B (en) 2019-11-21

Family

ID=54579067

Family Applications (1)

Application Number Title Priority Date Filing Date
TW104114138A TWI678065B (en) 2014-05-07 2015-05-04 Motor control

Country Status (4)

Country Link
JP (1) JP6312517B2 (en)
KR (1) KR20150127543A (en)
CN (1) CN105099321B (en)
TW (1) TWI678065B (en)

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102016201746A1 (en) * 2016-02-05 2017-08-10 Robert Bosch Gmbh Method, angle determination device and control device
JP6451662B2 (en) * 2016-02-23 2019-01-16 株式会社安川電機 Abnormality determination device, abnormality determination program, abnormality determination system, and motor control device
JP7012223B2 (en) * 2016-09-29 2022-01-28 パナソニックIpマネジメント株式会社 Motor control device and motor control method
JP6380628B1 (en) * 2017-07-31 2018-08-29 株式会社安川電機 Power conversion apparatus, server, and data generation method
WO2019106875A1 (en) * 2017-11-28 2019-06-06 株式会社安川電機 Abnormality determination system, motor control device, and abnormality determination device
JP7006471B2 (en) * 2018-04-12 2022-01-24 オムロン株式会社 State change detection device and state change detection method
KR20210020874A (en) * 2018-06-15 2021-02-24 파나소닉 아이피 매니지먼트 가부시키가이샤 Motor drive device and servo adjustment method
JP6721012B2 (en) * 2018-08-10 2020-07-08 株式会社安川電機 Motor control system
JP7092620B2 (en) * 2018-08-31 2022-06-28 株式会社日立産機システム Power conversion system and motor control method
WO2020230234A1 (en) * 2019-05-13 2020-11-19 三菱電機株式会社 Control system and motor control device
CN110401390B (en) * 2019-07-22 2021-02-26 青岛大学 Permanent magnet synchronous motor random command filtering fuzzy control method based on observer
JP2022117573A (en) * 2021-02-01 2022-08-12 株式会社日立製作所 Device diagnostic system
KR102558372B1 (en) * 2023-02-03 2023-07-24 멜콘 주식회사 Method for detecting bearing current of inverter-fed-motor

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6107767A (en) * 1998-03-20 2000-08-22 Trw Inc. Electric assist steering system having an improved motor current controller with notch filter
JP2005168225A (en) * 2003-12-04 2005-06-23 Matsushita Electric Ind Co Ltd Motor controller
JP2008312339A (en) * 2007-06-14 2008-12-25 Panasonic Corp Electric motor control device
CN101772884A (en) * 2008-06-04 2010-07-07 松下电器产业株式会社 motor control unit
TW201041293A (en) * 2009-04-14 2010-11-16 Mitsubishi Electric Corp Motor controlling apparatus
TW201304388A (en) * 2011-05-24 2013-01-16 Mitsubishi Electric Corp Apparatus for controlling a motor
JP2013089089A (en) * 2011-10-19 2013-05-13 Sumitomo Heavy Ind Ltd Resonance suppression device and resonance suppression method

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000060179A (en) * 1998-08-04 2000-02-25 Fuji Electric Co Ltd Control method of solar inverter for pump drive
JP2001029680A (en) * 1999-07-23 2001-02-06 Brother Ind Ltd Sewing machine control device
JP4212219B2 (en) * 2000-04-19 2009-01-21 新明和工業株式会社 Electric pump device and control method thereof
CN102918765B (en) * 2010-05-28 2015-11-25 松下电器产业株式会社 Control device of electric motor

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6107767A (en) * 1998-03-20 2000-08-22 Trw Inc. Electric assist steering system having an improved motor current controller with notch filter
JP2005168225A (en) * 2003-12-04 2005-06-23 Matsushita Electric Ind Co Ltd Motor controller
JP2008312339A (en) * 2007-06-14 2008-12-25 Panasonic Corp Electric motor control device
CN101772884A (en) * 2008-06-04 2010-07-07 松下电器产业株式会社 motor control unit
TW201041293A (en) * 2009-04-14 2010-11-16 Mitsubishi Electric Corp Motor controlling apparatus
TW201304388A (en) * 2011-05-24 2013-01-16 Mitsubishi Electric Corp Apparatus for controlling a motor
JP2013089089A (en) * 2011-10-19 2013-05-13 Sumitomo Heavy Ind Ltd Resonance suppression device and resonance suppression method

Also Published As

Publication number Publication date
TW201547178A (en) 2015-12-16
CN105099321A (en) 2015-11-25
JP2015216709A (en) 2015-12-03
KR20150127543A (en) 2015-11-17
CN105099321B (en) 2019-02-15
JP6312517B2 (en) 2018-04-18

Similar Documents

Publication Publication Date Title
TWI678065B (en) Motor control
US11241792B2 (en) Method and device for detecting abnormality of encoder, and robot control system
JP5566532B2 (en) Motor control device
JP6017057B2 (en) Motor control device
CN110174873B (en) Servo control device
JP2006281421A (en) Robot and abnormality detection method of robot
JP2007219991A (en) Abnormal load detection device
JP2017198079A (en) Electric oil pump light load abnormality determination method
JP2013106470A (en) Abnormality diagnostic device for motor
CN105443470A (en) Hydraulic pressure control device
US9356550B2 (en) Motor controller having abnormality detection function of power transmission unit between motor and main shaft
KR20170002759A (en) Failure diagnosis method for hall sensor
JP6101931B2 (en) Motor drive device
JP3829559B2 (en) Numerically controlled machine tool
JP6848845B2 (en) Servo motor load condition diagnostic device and load status diagnostic method
KR101421997B1 (en) Embedded system and method for detecting fault thereof
JP2003302421A (en) Diagnostic device for revolution sensor
JP7518381B2 (en) Protective Device
JP2006158031A (en) Motor controller and control method for the same
JP7449950B2 (en) Power conversion device and predictive diagnosis method used therefor
JP6568147B2 (en) Servo motor control device
JP2006003953A (en) Mechanical vibration suppressing device and mechanical vibration frequency detecting method
US20240421734A1 (en) Method and apparatus for detecting sensing delay of sensor equipped in electric moter
JP3930262B2 (en) Numerical controller
KR102217919B1 (en) Method for controlling speed Brushless DC motor with robusting to noise of hall sensor

Legal Events

Date Code Title Description
MM4A Annulment or lapse of patent due to non-payment of fees