Bé gi¸o dôc vµ ®µo t¹o Trêng ®¹i häc b¸ch khoa hµ néi --------------------------------------- Hä vµ tªn t¸c gi¶ luËn v¨n TrÇn v¨n diÖn Nghiªn cøu ¶nh hëng cña tèc ®é vµ t¶I träng tíi ®é chÝnh x¸c lÆp cña robot staubli 6 bËc tù do Chuyªn ngµnh: c¬ ®iÖn tö LuËn v¨n th¹c sÜ khoa häc C¬ ®iÖn tö Ngêi híng dÉn khoa häc: 1. Ts nguyÔn träng doanh Hµ néi n¨m 2013 1 17061131727021000000 Môc lôc Trang Trang phô b×a…………………………………………………………………. 1 Lêi cam ®oan…………………………………………………………………. 2 Danh môc c¸c h×nh vÏ, ®å thÞ………………………………………….
3 Më ®Çu……………………………………………………………………… 8 Ch¬ng 1- tæng quan vÒ robot c«ng nghiÖp……………… 10 1.1 LÞch sö ph¸t triÓn vµ øng dông R«b«t c«ng nghiÖp (IR)………………….1 S¬ lîc qu¸ tr×nh ph¸t triÓn robot c«ng nghiÖp………………………… 10 1.2 Sö dông robot c«ng nghiÖp trong s¶n xuÊt………………………….3 LÞch sö ph¸t triÓn robot c«ng nghiÖp t¹i ViÖt Nam……………………….2 C¸c kh¸i niÖm vµ ®Þnh nghÜa R«b«t c«ng nghiÖp (IR)……………………… 15 1.1 §Þnh nghÜa r«b«t c«ng nghiÖp…………………………………………….2 BËc tù do cña r«b«t………………………………………………………… 16 1.4 Trêng c«ng t¸c cña robot………………………………………………… 18 1.3 CÊu tróc c¬ b¶n cña robot c«ng nghiÖp……………………………………… 18 1.1 C¸c thµnh phÇn chÝnh cña robot c«ng nghiÖp ……………………………. KÕt cÊu cña tay m¸y………………………………………………………18 1. Ph©n lo¹i Robot c«ng nghiÖp……………………………………….1 Ph©n lo¹i theo kÕt cÊu…………………………………………………….2 Ph©n lo¹i theo hÖ thèng truyÒn ®éng…………………………………….3 Ph©n lo¹i theo øng dông………………………………………………….4 Ph©n lo¹i theo c¸ch thøc vµ ®Æc trng cña ph¬ng ph¸p ®iÒu khiÓn….5 HÖ thèng chia liÒu thuèc tiªm Theodorico vµ Robot Staubli-TX40 1.1 Giíi thiÖu vÒ hÖ thèng chia liÒu tù ®éng Theodorico………………….2 CÊu tróc c¬ b¶n cña robot TX40………………………………………… 27 1.3 Bé ®iÒu khiÓn, phÇn mÒm vµ thiÕt bÞ d¹y robot TX40……………… 30 1.4 C¸c ma trËn biÕn ®æi thuÇn nhÊt cña robot TX40……………………… 31 Ch¬ng 2- nguyªn lý ®o ®é chÝnh x¸c lÆp cña robot………35 2.2 Kh¸i niÖm ®é chÝnh x¸c, ®é chÝnh x¸c lÆp vµ ®é ph©n gi¶i………………… 36 2.3 C¸c chØ tiªu ®¸nh gi¸ chÊt lîng robot theo ISO 9238…………………….4 C¸c ph¬ng ph¸p ®¸nh gi¸ ®é chÝnh x¸c lÆp…………………………… 40 2.5 Chän ph¬ng ph¸p ®o…………………………………………………… 43 2.6 Chä ph¬ng ¸n bè trÝ c¶m biÕn trong hÖ thèng ®o………………………… 45 2.7 X¸c ®Þnh c¸c vÞ trÝ t¬ng quan…………………………………………… 49 Ch¬ng 3- thiÕt kÕ hÖ thèng ®o…………………………………….1 Nguyªn lý cña hÖ thèng ®o……………………………………………… …52 3.1 ThiÕt kÕ card ADC……………………………………………………….2 PhÇm mÒm ®iÒu khiÓn vµ thu thËp d÷ liÖu……………………………… 56 3.1 Ph©n lo¹i c¶m biÕn……………………………………………………… 58 3.2 C¸c th«ng sè ®Æc trng cña c¶m biÕn…………………………………… 59 3.3 C¶m biÕn sö dông trong hÖ thèng ®o………………………………… 60 3.4 HiÖu chuÈn c¶m biÕn (Calibration)……………………………………… 61 Ch¬ng 4- ®¸nh gi¸ ®é chÝnh x¸c lÆp cña robot tx40… 63 4.1 Tiªu chuÈn ®¸nh gi¸ vµ xö lý kÕt qu¶………………………………….1 Tiªu chuÈn ®¸nh gi¸………………………………………………….1 ¶nh hëng cña tèc ®é tíi ®é chÝnh x¸c lÆp cña robot…………………… 67 4.2 ¶nh hëng cña tèc ®é vµ t¶i träng tíi ®é chÝnh x¸c lÆp cña robot…… 69 KÕt luËn vµ kiÕn nghÞ………………………………………………… 72 Tµi liÖu tham kh¶o…………………………………………………… 74 Lêi cam ®oan Tªn t«i lµ TrÇn V¨n DiÖn, häc viªn líp cao häc 11BC§T. Sau gÇn 2 n¨m häc tËp, nghiªn cøu t¹i Trêng §¹i Häc B¸ch Khoa Hµ Néi, ®îc sù híng dÉn vµ gióp ®ì cña c¸c thÇy c« gi¸o, ®Æc biÖt lµ sù gióp ®ì cña gi¸o viªn híng dÉn tèt nghiÖp TS.
NguyÔn Träng Doanh, t«i ®· ®i ®Õn cuèi chÆng ®êng ®Ó kÕt thóc khãa häc. Víi §Ò tµi LuËn v¨n tèt nghiÖp lµ: Nghiªn cøu ¶nh hëng cña tèc ®é vµ t¶i träng tíi ®é chÝnh x¸c lÆp cña robot Staubli-TX40”. T«i xin cam ®oan ®©y lµ c«ng tr×nh nghiªn cøu cña c¸ nh©n t«i díi sù híng dÉn cña TS. NguyÔn Träng Doanh.
C¸c sè liÖu vµ néi dung trong luËn v¨n lµ trung thùc vµ cha sö dông ®Ó b¶o vÖ mét häc vÞ nµo. T¸c gi¶ luËn v¨n TrÇn v¨n diÖn 4 Danh môc c¸c h×nh vÏ, ®å thÞ H×nh 1.1: C¸c hÖ täa ®é suy réng cña Robot H×nh 1.2: Quy t¾c bµn tay ph¶i H×nh 1.3: BiÓu diÔn trêng c«ng t¸c cña Robot H×nh 1.4: C¸c thµnh phÇn chÝnh cña hÖ thèng Robot H×nh 1.5: Robot kiÓu täa ®é §Ò c¸c H×nh 1.6: Robot kiÓu täa ®é trô H×nh 1.7: Robot kiÓu täa ®é cÇu H×nh 1.8: Robot TX40- h·ng Staubli ho¹t ®éng theo hÖ täa ®é gãc H×nh 1.9: Robot kiÓu SCARA H×nh 1.10: HÖ thèng chia liÒu tù ®éng Theodorico cña Comecer H×nh 1.11: Robot TX40 trong buång chia liÒu H×nh 1.12 KÝch thíc th©n robot TX40 H×nh 1.13 CÊu tróc vµ kÝch thíc cæ tay cña robot TX40 H×nh 1.14 S¬ ®å khíp vµ kh«ng gian lµm viÖc cña robot Staubli-TX40 H×nh 1.15 Bé ®iÒu khiÓn CS8C H×nh 1.16 S¬ ®å giao tiÕp gi÷a phÇn mÒm ®iÒu khiÓn vµ hÖ thèng H×nh 1.17 ThiÕt bÞ d¹y robot SP1 cña Staubli H×nh 1.18 S¬ ®å ®éng häc cña robot Staubli-TX40 H×nh 2.1 Sai sè ®Þnh vÞ vµ ®Þnh híng cña robot c«ng nghiÖp H×nh 2.3 C¬ cÊu thÝch nghi cña robot l¾p r¸p HI-T-Hand Expert-2 5 H×nh 2.4 T¬ng quan gi÷a ®é chÝnh x¸c vµ ®é chÝnh x¸c lÆp H×nh 2.5 HÖ thèng ®o cña Brethe H×nh 2.6 HÖ thèng x¸c ®Þnh sai sè gãc cña Brethe H×nh 2.7 HÖ thèng ®o b»ng camera cña Koseki H×nh 2.8 Ph¬ng ph¸p ®o cña Shiakolas dïng c¶m biÕn lùc, ®Çu ®o tiÕp xóc H×nh 2.9 Ph¬ng ¸n sö dông 6 c¶m biÕn (3-2-1) H×nh 3.1 S¬ ®å khèi cña Card ADC H×nh 3.2 S¬ ®å nguyªn lý khèi ADC H×nh 3.3 Khèi vi xö lý trung t©m dsPic 4012 H×nh 3.4 Khèi giao tiÕp m¸y tÝnh RS232 H×nh 3.5 Khèi nguån H×nh 3.6: S¬ ®å m¹ch in card ADC H×nh 3.7 Card ADC 12bits H×nh 3.8 S¬ ®å thuËt to¸n ®äc vµ göi tÝn hiÖu Card ADC H×nh 3.9 ThuËt to¸n thu thËp vµ xö lý d÷ liÖu C# H×nh 3.10: Giao diÖn hÖ thèng ®o ®é chÝnh x¸c lÆp H×nh 3.11: C¶m biÕn ®iÖn tõ kh«ng tiÕp xóc LD701 2/5 mm H×nh 3.12: ThiÕt bÞ ®o dÞch chuyÓn Micro Digimax Head cña Mitoyo.13: §êng ®Æc tÝnh cña c¶m biÕn LD701 H×nh 3.14: Gi¸ ®ì hÖ thèng c¶m biÕn H×nh 3.15: B¶ng d÷ liÖu hÖ thèng ®o thu ®îc trªn 6 kªnh H×nh 4.1 L¾p ®Æt vµ ®Þnh vÞ hÖ thèng ®o 6 H×nh 4.2 VÞ trÝ ®Þnh vÞ ®o ®é chÝnh x¸c lÆp H×nh 4.3 Giao diÖn phÇn mÒm ®iÒu khiÓn robot TX40 H×nh 4.4 B¶ng xö lý kÕt qu¶ ®o H×nh 4.5 B¶ng kÕt qu¶ ®o vµ gi¸ trÞ ®é chÝnh x¸c lÆp khi t¶i 0g vµ vËn tèc 5% H×nh 4.6 Sai sè ®Þnh vÞ theo ph¬ng X,Y,Z khi robot kh«ng mang t¶i H×nh 4.7 §é chÝnh x¸c lÆp khi robot kh«ng mang t¶i H×nh 4.8 B¶ng gi¸ trÞ ®é chÝnh x¸c lÆp theo tèc ®é vµ t¶i träng H×nh 4.9 §å thÞ ®é chÝnh x¸c lÆp theo vËn tèc vµ t¶i träng 7 PhÇn më ®Çu 1. §é chÝnh x¸c lÆp cña robot lµ mét chØ tiªu quan träng cho viÖc lùa chän robot mét øng dông cô thÓ. ChØ tiªu nµy ®îc cung cÊp bëi nhµ s¶n xuÊt nhng kh«ng nªu râ ®iÒu kiÖn ®¹t ®îc vÒ t¶i träng, tèc ®é, nhiÖt ®é…Do vËy trong qu¸ tr×nh sö dông ®Ó n©ng cao hiÖu qu¶ lµm viÖc cÇn thùc hiÖn ®¸nh gi¸ ¶nh hëng cña t¶i träng vµ tèc ®é tíi ®é chÝnh x¸c lÆp cña robot, tõ ®ã ®a ra ®iÒu kiÖn lµm viÖc tèi u nhÊt cho hÖ thèng.
KÕt qu¶ cña ®Ò tµi còng lµ cho ra mét s¶n phÈm c¬ ®iÖn tö ®Æc trng phï hîp víi lÜnh vùc nghiªn cøu vµ c«ng t¸c cña b¶n th©n. §· cã nh÷ng nghiªn cøu vÒ ®é chÝnh x¸c lÆp cña robot trong m« h×nh häc cô. Tuy nhiªn c¸c nghiªn cøu cha thùc hiÖn trªn mét robot c«ng nghiÖp cô thÓ ®ang ho¹t ®éng vµ ®¸nh gi¸ ¶nh hëng cña ®iÒu kiÖn lµm viÖc tíi ®é chÝnh x¸c lÆp cña chóng. Môc ®Ých nghiªn cøu cña luËn v¨n, ®èi tîng vµ ph¹m vi nghiªn cøu.
- Môc ®Ých nghiªn cøu: Nghiªn cøu tæng quan vÒ robot c«ng nghiÖp vµ øng dông robot c«ng nghiÖp. C¸c ph¬ng ph¸p ®o ®é chÝnh x¸c lÆp cña robot. Ph¬ng ph¸p thiÕt kÕ vµ thi c«ng hÖ thèng ®o lêng vµ thu thËp d÷ liÖu dïng cho nghiªn cøu ®é chÝnh x¸c lÆp. §¸nh gi¸ ¶nh hëng cña tèc ®é vµ t¶i träng ®Õn ®é chÝnh x¸c lÆp cña mét robot cô thÓ tõ ®ã lùa chän ®iÒu kiÖn lµm viÖc tèi u cho hÖ thèng.
- Ph¹m vi nghiªn cøu: ThiÕt kÕ hÖ thèng ®o ®é chÝnh x¸c lÆp tõ ®ã ®¸nh gi¸ ¶nh hëng cña tèc ®é vµ t¶i träng ®Õn ®é chÝnh x¸c lÆp cña robot. - §èi tîng nghiªn cøu: §é chÝnh x¸c lÆp cña robot c«ng nghiÖp Staubli TX40 dïng trong hÖ thèng chia liÒu thuèc tiªm cña Trung t©m M¸y gia tèc- BÖnh viÖn T¦Q§ 108. Tãm t¾t c« ®äng c¸c luËn ®iÓm c¬ b¶n vµ ®ãng gãp cña t¸c gi¶: - T×m hiÓu tæng quan vÒ robot c«ng nghiÖp vµ øng dông robot c«ng nghiÖp ë ViÖt Nam. - T×m hiÓu cÊu tróc, ®éng häc vµ ®iÒu khiÓn cña robot TX40.
- T×m hiÓu ph¬ng ph¸p ®¸nh gi¸ ®é chÝnh x¸c lÆp. - Nghiªn cøu c¸c ph¬ng ph¸p ®o vµ chän hÖ thèng ®o phï hîp. - X©y dùng hoµn thiÖn hÖ thèng ®o, card thu thËp d÷ liÖu vµ phÇn mÒm thu thËp d÷ liÖu chuyªn dông cho nghiªn cøu ®é chÝnh x¸c lÆp. - §¸nh gi¸ ¶nh hëng cña tèc ®é vµ t¶i träng tíi ®é chÝnh x¸c lÆp cña robot TX40 dùa vµo kÕt qu¶ ®o thùc nghiÖm vµ lùa chän ®iÒu kiÖn lµm viÖc tèi u cho robot.
Ph¬ng ph¸p nghiªn cøu: Sö dông ph¬ng ph¸p thùc nghiÖm. X©y dùng hÖ thèng ®o ®é chÝnh x¸c cho robot vµ thùc hiÖn ®o khi robot lµm viÖc ë c¸c ®iÒu kiÖn kh¸c nhau. TÝnh to¸n vµ xö lý kÕt qu¶ dùa theo tiªu chuÈn ISO9238. §¸nh gi¸ dùa vµo kÕt qu¶ tÝnh to¸n vµ chØ tiªu kü thuËt cña nhµ s¶n xuÊt.
9 Ch¬ng 1 - tæNG QUAN VÒ R¤B¤T C¤NG NGHIÖP 1.1 LÞch sö ph¸t triÓn vµ øng dông robot c«ng nghiÖp (IR : Industrial Robot) 1.1 S¬ lîc qu¸ tr×nh ph¸t triÓn cña robot c«ng nghiÖp ThuËt ng÷ “Robot” xuÊt ph¸t tõ tiÕng Sec (Czech) “Robota” cã nghÜa lµ c«ng viÖc t¹p, dÞch trong vë kÞch Rossum’s Universal Robots cña Karel Capek, vµo n¨m 1921. Trong vë kÞch nµy, Rossum vµ con trai cña «ng ta ®· chÕ t¹o ra nh÷ng chiÕc m¸y gÇn gièng víi con ngêi ®Ó phôc vô con ngêi. Cã lÏ ®ã lµ mét gîi ý ban ®Çu cho c¸c nhµ s¸ng chÕ kü thuËt vÒ nh÷ng c¬ cÊu, m¸y mãc b¾t chíc c¸c ho¹t ®éng c¬ b¾p cña con ngêi. §Çu thËp kû 60, c«ng ty Mü AMF (American Machine and Foundry Company) qu¶ng c¸o mét lo¹i m¸y tù ®éng v¹n n¨ng vµ gäi lµ “Ngêi m¸y c«ng nghiÖp” (Industrial Robot).
Ngµy nay ngêi ta ®Æt tªn ngêi m¸y c«ng nghiÖp (hay robot c«ng nghiÖp) cho nh÷ng lo¹i thiÕt bÞ cã d¸ng dÊp vµ mét vµi chøc n¨ng nh tay ngêi ®îc ®iÒu khiÓn tù ®éng ®Ó thùc hiÖn mét sè thao t¸c s¶n xuÊt. VÒ mÆt kü thuËt, nh÷ng robot c«ng nghiÖp ngµy nay, cã nguån gèc tõ hai lÜnh vùc kü thuËt ra ®êi sím h¬n ®ã lµ c¸c c¬ cÊu ®iÒu khiÓn tõ xa (Teleoperators) vµ c¸c m¸y c«ng cô ®iÒu khiÓn sè (NC - Numerically Controlled machine tool). C¸c c¬ cÊu ®iÒu khiÓn tõ xa (hay c¸c thiÕt bÞ kiÓu chñ-tí) ®· ph¸t triÓn m¹nh trong chiÕn tranh thÕ giíi lÇn thø hai nh»m nghiªn cøu c¸c vËt liÖu phãng x¹.