Stepping motor control system and method for controlling a stepping motor using closed and open loop controls

• US 20070040529A1
• Filed: 08/19/2005
• Published: 02/22/2007
• Est. Priority Date: 08/19/2005
• Status: Abandoned Application

• Current Assignee: SMC Corporation of America (Alamo Group Incorporated)
• Original Assignee: SMC Corporation of America (Alamo Group Incorporated)
• Inventors: Takebayashi, Takashi, Tomov, Pavel, Cho, David, Gokhale, Dipen
• Application Number:
  US11/206,943
• Publication Number:
  US 20070040529A1
• Time in Patent Office: Days
• US Class Current: 318/685
• CPC Class Codes: G05B 19/40 Open loop systems, e.g. using stepping motor
• CPC Class Codes: G05B 2219/42122 First open loop, then closed loop
• CPC Class Codes: G05B 2219/43083 Structure, step motor
• CPC Class Codes: H02P 23/20 Controlling the acceleration or deceleration
• CPC Class Codes: H02P 8/005 of linear motors
• CPC Class Codes: H02P 8/08 Determining position before starting
• CPC Class Codes: H02P 8/22 Control of step size; Intermediate stepping, e.g. microstepping

Abstract

A stepping motor is driven in both closed-loop and open-loop modes while initiating microstepping after a predetermined threshold velocity has been reached. A feedback device such as an encoder is mounted on the stepping motor shaft and the encoder keeps track of the mechanical position of the rotor. Based on feedback from the encoder, stator phases are activated to maintain a 90° phase advance and produce maximum torque. A lead angle compensation technique is used to advance the motor lead angle, to allow for the excitation currents to reach maximum even at higher speeds. The stepping motor controller employs this strategy in order to produce maximum torque across a wide range of motor speeds and actuator motions.

Claims

1. A stepping motor control system, comprising:

a stepping motor with an encoder connected to said stepping motor;

a current and phase compensation controller, which receives an output from said encoder, wherein said controller implements a lead angle compensation routine, microstepping and full-step motor driving modes during closed-loop driving of said stepping motor, and an open-loop position holding mode when said stepping motor is at rest;

a trajectory generator for sending a velocity motion profile to said current and phase compensation controller, said motion profile having rest, acceleration and constant velocity stages,

wherein when said stepping motor moves at a velocity lower than a predetermined velocity threshold, said stepping motor is operated in the microstepping driving mode, and when said stepping motor moves at a velocity above said velocity threshold, said stepping motor is operated in the full-step driving mode.

2. The stepping motor control system according to claim 1, further comprising:

a velocity feedback loop comprising a velocity estimator connected to said encoder and which outputs an estimated velocity based on a position signal output from said encoder, a PI (proportional and integral) gain block which compares the estimated velocity with a commanded velocity output by said trajectory generator, wherein said PI gain block outputs a velocity error signal to said current and phase compensation controller; and

a position feedback loop comprising a P (proportional) gain block connected to said encoder and which compares the position signal output from said encoder with a commanded position output by said trajectory generator, wherein said P gain block outputs a position error signal to said PI gain block of said velocity feedback loop,

wherein said position feedback loop includes a switch for opening and closing said position feedback loop, said switch being opened to initiate said open-loop position holding mode when said stepping motor is at rest.

3. The stepping motor control system according to claim 1, wherein said stepping motor comprises a two-phase stepping motor, said current and phase compensation controller outputting a pair of stator phase current signals (IA, IB) respectively to an excitation circuit for A and B phase windings of said stepping motor, and outputting a pair of phase current direction signals (PA, PB) respectively to said excitation circuit.

4. The stepping motor control system according to claim 2, further comprising a lead angle compensator connected to said velocity estimator, and which outputs a lead angle compensation signal (ν

) to said current and phase compensation controller, wherein said lead angle compensation signal increases depending on the rotational speed of said stepping motor.

5. The stepping motor control system according to claim 1, wherein said stepping motor is contained in an actuator making up one of a plurality of actuators of a multi-axis actuator setup, each of said actuators being connected to respective motor controllers.

6. The stepping motor control system according to claim 5, further comprising a human machine interface (HMI) program for supplying control parameters to each of said respective motor controllers.

7. The stepping motor control system according to claim 6, wherein each of said respective motor controllers stores a hardware identification ID therein, and said human machine interface program reads said hardware identification ID from each of said motor controllers and displays a control screen for each respective motor controller.

8. A method for controlling a stepping motor connected to an encoder, comprising the steps of:

supplying a velocity motion profile, said motion profile having rest, acceleration and constant velocity stages, for driving said stepping motor;

holding said stepping motor in an open-loop position holding control mode when said stepping motor is at rest;

driving said stepping motor in a closed-loop microstepping mode when said stepping motor moves at a velocity lower than a predetermined threshold velocity; and

driving said stepping motor in a closed-loop full-step mode when said stepping motor moves at a velocity higher than said predetermined velocity threshold.

9. The method according to claim 8, said stepping motor comprising a two-phase stepping motor, wherein prior to entering an initial closed-loop driving mode, alignment and base offset measurement of said stepping motor are performed, comprising the steps of:

exciting respective phase windings of said stepping motor with equal excitation current magnitudes, IA=I_R sin ((2π

/16)2) and IB=I_R sin ((2π

/16)2−

π

/2), wherein I_R is a predetermined rated current;

determining a number of microsteps (n) required for mechanical alignment of said stepping motor;

rotating said stepping motor in said open loop mode, until a reference home position of said actuator is detected while counting a number of pulses (k) required to reach said reference home position, wherein the respective excitation currents IA and IB become IA=I_R sin ((2π

/16)2±

(2π

/16)n±

(2π

/16)k) and IB=I_R sin ((2π

/16)2−

π

/2±

(2π

/16)n±

(2π

/16)k); and

advancing the excitation currents IA and IB by a predetermined number of counts in order to maximize driving torque, whereupon said stepping motor goes into an initial open loop position holding mode.

10. The method according to claim 9, wherein the step of determining the number of microsteps (n) required for mechanical alignment further comprises reading current signal states of respective phases of said stepping motor, and determining said number of microsteps (n) from a motor commutation table.

11. The method according to claim 9, wherein the step of determining the number of microsteps (n) required for mechanical alignment further comprises rotating said stepping motor in an open loop mode until an index pulse is detected, while said microsteps (n) are determined by counting a number of pulses required to reach said index pulse, wherein the respective excitation currents IA and IB become IA=I_R sin ((2π

/16)2±

(2π

/16)n) and IB=I_R sin ((2π

/16)2−

π

/2±

(2π

/16)n).