BACKGROUND OF THE INVENTION
1. Field of the Invention
The present invention relates to a motor drive apparatus for driving a stepping motor and a control method therefor.
2. Description of the Related Art
Stepping motors have features such as small size, high torque, and long service life, and can easily realize digital positioning by open-loop control. Accordingly, stepping motors are widely used e.g. for information household appliances such as cameras and optical disk devices and used for office automation equipment such as printers and projectors.
In open-loop control of a stepping motor, a rotation position of a rotor of the stepping motor is detected. Generally, a current phase of a drive signal applied to the stepping motor is detected as a current rotation position of the rotor. However, there is a follow-up delay in rotation of the stepping motor relative to the drive signal applied to the stepping motor. In other words, the phase of the drive signal detected as the rotor rotation position has an error corresponding to the follow-up delay of the rotor.
To eliminate such a detection error, a stepping motor drive apparatus that detects a rotor rotation position by using a highly accurate rotation position detector has been proposed (see, for example, Japanese Laid-open Patent Publication No. 2004-180431). However, the highly accurate rotation position detector is high priced, and the motor drive apparatus using such a rotation position detector results in a substantial cost increase.
SUMMARY OF THE INVENTION
The present invention provides a motor drive apparatus capable of detecting a rotor rotation position of a stepping motor, without causing a substantial cost increase.
According to one aspect of this invention, there is provided a motor drive apparatus that drives a stepping motor having coils and a rotor that rotates when the coils are energized, comprising a drive unit configured to supply the coils with drive signals that periodically change, a signal output unit configured to output output signals that change with rotation of the rotor, and a control unit configured to control said drive unit, wherein said control unit determines a difference between a state of either one of the drive signals at a timing of change of a corresponding one of the output signals in a case where there is no follow-up delay of the rotor relative to the drive signals and a state of said either one of the drive signals at a timing of change of the corresponding one of the output signals in a case where there is a follow-up delay of the rotor relative to the drive signals, and corrects the follow-up delay of the rotor based on the determined difference.
With this invention, a rotor rotation position can be detected with high accuracy without causing a substantial cost increase.
Further features of the present invention will become apparent from the following description of exemplary embodiments with reference to the attached drawings.
BRIEF DESCRIPTION OF THE DRAWINGS
FIG. 1 is a perspective view showing an external construction of a motor drive apparatus according to one embodiment of this invention;
FIG. 2 is a block diagram showing a construction of a motor drive control system of the motor drive apparatus;
FIG. 3A is a view showing a construction of a stepping motor driven by the motor drive apparatus;
FIGS. 3B-3C are views each showing a relation among physical positions of a rotor and stator poles of the stepping motor, a slit rotary plate attached to the rotor, and first and second photointerrupters;
FIGS. 4A-4I are views showing operation of a motor driver to control a voltage applied to an A-phase stator coil of the stepping motor and control a current flowing through the coil;
FIG. 5 is a view showing a relation between a phase of a sinusoidal voltage applied to one of stator coils and a data number representing a data region of a data table stored in a sine wave generator;
FIG. 6A is a view showing voltage signals applied to the stator coils to forwardly rotate the rotor;
FIG. 6B is a view showing voltage signals applied to the stator coils to reversely rotate the rotor;
FIG. 7A is a view showing a modeled rotor having one N-pole and one S-pole and showing a state where the rotor and the slit rotary plate are in a reference positional relation;
FIG. 7B is a graph showing a change of each of signals obtained by binarizing outputs of the first and second photointerrupters with a forward rotation of the rotor from the state of FIG. 7A;
FIG. 7C is a view showing a state where the slit rotary plate is deviated from the reference positional relation of FIG. 7A in a reverse rotation direction;
FIG. 7D is a view showing a change of each of binarized signals with a forward rotation of the rotor from the state of FIG. 7C;
FIG. 8A is a view showing a relation between rotor electrical angle and rotor rotation position in the case without follow-up delay of the rotor relative to sinusoidal voltage signals applied to the stator coils to forwardly rotate the rotor;
FIG. 8B is a view showing a relation between rotor electrical angle and rotor rotation position in the case of the presence of follow-up delay of the rotor relative to the sinusoidal voltage signals;
FIG. 9 is a view showing a relation among voltage signals applied to the stator coils to forwardly rotate the rotor 14, rotor rotation position, and outputs of the first and second photointerrupters;
FIG. 10A is a view showing a relation between rotor electrical angle and rotor rotation position in the case without follow-up delay of the rotor relative to the voltage signals when the rotor is reversely rotated;
FIG. 10B is a view showing a relation between rotor electrical angle and rotor rotation position in the case of the presence of follow-up delay of the rotor relative to the voltage signals when the rotor is reversely rotated;
FIG. 11 is a view showing a relation among voltage signals applied to the stator coils to reversely rotate the rotor 14, rotor rotation position, and outputs of the first and second photointerrupters;
FIGS. 12 and 13 are a flowchart showing procedures of a stepping motor drive process; and
FIG. 14 is a view showing a case where ENC0 and ENC1 signals corresponding to outputs of the first and second photointerrupters are different in duty ratio from each other.
DESCRIPTION OF THE EMBODIMENTS
The present invention will now be described in detail below with reference to the drawings showing preferred embodiments thereof.
FIG. 1 shows in perspective view an external construction of a motor drive apparatus 100 according to one embodiment of this invention. The motor drive apparatus 100 for driving a stepping motor 10 has a slit rotary plate 16 attached to a rotor shaft 15 of the stepping motor 10, and has first and second photointerrupters 21, 22, which are also referred to as the ch0 and ch1 photointerrupters and denoted by symbols ch0PI, ch1PI in FIG. 2.
In the motor drive apparatus 100, the slit rotary plate 16 is configured to have bright and dark regions whose angle ratio is equal to 50:50. When the stepping motor 10 is driven, the slit rotary plate 16 rotates, and the first and second photointerrupters 21, 22 output output signals that change as described later.
FIG. 2 shows in block diagram a construction of a motor drive control system of the motor drive apparatus 100, together with a relevant construction of the stepping motor 10. As shown in FIG. 2, the stepping motor 10 has an A-phase stator coil 11a, a B-phase stator coil 11b, A-phase positive side stator poles 12a, A-phase negative side stator poles 13a, B-phase positive side stator poles 12b, B-phase negative side stator poles 13b, and a rotor magnet 14. When the A-phase coil 11a and/or the B-phase coil 11b is energized, the rotor 14 rotates.
In the following, the A- and B-phase stator coils will be referred to as the A- and B-phase coils, respectively, the rotor magnet will be referred to as the rotor, and the A-phase positive side stator poles, the A-phase negative side stator poles, the B-phase positive side stator poles, and the B-phase negative side stator poles will be sometimes collectively referred to as the stator poles.
In the motor drive apparatus 100, a comparator 23 receives analog signals from the first and second photointerrupters 21, 22, binarizes the analog signals according to a threshold voltage set in advance, and outputs the binarized signals to an encoder circuit 24. In this embodiment, the threshold voltage is set in advance such that each of the output signals of the comparator 23 has a high/low ratio of 50:50 when the stepping motor 10 rotates at a constant rotation speed without rotational unevenness. Hereinafter, the output signals of the first and second photointerrupters (ch0 photointerrupter and ch1 photointerrupter) 21, 22 after being binarized will be referred to as the ENC0 and ENC1 signals, respectively.
The encoder circuit 24 acquires four type signal output timings. More specifically, the encoder circuit 24 acquires timings of change of the ENC0 signal from low to high and from high to low, and acquires timings of change of the ENC1 signal from low to high and from high to low.
A CPU 25 can make interrupt processing at any of the four type signal output timings acquired by the encoder circuit 24. At that time, the CPU 25 determines the type of the signal output timing at which the interruption has occurred. The CPU 25 has a function of executing programs stored in advance in a storage unit (not shown). The CPU 25 can access the encoder circuit 24 and a PWM generator 28 via a bus 27.
A sine wave generator 26 for generating a sine wave signal has a data table (not shown) having data regions stored with PWM values respectively corresponding to data numbers from “0” to “511” by which one period of the sine wave signal is divided into 512 parts. The sine wave generator 26 sequentially outputs the PWM values to the PWM generator 28. The PWM generator 28 outputs PWM signals to a motor driver 29. The motor driver 29 amplifies the PWM signals and supplies the amplified PWM signals to the A- and B-phase coils 11a, 11b of the stepping motor 10.
The first and second photointerrupters 21, 22, the slit rotary plate 16, the comparator 23, and the encoder circuit 24 of this embodiment correspond to a signal output unit of this invention. For each of the photointerrupters 21, 22, a photointerrupter is used that has a resolution with which an output signal thereof can properly be binarized by the comparator 23 but which is lower than a resolution of the sine wave generator 26.
In the following, a description will be given in detail of how drive signals are supplied from the sine wave generator 26 to the stepping motor 10 with reference to FIGS. 4 and 5.
FIGS. 4A-4I illustrate operation of the motor driver 29 to control a voltage applied to the A-phase coil 11a and control a current flowing through the A-phase coil 11a. As previously described, the motor driver 29 amplifies PWM signals supplied from the PWM generator 28 and supplies the amplified PWM signals to the A- and B-phase coils 11a, 11b. As shown in FIGS. 4A-4C, one end A of the A-phase coil 11a is connected to a line that connects switches 41, 43 together, and another end B of the A-phase coil 11a is connected to a line that connects switches 42, 44 together.
When the A-phase PWM signal supplied from the PWM generator 28 is at high level, the switches 41, 44 are closed as shown in FIG. 4B. In the state of FIG. 4B, a potential difference corresponding to the voltage of Vcc supplied to the motor driver 29 is produced between the ends A, B of the A-phase coil 11a. At that time, the electric potential at the end A of the A-phase coil 11a relative to that at the other end B thereof becomes +Vcc as shown in FIG. 4D, and a current of +I flows through the A-phase coil 11a as shown in FIG. 4E.
On the other hand, when the A-phase PWM signal supplied from the PWM generator 28 is at low level, the switches 42, 43 are closed as shown in FIG. 4C. In the state of FIG. 4C, a potential difference corresponding to the voltage of Vcc supplied to the motor driver 29 is produced between the ends A, B of the A-phase coil 11a. At that time, the electric potential at the end A of the A-phase coil 11a relative to that at the other end B thereof becomes −Vcc as shown in FIG. 4F, and a current of −I flows through the A-phase coil 11a as shown in FIG. 4G.
When an A-phase PWM signal that repeatedly alternately changes between high and low levels at short intervals is supplied, the potential at one end A of the A-phase coil 11a relative to that at another end B alternately changes between +Vcc and −Vcc, so that a voltage signal of rectangular shape is applied across the both ends of the A-phase coil 11a, as shown in FIG. 4H. The rectangular shaped voltage signal is smoothed by the A-phase coil 11a, and a current corresponding to the smoothed voltage signal flows through the coil 11a.
In other words, if a period of generation of the +Vcc voltage and that of the −Vcc voltage in one period of the rectangular shaped voltage signal applied to the A-phase coil 11a are the same as each other as shown in FIG. 4H, the current flowing through the A-phase coil 11a becomes effectively equal to zero as shown in FIG. 4I. Thus, if a duty ratio of the PWM signal (i.e. a ratio of the high-level PWM signal to the entire PWM signal) is 50% as in the case of FIG. 4H, it can be regarded that a voltage of zero volts is always applied to the A-phase coil 11a. It can be regarded that the +Vcc voltage is always applied to the A-phase coil 11a, if the duty ratio of the PWM signal is 100%, and that a +Vcc/2 is always applied to the A-phase coil 11a, if the duty ratio of the PWM signal is 75%.
FIG. 5 shows a relation between a phase of a sinusoidal voltage applied to one of the stator coils and a data number representing a data region of the data table stored in the sine wave generator 26.
The sine wave generator 26 has the data table (not shown) described above. The data table has e.g. 512 data regions respectively stored with duty ratio values (%) of the PWM signal. In FIG. 5, numeric values 0-511 are data numbers that respectively represent zero-th to 511th data regions in the data table. In each data region, a duty ratio value of the PWM signal corresponding to a sinusoidal voltage phase is stored.
As shown in FIG. 5, the zero-th data region corresponds to a 0-degree phase of the sinusoidal voltage, and the 256th data region corresponds to a 180-degree phase of the sinusoidal voltage. The zero-th and 256th data regions are each stored with a duty ratio value of 50%.
In this embodiment, a duty ratio smaller than 100% is stored in the 128th data region corresponding to a peak of N-pole excitation, and a duty ratio larger than 0% is stored in the 384th data region corresponding to a peak of S-pole excitation, thereby preventing such an inconvenience, which is caused when a duty ratio of 100% is stored in the 128th data region corresponding to a peak of N-pole excitation, that a voltage of +Vcc is output based on the duty ratio of 100% to make a gain of the sinusoidal voltage unchangeable.
Sinusoidal voltage signals can be applied to the A- and B-phase coils 11a, 11b as described above referring to FIGS. 4 and 5, whereby the stepping motor 10 can be micro-step driven. In the following description, it is assumed that sinusoidal voltage signals are applied to the A- and B-phase coils 11a, 11b.
The sine wave generator 26, the PWM generator 28, and the motor driver 29 of this embodiment correspond to a drive unit of this invention, and the sinusoidal voltage signals applied to the A- and B-phase coils 11a, 11b correspond to drive signals of this invention that periodically change.
In this embodiment, since one period of the sine wave signal generated by the sine wave generator 26 is divided into 512 parts as already described, a state of each of the sinusoidal voltage signals applied to the A- and B-phase coils 11a, 11b changes 512 times during one revolution of the stepping motor 10. The comparator 23 binarizes the output signals of the photointerrupters 21, 22 into the ENC0 and ENC1 signals, respectively, as previously described. The number of times the comparator 23 outputs each of the ENC0 and ENC1 signals during one revolution of the stepping motor 10 is less than the number of times the state of each of the voltage signals applied to the coil 11a, 11b changes during one revolution of the stepping motor 10.
Referring to FIG. 2 again, the A-phase coil 11a, when applied with the sinusoidal voltage signal, excites the A-phase positive side and negative side stator poles 12a, 13a. Similarly, the B-phase coil 11b when applied with the sinusoidal voltage signal excites the B-phase positive side and negative side stator poles 12b, 13b. The voltage signals respectively applied to the A- and B-phase coils 11a, 11b are different in phase from each other.
With reference to FIGS. 3 and 6, a description will be given of a relation among the sinusoidal voltage signals applied to the A- and B-phase coils 11a, 11b, excited stator poles, and rotation positions of the rotor 14 and the slit rotary plate 16.
FIG. 3A shows the construction of the stepping motor 10. The rotor 14 of the stepping motor 10 is disposed to be freely movable. Around the rotor 14, the stator poles (i.e., A-phase positive side stator poles 12a, A-phase negative side stator poles 13a, B-phase positive side stator poles 12b, and B-phase negative side stator poles 13b) are disposed at intervals of a physical angle of 18 degrees.
When the voltage signal applied to the A-phase coil 11a is in a positive region of the sinusoidal waveform, the A-phase positive side stator poles 12a are each excited to N-pole and the A-phase negative side stator poles 13a are each excited to S-pole. When the voltage signal applied to the A-phase coil 11a is in a negative region of the sinusoidal waveform, the A-phase positive side stator poles 12a are each excited to S-pole and the A-phase negative side stator poles 13a are each excited to N-pole.
When the voltage signal applied to the B-phase coil 11b is in a positive region of the sinusoidal waveform, the B-phase positive side stator poles 12b are each excited to N-pole and the B-phase negative side stator poles 13b are each excited to S-pole. When the voltage signal applied to the B-phase coil 11b is in a negative region of the sinusoidal waveform, the B-phase positive side stator poles 12b are each excited to S-pole and the B-phase negative side stator poles 13b are each excited to N-pole.
FIG. 6A shows sinusoidal voltage signals respectively applied to the A- and B-phase coils 11a, 11b to forwardly rotate the rotor 14, and FIG. 6B shows sinusoidal voltage signals applied to the coils 11a, 11b to reversely rotate the rotor 14.
In FIGS. 6A and 6B, the terms “N-pole” and “S-pole” recited in the positive and negative regions of the sinusoidal waveform respectively indicate polarities to which the A- and B-phase positive side stator poles 12a, 12b are excited. The A-phase negative side stator pole 13a is excited to the polarity opposite to that of the A-phase positive side stator pole 12a, and the B-phase negative side stator pole 13b is excited to the polarity opposite to that of the B-phase positive side stator pole 12b.
To forwardly rotate the rotor 14, the sine wave generator 26 generates the drive signals while increasing the data number, and outputs the generated drive signals to the stepping motor 10. The drive signal output to the A-phase coil 11a becomes a sine wave, and the drive signal output to the B-phase coil 11b becomes a cosine wave and leads by 90 degrees the drive signal output to the A-phase coil 11a.
To reversely rotate the rotor 14, the sine wave generator 26 generates the drive signals while decreasing the data number, and outputs the drive signals to the stepping motor 10. The drive signal output to the B-phase coil 11b lags behind the drive signal output to the A-phase coil 11a by 90 degrees.
FIGS. 3B and 3C each show a relation among physical positions of the rotor 14, the first and second photointerrupters 21, 22, the slit rotary plate 16, the A-phase positive side stator pole 12a, and the B-phase positive side stator pole 12b. It should be noted that although the stepping motor 10 of this embodiment has twenty stator poles as shown in FIG. 3A, only one of the A-phase positive side stator poles 12a and one of the B-phase positive side stator poles 12b are shown in FIG. 3B and in FIG. 3C.
FIG. 3B shows a state where the rotor 14 and the slit rotary plate 16 are in a reference positional relation where N-pole regions of the rotor 14 and bright regions of the slit rotary plate 16 are coincident with one another.
FIG. 3C shows a state where the slit rotary plate 16 is attached to the rotor 14 at a position where the slit rotary plate 16 is deviated by an electrical angle of α (=180 degrees) in the reverse rotation direction from the reference positional relation shown in FIG. 3B. The electrical angle rotates 360 degrees during one cycle of the drive signal applied to the corresponding coil. In this embodiment, the rotation angle of 72 degrees of the rotor 14 corresponds to the electrical angle of 360 degrees of the drive signal.
As shown in FIG. 3A, the B-phase positive side stator pole 12b is disposed at a position away from the A-phase positive side stator pole 12a by a physical angle of 18 degrees in the reverse rotation direction. In this embodiment, the first photointerrupter 21 is disposed at the same rotation position as the B-phase positive side stator pole 12b, and the second photointerrupter 22 is disposed at the same rotation position as the A-phase positive side stator pole 12a. Thus, with rotation of the slit rotary plate 16 that rotates together with the rotor 14, the first and second photointerrupters 21, 22 output signals corresponding to the rotation phase of the rotor 14. In other words, the signal output from each photointerrupter changes with rotation of the rotor 14.
FIG. 7A shows a modeled rotor having one N-pole and one S-pole, which is obtained by simplifying the rotor 14 that has five N-poles and five S-poles as shown in e.g. FIG. 3B. In this model, the electrical angle of the drive signal is equal to the rotation angle of the rotor 14. The following description is given based on this model.
FIG. 7A shows a state where the rotation phase of the rotor 14 and the bright/dark phase of the slit rotary plate 16 are in a reference positional relation. FIG. 7B shows a change of each of the ENC0 and ENC1 signals with forward rotation of the rotor 14 from the state of FIG. 7A, i.e., with increase of rotation angle θ. As already described, the ENC0 and ENC1 signals are obtained by binarizing the outputs from the ch0 and ch1 photointerrupters (first and second photointerrupters) 21, 22.
FIG. 7C shows a state where the slit rotary plate 16 is deviated from the reference positional relation shown in FIG. 7A by an electrical angle of a degrees in the reverse rotation direction. FIG. 7D shows a change of each of the ENC0 and ENC1 signals with forward rotation of the rotor 14 from the state of FIG. 7C.
In a case where the slit rotation plate 16 is mounted to the rotor shaft 15 as shown in FIG. 7C so as to be deviated from the reference positional relation of FIG. 7A, the ENC0 and ENC1 signals are output with a delay of a degrees in electrical angle when the rotor 14 rotates forwardly and are output with an advance of a degrees in electrical angle when the rotor 14 rotates reversely, as compared to the case where the slit rotation plate 16 is mounted to the rotor shaft 15 in the reference positional relation of FIG. 7A. It should be noted that the mounting deviation angle α of the slit rotation plate 16 is set and specified at the time of fabrication of the motor drive apparatus 100.
FIG. 8A shows a relation between the electrical angle and rotation position of the rotor 14 at rotor electrical angles of 0, 90, 180, and 270 degrees in the case without follow-up delay in rotation of the rotor 14 relative to sinusoidal voltage signals applied to the A- and B-phase coils 11a, 11b to forwardly rotate the rotor 14.
FIG. 8B shows a relation between the electrical angle and rotation position of the rotor 14 at rotor electrical angles of 0, 90, 180, and 270 degrees in the case of the presence of follow-up delay in rotation of the rotor 14 (hereinafter, referred to as the follow-up delay of the rotor 14) relative to the sinusoidal voltage signals when the rotor 14 is forwardly rotated.
Polarities to which the A- and B-phase positive side stator poles 12a, 12b are excited are the same between the cases of FIGS. 8A and 8B, except that in the case of FIG. 8B, there is a follow-up delay (denoted by reference numeral 81) of the rotor 14 relative to the sinusoidal voltage signals.
At the rotor electrical angle of 0 degrees, the A-phase positive side stator pole 12a is excited to S-pole, but the B-phase positive side stator pole 12b is excited neither to N-pole nor to S-pole. At the rotor electrical angle of 90 degrees, the A-phase positive side stator pole 12a is excited neither to N-pole nor to S-pole, but the B-phase positive side stator pole 12b is excited to N-pole. At the rotor electrical angle of 180 degrees, the A-phase positive side stator pole 12a is excited to N-pole, but the B-phase positive side stator pole 12b is excited neither to N-pole nor to S-pole. At the rotor electrical angle of 270 degrees, the A-phase positive side stator pole 12a is excited neither to N-pole nor to S-pole, but the B-phase positive side stator pole 12b is excited to S-pole.
FIG. 9 shows a relation among voltage signals applied to the A- and B-phase coils 11a, 11b to forwardly rotate the rotor 14, rotation position of the rotor 14, and outputs of the first and second photointerrupters 21, 22.
In (a) of FIG. 9, there is shown the sinusoidal voltage signal applied to the A-phase coil 11a. When this sinusoidal voltage signal is in a positive region, each of the A-phase positive side stator poles 12a is excited to N-pole. When the sinusoidal voltage signal is in a negative region, the A-phase positive side stator pole 12a is excited to S-pole.
In (b) of FIG. 9, there is shown the sinusoidal voltage signal applied to the B-phase coil 11b. When this sinusoidal voltage signal is in a positive region, each of the B-phase positive side stator poles 12b is excited to N-pole. When the sinusoidal voltage signal is in a negative region, the B-phase positive side stator pole 12 is excited to S-pole.
In FIG. 9, there is shown a relation similar to the relation shown in FIG. 8A or 8B between rotor electrical angle and rotor rotational position. In other words, when the sinusoidal voltage signals shown in (a) and (b) of FIG. 9 are applied respectively to the A- and B-phase coils 11a and 11b, the rotor 14 rotates as shown in FIG. 8A or 8B.
In (d) of FIG. 9, there is shown a change of the data number corresponding to the PWM value. The data number is output from the sine wave generator 26 to apply the sinusoidal voltage signal to the A-phase coil 11a. During one period of the sinusoidal voltage signal, the data number output from the sine wave generator 26 sequentially changes from 0 to 511. By detecting the data number output from the sine wave generator 26, a phase (state) of the voltage signal applied to the A-phase coil 11a can be detected. Since it is known that there is a phase difference of 90 degrees between the voltage signals applied to the A- and B-phase coils 11a and 11b, a phase (state) of the voltage signal applied to the B-phase coil 11b can also be detected by detecting the data number output from the sine wave generator 26.
In (c) of FIG. 9, there is shown a change of current rotation position of the rotor 14. A current rotation position is represented by an accumulated number of times of output of the data number from the sine wave generator 26. The accumulated number of times of output increases with a forward rotation of the rotor 14, but decreases with a reverse rotation of the rotor 14. For example, the accumulated number of times of output increases by 512 per one forward revolution of the rotor 14, and decreases by 512 per one reverse revolution of the rotor 14. In a case that the accumulated number of times of output becomes equal to a value of 1408 when the rotor electrical angle becomes 0 degrees for the first time, the accumulated number of times of output becomes equal to a value of 1920 when the rotor 14 has rotated by one revolution and the rotor electrical angle becomes 0 degrees again.
In (e) and (f) of FIG. 9, there are shown relations between rotation position of the rotor 14 and excited states of the A- and B-phase positive side stator poles 12a, 12b in the case without follow-up delay of the rotor 14 relative to voltage signals applied to the A- and B-phase coils 11a and 11b as in the case of FIG. 8A.
In (e) of FIG. 9, a dotted waveform represents an excited polarity of the A-phase positive side stator pole 12a. More specifically, this dotted waveform indicates that the A-phase positive side stator pole 12a is excited to N-pole when the sinusoidal voltage signal applied to the A-phase coil 11a is in a positive region and excited to S-pole when the sinusoidal voltage signal is in a negative region as previously described.
In (e) of FIG. 9, beneath the dotted waveform, the rotor 14 is shown in development form. In FIG. 9, there is a relation similar to the relation shown in FIG. 8A between rotor electrical angle and rotor rotational position as previously described. More specifically, at the rotor electrical angle of 0 degrees, a circumferential center of the N-pole of the rotor 14 faces the A-phase positive side stator pole 12a. At the rotor electrical angle of 180 degrees, a circumferential center of the S-pole of the rotor 14 faces the stator pole 12a. Thus, the dotted waveform has a maximum amplitude at rotor electrical angles of 0 degrees and 180 degrees.
In (f) of FIG. 9, a dotted waveform represents an excited polarity of the B-phase positive side stator pole 12b. More specifically, the dotted waveform indicates that the B-phase positive side stator pole 12b is excited to N-pole when the sinusoidal voltage signal applied to the B-phase coil 11b is in a positive region and excited to S-pole when the sinusoidal voltage signal is in a negative region as previously described.
In (f) of FIG. 9, beneath the dotted waveform, the rotor 14 is shown in development form. As in the case of FIG. 8A, at the rotor electrical angle of 90 degrees, a circumferential center of the S-pole of the rotor 14 faces the B-phase positive side stator pole 12b. At the rotor electrical angle of 270 degrees, a circumferential center of the N-pole of the rotor 14 faces the stator pole 12b. Thus, the dotted waveform has a maximum amplitude at rotor electrical angles of 90 degrees and 270 degrees.
In (g) of FIG. 9, there are shown outputs of the ch0 and ch1 photointerrupters 21, 22 in the case without follow-up delay of the rotor 14 relative to voltage signals applied to the A- and B-phase coils 11a, 11b as in the case of FIG. 8A. More specifically, there are shown ENC0 and ENC1 signals (respectively obtained by binarizing outputs of the ch0 and ch1 photointerrupters 21, 22) at respective rotor electrical angles. The ENC0 and ENC1 signals shown in (g) of FIG. 9 reflect the mounting deviation angle α of the slit rotation plate 16 shown in FIG. 7C and change between high and low levels with a delay of a degrees in electrical angle.
In (h) and (i) of FIG. 9, there are shown relations between rotation position of the rotor 14 and excited states of the A- and B-phase positive side stator poles 12a, 12b in a case that there is a follow-up delay of the rotor 14 relative to voltage signals applied to the A- and B-phase coils 11a, 11b as in the case of FIG. 8B.
In (f) of FIG. 9, a dotted waveform represents an excited polarity of the A-phase positive side stator pole 12a. This dotted waveform lags behind the dotted waveform shown in (e) of FIG. 9 by an amount of follow-up delay 91 that corresponds to the follow-up delay 81 of the rotor 14.
In (h) of FIG. 9, beneath the dotted waveform, the rotor 14 is shown in development form. As in the case of FIG. 8B, at a rotor electrical angle between 0 degrees to 90 degrees, a circumferential center of the N-pole of the rotor 14 faces the A-phase positive side stator pole 12a. At a rotor electrical angle between 180 degrees to 270 degrees, a circumferential center of the S-pole of the rotor 14 faces the stator pole 12a. Thus, the dotted waveform has a maximum amplitude at the rotor electrical angles between 0 degrees to 90 degrees and between 180 degrees to 270 degrees.
In (i) of FIG. 9, a dotted waveform represents an excited polarity of the B-phase positive side stator pole 12b. This dotted waveform lags behind the dotted waveform shown in (f) of FIG. 9 by an amount of follow-up delay 91.
In (i) of FIG. 9, beneath the dotted waveform, the rotor 14 is shown in development form. As in the case of FIG. 8B, at a rotor electrical angle between 270 degrees to 0 degrees, a circumferential center of the N-pole of the rotor 14 faces the B-phase positive side stator pole 12b. At a rotor electrical angle between 90 degrees to 180 degrees, a circumferential center of the S-pole of the rotor 14 faces the stator pole 12b. Thus, the dotted waveform has a maximum amplitude at the rotor electrical angles between 270 degrees to 0 degrees and between 90 degrees to 180 degrees.
In (j) of FIG. 9, there are shown ENC0 and ENC1 signals corresponding to outputs of the ch0 and ch1 photointerrupters 21, 22 observed when there is a follow-up delay of the rotor 14 relative to voltage signals applied to the A- and B-phase coils 11a, 11b as in the case of FIG. 8B. The ENC0 and ENC1 signals change between high and low levels with the amount of follow-up delay 91 (corresponding to the follow-up delay 81 shown in FIG. 8B) relative to the high/low changes of the ENC0 and ENC1 signals shown in (g) of FIG. 9.
FIG. 10A shows a relation between the electrical angle and rotation position of the rotor 14 at rotor electrical angles of 0, 90, 180, and 270 degrees in the case without follow-up delay of the rotor 14 relative to the sinusoidal voltage signals applied to the A- and B-phase coils 11a, 11b to reversely rotate the rotor 14.
FIG. 10B shows a relation between the electrical angle and rotation position of the rotor 14 at rotor electrical angles of 0, 90, 180, and 270 degrees in the case of the presence of follow-up delay of the rotor 14 relative to the sinusoidal voltage signals when the rotor 14 is reversely rotated. In FIG. 10B, reference numeral 101 denotes a follow-up delay of the rotor 14 relative to the sinusoidal voltage signals. With the construction shown in FIGS. 10A and 10B, the A- and B-phase coils 11a, 11b are excited in basically the same manner as in the case of FIGS. 8A and 8B at respective rotor electrical angles, and a description thereof will be omitted.
FIG. 11 shows a relation among voltage signals applied to the A- and B-phase coils 11a, 11b to reversely rotate the rotor 14, rotation position of the rotor 14, and outputs of the first and second photointerrupters 21, 22.
Various signals in (a)-(j) of FIG. 11 are basically the same as those shown in (a)-(j) of FIG. 9, and a description thereof will be omitted. In FIG. 11, reference numeral 121 denotes a follow-up delay of the rotor 14 relative to the sinusoidal voltage signals, which corresponds to the follow-up delay 101 shown in FIG. 10B.
The case where the rotor 14 is reversely rotated is different in the following points from the case where the rotor 14 is forwardly rotated. When the rotor 14 is reversely rotated, the data number output from the sine wave generator 26 decreases with rotor rotation, as shown in (d) of FIG. 11. The accumulated number of times of output of the data number from the sine wave generator 26 also decreases with a reverse rotation of the rotor 14. More specifically, the accumulated number of times of output decreases by 512 per one revolution of the rotor 14. In the case of reverse rotation of the rotor 14, due to the mounting deviation angle α of the slit rotation plate 16, timings at which the ENC0 and ENC1 signals change between high and low levels lead by a degrees in electrical angle.
FIGS. 12 and 13 show in flowchart the procedures of a stepping motor drive process executed by the CPU 25 of the motor drive apparatus 100.
In step S101, the CPU 25 sets reference rotation positions (hereinafter, referred to as the reference positions) corresponding to timings at which there occur changes in outputs of the first and second photointerrupters (ch0 and ch1 photointerrupters) 21, 22. By way of example, the CPU 25 sets, as reference positions, data numbers corresponding to timings at which either the ENC0 signal or the ENC1 signal changes between high and low levels in the case without follow-up delay of the rotor 14.
First, a description will be given of how the reference positions are set in the case of forward rotation of the rotor 14.
As shown in (g) of FIG. 9, the ENC1 signal changes from high to low at timings of E1 and E5, the ENC0 signal changes from low to high at timings of E2 and E6, the ENC1 signal changes from low to high at a timing of E3, and the ENC0 signal changes from high to low at a timing of E4.
The CPU 25 adds a value α, which is obtained by converting the mounting deviation angle α of the slit rotation plate 16 into the number of times of output of data number, to a data number “0” to thereby calculate data numbers 90a and 90i which are the same as each other and will be referred to as the data number 90a, 90i (ditto in similar cases). The CPU 25 sets the data number 90a, 90i as a reference position corresponding to the timings E1 and E5. Further, the CPU 25 sets data number 90c, 90k obtained by adding the value α to a data number “128” as a reference position corresponding to timings E2 and E6, sets data number 90e obtained by adding the value α to a data number “256” as a reference position corresponding to the timing E3, and sets a data number 90g obtained by adding the value α to a data number “384” as a reference position corresponding to the timing E4.
The just-mentioned four reference positions are indicated by symbols ENC1F_CwBaseCnt, ENC0R_CwBaseCnt, ENC1R_CwBaseCnt, and ENC0F_CwBaseCnt within a block of step S101 of FIG. 12.
Next, a description will be given of how the reference positions are set in the case of reverse rotation of the rotor 14.
As shown in (g) of FIG. 11, the ENC1 signal changes from low to high at the timings of E1 and E5, the ENC0 signal changes from low to high at the timings of E2 and E6, the ENC1 signal changes from high to low at the timing of E3, and the ENC0 signal changes from high to low at the timing of E4.
The CPU 25 sets a data number 110a, 110i obtained by adding the value α to the data number “0” as a reference position corresponding to the timings E1 and E5, sets a data number 110c, 110k obtained by adding the value α to the data number “384” as a reference position corresponding to the timings E2 and E6, sets a data number 110e obtained by adding the value α to the data number “256” as a reference position corresponding to the timing E3, and sets a data number 110g obtained by adding the value α to the data number “128” as a reference position corresponding to the timing E4.
The just-mentioned four reference positions are indicated by symbols ENC1R_CcwBaseCnt, EnC0R_CcwBaseCnt, ENC1F_CcwBaseCnt, and ENC0R_CcwBaseCnt within the block of the step S101 in FIG. 12.
As described above, data numbers are calculated that correspond to timings at each of which the ENC0 or ENC1 signal changes between high and low levels when the rotor 14 is forwardly or reversely rotated. The calculated data numbers are stored into variable regions. The reference positions in the case without follow-up delay of the rotor 14 relative to voltage signals applied to the A- and B-phase coils 11a, 11b are set in step S101, as already described.
In step S102, the CPU 25 determines whether any of the eight data numbers set as the reference positions in step S101 exceeds a value of 512. If any of the eight data numbers exceeds the value of 512, the value of 512 is subtracted from such data number and the resultant data number is set as the reference position. Thus, the data numbers set as the reference positions are normalized between the value of 0 and the maximum value “511” of the data numbers.
Next, in step S103, the CPU 25 determines whether there is an inquiry about the current rotation position of the rotor 14. If there is such an inquiry (YES to step S103), the flow proceeds to step S104. If there is no inquiry (NO to step S103), the flow proceeds to step S105.
In step S104, the CPU 25 sends a data number corresponding to a current rotation position of the rotor 14 back to an inquiry source. As already described, the current rotation position of the rotor 14 is represented by an accumulated number of times of output of the data number from the sine wave generator 26.
In step S105, the CPU 25 determines whether a drive start instruction to the stepping motor 10 is given. If the drive start instruction is given (YES to step S105), the flow proceeds to step S106. If no drive start instruction is given (NO to step S105), the flow returns to step S103.
In step S106, the CPU 25 sets command values about rotation direction, speed, and target stop position, which are sent together with the drive start instruction.
In step S107, the CPU 25 sets a value of “0” to a variable DiffCnt for storing a difference between one of the data numbers set as the reference positions in step S101 and a data number corresponding to a timing at which the ENC0 or ENC1 signal changes between high and low levels. Then, the CPU 25 starts to drive the stepping motor 10 in a condition according to the command values set in step S106.
In step S108, the CPU 25 determines whether or not an interruption has occurred by a high/low change of the ENC0 or ENC1 signal. If an interruption has occurred (YES to step S108), the CPU 25 proceeds the process to step S109. If no interruption has occurred (NO to step S108), the CPU 25 proceeds the process to step S130.
In step S109, the CPU 25 determines whether the rotor 14 should be rotated forwardly based on information about the rotation direction sent together with the drive start instruction. If the rotor 14 should be rotated forwardly (YES to step S109), the process proceeds to step S110. If the rotor 14 should be rotated reversely (NO to step S109), the process proceeds to step S111.
In step S110, the CPU 25 determines whether the interruption determined in step S108 has occurred by the ENC0 signal. If the interruption has occurred by the ENC0 signal (YES to step S110), the process proceeds to step S112.
In step S112, the CPU 25 determines whether the ENC0 signal has risen from low to high. If the ENC0 signal has risen from low to high (YES to step S112), the process proceeds to step S116.
In step S116, the CPU 25 acquires a data number 90d or 90l corresponding to the timing E8 or E12 at which the ENC0 signal has changed from low to high (see, (d) and (j) of FIG. 9), and stores, into the variable DiffCnt, a difference 91b or 91f (positive value) between the acquired data number 90d or 90l (current phase Cnt value) and the data number 90c or 90k set as the reference position ENC0R_CwBaseCnt in step S101.
If determined in step S112 that the ENC0 signal has not risen from low to high, i.e., if the ENC0 signal has fallen from high to low, the process proceeds to step S117.
In step S117, the CPU 25 acquires a data number 90h corresponding to a timing E10 at which the ENC0 signal has fallen from high to low (see, (d) and (j) of FIG. 9), and stores into the variable DiffCnt a difference 91d (positive value) between the acquired data number 90h (current phase Cnt value) and the data number 90g set as the reference position ENC0R_CwBaseCnt in step S101.
If determined in step S110 that the interruption has not occurred by the ENC0 signal, the process proceeds to step S113.
In step S113, the CPU 25 determines whether the ENC1 signal has risen from low to high. If the ENC1 signal has risen from low to high (YES to step S113), the process proceeds to step S118.
In step S118, the CPU 25 acquires a data number 90f corresponding to a timing E9 at which the ENC1 signal has risen from low to high (see, (d) and (j) of FIG. 9), and stores into the variable DiffCnt a difference 91c (positive value) between the acquired data number 90f (current phase Cnt value) and the data number 90e set as the reference position ENC1R_CwBaseCnt in step S101.
If determined in step S113 that the ENC1 signal has not risen from low to high, i.e., if the ENC1 signal has fallen from high to low, the process proceeds to step S119.
In step S119, the CPU 25 acquires a data number 90b or 90j corresponding to a timing E7 or E11 at which the ENC1 signal has fallen from high to low (see, (d) and (j) of FIG. 9), and stores into the variable DiffCnt a difference 91a or 91e (positive value) between the acquired data number 90b or 90j (current phase Cnt value) and the data number 90a or 90i set as the reference position ENC1F_CwBaseCnt in step S101.
If determined in step S109 that the rotor 14 should be rotated reversely, the process proceeds to step S111. In step S111, as in the case of step S110, the CPU 25 determines whether the interruption determined in step S108 has occurred by the ENC0 signal. If the answer to step S111 is YES, the process proceeds to step S114. Otherwise, the process proceeds to step S115.
In step S114, as in the case of step S112, the CPU 25 determines whether the ENC0 signal has risen from low to high. If the answer to step S114 is YES, the process proceeds to step S120. Otherwise, the process proceeds to step S121.
In step S115, as in the case of step S113, the CPU 25 determines whether the ENC1 signal has risen from low to high. If the answer to step S115 is YES, the process proceeds to step S122. Otherwise, the process proceeds to step S123.
In step S120, the CPU 25 acquires a data number 110d or 110l corresponding to a timing E8 or E12 at which the ENC0 signal has risen from low to high (see, (d) and (j) of FIG. 11), and stores into the variable DiffCnt a difference 111b or 111f (negative value) between the acquired data number 110d or 110l (current phase Cnt value) and the data number 110c or 110k set as the reference position ENC0R_CcwBaseCnt in step S101.
In step S121, the CPU 25 acquires a data number 101h corresponding to a timing E10 at which the ENC0 signal has fallen from high to low (see, (d) and (j) of FIG. 11), and stores into the variable DiffCnt a difference 111d (negative value) between the acquired data number 101h (current phase Cnt value) and the data number 110g set as the reference position ENC0F_CcwBaseCnt in step S101.
In step S122, the CPU 25 acquires a data number 110f corresponding to the timing E9 at which the ENC1 signal has risen from low to high (see, (d) and (j) of FIG. 11), and stores into the variable DiffCnt a difference 111c (negative value) between the acquired data number 110f (current phase Cnt value) and the data number 110e set as the reference position ENC1R_CcwBaseCnt in step S101.
In step S123, the CPU 25 acquires a data number 110b or 110j corresponding to the timing E7 or Ell at which the ENC1 signal has fallen from high to low (see, (d) and (j) of FIG. 11), and stores into the variable DiffCnt a difference 111a or 111e (negative value) between the acquired data number 110b or 110j (current phase Cnt value) and the data number 110a or 110i set as the reference position ENC1F_CcwBaseCnt in step S101.
If two data numbers used for the difference calculation in any of steps S116-S123 straddle the data number “0” (such as the data numbers 110a, 110b or 110e, 110j used for the calculation of the difference 111a or 111e), the data number difference is corrected in steps S124-S127.
To this end, upon completion of the difference calculation in any of steps S116-S123, the CPU 25 determines whether the data number difference stored in the variable DiffCnt is larger than a value of 256 (step S124). If the data number difference is not larger than the value of 256 (NO to step S124), the process proceeds to step S126. On the other hand, if the data number difference stored in the variable DiffCnt is larger than the value of 256 (YES to step S124), the process proceeds to step S125 in which the CPU 25 subtracts a value of 512 from the data number difference stored in the variable DiffCnt and stores a resultant value into the variable DiffCnt. Subsequently, the process proceeds to step S126.
In step S126, the CPU 25 determines whether the data number difference stored in the variable DiffCnt is equal to or less than a value of −256. If the data number difference is neither equal to nor less than the value of −256 (NO to step S126), the process proceeds to step S128. On the other hand, if the data number difference stored in the variable DiffCnt is equal to or less than the value of −256 (YES to step S126), the process proceeds to step S127 in which the CPU 25 adds a value of 512 to the data number difference stored in the variable DiffCnt and stores a resultant value into the variable DiffCnt. Then, the process proceeds to step S128.
In step S128, the CPU 25 determines whether there is an inquiry about a current rotor rotation position. If there is no such inquiry (NO to step S128), the process proceeds to step S130. On the other hand, if there is such inquiry (YES to step S128), the process proceeds to step S129 in which the CPU 25 sends back a data number corrected by the data number difference stored in the variable DiffCnt in reply to the inquiry.
In a case, for example, that the inquiry about the current motor rotation position is made at the timing E7 shown in (j) of FIG. 9, the rotor 14 assumes at the timing E7 a rotation position 92b, which is shown in (c) of FIG. 9 to correspond to the timing E7. This rotor rotation position 92b is represented by an accumulated number of times of output of the data number until the timing E7, and corresponds to the data number 90b, which is shown in (d) of FIG. 9 to correspond to the timing E7.
If there is no follow-up delay of the rotor 14 relative to the voltage signals applied to the A- and B-phase coils 11a and 11b, the voltage signals corresponding to the data number 90b are applied to these coils 11a, 11b at the timing E7. On the other hand, if there is a follow-up delay of the rotor 14 represented by the data number difference 91a shown in (d) of FIG. 9, the voltage signals corresponding to the data number 90a are applied to the A- and B-phase coils 11a, 11b at the timing E7. In that case, in order to stop the rotation of the rotor 14 at the timing E7, the progress of output of data number from the sine wave generator 26 is controlled so as to be stopped at the rotor rotation position 92a corresponding to the data number 90a.
Next, in step S130, the CPU 25 determines whether the rotor 14 has reached a target stop position. If the rotor 14 has not reached the target stop position (NO to step S130), the process returns to step S108. On the other hand, if the rotor 14 has reached the target stop position (YES to step S130), the process proceeds to step S131 in which the CPU 25 causes the sine wave generator 26 to stop the progress of output of data number. Subsequently, the process returns to step S103.
According to the stepping motor drive process described above, it is possible to determine an amount of follow-up delay of the rotor based on a difference between a state of the drive signal observed at a timing of change of the output signal of the signal output unit in the case without follow-up delay of the rotor and a state of the drive signal observed at that timing in the case of the presence of follow-up delay of the rotor. Based on the determined amount of follow-up delay, the follow-up delay of the rotor can be corrected.
It should be noted that in this embodiment, the case has been described where duty ratios of the ENC0 and ENC1 signals are the same as each other, but this is not limitative.
FIG. 14 shows a case where duty ratios of the ENC0 and ENC1 signals are different from each other. In the example of FIG. 14, an analog output of the ch0 photointerrupter 21 is binarized into the ENC0 signal according to a threshold value 401. The ENC0 signal has a duty ratio smaller than 50%. On the other hand, an analog output of the ch1 photointerrupter 22 is binarized into the ENC1 signal according to a threshold value 402. The ENC1 signal has a duty ratio larger than 50%.
The encoder circuit 24 acquires timings of change of the ENC0 signal from low to high and from high to low and timings of change of the ENC1 signal from low to high and from high to low, which are shown in FIG. 14. In step S101 of the stepping motor drive process, the CPU 25 sets, as reference positions, data numbers corresponding to the timings at which either the ENC0 signal or the ENC1 signal changes between high and low levels in the case without follow-up delay of the rotor 14.
In a case where the rotor rotation speed varies at intervals less than intervals between timings at which the ENC0 or ENC1 signal changes in level, the follow-up delay of the rotor is corrected based on a plurality of amounts of follow-up delay. For example, a plurality of variables DiffCnt are prepared, a plurality of amounts of follow-up delay are held in these variables, and the follow-up delay of the rotor is corrected based on an average value of the plurality of amounts of follow-up delay.
Other Embodiments
Embodiments of the present invention can also be realized by a computer of a system or apparatus that reads out and executes computer executable instructions recorded on a storage medium (e.g., non-transitory computer-readable storage medium) to perform the functions of one or more of the above-described embodiment (s) of the present invention, and by a method performed by the computer of the system or apparatus by, for example, reading out and executing the computer executable instructions from the storage medium to perform the functions of one or more of the above-described embodiment (s). The computer may comprise one or more of a central processing unit (CPU), micro processing unit (MPU), or other circuitry, and may include a network of separate computers or separate computer processors. The computer executable instructions may be provided to the computer, for example, from a network or the storage medium. The storage medium may include, for example, one or more of a hard disk, a random-access memory (RAM), a read only memory (ROM), a storage of distributed computing systems, an optical disk (such as a compact disc (CD), digital versatile disc (DVD), or Blu-ray Disc (BD)™), a flash memory device, a memory card, and the like.
While the present invention has been described with reference to exemplary embodiments, it is to be understood that the invention is not limited to the disclosed exemplary embodiments. The scope of the following claims is to be accorded the broadest interpretation so as to encompass all such modifications and equivalent structures and functions.
This application claims the benefit of Japanese Patent Application No. 2013-049240, filed Mar. 12, 2013, which is hereby incorporated by reference herein in its entirety.