You are on page 1of 20

USOO591.

2541A
United States Patent (19) 11 Patent Number: 5,912,541
Bigler et al. (45) Date of Patent: Jun. 15, 1999
54 INTEGRATED DC SERVO MOTOR AND 5,311,400 5/1994 Fuchs et al. .............................. 439/44
CONTROLLER 5,321,585 6/1994 Trittschchuh, III et al. 361/784
5,327,064 7/1994 Arakawa et al. ........... 318/801
76 Inventors: Robert A. Bigler; Punita Pandit E. E. E. "35.
Bigler, both of 11230 Bubb Rd., 5.455.734 10/1995 Foreman et al... 318/118
Cupertino, Calif. 95014 5,504,940 4/1996 Hahs, Jr. et al. ... ... 455/38.1
5.532,533 7/1996 Mizutani ......... ... 310/68 B
21 Appl No 08/754 182 5,618,188 4/1997 Gilmore et al. -- --- ------- --- --- ------- - 439/91
y - - - 9

22 Filed: Nov.a 22,


149
1996 FOREIGN PATENT DOCUMENTS
4120665A1 12/1992 Germany.
Related U.S. Application Data 60-102839 6/1985 Japan.
2-211039 8/1990 Japan.
63 abandoned.
Continuation of application No. 08/347,807, Nov.30, 1994, OTHER PUBLICATIONS
(51) Int. Cl. .................................................. H02P 5/06 Product Brochure of Forcam, Inc., "Smart Motor Position
52 U.S. Cl. ........................... 318/600; 318/538; 318/625 ing Systems: Computerize the Setup of Your Machines",
58 Field of Search ..................................... 318/565,685, 1994.
318/616, 634, 640, 538, 254, 138, 439, Primary Examiner Bentsu Ro
600, 625; 310/47, 50, 42, 67 R, 68 R, 68 B, Attorney, Agent, or Firm Thomas Schenck; Mark Protsik
58; 439/44, 631
57 ABSTRACT
56) References Cited
An integrated motion control device having a controller
U.S. PATENT DOCUMENTS mated to a motor body with a Set of rigid, electrically
conductive Signal pins. The motor is direct-current and
R 7. 88: R al.". : preferably brushless, and has Hall sensors within the motor
3.809.935 5/1974 Kristen et al... 310/68 body and an encoder at a back end for precisely determining
4,060,310 11/1977 Brown ............... ... 160/310 rotor position. Signals from the Hall Sensors and encoder are
4,160,200 7/1979 Imamura et al. ... 318/616 fed to a microprocessor contained in the controller and
4,501,460 2/1985 Sisler ............ ... 339/49 R including a PID filter for servo control of the motor. The
4,517,481 5/1985 Breining .................................... 310/71 controller contains an amplifier for driving the motor and a
4,779,031 10/1988 Arends et al. ... 318/565 power Supply for providing appropriate levels of DC power
4,788,658 11/1988 Hanebuth ...... ... 364/900 to various elements of the controller and motor. All electrical
4,947,071 8/1990 Clarke ....... ... 318/254 Signals between the motor and controller are transmitted via
4,988.905 1/1991 Tolmie, Jr. ............................ 310/68 B the pins, eliminating wiring harnesses of the prior art and
5,006,703 4/1991 Shikunami et al. ... 250/231.13
5,006,744 4/1991 Archer et al. ............................. 310/89 related Signal noise and wiring problems. The motor body
5,038,088 8/1991 Arends et al. ... 318/565 and controller are affixed with a few Screws, allowing the
5,070,289 12/1991 Pona et al. ... ... 318/640 controller to be removed from the motor while the motor
5,107,387 4/1992 Orton ........................................ 361/33 remains connected to an application. Communication ports
5,136,452 8/1992 Orton ........................................ 361/33 are provided at a rear of the controller for connection to a
5,159,218 10/1992 Murry et al... 310/68 B computer or peripheral devices, and can be used to daisy
5,160,925 11/1992 Dailey et al. . 340/853.3 chain and Synchronize a number of interconnected motors
5,170,851 12/1992 Kress et al. ............................... 310/47 and controllers.
5,237.540 8/1993 Malone ..................................... 367/81
5,249,161 9/1993 Jones et al. ............................... 367/83
5,287,028 2/1994 Suzuki et al. ............................. 310/71 35 Claims, 3 Drawing Sheets

40 MOTOR

SENSOR

ENCODER
47
49
MICRO
PROCESSOR

POWER
SUPPLY

UNIVERSAL
- AMPLIFIER
58
62 60
U.S. Patent Jun. 15, 1999 Sheet 1 of 3 5,912,541

44 42

40 MOTOR

SENSOR

47 ENCODER

49 PID
MICRO FIG. 1
PROCESSOR

POWER
SUPPLY

UNIVERSAL
AMPLIFIER

62
U.S. Patent Jun. 15, 1999 Sheet 2 of 3 5,912,541
U.S. Patent Jun. 15, 1999 Sheet 3 of 3 5,912,541

FIG. 7 (PRIOR ART)


5,912,541
1 2
INTEGRATED DC SERVO MOTOR AND motor phases. The web or harness of wiring shown in this
CONTROLLER figure may be difficult to correctly connect and noise from
high current wires powering the motor may disrupt Sensitive
This application is a continuation of application Ser. No. Signals in nearby wires used for Servo control.
08/347,807 filed on Nov. 30, 1994, now abandoned. 5 It is an object of the present invention to provide a simple
and reliable Servo motor having improved precision of
TECHNICAL FIELD motion due to improved mechanical and electrical connec
tion between the motor and controller.
This invention relates generally to the field of DC motors
and controls for Such motorS. SUMMARY OF THE INVENTION
1O
BACKGROUND ART
The above object is accomplished with a controller that is
mated to a DC motor with a set of rigid, electrically
DC motors are well known and used in a wide variety of conductive pins protruding from a back end of the motor.
functions and industries. In general, Such motorS utilize a Both the motor and the controller are modular, providing for
changing magnetic field that causes an inner shaft or rotor to ease of interchange or replacement of either the motor or
rotate relative to an outer body or Stator, which is usually
15 controller. The pins provide mechanical as well as electrical
connection between the motor and controller. Electrical
fixed. Typically, the rotor is permanently magnetized, while connection of the pins to the controller allows communica
a Series of poles encircles the rotor, the poles wound with tion of power and control Signals for the motor from the
wire or “windings' So as to create a magnetic field when controller, and communication of data regarding measured
current flows in the wire. Current is Supplied to the windings positions of the motor for the controller.
to create a magnetic field near the poles that attracts or repels The motor may employ brushes, although in a preferred
the rotor, causing the rotor to revolve. embodiment it is brushless, as a brushleSS motor provides
To better control the motion of the rotor, information improved heat dissipation from the coils of a Stationary,
regarding actual or measured parameters of the motion can exterior housing rather than the coils of a rotating armature
be used to vary the input current in order to approach or 25 found with brushes. A rotor protrudes from a front end of the
achieve desired motion values. Such a Servo control System motor, while mounted on a back end of the motor is an
may employ a microprocessor, power Supply and amplifiers optical encoder for measuring incremental positioning of a
for controlling the current to the windings, position or rotor relative to the motor housing. The encoder has leads
motion detectors for determining the actual position or which, like the pins, extend from the back end of the motor
motion of the rotor, and wires for relaying Signals between to fit into matching connections in the controller. The motor
the controller, amplifiers, windings, detectors and power includes Hall Sensors for determining local magnetic fields
Supply. For Some applications it is desirable to have a motor within the motor for absolute position measurement of the
rOtOr.
in close proximity to a controller.
For example, in U.S. Pat. Nos. 5,107,387 and 5,136,452, Unlike typical servo motors, the motor of the present
Orton discloses a radio controlled model race car having a 35
invention can remain connected with an application while
controller coupled to a DC motor used to drive the car, and the controller is removed for adjustment or replacement.
various fuse and circuitry devices for connecting the motor Aside from the pins, the motor and controller are held
together with three screws which can be easily removed. The
and controller and for braking the motor. U.S. Pat. No. controller is of the same diameter as the motor, and in a
5,237,540, to Malone teaches a brushless DC motor used for preferred embodiment extends about as far as an encoder of
drilling having an encoder coupled to the motor for Sensing 40 the prior art, allowing use in tight Spots that are increasingly
a position of the motor. Similarly, U.S. Pat. No. 5,249,161 to common in modern motion control applications.
Jones et al. dis-closes a borehole driller having means for The controller includes a microprocessor with a servo
determining whether an encoder and position Sensor amplifier for driving the motor and a proportional integral
attached to the motor is jammed. In U.S. Pat. No. 5,159,218, derivative (PID) filter for controlling the motor based upon
Murry et al. teach a solid state controller mounted directly 45 feedback from the motor. The controller has a communica
to a brushleSS DC motor for pumping fluids in environments tions port that may be accessed by an RS232 plug from a
which may be encountered during Space missions. personal computer. Two or more controllers can be linked
Having a controller close to a motor may still require together via their communication ports to provide multi-axis
extensive interwiring. As shown in FIG. 7, a typical servo motion with the controllers and their connected motors
motor control system has a motor 20 with an encoder 22 50 Synchronized. A peripheral device port located adjacent to
attached to the motor for determining the position of the the communications port on a back end of the controller
motor 20. A servo controller 25 and an amplifier 27 are affords connections for devices Such as a flat panel display,
Separated from the motor 20 and encoder 22, but connected which may be mounted on the controller and display infor
by a multiplicity of wires. The servo controller 25 is supplied mation regarding the motor or controller, or joystick for
with power and ground wires 30, and the servo controller 25 55 controlling the motor.
is wired to a host via Separate transmit and receive wires as The modular, mated combination of motor and controller
well as a ground 32. The amplifier 27 is separately Supplied reduces wiring and electronic connections, offering Space
with power and ground wires 33, and has a number of Savings and improved reliability. The reduction in wiring
potentiometers 28 for adjusting the amplifier 27. The servo benefits the accuracy of motor control by reducing Signal
control 25 and the amplifier 27 are connected with a set of 60 interference in critical drive and Servo control functions.
wires 35 including those for a command Signal, a shutdown Space Savings and convenience also result from the compact
Signal, an error Signal and ground. Wire connections 37 Structure and lack of electronic components that require
between the encoder 22 and the servo controller 25 include mounting and interconnection.
power and ground and Six Signal wires. Wires 39 connecting BRIEF DESCRIPTION OF THE DRAWINGS
between the motor 20 and the amplifier 27 include a power 65
and a ground wire for a Hall Sensor in the motor 20, a pair FIG. 1 is a plan view of a combined motor body and
of Hall sensor signal wires, and individual wires for three controller of the present invention.
5,912,541
3 4
FIG. 2A is a side view of the motor body of FIG. 1. optimal motor body 40 Size is designed to accommodate
FIG. 2B is a rear view of the motor body of FIG. 1. standard NEMA23 frame dimensions and tolerances, allow
FIG. 3 is a cross-sectional view of the motor body of FIG. ing retrofit of existing 23 size Stepper motors. For this size,
2A and 2B. the pins 65 have a length L of approximately 0.5 in. and a
croSS-Sectional area of 0.025 Square inches. The rows of pins
FIG. 4A is a front view of the controller of FIG. 1 with a 65 are spaced about 1.5 inch from each other on opposite
mounting flange attached at the rear end. sides of the rotor tail 63, each row having 6 pins with centers
FIG. 4B is a rear view of the controller and flange of FIG. Spaced apart by about 0.1 inch.
4A. A first pin 80 provides 5 volts DC power to the motor 45
FIG. 5 is a side view of the combined motor and controller from the controller 49, while a second pin 82 provides a
of FIG. 1. return path for that power. A third pin 84 offers a ground
FIG. 6 is a plan View of a computer connected to a connection for the body 40. The other three pins 85, 86, and
mounted motor and controller of FIG. 1. 87 in that row are connections for three Hall sensors, not
shown, that provide Signals to the controller 49 regarding the
FIG. 7 is a plan view of a prior art motion control device. 15 magnetic field within the motor 45, measured by transverse
BEST MODE FOR CARRYING OUT THE electrical current, thereby measuring a general position of
INVENTION the rotor 42. The six pins 65 in the opposite row, labeled 91,
92,93, 94, 95 and 96 provide power to a set of six windings,
Referring now to FIG. 1, a motor body 40 is shown with which encircle the rotor 42 within the motor 45, providing
a rotor 42 protruding from a front end 44 of the body 40. changing magnetic fields to power the rotor 42.
Within the body 40 is a motor 45 and a Hall sensor 56. At FIG. 3 shows a simplified axial view of a portion of the
a back end 47 of the motor body 40 is an encoder 48. A motor body 40 containing the motor 45 with a stator 98
controller 59 adjoins the back end 47 of the body 40. The outside and the rotor 42 at the center. The rotor 42 is attached
controller 49 houses a microprocessor 50 including a pro to a cylindrical permanent magnet 100 having a diameter
portional integral derivative (PID) filter 53. The controller 25 larger than that of the rotor 42 and opposed north (N) and
49 also contains a power supply 55 and a universal amplifier south (S) poles. Six windings, labeled 102, 104, 106, 108,
58. Direct current (DC) power of 18 to 48 volts is provided 110, and 122 surround the permanent magnet 100, with
to the controller 49 through a power input 60, and RS-232 adjacent windings being oppositely wound and thus produc
or other formatted signals are provided to the controller 49 ing oppositely directed magnetic fields when Supplied with
via a communications port 62. electrical current. The windings are connected as pairs So
The power input 60 is connected to the power supply 55 that current flows through a pair of adjacent windings
and the amplifier 58. The power Supply 55 stores power and Simultaneously to provide a torque to the magnet 100 and
provides various levels of DC power as needed to different thereby turn the rotor 42. For example, pins 91 and 92 (FIG.
elements of the controller 49, including the microprocessor 2B) provide and drain current from windings 102 and 104,
50 and the amplifier 58. Signals input to the microprocessor 35 respectively. Winding 102 is oriented so that current pro
50 via the communications port 62 are used to run the motor vided by from pin 91 creates a magnetic field having a north
45 by controlling the current supplied to the motor from the pole directed toward the rotor 42 and a South pole directed
amplifier 58. A position of the motor 45 is measured by the away from the rotor 42. Current from winding 102 flows to
Sensor 46 and encoder 48 and information regarding this winding 104 by a wire, not shown, and drains from winding
position is sent to the microprocessor 50 for servo control of 40 104 through pin 92. Winding 104 is oriented so that this
the motor 45. current creates a magnetic field with a South pole directed
FIGS. 2A and 2B show some elements of the motor body toward the rotor 42. With the north pole (N) of the magnet
40 that connect with the controller 49. The body 40 is 100 oriented as shown in FIG. 3, the just described current
generally cylindrical, with the axially disposed rotor 42 in windings 102 and 104 produces a torque T that tends to
protruding from the front end 44 and a rotor tail 63 extend 45 cause magnet 100 and rotor 42 to rotate in a clockwise
ing from the back end 47. A set of rigid, electrically direction.
conductive, stainless steel pins 65 protrude from the back After the magnet 100 and rotor 42 have rotated clockwise
end 47 adjacent to the rotor tail 63. The pins 65 are grouped around a third of a revolution another pair of windings, 106
in a parallel pair of rows that are vertically oriented and and 108 are provided current in a similar manner through
centered horizontally beside the rotor tail 63. An encoder 67 50 pins 93 and 94, creating magnetic fields that provide further
is disposed adjacently below the rotor tail 63, and has a torque for rotation in the clockwise direction. Windings 110
series of electrical leads 70 that extend away from the back and 112 are activated similarly by current through pins 95
end 47 in a direction substantially parallel to the rotor tail 63 and 96 to provide further torque for further acceleration of
and the pins 65. The encoder 67 directs light at the rotor tail rotation. The direction of torque is reversible simply by
63, which is marked to reflect light from certain spots and 55 Supplying current in an opposite direction through the pairs
not from others, and the encoder 67 detects reflected light of windings while the north pole (N) is adjacent to those
from the tail 63 in order to determine an incremental position windings, or alternatively, by Supplying current in the origi
of the rotor 42. Data regarding this position is Sent to the nal direction while the south pole (S) is adjacent to the
controller 49, shown in FIG. 1, via the leads 70. Three windings Supplied with current. Thus it is important to know
tapped screw holes 72 are located near a perimeter 74 of the 60 the position of the magnet 100 at any time in order to provide
back end 47 for affixing the controller 49 to the motor body torque impelling the rotor 42 in one direction or another.
40. An annular recess 76 is disposed at the perimeter 74 for Disposed between each pair of windings are Hall Sensors
axial alignment of the controller 49. 114, 116, 118, 120, 122 and 124. The Hall sensors are
In the preferred embodiment, the motor body 40 has a transistors that transmit a current in response to an ambient
length L. that lies within a range of between 1 inch and 65 magnetic field of a particular orientation, and are employed
Several inches, optimally about 2 inches, and a similar to detect the position of the magnet 100. oppositely disposed
outside diameter D, optimally about 2.25 inches. The Hall sensors 114 and 120, 116 and 122, and 118 and 124
5,912,541
S 6
have Signals that are compared by comparators for deter 177 is connected through a hole in the Support, to the RS-232
mining a general position of the magnet 100 and rotor 42. port 154 of the controller, and also connected to a personal
The encoder 48 can determine two thousand incremental computer 180. Information regarding parameters of the
positions of the rotor 42, and the information from the Hall motion of the rotor 42 can be displayed on a terminal 182
sensors 114, 116, 118, 120, 122 and 124 and the data from connected to the computer 180. A keyboard 184 is used to
the encoder 48 are fed to the microprocessor 50, which input desired motion parameters into the computer 180
calculates the position and velocity of the rotor 42. The which inputs data into the controller 49 to precisely control
microprocessor 50 includes a proportional integral deriva the rotor 42. There is a large amount of information that a
tive (PID) filter 53 which receives information from the controller 49 can volunteer to a host computer 180 or
encoder 48 to servo control the rotor 42. The PID filter has peripheral display, not shown. This information includes an
a Service rate of 5 kHz, providing extreme accuracy in Servo actual position, Velocity, encoder error and motor Status,
control. which is sent over the cable 177 as a byte of information.
Referring now to FIGS. 4A and 4B, front and rear views The position, Velocity or acceleration of the rotor 42 can
of the controller 49 show a square flange 128 which is be programmed into the controller 49 with up to 32 bits of
attached to a rear end 132 of the controller 49, the flange 128 15
precision in any of those parameters, yielding extremely fine
having bolt holes 130 near its corners to allow mounting of resolution. Numeric resolution doubles with each additional
the controller 49 to a work Surface, not shown. A front end bit. Thus a 32 bit quantity does not have twice the resolution
134 of the controller 49 has 12 pin holes 136 configured in of a 16 bit quantity, but instead has 65,536 times that
a parallel pair of rows, the pinholes 136 mating with the pins resolution. AS an example, when photographying a distant
65 of the motor body 40. Another row of sockets 138 mates Star by opening a shutter of a telescope camera that is Set to
with the pins 70 from the encoder 67. The front end 134 has rotate as the earth rotates, resolution becomes very impor
a recess 140 to allow for the extension of the rotor tail 63 and tant. If an astronomer calculates that a rotation of
the encoder 67 from the back end of the motor body 40. A 0.00294785 rpm is needed for this purpose and a 16 bit
triad of apertures 142 allows passage of screws 144 from the resolution control System chops off the last 3 digits, the
rear end 132 to the Screw holes 72, for attachment of the picture that results will be a dash, not a dot. With a 32 bit
controller 49 to the motor body 40. The controller 49 can be 25 System, in between each velocity at which a 16 bit System
removed from the motor body 40 by simply unscrewing could track are 65,536 more velocities to choose from.
these screws 144 and pulling the pins 65 and 70 free, This extreme resolution allows for very accurate linear
allowing the motor body 40 to remain attached to an interpolation of many cascaded integrated motorS 45 and
application while the controller is removed for repair or controllers 49. It is essential in this case to assure that all the
replacement. rotors 42 start at the same time. Millisecond delays of
The rear end 132 of the controller 49 contains a number RS-232 can degrade Synchronization, and are averted by
of electrical ports providing power and communication to first inputting commands for the chain of motors 45 into the
the controller 49. DC power of from 5 to 18 volts is provided microprocessors 49 and then using internal timers of the
to power socket 150 and drained from power socket 152. A microprocessors 49 and Synchronization pins to initiate
set of sockets 154 compatible with RS-232 or other com 35 motion of each of the rotors 42 Simultaneously.
puter communication cabling provides capability to program Language used to input desired motion parameters to a
or change Settings of the controller 49 via a personal motor 45 and controller 49 follows common sense termi
computer or other compatible device. These sockets 154 also nology. Thus the letter “P” stands for position, “V” for
allow interconnection between a plurality of controllers 49 Velocity, and “A” for acceleration. Data is digitally trans
and attached motor bodies 40 to perform coordinated tasks. 40 ferred and maintained, eliminating errors inherent in analog
Asynchronization pin located within each controller 49, not Systems, and eliminating adjustment of potentiometers 28
shown, allows a plurality of controllers 49 and their asso shown in the prior art of FIG. 7. When a command is
ciated motors 45 to be perfectly synchronized despite the intended to transfer data, that data follows the command as
small delays inherent in RS-232. Interconnected motor ASCII characters like “P3000' to set a target absolute
bodies 49 can be held by their associated controllers 49 by 45 position of 3000 encoder counts. If several motors are
mounting on a work piece, not shown, So that their rotorS 42 cascaded, this letter command is preceded by the address of
are oriented in different directions or along different axes to the particular motor being contacted. There are four modes
provide precisely controlled quantities of motion in any that a motor 45 can operate in: Absolute Position, Relative
direction. A left limit port 156 provides control of motion of Position, Velociy and Torque. A current “I” command limits
the rotor in a clockwise direction while a right limit port 158 50 the current available to the motor in 1000 increments up to
Sets a limit on motion in a counterclockwise direction. A a peak current of 12.5 amps.
peripheral port 160 provides the opportunity to link periph The benefits of the mated, modular controller 49 and
eral devices Such as joysticks, mice, displayS or push-wheel motor body 40 are numerous. Complete elimination of the
inputs. need for local hand wiring reduces cost and increases
FIG. 5 displays the controller 49 attached to the motor 55 reliability. Elimination of the necessity of mounting the
body 40, demonstrating that the controller 49 adds little to Separate components Saves money, time and Space. Elimi
the length of the motor body beyond that typically assumed nation of the need to match, procure and inventory Separate
by an encoder of the prior art. The controller 49 has a length components adds to this Savings. Elimination of potentiom
Lc that may range from about 1 inch to Several inches, eters and other analog Settings removes Servo engineers
depending primarily upon the number of circuit boards 60 from assembly lines and assures uniformity acroSS different
stacked within the controller 49. The diameter of the con units and over time.
troller Dc can be seen to match the diameter D, of the motor We claim:
body 40, allowing the mated body 40 and controller 49 to fit 1. A digitally controlled integrated motor device
in a similar lateral space as the motor body 40 would fit in comprising,
alone. 65 a body housing a direct-current motor having a rotor, a
FIG. 6 shows the motor body 40 and controller 49 Stator and means for Sensing motion of Said rotor
attached by the flange 128 to a support 175. An RS-232 cable relative to Said Stator, defining Sensed motion, and
5,912,541
7 8
an encasement housing a controllers with Said encasement a modular body housing a direct-current motor with a
having a croSS-Sectional area equal to a cross-sectional moveable rotor protruding from Said body in a first
area of Said body, said encasement being removably direction and a plurality of rigid, electrically conduc
connected to Said body, Said controller being in elec tive pins protruding from Said body in a Second
trical communication with both Said motor and Said direction, Said body including encoder means for Sens
Sensing means and including a proportional integral ing motion of Said rotor compared to Said body,
derivative Servo control System, drive means, in data a modular control unit having a plurality of holes fitting
communication with Said proportional integral deriva Said pins, Said control unit having a croSS-Sectional area
tive Servo control System, for producing a Selected equal to a cross-sectional area of Said body, Said
quantity of motion by Said rotor, means for digitally modular control unit including a proportional integral
Storing data corresponding to motion parameters, Said derivative Servo control System, a microprocessor, in
motion parameters including Velocity and acceleration data communication with both Said encoder means and
of Said rotor with respect to Said Stator, and means, in Said control System via Said pins, drive means, in data
data communication with both Said Sensing means and communication with Said microprocessor and Said pro
Said Storing means, for deriving variations between Said 15 portional integral derivative Servo control System, for
Sensed motion and one of Said motion parameters, with moving Said rotor in response to Signals received from
Said proportional integral derivative Servo control Sys Said microprocessor, and means for digitally Storing
tem being adapted to Sense Said variations and produce
an actuation Signal corresponding thereto to vary an data corresponding to motion parameters, Said motion
operation of Said drive means to move Said rotor in parameters including Velocity and acceleration of Said
accordance with Said motion parameters. rotor with respect to Said Stator, wherein Said drive
2. The device of claim 1 further including a plurality of means moves Said rotor, with Said encoder means
rigid pins protruding from Said body and a plurality of transmitting information concerning motion of Said
corresponding holes formed in Said controller, forming a rotor to Said microprocessor, and Said microprocessor
plurality of wireleSS connections, with all electrical commu determining variations between Said motion Sensed and
nication between Said motor and Said controller occurring 25 one of Said motion parameters and transmitting the
through Said plurality of wireleSS connections. Same to Said proportional integral derivative Servo
3. The device of claim 1 wherein said drive means control System, with Said proportional integral deriva
includes an amplifier connected to a power Supply and tive Servo control System transmitting a signal to Said
controlled by Said deriving means, with Said Storing means drive means to remove or reduce Said variation deter
adapted to contain up to 32 bits of information correspond mined.
ing to each of Said motion parameters. 13. The device of claim 12 wherein said control unit
4. The device of claim 1 wherein Said Sensing means includes a communications port disposed distal to Said holes
includes an encoder attached to said body and connected to for programming said microprocessor.
Said controller, Said encoder in Signal communication with 14. The device of claim 12 wherein said rotor is electri
Said microprocessor. 35 cally insulated from a Stator contained in Said body.
5. The device of claim 1 wherein said rotor includes a 15. The device of claim 12 wherein said storing means
magnet and Said motor includes a plurality of hall Sensors to adapted to contain up to 32 bits of information correspond
Sense a polarization of Said magnet, with Said hall Sensors ing to each of Said motion parameters and Said rotor includes
being in data communication with Said deriving means. a magnet and Said motor includes a plurality of hall Sensors
6. The device of claim 1 wherein Said Sensing means is 40 to Sense a polarization of Said magnet, with Said hall Sensors
adapted to Sense two thousand incremental positions of Said being in data communication with Said microprocessor.
rOtOr. 16. The device of claim 12 wherein said encoder means is
7. The device of claim 1 wherein said body and said adapted to Sense two thousand incremental positions of Said
controller are essentially cylindrical and have Substantially rOtOr.
Similar diameters. 45 17. The device of claim 12 wherein said encoder means is
8. The device of claim 1 wherein said proportional in optical communication with Said rotor and includes a
integral derivative Servo control System is adapted to operate Source of light and a light detector, with Said rotor formed
at 5 kHz. with a plurality of Surfaces having differing reflectivity, each
9. The device of claim 1 wherein said sensing means of which corresponds to an angular position of Said rotor
comprises of an optical encoder with Said encasement defin 50 different than an angular position with which the remaining
ing a receSS adapted to receive Said rotor and Said optical Surfaces correspond, wherein an angular position of Said
encoder upon said encasement being attached to Said body, rotor is determined by Said encoder means detecting an
thereby shielding Said encoder from ambient light. intensity of light reflected from said rotor.
10. The device of claim 1 wherein said sensing means 18. A digitally controlled integrated motor device
precisely determines a plurality of positions of Said rotor 55 comprising,
relative to Said Stator. a body housing a direct-current motor having a rotor, a
11. The device of claim 1 further including a plurality of Stator and means for determining a position of Said
first and Second complementary connectors, with Said plu rotor relative to Said Stator, Said determining means
rality of first connectors rigidly attached to Said body and in including an encoder in optical communication with
electrical communication with Said motor and Said plurality 60 Said rotor, Said encoder including a Source of light and
of Second connectors rigidly attached to Said encasement a light detector, with Said encoder adapted to transmit
and in electrical communication with Said controller, Said data corresponding to angular positions of Said rotor
first and Second plurality of connectors being coupled with respect to Said Stator, defining Sensed motion, and
together, providing electrical communication between said an encasement housing a controllers with Said encasement
motor and Said controller. 65 having a croSS-Sectional area equal to a cross-sectional
12. A digitally controlled integrated motor device area of Said body, said encasement being removably
comprising, connected to Said body, Said controller being in elec
5,912,541
9 10
trical communication with both Said motor and Said insulated from Said Stator and includes a magnet, and
encoder, and including a proportional integral deriva wherein current Supplied to windings of Said Stator generates
tive Servo control System, a drive means, in data a magnetic field that drives Said rotor, Said motor further
communication with Said proportional integral deriva including a plurality of Hall Sensors to Sense an orientation
tive Servo control System, for producing a Selected of Said rotor magnet, Said Hall Sensors being in data com
quantity of motion by Said rotor, means for digitally munication with said PID servo control system.
Storing data corresponding to motion parameters, Said 22. The motor device of claim 20 wherein said encoder is
motion parameters including Velocity and acceleration an optical encoder including a Source of light, a position
of Said rotor with respect to Said Stator, and means, in indicator associated with Said rotor having a plurality of
data communication with both said encoder and Said optically contrasting portions thereon corresponding to dif
Storing means, for deriving variations between Said ferent angular positions of Said rotor, and a light detector
Sensed motion and one of Said motion parameters, with positioned to detect changes in intensity of light received
Said proportional integral derivative Servo control from Said Source Via Said position indicator portions.
System, being adapted to Sense Said variations and 23. The motor device of claim 20 wherein said encoder is
produce an actuation Signal corresponding thereto to 15 adapted to Sense at least 2000 incremental angular positions
vary an operation of Said drive means to move Said of Said rotor.
rotor in accordance with Said motion parameters. 24. The motor device of claim 20 wherein said motion
19. The device of claim 18 wherein electrical signals parameter commands indicate desired position, Velocity and
travel between said body and said controller essentially only
Via Signal pins. acceleration with a resolution up to 32 bits, said Storing
20. A digitally controlled, integrated motor device, com means adapted to contain Said 32-bit motion parameter
prising: command information.
a modular motor body housing a direct current Servo 25. The motor device of claim 20 wherein said data and
motor having a rotor and a Stator; electrical communication between elements associated with
an encoder associated with Said Servo motor and adapted Said modular motor body and elements associated with Said
to Sense incremental angular positions of Said rotor 25 modular control unit are provided by a plurality of wireleSS
with respect to Said Stator, Said encoded transmitting complementary pin-and-hole connections fixed to the
incremental position data corresponding to Sensed respective modules in mating relationship.
motion of Said rotor; and 26. A motor and controller to be operated by a digital
a modular control unit in the form of an encasement, computer through a communications port for bringing a
removably connected to Said motor body in mating rotor of the motor to a target position comprising,
relationship therewith, Said encasement housing a con a motor having a rotor disposed within a first housing,
troller with a drive amplifier for said motor whereby a rotor position encoder associated with the rotor, the
Said motor, encoder, controller and drive amplifier form encoder producing an electrical Signal indicating the
a fully integrated compact unit within Said motor body measured position of the rotor, a microprocessor
and encasement, Said controller including a micro 35 mounted within a Second housing, the Second housing
processor in data communication with a communica in mating relation to the first housing and electrically
tions port on Said encasement to receive one or more connected to the rotor position encoder, the Second
digital motion parameter commands from an external housing having a Serial data communications port con
Source through Said port, available motion parameter nectable to a remote digital computer issuing a desired
commands that can be received including a set of 40 rotor position command using Serial digital data, the
commands that indicate a desired position, Velocity and microprocessor having Software which receives desired
acceleration of Said rotor, Said microprocessor also in position commands through the communications port,
data communication with Said encoder to receive Said repeatedly computes error Signals between the desired
incremental position data transmitted from Said position command and the measured position of the
encoder, Said microprocessor having means for digi 45 rotor as transmitted by the encoder, and reduces the
tally Storing Said received motion parameter error Signals to Zero, whereby the microprocessor oper
commands, continually calculating and updating an ates as a position based, Servo System within the Second
actual rotor position from Said received incremental housing to bring the rotor within the first housing to the
position data, determining variations between the desired position defined by the remote digital computer.
desired position or motion of Said rotor corresponding 50 27. The motor and controller of claim 26 wherein said
to Said Stored motion parameter commands and the microprocessor is adapted to further receive other com
calculated actual position of Said rotor, and producing mands corresponding to desired motor motion that are
an actuation signal to direct motion of Said rotor in Selected from the group consisting of relative rotor position,
accordance with Said motion parameter commands, maximum allowable Velocity, rotor acceleration, torque
Said controller also including a proportional-integral 55 magnitude and drive current limit.
derivative (PID) servo control system in data commu 28. The motor and controller of claim 27 wherein said
nication with Said encoder to receive Said incremental desired rotor position command and Said other commands
position data therefrom and in data communication have up to a 32-bit resolution.
with Said microprocessor to receive Said actuation 29. The motor and controller of claim 26 wherein said
Signal therefrom, Said PID Servo control System respon 60 microprocessor produces an actuation signal to direct a
Sive to Said incremental position data and Said actuation proportional-integral-derivative (PID) filter connected to
Signal to control operation of Said drive amplifier, Said Said microprocessor, Said PID filter providing Servo control
drive amplifier in electrical communication with Said of a drive amplifier Supplying current to Said motor.
motor to Supply current to Said Stator to move Said rotor 30. The motor and controller of claim 26 wherein said
in accordance with Said motion parameter commands. 65 microprocessor is also in output data communication with
21. The motor device of claim 20 wherein said servo Said remote computer to provide motor position information
motor is a brushleSS motor wherein Said rotor is electrically to Said remote computer.
5,912,541
11 12
31. The motor and controller of claim 26 wherein said means for Synchronizing Said controller with a controller
Serial data communications port is an RS-232 port. of at least one other like integrated motor device,
32. An integrated motor device, comprising: whereby a plurality of integrated motor devices may be
a body housing a direct-current motor having a rotor, a Synchronously interconnected.
33. The motor device of claim 32 wherein said means for
Stator, and means for determining a position of Said Synchronizing includes a Synchronization pin in communi
rotor relative to Said Stator; cation with Said controller housed in Said encasement.
an encasement housing a controller, with Said encasement 34. The motor device of claim 33 wherein said means for
removably connected to Said body, Said controller in Synchronizing further includes an internal timer of Said
electrical communication with both Said motor and Said microprocessor responsive to Said Synchronization pin.
position determining means and including a 35. The motor device of claim 32 wherein said means for
microprocessor, Servo means for controlling a quantity Synchronizing initiates motion of Said rotor, whereby all
of motion of said rotor as directed by said rotors of a plurality of interconnected integrated motor
microprocessor, and associated drive means responsive devices will Start Simultaneously.
to Said Servo means for producing Said motion of Said
rotor; and
USOO591.2541C1
(2) REEXAMINATION CERTIFICATE (4593rd)
United States Patent (10) Number: US 5,912,541 C1
Bigler et al. (45) Certificate Issued: Jun. 11, 2002
(54) INTEGRATED DC SERVO MOTOR AND 5,208,523 A 5/1993 Harman ...................... 318/685
CONTROLLER 5,391,970 A * 2/1995 Chaffee et al. ............. 318/618
5,610,487 A * 3/1997 Hutsell ....................... 318/560
(75) Inventors: Robert A. Bigler; Punita Pandit, both FOREIGN PATENT DOCUMENTS
of Cupertino, CA (US)
JP 59028519 2/1984
(73) Assignee: Animatics Corporation, Santa Clara, OTHER PUBLICATIONS
CA (US)
“LM628/620. User Guide', National Semiconductor Appli
Reexamination Request: cation Note AN-706, 1993.*
No. 90/005,639, Feb. 17, 2000 (List continued on next page.)
No. 90/005,936, Feb. 21, 2001
Primary Examiner Jo Macaluso
Reexamination Certificate for:
(57) ABSTRACT
Patent No.: 5,912,541
Issued: Jun. 15, 1999 An integrated motion control device having a controller
Appl. No.: 08/754,182 mated to a motor body with Set of rigid, electrically con
Filed: Nov. 22, 1996 ductive signal pins. The motor is direct-current and prefer
ably brushless, and has Hall sensors within the motor body
Related U.S. Application Data and an encoder at a back end for precisely determining rotor
position. Signals from the Hall Sensors and encoder are fed
(63) Continuation of application No. 08/347,807, filed on Nov. to a microprocessor contained in the controller and including
30, 1994, now abandoned. a PID filter for servo control of the motor. The controller
(51) Int. Cl." .................................................. H02P 5/06 contains an amplifier for driving the motor and a power
(52) U.S. Cl. ........................ 318/600; 318/538; 318/625 Supply for providing appropriate levels of DC power to
(58) Field of Search ................................. 318/600, 538, various elements of the controller and motor. All electrical
318/625, 565, 685, 616, 634, 640, 254, Signals between the motor and controller are transmitted via
138, 439, 560, 561; 310/47, 50, 42, 67 R, the pins, eliminating wiring harness of the prior art and
68 R, 68 B, 58; 439/44, 631 related Signal noise and wiring problems. The motor body
and controller are affixed with a few screws, allowing the
(56) References Cited controller to be removed from the motor while the motor
U.S. PATENT DOCUMENTS
remains connected to an application. Communication ports
are provided at a rear of the controller for connection to a
4,618.808 A * 10/1986 Ish-Shalom et al. ........ 318/696 computer or peripheral devices, and can be used to daisy
4,893,068 A 1/1990 Evans, Jr. ................... 318/615 chain and Synchronize a number of interconnected motors
4.951,549 A * 8/1990 Olson et al. .............. 91/363 R and controllers.

MICRO
PROCESSOR

POWER
SUPPLY

NIVERSAL
AMPLIFIER
US 5,912,541 C1
Page 2

OTHER PUBLICATIONS Elettronica Oggi, No. 69, Oct. 1988, pp. 67-75, 0 references.
“Interfacing the HPC and LM629 for Motion Control”, Bridge Between Control Science and Technology, Proceed
National Semiconductor Application Note AN-868, 1993.* ings of the Ninth Triennial World Congress of IFAC, 1985,
Intellimotor Series Brochure, Intellico, Inc., pp. 16 (1990). pp. 2809-2813 vol. 5, 6 vol. (xiv--Xi+xiv--Xiv +xiv--xiv+
Davis, “Smart Motor Integrates Hardware and Software.” 3526) page(s), 8 references.
PCIM, pp. 6–7 (1989).
McGraw-Hill Dictionary of Scientific and Technical Terms, Mesures, spec. issue, , Sep. 18, 1984, pp. 45-48, 0 refer
(4th ed.), pp. 367,700, 1507, 1508, 1642, 1708, 1739, 1816 CCCS.
(1989).
Proceedings of the Fifth Annual Embedded Systems Con News Release, 96-05-01.
ference, Part Number, vol. 2, 1993, pp. 231-242 vol. 22 vol.
1072 page(s), 3 references. * cited by examiner
US 5,912,541 C1
1 2
REEXAMINATION CERTIFICATE a motor having a rotor disposed within a first housing,
ISSUED UNDER 35 U.S.C. 307 a rotor position encoder associated with the rotor, the
encoder producing an electrical Signal indicating the
THE PATENT IS HEREBY AMENDED AS measured position of the rotor, a microprocessor
INDICATED BELOW. mounted within a Second housing, the Second housing
in mating relation to the first housing and electrically
Matter enclosed in heavy brackets appeared in the connected to the rotor position encoder, the Second
patent, but has been deleted and is no longer a part of the housing having a Serial data communications port con
patent; matter printed in italics indicates additions made nectable to a remote digital computer issuing a desired
to the patent. rotor position command using Serial digital data, the
ONLY THOSE PARAGRAPHS OF THE microprocessor having Software which receives desired
SPECIFICATION AFFECTED BY AMENDMENT position commands through the communications port,
ARE PRINTED HEREIN.
repeatedly computes error Signals between the desired
position command and the measured position of the
Column 4, lines 20-46: 15
rotor as transmitted by the encoder, and reduces the
FIG. 3 shows a simplified axial view of a portion of the error Signals to Zero, whereby the microprocessor oper
motor body 40 containing the motor 45 with a stator 98 ates as a position based, Servo System within the Second
outside and the rotor 42 at the center. The rotor 42 is housing to bring the rotor within the first housing to the
electrically insulated from the Stator 98 contained in the desired position defined by the remote digital
motor body 40. The rotor 42 is attached to a cylindrical computer, wherein Said microproceSSOr produces an
permanent magnet 100 having a diameter larger than that of actuation Signal to direct a proportional-integral
the rotor 42 and opposed north (N) and south (S) poles. Six derivative (PID) filter connected to Said
windings, labeled 102,104,106, 108, 110, and 122 surround microprocessor, Said PID filter providing servo control
the permanent magnet 100, with adjacent windings being of a drive amplifier Supplying current to Said motor.
oppositely wound and thus producing oppositely directed 36. A compact digitally servo controlled integrated motor
25 device comprising,
magnetic fields when Suppplied with electrical current. The a body housing a direct-current motor having a rotor, a
windings are connected as pairs So that current flows Stator and means for Sensing motion of Said rotor
through a pair of adjacent windings simultaneously to pro relative to Said Stator, defining Sensed motion, and
vide a torque to the magnet 100 and thereby turn the rotor an encasement housing a modular controller with Said
42. For example, pins 91 and 92 (FIG. 2B) provide and drain encasement having a croSS-Sectional area equal to a
current from windings 102 and 104, respectively. Winding croSS-Sectional area of Said body, Said encasement
102 is oriented so that current provided by from pin 91 mated to and removably connected by rigid connectors
creates a magnetic field having a north pole directed toward to Said motor housed by Said body, Said controller
the rotor 42 and a south pole directed away from the rotor being in feedback electrical communication with both
42. Current from winding 102 flows to winding 104 by a 35 Said motor and Said Sensing means, and Said controller
wire, not shown, and drains from winding 104 through pin including a proportional integral derivative ServO COn
92. Winding 104 is oriented so that this current creates a trol System which receives said feedback communica
magnetic field with a south pole directed toward the rotor 42. tion from Said motor and Said Sensing means, drive
With the north pole (N) of the magnet 100 oriented as shown means, in data communication with Said proportional
in FIG. 3, the just described current in windings 102 and 104 40 integral derivative servo control System, for producing
produces a torque T that tends to cause magnet 100 and rotor a Selected quantity of motion by Said rotor, means for
42 to rotate in a clockwise direction.
digitally Storing data corresponding to motion
AS A RESULT OF REEXAMINATION, IT HAS BEEN parameters, Said motion parameters including velocity
DETERMINED THAT and acceleration of Said rotor with respect to Said
45 Stator, and means, in data communication with both
The patentability of claims 1-3, 12–25 and 32-35 is Said Sensing means and Said Storing means, for deriv
confirmed. ing variations between Said Sensed motion and One of
Said motion parameters, with Said proportional inte
Claim 29 is cancelled. gral derivative ServO control System being adapted to
50 Sense Said variations and produce an actuation Signal
Claims 4 and 26 are determined to be patentable as corresponding thereto to vary an Operation of Said
amended. drive means to move Said rotor in accordance with Said
motion parameters to produce Said Selected quantity of
Claims 5-11, 27, 28, 30 and 31, dependent on an amended motion by Said rotor.
claim, are determined to be patentable. 55 37. The device of claim 36 further including a plurality of
rigid pins protruding from Said body and a plurality of
New claims 36-100 are added and determined to be corresponding holes formed in Said controller, forming a
patentable. plurality of wireless connections, with all electrical commu
nication between said motor and Said controller occurring
4. The device of claim 1 wherein Said Sensing means 60 through said plurality of wireless connections.
includes an encoder attached to Said body and connected to 38. The device of claim 36 wherein Said drive means
Said controller, and Said means for deriving is a includes an amplifier connected to a power Supply and
microproceSSOr, said encoder being in Signal communication controlled by Said deriving means, with Said Storing means
with Said microprocessor. adapted to contain up to 32 bits of information correspond
26. A motor and controller to be operated by a digital 65 ing to each of Said motion parameters.
computer through a communications port for bringing a 39. The device of claim 36 wherein Said Sensing means
rotor of the motor to a target position comprising, includes an encoder attached to Said body and connected to
US 5,912,541 C1
3 4
Said controller, Said encoder in Signal communication with 48. The device of claim 47 wherein Said control unit
Said microproceSSOr. includes a communications port disposed distal to Said holes
40. The device of claim 36 wherein said rotor includes a for programming Said microproceSSOr.
magnet and Said motor includes a plurality of hall SensOrs 49. The device of claim 47 wherein said rotor is electri
to Sense a polarization of Said magnet, with Said hall SensOrs cally insulated from a Stator contained in Said body.
being in data communication with Said deriving means. 50. The device of claim 47 wherein Said Storing means
41. The device of claim 36 wherein said Sensing means is adapted to contain up to 32 bits of information correspond
adapted to Sense two thousand incremental positions of Said ing to each of Said motion parameters and Said rotor
FOO. includes a magnet and Said motor includes a plurality of hall
42. The device of claim 36 wherein Said body and Said Sensors to Sense a polarization of Said magnet, with Said hall
controller are essentially cylindrical and have substantially Sensors being in data communication with Said micropro
Similar diameters. CeSSO
43. The device of claim 36 wherein Said proportional 51. The device of claim 47 wherein Said encoder means is
integral derivative ServO control System is adapted to Oper adapted to Sense two thousand incremental positions of Said
ate at 5 kHz.
15 FOO.
44. The device of claim 36 wherein Said Sensing means 52. The device of claim 47 wherein Said encoder means is
comprises of an optical encoder with Said encasement in optical communication with Said rotor and includes a
defining a receSS adapted to receive Said rotor and Said Source of light and a light detector, with Said rotor formed
Optical encoder upOn Said encasement being attached to with a plurality of surfaces having differing reflectivity, each
Said body, thereby Shielding Said encoder from ambient
light. of which corresponds to an angular position of Said rotor
45. The device of claim 36 wherein Said Sensing means different than an angular position with which the remaining
precisely determines a plurality of positions of Said rotor Surfaces correspond, wherein an angular position of Said
relative to Said Stator: rotor is determined by Said encoder means detecting an
46. The device of claim 36 further including a plurality of intensity of light reflected from Said rotor.
first and Second complementary connectors, with Said plu 25 53. A compact digitally servo controlled integrated motor
rality of first connectors rigidly attached to Said body and in device comprising,
electrical communication with Said motor and Said plurality a modular body housing a direct-current motor having a
of Second connectors rigidly attached to Said encasement rotor, a Stator and means for determining a position of
and in electrical communication with Said controller, Said Said rotor relative to Said Stator, Said determining
first and Second plurality of connectors being coupled means including an encoder in Optical communication
together, providing electrical communication between Said with Said rotor, Said encoder including a Source of light
motor and Said controller: and a light detector, with Said encoder adapted to
47. A compact digitally servo controlled integrated motor transmit data corresponding to angular positions of
device comprising, Said rotor with respect to Said Stator, defining Sensed
a modular body housing a direct-current motor with a 35 motion, and
moveable rotor protruding from Said body in a first an encasement housing a modular controller with Said
direction and a plurality of rigid, electrically conduc encasement having a croSS-Sectional area equal to a
tive pins protruding from Said body in a Second croSS-Sectional area of Said body, Said encasement
direction, Said body including encoder means for Sens being removably connected to and mating Said body,
ing motion of Said rotor compared to Said body, 40 Said controller being in electrical feedback communi
a modular control unit having a plurality of holes fitting cation with both Said motor and Said encodei, and
Said pins to mate Said control unit to Said body, Said including a proportional integral derivative ServO COn
control unit having a cross-sectional area equal to a trol System, a drive means, in data communication with
croSS-Sectional area of Said body, Said modular control Said proportional integral derivative servo control
unit including a proportional integral derivative ServO 45 System, for producing a Selected quantity of motion by
control System, a microproceSSOr, in data communica Said rotor, means for digitally Storing data correspond
tion with both Said encoder means and Said control ing to motion parameters, Said motion parameters
System via Said pins, drive means, in data communi including velocity and acceleration of Said rotor with
cation with Said microproceSSOr and Said proportional respect to Said Stator, and means, in data communica
integral derivative servo control System, for moving 50 tion with both said encoder and said Storing means, for
Said rotor in response to Signals received from Said deriving variations between Said sensed motion and
microproceSSOr, and means for digitally Storing data One of Said motion parameters, with Said proportional
corresponding to motion parameters, Said motion integral derivative servo control System, being adapted
parameters including velocity and acceleration of Said to Sense Said variations and produce an actuation
rotor with respect to Said Stator, wherein Said drive 55 Signal corresOnding theretO to vary an Operation of
means moves Said rotor, with Said encoder means Said drive means to move Said rotor in accordance with
transmitting information concerning motion of Said Said motion parameters commands to produce Said
rotor to Said microproceSSOr, and Said microproceSSOr Selected quantity of motion by Said rotor to produce
determining variations between Said motion Sensed and Said Selected quantity of motion by Said rotor to yield
One of Said motion parameters and transmitting the 60 fine resolution of Said rotor.
Same to Said proportional integral derivative ServO 54. The device of claim 53 wherein electrical Signals
control System, with Said proportional integral deriva travel between Said body and Said controller essentially Only
tive ServO control System transmitting a Signal to Said via Signal pins.
drive means to remove or reduce Said variation 55. A compact digitally servo controlled, integrated motor
determined, for moving Said rotor in response to Sig 65 device, comprising:
nals received from Said microprocessor to yield fine a modular motor body housing a direct current servo
resolution of Said rotor. motor having a rotor and a Stator,
US 5,912,541 C1
S 6
an encoder aSSOciated with Said ServO motor and adapted 60. The motor device of claim 55 wherein Said data and
to Sense incremental angular positions of Said rotor electrical communication between elements associated with
with respect to Said Stator, Said encoded transmiting Said modular motor body and elements associated with Said
incremental position data corresponding to Sensed modular control unit are provided by a plurality of wireless
motion of Said rotor, and complementary pin-and-hole connections fixed to the
a modular control unit in the form of an encasement, respective modules in mating relationship.
removably connected to Said motor body in mating 61. An integrated compact motor and controller to be
relationship therewith, Said encasement housing a con Operated by a digital computer through a communications
troller with a drive amplifier for Said motor whereby port for bringing a rotor of the motor to a target position
Said motor, encoder, controller and drive amplifier form 1O
comprising,
a fully integrated compact unit within Said motor body a motor having a rotor disposed within a first housing,
and encasement, Said controller including a micro a rotor position encoder associated with the rotor, the
proceSSOr in data communication with a communica encoder producing an electrical Signal indicating the
tions port On Said encasement to receive One Or more measured position of the rotor, a microproceSSOr
digital motion parameter commands from an external 15 mounted within a Second housing, the Second housing
Source through Said port, available motion parameter in mating relation to the first housing and electrically
commands that can be received including a Set Of connected to the rotor position encoder, the Second
commands that indicate a desired position, velocity and housing having a Serial data communications port
acceleration of Said rotor, Said microporceSSOr also in connectable to a remote digital computer issuing a
data communication with Said encoder to receive Said
incremental position data transmitted from Said desired rotor position command using Serial digital
encoder, Said controller having a volume proportional data, the microprocessor having Software which
to Said motor volume, Said microproceSSOr having receives desired position commands through the com
means for digitally Storing Said received motion munications port, repeatedly computes error Signals
parameter commands, continually calculating and between the desired position command and the mea
updating an actual rotor position from Said received 25 Sured position of the rotor as transmitted by the
incremental position data, determining variations encoder, and reduces the error Signals to zero, Said
between the desired position or motion of Said rotor microproceSSOr produces an actuation Signal to direct
corresponding to Said Stored motion parameter com a proportional-integral-derivative (PID) filter con
mands and the calculated actual pOsition of Said rotor, nected to Said microprocessor, said PID filter providing
and producing an actuation Signal to direct motion of ServO control of a drive amplifier Supplying current to
Said rotor in accordance with Said motion parameter Said motor, thereby completing feedback control
commands, Said controller also including a between said motor, encoder, microprocessor with PID
proportional-integral-derivative (PID) ServO control filter, and said drive amplifier, whereby the micropro
System in closed loop data communication with Said ceSSOr Operates as a position based, ServO System
encoder to receive Said incremental position data there 35 within the Second housing to bring the rotor within the
from and in closed loop data communication with Said first housing to the desired position with fine resolution
microproceSSOr to receive Said actuation Signal defined by the remote digital computer.
therefrom, said PID Servo control System responsive to 62. The motor and controller of claim 61 wherein Said
Said incremental position data and Said actuation Sig microprocessor is adapted to further receive other com
nal to control operation of Said drive amplifier, Said 40 mands corresponding to desired motor motion that are
drive amplifier in electrical communication with Said Selected from the group consisting of relative rotor position,
motor to Supply current to Said Stator to move Said maximum allowable velocity, rotor acceleration, torque
rotor in accordance with Said motion parameter com magnitude and drive current limit.
mands to Said desired position. 63. The motor and controller of claim 62 wherein Said
56. The motor device of claim 55 wherein said servo 45 desired rotor position command and Said Other commands
motor is a brushless motor wherein Said rotor is electrically have up to a 32-bit resolution.
insulated from Said Stator and includes a magnet, and 64. The motor and controller of claim 61 wherein Said
wherein current Supplied to windings of Said Stator gener microproceSSOr is also in Output data communication with
ates a magnetic field that drives Said rotor, Said motor Said remote computer to provide motor position information
further including a plurality of Hall sensors to sense an 50 to Said remote computer:
Orientation of Said rotor magnet, Said Hall sensors being in 65. The motor and controller of claim 61 wherein Said
data communication with said PID Servo control System. Serial data communications port is an RS-232 port.
57. The motor device of claim 55 wherein Said encoder is 66. An integrated compact servo controlled motor device,
an optical encoder including a Source of light, a position comprising:
indicator associated with Said rotor having a plurality of 55 a body housing a direct-current motor having a rotor, a
Optically contrasting portions thereOn corresponding to dif Stator, and means for determining a position of Said
ferent angular positions of Said rotor, and a light detector rotor relative to Said Stator,
positioned to detect changes in intensity of light received an encasement housing a controller, with Said encasement
from Said Source via Said position indicator portions. removably connected to and mating Said motor housed
58. The motor device of claim 55 wherein Said encoder is 60 by Said body, Said controller including a proportional
adapted to sense at least 2000 incremental angular positions integral-derivative (PID) filter in feedback electrical
of Said rotor. communication with both Said motor and Said position
59. The motor device of claim 55 wherein Said motion determining means and including a microproceSSOr,
parameter commands indicate desired position, velocity and ServO means for controlling a quantity of motion of Said
acceleration with a resolution up to 32 bits, said Storing 65 rotor as directed by Said microproceSSOr, and aSSOci
means adapted to contain Said 32-bit motion parameter ated drive means responsive to Said servo means for
command information. producing Said motion of Said rotor, and
US 5,912,541 C1
7 8
means for Synchronizing Said controller with a controller a servo controlled motor having a rotor disposed within
of at least One Other like integrated motor device, a first housing, a rotor position encoder aSSOciated with
whereby a plurality of integrated motor devices may be the rotor, the encoder producing an electrical Signal
Synchronously interconnected. indicating the measured position of the rotor,
67. The motor device of claim 66 wherein Said means for 5 a modular Conroller having a microproceSSOr mounted
Synchronizing includes a Synchronization pin in communi within a Second housing, the Second housing in mating
cation with Said controller housed in Said encasement.
68. The motor device of claim 67 wherein Said means for relation to the first housing and electrically connected
Synchronizing further includes an internal timer of Said to the rotor position encoder, the Second housing hav
microproceSSOr responsive to Said Synchronization pin. ing a Serial data communications port connectable to a
69. The motor device of claim 66 wherein Said means for remote digital computer issuing a desired rotor posi
Synchronizing initiates motion of Said rotor, whereby all tion command using Serial digital data, the micropro
rotors of a plurality of interconnected integrated motor cessor having a PID filter and Software which receives
devices will Start Simultaneously. desired position commands through the communica
70. An integrated modular, mated combination motor and tions port, repeatedly computes error Signals between
controller to be operated by a digital computer through a 15 the desired position command and the measured posi
communications port for bringing a rotor of the motor to a tion of the rotor as transmitted by the encoder; and
target position comprising, reduces the error Signals to zero, Said microproceSSOr
a servo controlled motor having a rotor disposed within producing an actuation Signal to direct the
a first housing, a rotor position encoder aSSOciated with proportional-integral-derivative (PID) filter connected
the rotor, the encoder producing an electrical Signal to Said microprocessor, said PID filter providing servo
indicating the measured position of the rotor, a micro control of a drive amplifier Supplying current to Said
proceSSOr mounted within a Second housing, the Second motor, whereby the microprocessor via Said PID filter
housing in mating relation to the first housing and Operates as a position based, ServO System within the
electrically connected to the rotor position encoder, the Second housing to bring the rotor to fine resolution
Second housing having a Serial data communications 25 within the first housing to the desired position defined
port connectable to a remote digital computer issuing by the remote digital computer.
a desired rotor position command using Serial digital 73. An mated motor and controller to be operated by a
data, the microprocessor having a PID filter and Sofi digital computer through a communications port for bring
ware which receives desired position commands ing a rotor of the motor to a target position comprising,
through the communications port, repeatedly computes
error Signals between the desired position command a servo controlled motor having a rotor disposed within
and the measured position of the rotor as transmitted by a first housing, a rotor position encoder aSSOciated with
the encoder, and reduces the error Signals to zero, the rotor, the encoder producing an electrical Signal
whereby the microproceSSOr Operates as a position indicating the measured position of the rotor,
based, servo System within the Second housing to bring 35 a modular controller having a microproceSSOr mounted
the rotor within the first housing to the desired position within a Second housing, the Second housing in mating
defined by the remote digital computer. relation to the first housing and electrically connected
71. An integrated modular, mated combination motor and to the rotor position encoder, said modular controller
controller to be operated by a digital computer through a replaceable as a module by a like modular controller
communications port for bringing a rotor of the motor to a 40 On Said motor, the Second housing having a Serial data
target position comprising, communications port connectable to a remote digital
a servo controlled motor having a rotor disposed within computer issuing a desired rotor position command
a first housing, using Serial digital data, the microproceSSOr having a
a rotor position encoder associated with the rotor, the PID filter and Software which receives desired position
encoder producing an electrical Signal indicating the 45 commands through the communications port, repeat
measured position of the rotor, a controller having a edly computes error Signals between the desired posi
microproceSSOr mounted within a Second housing, the tion command and the measured position of the rotor as
Second housing in mating relation to the first housing transmitted by the encoder, and reduces the error
and electrically connected to the rotor position Signals to zero, whereby the microproceSSOr Operates
encoder, the Second housing having a Serial data com 50 as a position based, ServO System within the Second
munications port connectable to a remote digital Com housing to bring the rotor within the first housing to the
puter issuing a desired rotor position command using desired position defined by the remote digital computer.
Serial digital data, the microprocessor having a PID 74. An integrated combination motor and controller to be
filter and Software which receives desired position Operated by a digital computer through a communications
commands through the comunications port, repeatedly 55 port for bringing a rotor of the motor to a target position
computes error Signals between the desired position comprising,
command and the measured position of the rotor as a servo controlled motor having a rotor disposed within
transmitted by the encoder, and reduces the error a first housing, a rotor position encoder aSSOciated with
Signals to zero, whereby the controller via Said micro the rotor, the encoder producing an electrical Signal
proceSSOr Operates as a position based, ServO System 60 indicating the measured position of the rotor,
within the Second housing to bring the rotor within the a modular controller having a microproceSSOr mounted
first housing to the desired position defined by the within a Second housing, the Second housing in mating
remote digital computer: relation to the first housing and electrically connected
72. A modular, mated, integrated combination motor and to the rotor position encoder, the Second housing hav
controller to be operated by a digital computer through a 65 ing a Serial data communications port connectable to a
communications port for bringing a rotor of the motor to a remote digital computer issuing a desired rotor posi
target position comprising, tion command using Serial digital data, the micropro
US 5,912,541 C1
10
cessor having a PID filter and Software which receives encoder, and reduces the error Signals to zero, Said
desired position commands through the communica microproceSSOr producing an actuation Signal to direct
tions port, repeatedly computes error Signals between a proportional-integral-derivative (PID) filter con
the desired position command and the measured posi nected to Said microprocessor, said PID filter providing
tion of the rotor as transmitted by the encoder; and 5 ServO control of a drive amplifier Supplying current to
reduces the error Signals to zero, Said microproceSSOr Said motor, whereby the microprocessor via said PID
producing an actuation Signal to direct the filter Operates as a position based, ServO System within
porportional-integral-derivative (PID) filter connect to the Second housing to bring the rotor within the first
Said microprocessor, Said PID filter providing servo housing to the desired position defined by the remote
control of a drive amplifier Supplying current to Said 1O digital computer:
motor, whereby the microprocessor via Said PID filter 77. A combination integrated motor and controller to be
Operates as position based, ServO System within the Operated by a digital computer through a communications
Second housing to bring the rotor to fine resolution port for bringing a rotor of the motor to a target position
within the first housing to the desired position defined comprising,
by the remote digital computer, said modular controller is a modular servo controlled motor having a rotor disposed
having a volume proportional to the volume of Said within a first housing, a rotor position encoder aSSO
in Otor. ciated with the rotor, the encoder producing an elec
75. An integrated modular motor and controller to be trical Signal indicating the measured position of the
Operated by a digital computer through a communications rotor,
port for bringing a rotor of the motor to a target position 20 a modular controller having a microprocessor mounted
comprising, within a Second housing, the Second housing in mating
a servo controlled motor having a rotor disposed within relation to the first housing and electrically connected
a first housing, a rotor position encoder aSSOciated with by rigid connectors to the rotor position encoder, the
the rotor adapted to Sense two thousand incremental Second housing having a Serial data comunications
positions, the encoder producing an electrical Signal 25 port connectable to a remote digital computer issuing
indicating the measured position of the rotor, a desired rotor position command using Serial digital
a controller having a microprocessor mounted within a data, the microprocessor having Software which
Second housing, the Second housing in mating relation receives desired position commands through the com
to the first housing end electrically connected to the munications port, repeatedly computes error Signals
rotor position encoder, the Second housing having a 30 between the desired position command and the mea
Serial data communications port connectable to a Sured position of the rotor as transmitted by the
remote digital computer issuing a desired rotor posi- encoder, and reduces the error Signals to zero, Said
tion command using Serial digital data, the micropro- microprocessor having a plurality of Stacked circuit
cessor having Software which receives desired position boards and producing an actuation Signal to direct a
commands through the communications port, repeat- 35 proportional-integral-derivative (PID) filter connected
edly computes error Signals between the desired posi- to Said microprocessor, said PID filter providing servo
tion command and the measured position of the rotor as control of a drive amplifier Supplying current to Said
transmitted by the encoder, and reduces the error motor, whereby the microprocessor via Said PID filter
Signals to zero, Said microproceSSOr producing an Operates as a position based, ServO System within the
actuation Signal to direct a proportional-integral- 40 Second housing to bring the rotor within the first
derivative (PID) filter connected to Said housing to the desired position defined by the remote
microprocessor, said PID filter providing servo control digital computer:
of a drive amplifier Supplying current to Said motor, 78. A combination integrated motor and controller to be
whereby the microprocessor via said PID filter oper- Operated by a digital computer through a communications
ates as a position based, ServO System within the Second 45 port for bringing a rotor of the motor to a target position
housing to bring the rotor within the first housing to the comprising,
desired position defined by the remote digital computer. a modular servo controlled motor having a rotor disposed
76. An integrated modular combination motor and con- within a first housing, a rotor position encoder aSSO
troller to be operated by a digital computer through com- ciated with the rotor, the encoder producing an elec
munications port for bringing a rotor of the motor to a target so trical Signal indicating the measured position of the
position comprising, rotor,
a servo controlled motor having a rotor disposed within a modular controller having a microproceSSOr mounted
a first housing, a rotor position encoder aSSOciated with within a Second housing, the Second housing in mating
the rotor, the encoder producing an electrical Signal relation to the first housing and electrically connected
indicating the measured position of the rotor, 55 to the rotor position encoder, said modular controller
a controller having a microprocessor mounted within a replaceable as a module by a like modular controller
Second housing, the Second housing in mating relation On Said motor, the Second housing having a Serial data
by wireless connectors to the first housing and electri- communications port connectable to a remote digital
cally connected to the rotor position encoder, the computer issuing a desired rotor position command
Second housing having a Serial data communications 60 using Serial digital data, the microproceSSOr having
port connectable to a remote digital computer issuing Software which receives desired position commands
a desired rotor position command using Serial digital through the communications port, repeatedly computes
data, the microprocessor having Software which error Signals between the desired position command
receives desired position commands through the com- and the measured position of the rotor as transmitted by
munications port, repeatedly computes error Signals 65 the encoder, and reduces the error Signals to zero, Said
between the desired position command and the mea microproceSSOr producing an actuation Signal to direct
Sured position of the rotor as transmitted by the a proportional-integral-derivative (PID) filter con
US 5,912,541 C1
11 12
nected to said microprocessor, said PID filter providing 81. The motor and controller as in any One of claims
ServO control of a drive amplifier Supplying current to 70-75, and 78-80, inclusive further including first and
Said motor, whereby the microprocessor via said PID Second complementary rigid connections, with Said first
filter operates as a position based, ServO System within connections rigidly attached to and in electrical communi
the Second housing to bring the rotor within the first cation with Said encoder and Said Second connections
housing to the desired position defined by the remote rigidly attached to and in electrical communication with
digital computer: Said microproceSSOr, Said first and Second plurality of Con
79. An integrated motor and controller to be operated by nections being coupled together, providing wireleSS electri
a digital computer through a communications port for cal communication between Said encoder and Said mircro
bringing a rotor of the motor to a target position comprising, proceSSOr.
a servo controlled motor having a rotor disposed within 82. The motor and controller as in any One of claims 70
a first housing, a rotor position encoder aSSOciated with to 80 inclusive, wherein Said microprocessor is adapted to
the rotor, the encoder producing an electrical Signal further receive other commands corresponding to desired
indicating the measured position of the rotor, motor motion that are Selected from the group consisting of
a controller having a microprocessor mounted within a 15 relative rotor position, maximum allowable velocity, rotor
Second housing, the Second housing in mating relation acceleration, torque magnitude and drive current limit.
to the first housing and electrically connected to the 83. The motor and controller as in any One of claims 70
rotor position encoder, the Second housing having a to 80 inclusive, wherein Said desired rotor position com
Serial data communications port connectable to a mand and Said Other commands a 32-bit resolution.
remote digital computer issuing a desired rotor posi 84. The motor and controller as in any One of claims 70
tion command using Serial digital data, the micropro to 80 inclusive, wherein Said microprocessor is also in
cessor having Software which receives desired position Output data communication with Said remote computer to
commands through the communications port, repeat provide motor position information to Said remote computer.
edly computes error Signals between the desired posi
tion command and the measured position of the rotor as 85. The motor and controller as in any One of claims 70
transmitted by the encoder, and reduces the error 25 to 80 inclusive, wherein Said proportional integral deriva
Signals to zero, Said microproceSSOr producing an tive (PID) servo control System operates is adapted to
actuation Signal to direct a proportional-integral operate at 5 kHz.
derivative (PID) filter connected to Said 86. A digitally servo controlled, integrated motor device,
microprocessor, said PID filter providing servo control comprising:
of a drive amplifier Supplying current to Said motor, a modular motor body housing a direct current servo
whereby the microprocessor via said PID filter oper motor having a rotor and a Stator,
ates as a position based, ServO System within the Second an encoder aSSOciated with Said ServO motor and adapted
housing to bring the rotor within the first housing to the to Sense incremental angular positions of Said rotor
desired position defined by the remote digital computer, with respect to Said Stator, Said encoded transmitting
Said controller having a length proportional to a length 35 incremental pOSition data corresponding to Sensed
of Said motor. motion of Said rotor, and
80. An integrated motor and controller to be operated by a modular control unit in the form of an encasement,
a digital computer through a communications port for removably connected to Said motor body in mating
bringing a rotor of the motor to a target position comprising, relationship there with, Said encasement housing a con
a servo controlled motor having a rotor disposed within 40 troller with a drive amplifier for Said motor whereby
a first housing, a rotor position encoder aSSOciated with Said motor, encoder, controller and drive amplifier form
the rotor, the encoder producing an electrical Signal a fully integrated compact unit within Said motor body
indicating the measured position of the rotor, and encasement, Said controller including a micropro
a controller having a microprocessor mounted within a ceSSOr in data communication with a communications
Second housing, the Second housing in mating relation 45 port On Said encasement to receive One Or more digital
to the first housing and electrically connected to the motion parameter commands from an external Source
rotor position encoder, the Second housing having a through Said port, available motion parameter com
Serial data communications port connectable to a mands that can be received including a Set Of Com
remote digital computer issuing a desired rotor posi mands that indicate a desired position, velocity and
tion command using Serial digital data, the micropro 50 acceleration of Said rotor, Said microproceSSOr also in
cessor having Software which receives desired position data communication with Said encoder to receive Said
commands through the communications port, repeat incremental position data transmitted from Said
edly computes error Signals between the desired posi encoder, Said microproceSSOr having means for digi
tion command and the measured position of the rotor as tally Storing Said received motion parameter
transmitted by the encoder, and reduces the error 55 commands, continually calculating and updating an
Signals to zero, Said microproceSSOr producing an actual rotor position from Said received incremental
actuation Signal to direct a proportional-integral position data, determining variations between the
derivative (PID) filter connected to Said desired position Or motion of Said rotor corresponding
microprocessor, said PID filter providing servo control to Said Stored motion parameter commands and the
of a drive amplifier Supplying current to Said motor 60 calculated actual pOSition of Said rotor, and producing
whereby the microprocessor via said PID filter oper an actuation Signal to direct motion of Said rotor in
ates as a fine resolution position based, ServO System accordance with Said motion parameter commands,
within the Second housing to bring the rotor within the Said controller also including a proportional-integral
first housing to the desired position defined by the derivative (PID) servo control System in closed loop
remote digital computer, Said mated motor and Con 65 data communication with Said encoder to receive Said
troller fitting in a lateral space the same as the motor incremental position data therefrom and in closed loop
would fit in alone. data communication with Said microproceSSOr to
US 5,912,541 C1
13 14
receive said actuation Signal therefrom, said PID Servo body in mating relationship therewith, Said encasement
control System adapted to Operate at a Service rate of housing a controller with a drive amplifier for Said
5 kHz and responsive to Said incremental position data motor whereby said motor, encoder, controller and
and Said actuation Signal to control Operation of Said drive amplifier form a fully integrated compact unit
drive amplifier, Said drive amplifier in electrical com with Said motor body and encasement, Said controller
munication with Said motor to Supply current to Said including a mirco-proceSSOr in data communication
Stator to move Said rotor in accordance with Said with a communications port On Said encasement to
motion parameter commands. receive One Or more digital motion parameter com
87. A digitally servo controlled, integrated motor device, mands from an external Source through Said port,
comprising: available motion parameter commands that can be
a modular motor body housing a direct current servo received including a Set of commands that indicate a
motor having a rotor and a Stator, desired position, velocity and acceleration of Said rotor,
an encoder aSSOciated with Said ServO motor and adapted Said microproceSSOr also in data communication with
to Sense incremental angular positions of Said rotor Said encoder to receive Said incremental position data
with respect to Said Stator, Said encoded transmitting 15 transmitted from Said encoder, Said microprocessor
incremental position data of at least 2000 incremental having means for digitally Storing Said received motion
angular positions corresponding to Sensed motion of parameter commands, continually calculating and
Said rotor, and updating an actual rotor position from Said received
a modular control unit in the form of an encasement, incremental position data, determining variations
removably connected to Said motor body in mating between the desired position or motion of Said rotor
relationship therewih, Said encasement housing a con corresponding to Said Stored motion parameter com
troller with a drive amplifier for Said motor whereby mands and the calculated actual pOSition of Said rotor,
Said motor, encoder, controller and drive amplifier form and producing an actuation Signal to direct motion of
a fully integrated compact unit within Said motor body Said rotor in accordance with Said motion parameter
and encasement, Said controller including a micropro 25 commands, Said controller also including a
ceSSOr in data communication with a communications proportional-integral-derivative (PID) servo control
port On Said encasement to receive One Or more digital System in closed loop data communication with Said
motion parameter commands from an external Source encoder to receive said incremental position data there
through Said port, available motion parameter com from and in closed loop data communication with Said
mands that can be received including a Set Of Com microproceSSOr to receive Said actuation Signal
mands that indicate a desired position, velocity and therefrom, Said PID Servo control System responsive to
acceleration of Said rotor, Said microproceSSOr also in Said incremental position data and Said actuation Sig
data communication with Said encoder to receive Said nal to control operation of Said drive amplifier, Said
incremental position data transmitted from Said drive amplifier in electrical communication with Said
encoder, Said microproceSSOr having means for digi 35 motor to Supply current to Said Stator to move Said
tally Storing Said received motion parameter rotor in accordance with Said motion parameter com
commands, continually calculating and updating an mands to the desired position, Said controller having a
actual rotor position from Said received incremental plurality of Stacked circuit boards.
position data, determining variations between the 89. The device of claims 84 to 88 further including first
desired position Or motion of Said rotor corresponding 40 and Second complementary connectors, with Said plurality
to Said Stored motion parameter commands and the of first connectors rigidly attached to and in electrical
calculated actual pOSition of Said rotor, and producing communication with Said motor body housing and Said
an actuation Signal to direct motion of Said rotor in plurality of Second connectors rigidly attached to in elec
accordance with Said motion parameter commands, trical communication with Said controller, said first and
Said controller also including a proportional-integral 45 Second plurality of connectors being coupled together, pro
derivative (PID) servo control System in feedback data viding electrical communication between said motor and
communication with Said encoder to receive Said incre Said controller:
mental position data therefrom and in data communi 90. A digitally servo controlled, integrated motor device,
cation with Said microproceSSOr to receive Said actua comprising:
tion signal therefrom, said PID ServO control System 50 a modular motor body housing a direct current servo
reponsive to Said incremental position data and Said motor having a rotor and a Stator,
actuation Signal to control operation of Said drive an encoder aSSOciated with Said ServO motor and adapted
amplifier, said drive amplifier in electrical communi to Sense incremental angular positions of Said rotor
cation with Said motor to Supply current to Said Stator with respect to Said Stator, Said encoded transmitting
to move Said rotor in accordance with Said motion 55 incremental pOSition data corresponding to Sensed
parameter commands to Said desired position. motion of Said rotor, and
88. A digitally servo controlled, integrated motor device, a modular control unit in the form of an encasement,
comprising: removably connected to Said motor body in mating
a modular motor body housing a direct current servo relationship there with, Said encasement housing a con
motor having a rotor and a Stator, 60 troller with a drive amplifier for Said motor whereby
an Optical encoder aSSOciated with Said ServO motor and Said motor, encoder, controller and drive amplifier form
adapted to Sense incremental angular positions of Said a fully integrated compact unit with Said motor body
rotor with respect to Said Stator, Said encoded trans and encasement, Said controller including a micro
mitting incremental position data corresponding to proceSSOr in data communication with a communica
Sensed motion of Said rotor, and 65 tions port On Said encasement to receive One or more
modular control unit in the form of an encasement, digital motion parameter commands from an external
removably connected by rigid connectors to Said motor Source through Said port, available motion parameter
US 5,912,541 C1
15 16
commands that can be received including a Set Of and Said microproceSSOr is also in Output data communica
commands that indicate a desired position, velocity and tion with Said remote computer to provide motor position
acceleration of Said rotor, Said microproceSSOr also in information to Said remote computer.
data communication with Said encoder to receive Said 96. The motor device of any One of claims 86 to 90
incremental position data transmitted from Said inclusive, wherein Said encoder comprises of an optical
encoder, Said microproceSSOr having means for digi encoder with Said control unit defining a receSS adapted to
tally Storing Said received motion parameter receive Said rotor and Said optical encoder upon Said
commands, continually calculating and updating an control unit being attached to said motor body, thereby
actual rotor position from Said received incremental Shielding Said encoder from ambient light.
position data, determining variations between the 97. The motor device of any One of claims 87 to 90
desired position Or motion of Said rotor corresponding inclusive, wherein Said PID operates at 5 kHz, whereby said
to Said Stored motion parameter commands and the encoder precisely determines a plurality of positions of Said
calculated actual pOSition of Said rotor, and producing
an actuation Signal to direct motion of Said rotor in rotor relative to Said Stator with fine precision.
accordance with Said motion parameter commands, 15 98. The motor device of any One of claims 86-90
Said controller also including a proportional-integral inclusive, wherein Said external Source is a remote computer
derivative (PID) servo control System in closed loop connected to a display.
data communication with Said encoder to receive Said 99. An integrated motor device, comprising:
incremental position data therefrom and in closed loop a body housing a direct-current servo controlled motor
data communication with Said microproceSSOr to having a rotor, a Stator, and means for determining a
receive said actuation Signal therefrom, said PID Servo position of Said rotor relative to said Stator,
control System responsive to Said incremental position an encasement housing a modular controller, with Said
data and Said actuation Signal to control operation of encasement removably connected to Said body, Said
Said drive amplifier, Said drive amplifier in electrical controller in electrical feedback communication with
communication with Said motor to Supply current to 25 bOth Said motor and Said position determining means
Said Stator to move Said rotor in accordance with Said and including a microproceSSOr, ServO means for Con
motion parameter commands to the desired position trolling a quantity of motion of Said rotor as directed by
with fine resolution, Said control unit fitting in a lateral Said microproceSSOr, and aSSOciated drive means
Space the Same as the motor would fit in alone. responsive to Said ServO means for producing Said
91. The motor device of any One of claims 86 to 90 motion of Said rotor, and
inclusive, further including first and Second complementary means for Synchronizing Said controller with a controller
connectors, with Said first connector rigidly attached to and of at least One Other like integrated motor device,
in electrical communication with Said motor body housing whereby a plurality of integrated motor devices may be
and Said Second connector rigidly attached to in electrical Synchronously interconnected.
communication with Said control unit, Said first and Second 35
100. An integrated motor device, comprising:
connectors being coupled together, providing electrical
communication between said motor and Said controller. a body housing a direct-current servo controlled motor
92. The motor device of claim 91, wherein One of said first having a rotor, a Stator, and means for determining a
connector or Second connector further including a plurality position of Said rotor relative to said Stator,
of rigid pins protruding, and the Other of Said connectors 40 an encasement housing a modular controller, with Said
including a plurality of corresponding holes to form a encasement removably connected to Said body, Said
plurality of wireless connections, with Such electrical com controller in electrical feedback communication with
munication between Said motor and Said controller Occur bOth Said motor and Said position determining means
ring through said plurality of wireless connections. and including a microproceSSOr having a proportional
93. The motor device of any One of claims 86 to 90 45 integral-derivative (PID) filter, Servo means for con
inclusive, wherein Said microprocessor is adapted to further trolling a quantity of motion of Said rotor as directed by
receive other commands corresponding to desired motor Said microprocessor via Said PID filter, and associated
motion that are selected from the group consisting of relative drive means responsive to Said ServO means for pro
rotor position, maximum allowable velocity, rotor ducing Said motion of Said rotor, and
acceleration, torque magnitude and drive current limit. 50 means for Synchronizing Said controller with a controller
94. The motor device of claim 91 wherein Said desired of at least One Other like integrated motor device,
rotor position command and Said Other commands have up whereby a plurality of integrated motor devices may be
to a 32-bit resolution. Synchronously interconnected.
95. The motor device of any One of claims 86 to 90
inclusive, wherein Said external Source is a remote computer,

You might also like