TP. Hồ Chí Minh, 2024
BM-TN-05
TRƯỜNG ĐẠI HỌC GIAO THÔNG VẬN TẢI TP. HỒ CHÍ MINH
KHOA ĐIỆN – ĐIỆN TỬ VIỄN THÔNG
LUẬN VĂN TỐT NGHIỆP
NGHIÊN CU, THIT K CH TO HÌNH
CÁNH TAY ROBOT BC XP HÀNG LÊN PALLET
Ngành : Kỹ thuật điều khiểnTự động hóa
Chuyên ngành: Tự động hóa công nghiệp
Giảng viên hướng dẫn :TH.S Thị Ngọc Quyên
Sinh viên thực hiện :
1. Hồ Ngọc Hiếu 1951050055 TD19
2. Nguyễn Hữu Hậu 1951050052 TD19
Khóa lun tt nghip GVHD: Th.S Lê Th Ngc Quyên
Trang | 1
LI CẢM ƠN
Nhóm xin gi li cảm ơn đến Trường Đi hc Giao thông vn ti Thành Ph H
Chí Minh, nơi chúng em đưc tạo hội hc tp, phát triển, nơi để chúng em hoàn
thin bn thân, cung cp nhng nn tng cn thiết để chúng em có được cơ hội vic làm
trong tương lai.
Bên cạnh đó, để có th thc hiện và hoàn thành đề tài này, nhóm chúng xin gi li
chân thành cảm ơn Th Ngọc Quyên đã tạo nhng điều kin tt nht nhng ý
kiến góp ý chân thành nht cho nhóm chúng em. Nhng li dy của đưa ra giúp chúng
em có thêm động lc, kiến thc, cho chúng thy nhng khiếm khuyết đth sửa đổi,
t đó đưa đến mt kết qu tt nhất. Nhóm cũng gửi li cảm ơn chân thành đến nhau như
mt phn của nhóm hai người như một, cùng nhau vượt qua những khó khăn,
nhng ngày họp nhóm đầy căng thẳng, cùng nhau nhận ra đim sai cùng nhau tung
tìm ra được những hướng gii quyết mi. Nhóm cảm ơn thi gian diệu đ
án tt nghip mang li, giúp các thành viên t giác hơn, ng tạo hơn, đoàn kết hơn ng
nhau vượt qua khó khăn. Đây bước đệm để nhóm tiến đến thời gian đi làm sau này,
hội nhìn nhn phát trin kh năng hiện có, hc hi thêm các kiến thc chuyên
ngành để phc v lâu dài v sau và sâu hơn nữa.
Đề tài ca chúng em hin ti vn còn nhiu sai sót và khuyết điểm, nhưng đó cũng
là những điểm mà chúng em cn hc hi và phát trin thêm, do kiến thc ca chúng em
còn hn hp. Mong các thy cô cho chúng em nhng nhận xét để t đó hoàn thiện đề tài
để mang ti nhng giá tr thc tế trong tương lai.
Nhóm em xin chân thành cảm ơn!
Khóa lun tt nghip GVHD: Th.S Lê Th Ngc Quyên
Trang | 2
TÓM TT
Công nghip ngày càng phát trin đòi hỏi nhng công ngh thay thế, h tr con
người trong nhng công việc đòi hi tn nhiu sc, nguy him sc khe như bốc vác
hàng hóa, sp xếp hàng hóa t băng tải lên pallet, phân loi hàng lên pallet,…
Đề tài ”Nghiên cứu, thiết kếchế to hình cánh tay robot bc xếp hàng” sinh
ra như một phn h tr gii quyết vấn đ đặt ra trên, đây là hệ thng bao gm cánh tay
robot dùng camera x ảnh để nhn din chính xác đối tượng vc, din tích, thun
tin di chuyn t băng tải sang pallet các v trí phc tạp khác nhau trên băng tải. Đảm
bảo độ chính xác cao khi bc xếp hàng hóa, cũng như giảm thiếu rủi ro cho con ngưi.
H thng ng dng plc s7-1200 x nh trên nn opencv. H thng cánh tay 4
bc t do, một cơ cấu tay kẹp, đảm bo chính xác trong vic di chuyn hàng hóa và
linh đng trong v trí đt hàng hóa.
ABSTRACT
The growing industry requires alternative technologies to assist people in labor-
intensive, health-hazardous jobs such as loading and unloading goods, arranging goods
from conveyors to pallets, sorting goods. onto pallets,…
The topic "Research, design and manufacture a model of the loading and unloading
robot arm system" was born as a support to solve the problem posed above, this is a
system consisting of a robotic arm using a camera to handle the goods. Image
manipulation to accurately identify objects in terms of angle and area, convenient to
move from conveyor to pallet in different complex positions on the conveyor. Ensuring
high accuracy when loading and unloading goods, as well as minimizing risks to people.
Application system plc s7-1200 and image processing based on opencv. The arm system
has 4 degrees of freedom, and a clamping mechanism, ensuring precise movement of
goods and flexibility in the placement of goods.
Khóa lun tt nghip GVHD: Th.S Lê Th Ngc Quyên
Trang | 3
MC LC
LI CM ƠN ................................................................................................................ 1
TÓM TT ...................................................................................................................... 2
CHƯƠNG 1. Tng quan ......................................................................................... 12
1.1. Đặt vấn đề và chn đ tài .............................................................................. 12
1.2. Sơ lược v robot công nghip trong bc xếp hàng hóa ............................... 12
1.2.1. Robot công nghip là gì ? .......................................................................... 12
1.2.2. Mt s loi cánh tay robot công nghip .................................................... 13
1.3. Robot bc xếp ................................................................................................. 15
1.3.1. Hot đng .................................................................................................. 16
1.3.2. ng dng ................................................................................................... 16
1.3.3. Li ích ....................................................................................................... 16
1.3.4. Đặc trưng ca robot bc xếp so vi robot công nghip nói chung ........... 17
1.3.5. Chế to mô hình robot bc xếp cho đề tài ................................................. 18
1.4. Tích hp robot bc xếp vào h thng robot bc xếp hàng t động ........... 19
1.4.1. Tng quan h thng bc xếp hàng t đng ............................................... 19
1.4.2. H thng robot bc xếp hàng t động ....................................................... 20
1.4.3. H thng robot bc xếp s được xây dựng trong đề tài ............................ 24
1.5. Tng quan v x nh ................................................................................. 25
1.6. Gii thiu ngôn ng python .......................................................................... 26
1.6.1. Ngôn ng Python ...................................................................................... 26
1.6.2. Đặc điểm ni bt ca Python .................................................................... 26
1.6.3. Lý do s dng ngôn ng Python cho đ tài .............................................. 26
1.7. Thư viện OPENCV ........................................................................................ 27
1.7.1. Gii thiu ................................................................................................... 27
1.7.2. Đặc điểm ................................................................................................... 28
1.7.3. Các tính năng của thư viện OpenCV: [5] .................................................. 28
1.7.4. Lý do s dụng thư viện OpenCV cho đề tài .............................................. 28
1.8. Gii thiu v PLC Siemens S7-1200 ............................................................. 28
1.8.1. Tng quan v plc siemens s7 1200 ........................................................... 28
1.9. Gii thiu v các chun giao tiếp ca PLC .................................................. 33
1.9.1. Tng quan v giao tiếp Siemens: .............................................................. 33
1.9.2. S7 Protocol [7] .......................................................................................... 34
Khóa lun tt nghip GVHD: Th.S Lê Th Ngc Quyên
Trang | 4
1.9.3. Giao tiếp ca Siemens [7] ......................................................................... 35
1.10. Gii thiu Arduino UNO R3 ......................................................................... 38
1.10.1. Gii thiu ............................................................................................... 38
1.10.2. Thông tin cu hình [8] ........................................................................... 39
1.11. Gii thiu v phn mm Arduino IDE ......................................................... 42
1.12. Gii thiu v phn mm PyCharm [3] ......................................................... 44
1.13. Băng ti ........................................................................................................... 44
1.13.1. Khái nim ............................................................................................... 44
1.13.2. Lch s băng tải ...................................................................................... 45
1.14. Mc tiêu ca đề tài ......................................................................................... 45
1.14.1. Mc tiêu tng quát ................................................................................. 45
1.14.2. Mc tiêu c th ...................................................................................... 45
1.15. Đối tưng nguyên cu: .................................................................................. 45
1.16. Phương pháp nghiên cu: ............................................................................. 46
1.17. Phm vi nghiên cu: ...................................................................................... 46
1.18. Ý nghĩa khoa hc và thc tin: ..................................................................... 46
1.19. B cc báo cáo ................................................................................................ 46
CHƯƠNG 2. : ĐNG HC CÁNH TAY ROBOT .............................................. 49
2.1. Động hc thun ca robot 3 bc RRR ( Mô hình 1) ................................... 50
2.2. Động hc nghch ca robot 3 bc RRR (Mô hình 1)................................... 51
2.3. Động hc vn tc thun ca robot 3 bc RRR (Mô hình 1) ....................... 53
2.4. Động hc vn tc nghch ca robot 3 bc RRR (Mô hình 1) ..................... 54
2.5. Động hc gia tc thun ca robot 3 bc RRR (Mô hình 1) ........................ 56
2.6. Động hc gia tc nghch ca robot 3 bc RRR (Mô hình 1) ...................... 57
2.7. Mô hình 2 (1 khâu R) ..................................................................................... 58
2.8. Động hc ca robot 1 bc R ( Mô hình 2) .................................................... 58
2.9. Động hc gia tc ca robot 1 bc R ( Mô hình 2) ........................................ 59
CHƯƠNG 3. THIT K H THỐNG CƠ K .................................................. 60
3.1. Gii thiu tng quan v h thng ................................................................. 60
3.2. Tng quan v cánh tay robot ........................................................................ 61
3.3. Xác đnh s bc t do ..................................................................................... 62
3.4. Sn phm và tr trí đt trên pallet ................................................................ 63
3.4.1. Tng 1 ....................................................................................................... 63