Thiết kế bộ điều khiển

Một phần của tài liệu ĐỒ án THIẾT kế hệ THỐNG cơ điện tử đề tài THIẾT kế MOBILE PLATFORM bám LINE CHO TRƯỚC (Trang 125 - 133)

CHƯƠNG 4 : THIẾT KẾ

4.3 Mơ hình hố hệ thống

4.3.3 Thiết kế bộ điều khiển

4.3.3.1 Tiêu chí thiết kế bộ điều khiển

Tiêu chí chọn bộ điều khiển PID:

- Thời gian xác lập của động cơ < 0,15s (để đảm bảo chu kì lấy mẫu của bộ điều khiển bám line).

118 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

- Sai số xác lập < 5%.

Tiêu chí chọn bộ điều khiển tracking:

- Sai số bám line = ± 18mm.

4.3.3.2 Lý do lựa chọn và phương trình bộ điều khiển

- Thiết kế bộ điều khiển PID để điều khiển vận tốc cho động cơ: Có thể mơ phỏng,

dự đốn và thay đổi được đáp ứng của động cơ khi áp dụng bộ điều khiển, là bộ điều khiển phổ biến để điều khiển realtime, dễ dàng đưa giải thuật điều khiển vào vi điều khiển.

Phương trình bộ điều khiển PID là:

Rời rạc hóa phương trình trên dể đưa giải thuật điều khiển vào code vi điều khiển:

Value (k )=Value (k −1)+ K p (e (k )− e ( k − 1))+ Ki e (k )+ K d ¿

Các bước tìm hàm truyền và hệ số PID

Bước 1: Dùng PID Tuner của Matlab để xác dịnh các hệ số PID

Tiêu chí để chọn bộ điều khiển là thời gian xác lập T settling< 0.15 s (để đảm bảo chu kì lấy mẫu của bộ điều khiển bám line)

Hình 4.61 Hệ số PID và đồ thị đáp ứng

Kp = 1.4268; Ki = 28.9187; Kd = 0

Bước 2: Sau khi có các hệ số PID, đưa các hệ số này vào code và nạp cho vi điều khiển

và đo lại vận tốc động cơ sau khi có bộ điều khiển PID

Hình 4.62 Dữ liệu và đồ thị đáp ứng động cơ sau khi có PID

Đồ thị vận tốc theo thời gian khi có bộ điều khiển PID.

120 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

Sử dụng lại công cụ Ident của Matlab để xác định hàm truyền động cơ khi có bộ điều khiển PID.

Kết quả được hàm truyền là:

s2+ 62.66 s+ 1747

Hình 4.63 Đáp ứng step của động cơ trái

121 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

Hình 4.64 Đáp ứng step của động cơ phải

Bảng 10 Hàm truyền động cơ sau khi dùng bộ điều khiển PID

Động Hàm truyền

cơ trái

%Os (%)

T settling(s) Động Hàm truyền cơ phải %Os(%) T settling(s)

Kết luận: Dựa vào 2 đồ thị, thời gian đáp ứng 2 động cơ lần lượt là 0,13s và 0,12s

< 0,15s mục tiêu thiết kế => Đạt yêu cầu.

- Giải thuật điều khiển tracking: thực hiện theo yêu cầu về vận tốc mong muốn V r và sai số vị trí so với đường line từ đó tính ra vận tốc góc của từng bánh xe để điều khiển xe chạy bám line. Kết quả bám line tốt và sai số nhỏ.

Bộ điều khiển được sử dụng để từ tín hiệu đầu vào [ v ω ]T điều khiển hệ thống hội tụ về điểm làm việc [e1 e2 e3 ]T=[ 0 0 0]T .

Định lý: Một hệ được mơ tả bởi phương trình trạng thái x˙= f ( x1 , … ,xn ). Nếu tìm

được hàm V ( x ) là một hàm xác định dương với mọi biến trạng thái, sao cho đạo hàm của nó theo thời gian là một hàm xác định dấu âm thì hệ ổn định.

Hệ thống được ổn định theo tài liệu [7] bởi phương trình:

{ v=v R cos e 3 +k 1 e 1 (1) ω=k2 v R e2 +ωR + k3 sin e3 123 | P a g e

Chứng minh:

Chọn hàm Lyapunov xác định dương:

˙

⇒V =e1

Bộ điều khiển (1) làm giá trị V˙ âm, điều này có nghĩa hệ thống được ổn định theo tiêu chuẩn Lyapunov và những giá trị sai số e1, e2, e3 sẽ hội tụ về 0 khi t →∞

Một phần của tài liệu ĐỒ án THIẾT kế hệ THỐNG cơ điện tử đề tài THIẾT kế MOBILE PLATFORM bám LINE CHO TRƯỚC (Trang 125 - 133)

Tải bản đầy đủ (DOCX)

(160 trang)
w