ĐIỀU KHIỂN TRƯỢT CHO TAY MÁY ROBOT HAI BẬC TỰ DO A SLIDING CONTROLLER FOR A TWO-LINK ROBOT ARM LÊ TẤN DUY Đại học Đà Nẵng TÓM TẮT Bài báo này mô tả việc thiết kế bộ điều khiển trượt
Trang 1ĐIỀU KHIỂN TRƯỢT CHO TAY MÁY ROBOT HAI BẬC TỰ DO
A SLIDING CONTROLLER FOR A TWO-LINK ROBOT ARM
LÊ TẤN DUY
Đại học Đà Nẵng
TÓM TẮT
Bài báo này mô tả việc thiết kế bộ điều khiển trượt cho hành trình tay máy robot hai bậc tự do Bằng cách thay hàm signum bằng hàm khuếch đại-tích phân (PI) bảo hòa, ta có thể khử chattering cho các tín hiệu điều khiển mà không gây ra sự sai lệch trong hoạt động của hệ thống
ABSTRACT
This paper describes the design of a sliding mode controller for a two-link robot arm By replacing the signum function by a satured proportional-integral (PI), control chattering is eliminated without deterioration of the system
1 Giới thiệu
Lý thuyết điều khiển trượt và phương pháp lớp biên để giải quyết vấn đề chattering đã được trình bày trong [1] Bài báo này trình bày việc tính toán cấu trúc để điều khiển robot hai bậc tự do áp dụng phương pháp thay hàm signum bằng hàm PI-bão hòa
Bộ điều khiển này làm cho hệ thống hoạt động một cách ổn định Tính năng của hệ thống được kiểm chứng bởi các kết quả mô phỏng với tay máy hai bậc tự do trên quỹ đạo phẳng
2 Mô tả toán học
2.1 Hệ phương trình động lực học Lagrange
Sơ đồ cấu trúc động học và các tham số của tay máy hai bậc tự do được vẽ trên hình 1:
Hình 1 Cấu trúc động học của tay máy hai khâu hai bậc tự do
trong đó:
1, 2 Góc quay của từng khâu
l1, l2 Chiều dài của hai khâu
lg1, lg2 Chiều dài từ trục quay đến trọng tâm của từng khâu
m1, m2 Khối lượng toàn bộ của mỗi khâu
J1 , J2 Mômen quán tính của mỗi khâu
mt , Jt Khối lượng tải và mômen quán tính của tải
Y
l1
lg1
X
lg2 l2
1
m1, J1
m2, J2
2
mt, Jt
Trang 2Hệ phương trình động lực học Lagrange của tay máy hai khâu có cấu trúc như trên hình 1 được viết dưới dạng ma trận sau [2]:
2
1 2
1
2 1 2
2
2 1
22 21
12 11
2
1
g
g T
T 2 T h
h
h h
(1)
trong đó 1 và 2 lần lượt là các mômen điều khiển tác động lên khâu 1 và khâu 2
Các thành phần của ma trận được tính theo các biểu thức dưới đây:
) C l l 2 l l ( m J J ) C l l 2 l l ( m l m J
h11 1 1 21 2 12 22 1 2 2 2 t t 12 22 1 2 2
2 2 t t 2 2 2 1 2 2 2 21
12 h m (l l l C ) J J m l
2 2 t t 2 2 2 2
22 m l J J m l
2 2 1 t 2 1
2l l m l l )S m
(
) C l C l ( g m ) C l C l ( g m C gl m
g1 1 1 1 2 1 1 2 12 t 1 1 2 12
12 2 t 12 2 2
2 m gl C m gl C
trong đó hii là quán tính riêng của từng khâu và hij là quán tính liên kết, Ci và Si lần lượt là các
ký hiệu của cosi và sini (i = 1, 2) và C12 là ký hiệu của cos(1+ 2)
2.2 Hệ phương trình trạng thái
Đặt biến trạng thái cho khớp 1 và 2 như sau:
2 2
22
21 2
1 1
12
11 1
x
x X x
x X
2 1
2
1 u
u
Hệ phương trình vi phân trạng thái của các khớp 1 và 2 được viết:
Khớp 1:
2
1 j j j 1 1
12
12 11
u b ) X ( a x
x x
Khớp 2:
2
1 j
j j 2 2
22
22 21
u b ) X ( a x
x x
(6)
Từ các phương trình (1) đến (6), ta có hệ phương trình trạng thái của khớp 1 và 2 dưới đây:
Trang 3Khớp 1:
) u h u h ( D
1 g h g h Tx h ) x Tx 2 Tx ( h D
1
x
x
x
2 12 1 22 H 2 12 1 22 2 12 12 22 12 2
22 22 H
12
12
11
(7)
2 12 1 22 2 12 1 22 2 12 12 22 12 22 2
22 22 H
12
12
11
u h u h g h g h Tx h x Tx h Tx
h D
1
x
x
x
Khớp 2:
) u h u h ( D
1 g h g h Tx h ) x Tx 2 Tx ( h D
1
x
x
x
2 11 1 12 H 2 11 1 12 2 12 12 22 12 2
22 12 H
22
22
21
(8)
2 11 1 12 2 11 1 12 2 12 12 22 12 12 2
22 22 H
22
22
21
u h u h g h g h Tx h x Tx h 2 Tx ( h D
1
x
x
x
Như vậy mô hình tay máy robot hai bậc tự do là một hệ một đầu vào một đầu ra, được
mô tả bằng hai hệ nhỏ, mỗi hệ tương ứng với từng khớp 1 và 2, được đặc trưng bởi hai hệ phương trình vi phân trạng thái (7) và (8) Các hệ phương trình này có thể dùng để mô hình hóa trên máy tính cũng như để tổng hợp luật điều khiển cho tay máy
3 Thiết kế điều khiển trượt cho tay máy robot hai bậc tự do
3.1 Thiết kế bộ điều khiển kiểu trượt đơn thuần
Chọn mặt trượt cho từng khớp có dạng sau:
với e11 = x11d - x11 và e12 = x12d - x12
với e21 = x21d - x21 và e22 = x22d - x22
Tín hiệu điều khiển cho từng khớp có dạng [1]:
C.e q aˆ(q,q) K.sgn(S)
Bˆ
u 1 d
Từ (3) và (4), ta có:
) S sgn(
K
) S sgn(
K ) X ( aˆ
) X ( aˆ x
x e
C
e C h
h
h h u
u
2 2
1 1
2 1
22 21
22 2
21 1
22 12
12 11
2
1
(11) hay viết cho từng khớp:
Trang 4Khớp 1
C e x K sgn(S ) aˆ (X) h C e x K sgn(S ) aˆ (X)
h
Khớp 2
C e x K sgn(S ) aˆ (X) h C e x K sgn(S ) aˆ (X)
h
trong đó
S1 , S2 được xác định theo công thức (9) và (10)
2 12 12 22 12 22 2
22 22 H
D
1 )
X
(
2 12 12 22 12 12 2
22 12 H
D
1 )
X
(
với DH h11h22 h122
3.2 Dùng phương pháp lớp biên để giải quyết vấn đề chattering
Như đã nói ở phần 3.1, thay hàm signum bằng hàm bão hòa V(S/), tín hiệu điều khiển được viết lại như sau:
C.e q aˆ(q,q) K.V(S/ )
Bˆ
u 1 d
với:
1
/ S
1 )
/
S
(
V
1 / S
1 / S 1
1 / S
và K là ma trận (n x n) xác định dương và chọn đủ lớn để đảm bảo điều kiện trượt được thỏa mãn dù có tồn tại nhiễu và các tham số không xác định
Tương tự như cách khai triển ở phần 3.1, ta có tín hiệu điều khiển cho từng khớp:
Khớp 1
2
2 2 22 22 2 12 1
1
1 1 21 21
1
11
(16)
Khớp 2
2
2 1 22 22 2 22 1
1
1 1 21 21
1
12
(17) trong đó aˆ1(X),aˆ2(X) được xác định theo (14) và (15)
3.3 Bộ điều khiển trượt dùng hàm bão hòa-PI
Sử dụng hàm bão hòa-PI, tín hiệu điều khiển sẽ có dạng:
C.e q aˆ(q,q) K (S)
Bˆ
u 1
nếu nếu nếu
Trang 5trong đó S S1 ,S2 và K được chọn như trong mục 3.2 ở trên (Si) với i = 1,2 là các hàm bão hòa-PI được định nghĩa như sau:
t
t i i i i
i i i
i
S khi
dt S I S
S khi
) S sgn(
) S (
0 i
(18)
trong đó Ii là các hệ số tích phân dương [1]
Ta có tín hiệu điều khiển cho từng khớp:
Khớp 1
C e x K (S ) aˆ (X) h C e x K (S ) aˆ (X)
h
Khớp 2
C e x K (S ) aˆ (X) h C e x K (S ) aˆ (X)
h
trong đó aˆ1(X),aˆ2(X) được xác định theo (14) và (15)
4 Các kết quả mô phỏng và nhận xét
Ta thực hiện mô phỏng trên một tay máy hai bậc tự do có các tham số như sau:
Việc mô phỏng được thực hiện với trường hợp có tải (khối lượng tải mt = 10 kg và mômen quán tính của tải Jt = 0,1 kg.m2) của các hàm signum, bão hòa (sat) và bão hòa-PI (sat-PI) được sử dụng trong bộ điều khiển
4.1 Hàm signum
Trang 64.2 Hàm sat
4.3 Hàm sat-PI
Trang 7Nhận xét:
Việc sử dụng các hàm sat và sat-PI bảo đảm loại bỏ được hiện tượng chattering Nhưng hàm sat-PI bảo đảm sai số quỹ đạo nhỏ hơn so với hàm sat và đặc biệt hàm sat-PI đạt được tính ổn định của tín hiệu điều khiển tại điểm không, trong khi hàm sat không có được điều này (nhận xét này thể hiện rất rõ trên các hình vẽ của mặt trượt của khâu 2)
5 Kết luận
Phương pháp điều khiển kiểu trượt ứng dụng cho tay máy hai bậc tự do đã được trình bày Tín hiệu điều khiển được tính chọn để đảm bảo hệ thống kín ổn định và bền vững đối với nhiễu tải cũng như đối với sự thay đổi các thông số của đối tượng điều khiển, phương pháp lớp biên được ứng dụng để loại bỏ hiện tượng chattering của tín hiệu điều khiển khi trạng thái
hệ thống ở trên mặt trượt
Khi sử dụng hàm PI bão hòa (sat-PI) trong bộ điều khiển thay cho hàm signum và hàm sat, các kết quả mô phỏng cho thấy, khi thay đổi tải trọng và sự nhiễu loạn có giới hạn cho tay máy thì hệ điều khiển trượt này vẫn giữ được tính ổn định, khử được hiện tượng chattering của các tín hiệu điều khiển cũng như giảm được các sai số quỹ đạo
TÀI LIỆU THAM KHẢO
Công nghệ Đại học Đà Nẵng, số 4/2003
[2] K.S Fu Robotics, Control, Sensing, vision and intelligence, Graw Hill, Inc 1987
[3] Y.Itkis, Control systems of variable structure, New York, Wiley, 1976
[4] V.A.Utkin, Sliding modes and their application in variable structure systems,
Moscow, Mir 1987
[5] J.J.E Slotine and S.S Satry, Tracking control of nonlinear systems using sliding
surface with application to robot manipulator, Int J Control, vol 38, no 2 , pp
465-492, 1983
America 1989
[7] J.J.E Slotine and W.Li, Applied nonlinear control, Prentiee Hall, Englewood Cliff,
New Jersey, 1991
[8] J.J.E Slotine and S.Asada, Robot analysis and control, A Wiley-Interscience
Publication, John Wiley& Sons, Inc 1986
[9] S.L.Salas, Einar Hill, Calculus one and several variables, New York, Wiley 1990