The present invention relates to a motor control device.
There conventionally is an electric power steering system. An electric power steering system (hereinafter referred to as “EPS”) assists steering by a steering wheel, by applying torque from a motor to a steering mechanism. A control device of the EPS calculates a target current value according to steering torque applied to the steering wheel, and controls power feed to the motor, based on the target current value that is calculated. Thus, the motor generates torque corresponding to the steering torque.
In EPSs, vibrations generated due to torque ripple of the motor or reduction gear are readily conveyed to the steering wheel. Accordingly, torque differential control, such as described in Patent Document 1, for example, is performed. The control device calculates a torque differential value by differentiation of the steering torque detected by a torque sensor, and corrects the target current value in accordance with the torque differential value that is calculated. This suppresses vibrations due to torque ripple.
Executing torque differential control certainly does enable suppression of vibrations caused by torque ripple. However, torque differential control may not be able to suppress vibrations due to torque ripple to a required level. Accordingly, there is demand to more appropriately suppress vibrations due to torque ripple. Also, motors are used as drive sources not only for electric power steering systems but also for various types of mechanical devices. There also is demand to reduce vibrations due to torque ripple in the motors of these mechanical devices as well.
A motor control device according to an aspect of the present disclosure controls a motor of a mechanical device. The motor control device includes a command value calculation unit configured to calculate a command value for controlling the motor, and a disturbance observer unit configured to estimate a disturbance applied to the mechanical device, based on the command value and rotation information of the motor, and to correct the command value based on the disturbance that is estimated. The disturbance observer unit has a parameter that is adjusted to compensate for effects of the disturbance having a specific frequency that is an object of suppression. The disturbance that is applied to the mechanical device after the effects of the disturbance have been compensated for is a post-compensation disturbance, and the parameter is adjusted such that the disturbance following compensation for the disturbance has a frequency characteristic corresponding to an antiresonance characteristic of the mechanical device.
A motor control device 11 according to an embodiment will be described.
As illustrated in
The motor control device 11 has a microcomputer 21, an inverter 22, and a current sensor 23.
The microcomputer 21, which is a processing circuit, has a command value calculation unit 31 and a feedback calculation unit 32. These calculation units are functional parts realized by a CPU (central processing unit) of the microcomputer 21 executing a control program. The microcomputer 21 includes memory that stores the control program. The memory includes computer-readable media such as RAM (Random Access Memory) and ROM (Read Only Memory). However, each calculation unit being realized by software is only an example, and at least part of the calculation units may be realized by a hardware circuit such as a logic circuit.
The command value calculation unit 31 calculates a current command value I* for the motor 12 based on a state variable SSV indicating a state of the mechanical device 13, for example. The feedback calculation unit 32 calculates a difference between the current command value I* calculated by the command value calculation unit 31 and a value of a current Im of the motor 12 detected by way of the current sensor 23. The feedback calculation unit 32 generates a drive signal for the inverter 22 so as to eliminate the difference between the current command value I* and the value of the current Im of the motor 12.
The inverter 22 operates based on the drive signal generated by the feedback calculation unit 32. The inverter 22 has a plurality of switching elements. By switching these switching elements based on the drive signal, electric power according to the current command value I* is generated. The electric power generated by the inverter 22 is supplied to the motor 12 via a power supply path made up of a bus bar, a cable, or the like. Thus, the motor 12 generates torque corresponding to the current command value I*.
As illustrated in the block diagram of
A control system for the motor 12 is a feedback control system that determines the current command value I* for the motor 12 based on the state variable SSV of the mechanical device 13. Supplying current from the inverter 22 to the motor 12 in accordance with the current command value I* rotates the motor 12 at a predetermined angular velocity ωm. Therefore, a range from the current command value I* for the motor 12, to the angular velocity ωm of the motor 12, is the object of control target in the feedback control system. The angular velocity ωm of the motor 12 is rotation information of the motor 12. The plant P includes the mechanical device 13.
When the inertial number of the mechanical device 13 is “1”, and the mechanical device 13 and the motor 12 are regarded as being connected via an elastic element, the object of control can be regarded as being a two-inertial system in which two moments of inertia are connected by the elastic element. In this case, the object of control has frequency characteristics that include one set of resonance characteristics and antiresonance characteristics.
Also, when the inertial number of the mechanical device 13 is “2”, and the mechanical device 13 and the motor 12 are regarded as being connected via an elastic element, the object of control can be regarded as being a three-inertial system in which three moments of inertia are connected by the elastic element. In this case, the object of control has frequency characteristics that include two sets of resonance characteristics and antiresonance characteristics.
The disturbance observer unit 33 takes in the current command value I*, which is a target value of the plant P, and output of the plant P. An example of the output of the plant P is the angular velocity ωm of the motor 12. The angular velocity Ωm is obtained by differentiation of the rotation angle θ of the motor 12 that is detected by the rotation angle sensor 12A. The disturbance observer unit 33 estimates the disturbance Tld based on the current command value I* and the angular velocity ωm of the motor 12. The disturbance observer unit 33 calculates a first correction value Ic1 for canceling out the disturbance Tld having a frequency that is the object of suppression.
The disturbance observer unit 33 has an estimator 33A, a multiplier 33B, and a subtractor 33C. The disturbance observer unit 33 may be made up of a hardware circuit, such as a logic circuit. The disturbance observer unit 33 is also referred to as a disturbance observer circuit. Also, the disturbance observer unit 33 may be a functional part realized by a CPU of a computer executing a control program.
The estimator 33A has a nominal plant Pn, a first observer gain L1, and a second observer gain L2. The nominal plant Pn is a model simulating the plant P that is the object of control. The estimator 33A calculates a difference Δω between the angular velocity ωm of the motor 12 obtained as the output of the plant P, and an estimated angular velocity ωm{circumflex over ( )} of the motor 12 obtained as output of the nominal plant Pn, as shown in the following Expression (1). The “{circumflex over ( )}” indicates an estimated value.
The estimator 33A multiplies the value of the difference Δω between the angular velocity Ωm of the motor 12 and the estimated angular velocity ωm{circumflex over ( )} of the motor 12 by the second observer gain L2, as shown in the following Expression (2), thereby calculating a differential value dTld{circumflex over ( )} of an estimated disturbance Tld{circumflex over ( )}.
Note that the estimator 33A calculates the estimated disturbance Tld{circumflex over ( )} by integration of the differential value dTld{circumflex over ( )} of the estimated disturbance Tld{circumflex over ( )}. The nominal plant Pn calculates an estimated value ωm{circumflex over ( )} of the angular velocity ωm using the estimated disturbance Tld{circumflex over ( )}, a value obtained by multiplying the value of the difference Δω by the first observer gain L1, and a viscosity coefficient C of the motor 12.
The multiplier 33B calculates the first correction value Ic1 by multiplying the differential value dTld{circumflex over ( )} of the estimated disturbance Tld{circumflex over ( )} calculated by the estimator 33A, by a gain β. The first correction value Ic1 is a current value for canceling out the vibration due to the disturbance Tld.
The subtractor 33C subtracts the first correction value Ic1 from the current command value I* to calculate a current command value I* in which the effects of the disturbance Tld have been compensated for.
The disturbance Tld that is applied to the mechanical device 13 after the effects of the disturbance Tld have been compensated for by the disturbance observer unit 33 is referred to as post-compensation disturbance Tlast.
The post-compensation disturbance Tlast is expressed by the following Expression (3).
where “J” is a coefficient of inertia in which a moment of inertia of the mechanical device 13 is modeled, “C” is a viscosity coefficient in which friction of the mechanical device 13 is modeled, “s” is a Laplace operator, “L1” is first observer gain, “L2” is second observer gain, and “β” is gain.
As shown in the graph of
The first observer gain L1 is expressed by the following Expression (4).
where “Ω” is frequency, and “α” is a first parameter.
The second observer gain L2 is expressed by the following Expression (5).
where “J” is a coefficient of inertia in which the moment of inertia of the mechanical device 13 is modeled, and “Ω” is frequency.
The gain β is expressed by the following Expression (6).
where “α” is a first parameter, “Ω” is frequency, and “γ” is a second parameter. The second parameter γ is a value of “1” or less, and can be set, for example, in steps of “0.1”.
The value of the frequency Ω is set to the frequency of the disturbance Tld to be suppressed, and the frequency of the disturbance Tld to be suppressed is, for example, the center frequency fc of the notch in the disturbance Tld.
Further, adjusting the value of the first observer gain L1 enables a width Wn of the notch in the disturbance Tld to be adjusted. Adjusting the value of the first parameter α in Expression (4) enables the value of the first observer gain L1 to be adjusted.
Also, adjusting the value of the gain β enables a depth Dn of the notch in the disturbance Tld to be adjusted. Adjusting the value of the second parameter γ in Expression (6) enables the value of the gain β to be adjusted.
The first observer gain L1 and the gain β are parameters that are adjusted to suppress vibrations due to the disturbance Tld having a specific frequency that is the object of suppression. Adjusting the value of the first observer gain L1 and the value of the gain β enables a conveyance rate of the disturbance Tld to the plant P to be adjusted. The value of the first observer gain L1 and the value of the gain β are adjusted so that the post-compensation disturbance Tlast has frequency characteristics corresponding to the antiresonance characteristics of the plant P. Inputting the post-compensation disturbance Tlast having frequency characteristics corresponding to the antiresonance characteristics of the plant P into the plant P theoretically enables the amplitude of vibrations of the mechanical device 13 due to the disturbance Tld having a specific frequency that is the object of suppression to be set to “0”.
Substituting Expressions (4), (5), and (6) into the above Expression (3) yields the following Expression (7).
When the value of the second term “2·Ω·α·(1−γ)·s” in the curly brackets in the numerator of Expression (7) is “0”, the conveyance rate of the disturbance Tld having the specific frequency that is the object of suppression with respect to the plant P becomes “0”. Accordingly, setting the value of the second parameter γ to “1” enables the vibrations due to the disturbance Tld having the specific frequency that is the object of suppression to be cancelled out. Furthermore, adjusting the value of the second parameter γ between “0 and 1” in steps of “0.1”, for example, enables the conveyance rate of the disturbance Tld having the specific frequency that is the object of suppression with respect to the plant P to be adjusted. The smaller the value of the second term “2·Ω·α·(1−γ)·s” in the curly brackets in the numerator of Expression (7) becomes, the smaller the conveyance rate of the disturbance Tld having the specific frequency that is the object of suppression with respect to the plant P becomes.
Note that the second term in the curly brackets in the numerator of Expression (7), “2·Ω·α·(1−γ)·s”, corresponds to the second term in the curly brackets in the numerator of Expression (3), “(−L2·β)+L1·J)s”. To adjust the value of the second parameter γ is also to adjust the value of the gain β.
According to the present embodiment, the following effects can be obtained.
(1) The disturbance observer unit 33 estimates the disturbance Tld using a nominal plant Pn that is a model simulating the plant P, and corrects the current command value I* based on the disturbance Tld that is estimated. The disturbance observer unit 33 has parameters that are adjusted to suppress vibrations due to the disturbance Tld having the specific frequency that is the object of suppression. Adjusting these parameters enables compensating just for the effects of the disturbance Tld having the specific frequency that is the object of suppression. The parameters are adjusted so that the post-compensation disturbance Tlast has frequency characteristics corresponding to the antiresonance characteristics of the plant P. Inputting the post-compensation disturbance Tlast having frequency characteristics corresponding to the antiresonance characteristics of the plant P to the plant P enables vibrations occurring in the plant P to be suppressed or canceled out.
(2) The disturbance observer unit 33 estimates the disturbance Tld applied to the mechanical device 13 based on the current command value I* and the angular velocity ωm of the motor 12. Unlike in the case in which the rotation angle θ of the motor 12 is used, there is no need to calculate the midpoint of the motor 12. The midpoint of the motor 12 is the rotation angle θ of the motor 12 corresponding to the reference operating state of the mechanical device 13. Accordingly, the motor control device 11 does not need to have a function of calculating the midpoint of the motor 12.
(2) The disturbance observer unit 33 calculates the first correction value Ic1 for the current command value I* by multiplying the differential value dTld{circumflex over ( )} of the estimated disturbance Tld{circumflex over ( )} by the gain β. Multiplying the differential value dTld{circumflex over ( )} by the gain β is all that is necessary, and accordingly the first correction value Ic1 can be easily calculated.
(3) The post-compensation disturbance Tlast that is applied to the plant P after the effects of the disturbance Tld have been compensated for has conveyance characteristics expressed by the following Expression (A). This is based on Expression (3) above.
When the value of the second term “(−L2·B)+L1·J)s” in the numerator of Expression (A) is “0”, the conveyance rate of the disturbance Tld to the plant P theoretically becomes “0”. Accordingly, the value of the gain β of the disturbance observer unit 33 is adjusted so that the value of the second term of the numerator of Expression (A) becomes “0” or a value closer to “0”. Adjusting the value of the gain β enables the disturbance Tld to be suppressed more appropriately.
The present embodiment may be carried out modified as follows.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2021/035661 | 9/28/2021 | WO |