Professional Documents
Culture Documents
3/15/2020
Sơ đồ khốiĐỊỀUhệ
LÝ THUYẾT thống
KHIỂN II điều khiển
TH.S
1
NGUYỄN THỊ CHÍNH
II. THIẾT KẾ HỆ THỐNG BẰNG PHƯƠNG PHÁP
KGTT
1. Phương pháp hồi tiếp biến trạng thái
Luật điều khiển
u r Kx
x Ax B(r Kx)
x ( A BK ) x Br
sI A BK 0
Với r(t)=0, ta có
u Kx
Như vậy, u(t) sẽ điều khiển hệ thống từ trạng thái ban
đầu x(0) đến trạng thái t1, với x(t1)=0
Suy ra ma trận K
LÝ THUYẾT ĐỊỀU KHIỂN II TH.S
3/15/2020 5
NGUYỄN THỊ CHÍNH
II. THIẾT KẾ HỆ THỐNG BẰNG PHƯƠNG PHÁP
KGTT
2. Thiết kế bộ điều khiển bằng pp đặt cực
Cách 2: (phương pháp canonical)
Ma trận chuyển T:
LÝ THUYẾT ĐỊỀU KHIỂN II TH.S
3/15/2020 6
NGUYỄN THỊ CHÍNH
II. THIẾT KẾ HỆ THỐNG BẰNG PHƯƠNG PHÁP
KGTT
2. Thiết kế bộ điều khiển bằng pp đặt cực
Cách 2: (phương pháp canonical)
K n aLÝnTHUYẾT
n1 ĐỊỀU
aKHIỂN ....
n 1 II a
2 TH.S2 1 a1 T 1
3/15/2020 7
NGUYỄN THỊ CHÍNH
II. THIẾT KẾ HỆ THỐNG BẰNG PHƯƠNG PHÁP
KGTT
2. Thiết kế bộ điều khiển bằng pp đặt cực
Cách 3: (phương pháp Ackermann)
s 1
SI A s 2 20.6 0
20.6 s
LÝ THUYẾT ĐỊỀU KHIỂN II TH.S
3/15/2020 9
NGUYỄN THỊ CHÍNH
II. THIẾT KẾ HỆ THỐNG BẰNG PHƯƠNG PHÁP
KGTT
2. Thiết kế bộ điều khiển bằng pp đặt cực
Ví dụ:
Kiểm tra hạng của ma trận khả năng điều khiển :
0 1
M B : AB
1 0
( A) A2 3.6 A 9I
0 1 0 1 0 1 1 0
3.6 9
20.6 0 20.6 0 20.6 0 0 1
29.6 3.6
74.16 29.6
1
.
Vì vậy: K 0 1 B . AB ( A)
1
LÝ THUYẾT
0 1 ĐỊỀU
29 .6 3.6 TH.S
3/15/2020 0 1
KHIỂN II
NGUYỄN THỊ CHÍNH 29.6 3.6 13
1 0 74.16 29.6
II. THIẾT KẾ HỆ THỐNG BẰNG PHƯƠNG PHÁP
KGTT
2. Thiết kế bộ điều khiển bằng pp đặt cực
Ví dụ:
Cả 3 phương pháp tìm ma trận phản hồi K là như nhau,
với phản hồi trạng thái này, các cực vòng kín được đặt tại s
= -1.8 ± j2.4 như mong muốn ξ = 0.6; ωn = 3 rad/sec. Hệ
thống không ổn định ban đầu trở nên ổn định.
xˆ Axˆ Bu Ke ( y Cxˆ )
Đặt: e x xˆ
Ta có
e ( A KeC )e
xˆ ( A KeC ) xˆ Bu Ke y
W là ma trận: a n 1 a n 2 . . . a1 1
a
n 2 a n 3 . . . . 1 0
. . . . . . .
W . . . . . . .
. . . . . . .
a1 1 . . . 0 0
1 0 0 0 0 0
ĐỊỀU KHIỂN
LÝ THUYẾT
0
II TH.S
3/15/2020 22
NGUYỄN THỊ CHÍNH
II. THIẾT KẾ HỆ THỐNG BẰNG PHƯƠNG PHÁP
KGTT
3. Thiết kế bộ bộ quan sát trạng thái
Hoặc
0 20.6 0 C 0 1
Với: A B
1 0 1
Thiết kế bộ quan sát bậc đủ, giả sử giá trị riêng
mong muốn của ma trận quan sát là: μ1,2 = -1.8±j2.4
2 a2 1 0 9 20.6 29.6
K e WN
1
3.6
1 a1 0 1 3.6 0
LÝ THUYẾT ĐỊỀU KHIỂN II TH.S
3/15/2020 25
NGUYỄN THỊ CHÍNH
II. THIẾT KẾ HỆ THỐNG BẰNG PHƯƠNG PHÁP
KGTT
2. Thiết kế bộ điều khiển dùng bộ quan sát
trạng thái
Ví dụ: Phương pháp 2:
Ta có: e ( A K e C )e
Phương trình đặc tính bộ quan sát :
k e1
SI A K e C 0 Với K e k
e2
Khi đó phương trình trở thành
s 0 0 20.6 k e1
SI A K e C 0 1 s k e 2 s 10.6 k e1 0 (1)
2
0 s 1 0 k e 2
Phương trình mong muốn:
s 1 s 2 s 1.8 j 2.4s 1.8 j 2.4 s 2 3.6s 9 0 (2)
Do đó: ( A) A2 3.6 A 9I
1
0 20.6 0 20.6 0 20.6 1 0 0 1 0 29.6
K e 9
Suy ra 1 0 1 0 3.6 1
0 0 1 1 0 1 3.6
Ví dụ 2: Cho hệ thống
y Cx
0 1 0 0
Với: A 0 0 1 B 0
C 1 0 0
6 11 6 1
Thiết kế bộ quan sát bậc đủ, giả sử giá trị riêng mong
muốn của ma trận quan sát là: μ1,2 = -1.8±j3.464; μ3 = -5
1 0 0 11 6 1
Với: N 0 1 0 W
6 1 0
0 0 1
1 0 0
1
11 6 1 1 0 0 0 0 1
(WN ) 1 6 1 0 0 1 0 0 1 6
1 0 0 0 0 1 1 6 25
0 0 1 80 6 3
Suy ra K e 0 LÝ THUYẾT
1 ĐỊỀU 36 11 7
6KHIỂN
II
TH.S
3/15/2020 30
1 6 25 9 6 1
NGUYỄN THỊ CHÍNH
II. THIẾT KẾ HỆ THỐNG BẰNG PHƯƠNG PHÁP
KGTT
2. Thiết kế bộ điều khiển dùng bộ quan sát
trạng thái
Ví dụ 2: Cho hệ thống
~
x1 3 1 0 ~ x1 0 3
~x 2 7 0 1 ~
x 2 0u 7 y
~
~x3 5 11 6 x3 1
1
Solution:
A BK BK x
x
e 0 A K e C e
hay:3/15/2020 SI A BK SI A K C TH.S
LÝ THUYẾT ĐỊỀU KHIỂN II e
0
35
NGUYỄN THỊ CHÍNH
II. THIẾT KẾ HỆ THỐNG BẰNG PHƯƠNG PHÁP
KGTT
4. Ảnh hưởng của bộ quan sát trạng thái
bậc đủ lên hệ thống vòng kín
Sơ đồ khối của bộ điều khiển – bộ quan sát
U ( s)
K ( sI K e C BK ) 1 K e
Y ( s)
LÝ THUYẾT ĐỊỀU KHIỂN II TH.S
3/15/2020 36
NGUYỄN THỊ CHÍNH
II. THIẾT KẾ HỆ THỐNG BẰNG PHƯƠNG PHÁP
KGTT
4. Ảnh hưởng của bộ quan sát trạng thái
bậc đủ lên hệ thống vòng kín
Ví dụ: Cho hệ thống x Ax Bu
y Cx K 29,6 3.6
0 1 0
Với: A B C 1 0
20.6 0 1
Thiết kế bộ quan sát bậc đủ, giả sử giá trị riêng
mong muốn của ma trận quan sát là: μ1,2 = -8
Giải: x1
Tín hiệu điều khiển u sẽ là: u = -Kx = 29,6 3.6 x
2
Tín hiệu điều khiển phản hồi của bộ quan sát
~
sẽ là: u = -K x = 29,6 3.6
~
~
x1
3/15/2020
LÝ THUYẾT ĐỊỀU KHIỂN II x2
TH.S
37
NGUYỄN THỊ CHÍNH
II. THIẾT KẾ HỆ THỐNG BẰNG PHƯƠNG PHÁP
KGTT
4. Ảnh hưởng của bộ quan sát trạng thái
bậc đủ lên hệ thống vòng kín
Ví dụ: Chọn giá trị riêng của ma trận hệ số quan sát là:
μ1,2 = - 8
s 1
Đa thức đặc tính: sI A s 2 20.6 s 2 a1 s a 2
20.6 s
Đa thức mong muốn: s 1 s 2 s 8s 8 s 16s 64
2
2 a2
Xác định ma trận hệ số quan sát: K e WN
1
a1
1
a1 1 0 1
W 1 0
N C A C
1 0 1 0 0 1
1
2 a2 0 1 1 0 64 20.6 16
K e WN
1
84.6
3/15/2020 1 aLÝ1 THUYẾT
ĐỊỀU 0 II 0
1 KHIỂN 1TH.S
16 0 38
NGUYỄN THỊ CHÍNH
II. THIẾT KẾ HỆ THỐNG BẰNG PHƯƠNG PHÁP
KGTT
4. Ảnh hưởng của bộ quan sát trạng thái
bậc đủ lên hệ thống vòng kín
Ví dụ: phương trình cua bộ quan sát
~
~
Vì u = - K x
x ( A K eC ) ~
x Bu K e y
Ta được phương trinh: ~
x ( A K eC BK ) ~
x Ke y
~ 0 1 16 0 ~
x1 16
x
1
1 0 29.6 3.6 ~ y
~
x 2
20.6 0 84.6 1 x 2 84
16 1 ~ x1 16
~ 84 y
93.6 3.6 2
x
0 1 x 1 0
Đặc tính động học của hệ thống: x1 u
x 20.6 0 2 1
x
2
~x1 x1
u 29.6 3.6 ~ y 0 1
x2 x2
~ 16 1 ~
x1 16
x
1 LÝ THUYẾT ĐỊỀU KHIỂN
~ II
TH.S y
~ 93.6 NGUYỄN
x2
3/15/2020 3.6 THỊ 84.6
x 2CHÍNH 40
II. THIẾT KẾ HỆ THỐNG BẰNG PHƯƠNG PHÁP
KGTT
4. Ảnh hưởng của bộ quan sát trạng thái
bậc đủ lên hệ thống vòng kín
Sơ đồ khối của hệ thống với
phản hồi trạng thái quan sát
sI A BK sI A K eC s 2 3.6s 9 s 2 16s 64
s 4 19.6s 3 374.4s 576 0
Hàm truyền vòng kín
Y ( s) 778.16s 3690.72
4
R( s) s 19.6s 3 130.6s 2 374.4s576