The present invention relates to a resolver device, a motor control device, and a motor control method, in particular, a resolver device for detecting an abnormality in a resolver which outputs a sine signal indicating sin θ and a cosine signal indicating cos θ in accordance with a rotation angle θ of a rotating body, a motor control device using the same, and a motor control method therefor.
As a related-art abnormality detection device for a resolver, a device described in Patent Literature 1 has been proposed, for example. In the abnormality detection device described in Patent Literature 1, sin2θ+cos2θ is calculated based on a sine signal and a cosine signal. When the calculated value is out of a predetermined normal range, the occurrence of an abnormality in the resolver is determined.
Once determining that the resolver is abnormal, the abnormality detection device described in Patent Literature 1 executes a predetermined procedure in case of abnormality, such as temporarily stopping drive of a motor, based on the determination of an abnormality. Therefore, even when the resolver returns to be in the normal state while a target to be controlled is being controlled by using the resolver, because the abnormality detection device does not have a function of detecting the return, the return is not determined unless the drive of the motor is temporarily stopped to perform a procedure of restart or the like.
The present invention has been made to solve the problem described above, and has an object to provide a resolver device, a motor control device, and a motor control method, which are capable of determining whether or not a resolver is normal again after detection of an abnormality in the resolver.
According to one embodiment of the present invention, there is provided a resolver device, including: a resolver for detecting at least one of a sine signal and a cosine signal in accordance with a rotation angle of a rotating body as a detection value; an abnormality detection section for determining whether or not the detection value falls within a predetermined first normal range to determine whether or not there is an abnormality in the resolver; a region division section for dividing the predetermined first normal range into a plurality of regions; a region determination section for determining whether or not the detection value falls within a predetermined second normal range and within which of the plurality of regions of the predetermined first normal range the detection value falls, the plurality of regions being obtained by the division by the region division section, and for determining that the resolver is normal when detecting presence of the detection value in a predetermined number of the regions; and a return determination section for determining return of the resolver to normal when the region determination section determines that the resolver is normal after the abnormality detection section determines that the resolver is abnormal.
According to the one embodiment of the present invention, there is provided the resolver device, including: the resolver for detecting at least one of the sine signal and the cosine signal in accordance with the rotation angle of the rotating body as the detection value; the abnormality detection section for determining whether or not the detection value falls within the predetermined first normal range to determine whether or not there is an abnormality in the resolver; the region division section for dividing the predetermined first normal range into the plurality of regions; the region determination section for; determining whether or not the detection value falls within a predetermined second normal range and within which of the plurality of regions of the predetermined first normal range the detection value falls, the plurality of regions being obtained by the division by the region division section, and for determining that the resolver is normal when detecting presence of the detection value in a predetermined number of the regions; and the return determination section for determining return of the resolver to normal when the region determination section determines that the resolver is normal after the abnormality detection section determines that the resolver is abnormal. The resolver device can determine whether or not the resolver is normal again after detection of the abnormality in the resolver, and can thus automatically continue the control over the drive of the rotating body.
A first embodiment of the present invention is described below referring to the drawings.
As illustrated in
The resolver device 14 is provided in the motor control device. The resolver device 14 includes a sensor section 5 (resolver), a signal circuit 13, and the microcomputer 1. In the resolver device 14, the sensor section 5 (resolver) detects a rotation angle of the motor 4 and a rotation speed of the motor 4 to detect control timing for the drive circuit 3, and transmits these information to the microcomputer 1. The sensor section 5 (resolver) is provided in the vicinity of the motor 4. The sensor section 5 (resolver) includes, in the inside thereof, a rotor 9 which rotates in synchronization with the output shaft of the motor 4, an exciting coil 10, a sine-wave coil 11 for outputting a sine signal (sin θ) in accordance with a rotation angle θ of the rotor 9, and a cosine-wave coil 12 for outputting a cosine signal (cos θ) in accordance with the rotation angle θ of the rotor 9. The rotor 9 has four protrusions. By an exciting signal applied to the exciting coil 10, signals are generated in the sine-wave coil 11 and the cosine-wave coil 12 which are transformer-coupled through an intermediation of the protrusions of the rotor 9.
The signal circuit 13 includes an exciting circuit 6 for driving the exciting coil 10, an interface circuit 7 for shaping the sine signal output from the sine-wave coil 11, and an interface circuit 8 for shaping the cosine signal output from the cosine-wave coil 12. The exciting circuit 6 outputs an exciting signal based on a signal from the microcomputer 1. The sine signal detected by the sine-wave coil 11 and the cosine signal detected by the cosine-wave coil 12 are input to the microcomputer 1 respectively through the interface circuits 7 and 8.
sin2θ+cos2θ=K (1)
In the expression, K is a constant.
By using the description given above, when a value obtained by adding a square value of the sine signal and a square value of the cosine signal falls within a range of K±α as expressed by the following Expressions (2), it is determined that the sensor section 5 (resolver) is normal. On the other hand, when the value obtained by adding the square value of the sine signal and the square value of the cosine signal is out of the range of K±α as expressed by the following Expressions (2), it is determined that the sensor section 5 (resolver) is abnormal. A value of α is determined as required.
Normal range: K−α<sin2θ+cos2θ<K+α
Abnormal range: sin2θ+cos2θ<K−α or
sin2θ+cos2θK+α (2)
Next, an algorithm of returning to normal in the resolver device 14 in the case where it is determined that the sensor section 5 (resolver) is abnormal is described referring to
Further, the doughnut-like normal range can be divided into a plurality of regions. For example, when divided by the X axis (20) and the Y axis (21), the normal range is divided into four regions. When divided by split lines 25 and 26 (45-degree lines) in addition to the X axis (20) and the Y axis (21), the normal range is divided into eight regions. The microcomputer 1 includes counters CNTi (i=1, 2, 3, . . . , n, where n is the number of regions) provided to the respective regions. Each of the counters CNTi (i=1, 2, 3, . . . , n) counts the number of times that the detection values (sin θ and cos θ) of the sine-wave coil 11 and the cosine-wave coil fall within the corresponding region. Specifically, when detecting that the detection values fall within the corresponding region, each of the counters CNTi (i=1, 2, 3, . . . , n) adds 1 to a counter value and stores the counter value. In this manner, when the counter value of the counter CNTi of each of the regions reaches a predetermined value after sequentially incrementing the counter value based on the values of the detection signals of the sine-wave coil 11 and the cosine-wave coil 12, for example, when all the counter values become equal to or larger than 2, the microcomputer 1 determines that the sensor section 5 (resolver) has returned to normal. In this manner, in this embodiment, instead of determining the return to normal based merely on the detection signals of the sine-wave coil 11 and the cosine-wave coil 12 falling within the normal range, the microcomputer 1 also checks trajectories of the detection signals (namely, the number of times that the signals fall within each of the regions) to determine the return to normal.
The example of
Next, a method of returning to normal is specifically described referring to
In Step S4, an exciting signal at, for example, 10 KHz is output to the exciting coil 10 of the sensor section 5 (resolver). In Step S5, the control amount is computed based on the information from the vehicle sensor group 2, which is obtained in Step S2, so that a control signal for rotating the motor 4 is output to the drive circuit 3. In Step S6, the microcomputer 1 waits until a predetermined time period elapses. After elapse of the predetermined time period, the microcomputer 1 returns to Step S2 again. In this manner, the processing from Steps S2 to S6 is periodically repeated.
Next, referring to
First, in Step S10, a value which is obtained by adding a value obtained by squaring the value of the sine signal and a value obtained by squaring the cosine signal is calculated as ANS (sin2θ+cos2θ=ANS). Next, in Step S11, whether or not an abnormality flag FLG is set is checked. The abnormality flag FLG is set when an abnormality occurs in the sensor section 5 (resolver). When the abnormality flag is not set (No), specifically, when the sensor 5 (resolver) is not abnormal, it is determined in Step S12 whether or not the value of ANS obtained in Step S10 is smaller than a predetermined value (K+α) which indicates an upper limit of the normal range. When ANS is smaller (Yes) as a result of the determination, it is determined in Step S13 whether or not the value of ANS is larger than a predetermined value (K−α) which indicates a lower limit of the normal range. When ANS is larger (Yes) as a result of the determination, the detection values of the sensor section 5 (resolver) fall within the normal range (K−α<ANS<K+α). Therefore, a counter CNTa (abnormal counter) and all the counters CNTi (normal counters) are reset in Step S14. Then, the processing is terminated. The counters CNTi (i=1, 2, 3, . . . , n) are respectively provided to the respective regions illustrated in
When it is determined as negative (No) in Step S12 or S13, the detection values (sin θ, cos θ) of the sensor section 5 (resolver) are out of the normal range. Thus, 1 is added to a counter value of the counter CNTa (abnormal counter) in Step S15. Next, in Step S16, it is determined whether or not the counter value exceeds a predetermined value L. When the counter value exceeds the predetermined value L (Yes), it is determined that the sensor section 5 (resolver) is abnormal, and the abnormality flag FLG is set (specifically, the value of the abnormality flag FLG is set to 1) in Step S17. On the other hand, when the counter value does not exceed the predetermined value L (No), each of the processing is terminated without any further processing. In this manner, in this embodiment, when the number of times that the detection value (sin θ, cos θ) of the sensor section 5 (resolver) is consecutively determined as being out of the normal range exceeds L, it is determined that an abnormality occurs in the sensor 5 (resolver). A value of L is preset to any value equal to or larger than 1 as required.
The processing described above is processing for determining whether or not there is an abnormality in the sensor section 5 (resolver). Therefore, the processing from Steps S10 to S17 configures an abnormality detection section for determining whether or not there is an abnormality in the sensor section 5 (resolver) by determining whether or not the detection values of the sensor section 5 (resolver) fall within the predetermined normal range.
Next, the description continues for a method for determining whether or not the sensor section 5 (resolver) returns to normal again after it is determined that the sensor section 5 (resolver) is abnormal.
When it is determined that the abnormality flag FLG is set (Yes) in Step S11, it is then determined in Step S18 whether or not the value of ANS obtained in Step S10 is smaller than a predetermined value (K+β) which indicates an upper limit of a normal range. Here, β is a preset value. The value of β may be the same as the value of α which is used in Steps S12 and S13 or may be different therefrom. When ANS is smaller than the predetermined value (K+β) (Yes) as a result of the determination, it is then determined in Step S19 whether or not the value of ANS is larger than a predetermined value (K−β) which indicates a lower limit of the normal range. When ANS is larger than the predetermined value (K−β) (Yes) as a result of the determination, the detection values of the sensor section 5 (resolver) fall within the normal range (K−β<ANS<K+β). On the other hand, when the value of ANS is out of the normal range (No) in Step S18 or S19, all the counters CNTn (normal counters) are reset in Step S22. This means that the determination for the return to normal again is restarted from the beginning if the values of the sine signal and the cosine signal are out of the normal range even once.
When the value of ANS falls within the normal range (K−β<ANS<K+β) as a result of the determinations in Steps S18 and S19, it is determined, in Step 20, in which of the plurality of regions obtained by the division the value of ANS is present. The determination corresponds to determination in which of the plurality of regions illustrated in
Next, in Step S23, whether or not the counter values of the respective counters CNTi (i=1, 2, 3, . . . ) exceed a predetermined value M is checked. Specifically, whether or not ANS has been present in all the regions for a predetermined number of times (M+1 times) for each. For example, when the normal range is divided into four regions, i=1 to 4 and n=4 are obtained. Therefore, four counters CNTi are required. Thus, the above-mentioned check means the counter values of all the four counters CNT1, CNT2, CNT3, and CNT4 are checked. Specifically, only after verifying that ANS falls within the normal range and the detection values (sin θ, cos θ) have been present in all the four regions for M+1 times for each, the return to normal is determined. Although the example where all the regions of the normal range are used as targets has been described, all the regions are not necessarily required to be targets. Specifically, the determination for the return to normal may be made by using a predetermined number of regions among the plurality of regions (for example, two regions among four regions).
When it is determined that all the counters CNTi exceed the predetermined value M (Yes) in Step S23, the abnormality flag FLG is reset (specifically, 0 is set to the abnormality flag FLG) for the first time, and it is determined that the sensor section 5 (resolver) has returned to normal in Step S24. Moreover, the counter CNTa for abnormality detection is also reset. On the other hand, when the counter value of at least one of all the counters CNTi does not exceed the predetermined value M (No) in Step S23, the return to normal cannot be determined. Therefore, the processing is terminated without further processing. Steps S23 and 24 configure a return determination section.
As described above, for the return to normal, only after the detection values of the sensor section 5 (resolver) are continuously present in the normal range, and further are present in all the regions illustrated in
Moreover, the normal range (K−α<ANS<K+α) for the abnormality determination in Steps S12 and S13 and the normal range (K−β<ANS<K+β) for the determination of the return to normal in Steps S18 and S19 may be different from each other. In this case, the normal range for the abnormality determination may be set larger than the normal range for the determination of the return to normal so as to have a hysteresis. Specifically, α and β in
The predetermined value L and the predetermined value M for each of the counter values may be the same or may be different. When M>L is set, the return to normal can be strictly limited in an easy way, which provides the effect of preventing erroneous determination of the return to normal.
The return to normal is not determined merely because the detection values of the sensor section 5 (resolver) fall within the normal range. The determination of the region is used instead. Specifically, after the detection values of the sensor section 5 (resolver) which is determined as being abnormal are successfully detected in each of the plurality of regions of the normal range for a plurality of times, the return to normal is determined. Therefore, the determination for the return to normal is made with increased achievement of the return to normal. Further, by carrying out the determination for the return to normal, the control over the drive of the motor 4 can be automatically continued.
In this embodiment, another dividing method for dividing the normal range into regions is described referring to
In this embodiment, by checking whether or not the sum of the square of the detection value of the sine signal and the square of the detection value of the cosine signal (sin2θ+cos2θ) falls within the range from K−α to K+α and then checking whether or not the absolute value of the sine signal or the cosine signal is equal to or smaller than A1, the region can be specified.
When the determination of the region described above is used, the need of the computation for the sum of squares can be eliminated. Specifically, the presence/absence in the normal range can be determined and the determination of the region can be made by determining a magnitude relationship between each of the absolute value of the sine signal and the absolute value of the cosine signal and K±α.
As described above, in the second embodiment, the same effects as those obtained by the first embodiment can be obtained. In addition, in the second embodiment, the split lines (27a, 27b, 28a, and 28b) which are respectively parallel to the X axis and the Y axis are used as the split lines used for the determination of the region. As a result, the determination of the region within which the detection values of the sensor section 5 (resolver) fall can be more simplified.
The example illustrated
Next, a third embodiment of the present invention is described. By obtaining a tangent value (tan θ) from the detection values (sin θ, cos θ) of the sensor section 5 (resolver), the rotation angle of the motor 4 is obtained. Further, by computing a change in the rotation angle for each predetermined time period, a rotation angular velocity of the motor 4 can be easily obtained. It is known that the rotation angular velocity of the motor 4 is driven by the microcomputer 1 within a predetermined range in consideration of a magnitude of a load on the motor 4. Therefore, in this embodiment, the microcomputer 1 further includes a rotation angular velocity detection section (not shown) for detecting the rotation angular velocity of the motor 4 so that the determination for the return to normal is not made when the detected rotation angular velocity is out of a predetermined range, in particular, the rotation angular velocity is higher than the predetermined range. Specifically, when the microcomputer 1 determines that the motor 4 is rotating at a high speed (determines that an angular velocity of the motor 4 is larger than a predetermined value), the microcomputer 1 resets all the counters CNTi illustrated in
Alternatively, the microcomputer 1 prohibits the addition of 1 to the counter value of the counter CNTi (Step S21). In this manner, when the angular velocity of the motor 1 is higher than the preset angular velocity, the return determination section is prohibited from determining the return to normal or the region determination section is prohibited from determining the region. In this manner, the detection values of the sensor section 5 (resolver) are prohibited from being determined as normal.
Alternatively, in the flowchart of
As described above, in the third embodiment, the same effects as those obtained by the first embodiment are obtained. In addition, in the third embodiment, when the rotation of the motor 4 at the angular velocity within or higher than the preset range is detected, the return to normal is not determined. Therefore, the erroneous determination of the return to normal can be prevented.
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP2012/060025 | 4/12/2012 | WO | 00 | 8/6/2014 |