BÁO cáo THÍ NGHIỆM lý THUYẾT điều KHIỂN NÂNG CAO tuyến tính hóa tại điểm cân bằng trên và thiết kế bộ điều khiển LQR

ĐẠI HỌC QUỐC GIA TP.HỒ CHÍ MINH TRƯỜNG ĐẠI HỌC BÁCH KHOA KHOA ĐIỆN – ĐIỆN TỬ BỘ MÔN ĐIỀU KHIỂN TỰ ĐỘNG -o0o - BÁO CÁO THÍ NGHIỆM LÝ THUYẾT ĐIỀU KHIỂN NÂNG CAO GV: Trần Hồng Khơi Ngun Lớp: L05 Nhóm: 08 SVTH: MSSV: Phạm Trọng Thiện Đỗ Ngọc Thọ 1915297 1915339 TP HỒ CHÍ MINH, THÁNG 06 NĂM 2022 TIEU LUAN MOI download : skknchat@gmail.com Mục lục BÀI THÍ NGHIỆM 1.1 1.1.1 Tuyến tính hóa điểm cân thiết kế Khảo sát ả 1.1.2 Khảo sát ả Bộ ước lượng trạng thái 1.2 Điều khiển swing-up lắc phương pháp năn 1.3 Thiết kế điều khiển hồi tiếp tuyến tính hóa 1.4 Thiết kế điều khiển trượt 1.5 BÀI THÍ NGHIỆM 2.1 2.1.1 Khảo sát đáp ứng hệ thống Trường hợ 2.1.2 Trường hợ 2.2 2.2.1 Thiết kế điều khiển PID dùng phương pháp Ziegl Tìm thơng 2.2.2 Khảo sát ả 2.3 2.3.1 Khảo sát đáp ứng tần số hệ thống xung quanh Vị trí 2.3.2 Vị trí BÀI THÍ NGHIỆM Nhận dạng hàm truyền đối tượng 3.1 Xây dựng điều khiển tự chỉnh theo phương pháp 3.2 Xây dựng điều khiển tự chỉnh theo phương pháp 3.3 BÀI THÍ NGHIỆM 4.1 Tìm độ lợi tới hạn chu kỳ tới hạn hệ thống PID 32 4.2 Điều khiển thích nghi PID auto-tuning BÀI THÍ NGHIỆM 5.1 5.1.1 Tìm thơng số hệ xe – lị xo Tìm k1, b1 5.1.2 Tìm K, b2 5.2 5.3 Điều khiển vị trí xe Điều khiển vị trí xe i TIEU LUAN MOI download : skknchat@gmail.com Danh sách hình ảnh Hình 1.1: Đáp ứng mơ hình Q = diag([1, 1, 0.001, 1]), R = Hình 1.2: Đáp ứng mơ hình Q = diag([1, 1, 1, 1]), R = .2 Hình 1.3: Đáp ứng mơ hình Q = diag([1, 1, 104, 1]), R = Hình 1.4: Đáp ứng mơ hình Q = diag([1, 1, 1, 1]), R = 0.01 Hình 1.5: Đáp ứng mơ hình Q = diag([1, 1, 1, 1]), R = .3 Hình 1.6: Đáp ứng mơ hình Q = diag([1, 1, 1, 1]), R = 100 Hình 1.7: Đáp ứng mơ hình giá trị khởi tạo θ2 = 100 Hình 1.8: Đáp ứng mơ hình giá trị khởi tạo θ2 = 150 Hình 1.9: Đáp ứng mơ hình giá trị khởi tạo θ2 = 200 Hình 1.10: Đáp ứng mơ hình giá trị khởi tạo θ2 = 250 Hình 1.11: Ước lượng trạng thái điều khiển LQR cân lắc ngược quay Hình 1.12: Đáp ứng mơ hình giá trị Ksw = 10 Hình 1.13: Đáp ứng mơ hình giá trị Ksw = 15 Hình 1.14: Đáp ứng mơ hình giá trị Ksw = 50 Hình 1.15: Đáp ứng mơ hình giá trị Ksw = 100 Hình 1.16: Đáp ứng ngõ 10 Hình 1.17: Đáp ứng ngõ với hàm Sign(x) 11 Hình 1.18: Đáp ứng ngõ với hàm Sat(x) 11 Hình 1.19: Mơ hình lắc ngược quay thơng số 12 Hình 2.1: Đồ thị K1 theo điện áp đầu vào, quạt vị trí 13 Hình 2.2: Đồ thị k0 theo điện áp đầu vào, quạt vị trí 14 Hình 2.3: Đồ thị K1 theo điện áp đầu vào, quạt vị trí 15 Hình 2.4: Đồ thị k0 theo điện áp đầu vào, quạt vị trí 16 Hình 2.5: Đáp ứng ngõ đặt quạt vị trí 1, Kp = 0.4, Ki = 0, Kd = 17 Hình 2.6: Đáp ứng ngõ đặt quạt vị trí 1, Kp = Kp0, Ki = Ki0, Kd = Kd0 18 Hình 2.7: Đáp ứng ngõ đặt quạt vị trí 2, Kp = 0.4, Ki = 0, Kd = 18 Hình 2.8: Đáp ứng ngõ đặt quạt vị trí 2, Kp = Kp1, Ki = Ki1, Kd = Kd1 19 Hình 2.9: Đáp ứng hệ thống trường hợp: K p = Kp0/2, Kp = Kp0 Kp = 2Kp0 20 Hình 2.10: Đáp ứng hệ thống trường hợp: Ki = Ki0/2, Ki = Ki0 Ki = 2Ki0 .20 Hình 2.11: Đáp ứng hệ thống trường hợp: Kd = Kd0/2, Kd = Kd0 Kd = 2Kd0 .21 Hình 2.12: Đáp ứng hệ thống trường hợp: θd = 50, θd = 100, θd = 150 .22 Hình 2.13: Biểu đồ Bode vị trí 23 Hình 2.14: Biểu đồ Bode vị trí 24 Hình 3.1: Kết ước lượng lamda = 1, lần 25 ii TIEU LUAN MOI download : skknchat@gmail.com Hình 3.2: Kết ước lượng lamda = 1, lần Hình 3.3: Kết ước lượng lamda = 1, lần Hình 3.4: Kết ước lượng lamda = 1, lần Hình 3.5: Kết ước lượng lamda = 1, lần Hình 3.6: Đáp ứng ngõ ζ = 1, ω = 20 Hình 3.7: Đáp ứng ngõ ζ = 1, ω = 24 Hình 3.8: Đáp ứng ngõ ζ = 0.8, ω = 20 Hình 3.9: Đáp ứng ngõ α = 0.8, β = 0.1 Hình 3.10: Đáp ứng ngõ α = 0.5, β = 0.1 Hình 3.11: Đáp ứng ngõ α = 0.1, β = 0.1 Hình 4.1 Nhiệt độ lò nhiệt theo thời gian chế độ ON-OFF Hình 4.2: Nhiệt độ lò theo thời gian chế độ PID Hình 4.3: Nhiệt độ lị nhiệt theo thời gian Hình 5.1: Vị trí xe xe theo thời gian với Kf = [0 Hình 5.2: Vị trí xe xe theo thời gian với Kf = [0 Hình 5.3: Vị trí xe xe theo thời gian với Kf = [0.2 Hình 5.4: Vị trí xe xe theo thời gian với Kf = [1 Hình 5.5: Vị trí xe xe theo thời gian với Kf = [1 iii TIEU LUAN MOI download : skknchat@gmail.com Danh sách bảng số liệu Bảng 2.1: Liên hệ tốc độ quạt góc nghiêng phẳng trường hợp 13 Bảng 2.2: Liên hệ tốc độ quạt góc nghiêng phẳng trường hợp 15 Bảng 2.3: Thông số điều khiển PID vị trí quạt 17 Bảng 2.4: Đáp ứng tần số quạt vị trí 23 Bảng 2.5: Đáp ứng tần số quạt vị trí 24 Bảng 3.1: Thông số hàm truyền G(z) 25 Bảng 4.1: Giá trị KC, TC 33 Bảng 4.2: Chất lượng hệ thống 34 Bảng 5.1: Giá trị k1, b1 37 Bảng 5.2: Giá trị K, b2 37 Bảng 5.3: Bảng giá trị Kf 38 Bảng 5.4: Bảng giá trị Kf 40 iv TIEU LUAN MOI download : skknchat@gmail.com BÀI THÍ NGHIỆM ĐIỀU KHIỂN HỆ PHI TUYẾN CON LẮC NGƯỢC QUAY 1.1 Tuyến tính hóa điểm cân thiết kế điều khiển LQR 1.1.1 Khảo sát ảnh hưởng ma trận Q ma trận R Thực khảo sát mơ hình giá trị ma trận Q với giá trị khởi tạo trạng trái ( = d / dt = d / dt = 0, trạng thái x1 = , x1 = d / dt , x2 = , x2 =d ma trận R khác nhau, / dt Hình 1.1: Đáp ứng mơ hình Q = diag([1, 1, 0.001, 1]), R = 1 TIEU LUAN MOI download : skknchat@gmail.com Hình 1.2: Đáp ứng mơ hình Q = diag([1, 1, 1, 1]), R = Hình 1.3: Đáp ứng mơ hình Q = diag([1, 1, 104, 1]), R = TIEU LUAN MOI download : skknchat@gmail.com Hình 1.4: Đáp ứng mơ hình Q = diag([1, 1, 1, 1]), R = 0.01 Hình 1.5: Đáp ứng mơ hình Q = diag([1, 1, 1, 1]), R = TIEU LUAN MOI download : skknchat@gmail.com Hình 1.6: Đáp ứng mơ hình Q = diag([1, 1, 1, 1]), R = 100 • Ảnh hưởng ma trận Q lên góc θ2: tăng hệ số thứ ma trận θ2 xác lập nhanh độ vọt lố giảm • Ảnh hưởng ma trận R lên góc θ2: tăng giá trị R thời gian xác lập θ2 tăng lên 1.1.2 Khảo sát ảnh hưởng giá trị khởi tạo góc θ2 Thực khảo sát mơ hình giá trị khởi tạo θ2 khác nhau, với giá trị khởi tạo trạng trái ( = d / dt = d / dt = ) với ma trận Q = diag([1, 1, 1, 1]) ma trận R = 1, thu kết sau TIEU LUAN MOI download : skknchat@gmail.com Hình 1.7: Đáp ứng mơ hình giá trị khởi tạo θ2 = 10 Hình 1.8: Đáp ứng mơ hình giá trị khởi tạo θ2 = 15 TIEU LUAN MOI download : skknchat@gmail.com BÀI THÍ NGHIỆM ĐIỀU KHIỂN NHIỆT ĐỘ DÙNG BỘ ĐIỀU KHIỂN THÍCH NGHI PID AUTO-TUNING 4.1 Tìm độ lợi tới hạn chu kỳ tới hạn hệ thống để cài đặt thông số cho điều khiển PID • Điều khiển nhiệt độ lị nhiệt dùng điều khiển ON-OFF • Đáp ứng ngõ chế độ ON-OFF (Chu kỳ lấy mẫu T = 1s, thời gian mơ 1600s) Hình 4.1 Nhiệt độ lò nhiệt theo thời gian chế độ ON-OFF Từ đồ thị, ta tính thơng số: ▪ ▪ ▪ Biên độ dao động: Chu kỳ tới hạn: TC = 1189 − 731 = 458 Độ lợi tới hạn: K 32 TIEU LUAN MOI download : skknchat@gmail.com Bảng 4.1: Giá trị KC, TC • Tính tốn thơng số điều khiển PID ▪ ▪ Chọn =K K p ▪ ▪ • Điều khiển nhiệt độ lị nhiệt dùng điều khiển PID • Cài đặt thơng số cho điều khiển PID ▪ K ▪ = K i ▪ • K d = K p Td = 0.0252 74.0882 = 1.8670 Đáp ứng ngõ chế độ PID (Chu kỳ lấy mẫu T = 1s, thời gian mô 1200s) 33 TIEU LUAN MOI download : skknchat@gmail.com Hình 4.2: Nhiệt độ lị theo thời gian chế độ PID Từ đồ thị, ta tính thơng số ▪ Độ vọt lố: POT = (Sử dụng công cụ “Brush” chức “Export Brushed” để xuất liệu Output từ thời điểm 502s đến 1200s Từ tính giá trị yxl cách lấy trung bình giá trị Output từ thời điểm 502s đến 1200s) ▪ Sai số xác lập: exl = 101.7884 − 100 = 1.7884 ▪ Thời gian độ: tqd (2% ) = 290 s Bảng 4.2: Chất lượng hệ thống Kp 0.0252 • Đánh giá chất lượng hệ thống: Hệ thống có chất lượng tốt với sai số xác lập nhỏ khơng có vọt lố với thời gian độ thấp Với giá trị lớn hệ thống cho chất lượng tốt 34 TIEU LUAN MOI download : skknchat@gmail.com 4.2 Điều khiển thích nghi PID auto-tuning • Khối “PID computation” • Biến cnt có chức làm biến đếm thời gian lò nhiệt • Thời điểm A B xác định thời điểm mà ngõ khối “Relay” chuyển từ lên (2 thời điểm mà giá trị nhiệt độ đo 0 lò nhiệt giảm xuống đạt 70 C từ giá trị nhiệt độ cao 70 C trước đó) • Giá trị biên dao động M tính nửa độ chênh lệch nhiệt độ cao nhiệt độ thấp khoảng thời gian A B • Đáp ứng ngõ (Chu kỳ lấy mẫu T = 1s, thời gian mơ 1800s) Hình 4.3: Nhiệt độ lò nhiệt theo thời gian Từ đồ thị, ta tính tốn thơng số • Thời gian chuyển từ chế độ ON-OFF sang chế độ PID 1168s • Độ vọt lố: y POT = 35 TIEU LUAN MOI download : skknchat@gmail.com (Sử dụng công cụ “Brush” chức “Export Brushed” để xuất liệu Output từ thời điểm 1501s đến 1799s Từ tính giá trị yxl cách lấy trung bình giá trị Output từ thời điểm 1501s đến 1799s) • Thời gian độ: t qd • • Sai số xác lập: e xl =101.9482 −10 Nhận xét: • Chất lượng hệ thống sử dụng điều khiển PID auto-tuning: Hệ thống có độ vọt lố sai số xác lập nhỏ thời gian độ lớn thời gian chuyển từ chế độ ON-OFF sang chế độ PID cịn dài • Để giảm thời gian hệ thống chuyển từ chế độ ON-OFF sang chế độ PID, ta tăng giá trị d lên để hệ thống đạt dao động sớm hơn, từ thơng số cần tính tốn chế độ PID tính nhanh hệ thống chuyển sang chế độ PID nhanh 36 TIEU LUAN MOI download : skknchat@gmail.com BÀI THÍ NGHIỆM ĐIỀU KHIỂN HỒI TIẾP BIẾN TRẠNG THÁI 5.1 Tìm thơng số hệ xe – lị xo 5.1.1 Tìm k1, b1 Thực thu thập số liệu thu bảng giá trị thông số k1 b1 5.1.2 Tìm K, b2 Chương trình bổ sung cho file recti_ident.m a1 = T*T*(uu(2:N-1)); a2 = -T*(x2(2:N-1) - x2(1:N-2)); PHI = [a1 a2]; lamda = m2*(-2*x2(2:N-1) + x2(1:N-2) + x2(3:N))+k1_hat*T*T*(x2(2:N-1) - x1(1:N-2)); Thực thu thập số liệu thu bảng giá trị thông số K b2 Bảng 5.2: Giá trị K, b2 37 TIEU LUAN MOI download : skknchat@gmail.com Từ số liệu bảng 5.1 bảng 5.2, ta có phương trình biến trạng thái hệ xe – lò xo x x = x x y=1 x : điều khiển xe x y=0 : điều khiển xe 5.2 Điều khiển vị trí xe Thực khảo sát vị trí xe nhiều trường hợp hệ số Kf khác nhau, thu bảng số liệu sau Bảng 5.3: Bảng giá trị Kf Lần chạy 38 TIEU LUAN MOI download : skknchat@gmail.com Hình 5.1: Vị trí xe xe theo thời gian với Kf = [0 0.1 0] Hình 5.2: Vị trí xe xe theo thời gian với Kf = [0 0] 39 TIEU LUAN MOI download : skknchat@gmail.com • Ảnh hưởng hệ số Kf3 lên hệ thống: Khi tăng giá trị hệ số Kf3, hệ cho sai số xác lập giảm thời gian xác lập độ vọt lố tăng lên Khi Kf3 qua ngưỡng định (theo kết thu 5) hệ khơng cịn xác lập mà chuyển sang dao động • Ảnh hưởng hệ số Kf4 lên hệ thống: Khi tăng giá trị hệ số Kf4 độ vọt lố thời gian xác lập giảm đáng kể không thay đổi sai số xác lập Khi Kf4 vượt qua ngưỡng định (theo kết thu 0.2) hệ khơng cịn xác lập mà chuyển sang dao động 5.3 Điều khiển vị trí xe Thực khảo sát vị trí xe nhiều trường hợp hệ số Kf khác nhau, thu bảng số liệu sau Bảng 5.4: Bảng giá trị Kf Lần chạy 10 11 12 13 14 15 [0.2 [0.5 [1 [1.5 [2 [1 [1 [1 [1 [1 [1 [1 [1 [1 [1 40 TIEU LUAN MOI download : skknchat@gmail.com Hình 5.3: Vị trí xe xe theo thời gian với Kf = [0.2 0 0] Hình 5.4: Vị trí xe xe theo thời gian với Kf = [1 0 0] 41 TIEU LUAN MOI download : skknchat@gmail.com Hình 5.5: Vị trí xe xe theo thời gian với Kf = [1 0.01 0] • Ảnh hưởng hệ số Kf1 lên hệ thống: Khi tăng giá trị hệ số Kf1, hệ cho sai số xác lập giảm thời gian xác lập độ vọt lố tăng lên Khi Kf1 qua ngưỡng định (theo kết thu 1) hệ khơng cịn xác lập mà chuyển sang dao động • Ảnh hưởng hệ số Kf2 lên hệ thống: Khi tăng giá trị hệ số Kf2 độ vọt lố giảm đi, sai số xác lập giảm không nhiều, nhiên thời gian xác lập lại tăng lên Khi Kf2 vượt qua ngưỡng định (theo kết thu 0.01) hệ khơng cịn xác lập mà chuyển sang dao động • Ảnh hưởng hệ số Kf4 lên hệ thống: Khi tăng giá trị hệ số Kf4 độ vọt lố thời gian xác lập giảm đáng kể 42 TIEU LUAN MOI download : skknchat@gmail.com ... BÀI THÍ NGHIỆM 1.1 1.1.1 Tuyến tính hóa điểm cân thiết kế Khảo sát ả 1.1.2 Khảo sát ả Bộ ước lượng trạng thái 1.2 Điều khiển swing-up lắc phương pháp năn 1.3 Thiết kế điều khiển. .. TIEU LUAN MOI download : skknchat@gmail.com BÀI THÍ NGHIỆM ĐIỀU KHIỂN HỆ PHI TUYẾN CON LẮC NGƯỢC QUAY 1.1 Tuyến tính hóa điểm cân thiết kế điều khiển LQR 1.1.1 Khảo sát ảnh hưởng ma trận Q ma trận... • Giải thích: Mơ hình mơ hình phi tuyến, điều khiển PID điều khiển dành cho mơ hình tuyến tính Ở điểm làm việc θ =10 mơ hình phi tuyến xấp xỉ tuyến tính, áp dụng tốt điểu khiển PID Các điểm làm