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 CHÂU TÚ ỨNG DỤNG LOGIC MỜ VÀO ÐIỀU KHIỂN ROBOT TIẾP TÂN NGÀNH : KỸ THUẬT CƠ ÐIỆN TỬ- 60520114 S K C0 0 4 9 4 1 Tp. Hồ Chí Minh, tháng 10/2016 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 ---o0o--- LUẬN VĂN THẠC SĨ PHAN CHÂU TÖ ỨNG DỤNG LOGIC MỜ VÀO ĐIỀU KHIỂN ROBOT TIẾP TÂN NGÀNH : KỸ THUẬT CƠ ĐIỆN TỬ- 60520114 Tp. Hồ Chí Minh, tháng 10 năm 2016 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 ---o0o--- LUẬN VĂN THẠC SĨ PHAN CHÂU TÖ ỨNG DỤNG LOGIC MỜ VÀO ĐIỀU KHIỂN ROBOT TIẾP TÂN NGÀNH : KỸ THUẬT CƠ ĐIỆN TỬ- 60520114 Hƣớng dẫn khoa học : PGS.TS NGUYỄN TRƢỜNG THỊNH Tp. Hồ Chí Minh, tháng 10 năm 2016 Luan van CÔNG TRÌNH ĐƢỢC HOÀN THÀNH TẠI TRƢỜNG ĐẠI HỌC SƢ PHẠM KỸ THUẬT THÀNH PHỐ HỒ CHÍ MINH Cán bộ hƣớng dẫn khoa học :.
(Ghi rõ họ, tên, chức danh khoa học, học vị và chữ ký) Cán bộ chấm nhận xét 1:. (Ghi rõ họ, tên,, chức danh khoa học, học vị và chữ ký) Cán bộ chấm nhận xét 2:. (Ghi rõ họ, tên, chức danh khoa học, học vị và chữ ký) Luận văn thạc sĩ đƣợc bảo vệ trƣớc HỘI ĐỒNG CHẤM BẢO VỆ LUẬN VĂN THẠC SĨ TRƢỜNG ĐẠI HỌC SƢ PHẠM KỸ THUẬT TP HCM Ngày. Luan van LÝ LỊCH KHOA HỌC I.
LÝ LỊCH SƠ LƢỢC: Họ & tên: PHAN CHÂU TÖ Giới tính: NAM Ngày, tháng, năm sinh: 26/07/1990 Nơi sinh: TÂY NINH Quê quán: TÂY NINH Dân tộc: KINH Chỗ ở riêng hoặc địa chỉ liên lạc: 16A/1E KP ĐỒNG AN 2, P BÌNH HÕA, TX THUẬN AN, BÌNH DƢƠNG Điện thoại cơ quan: Điện thoại nhà riêng: Fax: E-mail: phanchautu@gmail. QUÁ TRÌNH ĐÀO TẠO: 1. Trung học chuyên nghiệp: Hệ đào tạo: Thời gian đào tạo từ ……/…… đến ……/ …… Nơi học (trƣờng, thành phố): Ngành học: 2. Đại học: Hệ đào tạo: CHÍNH QUY Thời gian đào tạo từ 08 /2008 đến 08 / 2012 Nơi học (trƣờng, thành phố): TRƢỜNG ĐH SƢ PHẠM KỸ THUẬT TP HCM Ngành học: CƠ ĐỆN TỬ Tên đồ án, luận án hoặc môn thi tốt nghiệp: “ THIẾT KẾ, CHẾ TẠO VÀ ĐIỀU KHIỂN ĐÀN CÁ DỰA TRÊN MÔ HÌNH SWARM”.
Ngày & nơi bảo vệ đồ án, luận án hoặc thi tốt nghiệp: 06/2012 – TRƢỜNG ĐH SƢ PHẠM KỸ THUẬT TP HCM Ngƣời hƣớng dẫn: TS.NGUYỄN TRƢỜNG THỊNH 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 09/2012- 3T Robotics Group Nhân viên thiết kế cơ khí 04/2013 04/2013- Logitem Việt Nam Nhân viên quản lý kho 04/2016 8/2016 - Nay Nhà máy tôn Hoa Sen Phú Mỹ Nhân viên Kỹ thuật Cơ 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 … tháng … năm 201… (Ký tên và ghi rõ họ tên) PHAN CHÂU TÖ Luan van LỜI CẢM TẠ Tôi xin gửi lời cảm ơn đến tất cả quý thầy cô giảng dạy tại Trƣờng Đại Học Sƣ Phạm Kỹ Thuật Thành Phố Hồ Chí Minh, đặc biệt là quý thầy cô khoa Cơ khí chế tạo máy đã hƣớng dẫn và truyền đạt những kiến thức quan trọng, đóng vai trò nền tảng cho đề tài của tôi.
Tôi xin gửi lời cảm ơn chân thành đến giáo viên hƣớng dẫn khoa học thầy PGS.TS Nguyễn Trường Thịnh đã góp ý, hƣớng dẫn phƣơng hƣớng nghiên cứu, cung cấp các kiến thức và vật tƣ quan trọng giúp tôi hoàn thành luận văn. Cảm ơn bạn bè,ngƣời thân, các anh chị em là thành viên của phòng thí nghiệm OpenLab đã hỗ trợ vật chất, đóng góp ý kiến giúp tôi hoàn thành luận văn này. Trân Trọng ! Ngƣời thực hiện PHAN CHÂU TÖ Luan van NHẬN XÉT CỦA CÁN BỘ HƢỚNG DẪN. Giáo viên hƣớng dẫn TS.
Nguyễn Trƣờng Thịnh Luan van NHẬN XÉT CỦA GIÁO VIÊN PHẢN BIỆN. Giáo viên phản biện Luan van TÓM TẮT Dựa trên các yêu cầu về chuyển động của robot dịch vụ trong môi trƣờng cụ thể, bài biết đã trình bày giải thuật điều khiển chuyển động, nguyên lý hoạt động của bộ điều khiển logic mờ và ứng dụng cụ thể của bộ điều khiển vào điều khiển chuyển động của Robot dịch vụ. Mô hình robot dịch vụ cũng đƣợc chế tạo và chạy thực nghiệm tại phòng thí nghiệm OpenLab – trƣờng đại học sƣ phạm kỹ thuật thành phố HCM. Bộ điều khiển đƣợc mô phỏng và tính toán bằng phần mềm Matlab trƣớc khi chạy thử nghiệm trên mô hình robot thực.
Các kết quả mô phỏng và thực nghiệm của bộ điều khiển đƣợc đánh giá và kết luận trong bài viết này. ABSTRACT Base on requirements of movement of service robot, this article present the algorithm of movement, the operating principles of fuzzy logic controller and its specifical applications to control the movement of the service robot. Model of service robot also was built at OpenLab laboratory – HCM of University technical and education. This controller is simulated and calculated by Matlab software before running on real robot model.
The simulation results and experiments of system are appreciated and concluded in this article. Luan van MỤC LỤC CHƢƠNG 1:TỔNG QUAN .2 TÌNH HÌNH NGHIÊN CỨU LIÊN QUAN ĐẾN ĐỀ TÀI .1 Nghiên cứu ngoài nƣớc .2 Nghiên cứu trong nƣớc .3 LÝ DO CHỌN ĐỀ TÀI .4 MỤC ĐÍCH NGHIÊN CỨU .5 ĐỐI TƢỢNG VÀ PHẠM VI NGHIÊN CỨU .2 Phạm vi nghiên cứu : .6 PHƢƠNG PHÁP NGHIÊN CỨU .7 NỘI DUNG ĐỀ TÀI. 7 CHƢƠNG 2:LÝ THUYẾT LOGIC MỜ VÀ BỘ ĐIỀU KHIỂN MỜ .1 LÝ THUYẾT LOGIC MỜ .2 Định nghĩa tập mờ .3 Các dạng hàm liên thuộc tiêu biểu .4 Các thông số đặc trƣng của tập mờ .5 Các phép toán trên tập mờ: .1 Biến ngôn ngữ .3 Các phép toán mệnh đề mờ .4 Phép toán kéo theo mờ – luật if - then mờ thông dụng .5 Luật modus-ponens tổng quát .3 BỘ ĐIỀU KHIỂN MỜ .1 Cấu trúc của một bộ điều khiển mờ .2 Phân loại bộ điều khiển mờ .3 Các bƣớc xây dựng bộ điều khiển mờ .4 Một số phƣơng pháp giải mờ thông dụng .28 CHƢƠNG 3:XÂY DỰNG BỘ ĐIỀU KHIỂN MỜ TRÊN ĐỐI TƢỢNG ĐIỀU KHIỂN VÀ GIẢI THUẬT TÌM ĐƢỜNG ĐI CHO ROBOT .1 TỔNG QUAN ĐỐI TƢỢNG ĐIỀU KHIỂN .1 Cơ cấu chấp hành .2 Phƣơng pháp điều hƣớng cho robot tự hành .3 Hệ thống thu thập dữ liệu .4 Phƣơng pháp định vị robot .5 Mô hình động học Mobile Robot .2 XÂY DỰNG BỘ ĐIỀU KHIỂN MỜ CHO ĐỐI TƢỢNG ĐIỀU KHIỂN .1 Di chuyển từ điểm đến điểm.2 Xây dựng luật mờ .3 Chọn thiết bị hơp thành và phƣơng pháp giải mờ.3 GIẢI THUẬT TÌM ĐƢỜNG ĐI CHO ROBOT DI CHUYỂN TRÊN MẶT PHẲNG CHO TRƢỚC .1 Yêu cầu chung .2 Giải thuật tìm đƣờng đi .54 CHƢƠNG 4:THỰC NGHIỆM VỚI MÔ HÌNH ROBOT DỊCH VỤ.1 MÔ PHỎNG BỘ ĐIỀU KHIỂN MỜ CHO GIẢI THUẬT DI CHUYỂN TỪ ĐIỂM TỚI ĐIỂM .2 MÔ PHỎNG BỘ ĐIỀU KHIỂN MỜ CHO ROBOT DI CHUYỂN THEO ĐƢỜNG HOẠCH ĐỊNH. 61 CHƢƠNG 5:KẾT LUẬN .1 KẾT QUẢ ĐẠT ĐƢỢC .2 HẠN CHẾ CỦA ĐỀ TÀI .3 HƢỚNG PHÁT TRIỂN.65 TÀI LIỆU THAM KHẢO .66 Luan van DANH MỤC HÌNH VẼ Hình 2.1: Hàm phụ thuộc A ( x ) của tập kinh điển A .2: Hàm liên thuộc đơn điệu biến E .3: Hàm liên thuộc hình tam giác .4: Độ cao, miền xác định, miền tin cậy của tập mờ .5: Giao của hai tập mờ .6: Giao của hai tập mờ .7: Bù của một tập mờ .8: Hàm liên thuộc biến nhiệt độ .9: Cấu trúc của bộ điều khiển mờ .10: Bộ suy diễn mờ đầu ra 1 biến đầu vào .11 Bộ suy diễn mờ đầu ra 2 biến đầu vào .12 Phƣơng pháp giải mờ cực đại .13: Phƣơng pháp điểm trọng tâm .1 Bản thiết kế 3D phần đế robot .2: Cấu hình phần đế robot và cảm biến vật cản.3 Hệ thống điều khiển tự động tốc độ động cơ sử dụng thuật toán PID .5: Góc bố trí các cảm biến và vùng nhìn thấy vật cản .6: Đối tƣợng điều khiển .7: Động học Robot .8 Phân tích thành phần chuyển động của robot trên mặt phẳng .9 Sơ đồ các bƣớc tính tọa độ robot .10: Giải thuật điều khiển từ điểm đến điểm.11: Cấu trúc ngõ vào ra của bộ điều khiển mờ .12: Giả lập quỹ đạo cho robot di chuyển từ điểm đến điểm .13: Tính biến ngõ vào cho bộ điều khiển mờ .14: Biến vào ra của bộ điều khiển mờ .14: Hàm liên thuộc biến ngôn ngữ vào “Distance” .15: Hàm liên thuộc biến vào“ThetaStart” .16: Hàm liên thuộc biến vào “ThetaGoal” .17: Hàm liên thuộc biến LinearVelocity .18: Hàm liên thuộc biến AngularVelocity .19: Luật hợp thành và nguyên lý giải mờ.51 Luan van Hình 3.20: Bề mặt điều khiển V(t) với 2 ngõ vào (Distance, ThetaStart) .21: Bề mặt điều khiển V(t) với 2 ngõ vào (ThetaStart, ThetaGoal) .22: Bề mặt điều khiển (t) với 2 ngõ vào (ThetaStart, Distance) .22: Bề mặt điều khiển (t) với 2 ngõ vào (ThetaStart, ThetaGoal) .23: Không gian hoạt động của robot di dộng .24: Tạo node đều trên không gian robot có thề đến .25: Các đƣờng thẳng nối các node lại với nhau .26: Kết quả của giải thuật tìm đƣờng đi ngắn nhất .1: Bản đồ không gian chạy thực nghiệm của robot .2 Đƣờng đi hoạch định .3 a) So sánh đƣờng đi mô phỏng và đƣờng hoạch định.b) Kết quả mô phỏng di chuyển của robot trong bản đồ.62 Luan van DANH SÁCH BẢNG BIỂU Bảng 2.1 Các phép toán trên tập mờ……………………………………….1 Thông số của đối tƣợng điều khiển……………………………….2 Lập ma trận luật ………………………………………………….1 Kết quả mô phỏng bộ điều khiển mờ cho giải thuật di chuyển từ điểm đến điểm…………………………………………………………………….
59 Luan van CHƢƠNG 1: TỔNG QUAN 1.1 GIỚI THIỆU Hơn nữa thế kỷ qua, robot là lĩnh vực có những bƣớc phát triển và tiến hóa mạnh mẽ đáp ứng nhu cầu của xã hội loài ngƣời. Các hƣớng nghiên cứu robot đang chuyển từ robot công nghiệp sang phát triển các robot dịch vụ. Robot dịch vụ đang là tâm điểm nghiên cứu vì nó đa dụng và đƣa robot vào hòa nhập vào nhu cầu xã hội của loài ngƣời. Ngày nay ngoài ứng dụng sơ khai ban đầu của robot trong chế tạo máy thì các ứng dụng khác nhƣ trong y tế, chăm sóc sức khỏe, nông nghiệp, đóng tàu, xây dựng, an ninh quốc phòng và gia đình đang có nhu cầu gia tăng là động lực cho các robot địa hình và các robot dịch vụ phát triển.