TRƯỜNG ĐẠI HỌC BÁCH KHOA HÀ NỘI
VIỆN ĐIỆN
BỘ MÔN ĐIỀU KHIỂN TỰ ĐỘNG
BÁO CÁO THÍ NGHIỆM ĐIỀU KHIỂN SỐ
Sinh viên thực hiện : Vũ Mạnh Hùng
Lớp : KSTN – ĐKTĐ – K55
MSSV : 20101664
Đối tượng : G3 – Lz1 – Gw3
Chu kì trích mẫu : T=0.1ms
Phương pháp trích mẫu : Tustin
HÀ NỘI, 12-2013
Bài thực hành số 1: Tìm mô hình gián đoạn ĐCMC
Hình 1: Sơ đồ cấu trúc của ĐCMC kích thích độc lập
Động cơ có các tham số:
- Điện trở phần ứng:
250
A
R m= Ω
- Mô men quán tính:
2
0,012J kgm
=
- Điện cảm phần ứng:
4
A
L mH
=
- Hằng số động cơ:
1.1.1 Tìm hàm truyền đạt trên miền ảnh z của đối tượng dòng phần ứng
Trong mục này, ta sẽ tính toán bằng tay theo phương pháp đã học (mục 1.3.2b, tài liệu [1]) để
xác định hàm truyền đạt trên miền ảnh z của mạch phần ứng, phục vụ thiết kế vòng trong cùng
ĐK dòng phần ứng.
Hình 2: Vòng điều chỉnh dòng phần ứng của ĐCMC
• Hàm truyền đạt của mạch phần ứng là:
( )
( )
( )
*
1 1 1
1 1
A
I
A t A A
i s
G s
u s sT R sT
= =
+ +
• Hàm truyền đạt trên miền ảnh z:
- Bước 1: Tính
( )
( )
I
G s
H s
s
=
( )
( )
( )
1
0
2
2
1
2
3
1
lim 1,6e-6
1
lim 1,0063e-8
1
lim -1,6101e-6
A
t
A t
s
A t
s
A A t
T
t A
s
t t A
T
K sP s T T
3
1 2
.
. .1
1
t A
T T
A A t
T T
K z
K z K z
H z
R T T z
z ez e
− −
÷
= + +
÷
−
÷
−−
- Bước 3: Tính
( )
( )
( )
1
1
K z
K z K z
z
G z z H z
R T T z z
z ez e
K z K z
K
R T T
z e
z e
−
− −
− −
−
÷
= − = + +
÷
÷
−
÷
−−
− −
÷
= + +
- Với
( )
2
0.01 sT T m
= =
:
2
2
2
2
5.294 16 0.0001209 0.0001169 0.0001209 0.0001169
1.904 0.9043 1.904 0.9043
z
e z z z
z z z z
G
− + + +
− + − +
= ≈
1.1.2 Tìm hàm truyền đạt trên miền ảnh z của đối tượng động cơ một chiều
Sơ đồ cấu trúc của động cơ một chiều kích từ độc lập được đưa ra ở Hình 2
Hình 2 – Sơ đồ cấu trúc ĐCMC kích từ độc lập
• Hàm truyền động cơ:
( )
( )
2
2 2
2
2 2
1 1 1
s s
k k k k
ψ
π
ψ
π
ψ
ψ
π π
π π ψ
ψ ψ
+
= =
+
+
= =
+ +
+ +
Giả sử ta viết được hàm truyền
( )
ĐC
G s
thành dạng:
( ) ( )
1 2
( )
1 1
ĐC
K
Tính toán tương tự mục 1.1.1, ta được:
- Hàm truyền đối tượng động cơ một chiều:
( )
2
1,528
0,0003016s 0,01885s 14,67
G s =
− +
- Với
( )
1
0.1 msT T= =
:
1
2
(2,528e 5).z+2,523e 5
1,993z 0,9938
z
G
z
− −
=
− +
- Với
( )
2
0.01 msT T= =
:
2
I
-1 -2
-1 -2
I
-1 -2
-1 -2
I
-1 -2
0,009176z +0,006577z
G (z)= Giz1=
1-1,362z +0,3656z
0,003298+0,01046z +0,001998z
G (z)= Giz2=
1-1,362z +0,3656z
0,004154+0,008307z +0,004154z
G (z)= Giz3=
1-1,327z +0,3313z
- Với
0.01ms
s
T =
:
-1 -2
I
-1 -2
-1 -2
I
-1 -2
-1 -2
ÐC
-1 -2
-1 -2
ÐC
-1 -2
-1 -2
ÐC
-1 -2
2,528e-05z +2,523e-05z
G (z)= Gdcz1 =
1-1,993z +0,9938z
8,431e-06+3,367e-05z +8,404e-06z
G (z)= Gdcz2=
1-1,993z +0,9938z
1,263e-05+2,525e-05z +1,263e-05z
G (z)= Gdcz3=
1-1,993z +0,9938z
- Với
0.01ms
s
T =
:
-1 -2
ÐC
-1 -2
-1 -2
ÐC
-1 -2
-1 -2
bước tính tay cũng như sử dụng lệnh c2d với các phương pháp ZOH, FOH và TUSTIN gần
như trùng nhau, với sai lệnh rất nhỏ. Điều này chứng tỏ sử dụng các phương pháp này đều cho
kết quả như nhau (với sai lệch chấp nhận được).
1.1.6 Mô phỏng khảo sát với đối tượng động cơ một chiều
Để so sánh các kết quả thu được, ta xây dựng sơ đồ Simulink như Hình 6 - Sơ đồ Simulink
kiểm chứng kết quả tính hàm truyền động cơ một chiều trên miền z
Hình 6 - Sơ đồ Simulink kiểm chứng kết quả tính hàm truyền động cơ một chiều trên miền z
Lần lượt chạy mô phỏng với các thời gian trích mẫu
0.1ms
s
T =
và
0.01ms
s
T =
, ta thu được
kết quả như Hình 7 và Hình 8
Ta cũng nhận thấy rằng: Các đường đáp ứng bước nhảy của các hàm truyền trên miền ảnh z
thu được từ bước tính tay cũng như sử dụng lệnh c2d với các phương pháp ZOH, FOH và
TUSTIN gần như trùng nhau, với sai lệnh rất nhỏ. Điều này chứng tỏ sử dụng các phương
pháp này đều cho kết quả như nhau (với sai lệch chấp nhận được).
Hình 7– Đáp ứng bước nhảy hàm truyền động cơ một chiều
Hình 8– So sánh các đáp ứng bước nhảy hàm truyền động cơ một chiều
Mô hình trạng thái ĐCMC kích thích độc lập
1.1.7 Xây dựng mô hình trạng thái ĐCMC trên miền thời gian liên tục
Theo Hình 1: Sơ đồ cấu trúc của ĐCMC kích thích độc lập, hàm truyền của ĐCMC kích
thích độc lập:
( )
( )
( )
G s
R sT J
R J sT k k J R T s J R s k k
k
J R T JR
s s
k k k k
ψ
π
ψ
ψ ψ
π
ψ ψ
π ψ π π ψ
ψ
π π
ψ ψ
+
= =
+
+
+
= =
+ + + +
=
+ +
Đặt:
2
21
, ,
38,2 . 236,8
2
. .T 0,0013.0,0160 2,08e 5
1 1
0,1056
236,8.0,04
A
mech
M e
A
mech el A
M e
e
a
JR
a T
k k
JR
a T T
k k
k
k
π π
ψ
π
ψ
ψ
=
−
= = = =
q n
= =
=
=
&
Khi đó ta có:
[ ]
1 1
1 2
0
1
2 2
0
1
2
2 2
2 1 2
2 2 2
1
1
2
0 1
0
1 0 0.
q q
q q
= − − + ⇒
= +
=
&
&
&
&
Đặt:
[ ]
0
1
22 2
1 1
2 2
0 1 0
u
x
= +
=
q Aq b
c q
&
Từ , , ta có:
[ ]
0 1 0
48100 62,5 5,08e3
1 0
u
x
= +
− −
=
q q
( ) ( )
{ }
( ) ( )
( )
1
2
31,25 31,25
1
1
31,25 31,25
0 1 1
48100 62,5 48100 62,5
62,5 48100
1
1
62,5s 48100
1,02.e cos 217,1. 8,2 221,56.e cos 217,1. 90
0,0046.e cos 217,1. 90 1,02.e
t t
t t
s
s
s
s
s
s
s
t t
t L s
t
Mô hình trạng thái gián đoạn:
- Với chu kì trích mẫu
( )
1
0,01T s=
ta có:
[ ]
1
0,3349 0,0027 0,1390
133,3760 0,5063 13,8923
1 0
k k k
k k
x
+
−
= +
− −
=
q q u
q
- Với chu kì trích mẫu
( )
Hình 10– Đáp ứng bước nhảy ba MHTT ĐCMC
Nhận xét: Từ đồ thị đáp ứng bước nhảy của 3 MHTT Hình 10, kết hợp với đồ thị đáp ứng
bước nhảy hàm truyền ĐCMC ở Hình 7, ta thấy dạng đáp ứng thu được từ mô hình trạng thái
giống như từ mô hình hàm truyền chứng tỏ quá trình xây dựng mô hình hàm truyền là hoàn
toàn chính xác. Đồng thời, đáp ứng của mô hình trạng thái gián đoạn trên Hình 10 cho thấy
các bước xây dựng mô hình trạng thái gián đoạn từ mô hình liên tục cũng cho kết quả chính
xác. Tuy nhiên ta nhận thấy rõ sự khác biệt ứng với các chu kì lấy mẫu
s
T
khác nhau. Ứng với
chu kì lấy mẫu
2
0.01sT =
cho kết quả tốt hơn nhiều so với
1
0.1sT =
.
Bài thực hành số 2: Tổng hợp vòng điều chỉnh dòng phần ứng( điều khiển
momen quay)
Hàm truyền đạt của mạch phần ứng:
( )
( )
( )
*
1 1 1
1 1
A
I
A t A A
i s
Gz3 =
0.004154 z^2 + 0.008307 z + 0.004154
z^2 - 1.327 z + 0.3313
Như vậy, trong mục này ta sẽ thiết kế bộ điều khiển dòng phần ứng của ĐCMC với hàm
truyền đạt gián đoạn (viết dưới dạng số mũ âm) là:
( )
1 2
1 2
1
0,004154 0,008307 0,004154
1 1,327 0,3313
I
z z
z z
G z
− −
− −
−
+ +
− +
=
Thiết kế bộ điều khiển dòng theo phương pháp Dead-beat
Ta thiết kế bộ điều khiển dòng theo phương pháp Dead-beat với
( )
1
L z
−
là một đa thức bậc 1.
1 1 2
0 1 2
1
1 2
0 1
1 2
0 1 2
0
2
0,004154; 0,008307; 0,004154
1; 1,327; 0,3313
B z b b z b z
A z a
b b
a a
a z a z
b
c
− − −
− − −
= =
= = −
+
=
= + +
= +
=
Theo phương pháp tìm các hệ số
0 1
= =
+
−
∑
( ) ( )
1
1
2
0 1
0
0,00415
1,327
1 1,327
( )
4 0,008307
34,
0,004154
322
i
i
a
l
a a b
=
+ +
−
= =
+
−
=
l0=25.864;
l1=34.322;
L=filt([l0 l1],[1],0.1e-3);
A=filt([1 -1.327 0.3313],[1],0.1e-3);
B=filt([0.004154 0.008307 0.004154],[1],0.1e-3);
GR=L*A/(1-L*B)
Kết quả ta tìm được bộ điều khiển
( )
R
G z
là:
GR =
25.86 + 0.000472 z^-1 - 36.98 z^-2 + 11.37 z^-3
0.8926 - 0.3574 z^-1 - 0.3926 z^-2 - 0.1426 z^-3
Mô phỏng khảo sát đặc điểm vòng khảo sát đã thiết kế:
Sơ đồ Simulink của vòng điều chỉnh tốc độ sử dụng bộ điều khiển thiết kế theo kiểu cân bằng
mô hình:
Kết quả mô phỏng (với chu kì trích mẫu
( )
1
0.1 sT m=
):
Hình 11– Đáp ứng bước nhảy vòng ĐC dòng thiết kế theo phương pháp Dead - Deat
Nhận xét:
Khi sử dụng bộ điều khiển Dead-beat
( )
R
G z
đã thiết kế được, đầu ra xác lập (bám giá trị đặt
R
S
G z
G z
G z G z
=
−
Thực hiện trên Matlab để tìm
( )
R
G z
:
Gw = filt([0 0.2 0.3 0.5],[1],0.1e-3);
B = filt([0.004154 0.008307 0.004154],[1],0.1e-3);
A = filt([1 -1.327 0.3313],[1],0.1e-3);
Gz = B/A;
GR = Gw/(Gz*(1-Gw))
Kết quả thu được bộ điều khiển là:
GR =
0.2 z^-1 + 0.0346 z^-2 + 0.1682 z^-3 - 0.5641 z^-4 + 0.1656 z^-5
0.004154 + 0.007476 z^-1 + 0.001246 z^-2 - 0.0054 z^-3 - 0.0054 z^-4 - 0.002077 z^-5
Mô phỏng khảo sát đặc điểm vòng khảo sát đã thiết kế
Sơ đồ Simulink của vòng điều chỉnh tốc độ sử dụng bộ điều khiển thiết kế theo kiểu cân bằng
mô hình:
Kết quả mô phỏng (với chu kì trích mẫu
( )
1
0.1 sT m
=
J J
ψ ψ
π π
− − −
= = + +
÷ ÷
Sử dụng Matlab tìm hàm truyền đạt trên miền ảnh z theo phương pháp Tustin
Chu kì trích mẫu được chọn là
( ) ( )
0,1 s 0,0001T m s= =
Chương trình Matlab tìm
( )
n
G z
:
T = 0.1e-3;
Gw =filt([0 0.2 0.3 0.5],[1],T);
km = 38.2;
phi = 0.04;
J = 0.012;
G = tf([1],[2*pi*J 0]);
Gz = c2d(G,T,'tustin');
Gn = km*phi*Gw*Gz
Kết quả thu được:
Gn =
0.0002027 z^-1 + 0.0005066 z^-2 + 0.0008106 z^-3+ 0.0005066 z^-4
6b b b b b
a a a a a
= = = = =
= =− = = =
Tổng hợp bộ điều chỉnh PI theo tiêu chuẩn tích phân bình phương
Giả sử bộ điều khiển PI có cấu trúc:
( )
( )
( )
1
0 1
1
1 z
R
R z
r r z
G z
p P z
−
−
+
= =
+
Chọn
1p
= −
, ta sẽ phải tìm 2 tham số
0 1
0 1 1 2 3 4
1 1
1
W W
E
1
1 .
1 z 1
R S
z z
z
r r z b z b z b z b z
G z G z
a z
− − − − −
− −
= =
+ + + +
+
+
− +
Viết sai lệch dưới dạng phương trình sai phân:
( ) ( ) ( )
( ) ( )
1 1 1 2 0 1 1 1 0 2 1 1 1 2
0 3 1 2 3 0 4 1 3 4 1 4 5
w 1 w w 1
k k k k k k
k k k
a1=-1;
r0=x(1);
r1=x(2);
b1=0.0002027;
b2=0.0005066;
b3=0.0008106;
b4=0.0005066;
e(1)=1;
e(2)=1+(a1-1)-(a1-1+r0*b1)*e(1);
e(3)=1+(a1-1)-a1-(a1-1+r0*b1)*e(2)-(-a1+r0*b2+r1*b1)*e(1);
e(4)=1+(a1-1)-a1-(a1-1+r0*b1)*e(3)-(-a1+r0*b2+r1*b1)*e(2)-
(r0*b3+r1*b2)*e(1);
e(5)=1+(a1-1)-a1-(a1-1+r0*b1)*e(4)-(-a1+r0*b2+r1*b1)*e(3)-
(r0*b3+r1*b2)*e(2)-(r0*b4+r1*b3)*e(1);
e(6)=1+(a1-1)-a1-(a1-1+r0*b1)*e(5)-(-a1+r0*b2+r1*b1)*e(4)-
(r0*b3+r1*b2)*e(3)-(r0*b4+r1*b3)*e(2)-r1*b4*e(1);
for i=6:1:n
e(i)=1+(a1-1)-a1-(a1-1+r0*b1)*e(i-1)-(-a1+r0*b2+r1*b1)*e(i-2)-
(r0*b3+r1*b2)*e(i-3)-(r0*b4+r1*b3)*e(i-4)-r1*b4*e(i-5);
end
I=0;
for i=1:1:n
I=e(i)*e(i)+I;
end
f=I;
- Hàm điều kiện ràng buộc phi tuyến
function[c,ceq]=nonlcon(x)
c=[];
ceq=[];
- Ctrình chính tìm giá trị cực tiểu của hàm
3,2981
Q
fvalI
==
khi
10
1 78.5279; 178.57r 28r
= −=
Khi đó, bộ điều khiển sẽ có cấu trúc là:
( )
1
1
1
1
0
1
1 78.5 178.
z 1
6
1
R
r r z
z
G z
p z
−
− −
−
−
+
+ +
=
−
Bộ điều khiển có cấu trúc:
( )
( )
( )
1 1
0 1 0 1 0 1
1 1
1 z 1 z 1
R
R z
r r z r r z r z r
G z
p z P z
− −
− −
+ + +
= = = =
+ − −
Đa thức đặc tính của hàm truyền chủ đạo:
( ) ( ) ( ) ( ) ( )
( )
( )
( )
( )
( ) ( ) ( ) ( )
4 3 3 2
1 2 3 1 2 1 3 2 3 1 2 3
2 3 2
1 2 3 1 2 1 3 2 3 1 2 3
5 4 3
1 2 3 1 2 3 1 2 1 3 2 3
2
1 2 3 1 2 1
0,9 0,95
1,85z + 0,855
1,85 0,855 1,85
0,85 1,85
N z z z z z z z z z z z z z z z z z z
z z z z z z z z z z z z z z z z
z z z z z z z z z z z z z z z
z z z z z z z z
= − − − + + + + + −
= − − + + + + + −
= + − − − − + + + + + + +
+ − + + − +
( )
( )
3 2 3 1 2 3
1 2 1 3 2 3 1 2 3 1 2 3
0,855 1,85
z z z z z
−
− −
+
−
= =
+ −