Tiểu luận: Robot công nghiệp

Chia sẻ: Nguyen Van Khiem | Ngày: | Loại File: PDF | Số trang:21

Thêm vào BST

Báo xấu

700
lượt xem 120
download

Download Vui lòng tải xuống để xem tài liệu đầy đủ

Tiểu luận: Robot công nghiệp giới thiệu sơ bộ về Robot Kuka KR 1000, phương trình động học cho khâu công tác của Robot, Robot có 1 khớp quay và hai khớp tịnh tiến. Cùng tham khảo nhé.

Chủ đề:

Bình luận(0) Đăng nhập để gửi bình luận!

Lưu

Nội dung Text: Tiểu luận: Robot công nghiệp

----------------------------------------------------- ROBOT CÔNG NGHIỆP Trường ĐHCN Hà Nôi ----------------------------------------------------- Sinh viên thực hiện : Nguyễn Văn Khiêm
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP LỜI MỞ ĐẦU Vào đ ầu thập kỷ trước, ý tưởng đầu tiên về robot xuất hiện, thể hiện ước mơ cháy bỏng của con người là tạo ra những người máy có thể thay thế mình trong những công việc nặng nhọc, nhàm chán nguy hiểm. Vào khoảng năm 1940, mẫu robot đầu tiên ra đời tại phòng thí nghiệm quốc gia Oak Ridge và Argonne của Mỹ, để vận chuyển các hoạt chất phóng xạ. Đến thập kỷ 80 trên thế giới đó có tới 40 nghìn robot thuộc 500 kiểu do 200 hãng tham gia sản xuất. Ngày nay robot đ ã được sử dụng rộng rãi trong sản xuất nghiên cứu khoa học và đời sống. Đó là các thiết bị không thể thiếu được trên các hệ thống sản xuất, đặc biệt là các hệ thống sản xuất linh hoạt. Robot ngày càng khéo léo và thông minh, được coi là sản phẩm điển hình của 1 số ngành kỹ thuật. Cho đến nay, hầu hết các trường đại học kỹ thuật ở Việt Nam đó đưa môn kỹ thuật robot vào chương trình chính khó a. Môn học này chủ yếu được giảng dạy cho chủ yếu cho các chuyên ngành cơ khí, song khía cạnh riêng biệt của nó như kỹ thuật điều khiển, lập trình, mô phỏng cũng được các ngành khác rất quan tâm. Ngày 12 -10-2003 đó xảy ra một sự kiện, đánh dấu mốc phát triển mới trong lĩnh vực nghiên cứu, đào tạo và ứng dụng khoa học vào công nghệ robot tại Việt Nam: Hội khoa học Công nghệ robot Việt Nam được thành lập. Sự ra đời của hội phản ánh nhu cầu cấp thiết của cô ng nghiệp, quốc phòng và cuộc sống, đáp ứng được sự mong mỏi của đông đảo các nhà khoa học, các nhà sản xuất, các giáo sư, các nhà nghiên cứu sinh, sinh viên tại các trường đại học và tất cả những ai quan tâm đến robot. Kuka là một loại robot đang được sử dụng rất rộng rãi, với công suất lớn. Ngay sau đây chúng tôi sẽ đưa ra những hiểu biết cơ b ản về robot Kuka. Trong quá trình tìm hiểu và làm bài có nhiều thiếu sót rất mong được sự đóng góp và thông cảm của quý thầy cô và các b ạn. Xin trân thành cảm ơn! SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP PHẦN I: GIỚI THIỆU SƠ BỘ VỀ ROBOT KUKA KR 1000 N gay từ khi mới ra đời Kuka đó được củng cố chủ quyền với những sáng tạo rất năng động trong lĩnh vực robot. Điển hình kr kuka 1000 là một nhà vô địch mới trong các lớp học của robot nặng. Mạnh mẽ và năng động, các KR kuka 1000 luôn xử lý an to àn và chính xác với những thành phần nặng nhất. N ăng lực tải trọng của nó là 1.000 kg - m ức cao nhất của robot cụng nghiệp, với một chuỗi động học mở, với một tiếp cận ngang rất lớn là 3.200 mm và và vươn cao tới 5.000 mm. Nú giúp lo ại bỏ sự cần thiết cho các trạm thang máy, thiết bị nâng hạ khác. Thiết kế của nó hoàn toàn mới cho phép tốc độ và sức nâng rất lớn mà đối với những loại robot trước đây chỉ là mơ ước: thời gian chu kỳ đạt tới mức tối thiểu, tải trọng tối đa và rất linh hoạt. 1. Kuka kr 1000 cú những lợi thế vụ tận với các tính năng sau: Mạnh hơn bất kỳ robot nào: Tải trọng 1.000 kg, năng lực tải trọng cao nhất của tất cả các robot 6 trục với một chuỗi động học mở. Nhanh hơn: Vận tốc cao làm việc do FEM và tối ưu hóa trọng lượng, động cơ AC năng động và nhanh chóng thích nghi với điều kiện môi trường. không gian làm việc: bề ngang là 3.200 mm và chiều cao từ 5.000 mm mở ra các ứng dụng mới rất linh hoạt trong sản xuất. An toàn hơn: Kuka luôn giữ an toàn để bảo vệ máy tính dựa trên phần mềm và an toàn khi vận hành. Chính xác hơn: Sai số do thiết kế robot tối ưu. Nhiều phũng để cơ động : Không có hạn chế chuyển động trục phạm vi do năng lượng tích hợp và hệ thống cấp nước. Bảo dưỡng thấp hơn: Quỏ tải, bảo vệ, động cơ brushless AC servo được sử dụng trong robot, các trục chính được bôi trơn. Độ bền cao: Kuka có thể làm việc nơi mà người khác không thể làm việc với nhiệt độ cao như các xưởng đúc, các lò cán thép , độ chịu nhiệt và chịu mài món cực tốt không những thế Kuka 1000 có thể đề 2 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP với cả 2 loại axit và kiềm . kháng 2. Kuka kr 1000 là robot đi tiên phong Khi bạn lựa chọn robot kuka, bạn có thể chắc chắn rằng bạn đang có sự lựa chọn đúng đắn cho mọi lĩnh vực ứng dụng mà bạn chọn, Kuka là một loại robot tối ưu. N hờ chính năng lực của chúng ta trong phát triển và sản xuất cộng thêm sự chuyên môn của các nhà thiết kế trong các bộ điều khiển và phần mềm, Kuka cung cấp cho bạn các tính năng không chỉ hiện nay mà sẽ vẫn còn đ ược chứng minh hiệu quả của chú ng trên thế giới trong tương lai. Kuka kr đ iều khiển dựa trên Windows kuka C2, chính vì vậy bạn được hưởng lợi từ công nghệ đó được chứng minh dịch vụ hàng ngàn lần, nên sẽ đơn giản hóa việc cài đặt, và lập trình các robot của bạn. 3. Thông số kỹ thuật cơ bản của Kuka Kr 1000 Góc quay tối đa bề ngang là 300o 3 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP ROBOT KR KUKA 1000 Đặc điểm kỹ thuật 4 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP Tải trọng 1000kg Tải trọng bổ sung 50kg Tầm với phương ngang 3200mm Tầm với phương dọc 5000mm Số trục 6 trục Sai số ±0.1mm Trọng lượng 4690kg Vị trí gắn Sàn phẳng Bộ điều khiển Kr C2 Nhiệt độ hoạt động an +10oC đến +50oC (283K đến 323K) toàn J1(58 o/s (1.01 rad/s) J2, J3 (50 o/s (0.87 rad/s) Tốc độ chuyển động J4, J5 (60 o/s (1.05 rad/s) J6 (84 o/s (1.47 rad/s) J1 = ±150o J2 = +175o, -130o J3 = +145o, -110o Giới hạn chuyển động J4 = ±350o J5 = ±118o J6 = ±350o 4. Cá c ứng dụng của robot Kr kuka và tiềm năng tại thị trường Việt Nam: Robot kr Kura cú rất nhiều ứng dụng trong nền công nghiệp hiện đại, nó được sử dụng trên nhiều lĩnh vực khác nhau. Ví dụ: Được sử dụng trong công nghiệp ô tô ,công nghiệp chế tạo kính…… - Ở V iệt Nam robot kr kura đã bắt đầu được ứng dụng nhiều, ví dụ ở cụng ty Toyota Việt Nam,Yamaha… - Ở Việt Nam có một số cô ng ty bán sản phẩm này: CÔNG TY TNHH SẢN XUẤT VÀ THƯƠNG MẠI W.I.N Đ ịa chỉ: Vĩnh Thịnh, Đại Áng, Thanh Trì, Hà Nội….. PHẦN 2: PHƯƠNG TRÌNH ĐỘNG HỌC CHO KHÂU CÔNG TÁC CỦA ROBOT 5 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP 1. Mô hình và bảng thông số động học Denavit – Hatenberg. θi αi Khâu di ai θ0* 90o 1 l0 a0 θ1* 2 0 a2 0 θ2* -90o 3 0 0 θ3* 90o 4 l4 0 θ4* 90o 5 0 0 θ5* 6 l6 0 0 6 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP x 6 6 z l x 5 5 x z 4 4 l x 2 z 3 a z 2 x 3 z 1 x 1 z 0 l x 0 a Robot KR 1000 và các hệ tọa độ 2. Giải bài toán động học thuận robot: Ma trận mô tả hướng và vị trí khâu thứ i so với khâu thứ i-1:       Ti 1  Trans zi 1 , d * .Rot zi 1 ,   .Trans xi1 , a  .Rot xi1 ,   i 7 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP 0 0 0  cos i sini  1 0 0 1 0 0 ai  1 0 0 0 0  sin cos 0 0 0  0 cos sin 0 i i 1 0 0 i 1 0 0  Ti1   .  i i . . 0 0 1 di   0 1 0 0 0 1 0  0 sini cos i 0  0      0 0 0 1 0 0 0 1 0 0 0 1  0 0 0 1 cos  i  sin  i . cos  i sin  i . sin  i ai . cos  i   sin  ai . sin  i  cos  i . cos  i  cos i . sin  i Ti 1    i i 0 di  sin  i cos  i   0 0 0 1 Ta có các ma trận biến đổi thuần nhất giữa các hệ trục tọa độ theo D – H: * 0 sin 0* a0 cos 0*  cos  0  * * 0  cos 0*  sin 0 a0 sin  0  O1 TO0   0 l0  1 0   0 0 0 1   cos1*  sin 1* 0 l2 cos1*    * cos 1* 0 l2 sin 1*   sin 1 O2 TO1   0 0 0 1   0 0 0 1   * cos  2 0  sin  0     sin  2 cos  0 0 O3 TO2   0 0 1 0   0 0 0 1   8 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP cos3 0 sin  0   sin  0  cos 0 TO3    O4 0 l4  1 0   0 0 0 1   cos  4 0 sin  0     sin  4 0  cos  0 O5 TO4   0 0 1 0   0 0 0 1   cos 5 0  sin  0     sin  5 cos 0 0 O6 TO5   0 l6  0 1   0 0 0 1   Phương trình động học của khâu công tác: O6 O3 O5 O6 O1 O2 O4 T T .T .T .T .T .T O0  O0  O1  O2  O3  O4  O5  Để đ ơn giản khi viết phương trình động học, ta quy ước các hàm lượng giác như sau: Ci  Cos i S i  Sin i i  0,5 Thực hiện tính toán ma trận trên phần mềm Matlab như sau: Syms C0 C1 C2 C3 C4 C5; Syms S0 S1 S2 S3 S4 S5; Syms l0 a0 a2 l4 l6; 9 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP T 0  C 0 0 S 0 a0 * C 0; S 0 0  C 0 a 0 * S 0; 0 1 0 l 0; 0 0 0 1 T1  C1  S1 0 a 2 * C1; S1 C1 0 a 2 * S1; 0 0 1 0; 0 0 0 1 T 2  C 2 0  S 2 0; S 2 0 C 2 0; 0  1 0 0; 0 0 0 1 T 3  C 3 0 S 3 0; S 3 0  C 3 0; 0 1 0 l 4; 0 0 0 1 T 4  C 4 0 S 4 0; S 4 0  C 4 0; 0 1 0 0; 0 0 0 1 T 5  C 5  S 5 0 0; S 5 C 5 0 0; 0 0 1 l 6; 0 0 0 1 T 6  T 0 * T 1* T 2 * T 3 * T 4 * T 5 T6 = [((C1*C2-S1*S2)*C3*C4+(-C1*S2-S1*C2)*S4)*C5+(C1*C2- S1*S2)*S3*S5, -((C1*C2 -S1*S2)*C3*C4+(-C1*S2 - S1*C2)*S4)*S5+(C1*C2-S1*S2)*S3*C5, (C1*C2-S1*S2)*C3*S4-(- C1*S2-S1*C2)*C4, ((C1*C2-S1*S2)*C3*S4 -(-C1*S2 - S1*C2)*C4)*l6+(-C1*S2 -S1*C2)*l4+a2*C1] [((S1*C2+C1*S2)*C3*C4+(C1*C2- S1*S2)*S4)*C5+(S1*C2+C1*S2)*S3*S5, - ((S1*C2+C1*S2)*C3*C4+(C1*C2- S1*S2)*S4)*S5+(S1*C2+C1*S2)*S3*C5, (S1*C2+C1*S2)*C3*S4-(C1*C2 -S1*S2)*C4, ((S1*C2+C1*S2)*C3*S4-(C1*C2-S1*S2)*C4)*l6+(C1*C2- S1*S2)*l4+a2*S1] [-S4*C4*C5+C3*S5, S4*C4*S5+C3*C5, -S4^2, -S4^2*l6] [0, 0, 0, 1] Thay số cụ thể: a0 = 600; l0 = 1100; a2 = 1400 ; l4 = 1200; l6 =0. T6 mô tả hướng và vị trí của khâu chấp hành cuối: 10 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP Ta được hệ thống các phương trình động học của khâu công tác như sau: nx = ((C1*C2-S1*S2)*C3*C4+(-C1*S2-S1*C2)*S4)*C5+(C1*C2 - S1*S2)*S3*S5. ny = ((S1*C2+C1*S2)*C3*C4+(C1*C2- S1*S2)*S4)*C5+(S1*C2+C1*S2)*S3*S5 nz = -S4*C4*C5+C3*S5 Ox = -((C1*C2-S1*S2)*C3*C4+(-C1*S2-S1*C2)*S4)*S5+(C1*C2- S1*S2)*S3*C5 Oy = -((S1*C2+C1*S2)*C3*C4+(C1*C2- S1*S2)*S4)*S5+(S1*C2+C1*S2)*S3*C5 Oz = S4*C4*S5+C3*C5 ax = (C1*C2-S1*S2)*C3*S4-(-C1*S2-S1*C2)*C4 ay = (S1*C2+C1*S2)*C3*S4-(C1*C2 -S1*S2)*C4 11 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP az = -S4^2 px = ((C1*C2-S1*S2)*C3*S4-(-C1*S2-S1*C2)*C4)*l6+(-C1*S2- S1*C2)*l4+a2*C1 pY = ((S1*C2+C1*S2)*C3*S4-(C1*C2 -S1*S2)*C4)*l6+(C1*C2 - S1*S2)*l4+a2*S1 pz = -S4^2*l6 12 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP PHẦN 3: ROBOT CÓ MỘT KHỚP QUAY VÀ HAI KHỚP TỊNH TIẾN Đề số 14 Câu 3: Viết phương trình động học robot Giải bài toán động học q1  q10  0.1sin t q2  q20  0.3sin t q3  q30  0.6sin t  xp , y p , z p ? x p  x p (t ) y p  y p (t ) z p  z p (t )  q1 , q2 , q3 ? Xác định quy luật chuyển động, vân tốc và gia tốc biến khớp q1? Biết: q1(0) = 50; q1(2) = 150; q1(4) = 450; q1(5) = 75 0; gia tốc liên tục tại các điểm chốt. Vẽ các biểu đồ vị trí, vận tốc, gia tốc biến khớp q1? I. Phương trình động học: 13 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP 14 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP Bảng thông số động học D – H: θi αi Khâu di ai d 2* θ1* 1 0 0 -90o -90o 2 l2 a3 d 3* 3 0 0 0 Các ma trận biến đổi thuần nhất theo D – H: 0 0 1 0 cos 1  sin 1 0 0   0  a3    sin 1 cos  1 0 0  T O3   1 0  TO   O 2 ; O2  0 1 0 l2  0 1 d2  1 0     0 0 0 1 0 0 0 1   1 00 0 0 1 0 0   O TO34  0 0 1 d3    0 0 0 1 Phương trình động học của robot: TO1 4  TO1 2 .TOO3 .TO34 O O O 2  sin 1 0 cos 1 cos 1 * d 3  sin 1 * a3   cos  0 sin 1 sin 1 * d 3  cos 1 * a3    1 O TO1 4 0  1 l2  d 2 0   0 0 0 1  Nhìn vào ma trận phương trình động học của robot ta thấy vị trí của khâu công tác: x p  cos  1 * d 3  sin 1 * a3 y p  sin  1 * d 3  cos 1 * a3 z p  l2  d 2 15 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP Thay các giá trị  q1  q10  0.1sin t  q2  q20  0.3 sin t q  q  0.6 sin t 3 30 Ta được xp  cosq10  0.1sint  *q30  0.6sint   sinq10  0.1sint  * a3 y p  sinq10  0.1sint  * q30  0.6sint   cosq10  0.1sint  * a3 z p  l2  q20  0.3sint II. BÀI TOÁN ĐỘNG HỌC NGƯỢC: x p t   cos 1 * d 3  sin 1 * a3 1 2  y p t   sin 1 * d 3  cos 1 * a3 z p t   l2  d 2 Lượng tịnh tiến d 2  z p t   l 2 Ta có: Bình phương 2 vế của (1) và (2 ) rồi cộng vào ta tìm được lượng tịnh tiến d 3  x p t   y p t   a3 2 2 2 Từ (1) rút sin 1 thay vào (2) ta có: x p t   y p t  cos  1  x 2 t   y 2 t   a 3  a 3 2 p p   x p t   y p t      1  arccos  x 2 t   y 2 t   a 3  a3   2 p  p \ III. QUY LUẬT CHUYỂN ĐỘNG CỦA KHÂU 1 Ta có: quy luật chuyển động của khớp 1 có dạng sau: 16 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP 1 t   a3t 3  a2t 2  a1t  a0  1 t   3a3t 2  2a2t  a1  1 t   6a3t  2a2 Tại các thời điểm đã cho: q1(0) = 5 0; q1(2) = 150; q1(4) = 450; q 1(5) = 750 Ta có hệ phương trình sau: a0  5   4a  2a  a  5 3 2 1  16a3  4a 2  a1  10 25a3  5a2  a1  14   a0  5  a 4 1  a2   1 2  a3  1 2  Vậy quy luật chuyển động của khâu 1 là: 1 1 1 t   t 3  t 2  4t  5 2 2 Và vận tốc và gia tốc:  3 1 t   t 2  t  4 2  1 t   3t  1 *) Đồ thị hàm số: 17 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP 13 12 a. Đồ thị hàm số của: 1 t   t  t  4t  5 2 2  32 b. Đồ thị hàm số của vận tốc: 1 t   t t  4 2 18 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH
TRƯỜNG ĐHCN HÀ NỘI ROBOT CÔNG NGHIỆP 19 SVTH: NGUY ỄN VĂN KHIÊM GVHD: KHỔNG MINH