BÀI báo cáo CUỐI kỳ THIẾT kế, mô PHỎNG XE HAI BÁNH tự cân BẰNG sử DỤNG bộ điều KHIỂN PID

ÍÍEquation Chapter Section 1211Equation Chapter Section 1311Equation Chapter Section 1411Equation Chapter Section 1BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐẠI HỌC SƯ PHẠM KỸ THUẬT TP.HCM HCMUTE BÀI BÁO CÁO CUỐI KỲ THIẾT KẾ, MÔ PHỎNG XE HAI BÁNH Tự CÂN BẰNG SỬ DỤNG BỘ ĐIỀU KHIỂN PID TIẾT HỌC: Thứ tư, Tiết - NHĨM THỰC HIỆN : Nhóm GIẢNG VIÊN HƯỚNG DẪN: GV Nguyễn Văn Đông Hải Thành viên: Mã sô sinh viên: Bùi Lê Anh 19151099 Nguyễn Ngọc Sơn 19151002 Đào Anh Vũ 19151199 TP.HỒ CHÍ MINH - 11/2021 TRƯỜNG ĐH SƯ PHẠM CỘNG HÒA - XÃ HỘI - CHỦ NGHĨA - VIỆT NAM KỸ THUẬT TPHCM • *** ,, Độc Lập - Tự Do - Hạnh Phúc T Tp Hồ Chí Minh, Ngày 21 tháng 11 năm 2021 BÁO CÁO CUỐI KỲ MÔN THỰC TẬP HỆ THỐNG ĐIỀU KHIỂN TỰ ĐỘNG Giảng viên hướng dẫn: Thầy Nguyễn Văn Đông Hải Sinh viên thực hiện: Bùi Lê Anh - 19151099 Nguyễn Ngọc Sơn - 19151002 Đào Anh Vũ - 19151199 Tên đề tài: Thiết kế, mô xe hai bánh tự cân sử dụng điều khiển PID Nhận xét giảng viên: Ngày 21 tháng 11 năm 2021 Giảng viên chấm điểm MỤC LỤC 4.1 Chương 1: GIỚI THIỆU 1.1 Đặt vấn đề Tự động hóa xu hướng phát triển giới, dần thay nhân cơng thiết bị máy móc tự động dây chuyển sản xuất Nghiên cứu robot đặc biệt robot di động phần quan trọng ngành tự động hóa Xe hai bánh tự cần đề tài quen thuộc nhiều kỹ sư giới ý Ta phải thiết kế điều khiển cho xe cân địa hình, thời tiết tình Từ ta ứng dụng vào đời sống giúp giảm thiểu tai nạn xe tự chủ hay áp dụng vào nhà máy vận chuyển hàng giảm thiểu tối đa kinh tế, Chúng em nhận thấy tầm quan trọng nghiên cứu xe hai bánh tự cân nên chúng em chọn đề tài: “Thiết kế mơ hình xe hai bánh tự cân với điều khiển PID” Do kiến thức kinh nghiệm chưa nhiều nên có sai sót báo cáo, mong thầy bạn đọc thông cảm 1.2 Mục tiêu nghiên cứu + Nắm khái niệm robot di động + Ứng dụng lý thuyết học để thiết kế thành công điều khiển cho xe hai bánh tự cân + Rèn luyện kỹ mô dung MATLAB SIMULINK + Hiểu quy trình nghiên cứu thiết kế hệ thống 1.3 Phương pháp nghiên cứu + Đọc sách tham khảo nguồn mạng mô xe hai bánh tự cân + Tìm kiếm báo giải thuật PID cho xe tự cân + Tham khảo giảng viên hướng dẫn bạn bè + Thực chứng minh lý thuyết mô song song 1.4 Bố cục đề tài Chương : Giới thiệu đề tài Chương 2: Cơ sở lý thuyết điều khiển PID Chương 3: Mô Chương 4: Kết luận Chương 2: CƠ SỞ LÝ THUYẾT 2.1 Bộ điều khiển PID Một hệ thống làm việc tốt hệ thống hoạt động tối ưu theo tiêu chuẩn đạt định (đạt cực trị) Trạng thái tối ưu có đạt trì hay khơng tùy thuộc vào vào u cầu chất lượng đặt ra, tác động lên đối tượng điều kiện làm việc đối tượng Một điều khiển giúp đối tượng hoạt động tối ưu theo ý muốn người sử dụng điều khiển PID Ta có sơ đồ điều khiển PID sau: Hinh 1: Sơ đồ điều khiển PID Để thiết kế điều khiển PID ta phải thiết điều khiển hồi tiếp âm để giá trị sai số ngõ với giá trị đặt sau đưa vào điều khiển PID Từ PID cấp điện áp để điều khiển động cho hệ thống đạt vị trí cân 2.2 Mơ hình ký hiệu Ta có mơ hình xe hai bánh tự cân sau: Mơ hình xe hai bánh tự cân Một số ký hiệu đặc trưng cho xe bánh tự cân bằng: Kí hiệu Đơn vị Ý nghĩa Mp Kg Khối lượng robot Mw Kg Khối lượng bánh xe R m Bán kính bánh xe P rad Góc nghiêng thân robot w rad Góc xoay bánh xe è„ Rad/s Vận tốc góc bánh xe r Ohms Điện trở động L H Cuộn cảm động co k f Nms/rad Hệ số ma sát km Nm/A Hệ số moment Ke Vs/rad Hệ số Back emf động 3 a rad / s2 Gia tốc góc động Va V Điện áp cấp cho động Ve V Điện áp phần ứng i A Dòng điện phần ứng IR Kgm T m I Moment quán tính động Nm Moment động w Moment quán tính bánh xe Ip Moment quán tính thân xe HL,HRPL,PR Lực tác động bánh xe thân robot l Khoảng cách từ tâm bánh xe đến tâm trọng trường thân xe CL,CR Moment động tác động lên bánh xe HfL,HfR Lực ma sát bánh xe mặt phẳng p Hệ số hiệu chỉnh 2.3 Mơ hình động học xe động DC Va k m T IR R IR R I a R (1) l.xiii l.xii l.xiv Phân tích lực tác động lên thân bánh xe Áp dụng định luật Newton tính tổng lực tác động lên bánh xe theo l.xv phương ngang l.xvi l.xvii l.xviii ỵ F=MX x p ( HL+HR)-Mplỗ p cos dp+Mplè2 p sin dp=MpX Ta được: ( HL+HR) = Mpx +Mplẽ p cos dp+Mplè \ sin dp l.xix (13) l.xx Lực vng góc tác động lên thân xe: l.xxi l.xxii ( H+ L H cos R) +( P +P hp L R E ) dp pgsỉndp sin -M M X cos xp= F P prẽ p=MpX -M e p cos Tổng moment tác động lên trọng tâm thân xe: dp (14) l.xxiii ỵ M =Ia o - ( HL+HR ) ỉcos6p-(Pí+PR) l.xxiv - Ta có: Âx -2k CL+CR= l.xxv l.xxvi l.xxvii + m RrR 2k V a (15) ỉsín0p-( CL+CR )= Ipẽp Thay vào phương trình 15 ta có: l.xxviii 2k k 2k l.xxix l.xxx l.xxxii l.xxxi r Rr Rr p p p p p p p ' Hai phương trình (18) (19) hệ phương trình phi tuyến hệ thống Để tuyến tính hóa mơ hình ta cho p= n + ộ với ộ góc nhỏ theo phương thẳng đứng lên Từ ta có: l.xxxiii cos6p=-1 l.xxxiv sin 6p = -ộ l.xxxv ldep l.xxxvi 7? = dt l.xxxvii Từ ta có mơ hình tuyến tính hóa hệ thống: l.xxxviii (I + MI2 )ộ - ^ ex+^V-Malộ=MDlx k k pp R a p Rr l.xxxix Rr \ ^V:= x+2 2k x -M lộ r2 Mwpl+ +MRr ( p Iw mke p (20) (21) l.xlĐể có mơ hình biến trạng thái hệ thống ta rút biến trạng thái từ l.xli phương trình (20) (21), ta có: ộ = r M 72 *+ ír ; ,21 x Ip+Mpl2 Rr (Ip + Mpl2) p l.i x= "—-V + 2k p Mpgl ộ l.ii R(Ip+Mpl) - R(Ip+ MplT ộ l.xliil.xliii km l.xliv -V l.xlv l.xlvi l.xlviii p l.xlvii e k m l.xlixl.l Mw + -l.li l.liii l.liv l.lvil.lvii M + R l.lii I — + Mp 24+Mp l.lix r l.lviii Mw+ l.lv ~ l.lxBằng cách thay phương trình vào phương trình (20) (21) k M l a Rr r r ta hệ không gian trạng thái sau: l.lxi l.lxii l.lxiii l.lxvii l.lxviii l.lxix l.lxx kmke l.lxxi x (Mplr-I l.lxxvii l.lxxv l.lxxvi l.lxxviii Rr a l.lxxxiii = l.lxxxiv l.lxxxv l.lxxxvi l.xcii l.xci l.xciii l.xcv l.xcvi ( ộ p2 a l.xciv l.ciiim e Rr l.cl.cil.cii l.cviii l.cix Với: x k k r - l.lxv l.lxiv l.lxvi 00 l.lxxii l.lxxiii l.lxxiv km (Ip + Mpl22 p-Mpl ) Mp gl Mplr) l.lxxix l.lxxx l.lxxxi l.lxxxii Rr2 a a l.lxxxix l.xc l.lxxxvii l.lxxxviii ộ l.xcviii l.xcvii l.xcix kp, (Mpl-rp) ) p ộ l.cv l.cvi l.cvii Rra l.civ a x x 0 M l l.cx p=(2 Mw+ ■■ + Mp) r 21 l.cxi l.cxii a = l.cxiv + l.cxvii I rp 2M pf l.cxiii l.cxvi l.iii Va ( r l.cxviii Với mơ hình trên, xe ln nằm mặt phẳng bỏ qua ma sát bánh xe với mặt phẳng, lực tác động không đáng kể l.cxix Chương 3: MÔ PHỎNG 3.1 Khai báo, khảo sát hệ thống xây dựng điều khiển l.cxx - Đầu tiên để tiến hành xây dựng điều khiển ta cần khai báo giá trị biến hệ thống khảo sát hệ thống có điều khiển hay khơng quan sát biến trạng thái hay không tính ổn định hệ thống 3.1.1 l.cxxi - Khai báo thông số hệ thống Thong SoTWBR.m + I clear ạ.ll; clc; ksi=0.022; ke=o.4 ĩ R-1.7; 1=0.0325; Mp=l; MW=0.03; lp=0.0012; Iw=0.000016; l=ũ.05;| g=9.ei; teta_init=0; te ta_dot_ỉíìit»0; x_ĩnĩt=ũ; x_dot_ỉnỉt=0; beta = 2*Mw+2*lw/r~2+Mp; alpha - lp*beta+2*Mp*ỉ"'2*(Mw+lw/r"'2); 3.1.2 Khảo sát tính ổn định hệ thống - Sử dụng MATLAB để tính hàm truyền nghiệm hệ thống l.cxxii % THONG- -% l.cxxiii[num,den] = ss2tf(A,B,c,D) l.cxxiv HTXE1 = tf(num (1, :),den) l.cxxv HTXE2 = tf(num(2,:),den) l.cxxvi %rlocus (A, B,C,D) l.cxxviipzmap (A,B,C,D) l.cxxviii nghiêm = roots(den) TINH HAM TRUYEN CUA HE l.cxxix l.cxxx l.cxxxi HTXE1 - 1.077 SA2 - 1.913e-14 s - 375.5 SA4 + 13.26 SA3 - 348.6 SA2 - 3134 s Continu.ous-time transíer ĩunction l.cxxxii HTXE2 = l.cxxxiii 1.88e-08 l.cxxxiv SA2 - 100.2 s + 7.196e-16 SA4 + 13.26 SA3 - 348.6 SA2 - 3134 s Continu.ous-time transfer function l.cxxxv Must call rlocus with a SISO System, e.g rlocus(a,b(:ri)/c(j,:)rd(i,j)) nghiem - l.cxxxvi l.cxxxvii 17.3190 l.cxxxviii l.cxxxix -8.0233 l.cxli l.cxlii -22.5532 l.cxl Dựa vào nghiệm hàm truyền cực, zero hệ thống ta kết luận hệ thống khơng ổn định theo tiêu chuẩn Routh Hurwitz 3.1.3 Khảo sát tính điều khiển hệ thống l.cxliii - Dựa vào lí thuyết điều khiển tự động với hệ tuyến tính có phương trình khơng gian trạng thái dạng sau: l.cxliv x = Ax + Bu y=Cx + Du l.cxlv - Với A6R ,B6 R ,C 6R D6 R nxn nxu rxm Xây dựng ma trận điều khiển: l.cxlvi ] l.cxlvii P = [B,AB,A2B, ,A B n- Điều kiện cần đủ để hệ thống mô tả tốn học dạng phương l.cxlviii trình trạng thái điều khiển rank(P)=n Với n số biến trạng thái hệ thống Ta sử dụng matlab để kiểm chứng hệ thống l.cxlix l.cl & Sr l.cli o o l.clii -% Khao sat tinh dieu khien duoc cua he thong % l.cliii p = [B A*B AA2*B AA3*B] l.cliv l.clv l.clvi rank(P) p = 1.0e+04 * Ũ □.0001 ũ ũ.0000 -ũ.0014 0.0001 -ũ.0014 0.ũũũũ -Ũ.0100 ans = 0.0189 -0.0100 0.1329 0.018 -0 4113 0.132 -5.2564 Bậc ma trận P với số biến trạng thái hệ thống Ta lựa chọn ma trận C 3.1.4 l.clviii Khảo sát tính quan sát hệ thống Ta có C.x(t) = l.clix 000 10 00 01 l.clx - Xây dựng ma trận quan sát: l.clxi l.clxii I L-\C,AC,A2C, ,A 1C n- Ta sử dụng matlab để kiểm chứng hệ thống l.clxiii % l.clxiv L = [C; C*A; C*AA2; C*AA3]; l.clxv rank (L) Khao sat tinh quan sat dnoc cua he thong— l.Ũe+03 * l.clxvi Ũ.0010 0 0 0 -0.0133 Ũ -0.0931 0.1758 1.2338 0.0010 0.0010 0 0.0160 0.3486 -0.2119 -1.4877 0 0 0010 0 0.0160 0.3486 Bậc ma trận P với số biến trạng thái hệ thống l.clxvii - Nhận xét: Từ kiểm chứng ta kết luận hệ thống điều khiển ta quan sát biến trạng thái hệ thống Và thông qua việc tađặt ma trận C để quan sát biến trạng thái vị trí xe góc nghiêng xe biến ổn định có hệ thống ổn định 3.1.5 Xây dựng điều khiển l.clxviii l.clxix l.clxx Mô tả hệ thống với điều khiển l.clxxi Ở hệ thống điều khiển xe bánh tự cân bằng, ta phải điều khiển ổn định tham số góc nghiêng vị trí hệ thống nên ta tách thành điều khiển song song lồng hiệu chỉnh thông số Kp Ki Kd để điều khiển điện áp cấp cho động để có đáp ứng mong muốn l.clxxii Để điều khiển ổn định xe cân trước tiên ta phải hiệu chỉnh ổn định góc nghiêng xe trước sau ta hiệu chỉnh để ổn định tiếp điều khiển vị trí cho xe 3.2 Xây dựng mơ hình Matlab Simulink l.clxxiv l.clxxiii l.clxxv Toàn hệ thống với điều khiển l.clxxvi l.clxxvii Khối mơ tả phương trình khơng gian trạng thái hệ thống l.clxxviii l.clxxix l.clxxx l.clxxxi l.clxxxii Bộ điều khiển PID vị trí hệ thống với Kp = 1143, Ki = 1940.4, Kd = -5 l.clxxxiii l.clxxxiv l.clxxxv l.clxxxvi Bộ điều khiển PID góc nghiêng hệ thống Kp = 520, Ki = 1550.5, Kd = 23.28 l.clxxxvii l.clxxxviii l.clxxxix Đáp ứng hệ thống l.cxc Nhận xét: Qua q trình thử sai có thử qua giải thuật di truyền để tìm thơng số PID phù hợp với hệ thống nhóm điều khiển đạt xe bánh tự cân Hệ thống ổn định với thời gian khoảng 3s có độ vọt lố chấp nhận điều khiển vị trí điều khiển xe tự cân với góc nghiêng độ Nhóm thử qua giải thuật pid_GA thầy Huỳnh Thái Hoàng qua hướng dẫn thầy Nguyễn Văn Đông Hải nhiên nhóm chưa đạtđược kết mong muốn, nhóm tìm hiểu thêm giải thuật di truyền hồn thiện tương lai l.cxci Chương 4: KẾT LUẬN 4.1 Kết l.cxcii Theo kết mô trên, ta nhận thấy thay đổi giá trị đặt ban đầu hệ thống đáp ứng lâu hơn, độ vọt lố tăng Mặc dù xe ổn định sau khoảng thời gian Vì ta sử dụng điều khiển PID để sử dụng cho xe bánh tự cân phải chọn thông số ban đầu cho hợp lý 4.2 Hướng ph át triển V Kết hợp xe hai bánh tự cân dùng điều khiển PID kết hợp với LQR V Khảo sát xe số môi trường không phẳng V Kết hợp số phương pháp để điều khiển xe 4.3 Nhận đinh chung l.cxciii Qua việc “Thiết kế xe hai bánh tự cân sử dụng điều khiển PID” giúp cho nhóm hiểu thêm điều khiển hệ thống môn Hệ thống điều khiển tự động Ngồi cịn giúp chúng em hiểu rõ kiến thức, kỹ sử dụng phần mềm mô hệ thống thực cụ thể Matlab l.cxciv Sau thời gian giao nhiệm vụ thiết kế tập lớn bên trên, hướng dẫn tận tình giảng viên, bạn môn chúng em hồn thành nhiệm vụ Do thời gian có hạn, chưa có nhiều kinh nghiệm thực tế, báo cáo chúng em khơng tránh khỏi thiếu sót, kính mong thầy thơng cảm Chúng em cảm ơn thầy hỗ trợ chúng em thời gian thực tập lơns, chúng em cố gắng nâng cao kiến thức kỹ để áp dụng vào đời sống sau ... xe hai bánh tự cân sau: Mơ hình xe hai bánh tự cân Một số ký hiệu đặc trưng cho xe bánh tự cân bằng: Kí hiệu Đơn vị Ý nghĩa Mp Kg Khối lượng robot Mw Kg Khối lượng bánh xe R m Bán kính bánh xe. .. điều kiện làm việc đối tượng Một điều khiển giúp đối tượng hoạt động tối ưu theo ý muốn người sử dụng điều khiển PID Ta có sơ đồ điều khiển PID sau: Hinh 1: Sơ đồ điều khiển PID Để thiết kế điều. .. trọng nghiên cứu xe hai bánh tự cân nên chúng em chọn đề tài: ? ?Thiết kế mơ hình xe hai bánh tự cân với điều khiển PID? ?? Do kiến thức kinh nghiệm chưa nhiều nên có sai sót báo cáo, mong thầy bạn