The present invention relates to a rotation angle detection device, and more particularly, to a rotation angle detection device configured to detect a rotation angle of a rotating body based on a sine signal and a cosine signal. The present invention also relates to an electric power steering device including the rotation angle detection device.
As means for detecting a rotation angle of a rotating body, for example, a motor, a resolver, a magneto resistance (MR) sensor, and the like are widely used. In those means, a sine signal and a cosine signal are output based on the rotation angle of the rotating body. A rotation angle detection device detects the rotation angle of the rotating body based on the sine signal and the cosine signal (for example, see Patent Literature 1).
The rotation angle detection device described in Patent Literature 1 reads a value of the peak and a value of the valley of each of the sine signal and the cosine signal, and calculates center point correction values each from a difference between a middle point between the value of the peak and the value of the valley and a center point value determined in advance. The rotation angle detection device adds the center point correction value to each of the sine signal and the cosine signal to correct the sine signal and the cosine signal, and detects the rotation angle of the rotating body based on the corrected sine signal and cosine signal.
[PTL 1] JP 2008-273478 A
However, the rotation angle detection device described in Patent Literature 1 does not have a measure to handle a case in which orthogonality between the sine signal and the cosine signal is low. A supplementary description is now given of the orthogonality between the sine signal and the cosine signal. When the phase difference between the sine signal and the cosine signal matches 90 degrees, it is defined that the sine signal and the cosine signal are orthogonal to each other, or have the orthogonality. Meanwhile, when the phase difference between the sine signal and the cosine signal does not match 90 degrees, it is defined that the sine signal and the cosine signal are not orthogonal to each other, or do not have the orthogonality. Moreover, a state in which the orthogonality is high means that the phase difference between the sine signal and the cosine signal is close to 90 degrees. A state in which the orthogonality is low means that the phase difference between the sine signal and the cosine signal is apart from 90 degrees.
In the rotation angle detection device described in Patent Literature 1, when the orthogonality between the sine signal and the cosine signal is low, an error occurs between the rotation angle detected by the rotation angle detection device and an actual rotation angle of the rotating body. As described below, this error is caused by frequency components twice as high as the frequency of fundamental waves of the sine signal and the cosine signal.
The error caused by the frequency components twice as high as the frequency of the fundamental waves of the sine signal and the cosine signal is hereinafter referred to as “rotation angle error of 2 f.” As described below, the rotation angle errors of 2 f occur not only when the orthogonality between the sine signal and the cosine signal is low, but the rotation angle errors of 2 f similarly occur also when, for example, the amplitude of the sine signal and the amplitude of the cosine signal are different from each other.
The present invention has been made in order to solve the above-mentioned problem, and has an object to provide a rotation angle detection device capable of suppressing rotation angle errors of 2 f.
In order to solve the above-mentioned problem, according to one embodiment of the present invention, there is provided a rotation angle detection device including: an intermediate signal generation unit configured to generate an intermediate signal based on a product of a sine signal and a cosine signal which are based on a rotation angle of a rotating body; a first multiplication unit configured to multiply the intermediate signal by one of the sine signal or the cosine signal; an addition/subtraction unit configured to add the other one of the sine signal or the cosine signal and an output of the first multiplication unit to each other or to subtract the output of the first multiplication unit from the other one of the sine signal or the cosine signal; and a first rotation angle calculation unit configured to calculate the rotation angle of the rotating body based on the one of the sine signal or the cosine signal and an output of the addition/subtraction unit.
Further, according to another embodiment of the present invention, there is provided a rotation angle detection device including: an amplitude ratio calculation unit configured to calculate an amplitude ratio between a sine signal and a cosine signal which are based on a rotation angle of a rotating body, based on respective second powers of the sine signal and the cosine signal; a second multiplication unit configured to multiply the amplitude ratio by one of the sine signal or the cosine signal; and a second rotation angle calculation unit configured to calculate the rotation angle of the rotating body based on an output of the second multiplication unit and the other one of the sine signal or the cosine signal.
The rotation angle detection device according to the present invention can suppress the rotation angle errors caused by the frequency components twice as high as the fundamental waves of the sine signal and the cosine signal, that is, the rotation angle errors of 2 f.
Now, details of embodiments of a rotation angle detection device disclosed in the present application are described with reference to the accompanying drawings. It should be noted, however, that the embodiments described below are merely examples, and the present invention is not limited to those embodiments.
The rotation angle detection system 100 includes a resolver 10, an excitation circuit 20, a differential amplification device 30, an A/D converter 40, and the rotation angle detection device 50.
The resolver 10 includes a rotor 1, an excitation coil 11, a sine detection coil 12, and a cosine detection coil 13. The rotor 1 is configured to rotate along with a motor (not shown). The excitation coil 11 is configured to be driven by an AC signal generated by the excitation circuit 20. The sine detection coil 12 is configured to detect the sine of a rotation angle of the motor. The cosine detection coil 13 is configured to detect the cosine of the rotation angle of the motor.
When the excitation coil 11 is driven by the AC signal as shown in
Each of the horizontal axes of
Referring back to
In the A/D converter 40, each peak point of a sine value and a cosine value indicated by each circle of
When there exists a difference between the amplitude of the sine signal S(θ) and the amplitude of the cosine signal C(θ) output from the A/D converter 40, such correction that the difference therebetween approaches zero may be made.
Referring back to
The rotation angle detection device 50 includes an intermediate signal generation unit 51, a multiplication unit 52, an addition unit 53, and a rotation angle calculation unit 54. The intermediate signal generation unit 51 is configured to generate an intermediate signal TMP1 based on a product of the sine signal S(θ) and the cosine signal C(θ).
As illustrated in
The multiplier 51a calculates the product S(θ)·C(θ) of the sine signal S(θ) and the cosine signal C(θ).
The cutoff frequency of the low-pass filter 51b is set to such a value as to remove frequency components equal to or higher than twice the frequency of the fundamental waves of the sine signal S(θ) and the cosine signal C(θ). Thus, an output X51b of the low-pass filter 51b is a signal obtained by removing the frequency components equal to or higher than twice the frequency of the fundamental waves of the sine signal S(θ) and the cosine signal C(θ) from the output S(θ)·C(θ) of the multiplier 51a.
The multiplier 51c multiplies the output X51b of the low-pass filter 51b by −2/(K×K)=−2/(K2). Thus, the output of the multiplier 51c, that is, the output TMP1 of the intermediate signal generation unit 51, is (−2/(K2))·X51b. Symbol K represents the amplitude of the sine signal S(θ) or the cosine signal C(θ).
As a method of obtaining K, an amplitude value measured offline in advance may be set to K. Alternatively, as described in Patent Literature 1, the amplitude value can also be calculated by reading, online, the value of the peak and the value of the valley of the sine signal S(θ) or the cosine signal C(θ).
Referring back to
The output OUT1 of the multiplication unit 52 is input to the addition unit 53. In the addition unit 53, the cosine signal C(S) and OUT1 are added to each other. Thus, an output C_corr1(θ) of the addition unit 53 is C(θ)+OUT1.
The output C_corr1(θ)=C(θ)+OUT1 of the addition unit 53 is input to the rotation angle calculation unit 54. Moreover, the sine signal S(θ) is also input to the rotation angle calculation unit 54.
The rotation angle calculation unit 54 calculates the rotation angle signal θr as given by the following expression based on the output C_corr1(θ)=C(θ)+OUT1 of the addition unit 53 and the sine signal S(θ).
A detailed description is now given of a reason for a point that the orthogonality between the sine signal S(θ) and the cosine signal C(θ) is improved and thus the above-mentioned rotation angle errors of 2 f are suppressed in the rotation angle detection device 50 described above.
First, it is assumed that the sine signal S(θ) and the cosine signal C(θ) are given as below, respectively.
S(θ)=K sin(θ) (2)
C(θ)=K cos(θ+α) (3)
That is, a phase difference between the sine signal S(θ) and the cosine signal C(θ) is n/2+α [rad]. Moreover, it is assumed that orthogonality between the sine signal S(θ) and the cosine signal C(θ) is reduced due to “α” included in the cosine signal C(θ).
When the sine signal S(θ) and the cosine signal C(θ) are directly input to the rotation angle calculation unit 54, and it is assumed that OUT1 is 0, the rotation angle errors of 2 f occur in the rotation angle signal θr with respect to the actual rotation angle θ of the motor. It is an object of the first embodiment to suppress the rotation angle errors of 2 f.
Expression (3) is expanded as given below.
C(θ)=K cos(θ)cos(α)−K sin(θ)sin(α) (4)
When it is assumed that “α” is sufficiently small, cos (α) is approximated to 1. Thus, Expression (3) can be transformed as follows.
C(θ)=K cos(θ)−K sin(θ)sin(α) (5)
When the second term on the right side can be removed from Expression (5), the orthogonality between the sine signal S(θ) and the cosine signal C(θ) is improved.
A purpose of the intermediate signal generation unit 51 and the multiplication unit 52 included in the rotation angle detection device 50 is to extract the second term on the right side of Expression (5). As described above, in the intermediate signal generation unit 51, the product S(θ)·C(θ) of the sine signal S(θ) and the cosine signal C(θ) is calculated by the multiplier 51a. The product S(θ)·C(θ) is expanded as given below.
In Expression (6), the first term on the right side is a DC term defined by “α”. Moreover, the second term and the third term on the right side include sin(2θ) and cos(2θ), respectively. The signals sin(2θ) and cos(2θ) oscillate at the frequency twice as high as the frequency of the fundamental waves of the sine signal S(θ) and the cosine signal (θ).
When the signal given by Expression (6) is caused to pass through the low-pass filter 51b, the second term and the third term on the right side of Expression (6) are removed, and hence the output X51b thereof is given as below.
When the signal given by Expression (7) is caused to pass through the multiplier 51c, the output TMP1 thereof is given as below.
TMP1=sin(α) (8)
When the intermediate signal TMP1 given by Expression (8) is caused to pass through the multiplication unit 52 of the rotation angle detection device 50, the output OUT1 thereof is given as below.
OUT1=sin(α)·K sin(θ) (9)
It is understood that −1 time Expression (9) matches the second term on the right side of Expression (5).
In the addition unit 53 of the rotation angle detection device 50, the following calculation is executed.
As described above, the sine signal S(θ) given by Expression (2) and the cosine signal C(θ) given by Expression (3) are not orthogonal to each other, but the second term on the right side of Expression (5) is removed by the above-mentioned calculation. As a result, the sine signal S(θ) given by Expression (2) and a signal given by Expression (10), which is orthogonal to the sine signal S(θ), are input to the rotation angle calculation unit 54.
The following calculation is executed in the rotation angle calculation unit 54, and the rotation angle errors of 2 f described above are consequently suppressed.
The configuration of the rotation angle detection device 50 described above is such that the intermediate signal TMP1 is generated based on the product S(θ)·C(θ) of the sine signal S(θ) and the cosine signal C(θ), the intermediate signal TMP1 is multiplied by the sine signal S(θ), and the result OUT 1 of the multiplication and the cosine signal C(θ) are added to each other.
However, the configuration of the first embodiment is not limited to this example. For example, the sine signal S(θ) and the cosine signal C(θ) can also be given by as follows.
S(θ)=K sin(θ+α) (12)
C(θ)=K cos(θ) (13)
In this case, the configuration of the rotation angle detection device 50 is such that the intermediate signal TMP1 is generated based on the product S(θ)·C(θ) of the sine signal S(θ) and the cosine signal C(θ), the intermediate signal TMP1 is multiplied by the cosine signal C(θ), and the result OUT1 of the multiplication is subtracted from the sine signal S(θ).
Moreover, the rotation angle detected by the rotation angle detection device 50 described above is the rotation angle of the motor, but an applicable range of the invention according to the first embodiment is not limited to the rotation angle of the motor. The invention according to the first embodiment can be applied to any rotating body, that is, a rotating object.
In summary, the rotation angle detection device according to the first embodiment of the present invention includes: an intermediate signal generation unit configured to generate an intermediate signal based on a product of a sine signal and a cosine signal which are based on a rotation angle of a rotating body; a first multiplication unit configured to multiply the intermediate signal by one of the sine signal or the cosine signal; an addition/subtraction unit configured to add the other one of the sine signal or the cosine signal and an output of the first multiplication unit to each other or to subtract the output of the first multiplication unit from the other one of the sine signal or the cosine signal; and a first rotation angle calculation unit configured to calculate the rotation angle of the rotating body based on the one of the sine signal or the cosine signal and on an output of the addition/subtraction unit.
Further, the intermediate signal generation unit includes: a first multiplier configured to calculate the product of the sine signal and the cosine signal; and a first low-pass filter configured to remove frequency components equal to or higher than twice a frequency of fundamental waves of the sine signal and the cosine signal from an output of the first multiplier.
As a result, the orthogonality between the sine signal S(θ) and the cosine signal C(θ) is improved, and the rotation angle errors of 2 f can thus be suppressed.
Description is now given of a rotation angle detection device according to a second embodiment of the present invention. In embodiments described below, components that are the same as or similar to those in the previous embodiments are denoted by the same reference numerals, and a detailed description thereof is omitted.
The rotation angle detection device according to the second embodiment includes an intermediate signal generation unit 251 of
The intermediate signal generation unit 251 includes the multiplier 51a, the low-pass filter 51b, and the multiplier 51c as in the first embodiment.
Moreover, the intermediate signal generation unit 251 includes a rotational speed calculator 251d, a delay device 251e, and a switch 251f.
The rotational speed calculator 251d calculates a rotational speed ωr of the motor based on the sine signal S(θ) and the cosine signal C(θ).
As a calculation method for the rotational speed ωr of the motor, the rotation angle signal θr is calculated based on the sine signal S(θ) and the cosine signal C(θ), and the rotational speed ωr of the motor is calculated by differentiating the rotation angle signal θr with respect to time. Alternatively, the rotational speed ωr of the motor can be calculated based on a period of time from zero-crossing of the sine signal S(θ) or the cosine signal C(θ) to next zero-crossing thereof.
The rotational speed ωr of the motor calculated by the rotational speed calculator 251d is input to the switch 251f as a signal for determination.
The switch 251f has two input terminals A and B. The output X51b of the low-pass filter 51b is input to the input terminal A. The signal output one cycle before by the switch 251f is again input to the input terminal B through the delay device 251e.
When the rotational speed ωr of the motor is equal to or higher than a predetermined rotational speed threshold value ωTH, the switch 251f outputs the signal on the input terminal A, that is, the output signal X51b of the low-pass filter 51b.
Moreover, when the rotational speed ωr of the motor is lower than the rotational speed threshold value ωTH, the switch 251f again outputs the signal on the input terminal B, that is, the signal output by the switch 251f itself one cycle before.
Thus, the switch 251f updates the output only when the rotational speed ωr of the motor is equal to or higher than the rotational speed threshold value ωTH, and holds the current output otherwise.
It is only required to determine the rotational speed threshold value ωTH of the switch 251f in accordance with a rotational speed variation band of the motor. For example, when the rotational speed variation band of the motor is f [Hz], and the number of pole pairs of the motor is Pm, the rotational speed threshold value ωTH can be determined as given by the following expression.
ωTH=f×60/Pm [r/min] (14)
Description is now given of effects of the rotational speed detection device according to the second embodiment. The above-mentioned intermediate signal generation unit 51 in the first embodiment calculates the product S(θ)·C(θ) of the sine signal S(θ) and the cosine signal C(θ) as given by Expression (6). In this configuration, when the rotational speed ωr of the motor is low, a variation frequency of the second term and the third term on the right side of Expression (6) is also low, and the second term and the third term may not sufficiently be removed by the low-pass filter 51b.
In order to handle this problem, the intermediate signal generation unit 251 in the second embodiment updates the intermediate signal TMP1 only when the rotational speed ωr of the motor is equal to or higher than the rotational speed threshold value ωTH, and holds the current intermediate signal otherwise. As a result, the orthogonality between the sine signal S(θ) and the cosine signal C(θ) is more precisely improved, and the rotation angle errors of 2 f are thus more reliably suppressed.
As described above, according to the second embodiment of the present invention, the intermediate signal generation unit further includes: a first rotational speed calculator configured to calculate a rotational speed of the rotating body; and a first switch connected at a subsequent stage of the first low-pass filter, which is configured to update an output only when the rotational speed of the rotating body is equal to or higher than a predetermined rotational speed threshold value, and to hold a current output when the rotational speed of the rotating body is lower than the predetermined rotational speed threshold value. As a result, the orthogonality between the sine signal S(θ) and the cosine signal C(θ) is more precisely improved, and the rotation angle errors of 2 f are thus more reliably suppressed.
An intermediate signal generation unit 351 of the rotation angle detection device 350 according to the third embodiment calculates the intermediate signal TMP1 based on the sine signal S(θ) and the cosine signal C(θ) and on the rotation angle signal θr calculated by the rotation angle calculation unit 54.
As illustrated in
That is, the intermediate signal generation unit 351 in the third embodiment does not include the low-pass filter included in each of the first and second embodiments.
The switch 351f has the two input terminals A and B. The output S(θ)·C(θ) of the multiplier 51a is input to the input terminal A. The signal output one cycle before by the switch 351f is again input to the input terminal B through the delay device 351e. Moreover, the rotation angle signal θr is input to the switch 351f as the signal for determination.
When the rotation angle signal θr is 90 degrees or 270 degrees, the switch 351f outputs the signal on the input terminal A, that is, the output signal S(θ)·C(θ) of the multiplier 51a.
Moreover, when the rotation angle signal θr is not 90 degrees or 270 degrees, the switch 351f again outputs the signal on the input terminal B, that is, the signal output by the switch 351f itself one cycle before.
Thus, the switch 351f updates the output only when the rotation angle signal θr is 90 degrees or 270 degrees, and holds the current output otherwise.
When the rotation angle signal θr is 90 degrees or 270 degrees, the output of the switch 351f is given as below, respectively.
Thus, the output TMP1 of the multiplier 51c, that is, the output TMP1 of the intermediate signal generation unit 351 is always sin(α) as given below, and thus matches Expression (8).
TMP2=−K2 sin(α)·(−1/K2)=sin(α) (17)
Thus, the intermediate signal generation unit 351 in the third embodiment can generate the intermediate signal TMP1=sin(α) while the intermediate signal generation unit 351 does not include the low-pass filter included in each of the first and second embodiments.
Meanwhile, for example, when the rotation angle signal θr is apart from 90 degrees by δ [rad], the output of the switch 351f is given as below.
Thus, when sin(2δ) of the first term on the right side is large, the output of the switch 351f greatly deviates from Expression (15). To deal with this problem, as described above, the switch 351f holds the current output when the rotation angle signal θr is not 90 degrees or 270 degrees.
As described above, according to the third embodiment of the present invention, the intermediate signal generation unit further includes: a first multiplier configured to calculate the product of the sine signal and the cosine signal; and a second switch connected at a subsequent stage of the first multiplier, which is configured to update an output only when the rotation angle of the rotating body calculated by the first rotation angle calculation unit is 90 degrees or 270 degrees, and to hold a current output when the rotation angle of the rotating body calculated by the first rotation angle calculation unit is not 90 degrees or 270 degrees.
As a result, the intermediate signal TMP1 can be generated while the low-pass filter is not included as in the first and second embodiments, and a component cost and an amount of calculation can thus be reduced compared to the first and second embodiments. Moreover, the orthogonality between the sine signal S(θ) and the cosine signal C(θ) is highly precisely improved without depending on the rotational speed ωr of the motor as in the second embodiment. Accordingly, the rotation angle errors of 2 f can more reliably be suppressed.
When δ is at such a level that a relationship given by Expression (19) is satisfied in Expression (18), influence on precision for identifying sin(α) is low. For example, Kδ is only required to be approximately ⅕. Thus, even when the rotation angle signal θr does not strictly match 90 degrees or 270 degrees, the rotation angle detection value θr is only required to be in a vicinity of 90 degrees or in a vicinity of 270 degrees.
Description is now given of a rotation angle detection device 450 according to a fourth embodiment of the present invention.
The above-mentioned rotation angle detection devices according to the first to third embodiments have an object to improve the orthogonality between the sine signal S(θ) and the cosine signal C(θ) when the orthogonality between the sine signal S(θ) and the cosine signal C(θ) is low, to thereby suppress the rotation angle errors of 2 f.
Meanwhile, the rotation angle detection device 450 according to the fourth embodiment has an object to improve an amplitude ratio between the amplitude of the sine signal S(θ) and the amplitude of the cosine signal C(θ) when the amplitude of the sine signal S(θ) and the amplitude of the cosine signal C(θ) are different from each other, to thereby suppress the rotation angle errors of 2 f.
The rotation angle detection device 450 according to the fourth embodiment includes an amplitude ratio calculation unit 451, a multiplication unit 452, and a rotation angle calculation unit 454. The amplitude ratio calculation unit 451 generates an amplitude ratio signal TMP2 corresponding to the amplitude ratio between the sine signal and the cosine signal based on the respective second powers of the sine signal S(θ) and the cosine signal C(θ).
As illustrated in
The multiplier 451g calculates the second power of the sine signal S(θ). Similarly, the multiplier 451h calculates the second power of the cosine signal C(θ).
The cutoff frequency of the low-pass filter 451i is set to such a value as to remove frequency components equal to or higher than twice the frequency of the fundamental wave of the sine signal S(θ). Thus, an output of the low-pass filter 451i is a signal obtained by removing the frequency components equal to or higher than twice the frequency of the fundamental waves from the output S(θ)2 of the multiplier 451g.
Similarly, the cutoff frequency of the low-pass filter 451j is set to such a value as to remove frequency components equal to or higher than twice the frequency of the fundamental wave of the cosine signal C(θ). Thus, an output of the low-pass filter 451i is a signal obtained by removing the frequency components equal to or higher than twice the frequency of the fundamental wave from the output C(θ)2 of the multiplier 451h.
The multiplier 451k multiplies an output of the low-pass filter 451i by two. Similarly, the multiplier 451l multiplies an output of the low-pass filter 451j by two.
The square root calculator 451m calculates a square root S_amp of an output of the multiplier 451k. Similarly, the square root calculator 451n calculates a square root C_amp of an output of the multiplier 451l.
The divider 451o calculates the amplitude ratio signal TMP2 as given by the following expression.
A detailed description is now given of a reason for a point that the amplitude ratio between the sine signal S(θ) and the cosine signal C(θ) is improved and thus the rotation angle errors of 2 f are suppressed in the rotation angle detection device 450 described above.
First, it is assumed that the sine signal S(θ) and the cosine signal C(θ) are given as below, respectively. It is assumed that K1≈K2.
S(θ)=K1 sin(θ) (21)
C(θ)=K2 cos(θ) (22)
As described above, when Expression (21) and Expression (22) are directly input to the rotation angle calculation unit 454, the rotation angle errors of 2 f occur in the rotation angle signal θr with respect to the actual rotation angle θ of the motor. It is an object of the fourth embodiment to suppress the rotation angle errors of 2 f.
First, S(θ)2 and C(θ)2 are calculated by the multipliers 451g and 451h, respectively.
After that, components of cos(2θ) included in Expression (23) and Expression (24) are removed by the low-pass filters 451i and 451j, respectively.
After that, S_amp and C_amp are given as below through the calculation by the multipliers 451k and 451l and the square root calculators 451m and 451n, respectively.
S_amp=K1 (27)
C_amp=K2 (28)
Thus, the output of the divider 451o, that is, the amplitude ratio signal TMP2 output by the amplitude ratio calculation unit 451 is given as below.
The amplitude ratio calculation unit 451 described above is configured to calculate S_amp and C_amp and then execute the division, but the configuration of the amplitude ratio calculation unit 451 is not limited to this example. For example, the order of processing may be changed such that the output results of the low-pass filters 451i and 451j are caused to pass through the divider 451o, and after that, the output of the divider 451o is caused to pass through the multiplier 451k and the square root calculator 451m.
Referring back to
Thus, the following calculation is executed in the rotation angle calculation unit 454, and the rotation angle errors of 2 f are consequently suppressed.
Description is now given of an advantage of the method in the fourth embodiment over a method of reading a value of the peak and a value of the valley of each of the sine signal S(θ) and the cosine signal C(θ), which is described in Patent Literature 1.
First, an ideal sine signal S(θ) and cosine signal C(θ) include only the fundamental waves having the same cycle as the rotation angle θ of the motor as given by Expression (21) and Expression (22), respectively. However, the actual sine signal S(θ) and cosine signal C(θ) include components of harmonics in addition to the fundamental waves.
A consideration is now given of a case in which the sine signal S(θ) includes a frequency component three times as high as the fundamental wave, that is, a third harmonic component.
In this case, as shown in
A rotation angle corresponding to the value of the peak of the sine signal S(θ) including only the fundamental wave, that is, a rotation angle θ corresponding to a point A of FIG. 11 is 90 degrees as given by the first term on the right side of Expression (31). Moreover, a rotation angle θ corresponding to the value of the valley of the sine signal S(θ) including only the fundamental wave, that is, a rotation angle corresponding to a point B of
Meanwhile, a rotation angle corresponding to a value of the peak of a sine signal S(θ) being the fundamental wave superimposed with the third harmonic, that is, a rotation angle θ corresponding to a point C of
Thus, the method of Patent Literature 1 cannot accurately extract the amplitude of each of the sine signal S(θ) and the cosine signal C(θ) when harmonic components other than the fundamental waves are included in the sine signal S(θ) or the cosine signal C(θ).
In contrast, the method of the fourth embodiment can cause the second power of the sine signal S(θ) and the second power of the cosine signal C(θ) to pass through the low-pass filters 451i and 451j, respectively, in the amplitude ratio calculation unit 451, to thereby be able to remove the influence of the harmonic components. As a result, each of the amplitudes of the sine signal S(θ) and the cosine signal C(θ) can accurately be extracted.
The rotation angle detection device 450 is configured to generate the amplitude ratio signal TMP2 based on the respective second powers of the sine signal S(θ) and the cosine signal C(θ), multiply the amplitude ratio signal TMP2 by the cosine signal C(θ), and to calculate the rotation angle signal θr based on the multiplication result C_corr2(θ) and the sine signal S(θ).
However, the configuration of the fourth embodiment is not limited to this example. The rotation angle detection device 450 may be configured to generate the amplitude ratio signal TMP2 based on the respective second powers of the sine signal S(θ) and the cosine signal C(θ), multiply the amplitude ratio signal TMP2 by the sine signal S(θ), and to calculate the rotation angle signal θr based on a multiplication result S_corr2(θ) and the cosine signal C(θ).
In summary, the rotation angle detection device according to the fourth embodiment of the present invention includes: an amplitude ratio calculation unit configured to calculate an amplitude ratio between a sine signal and a cosine signal which are based on a rotation angle of a rotating body, based on the respective second powers of the sine signal and the cosine signal; a second multiplication unit configured to multiply the amplitude ratio by one of the sine signal or the cosine signal; and a second rotation angle calculation unit configured to calculate the rotation angle of the rotating body based on an output of the second multiplication unit and the other one of the sine signal or the cosine signal.
Further, the amplitude ratio calculation unit includes: a second multiplier configured to calculate the second power of the sine signal; a third multiplier configured to calculate the second power of the cosine signal; a second low-pass filter configured to remove frequency components equal to or higher than twice a frequency of a fundamental wave of the sine signal from an output of the second multiplier; and a third low-pass filter configured to remove frequency components equal to or higher than twice a frequency of a fundamental wave of the cosine signal from an output of the third multiplier.
As a result, the amplitude ratio between the sine signal S(θ) and the cosine signal C(θ) is improved, and the rotation angle errors of 2 f can thus be suppressed.
The amplitude ratio calculation unit 451 of
Moreover, the amplitude ratio calculation unit 451 of
Description is now given of a rotation angle detection device according to a fifth embodiment of the present invention.
The rotation angle detection device according to the fifth embodiment includes an amplitude ratio calculation unit 551 of
The amplitude ratio calculation unit 551 includes the multipliers 451g and 451h, the low-pass filers 451i and 451j, the multipliers 451k and 451l, the square root calculators 451m and 451n, and the divider 451o as in the fourth embodiment.
Moreover, the amplitude ratio calculation unit 551 includes a rotational speed calculator 551p, delay devices 551q and 551r, and switches 551s and 551t.
The rotational speed calculator 551p calculates the rotational speed ωr of the motor based on the sine signal S(θ) and the cosine signal C(θ). As a calculation method for the rotational speed ωr of the motor, the same method described in the second embodiment may be used.
The rotational speed ωr of the motor calculated by the rotational speed calculator 551p is input to the switches 551s and 551t as a signal for determination.
The switch 551s has two input terminals A and B. The output S_amp of the square root calculator 451m is input to the input terminal A. The signal output one cycle before by the switch 551s is again input to the input terminal B through the delay device 551q.
Similarly, the switch 551t has two input terminals A and B. The output C_amp of the square root calculator 451n is input to the input terminal A. The signal output one cycle before by the switch 551t is again input to the input terminal B through the delay device 551r.
When the rotational speed ωr of the motor is equal to or higher than the predetermined rotational speed threshold value ωTH, the switches 551s and 551t output the signals on the input terminals A, that is, the output signals S_amp and C_amp of the square root calculators 451m and 451n, respectively.
Moreover, when the rotational speed ωr of the motor is lower than the rotational speed threshold value ωTH, the switches 551s and 551t again output the signals on the input terminals B, that is, the signals output by the switches 551s and 551t one cycle before.
Thus, the switches 551s and 551t update the output only when the rotational speed ωr of the motor is equal to or higher than the rotational speed threshold value ωTH, and hold the current output otherwise.
It is only required to determine the rotational speed threshold value ωTH of the switches 551s and 551t in accordance with a rotational speed variation band of the motor. For example, when the rotational speed variation band of the motor is f [Hz], and the number of pole pairs of the motor is Pm, the rotational speed threshold value ωTH can be determined as given by the following expression.
ωTH=2×f×60/Pm [r/min] (33)
The rotational speed threshold value ωTH of Expression (33) is the number of rotations corresponding to the frequency of the second harmonics of the sine signal S(θ) and the cosine signal C(θ).
Thus, the amplitude ratio calculation unit 551 updates the amplitude ratio signal TMP2=(S_amp/C_amp) only when the rotational speed ωr of the motor is equal to or higher than the rotational speed threshold value ωTH, and holds the current amplitude ratio otherwise.
Description is now given of effects of the rotation angle detection device according to the fifth embodiment. As described in the fourth embodiment, the outputs of the multipliers 451g and 451h are given by Expression (23) and Expression (24), respectively. In this configuration, when the rotational speed ωr of the motor is low, a variation frequency of the second term on the right side of each of Expression (23) and Expression (24) is also low, and thus the second terms may not sufficiently be removed by the low-pass filters 451i and 451j.
In order to handle this problem, the amplitude ratio calculation unit 551 in the fifth embodiment updates the amplitude ratio signal TMP2 only when the rotational speed ωr of the motor is equal to or higher than the rotational speed threshold value ωTH, and holds the amplitude ratio signal otherwise. As a result, the amplitude ratio between the sine signal S(θ) and the cosine signal C(θ) is more precisely improved, and the rotation angle errors of 2 f are thus more reliably suppressed.
As described above, according to the fifth embodiment of the present invention, the intermediate signal generation unit further includes: a second rotational speed calculator configured to calculate a rotational speed of the rotating body; a third switch connected at a subsequent stage of the second low-pass filter, which is configured to update an output only when the rotational speed of the rotating body is equal to or higher than a predetermined rotational speed threshold value, and to hold a current output when the rotational speed of the rotating body is lower than the predetermined rotational speed threshold value; and a fourth switch connected at a subsequent stage of the third low-pass filter, which is configured to update an output only when the rotational speed of the rotating body is equal to or higher than a predetermined rotational speed threshold value, and to hold a current output when the rotational speed of the rotating body is lower than the predetermined rotational speed threshold value. The third switch is arranged at the subsequent stage of the third low-pass filter, and the fourth switch is arranged at the subsequent stage of the fourth low-pass filter, but the third switch and the fourth switch may be arranged at other positions. For example, a configuration in which one switch is provided on the subsequent stage of the divider 451o can also provide the same effects.
As a result, the amplitude ratio between the sine signal S(θ) and the cosine signal C(θ) is more precisely improved, and the rotation angle errors of 2 f are thus more reliably suppressed.
The rotation angle detection device 650 according to the sixth embodiment calculates the amplitude ratio signal TMP2 based on the sine signal S(θ) and the cosine signal C(θ) and on the rotation angle θr calculated by the rotation angle calculation unit 454.
As illustrated in
That is, the amplitude ratio calculation unit 651 in the sixth embodiment does not include the low-pass filters included in the fourth and fifth embodiments.
The switch 651s has the two input terminals A and B. The output of the square root calculator 451m is input to the input terminal A. The signal output one cycle before by the switch 651s is again input to the input terminal B through the delay device 651q. Moreover, the rotation angle signal θr is input to the switch 651s as the signal for determination.
When the rotation angle signal θr is 90 degrees or 270 degrees, the switch 651s outputs the signal on the input terminal A, that is, the output signal of the square root calculator 451m.
Moreover, when the rotation angle signal θr is not 90 degrees or 270 degrees, the switch 651s again outputs the signal on the input terminal B, that is, the signal output by the switch 651s itself one cycle before.
Thus, the switch 651s updates the output only when the rotation angle signal θr is 90 degrees or 270 degrees, and holds the current output otherwise.
When the rotation angle signal θr is 90 degrees or 270 degrees, the output of the switch 651s is given as below, respectively.
√{square root over (S(90°)·S(90°))}=√{square root over (K1 sin(90°)·K1 sin(90°))}=K1 (34)
√{square root over (S(270°)·S(270°))}=√{square root over (K1 sin(270°)·K1(270°))}=K1 (35)
Similarly, the switch 651t has the two input terminals A and B. The output of the square root calculator 451n is input to the input terminal A. The signal output one cycle before by the switch 651t is again input to the input terminal B through the delay device 651r. Moreover, the rotation angle signal θr is input to the switch 651t as the signal for determination.
When the rotation angle signal θr is 0 degrees or 180 degrees, the switch 651t outputs the signal on the input terminal A, that is, the output signal of the square root calculator 451n.
Moreover, when the rotation angle signal θr is not 0 degrees or 180 degrees, the switch 651t again outputs the signal on the input terminal B, that is, the signal output by the switch 651t itself one cycle before.
Thus, the switch 651t updates the output only when the rotation angle signal θr is 0 degrees or 180 degrees, and holds the current output otherwise.
When the rotation angle signal θr is 0 degrees or 180 degrees, the output of the switch 651t is given as below, respectively.
√{square root over (C(0°)·C(θ))}=√{square root over (K2 cos(0°)·K2 cos(0°))}=K2 (36)
√{square root over (C(180°)·C(180°))}=√{square root over (K2 cos(180°)·K2 cos(180°))}=K2 (37)
Thus, the output of the divider 451o, that is, the amplitude ratio signal TMP2 output by the amplitude ratio calculation unit 651 is always K1/K2 as given below, and thus matches Expression (29).
Thus, the amplitude ratio calculation unit 651 in the sixth embodiment can generate the amplitude ratio signal TMP2=K1/K2 while the amplitude ratio calculation unit 651 does not include the low-pass filters included in the fourth and fifth embodiments.
As described above, according to the sixth embodiment of the present invention, the amplitude ratio calculation unit includes: a second multiplier configured to calculate the second power of the sine signal; a third multiplier configured to calculate the second power of the cosine signal; a fifth switch connected at a subsequent stage of the second multiplier, which is configured to update an output only when the rotation angle of the rotating body calculated by the second rotation angle calculation unit is 90 degrees or 270 degrees, and to hold a current output when the rotation angle of the rotating body calculated by the second rotation angle calculation unit is not 90 degrees or 270 degrees; and a sixth switch connected at a subsequent stage of the third multiplier, which is configured to update an output only when the rotation angle of the rotating body calculated by the second rotation angle calculation unit is 0 degrees or 180 degrees, and to hold a current output when the rotation angle of the rotating body calculated by the second rotation angle calculation unit is not 0 degrees or 180 degrees.
As a result, the amplitude ratio signal TMP2 can be generated while the low-pass filters are not included as in the fourth and fifth embodiments, and a component cost and an amount of calculation can thus be reduced compared with the fourth and fifth embodiments. Moreover, the amplitude ratio between the sine signal S(θ) and the cosine signal C(θ) is highly precisely improved without depending on the rotational speed ωr of the motor as in the fifth embodiment. Accordingly, the rotation angle errors of 2 f can more reliably be suppressed.
The rotation angle detection device 750 according to the seventh embodiment further includes a failure detection unit 755 configured to detect a failure of the motor in addition to the configuration of the rotation angle detection device 450 according to the fourth embodiment.
The failure detection unit 755 calculates a square-sum W of the sine signal S(θ) and the cosine signal C_corr2(θ) which is output from the multiplication unit 452, and has the amplitude that has been corrected.
The square-sum W calculated by the failure detection unit 755 is calculated as given below by Expression (23), Expression (24), and Expression (30).
Thus, even when the amplitude K1 of the sine signal S(θ) and the amplitude K2 of the cosine signal C(θ) are different from each other, the square-sum W does not depend on the value of K2, and is determined by only the value of K1.
The failure detection unit 755 determines that the motor is normal when the square-sum W is between a predetermined upper limit value and a predetermined lower limit value, and determines that the motor is abnormal otherwise.
When it is assumed that the sine signal S(θ) and the cosine signal C(θ) are directly input to the failure detection unit 755, the square-sum W calculated in this case is given as below.
Thus, when the amplitude K1 of the sine signal S(θ) and the amplitude K2 of the cosine signal C(θ) are different from each other, the square-sum W includes frequency components twice as high as the frequency of the fundamental wave of the cosine signal C(θ).
As a result, it is required to determine the upper limit value and the lower limit value of the failure detection device 755 in consideration of the frequency components twice as high as the frequency of the fundamental wave of the cosine signal C(θ), and a sufficient margin is required. Consequently, there occurs such a problem that a period of time required for the determination by the failure detection unit 755 is increased due to the margin.
In the seventh embodiment, as given by Expression (39), even when the amplitude K1 of the sine signal S(θ) and the amplitude K2 of the cosine signal C(θ) are different from each other, the square-sum W does not include the frequency components twice as high as the frequency of the fundamental wave of the cosine signal C(θ).
As a result, when the upper limit value and the lower limit value for the failure detection unit 755 are to be determined, it is not required to consider the frequency components twice as high as the frequency of the fundamental wave of the cosine signal C(θ), and the margin is thus not required. Accordingly, there does not occur the above-mentioned problem that the period of time required for the determination by the failure detection unit 755 is increased.
The rotation angle detection device 750 described above is configured to generate the amplitude ratio signal TMP2 based on the respective second powers of the sine signal S(θ) and the cosine signal C(θ), multiply the amplitude ratio signal TMP2 by the cosine signal C(θ), and to detect the failure of the motor based on the square-sum W of the multiplication result C_corr2(θ) and the sine signal S(θ).
However, the configuration of the seventh embodiment is not limited to this example. The rotation angle detection device 750 may be configured to generate the amplitude ratio signal TMP2 based on the respective second powers of the sine signal S(θ) and the cosine signal C(θ), multiply the amplitude ratio signal TMP2 by the sine signal S(θ), and to detect the failure of the motor based on the square-sum W of a multiplication result S_corr2(θ) and the cosine signal C(θ).
In summary, according to the seventh embodiment of the present invention, the rotation angle detection device further includes a failure detection unit configured to detect a failure of the rotating body based on a square-sum of the output of the second multiplication unit and the other one of the sine signal or the cosine signal. As a result, the failure detection for the rotating body can be executed at high speed.
The failure detection unit 755 may calculate the square root of the square-sum W of the sine signal S(θ) and the cosine signal C_corr2(θ) having the amplitude that has been corrected, and then execute the failure detection. Similarly, the failure detection unit 755 may calculate the square root of the square-sum W of the cosine signal C(θ) and the sine signal S_corr2(θ) having the amplitude that has been corrected, and then execute the failure detection.
Moreover, the failure detection unit 755 may execute the failure detection based on the sine signal S(θ), the cosine signal C(θ), and the amplitude ratio K1/K2 calculated by the amplitude ratio calculation unit 451.
The electric power steering device 800 according to the eighth embodiment is configured to generate an assist torque for assisting a steering torque of a steering system of a vehicle based on the rotation angle signal θr output from the rotation angle detection system 100 in the first embodiment.
The electric power steering device 800 includes the rotation angle detection system 100, a steering wheel 801, front wheels 802, gears 803, a torque detector 804, a voltage command generation device 806, and an AC motor 807.
The AC motor 807 generates the assist torque for assisting the steering torque of the steering system through intermediation of the gears 803.
The rotation angle detection system 100 detects the rotation angle of the AC motor 807, and outputs the rotation angle signal θr.
A driver of the vehicle operates the steering wheel 801, to thereby steer the front wheels 802.
The torque detector 804 detects a steering torque Ts of the steering system.
The volage command generation device 806 determines a drive voltage V to be applied to the AC motor 807 based on the steering torque Ts detected by the torque detector 804 and on the rotation angle signal θr output from the rotation angle detection system 100.
In detail, first, the voltage command generation device 806 calculates a current command value for the AC motor 807 based on the steering torque Ts. After that, the voltage command generation device 806 calculates a voltage command value based on the current command value and the rotation angle signal θr. Finally, the voltage command generation device 806 controls a power converter, for example, an inverter, based on the voltage command value, to thereby determine a drive voltage V to be applied to the AC motor 807.
In order to achieve the above-mentioned control, it is only required to use a publicly-known technology of, for example, independently providing a current sensor configured to detect the current flowing through the AC motor 807, and calculating the voltage command value based on a difference between the current command value and a detection value of the current sensor.
In general, in the electric power steering device, detection precision of the rotation angle of the AC motor 807 is important.
For example, it is assumed that rotation angle errors of 2 f occur between the rotation angle signal θr output from the rotation angle detection system 100 and the actual rotation angle A of the AC motor 807. In this case, the voltage command generation device 806 applies the drive voltage V including the rotation angle errors of 2 f to the AC motor. As a result, components of the rotation angle errors of 2 f are mixed with the torque to be generated by the AC motor 807, resulting in occurrence of ripples, vibration, noise, and the like.
Thus, in the electric power steering device, the precision of the rotation angle signal θr output from the rotation angle detection system 100 is very important. In the eighth embodiment, the rotation angle signal θr can highly precisely be calculated by using the rotation angle detection system 100 in the first embodiment.
Even when the rotation angle detection systems in the second to seventh embodiments are used in place of the rotation angle detection system 100 in the first embodiment, effects equivalent to or higher than those of the eighth embodiment can be obtained.
Moreover, in the first to eighth embodiments described above, the resolver is used as means for detecting the rotation angle of the motor. However, the applicable range of the first to eighth embodiments is not limited to the resolver. The first to eighth embodiments can similarly be applied to another detection means for outputting the sine signal and the cosine signal corresponding to the rotation angle of the motor, such as an MR sensor and an encoder.
Moreover, each function of the rotation angle detection devices according to the first to eighth embodiments described above is implemented by a processing circuit. The processing circuit configured to implement each function may be dedicated hardware or a processor configured to execute a program stored in a memory.
When the processing circuit is dedicated hardware, the processing circuit 1000 corresponds to, for example, a single circuit, a composite circuit, a programmed processor, a parallel-programmed processor, an application specific integrated circuit (ASIC), field programmable gate array (FPGA), or a combination thereof. The function of each of the units of the rotation angle detection device may be implemented by an individual processing circuit 1000, or the functions of the respective units may be implemented collectively by the processing circuit 1000.
Meanwhile, when the processing circuit is the processor 2001, the functions of the respective units of the rotation angle detection device are implemented by software, firmware, or a combination of software and firmware. The software and the firmware are written as programs, and stored in the memory 2002. The processor 2001 reads out and executes the program stored in the memory 2002, to thereby implement the function of each unit. That is, the rotation angle detection device includes the memory 2002 for storing programs for causing the above-mentioned respective control procedures to be executed resultantly when being executed by the processing circuit 2000.
In other words, those programs cause the computer to execute the above-mentioned procedures or methods for the respective units. In this case, the memory 2002 corresponds to, for example, a random access memory (RAM), a read only memory (ROM), a flash memory, an erasable programmable read only memory (EPROM), an electrically erasable and programmable read only memory (EEPROM), or other such non-volatility or volatile semiconductor memory. Further, the memory 2002 also corresponds to a magnetic disk, a flexible disk, an optical disc, a compact disc, a MiniDisk, a DVD, or the like.
Some parts of the functions of the respective units described above may be implemented by dedicated hardware, and other parts thereof may be implemented by software or firmware.
In this manner, the processing circuit can implement the functions of the respective units described above by hardware, software, firmware, or a combination thereof.
50, 350, 450, 650, 750 rotation angle detection device, 51, 251, 351 intermediate signal generation unit, 451, 551, 651 amplitude ratio calculation unit, 51a multiplier (first multiplier), 51b low-pass filter (first low-pass filter), 251d rotational angle calculator (first rotational speed calculator), 251f switch (first switch), 351f switch (second switch), 451g multiplier (second multiplier), 451h multiplier (third multiplier), 451i low-pass filter (second low-pass filter), 451j low-pass filter (third low-pass filter), 551p rotational speed calculator (second rotational speed calculator), 551s switch (third switch), 551t switch (fourth switch), 651s switch (fifth switch), 651t switch (sixth switch), 52 multiplication unit (first multiplication unit), 452 multiplication unit (second multiplication unit), 53 addition unit (addition/subtraction unit), 54 rotation angle calculation unit (first rotation angle calculation unit), 454 rotation angle calculation unit (second rotation angle calculation unit), 755 failure detection unit, 800 electric power steering device, 807 AC motor (rotating body), S(θ) sine signal, C(θ) cosine signal, TMP1 intermediate signal, TMP2 amplitude ratio signal (amplitude ratio), θr rotation angle signal
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2019/001736 | 1/22/2019 | WO | 00 |