CÔNG TRÌNH ĐƯỢC HOÀN THÀNH TẠI TRƢỜNG ĐẠI HỌC CÔNG NGHỆ TP. HCM Cán bộ hướng dẫn khoa học : TS. NGUYỄN HÙNG Luận văn Thạc sĩ được bảo vệ tại Trường Đại học Công nghệ TP. HCM ngày 25 tháng 01 năm 2014.
Thành phần Hội đồng đánh giá Luận văn Thạc sĩ gồm: TT Họ và tên Chức danh Hội đồng 1 PGS. Trần Thu Hà Chủ tịch 2 TS. Nguyễn Thanh Phuơng Phản biện 1 3 TS. Nguyễn Duy Anh Phản biện 2 4 TS.
Võ Tường Quân Ủy viên 5 TS. Nguyễn Viễn Quốc Ủy viên, Thư ký Xác nhận của Chủ tịch Hội đồng đánh giá Luận sau khi Luận văn đã được sửa chữa (nếu có). Chủ tịch Hội đồng đánh giá LV TRƯỜNG ĐH CÔNG NGHỆ TP. HCM CỘNG HÒA XÃ HỘI CHỦ NGHĨA VIỆT NAM PHÒNG QLKH – ĐTSĐH Độc lập – Tự do – Hạnh phúc TP.
HCM, ngày 05 tháng 05. năm 2013 NHIỆM VỤ LUẬN VĂN THẠC SĨ Họ tên học viên: THÂN VĂN THẾ Giới tính: Nam Ngày, tháng, năm sinh: 20/10/1965. Nơi sinh: Bắc Giang Chuyên ngành: Cơ điện tử MSHV: 1241840016 I- Tên đề tài: THIẾT KẾ BỘ ĐIỀU KHIỂN PHI TUYẾN CHO ROBOT HÀN DI ĐỘNG II- Nhiệm vụ và nội dung: - 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 hàn.
Mô hình hình học của robot hàn, mô hình động học, mô hình động lực học của robot hàn. - Thiết kế bộ điều khiển phi tuyến cho robot hàn. - Thiết kế, chế tạo robot hàn. - Chạy thực nghiệm robot hàn.
III- Ngày giao nhiệm vụ: Tháng 5 năm 2013 IV- Ngày hoàn thành nhiệm vụ: 30 tháng 12 năm 2013 V- Cán bộ hƣớng dẫn: TS. NGUYỄN HÙNG CÁN BỘ HƢỚNG DẪN KHOA QUẢN LÝ CHUYÊN NGÀNH NGUYỄN HÙNG i LỜI CAM ĐOAN Tôi xin cam đoan rằng luận văn với nội dung “THIẾT KẾ BỘ ĐIỀU KHIỂN PHI TUYẾN CHO ROBOT HÀN DI ĐỘNG” là công trình nghiên cứu của riêng tôi, dưới sự hướng dẫn của TS. Các số liệu, kết quả mô phỏng và thực nghiệm nêu trong luận văn là trung thực, có nguồn trích dẫn và chưa được công bố trong các công trình nghiên cứu khác. Tôi xin cam đoan rằng mọi sự giúp đỡ cho việc thực hiện luận văn này đã được cảm ơn và các thông tin trích dẫn trong luận văn đã được chỉ rõ nguồn gốc.
Học viên thực hiện luận văn Thân Văn Thế ii LỜI CÁM ƠN Trong quá trình thực hiện luận văn, tôi đã nhận được sự giúp đỡ rất nhiều từ thầy cô và các bạn. Trước tiên, tôi xin gửi lời cảm ơn sâu sắc, chân thành tới thầy giáo, TS Nguyễn Hùng – Phó Trưởng Khoa Cơ – Điện – Điện Tử Trường Đại Học Công Nghệ Tp.HCM đã tận tình hướng dẫn và giúp đỡ tôi trong suốt quá trình nghiên cứu và thực hiện luận văn. Tôi cũng xin chân thành gửi lời cảm ơn đến Ban Giám Hiệu Trường Đại học Kỹ thuật Công Nghệ Thành Phố Hồ Chí Minh, cùng quý thầy, cô đã tận tình truyền đạt kiến thức và tạo mọi điều kiện tốt nhất cho lớp chúng tôi trong suốt học trình cao học. Cuối cùng, tôi xin cảm ơn các bạn đã luôn động viên, giúp đỡ tôi hoàn thành luận văn này.
Tôi xin chân thành cảm ơn ! Học viên thực hiện luận văn Thân Văn Thế iii TÓM TẮT Trong những năm qua, nhiều nghiên cứu đã được thực hiện cho 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 đường hàn của robot hàn. 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 hàn đượ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 phân, 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.
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 hàn. Mô hình hình học của robot hàn mô hình động học, mô hình động lực học của robot hàn. - Thiết kế bộ điều khiển phi tuyến cho robot hàn.
- Thiết kế, chế tạo robot hàn. - Chạy thực nghiệm robot hàn. - Kết luận và hướng phát triển của đề tài. iv ABSTRACT In the past years, there are many researches have been done for the welding mobile robot (WMR) using many kind of controller [1-3].
In [1], the simple nonlinear controller of WMR was applied for tracking reference welding path but considered only the kinematic model which ignored the mechanical system dynamic and external disturbances. Chung, et al. [2] proposed the sliding mode controller that integrates a kinematic controller and a dynamic controller with bounded external disturbances have been used to solve the path welding tracking problem for the WMR. Ngo, et al.
[3] also proposed the adaptive sliding mode controller for the same WMR. In the above controllers, the WMR is considered in terms of dynamic model with known parameters in the presence of external disturbances. However, the linear velocity of welding point was not keep constant velocity smoothly as desired. To solve the roblem, this research proposes a new nonlinear controller that makes the integration of a kinematic controller and a sliding mode dynamic controller with bounded external disturbances for the WMR to track a desired welding trajectory.
The system stability is proved using the Lyapunov stability theory. The simulation results are shown to illustrate effectiveness of Integral sliding mode controller. The main contents of the thesis are: - Research overview of the mobile welding robot two wheels - Develop mathematical models for robot welding. Geometric modeling of welding robot kinematic model, the dynamics model of the welding robot.
- Design of nonlinear controllers for robot welding. - Design, fabrication welding robot - Run welding robot experiments. - Conclusions and directions of development topics v MỤC LỤC Trang tựa trang NHẬN XÉT LUẬN VĂN THẠC SĨ NHIỆM VỤ LUẬN VĂN THẠC SĨ LỜI CAM ĐOAN .iv MỤC LỤC. v DANH MỤC CÁC TỪ VIẾT TẮT.
vii DANH MỤC CÁC BẢNG.ix DANH MỤC CÁC HÌNH ẢNH. x 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. 26 CHƢƠNG 2 CƠ SỞ LÝ THUYẾT.
Tiêu chuẩn ổn định Lyapunov. Điều khiển trượt. 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. 33 CHƢƠNG 3 XÂY DỰNG MÔ HÌNH TOÁN CHO ROBOT HÀN DI ĐỘNG HAI BÁNH XE. Mô hình hình học của robot hàn di động hai bánh xe:. Mô hình động học của robot hàn 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:. 36 CHƢƠNG 4 THIẾT KẾ BỘ ĐIỀU KHIỂN TRƢỢT TÍCH PHÂN. Thiết kế bộ điều khiển trượt tích phân. Kết quả mô phỏng.
Lưu đồ giải thuật điều khiển. Các kết quả mô phỏng. 40 CHƢƠNG 5 THIẾT KẾ CHẾ TẠO ROBOT HÀN. Thiết kế, chế tạo kết cấu cơ khí của robot hàn.
Kích thước robot. Cấu tạo robot. Sơ đồ hệ thống điều khiển robot hàn. Giới thiệu card DSP TMS320F28335.
Bảng các chân kết nối của DSP. Các Module mạch cầu H. Module Arduino Pro Mini. 61 CHƢƠNG 6 KẾT QUẢ THỰC NGHIỆM.
Kết quả thực nghiệm. Robot chạy bám theo đường hàn. Robot chạy có tải. 65 CHƢƠNG 7 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. 70 TÀI LIỆU THAM KHẢO.
71 PHỤ LỤC vii 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 rad/s rw , lw 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 m/s vw 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 m xr , y r Tọa độ điểm tham chiếu v m/s Vận tốc mong muốn r rad/s r 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 mw kg Khối lượng của bánh lái I kgm2 Mô men quán tính của mỗi bánh lái quanh w trục bánh xe viii 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 , Mô men xoắn của động cơ tác dụng lên bánh kgm2 xe phải và trái lw KC Kinematic controller ISMC Integral sliding mode controller WMR Welding mobile robot WMR : Rô bốt di động bằng bánh xe (Wheeled Mobile Robot) ix DANH MỤC CÁC BẢNG Bảng 1. Ký hiệu các loại bánh xe. Các giá trị của các thông số khi mô phỏng. Các giá trị ban đầu.
Kết quả đo sai số đường hàn bám theo quỹ đạo hàn tham chiếu. 65 x DANH MỤC CÁC HÌNH ẢNH Hình 1. Máy hàn hồ quang điện. Máy hàn hồ quang điện ARC400.
Máy hàn hồ quang điện HERO DC – 315. Máy hàn công nghệ Inverter. Máy Hàn Bán Tự Động MAG - VMAG350/500. Robot hàn OTC DAIHEN.
Robot hàn ARC Mate1000B/2000B của hang Fanuc. Máy hàn của hang Panasonic. Rùa hàn tự động bám dầm Hit-8SS. Hàn hồ quang chìm tự động.
Servo-Robot’s MWR-350. Các loại bánh xe .