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Ĩ TRƯƠNG THIỆN QUÂN ĐIỀU KHIỂN HỆ TAY MÁY VÀ ROBOT DI ĐỘNG BÁM THEO QUỸ ĐẠO NGÀNH: KỸ THUẬT ĐIỆN TỬ - 605270 S K C0 0 4 3 3 8 Tp. Hồ Chí Minh, tháng 08/2014 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Ĩ TRƯƠNG THIỆN QUÂN ĐIỀU KHIỂN HỆ TAY MÁY VÀ ROBOT DI ĐỘNG BÁM THEO QUỸ ĐẠO NGÀNH: KỸ THUẬT ĐIỆN TỬ - 60 52 70 Tp Hồ Chí Minh, tháng 8 năm 2014 BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƢỜNG ĐẠI HỌC SƢ PHẠM KỸ THUẬT TP. HCM --------------------------- LUẬN VĂN THẠC SĨ TRƢƠNG THIỆN QUÂN ĐIỀU KHIỂN HỆ TAY MÁY VÀ ROBOT DI ĐỘNG BÁM THEO QUỸ ĐẠO NGÀNH: KỸ THUẬT ĐIỆN TỬ - 60 52 70 Hƣớng dẫn khoa học: TS. NGUYỄN THANH PHƢƠNG Tp Hồ Chí Minh, tháng 8 năm 2014 LÝ LỊCH KHOA HỌC I.
LÝ LỊCH SƠ LƢỢC: Họ & tên: TRƢƠNG THIỆN QUÂN Giới tính: Nam Ngày, tháng, năm sinh: 02 / 10 / 1979 Nơi sinh: TT- Huế Quê quán: Phong Sơn, Phong Điền, TT-Huế Dân tộc: Kinh Chỗ ở riêng hoặc địa chỉ liên lạc: Hải Tân, Long Hải, Long Điền, TT-Huế Điện thoại cơ quan: Điện thoại nhà riêng: 0972060601 Fax: E-mail: truongthienquan@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ừ 1999 đến 4 /2004 Nơi học (trƣờng, thành phố): Trƣờng ĐHSPKT Tp HCM Ngành học: Kỹ thuật Điện – Điện tử Tên đồ án, luận án hoặc môn thi tốt nghiệp: Ngày & nơi bảo vệ đồ án, luận án hoặc thi tốt nghiệp: Trƣờng Đại học SPKT Tp HCM Ngƣời hƣớng dẫ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 2004 - 2005 Cty TNHH Minh Long Quản đốc 2005 - nay Trƣờng Cao Đẳng Công Đồng BRVT Giảng viên 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) Trƣơng Thiện Quân CẢM TẠ Em xin bày tỏ lời cảm ơn chân thành và sâu sắc nhất tới tiến sĩ Nguyễn Thanh Phương - người thầy đã tận tâm, nhiệt tình chỉ bảo, hướng dẫn em trong suốt quá trình thực hiện luận văn thạc sĩ này! Em xin chân thành cảm ơn Ban Giám hiệu, Phòng Sau đại học, các thầy cô khoa Điện – Điện tử trường ĐHSPKT Tp HCM đã quan tâm và tạo điều kiện thuận lợi cho em hoàn thành khóa học! Xin gửi lời tri ân đến gia đình, bạn bè và đồng nghiệp đã luôn động viên, khích lệ, giúp đỡ tôi trong quá trình học tập và nghiên cứu! Tp HCM ngày 10 tháng 8 năm 2014 Tác giả Trương Thiện Quân TÓM TẮT Trong những năm qua, nhiều nghiên cứu đã đƣợc thực hiện cho robot di động đi kèm cánh tay máy (tiêu biểu là robot hàn) sử dụng nhiều bộ điều khiển khác nhau [1-3]. Trong tài liệu tham khảo [1], bộ điều khiển phi tuyến đơn giản đƣợc dùng để dò bám theo đƣờng hàn cho trƣớc, nhƣng chỉ căn cứ vào mô hình động học mà bỏ qua phần động lực học của hệ thống cơ khí và các nhiễu từ bên ngoài.
Chung [2] đề xuất bộ điều khiển trƣợt mà kết hợp phần động học và động lực học cùng với các ràng buộc của nhiễu từ bên ngoài, nhằm giải quyết vấn đề dò theo quỹ đạo thực hiện đƣợc của robot di động. Ngo [3] cũng đề xuất bộ điều khiển trƣợt thích nghi cho cùng loại robot hàn trên, trong các bộ điều khiển trên, robot di động đƣợc khảo sát dựa vào mô hình động học với các thông số cho trƣớc của nhiễu từ bên ngoài. Tuy nhiên vận tốc tuyến tính của các điểm hàn không đƣợc giữ cố định nhƣ thiết kế ban đầu. Để giải quyết vấn đề, luận này thiết kế một bộ điều khiển trƣợt, tích hợp mô hình động học và mô hình động lực học với các ràng buộc của nhiễu từ bên ngoài cho robot hàn để dò theo đƣờng hàn cho trƣớc.
Tính ổn định của hệ thống đƣợc chứng minh dựa vào lý thuyết ổn định Lyapunov. Kết quả mô phỏng và kết quả thực nghiệm đƣợc trình bày nhằm minh họa tính hiệu quả của bộ điều khiển trƣợt tích phân cho đối tƣợng robot di động mà trong đó robot hàn mang tính tiêu biểu. Nội dung chính của luận văn gồm có: Nghiên cứu tổng quan về robot hàn di động hai bánh xe. Xây dựng mô hình toán cho robot di động có cánh tay máy (robot hàn).
Mô hình hình học của robot mô hình động học, mô hình động lực học của robot. Thiết kế bộ điều khiển phi tuyến cho robot di động. Thiết kế robot hàn di động có cánh tay. Kết luận và hƣớng phát triển của đề tài.
i MỤC LỤC TÓM TẮT. ii DANH MỤC CÁC TỪ VIẾT TẮT .v DANH MỤC CÁC BẢNG. vii DANH MỤC CÁC HÌNH ẢNH. viii CHƢƠNG 1 GIỚI THIỆU LUẬN VĂN.
Tổng quan về robot. Kỹ thuật điều hƣớng cho robot di động bằng bánh xe. Tóm tắt một số công trình đã nghiên cứu. Nhận xét chung và hƣớng tiếp cận.
Mục tiêu của luận văn. Nhiệm vụ của luận văn. Giới hạn của luận văn. Điểm mới của luận văn.
Nội dung của luận văn.23 CHƢƠNG 2 CƠ SỞ LÝ THUYẾT. Tiêu chuẩn ổn định Lyapunov. Điều khiển trƣợt.1 Xuất phát điểm của phƣơng pháp điều khiển trƣợt. Nguyên lý điều khiển trƣợt.
Các bƣớc xây dựng bộ điều khiển trƣợt .29 CHƢƠNG 3 XÂY DỰNG MÔ HÌNH TOÁN CHO ROBOT DI ĐỘNG CÓ CÁNH TAY MÁY. Mô hình hình học của robot di động có cánh tay máy hai bánh xe:. Mô hình động học của robot hàn có cánh tay máy di động hai bánh xe …………………………………………………………………………….Mô hình động lực học của robot hàn di động hai bánh xe. Mô hình học của robot hàn có cánh tay máy nhiều bậc có hai bánh xe:………………………………………………………………….Mô hình động học tay máy .Mô hình hệ thống robot và tay máy di động .37 CHƢƠNG 4 THIẾT KẾ BỘ ĐIỀU KHIỂN TRƢỢT.
Thiết kế bộ điều khiển trƣợt. Kết quả mô phỏng. Lƣu đồ giải thuật điều khiển. Các kết quả mô phỏng.
Giải thuật trƣợt cho cánh tay đa bậc. Kết quả mô phỏng .50 CHƢƠNG 5 KẾT LUẬN VÀ HƢỚNG PHÁT TRIỂN. Những kết quả đạt đƣợc. Hạn chế của đề tài.
Hƣớng phát triển của đề tài .52 TÀI LIỆU THAM KHẢO .Chứng minh mô hình động học ,động lực học robot và bộ điều khiển trƣợt của robot. Mô hình động học. Thiết kế bộ điều khiển trƣợt tích phân. Điều khiển 1 bậc.
Điều khiển đa bậc .63 iv DANH MỤC CÁC TỪ VIẾT TẮT Ký hiệu Đơn vị Ý nghĩa ( x, y ) m Tọa độ tâm rô bốt ∅ Rad Góc của rô bốt v m/s Vận tốc dài của tâm rô bốt rad/s Vận tốc góc của tâm rô bốt rw , lw rad/s Vận tốc góc của bánh xe phải và trái ( xw , y w ) m Tọa độ điểm hàn w Rad Góc tại điểm hàn vw m/s Vận tốc dài tại điểm hàn w rad/s Vận tốc góc tại điểm hàn xr , y r m Tọa độ điểm tham chiếu v r m/s Vận tốc mong muốn r rad/s Vận tốc góc điểm tham chiếu b m Khoảng cách giữa bánh xe và trục đối xứng r m Bán kính bánh xe l m Chiều dài cơ cấu giữ mỏ hàn mc Kg Khối lƣợng của phần thân Kg Khối lƣợng của bánh lái mw I kgm2 Mô men quán tính của mỗi bánh lái quanh w trục bánh xe I kgm2 Mô men quán tính của mỗi bánh lái quanh m trục đƣờng kính bánh xe I kgm2 Mô men quán tính phần thân quanh trục c đứng qua phần giao nhau của trục đối xứng với trục bánh lái rw , lw kgm2 Mô men xoắn của động cơ tác dụng lên bánh xe phải và trái KC Kinematic controller ISMC Integral sliding mode controller v WMR Welding mobile robot WMR : Robot di động bằng bánh xe (Wheeled Mobile Robot) vi DANH MỤC CÁC BẢNG Bảng 1. 1:Ký hiệu các loại bánh xe. 1:Các giá trị của các thông số khi mô phỏng. 2:Các giá trị ban đầu.
43 vii DANH MỤC CÁC HÌNH ẢNH Hình 1. 1:Máy hàn hồ quang điện. 3: Máy hàn hồ quang điện ARC400. 4: Máy hàn hồ quang điện HERO DC – 315.
5 : Máy hàn công nghệ Inverter. 6:Máy Hàn Bán Tự Động MAG - VMAG350/500. 7 : Robot hàn OTC DAIHEN. 8: Robot hàn ARC Mate1000B/2000B của hang Fanuc.
9: Máy hàn của hãng Panasonic. 10 : Rùa hàn tự động bám dầm Hit-8SS. 11 : Hàn hồ quang chìm tự động. 13 : Servo-Robot’s MWR-350.
14 : Hình ảnh các loại bánh xe. 15 : Cấu hình một bánh lái phía trƣớc, một bánh truyền động phía sau. 16 :Cấu hình hai bánh truyền động với trọng tâm ở bên dƣới trục bánh xe. 17:Cấu hình hai bánh chuyển động vi sai và thêm hai điểm tiếp xúc.
18:Cấu hình hai bánh truyền động độc lập ở phía sau và một bánh lái ở phía trƣớc. 19:Cấu hình hai bánh quay tự do ở phía sau, bánh trƣớc vừa là bánh truyền động vừa là bánh lái. 20:Cấu hình ba bánh đa hƣớng. 21:Cấu hình bốn bánh đa hƣớng.
22:Chuyển động cơ bản của WMR. 23:Cấu trúc của robot di chuyển bằng bánh. 24:Mô hình Robot hàn MR-SL. 25:Các sai số bám e1, e2, e3 có sai lệch.
26: Vận tốc của mỏ hàn và WMR. 27:Robot super MARIO. 28:Các sai số bám ex và ey của robot super MARIO. 29:Các sai số khi robot MICRO bám đƣờng thẳng.
30:Các sai lệch bám e1,e2,e3 của robot hàn. 31:Vận tốc góc của robot của robot hàn. 32:Robot bám theo đƣờng thẳng. 33:Robot bám theo đƣờng cong.
1:Minh họa hàm Lyapunov. 2:Sơ đồ khối một hệ điều khiển. 3:Đồ thị quỹ đạo pha. 4:Giải thích hiện tƣợng trƣợt.
5:Giải thích nguyên lý trƣợt. 1:Cấu trúc hình học của robot hàn. 1:Tay máy ba liên kết. 1:Lƣu đồ giải thuật điều khiển.
2:Quỹ đạo (đƣờng hàn) mong muốn cho WMR. 3:Chuyển động bám đƣờng hàn mong muốn của WMR. 4:Sai lệch vị trí e1, e2, e3. 5:Vận tốc góc của bánh phải và bánh trái.
6: Mặt trƣợt S1. 7:Mặt trƣợt S2. 8: Momen bánh trái và phải. 9: Cấu hình ban đầu của tay máy .46 ix CHƢƠNG 1 GIỚI THIỆU LUẬN VĂN 1.