Now, an embodiment of the present invention will be described below with reference to the drawings.
A compensation for a back electromotive force by the back electromotive force compensating part 70 relative to the voltage command values Da2, Db2 and Dc2 is carried out by a method as disclosed in, for instance, Japanese Patent Unexamined Publication No. 2005-199780.
If the voltage command values Da21 to Dc21 of the phases are respectively not larger than, for instance, a prescribed value #2 and the phase current can be normally detected, when an error between the current estimated values Ia2e to Ic2e and the current detected values Iad to Icd is not smaller than a prescribed value #3 and the voltage command values Da21 to Dc21 are not larger than the prescribed value #2, the failure of the current detecting system such as a current detecting resistance or the current detecting circuit 361 is decided to be the “failure”. The current switching part 60 obtains the error between the current detected values Iad to Icd and the current estimated values Ia2e to Ic2e for each phase. In the case of the phase having the error of a prescribed value #1 or more, not the current detected values Iad to Icd, but the current estimated values Ia2e to Ic2e are fed back to subtracting parts 33a to 33c as feedback current values Iad1 to Icd1. In the case of the phase having the error under the prescribed value #1, the current detected values Iad to Icd are fed back to the subtracting parts 33a to 33c as the feedback current values Iad1 to Icd1.
In the above-described structure, an operation is described by referring to flowcharts shown in
Initially, a timer (time t=0) or an initial value necessary for three phases ABC (for instance, an initial value of a memory showing a failure or an undetectable state of each phase in each sample time (ordinarily, “0”)) is set (step S1) Wait until the timer exceeds a prescribed time T0 (step S2). When the prescribed time T0 elapses, a steering torque T, a vehicle speed V and the current detected values Iad, Ibd and Icd are read (step S3). A current command value calculating part 31 calculates a current command value Iref in accordance with the read steering torque T and the vehicle speed V (step S4). A three-phase current command value calculating part 32 calculates current command values Ia, Ib and Ic of respective phases in accordance with the current command value Iref, a motor angle θ and a motor angular velocity ω (step S5). The current switching part 60 calculates difference current values ΔIa to ΔIc between the current detected values Iad to Icd for the respective phases and the current estimated values Ia2e to Ic2e (step S6).
Then, the phase in which the absolute value of the difference current value ΔIa to ΔIc is larger than the prescribed value #1 is detected to store the phase in a memory ABC1 for observing the undetectable state (step S7). Further, the number of phases K is obtained in which the absolute value of the difference current value ΔIa to ΔIc is larger than the prescribed value #3 (>#1) and the voltage command values Da21 to Dc21 are not larger than the prescribed value #2 (step S10). When the error is large irrespective of the voltage command values Da21 to Dc21 under which the current can be detected, the current detecting system such as the current detecting resistance or the current detecting circuit 361 is considered to be failed. Accordingly, in the above-described step S10, when the number of the phases K is equal 0, the procedure moves to an operation of step S20 shown in
For instance, assuming that the memory ABC1 is an array, the array of the memory ABC1 indicates [1, 0, 0] (ABC1=[1, 0, 0]) that shows in order from the left a phase A, a phase B and a phase C, “1” represents “the difference>the prescribed value #1” and “0” represents “the difference≦the prescribed value #1”. Similarly, assuming that the memory ABC2 is an array, the array of the memory ABC2 indicates [0, 1, 0] (ABC2=[0, 1, 0]) that shows in order from the left a phase A, a phase B and a phase C, and “1” represents “the difference>the prescribed value #3” and the state in which the current can be detected.
When the maximum value Dlimit of the voltage command value is, for instance, 90%, the voltage command value is liable to be saturated and a current controller including an integrator is liable to be wound up (see
In the above-described step S10, when it is decided that the number of the phases K is 0 (K=0), the number of the phases M stored in the memory ABC1 is decided (step S20). When it is decided that the number of the phases M is 0 (M=0), namely, when all the phases indicate|the current detected value−the current estimated value|≦the prescribed value #1, the current detected values Iad to Icd are fed back to the subtracting parts 33a to 33c. The PI control part 34 calculates the voltage command values Da2, Db2 and Dc2 in accordance with difference current values Ia1 to Ic1 from the subtracting parts 33a to 33c. The voltage command values whose back electromotive force is compensated in the back electromotive force compensating part 70 and adding parts are inputted to the voltage command value restricting part 40 and the voltage command value restricting part 40 calculates the restricted voltage command values Da21, Db21 and Dc21 (step S21). The current estimating part 50 estimates currents at a next sampling time in accordance with the voltage command values Da21, Db21 and Dc21 and the current detected values Iad, Ibd and Icd (step S22). The PWM control part 35 outputs the gate signals G1 to G6 of PWM signals (step S23) to return to the step S2.
On the other hand, in the step S20, when it is decided that the number of the phases M=1, if the phase is, for instance, the phase A, the current estimated value Ia2e is used and the current detected values Ibd and Icd are used for two other phases (the phase B, the phase C) to calculate differences Ia1 to Ic1 from the current command values. The PI control part 34 calculates the voltage command values Da2, Db2 and Dc2 and the voltage command value restricting part 40 calculates the voltage command values Da21, Db21 and Dc21 (step S24). Then, the current estimating part 50 estimates currents at a next sampling time by using, only for the phase A, a value obtained by reversing the sign of the sum of the current detected values of other phases and the current detected values for other two phase (step S25), then go to the above-described step S23. Further, in the step S20, when it is decided that the number of the phases M is 2 or more (M≧2), any one of below-described (a) to (c) is selected to shift to the step S24 (step S26).
(a) Select the phase in which the voltage command value is maximum.
(b) Select the phase in which the voltage command value is larger than the prescribed value #2.
(c) Select the phase in which the absolute value of the difference current value is maximum.
Further, after the step S11, it is decided whether or not the number of the phases M stored in the memory ABC1 is 1 and the phase corresponds to the phase stored in the memory ABC2 (step S30). When the number of the phases M stored in the memory ABC1 is 1 and the phase corresponds to the phase stored in the memory ABC2, the phase stored in the memory ABC2 is selected (step S31), then go to the step S24. In the step S30, when the number of the phases M stored in the memory ABC1 is not “1” or the phases do not correspond to the phases stored in the memory ABC2 or both the cases are established, the phases stored in the memory ABC1 are compared with the phases stored in the memory ABC2. For the phases that do not correspond to each other, it is decided whether or not the phases are present in which the voltage command values Da21 to Dc21 exceed the prescribed value #2 (step S32). When there is a relevant phase, for the phase detected in the memory ABC1 and the memory ABC2, the voltage command values Da2 to Dc2 and Da21 to Dc21 are calculated by using the current estimated values Ia2e, Ib2e and Ic2e (step S33). For the phase detected in the memories ABC1 and ABC2, a current at a next sampling time is estimated based on the current estimated values Ia2e to Ic2e of other phases, and for other phases than the phase, a current at a next sampling time is estimated based on the current detected values (step S34), then go to the step S23. Further, in the above-described step S32, when there is no relevant phase, the procedure advances to the step S31.
The voltage command value restricting part 40 corrects the voltage command values Da2, Db2 and Dc2 so that the current of at least (N−1) phases can be normally detected. For instance, as shown in
An ordinary model of a motor is expressed by a transfer function part shown in
x(k+1)=Ax(k)+Bu(k), y(k)=Cx(k) (1)
where
is a current value, d is a disturbance and C=[1 0]
Further, an observer is defined as a below-described Eq. (2). A sign “over hat” expresses an estimated value. A difference between the estimated value and a real value is multiplied by a gain L and an obtained value is fed back so that the estimated value becomes close to the real value.
{circumflex over (x)}(k+1)=A{circumflex over (x)}(k)+Bu(k)+L(y(k)−ŷ(k)) (2)
Then, when the current is normally detected in accordance with the above-described Eq. (1) and Eq. (2), the difference between the estimated value and the detected value of the real value becomes decreased. When the difference is small, the detection is considered to be normal and the detected value is inputted to the observer of the Eq. (2) and a current of a next sampling time is estimated. In the case of the failure or under the undetectable state, since the difference between the estimated value and the detected value is increased, it is decided that the detection is not normal and the sum of the current detected values of other phases is inputted to the observer of the Eq. (2) and a current of a next sampling time is estimated. Namely, when the current detecting systems of all the phases are normal, the current detected values are used for the estimation. When the current cannot be detected due to the failure or the error arises, the current detected values of other phases are used to estimate a current using the observer expressed by the above-described Eq. (2). When the current detecting systems of at least the (N−1) phases can detect the current, the observer is established. That is, when the current of the (N−1) phases cannot be detected, the current of remaining one phase cannot be obtained. When the duty ratio by which the current detecting circuit (361) can detect the current is known, the duty ratio may be adjusted or restricted so that the duty ratios of at least the (N−1) phases satisfy that condition. When one phase is failed, a final output restricted value is set to, for instance, a range of 0 to the prescribed value #2 instead a range of 0 to 100%, so that the current of all the phases except the failed phase can be detected. Thus, the control can be continuously carried out. Accordingly, in the present invention, for the phase in which the current cannot be detected, the current estimated value is used.
The current detected value Iad of one phase detected in the current detecting circuit 361 is inputted to a point 518A of the switching part 518. The current detected values Ibd and Icd of other phases are added in the adding part 519C, inverted in the inverting part 517A, and inputted to a point 518B of the switching part 518. The current estimated values Ib2e and Ic2e of other phases are added in the adding part 519D, inverted in the inverting part 517B and inputted to a point 518C of the switching part 518. The switching deciding part 516 switches the points 518A to 518C of the switching part 518 in accordance with the error between the current estimated value Ia2e and the current detected value Iad.
A dq axis current id and iq of the vector control is expressed as Eq. (3), where a resistance is R and an inductance is L.
Ψ in the Eq. (3) indicates √{square root over (3/2)} of the inter-linkage flux of an armature by a permanent magnet. Further, a model that considers a disturbance d is expressed as a below-described Eq. (4) and an estimated model of the form of Eq. (2) is obtained on the dq axes.
The voltage command values Da21, Db21 and Dc21 of the three phases from the voltage command value restricting part 40 are inputted to a three phase/two phase converting part 540 and converted to voltage command values Vd and Vq of two phases. The voltage command values Vd and Vq are inputted to a dq axis observer 560. The current values Iad, Ibd and Icd of the three phases detected in the current detecting circuit 361 are inputted to a three phase/two phase converting part 570. The motor angle θ from a position sensor 37 is inputted to the three phase/two phase converting parts 540 and 570. The three phase/two phase converting part 570 outputs current values id and iq of two phases to input the current values to the dq axis observer 560. The three phase/two phase converting parts 540 and 570 are converted in accordance with a below-described Eq. (5).
Here, since one phase of the three phases can be obtained by a calculation from other two phases, for instance, id and iq can be obtained as ib=−(ia+ic).
The motor angle θ is also inputted to a two phase/three phase converting part 550 and current estimated values Ia4e, Ib4e and Ic4e of three phases converted in the two phase/three phase converting part 550 are inputted to the three phase/two phase converting part 570. When errors between the current detected values Iad to Icd and the current estimated values Ia4e to Ic4e are respectively not smaller than a prescribed value, the three phase/two phase converting part 570 decides that the current detecting system is failed, and outputs the current estimated values Ia4e to Ic4e as feedback current Iad1 to Icd1. The two phase/three phase converting part 550 is converted in accordance with a below-described Eq. (6).
When the voltage command values are restricted by limiters of a final stage shown in
Further, in the above-description, the control of the three-phase motor is explained. However, the present invention may be similarly applied to a motor of two phases or more. An instance of the three-phase current control under the three-phase control is described above, however, a remaining one phase may be obtained from current control values of other two phases under a two-phase current control, in such a way as expressed by a voltage command value B=−(a voltage command value A+a voltage command value C). In the above-described embodiment, in the case of the undetectable state, the current estimated values are used as a feedback current, however, a value obtained by reversing the sign of the sum of the current detected values of other phases may be used as a feedback current.
When the difference between the detected value and the estimated value is compared with the prescribed value, the prescribed value may be provided with a hysteresis. Since the current detected value has quantized noise, there is a fear that a chattering state is generated which needs to be frequently switched under the fixed prescribed value. To prevent the generation of the chattering state, the prescribed value is provided with the hysteresis.
Further, the control method and the controller for the motor can be applied to the electric power steering device and a steering control of high performance and high reliability can be realized.
While the invention has been described in connection with the exemplary embodiments, it will be obvious to those skilled in the art that various changes and modification may be made therein without departing from the present invention, and it is aimed, therefore, to cover in the appended claims all such changes and modifications as fall within the spirit and scope of the present invention.
Number | Date | Country | Kind |
---|---|---|---|
2006161297 | Jun 2006 | JP | national |