Motor Control Device

The motor control device addresses response delays in vibration damping control by processing speed commands to remove excitation frequency components, improving positioning speed and accuracy within the servo motor control system.

JP7586782B2Active Publication Date: 2024-11-19HITACHI IND EQUIP SYST CO LTD
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
JP2021107666
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2021-06-29
Publication Date
2024-11-19
Estimated Expiration
2041-06-29

AI Technical Summary

Technical Problem

Existing motor control systems face challenges in achieving desired response characteristics due to machine end vibrations caused by resonance and anti-resonance, particularly when implementing vibration damping control within a servo motor control device responsible for the speed control system, which results in response delays and prolonged positioning times.

Method used

A motor control device that includes a speed control system with a vibration damping controller, a position command estimator, a parallel vibration damping controller, a phase adjuster, and a unit converter to process speed commands, effectively removing frequency components that excite vibrations, thereby improving response delay and shortening positioning time.

Benefits of technology

The solution enhances the response delay in vibration damping control within the speed control system, allowing for faster and more precise positioning by processing speed commands to eliminate frequency components that cause machine end vibrations.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007586782000014
    Figure 0007586782000014
  • Figure 0007586782000015
    Figure 0007586782000015
  • Figure 0007586782000016
    Figure 0007586782000016
Patent Text Reader

Abstract

To provide a motor control device that mitigates response delay unique to damping control.SOLUTION: A motor control device comprises an intra-speed control system damping controller 15 including: a position command estimator 9 for calculating an estimated value 13 of a position command; a parallel type damping controller 10 that on the basis of the estimated value 13 of the position command, extracts a frequency component exciting vibration of a machine end included in a first speed command 14 and outputs the extracted frequency component; a phase adjuster 1 for mitigating response delay caused by the parallel type damping controller 10; a unit converter 12 for converting output of the phase adjuster 1 into a speed dimension; and an operator. The operator subtracts output of the parallel type damping controller 10 from the first speed command 14 to remove the frequency component exciting vibration of the machine end from the first speed command 14 and outputs a subtraction result as a second speed command 8; on the basis of output of the unit converter 12 and the second speed command 8, and outputs a first actual speed command 18 as output of the intra-speed control system damping controller 15 to make the first actual speed command 18 be a command to a speed controller 20.SELECTED DRAWING: Figure 1
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to a motor control device. [Background technology]

[0002] When driving a controlled machine with a semi-closed motor control system, If the rigidity of a machine is low, the machine's resonance and anti-resonance characteristics may cause the end of the machine (hereinafter referred to as the machine end) to vibrate at low frequencies of a few Hz to 100 Hz, making it impossible to achieve the desired response characteristics.

[0003] In the case of work machines in the factory automation field, where both positioning accuracy and shortening of the time required for positioning are required, vibration suppression control is generally used. Vibration suppression control is generally achieved by processing the control command, and a method is known for removing frequency components that excite vibrations at the machine end from the control command.

[0004] Patent Document 1 discloses a method for damping the ends of a machine by switching between two vibration damping filters in response to a position command, even when the machine's resonance and anti-resonance characteristics change. A notch filter is given as an example of the vibration damping filter. [Prior art documents] [Patent documents]

[0005] [Patent Document 1] JP 2005-168225 A Summary of the Invention [Problem to be solved by the invention]

[0006] When the motor control system is a position control system, vibration suppression control can be achieved by processing the position command using a notch filter or the like. However, as shown in Figure 2, due to industrial reasons such as equipment replacement, the upper-system control device that generates the position command may contain a position controller, and the servo motor control device may be responsible for the speed control system, which is a minor loop.

[0007] Furthermore, due to reasons such as ease of maintenance and the specifications of each device, there are cases where it is desired to realize vibration suppression control not in the position controller but within the servo motor control device which handles the speed control system, which is a minor loop.

[0008] In Patent Document 1, the vibration suppression filter 3, the filter switching means 9, and the command direction detection means 4, which contribute to the vibration suppression control, are configured to realize the vibration suppression control in the upper control device in Fig. 2. Therefore, in Patent Document 1, the vibration suppression control is not realized within the servo motor control device that handles the speed control system.

[0009] Furthermore, when performing vibration suppression control using a line enhancer (LE) as a filter to extract the frequency components that excite machine end vibrations, it becomes necessary to prevent the response delay that is specific to vibration suppression control.

[0010] The present invention aims to provide a motor control device that improves the response delay that is specific to vibration control in a semi-closed motor control system in which a host control device includes a position controller and vibration control is realized within the motor control device that handles the speed control system. [Means for solving the problem]

[0011] The present invention provides a motor control device included in a position control system that controls the position of a mechanical end connected to a motor, The motor control device includes: receiving a first speed command from a host control device; a position control system that outputs a position response of a motor shaft to the host control device; A speed controller; A vibration suppression controller in a speed control system; The vibration suppression controller in the speed control system is a position command estimator that calculates an estimate of a position command based on the first speed command and a position response of the motor shaft; a parallel-type vibration suppression controller that extracts a frequency component that excites vibration of the machine end, which is included in the first speed command, based on the estimated value of the position command, and outputs the extracted frequency component; a phase adjuster for improving a response delay caused by the parallel-type vibration suppression controller; a first unit converter that converts the output of the phase adjuster into a dimension of velocity; A computing unit; The computing unit includes: subtracting an output of the parallel-type vibration suppression controller from the first speed command to remove the frequency component that excites vibration of the machine end from the first speed command, and outputting the result as a second speed command; outputting a first actual speed command as an output of a vibration suppression controller in the speed control system based on an output of the first unit converter and the second speed command; The motor control device uses the first actual speed command as a command for the speed controller. Effect of the Invention

[0012] According to the present invention, when vibration damping control is realized within a motor control device that handles a speed control system, the response delay specific to vibration damping control can be improved and the positioning time can be shortened. [Brief description of the drawings]

[0013] [Figure 1] FIG. 2 is a diagram showing a first basic configuration of the first embodiment. [Diagram 2] FIG. 2 is a diagram showing a configuration including a host control device and a servo motor control device. [Diagram 3] FIG. 1 is a diagram for explaining a configuration that is a premise of a first embodiment. [Figure 4] FIG. 4 is a diagram showing the frequency characteristics of a vibration excitation component extractor. [Diagram 5] FIG. 4 is a diagram showing frequency characteristics of a phase adjuster. [Figure 6] FIG. 13 is a diagram showing the frequency characteristics of the machine end. [Figure 7] FIG. 11 is a diagram showing a first basic configuration of the second embodiment. [Figure 8] FIG. 13 is a diagram for explaining a configuration that is a premise of a second embodiment. [Figure 9] FIG. 2 is a diagram showing a specific configuration of a two-degree-of-freedom controller involving an FF controller. [Figure 10] FIG. 2 is a diagram showing a specific configuration of a model matching two-degree-of-freedom controller. [Figure 11] A diagram showing an AC servo motor control system. [Figure 12] FIG. 1 is a diagram showing an AC servo motor control system having a vibration suppression controller in a speed control system. [Figure 13] 13A and 13B are diagrams showing the effect of vibration suppression control in the configuration of FIG. 12. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0014] First, the configuration on which this embodiment is based will be explained with reference to Fig. 3. Fig. 3 shows a technique for achieving vibration suppression control within a servo motor control device 301 without processing a position command. The servo motor control device 301 in Fig. 3 includes a position command estimator 9, a parallel type vibration suppression controller 10, a speed controller 20, a position / speed calculator 21, a current control system 207, and an adder / subtractor 304, and is characterized in that it processes a speed command 303 obtained from a higher-level control device 201.

[0015] More specifically, parallel-type vibration suppression controller 10 consists of a vibration excitation component extractor and a unit converter, and achieves vibration suppression of the machine end by extracting frequency components that excite vibration of machine end 204 from position command estimate value 13 obtained from position command estimator 9 using the vibration excitation component extractor and converting this into speed units using the unit converter, and removing the vibration excitation component from speed command 303.

[0016] In FIG. 3, the vibration excitation component extractor in the parallel-type vibration suppression controller 10 employs the following equation, which corresponds to a line enhancer (LE), as a filter that can extract the frequency components that excite the machine end vibration from the position command estimator 9 without any phase delay.

[0017]

number

[0018] where W is the extraction width, L is a parameter that determines the extraction power level, and ωn is the frequency to be extracted [rad / s]. Also, s is the Laplace operator (hereinafter, s means the Laplace operator).

[0019] Figure 4 shows the frequency characteristics of equation (1) when W = 1, L = 0.1, and ωn = 2π × 10. It is characterized by the fact that the amplitude peaks at frequency ωn and the phase lag becomes 0.

[0020] The vertical axis in the upper part of Fig. 4 is Magnitude (the amplitude of the frequency to be extracted), and the horizontal axis is Frequency (the frequency of the waveform to be extracted). The vertical axis in the lower part of Fig. 4 is Phase (the phase of the frequency to be extracted), and the horizontal axis is Frequency (the frequency of the waveform to be extracted).

[0021] In vibration suppression control using the LE in formula (1), the occurrence of response delays peculiar to vibration suppression control becomes an issue. Specifically, a phase delay occurs in the frequency band below ωn, and while vibrations at the machine end can be suppressed, sufficient response characteristics cannot be obtained, and there are cases where the positioning time cannot be sufficiently shortened.

[0022] Hereinafter, an embodiment of the present invention will be described with reference to the drawings, which are configurations for improving the response delay specific to vibration suppression control. In each drawing, components having common functions are given the same numbers, and their explanations will be omitted. In addition, hereinafter, "feedback" may be abbreviated to "FB" and "feedforward" to "FF". EXAMPLES

[0023] FIG. 1 shows the configuration of vibration suppression controller 15 in a speed control system of this embodiment, which is configured by adding a phase adjuster 1, an adder-subtractor 3 and an adder-subtractor 17, and a unit converter 12 to vibration suppression controller 302 in a speed control system in servo motor control device 301 of FIG. 3.

[0024] This embodiment assumes that the motor control system is composed of a host control device 201 and a servo motor control device 301, as shown in Fig. 3. The servo motor control device 301 of this embodiment is included in a position control system that controls the position of a machine end connected to a motor.

[0025] The host control device 201 generates a position command 24, includes a position controller 22, receives a motor shaft position response 23 from a servo motor control device 301, generates a speed command 14 in the position controller 22 based on the position command 24 and the motor shaft position response 23, and outputs this to the servo motor control device 301. The position command 24 may be given from outside the host control device 201, such as from another host device.

[0026] The servo motor control device 301 of this embodiment includes a speed controller 20 which is responsible for the speed control system, a current control system 207, a position / speed calculator 21, and a vibration suppression controller 15 in the speed control system, and receives a speed command 14 from a host control device 201 to perform speed control for the motor. The position / speed calculator 21 calculates the position of the motor shaft based on a measurement signal from a sensor (e.g. a rotary encoder) which is attached to the motor and can grasp the position and speed. This is used as a position response 23 of the motor shaft, and the motor shaft position response 23 is output to the host control device 201.

[0027] The servo motor control device 301 has a CPU (Central Processing Unit) although not shown. The vibration suppression controller 302 in the speed control system including each processing unit such as the position command estimator 9, the parallel type vibration suppression controller 10, the adder / subtractor 304, the speed controller 20, the position / speed calculator 21, the current control system 207, etc. are executed by the CPU reading and executing a program. All or part of each processing unit can be configured with hardware such as an ASIC (Application Specific Integrated Circuit) or an FPGA (Field Programmable Gate Array). The upper-system control device 201 also has a CPU, which executes a program corresponding to the position controller 22.

[0028] In this embodiment, the position controller 22 of the upper-level control device 201 does not include vibration damping control, and the objective is to realize vibration damping control within the servo motor control device 301 and to improve the response delay that is specific to vibration damping control. The vibration damping controller 15 in the speed control system is the vibration damping controller of this embodiment to achieve this.

[0029] Vibration suppression control is realized by processing the speed command 14. In principle, this can be achieved by carrying out the following steps. S1: Position command grasping and estimation S2: Extract the frequency components that excite the machine end vibration from the grasped / estimated position command S3: Generate a speed command that does not include the frequency components extracted in S2 and use it as the speed command for the speed controller. Step S1 is realized by the position command estimator 9. An example of the means for realizing this is the following equation: Position command estimator 9 adds, in a third adder-subtractor, a signal obtained by processing first speed command 14 with an estimation filter in accordance with equation (2) and position response 23 of the motor shaft, and outputs the result as an estimated value of the position command.

[0030]

number

[0031] where re, sr and yp are position command estimate 13, speed command 14 and motor shaft position response 23, respectively, and Fp is an estimation filter that matches the inverse characteristics of position controller 22. For example, if position controller 22 is a P controller, Fp will be the inverse characteristics of the P controller, that is, the inverse of the P gain. Note that, for the sake of simplicity in the following discussion, it is assumed that position command estimate 13 obtained by position command estimator 9 can estimate position command 24 without error.

[0032] Step S2 is realized by the vibration excitation component extractor 11. The vibration excitation component extractor 11 is a line enhancer (LE) as a filter, and the line enhancer has the function of the above-mentioned equation (1).

[0033] Step S3 is realized by unit converter 12 and adder / subtractor 16, where the unit of the output of vibration excitation component extractor 11 is converted from position to speed by unit converter 12 and this is removed from speed command 14 by adder / subtractor 16, thereby realizing a speed command 8 that does not include frequency components that excite machine end vibration. Note that an example of unit converter 12 is position controller 22 included in upper-system control device 201.

[0034] The position controller 22 plays a role of generating a speed command based on a position command 24 and a deviation between the position command 24 and a position response 23 of the motor shaft. Therefore, the vibration suppression controller 15 in the speed control system can play a role of the unit converter 12.

[0035] The LE of equation (1) of vibration excitation component extractor 11 can extract the frequency component that excites the machine end vibration from position command estimate 13 without any phase delay, as shown in Fig. 4. However, LE has the characteristic of leading the phase in a band lower than the extracted frequency ωn [rad / s] (however, the maximum phase lead is π / 2 [rad / s]).

[0036] Now consider the following process in which a sine wave with amplitude α (0<α≦1) and phase lead β (0<β<π / 2) is subtracted from a sine wave of frequency ω.

[0037]

number

[0038] Transforming this equation gives the following:

[0039]

number

[0040]

number

[0041] When α (0<α≦1) and β (0<β<π / 2), γ is always negative. Therefore, the sine wave Sc(t) obtained by subtracting a sine wave with amplitude α (0<α≦1) and phase lead by β (0<β<π / 2) from a sine wave of frequency ω will always be a sine wave of frequency ω with a delayed phase relative to the sine wave of frequency ω. Note that the amount of phase lag tends to increase when α is large.

[0042] Consider the following process in which a sine wave with amplitude α (0<α≦1) and phase lead β (0<β<π / 2) is added to a sine wave of frequency ω.

[0043]

number

[0044] Transforming this equation gives the following:

[0045]

number

[0046]

number

[0047] In equation (8), γ is always positive when α (0<α≦1) and β (0<β<π / 2) are both true. Therefore, the sine wave Sc(t) obtained by adding a sine wave with amplitude α (0<α≦1) and phase lead by β (0<β<π / 2) to a sine wave of frequency ω will always be a sine wave of frequency ω with a lead in phase relative to the sine wave of frequency ω.

[0048] This embodiment utilizes the principles of equations (6) to (8) to improve the response delay that is specific to vibration damping control.

[0049] The parallel-type vibration suppression controller 10 in Fig. 1 employs equation (1). Therefore, due to the characteristics of the LE, frequency components (assumed to be ωL) lower than frequency ωn are advanced by the LE. Since the frequency component of frequency ωL, whose phase is advanced by the LE relative to the frequency component of frequency ωL of speed command 14, is subtracted by the adder-subtractor 16, the frequency component of frequency ωL in output 8 of the adder-subtractor 16 necessarily has a delay relative to the same frequency component of speed command 14, according to the principles of equations (3) to (5). In particular, when ωL is close to ωn, due to the characteristics of the LE, the gain is high (i.e., α is large). Therefore, when ωL is closer to ωn, the phase delay is more noticeable.

[0050] This is the cause of the response delay that is specific to the parallel-type vibration suppression control using LE. Such a phase delay characteristic delays the frequency components of the speed command 14 in a band lower than ωn, so the speed command is delayed overall.

[0051] In this embodiment, to address the problem of the phase of the speed command 14 being delayed, the phase adjuster 1, the adder-subtractor 3, the unit converter 12, and the adder-subtractor 17 in FIG.

[0052] The output 2 of the adder / subtractor 3 is a position command (estimated value) from which frequencies that excite machine end vibrations have been removed due to the nature of the vibration excitation component extractor 11. However, frequency components lower than the frequency ωn have a phase delay relative to the position command estimated value 5 (position command estimated value 13), similar to the output 8.

[0053] The phase adjuster advances the frequency component delayed due to the vibration excitation component extractor 11, converts the unit from position to speed in the unit converter 12, and then adds it to the output 8 in the adder / subtractor 17. As a result, according to the principles of the equations (6) to (8), it is possible to advance the phase delay of the output 8, which has a phase delay in the frequency component lower than ωn due to the vibration excitation component extractor 11, and as a result, it is possible to improve the response delay specific to vibration suppression control. In other words, this embodiment aims to process the speed command by improving the phase delay of the speed command 14 caused by the vibration excitation component extractor 11, thereby generating a speed command 18 (hereinafter, this will be referred to as the actual speed command 18) in which the delay of the speed command is improved. The actual speed command 18 is a speed command of the speed controller 20, It should be noted that since output 2 does not contain any frequency components that excite vibrations at the machine end, the actual speed command 18 obtained by adding output 7 of unit converter 12 to output 8 by adder / subtractor 17 is also a speed command that has a vibration-damping effect and does not excite vibrations at the machine end.

[0054] An example of the phase adjuster 1 is a first-order high-pass filter (HPF) shown below.

[0055]

number

[0056] Here, ωh is the cutoff frequency [rad / s], and h (>1) is the adjustment gain.

[0057] Figure 5 shows the frequency response of the HPF when ωh=2π×10 and h=2.5.

[0058] The vertical axis in the upper part of Fig. 5 is Magnitude (amplitude of the frequency in the HPF), and the horizontal axis is Frequency (frequency of the waveform in the HPF). The vertical axis in the lower part of Fig. 5 is Phase (phase of the frequency in the HPF), and the horizontal axis is Frequency (frequency of the waveform in the HPF).

[0059] The phase advance is π / 4[rad / s] at frequency ωh, and a maximum of π / 2[rad / s] in the frequency band below ωh. The gain increases by 20×log10(h) in the high frequency range.

[0060] Therefore, by using the formula (9), the phase delay of the speed command 14 can be improved.

[0061] There is a degree of freedom in the design of the parameters ωh and h in equation (9). For example, if the cutoff frequency is made to match the frequency ωn extracted by the LE (ωh = ωn), the rise delay in the response to the ramp command can theoretically be improved linearly with an increase in h.

[0062] In addition, the response characteristics of the machine end vibration are often expressed by the following equation (10).

[0063]

number

[0064] where ωa is the frequency of the machine end vibration [rad / s] and ζa is the damping coefficient. To extract the vibration frequency of the machine end using LE, ωa = ωn should be set.

[0065] Regarding the parameter design of the HPF, if the frequency characteristic of the AR in equation (10) is known, this may be taken into consideration.

[0066] The frequency characteristics of the AR are shown in Fig. 6. Note that ωa = 2π × 10 and ζa = 0.1.

[0067] The vertical axis of the upper part of Fig. 6 is Magnitude (amplitude of the frequency in AR), and the horizontal axis is Frequency (frequency of the waveform in AR). The vertical axis of the lower part of Fig. 6 is Phase (phase of the frequency in AR), and the horizontal axis is Frequency (frequency of the waveform in AR).

[0068] The AR has the characteristic that the phase lags and the gain attenuates in the frequency range higher than ωa. Therefore, in the HPF, ωh and h are functions of AR, ωh(ωa, ζa) and h(ωa, ζa), and by actively leading the phase in the high frequency range by ωh(ωa, ζa)>ωa and actively increasing the gain in the high frequency range by h(ωa, ζa)>2, it is expected that the response delay due to the AR characteristics, as well as the response delay specific to vibration suppression control, will be improved. The filter parameters of the phase adjuster are set based on the vibration characteristics of the machine end (vibration frequency and vibration attenuation coefficient).

[0069] The reason why such an active design of the HPF is possible is that output 2, which is the input of the HPF, does not contain any frequency components that excite vibrations at the machine end.

[0070] Thus, according to this embodiment, in providing a motor control device in which the upper-system control device incorporates a position controller and which is equipped with a means for realizing vibration control within a motor servo control device which is responsible for the speed control system, the response delay which is specific to vibration control caused by the parallel-type vibration control controller 10 can be improved by simple processing, and as a result, the positioning time can be shortened. EXAMPLES

[0071] 7 shows the configuration of a vibration suppression controller 71 in the speed control system of this embodiment, which differs from embodiment 1 in that an FF controller 72, an adder-subtractor 73, and an adder-subtractor 79 are added. Descriptions of the same contents as embodiment 1 will be omitted.

[0072] The configuration of a vibration suppression controller 81 in a speed control system, which is the premise of this embodiment, is shown in Fig. 8. In Fig. 8, an FF controller 85 is provided for the purpose of improving response characteristics when the position controller 22 of the upper-level control device does not include an FF controller. However, the FF controller 85 improves the response delay of the FB loop caused by the FB controller included in the position controller 22, and is not introduced to improve the response delay specific to vibration suppression control.

[0073] The FF controller 72 in this embodiment has the same role as the FF controller 85 in FIG. 8, and is provided for the purpose of improving the response delay of the FB loop caused by the FB controller included in the position controller 22.

[0074] Since the controlled object of a semi-closed position control system is generally a simple integrator 1 / s, the FF controller in the position control system can be simply configured as the product of a scalar gain and a differentiator s, and the FF controller can be provided in the position controller as shown in Figure 9.

[0075] Fig. 9 is a diagram showing a specific configuration of a two-degree-of-freedom controller with a general FF controller. In Fig. 9, an input 94 to the FF controller is a position command. It is a response 96 of the controlled object, such as the output from the position / speed calculator 21 in Fig. 8. An input to an FB controller 92 is the difference between the position command 94 and the response 96 of the controlled object. An output 97 of the position controller is a speed command. Therefore, the FF controller 93 has the property that the input can be expressed in units of position and the output can be expressed in units of speed.

[0076] In addition, the FB controller 92 in Fig. 9 is often a P controller, and therefore the FB controller 92 may simply have a scalar gain (denoted as ωp). Note that the position controller 22 in Fig. 7 is also a P controller with a gain ωp in this case.

[0077] When configuring the model matching two-degree-of-freedom control 100 with a position controller, an FF controller 103 may be provided as shown in Fig. 10 together with a reference model 101. In this case, the FF controller 103 and the reference model 101 may be designated as FFM and M, respectively, and the following equation may be used.

[0078]

number

[0079]

number

[0080] Here, ωf is a parameter that defines a desired response characteristic, and is generally designed so that ωp<ωf.

[0081] The FF controller 72 in Fig. 7 can employ the FF controller 93 in Fig. 9. Furthermore, the FF controller 72 can also be an FF controller in a model matching two-degree-of-freedom control 100 in Fig. 10. In that case, however, the FF controller 72 does not directly use the FF controller 103 in Fig. 10, but uses the following equation. This is the FF controller 93 when the block configuration in Fig. 10 is transformed into the form in Fig. 9.

[0082]

number

[0083] According to the formula (13), when the model matching two-degree-of-freedom control is adopted, the FF controller 72 in FIG. 7 is a high-pass filter HPF F and the position controller 22. Furthermore, the high-pass filter HPF F and unit converter 12.

[0084] High Pass FilterHPF F Comparing with equation (9), it can be seen that the cutoff frequency is ωf, and hf=ωf / ωp corresponds to the adjustment gain h. The filter parameters of the feedforward controller are set based on the vibration characteristics (vibration frequency and vibration damping coefficient) of the machine end.

[0085] 7, in the case of employing the FF controller 72 configured by equation (13), it can be seen that in the configuration of Fig. 7, for a speed command 78 in which the response delay specific to vibration suppression control has been improved by the phase adjuster 1, a speed command 76 in which a predetermined phase characteristic has been improved is obtained by the FF controller 72 due to a phase lead characteristic similar to that of equation (9). This phase lead characteristic plays the role of the FF controller of the position control system, and therefore does not improve the response delay specific to vibration suppression control, but rather plays the role of improving the response delay of the FB loop caused by the FB controller included in the position controller 22.

[0086] In FIG. 7, the input 74 of the FF controller is obtained by adding the input 2 and output 6 of the phase adjuster 1 by an adder-subtracter 73 in order to prevent the output 77 of the FF controller 72 from exciting machine end vibration, and to have the output 77, which has received a result of phase adjustment similar to that of the speed command 78 which has received the phase adjustment result of the phase adjuster 1, act on the speed command 78 via an adder-subtracter 79.

[0087] Therefore, according to this embodiment involving the FF controller 72, in providing a motor control device in which the upper-system control device incorporates a position controller and which is equipped with a means for realizing vibration control within a motor servo control device which is responsible for the speed control system, the response delay specific to vibration control caused by the parallel type vibration control controller 10 can be improved by simple processing, and it is also possible to improve the response delay of the FB loop caused by the FB controller at the same time, thereby making it possible to shorten the positioning time.

[0088] In addition, since ωf specifies the desired response characteristic in FF control and ωp is the control gain of the position controller 22, the parameters included in the formula (13) are uniquely determined and are designed independently of the response characteristic AR of the machine end vibration. However, hf in the formula (13) may be regarded as an adjustment gain, and the ωp of hf may be adjusted as desired.

[0089] This may result in further improvement of the response delay. As already mentioned, the phase adjuster 1 and the FF controller 72 have clear differences in the delay characteristics to be improved, and are assumed to be designed independently, but by deliberately making ωp of hf an adjustment element and performing an appropriate design to balance with the parameters ωh(ωa, ζa) and h(ωa, ζa) of the phase adjuster 1, it may be possible to reduce the response delay of the machine end while suppressing the machine end vibration overall.

[0090] Such an effect can be interpreted as being obtained by regarding the FF controller 72 as playing a role similar to that of the HPF of the phase shifter 1 and adjusting the phase of the speed command 8 using two HPFs. EXAMPLES

[0091] The motor control device according to this embodiment is assumed to be applied to a cascade position feedback control system 1100 of an AC servo motor, which is configured by a host control device and a servo motor control device, as shown in FIG.

[0092] Fig. 12 is a diagram showing a cascade position feedback control system 1200 of an AC servo motor according to the third embodiment. Fig. 12 shows a case where the vibration suppression controller 15 in the speed control system shown in Fig. 1 is applied to Fig. 11. Descriptions of the same contents as in the first embodiment will be omitted.

[0093] The cascade position FB control system of the AC servo motor in FIG. 12 includes an adder-subtractor 1410, an adder-subtractor 1411, an adder-subtractor 1412, a position controller 1315, a speed controller 132, a current controller 133, a first coordinate converter 134 which performs coordinate conversion from the dq coordinate system to the three-phase coordinate system, a second coordinate converter 1310 which performs coordinate conversion from the three-phase coordinate system to the dq coordinate system, a PWM output unit 135 which inputs a three-phase voltage command and outputs a PWM pulse, an inverter (power converter) 136 having switching elements, a current detector 138, a position / speed calculator 1311, a vibration suppression controller 15 in the speed control system, an encoder 139 which measures the rotation speed of the motor, a motor 137, and a machine 1313 which is driven by the motor and is the object of control.

[0094] The vibration suppression controller 15 in the speed control system inputs the motor shaft position response calculated by the position / speed calculator 1311 from the output of the encoder 139 and the position manipulation amount from the position controller 1315, outputs the motor shaft position response to the position controller 1315, and outputs a speed command to the speed controller 132.

[0095] The electric circuit part of the motor is controlled by current controller 133, and on the premise that this control cycle is faster than that of speed controller 132, the current control system is regarded as approximately 1 (the operation amount of the speed controller is directly transmitted to the mechanical part (rotor) of the motor) in the speed control system. Therefore, the controlled object of speed controller 132 is the mechanical part (rotor) of the motor and machine 1313 connected to the rotor of the motor, which corresponds to the controlled object of speed controller 20 in FIG. 1.

[0096] Also, assuming that the control period of the speed controller 132 is faster than the control period of the position controller 1315, the speed control period is regarded as approximately 1 in the position control system.

[0097] The vibration suppression controller 15 in the speed control system is located at the previous stage in the speed control system, processes the speed command which is the output of the upper control device, and generates a command for the speed controller 132 .

[0098] The inertia number of the machine 1313 is set to 1. When the machine 1313 and the motor rotor are elastically coupled, the controlled object can be regarded as a two-inertia system in which the machine 1313 and the motor rotor are coupled by a spring and a damper, and the controlled object has a frequency characteristic including a set of resonance and anti-resonance characteristics.

[0099] Furthermore, if the number of inertia of the machine 1313 is two and each inertia is connected by a spring / damper, one of which is elastically connected to the rotor of the motor, the controlled object can be regarded as a three-inertia system in which each inertia is connected by a spring / damper, and has frequency characteristics including two sets of resonance and anti-resonance characteristics.

[0100] The machine 1313 has low rigidity and has resonance and anti-resonance characteristics in the low frequency range of about several Hz to 100 Hz.

[0101] First, consider Fig. 11 in a state where the vibration suppression controller 15 in the speed control system is not included. If the control gain of the position controller is increased to provide high response control from the position command to the motor shaft position response of the motor 137, and the settings are made to suppress vibrations caused by the resonance and anti-resonance characteristics of the machine 1313, the end of the machine 1313 will vibrate because the rigidity of the machine 1313 is low.

[0102] On the other hand, when the vibration suppression controller 15 in the speed control system is included as shown in FIG. 12, the vibration suppression effect at the machine end can be exhibited as explained in the first embodiment, and the response delay specific to the vibration suppression control can be improved.

[0103] Fig. 13 is a diagram for explaining the effect of vibration damping control of the AC servo motor control system shown in Fig. 12. As shown in Fig. 13, the configuration of Fig. 12 can improve response delay while providing a sufficient vibration damping effect.

[0104] In both the upper and lower parts of Fig. 13, the vertical axis is Mech.angle (position response of the machine end) and the horizontal axis is Times. The position response of the machine end indicates the position to which the machine end, which is the end of the machine connected to the motor, moves as the motor rotates, and corresponds to the motor rotation angle (rad).

[0105] The upper diagram in Fig. 13 is an enlarged view of the lower diagram in Fig. 13. As shown in the lower diagram in Fig. 13, it can be seen that the response performance to a "position command" 1401 is higher in the "with vibration suppression control and with phase adjustment" shown by the solid line in this embodiment, compared to "without vibration suppression control" 1402 and "with vibration suppression control and without phase adjustment" 1403.

[0106] Therefore, according to this embodiment, in a semi-closed AC servo motor control system, it is possible to provide a motor control device in which the upper-system control device incorporates a position controller, is equipped with a means for realizing vibration suppression control within the motor servo control device which is responsible for the speed control system, and is equipped with a means for improving the response delay specific to vibration suppression control through simple processing.

[0107] In this embodiment, the vibration damping controller 15 in the speed control system of the first embodiment is applied to the cascade position feedback control system 1100 of an AC servo motor. However, the vibration damping controller 71 in the speed control system of the second embodiment may also be applied to the cascade position feedback control system 1100 of an AC servo motor.

[0108] In addition to AC servo motor control, DC motor control also has a cascade control configuration using speed / position controllers. Therefore, according to this embodiment, vibration suppression at the machine end can be realized within the speed control system by inserting a vibration suppression controller 15 in the front stage of the speed controller. [Explanation of symbols]

[0109] 1...phase adjuster, 9...position command estimator, 10...parallel type vibration suppression controller, 11...vibration excitation component extractor, 14...speed command, 15...vibration suppression controller in speed control system, 18...actual speed command, 21...position / speed calculator, 23...position response of motor shaft, 24...position command, 72...FF controller, 136...inverter, 137...AC servo motor, 138...current detector, 139...encoder, 201...host system control device, 301...servo motor control device, 1313...machine to be controlled

Claims

1. A motor control device included in a position control system that controls the position of a machine end connected to a motor, The motor control device includes: receiving a first speed command from a host controller; a position control system that outputs a position response of a motor shaft to the host control device; A speed controller; A vibration suppression controller in a speed control system; The vibration suppression controller in the speed control system is a position command estimator that calculates an estimate of a position command based on the first speed command and a position response of the motor shaft; a parallel-type vibration suppression controller that extracts a frequency component that excites vibration of the machine end, which is included in the first speed command, based on the estimated value of the position command, and outputs the extracted frequency component; a phase adjuster for improving a response delay caused by the parallel-type vibration suppression controller; a first unit converter that converts the output of the phase adjuster into a velocity dimension; A computing unit; The computing unit includes: subtracting an output of the parallel-type vibration suppression controller from the first speed command to remove the frequency component that excites vibration of the machine end from the first speed command, and outputting the result as a second speed command; outputting a first actual speed command as an output of a vibration suppression controller in the speed control system based on an output of the first unit converter and the second speed command; A motor control device that uses the first actual speed command as a command for the speed controller.

2. 2. The motor control device according to claim 1, The computing unit includes: a first adder / subtractor that subtracts an output of the parallel-type vibration suppression controller from the first speed command; a second adder-subtractor that adds an output of the first unit converter and the second speed command.

3. 2. The motor control device according to claim 1, The position command estimator an estimation filter having an inverse characteristic of a position controller included in the upper-level control device and a third adder / subtractor; a signal obtained by processing the first speed command through the estimation filter and a position response of the motor shaft are added together in the third adder-subtracter, and the result is output as the estimated value of the position command.

4. 2. The motor control device according to claim 1, The parallel vibration damping controller includes: a vibration excitation component extractor that extracts, without phase delay, a frequency component that excites vibration of the machine end and is included in the first speed command from the estimated value of the position command; a second unit converter that converts the unit of the vibration excitation component signal extracted by the vibration excitation component extractor into a velocity dimension; an output of the second unit converter is set as an output of the parallel-type vibration damping controller; The computing unit includes: Calculating the difference between the input and output of the vibration excitation component extractor; The phase adjuster includes: A motor control device that receives the difference, adjusts the phase, and outputs the phase to the first unit converter.

5. 5. The motor control device according to claim 4, The computing unit includes: a first adder / subtractor that subtracts an output of the parallel-type vibration suppression controller from the first speed command; a second adder / subtractor that adds an output of the first unit converter and the second speed command; a fourth adder / subtractor for subtracting an output from an input of the vibration excitation component extractor.

6. 2. The motor control device according to claim 1, The vibration suppression controller in the speed control system is a feedforward controller for improving a response delay associated with feedback control of a position controller included in the upper-level control device; The computing unit includes: Calculating the input and output of the phase adjuster; The result of the calculation is input to the feedforward controller, calculating a second actual speed command from an output of the feedforward controller and the first actual speed command; A motor control device in which the second actual speed command is an output of a vibration suppression controller in the speed control system.

7. 7. The motor control device according to claim 6, The computing unit includes: a fifth adder / subtractor that adds the input and output of the phase adjuster; a sixth adder / subtractor that adds an output of the feedforward controller and the first actual speed command.

8. 2. The motor control device according to claim 1, The motor control device, wherein the phase adjuster is a high-pass filter.

9. 7. The motor control device according to claim 6, The feedforward controller comprises: A motor control device comprising a high-pass filter.

10. 2. The motor control device according to claim 1, A motor control device in which a filter parameter of the phase adjuster is set based on vibration characteristics of the mechanical end.

11. 7. The motor control device according to claim 6, A motor control device in which filter parameters of the feedforward controller are set based on vibration characteristics of the mechanical end.

12. 2. The motor control device according to claim 1, The host control device includes: A position controller is incorporated in the position control system and generates the position command; The position controller generates the first speed command from the position command and a position response of the motor shaft received from the motor control device.

Citation Information

Patent Citations

  • Motor controller

    JP1998210781A

  • Motor controller

    JP2005168225A

  • Motor controller and motor control system

    JP2008228360A

  • Setting support device and setting support program

    JP2019133494A