chapter 1 stepper motor control - purdue engineeringwasynczu/ee423n/step_motor_control.pdf ·...

22
Class notes for EE423, © O. Wasynczuk,1998 1 CHAPTER 1 Stepper Motor Control 1.1 PULLOUT TORQUE Stepper motors are desirable in that they are readily interfaced with digital circuitry and do not require any position sensors or feed- back control system to achieve position control. Instead, it is assumed that the motor takes exactly one step per step command. However, if too large a load torque is applied, or if the stepping rate is set too high or changed too fast, the motor can ‘lose step’ whereupon future behav- ior will be unpredictable. During the design stage, it is necessary to en- sure that this does not occur. This requires knowledge of how much torque can be produced by a stepper motor at any given stepping rate (speed). This torque, known as the pullout torque, is dependent upon the type of drive circuit used. Typically, the drive can be classified as either current controlled or voltage controlled. Current Controlled Drives Suppose we have an excitation sequence of , The idealized winding currents in a current controlled drive i as i bs i as , , i bs ,

Upload: others

Post on 21-Mar-2020

10 views

Category:

Documents


0 download

TRANSCRIPT

CHAPTER 1 Stepper Motor Control

1.1 PULLOUT TORQUEStepper motors are desirable in that they are readily interfaced

with digital circuitry and do not require any position sensors or feed-back control system to achieve position control. Instead, it is assumedthat the motor takes exactly one step per step command. However, iftoo large a load torque is applied, or if the stepping rate is set too highor changed too fast, the motor can ‘lose step’ whereupon future behav-ior will be unpredictable. During the design stage, it is necessary to en-sure that this does not occur. This requires knowledge of how muchtorque can be produced by a stepper motor at any given stepping rate(speed). This torque, known as the pullout torque, is dependent uponthe type of drive circuit used. Typically, the drive can be classified aseither current controlled or voltage controlled.

Current Controlled DrivesSuppose we have an excitation sequence of ,

The idealized winding currents in a current controlled drive

ias ibs ias–, ,

ibs– …,

Class notes for EE423, © O. Wasynczuk,1998 1

Stepper Motor Control

2

will be square waves as shown in Fig. 1.1-1. Let us denote

= stepping rate (steps/sec)

= period of one step

= fundamental frequency of winding currents

For two-phase device ,

(1.1-1)

The fundamental component of the stator currents may be expressedas

(1.1-2)

t

ias

ibs

Ts

t = 0FIGURE 1.1-1. Idealized winding currents for constant stepping rate with current-controlled drive.

fs

Ts 1 fs⁄=

ωe

N 2=

ωe2π4Ts--------- 2π

4------fs

πfs2

-------= = =

ias 1, 2Is θesicos=

Class notes for EE423, © O. Wasynczuk,1998

(1.1-3)

where, in general,

(1.1-4)

Here, is the frequency of the currents and is the instantaneousangle or “position” of the stator currents. Transforming the fundamen-tal components of and into the rotor reference frame using(8.8-1) of EE321 text,

(1.1-5)

where the carrot symbol is used to denote the fact that only the fun-damental components of the stator currents are considered. The higer-order harmonic components can also produce torque; however, theelectromagnetic torque produced by the higer-order harmonics will, ingeneral, be smaller than that produced by the fundmaental compo-nents. Therefore, they will be neglected in this analysis. Using (8.8-18) of EE321 text,

(1.1-6)

where

(1.1-7)

For steady-state operation at a constant stepping rate,(1.1-8)

(1.1-9)

ibs 1, 2Is θesisin=

θesi ωe ξ( ) ξd0

t∫ θesi 0( )+=

ωe θesi

ias ibs

iqsr ias 1, RTθrm( )sin– ibs 1, RTθrm( )cos+

2Is θesi RTθrm–( )sin

=

=

Te RTλm′ 2Is θesi RTθrm–( )sin

RTλm′ 2Is RT θrm

θesiRT---------–

sin–

=

=

θrm ωrm ξ( ) ξd0

t∫ θrm 0( )+=

θesi ωet θesi 0( )+=

θrm ωrmt θrm 0( )+=

Class notes for EE423, © O. Wasynczuk,1998 3

Stepper Motor Control

4

whereupon (1.1-6) becomes

(1.1-10)

For all speeds except , the temporal average (aver-

age with respect to time) of will be zero (since is a sinusoidalfunction of time) and, if the load torque is nonzero, the motor cannotoperate steadily at a constant speed. The only speed at which the motorcan produce a nonzero average torque is denote as the synchronousspeed,

(1.1-11)

At synchronous speed, (1.1-10) becomes

(1.1-12)

The maximum torque that can be developed at synchronous speed is

(1.1-13)

which is the pullout torque for ideal current-controlled drives. It is in-teresting to note that this pullout torque is independent of the steppingrate.

Dynamic response due to change in load torqueIt is possible to express (1.1-10) in terms of the pullout torque

as(1.1-14)

Te RTλm′ 2Is RT ωrm

ωeRT--------–

t θrm 0( )θesi 0( )

RT-----------------–+sin–=

ωrm ωe RT( )⁄=

Te Te

ωrm sync,ωeRT--------

2πfs2N RT( )---------------------- SL( )fs

=

= =

Te RTλm′ 2Is RT θrm 0( )

θesi 0( )RT

-----------------– sin–=

Te(po) RTλm' 2Is=

Te Te po( ) RTδri( )sin–=

Class notes for EE423, © O. Wasynczuk,1998

where

(1.1-15)

Suppose is constant, , and . Since

, the integrand of (1.1-15) is zero. Thus, is con-

stant in the steady state. What is equilibrium value of ? Well, it's

whatever it has to be so that . From Fig. 1.1-2, the sta-

ble equilibrium is .

Now suppose that at , is stepped from zero to some positive

value less than . Since can't change instantaneously ( is

related to the rotor position which cannot change instantaneously),

δri θrmθesiRT---------–

ωrmωeRT--------–

τd0

t∫ θrm 0( )

θesi 0( )RT

-----------------–+

=

=

ωe TL 0= ωrm ωe RT( )⁄=

ωrm ωe RT( )⁄= δri

δri

Te TL 0= =

δri 0=

Stable equilibrium

T e (po)

TP /2δ ri

−TP /2

Te

FIGURE 1.1-2. Torque versus , zero load torque.δri

δri θrmθesiRT---------–

ωrmωeRT--------–

τd0

t∫ θrm 0( )

θesi 0( )RT

-----------------–+

=

=

t 0= TL

Te po( ) δri δri

Te

Class notes for EE423, © O. Wasynczuk,1998 5

Stepper Motor Control

6

also can't change instantaneously. Thus, will be momentarily larg-

er than causing to decrease. The integrand of (1.1-15) be-

comes negative causing to decrease. From Fig. 1.1-2, will

increase. Equilibrium established when as shown in Fig.1.1-3.

Example A

Consider 2-phase PM stepper motor with:RT = 50

Assume , , and . Evaluate

, , , and . Establish the maximum that can

be applied at the given .Solution:

TL

Te ωrm

δri Te

Te TL=

−TP /2 TP /2δ ri

Stable equilibrium

TL

T e (po)Te

FIGURE 1.1-3. Torque versus , .δri 0 TL Te po( )≤ ≤

Bm 0.001 N m⋅ sec⁄=

λm′ 0.00226 V s⋅ rad⁄=

2Is 1 A= fs 200 steps/sec= TL 0=

ωe ωrm Te δri TL

fs

Class notes for EE423, © O. Wasynczuk,1998

(A.1)

(A.2)

(A.3)

In the steady state,

= 0 + (0.001)(6.28) = 0.00628 N⋅m (A.4)

(A.5)

Now and . Thus,

the maximum that can be applied is

for the given .

Voltage Controlled DrivesIn an ideal voltage controlled drive, the winding voltages will

be ideal square waves as shown in Fig. 1.1-4. Neglecting harmonics, (1.1-16)

(1.1-17)

where

(1.1-18)

Transforming into the rotor reference frame,

SL 180o

RT( )N------------------- 180o

50( )2-------------- 1.8o= = =

ωeπfs2

------- 3.14( ) 200( )2

----------------------------- 314 rad/sec= = =

ωrmωeRT-------- 314

50--------- 6.28 rad/sec= = =

Te TL Bmωrm+=

Te RTλm′ 2Is RTδri( )sin–

0.113 50δri( )sin– 0.00628 N m⋅

== =

δri 3.2o=

Te po( ) 0.113 N m⋅= Bmωrm 0.00628 N m⋅=

TL 0.113 0.00628– =

0.107 N m⋅ fs

vas 1, 2Vs θesvsin–=

vbs 1, 2Vs θesvcos=

θesv ωe ξ( ) ξd0

t∫ θesv 0( )+=

Class notes for EE423, © O. Wasynczuk,1998 7

Stepper Motor Control

8

(1.1-19)

(1.1-20)

Let us define

(1.1-21)

Thus, (1.1-19) and (1.1-20) become

vas

vbs

Ts

t

0

FIGURE 1.1-4. Idealized winding voltages for constant stepping rate.

vqsr vas 1, RTθrm( )sin– vbs 1, RTθrm( )cos+

2Vs θesv RTθrm–( )cos=

=

vdsr vas 1, RTθrm( )cos vbs 1, RTθrm( )sin+

2Vs θesv RTθrm–( )sin–=

=

φv θesv RTθrm–

ωe ζ( ) RTωrm ζ( )–[ ] ζd0

t∫ θesv 0( ) RTθrm 0( )–+

ωe ζ( ) RTωrm ζ( )–[ ] ζd0

t∫ φv 0( )+

=

=

=

Class notes for EE423, © O. Wasynczuk,1998

(1.1-22)

(1.1-23)

These are the same relations as for a brushless dc motor; however, un-like a brushless dc motor, is not under our direct control. What then

determines ? Suppose, for example, that we have a stepper motorwith

RT = 50

Let us determine and the maximum that can be applied.

(1.1-24)

(1.1-25)

With reference to (7.6-9) of EE321 text, (with P/2 replaced by RT and

by

(1.1-26)

vqsr 2Vs φvcos=

vdsr 2Vs φvsin–=

φv

φv

rs 10 Ω=

λm′ 0.00226 V s⋅ rad⁄= Lss 1.1 mH=

fs 300 steps/sec= TL 0=

Vs 10 V(rms)=

φv TL

ωeπfs2

------- 3.14( ) 300( )2

----------------------------- 471 rad/sec= = =

ωrmωeRT-------- 471

50--------- 9.42 rad/sec= = =

ωr RTωrm

Te RTλm

′ rs

rs2 RTωrm( )2Lss

2+------------------------------------------------ Vqs

r RTωrmLssrs

-----------------------------Vdsr– RTωrmλm

′–=

Class notes for EE423, © O. Wasynczuk,1998 9

Stepper Motor Control

10

(1.1-27)

Equation (1.1-27) is plotted in Fig. 1.1-5. Now, since ,

(from figure, choose for stable operating point)

Te 50 0.00226( )10

102 50 9.42×( )2 1.1 10 3–×( )2

+----------------------------------------------------------------------------- 14.14 φvcos

50( ) 9.42( ) 1.1 10 3–×( )10

--------------------------------------------------------14.14 φvsin 50 9.42( ) 0.00226( )– –

0.0113 14.14 φvcos 0.773 φvsin– 1.06–[ ]

0.012– 0.16 φv 3°–( )cos+

=

=

=

TL 0=

Te

φv

unstable equilibrium

stable equilibrium

0.148

−0.172

FIGURE 1.1-5. versus at stepping rate of 300 steps/sec.

.

Te φv

T L = 0

φv ωe ζ( ) RTωrm ζ( )–[ ] ζd0

t∫ φv 0( )+=

Te 0 0.012– 0.16 φv 3°–( )cos+= =

φv 85.7° or 88.7°–=

85.7°–

Class notes for EE423, © O. Wasynczuk,1998

Dynamic response due to change in load torqueSuppose that load torque is stepped to some positive value less

than the maximum shown in Fig. 1.1-5. Since can't change instan-

taneously, will be momentarily greater than . Thus, willdecrease whereby the integrand of (1.1-21) becomes positive. As a re-sult, will increase. The new stable equilibrium point is shown inFig. 1.1-6.

From Fig. 1.1-6, the maximum load torque (including friction)that can be applied at this stepping rate (i.e., the pullout torque) is0.148 N⋅m. The pullout torque may also be established by substituting(1.1-22) and (1.1-23) into (1.1-26), differentiating with respect to ,

setting the result to zero, and solving for . This gives formulas sim-ilar to (7.6-34) and (7.6-35) of the EE321 text, i.e.

(1.1-28)

and

φv

TL Te ωrm

φv

Te

φv

unstable

new equilibrium

0.148

−0.172

TL

FIGURE 1.1-6. versus at stepping rate of 300 steps/sec.

. T e φ v

0 ≤ T L = T e(po )

φv

φv

φv po( ) tan 1– RTωrmτs( )=

Class notes for EE423, © O. Wasynczuk,1998 11

Stepper Motor Control

12

(1.1-29)

where it is assumed that and are related by

(1.1-30)

Expressing in terms of ,

(1.1-31)

A plot of the pullout torque versus stepping rate for the example motor

is shown in Fig. 1.1-7.

Te po( ) RT2Vs

2τv

rs 1 τs2RT2ωrm

2+( )----------------------------------------------- 1 τs

2RT2ωrm2+ τvRTωrm–[ ]=

ωe ωrm

ωeπfs2

------- RTωrm= =

Te po( ) fs

Te RT2Vs

2τv

rs 1 τs2 πfs

2-------

2

+----------------------------------------- 1 τs

2 πfs2

-------

2+ τv

πfs2

------- –=

Te(po)

fs

FIGURE 1.1-7. Pullout torque versus step rate.

Class notes for EE423, © O. Wasynczuk,1998

1.2 CONTROL OF PM STEPPER MOTORS

There are two types of stepper motor control systems that we willconsider: fixed and variable rate. The fixed rate control is easier toimplement; however, higher stepping rates can be achived if the step-ping rate is varied.

Fixed stepping rate controlA block diagram of a fixed rate stepper motor control system

is shown in Fig. 1.2-1. Therein, the number of steps to be taken is as-sumed to be known and enterred into an up/down counter that countsthe number of steps to be taken. The excitation sequence generatorsupplies proper excitation to the appropriate stator winding followingeach output clock pulse. In this control, the stepping rate is either zeroor a constant value. The only question we have to answer is: what isthe maximum fixed rate that we can set so that we can be sure thatthere will be no missed steps? This is called the maximum startingrate.

Clock

DownCounter

ExcitationSequenceGenerator

CkStart

-as

+bs

-bs

DriveCircuit

DriveCircuit

start stop

fs

as

vas

ias

ibs

vbs

+

-

+

-

# of steps

# steps

FIGURE 1.2-1. Constant stepping rate open-loop control system.

Class notes for EE423, © O. Wasynczuk,1998 13

Stepper Motor Control

14

Usually, the starting rate is quite small so that the “back emf”can be neglected whereupon the dynamic equations for phase a maybe expressed

(1.2-1)

The current following a step command resembles that shown in Fig.1.2-2. If, furthermore, , then it is reasonable to neglect .The response then resembles a squre wave as shown in Fig. 1.2-3.

Thus, we can use the static versus characteristics to

vas rs Lssp+( )ias λm′ RTωrm RTθrm( )cos+

rs Lssp+( )ias≈

=

Ts τa» τa

FIGURE 1.2-2. Electrical response for single step,

. λ m' RT ω rm << vas

Vsvas

iasVsrs------

Ts

FIGURE 1.2-3. Electrical response for single step, and .λm

′ RT( )ωrm Vs« Ts τs»

Vsrs------

Vsvas

ias

Ts

Te θrm

Class notes for EE423, © O. Wasynczuk,1998

establish the maximum start rate. For a two-phase permanent-magnetstepper, the static versus characteristics are plotted in Fig.1.2-4

Assume initially that , . Also, assume isconstant. Then

(1.2-2)

Since in the steady state,

(1.2-3)

Next, suppose we switch from +as to +bs. Eventually, will in-

crease by SL = TP/4. Given , J, and , we can calculate the time

for to increase by SL which will give us a conservative estimatefor the start rate. However, a slightly faster start rate can be set by as-

Te θrm

+as +bs -bs-as

θrm0 θrm1 θrm

TL

TP4

FIGURE 1.2-4. Static versus characteristics for 2-phase stepper motor.

Te θrm

ias I= ibs 0= TL

Te RTλm′ I RTθrm( )sin–

TPK RTθrm( )sin–=

=

Te TL=

θrmosin 1– TL TPK⁄( )–

RT------------------------------------------=

θrm

Te TL

θrm

Class notes for EE423, © O. Wasynczuk,1998 15

Stepper Motor Control

16

suming that next step initiated at the crossover angle, . To esti-

mate the time needed to reach , we first calculate the average

torque during the interval from to .

(1.2-4)

Note from Fig. 1.2-4 that . Thus, .

Now, the time needed to reach may be approximated as follows:

(1.2-5)

(1.2-6)

(1.2-7)

(1.2-8)

From which

(1.2-9)

(1.2-10)

where is given by (1.2-4)

θrm1

θrm1

θrm0 θrm1

Te TM1

θrm1 θrm0–------------------------------ TPK RTθrm( )cos θrmd

θrm0

θrm1

∫TPK

RT θrm1 θrm0–( )-------------------------------------------- RTθrm1( )sin RTθrm0( )sin–[ ]

= =

=

θrm1 TP( ) 8⁄= RTθrm1 π 4⁄=

θrm1

d2θrm

dt2---------------- 1

J--- TM TL–( )=

d θ rmdt

=1J

(T M − T L ) t +d θ rm

dt t =0

θ rm =

12 J

(T M − T L ) t2 + θ rm 0

θ rm 1 =

12 J

(T M − T L )T s + θ rm 0

Tsθrm1 θrm0–( )2J

TM TL–------------------------------------------=

fsTM TL–

θrm1 θrm0–( )2J------------------------------------------=

TM

Class notes for EE423, © O. Wasynczuk,1998

Variable Stepping Rate ControlIn general, a much larger stepping rate can be achieved by

slowly increasing stepping rate to some maximum value and slowlydecreasing it as the target position is approached as shown in Fig. 1.2-5.

In this control strategy, we need to determine:(1) the maximum stepping rate [pullout rate, ](2) the acceleration profile(3) the deceleration profile

In all three cases, we need versus stepping rate characteristic.

If we have a voltage source drive, is given by (1.1-29) or (1.1-31) and plotted in Fig. 1.1-7 for the example machine. If we have acurrent source drive, is given by (1.1-13) and is independent ofstepping rate. In practice, however, constant current cannot be main-tained at large step rates.We typically get something that looks like theplot shown in Fig. 1.2-7. For smaller stepping rates, the pullout torqueis constant. As the stepping rate increases, the back emf increases andthe actual currents may no longer track the desired currents. For veryhigh speeds, the current control degenerates to a voltage control

fs acceleration profile

deceleration profile

constant speed

time

fs (po)

A A = # of steps

FIGURE 1.2-5. Stepping rate versus time.

fs po( )

Te po( )

Te po( )

Te po( )

Class notes for EE423, © O. Wasynczuk,1998 17

Stepper Motor Control

18

whereupon the pullout torque assymptotically approaches that of avoltage controlled drive. We will find it convenient analytically to ap-proximate the pullout torque versus stepping rate characteristics astwo straigh-line segments, one of which is horizontal.

The maximum stepping rate taht can be achieved is known asthe pullout rate, , which is the intersection of versus

and versus characteristics. To determine acceleration profile,consider mechanical equation

(1.2-11)

For maximum acceleration, assume . Also, assume nomissed steps whereupon

(1.2-12)

Thus

(1.2-13)

0

0.04

0.08

0.12

0.16

0.2

0 1000 2000 3000 4000 5000 6000

TL

Te(po)

f s , steps/sec

fs(po)voltage sou rce

cu rrent sou rce

FIGURE 1.2-6. Extended versus characteristics for current source drive including constraints.

T e(po ) θ rm

fs po( ) Te po( ) fs

TL fs

T e − T L = Jp ω rm

T e = T e(po )

ω rm = SLf s

Te po( ) TL– J SL( )dfsdt--------=

Class notes for EE423, © O. Wasynczuk,1998

(1.2-14)

Integrating,

(1.2-15)

Dropping subscript 1, the time needed to reach constant stepping rate

of is

(1.2-16)

This integral may be integrated graphically or numerically. The se-quence of steps necessary to establish acceleration profile is shown inFig. 1.2-7.

Analytical expressions for the acceleration profile can be de-rived if we can assume is constant and use idealized versus

characteristics shown in Fig. 1.2-8. Let t = time to reach

.

(1.2-17)

(1.2-18)

This implies that we should increase linearly for .

Now let t = time to reach .

dt J SL( ) 1Te po( ) TL–---------------------------- fsd=

t1 td0

t1

∫ J SL( ) 1Te po( ) TL–---------------------------- fsd

0

fs1

∫= =

fs

t J SL( ) 1Te po( ) TL–---------------------------- fsd

0

fs

∫=

TL Te po( )

fs

f s < f s ,bp

t J SL( ) 1Te po( ) TL–---------------------------- fsd

0

fs

SL( )JKfs

=

=

fs1

SL( )JK----------------------t=

fs 0 < f s < f s ,bp

f s ,bp < f s < f s , po

Class notes for EE423, © O. Wasynczuk,1998 19

Stepper Motor Control

20

TL

Te(po) fs

1Te(po) − TL

A

t = J (SL) A

fs

t

fs

fs

fs

fs

FIGURE 1.2-7. Determination of acceleration profile.

Class notes for EE423, © O. Wasynczuk,1998

(1.2-19)

TL

fs(po)

fs

1Te(po) - TL

A

fs

fs(bp)

K

Te(po) = C Te(po) = b - a fs

FIGURE 1.2-8. Approximate determination of acceleration profile.

t SL( )J 1Te po( ) TL–---------------------------- fsd

0

fs

SL( )J K fsd0

fs bp,

∫ SL( )J 1b afs– TL–------------------------------ fsd

fs bp,

fs

∫+

tbp SL( )J 1B Afs–------------------- fsd

fs bp,

fs

∫+

tbp SL( )J 1A---- B Afs–( )ln– SL( )J 1

A---- B Afs bp,–( )ln+

=

=

=

=

Class notes for EE423, © O. Wasynczuk,1998 21

Stepper Motor Control

22

where

(1.2-20)

is the time it takes to increase from 0 to . The approximateoptimum acceleration profile is sketched in Fig. 1.2-9.

tbp SL( )J K fsd0

fs bp,

∫ SL( )JKfs bp,= =

f s f s,bp

linear

exponential

tbp

t

fs,bp

fs,po

fs

FIGURE 1.2-9. Approximate acceleration profile.

Class notes for EE423, © O. Wasynczuk,1998