Tiếp đến khi nhân vận tốc khâu cuối robot cùng với ma trận Jacobian nghịch đảo vừa tìm được, ta được một ma trận 3x3 thể hiện vận tốc của từng khớp robot:
𝜃̇ = [ 𝜃1̇ 𝜃2̇ 𝜃3̇ ] (54)
Tổng quan: khối Motor Control sẽ nhận giá trị đầu vào là vận tốc của khâu cuối robot, sau khi qua các khối tính tốn sẽ cho ta giá trị đầu ra là góc quay của từng khớp robot. Vì ma trận Jacobian là một ma trận thay đổi phụ thuộc vào giá trị của các góc
quay 𝜃1, 𝜃2 và 𝜃3 của robot, ta cần sử dụng các giá trị đó để tính giá trị của ma trận
Jacobian theo thời gian.
6.7 Gửi giá trị tìm được lên ROS network và Raspberry Pi:
Hình 6.35: Gửi các giá trị góc quay của từng motor lên ROS
Hình 6.37: Quy trình điều khiển Task của robot
6.8 Tiến hành mô phỏng:
Mô phỏng animation trong công nghiệp:
Hình 6.39: Mơ phỏng, định vị và gắp sản phẩm
Hình 6.41: Giao diện Motion Animation
• Nhận xét:
Cánh tay robot được mô phỏng bởi phần mềm Solidworks Motion Animation, Robot đang tiến nâng và di chuyển hàng hóa từ vị trí băng tải 1, sang đặt vào thùng gỗ ở băng tải 2.
Mô phỏng này chúng em dựa trên ứng dụng thực tế trong việc gắp sản phẩm và đóng gói trong kho hàng, kho bãi của cơng ty, nhà máy và xí nghiệp.
Mơ phỏng điều khiển chuyển động:
Hình 6.43: Giao diện điều khiển robot thơng qua GUIDE
• Nhận xét:
Để hạn chế việc lỗi xảy ra khi mô phỏng chuyển động trên matlab. Nên chúng em đã thay thế mơ hình thực tế của robot bằng một mơ hình khác đơn giản hơn để tiện cho việc mơ phỏng.
Kết quả đạt được là mơ hình chuyển động thành cơng và luôn giữ mặt của khâu luôn hướng xuống và song song với mặt đất, đúng với những yêu cầu mà chúng em đã đặt ra ở chương 3 và chương 4.
CHƯƠNG 7: KẾT LUẬN VÀ HƯỚNG PHÁT TRIỂN
7.1 Nhận xét tổng quan:
• Nhược điểm:
Visual Servoing được ứng dụng cho các thao tác của robot trở nên đơn giản và linh hoạt, tuy nhiên do robot được áp dụng chỉ có 3 bậc tự do, do đó camera được kết nối vào khâu cuối của robot cũng chỉ có 3 bậc tự do, điều này hạn chế các góc và hướng chuyển động của robot do đó robot chỉ có thể thao tác và nhận biết đối với các vật bị hạn chế bởi 3 góc xoay quanh trục x y z.
• Bộ điều khiển vẫn cịn đơn giản nên đầu ra chính xác vẫn chưa đủ tốt.
• Robot di chuyển chậm do khả năng kiểm sốt bộ điều khiển cịn hạn
chế.
• Vùng làm việc bị giới hạn.
• Hộp số của động cơ cũng như độ chính xác của encoder có thể ảnh
hướng đến độ chính xác của robot.
• Việc dùng vít cố định trục động cơ là khơng tối ưu về mặt cơ khí khi
có thể làm biến dạng then của trục một cách khơng đồng đều. Dẫn đến tháo lắp khó khăn.
• Khơng có phần ngắt điện tự động khi động cơ bị nhiễu dẫn đến tình
trạng mất kiểm sốt tay máy.
• Ưu điểm:
Tuy vậy, đồ án vẫn đáp ứng được những yêu cầu của phạm vi đề tài, thu được những kết quả tốt:
• Với ứng dụng phương pháp điều khiển bằng Visual Servoing ta khơng
• Với việc ứng dụng kết nối hệ thống với ROS (Robot Operating System) ta có thể dễ dàng quan sát tín hiệu và giá trị được truyền và nhận từ robot. Thiết lập được robot chạy trong thời gian thực.
• Với thiết kế nhỏ gọn, cánh tay dễ dàng lắp đặt lên các xe tự hành AGV
• Sử dụng các bộ điều khiển tối ưu về tốc độ, ứng dụng trong việc vận
chuyển trong công nghiệp.
7.2 Hướng phát triển:
• Ta có thể sử dụng nhận diện vật dựa vào mã QR thay cho việc nhận diện
bằng màu sắc, kết quả mang lại giúp robot nhận diện vật chính xác hơn, khơng bị phụ thuộc vào màu sắc của vật cũng như các tín hiệu nhiễu từ mơi trường bên ngồi.
• Ta có thể thay đổi stereo camera bằng camera cảm biến chiều sâu bằng
lazer giúp tín hiệu nhận được nhanh hơn.
• Sử dụng ROS network như một cơng cụ giao tiếp giữa người dùng với
TÀI LIỆU THAM KHẢO
[1] Tài liệu tham khảo là sách:
Lê Hoài Quốc (2001), Chung Tấn Lâm, Nhập Môn Robot công nghiệp,
Nhà xuất bản Khoa học và Kỹ thuật.
Gs.Ths Nguyễn Thiện Phúc (1990), Robot công nghiệp.
Ninh Đức Tôn (2016), Dung sai và lắp ghép, Nhà xuất bản giáo dục. TS Nguyễn Hữu Lộc (2016), Cơ sở thiết kế máy, Nhà xuất bản Đại học
quốc gia tp.HCM.
Trịnh Chất – Lê Văn Uyển, Tính tốn thiết hệ dẫn động cơ khí tập 1 và
2, Nhà xuất bản bộ giáo dục.
[2] Tài liệu tham khảo là nghiên cứu khoa học:
Hanwen Yu, Qun Sun, Chong Wang, Yongjun Zhao December 12,
2019. Frequency response analysis of heavy-load palletizing robot considering eslactic deformation
Bryan Kelly a, J. Padayachee b and G. Bright. Quasi-serial
Manipulator for Advanced Manufacturing Systems.
Lv Mei-yu, LI Jin-quan, Duan Bing-lei, Fu Rong. 2012. The
Dynamics Analysis on a Type Palletizing Robot.
John J. Craig. Introduction to Robotics Mechanics and Control 3rd
edition
Bruno Siciliano, Lorenzo Sciavicco, Luigi Villani, Giuseppe Oriolo.
Robotics: Modelling, Planning and Control by
Min Xiu Kong, Wei You, Zhi Jiang Du, Li Ning Sun. Optimal design
for a 2-DOF high dyamic manipulator based onparallelogram mechanism.
Robot Master class của Peter Corke: https://robotacademy.net.au/ Các bài giảng online của Liang Zhao về robot trong lecture 9 và 10:
https://www.youtube.com/channel/UCR8fRMFnlfUmH7p0cgwBnVw
https://new.abb.com/products/robotics/industrial-robots/irb-460/irb-
460-data, 27/06/2021
http://roboconshop.com/, 27/06/2021 https://hshop.vn/, 27/06/2021
PHỤ LỤC
• Bản vẽ mơ hình 3D
Ghi chú có đính kèm file
Ghi chú có đính kèm file
Ghi chú có đính kèm theo file
• Bản vẽ điện: