BACKGROUND OF THE INVENTION
Field of the Invention
The present invention relates, in general, to stepper motors and, more specifically, to stepper motor control apparatus.
Description of the Art
Stepper motors are widely employed to move an object a selected distance at a selected speed. Such stepper motors enable a machine or other apparatus to be reconfigured or to execute various steps in a predetermined order or operation.
However, conventional stepper motor control apparatus employ a single stepper motor driver for each stepper motor. This results in an expensive control apparatus due to the high cost of the stepper motor drivers as well as the increased space requirement to mount such drivers in a control panel.
It would be desirable to provide a stepper motor control apparatus which overcomes these problems. It would also be desirable to provide a stepper motor control apparatus which is less costly than conventional stepper motor control apparatus. It would also be desirable to provide a stepper motor control apparatus which enables a plurality of stepper motors to be selectively connected to a single stepper motor driver. Finally, it would be desirable to provide a stepper motor control apparatus which enables a plurality of stepper motors to be selectively connected, either singly or in selectible groups, to one or more stepper motor drivers.
SUMMARY OF THE INVENTION
The present invention is a multiplexed stepper motor control apparatus which controls a plurality of stepper motors.
The apparatus includes a plurality of selectively energizable stepper motor drivers which supply electrical energy in the form of a pulse width modulated series of pulses to one or more stepper motors to determine the amount of movement, the direction of movement and the speed of movement of the stepper motor output. A stepper motor controller in the form of a multi-axis position controller receives commands from a computer executing a control program to selectively energize certain stepper motor drivers.
The apparatus of the present invention includes multiplexor means for selectively connecting certain stepper motors to certain stepper motor drivers, with one stepper motor driver being capable of being connected to a plurality of stepper motors. The multiplexor means comprises a switching circuit formed of relay contact sets selectively controlled by commands from a control computer. The relay contact sets are connected between certain drivers and certain stepper motors such that when energized by the control computer, one or more stepper motors may be operably energized by a single driver. This significantly reduces the cost of stepper motor control apparatus as compared to conventional stepper motor control apparatus since a single driver may be uniquely connected to a plurality of stepper motors instead of the conventional one driver to one stepper motor arrangement.
In another embodiment, a plurality of relays are provided in a number sufficient to enable each stepper motor to be selectively connected under program control of the control computer to any of the drivers. This adds greater flexibility to the stepper motor control apparatus since the operation of the apparatus may be varied under user control to create different modes of operation including simultaneous energization of certain stepper motors in selectible groups.
The stepper motor control apparatus of the present invention also includes means for storing the actual position of each of the stepper motors. This data may be recalled to move the stepper motors to the previously stored position to replicate a certain configuration for the apparatus controlled by the stepper motors.
The stepper motor control apparatus of the present invention significantly reduces the costs associated with such stepper motor control apparatus since the number of expensive drivers is reduced by uniquely connecting a single driver to a plurality of stepper motors. A less expensive multiplexor circuit including relays, for example, is employed to effect selective connection of parallel arranged stepper motors to a single driver.
BRIEF DESCRIPTION OF THE DRAWING
The various features, advantages and other uses of the present invention will become more apparent by referring to the following detailed description and drawing in which:
FIG. 1 is a pictorial representation of a stepper motor employed to move an object along a predetermined path;
FIG. 2 is a block diagram of the multiplexed stepper motor control apparatus of the present invention;
FIG. 3 is a block diagram of a portion of the apparatus shown in FIG. 2;
FIG. 4 is a block diagram showing another portion of the apparatus depicted in FIG. 2;
FIG. 5 is a schematic diagram showing a portion of the multiplexor circuit of the present invention;
FIG. 6 is a schematic diagram showing another portion of the multiplexor circuit of the present invention; and
FIG. 7 is a schematic diagram showing another embodiment of the multiplexor circuit of the present invention.
DESCRIPTION OF THE PREFERRED EMBODIMENTS
Referring now to the drawings, there is depicted a multiplexed stepper motor control apparatus which controls a plurality of stepper motors with a lesser number of individual stepper motor drives.
For clarity in understanding the features and advantages of the present invention, a brief description of a typical environment in which the present apparatus could be advantageously employed is depicted in FIG. 1.
In FIG. 1, a conventional stepper motor 10 is illustrated. The stepper motor 10 has a bi-directional rotatable output shaft 12 extending therefrom. A gear or transmission means 14 may be coupled to the output shaft 12 for providing gear reduction for increased torque or for changing the axis of motion of the output shaft 12. A shaft 16 extends from the gear means 14 to a drive means 18, such as an electric cylinder. As is well known, such cylinders have a bi-directional rotatable output screw. A nut or seat 22 is mounted on the screw and travels linearly in either direction along the screw as the screw 20 is rotated clockwise or counterclockwise. A suitable mounting means, such as a bracket 24, is connected to the seat 22 and supports an object 26 to be reciprocatingly moved.
In order to define the positions of the object 26, suitable position sensors are provided. Such position sensors include a HOME limit switch 28 which detects the normal or design position of the object 26. In addition, a CW TO limit switch 30 is mounted at the maximum travel distance of the object 26 when the screw 20 is rotated in a clockwise direction. Another switch 32 labelled CCW OT is provided at a maximum travel distance of the object 26 when the screw 20 is rotated in a counterclockwise direction.
Referring now to FIG. 2, there is depicted a block diagram of the multiplexed stepper motor control apparatus 40 of the present invention. The apparatus 40 includes a computer 42 which may be any conventional computer, such as an IBM compatible computer or a VME compatible computer. The computer 42 includes internal and/or external memory 44 for storing control programs and data. A keyboard 46 provides user inputs to the computer 42 and a conventional display or monitor provides menu selection for a user.
The computer 42 is connected to a programmable multi-axis controller 50 which provides multiple axis stepper motor control. Any conventional multi-axis controller 50 may be employed in the present invention. By way of example only, a programmable multi-axis controller sold by Delta Tau Data Systems, Inc., of Canoga Park, Calif., Model No. PMAC-VME(DSP) is employed to provide control of up to eight axes. Upon commands from the computer 42, the programmable multi-axis controller 50 will generate a pulse train containing of a predetermined number of pulses at a pulse width modulated frequency to drivers 52 for the stepper motors 56. The drivers 52, as described hereafter, convert the pulses from the programmable multi-axis controller 50 to electrical current of a prescribed polarity, duration and frequency for application to the individual stepper motors 56.
According to the present invention, a unique multiplexor or switching circuit 54 is provided to selectively connect one or more or any one of the stepper motors denoted in general by reference number 56 in FIG. 2 to one of the drivers 52. The multiplexor circuit 54 also selects the individual HOME, CW OT and CCW OT signals associated with the previously selected stepper motor for transmission to the computer 42.
As shown in greater detail in FIG. 3, the programmable multi-axis controller 50, in the example described above, includes three separate circuit boards, namely, a VME PMAC board 60, a terminal board 62 and a stepper controller board 64, all forming a part of the controller sold by Delta Tau Data Systems, Inc. The circuitry on the circuit boards 60, 62 and 64 are connected via cables to provide the desired output signals to the individual drivers 52 and to the multiplexor circuit 54. Upon receiving a user input specifying a predetermined amount of travel advance of one of the driven members, such as the object 26 shown in FIG. 1, the computer 42 will convert the input distance to a number of pulse steps or counts. This information is provided to the programmable multi-axis controller 50 which converts the pulse count to a series of pulses at a pulse width modulated frequency which determines the speed of rotation of the output shaft of the stepper motor driven by the selected stepper motor.
The stepper controller board 64 of the controller 50 generates a set of signals for each driver labelled "STEP+, STEP-, DIRECTION+, DIRECTION-, SHUTDOWN+ and SHUTDOWN-. These signals are output on separate cables to each driver 52.
As shown in FIG. 4, each driver is connected to a suitable source of 120 VAC electric power and receives one of the cables from the multi-axis controller 50. Any suitable stepper motor driver may be employed in the present invention. By way of example only, a stepper motor driver suitable for electric cylinder control and manufactured by Industrial Controls Corporation, Navato, Calif., Model No. S5101, is employed in the present invention. This driver is capable of driving four, six or eight lead motors.
In the present invention, four drivers 68, 70, 72 and 74 are employed. Each of the drivers 68, 70, 72 and 74 receives a separate cable from the multi-axis controller 50 containing the appropriate control signals described above. Each driver then outputs electric current on conductors labelled "A+, A-, B+, B- and GND to the multiplexor circuit 54. Each driver 68, 70, 72 and 74 is energized by the controller 50 either independently or simultaneously in combination with other drivers.
The multiplexor circuit 54 contains a plurality of switch devices, such as relays. A first set of soft start relays labelled S1, S2, S3 and S4 are selectively energized by control signals from the computer 42. As shown in FIGS. 4 and 5, the contacts 1S1, 1S2, 1S3 and 1S4 associated with each of the soft start relays S1, S2, S3 and S4, respectively, are connected between the individual output signal lines of each driver 68, 70, 72 and 74 to the remaining circuitry for the stepper motors M1-M6. The purpose of the soft start relays S1, S2, S3 and S4 is to provide isolation from voltage surges or spikes which could damage the other contacts in the multiplexor circuit 54, described hereafter, or the stepper motors.
Also contained in the multiplexor circuit 54 are three select relays labelled R1, R2 and R3. The select relays R1, R2 and R3 provide selection, under computer 42 control, of the energization of a selected one of the stepper motors M1-M6. The use of such select relays R1, R2 and R3, which may be provided in any number, enables a plurality of stepper motors to be connected in parallel to a single driver, such as the stepper motors M1 and M2 which are connected in parallel to the first driver 68, so as to reduce the number of drivers required for the number of stepper motors in a particular control system.
The multiplexor circuit shown in FIG. 5 is provided by way of example. It will be understood that other arrangements may be provided to connect any number of stepper motors to a particular driver and to energize such stepper motors individually, one at a time.
Thus, as shown in FIG. 5, when the relay R1 is energized by a command from the computer 42, its contacts labelled 1R1 will close thereby connecting the stepper motors connected thereto, such as stepper motors M1, M3 and M6 in FIG. 5 to the respective driver, such as drivers 68, 70 and 74, for simultaneous energization of the stepper motors M1, M3 and M6. Likewise, the contacts 1R2 of the select relay R2 are connected in parallel with the contacts 1R1, but are individually connected to stepper motors M2 and M4. In this manner, when the select relay R1 is de-energized and the select relay R2 energized, stepper motors M2 and M4 are energized by the first and second drivers 68 and 70; while stepper motors M1 and M3 remain de-energized. The contacts 1R3 of the third select relay R3 are connected between the soft start contacts 1S1, the third driver 72 and stepper motor M5.
Alternate configurations in which six select relays may be provided for six stepper motors, with the individual contacts of each select relay being connected in parallel with the contacts of the other select relays to a single driver. In this manner, a single driver controls any number of individual stepper motors thereby eliminating the cost of separate drivers for each stepper motor.
FIG. 6 depicts the connection of the home and over-travel limit switches of each of the stepper motors M1-M6 as to the computer 42. Contacts from additional relays R4, R5 and R6 are provided for each set of HOME and over-travel limit switches associated with each stepper motor M1-M6. Thus, contacts 1R4 of the select relay R4 are connected in series with the CW OT, CCW OT and HOME limit switches associated with the first stepper motor M1. A set of 1R5 contacts from select relay R5 are likewise associated with the CW OT, CCW OT and HOME limit switches of the second stepper motor M2. These serial pairs are connected in parallel to common output conductors denoted generally by reference number 80. These signals are input to the computer 42 to enable the computer 42, when executing its control program, as described hereafter, to establish the travel limits and the HOME position of the object driven by each stepper motor.
As also shown in FIG. 6, additional sets of 1R4 and 1R5 contacts are connected in series with the over-travel and home limit switches associated with the third and fourth stepper motors M3 and M4, respectively. These signals are connected in parallel to a common group of output conductors 82 which are input to the computer 42. Similar over-travel and HOME signals are also provided on conductors 84 and 86 for stepper motors M5 and M6.
The control program stored in the memory 44 of the computer 42 is designed to control the amount, direction and speed of rotation of the output shaft 12 of each stepper motor under program control of a user. In initiating each movement of a stepper motor output shaft, the control program executed by the computer 42 follows a predetermined sequence to prevent surges or voltage spikes from damaging the multiplexor circuitry 54. Specifically, the computer 42, before energizing a stepper motor, will activate the shut-down input of the multi-axis controller 50 to turn off power to the driver associated with a particular axis of the controller 50. The computer 42 then de-energizes the appropriate soft start relay S1, S2, S3 or S4, as described above, thereby opening the respective contacts of the soft start relay. This isolates the driver connected to the soft start relay contacts from the multiplexor circuitry 54 and connected stepper motor. Next, the computer 42 generates appropriate signals energizing one or more of the select relays R1, R2 and R3 and then energizes the soft start relay S1-S4 associated therewith. The shut-down signal is then turned off to enable current to be supplied to the stepper motor from the associated driver.
In operation, the computer 42 executes its control program and generates a succession of menus on the display 48 providing the user with various options in moving the device or object attached to each stepper motor in a preferred amount or direction. The first menu is an Options Menu and contains various selections as follows:
This provides the user with access to other menus for various control functions.
When the operator selects F1, the computer 42 will generate a Motor Parameter Menu which contains pre-programmed speed of the movement as well as the maximum and minimum positions corresponding to maximum and minimum over-travel positions for each of the stepper motors M1-M6. An example of such a Motor Parameter Menu is set forth below:
It is noted that the minimum and maximum positions and the speed set forth in the Motor Parameter Menu have been preprogrammed or may be altered by the user. These values may be changed by the user by entering new data via the keyboard 46. The positions are set forth in millimeters and define an actual position on the object or apparatus being moved by the stepper motors. Speed is depicted as a relative value on a scale of 0 to 12 for example, with 12 representing the fastest speed possible.
When the operator selects option F2, the control program generates an Axis Jog Menu as set forth below:
The Axis Jog Menu repeats the pre-stored minimum and maximum positions for each axis as well as the current position in millimeters of the object on each axis. The user may select one of the axes for movement and, via the incrementing and decrementing keys on the keyboard 46, generate commands to the computer 42 to jog the stepper motor associated with the selected axis in a clockwise or counterclockwise direction in response to repeated incrementing or decrementing key inputs. In this manner, the user move a particular stepper motor to a desired position.
Another menu selection labelled F3 enables the user to move the object associated with a selected stepper motor to its HOME position. The Axis Home Menu appears as:
This menu also repeats the minimum and maximum positions for each of the axes as well as the current position of the object on each axis. When a particular axis is selected by the user via the keyboard 46, the computer 42 will generate appropriate commands to the controller 50, drivers 52 and selected stepper motors M1-M6 which result in an automatic movement of the selected stepper motor to its HOME position. During such homing movement, the selected stepper motor is driven in a counterclockwise direction until the CCW OT limit switch associated therewith is struck. The selected stepper motor is then reversed and driven in a clockwise direction until the HOME limit switch is made. This represents the 0.0 current position shown in the Axis Home Menu. This menu provides selective homing of each axis independent of the other. If option F4 is selected, the same menu screen as set forth above for the Axis Home Menu will be displayed. When automatic homing is selected by the user via an input from the keyboard 46, the computer 42 will automatically home each axis in succession.
When option F5 is selected, a menu labelled Axis Position will be displayed. This menu contains desired, actual and initial position data for each axis as set forth below:
(Although 0's are displayed in the menu for each desired, actual and initial position, the actual position of each object associated with each stepper motor M1-M6 will be displayed in this menu on the display or monitor 48.
The F5 option enables the user to store the actual positions for each axis under a particular file name for recall at a later time. This information can be recalled from memory whenever the F5 option is selected. When the appropriate file has been recalled, an Axis Position Menu, as set forth above will be generated by the computer 48. This menu sets forth the actual position of each axis as well as the initial position of each axis previously stored in the memory 44. The user via appropriate keys on the keyboard 46 may then input a desired position for one or more axes and, when an enter command is generated, the computer 42 will generate appropriate commands to move the selected stepper motor(s) the desired amount. This new position can then be saved as an initial position for future recall.
The last two menus F6 and F7 provide data for comments associated with a particular stored file as well as a listing of all of the stored file names.
It should be noted that the connections between the soft start contacts 1S1-1S4 and the individual select relay contacts for each of the stepper motors M1-M6 are hard-wired in the embodiment shown in FIG. 5. This dedicates each select relay and associated stepper motor to a particular driver.
Greater flexibility can be obtained by bussing the connections between the outputs of the drivers 68, 70, 72 and 74 and the individual stepper motors M1-M6 as shown in FIG. 7. In the embodiment shown in FIG. 7, twenty-four relays, each having a set of four contacts and respectively labelled A1-A24, are provided. Each set of contacts A1-A24 is individually connected between the soft start contacts of each driver 68, 70, 72 and 74 and each stepper motor M1-M6. These connections may be hard-wired connections or, preferably, bus connections on a circuit board on which the relays containing the contact sets A1-A24 are mounted.
This arrangement provides selective control of the connections between each of the drivers 68, 70, 72 and 74 and each of the stepper motors M1-M6. The relays A1-A24 may be individually energized or energized in groups of two or more simultaneously to effect different operations of the apparatus controlled by the stepper motor control apparatus 10 of the present invention. As one set of contacts A1-A24 is connected between the first driver 68 and each of the motors M1-M6, successive energization of relays A1, A5, A9 and A13 will enable the first driver 68 to sequentially drive all six stepper motors M1-M6. Different stepper motors may be energized by merely energizing different relays A1-A24.
In summary, there has been disclosed a unique multiplexed stepper motor control apparatus which significantly reduces the number of stepper motor drivers required to control a plurality of stepper motors. The present apparatus enables a single driver to individually control a plurality of stepper motors thereby effecting a significant cost savings over conventional stepper motor control apparatus.