BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐẠI HỌC SƯ PHẠM KỸ THUẬT THÀNH PHỐ HỒ CHÍ MINH LUẬN VĂN THẠC SĨ PHAN THANH PHÚC ÐIỀU KHIỂN HỆ BÓNG TRÊN THANH BẰNG GIẢI THUẬT ÐIỀU KHIỂN THÔNG MINH NGÀNH: CƠ ÐIỆN TỬ - 8520114 S K C0 0 5 9 3 3 Tp. Hồ Chí Minh, tháng 04/2018 Luan van BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƢỜNG ĐẠI HỌC SƢ PHẠM KỸ THUẬT THÀNH PHỐ HỒ CHÍ MINH LUẬN VĂN THẠC SĨ PHAN THANH PHÚC ĐIỀU KHIỂN HỆ BÓNG TRÊN THANH BẰNG GIẢI THUẬT ĐIỀU KHIỂN THÔNG MINH NGÀNH: CƠ ĐIỆN TỬ - 8520114 Tp. Hồ Chí Minh, tháng 04/2018 Luan van BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƢỜNG ĐẠI HỌC SƢ PHẠM KỸ THUẬT THÀNH PHỐ HỒ CHÍ MINH LUẬN VĂN THẠC SĨ PHAN THANH PHÚC ĐIỀU KHIỂN HỆ BÓNG TRÊN THANH BẰNG GIẢI THUẬT ĐIỀU KHIỂN THÔNG MINH NGÀNH: CƠ ĐIỆN TỬ - 8520114 Hƣớng dẫn khoa học: PGS.TS NGUYỄN NGỌC PHƢƠNG Tp. Hồ Chí Minh, tháng 04/2018 Luan van QUYẾT ĐỊNH GIAO ĐỀ TÀI Luan van LÝ LỊCH KHOA HỌC I.
LÝ LỊCH SƠ LƢỢC: Họ & tên: Phan Thanh Phúc Giới tính: Nam Ngày, tháng, năm sinh: 02/02/1987 Nơi sinh: Tỉnh Đồng Tháp Quê quán: Tỉnh Long An Dân tộc: Kinh Chỗ ở riêng hoặc địa chỉ liên lạc: 162/56 Đƣờng Số 10, Phƣờng 9, Quận Gò Vấp, TpHCM Điện thoại cơ quan: Điện thoại nhà riêng: Fax Email:phanthanhphuc@gmail. QUÁ TRÌNH ĐÀO TẠO: 1. Trung học chuyên nghiệp: Hệ đào tạo: Chính qui Thời gian đào tạo từ 09/2009 đến 07/ 2009 Nơi học (trƣờng, thành phố): Cao Đẳng Kỹ Thuật Cao Thắng, TPHCM Ngành học: Cơ Điện tử 2. Đại học: Hệ đào tạo: Chính qui Thời gian đào tạo từ11/2011 đến 02/ 2015 Nơi học (trƣờng, thành phố): ĐH Công Nghiệp TPHCM Ngành học: Cơ Điện tử Tên đồ án tốt nghiệp: Thiết kế và điều khiển máy phay CNC 2 trục Ngày & nơi bảo vệ đồ án, luận án hoặc thi tốt nghiệp: 2015 Ngƣời hƣớng dẫn: TS Đƣờng Công Truyền III.
QUÁ TRÌNH CÔNG TÁC CHUYÊN MÔN KỂ TỪ KHI TỐT NGHIỆP ĐẠI HỌC: Thời gian Nơi công tác Công việc đảm nhiệm 2009-2014 Công ty TNHH Nam Ngọc Linh Nhân viên 2014-2016 Công ty TNHH Cơ Điện APS Nhân viên i Luan van LỜI CAM ĐOAN Tôi cam đoan đây là công trình nghiên cứu của tôi. Các số liệu, kết quả nêu trong luận văn là trung thực và chƣa từng đƣợc ai công bố trong bất kỳ công trình nào khác Tp. Hồ Chí Minh, ngày 26 tháng 03 năm 2018 (Ký tên và ghi rõ họ tên) Phan Thanh Phúc ii Luan van LỜI CẢM ƠN Lời đầu tiên xin chân thành cám ơn thầy cô trong bộ môn Cơ Điện Tử, thầy Nguyễn Văn Đông Hải phòng thí nghiệm bộ môn Tự Động Hóa của Trƣờng Đại học Sƣ Phạm Kỹ Thuật TPHCM luôn nhiệt tình hỗ trợ giúp đỡ trong việc điều khiển mô hình thực tế. Đăc biệt thầy Nguyễn Ngọc Phƣơng luôn đôn đốc tinh thần, đƣa ra điểm chính, những vấn đề cần giải quyết của đề tài để tôi hoàn thành đề tài này.
Cám ơn các bạn học viên cùng khóa Cơ điện tử 15B đã đồng hành động viên giúp đỡ tôi trong học tập để vƣợt qua các khó khăn trong quá trình học tập tại trƣờng. Cuối cùng, tôi xin chân thành cám ơn sự quan tâm hỗ trợ tạo điều kiện về vật chất và tinh thần của gia đình trong suốt quá trình học tập. Hồ Chí Minh, ngày 26 tháng 03 năm 2018 Học viên Phan Thanh Phúc iii Luan van TÓM TẮT Điều khiển thông minh là phƣơng pháp điều khiển phỏng theo các đặc điểm cơ bản của trí thông minh con ngƣời, bao gồm khả năng học, khả năng xử lý thông tin không chắc chắn và khả năng tìm kiếm lời giải tối ƣu. Ngày nay, lĩnh vực điều khiển thông minh có xu hƣớng bao gồm tất cả các vấn đề không thuộc phạm vi điều khiển thông thƣờng.
Tuy nhiên ranh giới giữa điều khiển thông minh và điều khiển thông thƣờng là tƣơng đối và thay đổi theo thời gian [14]. Từ các định nghĩa trên tác giả đề xuất giải thuật phi tuyến để áp dụng cho đề tài luận văn của mình. Hệ thống bóng trên thanh trục lệch là hệ thống phi tuyến không ổn đinh, và đƣợc ứng dụng rất nhiều thí nghiệm ở các trƣờng đại học, cũng nhƣ trong thực tế. Trong giới hạn luận văn tốt nghiệp “Điều khiển hệ bóng trên thanh bằng giải thuật điều khiển thông minh” tác giả sẽ trình bày phƣơng pháp điều khiển trƣợt động để so sánh các kết quả trƣợt tĩnh, trƣợt mờ bằng phƣơng pháp xây dựng mô hình hóa sau đó mô phỏng từ đó tiến hành xây dựng và điều khiển mô hình thực bằng các giải thuật điều khiển sau.
Trƣợt tĩnh: [11] đáp ứng hệ thống tốt tuy nhiên vẫn tồn tại hiện tƣợng chatteting (dao động). Trƣợt mờ:[13]xuất phát từ ý tƣởng [7] [9] là thay hàm Sign bởiFuzzy- Sugeno và hàm Sat trong mặt trƣợt, tuy nhiên việc thay hàm Sat vẫn tồn tại nhƣợc điểm đó là độ trể của đáp ứng hệ thống. Do đó theo [7] [13] thay hàm Sign bằng luật điều khiển Fuzzy-Sugeno với mục đích giảm hiện tƣợng chattering. Tuy nhiên bằng phƣơng pháp điều khiển này vẫn chƣa tốt.
Trƣợt động: khắc phục hoàn toàn cả hai nhƣợc điểm trên hiện tƣợng dao động đồng thời hệ thống đáp ứng tốt hơn. Việc điều khiển mô hình thực tế bằng cách sử dụng Matlab/Simulink thông qua công cụ hỗ trợ lập trình nhúng Waijung 15.04 cho DSP STM32F4, Sau đó tiến hành thu thập dữ liệu hiển thị lên máy tính thông qua Terminal dể kiểm tra chất lƣợng kết quả điều khiển thực tế. iv Luan van MỤC LỤC Chƣơng 1: TỔNG QUAN .Giới thiệu hệ bóng trên thanh .Nguyên lý hoạt động: .Mục tiêu của luận văn: .Phạm vi nghiên cứu:.Phƣơng pháp nghiên cứu:.Các công trình nghiên cứu: .Nghiên cứu trong nƣớc: .Nghiên cứu ngoài nƣớc: .Tầm quan trọng và ý nghĩa thực tiễn của hệ thống: .Cấu trúc của luận văn:. 9 Chƣơng 2:MÔ HÌNH HÓA HỆ THỐNG .Giới thiệu mô hình sử dụng trong đề tài .Mô hình hóa học hệ thống.Nhận dạng động cơ.
15 Chƣơng 3: THUẬT TOÁN ĐIỀU KHIỂN .Giới thiệu một số thuật toán đã áp dụng cho hệ bóng trên thanh .Thuật toán điều khiển PID .Thuật toán điều khiển mờ.Bộ điều khiển mờ PD .Thuật toán điều khiển trƣợt .Giới thiệu lý thuyết điều khiển trƣợt .Điều khiển trƣợt tĩnh cho hệ bóng trên thanh áp dụng trong đề tài.Điều khiển trƣợt động cho hệ bóng trên thanh áp dụng trong đề tài .Thuật toán PD kết hợp .Thuật toán mờ PD .Trƣợt tĩnh .Trƣợt mờ .Trƣợt động. 50 v Luan van Chƣơng 4: THIẾT KẾ VÀ ĐIỀU KHIỂN MÔ HÌNH THỰC TẾ .Thiết kế cơ khí .Mạch điều khiển .Mạch điều khiển .Mạch công suất .Cảm biến vị trí.Công cụ hỗ trợ lập trình điều khiển.Kết quả điều khiển .Điều khiển trƣợt tĩnh: .Điều khiển trƣợt mờ .Điều khiển trƣợt động. 78 Chƣơng 5: KẾT QUẢ VÀ ĐÁNH GIÁ .Kết quả đạt đƣợc .Hạn chế và khắc phục .Hƣớng phát triển. 91 vi Luan van DANH MỤC CÁC HÌNH Hình 1.1 Hệ bóng trên thanh trục lệch .2 Hệ bóng trên thanh trục giữa .3 Cân bằng bóng trên thanh đƣợc xây dựng bởi phòng thí nghiệm ngƣời máy Berkeley (Arroyo 2005).4Hệ thống bóng thanh tự cân bằng đƣợc xây dựng ở khoa điện trƣờng đại học Lakehead (của tác giả Ambalavanar, Moinuddin và Malyshev năm 2006) .5Hệ bóng thanh đƣợc đƣa ra thƣơng mại bởi Quanser 2006 .6Hệ bóng trên thanh của Hirsch 1999 .7Ngƣời máy cân bằng bóng thanh của Lieberman 2004 .8a Ứng dụng vào điều khiển máy bay nhào lộn trên không .8b Ứng dụng vào điều khiển góc tên lửa .1 Mô hình động học của hệ thống .2 Sơ đồ khối động cơ DC .3 Sơ đồ đọc tín hiệu đo lƣờng củađộng cơ DC .4 Sơ đồ kết nối đo tín thực tế .1 Đáp ứng dạng nấc của hệ hở .2 Đáp ứng dạng nấc của hệ kín khi K= Kgh .3 Cấu trúc bộ điều khiển PD kết hợp .4 Cấu tạo của của bộ điều khiển mờ .5 Hàm liên thuộc của biến ngõ vào .5 Hàm liên thuộc của biến ngõ vào .6 Chuẩn hóa khâu giải mờ.7 Cấu trúc bộ điều khiển mờ .8 Cấu trúc bộ điều khiển mờ PD kết hợp .9 Mặt trƣợt s với hiện tƣợng chattering.
32 vii Luan van Hình 3.12 cấu trúc của hệ thống điều khiển vòng kín.13 Mô hình hệ bóng trên thanh trên Matlab/Simulink .14 Cấu trúc bên trong của hệ bóng trên thanh .15 Cấu trúc điều khiển PD kết hợp theo (3.48) hệ bóng trên thanh.15 Bên trong cấu trúc điều khiển PD kết hợp .16 Kết quả mô phỏng điều khiển vị trí r_set = 0.17 Kết quả mô phỏng điều khiển góc của thanh r_set = 0.18 Kết quả mô phỏng điều khiển vị trí r_set = 0.19 Kết quả mô phỏng điều khiển góc của thanh r_set = 0.20 Cấu trúc của bộ điều khiển mờ PD .21 Bên trong bộ điều khiển mờ PD .22 Kết quả mô phỏng điều khiển vị trí với r_set = 0.23 Kết quả mô phỏng điều khiển góc với r_set = 0.25 Kết quả mô phỏng điều khiển vị trí với r_set = 0.25 Kết quả mô phỏng điều khiển góc với r_set = 0.26 Cấu trúc của bộ điều khiển trƣợt tĩnh.27 Cấu trúc của bộ điều khiển trƣợt mờ.28 Cấu trúc của bộ điều khiển trƣợt động .29 Kết quả mô phỏng điều khiển vị trí với r_set = 0.30 Kết quả mô phỏng điều khiển góc với r_set = 0.31 Điện áp điều khiển với r_set = 0.32 Mặt trƣợt với r_set = 0.33 Kết quả mô phỏng điều khiển vị trí với r_set = 0.34 Kết quả mô phỏng điều khiển góc với r_set = 0.35 Điện áp điều khiển với r_set = 0.36 Mặt trƣợt với r_set = 0.37 Kết quả mô phỏng điều khiển vị trí với r_set = 0.38 Kết quả mô phỏng điều khiển góc với r_set = 0.39 Điện áp điều khiển với r_set = 0. 56 viii Luan van Hình 3.40 Mặt trƣợt với r_set = 0.41 Kết quả mô phỏng điều khiển vị trí với r_set = 0.42 Kết quả mô phỏng điều khiển góc với r_set = 0.43 Điện áp điều khiển với r_set = 0.44 Mặt trƣợt với r_set = 0.45 Kết quả mô phỏng điều khiển vị trí với r_set = 0.46 Kết quả mô phỏng điều khiển góc với r_set = 0.47 Điện áp điều khiển với r_set = 0.48 Mặt trƣợt với r_set = 0.49 Kết quả mô phỏng điều khiển vị trí với r_set = 0.50 Kết quả mô phỏng điều khiển góc với r_set = 0.51 Điện áp điều khiển với r_set = 0.52 Mặt trƣợt với r_set = 0.1 Cấu tạo phần cứng hệ bóng trên thanh .2 Động cơ đƣợc sử dụng trong mô hình thực tế .3 Board DSP STM32F407VGT .4 Cấu tạo cơ bản của mạch cầu H .5 Mạch cầu H đƣợc sử dụng trong mô hình .6 Nguyên lí đó vị trí viên bi bằng dây điện trở .7 Nguyên lí đó vị trí viên bi bằng dây điện trở sau khi lắp thêm tụ.