Đặt vấn đề [1.] Giới thiệu chung về Robot. Khái niệm robot ra đời đầu tiên vào năm gày 0/10/1922 tại NewYork, khi nhà soạn kịch người Tiệp Khắc Karen Kapek đã tưởng tượng ra một cỗ máy hoạt động một cách tự động. Và nóNó là niềểm mơ ước của con người lúc đóấy., Từ đó ý tưởng thiết kế, chế tạo Robot đã luôn thôi thúc con người. Đến năm 1948, tại phòng thí nghiệm quốc gia Argonne, Goertz đã chế tạo thành công tay máy đôi (Mmaster-Sslave Mmanipulator).
Đến năm 1954, Goertz đã chế tạo tay máy đôi sử dụng động cơ Sservo và có thể nhận biết được lực tác động lên khâu cuối. Ngày nay Rô bô hoặc c Rôbốt, Rô-bốt (tiếng Anh: Robot) được định nghĩa là một loại máy có thể thực hiện những công việc một cách tự động bằng sự điều khiển của máy tính hoặc các vi mạch điện tử được lập trình. Robot được dùng trong nhiều công việc như y tế, giáo dục, dịch vụ, vũ trụ, … nhưng đa số được sử dụng trong các ngành công nghiệp (khoảng 80%). SV: Nguyễn Công Tướng 9 GVHD: Lê Thị Thu Thủy Đồ án Robot công nghiệp Đồ án Robot công nghiệp____________________________________________________ Hình 1: Robot Shakey thời kỳ đầu Về mặt kỹ thuật, Robot công nghiệp ngày nay có nguồn gốc từ hai lĩnh vực kỹ thuật: Cơ cấu điều khiển từ xa (trong chiến tranh thế giới thứ II) và các máy công cụ điều khiển số NC đáp ứng gia công các chi tiết máy bay (1949).
Robot công nghiệp (hay người máy công nghiệp) được đặt tên cho những dáng vấp và một vài chức năng như tay người để thực hiện một số thao tác sản xuất. Hình 2: Một số robot hiện đại ngày nay Robot công nghiệp ngày nay được tạo ra theo những dáng vấp và một vài chức năng như tay người để thực hiện một số thao tác SV: Nguyễn Công Tướng 10 GVHD: Lê Thị Thu Thủy Đồ án Robot công nghiệp Đồ án Robot công nghiệp____________________________________________________ sản xuất. Và Scara là một trong những robot công nghiệp đang được sử dụng rộng rãi.] Giới thiệu về Robot ScaraScara: Robot SCARA (Selectively Compliant Articulated Robot Arm) có nghĩa là có thể lựa chọn dễ dàng khớp nối cánh tay Robot.Từ khi mới ra đời robot công nghiệp được áp dụng trong nhiều lĩnh vực dưới góc độ thay thế sức người. Nhờ vậy các dây chuyền sản xuất được tổ chức lại, năng suất và hiệu quả sản xuất tăng lên rõ rệt.
Trong các robot được sử dụng trong công việc sản xuất thì SCARA Scara là robot được sử dụng tương đối rộng rãi trong nhiều lĩnh vực khác nhau. Vì SCARAScara là robot chỉ có 3 bậc tự do và chuyển động của Robot Scara đơn giản, dễ dàng điều khiển nên nó được sử dụng khá phổ biến trong công nghiệp. nên thiết kế gọn và không gian làm việc cũng tương đối linh hoạt. Một robot SCARAScara có 3 trục và ba bậc tự do.
Tất cả các trục được thiết kế với chuỗi Kinematic, bắt đầu từ một nguồn gốc của trục đầu tiên, các trục tiếp theo được tính toán với vị trí, phương của trục trước đó. Trong một robot SCARAScara, các trục thứ nhất và thứ hai quay, trục thứ ba là khớp trượt hay tịnh tiến. Tay kẹp được gắn trên phần cuối của trục Z. SCARAScara có thể cho phép bán kính hành động từ 100 mm đến 1.200 mm, với dung tích tải từ 1 kg đến 200 kg: Hình 3: Sơ đồ và hình dáng thực của robot ScaraScara SV: Nguyễn Công Tướng 11 GVHD: Lê Thị Thu Thủy Đồ án Robot công nghiệp Đồ án Robot công nghiệp____________________________________________________ Loại robot này được phát triển đáp ứng với tốc độ cao và tính lặp lại trong lắp ráp hàng loạt, chẳng hạn như Pick-and-Place từ nơi này đến nơi khác.
Điểm mạnh nằm ở lực lượng xử lý cao dọc (đôi khi> 300N). Điểm tiêu cực là chúng ta chỉ có thể làm việc trên một mặt phẳng nằm ngang. Ví dụ ứng dụng của robot ScaraScara: Hình 4: Ứng dụng robot Scara phân loại thuốc Hình 5: Ứng dụng robot Scara phân loại thuốc [1.] Kết luận Do Robot ScaraScara chỉ có 3 bậc tự do, cơ cấu thiết kế không quá phức tạp nên việc nghiên cứu và chế tạo được ưu tiên đầu tiên trong các lựa chon phù hợp với công việc đòi hỏi các công việc đơn giản nhưng cần tốc độ cao vì ưu điểm của ScaraScara làm làm việc linh hoạt. Ứng dụng của robot ScaraScara khá rộng rãi.
Việc ứng dụng được sử dụng rất nhiều trong thực tế nhiều nhất là dùng để phân loại sản phẩm, di chuyển xếp đặt vị trí sản phẩm theo yêu cầu. Vì lý do đó nên chúng ta cần nghiên cứu sâu hơn về hoạt động của Scara và ứng dụng của nó trong công nghiệp. Ví dụ ứng dụng của robot Scara: SV: Nguyễn Công Tướng 12 GVHD: Lê Thị Thu Thủy Đồ án Robot công nghiệp Đồ án Robot công nghiệp____________________________________________________ Hình 6: Ứng dụng robot Scara phân loại thuốc Vì lý do đó nên chúng ta cần nghiên cứu sâu hơn về hoạt động của Scara và ứng dụng của nó trong công nghiệp. SV: Nguyễn Công Tướng 13 GVHD: Lê Thị Thu Thủy Đồ án Robot công nghiệp Đồ án Robot công nghiệp____________________________________________________ SV: Nguyễn Công Tướng 14 GVHD: Lê Thị Thu Thủy Đồ án Robot công nghiệp Đồ án Robot công nghiệp____________________________________________________ Chương 2: XÂY DỰNG MÔ HÌNH ĐỘNG HỌC ROBOT XÂY DỰNG MÔ HÌNH ĐỘNG HỌC ROBOT Động học robot nghiên cứu các đặc trưng của chuyển động mà không quan tâm đến nguyên nhân gây ra chúng như lực mà mô men.
Khoa học động học nghiên cứu về vị trí, vận tốc, gia tốc. Do đó, động học chỉ liên quan đến hình học và thời gian thay đổi của chuyển dộng. Sự thay đổi của các khâu của robot liên quan đến hướng và vị trí của khâu chấp hành cuối cùng bởi sự ràng buộc của các khớp. Những quan hệ động học đó là trọng tâm của việc nghiên cứu động học robot.
Việc nghiên cứu động học có hai vấn đề: Phân tích động học và tổng hợp động học. Tuy nhiên vấn đề phân tích động học và tổng hợp động học luôn liên quan đến nhau. Nội dung nghiên cứu động học của robot là việc tìm ra quan hệ chuyển động của các khâu gồm 2 bài toán là: Bài toán động học thuận và bài toán động học ngược. Trong việc lập trình cho robot điều cơ bản là đặt ra các yêu cầu về vị trí của điểm tác động cuối và hướng của khâu cuối, vân tốc và gia tốc của khâu bất kì trong không gian.
Vấn đề ở đâu là tìm tất cả các bộ thông số có thể chấp nhận được về sự thay đổi của các khâu hoạt động và các đạo hàm tương ứng của chúng xảy ra ở khâu chấp hành cuối cùng để đặt các yêu cầu về hướng và vị trí, đó chính là các thông số hoạt động (( bài toán động học thuận ) hay từ yêu cầu vị trí và hướng của khâu chấp hành cuối tìm ra các thông số tương ứng của các khâu trước đó ( bài toán động học ngược ) Tổng hợp động học chính là quá trình ngược lại của việc phân tích động học. Trong trường hợp này, nhà thiết kế cần đặt ra được những robot hay máy mới, điều đó đòi hỏi những thay đổi nhất định về mặt động học. Cụ thể, khi có các thông số vị trí và hướng (cùng vận tốc và gia tốc ) của khâu chấp hành cuối cùng, chúng ta cần xác định các thay đổi tương ứng ở các khâu hoạt động và cấu trúc hình học của robot. SV: Nguyễn Công Tướng 15 GVHD: Lê Thị Thu Thủy Đồ án Robot công nghiệp Đồ án Robot công nghiệp____________________________________________________ 1.] Cơ sở xây dựng mô hình động học trên robot công nghiệp 1.] Quy tắc Denavit – Hartenberg (D-H) Xét hai khâu ii-11 và ii liên ki khâu tenberg khớp bản lề, trục quay của khớp có phương bất kì và hai khâu không nằm trong những mặt phẳng song song nhau.
Hình 7: Mối quan hệ giữa các khâu và hệ tọa độ - Sau khi được thiết lập, vị trí của hệ Oixiyizi so với hệ Oi-1xi-1yi-1zi-1 hoàn toàn được xác định nhờ 4 thông số: + ai : khoảng cách giữa 2 khớp liên tiếp theo phương xi. + di : khoảng cách giữa 2 khớp liên tiếp theo phương zi-1. + i : góc quay quanh trục xi giữa zi-1 và zi. + i : góc quay quanh trục zi-1 giữa xi-1 và xi - Nếu khớp i là khớp quay : i là biến khớp di , ai , i là tham số do thiết kế tạo ra.
- Nếu khớp i là khớp tịnh tiến : di là biến khớp i , ai , i : tham số phụ thuộc kết cấu. Ma trận chuyển đổi giữa hệ trục i và i -1. SV: Nguyễn Công Tướng 16 GVHD: Lê Thị Thu Thủy Đồ án Robot công nghiệp Đồ án Robot công nghiệp____________________________________________________ Để chuyển từ hệ Oi-1xi-1yi-1zi-1 sang hệ Oixiyizi là thực hiện liên tiếp 4 phép biến đổi toạ độ : Quay quanh zi-1một góc i : Rz-1,i Tịnh tiến dọc zi-1 một đoạn di : Tz-1, di Tịnh tiến dọc xi xi một đoạn ai: Tx, ai Quay quanh xi một góc i : Rx,i , Pi = Rz-1,i. R x ,i Ma trận biến hình tổng hợp của các phép quay trên A i : i-1 i-1 A i ( q i ) = R z - 1 ,i.
cos❑i i-1 sin ❑i cos❑i. sin ❑i Ai = 0 sin ❑i cos❑i di 0 0 0 1 Ma trận thể hiện hướng và vị trí của tay kẹp so với hệêi trục tọa độ gốc 0x0y0z0 là: SV: Nguyễn Công Tướng 17 GVHD: Lê Thị Thu Thủy Đồ án Robot công nghiệp Đồ án Robot công nghiệp____________________________________________________ [ ] nx sx ax px 0 0 1 2 4 n s ay py T E= A 6 = A 1. A 3 = y y nz sz az pz 0 0 0 1 1.] Bài toán động học thuận Cho các giá trị biến khớp q1, q2, q3, q4, q5, q6 tìm ma trận toạ độ thực Hệ phương trình động học thuận của robot: { s x = f 1 ( q1 , q2 , q3 , q 4 , q5 , q6 ) a y = f 2 ( q1 , q2 , q3 , q 4 , q5 , q6 ) a x = f 3 ( q1 , q2 , q3 , q 4 , q5 , q6 ) P x = f 4 ( q1 , q2 , q3 , q 4 , q5 , q6 ) P y = f 5 ( q1 , q2 , q3 , q 4 , q5 , q6 ) P z = f 6 ( q1 , q2 , q3 , q 4 , q5 , q6 ) 1.] Bài toán động học ngược Cho vị trí và hướng của tay kẹp tức là biết ma trân tọa độ thực T E.