You are on page 1of 4

Thc 2004 IEEE .

4sia-Pncilic Conicrcncc on
Circuits and Systems, Deccmbcr 6-9.2004

HIGH PERFORMANCE PMLSM DRIVES USING TMS320F2812


DSP CONTROLLER

Ying-Shieh Kung,member IEEE

Department of Electrical Engineering


Southem Taiwan University of Technology
Yung-Kang City, Tainan Hsien, 710, Taiwan
kung@mail.stut.edu.tw

solution. Especially the new generation DSP controller


ABSTRACT TMS320F28x [8] produced hy Texas Instrument, which
has the advantages of high speed (150MIPS) performance,
A high performance position control for PMLSM drives up to 128Kx16 flash, 2 set (12 channels) ofPWM output,
using TMS320F2812 DSP controller is presented. Due to 2 set (4 channels) of QEP input, 12 channels 12-hit A D
the DSP has the characteristics of fast computation and converter (20011s conversion time), 56 hits GPIO, is very
the complete integrations of motor peripheral circuit, a suitable to develop a fully digital controller and a
fully digital controller of PMLSM drives system can be complicated intelligent control algorithm in servo motor
integrated and realized by s o h a r e in single chip. To drives. Therefore, in this paper, a TMS320F2812 DSP
increase the perfonance of PMLSM drives, an adaptive embedded with the function of current vector control,
fuzzy controller is applied to cope with the system SWWM scheme and adaptive fuzzy position control has
uncertainty and load variations. Some experimental been developed a high performance drives for PMLSM.
results have been validated the theoretical ones. With the exceilent characteristics of proposed system, it
will make drives of PMLSM more programmable, robust
and easy implementation.

1. INTRODUCTION 2. THEORETICAL ANALYSIS

W i g to the advantages of high power density, high The architecture of the proposed intelligent control
performance motion control in fast speed and better system for a PMLSM is shown in Fig. 1, in which the
accuracy, permanent magnet linear synchronous motors current vector control and the intelligent position control
(PMLSM) have been gradually used in many automation are all implemented in a TMS320F2812 DSP chip. The
control fields as an actuators [l-21, such as detailed are introduced in the following section:
computer-controlled machining tools and semiconductor
manufacturing equipments. But in industrial applications, 2.1 Mnthematical model of PMLSM:
there are many uncertainties, such as system parameter
uncertainty, external load disturbance, kiction force, The dynamic model of a typical PMLSM can be
model uncertainty, always diminish the performance represented with synchronous rotating reference 6” as
quality of the pre-design of the motor driving system. To follows [I]
cope with those problems, in recent years, many !%=-R-;,+lTL,x; 1
intelligent control techniques [3-41, such as fuzzy control, dt L, T Ld ‘I L,
neural networks control, adaptive fuzzy control etc., have
been developed and applied to the position control of
servo motor drives to obtain high operating performance.
A high performance motor control system should have a where vd, vq are d- and q-axis voltages; id, is, are the d-
fast dynamic response in adjusting its control parameters and q-axis currents, R, is the phase winding resistance; L d ,
so that the motor outputs affected by the disturbances can L,are the d- and q-axis inductance; f is the translator
recover to their original status as soon as possible [5].
With the rapid development in microprocessor, the high speed; 1
, is the permanent magnet flux linkage; T is the
performance digital signal processor @SP) becomes a pole pitch. The developed electromagnetic thrust force is
popular research on digital control [6-71 for ac drives due given by
to their high-speed performance, simple circuitry, on-chip
peripherals of a micro-controller into a single chip

0-7803-8660-4/04/$20.00 02004 IEEE 645


The current control of a PMLSM drive is based on a and e, de and q a s input and output variable of fuzzy
vector control, that is, if we control idto 0 in Fig.1, the controller, respectively. The design procedure of the
PMLSM will be decoupled and control a PMLSM fuzzy controller is as follows:
become easy as to control a DC motor. After 0 Defme the linguist value are { A , ,A 2 , E ) with the
simplification and considering the mechanical load, the symmetrical triangular membership function:
model of a PMLSM can be expressed in the following
I n
equation,
(4)
where

and the mechanical dynamic equation of PMLSM is where X, is input value, L(.) is output value,
d2x, dx x," and W ; are mean value and width of the
E - FL = J , -tdt2 B,
dt triangular membership function.
where Fe ,K , ,J , , B, and FL are represented with 0 Derive M fuzzy control rules as initial condition, such
the motor thrust force, force constant, inertial value, as,
damping ratio and external force, respectively. In Fig.1, IF eisAy and AeisA; THENu, isEm,m=1,2,..,M(10)
the configuration of the current loop using vector control
for PMLSM drives includes PI controller, coordinate
0 Construct the fuzzy system with u,(zl e)
kom those
transformation for Clarke, Clarke-' , Park , Park-' M rules using the singleton fuzzifier,
and SVPWM, A/D conversion, pulse signal detection of product-inference rule, and central average
the encoder etc. which are not to discuss here. defuzzifier method. Therefore, (IO) is replaced with
the following expression:
M M
2.2 Adaptive fuzzy controller in position control loop:
C c m [ n : = , 5, (x, 2: W:)I A"='
3 9 cmpm

The structure of an adaptive fuzzy controller for u,(x18)= "2 = M


PMLSM drives is depicted in the dotted line of Fig. 1, C[rI:=,s,(.,.Y,m
,=I
CPm
m=l
which consists of a fuzzy controller, a reference model
and an adjusting mechanism. In Fig.1, the tracking error those c I ,c 2,.., c y are adjustable parameters.
and the change of the error, e , Ae are defmed as The gradient descent method is adopted to derive the
e(k)= x,(k)-x,(k), (7) fuzzy control law in Fig. 1. The main purpose of
adjusting the parameters of the fuzzy controller is to
&(k) = e(k)- e(k -I), (8) m i n i u m the square error (instantaneous cost function)
between the position of moving part of the linear motor

646
and the output of the reference model. The instantaneous voltage source IGBT inverter and a PMLSM. The
cost function is defined as follows: PMLSM is single-axis stage with cog-free linear motor
1 1 and its stroke length is 600mm. The maximum speed and
J(k+l)=- g(k+ly =- [xJk+I)-xp(k+$ (12) acceleration are 4m/s and 4 g's, respectively. The
2 2
moving mass is 2.5kg, the maximum payload is 22.5kg
and the parameters of c, is adjusted with, and the maximum thrust force is 73N at continuous
aJ(k + 1) condition. A linear encoder with 5pm resolution is
Ac,(k) oc - ~
mounted on the PMLSM as position sensor, and the pole
aqk) pitch is 30.5mm (about 6100 pulses). The
To derive the formulation of adjusting the parameters TMS320F2812 DSP controller in Fig.1 is used to
c, ,at first, we assume FL to be zero, and take Laplace develop a fully digital controller for PMLSM drives,
which the current vector control scheme and intelligent
transformation with (4)-(6), and then
adaptive position control strategy are all realized by
(14) software in this DSP chip. In the implementation, the
PWM switching frequency of inverter is designed with
16k Hz, dead-band is l p , and the control sampling
The bilinear transformation is applied and the difference frequency of current and position loop are chosen as
equation of PMLSM drive system can be derived as BkHz, and ZkHz, respectively. The flay chart of main
(~-e-wJ")z-~ program and the intermpt service routine for digital
(15)
(1 -e-B-r"-z-')(l - 2.') ' motor control algorithm are designed and shown in Fig.
2. The programs are coded by C language and the
where z-' is a back-shift operator, and T is the sampling computation time of DSP for executing current loop is
period. In Fig.1, the current command ii and the output 3 . 6 and
~ executing the adaptive fuzzy control algorithm
of position loop is 16 p.
of fuzzy controlleruJ can be obtained by the following In experiment, for testing the learning effect of the
expression proposed controller and choosing an adequate learning
rate a, a square wave position command with amplitude
i~(k)=~(u,(k-l)+(K,+Kp)u,(k)-xp(k)+xp(R-l)) (16) of 5mm with no external load is applied and the tracking
From(15)and(16), wehave results between the output of reference model and the
measured position of the moving part of PMLSM under
x , ( k ) = ( A + I - B k v ) x p ( k - l ) - ( l - BK,)x,(k-2) different learning rate of 0.05, 0.1, and 0.15 is shown in
(17)
+ Bk,u,(k - 2)+ Bk, ( K , + K,)u,(k- 1) Fig. 3. All cases in Fig. 3, at initial, the moving part of
PMSLM tracks the output of reference model with
with A = exp(-B,T/ J.). B = K,(1 -A)/B,. oscillation, meanwhile the parameters of fuzzy controller
Furthermore, according to the chain rule, the partial continuous tuning toward reducing the error between the
differential equation of J(k +1) in (12) can be output of the reference model and the position of the
moving part at each control sampling interval. After one
rewritten as square wave position command tracking, the parameters
of fuzzy controller are almost tuned to the adequate
value. It has also shown that a choose 0.15 is better
learning performance than a choose 0.05. Furthermore,
where a is learning rate. From (1 I), (13), (17) and (18), in order to compare the advantages between the
it is straightforward that the parameters c, of fuzzy proposed adaptive fuzzy controller and conventional PI
controller, the same square wave with amplitude of 5mm
controller in (1 I ) can be derived by the following but 1 Hz frequency position command is used, and the
expression. step response error between them are shown in Figs.
4(a)-4(b). It shows that after one command period
learning, in steady state, both of them all have zero error,
but in transient state, the peak of the tracking errors for
the proposed adaptive fuzzy controller is only the half of
= aSign(B)K,(K, + K,) e,(k) those of the PI controller. At last, to demonstrate the
cpm performance of the frequency response, a tested input
signal of sinusoid wave with Y2.5 mm amplitude and 5
Because the motor parameter B is not easy to know, the Hz frequency value is provided. In this design, the
sign(B) is employed to calculate in (19) and it is always moving part of the PMLSM tracking the tested signal is
one due to B be positive. The sign(.) denoted the sign shown in Fig. 5(a) and the tracking errors is plotted in
operator. Fig. 5(b). The results reveal that they have good position
tracking. Therefore, from Figs. 3-5, they demonstrate
3. EXPERIMENTAL SYSTEM AND RESULTS that the use of a TMS320F2812 DSP chip to construct a
vector control and an adaptive fuzzy position controller
The overall experimental system is depicted in Fig. I , for PMLSM drives is effectiveness, high performance
and it includes a TMS320F2812 DSP controller. a and robustness.

647
4. CONCLUSIONS

A high performance o f PMLSM drives using a new


generation TMS320F2812 DSP chip has been presented
in this paper. In order to reach this high performance
goals, those key techniques, such as the current vector
controller, the SVPWM scheme and the adaptive fuzzy
speed controller of the PMLSM drives are all
implemented in this DSP chip. Emulation result shows
that even in the complicated operation of the proposed
control algorithm, it only spends about Z O p
computation time of DSP for executing an overall
control loop. Experimental results also demonstrate that
in step command response and fiequency command
response, the position of the moving part of PMLSM
adopting the proposed system can fast track the
prescribed dynamic response well.

5. REFERENCES
Synchronous Motors -
[ I ] J.F.Gieras and Z.J. Piech, Linear
Tranrportotionand Automation System, CRC Press, 2000. M Ti=O)
[2] P. K. Budig, "The application of linear motors," Fig.3. Step response tracking results between the output of rcfcrcncc
Proceedings, PIEMC 2000, the third international, vol. 3, model and the actual position of moving part at different learning
pp. 1336-1340. rate(a)a=0.05(b)a=0.10(c)a=0.15
[3] C.M. Liaw, R.Y. Shue, H.C. Chen and S.C. Chen,
"Development of a linear brushless DC motor drive with
robust position control," IEE Proc. Electr. Power Appl.,
2001,vol. 148,No.2, pp. 11l-l18.
[4] F.I. Lin and C.H. Lin, "On-line gain tuning using RFNN
for linear synchronous motor," PESC, 2001 IEEE 3Znd
Annual, vol. 2, pp. 766-771.
[ 5 ] T.S. Radwan, M A . Rahman, A.M. Osheiba and A.E. 0 0.25 0.5 0.75 I 1.25 1.5 1.75 2 225 2.5
Lashine, "Dynamic Analysis of a High Performance (8) Tim@,)
Permanent Magnet Synchronous Motor Drive," Electrical
and Computer Engineering, 1996, Canadian Conference on
vol. 2, pp. 611-614.
[6] B; Zhang, Y. Li and Y. Zuo, "A DSP-based fully digital
PMSM servo drive using on-line self-tuning PI controller"
Proc. PIEMC 2000, v01.2, pp. 1012-1017.
[7]A.M. Trzynadlowski, M.P. Kazmierkowski, P.Z. ._
Grabowski, M.M. Bech, "Three examples of DSP o 0.25 0.5 a75 i 1.25 1.5 1.i~ 2 z.25 2s
applications in advanced induction motor drives," (b) The@)
American Control Conference, 1999, vol. 3, pp. Fig. 4. Tracking error for a squarc wave position command with
2139-2140. amplitude 5 mm under (a) proposed adaptive fuzzy control (b)
PI control.
[8] TMS32OF2810 and TMS320F2812 Digital Signal
Processors, Handbook of Texas Instruments, 2002.

yi as
t
: a
M
5 4.5
e
+ -I
0 0.15 0.5 0.75 I 1.25 1.5 1.75 I 1.25 2.5

U Fig. 5 . (a) Tracking a 5Hz sinusoid input signal (b) Trackingemr.


Fig. 2. Flow chan of main and ISR program in DSP chip

648

You might also like