Professional Documents
Culture Documents
MSSV:20081090
Lp
:TDH1-K53
Bi Thc Hnh S 1
Tm m hnh gin on ca CMC
>> Ra=0.25;La=0.004;J=0.012;ke=236.8;km=38.2;fi=0.04;
>> Ta=La/Ra;
>> Wh=1/Ra *tf(1,[Ta 1])*km*fi*tf(1,[2*3.14*J 0])
Transfer function:
6.112
-----------------------0.001206 s^2 + 0.07536 s
>> Wk=feedback(Wh,ke*fi)
Transfer function:
6.112
-------------------------------0.001206 s^2 + 0.07536 s + 57.89
>> step(Wk)
>> Wz1=c2d(Wk,0.1e-3)
Transfer function:
2.529e-005 z + 2.524e-005
------------------------z^2 - 1.993 z + 0.9938
Sampling time: 0.0001
>> step(Wz1)
>> Wz2=c2d(Wk,0.01e-3)
Transfer function:
2.534e-007 z + 2.533e-007
------------------------z^2 - 1.999 z + 0.9994
Sampling time: 1e-005
>> step(Wz2)
>> Wz3=c2d(Wk,0.1e-3,'zoh')
Transfer function:
2.529e-005 z + 2.524e-005
------------------------z^2 - 1.993 z + 0.9938
Sampling time: 0.0001
>> step(Wz3)
>> Wz4=c2d(Wk,0.01e-3,'zoh')
Transfer function:
2.534e-007 z + 2.533e-007
------------------------z^2 - 1.999 z + 0.9994
Sampling time: 1e-005
>> step(Wz4)
>> Wz5=c2d(Wk,0.1e-3,'foh')
Transfer function:
8.435e-006 z^2 + 3.369e-005 z + 8.409e-006
-----------------------------------------z^2 - 1.993 z + 0.9938
Sampling time: 0.0001
>> step(Wz5)
>> Wz6=c2d(Wk,0.01e-3,'foh')
Transfer function:
8.447e-008 z^2 + 3.378e-007 z + 8.444e-008
-----------------------------------------z^2 - 1.999 z + 0.9994
Sampling time: 1e-005
>> step(Wz6)
>> Wz7=c2d(Wk,0.1e-3,'tustin')
Transfer function:
1.263e-005 z^2 + 2.526e-005 z + 1.263e-005
-----------------------------------------z^2 - 1.993 z + 0.9938
Sampling time: 0.0001
>> step(Wz7)
>> Wz8=c2d(Wk,0.01e-3,'tustin')
Transfer function:
1.267e-007 z^2 + 2.534e-007 z + 1.267e-007
-----------------------------------------z^2 - 1.999 z + 0.9994
Sampling time: 1e-005
>> step(Wz8)
10
B=
1
0
C=
1.0e+003 *
0
5.0680
D =0
11
x2
-62.49 -4.8e+004
x2
b=
u1
x1 1
x2 0
c=
x1
y1
x2
0 5068
d=
u1
y1 0
Sampling time: 0.0001
Discrete-time model.
>> SYS = SS(A,B,C,D,0.01e-3)
a=
x1
x1
x2
-62.49 -4.8e+004
x2
b=
u1
x1 1
x2 0
12
c=
x1
y1
x2
0 5068
d=
u1
y1 0
Sampling time: 1e-005
Discrete-time model.
Bi Thc Hnh S 2
Tng Hp Vng iu Chnh Phn ng(iu Khin M Men Quay)
Ta c :
>> Gz1=c2d(Wk,0.1e-3,'zoh')
Transfer function:
2.529e-005 z + 2.524e-005
------------------------z^2 - 1.993 z + 0.9938
Sampling time: 0.0001
) = L0 +L1*
13
Transfer function:
6612 - 1.969e004 z^-2 + 1.31e004 z^-3
14
Kt qu
15
-Bac 2 voi L(
) = L0 +L1*
+ L2*
>> Wz1=c2d(Wk,0.1e-3)
Transfer function:
2.529e-005 z + 2.524e-005
------------------------z^2 - 1.993 z + 0.9938
>> Bz=filt([0 2.529e-5 2.524e-5],1)
Transfer function:
2.529e-005 z^-1 + 2.524e-005 z^-2
Sampling time: unspecified
>> Az=filt([1 -1.993 0.9938],1)
Transfer function:
1 - 1.993 z^-1 + 0.9938 z^-2
Sampling time: unspecified
>> mtc=1+1.993*1.993-(-1.993+0.9938);
>> L0=1/mtc *(2.529e-5+2.524e-5)
L0 =
8.4622e-006
>> L1=1.993/mtc
L1 =
0.3338
>> L2=(1.993*1.993-0.9938)/mtc
L2 =
0.4988
16
17
18
19
Bi Thc Hnh S 3
Tng Hp Vng iu Chnh Tc Quay
Ta c :
>> Gw1=filt([0 0.5 0.5],1)
Transfer function:
0.5 z^-1 + 0.5 z^-2
>> Gn1 = 38.2*0.04*tf([1],[2*pi*0.012 0])
20
Transfer function:
1.528
-------0.0754 s
>> Gn1z = c2d(Gn1,0.1e-3)
Transfer function:
0.002027
-------z-1
Sampling time: 0.0001
>> Gn = Gw1*Gn1z
Transfer function:
0.001013 z^-2 + 0.001013 z^-3
----------------------------1 - z^-1
Sampling time: 0.0001
>> step(Gn/(1+Gn))
21
Step Response
1
0.9
0.8
0.7
Amplitude
0.6
0.5
0.4
0.3
0.2
0.1
0
0.05
0.1
0.15
0.2
0.25
0.3
Time (sec)
+ (a1-1)
- a1
(a1-1+ b1)
- ( b3+ b2)
b3
Chn
nh nht
22
iu kin:
suy ra:
Ta ln lt tnh c:
=1
=1
= 0.997974
= 0.991896 0.0001013
= 0.981766 0.0004052
T ta tnh c r1 = 2.52e-004
Chn
= -20
Gr =
Step Response
1
0.9
0.8
0.7
Amplitude
0.6
0.5
0.4
0.3
0.2
0.1
0
0.002
0.004
0.006
0.008
0.01
0.012
0.014
Time (sec)
24
-------------------------------
1 - z^-1
B iu khin c dng:
Gr(z) =
= P(z).A(z) +R(z).B(z)
= (z-1)(
=
)+(
).(b1
+ (a1-1+b1 )
+ (-a1 +b1
)
+b2 )
+(b3.
+b2. )z +b3.
25
Gi s cc im cc ca i tng l: z1,z2,z3,z4
N(z)
= (z-z1).(z-z2).(z-z3).(z-z4)
=
- (z1+z2+z3+z4) + (z1.z2+z3.z4-z1.z3-z1.z4-z2.z3-z2z4)
(z1.z2.z3+z1.z2.z4+z1.z3.z4+z2.z3.z4)z + z1.z2.z3.z4
Chn z1,2 = 0.5
0.35i
Cn bng h s ta c:
= 27.08
= -26.24
>> Gr = filt([27.08 -26.24],1)/filt([1 -1],1)
Transfer function:
27.08 - 26.24 z^-1
-----------------1 - z^-1
Sampling time: unspecified
>> Gz = Gr*Gn
Transfer function:
0.02744 z^-2 + 0.0008512 z^-3 - 0.02659 z^-4
-------------------------------------------1 - 2 z^-1 + z^-2
Sampling time: 0.0001
26
Step Response
1.4
1.2
Amplitude
0.8
0.6
0.4
0.2
0.005
0.01
0.015
0.02
0.025
Time (sec)
27
28
29
Bi Thc Hnh S 4
Tng Hp B iu Chnh Tc Quay Trn KGTT
>> [A,B,C,D] = tf2ss(6.112,[0.001206 0.07536 57.89])
A=
1.0e+004 *
-0.0062 -4.8002
0.0001
B=
1
0
C=
1.0e+003 *
0
5.0680
D =0
>> [Ad1,Bd1,Cd1,Dd1]=c2dm(A,B,C,D,0.1,'zoh')
Ad1 =
-0.0438 -2.9297
0.0001 -0.0400
Bd1 =
1.0e-004 *
0.6103
0.2167
30
Cd1 =
1.0e+003 *
0
5.0680
Dd1 =
0
>> P1 = [0 0];
>> P2 = [0.2 0.3];
>> K = acker(Ad1,Bd1,P1)
K=
1.0e+003 *
-0.0276 -3.7924
>> H1=ss(Ad1-Bd1*K,Bd1,Cd1,Dd1,0.1)
a=
x1
x2
x1 -0.04215
-2.698
x2 0.0006584
0.04215
b=
u1
x1 6.103e-005
x2 2.167e-005
c=
x1
y1
x2
0 5068
d=
u1
31
y1 0
Sampling time: 0.1
Discrete-time model.
>> step(H1)
Step Response
0.12
0.1
Amplitude
0.08
0.06
0.04
0.02
0.2
0.4
0.6
0.8
1.2
1.4
1.6
1.8
Time (sec)
>> H2=ss(Ad1-Bd1*K,Bd1,Cd1,Dd1,0.01)
a=
x1
x2
x1 -0.04215
-2.698
x2 0.0006584
0.04215
b=
u1
x1 6.103e-005
32
x2 2.167e-005
c=
x1
y1
x2
0 5068
d=
u1
y1 0
Sampling time: 0.01
Discrete-time model.
>>step(H2)
Step Response
0.12
0.1
Amplitude
0.08
0.06
0.04
0.02
0.02
0.04
0.06
0.08
0.1
0.12
0.14
0.16
0.18
0.2
Time (sec)
>> K = acker(Ad1,Bd1,P2)
K=
33
1.0e+004 *
-0.1315 -2.3244
>> H3=ss(Ad1-Bd1*K,Bd1,Cd1,Dd1,0.01)
a=
x1
x2
x1 0.0364 -1.511
x2 0.02854 0.4636
b=
u1
x1 6.103e-005
x2 2.167e-005
c=
x1
y1
x2
0 5068
d=
u1
y1 0
Step Response
0.25
0.2
Amplitude
0.15
0.1
0.05
0.02
0.04
0.06
0.08
0.1
0.12
0.14
0.16
0.18
0.2
Time (sec)
>> H4=ss(Ad1-Bd1*K,Bd1,Cd1,Dd1,0.1)
a=
x1
x2
x1 -0.1855
-31.78
x2 0.005889
0.6855
b=
u1
x1
0.002789
x2 2.759e-005
c=
x1
y1
x2
0 5076
d=
u1
35
y1 0
Sampling time: 0.1
Discrete-time model.
>> step(H4)
Step Response
0.5
0.45
0.4
0.35
Amplitude
0.3
0.25
0.2
0.15
0.1
0.05
0
0.1
0.2
0.3
0.4
0.5
0.6
0.7
0.8
0.9
Time (sec)
1. Vi Ttm = 0.1s
>> [Ad1,Bd1,Cd1,Dd1]=c2dm(A,B,C,D,0.1,'zoh')
Ad1 =
-0.0438 -2.9271
0.0001 -0.0399
36
Bd1 =
1.0e-004 *
0.6098
0.2166
Cd1 =
1.0e+003 *
0
5.0763
Dd1 =
0
>> K = acker(Ad1,Bd1,P1)
K=
1.0e+003 *
-0.0275 -3.7862
>> H5=ss(Ad1-Bd1*K,Bd1,Cd1,Dd1,0.01)
a=
x1
x2
x1 -0.04208
-2.696
x2 0.0006568
0.04208
b=
u1
x1 6.098e-005
x2 2.166e-005
c=
x1
x2
37
y1
0 5076
d=
u1
y1 0
Sampling time: 0.01
Discrete-time model.
>> step(H5)
Step Response
0.12
0.1
Amplitude
0.08
0.06
0.04
0.02
0.01
0.02
0.03
0.04
0.05
0.06
0.07
0.08
0.09
0.1
Time (sec)
>>
H6=ss(Ad1-Bd1*K,Bd1,Cd1,Dd1,0.1)
a=
x1
x1 -0.04208
x2
-2.696
38
x2 0.0006568
0.04208
b=
u1
x1 6.098e-005
x2 2.166e-005
c=
x1
y1
x2
0 5076
d=
u1
y1 0
Sampling time: 0.1
Discrete-time model.
>> step(H6)
39
Step Response
0.12
0.1
Amplitude
0.08
0.06
0.04
0.02
0.1
0.2
0.3
0.4
0.5
0.6
0.7
0.8
0.9
Time (sec)
>> K = acker(Ad1,Bd1,P2)
K=
1.0e+004 *
-0.1315 -2.3241
>> H7=ss(Ad1-Bd1*K,Bd1,Cd1,Dd1,0.01)
a=
x1
x1 0.03643
x2
-1.51
x2 0.02855 0.4636
b=
u1
x1 6.098e-005
40
x2 2.166e-005
c=
x1
y1
x2
0 5076
d=
u1
y1 0
Sampling time: 0.01
Discrete-time model.
>> step(H7)
Step Response
0.25
0.2
Amplitude
0.15
0.1
0.05
0.01
0.02
0.03
0.04
0.05
0.06
0.07
0.08
0.09
0.1
Time (sec)
>> H8=ss(Ad1-Bd1*K,Bd1,Cd1,Dd1,0.1)
a=
41
x1
x2
x1 0.03643
-1.51
x2 0.02855 0.4636
b=
u1
x1 6.098e-005
x2 2.166e-005
c=
x1
y1
x2
0 5076
d=
u1
y1 0
Sampling time: 0.1
Discrete-time model.
>> step(H8)
42
Step Response
0.25
0.2
Amplitude
0.15
0.1
0.05
0.1
0.2
0.3
0.4
0.5
0.6
0.7
0.8
0.9
Time (sec)
43
44