ĐẠI HỌC QUỐC GIA TP. HCM TR ONG ĐẠI HỌC BACH KHOA TRAN VAN LINH THIET KE CHE TAO ROBOT BOC XEP HANG Chuyên ngành: Công Nghệ Chế Tao May Mã số: 605204 LUẬN VĂN THẠC SĨ TP. HỎ CHÍ MINH, tháng 06 năm 2014 ĐẠI HỌC QUỐC GIA TP.HCM CỘNG HÒA XÃ HỘI CHỦ NGHĨA VIỆT NAM TR ONG ĐẠI HỌC BACH KHOA Độc lập - Tự do - Hanh phúc NHIỆM VỤ LUẬN VĂN THẠC SĨ Họ tên học viên: TRAN VĂN LINH MSHV: 12040469 Ngày, tháng, năm sinh: 30/06/ 1989 Nơi sinh: Phú Yên Chuyên ngành: Công Nghệ Chế Tạo Máy Mã số : 605204 I. TÊN DE TÀI: THIET KE CHE TAO ROBOT BÓC XÉP HÀNG Il.
NHIEM VU VA NOI DUNG: Dé thực hiện nhiệm vụ thiết kế chế tao Robot bốc xếp hang, thì luận văn sẽ trình bày 5 nội dung như sau: - Thiết lập và phân tích bài toán động học thuận và ngược cho cơ câu - Tinh toán thiết kế và chế tạo mô hình robot - Thiết lập hệ thống điều khiển và đánh gia thực nghiệm độ chính xác của cơ câu. NGÀY GIAO NHIỆM VỤ: 20/01/2014 IV. NGÀY HOÀN THÀNH NHIỆM VU: 20/06/2014 v. CAN BOH ONG DAN: TS.
PHAM CÔNG BANG Tp. tháng 07 năm 2014 CAN BOH ONG DAN CHU NHIEM BO MON DAO TAO (Họ tên va chữ ky) (Họ tên và chữ ký) TS. Phạm Công Băng TR ONG KHOA CƠ KHÍ (Họ tên va chữ ky) PGS. Nguyễn Hữu Lộc Lời cảm ơn Trước tiên, tôi xin được gửi lời cảm ơn đến tất cả quý thầy cô đã giảng dạy trong chương trình Cao học Chế Tạo Máy của trường Đại hoc Bách Khoa Tp.
Hồ Chí Minh. Những người đã truyền đạt cho chúng tôi những kiến thức hữu ích trong ngành Công Nghệ Chế Tạo Máy, làm cơ sở cho tôi thực hiện tốt luận văn thiết kế chế tạo Robot bốc xếp hàng. Đề đạt được kết quả như trình bày trong luận văn nảy, tôi xin chân thành cảm ơn TS. Phạm Công Bang, thay đã tận tình hướng dẫn và giúp đỡ tôi rất nhiễu trong thời gian thực hiện luận văn.
Sau cùng tôi xin gửi lời biết ơn sâu sắc đến Trung Tâm Nghiên Cứu Triển Khai đã hỗ trợ kinh phí và luôn tạo điều kiện tốt nhất cho tôi trong suốt thời gian làm luận văn. Vì thời gian có hạn và chưa có được nhiều kinh nghiệm nghiên cứu khoa học nên luận văn có thể còn nhiều thiếu sót. Rất mong nhận được ý kiến góp ý của quý Thây/Cô và các anh chị học viên. Tôi xin chân thành cảm on! TÓM TẮT Robot công nghiệp ngày càng được sử dụng pho biến trong các công ty sản xuất.
Sự xuất hiện của nó đã thay thế cho con người thực hiện các công việc nặng nhọc, nguy hiểm và độc hại như: phun sơn, hàn, bốc xếp hàng lên pallet,. Trong đó, công việc bốc xếp hàng lên pallet là một công việc nặng nhọc và hầu hết các công ty sản xuất đều có công đoạn này. Do đó, trong luận văn này sẽ nghiên cứu thiết kế chế tạo robot bốc xếp hàng. Với cơ cầu robot có 4 bậc tự do và điều khiển băng vi xử lý, có khả năng thực hiện công việc gắp sản phẩm ở đầu ra của dây chuyên sản xuất và sắp xếp lên pallet theo nhiều kiểu khác nhau.
Dau gap sản phẩm có thé thay thé được nhiều dạng co cấu gap khác nhau, dé ứng dụng trong các dây chuyền sản xuât những dạng sản phâm khác nhau. ABSTRACT Industrial robots are increasingly widely used in the production company. The appearance of it was replaced humans perform heavy work, dangerous and toxic, such as paint spraying, welding, stacking products onto pallet,. In particular, work of stacking products onto pallet is a heavy job and most companies manufacture always have this step.
Therefore, in this thesis will research design fabricate Robotic palletizer. With the structure of the robot has 4 degrees of freedom and controlled by microprocessors, capable of performing the pick up products at the output of the production line and onto pallets arranged in many different ways. Head pick products can replace many different types of structural pick up, for application in the production lines of various types of products. LỜI CAM ĐOAN Tôi xin cam đoan đây là công trình nghiên cứu của riêng tôi và chưa được công bô trong bât cứ công trình nào khác.
Các sô liệu, kêt quả nêu trong luận văn là trung thực. Phụ lục CHUONG 1. GIỚI THIỆU DE TÀI NGHIÊN CỨU.1 Giới thiệu chung .2 Mô hình sắp xếp thành phẩm tự động bang robot bốc xếp hang .3 Tính cấp thiết của dé tain. ccc 5c ST 1112111 5151111115111 10101010 111101 0111 1 kg e 4 1.4 Những nghiên cứu về robot bốc xếp hàng ở ngoài nước.5 Những nghiên cứu về robot bốc xếp hàng ở trong nước .6 Mục tiêu và nhiệm vụ thực hiện luận văn.7 Phạm vi thực hiện của luận văn .8 Bố cục luận văn .-- Gv 12111 TH TH ng TH TH nh Hưng ng 13 1.9 Ý nghĩa khoa học và thực tiễn của luận văn .-- --- ¿55 c2 <czkczkccrecsecez 13 CHUONG 2: PHAN TÍCH VÀ LỰA CHỌN CƠ CÂU.1 Phân tích và lựa chọn kết cẤu.2 Xây dựng mối quan hệ giữa các khâu .1 Thiết kế co cau ràng buộc phương trục xoay dau gap hang .2 Thiết lập mối quan hệ kích thước giữa các khâu của robot.3 Xác định ràng buộc chuyển động giữa các khâu trong cơ cau robot .- G1 12 HT HT HH HT TH HT TH TH TH TH ngơ.
25 CHUONG 3: PHAN TICH ĐỘNG HOC .1 Thiết lập bài toán động học thuận cho robot .2 Thiết lập bài toán động học ngược cho rObO(. 37 CHUONG 4: THIẾT KE CƠ KPHÍ.1 Xác định kích thước của các khâu trong robot bốc xếp hàng.2 Thiết kế mô hình chế tao robot .3 Xác định áp lực tại các khớp truyền động của rOobof.4 Tính và chọn động CƠ. -- ---c-c S301 1 v9 911 1 vn ng nh vế 53 4.1 Xác định thời gian thực hiện các bước bốc xếp hàng.2 Xác định vận tốc của các khâu truyền động .4 Xác định công suất động €Ơ.5 Chon dOng CO 04): ŸTAAỖŨẮẲẮIẲẮẲỔIAIẢẦẮẦẮẶẮẦẶ.5 KKẾT WAN eee cceccccccsescecscscssescscsesesscscscsesssscscscsesesssscscsesessscscsesssssscscscsesssecsesesssess 59 CHUONG 5: THIẾT LAP HE THONG DIEU KHIỂN .1 Thiép lập hệ thống điều khiến robot trên Matlab.1 Chuyển đối dữ liệu.2 Mô phỏng điều khiến robot trên Matlab .2 Thiết bị điều khiỂn.1Mạch điều khiến chính.2 Công tắc hành trình .- -- -G c + c St S113 53158158 11 13 13 11 H1 H1 HH HH ng rệt 67 5.4 Luu đồ giải thuật điều khiến. 68 CHƯƠNG 6: ĐÁNH GIÁ THỰC NGHIỆM.1 Kiểm tra chuyển động theo phương ngang .1 Quy trình thu thập số liệu theo phương ngang.2 Thu thập số liệu kiểm tra trục ngang.2 Kiểm tra chuyển động theo phương đứng .1 Quy trình thu thập giữ liệu theo phương đứng.2 Thu thập số liệu kiểm tra trục 90501 —------Ã1lÃ11T .3 Két LAI 077 cscscscescscscsessscecsesessessscsescsesscscscsessvscscsesssssscsescsessecsesesssess 77 CHƯƠNG 7: TONG KẾTT.-- 5 SE SE 2E 5 1515525 5 511111 1 51111115050 111111 re 78 7.1 Kết (oUF ae F216 100, 272721577 -.2 Những van dé còn hạn chỀ.------ ¿+ 5S 2 E225 5 53321 1 5 51121 51 E111 re, 78 TÀI LIEU THAM KH ẢO.
G6256 9195191 98 9813 91 11 H1 123 1x no 79 Danh mục hình Hình 1.1: Ứng dụng của robot trong sản XuẤt.2: Robot sắp xếp hang .-- --- E522 SE 191191211121 01 2111111 re 2 Hình 1.3: Một số dạng thành phẩm trong dây chuyên sản xuất .4: Hệ thống bốc xếp hang thủ công trong nhà máy phân đạm Phú Mỹ .5: Mô hình bốc xếp sản phẩm .6: Công nhân bốc xếp hàng trong công ty cô phần dinh dưỡng Hồng Hà .7: Robot bốc xếp hàng tự động .8: Mô hình robot bốc xếp hàng FUJI - ACE.---¿ 5-2252 sc+csze+essssd 7 Hình 1.9: Không gian làm việc của model EC-201 .10: Mô hình robot và không gian làm việc của robot IRB 460.11: Mô hình robot bốc xếp hàng A 1600 ID .12: Không gian làm việc của robot bốc xếp hàng A 1600111.13: Cánh tay robot TOSY TI, TI A620-30 ooo eeseseeeeeeeeeeeeererees II Hình 1.14: Ảnh minh hoa dạng thành phẩm và kiểu sắp xếp .1: Các dạng sắp xếp thành phẩm co bản trong sản xuất .2: Thành phâm không bị nghiên hoặc bị chèn ép trong quá trình bốc xếp.3: Thành phẩm bị nghiên và bị ép lên pallet khi sắp xếp .4: Robot 4 bac tự do đang ở VỊ tri (.--ccc c1 SH vn ng reu 16 Hình 2.5: Ảnh hưởng của biến khớp @ và @3 đến phương của dau gap hàng.6: Robot bốc xếp hàng 4 bậc tự do và một cơ cầu ràng buộc phương trục xoay đầu gap thành phẩm.--:- ¿+55 SẺ SE E2 E311 321212111 E1 Exrrrrred 17 Hình 2.7: Cơ cau robot bốc xếp hàng có 4 bậc tự do là khớp xoay .8: Cơ cau robot bốc xếp hàng có 4 bậc tự do là khớp xoay kết hop với 1 co cau ràng buộc hình bình hành ABKLI .9: Co cau robot bốc xếp hàng 4 bậc tự do có 2 khớp xoay và 2 khớp tinh tién "M.10: Minh hoa cơ cau ràng buộc phương của khâu cuối robot .11: Minh họa van dé can chứng minh (C’ = C) cho cơ cấu robot.12: Mô hình thể hiện mối quan hệ vi trí của các điểm trong cơ cầu robot .1: Mô hình robot hoàn chỉnh.cc ccc ceccesccceeceeccesccesceceecesecescceseceeceseces 27 Hình 3.2: Minh họa mối quan hệ của hệ trục tọa độ {Q} trong hệ trục tọa độ {0} (6 FT oss AO)0,0) 1 irễi.3: Mô hình robot được rút gon để xác định hướng đầu gắp ¬ 30 Hình 3.4: Hệ trục tọa độ đặt trên robot theo quy ước Denavit — Hartenberg .5: Minh họa các giá tri thu được từ phương trình (3.6: Minh hoa vị trí cơ cau robot theo một số trường hợp trong bảng 3.7:Minh họa yêu cau điều khiến robot sắp xếp sản phẩm lên pallet theo 2D 34 Hình 3.8: Minh hoa vị trí cơ cau robot tương ứng với các vị trí ( Xp, “yp, Zp, B).9: Minh họa vị trí cơ cấu robot theo trường hợp | trong bang 3.1: Minh họa tầm với của rOboOt.2: Minh hoa d,, d, theo vi trí tầm với của robot .3: Mô hình robot 3D CAD. Ặ G G QQQ ng 40 Hinh 4.4: Tam dé nh.6: Con trượt ngang.7: Con trượt dung .8: Các khâu mở rộng và thu nhỏ tầm với làm việc của robot .9: Các khâu ràng buộc phương trục xoay dau gap hàng của robot .11: Đầu gap hang .12: Cơ cau robot ứng với vị trí có tầm với lớn nhất .13: Cơ cau ràng buộc phương trục quay dau gap hang .14: Cơ cau mở rộng tầm với.--¿-¿ ¿+ +2 + SE 2E £E 2E rr re 48 Hình 4.15: Các thành phan lực tác dụng lên từng khâu .16: Các thành phan lực tác dụng lên khâu CDE-.17: Các thành phan lực tác dụng lên khâu EF .18: Các thành phan lực tác dụng lên khâu BFG .19: Các thành phan lực tác dụng lên khâu GH .20: Các thành phan lực tác dụng lên khâu LC.21: Các thành phan lực tác dụng lên khâu AB .