Motor control device and motor control method

Abstract

To provide a motor control device and a motor control method for preventing control from becoming unstable.SOLUTION: When a servo amplifier 100 that adjusts gain of a motor 300 analyzes a feedback signal and it is determined that there is vibration above a certain reference level, a torque adjustment unit 140 increases strength of a notch filter 141 from initial setting, thereby covering and attenuating peak frequencies of the vibration within a certain range when the peak frequencies of adjacent vibration determined by the servo amplifier 100 are within the certain range.SELECTED DRAWING: Figure 1

Description

[Technical field]

[0001] The present invention relates to a motor control device having an autotuning function and a motor control method. [Background technology]

[0002] When a servo motor is installed in a target device such as a robot or a machine tool, the gain of the servo amplifier needs to be adjusted according to the load inertia. Such servo amplifier gain adjustment is generally performed by a motor control device with an auto-tuning function.

[0003] In auto-tuning, multiple test operations are performed while changing the tuning parameters, and the next parameters to be set are determined based on the results of each test operation. In particular, in order to suppress the oscillation of the motor side at the resonance point present in the target device, it is necessary to set a notch filter that can suppress the resonance peak, for example.

[0004] As a related art to this type of auto-tuning, Patent Document 1 proposes an automatic adjustment method for a motor control device in which an encoding unit extracts and outputs only information on the sign of an internal state quantity, a limiter unit calculates and outputs information limiting the amplitude of the output of a notch filter unit, an adaptive update unit sequentially updates and outputs an estimate of the notch frequency based on the multiplication of the output of the encoding unit and the output of the limiter unit, a notch filter unit adopts the estimate as the notch frequency, a unit conversion unit converts the unit of the estimate into Hertz and outputs this as an estimate, and the estimate is used to adaptively adjust a controller. [Prior art documents] [Patent documents]

[0005] [Patent Document 1] Patent Publication No. 2021-087276 Summary of the Invention [Problem to be solved by the invention]

[0006] In the automatic adjustment method for a motor control device described in Patent Document 1 above, the notch frequency of the notch filter is set near the frequency of the resonance point of the resonant frequency of the target device, which is thought to make it possible to attenuate the frequency level of the resonance point.

[0007] However, when there are multiple resonance points of the resonant frequency of the target device within a certain range, even if the notch frequency of the notch filter is set near the frequency of the resonance points, it may be impossible to attenuate the frequency level of the resonance points within the certain range, which may cause the control to become unstable.

[0008] The present invention has been made in view of the above circumstances, and has an object to provide a motor control device and a motor control method that can solve the above problems. [Means for solving the problem]

[0009] The motor control device of the present invention has a servo amplifier that adjusts the gain of a motor, and a torque adjustment unit having a notch filter, the servo amplifier analyzes a feedback signal and determines whether or not there is vibration above a certain reference level, and the torque adjustment unit When it is recognized that there are two vibration modes having different peak frequencies in the feedback signal, and the difference between the peak frequencies in the two vibration modes is within a certain range, the notch frequency of the notch filter is made to correspond to only one of the peak frequencies of the two vibration modes, and the vibrations in the two vibration modes are attenuated only by adjusting the strength of the notch filter having a notch frequency set to correspond only to the peak frequency. It is characterized by: In the motor control method of the present invention, a servo amplifier that adjusts the gain of the motor analyzes a feedback signal, judges whether or not there is vibration above a certain reference level, and a torque adjustment unit having a notch filter When it is recognized that there are two vibration modes having different peak frequencies in the feedback signal, and the difference between the peak frequencies in the two vibration modes is within a certain range, the notch frequency of the notch filter is made to correspond to only one of the peak frequencies of the two vibration modes, and the vibrations in the two vibration modes are attenuated only by adjusting the strength of the notch filter having a notch frequency set to correspond only to the peak frequency. It is characterized by: In the motor control device and motor control method of the present invention, a servo amplifier that adjusts the gain of the motor analyzes the feedback signal, judges whether or not there is vibration above a certain reference level, and a torque adjustment unit having a notch filter: When it is recognized that there are two vibration modes having different peak frequencies in the feedback signal, and the difference between the peak frequencies in the two vibration modes is within a certain range, the notch frequency of the notch filter is made to correspond to only one of the peak frequencies of the two vibration modes, and the vibrations in the two vibration modes are attenuated only by adjusting the strength of the notch filter having a notch frequency set to correspond only to the peak frequency. . Effect of the Invention

[0010] According to the motor control device and motor control method of the present invention, the peak frequencies of vibration within a certain range are covered and attenuated, so that it is possible to prevent the control from becoming unstable. [Brief description of the drawings]

[0011] [Figure 1] FIG. 1 is a diagram for explaining an embodiment of a motor control device of the present invention. [Figure 2A] FIG. 2A is a diagram for explaining torque adjustment by the servo amplifier of FIG. 1 for a vibration frequency exceeding a certain reference level, and is a diagram showing a case where a notch filter is set for one vibration. [Figure 2B] FIG. 2B is intended to explain torque adjustment by the servo amplifier of FIG. 1 for a vibration frequency exceeding a certain reference level, and is a diagram showing a case where a second vibration is present at a position away from the first vibration by a certain range or more. [Figure 2C] FIG. 2C is a diagram for explaining torque adjustment by the servo amplifier of FIG. 1 for a vibration frequency exceeding a certain reference level, and is a diagram showing a case where a notch filter is set for a second vibration. [Figure 3A] FIG. 3A is a diagram for explaining torque adjustment by the servo amplifier of FIG. 1 for a vibration frequency exceeding a certain reference level, and shows the setting of a notch filter when the peak frequencies of adjacent vibrations are within a certain range. [Figure 3B] FIG. 3B is a diagram for explaining torque adjustment by the servo amplifier of FIG. 1 for a vibration frequency exceeding a certain reference level, and shows the setting of a notch filter when the peak frequencies of adjacent vibrations are within a certain range. [Figure 3C] FIG. 3C is a diagram for explaining torque adjustment by the servo amplifier of FIG. 1 for a vibration frequency exceeding a certain reference level, and shows the setting of a notch filter when the peak frequencies of adjacent vibrations are within a certain range. [Figure 4]FIG. 4 is a flowchart for explaining auto-tuning by the servo amplifier of FIG. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0012] An embodiment of a motor control device of the present invention will be described below with reference to Figures 1 to 4. Note that when performing auto-tuning, the motor control device M described below needs to adjust the gain of the servo amplifier 100 according to the load inertia, but for convenience of explanation, illustration and explanation of the load inertia will be omitted. Also, for convenience of explanation, the frequency values ​​described below are set to values ​​that are easy to explain.

[0013] The motor control device M includes a servo amplifier 100 having an auto-tuning function. The servo amplifier 100 performs FFT (Fast Fourier Transform) analysis of the encoder pulse, which is a feedback signal, and performs processing such as extracting the vibration frequency. Furthermore, when the peak value of the extracted vibration frequency exceeds a certain reference level, the servo amplifier 100 determines that oscillation has occurred. Note that reference numeral 300 denotes a motor, reference numeral 150 denotes a subtractor, and reference numeral 160 denotes an adder-subtractor.

[0014] The servo amplifier 100 includes a position adjustment unit 110 , a feedforward control unit 120 , a feedback control unit 130 , a torque adjustment unit 140 , and a current control unit 170 .

[0015] The position adjustment unit 110 outputs a position command according to a gain setting to the feedforward control unit 120 and the subtractor 150 based on a command indicating a target value including command values ​​for position, speed, and torque from a controller (not shown).

[0016] Based on the position command from the position adjustment unit 110, the feedforward control unit 120 outputs to the adder / subtractor 160 a feedforward command (FF command) including a speed command and a torque command for controlling the speed and torque.

[0017] The feedback control unit 130 outputs a feedback command (FB command) to the adder-subtractor 160 based on the feedback signal, so as to make the deviation from the subtractor 150 zero.

[0018] The torque adjustment unit 140 has first and second notch filters 141 and 142. The torque adjustment unit 140 outputs an adjustment command to the current control unit 170, the adjustment command being attenuated by the notch filters 141 and / or 142 in response to vibration contained in the torque command of the control command from the adder / subtractor 160.

[0019] The first and second notch filters 141, 142 are not limited to two as shown in the figure, and three or more filters may be provided. Also, the first and second notch filters 141, 142 may be adaptive filters capable of self-adapting a transfer function according to an optimization algorithm. Details of the settings of the first and second notch filters 141, 142 will be described later.

[0020] Subtractor 150 subtracts a position command according to a gain setting from position adjustment unit 110 from the position and velocity signals of the feedback signal, and outputs a deviation. Adder-subtractor 160 subtracts a feedforward command from a feedback command, and outputs a control command for making the deviation from subtractor 150 zero.

[0021] The current control unit 170 controls the drive current of the motor 300 so that the torque indicated by the adjustment command from the torque adjustment unit 140 is generated.

[0022] In the motor control device configured as above, when a command is output from a controller (not shown), the motor 300 starts driving based on a feedforward command (FF command) from the feedforward control unit 120.

[0023] When a feedback signal detected by an encoder (not shown) is output as motor 300 is driven, a control command for making the deviation from subtractor 150 zero is output from adder-subtractor 160 in response to a feedback command (FB command) from feedback control unit 130. Then, current control unit 170 controls the drive current of motor 300 so as to generate a torque indicated by the adjustment command from torque adjustment unit 140 with vibration damped.

[0024] Next, the settings in torque adjustment unit 140 will be described with reference to Fig. 2A to Fig. 3C. For convenience of explanation, Fig. 2A to Fig. 3C only show vibrations that exceed a certain reference level. The vertical axis indicates the vibration level and the depth of first and second notch filters 141, 142, and the horizontal axis indicates the frequency.

[0025] Moreover, the first and second notch filters 141, 142 have a characteristic that the phase lags on the low frequency side of the center frequency and leads on the high frequency side. Therefore, if the notch frequency of the first and second notch filters 141, 142 is matched to the peak frequency of the vibration, the notch frequency and the peak frequency of the vibration may not match due to the influence of the phase lag on the low frequency side, and the servo amplifier 100 may become unstable. For this reason, in this embodiment, the notch frequency of the first and second notch filters 141, 142 is set to, for example, 90% of the peak frequency of the vibration.

[0026] 2A, when the peak frequency of vibration is 400 Hz, the notch frequency is set to 360 Hz. This makes it possible to match the phase of the notch frequency with the peak frequency of vibration after setting the first and second notch filters 141 and 142.

[0027] 2A shows a case where the servo amplifier 100 has one vibration due to oscillation. In this case, the torque adjustment unit 140 sets the notch frequency of the first notch filter 141 to a frequency (360 Hz) that is 90% of the peak frequency (400 Hz) of the vibration. As a result, after setting the first notch filter 141, the phase of the notch frequency can be matched with the peak frequency of the vibration, and the peak frequency (400 Hz) of the vibration can be attenuated as shown by the dotted line in FIG. 2B.

[0028] 2B shows a case where there are two vibrations due to the oscillation of the servo amplifier 100. In this case, when the peak frequency (800 Hz) of the second vibration is apart from the peak frequency (400 Hz) of the first vibration by a certain range or more, the torque adjustment unit 140 sets the notch frequency of the second notch filter 142 to a frequency (720 Hz) that is 90% of the peak frequency (800 Hz) of the vibration, as shown in FIG. 2C. This makes it possible to attenuate the peak frequency (800 Hz) of the second vibration after setting the second notch filter 142. Here, being apart by a certain range or more means that the peak frequencies of the two vibrations are apart by more than twice the band of the notch frequency, for example.

[0029] In auto-tuning, after setting the first notch filter 141, the gain of the first notch filter 141 is increased and a test operation is performed, and the tuning operation is completed when it is confirmed that there is no vibration whose peak value in the FFT analysis result of the torque value obtained from the feedback signal exceeds a certain reference level. Also, when the test operation of the first notch filter 141 is performed and there is a second vibration as shown in Fig. 2B, the second notch filter 142 is set to a frequency (720Hz) that is 90% of the peak frequency (800Hz) of the second vibration, and then the gain of the second notch filter 142 is increased and a test operation is performed, and the tuning operation is completed when it is confirmed that there is no vibration whose peak value exceeds a certain reference level.

[0030] 3A shows a case where the servo amplifier 100 has two vibrations due to oscillation, and the peak frequencies of the two vibrations are close to each other (within a certain range). For example, within a certain range means that the peak frequencies of the two vibrations are within the band of the notch frequency.

[0031] 3A, when the two vibration peak frequencies are close to each other, torque adjustment unit 140 sets the notch frequency of first notch filter 141 to a frequency (360 Hz) that is 90% of the vibration peak frequency (400 Hz). As a result, after setting first notch filter 141, the vibration peak frequency (400 Hz) can be attenuated as shown by the dotted line in FIG. 3B.

[0032] Here, the gain of first notch filter 141 is increased and a test operation is performed. If the FFT analysis result of the torque value obtained from the feedback signal shows that the vibration close to the peak frequency (400 Hz) is not attenuated as shown in Fig. 3B, torque adjustment unit 140 increases the strength of first notch filter 141 from the initial setting as shown in Fig. 3C. This makes it possible to cover and attenuate the peak frequency of vibration close to (within a certain range of) the peak frequency of vibration (400 Hz) by deepening the depth of the notch frequency as shown by the solid line in Fig. 3B.

[0033] When the two peak frequencies of vibrations caused by the oscillation of the servo amplifier 100 are close to each other (within a certain range), it is possible to set the notch frequency of the first notch filter 141 to the lower peak frequency of the vibration. However, if the first notch filter 141 is set to the lower peak frequency of the vibration, there is a risk that the notch frequency will not be able to cover the higher peak frequency of the vibration even if the depth of the notch frequency is increased. For this reason, it is preferable to align the first notch filter 141 to the higher peak frequency side of the vibration.

[0034] Next, the auto-tuning process of the motor control device M will be described with reference to Fig. 4. Note that the following describes a case related to vibration reduction through torque adjustment.

[0035] (Step S101) The servo amplifier 100 analyzes the vibration level. In this case, the servo amplifier 100 performs, for example, FFT analysis on the feedback signal to extract the vibration frequency.

[0036] (Step S102) The servo amplifier 100 judges whether or not there is vibration above a certain reference level. In this case, if the peak value of the extracted vibration frequency does not exceed a certain reference level, the servo amplifier 100 determines that there is no vibration at or above a certain reference level (step S102: No), and ends the process. In contrast, as shown in Figures 2A to 3C, if the peak value of the extracted vibration frequency exceeds a certain reference level, the servo amplifier 100 determines that there is vibration equal to or greater than the certain reference level (step S102: Yes), and proceeds to step S103.

[0037] (Step S103) The servo amplifier 100 determines whether there are two or more vibrations. In this case, if the servo amplifier 100 determines from the determination result of step S107 that there is one vibration as shown in FIG. 2A (step S103: No), the servo amplifier 100 proceeds to step S107. On the other hand, if the servo amplifier 100 determines from the determination result of step S102 that there are two or more vibrations as shown in FIG. 2B (step S103: Yes), the servo amplifier 100 proceeds to step S104.

[0038] (Steps S104 and S107) The servo amplifier 100 sets the first notch filter 141 . In this case, as shown in FIG. 2A, torque adjustment section 140 of servo amplifier 100 sets the notch frequency of first notch filter 141 to a frequency (360 Hz) that is 90% of the peak frequency (400 Hz) of the vibration. Then, after setting the first notch filter 141, a test operation is performed by increasing the gain of the first notch filter 141 to check whether the vibration of the peak frequency (400 Hz) at which the first notch filter 141 is set has attenuated. It should be noted that, when the setting of the first notch filter 141 is completed in step S107 and it is confirmed that the vibration has attenuated, the process ends.

[0039] (Step S105) The servo amplifier 100 determines whether the peak frequency of the second vibration is within a certain range. In this case, when the servo amplifier 100 determines that the peak frequency of the second vibration is within a certain range (close to) the peak frequency of the first vibration (400 Hz) as shown in FIG. 3A (step S105: Yes), it proceeds to step S106. In contrast, when the servo amplifier 100 determines that the peak frequency (800 Hz) of the second vibration is equal to or greater than a certain range relative to the peak frequency (400 Hz) of the first vibration (step S105: No), as shown in FIG. 2B, it proceeds to step S108.

[0040] (Step S106) The servo amplifier 100 sets the second notch frequency. In this case, as shown in FIG. 2C, torque adjustment section 140 of servo amplifier 100 sets the notch frequency of second notch filter 142 to a frequency (720 Hz) that is 90% of the peak frequency (800 Hz) of the second vibration. Then, after setting the second notch filter 142, the gain of the second notch filter 142 is increased and a test operation is performed to check whether the vibration of the peak frequency (800 Hz) at which the second notch filter 142 is set has attenuated.

[0041] (Step S108) The servo amplifier 100 increases the strength of the first notch filter 141 . In this case, the torque adjusting section 140 of the servo amplifier 100 makes the strength of the first notch filter 141 stronger than the initial setting, as shown in FIG. 3C. As a result, the depth of the notch frequency of the first notch filter 141 becomes deeper, so that after the first notch filter 141 is set, the notch frequency can cover and attenuate the peak frequency of vibration that is close (within a certain range) to the peak frequency of vibration (400 Hz).

[0042] (Step S109) The servo amplifier 100 judges whether the setting is complete. In this case, if the servo amplifier 100 cannot confirm in steps S104, S106, and S107 that the vibration of the peak frequency (400 Hz and 800 Hz, or 400 Hz) has been attenuated by setting the first and / or second notch filters 141, 142 (step S109: No), it determines that the setting is not complete. In response to this, if the servo amplifier 100 confirms in steps S104, S106, and S107 that the vibration of the peak frequency (400 Hz and 800 Hz, or 400 Hz) has been attenuated by setting the first and / or second notch filters 141, 142 (step S109: No), it determines that the setting is complete and terminates the process.

[0043] In the above description, the first and / or second notch filters 141, 142 are set in steps S104, S106, and S107, and the gains of the first and / or second notch filters 141, 142 are increased to perform the test operation, but the present invention is not limited to this example. For example, after the first and / or second notch filters 141, 142 are set in steps S104, S106, and S107, the gains of the first and / or second notch filters 141, 142 may be increased in step S109 to perform the test operation, and it may be confirmed whether the vibration of the peak frequency at which the first and / or second notch filters 141, 142 are set has attenuated, and whether the setting is complete may be determined.

[0044] In this embodiment, the servo amplifier 100 that adjusts the gain of the motor 300 analyzes the feedback signal and determines that there is vibration at or above a certain reference level. When the peak frequencies of adjacent vibrations determined by the servo amplifier 100 are within a certain range, the torque adjustment unit 140 makes the strength of the notch filter 141 stronger than the initial setting, thereby covering and attenuating the peak frequencies of vibrations within the certain range. This makes it possible to prevent the control from becoming unstable. [Explanation of symbols]

[0045] 100 Servo Amplifier 110 Position adjustment section 120 Feedforward control section 130 Feedback control section 140 Torque adjustment unit 141 First Notch Filter 142 Second Notch Filter 150 Subtractor 160 Adder / Subtractor 170 Current control section 300 Motor M Motor control device

Claims

1. A servo amplifier that adjusts the motor gain; a torque adjusting unit having a notch filter, The servo amplifier analyzes the feedback signal and determines whether or not there is vibration above a certain reference level, a torque adjustment unit that, when it is recognized that the feedback signal has two vibration modes having different peak frequencies, and when the difference in peak frequencies between the two vibration modes is within a certain range, causes the notch frequency of the notch filter to correspond to only one of the peak frequencies of the two vibration modes, and attenuates vibrations of the two vibration modes by only adjusting the strength of the notch filter having a notch frequency set to correspond only to that peak frequency.

2. 2. The motor control device according to claim 1, wherein the torque adjustment unit sets the notch frequency to a frequency that is a certain percentage lower than the corresponding peak frequency when the servo amplifier determines that vibration is present.

3. 2. The motor control device according to claim 1, wherein the torque adjusting unit causes the notch frequency to correspond to one of the two vibration modes having a higher peak frequency.

4. The servo amplifier that adjusts the motor gain analyzes the feedback signal and determines whether or not there is vibration above a certain reference level. When a torque adjustment unit having a notch filter recognizes that the feedback signal has two vibration modes having different peak frequencies, and the difference in peak frequencies between the two vibration modes is within a certain range, the notch frequency of the notch filter is made to correspond to only one of the peak frequencies of the two vibration modes, and vibrations in the two vibration modes are attenuated only by adjusting the strength of the notch filter having a notch frequency set to correspond only to the peak frequency. A motor control method comprising:

5. 5. The motor control method according to claim 4, wherein the torque adjustment unit sets the notch frequency to a frequency that is a certain percentage lower than the corresponding peak frequency when the servo amplifier determines that vibration is present.

Images