BÀI tập lớn CHUYÊN đề 1 đề tài hệ nâng vật trong từ trường

TRƯỜNG ĐẠI HỌC GIAO THÔNG VẬN TẢI TP HCM KHOA ĐIỆN – ĐIỆN TỬ VIỄN THÔNG BÀI TẬP LỚN CHUYÊN ĐỀ Đề tài: Hệ nâng vật từ trường Giảng viên hướng dẫn: Nguyễn Thị Chính Nhóm thực hiện: 01 Thành viên báo cáo: Họ tên Đường Quốc Phát Lại Nhất Nguyên TP Hồ Chí Minh, tháng 10/2021 MỤC LỤC CHƯƠNG 1:MƠ HÌNH TỐN HỌC CỦA HỆ NÂNG VẬT TRONG TỪ TRƯỜNG 1.1: Tìm mơ hình tốn hệ nâng vật từ trường: 1.2: Vẽ đáp ứng ngõ hệ thống: .6 1.3 Phương trình trạng thái hệ thống: 1.4 Xét tính điều khiển được: 1.5 Xét tính quan sát được: CHƯƠNG 2: THIẾT KẾ BỘ ĐIỀU KHIỂN TỐI ƯU LQR .10 2.1 Thiết kế điều khiển LQR: 10 2.2 Tính tốn thơng số: 10 2.3 Xây dựng mô hình simulink: 12 CHƯƠNG 3: THIẾT KẾ BỘ ĐIỀU KHIỂN FUZZY .15 3.1: Thiết kế điều khiển Fuzzy: 15 3.2: Thiết kế điều khiển PID mờ: 20 CHƯƠNG 1:MƠ HÌNH TỐN HỌC CỦA HỆ NÂNG VẬT TRONG TỪ TRƯỜNG 1.1: Tìm mơ hình tốn hệ nâng vật từ trường: Hình 1.1 Mơ tả hệ nâng vật từ trường _ Trong mô hình nâng vật từ trường ,điện áp u ngõ vào đối tượng, thay đổi để kiểm soát lực điện từ Fe dùng để nâng hạ viên bi Suy h(m) khoảnh cách viên bi so với nam châm điện ngõ đối tượng Áp dụng định luật Newton ta có : Trong :F= ma a :là gia tốc viên bi ( m / s2 ) Mà gia tốc đạo hàm vận tốc a = dv dt Đồng thời : đạo hàm quãng đường vận tốc : Suy ra: m dv dh dt = v i dt = mg − C( h ) => M Ta có cơng thức dịng điện R nối tiếp L từ trường theo hình 1: di (t) u (t ) = Ri (t ) + L (2) Từ (1), (2) suy ra: Mơ hình tốn học hệ thống: d y (t ) _M dt _ u (t ) = Ri (t ) + Z Bảng thích thơng số thực tế: Khối lượng viên bi Gia tốc trọng trường Điện trở Điểm cảm cuộn dây Hằng số lực từ Điện áp cung cấp Dòng điện qua c Vận tốc viên bi Độ cao viên bi _Vì nhiễu từ trường , ta có thông số : y ss = 7mm = 1A (Với i ss _Thế y(t) i(t) vào d2y m dt = mg −C( _Tuyến tính hóa cho hàm: d2y = dt m d2y C*i = dt 2*y _Laplace vế ta có : → s 2Y ( s ) = aY ( s ) + 2bI ( s) s 2Y ( s ) − aY ( s ) = 2bI ( s) Y ( s )( s − a ) = 2bI ( s) Y ( s )( s − a ) = 2b U ( s) ZL+R G ( s) = Trong : a= ss 2* y m ss 2C *i b= y ss Thế a b vào G(s), ta có: Hàm truyền hở G(s): G ( s) = Y(s) U(s) *m 1.2: Vẽ đáp ứng ngõ hệ thống: Hình 1.2 Sơ đồ hàm truyền hở Mơ simulink: Hình 1.3 Ngõ hệ thống Nhận xét : hệ thống không ổn định 1.3 Phương trình trạng thái hệ thống: Ta có : G ( s) = Y ( s ) (3.53s − 0.47 ) = 78.36U ( s) 3.53 y (t ) − 0.47 y (t ) = 78.36u ( t) y (t ) − 0.133 y (t ) = 22.198u (t) a0 y (t ) − a2 y (t ) = b0 u (t) Với a0 = a2 = −0.133 b0 = 22.198 Với x1 (t ) = y (t) x2 (t ) = x1 (t ) = y (t) x2 (t ) = y (t) Phương trình trạng thái có dạng: x (t ) = Ax (t ) + Bu (t) y (t ) = Cx (t) x (t ) x (t )01 x (t)0 x (t ) 22 = 1.33 x (t) + 22.198 * u (t) x1 (t ) = x2 (t) x2 (t ) = 0.133 x1 (t ) + 22.198u (t) y (t ) = x1 (t) Ta có: A= 1.33 B= C =[1 0] 1.4 Xét tính điều khiển được: Ma trận điều khiển được: M =[B: AB] AB = Với 1.33 Vậy M = B : AB = 22.198 Rank(M)=2 nên hệ thống điều khiển 8 1.5 Xét tính quan sát được: Ma trận quan sát được: T T T N = C :A C Ta có: ATCT = N= CT:ATCT Vì rank(N)=2 nên hệ thống quan sát CHƯƠNG 2: THIẾT KẾ BỘ ĐIỀU KHIỂN TỐI ƯU LQR 2.1 Thiết kế điều khiển LQR: Hình 2.1 Sơ đồ khối điều khiển LQR 2.2 Tính tốn thơng số: Ta có phương trình trạng thái: x (t ) = x (t) x2 (t ) = 0.133 x1 (t ) + 22.198u ( t) y (t ) = x (t) Trong A= 1.33 B= C =[1 Ta có tiêu chất lượng: (x J= T Qx + u T Ru )dt 10 Chọn: Q = R=1 Phương trình đại số Ricatti (với P ma trận đối xứng thực): 1.33 p p − p 11 12 1.33 p1.33 p p 11 492.75 p − 492.75 p22 p21 1.33 p21 + 1.33 p12 − 492.75 p12 p 21 + p + 1.33 p 11 Với P ma trận xác định dương ta có: 1.33 p21 + 1.33 p12 − 492.75 p12 p21 + = p 11 + 1.33 p − 492.75 p p = 22 22 21 p11 = 0.075 p12 = 0.0063 p21 = 0, 573 p22 = 0.0422 0.075 0, 0063 P = 0, 573 0, 0422 Chỉ tiêu chất lượng J đạt cực tiểu khi: K = R−1.BT P =1 11 Vậy ta có luật điều khiển: ( u t ) = − Kx 2.3 Xây dựng mơ hình simulink: Ta có: x (t ) = x (t) x2 (t ) = 0.133 x1 (t ) + 22.198u ( t) y (t ) = x (t) Laplace: sX (t ) = X ( s) (t ) = 0.133 X ( s ) + 22.198U ( s) sX Y ( s ) = X ( s) Ta tiến hành mơ phỏng: Hình 2.2 Sơ đồ mơ hệ thống simulink 12 Hình 2.3 Ngõ đáp ứng hệ thống Nhận xét: hệ thống có độ vọt lố nhỏ,thời gian độ nhanh 0.6s Suy hệ thống ổn định Đặt setpoint =1 Hình 2.4 Sơ đồ hệ thống đặt setpoint 13 Hình 2.5 Ngõ đáp ứng hệ thống Nhận xét: ta thấy ngõ có độ vọt lố nhỏ , khơng có sai số xác lập,thời gian độ 0.6s Suy hệ thống ổn định 14 CHƯƠNG 3: THIẾT KẾ BỘ ĐIỀU KHIỂN FUZZY 3.1: Thiết kế điều khiển Fuzzy: Ta có G ( s) = Tín hiệu vào u(t):điện áp Tín hiệu y(t):vị trí viên bi Bước 1: Xác định biến vào, đối tượng • Biến vào: + Điện áp E[-300;300] + Vi phân sai lệch DE[-150; 150] 15 • Biến ra: Vị trí viên bi U[-1; 1] Bước 2: Xác định hệ số chuẩn hóa biến vào, miền giá trị [0;1] [-1;1] Biến vào: E[-1;1], DE[-1;1] Biến ra: U[-1;1] Bước 3: Mờ hóa biến vào, cách xây dựng luật hợp thành giá trị ngôn ngữ cho biến vào, • Các biến ngôn ngữ: E= {NB; NS; ZE; PS; PB} DE= {NB; NS; ZE; PS; PB} U={NB; NS; ZE; PS; PB} Trong đó: NB: âm nhiều NS: âm ZE: khơng PS: dương PB: dương nhiều 16 • Xác định hàm liên thuộc cho biến ngơn ngữ E: • Xác định hàm liên thuộc cho biến ngơn ngữ DE: 17 • Xác định hàm liên thuộc cho biến ngôn ngữ U: Bước 4: Xây dựng hệ quy tắc mờ cho biến vào DE E NB NS ZE PS PB 18 Bước 5: Chọn phương pháp suy diễn thiết bị hợp thành Thiết kế điều khiển mờ Simulink: Hình 3.1 Sơ đồ mơ mờ simulink Ngõ hệ thống : 19 Hình 3.2 Ngõ đáp ứng hệ thống Nhận xét : hệ thống khơng có độ vọt lố,hầu khơng có sai số xác lập,thời gian độ nhanh