(Đồ án tốt nghiệp) chế tạo cánh tay robot trong công nghiệp gấp và xếp vật

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 ĐỒ ÁN TỐT NGHIỆP NGÀNH CÔNG NGHỆ KỸ THUẬT ĐIỀU KHIỂN VÀ TỰ ĐỘNG HĨA CHẾ TẠO CÁNH TAY ROBOT TRONG CƠNG NGHIỆP GẮP VÀ XẾP VẬT GVHD: LÊ HOÀNG LÂM SVTH: NGUYỄN TUẤN DUY MSSV: 15151015 SVTH: TRẦN VÕ MINH TÂM MSSV: 15151073 SKL005954 Tp Hồ Chí Minh, tháng 7/2019 TRƯỜNG ĐẠI HỌC SƯ PHẠM KỸ THUẬT THÀNH PHỐ HỒ CHÍ MINH KHOA ĐÀO TẠO CHẤT LƯỢNG CAO ĐỒ ÁN TỐT NGHIỆP CHẾ TẠO CÁNH TAY ROBOT TRONG CÔNG NGHIỆP GẮP VÀ XẾP VẬT SVTH: NGUYỄN TUẤN DUY TRẦN VÕ MINH TÂM Khóa: 2015 Ngành: CƠNG NGHỆ KỸ THUẬT ĐIỀU KHIỂN VÀ TỰ ĐỘNG HĨA GHVD: ThS LÊ HỒNG LÂM Tp Hồ Chí Minh, tháng năm 2019 ii i ii iii CỘNG HOÀ XÃ HỘI CHỦ NGHĨA VIỆT NAM Độc lập – Tự – Hạnh Phúc ****** PHIẾU NHẬN XÉT CỦA GIÁO VIÊN PHẢN BIỆN Họ và tên Sinh viên: Nguyễn Tuấn Duy MSSV: 15151015 Trần Võ Minh Tâm Ngành: Công nghệ kỹ thuật Điều khiển và Tự động hóa 15151073 Lớp: 15151CLC1 Tên đề tài: Chế tạo cánh tay robot công nghiệp gắp và xếp vật Họ và tên Giáo viên phản biện: TS Đặng Xuân Ba NHẬN XÉT Về nội dung đề tài & khối lượng thực hiện: - Nội dung đồ án chưa đạt yêu cầu, mức yếu Ưu điểm: - Phương pháp nghiên cứu phù hợp Khuyết điểm: - Giải pháp đưa khơng có tính - Tính ứng dụng trung bình - Khơng ghi trích dẫn Đề nghị cho bảo vệ hay không? - Được bảo vệ cần chỉnh sửa nhiều Đánh giá loại: - Đồ án trình bày chưa đạt yêu cầu, mức yếu Điểm:……………….(Bằng chữ: ) iv Tp Hồ Chí Minh, ngày … tháng … năm 2019 Giáo viên phản biện (Ký & ghi rõ họ tên) v MỤC LỤC NHIỆM VỤ ĐỒ ÁN TỐT NGHIỆP i PHIẾU NHẬN XÉT CỦA GIÁO VIÊN HƯỚNG DẪN ii PHIẾU NHẬN XÉT CỦA GIÁO VIÊN PHẢN BIỆN iv MỤC LỤC vi LỜI CẢM ƠN ix DANH MỤC CÁC TỪ VIẾT TẮT x DANH MỤC CÁC BẢNG BIỂU xi DANH MỤC CÁC HÌNH ẢNH xii Chương 1: GIỚI THIỆU CHUNG .1 1.1 Tổng quan hệ thống 1.2 Mục tiêu nghiên cứu 1.3 Nội dung nghiên cứu .2 1.4 Phương pháp nghiên cứu 1.5 Đối tượng nghiên cứu Chương 2: CƠ SỞ LÝ THUYẾT VỀ CÁNH TAY ROBOT 2.1 Cơ sở lý thuyết Robot 2.2 Cấu trúc và phân loại robot công nghiệp 2.2.1 Cấu trúc robot công nghiệp 2.2.2 Phân loại robot 2.3 Một số khái niệm robot 10 2.3.1 Bậc tự robot (DOF : Degrees Of Freedom) 10 2.3.2 Trường công tác robot (Workspace) 11 2.4 Động học robot 12 2.4.1 Động học thuận 12 vi 2.4.2Động học nghịch Chương 3: THIẾT KẾ PHẦN CỨNG 3.1Thiết kế phần khí 3.1.1Khung đỡ mơ hình và ch 3.1.2Bàn đỡ mơ hình 3.1.3Chân đặt cánh tay robot 3.1.4Bàn đặt vật 3.1.5Băng tải 3.1.6Cánh tay robot 3.2Thiết kế mạch điều khiển 3.2.1Thiết bị sử dụng 3.2.2Mạch điều khiển 3.2.3Mạch động lực 3.2.4 Mạng SSCNET III/H Chương 4: GIẢI THUẬT VÀ CHƯƠNG TRÌNH ĐIỀU KHIỂN 4.1Tính động học thuận và động học nghịch 4.1.1Tính động học thuận 4.1.2Tính động học nghịch 4.2Thiết kế màn hình HMI 4.3Phương pháp thực 4.3.1Lưu đồ khối 4.3.2Lập trình và thiết lập Chương 5: KẾT LUẬN VÀ HƯỚNG PHÁT TRIỂN 5.1Kết 5.1.1 Về PLC 5.1.2Về thiết bị điện 5.1.3Về Driver Servo vii 5.1.4 Về phần khí 5.1.5 Khả tìm kiếm tài liệ 5.2 Kết thực nghiệm 5.3 Hướng phát triển đề tài 5.3.1 Nâng cấp trục vít me 5.3.2 Thêm băng tải chuyển Pa 5.3.3 Thêm xử lý ảnh cánh tay TÀI LIỆU THAM KHẢO viii 4.2 Thiết kế hình HMI Dựa vào mục đích mơ hình là gắp và xếp vật Nhóm thiết kế với màn hình HMI: Hình 4.2: Màn hình chọn cách thức chạy Hình 4.3: Trang Manual 76  Trong trang Manual, ta chỉnh tọa độ điểm cuối robot Từ chọn tọa độ là điểm gắp vật (Pick POS), thả vật (Place POS) Cho cánh tay điểm HOME Hình 4.4: Màn hình AUTOMATION  Trong trang Automation, giúp người vận hành quan sát vật thả vị trí nào và gắp vật Bên cạnh có nút “RST ERR” để chạy lại có lỗi “RST COUNT” cho cánh tay tiếp tục chạy lại sau xếp đủ vật Hình 4.5: Trang REAL VALUE 77  Trong trang Real Value, giúp cho người vận hành theo dõi thơng số quan trọng giá trị trục quay, và tốc độ trục quay Hình 4.6: Trang SET UP  Trong trang Set up, người vận hành cài đặt thơng số liên quan đến xếp vật như: số hàng, số cột, số tầng, khoảng cách cột, hàng và tầng 4.3 Phương pháp thực 4.3.1 Lưu đồ khối 78  Khi chạy chế độ Auto  Khi chạy chế độ Manual 79  Khi chạy chế độ cúp điện: 80 4.3.2 Lập trình thiết lập thơng số 4.3.2.1 Lập trình Sừ dụng phần mềm GX Works2 để viết chương trình cho CPU Hình 4.7: Phần mềm GX Works2 4.3.2.2 Thiết lập thông số  Set Parameter trục cho QD75MH4 Hình 4.8: Set Parameter cho trục QD75MH4 81  Set Parameter điểm HOME, chọn chế độ Absolute Position Detection System để lưu nhớ vị trí servo Hình 4.9: Set Parameter cho điểm HOME  Chọn chiều quay cho Servo với hệ quy chiếu tọa độ Robot (quay ngược chiều kim đồng hồ là dương, chiều kim đồng hồ là âm) Hình 4.10: Quy ước chiều quay servo  Chọn chế độ tự điều chỉnh Moment động phù hợp với cấu Robot giúp giảm qn tính, robot vận hành ổn định khơng rung lắc dù chạy với cấp tốc độ khác Hình 4.11: Chọn chế độ tự điều chỉnh Moment 82  Set Data trục 1, chạy nội suy trục (trục 1,2,3) Hình 4.12: Set Data trục  Set Data trục (tay gắp) chạy độc lập Hình 4.13: Set Data trục 83  Set Parameter động Băng tải, qua tỉ số hộp giảm tốc ta được: động quay vòng ứng với băng tải dịch chuyển vật 64mm Hình 4.14: Set Parameter cho động băng tải 84 Chương 5: KẾT LUẬN VÀ HƯỚNG PHÁT TRIỂN 5.1 Kết Sau trải qua 16 tuần để thực hoàn thành đề tài này, qua trình nghiên cứu tài liệu, giúp đỡ anh chị khóa trước bạn phòng LAB nghiên cứu và đặc biệt là giúp đỡ tận tình giáo viên hướng dẫn ThS Lê Hoàng Lâm, nhóm đạt kết mong muốn: 5.1.1 Về PLC  Giao tiếp PLC với máy tính  Kết nối với thiết bị ngoại vi  Dùng phần mềm: GX Works2, MT Deverlop2, GT Designer 5.1.2 Về thiết bị điện         Cách dây, bấm đầu cốt, in tag name cho dây điện Sử dụng và lựa chọn CB, ELCB, CP Sử dụng máy biến áp Sử dụng contactor, relay Sử dụng lọc nhiễu Lựa chọn cảm biến Thiết kế giao diện và sử dụng HMI GOT 1000 Kết nối và sử dụng tay phát xung 5.1.3 Về Driver Servo  Kết nối với module chuyển động QD75MH  Cách lập trình và cài đặt thơng số  Điều khiển động nhiều trục theo yêu cầu 5.1.4 Về phần khí  Cơ cấu truyền động puly và dây đai  Sử dụng thiết bị khoan, cắt, mài  Cơ cấu vít me 85 5.1.5 Khả tìm kiếm tài liệu cách làm việc     Cách tìm tài liệu Internet Đọc tài liệu hướng dẫn thiết bị Làm việc nhóm Phân chia, quản lý thời gian 5.2 Kết thực nghiệm Hình 5.1: Cánh tay Robot Hình 5.2: Tủ điện 86  Nhóm hoàn thiện mơ dự kiến ban đầu: - Hệ thống vận hành cách trơn tru, mượt mà và ổn định Mơ hình gắp vật liên tục mà không bị lệch vị trí có cố Trong q trình thực hiện, nhóm gặp nhiều cố như: tính toán sai động học thuận, nghịch dẫn đến điều khiển sai vị trí Mơ hình chạy khơng mượt mà trơn tru tính tốn thời gian tăng giảm tốc Đảo chiều quay vít me với tốc độ nhanh nên gây gãy trục Và nhiều lỗi kết nối và cài đặt Parameter cho Driver, QD75MH Nhóm phải sử dụng nhiều tài liệu “Manual” thiết bị này để sửa lỗi  Rút ưu nhược điểm mơ sau - Ưu điểm:  Có thể gắp vật liên tục, đặt vật băng tải sát  Có chế độ Auto và Munual  Người vận hành thay đổi vị trí gắp vật và vị trí thả vật cách đơn giản Di chuyển cánh tay đến vị trí mong muốn bằng tay phát xung HMI, sau nhấn nút “Pick POS” (vị trí gắp) “Place POS” (vị trí thả vật) màn hình HMI  Có thể thay đổi số lượng Pallet (khi gắp đủ Pallet hệ thống dừng) bằng cách chọn HMI, có tín hiều Pallet chuyển mơ hình tiếp tục hoạt động  Có thể thay đổi khoảng cách vật thả, nhập khoảng cách HMI với đơn vị (mm) Độ xác nhỏ +−1  Khi thả xong vật, màn hình HMI hiển thị vật nào đặt Giúp cho người vận hành dễ dàng quan sát mà khơng cần nhìn vào hệ thống  Tốc độ mơ hình tương đối nhanh Từ gắp vật đến quay lại vị trị cũ 5s30 – 5s45 Tùy vào chọn vị trí thả vật  Khi hệ thống điện, hệ thống tự nhớ gắp đến vật thứ Để có điện lại không cần xếp lại vật  Ngoài cịn có nút dừng khẩn cấp để có cố - Nhược điểm:  Khơng thể đặt vật sát Do cấu tay gắp nhả (6cm), kẹp (4cm) Do khoảng cách tối thiểu vật là cm  Các vật bẳng tải phải đặt bẳng tải tay gắp gắp 87  Khi thay đổi hình dạng, kích thước vật phải điều chỉnh lại hệ thống  Mơ hình chưa thể thay đổi chiều thả vật (do mơ hình sử dụng vật hình trịn) 5.3 Hướng phát triển đề tài 5.3.1 Nâng cấp trục vít me Do cấu trục vít me phải quay đảo chiều liên tục để đưa cấu robot lên xuống theo trục z Do dó, muốn đạt tốc độ nhanh trục vít me phải chịu lực moment lớn dễ làm gãy trục vít Đặc biệt là vị trí nối với puly Do phần thân vít me có trụ trợ lực nên khó gãy Hiện cánh tay robot chạy nhanh nhiều cấu vít me nhóm khơng để chạy tốc độ lớn Có cách để nâng cấp: - Nhiệt luyện vít me để cứng - Thay bằng trục vít me có đường kính lớn 5.3.2 Thêm băng tải chuyển Pallet Sau xếp đủ vật, có băng tải đưa Pallet và đưa Pallet khác vào để cánh tay xếp tiếp vật Như mơ hình ứng dụng công nghiệp hoàn chỉnh 5.3.3 Thêm xử lý ảnh cảm biến phát người khu vực làm việc cánh tay Trong trình làm việc, người di chuyển vô khu vực làm việc robot nguy hiểm, bị cánh tay di chuyển trúng Do đó, cần phát nào người xuất khu vực làm việc cánh tay robot tự động dừng 88 TÀI LIỆU THAM KHẢO  Tiếng Việt https://www.mitsubishielectric.com/fa/assist/e-learning/vie.html https://kythuatchetao.com/canh-tay-robot-cac-khai-niem-co-ban-va-phanloai-robot/  Tiếng Anh [2] [3] [4] [5] [6] [7] [8] QD75MH Positioning Module User's Manual QCPU(Q Mode)/QnACPU Programming Manual I/O Module Type Building Block User's Manual MR-J4-B Servo Amplifier Instruction Manual Melservo J4 SSCNET III/H Interface Multi-axis AC Servo Manual MODEL HG-MR/HG-KR/HG-SR/HG-JR/HG-RR/HG-UR/HG-AK Servo Motor Instruction Manual Handy GOT GT11 User’s Manual 89 ... với băng tải 18 3.1.6 Cánh tay robot Cánh tay Cánh tay Thân robot Tay gắp Đế robot Hình 3.6: Mơ hình cánh tay robot 3.1.6.1 Đế robot (khớp xoay thứ nhất)  Kích thước đế robot: - Chiều dài: 30... gắn với cánh tay qua dây đai Từ xoay cánh tay 3.1.6.4 Cánh tay thứ hai Đây là phận nối cánh tay và tay gắp  Kích thước cánh tay 2: - Chiều dài: 26.5 cm - Độ dày: 10 cm Hình 3.18: Cánh tay 24... KHOA ĐÀO TẠO CHẤT LƯỢNG CAO ĐỒ ÁN TỐT NGHIỆP CHẾ TẠO CÁNH TAY ROBOT TRONG CÔNG NGHIỆP GẮP VÀ XẾP VẬT SVTH: NGUYỄN TUẤN DUY TRẦN VÕ MINH TÂM Khóa: 2015 Ngành: CƠNG NGHỆ KỸ THUẬT ĐIỀU KHIỂN VÀ TỰ