The present invention relates to a motor control device that controls the speed and position of a motor.
The motor control device that controls the speed and position of a motor generally performs a speed proportional-integral (PI) control or a control with a feedback loop that is configured using a filter or the like. Control constants that define characteristics of these controls need to be set according to characteristics of a mechanical system to be driven, and thus it is desired that high-speed and high-accuracy control be realized with setting and/or adjustment as simple as possible.
To satisfy this desire, for example, Patent Literature 1 discloses a technique related to a motor control device that has a speed control unit that performs PI control, a torque filter unit in which a low-pass filter is commonly used, and the like, and sets various control constants for setting characteristics of these units based on one parameter inputted from the external according to a specific relational expression.
Meanwhile, when the low-pass filter as in the above is used, stable control is difficult in a case where a mechanical system to be driven has a low rigidity and higher inertia than that of the motor. To solve this problem, a technique intended for a mechanical system which is two-inertia system having a larger load is disclosed in Patent Literature 2.
According to the technique described in Patent Literature 2, a proportional gain (speed gain) of a speed control unit can be stably increased using a phase-lag filter having characteristics that the frequency response gain is constant in a low-frequency region lower than a set first filter frequency and in a high-frequency region higher than a set second filter frequency and that phase lag occurs and the frequency response gain decreases with increase in frequency in an intermediate frequency region therebetween. The “frequency response gain” is hereinafter referred to simply as “gain” when there is no potential for confusion. Patent Literature 2 also discloses a technique in which a parameter set unit is provided to enable to automatically set the first filter frequency and the second filter frequency. As a set method of these frequencies, there is disclosed a method in which the first and second filter frequencies are set based on the proportional gain (speed gain) of the speed control unit, an inertia value of the whole mechanical system and an inertia value of the motor itself with reference to a first crossover frequency ωC1 considered in terms of the inertia of the whole mechanical system and a second crossover frequency ωC2 considered in terms of the inertia of only the motor. Alternatively, there is also disclosed a method in which the frequencies are set with reference to an antiresonant frequency or resonant frequency of the mechanical system.
However, when the common low-pass filter used in the technique described in Patent Literature 1 is used, phase lag due to the low-pass filter occurs. When the inertia of a mechanical system to be driven is considerably larger than that of the motor, the frequency response gain of the control object becomes large in higher frequencies and thus the control system adversely becomes unstable. Furthermore, oscillation is likely to occur also in a mechanical system with complicated characteristics that have a plurality of mechanical resonances and accordingly it is difficult to perform a stable control.
Patent Literature 2 shows a configuration to stably control a low-rigidity mechanical system using a phase-lag filter. However, its setting method only covers two-inertia systems as the control object. Therefore, in the method of setting the first and second filter frequencies with reference to the first crossover frequency ωC1 and the second crossover frequency ωC2, a relation between the first and second filter frequencies is determined only based on a ratio between the inertia of the mechanical system to be driven and the inertia of the motor. As a result, when the load inertia is not so high, a difference between the first crossover frequency ωC1 and the second crossover frequency ωC2 is small, thus leading to small effect of reducing the high frequency gain by using the filter. Furthermore, practical mechanical systems are different from the ideal two-inertia systems mentioned above and have complicated characteristics with a plurality of resonances in many cases, and a factor such as a dead time is included in the feedback loop. Because the parameter set unit described in Patent Literature 2 does not cover these points, the speed gain of a speed controller can not be sufficiently increased in some cases, which complicates realization of high-accuracy control.
The present invention has been achieved in view of the above circumstances, and an object of the present invention is to provide a motor control device that can realize high-speed and high-accuracy control for mechanical systems with a range of characteristics as wide as possible.
In order to solve the above-mentioned problems and achieve the object, the present invention provides a motor control device that drives a motor included in a control object, the motor control device comprising: a speed detection unit that detects a motion speed of the motor and outputs a detection speed; a control computation unit that computes a drive force command for the motor to conform the detection speed with a speed command; an amplifier compensation unit that performs computing of multiplying a feedback transfer function that is a transfer function from the detection speed to the drive force command by a speed gain Kv within the control computation unit; a feedback filter that has filter characteristics that a frequency response gain is substantially one at frequencies equal to or lower than a filter cutoff frequency, a frequency response gain decreases with increase in frequency in a range from the filter cutoff frequency to a filter upper limit frequency higher than the filter cutoff frequency, and a frequency response gain is substantially constant at frequencies equal to or higher than the filter upper limit frequency, and performs computing to apply the filter characteristics to the feedback transfer function within the control computation unit; a control-constant set unit that sets the speed gain Kv and at least one of the filter cutoff frequency and the filter upper limit frequency according to an input from the external; and a drive-force control unit that drives the motor to match a drive force of the motor with the drive force command, wherein the control-constant set unit sets the speed gain Kv and at least one of the filter cutoff frequency and the filter upper limit frequency to decrease a ratio of the filter upper limit frequency to the filter cutoff frequency with increase in the speed gain Kv.
According to the present invention, gains at higher frequencies can be decreased while a frequency range in which the phase of a feedback filter lags is narrowed with increase in the speed gain Kv. Therefore, a high-speed and high-accuracy control can be realized for a mechanical system with a range of characteristics as wide as possible.
Embodiments of a motor control device according to the present invention will be described below in detail with reference to the drawings. The present invention is not limited to the embodiments.
The motor control device 101 includes a torque control unit (drive-force control unit) 4, a speed detection unit 5, a control computation unit 102, and a control-constant set unit 105.
The speed detection unit 5 computes a speed at which the motor 1 moves based on the detected motion vm of the motor 1, and outputs the computed speed as a detection speed vb. The control computation unit 102 includes an amplifier compensation unit 103 that performs compensation amplification computing and a feedback filter 104 that performs filter computing, and outputs a torque command τr obtained through computing of feedback control for the detection speed vb to follow the speed command vr based on the speed command vr as the motion command and the detection speed vb. The torque control unit 4 controls a current of the motor 1, thereby performing control to match the torque τm generated from the motor 1 with the torque command τr.
The control-constant set unit 105 sets characteristics of the computing operation of the control computation unit 102 including the amplifier compensation unit 103 and the feedback filter 104, that is, constants to be used in the computing based on the response parameter Pr set from the external in a manner explained later.
[Computing of Control Computation Unit 102]
Now, a computing process of the control computation unit 102 including the amplifier compensation unit 103 and the feedback filter 104 is explained.
The control computation unit 102 receives the speed command vr and the detection speed vb. Within the control computation unit 102, the amplifier compensation unit 103 performs computing of a usual proportional-integral control for the detection speed vb to follow the speed command vr based on the speed command vr and the detection speed vb. That is, computing according to the following expression is performed through proportional compensation of multiplying a speed deviation, which is a deviation between the speed command vr and the detection speed vb, by a speed gain Kv, and integral compensation in which the inverse of an integral time constant is ωi to output a compensation torque τc as an intermediate variable in the control computation unit 102. In the next and subsequent expressions, “s” is a Laplace operator and 1/s denotes integration.
τc=Kv·{1+(ωi/s)}(vr−vb) (Expression 1)
The feedback filter 104 receives the compensation torque τc outputted from the amplifier compensation unit 103 as an input, and outputs the torque command τr through computing of a transfer function F(s) to relatively reduce the frequency response gain at higher frequencies than a predetermined filter cutoff frequency ωfL. The feedback filter 104 has frequency response characteristics, as a filter property, that the gain is substantially one in a low frequency region lower than the filter cutoff frequency ωfL, the gain decreases with increase in frequency in an intermediate frequency region from the filter cutoff frequency ωfL to a filter upper limit frequency ωfH higher than the filter cutoff frequency ωfL, and the gain is substantially constant in a high frequency region higher than the filter upper limit frequency ωfH. Contents of a computing process of the feedback filter 104 are explained in detail later.
While phase characteristics of the feedback filter 104 are not mentioned above, a filter to be used for the feedback control is practically within a category called minimum phase shift system and thus the phase characteristics are uniquely determined when the characteristics of the frequency response gain are determined. Specifically, when being provided with the gain characteristics mentioned above, the feedback filter 104 accordingly has phase characteristics that the phase relatively lags in the intermediate frequency region.
Through this computing, the control computation unit 102 performs computing in which a transfer function (hereinafter, described as feedback transfer function) from the detection speed vb to the torque command τr is represented by the following expression 2. That is, the control computation unit 102 performs computing to multiply the feedback transfer function by the speed gain Kv through the computing of the amplifier compensation unit 103 and to apply the filter characteristics mentioned above to the feedback transfer function through the computing of the feedback filter 104.
τr/vb=−F(s)·Kv{(s+Kpi)/s} (Expression 2)
[Characteristics of Control Object]
Now, general characteristics of the mechanical system 3 to be driven by the motor control device 101 according to the present invention, the torque control unit 4, and the speed detection unit 5 are explained below. While the computing characteristics of the control computation unit 102 that performs the computing of the torque command τr based on the detection speed vb are set according to the characteristics of the mechanical system 3 to be driven, the torque control unit 4 and the speed detection unit 5 are configured to have normally fixed characteristics that do not depend on the characteristics of the mechanical system 3. Therefore, characteristics from the torque command τr to the detection speed vb, that is, a combined part of the torque control unit 4, the mechanical system 3 and the speed detection unit 5 is referred to as a control object.
Characteristics in a case where the mechanical system 3 is assumed to be an ideal rigid body are explained first. In this case, a transfer function from the torque τm generated from the motor 1 to the mechanical system 3, that is, the actual motion speed of the motor 1 has pure integral characteristics. That is, the gain of the frequency response decreases with increase in frequency at a slope of −20 [dB/dec] and the phase is constant in −90 [deg]. Meanwhile, the characteristics of the torque control unit 4, that is, the transfer characteristics of the torque τm generated by the motor 1 in response to the torque command τr have some lag. The speed detection unit 5 computes the detection speed vb, for example, through a difference operation of an output of the encoder that has detected the motion of the motor 1 as mentioned above. However, a certain amount of time is required for transmission of a signal and the computing process, and therefore the detection speed vb becomes a signal having some delay as compared with the speed at which the motor 1 actually moves.
Herein, a frequency at which the sum of phase lags occurring in the torque control unit 4 and the speed detection unit 5 is −90 [deg] is referred to as a phase reference frequency ωq. As shown in
The phase reference frequency ωq is determined only by the phase lag characteristics of the torque control unit 4 and the speed detection unit 5 and thus can be determined by determining the frequency response from the torque command τr to the detection speed vb in a state where only the motor 1 is driven by the motor control device 101. Alternatively, the phase reference frequency ωq can be determined as a frequency of oscillation occurring when the control computation unit 102 is caused to have characteristics of a simple speed proportional control and the control gain thereof is increased in the same state where only the motor 1 is driven. That is, the phase reference frequency ωq can be determined beforehand without the mechanical load 2 being actually connected to the motor 1 and driven. In the present embodiment, the phase reference frequency is defined as 10000 [rad/s] as an example.
Practical characteristics in a case where the mechanical system 3 is not an ideal rigid body are explained next. The mechanical system 3 generally has a plurality of mechanical resonances due to a low rigidity of a coupling or shaft (not shown) that connects the motor to the mechanical load 2, or the mechanical load 2 itself. Furthermore, in many motors for industrial applications, the motor 1 and a motion detector such as an encoder (not shown) are configured in an integrated manner and a condition called collocation is met in which a drive-force generation part and a motion detecting part are sufficiently close to each other. In this case, it is theoretically known that anti-resonances and resonances alternately appear with increase in frequency and the phase does not lag by more than −90 [deg] in a transfer function from a generation torque of the motor 1 to an actual speed of the motor 1. That is, the phase lag does not become larger over all frequencies than in the case where the mechanical system 3 is an ideal rigid body.
Broken lines in
[Details of Feedback Filter 104]
Details of the configuration of the feedback filter 104 according to the first embodiment are explained below. The feedback filter 104 has a transfer function with a denominator and a numerator that each have the same predetermined order n (n is an integer equal to or larger than one). That is, the feedback filter 104 performs computing represented by the transfer function of the following expression using a denominator polynomial Df(s) and a numerator polynomial Nf(s) which are represented by polynomials of s having n-th-order, respectively.
F(s)=Nf(s)/Df(s) (Expression 3)
The feedback filter 104 in the present embodiment performs computing in which the denominator polynomial Df(s) and the numerator polynomial Nf(s) are represented by products of n polynomials as the following expressions using frequencies of n poles (hereinafter, simply “poles”) ωp_i [rad/s] and frequencies of n zero-points (hereinafter, simply “zero points”) ωz_i [rad/s], respectively. In this case, each of “i” in “_i” which indicates the suffix, is an integer from 1 to n.
Df(s)={(1/ωp—1)s+1} . . . {(1/ωp—n)s+1} (Expression 4)
Nf(s)={(1/ωz—1)s+1} . . . {(1/ωz—n)s+1} (Expression 5)
In (Expression 4) and (Expression 5), the n poles ωp_i are assigned with the suffixes i in the ascending order and similarly the n zero points ωz_i are assigned with the suffixes i in the ascending order. The first, or the lowest pole ωp—1 is associated with the above-mentioned filter cutoff frequency ωfL, the nth, or the highest zero point ωz_n is associated with the filter upper limit frequency ωfH, and the first to nth poles ωp_i and zero points ωz_i are set to alternate the pole and the zero point in the ascending order of absolute values thereof. That is, the poles ωp_i and the zero points ωz_i are set to have the following relationship.
ωfL=ωp—1<ωz—1< . . . <ωp—n<ωz—n=ωfH (Expression 6)
As a result of this setting, the frequency response characteristics of the feedback filter 104 represented by (Expression 3) to (Expression 5) are such that the gain is substantially one in a low frequency region lower than the filter cutoff frequency ωfL, that is, the lowest pole ωp_1, the gain decreases as the frequency increases in an intermediate frequency region between the filter cutoff frequency ωfL and the filter upper limit frequency ωfH, and the gain is substantially constant in a high frequency region higher than the filter upper limit frequency ωfH, that is, the highest zero point ωz_n to converge to Gh represented by the following expression 7, as shown in
Gh=(ωz—1 . . . ωz—n)/(ωp—1 . . . ωp—n) (Expression 7)
Furthermore, the phase characteristics of the transfer function F(s) of the feedback filter 104 are such that the phase is between −90 [deg] and 0 [deg] in the intermediate frequency region between the filter cutoff frequency ωfL and the filter upper limit frequency ωfH, the phase approaches zero as the frequency decreases in the low frequency region lower than the filter cutoff frequency ωfL, and the phase approaches zero as the frequency increases in the high frequency region higher than the filter upper limit frequency ωfH. Therefore, the feedback filter 104 has characteristics that the phase is larger than −90 [deg] over all frequencies.
[Operation of the Control-Constant Set Unit]
An outline of operations of the control-constant set unit 105 is explained. The response parameter Pr is inputted from the external to the control-constant set unit 105. The response parameter Pr is for setting a response speed of the motor control device 101 that operates to match the detection speed vb with the speed command vr, and may be either a continuous value such as a frequency indicating the response speed or a time constant of an inverse thereof, or a stepwise parameter such as large/medium/small. The response parameter Pr is determined according to an application to which the motor control device 101 is applied and/or characteristics of the mechanical system 3 to be driven, and considering stability of the control system or a desired response speed. The speed gain Kv itself may be inputted as the response parameter Pr.
When the response speed of the motor control device 101 is to be set higher, the control-constant set unit 105 have an input of the response parameter Pr to set the speed gain Kv in the computing of (Expression 1) in the amplifier compensation unit 103 of the control computation unit 102 to have a higher level. The inverse of the integral time constant is set at a value about 0.1 to 0.5 time as large as a gain crossover frequency ωc obtained by dividing the speed gain Kv by an inertia value J of the mechanical system 3. At the same time as this setting of the amplifier compensation unit 103, the control-constant set unit 105 sets the characteristics of the feedback filter 104 as follows. The inertia value J may be inputted from the external as a set value or may be determined by estimation based on the torque command τr and the detection speed vb.
The control-constant set unit 105 also sets the filter cutoff frequency ωfL at a value between a similar value and a slightly larger value than the gain crossover frequency ωc, usually at a value about 1 to 5 times as large as the gain crossover frequency ωc. The filter upper limit frequency ωfH is set at a value slightly smaller than the phase reference frequency ωq mentioned above, usually at a value about 0.2 to 1 time as large as the phase reference frequency ωq. For ease of explanations, the description will be directed to a case where the gain crossover frequency ωc is sufficiently lower than the phase reference frequency ωq and accordingly the filter cutoff frequency ωfL is set smaller than the filter upper limit frequency ωfH in the setting mentioned above.
In a case where a certain mechanical system 3 is to be driven, when the speed gain Kv is increased, the gain crossover frequency ωc increases in proportion to the speed gain Kv. Meanwhile, the phase reference frequency ωq has a value that does not depend on the speed gain Kv. Therefore, the control-constant set unit 105 performs setting such that a ratio of the filter upper limit frequency ωfH to the filter cutoff frequency ωfL is reduced when the speed gain Kv is increased according to input of the response parameter Pr. As a result, the intermediate frequency region mentioned above, that is, a frequency range in which the phase lag of the feedback filter 104 is large is narrowed on a logarithmic axis with increase in the speed gain Kv.
With the operation of the control-constant set unit 105 mentioned above, the feedback filter 104 has frequency response characteristics of reducing the gain at frequencies somewhat higher than the gain crossover frequency ωc without too much increasing the phase lag near the gain crossover frequency ωc and reducing the phase lag also near the phase reference frequency ωq.
[Details of Feedback Filter Setting]
Details of the setting of the feedback filter 104 performed by the control-constant set unit 105, the outline operation of which has been explained above, are explained below. The control-constant set unit 105 calculates an upper reference frequency ωH by multiplying the phase reference frequency ωq by a predetermined constant rH. The constant rH is substantially in a range from 0.2 to 1. Because the phase reference frequency ωq and the constant rH can be previously defined, the upper reference frequency ωH itself may be previously defined. The control-constant set unit 105 also calculates a lower reference frequency ωL by multiplying the gain crossover frequency ωc which is determined according to the inputted response parameter Pr, by a predetermined constant rL. The constant rL is set substantially in a range from 1 to 5. That is, the upper reference frequency ωH and the lower reference frequency ωL are calculated in the following expressions.
ωH=rH·ωq (Expression 8)
ωL=rL·ωc (Expression 9)
In the control-constant set unit 105, n constants αp_i corresponding to the poles ωp_i of the filter as many as the order number n of the feedback filter 104 mentioned above, and n constants αz_i corresponding to the n zero points ωz_i (i is an integer from 1 to n) are previously set to meet a relation according to the following expression 10.
0≦αp—1<αz—1< . . . <αp—n<αz—n≦1 (Expression 10)
The control-constant set unit 105 calculates the n poles ωp_i and the n zero points ωz_i in the feedback filter 104 by the following expressions using the upper reference frequency ωH, the lower reference frequency ωL, and the n constants αp_i and n constants αz_i previously set, and sets the calculated poles and zero points.
ωp—i={ωL^(1−αp—i)}·ωH^(αp—i) (Expression 11)
ωz—i={ωL^(1−αz—i)}·ωH^(αz—i) (Expression 12)
With the setting according to the above expressions, the ith pole ωp_i is set to a frequency obtained by dividing a range between the upper reference frequency ωH and the lower reference frequency ωL at a ratio of αp_i:(1−αp_i) on an axis on which the frequency is expressed logarithmically. Similarly, the ith zero point ωz_i is set to a frequency obtained by dividing the range between the upper reference frequency ωH and the lower reference frequency ωL at a ratio of αz_i:(1−αz_i) on the logarithmic axis. Because ωp—1 is the filter cutoff frequency ωfL and ωz_n is the filter upper limit frequency ωfH as mentioned above, the poles and the zero points of the feedback filter 104 are set to meet (Expression 6) by setting the constants αp_i and αz_i according to (Expression 10).
In the calculation according to (Expression 11) and (Expression 12), there is performed calculation with an exponent of a rational number not smaller than 0 and not larger than 1, not limited to an integer, using the constants αp_and αz_i. To realize this calculation, it is preferable to select the n constants αp_i and n constants αz_i to meet (Expression 10) and to be represented by products of values obtained by multiplying (½) by itself as many times as a predetermined integer “a” and a predetermined integer “b”, respectively. The number “a” of the number of times of multiplications of (½) can have different values according to “i” or between αp_i and αz_i. Similarly, the integer “b” can have different values according to “i” or between αp_i and αz_i. In this way, in (Expression 11) and (Expression 12), exponentiation operations having αp_i and αz_i which are not integers as exponents can be realized, for example, by “a” sets of square-root operations and “b” sets of multiplication operations for the upper reference frequency ωH, and can be realized without using an expensive computing device even with computation that can be installed therein.
A theoretical background related to the setting of the feedback filter 104 by the control-constant set unit 105 is added below. For ease of theoretical explanations, it is assumed that ωfL<<ωfH and that the order n of the feedback filter 104 is a sufficiently-large integer. It is the case to be considered that the magnitude relation represented by (Expression 6) and the same relation as that in the approximation realization method of a fractional order integration described in Chapter 5 in Non Patent Literature 1 are provided to the poles ωp_i and the zero points ωz_i of the feedback filter 104.
For this purpose, the n constants αp_i and the n constants αz_i are set to be arithmetic sequences having intervals Δα between adjacent ones, respectively, and also in such a manner that a difference between αz_i and αp_i is k (0<k<1) times as large as Δα. In this case, the transfer function F(s) of the feedback filter 104 is approximated to characteristics of a fractional order integration represented by the following expression at frequencies between ωfL and ωfH. The constant k in the following expression is a rational number having a relation of 0≦k≦1.
F(s)=1/(s^k) (Expression 13)
The phase of the fractional order integration of the k-th order represented by Expression 13 is constant to be −90 k [deg]. Therefore, when the control-constant set unit 105 and the feedback filter 104 are configured as in the present embodiment and ωp_i and ωz_i are set in such a manner that the fractional order k based on the theoretical background has a desired value, it is possible to set the phase to have a desired value between −90 [deg] to 0 [deg] in a frequency range between ωfL and ωfH even when the frequency range is wide.
The control by the motor control device 101 according to the present embodiment is specifically explained using numerical values.
The poles ωp_i and the zero points ωz_i of the feedback filter 104 shown in
0=αp—1<αz—1<αp—2<αz—2<1 (Expression 14)
In the specific example, because αp—1 is set at 0 as shown in the above expression, ωp—1, that is, the filter cutoff frequency ωfL is determined to be equal to the lower reference frequency ωL, which is a constant multiple of the gain crossover frequency ωc.
When the control-constant set unit 105 sets the characteristics of the feedback filter 104 as mentioned above, the transfer function F(s) of the feedback filter 104 has frequency response characteristics that the gain reduces at higher frequencies than the filter cutoff frequency ωfL, the gain is substantially one in a frequency region lower than the filter cutoff frequency ωfL, the gain reduces as the frequency increases in an intermediate frequency region between the filter cutoff frequency ωfL and the filter upper limit frequency ωfH, and the gain is substantially constant in a frequency region higher than the filter upper limit frequency ωfH as shown in the gain diagram of
As shown in the phase diagram of
A frequency response of an open-loop transfer function of a control system in a case where the mechanical system 3 is assumed to be an ideal rigid body in the specific example is shown in
While the frequency response of the open-loop transfer function in the case where the mechanical system 3 is an ideal rigid body is shown in
In this way, as shown in
While the setting operation of the feedback filter 104 in the control-constant set unit 105 is performed based on the gain crossover frequency ωc which is obtained by dividing the speed gain Kv by the inertia value of the mechanical system 3 in the above explanations, the same effect can be obtained by approximation without using a precise inertia value J, for example, in a case where a potential range of the inertia value of the mechanical system 3 is narrow. While the setting operation of the feedback filter 104 in the control-constant set unit 105 is based on the previously-determined phase reference frequency ωq, the same effect can be obtained by setting the phase reference frequency ωq, for example, to an empirical value without beforehand obtaining a precise value of the phase reference frequency ωq. That is, when the control-constant set unit 105 sets the characteristics of the feedback filter 104 to increase the ratio of the filter cutoff frequency ωfL to the filter upper limit frequency ωfH in a range equal to or smaller than one, in other words, to decrease the ratio of the filter upper limit frequency ωfH to the filter cutoff frequency ωfL, as the speed gain Kv increases, the same effect can be obtained.
The above-described control computation unit 102 is configured to cause the amplifier compensation unit 103 to make computation based on a deviation between the speed command vr and the detection speed vb and then cause the feedback filter 104 to respond to the computation result in this order, but this order is not particularly a limitation. That is, the control computation unit 102 may be configured to cause the feedback filter 104 of the transfer function represented by (Expression 3) to respond to a deviation between the speed command vr and the detection speed vb and then subject the output of the filter 104 to computation operations of a proportional-integral control based on the same input/output relation as in (Expression 1), thereby performing of operations by which a transfer function (feedback transfer function) from the detection speed vb to the torque command τr is exactly the same as (Expression 2).
The above-described motor control device 101 has a configuration of a speed control system that conforms the detection speed vb to the speed command vr, but it is needless to mention that the motor control device 101 can be configured as a position control system including the speed control system as a minor loop.
While the amplifier compensation unit 103 performs the proportional-integral computing in the above explanations, it is sufficient to perform computing such as multiplication of an feedback transfer function from the detection speed vb to the torque command τr by the speed gain Kv, and it is needless to mention, integral compensation may be omitted if it is unnecessary in a case where a steady-state deviation is allowable, in a case where it is used as a minor loop for a position control system or in like other cases. Furthermore, it is needless to mention that the features of the first embodiment are not lost at all even when low-pass characteristics of eliminating frequency components sufficiently higher than the filter upper limit frequency ωfH are added to the amplifier compensation unit 103.
As described above, according to the first embodiment, the control computation unit 102 includes: the amplifier compensation unit 103 that performs the computing of multiplying the feedback transfer function by the speed gain Kv; and the feedback filter 104 that has the frequency response characteristics of causing the gain to be substantially one on a lower frequency side than the filter cutoff frequency, reducing the gain as the frequency increases in a range from the filter cutoff frequency ωfL to the filter upper limit frequency ωfH higher than the filter cutoff frequency ωfL, and causing the gain to be substantially constant on a higher frequency side than the filter upper limit frequency ωfH, and that performs the computing of reducing the frequency response gain of the feedback transfer function at higher frequencies than the filter cutoff frequency ωfL, and the control-constant set unit 105 is configured to set the speed gain Kv, the filter cutoff frequency ωfL and the filter upper limit frequency ωfH so as to reduce the ratio of the filter upper limit frequency ωfH to the filter cutoff frequency ωfL as the speed gain Kv increases. Therefore, the frequency range in which the phase of the feedback filter 104 lags is narrowed as the speed gain Kv increases, and thus the high frequency gain of the open-loop transfer function can be reduced as far as possible according to the magnitude of the speed gain Kv without making the phase crossover frequency lowered. Accordingly, even when the inertia of the mechanical load 2 is higher than that of the motor 1 or when it is not higher, or even when there are a plurality of mechanical resonances, the stability can be enhanced as much as possible according to the speed gain Kv. This enables to set the speed gain Kv at a value as high as possible, so that a high-speed and high-accuracy control can be realized for the mechanical system with a range of characteristics as wide as possible. Because the filter cutoff frequency ωfL and the filter upper limit frequency ωfH are set based on the speed gain Kv, it is only necessary to input the response parameter Pr for determining the speed gain Kv as a variable parameter to be set, and therefore the high-speed and high-accuracy control can be realized by simple setting.
While the feedback filter 104 has a second order configuration in the first embodiment, a motor control device having an equivalent effect can be realized even when the feedback filter 104 has a simpler first order configuration.
The control computation unit 202 includes the amplifier compensation unit 103 and a feedback filter 204. The feedback filter 204 is a first-order filter as a replacement for the second-order feedback filter 104 in the first embodiment. The control-constant set unit 205 has a characteristic setting method different from that of the control-constant set unit 105 in the first embodiment because the feedback filter 204 differs from the filter 104 of the first embodiment.
[Feedback Filter 204]
Contents of a computing process performed by the feedback filter 204 are explained below. The feedback filter 204 receives an input of the compensation torque τc outputted by the amplifier compensation unit 103 same as in the first embodiment. A result obtained by performing computing F(s) of a first-order filter represented by the following expression using a filter cutoff frequency ωfL and a filter upper limit frequency ωfH set by the control-constant set unit 205 is outputted as the torque command τr to relatively reduce the gain at higher frequencies than the filter cutoff frequency ωfL. That is, the feedback filter 204 is a first-order filter with the filter cutoff frequency ωfL as a pole and the filter upper limit frequency ωfH as a zero point.
F(s)={(s/ωfH)+1}/{(s/ωfL)+1} (Expression 15)
The filter upper limit frequency ωfH is set equal to or higher than the filter cutoff frequency ωfL. The feedback filter 204 has characteristics of causing the gain to be substantially one in a low frequency region lower than the filter cutoff frequency ωfL, reducing the gain as the frequency increases in an intermediate frequency region from the filter cutoff frequency ωfL to the filter upper limit frequency ωfH, and causing the gain to be a value lower than that in the low frequency region in a high frequency region higher than the filter upper limit frequency ωfH to be substantially constant.
The transfer function F(s) of the feedback filter 204 has phase characteristics of, when the ratio between the filter upper limit frequency ωfH and the filter cutoff frequency ωfL is in a certain range, causing the phase to be between −90 [deg] and 0 [deg] in the intermediate frequency region between the filter upper limit frequency ωfH and the filter cutoff frequency ωfL, causing the phase to approach 0 [deg] as the frequency decreases at lower frequencies than the filter cutoff frequency ωfL, and causing the phase to approach 0 [deg] as the frequency increases at higher frequencies than the filter upper limit frequency. However, unlike the feedback filter 104 in the first embodiment, when the ratio of the filter upper limit frequency ωfH to the filter cutoff frequency ωfL becomes considerably large, the phase gradually approaches −90 [deg] in the center of the intermediate frequency region.
[Control-Constant Set Unit 205]
An operation of the control-constant set unit 205 is explained below. As in the first embodiment, when the response speed of the motor control device 201 is to be set at a higher level, the control-constant set unit 205 sets the speed gain Kv in the amplifier compensation unit 103 of the control computation unit 202 at a larger value based on the response parameter Pr inputted from the external. The control-constant set unit 205 also sets the inverse ωi of the integral time constant in the amplifier compensation unit 103 as in the first embodiment. At the same time, with increase in the speed gain Kv, the filter cutoff frequency ωfL and the filter upper limit frequency ωfH of the feedback filter 204 are set as follow.
As in the first embodiment, the control-constant set unit 205 calculates the upper reference frequency ωH by multiplying the phase reference frequency ωq by the constant rH. In this case, the constant rH is substantially in a range from 0.2 to 1, and the upper reference frequency ωfH itself may be previously determined. The control-constant set unit 205 calculates the lower reference frequency ωL by multiplying the gain crossover frequency ωc which is obtained by dividing the speed gain Kv determined according to the input response parameter Pr by the inertia value J of the mechanical system 3, by the previously determined constant rL. The constant rL is set substantially in a range from 1 to 5. That is, the upper reference frequency ωH and the lower reference frequency ωL are calculated according to (Expression 8) and (Expression 9) as in the first embodiment.
If the filter cutoff frequency ωfL is matched with the lower reference frequency ωL and the filter upper limit frequency ωfH is matched with the upper reference frequency ωH, the phase of the feedback filter 204 approaches −90 [deg] and the phase of the open-loop transfer function of the control system is near −180 [deg] in the center of the intermediate frequency region as mentioned above when the speed gain Kv is low and the gain crossover frequency ωc and the phase reference frequency ωq are greatly different from each other. Therefore, oscillation may occur when there is some mechanical resonance of the mechanical load 2 at frequencies near the center of the intermediate frequency region. For this reason, a maximum value Rmax of the ratio between the filter upper limit frequency ωfH and the filter cutoff frequency ωfL is previously defined and then the filter cutoff frequency ωfL and the filter upper limit frequency ωfH are determined as follows.
ωfL=ωL (Expression 16)
ωfH=min(Rmax·ωL,ωH) (Expression 17)
Alternatively, the filter cutoff frequency ωfL and the filter upper limit frequency ωfH are determined as follows.
ωfH=ωH (Expression 18)
ωfL=max(ωH/Rmax,ωL) (Expression 19)
In this case, the symbol “min(a, b)” used above denotes selection of a smaller one of “a” and “b”, and “max(a, b)” denotes selection of a larger one of “a” and “b”.
As shown in
As shown in
To compare
However, as shown in
In the explanations of the second embodiment, calculation of Expression 16 or 18 is performed regarding the filter cutoff frequency ωfL and the filter upper limit frequency ωfH as being equal to the lower reference frequency ωL and the upper reference frequency ωH, respectively, for purpose of simplified calculation. However, the filter cutoff frequency ωfL or the filter upper limit frequency ωfH may be calculated by assuming the order n in the explanations of the feedback filter 104 in the first embodiment to be one, setting the constants αp—1 and αz—1 different from 0 or 1 to meet the relation according to Expression 10, and using Expression 11 or 12. With this configuration, while the calculation becomes more complicated, change in phase can be smoothed compared to the characteristics shown in
As described above, according to the second embodiment, while the order of the feedback filter 204 is one, the control-constant set unit 205 sets the speed gain Kv, the filter cutoff frequency ωfL, and the filter upper limit frequency ωfH to decrease the ratio of the filter upper limit frequency ωfH to the filter cutoff frequency ωfL as the speed gain Kv increases. Therefore, a high-speed and high-accuracy control can be realized for the mechanical system having a range of characteristics as wide as possible, as in the first embodiment. Because it is only necessary to input the response parameter Pr for defining the speed gain Kv as a variable parameter to be set, the high-speed and high-accuracy control can be realized by simple setting.
While the feedback filter 104 in the control computation unit 102 receives the output of the amplifier compensation unit 103 as an input and outputs the torque command τr in the first embodiment, a feedback filter 304 in the control computation unit 302 receives the detection speed vb as an input and outputs a filter speed vbf as an intermediate variable in the control computation unit 302 in the third embodiment.
The control computation unit 302 includes an amplifier compensation unit 303 and the feedback filter 304. The feedback filter 304 receives the detection speed vb outputted by the speed detection unit 5 as an input and performs computing of exactly the same transfer function as that in the feedback filter 104 in the first embodiment to output the filter speed vbf. That is, computing according to the following expression is performed.
vbf=F(s)·vb (Expression 20)
The amplifier compensation unit 303 performs the same or similar computing as that in the proportional-integral control explained in the first embodiment based on the speed command vr and the filter speed vbf to conform the filter speed vbf with the speed command vr, and outputs a result of the computing as the torque command τr.
While the computing in the amplifier compensation unit 303 may be exactly the same proportional-integral operation as in the amplifier compensation unit 103 in the first embodiment except for the input and the output, it is assumed in the explanations of the present embodiment that computing called I-P control is performed. That is, the compensation torque τr is calculated according to the following expression 21 based the speed command vr and the filter speed vbf.
τr=Kv·{(ωi/s)(vr−vbf)−vbf} (Expression 21)
By performing the computing called I-P control, an effect to reduce overshoot in the response characteristics of the detection speed vb or the filter speed vbf to the speed command vr can be obtained. Meanwhile, response characteristics to disturbance affecting the mechanical system 3 are exactly the same as those in the case where the PI control is performed.
With the configuration of the present embodiment mentioned above, a feedback transfer function which is a transfer function from the detection speed vb to the torque command τr is represented by the following expression based on (Expression 20) and (Expression 21), though there is a difference in configuration from the first embodiment.
τr/vb=−Kv{(s+Kpi)/s}·F(s) (Expression 22)
That is, the feedback control according to exactly the same transfer function as that of (Expression 2) in the first embodiment is performed. The amplifier compensation unit 303 in the control computation unit 302 performs the computing according to (Expression 22) to multiply the feedback transfer function by the speed gain Kv, and the feedback filter 304 performs the computing according to (Expression 22) to reduce the gain of the feedback transfer function at higher frequencies than the filter cutoff frequency ωfL as in the first embodiment.
Therefore, the control-constant set unit 305 performs exactly the same operation as the control-constant set unit 105 in the first embodiment, whereby the response characteristics to disturbance affecting the mechanical system 3 can be set according to the response parameter Pr in exactly the same manner as in the first embodiment.
When the feedback filter 304 and the control-constant set unit 305 are configured in the same manner as the feedback filter 204 and the control-constant set unit 205 in the second embodiment, respectively, it is needless to mention that the third embodiment can obtain the same effects as the second embodiment.
As described above, according to the third embodiment, even when the feedback filter 304 is provided at the previous stage of the amplifier compensation unit 303, the high-speed and high-accuracy control can be realized for the mechanical system with as wide a range of characteristics as possible as in the first embodiment. Because it is sufficient to input the response parameter Pr for defining the speed gain Kv as a variable parameter to be set, the high-speed and high-accuracy control can be realized by simple setting.
As described above, the motor control device according to the present invention is suitable to be applied for a motor control device that controls the speed and/or position of a motor.
Number | Date | Country | Kind |
---|---|---|---|
2010-248432 | Nov 2010 | JP | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP2011/073212 | 10/7/2011 | WO | 00 | 4/12/2013 |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO2012/060180 | 5/10/2012 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
5504404 | Tamaki et al. | Apr 1996 | A |
7106017 | Kifuku et al. | Sep 2006 | B2 |
7183738 | Ikeda et al. | Feb 2007 | B2 |
7257478 | Sugano | Aug 2007 | B2 |
7389172 | Sugano | Jun 2008 | B2 |
8050825 | Ikeda et al. | Nov 2011 | B2 |
Number | Date | Country |
---|---|---|
1692548 | Nov 2005 | CN |
2002 27772 | Jan 2002 | JP |
2005 328607 | Nov 2005 | JP |
2007 134823 | May 2007 | JP |
2005 064781 | Jul 2005 | WO |
Entry |
---|
Odai, M., et al., “Controller Design Robust to Nonlinear Elements based on Fractional Order Control System,” T. IEE Japan, vol. 120-D, No. 1, pp. 11-18, (2000) (with English abstract). |
International Search Report Issued Dec. 13, 2011 in PCT/JP11/73212 Filed Oct. 7, 2011. |
Office Action issued Jan. 6, 2015 in Chinese Patent Application No. (with English Translation). |
Number | Date | Country | |
---|---|---|---|
20130214718 A1 | Aug 2013 | US |