Đối với bài toán tracking của robot bám line, luật điều khiển để robot có thể bám theo quỹ đạo cho trước. Có nhiều luật điều khiển được sử dụng như luật điều khiển tracking như back stepping dựa vào tiêu chuẩn ổn định Lyapunov hay bộ điều khiển fuzzy,…. Ở đây, nhóm sử dụng dụng bộ điều khiển tracking.
Hình 5.2 : Mô hình sai số xe dò line
Bộ điều khiển được thiết kế cho điểm C bám theo điểm R trên quỹ đạo với vận tốc .
Sai số của C so với điểm tham chiếu:
Sai số động học có thể được viết:
̇ 1 [ ̇] = [3 2 ̇ 3 1 − 1][−] 2 − 2 − −−11][ ]
Do hệ thống phototransitor chỉ xác định được sai số theo phương pháp tuyến với phương chuyển động của xe. Nên ta chọn điểm tracking là C trung điểm sensor. Giải sử xe
chạy với vận tốc bằng vận tốc tham chiếu, vì vậy1 = 0. Tuy nhiên, ta chỉ xác định được một sai số là2 nên ta sẽ chọn lại hàm Lyapunov cho bộ điều khiển.
=
ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD : TS.LÊ ĐỨC HẠNH
1
̇
=1( 3−)+2 3( − +22 )− 2
Để hệ ổn định thì ̇< 0
Mà ta không thể xác định được 1và 3 nên cho 1 = 0,3 ≈ 0. Từ đó ta có:
̇
= − 2 < 0
Chọn:
. =2.2
Với 2> 0
Từ đó: ̇= − 2.22 < 0 thỏa điều kiện.
Để xe chạy với vận tốc lớn nhất ta chọn = và = 2 2/
Tiến hành mô phỏng quá trình bám sa bàn của robot, sử dụng các thông số đầu vào:
Bảng 5.1 : Các thông số đầu vào cần thiết cho robot khi mô phỏng :
Đại lượng Bán kính cong Vận tốc cần đạt Khoảng cách từ tâm xe đến bánh xe chủ động Bán kính bánh xe
Thời gian lấy mẫu động cơ Thời gian lấy mẫu hệ thống
Hình 5.3 : Quan hệ giữa khoảng cách và sai số lớn nhất Từ đồ thị trên ta chọn = 100
ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD : TS.LÊ ĐỨC HẠNH