The present invention relates to a control device and relates to, for example, a control device of a motor.
In a brushless DC motor, as one of general control methods, on the basis of a rotating coordinate system in which a rotor magnetic pole direction is defined as a d axis and an axis which is advanced by 90° in the θ positive direction from the d axis is defined as a q axis, a d-axis current is set as 0, and linear control of a q-axis current and a torque is performed.
A technique of computing the rotation position of a rotor in the brushless DC motor on the basis of currents flowing in three-phase coils, not detecting the rotation position by using a sensor, is proposed.
Since the magnetic pole position (the position of the dq axis) of the rotor is unknown in a sensorless control including a method based on a current estimation error, the magnitude and the phase of an induced voltage generated in the motor are estimated and, from them, the magnetic pole position (the position of the dq axis) of the rotor is estimated.
For example, in Japanese Unexamined Patent Application Publication No. Hei 8(1996)-308286, current values Iu and Iv flowing in a stator coil are detected, and the rotation angle is estimated from the detected values. In Non-Patent Literature 1, “Sensorless Brushless DC Motor Control Method Based on Current Estimation Error”, Takaharu Takeshita, Naofumi Nomura, and Nobuyuki Matsui, T. IEE Japan, Vol. 115-D, No. 4, 1995, a sensorless brushless DC motor control based on a current estimation error is described.
Generally, in sensorless control of a motor based on a current estimation error, the induced voltage and the frequency characteristic of the magnetic pole position estimation system depend on the speed of the motor. Consequently, when the rotation of the motor becomes low speed, a convergence gain of an estimation system becomes small, and the response frequency becomes lower.
In the sensorless control of the motor, to perform current control and computation of estimation of the induced voltage and the magnetic pole position in a stable control axis, induced-voltage estimation response time has to be equal to or longer than current response time of a control system.
To maintain the relation, as the rotation of the motor decreases, the response frequency of current has to be decreased. Further, when the response frequency of current is decreased, in some cases, the response frequency of speed has to be decreased.
As described above, in the motor sensorless control, due to the characteristic of a response frequency, an induced voltage, a magnetic pole position estimation gain, a current control gain, and a speed control gain are closely related. However, there is a problem such that a method of designing those parameters cannot be established and the parameters have to be adjusted in a try and error manner.
The other problems and novel features will become apparent from the description of the specification and the appended drawings.
According to an embodiment, by using an induced-voltage observer, an induced voltage is estimated, and all of control gains are unconditionally determined.
According to the embodiment, the induced voltage and the frequency characteristic of a magnetic pole position estimation system can be clearly designed, and all of control gains necessary for sensorless control can be designed theoretically and quantitatively.
For clarification of description, omission and simplification are properly made in the following description and drawings. Each of elements illustrated in the drawings as function blocks performing various processes can be constructed by a CPU, a memory, and other circuits as hardware, and is realized by a program loaded to a memory as software. Therefore, a person skilled in the art understands that the function blocks can be realized in various forms of only hardware, only software, or combination of the hardware and software, and the invention is not limited to any of the forms. In the drawings, the same reference numeral is designated to the same element and repetitive description is omitted as necessary.
The estimator 101 estimates an estimated induction voltage and a phase error of a motor from a target voltage of the motor, a current value of the motor, and a magnetic pole position (rotation angle) of a rotor of the motor estimated in the past by applying an induced-voltage observer.
The controller 102 controls the motor on the basis of the estimated induction voltage and the phase error.
As described above, with the control device related to the outline of the embodiment, by estimating the induced voltage by using the induced-voltage observer and unconditionally determining all of control gains, the induced voltage and the frequency characteristic of a magnetic pole position estimation system can be clearly designed, and all of control gains necessary for sensorless control can be designed theoretically and quantitatively.
In a first embodiment, the detailed configuration of the control device 100 described in the outline of embodiments and a control device of a motor using the control device 100 will be described.
First, the functions of components of the control device according to the first embodiment will be described.
The estimator 101 estimates the present rotation angle of the rotor of the motor 210 on the basis of a U-phase current value Iu, a V-phase current value Iv, and the rotation angle of the rotor of the motor 210 in the past (for example, one sample before). The estimator 101 outputs the estimated rotation angle to the speed computing unit 201, the 2 phase/3 phase converter 203, and the 3 phase/2 phase converter 205. The detailed configuration and operation of the estimator 101 will be described later.
The controller 102 computes target voltages Vd and Vq on the dq coordinate axis on the basis of the deviation between a current target value Iq* determined from the difference between a target rotation speed and the rotation speed obtained by the speed computing unit 201 and a 3-phase current actually flowing in the motor 210. The controller 102 outputs the computation result to the estimator 101 and the 2 phase/3 phase converter 203.
The speed computing unit 201 calculates the rotation speed on the basis of the rotation angle estimated by the estimator 101. The speed computing unit 201 outputs the obtained rotation speed to the subtracter 202.
The subtracter 202 subtracts the rotation speed obtained by the speed computing unit 201 from the target rotation speed instructed from the outside. The subtracter 202 outputs the subtraction result to the controller 102.
The 2 phase/3 phase converter 203 converts the target voltages Vd and Vq instructed from the controller 102 to target voltages Vu*, Vv*, and Vw* of actual three phases. The 2 phase/3 phase converter 203 outputs the target voltages Vu*, Vv*, and Vw* of actual three phases to the PWM controller 204.
The PWM controller 204 determines a duty ratio which realizes the target voltages Vu*, Vv*, and Vw* of three phases by on/off of a not-illustrated DC power supply. The PWM controller 204 drives the motor 210 by a pulse wave of the duty ratio. For example, the PWM controller 204 has therein an inverter, controls six switching elements, and controls voltages applied to coils of three phases in the motor 210. The inverter has a current sensor detecting currents of the U phase and the V phase, and a U-phase current value Iu and a V-phase current value Iv are detected. The inverter may be provided on the inside or the outside of the PWM controller 204.
The 3 phase/2 phase converter 205 calculates the current values Id and Iq on the dq coordinate axis from the rotation angle estimated by the estimator 101 and the current values Iu and Iv of the phases detected by the PWM controller 204. Then, the 3 phase/2 phase converter 205 outputs the current values Id and Iq to the estimator 101 and the controller 102.
Next, the internal configuration of the estimator 101 will be described. In
The induced-voltage observer 111 estimates magnitude “e” of an estimation induced voltage and a phase error β on the basis of the target voltages Vd and Vq on the dq coordinate axis, the current values Id and Iq on the dq coordinate axis, and the rotation angle of the rotor of the motor 210 estimated in the past. The induced-voltage observer 111 outputs the magnitude “e” of the estimation induced voltage to the induced-voltage computing unit 112. The induced-voltage observer 111 outputs the phase error β to the phase computing unit 113.
The induced-voltage computing unit 112 performs computation of dividing the magnitude of the induced voltage by an induced-voltage coefficient. The induced-voltage computing unit 112 outputs the computation result to the subtracter 114.
The phase computing unit 113 performs computation of integration of multiplying the phase error β by an error angle integration gain ωβ. The phase computing unit 113 outputs the computation result to the subtracter 114.
The subtracter 114 subtracts the computation result of the phase computing unit 113 from the computation result of the induced-voltage computing unit 112 to obtain a magnetic pole position estimation value θ{circumflex over ( )}. The subtracter 114 outputs the magnetic pole position estimation value θ{circumflex over ( )} to the induced-voltage observer 111, the speed computing unit 201, the 2 phase/3 phase converter 203, and the 3 phase/2 phase converter 205.
As described above, in the estimator 101, the magnetic pole position estimation value θ{circumflex over ( )} is controlled by adding phase information calculated from the amplitude “e” and multiplying the phase error β with the error angle integration gain ωβ so that β becomes zero (β=0).
The internal configuration of the controller 102 will now be described. In
The speed PI controller 121 determines a current target value Iq* determined from the difference between the target rotation speed and the rotation speed obtained by the speed computing unit 201. The speed PI controller 121 outputs the current target value Iq* to the subtracter 123.
The subtracter 122 subtracts the current value Id output from the 3 phase/2 phase converter 205 from the target value Id* (=0). The subtraction result is output to the d-axis current PI controller 124.
The subtracter 123 subtracts the current value Iq output from the 3 phase/2 phase converter 205 from the target value Iq*. The subtraction result is output to the q-axis current PI controller 125.
The d-axis current PI controller 124 determines a target voltage Vd from the difference between the target value Id* and the current value Id. The d-axis current PI controller 124 outputs the target voltage Vd to the 2 phase/3 phase converter 203.
The q-axis current PI controller 125 determines a target voltage Vq from the difference between the target value Iq* and the current value Iq. The q-axis current PI controller 125 outputs the target voltage Vq to the 2 phase/3 phase converter 203.
As described above, in the controller 102, on the basis of the deviations between the current target value Iq* and the current values Id and Iq on the dq coordinate axis obtained by converting the currents of three phases actually flowing in the motor 210, the target voltages Vd and Vq on the dq coordinate axis are computed.
Next, the motor 210 will be described.
Three-phase fixed coordinates (UVW coordinate system) having a U axis, a V axis, and a W axis in the directions of the stator windings 231, 232, and 233 of the respective phases are defined. A two-phase rotation coordinate system (the dq coordinate system or actual rotation coordinate system) in which the d axis (magnetic pole axis) is set in the magnetic pole direction of the rotor 220 and the q axis (torque axis) is set in a direction orthogonal to the d axis in the rotation plane of the rotor 220 is also defined. The dq coordinate system is a rotation coordinate system which rotates together with the rotor 220. In the dq coordinate system, only the q-axis current contributes to torque generation of the rotor 220. Consequently, it is sufficient to set the d-axis current to zero and control the q-axis current in accordance with a desired torque. The rotation angle (rotor angle) θ of the rotor 220 is the rotation angle of the d axis with respect to the U axis. The dq coordinate system is an actual rotation coordinate system according to the rotor angle θ. By using the rotor angle θ, the coordinate conversion can be performed between the UVW coordinate system and the dq coordinate system.
In the first embodiment, the control device 100 controls the motor 210 as the above-described three-phase brushless motor. Next, the operation of the control device 100 of the first embodiment will be described.
By using
From
v*
d=(R+sLd)id−ω*Lqiq+ed (1)
v*
q=(R+sLq)iq+ω*Ldid+eq (2)
In the formulae (1) and (2), Vd* and Vq* are instruction voltage values of the d axis and the q axis. R denotes a winding resistance value of the coil of the rotor. “s” denotes a differential operator (Laplace operator). Ld and Ld are inductances in the d axis and the q axis, respectively. id and id are current values in the d axis and the q axis, respectively. ω* denotes target rotation speed. ed and eq denote estimation induced voltage values in the d axis and the q axis, respectively.
Now, −ω*Lqiq and −ω*Ldid are regarded as disturbances and set as −dd and −dq.
v*
d=(R+sLd)id−dd (3)
v*
q=(R+sLq)iq−dq (4)
Then, voltage equations become as the above formulae (3) and (4) and equations in which the d axis and the q axis are separated. First, an estimation formula of the d-axis induced voltage is derived. The formula (3) is rewritten to the following formula (5).
On the basis of the formula (5), id and d (disturbance) are set as state variables, and a state equation (6) and a formula (7) are set.
When estimation values of id and d are set as
{circumflex over (d)}
and
, respectively, estimation state equations on the observer side can be written as the following formulae (8) and (9) by adding terms in which estimation errors are multiplied by estimation gains KEd1 and KEd2.
When the formula (9) is substituted into the formula (8),
is expressed as the following formula (10).
When the formula (10) is substituted into the formula (9),
{circumflex over (d)}
can be written as the following formula (11).
Looking at the formulae (10) and (11),
and become secondary systems of formulae (12) and (13) using id and vd* as inputs.
That is, the frequency characteristics of the d-axis induced-voltage estimation system can be designed by a natural frequency ωEG and a damping factor ζEG, and estimation gains KEd1 and KEd2 can be written as the following formulae (14) and (15), respectively.
Subsequently, similar calculation is performed also on the q axis. The formula (4) is rewritten as the following formula (16).
On the basis of the formula (16), using iq and d (disturbance) as state variables, state equations (17) and (18) are set.
When estimation values of iq and d are expressed as
{circumflex over (d)}
and, estimation state equations on the observer side can be written as the following formulae (19) and (20) by adding terms in which an estimation error is multiplied by estimation gains KEq1 and KEq2.
When the formula (20) is substituted into the formula (19),
is expressed as the following formula (21).
When the formula (21) is substituted into the formula (20),
{circumflex over (d)}
can be written as the following formula (22).
Looking now at the formulae (21) and (22),
and become secondary systems of formulae (23) and (24) using iq and Vq* as inputs.
That is, like in the d-axis induced-voltage estimation system, the frequency characteristics of the q-axis induced-voltage estimation system can be also designed by ωEG and ζEG, and estimation gains KEq1 and KEq2 can be written as the following formulae (25) and (26), respectively.
Subsequently, when estimation induced-voltages are calculated from the estimated disturbances
and obtained by the formulae (11) and (22), the following formulae (27) and (28) are derived.
e
d
=−
+ω*L
q
i
q (27)
e
q
=−
−ω*L
d
i
d (28)
Therefore, the magnitude “e” of the estimation induced-voltage and the phase error β are obtained as the following formulae (29) and (30).
Next, from the calculated “e” and β, the magnetic pole position is estimated.
A frequency characteristic GE of the induced-voltage estimation system becomes a stable secondary system determined by the natural frequency ωEG and the damping factor ζEG when the estimation gains KEd1, KEd2, KEq1, and KEq2 are designed as formulae (31), (32), (33), and (34), respectively.
Therefore, the control gains which have to be designed in the induced voltage and magnetic pole position estimation system are the three control gains ωEG, ζEG, and ωβ.
Bandwidth ωSC of the speed control system and bandwidth ωCC of the current control system are designed to maintain the relation of the formula (35) so as not to interfere each other.
ωCC>>ωSC (35)
As illustrated in
According to the above-described design concept, ζEG is fixed to a value of about 0.6 and ωEG is designed so as to satisfy the relation of the following formula (36).
ωEG≥ωCC (36)
It is sufficient to design the error angle integration gain ωβ in the magnetic pole position estimation system in
Since the phase lag is directly related to torque decrease, the lower limit of the error angle integration gain ωβ is determined according to allowance of the phase lag.
According to the above-described design concept, the error angle integration gain ωβ is designed. First, when the error angle integration gain ωβ is designed as the following formula (37), the frequency characteristic of the magnetic pole position estimation system becomes almost the same as the characteristic of a first-order lag system, so that the phase lags about 45° at the cutoff frequency ωβ.
ωEG>>ωβ (37)
That is, it can be considered that the upper limit of the input frequency of the magnetic pole position estimation system is determined by the bandwidth of the speed control system. Consequently, for example, when the bandwidth of the speed control system is designed to be equal to or less than the error angle integration gain ωβ, an error is about 45° at the maximum. Using 45° as the allowable range of an error (torque decrease rate is about 30%), the relation between the bandwidth of the speed control system and the error angle integration gain is designed so as to always maintain the relation of the following formula (38).
ωβ>ωSC (38)
When the formulae (37) and (38) are combined, the following formula (39) is obtained.
ωEG>>ωβ≥ωSC (39)
When 2-1, 2-2, and 2-3 are combined, the relations of the gains of the control systems are expressed as the formula (40).
ωEG≥ωCC>>ωβ≥ωSC (40)
That is, when motor parameters are known, design of the entire sensorless control system using the induced-voltage observer is only design of gains while maintaining the relations of the formula (40).
As described above, according to the control device of the first embodiment, by applying the induced-voltage observer to the induced-voltage estimation algorithm, the frequency characteristic of the induced-voltage estimation system can be clearly determined by the natural frequency ωEG. The bandwidth ωCC of the current control system, the phase error integration gain ωβ, and the bandwidth ωSC of the speed control system are unconditionally determined according to the formula (40), gain adjustment is unnecessary, and stable control can be realized.
Generally, in sensorless control, at the time of low speed, low voltage cannot be correctly output due to voltage distortion caused by dead time necessary for inverter control. As a result, induced-voltage and the magnetic pole position cannot be accurately estimated.
In a second embodiment, negative feedback control is performed so that an output voltage of an inverter matches an instruction voltage without a lag. By decreasing the voltage distortion caused by the dead time, the precision of estimation of the induced voltage and the magnetic pole position is increased.
The 2 phase/3 phase converter 203 converts the target voltages Vd and Vq instructed from the controller 102 to target voltages Vu*, Vv*, and Vw* of actual three phases. The 2 phase/3 phase converter 203 outputs the target voltages Vu*, Vv*, and Vw* of actual three phases to the dead time compensator 801.
The dead time compensator 801 performs negative feedback control so that the target voltages Vu*, Vv*, and Vw* of three phases output from the 2 phase/3 phase converter 203 match the instruction voltage without a lag. The detailed operation of the dead time compensator 801 will be described later. For example, the dead time compensator 801 may be constructed by an ASIC (Application Specific Integrated Circuit) or a processor or a semiconductor device made by a CPU (Central Processing Unit) and a memory.
The PWM controller 204 determines a duty ratio which realizes the target voltages of three phases output from the dead time compensator 801 by on/off of a not-illustrated DC power supply. The PWM controller 204 drives the motor 210 by a pulse wave of the duty ratio. For example, the PWM controller 204 has therein an inverter, and controls six switching elements to control voltages applied to three-phase coils in the motor 210.
The detailed operation of the dead time compensator 801 will now be described.
In the formula (41), KP and KI are a proportional gain and an integration gain, respectively, in PI control. ωC denotes cutoff frequency of a filter cutting frequencies below the frequency of a PWM.
When it is designed that KP=1 and KI=ωC, the formula (41) becomes the following formula (42).
That is, as expressed by the relation of the formula (42), an instruction voltage V* and an output voltage VO match without a lag. The dead time compensator 801 performs the control process of the formula (42).
As described above, according to the control device of the second embodiment, the voltage distortion caused by dead time can be decreased, so that the precision of estimating the induced voltage and the magnetic pole position increases, and the control can be performed at lower speed. In addition, since the voltage distortion caused by dead time can be decreased, the lower limit speed of magnetic pole position estimation can be lowered.
In a third embodiment, when the speed is below the lower limit speed of estimation of the induced voltage and the magnetic pole position, the mode is switched to a mode of performing a drive by passing d-axis current and forcedly changing the phase in accordance with a position instruction value (this mode will be called a pull-in operation mode).
When rotation speed estimated by the speed computing unit 201 is larger than a predetermined threshold, the switching unit 1001 outputs id*=0 to the d-axis current PI controller 124 and outputs iq* output from the speed PI controller 121 to the q-axis current PI controller 125. When the rotation speed is equal to or less than the predetermined threshold, the switching unit 1001 outputs id*=id_ol to the d-axis current PI controller 124 and outputs iq*=0 to the q-axis current PI controller 125. For example, the switching unit 1001 may be constructed by an ASIC (Application Specific Integrated Circuit) or a processor or a semiconductor device made by a CPU (Central Processing Unit) and a memory.
The operation of the control device 1000 will now be described. First, an operation of generating a speed instruction value from a position instruction value will be described.
The speed instruction value is generated by differential of the position instruction value. The speed instruction value depends on an input parameter and becomes a trapezoid or triangle pattern. According to the speed instruction value, the motor is driven.
Next, the operation of the control device 1000 in the case where the motor rotates at low speed will be described.
As illustrated in
By the above operation, at the time of switch to the pull-in operation mode, the q-axis current just before switching of the mode is passed to the d-axis current PI controller 124, and the d-axis current and the q-axis current are replaced, thereby coupling the torques seamlessly.
Next, the internal configuration of the switching unit 1001 will be described.
The determining unit 1011 determines whether the rotation speed estimated by the speed computing unit 201 is larger than a predetermined threshold or is equal to or less than the predetermined threshold and outputs the determination result to the first switch 1021 and the second switch 1031.
According to the determination of the determining unit 1011, the first switch 1021 couples any of contact points 1022 and 1023 to a contact point 124. To the contact point 1024, the d-axis current PI controller 124 is coupled.
Concretely, when the rotation speed estimated by the speed computing unit 201 is larger than the predetermined threshold, the contact point 1022 is coupled to the contact point 1024. That is, id*=0 is output to the d-axis current PI controller 124.
When the rotation speed estimated by the speed computing unit 201 is equal to or less than the predetermined threshold, the contact point 1023 is coupled to the contact point 1024. That is, id*=id_ol is output to the d-axis current PI controller 124. id_ol is the d-axis current at the time of the pull-in operation.
According to the determination of the determining unit 1011, the second switch 1031 couples any of the contact points 1022 and 1033 to a contact point 1034. To the contact point 1032, the speed PI controller 121 is coupled. To the contact point 1034, the q-axis current PI controller 124 is coupled.
Concretely, when the rotation speed estimated by the speed computing unit 201 is larger than the predetermined threshold, the contact point 1032 is coupled to the contact point 1034. That is, iq* output from the speed PI controller 121 is output to the q-axis current PI controller 125.
When the rotation speed estimated by the speed computing unit 201 is equal to or less than the predetermined threshold, the contact point 1033 is coupled to the contact point 1034. That is, iq*=0 is output to the q-axis current PI controller 125.
With the above configuration, in combination with the dead time compensating function realized by negative-feedback-controlling the voltage applied to the motor, drive is performed so as to follow the instruction speed generated from the position instruction profile.
As described above, according to the control device of the third embodiment, by seamlessly switching the speed control mode and the pull-in operation mode using the lower limit speed as a threshold, and performing driving on the basis of the instruction speed generated from the position instruction value, the simple positioning operation can be realized.
In the case where the state shifts from the state in which the speed exceeds the lower limit speed of estimation of the induced voltage and the magnetic pole position to the state in which the speed is below the lower limit speed of estimation of the induced voltage and the magnetic pole position, by passing the q-axis current just before the state shifts to the d-axis current PI controller 124 and replacing the d-axis current and the q-axis current, the torques can be seamlessly coupled and, in a state where the speed is below the lower limit speed, the positioning operation can be realized.
Concretely, when the speed is below the lower limit speed, by changing the mode to the pull-in operation mode and forcedly turning the phase in accordance with the position instruction profile, the simple positioning operation can be realized.
The above-descried program is stored by using any of non-transitory computer readable media of various types and can be supplied to a computer. The non-transitory computer readable media include tangible storage media of various types. Examples of the non-transitory computer readable media include magnetic recording media (for example, flexible disk, magnetic tape, and hard disk drive), magnet-optic recording media (for example, magnet-optic disk), CD-ROM (Read Only Memory), CD-R, CD-R/W, and semiconductor memories (for example, mask ROM, PROM (Programmable ROM), EPROM (Erasable PROM), flash ROM, and RAM (Random Access Memory)). The program may be supplied to a computer by any of transitory computer readable media of various types. Examples of the transitory computer readable media include an electric signal, an optical signal, and electromagnetic wave. The transitory computer readable medium can supply a program to a computer via a wired communication path such as an electric wire or an optical fiber or a wireless communication path.
Although the present invention achieved by the inventors herein has been concretely described above on the basis of the embodiments, obviously, the present invention is not limited to the forgoing embodiments but can be variously changed without departing from the gist.
For example, although the example of controlling the three-phase brushless motor has been described in the foregoing embodiments, the invention can be also applied to a stepping motor of a PM (Permanent Magnet) type or an HB (Hybrid) type using a permanent magnet other than a three-phase motor.
Number | Date | Country | Kind |
---|---|---|---|
2016-177461 | Sep 2016 | JP | national |
This application is a Continuation of U.S. patent application Ser. No. 15/699,791 filed on Sep. 8, 2017, which claims the benefit of Japanese Patent Application No. 2016-177461 filed on Sep. 12, 2016 including the specification, drawings and abstract are incorporated herein by reference in their entirety.
Number | Date | Country | |
---|---|---|---|
Parent | 15699791 | Sep 2017 | US |
Child | 16399253 | US |