Ở bước này cần chọn số Poles sao cho độ chính xác xấp xỉ cao nhất có thể và ở 2 động cơ bài này có độ chính xác là 87.2% và 91%.
Bảng 9 Hàm truyền động cơ trước khi có PID
Trước khi có PID
Động cơ trái Hàm truyền 420.5
s2+50.07s+416.2
Độ chính xác xấp xỉ: 87.2% %Os (%) 0
Tsettling(s) 0.4011
Động cơ phải Hàm truyền 773.3
s2+77.55s+767.2
Độ chính xác xấp xỉ: 91%
%Os(%) 0
Tsettling(s) 0.3528
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).
- 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à: Value=Kp.e(t)+Ki∫
0
t
e(τ)dτ+Kd de(t) dt
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)+Kp(e(k)− e(k−1))+Kie(k)+Kd¿
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 Tsettling<0.15s (để đảm bảo chu kì lấy mẫu của bộ điều khiển bám line)