[ieee 2010 ieee international conference on mechatronics and automation (icma) - xi'an, china...

6
A Motor Speed Control System Using Dual-Loop PLL and Speed Feed-Forward/Back Hidekazu Mchida, Michinobu Kambara, Kouta Tanaka and Fuminori Kobayashi Abstract— PLL speed control systems can completely reject speed error and steady-state phase error for constant-speed inputs. Though it does not usually handle inputs including acceleration, the dual-loop scheme improves, as a feed-forward control system, rising time and phase error for acceleration input. However, since it is fundamentally a third-order PLL, it has slow rising up characteristics than speed feed-back, and cannot avoid over/undershoots. Nonetheless, the first loop has rapid rising up characteristics and no over/undershoot, since it is an ideal second-order PLL system. In this article, to solve the problem, we show a hybrid system of the dual-loop PLL and speed feed-forward/back. It has fast rising up characteristics and no over/undershoots thanks to the first and third PLL as F/V converter, which cannot be achieved in traditional PLL systems. I. INTRODUCTION PLL, phase locked loop [1], is a control system that generates a signal synchronizing to the phase of a ”reference” signal. PLL has been applied to MSC(motor speed control), originally by Moore [2]. PLL MSC features that systems can theoretically reject speed error and steady-state phase error completely for input signals with constant speed. Researches on PLL MSC are being actively published as in [3]-[6]. However, PLL MSC is usually used for constant speed reg- ulator. When used as servo for input including acceleration, such as in CLV (Constant Linear Velocity) control of CD drives, slow response poses problem. Out-of-lock in phase easily occurs, involving oscillatory pull-in behavior. In the field of radio communication, possible remedy for this situation called “dual-loop PLL” [7] has been used. It has two PLL loops, where first one without loop filter, is the feedforward component of the second one with loop filter. As a result, it can not only enable high-speed tracking, but also cancel phase error. Regrettably, motor control systems differ from circuits because of delays, and phase error cancellation cannot be achieved, if the output of the phase detector of both loops is not added directly. For this problem, we proposed to cancel the phase error, a method by inserting a filter in the feedback of both loops [8]. A problem with this scheme is that, since it is fundamen- tally a third-order PLL, it has slow rising up characteristics H. Machida and Kouta Tanaka is with the Maizuru national college of technology, 234 Shiroya, Maizuru, Kyoto, Japan [email protected] Michimobu Kambara is with the Factory-Automation Electronics Inc., 1-6-14 dai-ni nichidai building 1F, higashinakajima, higasiyodogawa-ku, Osaka, Japan F.Kobayashi is with the Kyushu Institute of Technology, 680-4 Kawazu, Iizuka, Fukuoka, Japan [email protected] than speed feed-back, and cannot avoid over/undershoots. However, the first loop has rapid rising up characteristics, and no over/undershoot, since it is an ideal second order PLL system. In [9], we proposed hybrid of dual-loop PLL and speed feedforward for these reasons. In this article, to get faster rising up characteristics, (1) out- of-lock is detected using a five-state phase detector; (2) at out-of-lock, speed control by both feedback and feedforward is constructed by using the first and third PLL as F/V converter; and (3) when it reaches phase synchronization, it immediately returns to PLL. The second step forms a kind of speed feed-back control, generating no overshoot thanks to the rising up characteristics of the first and third PLL. This cannot be achieved in traditional PLL-MSC. From Sec.II on, a short introduction of PLL systems, including dula-loop scheme, will firstly be given. Sec.III reviews dual-loop PLL-MSC speed systems. Sec.IV shows hybrid control system of the dual-loop PLL and speed feed- back, with some experimental results, and Sec.V concludes the article. II. PLL SYSTEM A. Basic PLL system Block diagram of basic PLL [1] is shown in Fig.1. It consists of Phase Detector, PD for short, Loop Filter, LF for short, and VCO, voltage-controlled oscillator, as well as Divider, DIV between the VCO and the feedback input to the phase detector for frequency synthesizer applications. When this feedback system is stable in operation, it is called locked, and phase error is zero or very small, leading to synchronization between the input and output frequencies. PD in K - Kv s VCO LF f out f in F(s) N 1 out =N f in f out =f in DIV Fig. 1. Basic PLL construction When LF, loop filter, is of PI-type, as F (s)= τ 2 s +1 τ 1 s (1) transfer function H (s), from input phase θ in to feedback phase θ out , can be obtained as follows, 978-1-4244-5141-8/10/$26.00 © 2010 IEEE 1512 Proceedings of the 2010 IEEE International Conference on Mechatronics and Automation August 4-7, 2010, Xi'an, China

Upload: fuminori

Post on 18-Dec-2016

215 views

Category:

Documents


2 download

TRANSCRIPT

A Motor Speed Control System UsingDual-Loop PLL and Speed Feed-Forward/Back

Hidekazu Mchida, Michinobu Kambara, Kouta Tanaka and Fuminori Kobayashi

Abstract— PLL speed control systems can completely rejectspeed error and steady-state phase error for constant-speedinputs. Though it does not usually handle inputs includingacceleration, the dual-loop scheme improves, as a feed-forwardcontrol system, rising time and phase error for accelerationinput. However, since it is fundamentally a third-order PLL,it has slow rising up characteristics than speed feed-back, andcannot avoid over/undershoots. Nonetheless, the first loop hasrapid rising up characteristics and no over/undershoot, since itis an ideal second-order PLL system. In this article, to solve theproblem, we show a hybrid system of the dual-loop PLL andspeed feed-forward/back. It has fast rising up characteristicsand no over/undershoots thanks to the first and third PLL asF/V converter, which cannot be achieved in traditional PLLsystems.

I. INTRODUCTION

PLL, phase locked loop [1], is a control system thatgenerates a signal synchronizing to the phase of a ”reference”signal. PLL has been applied to MSC(motor speed control),originally by Moore [2]. PLL MSC features that systems cantheoretically reject speed error and steady-state phase errorcompletely for input signals with constant speed. Researcheson PLL MSC are being actively published as in [3]-[6].

However, PLL MSC is usually used for constant speed reg-ulator. When used as servo for input including acceleration,such as in CLV (Constant Linear Velocity) control of CDdrives, slow response poses problem. Out-of-lock in phaseeasily occurs, involving oscillatory pull-in behavior.

In the field of radio communication, possible remedy forthis situation called “dual-loop PLL” [7] has been used. Ithas two PLL loops, where first one without loop filter, is thefeedforward component of the second one with loop filter.As a result, it can not only enable high-speed tracking, butalso cancel phase error.

Regrettably, motor control systems differ from circuitsbecause of delays, and phase error cancellation cannot beachieved, if the output of the phase detector of both loops isnot added directly. For this problem, we proposed to cancelthe phase error, a method by inserting a filter in the feedbackof both loops [8].

A problem with this scheme is that, since it is fundamen-tally a third-order PLL, it has slow rising up characteristics

H. Machida and Kouta Tanaka is with the Maizuru nationalcollege of technology, 234 Shiroya, Maizuru, Kyoto, [email protected]

Michimobu Kambara is with the Factory-Automation Electronics Inc.,1-6-14 dai-ni nichidai building 1F, higashinakajima, higasiyodogawa-ku,Osaka, Japan

F. Kobayashi is with the Kyushu Institute of Technology, 680-4 Kawazu,Iizuka, Fukuoka, Japan [email protected]

than speed feed-back, and cannot avoid over/undershoots.However, the first loop has rapid rising up characteristics,and no over/undershoot, since it is an ideal second orderPLL system. In [9], we proposed hybrid of dual-loop PLLand speed feedforward for these reasons.

In this article, to get faster rising up characteristics, (1) out-of-lock is detected using a five-state phase detector; (2) atout-of-lock, speed control by both feedback and feedforwardis constructed by using the first and third PLL as F/Vconverter; and (3) when it reaches phase synchronization,it immediately returns to PLL. The second step forms a kindof speed feed-back control, generating no overshoot thanksto the rising up characteristics of the first and third PLL.This cannot be achieved in traditional PLL-MSC.

From Sec.II on, a short introduction of PLL systems,including dula-loop scheme, will firstly be given. Sec.IIIreviews dual-loop PLL-MSC speed systems. Sec.IV showshybrid control system of the dual-loop PLL and speed feed-back, with some experimental results, and Sec.V concludesthe article.

II. PLL SYSTEM

A. Basic PLL system

Block diagram of basic PLL [1] is shown in Fig.1. Itconsists of Phase Detector, PD for short, Loop Filter, LFfor short, and VCO, voltage-controlled oscillator, as well asDivider, DIV between the VCO and the feedback input tothe phase detector for frequency synthesizer applications.

When this feedback system is stable in operation, it iscalled locked, and phase error is zero or very small, leadingto synchronization between the input and output frequencies.

PD

in K-

Kvs

VCOLFfout

fin F(s)

N1

out

=N fin

fout’ =fin

DIV

Fig. 1. Basic PLL construction

When LF, loop filter, is of PI-type, as

F (s) =τ2s + 1

τ1s(1)

transfer function H(s), from input phase θin to feedbackphase θ′out, can be obtained as follows,

978-1-4244-5141-8/10/$26.00 © 2010 IEEE 1512

Proceedings of the 2010 IEEEInternational Conference on Mechatronics and Automation

August 4-7, 2010, Xi'an, China

H(s) =θ′out(s)θin(s)

=Kτ2s + K

τ1s2 + Kτ2s + K(2)

where K = KφKV

N . Steady-state phase error can be analyzedfrom the following final value theorem:

limt→∞φ(t) = lim

s→0s[1 − H(s)]θin(s)

= lims→0

sτ1s

2

τ1s2 + Kτ2s + Kθin(s) (3)

When input phase signal θin(s) has three components:phase step Δθ, frequency step Δω, and frequency ramp R,

θin(s) =R

s3+

Δω

s2+

Δθ

s. (4)

Steady-state phase error is zero for Δθ and Δω, but notzero for R, because:

limt→∞φ(t) =

τ1

KR (5)

B. Dual-loop PLL system

Dual-loop PLL [7] is intended to be used in fast-movingterminals such as satellites, to solve the problem of Dopplereffect.

In the dual-loop PLL shown in Fig. 2, the first loop doesnot have LF, but the second loop has a filter that maintainsphase margin. VCO of the second PLL is fed both by theLF output of the second loop and by the PD output of thefirst loop. PLL output is fed by the VCO of the second loop.

PD

in

First Loop

Second Loop

K1

-

KV1s

VCO

K2

-

++

fin

in +

fout

1

1N

1’

1N

2’

LF

F(s)

=N fin

KV2s

VCO

PD

DIV

DIV

Fig. 2. Dual-loop PLL construction

When input signal has the form of Eq. (4), steady phaseerror can be zero for frequency ramps with constant accel-eration R in the input. It is for cases where VCO gain KV 1

and motor gain KV 2 are equal, because:

limt→∞φ(t) =

τ1N(KV 1 − KV 2)KV 1KV 2

R = 0 (6)

That is, it can reject phase error for input acceleration andtrack to high speed input, because the system forms a kindof feed-forward structure.

III. DUAL-LOOP PLL-MSC SYSTEM

A. Basic PLL-MSC system

PLL-MSC system [2],[4] can be achieved only by replac-

ing VCO transfer functionKV

sin Fig.1 by motor + rotary

encoder transfer functionKm

s(Tms + 1). Where Tm is the

motor mechanical time-constant, and Km is the motor gain.Because this PLL-MSC system is still only of type two,

from the internal model principle, phase error for inputacceleration remains as: (where K = KφKm

N )

limt→∞φ(t) =

Tmτ1

KR (7)

B. Dual-loop PLL-MSC System

However, direct application of this PLL to motor speedcontrol poses a problem, because the plants are different:the first loop has VCO and the second loop has motor, andcomplete correspondence cannot be expected.

We solved this problem by inserting loop filters into bothfeed back paths as shown in Fig.3. Then, the feed-forwarderror cancellation is caused only when input including accel-eration, and feed-back correction by the second loop is notnecessary.

m Kms(Tms+1)

Motor+Encoder

PD

in

First Loop

Second Loop

K1

-

KV1s

VCO

PD

Km

-

++

LF

F(s)

fin

in +

fout=fm

1

1N

1’

1N

m’

LF

F(s)

=N fin

DIV

DIV

Fig. 3. Dual-loop PLL-MSC

When input signal has the form of Eq. (4), steady phaseerror can be reduced to zero for frequency ramps withconstant acceleration R in the input. It is for cases whereVCO gain KV and motor gain Km are equal, because:

limt→∞φ(t) =

τ1N(KV − Km)KφKV Km

R = 0 (8)

C. Simulation

For a DC motor with brushes, Sawamura SS32G, whereTm=11[msec],Km=3.39[kHz/V], the loop filter was designedby the method of reference [1]. By MATLAB simulation forthe case of single loop PLL-MSC, it is confirmed that steady-state phase does not coincide with inputs with constant

1513

f1

U/D cnt

1N

enb

clk2

_1

clk

rst

Divider

A

B

A>B

Accumlator

enb

enb

fm'

CMP

AMPMotorEncoder

fm

Up cnt

clk3

PWM

clk

rst

clk2

_2

clk

rst

1N

Divider

f1

f1'

NCOenb

clk

rst

clk4

PFD

clk

lag

lead

clk

data Q

+Kp MUX 0-Kp

+KpMUX

0-Kp

PFDlag

lead

Fig. 6. dual-loop PLL/PWM-MSC system

0 0.2 0.4 0.6 0.8 1-0.2

0

0.2

0.4

0.6

0.8

1

1.2

time [sec]

rota

tiona

l spe

ed[r

pm]

reference inputmotor output

Fig. 4. Responses for inputs with constant acceleration of the single PLL-MSC by MATLAB simulation

acceleration (Fig.4). Here, note that squared ramp is equalto constant acceleration.

On the other hand, in the case of dual loop PLL-MSC, itis confirmed that steady-state phase coincides with for inputswith constant acceleration (Fig.5).

0 0.2 0.4 0.6 0.8 1-0.2

0

0.2

0.4

0.6

0.8

1

1.2

time [sec]

rota

tiona

l spe

ed[r

pm]

reference inputmotor output

Fig. 5. Responses for inputs with constant acceleration of the dual PLL-MSC by MATLAB simulation

D. Dual-loop PWM control

We implement the dual-loop PLL/PWM-MSC system [8]with an FPGA, a programmable LSI. Fig.6 shows that it canbe implemented compactly all in digital by using the 1-bitPWM signal processing of the phase detector(PFD).

In the first loop, NCO, Numerical Controlled Oscillator,is used instead of VCO, Voltage Controlled Oscillator. Inthe second loop, the comparator modulates output of the PIfilter to PWM again, and power MOS-FET droves the motoraccording to its duty ratio.

E. Experimental result

The circuit of Fig.6, using the parameters KP same as thesimulation described in Sec. III-C,

was programmed in a single-chip FPGA, field pro-grammable gate array, a user-programmable LSI, and wasexperimented.

To begin with, it is confirmed that lock is achieved bysetting rotational speed with the programmable divider forall the possible speeds.

Next, oscilloscope observations shown in Fig.7 revealedthat steady-state phase error of the first row and third rowgoes to zero for input with constant acceleration.

reference input in(in acceleration)

first PLL output 1(lag from in)

second PLL-MSC output m(almost following to in)

phase lag occurs

no phase lag occurs

Fig. 7. Waveforms (for input acceleration)

1514

f1

U/D cnt

1N

enb

clk2

_1

clk

rst

Divider

A

B

A>B

Accumlator

enb

enb

fm'

CMP

AMPMotorEncoder

fm

Up cnt

clk3

PWM

clk

rst

clk2

_2

clk

rst

1N

Divider

f1

f1'

NCOenb

clk

rst

clk4

PFD

clk

lag

lead

PFDlag ilead i

clk

lag o

lead o

data Q

+Kp MUX 0-Kp

+KpMUX

0-Kp

Fig. 11. hybrid of dual PLL and speed feed-forward

Next, we shows frequency step responses obtained fromF/V-converted motor encoder output.

As in Fig.8, it is shown that the first loop acceleratessecond loop, and no over/undershoots occur when gain islow. This characteristic cannot be obtained by single loop,unless with far lower gain, which causes very slow responses.

Fig. 8. Step speed response of dual loop PLL motor speed control system(low KI gain)

However, as shown in Fig.9, It can not avoidover/undershoots when gain is set high for faster responses.

Fig. 9. Step speed response of dual loop PLL motor speed control system(high KI gain)

IV. HYBRID-MSC OF THE DUAL-LOOP PLL AND

FEED-FORWARD/BACK

A. Principle of the Hybrid-MSC

On the other hand, since the dual-loop PLL-MSC sys-tem is fundamentally a third-order PLL, it cannot avoidover/undershoots when gain is set high for fast responses.Nonetheless, the first loop has ideal rapid rising up charac-teristics without over/undershoot, since it is an ideal secondorder PLL system.

To solve the above problem of slow rising up characteris-tics and over/undershoots,

(1) out-of-lock is detected using a five-state phase detector.(as shown in Fig.10);

(2) at out-of-lock, speed feed-forward/back is constructedby using the first and third PLL as F/V converter; and

(3) when it reaches phase synchronization, it immediatelyreturns to PLL. The second step forms a kind of speedfeed-back control, generating no overshoot thanks tothe rising up characteristics of the first PLL.

leadi lock lagi lagoleado

lock in rangeout of range out of range

Fig. 10. Five state PFD

1) Hybrid of dual-loop PLL and speed feed-forward: Inthe step (2), at out-of-lock, integration counter of the secondloop is replaced by the one in the first loop as shown inFig.11. It is constructed as speed feed-forward scheme asshown in Fig.12. That is, first loop PLL is used as ideal F/Vconverter.

1515

f1

U/D cnt

1N

enb

clk2

_1

clk

rst

Divider

A

B

A>B

Accumlator

enb

enb

fm'

CMP

AMPMotorEncoder

fm

Up cnt

clk3

PWM

clk

rst

clk2

_2

clk

rst

1N

Divider

f1

f1'

NCOenb

clk

rst

clk4

PFD

clk

lag

lead

PFDlag ilead i

clk

lag o

lead o

data Q

+Kp MUX 0-Kp

+Kp

MUX

0-Kp

U/D cnt

enb

clk2

_1

clk

rst

Divider

f3'

NCOenb

clk

rst

clk4

PFD

clk

lag

lead

+Kp MUX 0-Kp

1N

fm'

f3

1bitleft shift

Fig. 15. hybrid of dual PLL and speed feed-back

Tms+1Kmfin fm

Motor +Encoder1st PLLas F/V

Fig. 12. speed feed-forward by using PLL as F/V

The rising up characteristic is completely correspondingto first PLL, and no over/undershoots occurs, even if firstPLL gain is set high for fast responses, as shown in Fig.13and 14 . From these figures, it is understood that the firstloop behaves as an idealized model of the second loop.

Fig. 13. Step speed response of hybrid of the dual loop PLL and feed-forward motor speed control system (low KI gain)

Fig. 14. Step speed response of hybrid of the dual loop PLL and feed-forward motor speed control system(high KI gain)

2) Hybrid of dual-loop PLL and speed feed-back: In thestep (2), at out-of-lock, content of the integration counterof the second loop is replaced by the one in the first loop,multiplied by 2, minus the one in the third loop, as shown inFig.15. It is constructed as speed feed-back scheme as shownin Fig.16. That is, first and third loop PLL is used as idealF/V converter. As a result, the time constant is improvedfrom Tm to Tm

2Km+1 .

3rd PLLas F/V

2Tms+1

Kmfin fmMotor +Encoder

1st PLLas F/V

Fig. 16. speed feed-back by using PLL as F/V

1516

By MATLAB simulation for the case of speed feed-back,it is confirmed that rising up characteristics is improved asshown in Fig.17.

uncontrolled motor output

F/V by first PLL

motor input

controlled motor input

time [sec]

norm

aliz

ed ro

tatio

nal s

peed

[r.p

.m.]

Fig. 17. MATLAB simulation of speed feed-back

B. Experimental Results

The circuit of Fig.15 was programmed in a single-chipFPGA and was experimented.

As shown in Fig.18, motor input voltage is sharper forhybrid of feed-forward and feed-back.

(a) original dual-PLL MSC

(b) hybrid of feed-forward and dual PLL

(c) hybrid of feed-back and dual PLL40 [msec/DIV]

first PLL

motor input

motor input

motor input

first PLL

first PLL

Fig. 18. Motor input voltage

Fig.19 shown the frequency step responses obtained fromF/V-converted motor encoder output. It is understood thatfaster rise-up is possible for feed-forward and feed-back.

(a) original dual-PLL MSC

(b) hybrid of feed-forward and dual PLL

(c) hybrid of feed-back and dual PLL40 [msec/DIV]

first PLL

motor output

motor output

motor output

first PLL

first PLL

Fig. 19. Motor rotational output

V. CONCLUSION

The dual-loop PLL-MSC system can accelerate rising timeand can cansel the phase error in acceleration input. However,it has still slow rising up characteristics than speed feed-back,and cannot avoid over/undershoots.

We show hybrid control system of the dual-loop PLLand feed-forward/back, to solve the above problem. It hasrapid rising up and no overshoot thanks to the rising upcharacteristics of the first and third PLL. This cannot beachieved in traditional PLL-MSC systems.

REFERENCES

[1] R.E. Best:Phase-Locked Loops 6th.ed.,McGraw-Hill, 2007.[2] A.W. Moore : Phase-locked loop motor-speed control, IEEE Spectrum,

pp.61-67, Apr. 1973.[3] Yoon Yong-Ho et al.: PLL control algorithm for precise speed control

of the slotless PM brushless DC motor Using 2 Hall-ICs, 35th IEEEPE Special. Conf., Vol. 2, pp. 1315-1321, 2004.

[4] J.X. Shen and S. Iwasaki; Sensorless control of ultrahigh-speed PMbrushless motor using PLL and third harmonic back EMF, IEEETrans., Vol. IE-53, Issue 2, pp. 421–428, 2006.

[5] J. Deskur and A. Maciejuk: Application of digital phase locked loopfor control of SRM drive, IEEE Europ. Conf. Power Electron. Appl.,pp. 1-6, 2007.

[6] C.T. Pan and E. Fang: A Phase-Locked-Loop-Assisted Internal ModelAdjustable-Speed Controller for BLDC Motors, IEEE Trans., Vol. IE-55, Issue 9, pp. 3415-3425, 2008.

[7] M. Kamata, et al.: Third-order phase locked loops using dual loopsinserting an active filter in the second loop with improved stability,IEICE-A, Vol. J82-A, No. 2, pp. 273–282, in Japanese, 1999.

[8] H. Machida et al.: A PWM Motor Speed Control System based onthe Dual-Loop PLL!$ ICROS-SICE in Fukuoka, 1A18-3, pp. 418-423,2009.

[9] H. Machida et al.: A Motor Speed Control System Using a Hybridof and Dual-Loop PLL and Feed-Forward!$ ACM-2010 in Nagaoka,Japan, NF-000361, pp. 185–190, 2010.

1517