US 5,294,877 AGrant
Circuit and Method for Detecting Deceleration Rates of a Polyphase DC Motor
Issue Date:1994-03-15
•22 Claims
•7 Drawing Sheets
Abstract
A circuit for operating a polyphase dc motor includes first circuitry for determining when the back emf of the floating driving coils crosses zero. A first counter counts a time period between a first set of zero crossings, and a second counter is loaded with the count reached by the first counter. The second counter counts a time period between a subsequently occurring set of zero crossings. If the second counter reaches zero before the occurrence of a third zero crossing, a warning signal is generated. A method for determining if a deceleration rate of a polyphase dc motor exceeds a predetermined threshold includes measuring a first period between a first set of zero crossings of the back emf of the floating driving coils, and comparing the measurement of the first period with a subsequent period between a subsequent set of zero crossings. If the subsequent period is larger than the first period by a predetermined amount a warning signal is produced. The first period is measured by counting up from zero at a first predetermined rate from a first zero crossing until a second zero crossing occurs. The comparison of the measurement of the first period with a subsequent period is done by counting down at a second predetermined rate from the count reached in the up count when the second zero crossing occurred. And the warning signal is produced if the down count reaches a zero before a third zero crossing occurs.
Metadata
Assignee
- SGS-Thomson Microelectronics, Inc.
Inventor
- Scott W. Cameron
Application Information
Application Number:US 8768714
Filing Date:1992-04-30
Priority Date:1991-10-03
Art Unit:217
Classifications
IPC:
H02P 528
Field of Search:
318254;138;439;757-765;798-812
Patent Drawings (7 sheets)
Description
Background of the Invention
1. Field of the Invention
This invention pertains to improvements in motor driving and controlling circuitry, and more particularly, to an improved circuit and method for detecting deceleration rates of a brushless, sensorless, dc motor, or the like, and for providing warnings or other responses in response to a breach of a desired deceleration rate profile.
2. Description of the Prior Art
Although the present invention pertains to polyphase dc motors, in general, it finds particular application in conjunction with three phase dc motors, particularly of the brushless, sensorless type. Three phase brushless, sensorless dc motors are becoming especially popular, due to their reliability, low weight, and accuracy.
Motors of this type can typically be thought of as having a stator with three coils connected in a "Y" configuration, although actually, a larger number of stator coils are usually employed with multiple motor poles. Typically, in such applications, eight pole motors are used having twelve stator windings and four N-S magnetic sets on the rotor, resulting in four electrical cycles per revolution of the rotor. The stator coils, however, can be analyzed in terms of three "Y" connected coils, connected in three sets of four coils, each physically separated by 90.degree.. In operation, the coils are energized in sequences in each of which a current path is established through two coils of the "Y", with the third coil left floating. The sequences are arranged so that as the current paths are changed, or commutated, one of the coils of the current path is switched to float, and the previously floating coil is switched into the current path. Moreover, the sequence is defined such that when the floating coil is switched into the current path, current will flow in the same direction in the coil which was included in the prior current path. In this manner, six commutation sequences are defined for each electrical cycle in a three phase motor.
In the past, during the operation of a such polyphase dc motor, it has been recognized that maintaining a known position of the rotor is an important concern. There have been various ways by which this was implemented. The most widely used way, for example, was to start the motor in a known position, then develop information related to the instantaneous or current position of the rotor. One source of such instantaneous position information was developed as a part of the commutation process, and involved identifying the floating coil, and monitoring its back emf, that is, the emf induced into the coil as it moves through the magnetic field provided by the stator.
When the voltage of the floating coil crossed zero (referred to in the art as "a zero crossing"), the position of the rotor was assumed to be known. Upon the occurrence of this event, the rotor coil commutation sequence was incremented to the next phase, and the process repeated. The assumption that the zero crossing accurately indicated the rotor position was generally if the motor was functioning properly.
As brushless, sensorless dc motors become more and more in demand, they are being increasingly used in such applications as in disk drives for use in computer applications, such as floppy disk, hard disk, CD ROM, and other similar applications. One of the main advantages provided by such brushless, sensorless motors is the absence of brush elements. This reduces the number of parts in the motor, reduces the mean time between failure of a particular motor, and has no sparking or other undesirable spurious emf generation properties.
In addition, brushless, sensorless motors are finding widespread use in robotics applications. This is due, in part, to the above listed advantages of such motors. It can be seen, furthermore, that the absence of brushes in the motors used in robotics arms, for example, enables their use in hazardous or explosive environments, in contrast to prior art devices.
In any such application, however, many factors exist that may produce an undesirable deceleration of the motor. For example, in the disk drive applications described, motor bearings may seize and cause the motor to decelerate. In disk drives that may be employed, for instance, in lap top computers, a bump or jar to the computer may cause the heads of the disk drive to bind, resulting in an undesired frictional force on the disk and causing an undesirable deceleration of the motor itself.
In robotics applications, a robot arm may encounter an unexpected object or an object in an unexpected place along the path of its travel. This may cause an undesirable deceleration of the motor, and, if no corrective steps are taken, may result in the current within the motor coils increasing to the point of damaging or destroying the motor. Alternatively, the robot arm may damage the object with which it comes in to contact. This is particularly disadvantageous in such applications as automotive assembly, and the like, in which relatively expensive objects may be seriously damaged by unintended contact with the robot arm.
Summary of the Invention
In light of the above, it is, therefore, an object of the invention to provide an improved circuit and method for controlling brushless, sensorless dc motors.
It is another object of the invention to provide an improved circuit and method of the type described that can detect deceleration rates of the motor.
It is yet another object of the invention to provide an improved circuit and method of the type described that enables a threshold to be set of the amount of deceleration that can be tolerated in a particular motor application, the violation of which produces a warning or initiates other corrective action.
These and other objects, features and advantages of the invention will be apparent to those skilled in the art from the following detailed description of the invention, when read in conjunction with the accompanying drawings and appended claims.
In accordance with a broad aspect of the invention, a circuit for operating a polyphase dc motor having a plurality of driving coils and a moving rotor is presented. The circuit includes first circuitry for determining when the back emf of a floating one of the driving coils crosses a reference voltage. A first counter counts a time period between a first set of reference voltage crossings. A second counter connected to be loaded with the count counted by the first counter, counts a time period between a subsequently occurring set of reference voltage crossings and second circuitry determines whether the second counter has reached a predetermined count with respect to the count of the first counter. In a preferred embodiment, the first counter is an up counter and the second counter is a down counter, and the predetermined count of the second counter is zero.
In the circuit, first and second clock pulse sources are provided for supplying first and second clock pulses respectively to the first and second counters, and the frequency of the pulses supplied by the first clock pulse source is less than a frequency of pulses supplied by the second clock pulse source. A first gate is connected to determine when the output of the second counter has reached zero, in which event, a warning signal is generated.
In accordance with another broad aspect of the invention, a method for determining if a deceleration rate of a polyphase dc motor having a plurality of driving coils and a moving rotor exceeds a predetermined threshold is presented. The method includes measuring a first period between a first set of reference voltage crossings of the back emf of floating ones of the driving coils, and comparing the measurement of the first period with a subsequent period between a subsequent set of reference voltage crossings of the back emf of floating ones of the driving coils. If the subsequent period is larger than the first period by a predetermined amount a warning signal is produced.
In accordance with the method, the step of measuring the first period comprises counting up from zero at a first predetermined rate from a first reference voltage crossing until a second reference voltage crossing occurs. The step of comparing the measurement of the first period with a subsequent period comprises counting down at a second predetermined rate from a count reached in the up count when the second reference voltage crossing occurred. And the step of producing a warning signal comprises producing a warning signal if the down count reaches a predetermined count before a third reference voltage crossing occurs. Preferably, the step of producing a warning signal comprises producing a warning signal if the down count reaches zero before the third reference voltage crossing occurs .
Brief Description of the Drawings
The invention is illustrated in the accompanying drawings, in which:
FIG. 1 is an electrical schematic block diagram of a motor driver system incorporating apparatus in accordance with a preferred embodiment of the invention.
FIG. 2 is an electrical schematic diagram of the power stage used in the motor driver system of FIG. 1 for providing motor driving signals to the "Y" connected stator coils of the motor with which the driver system might be associated.
FIG. 3 is an electrical schematic diagram of a typical "Y" connected rotor coil arrangement, illustrating the current flow direction for 6 phases of a 3 phase motor.
FIG. 4 is an electrical schematic diagram of a sequencer circuit used in the motor driver system of FIG. 1.
FIG. 5 is an electrical schematic diagram a back emf amplifier and zero crossing detector used in the motor driver system of FIG. 1.
FIG. 5a shows various voltage waveforms generated at the output of the zero crossing detector of FIG. 5, illustrating their timed relationship to a detected rising or falling zero crossing.
FIG. 6 is an electrical schematic diagram of a zero crossing logic switching circuit used to control the back emf amplifier connections in the circuit of FIG. 5.
FIG. 7 is an electrical schematic diagram of a circuit for generating a commutation delay and sequencer advance signals, a commutation noise mask generator, and a deceleration counter for use in the motor driver system of FIG. 1.
FIG. 8 are electrical waveforms showing the voltage signals at various points in the circuit of FIG. 1 with respect to several electrical cycles of the motor with which the driver circuit may be associated.
FIG. 9 are various waveforms illustrating the operation of the period and deceleration counters in accordance with the invention.
In the various figures of the drawing, like reference numerals are used to denote like or similar parts.
Detailed Description of the Preferred Embodiment
A portion of an electrical schematic block diagram of a motor controller 10 in which the apparatus and method in accordance with a preferred embodiment of the invention may be incorporated is shown in FIG. 1. Although the motor controller can be constructed of discrete components, preferably, the motor controller 10 is integrated onto a single semiconductor chip adapted for connection to the stator coils of a three phase dc brushless spindle motor, for use, for example, to turn a magnetic or other disk in systems such as computer hard disk drives, cd-rom drives, floppy disk drives, and the like, or in robotics applications, such as to drive various robotics arm or finger parts. Such 3 phase motor preferably has Y connected stator windings, although such Y configured winding connections are not essentially required.
Thus, the windings can be connected to output terminals OUT A, OUT B, OUT C and CTR TAP, as below described in further detail. It should be noted that although a preferred embodiment of the invention is described with regard to a three phase motor, in particular, the principles of the invention can be equally advantageously applied to polyphase motors, in general.
The driving voltage is provided to the output terminals OUT A, OUT B, and OUT C by a power stage 11, which may be configured as described below with reference to FIG. 2. The power stage 11 is sequenced to provide sequential control output signals to the output terminals OUT A, OUT B, and OUT C by a sequencer circuit 13, described below with reference to FIG. 4. A signal interface circuit 12 supplies the output signals from the sequencer circuit 13 to the power stage 11, as well as enabling other functions, such as brake and output enable functions. The sequencer 13 also provides drive signals to other circuits of the controller circuitry to control the various aspects of rotation of the motor driven by the circuit 10.
The output terminals OUT A, OUT B, and OUT C are switchably connected to a back-emf sense amplifier 14, the details of which are described with reference to FIG. 5 below. The back-emf sense amplifier 14 in turn delivers signals to a zero crossing detector circuit 16, also illustrated in FIG. 5 below, which provides input signals to a digital timing circuit 17, described in detail in FIG. 7 below. The output of the mask counter of the digital timing circuit 17 controls the operation of the sequencer 13, in a manner below described in detail.
The motor controller circuitry 10 includes system clock circuitry 23, and phase lock loop (PLL) frequency/phase detector circuitry 24, and may include various other circuitry, not shown, such as circuitry to support pulse width modulation operation of the motor, "align and go" start up circuitry to facilitate start up of the motor from a stopped condition, port control logic and associated shift register circuitry to facilitate control of the motor controller circuitry by an external microprocessor (not shown), and so forth.
The power stage 11 of the motor control circuitry 10 is a conventional H-bridge 30, commonly referred to as a triple - 1/2- H - bridge, as shown in greater detail in FIG. 2. The Y connected stator windings 32, 33, and 34 are shown in FIG. 2 connected to switchably receive the driving current delivered by the power stage 11 of the motor control circuitry 10. Three series current paths 37, 38, and 39 are provided between a supply voltage applied to a line 41, and a reference potential on line 42. Each current path includes, respectively, two switching transistors 44 and 45, 44' and 45', and 44" and 45". The transistors 44, 44', 44", 45, 45' and 45" can be of known power switch FETs, or other switch devices, as desired.
The line 42 is connected to an external sense resistor 49 (externally connected to terminals R SENSE, as shown in FIG. 1), which in turn is connected to ground.
One end of each of the stator coils 32, 33, and 34 is connected together at a common center tap 36, the other ends being connected to respective nodes OUT A, OUT B, and OUT C between the respective pairs of switching transistors 44-45; 44'-45', and 44"-45". Each of the switching transistors 44, 45, 44,' 45', 44", and 45" has a flyback diode 47, 48; 47', 48'; and 47", 48" connected in parallel with its current path, as shown.
In operation, during an energized phase, one node (for example, node out A) is driven high by one of the upper switches 44. One node (for example, node out B) is driven low by one of the lower switches 45', and the other node (for example, node C) is left floating with both switches 44" and 45" off. This is commonly to as the "AB phase". The coils are then switched in a commutation sequence determined by the sequence circuit 13 in a manner such that in each commutation phase current always flows in two of the three coils, with the third coil floating, and that after switching current will continue to flow, and in the same direction, in one of the two coils in which current was flowing in the previous phase.
More particularly, as shown in the diagram of FIG. 3, in a three phase motor, actually six operational phases exist. The current flows in each of these six phases as shown in the following Table A:
The switching of the driver transistors of the power stage 11 to effect the switching currents for each phase is accomplished by a sequencer circuit 13, as shown in FIG. 4. The sequencer circuit 13 provides signals to the upper driver outputs 52 and the lower driver outputs 53 to accomplish the switching sequence outlined above in Table A. The upper and lower driver outputs 52 and 53 are connected to the upper and lower driver input lines, shown in FIG. 2. A shift register 55 determines which of the specific upper and lower output lines which are activated any particular instant. To accomplish this determination, an appropriate sequence may be loaded into the shift register 55, and sequentially shifted through the various data positions of the shift register 55. For example, one data sequence in the embodiment shown which will produce the commutation sequence of Table A might be "110000", which will be continuously clocked to appear at the outputs Q.sub.1 -Q.sub.6.
The shift register 55 is clocked by a system clock, introduced into the shift register 55 by a clock signal produced by a delay counter 112, described in detail below with respect to FIG. 7. Thus, the shift register 55 operates to present a high state on one of its outputs Q.sub.1 -Q.sub.6 to turn on the corresponding upper and lower transistors according to the sequence shown in Table A.
Other circuitry of the sequence circuit 13 includes a reset line 59 to operate to reset the shift register 55. The outputs Q.sub.1 -Q.sub.6 are also connected via lines 66 to the zero voltage crossing logic control circuit of FIG. 6, described below. If desired, a brake and/or over-temperature indicating signals developed elsewhere in the motor control circuit 10 may be applied on line 67 to logic circuit 63 to prevent output to the motor on the upper and lower driver output lines 52 and 53 when such brake signal and/or over-temperature condition exist.
The commutation among the coils 32, 33, and 34 is performed in response to information indicating the specific position of the rotor of the motor in conjunction with circuit information indicating the desired position of the rotor. More specifically, the commutation to apply the next drive sequence of Table A is determined in response to a corresponding coil reaching a particular rotational position and its correlation with sequencer information indicating where the motor should be when a commutation is to occur. The determination of the precise rotational location of the rotor is continuously being determined by monitoring the zero crossing voltage in each non-driven, or floating, coil. More particularly, as the coils 32, 33, and 34 are switched during the commutation sequence of the rotor, the voltage of the floating coil is monitored by the back emf amplifier circuit 14 shown in FIG. 5.
The back emf amplifier circuit 14 includes switches 81, 82, and 83 respectively connected to the motor driver outputs OUT A, OUT B, and OUT C, in the circuit of FIG. 2 to apply a selected one of outputs OUT A, OUT B, or OUT C to the non-inverting input of a comparator 85. The particular one of the motor driver outputs OUT A, OUT B or OUT C which is applied to the comparator 85 corresponds to whichever of coils 32, 33, or 34 is expected to be floating (not the coil which is actually floating). Although the term "floating" is used herein to indicate the coil which is not in the instantaneous current path, the coil does not actually "float", but is connected to a tristate impedance. The switches 81, 82, and 83 are operated by the circuit of FIG. 6, below described, to effect the switching of the coil expected to be floating, as just described.
The center tap connection 36 (see FIG. 2) of the rotor is connected to the inverting input of the comparator 85, so that when the voltage on the selected floating coil becomes larger than the center tap voltage, the comparator produces an output, representing the zero voltage crossing of the voltage on the selected floating coil. (The voltage which is applied to the input to the comparator 85 is the so-called "back emf" of the coil, the voltage generated in the selected coil as it moves through the magnetic field within the motor produced by the stator of the motor.) The comparator 85 is designed to have hysteresis, because the occurrence of a voltage beyond the zero crossing voltage may not last a sufficiently long time to enable the output signal of the comparator 85 to be useful.
With further reference to FIG. 5, the output from the comparator 85 is connected to a shift register 88 through a transmission gate 89. The mask signal generated by the mask counter 111 (see FIG. 7) is applied to an enable input of the transmission gate 89 so that the output from the comparator 85 is inhibited from being applied to the shift register 88 during the mask period following a phase commutation of the sequencer circuit 13. When, however, the output signal from the comparator 85 is enabled to pass the transmission gate 89, it is applied to the D input of the first of four D-type flip flops 90, 91, 92, and 93 comprising the shift register 88.
The various outputs of the flip flops 90, 91, 92, and 93 are connected to the output logic circuit 95, which includes NAND gates 96, 97, 98, and 99. Each of the flip flops 90, 91, 92, and 93 receive a clock input, for example from the system clock, and each produces an inverted (Q(bar)) and non-inverted (Q) output. The Q outputs of flip flops 90, 91, and 92 are applied to the D input of the respective next stage flip flops, and the Q output of the last stage flip flop 93, is connected to NAND gate 98 of the output logic circuit 95.
The Q outputs of the flip flops 90 and 92 are connected to inputs of the upper NAND gates 96 and 97, respectively, while the Q outputs of the flip flops 91 and 93 are connected to the inputs of the lower NAND gates 99 and 98, respectively. On the other hand, the Q(bar) outputs of flip flops 90 and 92 are connected to inputs of the lower NAND gates 99 and 98, respectively, while the Q(bar) outputs of flip flops 91 and 93 are connected to inputs of the upper NAND gates 96 and 97, respectively.
Also, expected slope line 100 corresponding to an expected negative-to-positive going zero crossing slope is connected to inputs of NAND gates 96 and 97, and expected slope line 101 corresponding to an expected positive-to-negative going zero crossing slope is connected to inputs of NAND gates 98 and 99. The signals on lines 100 and 101 which indicate the direction of the expected zero crossing are generated from the phase information developed in the circuit of FIG. 6, which in turn, is derived from the outputs of the shift register 55 in the sequencer circuit of FIG. 4.
Finally, the outputs from the logic circuit 95 are connected to the output NAND gates 102 and 103, the outputs of which being produced in response to the detection of an actual zero crossing of a specified floating coil, the zero crossing having a transition in a specified, expected direction, i.e., either a negative-to-positive going zero crossing transition or a positive-to-negative going zero crossing transition.
The connections to the output NAND gates 102 and 103 are established with the output of the upper NAND gate 96 and the lower NAND gate 99 connected to the inputs of the output NAND gate 103, and the output of the upper NAND gate 97 and the output of the lower NAND gate 98 connected to the inputs of the output NAND gate 102. The line 101 on which a signal would appear if a positive slope zero crossing is expected is connected to the inputs of the upper NAND gates 96 and 97, and the line 100 on which a signal would appear if a negative slope zero crossing is expected is connected to the inputs of the lower NAND gates 98 and 99. Thus, the upper NAND gates 96 and 97 are responsive the actual occurrence of an expected positive slope zero crossing and the lower NAND gates 98 and 99 are responsive to the actual occurrence of an expected negative slope zero crossing.
Because of the staged connections at the four stage shift register 88 for each of the positive and negative detection paths, the outputs from the output NAND gates 102 and 103 are two non-overlapping pulses, spaced in time, as shown in FIG. 5a by the curves 109 and 108, respectively, resulting from either a positive-to-negative zero crossing 106 or a negative-to-positive zero crossing 107. Thus, the pulse generated at the output of NAND gate 103 precedes the pulse generated at the output of NAND gate 102 by one clock cycle. The output of the NAND gate 103 is used to provide a "load" signal to the counters which measure the required mask and delay time after a phase commutation as well as the deceleration counter to determine the deceleration rate. The output of the NAND gate 102 is used to provide a "reset' signal to the period counter, as below described.
The circuit for developing the switching signals for the switches 81, 82, and 83, as well as the negative and positive slope indicating signals on lines 100 and 101 is shown in FIG. 6, to which reference is now made. The circuit of FIG. 6 derives internal phase data on lines 66 from the output from the sequencer shift register 55 in FIG. 4. The lines 66 contain information respectively, from left to right indicating signals to upper and lower A, upper and lower B, and upper and lower C drive transistors (see FIG. 2). Thus, the output signal SA indicates that the coil at OUT A is expected to be floating, SB indicates the coil at OUT B is expected to be floating, and the output signal SC indicates the coil at OUT C is expected to be floating. The signals on lines 101 and 100 likewise, indicate whether the floating coil (that is, whichever may be instantaneously floating) is expected to experience a back emf zero crossing from the negative or positive direction.
In order to assist the back emf amplifier 14 and logic circuit 95 properly detect the zero crossing of the selected floating coil, it has been found necessary to mask noise generated in the operation of various circuit elements, especially noise generated by the commutation of the coils, which tend to ring, for some time after switching, and noise generated in the sequencer circuit. To accomplish this masking function, as well as deceleration rate detection and other circuit functions enabled by the method of operation of the circuit of the invention, the timing circuitry 105 of FIG. 7 is provided. The timing circuitry 105 has an up counter 110, and three down counters 111, 112, and 113. The up counter 110 serves as a period counter to provide a digital count on its output corresponding to the time between actual zero crossings of the selected floating coil, detected by the zero crossing circuitry described above with reference to FIG. 5.
The up counter 110 receives a clock signal input from a clock frequency divider 120, which divides the system clock frequency to a desired frequency. The frequency selected determines the resolution of the system. The up counter 110 is reset by the reset pulse produced by the NAND gate 102 in the circuit of FIG. 5, after the actual occurrence of a desired zero crossing has been detected. Accordingly, the up counter 110 starts to count after being reset, and continues the count until being again reset upon the detection of the next actual zero crossing.
The output of the up counter 110 is connected to the inputs of each of the down counters 111, 112, and 113, which serve mask, delay, and deceleration rate detection functions. The down counter 111 determines a mask which serves to mask the noise of the sequencer circuit 13, shown in FIG. 4, as well as the noise produced by the coils 32, 33, and 34 in response to being commutated, to produce an output on line 120 when the desired mask count has been reached. The down counter 111 is hereafter referred to as the mask counter 111. The mask counter output signal on the line 120, for example, can be used to enable the transmission gate 89 in the zero crossing detector in FIG. 5, so that no zero crossing can be detected until after the expiration of the mask period. The mask counter 111 receives a "LOAD" signal from line 121, the "LOAD" signal being produced by the output of the NAND gate 103, shown in FIG. 5, just prior to the occurrence of the RESET pulse upon the output of the NAND gate 102.
Also, the mask counter 111 receives a clock signal from a frequency divider 123. If desired, a number of select terminals 124 may be provided enable the divisor of the frequency divider 123 to be controlled to allow the resolution of the mask count to be selected for a particular application in which the driver circuit 10 will be used.
Thus, in operation, when an actual zero crossing of a selected floating coil is detected by the circuitry of FIG. 5, the count which exists in the up counter 110 is loaded into the mask counter 111. The up counter 110 is reset to begin a new period count that will continue until the occurrence of the next zero crossing, at which time, the new count will be loaded into the mask counter 111, the up counter 110 reset, and the process repeated. It can therefore be seen that the actual mask time determined by the mask counter 111 will vary, depending upon the speed of rotation of the motor. (The percentage of the number of rotational degrees, however, will remain constant.)
In a similar fashion, the down counter 112 serves to count a time corresponding to a delay after the detection of a zero crossing before the coils are switched or commutated to the next phase. The down counter 112 is referred to hereafter as the delay counter 112. The delay counter 112 receives a divided clock frequency from a frequency divider 126, the divisor of which may be selected by applying an appropriate signal to one of the select lines 127. The operation of the load and count functions are essentially the same as the operation of the mask counter 111 above described. However, it is noted that the time calculated by the delay counter 112 indicated by the output on line 122 may be substantially longer than the time calculated by the mask counter 111.
The inverted output of the delay counter 112 on the line 122 is applied to the clock input of the mask counter 111 by a NAND gate 141 to which the clock pulses from the frequency divider 123 are also applied. Thus, the signal on the line 122 inhibits the application of the clock pulses to the mask counter 111 until after the completion of the delay count by the delay counter 112. The counts of the mask counter 111 and the delay counter 112 are therefore sequential, with the mask count of the mask counter 111 following the completion of the delay count of the delay counter 112.
Because the timing circuitry 105 of FIG. 7 operates on the actual, not expected, zero crossing signals of the floating rotor coils, it enables many motor control functions which have been heretofore not possible to achieve. For example, the rotor commutation can be based upon a delay calculated after an actual zero crossing of an anticipated floating coil occurs. Thus, for example, the output of the delay counter 112 on the output line 122 is used to initiate a coil commutation. Then, since the mask counter 111 is also dependent upon the delay counter output signal to begin its count, the switching noise from the sequencer circuit 13 and switching transients produced by the coils can be masked, so that spurious zero crossings caused by switching noise will not be interpreted as an actual zero crossing of the selected floating coil.
In addition, the deceleration rate of the motor can be detected, and if desired, compared with a particular profile or threshold. To accomplish this function, an additional down counter 113 mentioned is provided. The down counter 113 is referred to hereafter as the deceleration counter 113. The deceleration counter 113 is connected in the timing circuit 105 in a similar manner as that of the mask counter 111 and delay counter 112. The deceleration counter 113 receives a clock signal divided in frequency from the system clock frequency by a frequency divider 128. If desired, select input lines 129 may be provided to allow the frequency divisor to be selected for particular motor driver applications. By appropriately selecting the clock frequency applied to the deceleration counter 113 so that the down count will be longer than the time between actual zero crossings of the commutated floating coils, if the output signal on line 130 changes states, indicating that the deceleration counter 113 has completed its count, the signal can be used as in indication that the motor is slowing down. That is, the appearance of a signal on the output line 130 indicates that the period counted is greater than the previous period which was loaded into the counter, indicating that the motor is slowing down.
NAND gates 133, 134, 135, and 136 are provided for the respective counters 110, 111, 112, and 113 by which the outputs of the respective counters are combined, to provide an output which is combined with the respective clock signals by NAND gates 140, 141, 142, and 143. Thus, the count of any of the counters 110, 111, 112, or 113 is allowed only to reach its maximum up or down count, and its count is stopped so that the counter will not recycle and begin a new count.
The operation of the circuit 10 will now be described, with reference to the waveforms which are developed in the various parts of the circuit, as shown in FIG. 8. The rotational degree index curves 160 for each coil are shown across the top of the waveforms for reference. Each sinusoidal waveform is labeled to correspond to the node to which each of the coils is connected: coil 32 - A, coil 33 - B, and coil 34 - C. Beneath the rotational degree curves 160 is the corresponding commutation sequence which occurs at the specified rotational position.
The next three curves 164, 165, and 166 show the voltages of the respective driven coils A, B, and C. It can be seen that for one electrical cycle, indicated at the bottom of the curves of FIG. 8, each coil will have two sequences in which it has positive voltage, two sequences in which it has negative voltage, and two sequences during which it floats. For example, referring to the curves representing the voltage on coil A, the first two voltages 170 and 171 of sequences 1 and 2 during which current flows respectively from coil A to coil B, and from coil A to coil C, are positive. During the time coil A floats in sequence 3 the voltage 173 changes from positive to negative. The next two voltages 174 and 175 of sequences 4 and 5 during which current flows respectively from coil B to coil A, and from coil C to coil A, are negative. Finally, when coil A again floats during sequence 6, the voltage 176 changes from negative to positive. The other coils B and C have similar voltage curves, each displaced 120.degree. from each other.
It can be seen that each coil floats twice during one electrical cycle, and has two zero crossings; however, one zero crossing has a negative slope, from positive to negative, and the other has a positive slope, from negative to positive. Thus, an ambiguity would exist if the rotor position were to be determined solely on the basis of a zero crossing without regard to the direction of the crossing. (This was one of the shortcomings of previous motor driver systems.) Thus, when the voltage, for example, of coil A transitions from positive to negative, shown by curve 173, a zero crossing 180 is detected by the zero crossing circuit 80, shown in FIG. 5. Moreover, the direction of the crossing also is detected by the slope detecting circuitry 95, also shown in FIG. 5. Once the zero crossing has been detected, the sequences is incremented, commutating the coils, the timing circuit 105 of FIG. 7 is reset and reloaded, as above described. The zero crossing detector then begins to look for the zero crossing of the next floating coil; in this case of coil C, which will be transitioning from negative to positive, as can be seen from the curve 182 in FIG. 8. After its zero crossing is detected and commutation performed, the positive to negative zero crossing of floating coil B, shown by the curve 183 is sought, and so forth.
In summary, the commutation sequence is as follows: the sequencer circuit establishes a desired rotor phase, and the zero crossing detector detects the occurrence by finding the proper zero crossing. When the zero crossing is detected, first a delay mask is generated by the delay counter 112, then the rotor coils are commutated, and a second mask is generated by the mask counter 111. The correct floating coil is determined by the phase information being generated from the output signals of the shift register 55, and the phase information connects the proper coil to the back emf amplifier 85 by closing the proper switch 81, 82, or 83.
By creating the delay between the zero crossing and incrementing to the next phase, the torque ripple can be optimized, thereby taking advantage of the inertia of the rotor.
It can be seen that throughout the process, two key elements exist: 1) the anticipated zero crossing is first established and 2) the actual zero crossing detected which corresponds to the previously established anticipated zero crossing. If the actual zero crossing is not detected, no commutation occurs until the zero crossing is in fact detected. Thus, the sequencer 13 is always synchronized to the actual motor position, even if the drive signals to the motor are removed.
Finally, the mask signal 190 which would be produced on the line 120 of the mask circuit of FIG. 7 is shown in the bottom curves of FIG. 8. The mask curve has two portions, for example 191 and 192, corresponding to the mask times of the delay counter 112 and the mask counter 111, respectively.
With reference again to FIG. 7, the timing circuitry 105 incorporates a deceleration rate detection circuitry, according to the invention. The reset signal on the line 200 generated by the circuit of FIG. 5 in response to a zero crossing resets the period counter 110 to all "zeros."
Clock pulses from the system clock 23 (See FIG. 1) on the line 201 are applied to a frequency divider 120 for delivery on a line 202 to the period counter 110. The frequency of the clock pulses on the line 202 from the frequency divider 120 is f.sub.clk, having a period, .tau..sub.clk. After the reset signal resets the period counter 110 to all zeros, it counts up. Every binary count of the period counter corresponds to one period of the clock frequency. Thus, at any interval of time, the binary bus 204 will contain a series of bits, which, when multiplied by the period of the clock, .tau..sub.clk, represents the total time duration between the last reset of the period counter 110 and the time when the binary number on the bus 13 is observed.
The output from the period counter 110 delivered on the bus 204 is applied to a deceleration counter 113. The deceleration counter 113 is a down counter and receives clock pulses on a line 208 from the system clock appearing on line 201, divided by a frequency divider 128. The clock pulses on the line 208 have a frequency, f.sub.dec, with a period, .tau..sub.dec. Additionally, the deceleration counter 113 has a "load" terminal that receives from line 121 load pulses that are derived in a response to a zero crossing by the circuit shown in FIG. 5 just prior to the reset pulse on the line 200 to the period counter 110. The load and reset pulse relationship is shown by the graphs at the bottom of FIG. 9, and shown in FIG. 5a.
It should be noted that to detect the deceleration of the rotor of the motor, the clock frequency, f.sub.clk, applied on line 202 to the period counter 110 is larger than the frequency, f.sub.dec, applied to the deceleration counter 113 on the line 208. (On the other hand, if acceleration rate is desired to be detected, the deceleration frequency on line 208 can be made larger than the frequency of the clock applied to the period counter 110 on line 202.)
The operation of the circuit is explained using the wave forms shown in FIG. 9. A first zero crossing, ZC1, is represented by a vertical line 210. The zero crossing ZC1 relates to the position of the rotor of the motor with which the circuit is associated, as described above. When the zero crossing ZC1 occurs, a "load" pulse 211 and "reset" pulse 212 are generated by the circuit of FIG. 5. The reset pulse 212 resets the period counter 110 to all zeros.
Initially, the contents of the period counter are not of concern (or are "don't care") as indicated by the "X" 220. From this point, the period counter 110 is reset to count upward, shown by the stair-step line 221. At the next zero crossing 224, ZC2, the period counter 110 reaches a certain count. This count multiplied by the period .tau..sub.clk of clock of the clock frequency, equals the actual time taken for the period counter 100 to count to the next occurring zero crossing 224, ZC2.
The count in the period counter 110 that exists upon the occurrence of the second zero crossing 224, ZC2, represents the time from the first zero crossing 210, ZC1. This count is loaded into the deceleration counter 113 upon the occurrence of the load pulse 215. Immediately after that, the count within the period counter 110 is again reset to all zeros upon the occurrence of the reset pulse 225 in preparation of the next zero crossing measurement. The period counter 110 then begins its upward count again, as illustrated by the stair step line 226. On the other hand, the deceleration counter begins a downward count at the rate determined by the frequency, f.sub.dec, of the deceleration counter clock on line 208, shown by the dotted stair-step line 227.
If the time between successive zero crossings ZC1 and ZC2 increases, as illustrated, depending upon the frequency of the clock pulses applied to the deceleration counter 113 on the line 208, the count contained within the deceleration counter 113 will reach zero, to show that the deceleration rate exceeds the predetermined threshold. On the other hand, if the count in the deceleration counter 113 had not reached zero, because the predetermined threshold has not been exceeded, no fault is indicated. The process may then be repeated and a new deceleration count initiated upon the occurrence of the next load pulse 228.
To detect that the deceleration counter 113 has reached the threshold count, the output on the bus 230 from the deceleration counter 113 is connected to a NOR gate 136. The output from the NOR gate 136 is connected to a D-type-flip-flop 231, the Q output of which being usable for initiating a desired fault warning. The D-type-flip-flop 231 is clocked on a rising edge of the load pulse on the line 212, prior to the occurrence of a reset pulse. Thus, the D-type-flip-flop 231 is enabled to produce its output, if any, before the deceleration counter 113 is loaded with the count of the period counter 110 representing the count of the next succeeding zero crossing time.
As mentioned, the deceleration rate threshold can be adjusted by determining the ratio between the frequencies of the period counter clock on line 202 and the deceleration counter clock on line 208. By adjusting the count down rate performed by the deceleration counter pulses on line 208, a time at which the deceleration counter 113 reaches zero can be controlled.
It should be noted that the zero crossing is an asynchronous signal, in comparison to the frequencies of the clocks applied to the period counter 110 and deceleration counter 113. The zero crossing signal occurs when the motor is at particular physical locations, which depend upon the speed of the motor and other factors. The zero crossings, therefore, are unrelated to the frequencies of the clocks.
Also, it should be appreciated that the measurement of the deceleration rate is essentially independent of the particular speed of the motor. This is because at each zero crossing a new count is loaded into the deceleration counter 113, representing the time between the preceding and next preceding zero crossings. Thus, the technique according to the invention is independent of the speed at which the motor may be operating.
Additionally, as explained, the deceleration rate threshold can be adjusted, as desired, by adjusting the ratios of the clock frequencies of the clock to the period counter and the deceleration counter.
Although the invention has been described and illustrated with a certain degree of particularity, it is understood that the present disclosure has been made by way of example only, and that numerous changes in the combination and arrangements of parts and features can be made by those skilled in the art without departing from the spirit and scope of the invention, as hereinafter claimed.
Claims
I claim:
1. A circuit for determining if a deceleration rate of a polyphase de motor having a plurality of driving coils and a moving rotor exceeds a predetermined threshold, comprising: a back emf detector to selectively produce a back emf signal from said driving coils when said driving coils are sequentially switched into a floating state; a reference voltage crossing detector to determine when said back emf signal produced by said back emf detector crosses a reference voltage; a pulse generator for producing first and second non-overlapping pulses when said reference voltage crossing detector determines that said back emf has crossed the reference voltage, said second pulse occurring after said first pulse; an up counter connected to be reset by the second pulse produced by said pulse generator; a down counter connected to be loaded with the count existent in said up counter by said first pulse from said pulse generator; first and second clock pulse sources, the frequency of the first clock pulses being less than the frequency of said second clock pulses, the first and second clock pulses being delivered respectively to said up and down counters to be counted thereby; a circuit connected to said down counter to determine if the down counter has reached a predetermined count prior to the occurrence of another reference voltage crossing subsequent to the reference voltage crossing that loaded the count of said up counter into said down counter.
2. The circuit of claim 1 wherein said predetermined count of said down counter is zero.
3. The circuit of claim 1 wherein said reference voltage crossing detector determines when said back emf signal produced by said back emf detector crosses zero volts.
4. The circuit of claim 1 wherein said circuit to determine if the down counter has reached a predetermined count comprises a first gate to which an output of said down counter is applied to determine whether said down counter has reached the predetermined count.
5. The circuit of claim 4 wherein said first gate is connected to determine when the output of said down counter has reached zero.
6. The circuit of claim 5 further comprising a second gate connected to disable the count of said down counter when said first gate determined whether said down counter has reached the predetermined count.
7. The circuit of claim 1 wherein said another reference voltage crossing subsequent to the reference voltage crossing that loaded the count of said up counter into said down counter is a next occurring reference voltage crossing.
8. The circuit of claim 1 wherein said polyphase dc motor is a three phase dc brushless, sensorless motor.
9. The circuit of claim 1 further comprising a second down counter connected to be loaded with the count existent in said up counter by said first pulse from said pulse generator, and circuitry responsive to said second down counter reaching another predetermined count for sequentially switching said driving coils.
10. A method for determining if a deceleration rate of a polyphase dc motor having a plurality of driving coils and a moving rotor exceeds a predetermined threshold, comprising: measuring a first period between a first set of reference voltage crossings of the back emf of floating ones of said driving coils; measuring a second period between a second set of reference voltage crossings of the back emf of floating ones of said driving coils; comparing the measurement of the first period with a second subsequent period; and producing a warning signal if the second period is larger than said first period by a predetermined amount.
11. The method of claim 10 wherein said steps of measuring said first period comprises measuring a time between zero crossings of said first set of reference voltage crossings.
12. The method of claim 1 wherein said step of measuring the first period comprises counting up from zero at a first predetermined rate from a first reference voltage crossing until a second reference voltage crossing occurs; wherein said step of comparing the measurement of the first period with the second period comprises counting down at a second predetermined rate slower than said first predetermined rate from a count reached in said up count when said second reference voltage crossing occurred; and wherein said step of producing a warning signal comprises producing a warning signal if said down count reaches a predetermined count before a third reference voltage crossing occurs.
13. The method of claim 12 wherein said step of producing a warning signal comprises producing a warning signal if said down count reaches zero before the third reference voltage crossing occurs.
14. A circuit for determining if a deceleration rate of a polyphase dc motor having a plurality of driving coils and a moving rotor exceeds a predetermined threshold, comprising: a back emf detector to selectively produce back emf signals from said driving coils when said driving coils are sequentially switched into floating states; a reference voltage crossing detector to determine when said back emf signals produced by said back emf detector cross a reference voltage; a pulse generator for producing first and second non-overlapping pulses when said reference voltage crossing detector determines that said back emf has crossed the reference voltage, said second pulse occurring after said first pulse; a first counter connected to be reset by the second pulse produced by said pulse generator; a second counter connected to be loaded with the count existent in said up counter by said first pulse from said pulse generator; first and second clock pulse sources, the frequency of the first clock pulses being less than the frequency of said second clock pulses, the first and second clock pulses being delivered respectively to said first and second counters to be counted thereby; a circuit connected to said second counter to determine if the second counter has reached a predetermined count prior to the occurrence of another reference voltage crossing subsequent to the reference voltage crossing that loaded the count of said first counter into said second counter.
15. The circuit of claim 14 wherein said second counter is a down counter and said predetermined count of said second counter is zero.
16. The circuit of claim 14 wherein said reference voltage crossing detector determines when said back emf signal produced by said back emf detector crosses zero volts.
17. The circuit of claim 14 wherein said circuit to determine if the second counter has reached a predetermined count comprises a first gate to which an output of said second counter is applied to determine whether said second counter has reached the predetermined count.
18. The circuit of claim 17 wherein said first gate is connected to determine when the output of said second counter has reached zero.
19. The circuit of claim 18 further comprising a second gate connected to disable the count of said second counter when said first gate determined whether said second counter has reached the predetermined count.
20. The circuit of claim 14 wherein said another reference voltage crossing subsequent to the reference voltage crossing that loaded the count of said up counter into said down counter is a next occurring reference voltage crossing.
21. The circuit of claim 14 wherein said polyphase dc motor is a three phase dc brushless, sensorless motor.
22. The circuit of claim 15 further comprising a second down counter connected to be loaded with the count existent in said first counter by said first pulse from said pulse generator, and circuitry responsive to said second down counter reaching another predetermined count for sequentially switching said driving coils.