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.
|
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 ωr from the angle signal θr;
a low-pass filter which performs a low pass filtering on the velocity signal ωr to remove a frequency component higher than an electrical angle frequency of the angle signal θr and obtains a velocity signal ω0;
a first integrator which integrates the velocity signal ω0 to obtain a filtered angle signal θ0, in which the filtered angle signal θ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 θ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 es; and
a third integrator which integrates a value based on the angle error Δθ and determines a cosine offset correction value ec;
a first adder that calculates a sum of the sine signal and the sine offset correction value es; and
a second adder that calculates a sum of the cosine signal and the cosine offset correction value ec,
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 es, and the sum of the cosine signal and the cosine offset correction value ec, and
wherein the rotatory machine is controlled based on the adjusted angle signal θr.
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 ωr from the angle signal θr;
a low-pass filter which performs a low pass filtering on the velocity signal ωr to remove a frequency component higher than an electrical angle frequency of the angle signal θr and obtains a velocity signal ω0;
a first integrator which integrates the velocity signal ω0 to obtain a filtered angle signal θ0, in which the filtered angle signal θ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 θ0 from the angle signal θr and obtains an angle error dq;
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 es 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 ec 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 es; and
a second adder that calculates a sum of the cosine signal and the cosine offset correction value ec,
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 es, and the sum of the cosine signal and the cosine offset correction value ec, and
wherein the rotatory machine is controlled based on the adjusted angle signal θr.
2. The angle detecting apparatus according to
3. The angle detecting apparatus according to
4. The angle detecting apparatus according to
5. The angle detecting apparatus according to
6. The angle detecting apparatus according to
8. The angle detecting apparatus according to
10. The angle detecting apparatus according to
11. The angle detecting apparatus according to
12. The angle detecting apparatus according to
13. The angle detecting apparatus according to
15. The angle detecting apparatus according to
|
This is a National Stage of International Application No. PCT/JP2012/082148 filed Dec. 12, 2012, claiming priority based on Japanese Patent Application No. 2012-059731 filed Mar. 16, 2012, the contents of all of which are incorporated herein by reference in their entirety.
This invention relates to an angle detecting apparatus.
A resolver is mechanically robust and excellent, in environmental resistance. For this reason, the resolver is widely used for detecting the rotation angle of a rotary machine. However, the resolver usually has errors resulting from decentering of a rotor and errors resulting from temperature drift of a differential amplifier, or the like and these errors appear as errors in the calculated angle. In view of this, according to PTL 1, midpoint correction values for a sine signal and a cosine signal of a resolver are stored in advance in an EEPROM (Electrically Erasable Programmable Read-Only Memory) or the like. Alternatively, according to PTL 1, the peak values and the bottom values of a sine signal, and a cosine signal are read, and a midpoint correction value is obtained from the difference between a predetermined midpoint value and midpoint between the peak value and the bottom value. The midpoint, correction value is added to the sine signal and the cosine signal to perform correction, and the angle of a rotary machine is calculated from the corrected sine signal and cosine signal.
In PTL 2, an angle signal is detected from the signals detected in a resolver, and from the detected angle signal, a velocity signal is detected. By making use of the fact that the error waveform of a resolver is composed of n-th order component inherent, to the resolver and that it is reproducible, an angle error estimator calculates the size of the error for each of a plurality of divided components by frequency converting, for example, Fourier transforming a high-frequency component of a velocity signal containing an error, which is generated from the detected angle signal containing an error. The calculated errors are synthesized to generate an error waveform signal in which the detected errors are recovered. With the use of this error waveform signal, an angle signal correcting circuit corrects the angle signal containing an error that has been detected by the resolver.
Patent Literature
PTL 1: JP-A-2008-273478
PTL 2: JP-A-2009-156852
Among the angle errors for the angle signal of the rotation angle of a rotary machine detected by the resolver, which are due to the midpoint error caused by correcting a midpoint error (offset) the conventional angle detecting apparatus as disclosed in PTL 1 can correct an electrical angle frequency component of the angle signal. (Hereinafter, the electrical angle frequency of an angle signal is abbreviated as “1f”, and the electrical angle frequency component of the angle signal is referred to as “1f angle error”.) However, it cannot correct the 1f angle error resulting from the sine signal and the cosine signal containing the frequency component that is two times the 1f angle error.
Moreover, in the conventional angle detecting apparatus disclosed in PTL 2, the error waveform signal calculated in the angle error estimator is alternating quantity. Therefore, as the rotary machine rotates at a higher speed, the frequency of the error waveform signal becomes higher, so if there is a wasteful time in the calculation at the angle error estimator a phase shift occurs in the error waveform signal, and the error cannot be corrected accurately. Accordingly, the computing speed of the angle error estimator needs to be shortened, and the process load for the microcomputer increases.
This invention has been accomplished in order to solve the problems as described above, and it is an object of the invention to obtain an angle detecting apparatus that is capable of correcting 1f angle errors contained in the angle signal even when the sine signal and the cosine signal contain the frequency components that are twice the standard wave components thereof.
An angle detecting apparatus according to this invention is for computing an angle signal of a rotary machine from a sine signal and a cosine signal obtained from an angle detector, and the angle detecting apparatus is configured to compute respective offset correction values for the sine signal and the cosine signal from the angle signal, to add the computed sine signal offset correction value to the sine signal to correct the sine signal, and to add the computed cosine signal offset correction value to the cosine signal to correct the cosine signal.
In addition, the angle detecting apparatus according to this invention is configured to: by using an angle error Δθ obtained by removing, from the angle signal, a frequency component lower than the frequency of an electrical angle frequency component and extracting a frequency component equal to or higher than the frequency of the electrical angle frequency component, obtain the sine signal offset correction value from a cosine component of an inverted value −Δθ of the angle error Δθ and add the sine signal offset correction value to the sine signal, and is configured to obtain the cosine signal offset correction value from a sine component of the angle error Δθ and add the cosine signal offset correction value to the cosine signal, whereby the sine signal and the cosine signal are corrected.
with the angle detecting apparatus of this invention, the offset correction values for the sine signal and the cosine signal are computed from the angle signal to correct the sine signal and the cosine signal. Therefore, it becomes possible to correct the 1f angle error the electrical angle frequency component of the angle signal) even in the case where the sine signal and the cosine signal contain the frequency components that are two times the standard wave components thereof, in addition to the case where the midpoint errors of the sine signal and the cosine signal exist. Moreover, because the offset correction values are direct current quantities, the correction value computation is made possible at a low control response even in the case where the rotary machine rotates at high speed, noise resistance is improved, and it is made possible to use a central processing unit (CPU) with a low computing speed.
The foregoing and other object, features, aspects, and advantages of the present invention will become more apparent from the following detailed description of the present invention, when taken in conjunction with the accompanying drawings.
Next, a processing method for the signals output from the resolver 1 will be described. Referring to
Next, the offset correction value computing means 11 is described.
An offset correction value computing unit 85 outputs the sine signal offset correction value es and the cosine signal offset correction value ec based on the input angle signal θr and the input velocity signal ω0. An integrator 23 integrates the velocity signal ω0 and outputs the angle signal θ0.
Here, the angle signal θ0 contains the function to reference the angle signal θr and reset the angle signal θ0 to the value of the angle signal θr when the angle signal θr passes a predetermined reference angle α degrees. Thus, the angle signal θ0 is one obtained by integrating the velocity signal ω0, and therefore, the angle signal θ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 θ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.
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.
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 θ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.
Accordingly, the output of the switch 28 is an angle error inverted value −Δθe0 at the time when the angle signal θ0 has passed approximately 0 degrees, and the output of the switch is updated every time the angle signal θ0 passes approximately 0 degrees again. The switch 28 according to the first preferred embodiment is configured to output the angle error inverted value −Δθe0 at the time when the angle signal θ0 passes approximately 0 degrees. However, it is also possible to employ such a configuration that, when it: is determined that the angle signal θ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.
In this case, the output of the switch 28 is an angle error Δθe180 at the time when the angle signal θ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 −Δθe0 and the angle error Δθe180 may be output from the switch 28. The average value Δθe0-180 thereof is obtained, and is input to the integrator 30.
A switch 29 has two inputs A and B. It outputs the input A (angle error Δθ) when it is determined that the angle signal θ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 Δθe90 at the time when the angle signal θ0 has passed approximately 90 degrees, and the output is updated every time the angle signal θ0 passes approximately 90 degrees again.
The switch 29 according to the first preferred embodiment is configured to output the angle error Δθe90 at the time when the angle signal θ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 θ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 −Δθe270 at the time when the angle signal θ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 Δθe90 and the angle error inverted value −Δθe270. The average value Δθe90-270, thereof is obtained, and is input to the integrator 31.
The integrator 30 outputs a value obtained by integrating the angle error inverted value −Δθe0 as the sine signal offset correction value es. Likewise, the integrator 31 outputs a value obtained by integrating the angle error inverted value −Δθe90 as the cosine signal offset correction value ec. Here, a reference character K denotes feedback gain. By adjusting this, the computation response of the sine signal offset correction value es and the cosine signal offset correction value ec from the angle signal θr is adjusted.
Next, the computation for offset correction values of this invention will be described.
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.
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 −Δθe0 and the angle error Δθ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)
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 Δθ.
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
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,
The angle detecting apparatus according to the first preferred embodiment computes the sine signal offset correction value es and the cosine signal offset correction value ec 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.
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.
An offset correction value computing unit 85a outputs the sine signal offset correction value es and the cosine signal offset correction value ec based on the input angle signal θr and the input velocity signal ω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.
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.
So, the 0-degree mechanical angle error computing means 90 executes the following calculation if it is determined that the angle signal θ0 has passed 0 degrees.
−Δθm0=(−Δθ−Δθ0-1−Δθ0-2 . . . −Δθ0-(N-1))/N (3)
Here, Δθ0-i (i=1 to N−1) represents the value of Δθ at the time when it was determined that the angle signal θ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 θ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 θ0 passed 0 degrees.
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 θ0 passed 180 degrees.
Δθm180=(Δθ+Δθ180-1−Δθ180-2 . . . −Δθ180-(N-1))/N (4)
Here, Δθ180-i (i=1 to N−1) represents the value of Δθ at the time when it was determined that the angle signal θ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 θ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 θ0 passed 180 degrees.
Likewise, the 90-degree mechanical angle error computing means 91 executes the following calculation if it is determined that the angle signal θ0 has passed 90 degrees.
Δθm90=(Δθ+Δθ90-1+Δθ90-2 . . . +Δθ90-(N-1))/N (5)
Here, Δθ90-i (i=1 to N−1) represents the value of Δθ at the time when it was determined that the angle signal θ0 is 90 degrees i times before the computation of equation (5), and N represents an angle multiplication factor.
If it is not determined that the angle signal θ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 θ0 passed 90 degrees.
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 θ0 passed 270 degrees.
−Δθm270=(−Δθ−Δθ270-1−Δθ270-2 . . . −Δθ270-(K-1))/N (6)
Here, Δθ270-1 (i=1 to N−1) represents the value of Δθ at the time when it was determined that the angle signal θ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 θ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 θ0 passed 270 degrees.
The angle error inverted value −Δθ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 θ0 has passed 0 degrees. Accordingly, by using the sine signal offset correction value es obtained by inputting the angle error inverted value −Δθ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 Δθ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 −Δθm0 and the angle error Δθm180 and the average values thereof are used.
Likewise, the angle error Δθ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 θ0 has passed 90 degrees. Accordingly, by using the cosine signal offset correction value ec obtained by inputting the angle error Δθ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 −Δθ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 Δθm90 and the angle error inverted value −Δθm270 and the average values thereof are used.
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.
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 es and the cosine signal offset correction value ec based on the input angle signal θr and the input velocity signal ω0. A cosine value calculator 41 calculates a cosine value cos (θ0) of the angle signal θ0. Likewise, a sine value calculator 42 calculates a sine value sin(θ0) of the angle signal θ0. A multiplier 43 multiplies the cosine value cos (θ0) by the angle error Δθ to obtain Δθ cos(θ0). Likewise, a multiplier 44 multiplies the sine value sin(θ0) by the angle error Δθ to obtain Δθ sin(θ0).
An integrator 45 performs the computation of the following equation (7) with Δθ cos(θ0) to compute a cosine component θ1f_cos_amp of the angle error inverted value −Δθ. Here T2 denotes the electrical angle cycle of the angle signal θr.
Likewise, an integrator 46 performs the computation of the following equation (8) with Δθ sin(θ0) to compute a sine component θ1f_sin_amp of the angle error Δθ. T2 is set to the same value as that in equation (7)
Then, the cosine component θ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 es. Likewise, the sine component θ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 ec. It should be noted that, in the computation in the integrators 45 and 46, T2 may be the mechanical angle cycle of the rotary machine. This makes it possible to obtain the sine signal offset correction value es and the cosine signal offset correction value ec that correspond to the mechanical angle cycle of the rotary machine.
Moreover, when the T2 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 es and the just-mentioned cosine signal offset correction value ec 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.
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 θ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 θ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.
As an example,
Hereinbelow, in order to resolve such a problem, the fourth preferred embodiment introduces an integrator 51 for resetting an angle signal. θ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 θ0 sin, which is the output therefrom, to the value of the angle signal θr, to calculate the cosine signal offset correction value ec at the location at which the angle signal θr passes 90 degrees. A subtracter 53 subtracts the angle signal θcos, from the angle signal θr and calculates an angle error Δθ. Likewise, a subtracter 54 subtracts the angle signal θ0 sin from the angle signal θr, and calculates an angle error Δθsin.
A cosine value calculator 55 calculates a cosine value cos(θ0 cos) of the angle signal θ0 cos.
Likewise, a sine value calculator 56 calculates a sine value sin(θ0 sin) of the angle signal θ0 sin. A multiplier 57 multiplies the cosine value cos (θ0 cos) by the angle error Δθcos to calculate Δθ0, cos(θ0 cos). Likewise, a multiplier 58 multiplies the sine value sin (θ0 sin) by the angle error Δθsin to calculate Δθsin sin (θ0 sin).
An integrator 59 performs the computation of the following equation (9) with Δθ cos (θ0 cos) to compute a cosine component θ1f_cos_amp of the angle error inverted value −Δθcos. Here, T2 is the value explained in the third preferred embodiment. Hereinbelow, resetting of equation (9) is discussed. In the case where T2 is selected to be the angle cycle of the angle signal θr, θ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 T2 is set to be M times (M: natural number) the mechanical angle cycle of the rotary machine, θ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.
Likewise, an integrator 60 performs the computation of the following equation (10) with Δθsin sin(θ0 sin) to compute a sine component θ1f_sin_amp of the angle error Δθsin. Here, T2 is the value explained in the third preferred embodiment. Hereinbelow, resetting of equation (10) is discussed. In the case where T2 is selected to be the angle cycle of the angle signal θr, θ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 T2 is set to be M times (M: natural number) the mechanical angle cycle of the rotary machine, θ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.
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 es. Likewise, the sine component θ1f_sin_amp of the angle error Δθsin is input to the integrator 31, and the output thereof is used as the cosine signal offset correction value ec.
In the computation of the velocity signal ω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.
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
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.
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.
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 ω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 ω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 es at one operation cycle earlier. Thus, the switch 81 updates the output signal when the velocity signal ω0 is higher than the reference velocity co.
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 ω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 ec at one operation cycle earlier. Thus, the switch 82 updates the output signal when the velocity signal ω0 is higher than the reference velocity ω.
Referring to
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 ω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.
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.
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.
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.
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.
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.
Kifuku, Takayuki, Kojima, Tetsuya, Mori, Tatsuya, Kinpara, Yoshihiko
Patent | Priority | Assignee | Title |
11733316, | Dec 14 2020 | Allegro MicroSystems, LLC | Position sensor having harmonic distortion compensation |
Patent | Priority | Assignee | Title |
5179515, | Mar 16 1990 | WESTINGHOUSE ELECTRIC CO LLC | Neutron flux detector positioning |
6320344, | Jul 01 1997 | Fanuc Ltd. | Position control device |
20050067996, | |||
20060077083, | |||
20060273247, | |||
20070288187, | |||
20090039808, | |||
20090167296, | |||
20100091926, | |||
20100102765, | |||
20100207615, | |||
20120010849, | |||
20120187939, | |||
20120256773, | |||
DE102004038621, | |||
EP935335, | |||
EP1647811, | |||
EP1728705, | |||
JP11027973, | |||
JP2006266758, | |||
JP2008273478, | |||
JP2009156852, | |||
JP2010071783, | |||
JP2010078461, |
Executed on | Assignor | Assignee | Conveyance | Frame | Reel | Doc |
Dec 12 2012 | Mitsubishi Electric Corporation | (assignment on the face of the patent) | / | |||
Apr 07 2014 | KIFUKU, TAKAYUKI | Mitsubishi Electric Corporation | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 032950 | /0570 | |
Apr 10 2014 | MORI, TATSUYA | Mitsubishi Electric Corporation | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 032950 | /0570 | |
Apr 11 2014 | KINPARA, YOSHIHIKO | Mitsubishi Electric Corporation | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 032950 | /0570 | |
Apr 17 2014 | KOJIMA, TETSUYA | Mitsubishi Electric Corporation | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 032950 | /0570 |
Date | Maintenance Fee Events |
Dec 11 2024 | M1551: Payment of Maintenance Fee, 4th Year, Large Entity. |
Date | Maintenance Schedule |
Jun 29 2024 | 4 years fee payment window open |
Dec 29 2024 | 6 months grace period start (w surcharge) |
Jun 29 2025 | patent expiry (for year 4) |
Jun 29 2027 | 2 years to revive unintentionally abandoned end. (for year 4) |
Jun 29 2028 | 8 years fee payment window open |
Dec 29 2028 | 6 months grace period start (w surcharge) |
Jun 29 2029 | patent expiry (for year 8) |
Jun 29 2031 | 2 years to revive unintentionally abandoned end. (for year 8) |
Jun 29 2032 | 12 years fee payment window open |
Dec 29 2032 | 6 months grace period start (w surcharge) |
Jun 29 2033 | patent expiry (for year 12) |
Jun 29 2035 | 2 years to revive unintentionally abandoned end. (for year 12) |