ENCODER ABNORMALITY DIAGNOSIS DEVICE

Abstract

An encoder abnormality diagnosis device configured to diagnose an abnormality in an encoder that outputs a cosine waveform and a sine waveform according to a rotation angle of an object includes a stop determination processing unit configured to determine whether the object is rotating or stopping, based on a change in a count value of a pulse signal obtained by pulsing of each of the cosine waveform and the sine waveform, a frequency measurement unit configured to measure a frequency of the pulse signal, and a frequency diagnosis unit configured to compare the frequency measured by the frequency measurement unit with a preset upper limit frequency when the stop determination processing unit determines that the object is stopping, and to determine that an abnormality has occurred in the encoder when the measured frequency exceeds the upper limit frequency.

Claims

1. An encoder abnormality diagnosis device configured to diagnose an abnormality in an encoder that outputs a cosine waveform and a sine waveform according to a rotation angle of an object, the encoder abnormality diagnosis device comprising: a stop determination processing unit configured to determine whether the object is rotating or stopping, based on a change in a count value of a pulse signal obtained by pulsing of each of the cosine waveform and the sine waveform; a frequency measurement unit configured to measure a frequency of the pulse signal; and a frequency diagnosis unit configured to compare the frequency measured by the frequency measurement unit with a preset upper limit frequency when the stop determination processing unit determines that the object is stopping, and to determine that an abnormality has occurred in the encoder when the measured frequency exceeds the upper limit frequency.

2. The encoder abnormality diagnosis device according to claim 1, wherein the upper limit frequency is determined based on a control cycle of the object.

3. The encoder abnormality diagnosis device according to claim 1, wherein the upper limit frequency is determined based on a maximum acceleration of the object and a hysteresis width used for the pulsing.

4. An encoder abnormality diagnosis method of diagnosing an abnormality in an encoder that outputs a cosine waveform and a sine waveform according to a rotation angle of an object, the method comprising the steps of: determining whether the object is rotating or stopping, based on a change in a count value of a pulse signal obtained by pulsing of each of the cosine waveform and the sine waveform; measuring a frequency of the pulse signal; and comparing the measured frequency of the pulse signal with a preset upper limit frequency when the object is determined to be stopping, and determining that an abnormality has occurred in the encoder when the measured frequency exceeds the upper limit frequency.

Description

BRIEF DESCRIPTION OF DRAWINGS

[0015] Embodiment(s) of the present disclosure will be described based on the following figures, wherein:

[0016] FIG. 1 is a block diagram illustrating a configuration of an encoder abnormality diagnosis device;

[0017] FIG. 2 is a block diagram illustrating a configuration of a conventional encoder abnormality diagnosis device;

[0018] FIG. 3 is a view illustrating an example of a Lissajous waveform when an encoder is normal;

[0019] FIG. 4 is a view illustrating an example of a Lissajous waveform when an abnormality has occurred in the encoder;

[0020] FIG. 5 is a flowchart illustrating a flow of a stop determination processing;

[0021] FIG. 6 is a view illustrating an example of a Lissajous waveform in an oscillation state; and

[0022] FIG. 7 is a graph illustrating an operation of a pulsing circuit.

DESCRIPTION OF EMBODIMENTS

[0023] A configuration of an encoder abnormality diagnosis device will be described by reference to FIG. 1, FIG. 5, FIG. 6, and FIG. 7. FIG. 1 is a block diagram of the encoder abnormality diagnosis device. An encoder 1 outputs a sine/cosine signal including cosine waveform=A.Math.cos(N.Math.θ) and sine waveform=A.Math.sin(N.Math.θ) according to a rotation angle θ, where N represents frequencies of the sine and cosine waveforms that are output per rotation of the encoder. N is determined by the number of teeth of a gear in a magnetic encoder or by the number of slits in an optical encoder. A level conversion circuit 2 converts the cosine waveform into a voltage level available for a subsequent-stage circuit to output it as Vc. A pulsing circuit 3 converts Vc into a pulse signal. Similarly, a level conversion circuit 4 converts the sine waveform into a voltage level available for a subsequent-stage circuit to output it as Vs, and a pulsing circuit 5 converts the Vs into a pulse signal. The pulse signals output by the respective pulsing circuits 3 and 5 are pulse signals whose phases are shifted by 90° from each other, and counters 6 and 8 count pulses multiplied by four in a known method. A speed monitoring unit 7 calculates a rotation speed of the encoder based on a change amount in the count value of the counter 6 and monitors the speed. In the case where the speed exceeds a speed limit, the speed monitoring unit 7 outputs an abnormal signal to an abnormality processing unit 14. Similarly, a speed monitoring unit 9 calculates a rotation speed of the encoder based on a change amount in the count value of the counter 8 and monitors the speed. In the case where the speed exceeds a speed limit, the speed monitoring unit 9 outputs an abnormal signal to the abnormality processing unit 14. The speed monitoring units 7 and 9 mutually monitor the respective speed calculation results and the respective speed monitoring results, and output the abnormal signals to the abnormality processing unit 14 in the case where a difference arises between the calculation results of the speed monitoring units 7 and 9.

[0024] AD converters 10 and 11 perform AD-conversion on the signal Vc and the signal Vs that are output from the level conversion circuits 2 and 4, respectively, and output the respective AD-converted signals to a Lissajous radius calculation processing unit 12. The Lissajous radius calculation processing unit 12 performs various corrections including an offset correction, an amplitude ratio correction, a phase correction, and the like with respect to the AD conversion results of the signal Vc and the signal Vs that are output by the AD converters 10 and 11, respectively, and then calculates a Lissajous radius. A diagnosis processing unit 13 outputs an abnormal signal to the abnormality processing unit 14 in the case where the Lissajous radius is outside a predetermined reference range.

[0025] A stop determination processing unit 15 determines whether an object is rotating or stopping, based on the count value output from the counter 6. The stop determination processing unit 15 outputs, to a frequency diagnosis unit 17, a stop flag in an on state when determining that the object is stopping, and the stop flag in an off state when determining that the object is rotating. A frequency measurement unit 16 measures a frequency of the pulse signal output by the pulsing circuit 3, and outputs the measured frequency to the frequency diagnosis unit 17. The frequency diagnosis unit 17 compares the frequency of the pulse signal output by the frequency measurement unit 16 with an upper limit frequency when the stop flag output by the stop determination processing unit 15 is on, and outputs an abnormal signal to the abnormality processing unit 14 in the case where the frequency of the pulse signal exceeds the upper limit frequency.

[0026] Similarly, a stop determination processing unit 18 determines whether the object is rotating or stopping, based on the count value output from the counter 8. The stop determination processing unit 18 outputs, to a frequency diagnosis unit 20, a stop flag in an on state when determining that the object is stopping, and the stop flag in an off state when determining that the object is rotating. A frequency measurement unit 19 measures a frequency of the pulse signal output by the pulsing circuit 5, and outputs the measured frequency to the frequency diagnosis unit 20. The frequency diagnosis unit 20 compares the frequency of the pulse signal output by the frequency measurement unit 19 with an upper limit frequency when the stop flag output by the stop determination processing unit 18 is on, and outputs an abnormal signal to the abnormality processing unit 14 in the case where the frequency of the pulse signal exceeds the upper limit frequency.

[0027] The abnormality processing unit 14 performs an abnormality process such as turning off the energization of a motor, in the case where any one of the speed monitoring units 7 and 9, the diagnosis processing unit 13, and the frequency diagnosis units 17 and 20 outputs the abnormal signal.

[0028] FIG. 5 is a flowchart illustrating a flow of processing to be performed by the stop determination processing unit 15. The stop determination processing unit 15 inputs the counter value output from the counter 6, and calculates a value obtained by subtracting a previous counter value from a current counter value, as a counter difference value (S10). When an absolute value of the counter difference value is equal to or greater than 2 (No in S12), the stop determination processing unit 15 determines that the object is rotating, and turns off the stop flag (S14). On the other hand, when the absolute value of the counter difference value is smaller than 2 (Yes in S12), the stop determination processing unit 15 proceeds to step S16.

[0029] In step S16, the stop determination processing unit 15 checks the current state of the stop flag. As a result of the check, when the stop flag is off (No in S16), the stop determination processing unit 15 sets a current counter value as a value of a counter stop value (S18), and proceeds to step S20. The counter stop value is a counter value when the stop flag is switched from off to on. On the other hand, when the stop flag is on (Yes in S16), the stop determination processing unit 15 proceeds directly to step S20, without resetting the counter stop value.

[0030] In step S20, the stop determination processing unit 15 calculates, as a counter accumulated change value, a value obtained by subtracting the counter stop value from the current counter value. Then, when an absolute value of the counter accumulated change value is equal to or greater than 2 (No in S22), the stop determination processing unit 15 determines that the object is rotating, and turns off the stop flag (S14). On the other hand, when the absolute value of the counter accumulated change value is less than 2 (Yes in S22), the stop determination processing unit 15 determines that the object is stopping, and turns on the stop flag (S24). When the stop flag is set in step S14 or step S24, the stop determination processing unit 15 records the current counter value as the previous counter value (S26), and returns to step S10. Thereafter, similar processing is repeated every time the counter value is output.

[0031] As is clear from the foregoing description, in this example, whether the object is rotating is determined based on the absolute value of the counter difference value. Accordingly, in the case where the Lissajous waveform 21 as illustrated in FIG. 4 is generated due to failure of the encoder, the counter repeats counting up and down. As a result, the stop determination processing unit 15 determines that the object is stopping even while rotating, and turns on the stop flag. The same applies to the determination processing to be performed by the stop determination processing unit 18.

[0032] As described above, the determination result by the stop determination processing unit 15, 18 is input to the frequency diagnosis unit 17, 20. When the stop flag is on, the frequency diagnosis unit 17, 20 compares the frequency of the pulse signal output by the frequency measurement unit 16, 19 with a preset upper limit frequency f.sub.max. This is to determine that an abnormality has occurred in the case where the Lissajous waveform 21 as illustrated in FIG. 4 is generated.

[0033] That is, in the case where the Lissajous waveform 21 as illustrated in FIG. 4 is generated, the stop determination processing unit 15, 18 determines that a spindle (an object to be measured) is stopping (that is, the stop flag is on) even while rotating, and therefore cannot detect the abnormality in the encoder. Then, in this example, in the case where the stop flag is on, the frequency of the pulse signal is compared with the upper limit frequency f.sub.max, and it is determined that the abnormality has occurred, in the case where the frequency of the pulse signal exceeds the upper limited frequency f.sub.max.

[0034] The upper limit frequency f.sub.max is set to a value that can exclude the case where the spindle is oscillated minutely. That is, the stop flag is turned on not only when the abnormality has occurred in the encoder but also when the spindle is oscillated minutely. In the case where the spindle is oscillated minutely, the frequency of the pulse signal is non-zero, but this state does not correspond to the abnormality in the encoder. Then, the upper limit frequency f.sub.max is set to a value that is sufficiently greater than the frequency of the pulse signal obtained when the minute oscillation has occurred, thereby preventing the minute oscillation from being determined as the abnormality.

[0035] The setting of the upper limit frequency f.sub.max will be described with reference to FIG. 6 and FIG. 7. FIG. 6 is a view illustrating an example of the Lissajous waveform 21 in an oscillation state. FIG. 7 is a graph illustrating an input/output relationship of the pulsing circuit 5. The pulsing circuit 5 generally includes a hysteresis comparator. Therefore, in the case where an oscillation amplitude of a pulsing circuit input signal 25 is smaller than a specific hysteresis width 26, a pulse signal 27 is not output from the pulsing circuit 5. In this case, the frequency output by the frequency measurement unit 19 becomes zero. Accordingly, in the case where the frequency measurement unit 19 outputs a frequency other than zero, it can be said that oscillation having an amplitude equal to or greater than the hysteresis width 26 has occurred.

[0036] Here, the frequency of the pulse signal 27 when the Lissajous waveform 21 as illustrated in FIG. 4 is generated due to the abnormality of the encoder is high such that it cannot be generated in the normal oscillation state of the spindle. In this example, the upper limit frequency allowable in the normal oscillation state of the spindle is set as the upper limit frequency f.sub.max. For example, the upper limit frequency f.sub.max is determined based on a control cycle Tc of the spindle. When the control cycle of the spindle is Tc, or when the frequency is 1/Tc, a command exceeding the nyquist frequency (1/(2.Math.Tc)) cannot be output to the spindle. That is, it can be said that (1/(2.Math.Tc)) is the upper limit frequency allowable in the normal oscillation state of the spindle. Accordingly, the upper limit frequency is set as f.sub.max=(1/(2.Math.Tc)), and it may be determined that the abnormality has occurred in the case where the frequency of the pulse signal 27 exceeds f.sub.max=(1/(2.Math.Tc)).

[0037] As another mode, the upper limit frequency f.sub.max may be determined based on an allowable maximum acceleration α.sub.max of the spindle. That is, as described above, when the pulse signal 27 is obtained, Peak to Peak of the sine waveform or the cosine waveform becomes equal to or greater than the hysteresis width 26 (hereinafter, referred to as a “hysteresis width ΔH”). Therefore, in the case of the minimum amplitude at which the pulse signal 27 changes, in the case of the Lissajous waveform 21 illustrated in FIG. 6, the spindle angle θ oscillates with an amplitude of (ΔH/2), in one tooth of the encoder. The spindle angle θ is represented by the following expression 1, where Z is the number of teeth of the encoder, t is time, and ϕ is the initial phase.

θ=(ΔH/2)×(1/Z)×sin(2πf.Math.t+ϕ)  Expression 1

[0038] The acceleration α is obtained by differentiating expression 1 twice, and is represented by expression 2.

α=−(ΔH×2π.sup.2f.sup.2)/Z×sin(2πf.Math.t+ϕ)  Expression 2

[0039] The frequency f when the acceleration a becomes the maximum acceleration α.sub.max may be set as the upper limit frequency f.sub.max. Accordingly, the upper limit frequency f.sub.max is obtained by solving the expression obtained by substituting α.sub.max for a in expression 2 for the frequency f, and is represented by the following expression 3.

f.sub.max=1/π×((α.sub.max.Math.Z)/(2ΔH)).sup.1/2  Expression 3

[0040] Thus, when the upper limit frequency f.sub.max is determined based on the control cycle or the maximum acceleration, the minute oscillation and the abnormality in the encoder can be detected distinctively from one another, and the abnormality in the encoder can be detected more accurately. A method of determining the upper limit frequency f.sub.max exemplified herein is an example, and the upper limit frequency may be any value that can differentiate the minute oscillation and the abnormality in the encoder.

REFERENCE SIGNS LIST

[0041] 1 Encoder [0042] 2, 4 Level conversion circuit [0043] 3, 5 Pulsing circuit [0044] 6, 8 Counter [0045] 7, 9 Speed monitoring unit [0046] 10, 11 AD converter [0047] 12 Lissajous radius calculation processing unit [0048] 13 Diagnosis processing unit [0049] 14 Abnormality processing unit [0050] 15, 18 Stop determination processing unit [0051] 16, 19 Frequency measurement unit [0052] 17, 20 Frequency diagnosis unit [0053] 21 Lissajous waveform [0054] 22 Lissajous radius [0055] 23 Upper limit threshold [0056] 24 Lower limit threshold [0057] 25 Pulsing circuit input signal [0058] 26 Hysteresis width [0059] 27 Pulse signal