
























































Study with the several resources on Docsity
Earn points by helping other students or get them with a premium plan
Prepare for your exams
Study with the several resources on Docsity
Earn points to download
Earn points by helping other students or get them with a premium plan
reports for my cource Robot. it includes my designs about Arm robot and code controll this arm robot
Typology: Summaries
1 / 64
This page cannot be seen from the preview
Don't miss anything!

























































----------------- ⸙∆ ⸙----------------- ĐỒ ÁN ROBOT Ứng dụng xử lý ảnh và cánh tay robot 3 bậc tự do phân loại sản phẩm theo hình dạng GVHD : TS.Trần Đức Thiện SVTH : Lê Thành Long 21151125 SVTH : Nguyễn Chí Tâm 21151161 TP. HỒ CHÍ MINH – 12025
LỜI CẢM ƠN Chúng em xin bày tỏ lòng biết ơn sâu sắc đến thầy Trần Đức Thiện, người đã tận tình hướng dẫn và truyền đạt những kiến thức quý báu trong suốt quá trình thực tập và thực hiện đề tài "Thiết kế và mô phỏng robot 3 bậc tự do" này. Thầy không chỉ cung cấp những kiến thức nền tảng và chuyên sâu về cơ khí, điều khiển tự động và lập trình mà còn luôn sẵn lòng hỗ trợ, giải đáp những thắc mắc và định hướng cho chúng em trong từng bước nghiên cứu. Sự nhiệt tình và tâm huyết của thầy đã tạo động lực lớn giúp chúng em hoàn thành tốt bài báo cáo này. Những bài giảng, tài liệu và hướng dẫn của thầy đã giúp chúng em hiểu rõ hơn về tầm quan trọng của việc thiết kế và mô phỏng robot trong thực tiễn. Qua đó, chúng em đã học được cách áp dụng lý thuyết vào thực tế, từ việc thiết kế mô hình trên phần mềm SolidWorks đến việc mô phỏng và kiểm tra các thông số trong MATLAB Simulink. Chúng em xin chân thành cảm ơn thầy vì tất cả sự hỗ trợ và chỉ dẫn quý báu. Những kinh nghiệm và kỹ năng chúng em học được từ thầy sẽ là hành trang quý báu cho con đường học tập và sự nghiệp sau này. Kính chúc thầy luôn mạnh khỏe, hạnh phúc và tiếp tục thành công trong sự nghiệp giảng dạy và nghiên cứu Thành phố Hồ Chí Minh, ngày 5 tháng 1 năm 202 5 Nhóm thực hiện đề tài i
- 2.5.3 Phần mềm MATLAB.......................................................................... - 2.5.5 Kiểm chứng động học nghịch............................................................. - 2.5.6 Tính toán & kiểm chứng quy hoạch quỹ đạo...................................... CHƯƠNG 1. TỔNG QUAN ĐỀ TÀI
1.1.1 Lý do thực hiên đề tài Trong cuộc cách mạng công nghiệp 4.0, tự động hóa đang đóng vai trò quan trọng trong việc nâng cao hiệu quả sản xuất và dịch vụ. Ở các nhà máy hiện đại, các quy trình như phân loại, lắp ráp và vận chuyển được thực hiện tự động nhờ các hệ thống robot tiên tiến. Việc sử dụng robot giúp giảm thiểu sự phụ thuộc vào lao động thủ công, tăng năng suất và đảm bảo chất lượng sản phẩm nhờ khả năng hoạt động ổn định, chính xác và nhanh chóng. Một trong những ứng dụng phổ biến của tự động hóa là phân loại sản phẩm dựa trên hình dáng. Việc phân loại theo hình dáng đóng vai trò quan trọng trong nhiều ngành công nghiệp, bao gồm chế biến thực phẩm, sản xuất linh kiện điện tử và đóng gói hàng hóa. Các hệ thống robot phân loại theo hình dáng có thể thay thế con người trong những công việc lặp đi lặp lại, giúp giảm thiểu sai sót và đẩy nhanh tốc độ quy trình. Robot phân loại theo hình dáng có thể nhận biết các đặc điểm như chiều dài, bề ngang, độ cong hay góc cạnh của sản phẩm, từ đó sắp xếp chúng vào các nhóm phù hợp một cách chính xác và nhanh chóng. Ứng dụng của robot trong phân loại theo hình dáng không chỉ giúp các nhà máy hoạt động hiệu quả hơn mà còn giảm thiểu chi phí, nâng cao chất lượng sản phẩm và cải thiện an toàn lao động khi công nhân không phải trực tiếp thực hiện các công việc lặp lại. Hình 1 : Một trong những ứng dụng cánh tay robot và xử lý ảnh ĐỒ ÁN KỸ THUẬT ROBOT 1
1.1.2 Ứng dụng kết hợp giữa Robot và công nghệ xử lý ảnh Sự kết hợp giữa công nghệ robot và xử lý ảnh đang mang lại các giải pháp tự động hóa thông minh, trong đó nổi bật là hệ thống cánh tay robot phân loại vật thể dựa trên hình dạng. Hệ thống này giúp nâng cao hiệu quả, độ chính xác trong sản xuất, đồng thời giảm gánh nặng lao động thủ công. Đề tài “Ứng dụng xử lý ảnh và cánh tay robot 3 bậc tự do phân loại vật thể theo hình dạng” hướng đến nghiên cứu và phát triển hệ thống robot tự động, tích hợp xử lý ảnh để nhận diện và phân loại vật thể chính xác. Với tiềm năng ứng dụng cao trong công nghiệp, đề tài không chỉ phục vụ học tập, nghiên cứu về động học và điều khiển robot mà còn trang bị kỹ năng lập trình và sử dụng công cụ như SolidWorks, MATLAB, và Python. Dự án cung cấp cơ hội thực hành từ thiết kế lộ trình chuyển động, tính toán không gian làm việc đến phát triển hệ thống điều khiển, giúp chúng em ứng dụng công nghệ vào thực tế và phát triển năng lực nghiên cứu chuyên sâu.
Mục tiêu chính của đề tài là thiết kế và chế tạo một mô hình cánh tay robot 3 bậc tự do (3-DOF), mô phỏng được các chuyển động cơ bản trong không gian ba chiều và có khả năng phân loại vật thể theo màu sắc thông qua hệ thống xử lý ảnh. Các mục tiêu cụ thể gồm:
tích hình ảnh thu được từ camera, từ đó gửi dữ liệu đến bộ điều khiển để thực hiện thao tác phân loại chính xác
Để đạt được mục tiêu đề ra, đề tài sử dụng các phương pháp nghiên cứu kết hợp giữa lý thuyết và thực nghiệm. Trước hết, phương pháp phân tích tài liệu được áp dụng nhằm tổng hợp kiến thức về robot 3 bậc tự do (3 DOF), các hệ thống phân loại sản phẩm và công nghệ xử lý ảnh từ các tài liệu chuyên ngành, bài báo khoa học. Tiếp theo, phương pháp thiết kế và mô phỏng được sử dụng để phát triển mô hình cơ khí của robot 3 DOF, xây dựng thuật toán và thử nghiệm các thuật toán xử lý ảnh trong môi trường ảo trước khi thực nghiệm trên phần cứng. Phương pháp thực nghiệm là trọng tâm, bao gồm việc triển khai robot thực tế, cài đặt và tích hợp các động cơ, camera xử lý ảnh, bộ điều khiển. Đồng thời, các thuật toán xử lý ảnh và điều khiển được hiệu chỉnh thông qua các thử nghiệm phân loại sản phẩm. Ngoài ra, phương pháp phân tích và đánh giá kết quả được áp dụng để so sánh kết quả thực nghiệm với mục tiêu đề ra, xác định những hạn chế của hệ thống và đề xuất hướng cải tiến. Việc kết hợp các phương pháp này đảm bảo tính khoa học và khả năng thực tiễn của nghiên cứu. ĐỒ ÁN KỸ THUẬT ROBOT 4
CHƯƠNG 2. CƠ SỞ LÝ THUYẾT
Lực là bất kì ảnh hưởng nào làm cho một vật thể chịu sự thay đổi về hình dạng hay làm ảnh hưởng đến chuyển động của nó. Nói cách khác lực là nguyên nhân làm cho một vật có khối lượng thay đổi vận tốc hay làm biến dạng vật thể. Một số ví dụ đơn giản về lực: Khi bạn đá quả bóng, bạn tác động một lực lên nó. Khi bạn ngồi xuống, bạn chịu tác động của lực hấp dẫn trái đất. Mặt trăng chịu lực hấp dẫn Trái Đất nên xoay quanh Trái Đất với một quỹ đạo nhất định, ... Tóm lại lực nó có thể làm thay đổi hình dạng hoặc cấu trúc của một vật thể tùy vào độ lớn và phương, chiều của lực. Trong khi lực tác động lên một vật sẽ tạo cho vật một chuyển động thẳng, tịnh tiến, thì Torque được định nghĩa là khuynh hướng của lực làm xoay một vật quanh một trục cố định. Nói nôm na Torque cũng tương tự như lực nhưng sẽ tạo chuyển động xoay cho vật. Một ví dụ đơn giản: Ta muốn xoay một con ốc nhưng nếu sử dụng tay vặn thông thường sẽ khó có thể mở con ốc ra, do đó ta sẽ dùng cờ lê để vặn ốc ra như ta tác động một lực vào cờ lê và cờ lê có độ dài là d, d này được coi là cánh tay đòn, giúp cho việc vặn ốc trở nên dễ dàng hơn. Ta có công thức tính Torque xoay quanh trục của con ốc là: (2.1) Theo như công thức độ lớn của τ sẽ tỉ lệ thuận với lực F tác động và độ dài cánh tay đòn d. Với một lực cố đinh, cánh tay đòn càng dài thì τ sẽ càng lớn. ĐỒ ÁN KỸ THUẬT ROBOT 5
Hình 3 : Robot 3 DOF trên SOLIDWORK Robot 3 bậc tự do (3 DOF) là một dạng robot công nghiệp phổ biến, được thiết kế với ba bậc tự do bao gồm hai chuyển động quay và một chuyển động tịnh tiến. Với cấu trúc đơn giản, robot này có khả năng thao tác chính xác và linh hoạt trong không gian ba chiều, thường được ứng dụng trong các ngành công nghiệp đòi hỏi tốc độ và độ chính xác cao như lắp ráp, đóng gói, và xử lý vật liệu. Điểm nổi bật của robot 3 DOF là sự tối ưu trong chuyển động trên mặt phẳng (XY) và khả năng duy trì độ ổn định trong phương thẳng đứng (Z), giúp nó thích nghi tốt với các nhiệm vụ trong không gian làm việc hạn chế. Cấu trúc cơ bản của robot bao gồm một đế cố định, hai khớp quay để điều hướng trên mặt phẳng và một trục tịnh tiến để thay đổi độ cao. Nhờ thiết kế nhỏ gọn, dễ vận hành và chi phí hợp lý, robot 3 DOF đã trở thành một lựa chọn lý tưởng trong các dây chuyền sản xuất tự động hóa hiện đại, đáp ứng nhu cầu về hiệu suất và tính kinh tế. ĐỒ ÁN KỸ THUẬT ROBOT 7
2.4.1 Động học thuận Động học thuận (Forward Kinematics) là quá trình xác định vị trí và hướng của đầu cánh tay robot dựa trên các thông số đầu vào là góc quay hoặc chuyển động tịnh tiến tại các khớp. Bằng cách sử dụng thông số điều khiển đã biết ở từng khớp, ta có thể tính toán vị trí và phương hướng của điểm đầu cuối (end-effector) trong không gian 3 chiều. Kết quả từ động học thuận thường được sử dụng để lập trình robot thực hiện các nhiệm vụ định trước, trong đó thông tin về các góc khớp đã được cung cấp. 2.4.2 Động học nghịch Động học nghịch (Inverse Kinematics) là bài toán tính toán ngược so với động học thuận, nhằm tìm ra các thông số khớp (góc quay hoặc khoảng cách tịnh tiến) cần thiết để đưa điểm đầu cuối của robot đến một vị trí và hướng mong muốn. Khi vị trí và hướng cụ thể của end-effector đã được xác định, động học nghịch giúp tính toán các góc khớp phù hợp để đạt được trạng thái đó. Quá trình này thường được sử dụng trong điều khiển robot để đưa end-effector đến các vị trí đích chính xác trong không gian làm việc. 2.4.3 Quy hoạch quỹ đạo Quy hoạch quỹ đạo là một phần nhỏ của một vấn đề tổng thể như là dẫn đường (navigation) hay quy hoạch chuyển động (Motion planning). Hệ thống cấp bậc điển hình cho quy hoạch chuyển động như sau:
l 9 Tọa độ X đặt robot so với góc bàn 250 mm l 1 0 Tọa độ Y đặt robot so với góc bàn 180 mm D 1 Khoảng cách giữa trục link 1 và link 2 -31 mm Bảng 2 : Bảng DH
1 0 0 l 0 θ₁ 2 l 1 90 0 θ₂
Bảng 3 : Giải thích ký hiệu bảng DH
Ta có ma trận chuyển đổi giữa hệ tọa độ sang hệ tọa độ là: 111 Equation Chapter (Next) Section 1 212 Equation Chapter (Next) Section 1 313 Equation Chapter (Next) Section 1 (2.2) Trong đó: = cos( ); = sin( ); = cos( ); = sin ( ) Từ công thức (1.1) ta tìm ma trận chuyển đổi hệ trục tọa độ {1} sang hệ trục tọa độ {0}: 1^ T 0 = [ c 1 − s 1 0 0 s 1 c 1 0 0 0 0 1 l 0 0 0 0 1 ]
Ma trận chuyển đổi hệ trục tọa độ {2} sang hệ trục tọa độ {1}: 2^ T 1 =
c 2 − s 2 0 0 0 0 − 1 0 s 2 c 2 0 0 0 0 0 1
Ma trận chuyển đổi hệ trục tọa độ {3} sang hệ trục tọa độ {2}: 3^ T 2 =
c 3 − s 3 0 l 2 s 3 c 3 0 0 0 0 1 0 0 0 0 1
Ma trận chuyển đổi hệ trục tọa độ {3} sang hệ trục tọa độ {0}: 3^ T 0 = 1 T 0 2 T 1 3 T 2 =
c 23 c 1 − s 23 c 1 s 1 c 1 ( l 1 + l 2 c 2 ) c 23 s 1 − s 23 s 1 − c 1 s 1 ( l 1 + l 2 c 2 ) s 23 c 23 0 l 0 + l 2 s 2 0 0 0 1
Biểu diễn vị trí điểm EE trong hệ tọa độ {3}: ¿
l 3 0
Biểu diễn vị trí điểm EE trong hệ tọa độ {0}:
0
l 0 + l 3 s 23 + l 2 s 2 1
Trong đó và 2.5.2 Động học nghịch Từ phương trình (2.8) ta tiến hành đặt x, y, z theo lần lượt như sau: (2.9) (2.10) ĐỒ ÁN KỸ THUẬT ROBOT 11