Angle detecting apparatus
11047679 · 2021-06-29
Assignee
Inventors
- Tatsuya Mori (Chiyoda-ku, JP)
- Tetsuya Kojima (Chiyoda-ku, JP)
- Yoshihiko Kinpara (Chiyoda-ku, JP)
- Takayuki Kifuku (Chiyoda-ku, JP)
Cpc classification
G01D3/02
PHYSICS
G01D5/00
PHYSICS
International classification
G01B21/22
PHYSICS
G01D5/00
PHYSICS
Abstract
An angle detecting apparatus is obtained. The angle detecting apparatus is capable of correcting an electrical angle frequency component of an angle signal contained angle signal. An angle detecting apparatus computes an angle signal of a rotary machine from a sine signal and a cosine signal obtained from the angle signal. Offset correction values for the sine signal and the cosine signal are computed from the angle signal. The computed offset correction value for the sine signal is added to the sine signal to correct the sine signal, and the computed offset correction value for the cosine signal is added to the cosine signal to correct the cosine signal.
Claims
1. An angle detecting apparatus for computing an angle signal θr of a rotary machine, the angle detecting apparatus including: a resolver comprising a sine detection coil that obtains a sine signal and a cosine detection coil that obtains a cosine signal; an angle calculator that obtains the angle signal Or indicating a rotational angle of the rotary machine, from the sine signal and the cosine signal, at an initial stage; an offset correction value computing apparatus comprising: a differentiator which obtains the angle signal θr from the angle calculator, and performs a differentiation operation on the angle signal θr to obtain a velocity signal ω.sub.r from the angle signal θr; a low-pass filter which performs a low pass filtering on the velocity signal ω.sub.r to remove a frequency component higher than an electrical angle frequency of the angle signal θr and obtains a velocity signal ω.sub.0; a first integrator which integrates the velocity signal ω.sub.0 to obtain a filtered angle signal θ.sub.0, in which the filtered angle signal θ.sub.0 is reset to the angle signal θr in response to the angle signal θr passing a predetermined angle α; a subtracter which subtracts the filtered angle signal θ.sub.0 from the angle signal θr to obtain an angle error Δθ; a second integrator which integrates a value based on an inverted value −Δθ of the angle error Δθ and determines a sine offset correction value e.sub.s; and a third integrator which integrates a value based on the angle error Δθ and determines a cosine offset correction value e.sub.c; a first adder that calculates a sum of the sine signal and the sine offset correction value e.sub.s; and a second adder that calculates a sum of the cosine signal and the cosine offset correction value e.sub.c, wherein the angle calculator adjusts the angle signal θr at subsequent stages, based on the sum of the sine signal and the sine offset correction value e.sub.s, and the sum of the cosine signal and the cosine offset correction value e.sub.c, and wherein the rotatory machine is controlled based on the adjusted angle signal θr.
2. The angle detecting apparatus according to claim 1, wherein the second integrator which determines the sine offset correction value e.sub.s is further configured to integrate a cosine component of the inverted value −Δθ of the angle error Δθ and the third integrator which determines the cosine offset correction value e.sub.c is further configured to integrate a sine component of the angle error Δθ.
3. The angle detecting apparatus according to claim 2, wherein the second integrator which determines the sine offset correction value e.sub.s is further configured to integrate the cosine component of the inverted value −Δθ of the angle error Δθ during a rotary machine mechanical angle cycle to obtain the sine offset correction value e.sub.s and the third integrator which determines the cosine offset correction value e.sub.c is further configured to integrate the sine component of the angle error Δθ during the rotary machine mechanical angle cycle to obtain the cosine offset correction value e.sub.c.
4. The angle detecting apparatus according to claim 3, wherein the sine component contained in the angle signal θr is obtained from a location at which the angle signal θr has passed 90 degrees or 270 degrees, and the cosine component contained in the angle signal θr is obtained from a location at which the angle signal θr has passed 0 degrees or 180 degrees.
5. The angle detecting apparatus according to claim 1, wherein the angle detecting apparatus is further configured to compute the sine and the cosine offset correction values e.sub.s and e.sub.c in response to a velocity of the rotary machine being greater than or equal to a predetermined value.
6. The angle detecting apparatus according to claim 1, wherein the resolver uses magnetic reluctance.
7. The angle detecting apparatus according to claim 1, wherein the resolver includes an encoder.
8. The angle detecting apparatus according to claim 1, wherein the resolver includes a Hall element.
9. An angle detecting apparatus for computing an angle signal θr of a rotary machine, the angle detecting apparatus including: a resolver comprising a sine detection coil that obtains a sine signal and a cosine detection coil that obtains a cosine signal; an angle calculator that obtains the angle signal Or indicating a rotational angle of the rotary machine, from the sine signal and the cosine signal, at an initial stage; an offset correction value computing apparatus comprising: a differentiator which obtains the angle signal θr from the angle calculator, and performs a differentiation operation on the angle signal θr to obtain a velocity signal ω.sub.r from the angle signal θr; a low-pass filter which performs a low pass filtering on the velocity signal ω.sub.r to remove a frequency component higher than an electrical angle frequency of the angle signal θr and obtains a velocity signal ω.sub.0; a first integrator which integrates the velocity signal ω.sub.0 to obtain a filtered angle signal θ.sub.0, in which the filtered angle signal θ.sub.0 is reset to the angle signal θr in response to the angle signal θr passing a predetermined angle α; a subtracter which subtracts the filtered angle signal θ.sub.0 from the angle signal θr and obtains an angle error D.sub.q; a second integrator which integrates a cosine component of an inverted value −Dq of the angle error Dq and determines a sine offset correction value e.sub.s which represents a direct current value for the analog sine signal; a third integrator which integrates a sine component of the angle error Dq and determines a cosine offset correction value e.sub.c which represents a direct current value for the analog cosine signal; a first adder that calculates a sum of the sine signal and the offset correction value e.sub.s; and a second adder that calculates a sum of the cosine signal and the cosine offset correction value e.sub.c, wherein the angle calculator adjusts the angle signal θr at subsequent stages, based on the sum of the sine signal and the sine offset correction value e.sub.s, and the sum of the cosine signal and the cosine offset correction value e.sub.c, and wherein the rotatory machine is controlled based on the adjusted angle signal θr.
10. The angle detecting apparatus according to claim 9, wherein the sine and the cosine offset correction values e.sub.s and e.sub.c are computed based on the angle signal θr with a period of an integer multiple of a rotary machine mechanical angle cycle.
11. The angle detecting apparatus according to claim 10, wherein the sine component contained in the angle signal θr is obtained from a location at which the angle signal θr has passed 90 degrees or 270 degrees, and the cosine component contained in the angle signal θr is obtained from a location at which the angle signal θr has passed 0 degrees or 180 degrees.
12. The angle detecting apparatus according to claim 9, wherein the angle detecting apparatus is further configured to compute the sine and the cosine offset correction values e.sub.s and e.sub.c in response to a velocity of the rotary machine being greater than or equal to a predetermined value.
13. The angle detecting apparatus according to claim 9, wherein the resolver uses magnetic reluctance.
14. The angle detecting apparatus according to claim 9, wherein the resolver includes an encoder.
15. The angle detecting apparatus according to claim 9, wherein the resolver includes a Hall element.
Description
BRIEF DESCRIPTION OF DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
(14)
DESCRIPTION OF EMBODIMENTS
First Preferred Embodiment
(15)
(16) Next, a processing method for the signals output from the resolver 1 will be described. Referring to
(17) Next, the offset correction value computing means 11 is described.
(18) An offset correction value computing unit 85 outputs the sine signal offset correction value e.sub.s and the cosine signal offset correction value e.sub.c based on the input angle signal θr and the input velocity signal ω.sub.0. An integrator 23 integrates the velocity signal ω.sub.0 and outputs the angle signal θ.sub.0.
(19) Here, the angle signal θ.sub.0 contains the function to reference the angle signal θr and reset the angle signal θ.sub.0 to the value of the angle signal θr when the angle signal θr passes a predetermined reference angle α degrees. Thus, the angle signal θ.sub.0 is one obtained by integrating the velocity signal ω.sub.0, and therefore, the angle signal θ.sub.0 is an angle signal from which the frequency component equal to or higher than the electrical angle frequency of the angle signal is removed from the angle signal θr. A subtracter 24 subtracts the angle signal θ.sub.0 from the angle signal θr, and calculates an angle error Δθ, from which the frequency component lower than the electrical angle frequency of the angle signal θr has been removed.
(20) This configuration can eliminate the influence of velocity variation of the rotary machine from the angle signal θr when extracting the angle error Δθ because the frequency of velocity variation of the rotary machine is generally lower than the 1f angle error. Therefore, it becomes possible to compute the offset correction value accurately. When the angle error Δθ is input, a gain 25 outputs an angle error inverted value −Δθ obtained by multiplying the angle error Δθ by −1. In delay units 26 and 27, a reference character z indicates an operator representing transform, and each of the delay units 26 and 27 outputs a signal that has been input one operation cycle earlier of the offset correction value computing means 11.
(21) A switch 28 has two inputs A and B. It outputs the input A (angle error inverted value −Δθ) when it is determined that the angle signal θ.sub.0 has passed approximately 0 degrees, and outputs the input B (one operation cycle earlier value of the output of the switch 28) in other cases.
(22) Accordingly, the output of the switch 28 is an angle error inverted value −Δθ.sub.e0 at the time when the angle signal θ.sub.0 has passed approximately 0 degrees, and the output of the switch is updated every time the angle signal θ.sub.0 passes approximately 0 degrees again. The switch 28 according to the first preferred embodiment is configured to output the angle error inverted value −Δθ.sub.e0 at the time when the angle signal θ.sub.0 passes approximately 0 degrees. However, it is also possible to employ such a configuration that, when it: is determined that the angle signal θ.sub.0 has passed approximately 180 degrees, the switch 28 outputs input A (angle error Δθ), and in other cases, the switch 28 outputs input B (one operation cycle earlier value of the output of the switch 28) and inputs it into an integrator 30.
(23) In this case, the output of the switch 28 is an angle error Δθ.sub.e180 at the time when the angle signal θ.sub.0 has passed approximately 180 degrees, and the output is updated every time the angle signal passes approximately 180 degrees. Alternatively, it is also possible to employ the following configuration. The angle error inverted value −Δθ.sub.e0 and the angle error Δθ.sub.e180 may be output from the switch 28. The average value Δθ.sub.e0-180 thereof is obtained, and is input to the integrator 30.
(24) A switch 29 has two inputs A and B. It outputs the input A (angle error Δθ) when it is determined that the angle signal θ.sub.0 has passed approximately 90 degrees, and outputs the input B (one operation cycle earlier value of the output of the switch 29) in other cases. Accordingly, the output of the switch 29 is an angle error Δθ.sub.e90 at the time when the angle signal θ.sub.0 has passed approximately 90 degrees, and the output is updated every time the angle signal θ.sub.0 passes approximately 90 degrees again.
(25) The switch 29 according to the first preferred embodiment is configured to output the angle error Δθ.sub.e90 at the time when the angle signal θ.sub.0 has passed approximately 90 degrees. However, it is also possible to employ such a configuration that, when it is determined that the angle signal θ.sub.0 has passed approximately 270 degrees, the switch 29 outputs input A (angle error inverted value −Δθ), and in other cases, the switch 29 outputs input B (one operation cycle earlier value of the output of the switch 29) and inputs it into an integrator 31. In this case, the output of the switch 29 is an angle error inverted value −Δθ.sub.e270 at the time when the angle signal θ.sub.0 has passed approximately 270 degrees, and the output is updated every time the angle signal passes approximately 270 degrees. Alternatively, it is also possible to employ the following configuration. The switch 29 outputs the angle error Δθ.sub.e90 and the angle error inverted value −Δθ.sub.e270. The average value Δθ.sub.e90-270, thereof is obtained, and is input to the integrator 31.
(26) The integrator 30 outputs a value obtained by integrating the angle error inverted value −Δθ.sub.e0 as the sine signal offset correction value e.sub.s. Likewise, the integrator 31 outputs a value obtained by integrating the angle error inverted value −Δθ.sub.e90 as the cosine signal offset correction value e.sub.c. Here, a reference character K denotes feedback gain. By adjusting this, the computation response of the sine signal offset correction value e.sub.s and the cosine signal offset correction value e.sub.c from the angle signal θr is adjusted.
(27) Next, the computation for offset correction values of this invention will be described.
(28)
(29) In this invention, the frequency component that is lower than the frequency of the 1f angle error is removed from the angle signal θr. Using the angle error Δθ obtained by extracting the frequency component equal to or higher than the frequency of the 1f angle error, an offset correction value for the sine signal is obtained from cosine component of the inverted value −Δθ of the 1f angle error. Then, the obtained offset correction value for the sine signal is added to the sine signal, and an offset correction value for the cosine signal is obtained from the sine component of the angle error Δθ. The obtained offset correction value for the cosine signal is added to the cosine signal, whereby the angle signal θr is obtained.
(30) In the case where the angle error Δθ is represented approximately as the following equation (1), the sine component is represented as θ1f cos(α) and the cosine component is represented as θ1f sin(α), when converting equation (1) into equation (2), and these are obtained in equation (2) when θ=0 degrees and when θ=90 degrees, respectively. So, taking this into account, the angle error inverted value −Δθ.sub.e0 and the angle error Δθ.sub.e90 are obtained from the switch 28 and the switch 29, respectively, in the first preferred embodiment.
Δθ=θ1f sin(θ+α) (1)
Δθ=θ1f cos(α)sin(θ)+θ1f sin(α)cos(θ) (2)
(31) However, in equations (1) and (2), θ1f is the amplitude of the 1f angle error, θ is the angle (electrical angle) of the rotary machine, and α is the initial phase angle of the angle error Δθ.
(32) In the first preferred embodiment, it is possible that the low-pass filter 22 may be a second order or higher low-pass filter, other than the first order low-pass filter as shown in
(33) The conventional angle detecting apparatus has a structure in which the midpoint (offset) errors are corrected based on the sine signal and the cosine signal. The frequency component that is two times the 1f angle error, which is contained in the sine signal and the cosine signal, does not appear in the midpoint (offset), and it is impossible to correct the 1f angle error resulting from the just-mentioned component,
(34) The angle detecting apparatus according to the first preferred embodiment computes the sine signal offset correction value e.sub.s and the cosine signal offset correction value e.sub.c respectively based on the angle signal θr. Therefore, it can perform 1f angle error correction taking into consideration the 1f angle error of the an ole signal that is caused by the sine signal and the cosine signal containing a frequency component that is two times the 1f angle error. Moreover, the sine signal offset correction value and the cosine signal offset correction value are calculated so that the correction amounts thereof will be direct current quantities, the errors resulting from phase shift, such as those observed in the conventional angle detecting apparatus, do not occur even when there is wasted time in calculating the offset correction, values. Therefore, the configuration according to the first preferred embodiment can obtain an advantageous effect that it becomes possible to use a low cost CPU, which has a low computing speed.
Second Preferred Embodiment
(35) In the first preferred embodiment, the offset correction values are computed based on the angle signal of electrical angle cycle. However, the offset correction values may be computed based on an angle signal with a period of an integer multiple of the rotary machine mechanical angle cycle.
(36) An offset correction value computing unit 85a outputs the sine signal offset correction value e.sub.s and the cosine signal offset correction value e.sub.c based on the input angle signal θr and the input velocity signal ω.sub.0. A feature of the second preferred embodiment is that a 0-degree mechanical angle error computing means 90 is provided downstream of the inverted value −Δθ of the angle error Δθ and that a 90-degree mechanical angle error computing means 91 is provided downstream, of the angle error Δθ. The resolver 1 has a rotor with an N angle multiplication factor, which outputs a signal for N rotations when the rotation shaft of the rotary machine rotates one rotation.
(37) In many cases, the angle signals for N rotations at the time when the rotary machine rotates one rotation contain different angle errors from each other. For this reason, it is desirable that the correction of the angle error be performed every mechanical angle cycle of the rotary machine.
(38) So, the 0-degree mechanical angle error computing means 90 executes the following calculation if it is determined that the angle signal θ.sub.0 has passed 0 degrees.
−Δθ.sub.m0=(−Δθ−Δθ.sub.0-1−Δθ.sub.0-2 . . . −Δθ.sub.0-(N-1))/N (3)
Here, Δθ.sub.0-i (i=1 to N−1) represents the value of Δθ at the time when it was determined that the angle signal θ.sub.0 passed 0 degrees i times before the computation of equation (3), and N represents an angle multiplication factor. On the other hand, if it is not determined that the angle signal θ.sub.0 has passed 0 degrees, it outputs the value that was obtained by equation (3) at the last time when it was determined that the angle signal θ.sub.0 passed 0 degrees.
(39) Here, instead of executing the calculation of equation (3), the 0-degree mechanical angle error computing means 90 may execute the calculation according to the following equation (4) using the angle error Δθ in the case where it was determined that the angle signal θ.sub.0 passed 180 degrees.
Δθ.sub.m180=(Δθ+Δθ.sub.180-1−Δθ.sub.180-2 . . . −Δθ.sub.180-(N-1))/N (4)
Here, Δθ.sub.180-i (i=1 to N−1) represents the value of Δθ at the time when it was determined that the angle signal θ.sub.0 is 180 degrees i times before the computation of equation (4), and N represents an angle multiplication factor. If it is not determined that the angle signal θ.sub.0 has passed 180 degrees, it outputs the value that was obtained by equation (4) at the last time when it was determined that the angle signal θ.sub.0 passed 180 degrees.
(40) Likewise, the 90-degree mechanical angle error computing means 91 executes the following calculation if it is determined that the angle signal θ.sub.0 has passed 90 degrees.
Δθ.sub.m90=(Δθ+Δθ.sub.90-1+Δθ.sub.90-2 . . . +Δθ.sub.90-(N-1))/N (5)
Here, Δθ.sub.90-i (i=1 to N−1) represents the value of Δθ at the time when it was determined that the angle signal θ.sub.0 is 90 degrees i times before the computation of equation (5), and N represents an angle multiplication factor.
(41) If it is not determined that the angle signal θ.sub.0 has passed 90 degrees, it outputs the value that was obtained by equation (5) at the last time when it was determined that the angle signal θ.sub.0 passed 90 degrees.
(42) Likewise, instead of executing the calculation of equation (5), the 90-degree mechanical angle error computing means 91 may execute the calculation according to the following equation (6) using the angle error Δθ in the case where it was determined that the angle signal θ.sub.0 passed 270 degrees.
−Δθ.sub.m270=(−Δθ−Δθ.sub.270-1−Δθ.sub.270-2 . . . −Δθ.sub.270-(K-1))/N (6)
Here, Δθ.sub.270-1 (i=1 to N−1) represents the value of Δθ at the time when it was determined that the angle signal θ.sub.0 passed 270 degrees i times before the computation of equation (6) and N represents an angle multiplication factor. If it is not determined that the angle signal θ.sub.0 has passed 270 degrees, it outputs the value that was obtained by equation (6) at the last time when it was determined that the angle signal θ.sub.0 passed 270 degrees.
(43) The angle error inverted value −Δθ.sub.m0 computed by equation (3) is the average value of the angle error inverted values −Δθ for one mechanical angle cycle of the rotary machine, in the location at which the angle signal θ.sub.0 has passed 0 degrees. Accordingly, by using the sine signal offset correction value e.sub.s obtained by inputting the angle error inverted value −Δθ.sub.m0 into the integrator 30 as the sine signal offset correction value, it is possible to carry out the correction of the sine signal corresponding to the mechanical angle cycle of the rotary machine. Furthermore, the same advantageous effects are obtained when the angle error Δθ.sub.m180 computed from equation (4) is used as the input to the integrator 30 and when equations (3) and (4) are computed to obtain the angle error inverted value −Δθ.sub.m0 and the angle error Δθ.sub.m180 and the average values thereof are used.
(44) Likewise, the angle error Δθ.sub.m90 computed in equation (5) is the average value of the angle errors Δθ for one mechanical angle cycle of the rotary machine, in the location at which the angle signal θ.sub.0 has passed 90 degrees. Accordingly, by using the cosine signal offset correction value e.sub.c obtained by inputting the angle error Δθ.sub.m90 into the integrator 31, it is possible to carry out the correction of the cosine signal corresponding to the mechanical angle cycle of the rotary machine. Furthermore, the same advantageous effects are obtained when the angle error inverted value −Δθ.sub.m270 computed from equation (6) is used as the input to the integrator 31 and when equations (5) and (6) are computed to obtain the angle error Δθ.sub.m90 and the angle error inverted value −Δθ.sub.m270 and the average values thereof are used.
(45) In the computation of equations (3) through (6), the angle error or the inverted value of the angle error for the mechanical angle cycle of the rotary machine are calculated. However, if the computation period is set to be a period of an integer multiple of the mechanical angle of the rotary machine, the high-frequency noise component is smoothed and the component based on the electrical angle cycle is not produced. Therefore, the angle error or the inverted value of the angle error based on the mechanical angle cycle can be obtained highly accurately. Thus, the second preferred embodiment can perform offset correction corresponding to the mechanical angle cycle of the rotary machine.
Third Preferred Embodiment
(46)
(47) Hereinbelow, a computation in the third preferred embodiment will be described. An offset correction value computing unit 85b outputs the sine signal offset correction value e.sub.s and the cosine signal offset correction value e.sub.c based on the input angle signal θr and the input velocity signal ω.sub.0. A cosine value calculator 41 calculates a cosine value cos (θ.sub.0) of the angle signal θ.sub.0. Likewise, a sine value calculator 42 calculates a sine value sin(θ.sub.0) of the angle signal θ.sub.0. A multiplier 43 multiplies the cosine value cos (θ.sub.0) by the angle error Δθ to obtain Δθ cos(θ.sub.0). Likewise, a multiplier 44 multiplies the sine value sin(θ.sub.0) by the angle error Δθ to obtain Δθ sin(θ.sub.0).
(48) An integrator 45 performs the computation of the following equation (7) with Δθ cos(θ.sub.0) to compute a cosine component θ.sub.1f_cos_amp of the angle error inverted value −Δθ. Here T.sub.2 denotes the electrical angle cycle of the angle signal θr.
(49)
(50) Likewise, an integrator 46 performs the computation of the following equation (8) with Δθ sin(θ.sub.0) to compute a sine component θ.sub.1f_sin_amp of the angle error Δθ. T.sub.2 is set to the same value as that in equation (7)
(51)
(52) Then, the cosine component θ.sub.1f_cos_amp of the angle error inverted value −Δθ is input to the integrator 30, and the output thereof is used as the sine signal offset correction value e.sub.s. Likewise, the sine component θ.sub.1f_sin_amp of the angle error Δθ is input to the integrator 31, and the output thereof is used as the cosine signal offset correction value e.sub.c. It should be noted that, in the computation in the integrators 45 and 46, T.sub.2 may be the mechanical angle cycle of the rotary machine. This makes it possible to obtain the sine signal offset correction value e.sub.s and the cosine signal offset correction value e.sub.c that correspond to the mechanical angle cycle of the rotary machine.
(53) Moreover, when the T.sub.2 is set to an integer multiple the mechanical angle cycle of the rotary machine, the high-frequency noise component contained in the sine component and the cosine component of the angle error is smoothed, and the component used on the electrical angle cycle is not generated. Therefore, it is possible to increase the noise resistance for the just-mentioned sine signal offset correction value e.sub.s and the just-mentioned cosine signal offset correction value e.sub.c corresponding to the mechanical angle cycle of the rotary machine. As described above, in the third, preferred embodiment, the sine signal offset correction value is calculated by obtaining the cosine component contained in the angle signal, and the cosine signal offset correction value is calculated by obtaining the sine component contained in the angle signal. In addition to the advantageous effects of the first and second preferred embodiments, this makes it possible to compute the sine signal offset correction value and the cosine signal offset correction value accurately even when angle error components other than the 1f angle error are contained in the case where the angle error Δθ of the angle signal θr is represented by equation (1) described in the first preferred embodiment.
(54) The reason is explained in the following. In the first and second preferred embodiments, the offset correction values are computed based on the angle error Δθ when the angle signal θ.sub.0 is approximately at 0 degrees and approximately at 90 degrees. However, if the angle error Δθ contains angle error components other than the 1f angle error, the angle error components other than the 1f angle error are contained in addition to the cosine component and the sine component of the angle error Δθ respectively at the time when the angle signal θ.sub.0 is approximately at 0 degrees and approximately at 90 degrees, so the calculated offset correction values may have errors. On the other hand, in the third preferred embodiment, the cosine component and the sine component in the angle error Δθ are extracted respectively with the use of the integrators 45 and 46. Therefore, even when the angle error Δθ contains angle error components other than the 1f angle error, the 1f angle error can be extracted and the offset correction values can be computed accurately. Thus, even when the angle signal of the resolver contains angle error components other than the 1f angle error, the offset correction can be carried out accurately.
Fourth Preferred Embodiment
(55)
(56) As an example,
(57) Hereinbelow, in order to resolve such a problem, the fourth preferred embodiment introduces an integrator 51 for resetting an angle signal. θ.sub.0 cos, which is the output therefrom, to the value of the angle signal θr at the location at which the angle signal θr passes 0 degrees, to obtain the cosine component of the angle signal. It also introduces an integrator 52 for resetting an angle signal θ.sub.0 sin, which is the output therefrom, to the value of the angle signal θr, to calculate the cosine signal offset correction value e.sub.c at the location at which the angle signal θr passes 90 degrees. A subtracter 53 subtracts the angle signal θ.sub.cos, from the angle signal θr and calculates an angle error Δθ. Likewise, a subtracter 54 subtracts the angle signal θ.sub.0 sin from the angle signal θr, and calculates an angle error Δθ.sub.sin.
(58) A cosine value calculator 55 calculates a cosine value cos(θ.sub.0 cos) of the angle signal θ.sub.0 cos.
(59) Likewise, a sine value calculator 56 calculates a sine value sin(θ.sub.0 sin) of the angle signal θ.sub.0 sin. A multiplier 57 multiplies the cosine value cos (θ.sub.0 cos) by the angle error Δθ.sub.cos to calculate Δθ.sub.0, cos(θ.sub.0 cos). Likewise, a multiplier 58 multiplies the sine value sin (θ.sub.0 sin) by the angle error Δθ.sub.sin to calculate Δθ.sub.sin sin (θ.sub.0 sin).
(60) An integrator 59 performs the computation of the following equation (9) with Δθ cos (θ.sup.0 cos) to compute a cosine component θ.sub.1f_cos_amp of the angle error inverted value −Δθ.sub.cos. Here, T.sub.2 is the value explained in the third preferred embodiment. Hereinbelow, resetting of equation (9) is discussed. In the case where T.sub.2 is selected to be the angle cycle of the angle signal θr, θ.sub.1f_cos_amp is reset to 0 and the computation of equation (9) is started again when the angle signal θr passes 0 degrees. In the case where T.sub.2 is set to be M times (M: natural number) the mechanical angle cycle of the rotary machine, θ.sub.1f_cos_amp is reset to 0 and the computation of equation (9) is started every time the angle signal θr passes 0 degrees for the number of times obtained by multiplying an angle multiplication factor N of the resolver by the integer M.
(61)
(62) Likewise, an integrator 60 performs the computation of the following equation (10) with Δθ.sub.sin sin(θ.sub.0 sin) to compute a sine component θ.sub.1f_sin_amp of the angle error Δθ.sub.sin. Here, T.sub.2 is the value explained in the third preferred embodiment. Hereinbelow, resetting of equation (10) is discussed. In the case where T.sub.2 is selected to be the angle cycle of the angle signal θr, θ.sub.1f_sin_amp is reset to 0 and the computation of equation (10) is started again when the angle signal θr passes 90 degrees. In the case where T.sub.2 is set to be M times (M: natural number) the mechanical angle cycle of the rotary machine, θ.sub.1f_sin_amp is reset to 0 and the computation of equation (10) is started every time the angle signal θr passes 90 degrees for the number of times obtained by multiplying an coals multiplication factor N of the resolver by the integer M.
(63)
(64) Then, the cosine component of the angle error inverted value −Δθ is input to the integrator 30, and the output thereof is used as the sine signal offset correction value e.sub.s. Likewise, the sine component θ.sub.1f_sin_amp of the angle error Δθ.sub.sin is input to the integrator 31, and the output thereof is used as the cosine signal offset correction value e.sub.c.
(65)
Fifth Preferred Embodiment
(66) In the computation of the velocity signal ω.sub.0 in the first through fourth preferred embodiments, when the velocity of the rotary machine is low, the frequency of velocity variation of the rotary machine and the frequency of 1f angle error are brought close to each other. This cases the offset correction values to nave correction errors. This is because, in the low-pass filter 22 in the first through third preferred embodiments, it becomes difficult to design such a filter that blocks the frequency component of the 1f angle error and also allows the frequency component of the velocity variation of the rotary machine to pass therethrough.
(67) The reason why the designing of the filter becomes difficult will be explained in the following. As an example, it is assumed that the frequency of the velocity variation of the rotary machine is 10 Hz and the 1f angle error is −20 dB or lower. At this time, when the order of the low-pass filter 22 is set to 1 and the cut-off frequency thereof is set to f1 (=10 Hz), the Bode diagram (approximation line profile) as shown in
(68) Therefore, the target is not satisfied unless the frequency of the 1f angle error is 10 times or higher the frequency of the velocity variation. For the reason stated above, the designing of the filter becomes difficult when the frequency of the 1f angle error becomes close to the frequency of the velocity variation.
(69) In view of this, the fifth preferred embodiment sets the computation in the first through fourth preferred embodiments so that the velocity of the rotary machine becomes equal to or higher than a predetermined value. This makes it possible to remove the influence of the above-described interference.
(70) Each of the switches 81 and 82 has two inputs A and B. Each of the switches outputs the input A in the case where it is determined that the velocity signal ω.sub.0 is higher than a predetermined reference velocity ω, and outputs the input B in other cases. A reference character z in delay units 83 and 84 indicates an operator representing z transform, and each of the delay units 83 and 84 outputs, as the output signal, an input signal to the offset correction value computing means 11 that has been input one operation cycle earlier. Thus, the switch 81 outputs the input A, which is the output of the integrator 30 in the case where it is determined that the velocity signal ω.sub.0 is higher than the predetermined reference velocity ω, and in other cases, it outputs the input B, which is the sine signal offset correction value e.sub.s at one operation cycle earlier. Thus, the switch 81 updates the output signal when the velocity signal ω.sub.0 is higher than the reference velocity co.
(71) Likewise, the switch 82 outputs the input A, which is the output of the integrator 31 in the case where it is determined that the velocity signal ω.sub.0 is higher than the predetermined reference velocity co, and in other cases, it outputs the input B, which is the cosine signal offset correction value e.sub.c at one operation cycle earlier. Thus, the switch 82 updates the output signal when the velocity signal ω.sub.0 is higher than the reference velocity ω.
(72) Referring to
(73) As described above, it is possible to eliminate the errors in the offset correction values resulting from the interference by the frequency of the 1f angle error and the frequency of velocity variation of the rotary machine by, performing the computation of the offset correction values when the velocity signal ω.sub.0 is higher than the reference velocity ω. In particular, when the rotary machine is a motor for electric power steering, the correction of the 1f angle error can be performed effectively by setting the reference velocity ω to a velocity that is higher than the steering operation frequency of the driver. In addition, as the velocity of the rotary machine increases, the number of times of the computation per one rotation of the rotary machine decreases, and therefore, the offset correction accuracy lowers. In view of this, each of the switches 81 and 82 may be allowed to output the input A in the case where it is determined that the velocity signal is lower than a predetermined reference velocity and to output the input B in other cases. Thereby, it is also possible to set the computation of the offset correction values to be performed when the velocity of the rotary machine is equal to or less than a predetermined value.
(74) Needless to say, this invention can be implemented accurately by reducing the errors in the inverter output voltage in the case where a torque ripple of the rotary machine or the rotary machine is driven by a power converter such as an inverter and the ripple components in angle detection resulting from the torque ripple due to the errors in electric current detection with the use of a filter or the like.
(75) Furthermore, although the description has been made about the resolver with a two-phase output in the first through fifth preferred embodiments, this invention is not limited thereto, and the same advantageous effects can be obtained also in the cases where the invention is applied to a resolver with a three or more phase output.
(76) In addition, although the description has been made about the cases where the invention is applied to a resolver with a two-phase output and a resolver with a three or more phase output in the first through fifth preferred embodiments, this invention is not limited thereto. The same advantageous effects can be obtained also in the cases where the invention is applied to an angle detector with a two-phase output or with a three or more phase output, including sensors utilizing magneto resistive (MR), such as a sensor utilizing anisotropic may (AMR), a sensor utilizing giant magnetoresistive (GMR), and a sensor utilizing tunneling magnetoresistive (TMR), an encoder, and a Hall element.
(77) The present invention may be within the scope of the invention, or any combination of the embodiments, as appropriate, modified to respective embodiments, will be omitted.
(78) Various modifications and alterations of this invention will be apparent to those skilled in the art without departing from the scope and spirit of this invention, and it should be understood that this invention is not limited to the illustrative embodiments set forth herein.