Professional Documents
Culture Documents
Nghien Cuu Va Ung Dung Card Dieu Khien So DSP de Thiet Ke Bo Dieu Khien So Trong Dieu Khien Chuyen Dong 1286
Nghien Cuu Va Ung Dung Card Dieu Khien So DSP de Thiet Ke Bo Dieu Khien So Trong Dieu Khien Chuyen Dong 1286
c lp - T do - Hnh phc
-----------***-----------
THUYT MINH
LUN VN THC S K THUT
TI
CB HNG DN
HC VIN
inh Vn Nghip
http://www.lrc-tnu.edu.vn
I HC THI NGUYN
Ngnh: T NG HA
M s:
Hc vin: INH VN NGHIP
Ngi HD Khoa hc: TS. BI CHNH MINH
http://www.lrc-tnu.edu.vn
I HC THI NGUYN
INH VN NGHIP
http://www.lrc-tnu.edu.vn
LI CAM OAN
Tn ti l: inh Vn Nghip
Sinh ngy 25 thng 12 nm 1981
Hc vin lp cao hc kho 10 - T ng ho - Trng i hc K thut
Cng nghip Thi Nguyn.
Hin ang cng tc ti khoa in - Trng i hc K thut Cng nghip
Thi Nguyn.
Xin cam oan: ti Nghin cu v ng dng Card iu khin s DSP
(Digital signal Processor) thit k b iu khin s trong iu khin chuyn ng
do thy gio TS. Bi Chnh Minh hng dn l cng trnh nghin cu ca ring
ti. Tt c cc ti liu tham kho u c ngun gc, xut x r rng.
Tc gi xin cam oan tt c nhng ni dung trong lun vn ng nh ni
dung trong cng v yu cu ca thy gio hng dn. Nu sai ti hon ton
chu trch nhim trc Hi ng khoa hc v trc php lut.
inh Vn Nghip
http://www.lrc-tnu.edu.vn 1
LI CM N
Sau su thng nghin cu, lm vic khn trng, c s ng vin, gip
v hng dn tn tnh ca thy gio TS. Bi Chnh Minh, lun vn vi ti
Nghin cu v ng dng Card iu khin s DSP (Digital signal Processor) thit
k b iu khin s trong iu khin chuyn ng hon thnh.
Tc gi lun vn
inh Vn Nghip
http://www.lrc-tnu.edu.vn 2
MC LC
Ni dung
Trang
Trang ph ba
Li cam oan
Li cm n
Mc lc
Danh mc cc hnh v, th
11
11
11
1.1.2. C s ca iu khin s
21
1.1.2.1. Bin i Z
21
24
27
27
29
30
32
32
34
36
37
38
38
40
http://www.lrc-tnu.edu.vn 3
41
41
41
47
49
49
51
51
53
59
59
65
67
70
73
75
76
78
2.3.1. Ci t dSPACE
79
80
81
81
81
chuyn ng.
2.4.1. Cc iu khin v tr Encoder
81
82
http://www.lrc-tnu.edu.vn 4
88
93
94
Management Tools.
CHNG 3.
100
100
php tng t)
3.1.1. M hnh ton hc ca h
100
104
110
khin v tr
3.1.4. M phng h trn Matlab
114
115
121
121
123
124
129
129
http://www.lrc-tnu.edu.vn 5
http://www.lrc-tnu.edu.vn 6
http://www.lrc-tnu.edu.vn 7
http://www.lrc-tnu.edu.vn 8
http://www.lrc-tnu.edu.vn 9
http://www.lrc-tnu.edu.vn10
My tnh s
11
http://www.lrc-tnu.edu.vn
12
http://www.lrc-tnu.edu.vn
13
http://www.lrc-tnu.edu.vn
Ii =
Uch
R.2i
(i=0n-1)
14
http://www.lrc-tnu.edu.vn
Rf
2n-1Bn-i +2n-2 Bn-2 +...+20 B0
n
2R
15
http://www.lrc-tnu.edu.vn
16
http://www.lrc-tnu.edu.vn
17
http://www.lrc-tnu.edu.vn
18
http://www.lrc-tnu.edu.vn
U maxA
2m -1
U maxA
N
2m -1
N
,Trong fn l tn s xung nhp.
fn
=
2m -1 N 2m -1
dt max T
19
http://www.lrc-tnu.edu.vn
k=0
k=1
20
http://www.lrc-tnu.edu.vn
1.1.2. C s ca iu khin s.
1.1.2.1. Bin i Z
Khi phn tch h iu khin tuyn tnh lin tc th ta dng php bin i Laplace
lc hm truyn ca h thng l t s gia hai a thc theo bin t. Trong h iu
khin s th hm truyn ca h thng khng cn l mt a thc i s theo p m a
thc i s theo e Tp . n gin ta t e Tp z lc hm truyn ca h thng
tr thnh a thc i s theo z. Ta c th s dng cc kt qu kho st h tuyn
tnh lin tc cho h iu khin s.
1.1.2.1.1. Php bin i z
Cho tn hiu ri rc x(nT) th bin i z ca tn hiu ny s l:
X(z) x(nT )z n
Cng thc trn c gi l cng thc bin i Z theo hai pha. Trong k thut
iu khin s ta thng dng bin i Z theo mt pha (0 +).
X(z)= X( nT )z n
0
Z = eTp p =
0
*
1
F (p) = p ln Z = F(z) =
T
Bin i Z ca hm 1(t):
f (nt )z
1
lnZ
T
f(t) = 1(t)
f(nT) = 1(n) vi T = 1
Z 1( t ) =
1(n )2
0
=1+
1 1
z
2 +=
z z
z 1
21
http://www.lrc-tnu.edu.vn
Bin i Z ca hm f(t)
f(nT) = f(n) vi
Z e at =
na
= e-aT vi a = const
T = 1 = e-na
1
Vy Z e =
=
1q
at
ea z
z
= a
=
1
e z 1 z e a
1 a
e z
Z f (n m = Z m F(z) -
m 1
f ( j)z
( m j )
j0
f ( n 0) f (0) Lim
F(z )
z
Xut pht t bin i Z: V
Lim
F(z ) f (0) lim
f ( n)
z
n0
d. Gi tr cui ca hm gc ri rc
lim
f (n) lim
(1 z 1 )Fz
n
z 1
V Zf ( n 1) f ( n) lim f ( n 1) f ( n)z n
m
n 0
1
)
f
(
n
)
z
m
m
n 0
22
http://www.lrc-tnu.edu.vn
f(n)=f(n+1)-f(n)
Z f(n) =Z f(n+1)-f(n) =Z f(n+1) -Z f(n)
Z f(n) =zF(z)-zF(0)-F(z)=(z-1)F(z)-zf(0)
Tng t i vi sai phn cp hai:
f ( n) f ( n) f ( n 1)
F ( z ) f ( n )z n f 0
f (1) f2
2 ...
z
z
1
F(z )z n 1 dz
L
2j
23
http://www.lrc-tnu.edu.vn
e(t)
Ze(t T) z E(z)
Nu chn n 1 n th sai s gia
nT v
(n-1)
(n+1)
l :
T nT T n
Trong l mt s dng v 0 1 .
Gi thit E(p) l bin i Laplace ca e(t)
T )
Le(t T ) E(p, E(p) e Tp )
Thay n ta c:
24
http://www.lrc-tnu.edu.vn
1.1.2.2.1. Ly mu tn hiu
Trong h iu khin s lun tn ti hai loi tn hiu l tn hiu lin tc v tn
hiu ri rc. Tn hiu a vo my tnh l tn hiu
x(t)
2T 3T
nT
1.12):
Ta gi thit ly mu tn hiu nhng im cch
x(nT)
2
x ( T ) . ch c th c c nh phng php
5
ni suy.
2T 3T
nT
25
http://www.lrc-tnu.edu.vn
x(t)
x(nT)
B ct mu
x(t)
x(nT)
Hnh1.14:B ct mu
0 T 2T
3T .(t-nT)
nT
(t) = (t nT)
n
0 vi t nT
Trong : (t-nT) =
vi t nT
sao cho ( t nT ) dt =1 chnh l o hm ca
*
d
1(t-nT)
dt
x(nT)(t nT)
26
http://www.lrc-tnu.edu.vn
T ta c: x (t )
x(nt ) (t nT )
27
http://www.lrc-tnu.edu.vn
Gc(z)
Khi iu khin, s
(theo thi gian gin on)
DAC
phn t lu gi
G1(s)
Qu trnh
lin tc
ADC
phn t ly mu
T
(nh hnh
2
.
Lng t ho c tn s ln,
khong 10 n 20 ln tn s ring ca
i tng.
phng php trc tip qu
Hnh 1.16
28
http://www.lrc-tnu.edu.vn
trnhtrng hp ngcng T= n
Ti
. Nh vy tn s lng t ho ln cn l loi
Gc * ( s)G ( s)
Y * ( s)
X * ( s) 1 Gc * ( s)G * ( s)
Hnh 1.17
29
http://www.lrc-tnu.edu.vn
Wk * ( s)
1
G * ( s) 1 Wk * ( s)
(*)
30
http://www.lrc-tnu.edu.vn
0
2
b
0
20
b
31
http://www.lrc-tnu.edu.vn
0
40
d
0
20.
d
1
U(s)
G c (s)=k p +k i +k d s=
s
E s
t
de
u(t)=k p e(t)+k i e(t)dt+k d
dt
0
(1-7)
32
http://www.lrc-tnu.edu.vn
(1-8)
z 1
(1-9)
(1-10)
Hnh 1.19
z 1
(1-11)
T
{e(kT)+e[(k-1)T]}
2
Hnh 1.20
(1-12)
Hm truyn ca khu tch phn gin on l:
Gi(z) ki U ( z ) ki T z 1
E z
2 z 1
(1-13)
33
http://www.lrc-tnu.edu.vn
t kT
1
(e(kT ) e(k 1)T )
T
(1-14)
1
z 1
(1 z 1 ) E ( z )
E( z)
T
Tz
z 1
T
Tki z 2 k p d z d
kp
T
T
T
Gc(z) =
z ( z 1)
k p z Tk i k p d z d
T
T
T
Gc(z) =
z ( z 1)
1
ln(z). Tuy nhin biu thc xc nh Gc(z) l siu
T
34
http://www.lrc-tnu.edu.vn
Ln(z) = 2 v
v3
...
3
V biu thc s =
|v| =
1 z 1
1
1 z 1
1
ln(z)
T
by gi c dng
ca s.
u(kT) =
kT
e(t)dt+
e(t)dt
(1.16)
e (k-1)T +e(kT)
2
(1.17)
(k-1)T
t : u(kT) = u[(k-1]+T
u(z) T 1 z -1 T z 1
.
.
1
E(z) 2 1 z
2 z 1
(1.18)
35
http://www.lrc-tnu.edu.vn
G0(z)|z=1 = Gc(s)|a=0
(1.19)
Nu Gc(s) c nhiu
nghim khng kh
th Gc(s) 0. iu y
tng ng vi Gc*(s) = 0
di
tn
th
nht
0 0
2 , 2 v G0(z) = 0
vi z = 1. V vy, bc
ca t s v mu s nh
nhau, cn thm nhn t
(z+1) (z+1)q-p m q v p
l bc ca mu s v t s
ca Gc(s).
1.2.4.3.
Phng
gi
36
http://www.lrc-tnu.edu.vn
-Ts
Gob(s) =
1-e
s
T
T
hoc bi Gob(s) =
suy ra t
Ts
2
1+
2
Ts
2 .
v e-Ts =
Ts
1+
2
1-
Vic chn b iu khin tng t t trc G0a(s) G1(s) hay Gob(s), G1(s)
c thc hin nh h lin tc. Tuy nhin cn bit trc chu k lng t ho T.
Mt phng php khc c thc hin theo cc bc sau:
G1 (s)
2 wT
c G(w).
2 - wT
wa
chng hn, tho mn iu kin
wa
n nh v chnh xc.
S ha bi Trung tm Hc liu i hc Thi Nguyn
37
http://www.lrc-tnu.edu.vn
Wk(z) =
G1 ( s )
(z-z )
i
1+K
i=1
n
=0
(z-p )
j
j=1
(z-p )
j
-K=
j=1
r
(z-pi)
i=1
38
http://www.lrc-tnu.edu.vn
.
n-r
n nh h thng, c th dng
c cu b dng:
Gc(z) = K
z-a
; 0 b < a < 1
z-b
vy
K.Gc(z)G(z)
(z-a)(z+1)
T2
;K=K'
K
(z-b)(z-1)2
2
By gi qu o nghim s s c
Hnh 1.23
ba nhnh v h c ba nghim cc p1 = p2
=1; p3 = b. Mt nhnh n nghim khng
z1 = -1, nhnh th hai n z2 = a v nhnh
th hai tin n - .
C th c hai trng hp:
1. C ba nghim u thc nm ng
thi trn hai on thng ca qu o [b, a] v
Hnh 1.24
Hnh 1.25
39
http://www.lrc-tnu.edu.vn
z
n 0
1 Gc ( z )G1 ( z ) z
1 G1 ( z )
Gc ( z )
1
n 0
1 Gc ( z )G1 ( z ) z
1 G1 ( z )
1
1 Gc ( z )(1 z n 0 )
Gc ( z )G1 ( z )
G1 ( z ) n 0
z
1 Gc ( z )G1 ( z ) 1 G1 ( z )
40
http://www.lrc-tnu.edu.vn
WK(z) =
G c (z)G(z)
vi E(z) = X(z) - Y(z) = X(z)[1-WK(z)]
1+G c (z)G(z)
1
WK ( z )
.
G ( z ) 1 WK ( z )
Vic chn Gc(z) t cht lng mong mun gp phi nhng iu kin hn
ch:
1. iu kin thc hin c i hi bc ca h kn ln hn hoc bng bc ca
phn lin tc quy i (kn):
2. Sai lch trng thi xc lp, theo (4-58b) v theo nh l ti hn
3. n nh v tn t c khi sai lch trng thi xc lp ca cc tr ri rc
bng khng, k c mt thi im hu hn.
1.2.6. Dng matlab tng hp h iu khin s
- Tng hp theo c tnh tn Bode
- Tng hp theo qu o nghim s
1.3. iu khin s trong iu khin chuyn ng.
1.3.1. Mt s cu trc iu chnh c s dng.
1-Khu C
2-iu khin mmen
3-ng c
4-Khu o
41
http://www.lrc-tnu.edu.vn
42
http://www.lrc-tnu.edu.vn
43
http://www.lrc-tnu.edu.vn
44
http://www.lrc-tnu.edu.vn
45
http://www.lrc-tnu.edu.vn
46
http://www.lrc-tnu.edu.vn
47
http://www.lrc-tnu.edu.vn
48
http://www.lrc-tnu.edu.vn
49
http://www.lrc-tnu.edu.vn
hnh c m phng. Vi nhng m hnh phc tp, s lng php tnh ln th thi
gian m phng l vn cn c quan tm.
50
http://www.lrc-tnu.edu.vn
FLASH
Ngun nui
EEPROM
(V)
DATA
DATA/PROG
PROG
288
256
16K
Chu k (ns)
S chn
20
PQ 132P
51
http://www.lrc-tnu.edu.vn
B nh:
Ngt ng b PWM
u vo tng t:
Vo/ra s 20 bit
Dng ra 5mA
S ha bi Trung tm Hc liu i hc Thi Nguyn
52
http://www.lrc-tnu.edu.vn
Giao tip:
53
http://www.lrc-tnu.edu.vn
cho bo mch, ti chng trnh xung v truyn d liu thi gian thc. Vic ci t
b iu khin bus kim tra v truyn d liu cng c thc hin vi giao din
vo/ra.
ng b ho s thc thi ca DSP v cc chng trnh ca my ch DS1104
s dng mt cng ngt hai chiu cho php my ch c th ngt DSP v ngc
li.
Giao din vo/ra gia my ch v DS1104 bao gm mt khi vi 7 cng
vo/ra lin tip. chn cc a ch c s ca khi ny trong di a ch vo ra 64K
ca PC/AT (my ch), DS1104 s dng cc chuyn mch DIP (Dual In-line
Package v hai hng chn) gn trn bo mch.
Giao din vi my ch ca DS1104 cha nhng thanh ghi c di khc nhau
(8 hoc 16 bit). Khi truy cp vo mt thanh ghi c th th phi s dng lnh vo/ra
tng ng, chng hn nh mun truy cp vo thanh ghi 8-bit th phi s dng lnh
vo/ra 8-bit, cn mun truy cp vo thanh ghi 16-bit th phi dng lnh vo/ ra 16
bit. Nu s dng cc lnh vo/ra 8-bit cho mt thanh ghi rng 16-bit th kt qu s
b li. Nu s dng ngn ng cp cao lp trnh cho cc thanh ghi giao din vi
my ch th cn phi m bo rng chng trnh dch Compiler to ra cc dng lnh
chnh xc.
Mt s thanh ghi giao din vi my ch phi c truy cp theo mt th t
c bit. ghi hoc c b nh ca DSP th mt trnh t c bit l bt buc.
a. Thanh ghi d liu (Data Register): a ch Offset: 00H v 02H
Thanh ghi d liu l mt thanh ghi c/ghi rng 32 bit c s dng truy
cp vo cc b nh off-chip (bn ngoi chip) ca DSP. Cc hot ng ghi v c
trn thanh ghi d liu lun c thc hin ti v tr b nh hin ang c chn bi
cc thanh ghi a ch LAR (Lower Address Register) v UAR (Upper Address
Register). V my ch ti mt thi im ch c th truy cp 16 bit nn thanh ghi d
liu 32-bit c chia thnh hai thanh ghi 16-bit: thanh ghi d liu thp hn LDR
(Lower Data Register) v thanh ghi d liu cao hn UDR (Upper Data Register).
chuyn mt t d liu 32-bit gia b nh ca my ch v ca DSP cn c hai
S ha bi Trung tm Hc liu i hc Thi Nguyn
54
http://www.lrc-tnu.edu.vn
php ghi hoc c lin tip. u tin, 16 bit thp hn c truy cp bng cch s
dng LDR. Sau , 16 bit cao hn c truy cp thng qua UDR. Mch chuyn i
rng bus trn bo mch (on-board) lu tr tm thi gi tr 32-bit v thc hin ch
mt truy cp 32-bit n vo b nh ca DSP. mch chuyn i rng bus hot
ng chnh xc th th t truy cp LDR-UDR nh c m t trn l bt buc.
Ni dung ca cc thanh ghi LAR v UAR phi khng i trong mt truy cp 32-bit.
V cc thit b ngoi vi trn bo mch ca DS1104 c sp xp trong b nh
ca DSP nn thanh ghi d liu cng c th dng truy cp vo cc thit b ny.
Thanh ghi d liu c th c truy cp thm ch c khi DSP dang chy cho php
chuyn d liu chy thc gia my ch v DSP.
b. Thanh ghi a ch (Address Register): a ch Offset: 04H v 06H
Thanh ghi a ch l mt thanh ghi ghi/c c rng 19-bit c s dng
chn v tr ca b nh chng trnh ca DSP. V tr b nh m thanh ghi a ch
ang tr ti c th c ghi v c thng qua thanh ghi d liu. Thanh ghi a ch
c xy dng bng hai thanh ghi, thanh ghi 16-bit cha 16 bit a ch thp
A0A15 (LAR) v mt thanh ghi 3-bit cha cc bit a ch cao A16A18 (UAR).
Thanh ghi a ch c mt ch t ng tng/gim cho php chuyn khi gia b
nh ca my ch v ca DSP. Mun cho php ch ny th bit AUTOEN trong
thanh ghi ci t (Setup Register) phi c t ln 1. Sau bit UPDOWN s
chn chiu m. Nu ch t ng tng/gim c cho php th ni dung ca
thanh ghi a ch s c t ng tng/gim sau khi hon tt mt php ghi hoc c
thanh ghi d liu 32-bit. iu ny cho php truy cp lin tip cc khi ca b nh
DSP m khng cn thay i thanh ghi a ch cho mi ln chuyn.
truy cp thanh ghi a ch thp LAR cn c mt ch lnh vo/ra my ch
16-bit, cn truy cp vo thanh ghi a ch cao UAR cn phi s dng mt ch
lnh vo/ra my ch 8-bit. truy cp ln sau vo cng mt v tr b nh thanh ghi
a ch ch cn c ghi mt ln. Ch t ng tng/gim phi c loi b
(disable) cho nhng ng dng kiu ny. Nm bit cao ca UAR khng xc nh khi
c v c gi tr 0 khi ghi.
S ha bi Trung tm Hc liu i hc Thi Nguyn
55
http://www.lrc-tnu.edu.vn
Chc nng
Tn
0 RESET14
1 TBCINT
2 RSTDSP
3 TBCRST
4 TBCRDY
Trng thi ti lp (reset) Slave-DSP. RESET14=1 biu th SlaveDSP b thit lp li, RESET14=0 biu th Slave-DSP ang chy.
Trng thi ngt TBC. TBCINT=1, mt ngt TBC ti my ch hot
ng. TBCINT=0, my ch hon tt dch v ngt.
Trng thi ti lp TMS320C31. RSTDSP=1, DSP c reset.
RSTDSP=0, DSP ang chy.
ng reset TBC. TBCRST=1, TBC c reset. TBCRST=0,
TBC ang chy.
ng sn sng ca TBC. TBCRST=0 khi TBC ang thc thi mt
lnh. TBCRST=1 khi TBC kt thc mt lnh.
C sn sng truyn thng Slave-DSP. DSPRDY14=1, Slave-DSP
7 UPDOWN
56
http://www.lrc-tnu.edu.vn
Chc nng
Tn
1 RSTDAC
RSTDAC=1.
Lu rng thanh ghi ch DA phi c t ch khuch i
ng nht v hai cc sau khi RSTDAC c p dng
Reset TMS320C31. Ghi 1 reset DSP. Ghi 0 s ngt ng reset
2 RSTDSP
v cho php DSP bt u thc thi chng trnh. Khi khi ng,
TMS320C31 b reset.
3 TBCRST
4 IRQDSP
5 IRQEOI
6 AUTOEN
ch
tng/gim.
t ng tng/gim.
AUTOEN=1
7 UPDOWN loi
Chnbch
Ch Khi
tngkhi
nung
UPDOWN=1.
Ch
S ha bi Trung tm Hc liu i hc Thi Nguyn
57
http://www.lrc-tnu.edu.vn
58
http://www.lrc-tnu.edu.vn
59
http://www.lrc-tnu.edu.vn
60
http://www.lrc-tnu.edu.vn
61
http://www.lrc-tnu.edu.vn
Th t u tin
RESET
TI RESERVED
NMI
INT1
INT2
INT3
INT4
INT5
INT6
TI RESERVED
10
ng ngt
INT1
System Module
INT5
NMI
INT6
INT2
Event Manager
INT3
INT4
62
http://www.lrc-tnu.edu.vn
c tng s 64K 16Bit Word. Trong khong 64K Word ca khng gian d liu, t
256 n 32K word phn nh ca vng nh c th c xc nh m rng b
nh chung, khi c ch nh bi vng nh a phng (GREG). Vic truy cp vo
vng nh chung c iu khin bi tn hiu o BR.
B ghi bn b nh
v d tr
Cc ngt ngoi
Cc ngt
(On-Chip)
Dng cho bn
ngoi
On-Chip ROM
(Flash EEPROM)
(8 x 2K Segments)
On-Chip
DARAM B2
D tr
On-Chip DARAM B0
(CNF = 1)
hoc Bn ngoi (CNF
= 0)
On-Chip DARAM B0
(CNF = 1)
hoc Bn ngoi (CNF
= 0)
D tr
D tr
On-Chip DARAM B0
(CNF = 0)
hoc
D tr (CNF = 1)
On-Chip DARAM B1
D tr
Cm
B ghi bn b nh
ngoi vi (h thng,
WD,
ADC, SPI, SCI,
cc ngt, I/O)
B ghi bn b nh
ngoi vi
(Qun l s kin)
D tr
Ghi ch iu khin
Flash
D tr
D tr
Cm
iu khin b ghi khi
ch i c to ra
Dng cho bn ngoi
63
http://www.lrc-tnu.edu.vn
D tr
B ghi mt n v ngt
B ghi ton b vng nh a phng
B ghi bn b nh v d tr
B ghi cc c ngt
B ghi cc c ngt
On-Chip DARAM B2
D tr
Cm
B ghi cu trc h thng v iu khin
On-Chip DARAM
B0 (CNF = 0)
D tr (CNF = 1)
On-Chip
DARAM B1
ADC
SPI
SCI
Cm
D tr
Cm
Cm
Peripheral Frame 2
B ghi Timer a mc ch
D tr
Cm
D tr
B ghi so snh, PWM v vng cht
M rng
(Dng cho bn ngoi)
D tr
B ghi Capture & QEP
D tr
B ghi mt n che ngt, vector v c
D tr
64
http://www.lrc-tnu.edu.vn
65
http://www.lrc-tnu.edu.vn
ADC sau khi qu trnh chuyn i kt thc. Hnh 2.6 biu din s khi ca h
con AD.
Thanh ghi
023000H
023001H
023002H
023003H
66
http://www.lrc-tnu.edu.vn
http://www.lrc-tnu.edu.vn
Hnh 2.9.
67 Mch u vo ca ADC
Thanh ghi
022000H
022001H
022002H
022003H
026000H
026001H
68
http://www.lrc-tnu.edu.vn
Ch
Name
24
M4
27
M1
28
G4
Chc nng
Ch DA. Ghi 1 cho hot ng hai chiu, ghi 0 cho
hot ng mt chiu
Khuch i DA. Ghi 1 cho h s khuch i = 2, ghi 0
69
http://www.lrc-tnu.edu.vn
31
G1
cho h s khuch i =1
70
http://www.lrc-tnu.edu.vn
a ch
IOP
0:0
M t
Thanh ghi cng vo/ra. Lu gi d liu u ra cho cc chn
vo/ra v c nh cu hnh nh l u ra
Thanh ghi hng d liu. DDR = 1 nh cu hnh cho chn
DDR
0:1
BSET
0:2
BCLR
0:3
71
http://www.lrc-tnu.edu.vn
72
http://www.lrc-tnu.edu.vn
liu hai chiu lin tc. Bn cnh nh dng d liu khng ng b chun, cng ni
tip cn h tr thm mt giao thc truyn thng 9-bit kiu 8051 ca Intel trong
bit th 9 biu th a ch hoc truyn d liu.
e. Cng truyn thng DSP (DSP communication Port)
Truyn thng gia TMS320F240 v DSP t (slave-DSP) c thc hin qua
mt thanh ghi truyn thng rng 32-bit (DSPC). Thanh ghi ny trao i d liu gia
TMS320F240 v Slave-DSP da trn giao thc lnh/d liu (command/data). 16-bit
cao ca thanh ghi DSPC cha cc lnh c thc hin bi Slave-DSP cn 16-bit
thp cha i s ca lnh hoc cha phn kt qu thc hin lnh. 16-bit cao ch
c ghi bi TMS320F240 v c c bi Slave-DSP nhng phn thp th c
ghi/c bi c DSP ch v DSP t. i vi TMS320F240 th DSPC l mt thanh
ghi 32-bit n, cn i vi TMS320P14 th DSPC l hai thanh ghi 16-bit, l
thanh ghi CCMD (Communication Command) v CDATA (Communication Data),
trong dy (bank) vo/ra bn ngoi ca TMS320P14.
f. Truyn thng m rng
FIFO c th c s dng cho chuyn giao khi gia TMS320F240 v DSP
t. FIFO s dng 5 a ch ca Slave-DSP cho truyn thng.
chuyn mt khi d liu t TMS320F240 ti Slave-DSP, trc tin ng
dng phi c thanh ghi CCMD ly lnh, sau c thanh ghi CDATA ly s
t d liu.
chuyn mt khi d liu t Slave-DSP ti TMS320F240, trc tin
TMS320F240 ghi mt lnh tng ng vo thanh ghi CCMD. ng dng SlaveDSP s c thanh ghi CCMD ly lnh. Sau , thc hin mt lnh c gi trn
thanh ghi CDATA xo cho ln chuyn tip theo.
2.2.3.5. H con b m ho so lch (Incremental encoder subsystem):
DS1104 cha hai giao din cm bin so lch h tr cc cm bin so lch
quang hc c s dng ph bin trong iu khin v tr. Mi giao din cha cc b
thu ng truyn (line-receiver) khc nhau cho cc tn hiu u vo, mt b lc
S ha bi Trung tm Hc liu i hc Thi Nguyn
73
http://www.lrc-tnu.edu.vn
74
http://www.lrc-tnu.edu.vn
75
http://www.lrc-tnu.edu.vn
76
http://www.lrc-tnu.edu.vn
Tn
ADC 1-4
DAC 1-4
CAP 0-3
CMP 0-3
IOP 1-15
Ni t s. Ni vi mt h thng bn trong.
77
http://www.lrc-tnu.edu.vn
INTEXT
XF0,XF1
RCD
DSP .
Truyn d liu. u ra d liu ni tip tng thch RS232 ca Slave-
TXD
DSP .
WDTINT
TCLK 1,2
Phi0,/Phi0
Phi90,/Phi90
Index,/Index
Vsupply
78
http://www.lrc-tnu.edu.vn
79
http://www.lrc-tnu.edu.vn
80
http://www.lrc-tnu.edu.vn
81
http://www.lrc-tnu.edu.vn
82
http://www.lrc-tnu.edu.vn
83
http://www.lrc-tnu.edu.vn
84
http://www.lrc-tnu.edu.vn
85
http://www.lrc-tnu.edu.vn
86
http://www.lrc-tnu.edu.vn
87
http://www.lrc-tnu.edu.vn
SPWM3
SPWM5 c to ra bi
DSP c dng nh hnh
2.29
Gi tr T0 c xc nh
nh T0=Tp-T1-T2. V T0
0 nn gii hn ca T1 v T2 nh sau T1 + T2 Tp.
88
http://www.lrc-tnu.edu.vn
Khi ng
Control Desk
Start
To mt th mc mi t
ng dng: C:\NewApp
Khi ng Matlab
- Simulink
To ng dn n th mc
mi bng lnh Set path
Xy dng mt m hnh
Simulink
Thit lp cc tham s m phng
- Stop time = inf
- Solver Type = fixed-step
- Method = ode1 (Euler)
- Fixed Step size = Thi gian
ct mu yu cu.
- Mode = Single Tasking
To m DSP bng cch s dng
Tools/RTWBuild hoc Ctrl-B
Nhn file m: *.obj - m DSP
*.tlc - cc bin ca m hnh
To mt ng dng mi
To -ng dn Working Root
n th- mc C:\NewApp
To mt lp (Layout) mi
bng lnh: File/New/ Layout.
Thm vo cc iu khin v
quan st (scope) t ca s
Tools bng cch ko v th cc
biu t-ng ho t-ng ng.
M file cha cc bin
Nhn Ctrl-T m file *.tlc
Gn bin cho cc iu khin
Ko v th cc bin cn phi
theo di vo mi iu khin t
tap ToolWindow pha bn
d-i mn hnh ca Layout.
Thm tt c cc file m
Nhn File/Add all opened files
lin kt cc file.
Np m i t-ng
Nhn Load Application v chn
file *.obj
Stop
Chy ng dng
(a)
(b)
89
http://www.lrc-tnu.edu.vn
90
http://www.lrc-tnu.edu.vn
91
http://www.lrc-tnu.edu.vn
lnh
theo,
RTW
92
http://www.lrc-tnu.edu.vn
Tool Window
c hin th
di mn
hnh. Cc th
(Tap) hin th
cc cng c
hin ang s
dng. hnh
2.33 hin ti ch s dng hai cng c l Log Viewer (Trnh xem cc gii thch) v
Reference Data Manager (trnh qun l d liu chun).
C mt cng c rt quan trng, l Variable Manager (trnh qun l bin),
n bao gm Variable Browser (trnh duyt bin) v Parameter Editor (trnh hiu
chnh tham s). N cho php truy cp n cc bin ca ng dng. Nhng bin ny
S ha bi Trung tm Hc liu i hc Thi Nguyn
93
http://www.lrc-tnu.edu.vn
Nhn
File/Open
Th
Variable
94
http://www.lrc-tnu.edu.vn
din v thm cc dng c, thit b vo. to giao din ny, t menu File nhn
File/New/Layout. Xut hin hai ca s mi trong khng gian lm vic Control Desk
(hnh 2.37). Ca s th nht c t tn l Layout1 cha cc dng c dng
qun l th nghim. Ca s th hai thc t l mt thanh cng c (Toolbar) cho php
ta ko v th cc iu khin cn thit cho th nghim.Cc iu khin c hin th
trong thanh cng c Virtual Instruments (cc dng c o) cho php ta iu khin ch
cc bin m bin c th hiu chnh trc tuyn (on-line).
Chn nt Slider t
thanh cng c pha bn
phi. Con tr chuyn
thnh dng u rui hnh
vung. Nhn v gi chut
trong khi ko thnh mt
hnh ch nht trong ca
s Layout1 (hnh 2.38).
Hnh 2.36. Ca s New Layout
Sau khi th
chut,
ta
nhn
mt
iu
khin
dng
con
c chn.
Kch p chut vo iu khin con trt Slider thay i tham s ca Slider.
Nu ta quyt nh s dng h s khuch i nm trong khong 0 v 5, chn th
Slider ri t Range Min v Range Max nh hnh 2.39. Sau khi nhn OK th gii
hn m con tr c th iu chnh c l t 0 n 5. Nhng Slider vn c bao
S ha bi Trung tm Hc liu i hc Thi Nguyn
95
http://www.lrc-tnu.edu.vn
96
http://www.lrc-tnu.edu.vn
vo ca s Variable Manager v ko hai tn hiu cn gim st l Model Root/InGain->Out1 v Model Root/Slider Gain->Out1 ri th vo hnh ch nht va v.
Khi ko tn hiu th hai cn m bo th chut vo cng mt trc vi tn hiu
th nht. Nu khng th mt trc th hai s c v v khng gian cn li quan
st hnh dng ca tn hiu s b thu hp li. Hai tn hiu c gn vo Plotter v
c hin th vi cc mu khc
nhau. Nhn ca trc c gn tn
hiu s ch hin th tn hiu cui
cng c gn.
Ti bt k thi im no,
mun sa i hoc xem c
nhng tn hiu no c gn
vo th, nhn chut phi vo
khu vc quan st v chn lnh
Edit Data Connections. C th
xo bt k mt tn hiu no bng
cch chn n v nhn phm
Delete.
97
http://www.lrc-tnu.edu.vn
Trc khi thc hin m phng cn thit lp cc tham s quan st. thit lp
cc tham s quan st, chn lnh Capture Settings Window trong menu
View/Controlbars.
Trong ca s Capture Settings Window (hnh 2.43), t di m phng
Length l 2, gi nguyn s Downsampling. i vi cc h thng phc tp hn th
s ny cn c tng ln khi di m phng ln hn 20 ln thi gian ly mu.
Bc cui cng l chy v dng th nghim. chy v dng s thc thi ca
DSP, c th s dng cc biu tng start v stop trn thanh cng c Hardware
Management nh hnh 2.44a. khi ng DSP, nhn chut vo biu tng hnh
tam gic mu xanh, nu file example1.obj c np vo b nh ca DSP th n
s bt u chy v biu tng Stop c dng hnh ch nht mu s sng ln.
dng th nghim, nhn chut vo biu tng c dng hnh ch nht mu .
quan st s thay i ca tn hiu, khi ng Animation bng cch nhn
biu tng pha bn phi ca thanh cng c Edit Mode.
Quan st trn mn hnh s thy hai tn hiu vo v ra c v trn Plotter. C
sau hai giy, th hnh nh hin th li b xo v mt tp d liu mi li c hin th.
Thay i h s khuch i bng cch di chuyn con trt ca Slider v quan
st s thay i ca cc tn hiu.
(a)
(b)
98
http://www.lrc-tnu.edu.vn
GND
INPUT
FAULT
2
99
http://www.lrc-tnu.edu.vn
Uk
ik
Uk(p)
(p)
(p)
(p)
R
(-)
Ui
Ui(p)
Ri
R
(-)
PA
(-)E(p)
(-)
FT
Ki
1 pTi
K
1 pT
K
1 pT
1
p
100
http://www.lrc-tnu.edu.vn
Uk , Ik
: in p v dng in kch t.
: momen ca ng c mt chiu.
Mc
: momen ti.
Mc
ik
Uk
LR-
di k
Uk
; ik =
dt
R k (1 pTk )
Trong :
Tk =
Lk
: hng s thi gian mch kch t, thng thng
Rk
Tk 100 ms 600ms
Trn hnh 3.3 l s thay th mch in phn ng:
U - E = R . (1 + pT). I
T =
L ud
: hng s thi gian phn ng.
R ud
i
101
http://www.lrc-tnu.edu.vn
Khi = const: Dng khu khuch i K thay cho khi nhn phi tuyn:
Mc(p)
I(p)
U(p)
1/ R
1 pT-
(-)
(p)
1
Jp
Ko
(-)
Ko
(-)
KIo
Ko
Uk (p)
1/ R
1 pTk
Kk
Hnh 3.4. M hnh tuyn tnh ho ng c in mt
chiu
t: Cu = K = const ta c m hnh tuyn tnh nh trn hnh 3.5.
T m hnh trn hnh 3.5 ta tnh c:
U - Cu. = R.I(1 + p . T)
Cu.I Mc
=
Jp
Cu
(-)
U(p)
1/ R
1 pT-
I(p)
Cu
1
Jp
(p)
(-)
1
Cu
Mc(p)
Hnh 3.5. M hnh tuyn tnh ho ng c in mt
chiu
S ha bi Trung tm Hc liu i hc Thi Nguyn
102
http://www.lrc-tnu.edu.vn
U+
Cu.Mc
= R.I.
Jp
Cu 2
1+p.T
+
pJR
I.(p.JR p 2 .JR.T- Cu 2
p.U.I Cu.Mc
=
Cu 2
Cu 2
Vy ta c:
JR
Mc
pU
2
Cu
Cu R
I=
JR
JR
1
p
T- p 2
Cu 2
Cu 2
Tc p / R
1 Tc p T- Tc p 2
I(p)
1 / Cu
1 Tc p T- Tc p 2
Mc(p)
Mch
iu khin
PA
Uk
103
http://www.lrc-tnu.edu.vn
T o
.
K cl
(1 pTdk ).(1 pTv )
dt
Uk(p)
Ui(p)
Ui
Ri
(-)
Cu
(-) E(p)
(-)
K cl
(1 Tdk p)(1 Tv p)
1/ R
1 pT-
Cu
Mc
1
Jp
Ki
1 pTi
Hnh 3.8. S mch vng iu chnh dng in
S ha bi Trung tm Hc liu i hc Thi Nguyn
104
http://www.lrc-tnu.edu.vn
L
: hng s thi gian in t ca mch phn ng.
R
R = Rb + Rk + Rd + Rs
L = Lb + Lk + Ld
Ki = Rs : in tr ca sensor.
Ti = R . C : hng s thi gian ca sensor dng in.
UI
UI(p)
RI
Soi
I(p)
(-)
Hnh 3.9.
Vit gn li ta c s nh trn hnh 3.9:
Trong :
Tk 100 s, Tv 2,5ms, Ti 2ms, T 100ms
Thay Tsi = Ti + Tv + Tk << T , b qua cc h s bc cao ta c:
Ki
R
Soi (p)
(1 pTsi )(1 pT- )
K cl
105
http://www.lrc-tnu.edu.vn
1
1 2 p 2 2 p 2
FOMi =
FOMi (p) =
Ri(p) =
Ri(p) =
FOMi
S oi FOMi .S oi
1
1 2 P 2 2 P 2
K
K cl i
R
.2 P(1 P)
1 pTsi 1 pT-
1 PT2P.K cl .K i .
Tsi
R
.1
pT-
FOMi = U i (p) =
U id ( p)
1
1 2TSi p 2TSi2 p 2
106
http://www.lrc-tnu.edu.vn
(p)
Ui(p)
(p)
R
(-)
(-)
1
Ki
1
1 2TSi P
R
1
CuTc p
p
K
1 pT
K
1 pT
R.K
K 1 .Cu.Tc .p.(1 p.Ts )
Vi TS = 2TSi + T TS rt nh.
p dng tiu chun ti u modul: U
U(p)
So
(p)
(-)
FOM =
1
; R (p) =
1 2 p 2 2 p 2
Hnh 3.11
S o
FOM
FOM .S o
1
1+2 p+2 2 p 2
R (p) =
R.K
1
12 2
K1.Cu.Tc .p.(1+p.Ts ) 1+2 p+2 p
R (p) =
Chn
1
R.K
.2 p(1 p(1 p)
K1 .Cu.Tc .p.(1 p.Ts )
= TS
107
http://www.lrc-tnu.edu.vn
Ta c:
Vy:
R(p) =
K i .Cu .Tc
R .K .2.Ts
1 4 p
FOM
2 2
3 3 ; R (p) =
1 4 p 8 p 8 p
S o FOM .S o
1+4 p
1+4 p+8 2 p 2 +83 p3
R(p) =
R.K
1+4 p
1
K1.Cu.Tc .p.(1+p.Ts ) 1+4 p+8 2 p 2 +83 p3
R(p) =
1+4 p
R.K
8 2 p 2 1+ p
K1.Cu.Tc .p.(1+p.Ts )
Chn = Ts ta c: R(p) =
1 4Ts p
R.K
8Ts2 p
K1 .Cu.Tc
108
http://www.lrc-tnu.edu.vn
Khi dng
chun ti
u modul
(p)
1
1
=
.
d (p) 1+2Ts p+2Ts2 p2 K
(p)
R
(-)
(p)
1
1
.
2 2
3 3
d (p) 1 4Ts p 8Ts p 8Ts p K
Khi dng
chun ti
u i
xng
Kr
p
K
1 pT
Hnh 3.12
.
d (p) 1 2Ts p K
(p)
1
1
.
d (p) 1 4Ts p K
U (p)
So
(p)
(-)
Hnh 3.13
R
R
S0(p) =
(1 2Ts . p) p(1 pT )
109
http://www.lrc-tnu.edu.vn
K
1 p
.2 p.
K . p (1 2 p.Ts )
1 T p
Chn = T . Ta c: R(p) =
Vi: K =
K
K .2T
K
(1 + 2Tsp); R = K + KD . p
K .2T
v KD =
K Ts
K .T
R l khu t l - o hm (PD)
Khi tng hp mch vng tc dng chun ti u i xng ta c hm truyn
ca i tng:
K
K
S0(p) =
(1 4Ts . p) p(1 pT )
p dng tiu chun ti u modul, ta c:
R(p) =
Chn: = T
K
1 p
.2 p.
K . p (1 4 p.Ts )
1 T p
ta c: R(p) =
K
(1 + 4Tsp)
K .2T
110
http://www.lrc-tnu.edu.vn
Pm
: Cng sut nh mc ca ng c
= 1,5
Kw
Um
: in p phn ng nh mc
= 140
nm
: Tc quay roto nh mc
= 2000
v/ph
Idm
: Dng in nh mc
= 13.8
: in cm phn ng
= 0,2
Ti
= 0,002
Tv
= 0,0025
Tk
= 0,001
= 0,001
= 0,3
GD2
= 0,01
Kg,m2
111
http://www.lrc-tnu.edu.vn
PN
2a
P : S i cc t chnh.
N : S thanh dn tc dng ca cun dy phn ng.
: T thng kch t di mt cc t.
: Tc gc.
K=
PN
: H s cu to ca ng c.
2a
E = Ken
n : Tc Roto.
=
n
1500
K
2n
=
; m =
= 209,4 rad/s; Ke =
= 0,105K
9,55
9,55
60
9,55
Uu R u +R f
Iu
Cu
Cu
Uu R u Rf
M
Cu
(Cu ) 2
M dt
; Mdt = Mc = M
Cu
Pdm
dm
2000
9,55 Nm
209, 4
M dm 9,55
=
=0,7
Idm 13,8
U dm
140
= 0,5(1 - 0,9)
= 0,5
I dm
13,8
112
http://www.lrc-tnu.edu.vn
L = Lb + Lk + Ld = 0,2 H
T =
L
: Hng s thi gian phn ng.
Ru
Tu =
0, 2
0, 4 s
0,5
U dm 140
14
U dk
10
RTu
1
1+
Ri =
Uid
7
=
=0,51
Idm 13,8
0,5.0,4
1
1+
-3
2.14.0,51.4,6.10 0,4p
Ri = 3,045 1+
0,4p
K= 4,7 0,0224
209, 4
T = 1ms
Tsi = 4,6 . 10-3s
113
http://www.lrc-tnu.edu.vn
Tc =
JR 2.45.0,5
2,5 s
Cu 2
0, 72
Ts = 0.01s
R(p) =
K i .Cu.Tc
0,51.0,7.2,5
=
=8662
R.K .2Ts 0,5.0,0224.2.4,6.10-3
R
0,5
=
=0,286
Cu.Tc 0,7.2,5
K =
10
0,032 ; = .dt=.t
100
0
K
(1 + 2.Tsp)
K .2.T
B iu chnh v tr R : R =
0,0224
(1+0,02p)
0,032.2.0,3
= 1,167 . (1 + 0,02p)
3.1.4. M phng h trn Matlab.
lp trnh cho h th nghim thc, th trc ht ta phi m phng nh gi
cc kt qu tng hp h.
114
http://www.lrc-tnu.edu.vn
115
http://www.lrc-tnu.edu.vn
v tr t
(-)
Ri
R
(-)
vi phn
(-)
DAC
PWM
Power
AMP
C
Servo
v tr
thc
ADC
ADC
Sensor
v tr
Card DS1104
116
http://www.lrc-tnu.edu.vn
d
a ph
Fuzzy logic
Contrller
Analog Output
D/A
Power
AMP
DC
Servo
CardDS1104
Incremental
encoder
Encoder
24 bit
k ) e( k ) e( k 1 )
e( k ) d ( k ) a ( k ) ; e(
trong
117
http://www.lrc-tnu.edu.vn
Card DS1104
Icremental
encoder
e / e NB NM NS Z
NB
NM
NS
Z
PS
PM
PB
PS
NB NB NB NB NS
NB NB NM NM Z
NB NB NS NS Z
NB NB NS Z
PS
NB NM Z
PS PS
NB NS Z
PM PM
NB NS PS PB PB
Bng 3.2. Lut iu khin
PM
PS
PS
PM
PB
PB
PB
PB
PB
PB
PB
PB
PB
PB
PB
PB
118
http://www.lrc-tnu.edu.vn
119
http://www.lrc-tnu.edu.vn
120
http://www.lrc-tnu.edu.vn
1500
vi tri dat
toc do
vi tri
1000
500
vi tri
-500
toc do
-1000
-1500
0.5
1.5
2.5
3.5
4.5
My tnh s
Card DS1104
Matlab 7.0.4
ControlDesk
I/O connector:P1A
P1B
I/O connector:P1A
P1B
Driver Servo
motor MidiMaestro
Matador DC
Servo Motor
121
http://www.lrc-tnu.edu.vn
2. Card DS1104.
Cc chn tn hiu vo ra v
ngun ca Card DS 1104 c ni
n i tng bng 2 cp P1A v
P1B.
- Knh chuyn i s-tng t
DACH6(Pin46-DACH6,
Pin45-
122
http://www.lrc-tnu.edu.vn
- ng c c ch to ng b km
theo my pht tc mt chiu, encoder
24 bit.
5. B iu khin ti v ti AS motor.
3.3.2. Lp trnh iu khin h.
Vi kt qu m phng Offline, trong
phn ny ta tin hnh lp trnh iu
khin h thc nghim.
Bc 1: Xc nh hm truyn ca i
Hnh 3.30.DC servo motor
tng hp h thng)
Bc 3: B xung thm cc
khi xut/nhp d liu:
-DS1104ADC_C5
Chuyn
i tn hiu vo tng t (10V10V) thnh tn hiu s(o
tc bng my pht tc).
-DS1104ADC_C6
Chuyn
i tn hiu vo tng t (10V10V) thnh tn hiu s
(dng in).
-DS1104DAC_C6
Chuyn
i tn hiu s thnh tn hiu
tng t (-10V10V)
- Chn thi gian ly mu tn
hiu: T=0.001S.
123
http://www.lrc-tnu.edu.vn
Version
124
http://www.lrc-tnu.edu.vn
V tr
Tc
V tr t
125
http://www.lrc-tnu.edu.vn
126
http://www.lrc-tnu.edu.vn
Hnh 3.40.
3.38. Kp=0.05, Kd=0.02334, Idm=4A
S ha bi Trung tm Hc liu i hc Thi Nguyn
127
http://www.lrc-tnu.edu.vn
128
http://www.lrc-tnu.edu.vn
129
http://www.lrc-tnu.edu.vn
130
http://www.lrc-tnu.edu.vn