CHƯƠNG 4 : THIẾT KẾ
4.3 Mơ hình hố hệ thống
4.3.2 Tìm hàm truyền động cơ
Xác định số lần lấy mẫu và chu kì lấy mẫu:
Động cơ chạy với vận tốc tối đa là 280 rpm = 280/60 vòng/s = 14/3 vòng/s Suy ra f h = 14/3 vịng/s
Theo tiêu chuẩn lấy mẫu Nyquist thì: f s ≥2 f h = 28/3 ≈ 9.33 Hz
Chọn f s=50 Hz vì lý do phụ thuộc vào độ phân giải của encoder của động cơ.
111 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat
Số lần lấy mẫu cần thiết:
Với T s=0.02 s là thời gian lấy mẫu vận tốc động cơ
T h= 1
14
( 3 )
N là số lần lấy mẫu. Chọn giá trị N để m là số nguyên
Vậy N=75 là giá trị đầu tiên để m là số nguyên => Phải lấy mẫu vận tốc 75 lần với chu kì lấy mẫu là 0.02s
Các bước tìm hàm truyền động cơ:
Bước 1: Cấp PWM từ vi điều khiển cho động cơ, tăng dần giá trị này (ghi lại các giá trị
vận tốc khi tăng) đến khi động cơ đạt được vận tốc cực đại. Ta được hình sau:
Hình 4.55 Đồ thị vận tốc theo PWM
Nhận xét: đồ thị vận tốc động cơ theo PWM là khơng tuyến tính và có thể
dùng phương pháp xấp xỉ tuyến tính để xấp xỉ vận tốc theo PWM
Đồ thị trên với trục hoành là PWM (55), trục tung là tốc độ động cơ (rpm), đường màu xanh là giá trị đo được, đường màu đỏ là đường xấp xỉ tuyến tính.
Từ phương pháp xấp xỉ ta suy ra được phương trình vận tốc theo PWM là:
y=0.659 x +93.456
Từ kết quả phần mô phỏng ta thấy vận tốc động cơ cỡ khoảng 220 rpm nên ta sẽ sử dụng giá trị này để tìm hàm truyền và đáp ứng của động cơ khi chưa có bộ điều khiển PID.
Bước 2: Tìm hàm truyền khi chưa có bộ điều khiển PID.
Với v = 220 rpm thì PWM = (223.456)/0.659 = 192
Với chu kì lấy mẫu là 0.02s và số lần lấy mẫu là 75 lần ta đo các kết quả sau
Hình 4.56 Dữ liệu tìm hàm truyền khi chưa có bộ điều khiển PID
113 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat
Bước 3: Đo vận tốc theo thời gian
Hình 4.57 Đồ thị vận tốc theo thời gian khi chưa có bộ điều khiển PID
Trục hồnh là thời gian (s) trục tung là vận tốc động cơ (rpm) với vận tốc tham chiếu là 220 rpm
Bước 4: Dùng cơng cụ Ident của Matlab để tìm hàm truyền:
114 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat
Hình 4.58 Cơng cụ Ident của Matlab
Chọn Time-Domain Signals để chọn nhập dữ liệu trong miền thời gian. Input: nhập mảng 1 chiều có giá trị của các phần tử là vận tốc tham chiếu. Output: nhập mảng 1 chiều là giá trị vận tốc của động cơ.
Starting time = 0, Sample time = 0.02.
115 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat
Hình 4.59 Giao diện xấp xỉ hàm truyền của Matlab
116 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat
Hình 4.60 Hàm truyền khi chưa có bộ điều khiển PID
Ở 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%.
117 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat
Bảng 9 Hàm truyền động cơ trước khi có PID
Động cơ trái
Động cơ phải