Báo cáo Các kết quả nghiên cứu theo nhiệm vụ 2 - Đề tài kc.03.08 - Nhóm sản phẩm robot SCA

247 trang yendo 4160

Download

Bạn đang xem 20 trang mẫu của tài liệu "Báo cáo Các kết quả nghiên cứu theo nhiệm vụ 2 - Đề tài kc.03.08 - Nhóm sản phẩm robot SCA", để tải tài liệu gốc về máy bạn click vào nút DOWNLOAD ở trên

Tài liệu đính kèm:

bao_cao_cac_ket_qua_nghien_cuu_theo_nhiem_vu_2_de_tai_kc_03.pdf

Nội dung text: Báo cáo Các kết quả nghiên cứu theo nhiệm vụ 2 - Đề tài kc.03.08 - Nhóm sản phẩm robot SCA

BỘ KHOA HỌC VÀ CÔNG NGHỆ CHƯƠNG TRÌNH KC.03 YZ YZ YZ YZ YZ YZY YZ YZ YZY YZ YZ YZY “NGHIÊN CỨU THIẾT KẾ, CHẾ TẠO CÁC ROBOT THÔNG MINH PHỤC VỤ CHO CÁC ỨNG DỤNG QUAN TRỌNG” MÃ SỐ: KC.03.08 BÁO CÁO CÁC KẾT QUẢ NGHIÊN CỨU THEO NHIỆM VỤ 2 - ĐỀ TÀI KC.03.08 NHÓM SẢN PHẨM ROBOT SCA 6246-2 25/12/2006 HÀ NỘI 2006
Môc lôc Më ®Çu 4 PhÇn 1: 11 Robot SCATM khÝ nÐn I. Giíi thiÖu chung 11 II. X©y dùng c¸c m« h×nh ®éng häc vµ ®éng lùc häc Robot SCATM 12 2.1. ThiÕt lËp ph−¬ng tr×nh ®éng häc Robot SCATM 12 2.1.1. X¸c ®Þnh c¸c hÖ täa ®é cña Robot SCATM 12 2.1.2. B¶ng th«ng sè DH cña Robot SCATM 12 2.1.3. X¸c ®Þnh c¸c ma trËn cña Robot SCATM 12 2.1.4. TÝnh c¸c ma trËn T cña Robot SCATM 13 2.1.5. Ph−¬ng tr×nh ®éng häc Robot SCATM 14 2.2. ThiÕt lËp bµi to¸n ®éng häc ng−îc Robot SCATM 15 2.3. X©y dùng m« h×nh ®éng lùc häc Robot SCATM 19 III. ThiÕt kÕ c¶i tiÕn chÕ t¹o Robot SCATM khÝ nÐn 36 PhÇn 2: 40 M«®un quay dïng b¸nh r¨ng con l¨n I. Giíi thiÖu chung 40 II. Nhu cÇu cÇn cã m«®un quay dïng BRCL 41 III. CÊu t¹o vµ nguyªn t¾c lµm viÖc 46 3.1. C¸c bé phËn chñ yÕu cña hép gi¶m tèc BRCL 46 3.2. Nguyªn lý lµm viÖc cña hép gi¶m tèc BRCL 48 IV. D¹ng r¨ng b¸nh r¨ng con l¨n 49 4.1. D¹ng r¨ng l−în sãng 49 4.2. X©y dùng biªn h×nh r¨ng con l¨n 52 4.3. Ph−¬ng ph¸p chän d¹ng r¨ng hîp lý 54 V. Ph−¬ng ph¸p chÕ t¹o BRCL 56 2
VI. LËp tr×nh gia c«ng trªnm¸y c¾t d©y CNC 57 VII. Sö dông BRCL cho m«dun quay Robot lµ gi¶i ph¸p hîp lý nhÊt 58 VIII. ChuÈn hãa thiÕt kÕ hép gi¶m tèc BRCL 59 IX. M«®un quay BRCL 69 X. Mét sè s¶n phÈm ®· chÕ t¹o 72 XI. KÕt luËn 82 PhÇn 3: 83 m«®un d©y chuyÒn s¶n xuÊt tù ®éng I. Giíi thiÖu chung 83 II. HÖ thèng b¨ng chuyÒn 84 III. HÖ thèng ®iÒu khiÓn 98 3.1. Nguyªn t¾c ho¹t ®éng 98 3.2. C¸c bé phËn chñ yÕu 99 PhÇn 4: 102 C¬ së tÝnh to¸n vµ x©y dùng c¸c ch−¬ng tr×nh m¸y tÝnh vµ ®iÒu khiÓn I. Giíi thiÖu chung 102 II. Ch−¬ng tr×nh tù ®éng thiÕt lËp 103 III. Ch−¬ng tr×nh kiÓm nghiÖm lêi gi¶i 105 IV. Ch−¬ng tr×nh phÇn mÒm tÝnh to¸n ®éng lùc häc 107 V. Ch−¬ng tr×nh phÇn mÒm ®iÒu khiÓn SCA 107 VI. Ch−¬ng tr×nh phÇn mÒm ®iÒu khiÓn d©y chuyÒn s¶n xuÊt 109 Tµi liÖu tham kh¶o 131 3
BÁO CÁO CÁC KẾT QUẢ NGHIÊN CỨU THEO NHIỆM VỤ 2 CỦA ĐỀ TÀI KC.03.08 NGHIÊN CỨU THIẾT KẾ CHẾ TẠO NHÓM SẢN PHẨM ROBOT SCA MỞ ĐẦU Robot SCA là loại robot thuộc nhóm robot SCARA (selective Compliance Assembly Robot Arm) có cấu trúc động học theo kiểu cơ cấu tay máy phỏng sinh trục đứng. SCARA là loại robot dùng để lắp ráp linh hoạt. Tuy SCARA mới xuất hiện ở Nhật trong những năm 80, nhưng do có nhiều ưu điểm nên nhanh chóng được nhiều nước áp dụng và cải tiến. Có thể xếp vào nhóm robot SCARA các kiểu robot sau: Adept - One, IBM - 7545, Intelldex 440, Rhino SCARA của Hoa Kỳ; Skilam, SR-2, Nam Robo, Puha 2 của Nhật bản; IS 600 của Đức; Serpent của Anh v.v. Tại Trung tâm NCKT tự động hóa, ĐHBK - HN cũng đã thiết kế chế tạo kiểu robot SCA là một biến thể của SCARA. Kiểu robot SCA này có cấu hình RRRT, với 4 bậc tự do, toàn dùng động cơ bước. 4
Hình 2.0.1. Chế tạo và lắp ráp Robot SCA Nhằm nâng cao khả năng thao tác linh họat cho robot SCAđể đáp ứng được những tình huống xử lý thông minh của bộ điều khiển theo các tín hiệu nhận được từ các sensors, Đề tài đã nghiên cứu thiết kế cải tiến robot SCA theo 2 định hướng: dùng khí nén để tác động nhanh và môđun hóa để vạn năng hóa kết cấu. 1) Robot SCATM khí nén có 3 bậc tự do đầu dùng động cơ bước, còn bậc cuối thực hiện chuyển động tịnh tiến dùng truyền động khí nén. Trên hình 2.0.2 là bản vẽ thiết kế robot SCATM khí nén. Kết quả nghiên cứu thiết kế, chế tạo và điều khiển vận hành robot SCATM khí nén ®−îc tr×nh bµy trong Phần I của Báo cáo về nhiệm vụ 2 của Đề tài. 2) Robot SCA môđun hóa là một thử nghiệm tạo ra môđun cánh tay chuẩn hóa, từ đó có thể lắp ghép thành nhiều kiểu robot SCA. Trên hình 2.0.3 là ví dụ một kiểu robot SCA tạo ra từ các môđun cánh tay chuẩn hóa và hình 2.0.4. là một ví dụ khác: robot SCA có 2 tay. 5
Mỗi môđun cánh tay (hình 2.0.5) là một khâu hoàn chỉnh của cơ cấu tay máy robot, được thực hiện chuyển động quay rất chậm trực tiếp bởi một động cơ kèm hộp giảm tốc tỷ số truyền cao và không tồn tại khe hở cạnh răng. Như vậy, phần cốt lõi của môđun cánh tay là môđun quay (rotation module). Vì thế khi triển khai thực hiện nhiệm vụ 2 của Đề tài đã phát sinh một nội dung nghiên cứu và đã nhận được những kết quả bất ngờ và rất có ý nghĩa không những đối với các truyền động quay trong robot mà còn có tác dụng trong hầu hết các thiết bị máy móc hiện đại. Tóm tắt các kết quả chủ yếu về nội dung nghiên cứu này được trình bày trong phần II của Báo cáo về Nhiệm vụ 2 của Đề tài. 6
Hình 2.0.5. Bản vẽ thiết kế Robot SCATM khí nén 7
H×nh 2.0.3. Robot SCA mét c¸nh tay m«®un hãa 765 756 H×nh 2.0.4. Robot SCA 2 c¸nh tay m«®un hãa 8
H×nh 2.0.5. M«®un c¸nh tay Nội dung phần III của Báo cáo về Nhiệm vụ 2 của Đề tài là các kết quả nghiên cứu thiết kế chế tạo môđun Dây chuyền sản xuất (DCSX) dùng robot SCA để phân loại sản phẩm theo màu sắc. Nội dung nghiên cứu này cốt để minh họa về một cách thức thể hiện khả năng thông minh hóa cho robot ở đây cụ thể là robot SCA, trong môi trường làm việc cụ thể nào đó. Ngoài ra ®¬n vÞ chñ tr× Đề tài còn tham gia xây dựng Dự án “Chế tạo robot bốc dì két lên pallet tại phân xưởng chiết của Công ty liên doanh Bia Sài Gòn”. Hình 2.0.6. là mô phỏng hoạt hình robot này, đó cũng là một biến thể cỡ lớn của Robot SCARA. Kinh phí từ ngân sách SNKH được duyệt là 2,6 tỷ đồng, phần tham gia của ®¬n vÞ là 250 triệu đồng. Các thông số kỹ thuật của robot này giới thiệu trong phần phụ lục. 9
Hình 2.0.6. Mô phỏng Robot bốc dỡ két bia Nội dung Phần 4 của Báo cáo về Nhiệm vụ 2 của Đề tài là các kết quả nghiên cứu xây dựng cơ sở lý thuyết, thuật toán và chương trình phần mềm điều khiển robot SCA trong trường hợp hoạt động riêng rẽ và trong trường hợp thao tác với dây chuyền sản xuất. Trong đó cã các vấn đề với phương pháp giải bài toán động học thuận, bài toán động học ngược, trong lập trình quỹ đạo cho robot, bài toán động lực học và phương pháp thực hiện việc chọn lựa sản phẩm theo màu sắc. Nội dung chủ yếu của Phần I đã được viết thành một luận văn thạc sĩ, bảo vệ năm 2006. Phần II có một sản phẩm đã trưng bày ở chợ Techmart 2003 tại Hà Nội và được tặng thưởng Huy chương Vàng và một phần nội dung đã có trong luận văn Thạc sĩ, bảo vệ năm 2005. Phần IV có 2 chương trình phần mềm được cấp giấy chứng nhận bản quyền. 10
PhÇn i B¸o c¸o tãm t¾t c¸c kÕt qu¶ nghiªn cøu theo nhiÖm vô 2 cña ®Ò tµi kc. 03.08 robocar scaTm khÝ nÐn i. giíi thiÖu chung Nghiên cứu thiết kế chế tạo Robot SCATM khí nén để nâng cao mức linh hoạt thao tác của nó nhằm đáp ứng được điều khiển không bị trễ khi xử lý thông minh các tín hiệu nhận được từ hệ thống sensor Phần I báo cáo này trình bày 2 nội dung: 1. Xây dựng các mô hình động học và động lực học của Robot SCATM 2. Thiết kế cải tiến và chế tạo Robot SCATM khí nén 11
II. tãm t¾t vÒ kÕt qu¶ nghiªn cøu x©y dùng c¸c m« h×nh ®éng häc vµ ®éng lùc häc cña Robot scatm 2.1. Thiết lập phương trình động học Robot SCATM 2.1.1. X¸c ®Þnh c¸c hÖ täa ®é cña robot SCATM a 2 z z 0 1 q q 1 2 x , x ,x 0 1 2 d 3 a 1 x 3 d4 cè ®Þnh x q 4 4 z , z ,z 2 3 4 H×nh 2.1.1. HÖ to¹ ®é cña robot SCATM 2.1.2. B¶ng th«ng sè DH cña robot SCATM Kh©u qi αi ai di * 1 q1 0 a1 0 * o 2 q2 180 a2 0 * 3 0 0 0 d3 * 4 q4 0 0 d4 TM 2.1.3. X¸c ®Þnh c¸c ma trËn Ai cña robot SCA 12
⎡⎤CS11− 0 aC 11 ⎢⎥SC0 aS A = ⎢⎥11 11 1 ⎢⎥0010 (2.1) ⎢⎥ ⎣⎦0001 ⎡⎤CS220 aC 22 ⎢⎥SC− 0 aS A = ⎢⎥22 22 2 ⎢⎥00− 10 (2.2) ⎢⎥ ⎣⎦0001 ⎡⎤100 0 ⎢⎥010 0 A = ⎢⎥ 3 (2.3) ⎢⎥001d3 ⎢⎥ ⎣⎦000 1 ⎡⎤CS44− 00 ⎢⎥SC00 ⎢⎥44 A4 = (2.4) ⎢⎥0010 ⎢⎥ ⎣⎦000d4 TM 2.1.4. TÝnh c¸c ma trËn Ti cña robot SCA ⎡⎤CS44− 00 ⎢⎥SC00 3TA==⎢⎥44 44⎢⎥0010 (2.5) ⎢⎥ ⎣⎦000d4 ⎡⎤nsapx xx x ⎢⎥nsap T = ⎢⎥yy y y 4 (2.6) ⎢⎥nsapz zz z ⎢⎥ ⎣⎦0001 13
⎡⎤CS44− 00 ⎢⎥SC00 2 ⎢⎥44 TAA434== (2.7) ⎢⎥001dd43+ ⎢⎥ ⎣⎦0001 ⎡⎤cos(qq24−− ) sin( qq 24 ) 0 Ca 22 ⎢⎥sin(qq−− ) cos( qq − ) 0 Sa 1 ⎢⎥24 24 22 TAAA4234== (2.8) ⎢⎥001−−−dd43 ⎢⎥ ⎣⎦0001 ⎡⎤cos(qqq124+− ) sin( qqq 124 +− ) 0 aCaC 21211 + ⎢⎥sin(qqq+− ) − cos( qqq +− ) 0 aSaS + 1 ⎢⎥124 124 21211 TAT414== (2.9) ⎢⎥001−−−dd43 ⎢⎥ ⎣⎦0001 2.1.5. Ph−¬ng tr×nh ®éng häc robot SCATM ⎡⎤nsapxx x x ⎢⎥nsap ⎢⎥yy y y= T 4 (2.10) ⎢⎥nsapzz z z ⎢⎥ ⎣⎦0001 Tõ ®ã ta cã hÖ ph−¬ng tr×nh sau: 14
⎧nqqqx =+−cos(124 ) ⎪nqqq=+−sin( ) ⎪ y 124 ⎪n = 0 ⎪ z ⎪sqqqx =+−sin(124 ) ⎪s =−cos(qqq + − ) ⎪ y 124 ⎪ ⎪sz = 0 → ⎨ a = 0 ⎪ x (2.11) ⎪a = 0 ⎪ y ⎪az =−1 ⎪ paCaC=+ ⎪ x 212 11 ⎪ paSaS=+ ⎪ y 212 11 ⎩⎪ pddz =−43 − 2.2. ThiÕt lËp bµi to¸n ®éng häc ng−îc Robot SCATM Như đã ký hiệu trong bài toán động học thuận, ta có phương trình sau: i Tn = Ai Tn −1 Nhân hai vế của phương trình này với Ai , nhận được i −1 Tn = Ai Tn ⎡⎤Cn12xyxyxy+++ Sn 12 Cs 12 Ss 12 Ca 12 Sa 12 Cp 12 x +−− S 12 p y Ca 2 1 a 2 ⎢⎥Sn−−− Cn Ss Cs Sa Ca Sp −− Cp Sa −−−111 ⎢⎥12xyxyxy 12 12 12 12 12 12 x 12 y 2 1 X34== AAAT 3 2 1 4 ⎢⎥−−−nsazz z −− pd z3 ⎢⎥ ⎣⎦000 1 (2.12) 15
⎡⎤Cn12xyxyxy+++ Sn 12 Cs 12 Ss 12 Ca 12 Sa 12 Cp 12 x +−− S 12 p y Ca 2 1 a 2 ⎢⎥Sn−−− Cn Ss Cs Sa Ca S p −− Cp Sa −−11 ⎢⎥12xyxyxy 12 12 12 12 12 12 x 12 y 2 1 XAAT24== 2 1 4 ⎢⎥−−−nsazz z − p z ⎢⎥ ⎣⎦000 1 (2.13) ⎡⎤Cn11xy++++− Sn Cs 11 xy Ss Ca 11 xy Sa Cp 1 x S 1 p y a 1 ⎢⎥−+Sn Cn −+ Ss Cs −+ Sa Ca − S p + Cp −1 ⎢⎥11xy 11 xy 11 xy 1 x 1 y XAT14== 1 4 ⎢⎥nsazz z p z ⎢⎥ ⎣⎦000 1 (2.14) * T×m q1 1 XÐt phÇn tö hµng 1 cét 4 cña 2 ma trËn X14 vµ T4 tõ (2.14) vµ (2.8) 1 vµ phÇn tö hµng 2 cét 4 cña 2 ma trËn X14 vµ T4 tõ (2.14) vµ (2.8) ⎪⎧pqpqaaqxycos(11122 )+−= sin( ) cos( ) (2.15) ⎨ ⎩⎪−+pqpqaqxysin(1122 ) cos( ) = sin( ) (2.16) 2 ⎧⎡⎤22 ⎪⎣pqpqaaxycos(11122 )+−= sin( ) ⎦ cos ( q ) (2.17) ⎨ 2 ⎪⎡⎤−+pqpqsin( ) cos( ) = a22 sin ( q ) (2.18) ⎩⎣⎦xy1122 22 22 (2.17)+→+− (2.18)ppxy 2 apq111112 x cos( ) − 2 apqaa y sin( ) +=(2.19) 2222 ⎡ ⎤ ppaaxy++−=122 ap 1⎣ x cos( q 1 ) + p y sin( q 1 )⎦ (2.20) ppaa2222++− p p xy12=+x cos(qq ) y sin( ) 22 2211 22 (2.21) 2ap1 xy++ p p xy p p xy + p §Æt 16
p x = sinϕ 22 (2.22) ppxy+ p y = cosϕ 22 (2.23) ppxy+ Tõ (2.19) ta cã: ppaa2222++− xy12=+sin ()ϕ q 22 1 (2.24) 2ap1 xy+ p 2 ⎛⎞ppaa2222++− ⎜⎟xy12 ⇒+=−cos()ϕ q1 1 (2.25) ⎜⎟2ap22+ p ⎝⎠1 xy ⎛⎞2 ppaa2222++−⎛⎞ ppaa 2222 ++− ⎜⎟xy12⎜⎟ xy 12 ϕ +=qarctg1 2,1⎜⎟ − (2.26) 22⎜⎟ 22 ⎜⎟22ap11xy++ p ap xy p ⎝⎠⎝⎠ Tõ (2.22) vµ (2.23) ⇒=ϕ arctg2,( px py ) (2.27) Tõ (2.26) vµ (2.27) ta cã: ⎛⎞2 ⎜⎟ppaa2++− 222⎛⎞ ppaa 2 ++− 222 xy12⎜⎟ xy 12 qarctg1 =−−2,1,⎜⎟ arctgpp()x y (2.28) 22⎜⎟ 22 ⎜⎟22ap11xy++ p ap xy p ⎝⎠⎝⎠ * T×m q2. Tõ (2.15) ⇒+−=pxycos(qp11122) sin( qaa) cos( q) (2.29) p p aa x cos(qq )+−=y sin( )12 cos() q (2.30) 2211 22 22 22 2 ppxy++++ pp xy pp xy pp xy §Æt: 17
p x = sinϕ 22 (2.31) ppxy+ p y = cosϕ 22 (2.32) ppxy+ ⎡⎤aa ⎢⎥12 ⇒+−sin()ϕ qq12 = cos() (2.33) ⎢⎥pp22++ pp 22 ⎣⎦xy xy KÕt hîp víi (2.24), ta ®−îc: ⎛⎞2222 22 ppaa++− a ppxy+ ⎜⎟xy12 1 −=cos()q2 22 22 (2.34) ⎜⎟2ap++ p p p a2 ⎝⎠1 xy xy 2 222 pxy+−− paa12 ⇒=cos()q2 (2.35) 2aa12 2 ⎛⎞ppaa2222+−− ⇒−1sinxy12 = q ⎜⎟()2 (2.36) ⎝⎠2aa12 ⎡⎤22222 2222 ⎛⎞p +−−paa p +−− paa ⇒=qarctg21⎢⎥ −⎜⎟xy12 , xy 12 2 ⎢⎥⎜⎟ 22aa12 aa 12 ⎣⎦⎢⎥⎝⎠ (2.37) * T×m d3 1 XÐt phÇn tö hµng 3 cét 4 cña hai ma trËn X14 vµ T4 tõ (2.14) vµ (2.8) pz =−dd43 − (2.38) ⇒=−−dpd34z (2.39) * T×m q4 3 XÐt phÇn tö hµng 2 cét 1 cña hai ma trËn X 34 vµ T4 tõ (2.12) vµ (2.5) Sn12xy−= Cn 12 S 4 (2.40) 18
3 XÐt phÇn tö hµng 1 cét 1 cña hai ma trËn X 34 vµ T4 tõ (2.12) vµ (2.5) Cn12xy+= Sn 12 C 4 (2.41) ⇒=qarctgSC4442,( ) (2.42) 2.3. Xây dựng mô hình động lực học Robot SCATM i-1 Ta thiÕt lËp c¸c ma trËn Ai Tõ c¸c c«ng thøc (1.22) vµ (1.23) ta cã: ⎡⎤CS11− 0 aC 11 ⎢⎥SC0 aS 0 ⎢⎥11 11 A1 = (2.43) ⎢⎥0010 ⎢⎥ ⎣⎦0001 ⎡⎤CS220 aC 22 ⎢⎥SC− 0 aS 1A = ⎢⎥22 22 2 ⎢⎥00− 10 (2.44) ⎢⎥ ⎣⎦0001 ⎡⎤100 0 ⎢⎥010 0 2 ⎢⎥ A3 = (2.45) ⎢⎥001d3 ⎢⎥ ⎣⎦000 1 ⎡⎤CS44− 00 ⎢⎥SC00 3 A = ⎢⎥44 (2.46) 4 ⎢⎥0010 ⎢⎥ ⎣⎦000d4 Tõ c«ng thøc (1.21) ta cã: ⎡⎤CS12 120 aCaC 2 12+ 1 1 ⎢⎥SC−+0 aSaS 001⎢⎥12 12 2 12 1 1 AAA212== (2.47) ⎢⎥00− 1 0 ⎢⎥ ⎣⎦000 1 19
⎡⎤CS12 120 aCaC 2 12+ 1 1 ⎢⎥SC−+0 aSaS 0012⎢⎥12 12 2 12 1 1 AAAA3123== (2.48) ⎢⎥00−− 1 d3 ⎢⎥ ⎣⎦000 1 ⎡+−cos()qqq124 sin( qqq 124 +−) 0 aCaC 21211 +⎤ ⎢⎥ sin()()qqq+− − cos qqq +− 0 aSaS + 00123AAAAA==⎢⎥124 124 21211(2.49) 41234⎢⎥001−−−dd ⎢⎥34 ⎣⎦0001 ⎡⎤CS220 aC 22 ⎢⎥SC− 0 aS 112⎢⎥22 22 AAA323== (2.50) ⎢⎥00−− 1d3 ⎢⎥ ⎣⎦0001 ⎡−+−−+cos( qq24) sin( qq 24) 0 aC 22 ⎤ ⎢⎥ −−+−sinqq cos −+ qq 0 aS 1123⎢⎥()()24 24 22 AAAA4234== (2.51) ⎢⎥001−−−dd ⎢⎥34 ⎣⎦0001 ⎡⎤CS44− 00 ⎢⎥SC00 223⎢⎥44 AAA434== (2.52) ⎢⎥001dd34+ ⎢⎥ ⎣⎦0001 Tõ c«ng thøc (1.26) vµ (1.27) ta cã: ⎡⎤0100− ⎢⎥1000 D = ⎢⎥ 1 ⎢⎥0000 (2.53) ⎢⎥ ⎣⎦0000 20
⎡⎤0100− ⎢⎥1000 D = ⎢⎥ 2 ⎢⎥0000 (2.54) ⎢⎥ ⎣⎦0000 ⎡⎤0000 ⎢⎥0000 D = ⎢⎥ 3 ⎢⎥0001 (2.55) ⎢⎥ ⎣⎦0000 ⎡⎤0100− ⎢⎥1000 D = ⎢⎥ 4 ⎢⎥0000 (2.56) ⎢⎥ ⎣⎦0000 Ta tÝnh Uij theo c«ng thøc (1.31) ⎡⎤−−SC110 − aS 11 ⎢⎥CS− 0 aC 0 ⎢⎥11 11 UDA11== 1 1 (2.57) ⎢⎥0000 ⎢⎥ ⎣⎦0000 ⎡⎤−−−SC12 120 aSaS 2 12 1 1 ⎢⎥CS0 aCaC+ UDA==0 ⎢⎥12 12 2 12 1 1 21 1 2 ⎢⎥000 0 (2.58) ⎢⎥ ⎣⎦000 0 21
⎡⎤−−SC12 120 aS 2 12 ⎢⎥CS0 aC UADA==01⎢⎥12 12 2 12 22 1 2 2 ⎢⎥0000 (2.59) ⎢⎥ ⎣⎦0000 ⎡⎤−−−SC12 120 aSaS 2 12 1 1 ⎢⎥C S0 aC+ aC 0 ⎢⎥12 12 2 12 2 1 UDA31== 1 3 (2.60) ⎢⎥000 0 ⎢⎥ ⎣⎦000 0 ⎡⎤−−SC12 120 aS 2 12 ⎢⎥CS0 aC UADA==01⎢⎥12 12 2 12 32 1 2 3 ⎢⎥0000 (2.61) ⎢⎥ ⎣⎦0000 ⎡⎤000 0 ⎢⎥000 0 UADA==02⎢⎥ 33 2 3 3 ⎢⎥000− 1 (2.62) ⎢⎥ ⎣⎦000 0 ⎡−sin()qqq124 +− cos( qqq 124 +−) 0 − aSaS 21211 − ⎤ ⎢⎥ cos()()qqq+− sin qqq +− 0 aCaC + UDA==0 ⎢⎥124 124 21211 (2.63) 41 1 4 ⎢⎥0000 ⎢⎥ ⎣⎦0000 ⎡−sin()qqq124 +− cos( qqq 124 +−) 0 − aS 212 ⎤ ⎢⎥ cos()()qqq+− sin qqq +− 0 aC UADA==01⎢⎥124 124 212 (2.64) 42 1 2 4 ⎢⎥0000 ⎢⎥ ⎣⎦0000 22
⎡⎤000 0 ⎢⎥000 0 UADA==02⎢⎥ 43 2 3 4 ⎢⎥000− 1 (2.65) ⎢⎥ ⎣⎦000 0 ⎡+−−+−⎤sin()qqq124 cos( qqq 124) 0 0 ⎢⎥ −+−−+−cos()()qqq sin qqq 0 0 UADA==03⎢⎥124 124 44 3 4 4 ⎢⎥0000(2.66) ⎢⎥ ⎣⎦0000 ⎛⎞11 ma2 00− ma ⎜⎟3211 11 ⎜⎟ ⎜⎟0000 J = 1 ⎜⎟0000 (2.67) ⎜⎟ ⎜⎟1 ⎜⎟− ma00 m ⎝⎠2 11 1 ⎛⎞11 ma2 00− ma ⎜⎟3222 22 ⎜⎟ ⎜⎟0000 J = 2 ⎜⎟0000 (2.68) ⎜⎟ ⎜⎟1 ⎜⎟− ma00 m ⎝⎠2 22 2 ⎛⎞11 ml2 00− ml ⎜⎟3233 33 ⎜⎟ ⎜⎟0000 J = 3 ⎜⎟0000 (2.69) ⎜⎟ ⎜⎟1 ⎜⎟− ml00 m ⎝⎠2 33 3 23
⎛⎞11 ml2 00− ml ⎜⎟3244 44 ⎜⎟ ⎜⎟0000 J = 4 ⎜⎟0000 (2.70) ⎜⎟ ⎜⎟1 ⎜⎟− ml00 m ⎝⎠2 44 4 Tõ c«ng thøc (1.51): TTTT D11=+ TrUJU()() 11 1 11 TrU 21 JU 2 21 ++ TrUJU( 31 3 31) TrU( 41 JU 4 41 ) 1 =ma22++ m a ma 2 + maaC − mlaC − mla cos( −++ q q ) 2 maaC 42 413 22 212 2 442 4 441 2 4 412 2 111 −+mlaCmaaCmlamamamamamlml2 −++++++222 2 2 2 33 1 2 3 1 2 2 33 2 2 1 3 2 3 1333 1 1 33 44 (2.71) TTT D12=++ TrUJ( 22 2UUU 21) TrUJ( 32 3 31) TrUJ( 42 4 41 ) 11 1 1 =+ma2 maaC −+ aml maaC − amlC − amlC + ml2 3222 2212 2 33 3212 2 1 332 2 444 3 33 11 ++−ml22 am amlcos() −++ q q amaC + am 2 (2.72) 3244 2 3 1 44 2 4 2 4 1 2 2 4 TT DTrUJ13=+=() 33 3UU 31 TrUJ( 43 4 41 ) 0 (2.73) T DTrUJ14= () 44 4U 41 112 1 =+ml44 mlaC 44 2 4 + mla 44 1cos() −+ q 2 q 4 (2.74) 32 2 TTT D22=++ TrUJ() 22 2UUU 22 TrUJ( 32 3 32) TrUJ( 42 4 42 ) 111 =−aml + am222 + am + am − amlC + lm 22 + lm (2.75) 233 23333 2 2 2 4 2444 3 3 4 4 TT D23=+= TrUJ( 33 3UU 32) TrUJ( 43 4 42 ) 0 (2.76) T 112 DTrUJ24==−+() 33 4U 42 lmamlC 4 4 2 4 4 4 (2.77) 32 24
TT D33=+=+ TrUJ( 33 3UU 33) TrUJ( 43 4 43) m 3 m 4 (2.78) T DTrUJ34==() 44 4U 33 0 (2.79) T 1 2 DTrUJ44==() 44 4U 44 ml 4 4 (2.80) 3 ⎡⎤DDDD11 12 13 14 ⎢⎥ DDDD12 22 23 24 Dq()= ⎢⎥ (2.81) ⎢⎥DDDD ⎢⎥12 23 33 34 ⎣⎦DDDD14 24 34 44 ⎡⎤−−CS110 aC 11 ⎢⎥−−SC0 − aC UDA==20 ⎢⎥11 11 111 1 1 ⎢⎥0000 (2.82) ⎢⎥ ⎣⎦0000 ⎡⎤−−CS12 120 −− aCaC 2 12 1 1 ⎢⎥−−−SC0 aSaS UDAA==20 1 ⎢⎥12 12 2 12 1 1 211 1 1 2 ⎢⎥000 0 (2.83) ⎢⎥ ⎣⎦000 0 ⎡⎤−−CS12 120 −− aCaC 2 12 1 1 ⎢⎥−−−SC0 aSaS UDAAA==20 1 2 ⎢⎥12 12 2 12 1 1 311 1 1 2 3 ⎢⎥000 0 (2.84) ⎢⎥ ⎣⎦000 0 ⎡−cos(qqq124 + −) − sin( qqq 124 + −) 0 − aCaC 21211 − ⎤ ⎢⎥ −+−sin()()qqq cos qqq +−−− 0 aSaS UDAAAA==20 1 2 3 ⎢⎥124 124 21211 411 1 1 2 3 4 ⎢⎥0000 ⎢⎥ ⎣⎦0000 (2.85) 25
⎡−−CS12 120 − aC 2 12 ⎤ ⎢−−SC0 aS⎥ UDADA==01⎢ 12 12 2 12 ⎥ 212 1 1 2 2 ⎢ 0000⎥ (2.86) ⎢ ⎥ ⎣ 0000⎦ ⎡−−CS12 120 − aC 2 12 ⎤ ⎢−−SC0 aS⎥ UDADAA==012⎢ 12 12 2 12 ⎥ 312 1 1 2 2 3 ⎢ 0000⎥ (2.87) ⎢ ⎥ ⎣ 0000⎦ ⎡−+−−+−−⎤cos(qqq124) sin( qqq 124) 0 aC 212 ⎢ ⎥ −+−sin()()qqq cos qqq +−− 0 aS UDADAAA==0123⎢ 124 124 212⎥ 412 1 1 2 2 3 4 ⎢ 0000⎥ ⎢ ⎥ ⎣ 0000⎦ (2.88) ⎡0000⎤ ⎢0000⎥ UDAADA==01 2 ⎢ ⎥ 313 1 1 2 3 3 ⎢0000⎥ (2.89) ⎢ ⎥ ⎣0000⎦ ⎡0000⎤ ⎢0000⎥ UDAADAA==01 2 3 ⎢ ⎥ 413 1 1 2 3 3 4 ⎢0000⎥ (2.90) ⎢ ⎥ ⎣0000⎦ ⎡cos(qqq124+−) sin( qqq 124 +−) 0 0 ⎤ ⎢ ⎥ sin()()qqq+− − cos qqq +− 0 0 UDAAADA==012 3 ⎢ 124 124 ⎥ 414 1 1 2 3 4 4 ⎢ 0000⎥ ⎢ ⎥ ⎣ 0000⎦ (2.91) 26
⎡−−CS12 120 − aC 2 12 ⎤ ⎢−−SC0 aS⎥ UADA==021 ⎢ 12 12 2 12 ⎥ 222 1 2 2 ⎢ 0000⎥ (2.92) ⎢ ⎥ ⎣ 0000⎦ ⎡−−CS12 120 − aC 2 12 ⎤ ⎢−−SC0 aS⎥ UADAA==0212 ⎢ 12 12 2 12 ⎥ 322 1 2 2 3 ⎢ 0000⎥ (2.93) ⎢ ⎥ ⎣ 0000⎦ ⎡−+−−+−−⎤cos(qqq124) sin( qqq 124) 0 aC 212 ⎢ ⎥ −+−sin()()qqq cos qqq +−− 0 aS UADAAA==02123 ⎢ 124 124 212⎥ 42212234⎢ 0000⎥ ⎢ ⎥ ⎣ 0000⎦ (2.94) ⎡0000⎤ ⎢0000⎥ UADADA==012⎢ ⎥ 323 1 2 2 3 3 ⎢0000⎥ (2.95) ⎢ ⎥ ⎣0000⎦ ⎡0000⎤ ⎢0000⎥ UADADAA==0123⎢ ⎥ 423 1 2 2 3 3 4 ⎢0000⎥ (2.96) ⎢ ⎥ ⎣0000⎦ ⎡cos(qqq124+−) sin( qqq 124 +−) 0 0 ⎤ ⎢ ⎥ sin()()qqq+− − cos qqq +− 0 0 UADAADA==0123⎢ 124 124 ⎥ 424 1 2 2 3 4 4 ⎢ 0000⎥ ⎢ ⎥ ⎣ 0000⎦ (2.97) 27
⎡0000⎤ ⎢0000⎥ UAADA==01 22 ⎢ ⎥ 333 1 2 3 3 ⎢0000⎥ (2.98) ⎢ ⎥ ⎣0000⎦ ⎡0000⎤ ⎢0000⎥ UAADAA==01 223 ⎢ ⎥ 433 1 2 3 3 4 ⎢0000⎥ (2.99) ⎢ ⎥ ⎣0000⎦ ⎡0000⎤ ⎢0000⎥ UAADADA==01 2 3 ⎢ ⎥ 434 1 2 3 3 4 4 ⎢0000⎥ (2.100) ⎢ ⎥ ⎣0000⎦ ⎡−cos(qqq124 + −) − sin( qqq 124 + −) 0 0 ⎤ ⎢⎥ −+−sin()()qqq cos qqq +− 0 0 UAAADA==012 23 ⎢⎥124 124 444 1 2 3 4 4 ⎢⎥0000 ⎢⎥ ⎣⎦0000 (2.101) Tõ (1.53) ta cã: TTTT h111=+ Tr( U 111 J 1 U 11) Tr( U 211 J 2 U 21) ++ Tr( U 311 J 3 U 31) Tr( U 411 J 4 U 411 ) =0 (2.102) TTT h112=++ TrU( 212 JU 2 21) TrU( 312 JU 3 31) TrU( 412 JU 4 41 ) 11 1(2.103) =−amaS + mlaS − mlasin () − q + q − maaS 2 31222 3312 441 2 4 2 2212 TT hTrUJUTrUJU113=+=( 313 3 31) ( 413 4 41 ) 0 (2.104) 28
T hTrUJU114= () 414 4 41 11 (2.105) =+mlaS mlasin () −+ q q 2244 2 4 44 1 2 4 TTT h122=++ TrU( 222 JU 2 21) TrU( 322 JU 3 31) TrU( 422 JU 4 41 ) 11 =−−−mlaS amaS amaS mlasin () −+− q q maaS 223212 2 312 2 412 441 2 4 4212 (2.106) TT hTrUJUTrUJU123=+=() 323 3 31( 423 4 41 ) 0 (2.107) T 11 h124==+−+ TrU() 424 JU 4 41 mlaS 4 4 2 4 mla 4 4 1sin () q 2 q 4 22 (2.108) TT hTrUJUTrUJU133=+=( 333 3 31) ( 433 4 41 ) 0 (2.109) T hTrUJU134==() 434 4 41 0 (2.110) T hTrUJU144= ( 444 4 41 ) 11 (2.111) =−mlaS − mlasin () − q + q 2244 2 4 44 1 2 4 hh121= 112 (2.112) hh131= 113 (2.113) hh141= 114 (2.114) hh132= 123 (2.115) hh142= 124 (2.116) hh143= 134 (2.117) 29
TTT hTrUJUTrUJUTrUJU211=++( 211 2 22) ( 311 3 32) ( 411 4 42 ) 11 1 =−mlaS + maaS + mlasin () − q + q + maaS + maaS 223312 3212 441 2 4 4212 2 2212 (2.118) TTT h212=++= TrU() 212 JU 2 22 TrU( 312 JU 3 32) TrU( 412 JU 4 42 ) 0 (2.119) TT hTrUJUTrUJU213=+=( 313 3 32) ( 413 4 42 ) 0 (2.120) T 1 hTrUJUmlaS214==() 414 4 42 4 4 2 4 (2.121) 2 TTT h222=++= TrU() 222 JU 2 22 TrU( 322 JU 3 32) TrU( 422 JU 4 42 ) 0 (2.122) TT hTrUJUTrUJU223=+=( 323 3 32) ( 423 4 42 ) 0 (2.123) T 1 hTrUJUmlaS224==() 424 4 42 4 4 2 4 (2.124) 2 TT hTrUJUTrUJU233=+=() 333 3 32( 433 4 42 ) 0 (2.125) T hTrUJU234==( 434 4 42 ) 0 (2.126) T 1 hTrUJU244==−() 444 4 42 mlaS 4 4 2 4 (2.127) 2 hh221= 212 (2.128) hh231= 213 (2.129) hh241= 214 (2.130) hh232= 223 (2.131) hh242= 224 (2.132) hh243= 234 (2.133) 30
TT hTrUJUTrUJU311=+=( 311 3 33) ( 411 4 43 ) 0 (2.134) TT hTrUJUTrUJU312=+=() 312 3 33( 412 4 43 ) 0 (2.135) TT hTrUJUTrUJU313=+=() 313 3 33( 413 4 43 ) 0 (2.136) T hTrUJU314==( 414 4 43 ) 0 (2.137) TT hTrUJUTrUJU322=+=( 322 3 33) ( 422 4 43 ) 0 (2.138) TT hTrUJUTrUJU323=+=() 323 3 33( 423 4 43 ) 0 (2.139) T hTrUJU324==( 424 4 43 ) 0 (2.140) TT hTrUJUTrUJU333=+=( 333 3 33) ( 433 4 43 ) 0 (2.141) T hTrUJU334==() 434 4 43 0 (2.142) T hTrUJU344==() 444 4 43 0 (2.143) hh321= 312 (2.144) hh331= 313 (2.145) hh341= 314 (2.146) hh332= 323 (2.147) hh242= 324 (2.148) hh343= 234 (2.149) T 11 h411==−−−+ TrU() 411 JU 4 44 mlaS 4 4 2 4 mla 4 4 1sin () q 2 q 4 (2.150) 22 T 1 hTrUJU412==−() 412 4 44 mlaS 4 4 2 4 (2.151) 2 T hTrUJU413==() 413 4 44 0 (2.152) 31
T hTrUJU414==( 414 4 44 ) 0 (2.153) T 1 hTrUJU422==−() 422 4 43 mlaS 4 4 2 4 (2.154) 2 T hTrUJU423==() 423 4 44 0 (2.155) T hTrUJU424==( 424 4 44 ) 0 (2.156) T hTrUJU433==( 433 4 44 ) 0 (2.157) T hTrUJU434==( 434 4 44 ) 0 (2.158) T hTrUJU444==() 444 4 44 0 (2.159) hh421= 412 (2.160) hh431= 413 (2.161) hh441= 414 (2.162) hh432= 423 (2.163) hh442= 424 (2.164) hh443= 434 (2.165) Tõ c«ng thøc (1.52): 44 2 2 h1==++++++∑∑ h 1km qq&&& k m hq 111 1 hqqhqqhqqhqqhq 121 &&&&&&&&& 2 1 131 3 1 141 4 1 112 1 2 122 2 hqq 132 && 3 2 km==11 2 2 +++++++++hqq142&&&&&&&&&&&&&&&& 4 2 hqqhqqhq 113 1 3 123 2 3 133 3 hqqhqqhqq 143 4 3 114 1 4 124 2 4 hqqhq 134 3 4 144 4 ⎛⎞11 =+−+2sin⎜⎟mlaS44 2 4 mla 44 1() q 2 q 4 q& 4 ⎝⎠22 32
⎡⎤⎛⎞11 1 +−2sin⎢⎥⎜⎟maaS312 2 + mlaS 3312 − mla 441() −+− q 2 q 4 maaS 412 2 − maaS 212 2 q&& 2 q 1 ⎣⎦⎝⎠22 2 ⎡⎤11 2 +−mlaS44 2 4 mla 44 1sin () −+ q 2 q 4 q& 4 ⎣⎦⎢⎥22 ⎡⎤11 1 2 +−maaS3122 + mlaS 3312 − mla 441sin () − q 2 + q 4 − maaS 4122 − maaS 21222 q& ⎣⎦⎢⎥22 2 ⎡⎤11 ++mlaS44 2 4 mla 44 1sin () −+ q 2 q 4 qq&& 4 2 (2.166) ⎣⎦⎢⎥22 44 22 h2=∑∑ h 2km qq&&& k m =+++++ hq 211 1 hqqhqqhqqhq 221 &&&&&&& 2 1 231 3 1 241 4 1 222 2 hqq 232 && 3 2 km==11 2 2 +++++++++hqqhqqhqqhq242&&&&&&&&&&&&&&&& 4 2 213 1 3 223 2 3 233 3 hqqhqqhqqhqqhq 243 4 3 214 1 4 224 2 4 234 3 4 244 4 ⎛⎞11 12 =−⎜⎟mlaS3312 + maaS 3212 + mla 441sin () − q 2 + q 4 + maaS 4212 + maaS 2212 q& 1 ⎝⎠22 2 ⎡⎤⎛⎞11 1 +−2sin⎢⎥⎜⎟maaS312 2 + mlaS 3312 − mla 441() −+− q 2 q 4 maaS 412 2 − maaS 212 2 q&& 2 q 1 ⎣⎦⎝⎠22 2 ⎡⎤11 2 +−mlaS44 2 4 mla 44 1sin () −+ q 2 q 4 q& 4 ⎣⎦⎢⎥22 ⎡⎤11 1 2 +−maaS312 2 + mlaS 3312 − mla 441sin () − q 2 + q 4 − maaS 412 2 − maaS 212 2 q& 2 ⎣⎦⎢⎥22 2 1 2 ++qqmlaS&&414424 qqmlaS && 42 4424 − qmlaS & 4 4424 (2.167) 2 44 22 h3==++++++∑∑ hqq 3&&km hq 311 & 1 hqqhqqhqqhq 321 && 2 1 331 && 3 1 341 && 4 1 322 & 2 hqqhqq 332 && 3 2 342 && 4 2 km==11 2 2 ++hqqhqqhq313&&&&&&&&&&&&&& 1 3 323 2 3 +++ 333 3 hqqhqqhqqhqqhq 343 4 3 314 1 4 + 324 2 4 + 334 3 4 += 344 4 0 (2.168) 44 22 h4=∑∑ h 4km qq&& k m =+++++ hq 411 & 1 hqqhqqhqqhq 421 && 2 1 431 && 3 1 441 && 4 1 422 & 2 hqq 4 && 3 2 km==11 2 2 +++++++h442 qq&&&&&&&&&&&&&&&& 4 2 h 413 qq 1 3 h 423 qq 2 3 h 433 q 3 h 443 qq 4 3 h 414 qq 1 4 h 424 qq 2 4 + h 434 qq 3 4 + h 444 q 4 1 22 2 =−ml44⎡⎤ qaS&& 1 22 + qa 11sin() − q 2 + q 4 + 2 aSqq 2421 &&& + aSq 242 2 ⎣⎦ 33
(2.169) T hqq(), & = [ hhhh1234] (2.170) gg=−[00 0] (2.171) 1 ⎡⎤a1 r1 =−⎢⎥001 (2.172) ⎣⎦2 2 ⎡⎤a2 r2 =−⎢⎥001 (2.173) ⎣⎦2 3 ⎡⎤l3 r3 =−⎢⎥00 1 (2.174) ⎣⎦2 4 ⎡⎤l4 r4 =−⎢⎥00 1 (2.175) ⎣⎦2 Tõ (1.54) ta cã: 123 4 c1=−( m 1 gU 11 r 1 + m 2 gU 21 r 2 + m 3 gU 31 r 3 + m 4 gU 41 r 4 ) =0(2.176) 234 c2=−( m 2 gU 22 r 2 + m 3 gU 32 r 3 + m 4 gU 42 r 4 ) =0 (2.177) 34 cmgUrmgUrmgmg3=−( 3 33 3 + 4 43 4) =− 3 − 4 (2.178) 4 c44444=−() m gU r =0 (2.179) T cq()= [] c1234 c c c (2.180) T qt&&()=⎡⎣⎦ qt&&1234 () qt&& () qt&& () qt&& () ⎤ (2.181) Tõ (2.81), (2.170), (2.180), (2.181) ta cã kÕt qu¶: FM ()tDqqthqqcq=++ ( )()&&( ) ( , & ) ( ) (2.182) C¸c ph−¬ng tr×nh ®éng lùc (2.182) lµ nh÷ng ph−¬ng tr×nh vi ph©n phi tuyÕn bËc hai. C¸c ph−¬ng tr×nh trªn cã thÓ vËn dông ®Ó gi¶i quyÕt c¸c nhiÖm vô sau ®©y: 34
Khi biÕt lùc ®éng FM ë tõng khíp vµ tõng thêi ®iÓm, trªn c¬ së c¸c ph−¬ng tr×nh ®éng lùc nãi vÒ nguyªn t¾c cã thÓ t×m ra quy luËt thay ®æi c¸c gi¸ trÞ biÕn khíp q(t) theo thêi gian. Råi tiÕp theo ®ã, tõ bé gi¸ trÞ q(t) sÏ x¸c ®Þnh ®−îc quy luËt thay ®æi thêi gian cña vÞ trÝ bµn kÑp tøc lµ x¸c ®Þnh ®−îc quü ®¹o chuyÓn ®éng cña bµn kÑp. Ng−îc l¹i, nÕu cho biÕt ch−¬ng tr×nh chuyÓn ®éng, tøc lµ cho biÕt q(t) vµ c¸c ®¹o hµm bËc nhÊt, bËc 2 theo thêi gian cña q(t), trªn c¬ së c¸c ph−¬ng tr×nh ®éng lùc nãi trªn cã thÓ x¸c ®inh FM t¸c ®éng lªn tõng khíp ®éng ë c¸c thêi ®iÓm kh¸c nhau. Tõ ph−¬ng tr×nh ®éng lùc (2.182) cã thÓ x©y dùng ph−¬ng tr×nh tr¹ng th¸i ®iÒu khiÓn hÖ thèng robot cã c¸c liªn hÖ ph¶n håi. Trªn c¬ së ®ã cã thÓ chän lùa c¸c quy luËt ®iÒu khiÓn th−êng gÆp lµ sao cho gi¶m ®iÒu thiÓu c¸c ¶nh h−ëng phi tuyÕn t¸c ®éng lªn nhau cña c¸c nguån ®éng lùc trong c¸c khíp ®éng. 35
III. tãm t¾t vÒ kÕt qu¶ nghiªn cøu thiÕt kÕ c¶i tiÕn vµ chÕ t¹o robot scaTM khÝ nÐn Nh− ®· tr×nh bµy ë trªn Robot SCA víi cÊu h×nh RRRT, 4 bËc tù do, toµn dïng ®éng c¬ b−íc ®· ®−îc Trung t©m NCKT Tù ®éng hãa, thiÕt kÕ, chÕ t¹o cung cÊp cho mét sè c¬ së ®µo t¹o. §Ó n©ng cao tèc ®é cña robot SCA cho phï hîp víi ho¹t ®éng cña b¨ng truyÒn, mµ dù kiÕn nã sÏ phôc vô §Ò tµi ®· nghiªn cøu c¶i tiÕn, chñ yÕu lµ cho bËc tù do thø t− khÝ nÐn thùc hiÖn chuyÓn ®éng tÞnh tiÕn b»ng khÝ nÐn ®Ó c«ng g¾p nhanh. V× thÕ ë môc nµy chØ tr×nh bµy mét sè b¶n vÏ chñ yÕu. - H×nh 2.1.2. B¶n vÏ vÒ vïng ho¹t ®éng cña Robot SCATM khÝ nÐn - H×nh 2.1.3. B¶n vÏ l¾p chung cña Robot SCATM khÝ nÐn - H×nh 2.1.4. ¶nh chôp Robot SCATM khÝ nÐn 36
394 §iÒu chØnh 340 §iÒu chØnh 130 455 §iÒu chØnh 120 150 124,5 H×nh 2.1.2. Vïng ho¹t ®éng cña Robot SCATM khÝ nÐn 37
18 17 58 16 5 59 15 60 14 14 61 13 13 62 12 20 250 7 8 9 10 11 63 64 65 37 34 66 26 33 35 27 36 22 28 21 23 29 24 30 0 500 25 31 180 4 32 78 180 0 125 125 150 3 2 1 3600 530 165 250 38 H×nh 2.1.3 B¶n vÏ l¾p tæng thÓ Robot SCATM khÝ nÐn
H×nh 2.1.4. Robot SCATM khÝ nÐn 39
PHẦN II BÁO CÁO CÁC KẾT QUẢ NGHIÊN CỨU THEO NHIỆM VỤ 2 ĐỀ TÀI KC.03.08 MÔĐUN QUAY DÙNG BÁNH RĂNG CON LĂN I. GIỚI THIỆU CHUNG Trong các máy móc hiện đại được điều khiển số cũng như trong kỹ thuật robot, mỗi bậc tự do chuyển động đều có nguồn động cơ riêng kèm hộp giảm tốc và có bộ phận đo báo tín hiệu phản hồi về góc quay, tốc độ quay, như một môđun độc lập. Có 2 loại môđun cơ bản: Môđun tịnh tiến (translation module) và môđun quay (rotation module). Trong số các yêu cầu kỹ thuật đối với các mođun này cần nhấn mạnh đến các yếu tố sau: - Vì các môđun này gắn với từng khâu động, nối liên tiếp với nhau thành một chuỗi hở nên yêu cầu gọn nhẹ về kích cỡ là rất quan trọng. Các động cơ dùng trong môđun này có tốc độ cao, mà các khâu của robot chuyển động lại rất chậm, nên cần có các hộp giảm tốc tỷ số truyền cao. Nếu dùng hộp giảm tốc thông thường thì rất cồng kềnh, còn nếu dùng hộp giảm tốc hành tinh càng tỷ số truyền cao thì hiệu suất lại càng thấp, thậm chí không còn quay được nữa. - Khe hở cạnh răng là nguyên nhân bị trễ trong điều khiển các cơ cấu chấp hành có bánh răng thông thường. Trong các thiết bị điều khiển theo những chương trình nói chung và trong robot nói riêng yêu cầu triệt tiêu khe hở cạnh răng là rất quan trọng để đảm bảo điều khiển được trong thời 40
gian thực. Bộ truyền vítme bi trong môđun tịnh tiến đã đáp ứng yêu cầu này, vì có thể điều chỉnh được khe hở giữa viên bi và các rãnh xoắn ốc tiết diện lõm. Trong lúc đó yêu cầu này đối với bộ truyền bánh răng còn là đối tượng đang được nghiên cứu. Trong nhiều loại robot có tiếng trên thế giới các môđun quay thực hiện bằng bánh răng sóng (harmonic/ driver). Truyền động bánh răng sóng đạt được tỷ số truyền khá cao, có vành răng mỏng biến dạng được nên có thể triệt tiêu khe hở cạnh răng được. Tuy nhiên nhược điểm là hiệu suất tương đối thấp và nhất là rất khó chế tạo, giá bán rất cao. Cho nên nay hầu như đều phải mua của Hoa Kỳ. Hộp giảm tốc bánh răng con lăn (BRCL) có cả những ưu điểm của bánh răng sóng và của vítme bi, hiệu suất cao vì chuyển sang ma sát lăn và nhiều khả năng tồn tại màng dầu tiếp xúc thủy động. Hộp giảm tốc BRCL mới xuất hiện gần đây nhưng rất có nhiều triển vọng. Nội dung nghiên cứu tạo ra những môđun quay dùng BRCL là rất mới mẻ và hấp dẫ về mặt ý nghĩa khoa học và ý nghĩa thực tiễn. II. NHU CẦU CẦN CÓ MÔĐUN QUAY DÙNG BRCL Như đã đề cập ở mục giới thiệu chung, các môđun truyền động ở các khớp động trong robot có 2 yêu cầu quan trọng là gọn nhẹ về kích cỡ và triệt tiêu khe hở cạnh răng. Đối với truyền động tịnh tiến nếu dùng vítme bi thì có thể đáp ứng được các yêu cầu này. Còn đối với các khớp quay trong nhiều loại robot để đảm bảo được các yêu cầu này người ta phải dùng đến bánh răng sóng, rất đắt tiền vì rất khó chế tạo vành răng mỏng biến dạng được. Trước khi trình bày về BRCL cần phải tìm hiểu phân tích về 2 truyền động nói trên. 41
Truyền động vítme bi Truyền động vítme bi xuất hiện từ những năm đầu của thập kỷ 50 dùng cho máy điều khiển số. Ngày nay đã có rất nhiều hãng snả xuất loại truyền động này, dùng rộng rãi cho nhiều lĩnh vực, trong đó có kỹ thuật robot. Hiệu suất của truyền động vítme bi có thể hơn 90% vì khi có bi chen giữa 2 mặt ren lõm của vítme và đai ốc thì ma sát lăn đã thay cho ma sát trượt trong truyền động vítme thông thường. Nhiều cải tiến mới đã áp dụng. Trong đó có vấn đề chọn lựa hợp lý quan hệ đường kÝnh viên bi và đường kính tiết diện cắt ngang của các rãnh lăn cho phù hợp với điều kện ứng dụng cụ thể. Đồng thời phải quan tâm đến tốc độ di chuyển của viên bi trong rãnh lõm và đường hồi bi. Hai yêu tố này ảnh hưởng lớn đến hiệu ứng màng dầu thủy động và do vậy sẽ liên quan đến kích cỡ bộ truyền. Hình 2.2.1. Kết cấu bộ truyền vítme bi 42
Truyền động bánh răng sóng TruyÒn ®éng b¸nh r¨ng sãng (The harmonic drive) kh¸c biÖt so víi c¸c lo¹i truyÒn ®éng b¸nh r¨ng kh¸c lµ ë chç nã cã mét b¸nh r¨ng mÒm truyÒn sãng biÕn d¹ng vµ nhê vËy mµ truyÒn ®−îc chuyÓn ®éng quay (h×nh 2.2.2) H×nh 2.2.2. Bé truyÒn b¸nh r¨ng sãng. Bé truyÒn b¸nh r¨ng sãng gåm 3 bé phËn c¬ b¶n: b¸nh r¨ng mÒm 1, b¸nh r¨ng cøng 2 vµ cÇn t¹o sãng b. B¸nh r¨ng mÒm cã d¹ng èng vá máng. Mét ®Çu èng nèi víi trôc quay ω1, cßn ®Çu kia ®−îc c¾t r¨ng víi sè r¨ng Z1. Vµnh r¨ng nµy ®−îc biÕn d¹ng ®i mét ®¹i l−îng 2W0 do cÇn t¹o sãng g©y nªn. Nh− m« t¶ trªn s¬ ®å tiÕt diÖn c¾t ngang (h×nh 2.2d), do t¸c ®éng cña cÇn t¹o sãng vµnh r¨ng mÒm tõ h×nh trßn biÕn d¹ng thµnh h×nh enlip. Chu vi vµnh r¨ng khi biÕn d¹ng so víi chu vi vµnh r¨ng khi ch−a biÕn d¹ng, t¹o ra 2 sãng (xem h×nh khai triÓn trªn h×nh 2.2.2 d). Ph−¬ng AA lµ ph−¬ng biÕn 43
d¹ng lín, cßn ph−¬ng BB lµ ph−¬ng biÕn d¹ng nhá. §Ønh sãng biÕn d¹ng n»m trªn ph−¬ng AA, cßn ®¸y sãng biÕn d¹ng n»m trªn ph−¬ng BB. Tuú theo c¸ch t¹o sãng, sè sãng biÕn d¹ng cã thÓ lµ 1, 2, 3 v.v Th«ng th−êng lµ bé truyÒn 2 sãng vµ quan hÖ sè r¨ng gi÷a b¸nh r¨ng mÒm víi b¸nh r¨ng cøng lµ Z2 - Z1 = 2. Bé truyÒn b¸nh r¨ng sãng cßn dïng ®Ó truyÒn chuyÓn ®éng qua v¸ch ng¨n kÝn, cho nªn vá máng 1 th−êng lµm kÝn mét ®Çu. CÇn t¹o sãng dïng ®Ó h×nh thµnh vµ truyÒn sãng biÕn d¹ng trªn b¸nh r¨ng mÒm. Cã thÓ t¹o sãng b»ng ph−¬ng ph¸p c¬ khÝ, ®iÖn tõ, thuû lùc, khÝ nÐn. Theo ph−¬ng ph¸p c¬ khÝ cã thÓ dïng 2 con l¨n, 4 con l¨n, ®Üa l¨n, vßng l¨n hoÆc cam l¨n. §Æc ®iÓm ¨n khíp cña b¸nh r¨ng sãng: - Nhê cã b¸nh r¨ng mÒm biÕn d¹ng ®−îc nªn khe hë gi÷a c¸c cÆp r¨ng Z1 vµ Z2 ë miÒn ®Ønh sãng lµ rÊt bÐ, hoÆc gÇn nh− triÖt tiªu. - Còng nhê sù biÕn d¹ng cña b¸nh r¨ng mÒm nªn trong bé truyÒn b¸nh r¨ng sãng cã sè lín cÆp r¨ng cïng ¨n khíp (®Õn 40%). - Bé truyÒn b¸nh r¨ng sãng ®¹t ®−îc tû sè truyÒn lín. §èi víi bé truyÒn dïng b¸nh r¨ng mÒm b»ng thÐp, nÕu mét cÊp th× u = 50 ÷ 300, nÕu 2 cÊp th× u = 200 ÷ 104 hoÆc cßn cã thÓ cao h¬n n÷a. - Do cã nhiÒu cÆp r¨ng cïng ¨n khíp vµ cã thÓ t¹o ra mét vµi vïng ¨n khíp ®ång thêi, cho nªn cã thÓ bï trõ ®−îc c¸c sai sè chÕ t¹o, sai sè l¾p r¸p vµ nãi chung ®¹t ®−îc ®é chÝnh x¸c ®éng lùc t−¬ng ®èi cao.Còng nhê vËy mµ bé truyÒn b¸nh r¨ng sãng lµm viÖc ®Òu hoµ vµ Ýt g©y tiÕng ån h¬n so víi c¸c lo¹i b¸nh r¨ng kh¸c. - HiÖu suÊt bé truyÒn b¸nh r¨ng sãng còng kh«ng thÊp, vÝ dô khi tû sè truyÒn u = 50 ÷ 200 th× hiÖu suÊt trong kho¶ng 70 ÷ 85% 44
- Ngoµi ra bé truyÒn b¸nh r¨ng sãng cßn cã −u ®iÓm n÷a lµ nhê cã vµnh r¨ng mÒm ë mét ®Çu èng vá máng, biÕn d¹ng l¹i kh«ng lín, èng vá máng cã thÓ lµm mét ®Çu kÝn nªn cã thÓ t¹o ra c¬ cÊu bé truyÒn xuyªn kÝn qua v¸ch ng¨n gi÷a 2 m«i tr−êng kh¸c nhau (xem h×nh 9.3). §èi víi b¸nh r¨ng mÒm b»ng thÐp th× ®é biÕn d¹ng Wa = (0,003 ÷ 0,015)d1, cßn chiÒu dµy vá máng chç ch©n r¨ng hc = (0,005 ÷ 0,03)d1, víi d1 lµ ®−êng kÝnh èng vá máng. 1 2 3 H×nh 2.2.3. Bé truyÒn b¸nh r¨ng sãng xuyªn qua v¸ch ng¨n D−íi ®©y giíi thiÖu mét vµi øng dông truyÒn ®éng b¸nh r¨ng sãng trong kÕt cÊu robot. Trªn h×nh 2.2.4. lµ s¬ ®å cÊu t¹o mét khíp quay dïng b¸nh r¨ng sãng. Trong th©n hép 1 ®Æt ®éng c¬ ®iÖn 3 vµ bé phËn 2 nh©n tÝn hiÖu ph¶n håi liªn hÖ víi trôc ®éng c¬ b»ng c¸c b¸nh r¨ng 4, 5, 6. B¸nh r¨ng 5 g¾n liÒn víi trôc 10 ®Êu vµo bé truyÒn b¸nh r¨ng sãng. Trôc 10 lµ trôc khuûu, trªn ®ã g¾n c¸c ®Üa 9 ®Ó t¹o sãng biÕn d¹ng cho b¸nh r¨ng mÒm 8. B¸nh r¨ng 8 nµy ¨n khíp víi b¸nh r¨ng cøng 7 cè ®Þnh vµ g¾n víi trôc ®Çu ra 11 cña bé 45
truyÒn b¸nh r¨ng sãng. Trôc 11 g¾n liÒn víi kh©u tiÕp theo cña c¬ cÊu tay m¸y. H×nh 2.2.4 S¬ ®å cÊu t¹o mét khíp quay tay m¸y dïng B¸nh r¨ng sãng TruyÒn ®éng BRCL cã thÓ thay thÕ thµnh c«ng cho b¸nh r¨ng sãng v× nhiÒu −u ®iÓm v−ît tréi mµ gi¸ thµnh l¹i thÊp h¬n nhiÒu. Hép gi¶m tèc BRCL cã thÓ ®¹t ®−îc tû sè truyÒn cao h¬n, kÝch th−íc nhá gän h¬n, hiÖu suÊt cao h¬n do ma s¸t l¨n ®· thay thÕ cho ma s¸t tr−ît vµ mµng dÇu tiÕp xóc thñy ®éng cã hiÖu øng to lín. III. cÊu t¹o vµ nguyªn t¾c lµm viÖc 3.1. C¸c bé phËn chñ yÕu cña Hép gi¶m tèc BRCL VÒ cÊu t¹o hép gi¶m tèc b¸nh r¨ng con l¨n cã 4 bé phËn chñ yÕu: - Trôc vµo, trªn ®ã l¾p vßng lÖch t©m vµ trªn b¸nh lÖch t©m l¾p æ l¨n. - Vµnh r¨ng con l¨n cè ®Þnh 46
- B¸nh r¨ng l−în sãng l¾p trªn æ l¨n víi b¸nh lÖch t©m. Tr−êng hîp dïng 2 hoÆc 3 b¸nh th× t−¬ng øng cã 2 hoÆc 3 vßng lÖch t©m l¾p c¹nh nhau vµ lÖch nhau 1800 hoÆc 1200. - Trôc ra g¾n liÒn víi vµnh chèt con l¨n. Trªn h×nh 2.2.5 lµ s¬ ®å cÊu t¹o hép gi¶m tèc BRCL, cßn trªn h×nh 2.6 lµ h×nh bãc t¸ch c¸c bé phËn chñ yÕu cña hép gi¶m tèc BRCL. Con lăn vòng ngoài Đĩa răng Trục ra Chốt con lăn Ổ bi Trục vào H×nh 2.2.5. S¬ ®å cÊu t¹o Hép gi¶m tèc BRCL H×nh 2.2.6. C¸c bé phËn chñ yÕu cña Hép gi¶m tèc BRCL 47
3.2. Nguyªn lý lµm viÖc cña hép gi¶m tèc BRCL Trªn h×nh 2 m« t¶ lÇn l−ît c¸c pha chuyÓn ®éng cña hép gi¶m tèc BRCL (a) (b) (c) (d) H×nh 2. 2.7. C¸c pha chuyÓn ®éng cña hép gi¶m tèc BRCL H×nh 2.2.7 - a): B¸nh lÖch t©m l¾p ë æ l¨n quay cïng víi trôc vµo (g¾n ®éng c¬) 48
H×nh 2.2.7 - b): §Üa r¨ng l−în sãng l¾p trªn æ l¨n nãi trªn nªn còng cã ®é lÖch t©m so víi trôc vµo vµ cã chuyÓn ®éng hµnh tinh. Do ¨n khíp gi÷a r¨ng cña ®Üa víi c¸c con l¨n cña vµnh r¨ng con l¨n cè ®Þnh nªn ®Üa quay ng−îc chiÒu víi chiÒu quay cña trôc vµo. H×nh 2.2.7 - c): Do sè r¨ng cña ®Üa r¨ng Ýt h¬n 1 so víi sè r¨ng con l¨n nªn khi trôc vµo quay ®−îc 1 vßng th× ®Üa r¨ng míi quay quanh trôc t©m cña nã ®−îc 1 b−íc r¨ng. H×nh 2.2.7 - d): §Üa r¨ng truyÒn chuyÓn ®éng quay ®Õn trôc ra nhê c¸c con l¨n ®Çu ra. Nh− vËy, truyÒn ®éng BRCL cã thÓ ®¹t ®−îc tû sè truyÒn lín b»ng chÝnh sè r¨ng cña ®Üa r¨ng. iv. d¹ng r¨ng b¸nh r¨ng con l¨n 4.1. D¹ng r¨ng l−în sãng Trªn h×nh 2.2.8, r1 vµ r2 lµ b¸n kÝnh vßng l¨n (vßng t©m kÝnh). Khi l¨n vßng r2 trªn vßng r1, mét ®iÓm B nµo ®ã n»m trªn vßng trßn r2 sÏ vÏ nªn ®−êng epicyloid B0B1. NÕu thay ®iÓm B0 b»ng ®iÓm D0 còng g¾n liÒn víi vßng trong r2 nh−ng n»m phÝa ngoµi vßng r2 th× khi l¨n vßng r2 trªn vßng r1, ®iÓm D0 sÏ vÏ nªn ®−êng D0D1 epicyloid kÐo dµi (inflected epicyloid). B©y giê nÕu thay ®iÓm D0 b»ng chèt ®−êng kÝnh 2r th× khi l¨n vßng r2 trªn vßng r1 bao h×nh cña c¸c chèt lµ ®−êng sè 3 c¸ch ®Òu ®−êng epicyloid kÐo dµi. §ã chÝnh lµ d¹ng r¨ng ¨n khíp víi b¸nh r¨ng chèt. Nh− vËy ®èi víi bé truyÒn b¸nh r¨ng chèt, cÆp b¸nh r¨ng ¨n khíp víi nhau cã biªn d¹ng lµ ®−êng sè 3 vµ vßng trßn b¸n kÝnh r cña chèt. Qu¸ tr×nh h×nh thµnh ®−êng B0B1 vµ ®−êng D0D1 ®Òu hoµn thµnh khi b¸nh 2 quay ®i cïng mét gãc b»ng 2π. Khi ®ã vßng l¨n 2 ®· l¨n ®i võa trßn 2πr1 + B o B1 = 2πr1 + t 49
mét vßng 2πr2, cßn vßng l¨n 1 ®· l¨n ®i mét ®é dµi lµ : víi t lµ b−íc r¨ng. Do ®ã: t = 2π (r2 - r1) = 2πA. Víi A = 0102; MÆt kh¸c ta cã: 2πr t = 1 Z1 Víi Z1 lµ sè (nguyªn) lÇn ®−êng B0B1 vÏ ®−îc trªn chu vi vßng l¨n 1. So s¸nh (2.1) vµ (2.2) ta cã: r1 = AZ1 vµ r2 = r1 + A = A(Z1 + 1) V× r»ng: r Z 1 = 1 . r2 Z 2 Trªn h×nh (2.2.8) lµ bé truyÒn b¸nh r¨ng cã biªn d¹ng r¨ng ¨n khíp víi chèt lµ ®−êng c¸ch ®Òu epicycloid keã dµi gäi t¾t lµ bé truyÒn b¸nh r¨ng chèt - epicycloid. H×nh 2.2.8. S¬ ®å t¹o h×nh d¹ng r¨ng. 50
Trªn h×nh 2.2.9 lµ bé truyÒn BRCL cã biªn d¹ng r¨ng g¾n khíp lµ ®−êng c¸ch ®Òu ®−êng epicycloid kÐo dµi vµ t¹o ra ®Üa r¨ng l−în sãng. H×nh 2.2.9. D¹ng r¨ng b¸nh r¨ng l−în sãng Nh− vËy profile cña b¸nh r¨ng trong bé truyÒn BRCL kh«ng ph¶i lµ cycloid, kh«ng ph¶i lµ epicycloid, còng kh«ng ph¶i lµ epicycloid kÐo dµi (cßn gäi epitrokhoid) mµ lµ ®−êng c¸ch ®Òu cña ®−êng epitrokhoid. VÊn ®Ò l¹i cßn lµ dïng ®o¹n nµo cña ®−êng nµy v× b¶n th©n ®−êng epitrokhoid cã d¹ng h×nh häc rÊt kh¸c nhau trªn tõng ®o¹n (h×nh 2.2.10) Epitrokhoid H×nh 2.2.10. D¹ng h×nh häc cña ®−êng epitrokhoid V× vËy tªn gäi cña bé truyÒn nµy kh«ng nªn gäi lµ cycloid v× võa kh«ng chÝnh x¸c võa cã thÓ g©y nhÇm lÉn. D¹ng r¨ng ®ång hå, r¨ng ®Üa xÝch 51
v.v. lµ ®−êng cycloid hoÆc epicycloid. Gäi tªn lµ “hép gi¶m tèc b¸nh r¨ng con l¨n” lµ hoµn toµn chÝnh x¸c vµ hîp lý v× c¨n cø vµo dÊu hiÖu tiªu biÓu lµ “con l¨n”. Tªn dÞch ra tiÕng Anh lµ “Roller Gear Reducer” (Hép gi¶m tèc b¸nh r¨ng con l¨n). 4.2. X©y dùng biªn h×nh r¨ng b¸nh r¨ng con l¨n Trong [1] ®· m« t¶ nguyªn lý ho¹t ®éng vµ nguyªn lý t¹o h×nh cña lo¹i truyÒn ®éng b¸nh r¨ng kiÓu míi nµy (h×nh 2.2.1). Cã nhiÒu ph−¬ng ph¸p x©y dùng biªn h×nh r¨ng lo¹i nµy. VÝ dô ph−¬ng ph¸p dùng ®−êng bao cña c¸c con l¨n b¸n kÝnh rc lµm biªn h×nh r¨ng. D−íi ®©y tr×nh bµy ph−¬ng ph¸p x©y dùng biªn h×nh r¨ng dùa trªn nguyªn lý ¨n khíp sau: §iÒu kiÖn ®Ó ®iÓm N lµ ®iÓm tiÕp xóc gi÷a con l¨n vµ biªn h×nh r¨ng th× ph¸p tuyÕn cña nã ph¶i ®i qua t©m con l¨n M vµ t©m ¨n khíp P trong qu¸ tr×nh ¨n khíp m¸y (¨n khíp khi chÕ t¹o b¸nh r¨ng). Tõ ®iÒu kiÖn ®ã, trong [1] ®· x¸c ®Þnh ®−îc to¹ ®é cña ®iÓm N theo to¹ ®é cña ®iÓm M vµ ®iÓm P, nh− sau: yM − y N xN = xM − (xM − x p ) yM − Yp rc (yM − y p ) yN = yM − . 2 2 (xM − x p ) + (yM − y p ) [1] N.T.P. “Roller Gear Reducar” Mechanics. N02, 2002 52
4.3. Ph−¬ng ph¸p chän d¹ng r¨ng hîp lý Cho ®Õn nay ch−a cã mét tµi liÖu nµo nãi vÒ ph−¬ng ph¸p chän d¹ng r¨ng hîp lý cho bé truyÒn BRCL. Nh− ®· biÕt chän d¹ng r¨ng ®èi tiÕp nhau hîp lý l¹i lµ vÊn ®Ò chñ yÕu cña lý thuyÕt ¨n khíp b¸nh r¨ng. Ph©n tÝch c¸c catalog chµo hµng vµ c¸c s¶n phÈm cña c¸c c«ng ty n−íc ngoµi s¶n xuÊt hép gi¶m tèc lo¹i nµy cã thÓ thÊy c¸ch chän d¹ng r¨ng kh«ng nhÊt qu¸n. HÇu hÕt lµ ®Üa r¨ng d¹ng sãng l−în, nh−ng còng nhiÒu tr−êng hîp chç giao nhau gi÷a vßng ®Ønh r¨ng víi profin r¨ng kh«ng ph¶i lµ ®−êng cong liªn tôc. ThËm chÝ cã tr−êng hîp d¹ng r¨ng nh− r¨ng ®Üa xÝch xe ®¹p vµ chªnh nhau 2 hoÆc 3 r¨ng. ë ®©y ph−¬ng ph¸p chän d¹ng r¨ng xuÊt ph¸t tõ c¸c tiªu chÝ ®¸nh gi¸ bé truyÒn, tøc lµ thùc hiÖn gi¶i “bµi to¸n ng−îc” trong lý thuyÕt ¨n khíp b¸nh r¨ng. §ã lµ ®iÒu kh¸c biÖt næi bËt cña cña lo¹i bé truyÒn BRCL kiÓu míi nµy so víi c¸c c«ng tr×nh nghiªn cøu tr−íc nã. Trªn c¬ së “Lý thuyÕt ¨n khíp gÇn ®óng b¸nh r¨ng kh«ng gian tiÕp xóc enlip” [N.T.Phóc, LV] cã thÓ x©y dùng ®−îc c¸c tiªu chÝ ®¸nh gi¸ chÊt l−îng ¨n khíp. H¬n thÕ, cßn cã thÓ tÝnh to¸n cho tr−êng hîp ¨n khíp khi mÆt r¨ng bÞ biÕn d¹ng do t¶i vµ tr−êng hîp tiÕp xóc cã dÇu. §Æc biÖt lµ cã thÓ thiÕt kÕ “ng−îc” theo yªu cÇu cho tr−íc vÒ tiªu chÝ ¨n khíp. Trong bé truyÒn BRCL còng nh− trong truyÒn ®éng vÝtme bi tån t¹i sù ¨n khíp låi lâm cã kh¶ n¨ng tèt t¹o ra mµng dÇu thñy ®éng khi tiÕp xóc. Trong bµi b¸o vÒ. mµng dÇu [N.T. Phóc, 1976] ®· tr×nh bµy ph−¬ng ph¸p tÝnh to¸n vÒ mµng dÇu tiÕp xóc (h×nh 2.2.13) vµ ph©n tÝch vÒ c¸c th«ng sè h×nh häc ¶nh h−ëng ®Õn mµng dÇu tiÕp xóc (h×nh 2.2.14). 54
H×nh 2.2.13 TÝnh to¸n vÒ mµng dÇu tiÕp xóc H×nh 2.2.14. C¸c th«ng sè ¶nh h−ëng ®Õn mµng dÇu tiÕp xóc Khi ph©n tÝch vÒ truyÒn ®éng vÝtme bi chóng ta ®· nhÊn m¹nh ®Õn 2 yÕu tè lµ quan hÖ ®−êng kÝnh viªn bi víi ®−êng kÝnh tiÕt diÖn c¾t ngang c¸c r·nh lâm trªn vÝtme ®ai èc vµ tèc ®é di chuyÓn cña viªn bi trong c¸c r·nh lâm nµy. §ã chÝnh lµ 2 yÕu tèt chñ yÕu ¶nh h−ëng ®Õn mµng dÇu tiÕp xóc thñy ®éng. §èi víi truyÒn ®éng b¸nh r¨ng yÕu tè ¶nh h−ëng ®Õn mµng dÇu tiÕp xóc thñy ®éng kh«ng nh÷ng chØ lµ tèc ®é di chuyÓn mµ ph−¬ng di chuyÓn t−¬ng ®èi cña mÆt tiÕp xóc so víi vÞ trÝ cña enlip tiÕp xóc (h×nh 2.11). Quan träng h¬n lµ yÕu tè vÒ quan hÖ b¸n kÝnh cong cña c¸c mÆt tiÕp xóc. Trong truyÒn ®éng BRCL mét mÆt tiÕp xóc lµ mÆt trô con l¨n, cßn mÆt ®èi tiÕp víi nã lµ mÆt r¨ng cña b¸nh r¨ng. Quan hÖ gi÷a b¸n kÝnh con l¨n vµ b¸n kÝnh cong cña biªn h×nh tiÕt diÖn c¾t ngang cña mÆt ®èi tiÕp nµy chÝnh lµ ®èi t−îng cÇn chän lùa trong qu¸ tr×nh t×m d¹ng r¨ng hîp lý cho ®Üa r¨ng. 55
C¸c gi¸ trÞ ng−ìng cña 2 yÕu tè nãi trªn lµ nh÷ng sè liÖu ®Çu vµo quan träng trong ch−¬ng tr×nh x©y dùng biªn h×nh b¸nh r¨ng cña bé truyÒn BRCL. v. ph−¬ng ph¸p chÕ t¹o b¸nh r¨ng con l¨n Cã nhiÒu ph−¬ng ph¸p ®Ó chÕ t¹o b¸nh r¨ng con l¨n, c¾t r¨ng bao h×nh hoÆc c¾t b»ng dao ®Þnh h×nh. C¸c ph−¬ng ph¸p gia c«ng nµy ®Òu cã thÓ thùc hiÖn trªn c¸c m¸y gia c«ng b¸nh r¨ng th«ng dông vµ cã −u nh−îc ®iÓm nh− ®· biÕt. Ph−¬ng ph¸p c¾t r¨ng bao h×nh b¨ng dao xäc hoÆc dao phay l¨n cã n¨ng suÊt cao, nh−ng ®Ó biªn h×nh r¨ng ®−îc c¾t ®óng nh− thiÕt kÕ lý thuyÕt th× ph¶i rÊt kh¾t khe nªn rÊt ®¾t tiÒn khi chÕ t¹o con dao phay l¨n. Tuy vËy vÉn kh«ng ®¶m b¶o ®−îc ®é chÝnh x¸c cao vÒ biªn h×nh r¨ng. §iÒu nµy l¹i rÊt ¶nh h−ëng ®Õn chÊt l−îng ¨n khíp. ë ®©y ®Þnh h−íng nghiªn cøu vÒ ph−¬ng ph¸p chÕ t¹o b¸nh r¨ng con l¨n lµ khai th¸c c¸c thiÕt bÞ gia c«ng hiÖn ®¹i. Sau thêi gian qua nhiÒu thö nghiÖm cã thÓ ®i ®Õn kÕt luËn nh− sau: 1. ViÖc chÕ t¹o b¸nh r¨ng con l¨n trªn c¸c m¸y gia c«ng CNC lµ hoµn toµn hîp lý. M¸y gia c«ng CNC cã thÓ lµ m¸y c¾t d©y CNC, m¸y c¾t laser CNC, m¸y c¾t platsma CNC, m¸y c¾t tia n−íc CNC hoÆc m¸y phay CNC dïng dao phay ngãn v.v. Qua nhiÒu lÇn c¾t thö nhËn thÊy −u nh−îc ®iÓm sau ®©y trªn m¸y c¾t d©y CNC: - V× biªn h×nh cña b¸nh r¨ng con l¨n lµ ®−êng l−în sãng liªn tôc ®−îc m« t¶ b»ng ph−¬ng tr×nh gi¶i tÝch thuËn tiÖn cho viÖc lËp tr×nh trªn m¸y CNC. - Cïng mét lÇn g¸ trªn m¸y c¾t d©y CNC cã thÓ gia c«ng ®−êng biªn b¸nh r¨ng l−în sãng, lç l¾p æ l¨n vµ c¸c lç cho con l¨n g¾n víi trôc ®Çu ra. V× thÕ 56
vÒ tæng thÓ l¹i cã thÓ ®¹t ®é chÝnh x¸c cao h¬n ph−¬ng ph¸p c¾t b»ng dao phay l¨n hoÆc dao xäc r¨ng. - B¸nh r¨ng con l¨n th−êng ë d¹ng ®Üa máng vµ ph«i c¾t ®· ®−îc nhiÖt luyÖn, mµi ph¼ng nªn cã thÓ xÕp chång nhiÒu ®Üa lªn nhau råi c¾t mét lÇn vµ xem nh− c¾t tinh lu«n kh«ng ph¶i qua nhiÒu c«ng ®o¹n c¾t th«. V× thÕ n¨ng suÊt còng kh«ng ph¶i lµ thÊp vµ quan träng h¬n sù ®ång nhÊt cña b¸nh r¨ng xÕp thµnh bé (2 hoÆc 3 ®Üa) ®¶m b¶o ®é chÝnh x¸c cña bé truyÒn. - Cã thÓ nh−îc ®iÓm lµ ®é bãng bÒ mÆt r¨ng ch−a ®−îc cao tïy thuéc vµo viÖc sö dông lo¹i m¸y c¾t d©y CNC nµo. Ngoµi ra theo ph−¬ng ph¸p c¾t d©y th× n¨ng suÊt ch−a thËt lµ cao. 2. Khi s¶n xuÊt cã thÓ theo ph−¬ng ph¸p ®Ò xuÊt sau ®©y: §ã lµ chÕ t¹o b¸nh r¨ng l−în sãng b»ng c¸c ph−¬ng ph¸p gia c«ng ¸p lùc n¨ng suÊt rÊt cao. Sau ®ã mµi c¶ chång ®Üa b¸nh r¨ng trªn m¸y mµi r¨ng cã c¶i tiÕn. VÒ c¬ b¶n quy tr×nh c«ng nghÖ nµy ®· ®−îc so¹n th¶o. Tuy nhiªn ®ã ®· lµ mét vÊn ®Ò ®Çu t− cho s¶n xuÊt lín. Ph−¬ng ph¸p nµy kh«ng chØ bã hÑp trong ph¹m vi chÕ t¹o cho m«®un quay cña robot lµ mµ viÖc ®Çu t− lín cho viÖc s¶n xuÊt hép gi¶m tèc kiÓu míi thay thÕ cho hép gi¶m tèc th©n khai víi −u ®iÓm nhiÒu lÇn v−ît tréi. §©y lµ ph−¬ng ph¸p hßan toµn míi, ch−a n−íc nµo ¸p dông vµ cã thÓ ®em l¹i hiÖu qu¶ kinh tÕ rÊt lín v× thiÕt bÞ nµo còng cÇn ®Õn hép gi¶m tèc. vi. lËp tr×nh gia c«ng brcl trªn m¸y c¾t d©y cnc PhÇn mªm Auto English lµ 1 phÇn mÒm ®−îc thiÕt kÕ phï hîp cho m¸y tÝnh trung cÊp. Cïng víi sù hç trî cña nã, hÖ thèng cã thÓ kÕt hîp NC (®iÒu khiÓn b»ng kü thuËt sè). ChØ cÇn ng−êi sö dông vÏ h×nh cÇn thùc hiÖn lªn trªn mµn h×nh víi thiÕt bÞ nhËp lµ bµn phÝm, chuét hay c¸c thiÕt bÞ kh¸c. 57
Trong phÇn phô lôc giíi thiÖu ch−¬ng tr×nh c¾t b¸nh r¨ng con l¨n trªn m¸y c¾t d©y CNC. vii. sö dông brcl cho m«®un quay robot lµ gi¶i ph¸p hîp lý nhÊt Nh− ®· biÕt hép gi¶m tèc lµ bé phËn quan träng vµ quyÕt ®Þnh ®Õn kÝch th−íc vµ chÊt l−îng cña m«®un quay cña robot. Yªu cÇu ph¶i cã tû sè truyÒn cao ®Ó cã kÝch th−íc nhá gän vµ yªu cÇu triÖt tiªu khe hë c¹nh r¨ng ®Ó kh«ng bÞ trÔ trong ®iÒu khiÓn lµ 2 yªu cÇu quan träng nhÊt ®èi víi hép gi¶m tèc dïng cho m«®un quay robot. Hép gi¶m tèc BRCL kh«ng nh÷ng tháa m·n 2 yªu cÇu ®ã mµ cßn cã nh÷ng −u nh−îc ®iÓm kh¸c n÷a. Hép gi¶m tèc BRCL lµ lo¹i l¾p liÒn trôc víi ®éng c¬ rÊt thuËn tiÖn v× trong kiÓu gi¶m tèc nµy trôc ra ®ång trôc víi trôc vµo. Tû sè truyÒn cña hép gi¶m tèc BRCL ®¹t ®−îc rÊt cao th−êng dïng tõ 11 ®Õn 87 ®èi víi cÊp ®¬n, 10.000 ®èi víi lo¹i kÐp 2 vµ cao h¬n n÷a ®èi víi lo¹i kÐp 3. Dïng hép gi¶m tèc BRCL, so víi tr−êng hîp dïng hép gi¶m tèc b¸nh r¨ng trô th«ng th−êng, cã thÓ gi¶m kÝch cì tõ 1,5 ®Õn 2 lÇn, cßn träng l−îng gi¶m tõ 3 ®Õn 4 lÇn. B¶n th©n viÖc dïng bé truyÒn BRCL cho phÐp lùa chän ®éng c¬ ®iÖn cã sè vßng quay cao h¬n th× kh«ng chØ rÎ h¬n, n©ng cao h¬n hiÖu suÊt vµ hÖ sè cosϕ, mµ khèi l−îng ®éng c¬ còng nhá h¬n. Mét ®éng c¬ ®iÖn 7KW quay nhanh cã träng l−îng b»ng 1/2 ®éng c¬ ®iÖn quay chËm. Trong truyÒn ®éng b¸nh r¨ng kiÓu míi nµy, ma s¸t l¨n ®· thay thÕ cho ma s¸t tr−ît nªn hiÖu suÊt ®· t¨ng lªn râ rÖt vµ duy tr× ë møc cao, trªn 90%. Ngoµi ra víi nh÷ng quan hÖ h×nh häc ®éng hîp lý ë vïng tiÕp xóc gi÷a 58
b¸nh r¨ng vµ con l¨n cßn tån t¹i mµng dÇu thñy ®éng, nªn kh«ng nh÷ng c¶i thiÖn vÒ hiÖu suÊt mµ n©ng cao ®¸ng kÓ vÒ kh¶ n¨ng chÞu t¶i. §ång thêi kh¶ n¨ng t¶i cao cßn do sè r¨ng cïng vµo khíp kh«ng ph¶i chØ mét vµi r¨ng mµ ®Õn gÇn mét nöa sè r¨ng, nhÊt lµ khi hai b¸nh r¨ng ®−îc l¾p lÖch t©m ®èi xøng nhau. Còng chÝnh v× thÕ mµ cã thÓ triÖt tiªu ®−îc khe hë c¹nh r¨ng c©n b»ng lùc ly t©m, nªn lµm viÖc ªm dÞu. Víi nh÷ng −u ®iÓm ®ã hép gi¶m tèc BRCL kh«ng nh÷ng sÏ dïng réng r·i trong c¸c m«®un quay robot, mµ sÏ thay thÕ dÇn c¸c lo¹i hép gi¶m tèc th«ng th−êng kh¸c. viii. chuÈn hãa thiÕt kÕ hép gi¶m tèc brcl Ph¸t huy kÕt qu¶ nghiªn cøu vÒ truyÒn ®éng BRCL dïng cho m«®un quay robot vµ ®Ó nhanh chãng ®¸p øng c¸c yªu cÇu ®a d¹ng cña c¸c ®¬n vÞ hîp t¸c, §Ò tµi ®· b¾t ®Çu triÓn khai b−íc 1 vÒ chuÈn hãa thiÕt kÕ hép gi¶m tèc BRCL. Hai néi dung ®−îc triÓn khai trong b−íc 1 nµy lµ: - Ph¸c th¶o ®Þnh h−íng c¸ch ph©n lo¹i phôc vô cho triÓn khai c«ng nghiÖp sau nµy. Theo ®Þnh h−íng nµy cã thÓ t¸ch kÕt cÊu mét hép gi¶m tèc BRCL thµnh 3 lÇn: phÇn ®Çu vµo (V), phÇn gi÷a (G) vµ phÇn ®Çu ra (R). Trªn h×nh 2.2.15 lµ vÝ dô c¸c tr−êng hîp cô thÓ. 59
H×nh 2.2.15. KÕt cÊu HGT gåm 3 phÇn Ba phÇn nµy ®−îc liªn kÕt víi nhau b»ng bul«ng ghÐp. PhÇn G lµ phÇn ®−îc quan t©m nhÊt. Trong mét ph¹m vi nhÊt ®Þnh cã thÓ chØ thay phÇn G lµ cã mét nhãm hép gi¶m tèc kiÓu mét b¸nh, 2 b¸nh (l¾p lÖch t©m ®èi xøng nhau), 3 b¸nh (l¾p lÖch t©m chªnh nhau 1200), kiÓu ®¬n 1 cÊp, kÐp 2 cÊp, kÐp 3 cÊp hoÆc víi c¸c gi¸ trÞ tû sè truyÒn kh¸c nhau. Ngoµi ra tïy theo vÞ trÝ trôc cã lo¹i hép gi¶m tèc BRCL trôc ngang, hép gi¶m tèc BRCL trôc ®øng vµ cã lo¹i HGT liÒn trôc ®éng c¬ hoÆc kh«ng. Nh÷ng ph¸c th¶o b−íc ®Çu tr×nh bµy trong tËp lµi liÖu: “ChuÈn hãa thiÕt kÕ Hép gi¶m tèc B¸nh r¨ng con l¨n”. - X©y dùng ch−¬ng tr×nh thiÕt kÕ chuÈn hãa phÇn G. Néi dung ch−¬ng tr×nh bao gåm c¸c phÇn tõ x¸c ®Þnh d¹ng r¨ng ®Õn vÏ t« bãng m« h×nh 3D vµ vÏ ho¹t h×nh qu¸ tr×nh vËn hµnh cña bé truyÒn b¸nh r¨ng con l¨n. D−íi ®©y tr×nh bµy mét sè b¶n vÏ lµ kÕt qu¶ tÝnh to¸n theo ch−¬ng tr×nh m¸y tÝnh. Ch−¬ng tr×nh m¸y tÝnh ®−îc hoµn thµnh víi nhiÒu phiªn b¶n 60
do c¸c Th.S. NguyÔn TiÕn §øc, KS. §Æng V¨n Huynh, Th.S. Vò Lª Huy. Ch−¬ng tr×nh m¸y tÝnh ®−îc cÊp giÊy chøng nhËn b¶n quyÒn. C¸c vÝ dô: VÝ dô 1: MJV3-103-17 P1 = 2.5kW P2 = 2.2kW n1= 750 vßng/phót u = 17 R2 = 125mm Th«ng sè Ký hiÖu Gi¸ trÞ §¬n vÞ C¸c th«ng sè h×nh häc c¬ b¶n cña bé truyÒn Sè r¨ng ®Üa b¸nh r¨ng l−în sãng z1 17 Sè con l¨n vµnh r¨ng chèt con l¨n z2 18 Sè b¸nh r¨ng z 2 B¸n kÝnh vßng trßn qua t©m c¸c con l¨n R2 115.0 mm B¸n kÝnh con l¨n rc 14.00 mm B¸n kÝnh chèt trªn vµnh rchcl 10.00 mm Kho¶ng lÖch t©m cña bé truyÒn A 3.20 mm BÒ réng b¸nh r¨ng b 16.0 mm Kho¶ng c¸ch gi÷a c¸c b¸nh r¨ng vµ trôc 11 2.00 mm ra HÖ sè bÒ réng b¸nh r¨ng Xibd 0.0815 HÖ sè quan hÖ Raz 2.00 Trôc ®Çu vµo §−êng kÝnh ®o¹n trôc l¾p b¸nh r¨ng d1 25 mm KÝch th−íc then l¾p trôc vµo víi b¹c lÖch t©m BÒ réng then b 6.0 mm ChiÒu cao then h 6.0 mm §é s©u r·nh then trªn trôc t1 3.5 mm 61
§é s©u r·nh then trªn lç t2 2.8 mm ChiÒu dµi then 1 31.0 mm Sè then 1 KÝch th−íc b¹c lÖch t©m §−êng kÝnh trong d1 25 mm §−êng kÝnh ngoµi db 40 mm Trôc ®Çu ra B¸n kÝnh vßng trßn qua t©m c¸c chèt ®Çu Rt 70 mm ra Sè chèt ®Çu ra trªn trôc ra z 10 B¸n kÝnh chèt ®Çu ra rchra 11.00 mm B¸n kÝnh con l¨n ®Çu ra rp 12.5 mm §−êng kÝnh ®o¹n trôc ra d2 55.0 mm 62
H×nh 2.2.16. M« pháng 2D phÇn G cña hép gi¶m tèc BRCL (MJV3-103-17) 63
H×nh 2.2.17. M« pháng 3D phÇn G cña hép gi¶m tèc BRCL (MJV3-103-17) 64
VÝ dô 2: MJH 8-106-35 P1 = 5.86kW P2 = 5.5kW n1 = 1000vßng/phót u = 35 R2 = 130mm Th«ng sè Ký hiÖu Gi¸ trÞ §¬n vÞ C¸c th«ng sè h×nh häc c¬ b¶n cña bé truyÒn Sè r¨ng ®Üa b¸nh r¨ng l−în sãng z1 35 Sè con l¨n vµnh r¨ng chèt con l¨n z2 36 Sè b¸nh r¨ng z 2 B¸n kÝnh vßng trßn qua t©m c¸c con l¨n R2 140 mm B¸n kÝnh con l¨n rc 8.00 mm B¸n kÝnh chèt trªn vµnh rchcl 5.00 mm Kho¶ng lÖch t©m cña bé truyÒn A 2.50 mm BÒ réng b¸nh r¨ng b 25.00 mm Kho¶ng c¸ch gi÷a c¸c b¸nh r¨ng vµ trôc 11 2.00 mm ra HÖ sè bÒ réng b¸nh r¨ng Xibd 0.0947 HÖ sè quan hÖ Raz 1.56 Trôc ®Çu vµo §−êng kÝnh ®o¹n trôc l¾p b¸nh r¨ng d1 35 mm KÝch th−íc then l¾p trôc vµo víi b¹c lÖch t©m BÒ réng then b 10.0 mm ChiÒu cao then h 8.0 mm §é s©u r·nh then trªn trôc t1 5.0 mm §é s©u r·nh then trªn lç t2 3.3 mm ChiÒu dµi then 1 48 mm 65
Sè then 1 KÝch th−íc b¹c lÖch t©m §−êng kÝnh trong d1 35 mm §−êng kÝnh ngoµi db 55 mm Trôc ®Çu ra B¸n kÝnh vßng trßn qua t©m c¸c chèt ®Çu Rt 95 mm ra Sè chèt ®Çu ra trªn trôc ra z 10 B¸n kÝnh chèt ®Çu ra rchra 17.00 mm B¸n kÝnh con l¨n ®Çu ra rp 18.5 mm §−êng kÝnh ®o¹n trôc ra d2 85.0 mm 66
H×nh 2.2.18. M« pháng 2D phÇn G cña hép gi¶m tèc BRCL (MJH8-106-35) 67
H×nh 2.2.18. M« pháng 3D phÇn G cña hép gi¶m tèc BRCL (MJH8-106-35) 68
ix. m«®un quay brcl vµ m«®un hãa kÕt cÊu robot Nh− ®· tr×nh bµy trong phÇn giíi thiÖu chung. Mét m«®un quay gåm cã c¸c bé phËn chñ yÕu sau: §éng c¬ ®iÖn, Hép gi¶m tèc, Bé phËn ®o b¸o sè vßng quay. Khi dïng hép gi¶m tèc BRCL th× cã thÓ t¹o ra m«®un quay gän nhÑ h¬n nhiÒu, v× b¶n th©n bé truyÒn BRCL cã tû sè truyÒn rÊt cao, kÐo theo cã thÓ dïng ®éng c¬ quay nhanh do ®ã b¶n th©n ®éng c¬ còng nhá gän ®i. Trong bé truyÒn BRCL mas¸t l¨n ®· thay thÕ cho mas¸t tr−ît nªn hiÖu suÊt t¨ng lªn râ rÖt. H¬n thÕ, c¸c con l¨n tiÕp xóc víi c¸c mÆt lâm cña b¸nh r¨ng vµ vËn tèc di chuyÓn th¼ng gãc víi ph−¬ng tiÕp xóc nªn rÊt thuËn lîi cho viÖc t¹o nªn mµng dÇu thñy ®éng. V× thÕ kh¶ n¨ng chÞu t¶i n©ng cao lªn râ rÖt, còng cã nghÜa lµ ®¸p øng cïng mét yªu cÇu vÒ m«®un t¶i cã thÓ dïng lo¹i ®éng c¬ vµ hép gi¶m tèc nhá ®i. Mét yÕu tè quan träng n÷a lµm t¨ng kh¶ n¨ng chÞu t¶i cña hép gi¶m tèc BRCL lµ cã thÓ bè trÝ 2 b¸nh lÖch t©m chªnh nhau 1800. Nh− vËy cã 2 vïng ¨n khíp vµ hÇu nh− tÊt c¶ sè r¨ng cïng vµo khíp mét lóc, cho nªn kh«ng nh÷ng t¨ng kh¶ n¨ng chÞu t¶i lªn rÊt cao, mµ cßn triÖt tiªu ®−îc khe hë c¹nh r¨ng khi ®¶o chiÒu quay. ý t−ëng chung trong viÖc nghiªn cøu thiÕt kÕ robot lµ “m«®un hãa”. M«®un ®−îc hiÓu lµ mét côm c¸c bé phËn hîp thµnh, cã nh÷ng chøc n¨ng cô thÓ t−¬ng ®èi hoµn chØnh. Ngay trong kÕt cÊu cña hép gi¶m tèc BRCL còng ®−îc thiÕt kÕ nh− 3 phÇn ghÐp l¹i, trong ®ã phÇn gi÷a (phÇn G) xem nh− mét m«®un thay ®æi ®−îc víi nhiÒu cÊp bËc tû sè truyÒn kh¸c nhau ®Ó ghÐp nèi víi 2 phÇn cßn l¹i thµnh c¸c hép gi¶m tèc kh¸c nhau. TiÕn xa h¬n, cã thÓ t¹o ra nh÷ng “kh©u chuÈn hãa” nh− nh÷ng m«®un ghÐp nèi l¹i thµnh c¬ cÊu robot. Së dÜ cã thÓ ®Æt ra vÊn ®Ò nh− vËy v×, nh− ®· biÕt, c¸c kh©u t¹o thµnh c¬ cÊu robot ®Òu cã nguån ®éng lùc riªng. 69
Nh− vËy vÝ dô minh häa, §Ò tµi ®· nghiªn cøu thiÕt kÕ chÕ t¹o c¸c m«®un quay dïng BRCL vµ l¾p r¸p phèi hîp thµnh c¸c kiÓu robot kh¸c nhau. H×nh 2.2.20 lµ robot SCATM mét c¸nh tay vµ h×nh 2.2.21 lµ robot SCATM hai c¸nh tay dïng cho c«ng viÖc l¾p r¸p. H×nh 2.2.20. Robot SCATM mét c¸nh tay m«®un hãa 765 756 H×nh 2.2.21. Robot SCATM hai c¸nh tay m«®un hãa 70
ViÖc m«®un hãa kÕt cÊu robot lµ theo xu thÕ chung ®èi víi thiÕt bÞ c«ng nghiÖp. ViÖc lµm nµy cã c¸c −u ®iÓm næi bËt lµ cã thÓ ®a d¹ng hãa lo¹i h×nh kÕt cÊu robot trong lóc vÉn chuyªn m«n hãa s¶n xuÊt chÕ t¹o tõng lo¹i m«®un nªn ®¶m b¶o ®−îc gi¸ thµnh gia c«ng vµ chÊt l−îng s¶n phÈm. Hå s¬ kü thuËt vµ c¸c b¶n vÏ vÒ m«®un quay dïng BRCL vµ vÒ kÕt cÊu m«®un hãa c¸nh tay robot sÏ ®−îc tr×nh bµy trong phÇn phô lôc. 71
X. mét sè s¶n phÈm brcl ®∙ ®−îc thiÕt kÕ chÕ t¹o Trong môc nµy tr×nh bµy c¸c kÕt qu¶ nghiªn cøu thiÕt kÕ, chÕ t¹o c¸c s¶n phÈm BRCL, chia thµnh 3 nhãm. 1) C¸c bé truyÒn BRCL dïng cho m«®un quay. VÒ néi dung nghiªn cøu thiÕt kÕ, c¸c b¶n vÏ vµ hå s¬ kü thuËt ®· tr×nh bµy trong môc “M«®un quay BRCL vµ m«®un hãa kÕt cÊu robot”. ë ®©y chñ yÕu chØ giíi thiÖu mét sè mÉu s¶n phÈm ®· chÕ t¹o. H×nh 2.2.22. C¸c chi tiÕt m¸y hîp thµnh m«®un quay BRCL H×nh 2.2.23. M«®un quay BRCL 72
H×nh 2.2.24. C¸c m«®un quay BRCL th¸o rêi 73
H×nh 2.2.25. C¸c b¸nh r¨ng l−în sãng 2) Hép gi¶m tèc BRCL dïng cho c«ng nghiÖp. Ph¸t triÓn kÕt qu¶ nghiªn cøu BRCL cã thÓ t×m thÊy øng dông réng r·i trong c«ng nghiÖp. Ngµy nay c¸c thiÕt bÞ c«ng nghiÖp råi sÏ ®−îc chuyÓn sang ®iÒu khiÓn sè lµ chÝnh. V× thÕ yªu cÇu triÖt tiªu khe hë c¹nh r¨ng trong bé truyÒn b¸nh r¨ng sÏ ®Æt ra nh− mét yªu cÇu bøc b¸ch. Cho nªn cÇn n¾m b¾t nhu cÇu nµy mµ sím ®Çu t− khoa häc cho lÜnh vùc nµy. NhÊt lµ trong c«ng nghiÖp ViÖt nam ch−a cã c¬ së nµy thùc sù lµ c¬ së s¶n xuÊt hép gi¶m tèc. Ngoµi ra yªu cÇu triÖt tiªu khe hë c¹nh r¨ng ®Ó ®¸p øng ®ßi hái vÒ ®iÒu khiÓn kh«ng trÔ cña c¸c thiÕt bÞ ®−îc ®iÒu khiÓn sè, cßn cã c¸c nhu cÇu ë c¸c thiÕt bÞ di ®éng võa ®ßi hái gän nhÑ, võa yªu cÇu hiÖu suÊt cao ®Ó tiÕt kiÖm n¨ng l−îng, nhÊt lµ thiÕt bÞ ch¹y b»ng ¾c quy. Trong tr−êng hîp nµy truyÒn ®éng BRCL tá ra cã triÓn väng nhÊt. Bªn c¹nh c¸c yªu cÇu nãi trªn c¸c tiªu chÝ th−êng xuyªn ®Æt ra víi c¸c bé truyÒn b¸nh r¨ng ®é bÒn cao, kh¶ n¨ng chÞu t¶i lín, ®é chÝnh x¸c chÕ t¹o ®¹t ®−îc ë cÊp cao mµ gi¸ thµnh l¹i h¹ thÊp. Hép gi¶m tèc BRCL hßan 74
toµn ®¸p øng ®−îc c¸c tiªu chÝ ®ã vµ rÊt nhiÒu triÓn väng thay thÕ dÇn c¸c lo¹i hép gi¶m tèc b¸nh r¨ng th©n khai ®ang dïng hiÖn nay. H×nh 2.2.26. C¸c hép gi¶m tèc BRCL ®−îc chÕ t¹o cho øng dông c«ng nghiÖp 75
H×nh 2.2.27. Hép gi¶m tèc BRCL víi cÆp ®Üa r¨ng l−în sãng vµ hép ®iÒu khiÓn 76
58 Khíp nèi 1 57 Then 2 56 Vßng ch¾n dÇu H×nh 2.2.29.VÝdôb¶n thiÕtkÕ 55 Trôc ®Çu vµo 1 54 æ bi 20x47x14 53 Vßng lÖch t©m 1 52 Vßng lß xo 2 51 £ cu 12 50 49 Vßng l¨n r¨ng chèt 1 48 Vßng c¸ch 1 47 Vßng lÖch t©m 2 46 æ bi 30x55x13 45 Then 3 44 Bu l«ng 12 M12 43 Vßng c¸ch 2 42 æ bi 15x35x11 41 £ cu 16 40 æ bi 40x80x18 39 KhípVµnh nèir¨ng 2 2 38 Trôc ®Çu vµo 2 37 Vßng c¸ch 3 25 24 23 22 21 20 19 1817 16 15 14 13 12 11 10 987 6 5 4 3 2 1 36 R¨ng chèt 2 35 Bu l«ng 16 M16 34 Vßng l¨n r¨ng chèt 2 33 Vßng lÖch t©m 3 32 Vßng lÖch t©m 4 31 Vßng c¸ch 4 30 æ bi 65x140x33 29 æ bi 30x62x16 28 Then 6 Hép gi¶mtècBRCL2 cÊpkÐp 27 oá bi 55x120x29 26 Vßng ch¾n dÇu 55x80x12 25 Vò mì 24 Th©n ®Çu ra 23 Trôc ®Çu ra 2 22 Vßng lß xo 2 21 Con l¨n chèt ®Çu ra 2 20 æ bi 45x85x19 19 æ bi 45x85x19 18 Then 5 17 Chèt 2 16 Then 4 15 Th©n gi÷a 14 Bu l«ng vßng 13 Vßng lß xo 1 12 Trôc ®Çu ra 1 26 27 28 29 3031 32 3334 35 36 37 38 3940 41 42 43 44 45 46 47 48 49 50 5152 53 54 5556 57 58 11 Con l¨n chèt ®Çu ra 1 10 Chèt 1 9 R¨ng chèt 1 8 Vµnh r¨ng 1 7 B¸nh r¨ng 15 6 B¸nh r¨ng 15 5 GÝa ®ì trôc ®Çu vµo 4 Th©n ®Çu vµo 3 æ bi 45x85x19 2 Vßng ch¾n dÇu 45x70x12 1 Then 1 STT Tªn chi tiÕt KÝ hiÖu Sè l−îng VËt liÖu Ghi chó Tr.nhiÖm Hä vµ tªn Ký Ngµy Hép gi¶m tèc BRCL VËt liÖu : ThiÕt kÕ Nguy?n Ti?n Đ?c Sè l−îng : TØ lÖ : 78 KiÓm tra Nguy?n Van Minh DuyÖt Nguy?n Thi?n Phúc b¶n vÏ l¾p Chi tiÕt sè:
H×nh 2.2.30. Hépgi¶mtèc 23 Vßng lÖch t©m02 ThÐp 45 22 N¾p duíi 01 ThÐp 45 21 Chèt ®Þnh vÞ 06 ThÐp 45 20 Vµnh r¨ng 01 ThÐp 45 19 B¸nh r¨ng 29 02 ThÐp 45 18 Vßng c¸ch 01 PhÝp 17 æ bi 12x24x6 02 16 Chèt 01 ThÐp 45 15 æ bi 20x42x12 01 14 PhÇn l¾p sen s¬ 01 ThÐp 45 13 Trôc ®Çu ra 01 ThÐp 45 BRCL cho m«®un quayrobot 12 Then 2 01 ThÐp 45 11 Then 1 01 ThÐp 45 10 Vßng ch¾n dÇu 01 Xevanit11 9 æ bi 17x35x10 01 8Vò mì 01 7 Th©n ®Çu ra 01 ThÐp 45 5 Chèt ®Çu ra 06 ThÐp 45 4 Con l¨n chèt ®Çu ra 06 ThÐp 45 3 Con l¨n 30 ThÐp 45 201MiÕng ®Öm ThÐp 45 1 N¾p trªn 01 ThÐp 45 STTTªn chi tiÕt Sè l\'eeng VËt liÖu Tr.nhiÖm Hä vµ tªn Ký Ngµy hép gi¶m tèc i=29 79 ThiÕt kÕ Tû lÖ : b¶n vÏ l¾p KiÓm tra §¹i häc B¸ch Khoa hµ néi DuyÖt
3) Hép gi¶m tèc BRCL dïng cho c«ng t¸c häc tËp ý thøc r»ng lo¹i h×nh truyÒn ®éng BRCL lµ rÊt cã triÓn väng øng dông réng r·i trong nhiÒu lÜnh vùc c«ng nghiÖp vµ ®ang trong giai ®o¹n nghiªn cøu s¸ng t¹o phï hîp víi nh÷ng ph−¬ng ph¸p c«ng nghÖ míi, §Ò tai ®· lµm thªm mét viÖc lµ chÕ t¹o cho tr−êng häc nh÷ng hép gi¶m tèc BRCL cã thªn hép b»ng vËt liÖu trong suèt. Ng−êi häc cã thÓ hiÓu nã vËn hµnh ra sao nh×n thÊy râ trôc ®éng c¬ nèi liÒn víi trôc ®Çu vµo quay nhanh ®Õn thÕ mµ trôc ®Çu ra ®−îc quay rÊt chËm H×nh 2.2.31. Hép gi¶m tèc BRCL víi th©n hép chÕ t¹o b»ng vËt liÖu trong suèt ®Ó phôc vô ®µo t¹o 80
H×nh 2.2.32. S¶n xuÊt hép gi¶m tèc BRCL phôc vô ®µo t¹o 81
IV. KÕt luËn TriÓn khai thùc hiÖn nhiÖm vô 2 lµ nghiªn cøu c¶i tiÕn n©ng cÊp robot SCATM ®Ó ®¸p øng yªu cÇu th«ng minh, §Ò tµi ®· b¾t gÆp néi dung t¹o ra nh÷ng khíp quay robot, trong ®ã ph¶i cã truyÒn ®éng b¸nh r¨ng kh«ng cã khe hë c¹nh r¨ng ®Ó khi ®iÒu khiÓn kh«ng bÞ trÔ. Do vËy ®· xuÊt hiÖn nhu cÇu nghiªn cøu vÒ m«®un quay dïng BRCL. Víi néi dung nghiªn cøu nµy §Ò tµi ®· nhËn ®−îc c¸c kÕt qu¶ khoa häc chñ yÕu sau: 1) §Ò xuÊt ph−¬ng ph¸p x©y dùng d¹ng r¨ng b¸nh r¨ng l−în sãng theo yªu cÇu ®Æt tr−íc ®èi víi bé truyÒn BRCL (b¸nh r¨ng con l¨n) vµ thiÕt lËp ch−¬ng tr×nh m¸y tÝnh thiÕt kÕ hép gi¶m tèc BRCL. Ch−¬ng tr×nh nµy ®· ®−îc cÊp giÊy chøng nhËn b¶n quyÒn. 2) §Ò xuÊt ph−¬ng ph¸p chÕ t¹o b¸nh r¨ng con l¨n trªn m¸y gia c«ng CNC vµ kh«ng dïng dao (dao phay l¨n hoÆc dao xäc) ®Ó tr¸nh sai lÖch so víi d¹ng r¨ng lý thuyÕt. Trong tr−êng hîp s¶n xuÊt lo¹t lín ®Ò xuÊt dïng c¸c ph−¬ng ph¸p gia c«ng ¸p lùc tr−íc nguyªn c«ng mµi ®Ó chÕ t¹o BRCL, cã ®é chÝnh x¸c cao vÒ t¹o h×nh vµ gi¸ thµnh thÊp. 3) HiÖn thùc viÖc m«®un hãa thiÕt kÕ m«®un quay vµ kÕt cÊu robot ®Ó ®¸p øng nhu cÇu ®a d¹ng lo¹i h×nh robot trong lóc vÉn cã thÓ chuyªn m«n hãa s¶n xuÊt chÕ t¹o tõng lo¹i m«®un ®¶m b¶o ®−îc gi¸ thµnh gia c«ng vµ chÊt l−îng s¶n phÈm. 4) ChÕ t¹o thö nghiÖm thµnh c«ng nhiÒu s¶n phÈm BRCL. Trong ®ã cã m«®un quay robot dïng BRCL, c¸c hép gi¶m tèc BRCL dïng cho c«ng nghiÖp, hép gi¶m tèc BRCL phôc vô c«ng t¸c ®µo t¹o. 82
PHẦN III BÁO CÁO CÁC KẾT QUẢ NGHIÊN CỨU THEO NHIỆM VỤ 2 ĐỀ TÀI KC.03.08 MÔĐUN DÂY CHUYỀN TỰ ĐỘNG DÙNG ROBOT SCATM ĐÓ PHÂN LOẠI SẢN PHẨM THEO MÀU SẮC I. GIỚI THIỆU CHUNG Trong phần báo cáo này trình bày kết quả nghiên cứu xây dựng môđun dây chuyền tự động dùng robot SCATM để phân loại sản phẩm theo màu sắc. Đây là một sản phẩm minh họa về cách thức “thông minh hóa” hoạt động của robot. Tất nhiên khả năng “thông minh” của robot của robot phải thể hiện trên một công việc cụ thể. Trong môđun dây chuyền tự động này, máy tính sẽ trực tiếp điều khiển các chuyển dịch của robot và các sản phẩm trên dây chuyền theo các tín hiệu về màu sắc do các sensor nhận biết. Định hướng ứng dụng của nội dung nghiên cứu này là công nghiệp hàng tiêu dùng. Trong các dây chuyền sản xuất này bộ phận phân loại sản phẩm luôn luôn có mặt như một môđun của hệ thống thiết bị sản xuất. Ở đây dùng Robot SCATM thao tác phối hợp với các băng truyền điều chỉnh được tốc độ, có trang bị các sensor nhận biết được màu sắc và toàn bộ hệ thống được điều khiển bằng máy tính. Nội dung nghiên cứu này bao gồm một khối lượng lớn các công việc từ thiết kế, chế tạo, lắp ráp vận hành toàn bộ hệ thống chấp hành cơ, điện, 83
khí nén, các thiết bị phần cứng của hệ thống điều khiển và chương trình phần mềm điều khiển toàn bộ hệ thống nói trên. Các thiết bị chủ yếu của hệ thống gồm: Robot SCATM, bộ phận khí nén, 2 băng truyền, bộ phận truyền động với tốc độ thay đổi được, bộ phận thu hồi sản phẩm và bộ phận điều khiển. Ngoài Robot SCATM đã trình bày riêng ở phần trên, dưới đây giới thiệu tóm tắt các bộ phận còn lại trong 2 mục: Hệ thống băng truyền và hệ thống điều khiển. II. HỆ THỐNG BĂNG TRUYỀN Hệ thống băng truyền được thiết kế đảm bảo cho các sản phẩm đặt trên đó di chuyển đều đặn với tốc độ đã định. Đảm bảo mặt băng bằng phẳng và đủ rộng để phân nhiều luồng sản phẩm theo từng màu sắc. So với vị trí đặt Robot SCATM bố trí 2 băng truyền: Băng thứ nhất đem sản phẩm tới Robot và băng thứ 2 đưa sản phẩm đi. Trong điều khiển chật hẹp của phòng thí nghiệm các băng tải đều rút nhỏ kích thước và bổ xung thêm bộ phận thu hồi sản phẩm từ cuối băng chuyền thứ 2 về đầu băng truyền thứ 1. Dưới đây là bộ hồ sơ kỹ thuật của hệ thống băng truyền gồm: - H×nh 2.3.1. Các bản vẽ lắp Môđun dây chuyền dùng robot SCATM - H×nh 2.3.2. Các ảnh chụp Môđun dây chuyền dùng Robot SCATM (nhìn từ nhiều phía). - H×nh 2.3.3. Các bản vẽ và ảnh chụp về hệ thống khí nén. - H×nh 2.3.4. Các ảnh chụp hệ thống truyền dẫn động và biến tần - H×nh 2.3.5. Các ảnh chụp và bản vẽ lắp bộ phận thu hồi sản phẩm 84
3 2 H×nh 2.3.1. B¶nvÏl¾pM«®und©y c 1 A A A huyÒn s¶n xuÊt dïngRobotSCA A 3 Tñ ®iÖn 1 2 1 TM Robot SCA 1 85 1 M« ®un b¨ng t¶i §¬n vÞ VÞ trÝ Tªn gäi Sè l−îng VËt liÖu Tæng sè Ghi chó Khèi l−îng Tr. nhi?m H? và tên Ký Ngày D¢Y TRUYÒn ph©n lo¹i Đ? tài KC - 03 - 08 Thi?t k? Hoµng Anh §¹i s¶n phÈm theo m¸u s¾c B?n v? s?: S? lu?ng: T? l?: Ki?m tra Nguy?n Van Minh B¶n vÏ l¾p Duy?t Nguy?n Thi?n Phúc Trung tâm NCKT T? d?ng hóa Tru?ng Đ?i h?c Bách Khoa Hà N?i
H×nh 2.3.3.S¬ ®å vµ ¶nh chôp vÒ hÖ thèng khÝ nÐn ®iÒu khiÓn b¨ng truyÒn dïng Robot SCATM 87
H×nh 2.3.4. Van khÝ nÐn ®iÖn tõ ®iÒu khiÓn Robot SCATM vµ b¨ng truyÒn H×nh 2.3.5. Bé phËn thu håi s¶n phÈm 88
M« t¶ th«ng sè kü thuËt cña hÖ thèng khÝ nÐn cho Robot SCATM vµ b¨ng truyÒn 1. Xy lanh bµn kÑp tay m¸y SCATM * Ký hiÖu: HGW-25-A * §Æc tÝnh kü thuËt: - DÉn ®éng b»ng xy lanh khÝ nÐn t¸c ®éng kÐp - §Þnh t©m tù ®éng - T¸c ®éng cña ngãn kÑp: KÑp bªn ngoµi hoÆc kÑp bªn trong. - Cã kh¶ n¨ng tæ hîp víi c¸c dÉn ®éng kh¸c - Cã thÓ g¾n c¶m biÕn vÞ trÝ tõ tÝnh hoÆc c¶m biÕn Hall. - Linh ho¹t víi kÑp tõ bªn ngoµi - Lùc kÑp lµ h»ng sè kh«ng phô thuéc vµo gãc kÑp. - Gãc më tèi ®a cña m¸ kÑp lµ 400 - §é chÝnh x¸c lËp l¹i: ± 0,02 mm - §é chÝnh x¸c kho¶ng c¸ch: < 0,2 mm - Sè ngãn kÑp: 2 - ¸p suÊt lµm viÖc: 2-8 bar - TÇn sè lµm viÖc lín nhÊt cña bµn kÑp: 4 Hz - Thêi gian më nhá nhÊt ë ¸p suÊt 6 bar: 10 ms - Thêi gian më ®ãng nhÊt ë ¸p suÊt 6 bar: 10 ms - NhiÖt ®é m«i tr−êng lµm viÖc: 5 - 60 0C - M« ment tay kÑp më ë ¸p suÊt 2 bar = 60 Ncm - M« ment tay kÑp më ë ¸p suÊt 4 bar = 120 Ncm - M« ment tay kÑp më ë ¸p suÊt 6 bar = 180 Ncm - M« ment tay kÑp ®ãng ë ¸p suÊt 2 bar = 53,5 Ncm - M« ment tay kÑp ®ãng ë ¸p suÊt 4 bar = 106,7 Ncm - M« ment tay kÑp ®ãng ë ¸p suÊt 2 bar = 160 Ncm - Lùc lín nhÊt ë m¸ kÑp Fz tÜnh = 54 N - M« ment lín nhÊt ë m¸ kÑp Mx tÜnh = 1,7 Nm - M« ment lín nhÊt ë m¸ kÑp My tÜnh = 0,6 Nm - M« ment lín nhÊt ë m¸ kÑp Mz tÜnh = 1,1 Nm - Träng l−îng: 250 g - §Çu nèi khÝ: M5 - VËt liÖu: Hîp kim nh«m 89
- M¹ anod cøng - M¸ kÑp ®−îc m¹ Niken KÝch th−íc: 2. Xy lanh quay: * Ký hiÖu: DSR-12-180 * Th«ng sè kü thuËt: - Nguyªn lý: xy lanh quay kiÓu c¸nh g¹t, gãc quay cã thÓ ®iÒu chØnh ®−îc. HÖ thèng dõng ®−îc t¸ch riªng khái c¸nh g¹t v× thÕ lùc qu¸n tÝnh ®−îc hÊp thô b»ng gi¶m chÊn vµ cam giíi h¹n hµnh tr×nh th«ng qua tÊm nhùa linh ho¹t. - Lùc ®Èy ®−îc truyÒn trùc tiÕp ®Õn trôc quay qua c¸c c¸nh g¹t b»ng chuyÓn ®éng l¾c qua l¹i. 90
- Lùc ®Èy max: 0,5 Nm - C¶m biÕn giíi h¹n hµnh tr×nh: c«ng t¾c c¬ ®iÖn mini hoÆc c¶m biÕn tõ tÝnh - Gãc l¾c cã thÓ hiÖu chØnh tõ 00 ®Õn 1800 . - Cã thÓ g¸ l¾p ë bÊt cø vÞ trÝ nµo. - ¸p suÊt lµm viÖc: 2 - 8 bar - TÇn sè l¾c lín nhÊt ë 6 bar : 3 Hz - NhiÖt ®é m«i tr−êng lµm viÖc: -100C ®Õn 600C - M« ment ë 6 bar: 1 Nm - §Çu nèi khÝ nÐn: M5 - VËt liÖu lµm trôc: ThÐp - M¹ Niken - Vßng lµm kÝn: NBR KÝch th−íc: 3. Xy lanh khÝ: * Ký hiÖu: DSN-25-100-PPV-A * Th«ng sè kü thuËt: - Hµnh tr×nh: 100 mm - §−êng kÝnh piston: 25mm - Ren cÇn piston: M10x1.25 - Gi¶m chÊn cuèi hµnh tr×nh: Vßng gi¶m chÊn ®µn håi ë c¶ hai phÝa 91
- ¸p suÊt lµm viÖc: 1 - 10 bar - ChÕ ®é lµm viÖc: t¸c dông kÐp - NhiÖt ®é m«i tr−êng lµm viÖc: -20 - 80 °C - Lùc ®Èy lý thuyÕt ë 6 bar, hµnh tr×nh trë vÒ: 247.4 N - Lùc ®Èy lý thuyÕt ë 6 bar, hµnh tr×nh tiÕn ra: 294.5 N - Khèi l−îng chuyÓn ®éng víi hµnh tr×nh 0 mm: 71 g - Khèi l−îng ccéng thªm cho mçi hµnh tr×nh 10 mm: 11g - Träng l−îng c¬ b¶n cho hµnh tr×nh 0 mm: 238 g - §Çu nèi ren khÝ nÐn: G 1/8" - VËt liÖu vá xy lanh: Hîp kim nh«m ®−îc an«d ho¸ - VËt liÖu vßng lµm kÝn: TPE-U(PU) NBR - VËt liÖu xy lanh: ThÐp hîp kim cao cÊp, kh«ng rØ - VËt liÖu piston: ThÐp hîp kim cao cÊp, kh«ng rØ Van ®iÖn tõ lo¹i nhá CPE: * Ký hiÖu: CPE14-M1BH-5L-1/8 * Th«ng sè kü thuËt: - Van ®iÖn tõ 5 cöa 2 vÞ trÝ t¸c ®éng ®¬n, håi b»ng lß xo - KÝch th−íc dÇy: 10mm - L−u l−îng khÝ ®i qua: 350l/phót - §iÖn ¸p ®iÒu khiÓn: 24 VDC - Cã chèt ®iÒu khiÓn van b»ng tay - §Çu nèi ren khÝ nÐn: G 1/8" 92
Van ®iÖn tõ lo¹i lín Tiger 2000 : * Ký hiÖu: JMFH-5-1/8-B * Th«ng sè kü thuËt: - Van kiÓu con tr−ît ®iÒu khiÓn ®iÖn tõ c¶ hai phÝa - Van ®iÖn tõ cã chèt ®iÒu khiÓn b»ng tay - L−u l−îng khÝ ®i qua: 1000l/phót - §iÖn ¸p lµm viÖc: 24VDC - Cã thÓ l¾p trùc tiÕp trªn ®−êng dÉn hoÆc trªn ®Õ thµnh tr¹m van tõ 2 ®Õn 10 van 93
Van Kho¸ HE : * Ký hiÖu: HE-2-1/8-QS-6 * Th«ng sè kü thuËt: - KiÓu van 2 cöa 2 vÞ trÝ - KÝch th−íc ®Þnh møc: 5 mm - ¸p suÊt lµm viÖc: 0,75 - 10 bar - L−u l−îng khÝ: 300 - 800 l/phót - §iÒu khiÓn b»ng tay - L¾p ®Æt ë vÞ trÝ bÊt kú - Dßng khÝ kh«ng ®¶o chiÒu ®−îc - Träng l−îng: 18 g - Ren nèi khÝ: G1/8" - VËt liÖu: Nhùa PBT Bé läc, ®iÒu ¸p khÝ nÐn LFR : * Ký hiÖu: LFR-1/4-D-MINI * Th«ng sè kü thuËt: - KÝch th−íc: lo¹i Mini - KiÓu: D - Cã kho¸ nót ®iÒu chØnh - L−u l−îng khÝ: 1400 l/phót - §é läc: 40 µm - L¾p ®Æt: Th¼ng ®øng +/- 5° - X¶ n−íc ng−ng tô: nót quay b»ng tay - ThÓ tÝch n−íc ng−ng tù lín nhÊt: 22 cm3 94
- Vá b¶o vÖ: b»ng kim lo¹i - Cã l¾p ®ång hå ¸p suÊt - D¶i ¸p suÊt ®iÒu chØnh: 0.5 - 12 bar - ¸p suÊt ®Çu vµo: 0 - 16 bar - NhiÖt ®é lµm viÖc: -10 - 60oC - NhiÖt ®é m«i tr−êng: -10 - 60oC - Träng l−îng: 460g - §−êng nèi khÝ: G1/4" - VËt liÖu van: KÏm ®óc - VËt liÖu bÇu chøa n−íc ng−ng tô: nhùa trong PC 95
H×nh 2.3.6. B¶n thiÕt kÕ 3D b¨ng t¶i 1 H×nh 2.3.7. B¶n thiÕt kÕ 3D b¨ng t¶i 2 (cã g¾n sensor nhËn mµu) 96
H×nh 2.3.8. HÖ thèng 2 b¨ng t¶i 97
III. hÖ thèng ®iÒu khiÓn dcsx dïng robot scatm ®Ó ph©n lo¹i s¶n phÈm theo mµu s¾c 3.1. Nguyên tắc hoạt động Hoạt động được điều khiển là môđun dây chuyền sản xuất (DCSX) gồm robot SCATM làm việc với hệ thống băng tải được điều khiển bằng biến tần và được trang bị các sensor nhận biết màu sắc. Nhờ chương trình phần mềm điều khiển, các thông số chuyển động của robot SCATM và của băng tải được tính toán hoặc nạp vào thông qua bàn phím và màn hình của máy PC. Khi khởi động môđun DCSX làm việc, chương trình điều khiển sẽ đưa các bộ phận chấp hành về vị trí ban đầu. Trong quá trình làm việc từ các khớp quay các giá trị xung tương ứng với độ chuyển dịch tức thời đều được ghi nhớ và so sánh với các giá trị đặt trước hoặc tính toán ra, chương trình điều khiển sẽ xuất ra các lệnh để làm chuyển dịch các khớp động đến vị trí cần thiết. Độ chuyển dịch của 3 động cơ bước sẽ đảm bảo tọa độ X,Y và hướng mở của bàn kẹp. Tọa độ Z của nó được thực hiện bằng độ chuyển dịch của xilanh khí nén. Hệ thống robot được dạy học nhận biết màu qua các sensor. Khi có tín hiệu xuất hiện vật thể có màu đã chọn, bằng cách phối hợp các chuyển động của băng tải và của bản thân mình, robot SCATM được ra lệnh nhặt lấy vật thể có màu đó. Phân loại sản phẩm bằng màu sắc có thể trở thành phương thức phân loại được dùng rộng rãi nhất nếu lưu ý rằng có thể dễ dàng tạo ra tín hiệu màu sắc để nhìn thấy ở vị trí thuận lợi trên bất kỳ loại bao bì hoặc trực tiếp trên sản phẩm. Trên hình 2.3.6 là ảnh chụp môđun DCSX với robot SCATM đang làm việc cùng băng tải phân loại sản phẩm theo màu sắc. 98
Hình 2.3.9. Tßan c¶nh m«®un DCSX dïng robot SCATM ®Ó ph©n lo¹i s¶n phÈm theo mµu s¾c 3.2. Các bộ phân chủ yếu Hệ thống điều khiển môđun DCSX dùng robot SCATM làm việc với băng tải phân loại sản phẩm, đã được thiết kế, chế tạo, lắp ráp và vận hành thử nghiệm đối với cả phần cứng và phần mềm. Phần cứng dùng bộ giao tiếp với máy tính PC qua cổng máy in, thực hiện các chuyển động của robot SCATM và của hệ thống băng tải theo các số liệu đã được lập trình. Các bộ phận phần cứng chủ yếu gồm có: Mạch giao tiếp với máy tính; Mạch logic và điều khiển động cơ bước; Mạch điều khiển khí nén v.v. Lấy ví dụ, trên hình 2.3.10. là sơ đồ điều khiển mạch động cơ bước. 99
1 2 3 4 IC7 IC8 D D 74LS245 74LS373 STROBE =0 DIA CHI 2 18 3 2 A0 B0 D0 Q0 3 17 4 5 IC3B =1 DU LIEU A1 B1 D1 Q1 4 16 7 6 IC3C 74LS32 A2 B2 D2 Q2 AF =1 WR 5 15 8 9 IC3A 74LS32 4 A3 B3 D3 Q3 6 14 13 12 74LS32 9 6 A4 B4 D4 Q4 7 13 14 15 1 58 SLCTIN =1 RD A5 B5 D5 Q5 8 12 17 16 103 A6 B6 D6 Q6 9 11 18 19 2 INIT =0 NUA BYTE THAP A7 B7 D7 Q7 =1 NUA BYTE CAO 19 1 E OE 1 11 13 12 IC5 DIR LE D2 74LS138 DB25 +5 IC3D 1 15 IC2E A Y0 13 74LS32 2 14 74LS04 SLCT B Y1 25 +5 5 3 13 3 6 8 11 C Y2 12 12 11 10 PE Y3 24 IC2C 11 IC14A IC14B IC14C IC14D Y4 11 18 17 14 13 8 7 4 3 1 13 11 BUSY 74LS04 4 10 74LS32 74LS32 74LS32 74LS32 C E1 Y5 C 23 6 11 5 9 IC6 E2 Y6 10 IC9 6 7 IC13D 74LS373 +5 ACK E3 Y7 LE D7 D6 D5 D4 D3 D2 D1 D0 22 OE 74LS373 IC4B IC1 74LS02 11 6 LE 9 74LS00 74LS138 1 D7 1 2 4 5 9 OE 21 1 15 10 12 13 A Y0 VAO12 8 D6 2 14 19 18 J1 Q7 Q6 Q5 Q4 Q3 Q2 Q1 Q0 B Y1 Q7 D7 20 3 13 16 17 C Y2 Q6 D6 11 12 7 12 15 14 D5 4 5 Y3 Q5 D5 19 11 12 13 9 6 5 2 Y4 Q4 D4 6 D4 19 16 15 12 4 10 9 8 E1 Y5 Q3 D3 18 5 9 6 7 E2 Y6 Q2 D2 5 6 7 5 4 D3 E3 Y7 Q1 D1 17 2 3 SLCTIN Q0 D0 4 D2 D4 D0 D5 D1 RD 16 INIT D6 D2 D7 D3 WR 14 11 5 2 13 10 6 3 15 3 3 D1 1 +5 R2 15 3 2 6 5 9 8 8X10K 2 D0 IC15 IC4A G 4B 3B 2B 1B AF 14 4A 3A 2A 1A 74LS257 74LS00 IC13A IC13B IC13C B A/B B 1 74LS02 74LS02 74LS02 STROBE 4Y 3Y 2Y 1Y 1 2 1 4 18 17 14 13 8 7 4 3 18 17 14 13 8 7 4 3 11 18 17 14 13 8 7 4 3 11 11 10 1 1 1 9 7 4 D4 12 D5 IC11 IC10 IC12 D7 D6 D5 D4 D3 D2 D1 D0 D7 D6 D5 D4 D3 D2 D1 D0 LE D7 D6 D5 D4 D3 D2 D1 D0 D6 IC2D OE 74LS374 OE 74LS374 OE 74LS373 74LS04 CLK CLK D7 8 9 RA13 RA14 RA15 IC2A Q7 Q6 Q5 Q4 Q3 Q2 Q1 Q0 Q7 Q6 Q5 Q4 Q3 Q2 Q1 Q0 Q7 Q6 Q5 Q4 Q3 Q2 Q1 Q0 74LS04 IC4D 74LS00 9 6 5 2 9 6 5 2 9 6 5 2 /WR 1 2 12 19 16 15 12 19 16 15 12 19 16 15 12 11 /WR 13 IC4C IC2F 74LS00 Title A A 74LS04 9 8 /RD Hình 3.2 /RD 13 12 10 Size Number Revision A4 Date: 21-Sep-2001 Sheet of File: C:\NGHIA\DKM.S01 Drawn By: 1 2 34 H×nh 2.3.10. S¬ ®å c¸c m¹ch ®iÒu khiÓn ®éng c¬ b−íc Chương trình phần mềm được viết trên ngôn ngữ Visual C++. Việc thực hiện quỹ đạo chuyển động của bàn kẹp của robot SCATM được tự động tính toán theo chương trình con để giải các bài toán thuận và ngược động học, như đã trình bày ở phần trên. Trong quá trình điều khiển, chương trình bày tính toán giá trị của các góc khớp quay và so sánh với các giá trị nhận được từ các sensor gắn với các khớp quay để xuất ra các lệnh làm quay các động cơ tương ứng. Các số liệu được nhập vào từ bàn phím của máy PC. Khi khởi động, chương trình điều khiển sẽ đưa tay máy về vị trí ban đầu được xác định nhờ các bộ cảm biến vị trí gắn trên các hành trình của mỗi bậc tự do chuyển động. Hình 2.3.11 là trích đoạn chương trình phần mềm nói trên. Toàn bộ chương trình được trình bày ở phần IV của Báo cáo nhiệm vụ 2. Robot SCATM còn được điều khiển theo phương pháp “dạy học”, tức là dẫn dắt tay máy thực hiện các bước chuyển dịch cần thiết và các số liệu này được ghi vào bộ nhớ để sau đó lặp lại trong quá trình làm việc. Các “teaching box” này cũng được thiết lập trên màn hình (hình 2.3.12.) 100
Hình 2.3.11 Trích đoạn chương trình điều khiển robot SCA khí nén. Hình 2.3.12. Thiết lập “teaching box” trên màn hình 101
PHẦN IV. BÁO CÁO VỀ NHIỆM VỤ 2 CỦA ĐỀ TÀI KC.03.08 CƠ SỞ TÍNH TOÁN VÀ XÂY DỰNG CÁC CHƯƠNG TRÌNH MÁY TÍNH VỀ ĐIỀU KHIỂN VÀ ỨNG DỤNG ROBOT SCA I. GIỚI THIỆU CHUNG Trong phần IV của Báo cáo trình bày các cơ sở tính toán và xây dựng các chương trình máy tính. Trên cơ sở đó đã xây dựng các chương trình máy tính sau: - Ch−¬ng tr×nh tù ®éng thiÕt lËp m« h×nh ®éng häc robot (TDH) - Ch−¬ng tr×nh kiÓm nghiÖm lêi gi¶i bµi to¸n ®éng häc ng−îc (KN§H) - Ch−¬ng tr×nh tÝnh to¸n ®éng lùc häc (TDLH) - Chương trình điều khiển Robot SCA - Chương trình điều khiển môđun DCSX dùng robot SCA chọn lựa sản phẩm theo màu sắc. 102
II. Ch−¬ng tr×nh tù ®éng thiÕt lËp m« h×nh ®éng häc robot (tdh) Khi thiÕt lËp hÖ ph−¬ng tr×nh ®éng häc c¬ b¶n cña robot ph¶i lÆp l¹i nhiÒu phÐp tÝnh ®¹i sè ma trËn phøc t¹p. Ta cÇn cã hÖ ph−¬ng tr×nh (1.11) ë d¹ng gi¶i tÝch ®Ó cã thÓ trùc gi¸c ph©n tÝch vµ t×m lêi gi¶i cu¶ hÖ ph−¬ng tr×nh nµy nh»m x¸c ®Þnh c¸c th«ng sè ®iÒu khiÓn vÞ trÝ cña robot. MÆt kh¸c, nÕu thùc hiÖn c¸c phÐp tÝnh ma trËn b»ng tay th× rÊt mÊt thêi gian vµ rÊt dÔ nhÇm lÉn. V× vËy rÊt cÇn thiÕt tiÕn hµnh tÝnh to¸n, thiÕt lËp c¸c biÓu thøc gi¶i tÝch nãi trªn b»ng m¸y tÝnh. Lêi gi¶i ë ®©y ph¶i lµ c¸c biÓu thøc gi¶i tÝch (chø kh«ng ph¶i b»ng sè), biÓu diÔn mèi quan hÖ ®éng häc cña robot. Gi¶i quyÕt ®−îc c¸c vÊn ®Ò trªn, nh»m tù ®éng hãa mét sè c«ng viÖc tÝnh to¸n thiÕt kÕ ®éng häc robot, sÏ phôc vô cã c¸c b−íc tiÕp theo trong qóa tr×nh tù ®éng hãa s¶n xuÊt dïng robot. Ch−¬ng tr×nh tÝnh to¸n TDH ®−îc viÕt b»ng ng«n ng÷ Matlab. KÕt qu¶ tÝnh to¸n cã thÓ l−u vµo ®Üa vµ cã thÓ xem l¹i hoÆc in ra giÊy khi cÇn. D÷ liÖu nhËp trùc tiÕp trªn mµn h×nh mét c¸ch trùc quan, chñ yÕu lµ bé th«ng sè Denavit - Hartenberg (DH) cña c¬ cÊu robot , tªn robot vµ sè kh©u ®éng. Ch−¬ng tr×nh sÏ tù ®éng tÝnh to¸n vµ cho ra kÕt qu¶. L−u ®å thuËt to¸n cña ch−¬ng tr×nh chÝnh TDH nh− h×nh 2.4.1 103
Begin NhËp d÷ liÖu: Tªn robot, sè kh©u Më File kÕt qu¶ cò ®éng n, c¸c th«ng sè DH, kiÓu khíp Ghi kÕt qu¶ ra mµn h×nh X¸c ®Þnh c¸c ma trËn Ai In kÕt qu¶ ra m¸y in TÝnh to¸n c¸c ma trËn Ti Xö lý kÕt qu¶ Ghi kÕt qu¶ vµo ®Üa End H×nh 2.4.1. L−u ®å thËt to¸n c¸c ma trËn Ti nh− h×nh 2.4.2 Begin TÝnh tÝch c¸c ma trËn * * Ti = A1 (A2 (An-1 An)) Khai b¸o c¸c biÕn, c¸c ma trËn, ®äc c¸c th«ng TÝnh kÕt qu¶ ë d¹ng triÓn tin tÖp d÷ liÖu, sè khíp khai §äc c¸c phÇn tö Rót gän c¸c biÓu thøc l−îng cña c¸c ma trËn Ai gi¸c, biÓu diÔn kÕt qu¶ ë d¹ng rót gän dïng c¸c ngoÆc ®¬n §Æt c¸c gi¸ trÞ ®Çu cho c¸c biÕn, c¸c ma trËn kh¸c nhau End H×nh 2.4.2 104
Mµn h×nh tÝnh to¸n ch−¬ng tr×nh TDH nh− h×nh 2.4.3 H×nh 2.4.3 PhÇn mÒm nµy còng cã t¸c dông tèt trong viÖc gi¶ng d¹y robot. Khi cho sinh viªn thiÕt lËp m« h×nh ®éng häc c¸c lo¹i robot, ta cã thÓ dÔ dµng kiÓm tra kÕt qu¶ sinh viªn thiÕt lËp m« h×nh ®éng häc mét c¸ch nhanh chãng. III. Ch−¬ng tr×nh kiÓm nghiÖm lêi gi¶i bµi to¸n ®éng häc ng−îc V× lêi gi¶i bµi to¸n ®éng häc ng−îc th−êng cã tÝnh ®a trÞ, kh«ng ph¶i lêi gi¶i nµo còng thÝch hîp nªn ë ®©y ta cÇn kiÓm nghiÖm c¸c lêi gi¶i. §Çu tiªn ta cho bé th«ng sè biÕn khíp (qi , i=1 4) øng víi n ®iÓm, sÏ x¸c ®Þnh ®−îc ®−êng ®i cña “ ®iÓm t¸c ®éng cuèi “. VËy ë ®©y ta cã n ®iÓm “®iÓm t¸c ®éng cuèi ”. Mçi mét “ ®iÓm t¸c ®éng cuèi “ sÏ cho ta mét bé nghiÖm cña bµi to¸n thuËn (nx, ny, nz, sx, sy, sz, ax, ay, az, px, py, pz ). Tõ bé nghiÖm cña bµi to¸n thuËn nµy ta thay vµo bµi to¸n ng−îc ®Ó t×m ra ®−îc 105
nghiÖm cña bµi to¸n ng−îc lµ c¸c biÕn khíp (qi_nguoc , i=1 4). Ta thay c¸c nghiÖm (qi_nguoc , i=1 4) vµo bµi to¸n thuËn vµ t×m ra ®−îc bé nghiÖm kh¸c cu¶ bµi to¸n thuËn (nx_sau, ny_sau, nz_sau, sx_sau, sy_sau, sz_sau, ax_sau, ay_sau, az_sau, px_sau, py_sau, pz_sau ). Cho (qi , i=1 4) → bµi to¸n thuËn →(nx, ny, nz, sx, sy, sz, ax, ay, az, px, py, pz ) → bµi to¸n ng−îc → (qi_nguoc , i=1 4) → bµi to¸n thuËn →(nx_sau, ny_sau, nz_sau, sx_sau, sy_sau, sz_sau, ax_sau, ay_sau, az_sau, px_sau, py_sau, pz_sau ). Tõ mét bé nghiÖm (nx, ny, nz, sx, sy, sz, ax, ay, az, px, py, pz ) ta x¸c ®Þnh ®−îc tr¹ng th¸i cña ®iÓm “ ®iÓm t¸c ®éng cuèi “. Ta sÏ so s¸nh (nx, ny, nz, sx, sy, sz, ax, ay, az, px, py, pz ) vµ (nx_sau, ny_sau, nz_sau, sx_sau, sy_sau, sz_sau, ax_sau, ay_sau, az_sau, px_sau, py_sau, pz_sau ) xem sù sai kh¸c cã nhiÒu hay kh«ng. KÕt qu¶ ch−¬ng tr×nh KNDH sau khi ch¹y nh− trªn h×nh 4.4. H×nh 2.4.4. 106
NhËn xÐt: Tõ nh÷ng h×nh ¶nh trùc quan trªn, ta thÊy râ sù thuËn lîi h¬n h¼n khi kiÓm nghiÖm bµi to¸n robot b»ng viÖc m¸y tÝnh ho¸ c¸c phÐp tÝnh to¸n vµ dïng c¸c ch−¬ng tr×nh øng dông ¸p dông vµo ®©y. KÕt qu¶ kiÓm nghiÖm cho ta thÊy sù tÝnh to¸n bµi to¸n ®éng häc thuËn vµ bµi to¸n ®éng häc ng−îc cña robot SCATM lµ hoµn toµn chÝnh x¸c. IV. Ch−¬ng tr×nh phÇn mÒm tÝnh to¸n ®éng lùc häc (tdlh). PhÇn mÒm nµy ®−îc viÕt trªn ch−¬ng tr×nh matlab ®Ó tÝnh to¸n ®éng lùc häc. KÕt qu¶ lµ c¸c biÓu thøc gi¶i tÝch (chø kh«ng ph¶i b»ng sè). KÕt qu¶ ch−¬ng tr×nh khi tÝnh ®éng lùc häc robot SCA nh− ë môc 2.3. PhÇn I Ch−¬ng tr×nh nguån cña phÇn mÒm xem ë phÇn phô lôc. V. Ch−¬ng tr×nh phÇn mÒm ®iÒu khiÓn robot SCA (DKSCA) Ch−¬ng tr×nh phÇn mÒm ®−îc viÕt trªn ng«n ng÷ Visual C++. ViÖc thùc hiÖn quü ®¹o chuyÓn ®éng cña bµn kÑp cña robot SCA ®−îc tù ®éng tÝnh to¸n theo ch−¬ng tr×nh con ®Ó gi¶i c¸c bµi to¸n thuËn vµ ng−îc ®éng häc, nh− ®· tr×nh bµy ë phÇn trªn. Trong qu¸ tr×nh ®iÒu khiÓn, ch−¬ng tr×nh nµy sÏ tÝnh to¸n gi¸ trÞ cña c¸c gãc khíp quay vµ so s¸nh víi c¸c gi¸ trÞ nhËn ®−îc tõ c¸c sensor g¾n víi c¸c khíp quay ®Ó xuÊt ra c¸c lÖnh lµm quay c¸c ®éng c¬ t−¬ng øng. HÖ thèng ®iÒu khiÓn robot ®−îc kÕt nèi víi m¸y tÝnh, qua cæng m¸y in, cho phÐp xuÊt nhËp d÷ liÖu ®iÒu khiÓn ®éng c¬ b−íc, theo c¸c chiÒu kh¸c nhau, ®Ó thùc hiÖn ®−a c¸nh tay robot SCA ®i theo nh÷ng hµnh tr×nh ®−îc x¸c ®Þnh tr−íc nhê c¸c ch−¬ng tr×nh ®iÒu khiÓn kh¸c nhau nhËp vµo m¸y tÝnh. 107
M¹ch logic vµ ®iÒu khiÓn ®éng c¬ b−íc ®−îc thiÕt kÕ trªn c¸c IC: 4093, 7474, 74257, 7406, 4066 vµ c¸c transitor c«ng suÊt lín, cho phÐp t¹o ra c¸c xung ®iÒu khiÓn lµm quay ®éng c¬ theo c¸c ch−¬ng tr×nh ®iÒu khiÓn. Trªn h×nh 5.5 lµ mµn h×nh ®iÒu khiÓn ®éng häc thuËn robot SCA H×nh 2.4.5 Trªn h×nh 2.4.6 lµ mµn h×nh ®iÒu khiÓn ®éng häc ng−îc robot SCA H×nh 2.4.6 108
Khi lËp tr×nh trùc tuyÕn, ng−êi vËn hµnh robot trùc tiÕp tiÕn hµnh lËp tr×nh trªn b¶n th©n robot hoÆc thiÕt bÞ phô trî kÌm theo. ë ®©y theo ph−¬ng ph¸p lËp tr×nh dïng hép d¹y häc (teach box). "Hép d¹y häc" ®−îc thiÕt kÕt ngay trªn mµn h×nh m¸y tÝnh (h×nh 2.4.7). H×nh 2.4.7 C¸ch sö dông "hép d¹y häc" nh− sau: sau khi bËt m¸y, trªn mµn h×nh hiÖn sè liÖu tr¹ng th¸i hiÖn thêi cña c¸c khíp ®éng vµ th«ng tin vÒ kÕt qu¶ so s¸nh víi vÞ trÝ ban ®Çu cÇn cã cña tõng khíp ®éng. NÕu khíp ®éng nµo cßn ch−a ë vÞ trÝ ban ®Çu th× ta bÊm vµo nót lÖnh cho vÒ vÞ trÝ ®Çu. Sau ®ã dïng c¸c nót trªn "hép d¹y häc" ®Ó ®iÒu khiÓn c¸c khíp ®éng ®Õn vÞ trÝ mong muèn. Lóc ®ã sè liÖu sÏ ®−îc ghi l¹i vµ khi cã lÖnh chuyÓn ®éng sÏ ®−îc t¸i hiÖn vµ lËp l¹i nhiÒu lÇn theo ý muèn. Trong khi c¸c ®éng c¬ ®ang quay th× lu«n lu«n cã ch−¬ng tr×nh con kiÓm tra tr¹ng th¸i ho¹t ®éng cña tõng khíp ®éng. VI Ch−¬ng tr×nh ®iÒu khiÓn m«®un DCSX dïng Robot SCA chän lùa s¶n phÈm theo mµu s¾c. 109
// rbkhinenDlg.cpp : implementation file #include "stdafx.h" #include "rbkhinen.h" #include "rbkhinenDlg.h" #ifdef _DEBUG #define new DEBUG_NEW #undef THIS_FILE static char THIS_FILE[] = __FILE__; #endif ///////////////////////////////////////////////////////////////////////////// // CAboutDlg dialog used for App About class CAboutDlg : public CDialog { public: CAboutDlg(); // Dialog Data //{{AFX_DATA(CAboutDlg) enum { IDD = IDD_ABOUTBOX }; //}}AFX_DATA // ClassWizard generated virtual function overrides //{{AFX_VIRTUAL(CAboutDlg) protected: virtual void DoDataExchange(CDataExchange* pDX); // DDX/DDV support //}}AFX_VIRTUAL // Implementation protected: //{{AFX_MSG(CAboutDlg) //}}AFX_MSG DECLARE_MESSAGE_MAP() }; CAboutDlg::CAboutDlg() : CDialog(CAboutDlg::IDD) { //{{AFX_DATA_INIT(CAboutDlg) //}}AFX_DATA_INIT } void CAboutDlg::DoDataExchange(CDataExchange* pDX) { CDialog::DoDataExchange(pDX); //{{AFX_DATA_MAP(CAboutDlg) 111
//}}AFX_DATA_MAP } BEGIN_MESSAGE_MAP(CAboutDlg, CDialog) //{{AFX_MSG_MAP(CAboutDlg) // No message handlers //}}AFX_MSG_MAP END_MESSAGE_MAP() ///////////////////////////////////////////////////////////////////////////// // CRbkhinenDlg dialog CRbkhinenDlg::CRbkhinenDlg(CWnd* pParent /*=NULL*/) : CDialog(CRbkhinenDlg::IDD, pParent) { //{{AFX_DATA_INIT(CRbkhinenDlg) // NOTE: the ClassWizard will add member initialization here //}}AFX_DATA_INIT // Note that LoadIcon does not require a subsequent DestroyIcon in Win32 m_hIcon = AfxGetApp()->LoadIcon(IDR_MAINFRAME); } void CRbkhinenDlg::DoDataExchange(CDataExchange* pDX) { CDialog::DoDataExchange(pDX); //{{AFX_DATA_MAP(CRbkhinenDlg) DDX_Control(pDX, IDC_DUNG, m_cDung); DDX_Control(pDX, IDC_CHAY, m_cChay); //}}AFX_DATA_MAP } BEGIN_MESSAGE_MAP(CRbkhinenDlg, CDialog) //{{AFX_MSG_MAP(CRbkhinenDlg) ON_WM_SYSCOMMAND() ON_WM_PAINT() ON_WM_QUERYDRAGICON() ON_BN_CLICKED(IDC_CHAY, OnChay) ON_BN_CLICKED(IDC_DUNG, OnDung) ON_BN_CLICKED(IDC_VITRIDAU, OnVitridau) ON_WM_TIMER() //}}AFX_MSG_MAP END_MESSAGE_MAP() ///////////////////////////////////////////////////////////////////////////// // CRbkhinenDlg message handlers BOOL CRbkhinenDlg::OnInitDialog() { 112
CDialog::OnInitDialog(); // Add "About " menu item to system menu. // IDM_ABOUTBOX must be in the system command range. ASSERT((IDM_ABOUTBOX & 0xFFF0) == IDM_ABOUTBOX); ASSERT(IDM_ABOUTBOX AppendMenu(MF_SEPARATOR); pSysMenu->AppendMenu(MF_STRING, IDM_ABOUTBOX, strAboutMenu); } } // Set the icon for this dialog. The framework does this automatically // when the application's main window is not a dialog SetIcon(m_hIcon, TRUE); // Set big icon SetIcon(m_hIcon, FALSE); // Set small icon // TODO: Add extra initialization here return TRUE; // return TRUE unless you set the focus to a control } void CRbkhinenDlg::OnSysCommand(UINT nID, LPARAM lParam) { if ((nID & 0xFFF0) == IDM_ABOUTBOX) { CAboutDlg dlgAbout; dlgAbout.DoModal(); } else { CDialog::OnSysCommand(nID, lParam); } } // If you add a minimize button to your dialog, you will need the code below // to draw the icon. For MFC applications using the document/view model, // this is automatically done for you by the framework. 113
void CRbkhinenDlg::OnPaint() { if (IsIconic()) { CPaintDC dc(this); // device context for painting SendMessage(WM_ICONERASEBKGND, (WPARAM) dc.GetSafeHdc(), 0); // Center icon in client rectangle int cxIcon = GetSystemMetrics(SM_CXICON); int cyIcon = GetSystemMetrics(SM_CYICON); CRect rect; GetClientRect(&rect); int x = (rect.Width() - cxIcon + 1) / 2; int y = (rect.Height() - cyIcon + 1) / 2; // Draw the icon dc.DrawIcon(x, y, m_hIcon); } else { CDialog::OnPaint(); } } // The system calls this to obtain the cursor to display while the user drags // the minimized window. HCURSOR CRbkhinenDlg::OnQueryDragIcon() { return (HCURSOR) m_hIcon; } // #include"stdio.h" #include"conio.h" #include"math.h" #include"stdlib.h" #include"iostream.h" #define basad 0x378 #define datreg basad #define statreg basad+1 #define contrreg basad+2 int xuat_cong_13(int); int xuat_cong_14(int); int xuat_cong_15(int); int dong_co_1(int); 114
int dong_co_2(int); int dong_co_3(int); int dong_co_1_ve(int); int dong_co_2_ve(int); int dong_co_3_ve(int); // int vao_cong(int); int vi_tri_dau(int); int vao; int xuong4=255, dong5=255; // int vi_tri_dau(int cong) { int loc_1,loc_11,loc_sau_1; int loc_2,loc_21,loc_sau_2; int loc_3,loc_31,loc_sau_3; int loc_4,loc_41,loc_sau_4; int loc_5,loc_51,loc_sau_5; int luc_dau,tg,co_ban,chieu_quay; /* vao_cong(12); loc_2=vao&2; loc_sau_2=loc_2&0; Sleep(10); xuat_cong_14(34); Sleep(10); xuat_cong_15(253); while(loc_21!=loc_sau_2) { vao_cong(12); loc_21=vao&2; } xuat_cong_15(255); */ vao_cong(12); Sleep(10); loc_1=vao&1; loc_sau_1=loc_1&0; 115
loc_2=vao&2; loc_sau_2=loc_2&0; loc_3=vao&4; loc_sau_3=loc_3^4; xuat_cong_14(38); xuat_cong_15(248); xuat_cong_15(248); while(loc_11!=loc_sau_1) { vao_cong(12); loc_11=vao&1; xuat_cong_15(251); xuat_cong_15(251); } // xuat_cong_15(255); while(loc_21!=loc_sau_2) { vao_cong(12); loc_21=vao&2; xuat_cong_15(253); Sleep(0.1); xuat_cong_15(253); Sleep(0.1); xuat_cong_15(253); } while(loc_31!=loc_sau_3) { vao_cong(12); loc_31=vao&4; xuat_cong_15(254); } xuat_cong_15(255); //xuat_cong_15(255); 116
return(0); } // int vao_cong(int y8) { int tam1,tam2,thap,cao; _outp(contrreg,0); //mo dia chi _outp(datreg,y8); //d/c cong _outp(contrreg,1); //ghi ra _outp(contrreg,3); // doc vao nua byte thap,AF=1,Init=0 Sleep(0.1); thap=_inp(statreg); //truyen _outp(contrreg,7); // doc nua cao cua byte thap,AF=1,Init=1 Sleep(0.1); cao=_inp(statreg); //truyen _outp(contrreg,1); // ket thuc xung doc,AF=0,Init=0 tam1=thap&240; //giu nguyen 4 bit dau, 4 bit sau =0 tam2=cao&240; //giu nguyen 4 bit dau, 4 bit sau =0 vao=tam1/16+tam2; return(0); } // int xuat_cong_15(int x15) { _outp(contrreg,0); Sleep(0.1); _outp(datreg,15); _outp(contrreg,1); Sleep(0.1); _outp(datreg,x15); _outp(contrreg,9); //xung ghi Sleep(0.1); _outp(contrreg,1); //ket thuc ghi Sleep(0.1); return(0); } 117
int xuat_cong_14(int x14) { _outp(contrreg,0); Sleep(0.1); _outp(datreg,14); _outp(contrreg,1); Sleep(0.1); _outp(datreg,x14); _outp(contrreg,9); //xung ghi Sleep(0.1); _outp(contrreg,1); //ket thuc ghi Sleep(0.1); return(0); } int xuat_cong_13(int x13) { _outp(contrreg,0); _outp(datreg,13); _outp(contrreg,1); _outp(datreg,x13); _outp(contrreg,9); //xung ghi _outp(contrreg,1); //ket thuc ghi return(0); } // // void CRbkhinenDlg::OnChay() { // TODO: Add your control notification handler code here int loc,loc_sensophathienvat1,loc_senso,loc1; dong_co_1(820);//780 Sleep(100); dong_co_2(500);//-510 Sleep(100); dong_co_3(150);//-510 Sleep(100); // xuat_cong_15(223); //ca len va mo // xuat_cong_15(215); //xuong // xuat_cong_15(199); //xuong va dong // xuat_cong_15(207); //len // xuat_cong_15(231); //xuong va dong//231 118
/* xuat_cong_14(40); // xi lanh ra delay(1000); xuat_cong_14(48); // xi lanh vao delay(1000); xuat_cong_14(34); // quay xl delay(1000); xuat_cong_14(32); // quay xl delay(1000); */ while(1) { vao_cong(12); Sleep(10); loc=vao&128; loc1=vao&64; Sleep(1); if(loc1==0) { xuat_cong_14(40); Sleep(300); Sleep(500); xuat_cong_15(215); Sleep(1500); xuat_cong_15(199); Sleep(1000); xuat_cong_15(207);//207 Sleep(1000); xuat_cong_14(48); Sleep(500); dong_co_1_ve(-550); Sleep(1000); xuat_cong_15(231); Sleep(800); xuat_cong_15(215);//255 Sleep(500); xuat_cong_15(255);//255 Sleep(1000); dong_co_1(550);//780 xuat_cong_14(2); Sleep(2000); 119
xuat_cong_14(32); } else if(loc==0) { Sleep(500); xuat_cong_14(40); Sleep(800); xuat_cong_15(215); Sleep(1500); xuat_cong_15(199); Sleep(1000); xuat_cong_15(207);//207 Sleep(1000); xuat_cong_14(48); Sleep(500); dong_co_1_ve(-650); Sleep(1000); xuat_cong_15(231); Sleep(800); xuat_cong_15(215);//255 Sleep(500); xuat_cong_15(255);//255 Sleep(1000); dong_co_1(650);//780 xuat_cong_14(2); Sleep(2000); xuat_cong_14(32); } else { xuat_cong_15(255); } } // m_cChay.EnableWindow(FALSE); // m_cDung.EnableWindow(TRUE); } 120
// void CRbkhinenDlg::OnDung() { // TODO: Add your control notification handler code here m_cChay.EnableWindow(TRUE); m_cDung.EnableWindow(FALSE); } // void CRbkhinenDlg::OnVitridau() { // TODO: Add your control notification handler code here xuat_cong_14(48); // xi lanh vao vi_tri_dau(1); Sleep(10); // vi_tri_dau(1); xuat_cong_13(255); Sleep(1); xuat_cong_13(0); /* xuat_cong_14(48); // xi lanh vao Sleep(1000); xuat_cong_14(32); // xi lanh quay ve dau //Sleep(1000); */ } // // int dong_co_1(int dc1) { int tam1,tam2,tam3,tam4,thap_thap,cao_thap, thap_cao,cao_cao,thap_that,cao_that; int gia_tri_tong_hop,gia_tri_tong_hop_that; xuat_cong_15(255-510+xuong4+dong5);//+(223-255)); Sleep(1); if (dc1<0) { xuat_cong_14(36); } else { xuat_cong_14(32); } xuat_cong_15(255+(-510+xuong4+dong5));//+(223-255)); 121
xuat_cong_13(255); xuat_cong_13(0); xuat_cong_15(251+(-510+xuong4+dong5));//+(223-255)); Sleep(1); do { _outp(contrreg,0); //mo dia chi _outp(datreg,4); //d/c cong 0 _outp(contrreg,1); //ghi ra _outp(contrreg,3); // doc vao nua byte thap,AF=1,Init=0 // Sleep(100); thap_thap=_inp(statreg); //truyen tam1=thap_thap&240; //giu nguyen 4 bit dau, 4 bit sau =0 _outp(contrreg,7); // doc nua cao cua byte thap,AF=1,Init=1 // Sleep(100); cao_thap=_inp(statreg); //truyen _outp(contrreg,1); // ket thuc xung doc,AF=0,Init=0 tam2=cao_thap&240; //giu nguyen 4 bit dau, 4 bit sau =0 thap_that=tam1/16+tam2; // _outp(contrreg,0); //mo dia chi _outp(datreg,5); //d/c cong 0 _outp(contrreg,1); //ghi ra _outp(contrreg,3); // doc vao nua byte thap,AF=1,Init=0 //Sleep(100); thap_cao=_inp(statreg); //truyen tam3=thap_cao&240; //giu nguyen 4 bit dau, 4 bit sau =0 _outp(contrreg,7); // doc nua cao cua byte thap,AF=1,Init=1 // Sleep(100); cao_cao=_inp(statreg); //truyen _outp(contrreg,1); // ket thuc xung doc,AF=0,Init=0 tam4=cao_cao&240; //giu nguyen 4 bit dau, 4 bit sau =0 cao_that=tam3/16+tam4; // // Sleep(1); gia_tri_tong_hop=(cao_that*256+thap_that); Sleep(1); }while (gia_tri_tong_hop<=abs(dc1)); 122
// xuat_cong_15(255); // Sleep(50); xuat_cong_15(255-510+xuong4+dong5);//+(223-255)); return(0); } // // int dong_co_2(int dc2) { int tam1,tam2,tam3,tam4,thap_thap,cao_thap, thap_cao,cao_cao,thap_that,cao_that; int gia_tri_tong_hop,gia_tri_tong_hop_that; xuat_cong_15(255-510+xuong4+dong5);//+(223-255)); if (dc2<0) { xuat_cong_14(34); } else { xuat_cong_14(32); } xuat_cong_13(255); xuat_cong_13(0); xuat_cong_15(253+(-510+xuong4+dong5));//+(223-255)); do { _outp(contrreg,0); //mo dia chi _outp(datreg,2); //d/c cong 0 _outp(contrreg,1); //ghi ra _outp(contrreg,3); // doc vao nua byte thap,AF=1,Init=0 // Sleep(0.1); thap_thap=_inp(statreg); //truyen tam1=thap_thap&240; //giu nguyen 4 bit dau, 4 bit sau =0 _outp(contrreg,7); // doc nua cao cua byte thap,AF=1,Init=1 // Sleep(0.1); cao_thap=_inp(statreg); //truyen _outp(contrreg,1); // ket thuc xung doc,AF=0,Init=0 123
tam2=cao_thap&240; //giu nguyen 4 bit dau, 4 bit sau =0 thap_that=tam1/16+tam2; // _outp(contrreg,0); //mo dia chi _outp(datreg,3); //d/c cong 0 _outp(contrreg,1); //ghi ra _outp(contrreg,3); // doc vao nua byte thap,AF=1,Init=0 //Sleep(0.1); thap_cao=_inp(statreg); //truyen tam3=thap_cao&240; //giu nguyen 4 bit dau, 4 bit sau =0 _outp(contrreg,7); // doc nua cao cua byte thap,AF=1,Init=1 //Sleep(0.1); cao_cao=_inp(statreg); //truyen _outp(contrreg,1); // ket thuc xung doc,AF=0,Init=0 tam4=cao_cao&240; //giu nguyen 4 bit dau, 4 bit sau =0 cao_that=tam3/16+tam4; // gia_tri_tong_hop=(cao_that*256+thap_that); Sleep(1); }while (gia_tri_tong_hop<=abs(dc2)); // xuat_cong_15(255); xuat_cong_15(255-510+xuong4+dong5);//+(223-255)); return(0); } // // int dong_co_3(int dc3) { int tam1,tam2,tam3,tam4,thap_thap,cao_thap, thap_cao,cao_cao,thap_that,cao_that; int gia_tri_tong_hop,gia_tri_tong_hop_that; xuat_cong_15(255-510+xuong4+dong5);//+(223-255)); if (dc3<0) { xuat_cong_14(32); 124
} else { xuat_cong_14(33); } xuat_cong_13(255); xuat_cong_13(0); xuat_cong_15(254+(-510+xuong4+dong5));//+(223-255)); do { _outp(contrreg,0); //mo dia chi _outp(datreg,0); //d/c cong 0 _outp(contrreg,1); //ghi ra _outp(contrreg,3); // doc vao nua byte thap,AF=1,Init=0 //Sleep(0.1); thap_thap=_inp(statreg); //truyen tam1=thap_thap&240; //giu nguyen 4 bit dau, 4 bit sau =0 _outp(contrreg,7); // doc nua cao cua byte thap,AF=1,Init=1 //Sleep(0.1); cao_thap=_inp(statreg); //truyen _outp(contrreg,1); // ket thuc xung doc,AF=0,Init=0 tam2=cao_thap&240; //giu nguyen 4 bit dau, 4 bit sau =0 thap_that=tam1/16+tam2; // _outp(contrreg,0); //mo dia chi _outp(datreg,1); //d/c cong 0 _outp(contrreg,1); //ghi ra _outp(contrreg,3); // doc vao nua byte thap,AF=1,Init=0 //Sleep(0.1); thap_cao=_inp(statreg); //truyen tam3=thap_cao&240; //giu nguyen 4 bit dau, 4 bit sau =0 _outp(contrreg,7); // doc nua cao cua byte thap,AF=1,Init=1 //Sleep(0.1); cao_cao=_inp(statreg); //truyen _outp(contrreg,1); // ket thuc xung doc,AF=0,Init=0 tam4=cao_cao&240; //giu nguyen 4 bit dau, 4 bit sau =0 cao_that=tam3/16+tam4; // gia_tri_tong_hop=(cao_that*256+thap_that); 125
Sleep(1); }while (gia_tri_tong_hop<=abs(dc3)); // xuat_cong_15(255); xuat_cong_15(255-510+xuong4+dong5);//+(223-255)); return(0); } // // // int dong_co_1_ve(int dc1) { int tam1,tam2,tam3,tam4,thap_thap,cao_thap, thap_cao,cao_cao,thap_that,cao_that; int gia_tri_tong_hop,gia_tri_tong_hop_that; xuat_cong_15(239); if (dc1<0) { xuat_cong_14(36); } else { xuat_cong_14(32); } xuat_cong_13(255); xuat_cong_13(0); xuat_cong_15(251+(-255+239)); do { _outp(contrreg,0); //mo dia chi _outp(datreg,4); //d/c cong 0 _outp(contrreg,1); //ghi ra _outp(contrreg,3); // doc vao nua byte thap,AF=1,Init=0 // Sleep(0.1); thap_thap=_inp(statreg); //truyen tam1=thap_thap&240; //giu nguyen 4 bit dau, 4 bit sau =0 126
_outp(contrreg,7); // doc nua cao cua byte thap,AF=1,Init=1 // Sleep(0.1); cao_thap=_inp(statreg); //truyen _outp(contrreg,1); // ket thuc xung doc,AF=0,Init=0 tam2=cao_thap&240; //giu nguyen 4 bit dau, 4 bit sau =0 thap_that=tam1/16+tam2; // _outp(contrreg,0); //mo dia chi _outp(datreg,5); //d/c cong 0 _outp(contrreg,1); //ghi ra _outp(contrreg,3); // doc vao nua byte thap,AF=1,Init=0 // Sleep(0.1); thap_cao=_inp(statreg); //truyen tam3=thap_cao&240; //giu nguyen 4 bit dau, 4 bit sau =0 _outp(contrreg,7); // doc nua cao cua byte thap,AF=1,Init=1 // Sleep(0.1); cao_cao=_inp(statreg); //truyen _outp(contrreg,1); // ket thuc xung doc,AF=0,Init=0 tam4=cao_cao&240; //giu nguyen 4 bit dau, 4 bit sau =0 cao_that=tam3/16+tam4; // gia_tri_tong_hop=(cao_that*256+thap_that); Sleep(1); }while (gia_tri_tong_hop<=abs(dc1)); // xuat_cong_15(255); xuat_cong_15(239); return(0); } // // int dong_co_2_ve(int dc2) { int tam1,tam2,tam3,tam4,thap_thap,cao_thap, thap_cao,cao_cao,thap_that,cao_that; int gia_tri_tong_hop,gia_tri_tong_hop_that; xuat_cong_15(239); 127
if (dc2<0) { xuat_cong_14(34); } else { xuat_cong_14(32); } xuat_cong_13(255); xuat_cong_13(0); xuat_cong_15(253+(239-255)); do { _outp(contrreg,0); //mo dia chi _outp(datreg,2); //d/c cong 0 _outp(contrreg,1); //ghi ra _outp(contrreg,3); // doc vao nua byte thap,AF=1,Init=0 // Sleep(0.1); thap_thap=_inp(statreg); //truyen tam1=thap_thap&240; //giu nguyen 4 bit dau, 4 bit sau =0 _outp(contrreg,7); // doc nua cao cua byte thap,AF=1,Init=1 //Sleep(0.1); cao_thap=_inp(statreg); //truyen _outp(contrreg,1); // ket thuc xung doc,AF=0,Init=0 tam2=cao_thap&240; //giu nguyen 4 bit dau, 4 bit sau =0 thap_that=tam1/16+tam2; // _outp(contrreg,0); //mo dia chi _outp(datreg,3); //d/c cong 0 _outp(contrreg,1); //ghi ra _outp(contrreg,3); // doc vao nua byte thap,AF=1,Init=0 //Sleep(0.1); thap_cao=_inp(statreg); //truyen tam3=thap_cao&240; //giu nguyen 4 bit dau, 4 bit sau =0 _outp(contrreg,7); // doc nua cao cua byte thap,AF=1,Init=1 //Sleep(0.1); cao_cao=_inp(statreg); //truyen _outp(contrreg,1); // ket thuc xung doc,AF=0,Init=0 tam4=cao_cao&240; //giu nguyen 4 bit dau, 4 bit sau =0 cao_that=tam3/16+tam4; 128
// gia_tri_tong_hop=(cao_that*256+thap_that); Sleep(1); }while (gia_tri_tong_hop<=abs(dc2)); // xuat_cong_15(255); xuat_cong_15(239); return(0); } // // int dong_co_3_ve(int dc3) { int tam1,tam2,tam3,tam4,thap_thap,cao_thap, thap_cao,cao_cao,thap_that,cao_that; int gia_tri_tong_hop,gia_tri_tong_hop_that; xuat_cong_15(239); if (dc3<0) { xuat_cong_14(32); } else { xuat_cong_14(33); } xuat_cong_13(255); xuat_cong_13(0); xuat_cong_15(254+(239-255)); do { _outp(contrreg,0); //mo dia chi _outp(datreg,0); //d/c cong 0 _outp(contrreg,1); //ghi ra _outp(contrreg,3); // doc vao nua byte thap,AF=1,Init=0 // Sleep(0.1); thap_thap=_inp(statreg); //truyen tam1=thap_thap&240; //giu nguyen 4 bit dau, 4 bit sau =0 129
_outp(contrreg,7); // doc nua cao cua byte thap,AF=1,Init=1 //Sleep(0.1); cao_thap=_inp(statreg); //truyen _outp(contrreg,1); // ket thuc xung doc,AF=0,Init=0 tam2=cao_thap&240; //giu nguyen 4 bit dau, 4 bit sau =0 thap_that=tam1/16+tam2; // _outp(contrreg,0); //mo dia chi _outp(datreg,1); //d/c cong 0 _outp(contrreg,1); //ghi ra _outp(contrreg,3); // doc vao nua byte thap,AF=1,Init=0 //Sleep(0.1); thap_cao=_inp(statreg); //truyen tam3=thap_cao&240; //giu nguyen 4 bit dau, 4 bit sau =0 _outp(contrreg,7); // doc nua cao cua byte thap,AF=1,Init=1 //Sleep(0.1); cao_cao=_inp(statreg); //truyen _outp(contrreg,1); // ket thuc xung doc,AF=0,Init=0 tam4=cao_cao&240; //giu nguyen 4 bit dau, 4 bit sau =0 cao_that=tam3/16+tam4; // gia_tri_tong_hop=(cao_that*256+thap_that); Sleep(1); }while (gia_tri_tong_hop<=abs(dc3)); xuat_cong_15(255); xuat_cong_15(239); return(0); } // void CRbkhinenDlg::OnTimer(UINT nIDEvent) { // TODO: Add your message handler code here and/or call default CDialog::OnTimer(nIDEvent); } 130
Tµi liÖu tham kh¶o 1. Morgan, C. Robots: planning and implementation, UK, IFS Publications, 1984. 2. Owen, T. Assembly with Robot. London: Kogan Page, 1985 3. Pham and Heginbotham – Robot Grippers. Bedford, UK, IFS Publications, 1986. 4. Pugh, A. (editor). Robot Sensors. Vol. 1 and Vol 2, Bedford UK, IFS Publications, 1986. 5. Vijay Kumar “Motion Planning and Control Robots” . Handbook of Industrial Robotics. Ed. S.Y.Nof. NewYork, John Wiley & Sons. Inc, 1999. 6. Refael C. Gonzaler & Richard E. Woods. Digital Image Processing. Addison – Wesley, 1992. 7. Mair G. Industrial Robotics. Prentice Hall, 1988. 8. Paul R.P., Modeling, Trajectory Caculation and Servoing of a Computer Controlled Arm. Palo Alto Calif, 1972. 9. Paul R.P., Robot Manipulators: Mathematics, Programming and Control. The MIT Press – Cambridge, Massachusetts and London, England, 1981. 10. Schilling R.J., Fundamentals of Robotics, Analysis & Control. Prentice Hall, 1990. 11. Snyder W.E., Industrial Robots: Computer Interfacing and Control. Prentice Hall Inc. New Jersey, 1985. 12. Shimon Y. Nof, Handbook of Industrial Robotics, 2nded. John Wiley & Sons. Inc. 1999. 131