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Ĩ PHẠM LÊ LONG TRIỀU TỔNG QUAN VỀ OMNI DIRECTION ROBOT NGÀNH: KỸ THUẬT ĐIỆN SKC007430 Tp. Hồ Chí Minh, tháng 10/2017 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Ỹ PHẠM LÊ LONG TRIỀU TỔNG QUAN VỀ OMNI DIRECTION ROBOT NGÀNH: KỸ THUẬT ĐIỆN – 60520202 Tp. Hồ Chí Minh, tháng 10/2017 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Ỹ PHẠM LÊ LONG TRIỀU TỔNG QUAN VỀ OMNI DIRECTION ROBOT NGÀNH: KỸ THUẬT ĐIỆN – 60520202 Hƣớng dẫn khoa học: PGS.TS NGUYỄN THANH PHƢƠNG Tp. Hồ Chí Minh, tháng 10/2017 Luan van Luan van Luan van LÝ LỊCH KHOA HỌC I.
LÝ LỊCH SƠ LƢỢC: Họ & tên: PHẠM LÊ LONG TRIỀU Giới tính: Nam Ngày, tháng, năm sinh: 10-03-1991 Nơi sinh: Đồng Nai Quê quán: Quảng Nam Dân tộc: Kinh Chỗ ở riêng hoặc địa chỉ liên lạc: Tổ 25b,Ấp trần cao vân,Xã Bàu Hàm 2,Thống Nhất,Đồng Nai. Điện thoại cơ quan: Điện thoại riêng: 0968228908 Fax: E-mail: longtrieu719@gmail. QUÁ TRÌNH ĐÀO TẠO: 1. Đại học: Hệ đào tạo: Đại học chính quy Thời gian đào tạo từ 09/2009 đến 10/ 2014 Nơi học (trƣờng, thành phố): Đại học Sƣ Phạm Kỹ Thuật, Tp.
Hồ Chí Minh. Ngành học: Sƣ Phạm Kỹ Thuật Điện công nghiệp. Tên đồ án, luận án hoặc môn thi tốt nghiệp:ỨNG DỤNG MẠNG WAVELET TRONG DỰ BÁO NGẮN HẠN PHỤ TẢI ĐIỆN KHU VỰC TP. Ngày & nơi bảo vệ đồ án, luận án hoặc thi tốt nghiệp: 20/04/2014, Đại học sƣ phạm kỹ thuật Tp.
Hồ Chí Minh Ngƣời hƣớng dẫn: TS.Lê Chí Kiê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 Từ 11/2014 đến Trung Tâm Phát Triển Qũy Đất Huyện Nhân Viên 6/2017 Thống Nhất, Tỉnh Đồng Nai Từ 7/2017 đến Công ty Cổ Phẩn Sản Xuất Kinh Doanh Kỹ sƣ Điện nay Thiết Bị Điện TTC 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. Hồ Chí Minh, ngày……tháng……năm 2017 (Ký tên và ghi rõ họ tên) Phạm Lê Long Triều ii Luan van LỜI CẢM ƠN Trong thời gian học tập và nghiên cứu tại trƣờng, nay Tôi đã hoàn thành đề tài tốt nghiệp cao học của mình.
Có đƣợc thành quả này, Tôi đã nhận đƣợc rất nhiều sự hỗ trợ và giúp đỡ tận tình của thầy cô, gia đình, cơ quan và bạn bè trong thời gian học tập vừa qua. Tôi xin bày tỏ lòng biết ơn chân thành đến Thầy PGS. Nguyễn Thanh Phƣơng, Trƣờng Đại học Kỹ Thuật Công Nghệ TP.HCM, ngƣời đã tận tình hƣớng dẫn, giúp đỡ, truyền đạt kinh nghiệm để Tôi hoàn thành luận văn này. Xin chân thành cảm ơn đến tất cả quí Thầy Cô trƣờng Đại Học Sƣ Phạm Kỹ Thuật Tp.
Hồ Chí Minh đã trang bị cho tôi một lƣợng kiến thức rất bổ ích, đặc biệt xin chân thành cảm ơn quí Thầy Cô Khoa Điện – Điện Tử đã tạo điều kiện thuận lợi và hỗ trợ cho Tôi trong quá trình học tập cũng nhƣ trong thời gian làm luận văn tốt nghiệp này. Tôi xin gởi lời cảm ơn chân thành nhất đến đồng nghiệp, gia đình, bạn bè đã giúp đỡ cho tôi rất nhiều để vƣợt qua khó khăn, đã tạo cho Tôi niềm tin và nỗ lực phấn đấu để hoàn thành luận văn này. Xin chân thành cảm ơn ! Tp. Hồ Chí Minh, tháng 10/2017 Học viên thực hiện Phạm Lê Long Triều iii Luan van TÓM TẮT Đề tài ― TỔNG QUAN VỀ OMNIDIRECTION ROBOT ‖ đƣợc tiến hành trong khoảng thời gian 1,5 năm tại trƣờng Đại Học Sƣ Phạm Kỹ Thuật TP.
Sau thời gian nghiên cứu đề tài đƣợc triền khai và tập trung giải quyết các vấn đề sau: Tìm hiểu về mô hình toán học của robot di động đa hƣớng 3 bánh (OMR) Tìm hiểu phƣơng pháp điều khiển trƣợt tích phân (Integal Sliding Mode Control – ISMC) cho robot di động đa hƣớng 3 bánh Mô phỏng robot bám theo quỹ đạo tham chiếu bộ điều khiển sử dụng Matlab Simulink cho robot di động đa hƣớng 3 bánh (OMR). Xây dựng mô hình thực nghiệm Nhận xét kết quả đạt đƣợc và hạn chế của mô hình iv Luan van ABSTRACT Thesis ―OVERVIEW OF OMNIDIRECTIONAL ROBOT ‖ has been done for one and a half years at HO CHI MINH University of Technology And Education. The thesis‘s content focused on: Learn about mathematical model of the three-wheel mobile omni- directional robot (OMR) Learn about Integal Sliding Mode Control for the three-wheel mobile omni-directional robot (OMR) Simulation of the reference robot trajectory using Matlab Simulink for OMR. Construct model experiment Comment on the results and limitations of the model v Luan van MỤC LỤC LÝ LỊCH KHOA HỌC.
i LỜI CAM ĐOAN .ii LỜI CẢM ƠN. vi DANH SÁCH KÝ HIỆU SỬ DỤNG TRONG LUẬN VĂN. viii DANH SÁCH CÁC BẢNG. ix DANH SÁCH CÁC HÌNH.
x Chƣơng 1: TỔNG QUAN .1 Tổng Quan Về RoBot .2 Sơ Lƣợc Qúa Trình Phát Triển .3 Những Ứng Dụng Điển Hình Của Robot .4 Tóm Tắt Các Công Trình Nghiên Cứu Liên Quan .5 Nhận xét chung và hƣớng tiếp cận .6 Mục tiêu của luận văn .7 Nhiệm vụ của luận văn .8 Giới hạn của luận văn .9 Bố cục của đề tài. 13 Chƣơng 2: CƠ SỞ LÝ THUYẾT .1 Giới thiệu phƣơng pháp Lyapunov .2 Định lý ổn định thứ 2 của Lyapunov .3 Lý thuyết điều khiển trƣợt .1 Giới thiệu chung .2 Thiết kế bộ điều khiển trƣợt. 18 Chƣơng 3: MÔ HÌNH TOÁN HỌC CỦA ROBOT DI ĐỘNG ĐA HƢỚNG. Cấu trúc hình học và các giả thiết.
Cấu trúc hình học của robot di động đa hƣớng. 20 vi Luan van 3. Các giả thiết cho mô hình nghiên cứu. Mô hình toán học của robot di động đa hƣớng.
Mô hình động học. Mô hình động lực học. 23 Chƣơng 4 : ĐIỀU KHIỂN CHUYỂN ĐỘNG CỦA OMR SỬ DỤNG PHƢƠNG PHÁP ĐIỀU KHIỂN TRƢỢT. Bộ điều khiển trƣợt tích phân (ISMC) thiết kế cho OMR.
31 Chƣơng 5: MÔ PHỎNG. Kết quả mô phỏng. Kết quả mô phỏng với bộ điều khiển có bộ thông số thứ nhất. Kết quả mô phỏng với bộ điều khiển có bộ thông số thứ hai.
48 Chƣơng 6: MÔ HÌNH THỰC NGHIỆM .1 Các thiết bị để thực hiện mô hình.2 Ý tƣờng thiết kế .2 Mô phỏng Robot Omni trên bảng điều khiển. 53 Chƣơng 7: KẾT LUẬN VÀ HƢỚNG PHÁT TRIỂN .2 Hƣớng phát triển của đề tài. 56 TÀI LIỆU THAM KHẢO. 61 * Phần lập trình điều khiển cho robot Omni.
61 vii Luan van DANH SÁCH KÝ HIỆU SỬ DỤNG TRONG LUẬN VĂN Ký hiệu Diển giải OMR Robot di động đa hƣớng ( Omnidirectional mobile robot) ISMC Điều khiển trƣợt tích phân ( Integal sliding mode control) OMS-SOW Robot di động đa hƣớng có bánh xe đa hƣớng ( Omnidirectional mobile robot – steerable omnidirectional wheels) 4WD Bốn bánh xe có lái ( Four wheel drive) OOMR Robot di động đa hƣớng vận hành ngoài long đƣờng ( Offroad omnidirectional mobile robot) DOF Bậc tự do ( Degree of freedom) KC Điều khiển động học ( Kinetic control) SMC Điều khiển kiểu trƣợt (Sliding mode control) viii Luan van DANH SÁCH CÁC BẢNG Bảng 5. 1: Giá trị các thông số của OMR. 2: Giá trị ban đầu cho mô phỏng. 1: Các thiết bị thực hiện mô hình thực nghiệm .49 ix Luan van DANH SÁCH CÁC HÌNH Hình 1.
1: Robot hàn điểm trong nhà máy sản xuất xe hơi. 2: Hệ thống robot hàn đƣờng của hãng FANUC. 3: Robot lắp ráp mạch in có hệ thống camera quan sát đƣợc dùng để xác định vị trí chân trên bản mạch in. 4: Tay Robot đƣợc sử dụng trong máy ép nhựa để lấy thành phẩm.
5: Mô tả hình học cho OMR-SOW. 6: Kết quả thực nghiệm bám theo đƣờng tròn. 7: Cơ cấu truyền động. 8: Mô hình robot thực nghiệm.
9: Chuyển động robot từ trên xuống. 10: Robot di động đa hƣớng trên con lăn bánh xích (OOMR). 11: Robot di động đa hƣớng 4 bánh (OMR). 12: Bánh xe vô hƣớng.
13: Phân tích lực tác động lên robot. 1: Minh họa hàm Lyapunov. 2: Hệ thống có điều khiển trƣợt. 3: Hình chiếu quỹ đạo pha.
1: Cấu trúc hình học của OMR. 1: Định nghĩa véc tơ sai số bám. 2: Sơ đồ khối cho bộ ISMC. 1: Quỹ đạo mong muốn.
2: Véc tơ điều khiển mô men ngõ vào (I). 3: Véc tơ sai số bám ep tại thời điểm ban đầu (I). 4: Véc tơ sai số bám ep trong toàn bộ thời gian (I). 5: Véc tơ mặt trƣợt Sv (I).
6: Véc tơ sai số vận tốc bám ev ở thời điểm ban đầu (I). 7: Véc tơ sai số vận tốc ev bám ở toàn bộ thời gian (I). 8: Vận tốc góc 1, 2, 3 của 3 bánh xe (I).37 x Luan van Hình 5. 9: Vận tốc tuyến tính vC của OMR (I).
10: Vận tốc góc C của OMR (I). 11: Chuyển động của OMR ở thời điểm ban đầu (I). 12: Chuyển động của OMR ở toàn bộ thời gian (I). 13: Quỹ đạo là đƣờng elip có r1 = 0,3 m; r2 = 0,8 m (I).
14: Quỹ đạo là đƣờng cong có dạng chữ Ω (I). 15: Véc tơ điều khiển mô men ngõ vào (II). 16: Véc tơ sai số bám ep tại thời điểm ban đầu (II). 17: Véc tơ sai số bám ep trong toàn bộ thời gian (II).
18: Véc tơ mặt trƣợt Sv (II). 19: Véc tơ sai số vận tốc bám ev ở thời điểm ban đầu (II). 20: Véc tơ sai số vận tốc ev bám ở toàn bộ thời gian (II). 21: Vận tốc góc 1, 2, 3 của 3 bánh xe (II).
22: Vận tốc tuyến tính vC của OMR (II). 23: Vận tốc góc C của OMR (II). 24: Chuyển động của OMR ở thời điểm bắt đầu (II). 25: Chuyển động của OMR ở toàn bộ thời gian (II).
26: Quỹ đạo là đƣờng elip với r1 = 0,3 m; r2 = 0,8 m (II). 27: Quỹ đạo là đƣờng cong có dạng chữ Ω (II). 1: Minh họa mô hình robot thi công. 4: Robot omni chạy theo quỹ đạo hình chữ nhật.
5: Robot omni chạy theo quỹ đạo hình vuông. 6: Robot omni chạy theo quỹ đạo hình tròn .55 xi Luan van Chƣơng 1: TỔNG QUAN 1 .