Thiết kế và chế tạo mô hình _ Hexapod

Thiết kế và chế tạo mô hình _ Hexapod PGS, TS: Đặng Văn Nghìn Trường đh Bách Khoa TP HCM Tóm tắT Bài báo này trình bày xu thế cũng nh− tình hình nghiên cứu của các bộ môn Cơ Điện Tử, phòng thí nghiệm cơ điện tử về Hexapod trên thế giới. Các tác giả nêu một số kết quả nghiên cứu thiết kế, chế tạo và điều khiển Hexapod 2001. ABSTRACT This paper introduces the trend and also the researching of the Mechatronics Department and Mechatronics laboratory about Hexapod all over the world. The authors bring out some research and design results, manufacture and control Hexapod 2001. I. GIớI THIệU CHUNG Hiện nay Hexapod là một lĩnh vực đang đ−ợc nhiều nhà khoa học trong và ngoài n−ớc quan tâm nghiên cứu vì những hiệu quả to lớn mà nó đem lại. Tuy nhiên đây là một thuật ngữ có nhiều nghĩa kỹ thuật khác nhau. Hexapod là từ ghép “ HEX ” a “ POD ”, theo tiếng hy lạp có nghĩa là 6 chân. Ban đầu ng−ời ta hiểu đó là những con vật 6 chân. Các nhà khoa học lại mong muốn thiết kế và chế tạo những robot đi bằng 6 chân và nh− thế những tên gọi mới đ−ợc ra đời nh− Hexapod Walking Robot, hoặc Hexapod Walker. Trong quá trình nghiên cứu và phát triển loại robot có chân, các nhà khoa học đã tạo ra những robot có 8 ,6 , 4 , 2 và thậm chí 1 chân. Theo h−ớng nghiên cứu này các nhà nghiên cứu lại mong muốn nó di chuyển nhanh hơn bằng cách chạy vì thế những sản phẩm mới ra đời với tên gọi Hexapod Running Robot. Các robot có chân đã và đang là mối quan tâm hàng đầu của các nhà khoa học dùng để thám hiểm, thăm dò trên những điạ hình phức tạp, môi tr−ờng khắc nghiệt và độc hại trên trái đất, d−ới đại d−ơng hoặc ở trên những hành tinh xa xôi. Cuối những năm 80 các nhà khoa học mới thực hiện đ−ợc những mong muốn của mình là thay thế sức lao động của con ng−ời trong việc vận chuyển, bốc xếp, lắp ráp sản phẩm và họ đã tạo ra một loại robot mới là robot song song (parallel robot). Con ng−ời không dừng lại ở đây và tiếp tục phát triển thành các máy 6 chân, trung tâm gia công dùng để cắt gọt các loại vật liệu khác nhau, với những tên gọi Hexapod Machine, Hexapod grinding robot, Hexapod Machine Center, Hexapod Parallel Kinematic Machine, hoặc dùng để đo toạ độ các bề mặt phức tạp nh− Hexapod Coordinate Measuring Machine. Ngoài ra các máy 6 chân này có thể dùng để điều khiển các thiết bị, dụng cụ phẫu thuật trong y khoa, thiên văn học, giao thông và kinh vĩ trong xây dựng . Sau đây là một số hình ảnh ứng dụng của Hexapod:

pdf10 trang | Chia sẻ: tlsuongmuoi | Lượt xem: 1916 | Lượt tải: 1download
Bạn đang xem nội dung tài liệu Thiết kế và chế tạo mô hình _ Hexapod, để tải tài liệu về máy bạn click vào nút DOWNLOAD ở trên
THIÕT KÕ Vµ CHÕ T¹O M¤ H×NH HEXAPOD PGS.TS. §Æng V¨n Ngh×n, KS. NguyÔn Minh TuÊn, KS.Tõ DiÖp C«ng Thµnh Bé m«n C¬ §iÖn Tö, Khoa c¬ KhÝ, Tr−êng §¹i häc B¸ch Khoa Tp HCM Email:mechatronics@dme.hcmut.edu.vn Tãm t¾T Bµi b¸o nµy tr×nh bµy xu thÕ còng nh− t×nh h×nh nghiªn cøu cña c¸c bé m«n C¬ §iÖn Tö, phßng thÝ nghiÖm c¬ ®iÖn tö vÒ Hexapod trªn thÕ giíi. C¸c t¸c gi¶ nªu mét sè kÕt qu¶ nghiªn cøu thiÕt kÕ, chÕ t¹o vµ ®iÒu khiÓn Hexapod 2001. ABSTRACT This paper introduces the trend and also the researching of the Mechatronics Department and Mechatronics laboratory about Hexapod all over the world. The authors bring out some research and design results, manufacture and control Hexapod 2001. I. GIíI THIÖU CHUNG HiÖn nay Hexapod lµ mét lÜnh vùc ®ang ®−îc nhiÒu nhµ khoa häc trong vµ ngoµi n−íc quan t©m nghiªn cøu v× nh÷ng hiÖu qu¶ to lín mµ nã ®em l¹i. Tuy nhiªn ®©y lµ mét thuËt ng÷ cã nhiÒu nghÜa kü thuËt kh¸c nhau. Hexapod lµ tõ ghÐp “ HEX ” a “ POD ”, theo tiÕng hy l¹p cã nghÜa lµ 6 ch©n. Ban ®Çu ng−êi ta hiÓu ®ã lµ nh÷ng con vËt 6 ch©n. C¸c nhµ khoa häc l¹i mong muèn thiÕt kÕ vµ chÕ t¹o nh÷ng robot ®i b»ng 6 ch©n vµ nh− thÕ nh÷ng tªn gäi míi ®−îc ra ®êi nh− Hexapod Walking Robot, hoÆc Hexapod Walker. Trong qu¸ tr×nh nghiªn cøu vµ ph¸t triÓn lo¹i robot cã ch©n, c¸c nhµ khoa häc ®· t¹o ra nh÷ng robot cã 8 ,6 , 4 , 2 vµ thËm chÝ 1 ch©n. Theo h−íng nghiªn cøu nµy c¸c nhµ nghiªn cøu l¹i mong muèn nã di chuyÓn nhanh h¬n b»ng c¸ch ch¹y v× thÕ nh÷ng s¶n phÈm míi ra ®êi víi tªn gäi Hexapod Running Robot. C¸c robot cã ch©n ®· vµ ®ang lµ mèi quan t©m hµng ®Çu cña c¸c nhµ khoa häc dïng ®Ó th¸m hiÓm, th¨m dß trªn nh÷ng ®i¹ h×nh phøc t¹p, m«i tr−êng kh¾c nghiÖt vµ ®éc h¹i trªn tr¸i ®Êt, d−íi ®¹i d−¬ng hoÆc ë trªn nh÷ng hµnh tinh xa x«i. Cuèi nh÷ng n¨m 80 c¸c nhµ khoa häc míi thùc hiÖn ®−îc nh÷ng mong muèn cña m×nh lµ thay thÕ søc lao ®éng cña con ng−êi trong viÖc vËn chuyÓn, bèc xÕp, l¾p r¸p s¶n phÈm vµ hä ®· t¹o ra mét lo¹i robot míi lµ robot song song (parallel robot). Con ng−êi kh«ng dõng l¹i ë ®©y vµ tiÕp tôc ph¸t triÓn thµnh c¸c m¸y 6 ch©n, trung t©m gia c«ng dïng ®Ó c¾t gät c¸c lo¹i vËt liÖu kh¸c nhau, víi nh÷ng tªn gäi Hexapod Machine, Hexapod grinding robot, Hexapod Machine Center, Hexapod Parallel Kinematic Machine, hoÆc dïng ®Ó ®o to¹ ®é c¸c bÒ mÆt phøc t¹p nh− Hexapod Coordinate Measuring Machine. Ngoµi ra c¸c m¸y 6 ch©n nµy cã thÓ dïng ®Ó ®iÒu khiÓn c¸c thiÕt bÞ, dông cô phÉu thuËt trong y khoa, thiªn v¨n häc, giao th«ng vµ kinh vÜ trong x©y dùng..... Sau ®©y lµ mét sè h×nh ¶nh øng dông cña Hexapod: 1. M¸y gia c«ng 2. Y häc 3. HÖ thèng m« pháng 4. §iÒu khiÓn thiÕt bÞ thiªn v¨n 5. Tr¾c ®Þa V× ph¹m vi øng dông cña Hexapod réng lín nh− vËy cho nªn nã ®· thu hót sù quan t©m cña c¸c nhµ khoa häc thuéc nhiÒu lÜnh vùc kh¸c nhau nh−: c¬ khÝ, ®iÖn tö, tin häc, ®éng vËt häc, thiªn v¨n häc vµ ®−¬ng nhiªn lµ c¬ ®iÖn tö. C¸c tr−êng ®¹i häc nghiªn cøu vÒ Hexapod cã thÓ ®−îc kÓ ®Õn lµ: §¹i häc Florida, Columbia, Texas, Northwestern, Maryland, Washington (Mü); §¹i häc Queens, Laval (Canada); §¹i häc Nottingham (Anh); §¹i häc Chemnitz, Aachen, Hamburg, Stuttgart, Hanover (§øc); §¹i häc Tokyo, Osaka (NhËt); §¹i häc Seoul, K-jist (Hµn Quèc); §¹i häc C«ng nghÖ Nanyang (Singapore); §¹i häc Kü thuËt (Israel); §¹i häc Lausans (Thôy SÜ); §¹i häc Leuven (BØ); §¹i häc B¸ch Khoa Milan (Italia). Nh÷ng tËp ®oµn c«ng nghiÖp øng dông Hexapod nh−: Toyoda (HexaM Machine), Fanuc (F-100 Robot), Hexel (Tornado 2000), Geodetic (G500 Machine)... Vµ ®Æc biÖt, nh÷ng tæ chøc vµ viÖn nghiªn cøu sau ®©y cã nh÷ng chiÕn l−îc ®Çu t− rÊt lín ®Ó nghiªn cøu lý thuyÕt còng nh− øng dông triÓn khai Hexapod nh− NASA, LME, NIST. §Ó hiÓu râ h¬n møc ®é ®Çu t− còng nh− qui m« nghiªn cøu chóng t«i xin minh häa mét sè dù ¸n sau ®©y: Dù ¸n NIST (National Institute of Standards and Technology) víi c¸c môc tiªu lµ kiÓm tra ®¸nh gi¸ vµ n©ng cao ®é chÝnh x¸c còng nh− më réng kh¶ n¨ng cña m¸y phay CNC 5 trôc kiÓu Hexapod ®−îc triÓn khai tõ n¨m 1998 ®Õn n¨m 2002. Dù ¸n Cubic Hexapod hîp t¸c gi÷a §¹i häc Washington vµ TËp ®oµn c«ng nghÖ Hood kÐo dµi 6 n¨m tõ 1998 ®Õn 2004. Dù ¸n nµy ®−îc ph¸t triÓn tõ Stewart tÊm dÞch chuyÓn( platform) ®Ó lo¹i trõ nhiÔu trong c¸c hÖ thèng chÝnh x¸c (®iÒu khiÓn vÞ trÝ víi ®é chÝnh x¸c 1 nanomet). Dù ¸n Hexaglide ®−îc triÓn khai ¬ ViÖn Robot Thôy Sü b¾t ®Çu tõ n¨m 1996. M¸y lµ hÖ cÊu tróc song song 6 bËc tù do, sö dông m¸y phay tèc ®é cao víi kh«ng gian lµm viÖc 700 × 600 × 500 mm, sö dông hÖ ®iÒu khiÓn VME-Bus vµ hÖ thèng thêi gian thùc. ¦u ®iÓm lµ cã thÓ thùc hiÖn c¸c chuyÓn ®éng nhanh, ®é cøng v÷ng vµ ®é chÝnh x¸c cao. ROBOTOOL lµ mét dù ¸n ®−îc Céng ®ång Ch©u ¢u tµi trî. Dù ¸n nµy lµ hîp t¸c gi÷a 10 tr−êng ®¹i häc, viÖn nghiªn cøu vµ c¸c c«ng ty bao gåm c¸c thµnh viªn sau ®©y: §¹i häc Hanover (§øc), Leuven (BØ), Montpelier (Ph¸p), c¸c viÖn nghiªn cøu Irf (Thôy ®iÓn) Ikerlan Itia (Italia), c¸c c«ng ty BELCAM.PLC, TTS, Linvot. Theo danh môc Hexapod cña dù ¸n nµy cho thÊy cã tíi 48 m¸y vµ trung t©m gia c«ng, 19 robot, 31 c¬ cÊu ®Þnh vÞ trÝ vµ ®Þnh h−íng vµ 2 m¸y ®o täa ®é. Trong nh÷ng n¨m gÇn ®©y, Bé m«n C¬ §iÖn Tö, Khoa C¬ KhÝ, §¹i häc B¸ch Khoa TPHCM ®· quan t©m nghiªn cøu vÒ HEXAPOD vµ trong bµi b¸o nµy chóng t«i xin giíi thiÖu m« h×nh HEXAPOD 2001 lµ lo¹i m¸y 6 ch©n hay cßn gäi lµ m¸y ®éng häc song song. II. CHäN PH−¬NG ¸N THIÕT KÕ Hexapod lµ mét lÜnh vùc ph¸t triÓn rÊt nhanh theo nh÷ng h−íng kh¸c nhau nh−: robot song song, m¸y ®éng häc song song, ... nh−ng ®Òu dùa theo nguyªn lý do Stewart ®−a ra vµo n¨m 1965 vµ chóng ta th−êng gäi lµ Nguyªn lý Stewart. S¬ ®å nguyªn lý Stewart ®−îc tr×nh bµy trªn h×nh 1. C¬ cÊu nµy gåm 6 ch©n cã ®é dµi thay ®æi ®−îc, c¸c ch©n nµy liªn kÕt víi gi¸ vµ tÊm dÞch chuyÓn ( platform) b»ng c¸c khíp cÇu. B»ng c¸ch thay ®æi chiÒu dµi c¸c ch©n, ta cã thÓ thay ®æi vÞ trÝ vµ h−íng cña tÊm dÞch chuyÓn trong kh«ng gian . ¦u ®iÓm cña c¬ cÊu nµy lµ cã thÓ ®Þnh vÞ bÊt kú vÞ trÝ, h−íng nµo trong kh«ng gian, kÕt cÊu ®¬n gi¶n, ®é cøng v÷ng cao, ®é chÝnh x¸c, æn ®Þnh cao, cã thÓ t¹o ra c¸c quü ®¹o phøc t¹p, vµ cã thÓ gia c«ng trong mét lÇn g¸ trªn m¸y HEXAPOD. V× kh¶ n¨ng v−ît tréi cña c¬ cÊu 6 bËc tù do mµ cã thÓ nãi ®©y lµ mét h−íng nghiªn cøu cã gi¸ trÞ vµ cã nhiÒu kh¶ n¨ng øng dông réng r·i. Theo nguyªn lý nµy cã hai ph−¬ng ¸n c¬ b¶n ®Ó thiÕt kÕ m¸y: ph−¬ng ¸n thuËn vµ ph−¬ng ¸n nghÞch. TÊm dÞch chuyÓn Gi¸ Ch©n H×nh 1: S¬ ®å nguyªn lý Ch©n Gi¸ platform Dông cô gia c«ng H×nh 3: S¬ ®å nguyªn lý nghÞch H×nh 2: S¬ ®å nguyªn lý thuËn. platform Ch©n Gi¸ S¬ ®å nguyªn lý thuËn ®−îc tr×nh bµy trªn h×nh 2. Theo s¬ ®å nguyªn lý nµy chi tiÕt ®−îc kÑp cè ®Þnh trªn bµn m¸y, cßn dông cô ®−îc g¾n trªn tÊm dÞch chuyÓn vµ ®−îc ®iÒu khiÓn bëi c¬ cÊu Stewart. Ng−îc l¹i, nÕu dông cô c¾t cè ®Þnh trªn ®Çu gia c«ng cßn ph«i g¸ trªn bµn m¸y 6 ch©n kiÓu c¬ cÊu Stewart lµ ph−¬ng ¸n nghÞch mµ s¬ ®å nguyªn lý cña nã ®−îc tr×nh bµy trªn h×nh 3. Theo ph−¬ng ¸n nµy chóng ta cã thÓ c¶i t¹o vµ tËn dông nh÷ng m¸y phay th«ng th−êng ®Ó g¾n dông cô vµ chØ lµm thªm bµn m¸y 6 ch©n. Tuy nhiªn viÖc tÝnh to¸n, thiÕt kÕ còng nh− ®iÒu khiÓn sÏ khã kh¨n h¬n vµ phøc t¹p h¬n so víi ph−¬ng ¸n thuËn. Víi nh÷ng c¬ së lËp luËn nh− vËy chóng t«i chän ph−¬ng ¸n thuËn ®Ó thiÕt kÕ m¸y HEXAPOD 2001. III. TÝNh to¸n thiÕt kÕ Hexapod Trong phÇn nµy chóng t«i tr×nh bµy bµi to¸n ®éng häc ng−îc, tÝnh to¸n ma trËn jacobian, ph©n tÝch ®é cøng v÷ng bµi to¸n ®éng häc vµ ®éng lùc häc cña ch©n. 3.1. X¸c ®Þnh bËc tù do c¬ cÊu: Sè bËc tù do cña c¬ cÊu: F = λ(n-j-1) + ∑fi - fp (1) Víi λ lµ bËc tù do cña kh©u trong kh«ng gian (λ = 6) n lµ tæng sè kh©u trong c¬ cÊu j lµ tæng sè khíp trong c¬ cÊu fi lµ tæng sè bËc tù do cña c¸c khíp trong c¬ cÊu fp lµ tæng sè bËc tù do thõa cña c¬ cÊu ⇒ F = 6(14-18-1) + (12×3+6×1) – 6 = 6 3.2. Bµi to¸n ®éng häc ng−îc §èi víi bµi to¸n ®éng häc ng−îc vÞ trÝ ®iÓm chuÈn dao (t©m mòi dao) Ct ( vector tõ t©m tÊm di chuyÓn ®Õn ®Çu mòi dao) trong hÖ täa ®é di chuyÓn B, ma trËn xoay B AR ®Ó ®−a vector trôc dông cô vÒ trïng víi trôc Z vµ vÞ trÝ ®iÓm chuÈn dao p0 trong hÖ täa ®é A cho tr−íc. Ta ph¶i x¸c ®Þnh chiÒu dµi ch©n di t¹i vÞ trÝ ph©n tÝch. Nh− minh häa trong h×nh 4 [ ]TiziyixiA aaa=a vµ [ ]TiwiviuiB bbb=b lµ c¸c vect¬ vÞ trÝ cña c¸c ®iÓm Ai vµ Bi trong hÖ täa ®é A vµ B. Theo h×nh 4 chóng ta cã ph−¬ng tr×nh chuçi vector cho ch©n i viÕt trong hÖ täa ®é A nh− sau: iiii BAOAPBOP +=+ (2) ii B B A ii RBA abp −+= (3) ( ) iiBBABAii RRBA abctp −+−= 0 (4) LÊy tÝch v« h−íng cña vector ii BA víi chÝnh nã cho ta chiÒu dµi cña ch©n i t¹i vÞ trÝ ®ang ph©n tÝch ( )[ ] ( )[ ]iiBBABATiiBBABAiiii2i RRRRBABAd abctpatp −+−−+−=⋅= 00 bc (5)         − +−+ −−− == θθφφθ ψθψφψθφψφψθφ ψθψφψθφψφψθφ φθψ csscs ssccscscsscc csscccsssccc RRRR zyzB A (6) p b ct n ct a p b n p p a H×nh 4: Ph©n tÝch vÞ trÝ c¬ cÊu 3.3. Ma trËn jabobian [ ] [ ]         × × == T T x b Sb JJJ 66 11 ss s T 6 T 1 1- q MM (7) ë ®©y bi vµ si biÓu diÔn vector iPB vµ vector ®¬n vÞ theo trôc. 3.4. ph©n tÝch lùc tÜnh Ph−¬ng tr×nh c©n b»ng lùc vµ moment cña tÊm dÞch chuyÓn t¹i ®iÓm gia c«ng nh− sau: 1. Hîp lùc t¸c dông lªn tÊm dÞch chuyÓn iif sf ∑= (8) 2. Tæng moment cña c¸c lùc t¸c ®éng t¹i ®iÓm gia c«ng ( )∑ ×= iii f sbn (9) ë ®©y bi vµ si biÓu diÔn vector iPB vµ vector ®¬n vÞ theo trôc. Cuèi cïng ta cã ph−¬ng tr×nh cho ta quan hÖ chuyÓn ®æi gi÷a lùc t¹o ra ë ®iÓm ®Çu cuèi vµ c¸c lùc t¸c ®éng τ 6 1 6611 61 ⋅=            ××=  = TJ f f bb MK K ss ss n f F (10) Do ®ã nÕu c¸c lùc t¸c dông cho tr−íc ta cã thÓ tÝnh trùc tiÕp lùc t¹o ra ë ®iÓm ®Çu cuèi vµ ng−îc l¹i nÕu cho tr−íc lùc ë ®iÓm ®Çu cuèi ta cã thÓ t×m ®¸p øng lùc trªn c¸c ch©n b»ng biÕn ®æi ng−îc. 3.5. ph©n tÝch ®é cøng v÷ng Ma trËn ®é cøng ®−îc x¸c ®Þnh nh− sau: [ ] [ ]         × ×    ××= T T b b bb kK 616 111 6611 61 ss ss ss ss T T MMK K (11) 3.6. ®éng häc VËn tèc : VËn tèc gãc cña ch©n thø i ®−îc x¸c ®Þnh (12) Mét khi t×m ®−îc vËn tèc gãc cña ch©n thø i, vector vËn tèc khèi t©m cña piston vµ xylanh thø i lµ i i i i vv 21 x¸c ®Þnh: (13) Gia tèc : Gia tèc gãc cña ch©n i ®−îc x¸c ®Þnh:        − = 0 v v d 1 bix i iy i i i iω         =×= 0 1 11 biy i bix i i i i i i i i v v d ee sv ω , =ii 2v ( ) ( )         − − biz i i biy i i bix i i i vd ved ved d 2 21             ⋅− +− =         = 0 .2 .2 1 0 i bix i biz i bix i i biy i biz i biz i i iy i ix i i i d vv v d vv v d & & & & & ω ω ω (14) Mét khi gia tèc gãc cña ch©n thø i t×m ®−îc, gia tèc cña khèi t©m piston vµ xylanh lµ :             +− − − = i biy i bix i i bix i biz i biy i i bix i biz i bix i i i d vv d vv v d vv v d e 22 1 1 1 .2 .2& &v (15) , ( ) ( ) ( )             ++ +− +− = i biy i bix i biz i i biy i biz i biy i i i bix i biz i bix i i i i i d vve v d vve ved d vveved d 22 2 2 2 2 2 2 2 2 1 & & & &v (16) 3.7. ®éng lùc häc §éng lùc häc ch©n Ph−¬ng tr×nh ®éng lùc häc ch©n i ®−îc x¸c ®Þnh: ( ) ( )[ ]iyiiy2iyiiy1ix2i2i2ix1i11ic2i2ic11 i bix i IIvedmvemsgedmsgem d 1f ωωθθ &&&& −−−−−−+= ( )[ ]ixiix2ixiix1iy2i2i2iy1i11 i biy i IIvedmvem d 1f ωω &&&& ++−−−= (17) ë ®©y jixI vµ jiyI lµ thµnh phÇn x vµ y cña moment qu¸n tÝnh chÝnh cña xylanh (j=1) vµ piston (j=2) ®èi víi khèi t©m t−¬ng øng trong hÖ täa ®é ch©n i. §éng lùc häc tÊm di chuyÓn: Ph−¬ng tr×nh ®éng lùc häc tÊm di chuyÓn ®−îc x¸c ®Þnh nh− sau: ( ) pxp6 1i iibiz i ibiy i iibix i vmscfsfccf &=+−∑ = φφφθφ (18) ( ) pyp6 1i iibiz i ibiy i iibix i vmssfcfcsf &=++∑ = θφφθφ (19) ( ) cppzp6 1i ibiz i ibix i gmvmcfsf +=+−∑ = &θθ (20) Lùc ph¸t ®éng vµ ph¶n lùc nÒn Khi c¸c ph¶n lùc ë c¸c khíp cÇu ®· t×m ®−îc, dÔ dµng x¸c ®Þnh lùc ph¸t ®éng iτ b»ng c¸ch lÊy tæng c¸c lùc t¸c ®éng lªn piston i theo trôc Zi. iz2 i 2ic2biz i i vmcgmf &++= θτ (21) C¸c ph¶n lùc t¹i khíp cÇu Ai ai i f cã thÓ t×m nhê ph−¬ng tr×nh Newton cho c¸c ch©n. ( ) i2i2i1i1AAi21biiaii mmRmm vvgff && +=+++ (22) iv. thuËt to¸n ®iÒu khiÓn Mçi täa ®é cña dông cô c¾t ®−îc quyÕt ®Þnh bëi vÞ trÝ 6 ch©n vµ ®−îc ®iÒu khiÓn bëi 6 ®éng c¬. §Ó ®iÒu khiÓn tÊm dÞch chuyÓn ( platform) mang dông cô cã thÓ thùc hiÖn b»ng nhiÒu ph−¬ng ¸n kh¸c nhau nh−: vi xö lý, PLC, m¸y tÝnh, .... ë ®©y chóng t«i chän ph−¬ng ph¸p ®iÒu khiÓn b»ng m¸y tÝnh qua c¸c vi xö lý ®iÒu khiÓn c¬ cÊu chÊp hµnh mµ gi¶i thuËt cña nã ®−îc tr×nh bµy H×nh 5: SÑ Ñ EX I T Ñ S S S Ñ O ÄN G C Ô T H Ö Ù i PH A ÙT X U N G T i = T i + T i Ñ T Í N H C H U K Y Ø PH A ÙT X U N G T i = X U N G m ax* tdl/X U N G i T i <= (0.5+ i )T m in delay PH A ÙT X U N G T Ö Ø 1-> X U N G m ax T Í N H SO Á X U N G C A ÀN PH A ÙT C H O M O ÃI Ñ O ÄN G C Ô T Ì M SO Á X U N G L ÔÙN N H A ÁT T Í N H C H I E ÀU D A ØI T Ö ØN G C H A ÂN BI E ÁN T H I E ÂN Ñ R E SE T D Ö ØN G K I E ÅM T R A C H I E ÀU D A ØI C H A ÂN Ñ A Õ D ÒC H C H U Y E ÅN K H Ô ÛI Ñ O ÄN G 8255 B E G I N N H A ÄP D A T A T Í N H C H I EÀU D A ØI C H A ÂN K I E ÅM T R A C H I E ÀU D A ØI C H A ÂN S ThuËt to¸n nµy cã −u ®iÓm lµ chuyÓn nhiÖm vô ®iÒu khiÓn tõ m¸y tÝnh ®Õn c¸c vi m¹ch phÇn cøng, mçi vi m¹ch ®¶m nhiÖm viÖc ®iÒu khiÓn cho mçi ch©n dÔ dµng vµ hiÖu qu¶ h¬n. M¸y tÝnh lóc nµy chØ dïng ®Ó gi¶i quyÕt c¸c vÊn ®Ò néi suy vµ tÝnh to¸n c¸c d÷ liÖu ®iÒu khiÓn. v. kÕt qu¶ vµ nhËn xÐt 5.1 NH÷NG KÕT QU¶ BAN ®ÇU Trªn c¬ së gi¶i nh÷ng bµi to¸n nãi trªn chóng t«i ®· thiÕt kÕ chÕ t¹o m« h×nh HEXAPOD 2001 thÓ hiÖn trªn h×nh 6 víi c¸c th«ng sè sau ®©y: KÝch th−íc :800x800x1600 mm KÕt cÊu cña kh©u t¸c ®éng : lmin = 552 mm, lmax = 772 mm Khèi l−îng cña m¸y :150 Kg §· tiÕn hµnh thùc nghiÖm ch¹y kh«ng t¶i còng nh− cã t¶i ®Ó gia c«ng trªn vËt liÖu mÒm. M¸y ch¹y kh¸ ªm vµ æn ®Þnh. 5.2. h−íng nghiªn cøu ph¸t triÓn tiÕp H×nh 5: S¬ ®å gi¶i thuËt H×nh 6: M¸y ®ang gia c«ng Qua nh÷ng thÝ nghiÖm ®· thùc hiÖn chóng t«i thÊy cã nhiÒu h−íng ph¸t triÓn hoµn thiÖn ®Ò ¸n nh−: - X©y dùng m« h×nh vµ ®å g¸ ®Ó kiÓm tra, ®¸nh gi¸ sai sè cña m¸y ®Ó cã biÖn ph¸p n©ng cao ®é chÝnh x¸c cña m¸y. - Nghiªn cøu c¶i thiÖn c¸c ph−¬ng ph¸p ®iÒu khiÓn ®Ó n©ng cao n¨ng suÊt gia c«ng. - ThiÕt kÕ vµ chÕ t¹o m¸y Hexapod c«ng nghiÖp cã c«ng suÊt lín ®Ó gia c«ng nhiÒu chi tiÕt lín vµ phøc t¹p. tµi liÖu tham kh¶o [1] Ng« Diªn TËp, Vi xö lý trong ®o l−êng vµ ®iÒu khiÓn, Nhµ xuÊt b¶n Khoa häc kü thuËt, 1999. [2] NguyÔn ThiÖn Phóc, Ng−êi m¸y c«ng nghiÖp vµ s¶n xuÊt tù ®éng linh ho¹t, Nhµ xuÊt b¶n Khoa häc kü thuËt, 1991. [3] Lorenzo Sciavicco, Bruno Siciliano, Modeling And Control of Robot Manipulators, McGraw-Hill, Inc 1996. [4] Lung-Wen Tsai , Robot Analysis, Wiley-Interscience Publication 1999. [5] T. D. Burtonm, Introduction to Dynamic Systems Analysis, McGraw-Hill, Inc 1994.

Các file đính kèm theo tài liệu này:

  • pdfThiết kế và chế tạo mô hình _ Hexapod.pdf
Tài liệu liên quan