Bậc tự do của robot.
BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƢỜNG ĐẠI HỌC BÁCH KHOA HÀ NỘI - NGUYỄN NGỌC ANH NGHIÊN CỨU THIẾT KẾ QUỸ ĐẠO CHUYỂN ĐỘNG CHO ROBOT HÀN ỐNG DẪN DẦU KHÍ LUẬN VĂN THẠC SĨ KỸ THUẬT CHẾ TẠO MÁY NGƢỜI HƢỚNG DẪN PGS TS PHAN BÙI KHÔI HÀ NỘI - 2014 1708094056468f5fb7bb7-65d9-43b8-84a2-1691277fa3a5 170809405646833284840-a526-4053-a7b1-1ef7e8f59532 170809405646790994a3f-d19f-415b-acfe-fde4a6a46bca LỜI CAM ĐOAN H tên: Nguyn Ngc Anh Xí nghip khai thác du khí tài: Nghiên cứu thiết kế quỹ đạo chuyển động cho robot hàn ống dẫn dầu khí” Chuyên ngành: Công ngh ch to máy Mã s: CB110015 c thc hi i s ng dn tn tình ca PGS.TS Phan Bùi Khơi Các s kt qu trình bày lun c cơng b bt kì mt tài liu Hà Nội, tháng năm 2014 Ngƣời viết Nguyễn Ngọc Anh DANH MỤC CÁC KÝ HIỆU, CÁC CHỮ VIẾT TẮT ISO International Organization for Standardization CAD Computer Aided Design CAM Computer Aided Manufacturing NC Numerical Control 1; 3 Chuyng quay d2; d4 Chuyng tnh tin f bc t ca robot n S khâu ca robot bao gm c giá c nh bc t ca mt vt rn không chu liên kt không gian làm vic ca robot fi S bc t ca khp th i g Tng s khp cu fc fr Vh T hàn Kp H s p Ih dòng hàn H s tn tht que hàn Fht Lng kim loi hòa tan to mt cng hàn Ih n hàn T khi kim loi hàn WMR Welding Mobile Robot i1 Ai H s t l Ma trn mô t v ng ca khâu i i vi khâu i-1 i 1 Ai1 Ma trn ngho ca ma trn i 1 Ci Ma trn cosin ch ng i 1 Ai i 1 C iT Ma trn chuyn v ) Ma trn cosin ch c quay h t quanh trc t x góc φ Ma trn cosin ch c quay h t quanh trc t y góc ψ Ma trn cosin ch c quay h t quanh trc t z Trans(a, Tnh tin dc trc t x mn a, theo trc t y mn b,c) b, theo trc t z mn c An Ma trnh v trí ca khâu thao tác n Ak Ma trnh v trí ca h t gn vi khâu thao tác tm tác ng cui h t khâu cui n D-H Denavit-Hartenberg MỤC LỤC LỜI CAM ĐOAN DANH MỤC CÁC KÝ HIỆU, CÁC CHỮ VIẾT TẮT DANH MỤC CÁC BÀNG, HÌNH VẼ CHƢƠNG 1: TỔNG QUAN VỀ ROBOT 1.1 GII THIU CHUNG V ROBOT 1.1.1 Bc t ca robot ng công tác vùng làm vic ca robot 13 1.2.1 Hàn h quang 14 1.2.2 T chc ca kim loi hàn 15 1.2.3.t h n: 16 1.2.4 Mn .17 1.2.5 Các tham s ca trình hàn h 18 n 18 n áp h quang 19 1.2.8 T di chuyn (vn tc hàn) 19 dài h quang 19 1.3.CU TRÚC CHUNG CA ROBOT HÀN 19 1.3.1 B u khin 20 1.3.2 Ngun dng 20 1.3.3 Súng hàn 21 1.3.4 Ngun 22 1.3.5 B làm sch súng hàn 22 1.3.6 B cp dây 22 1.3.7 Khung hàn, tay hàn 23 1.3.8 B nh tâm, cm bin 23 1.4 MT S LOI ROBOT HÀN 23 1.4.1 Gii thiu mt s robot hàn 23 1.4.1 Kt cu ca robot hàn ng du khí 25 1.4.2 Bc t chuyng ca robot hàn ng du khí 28 1.4.3 Thông s ng hàn dc tính k thut ca Robot hàn 29 1.5 NG DNG ROBOT HÀN TRONG NGÀNH DU KHÍ 30 1.5.1 Công tác lng ng dn du khí Vit Nam 30 1.5.2 Cơng ngh khai thác du khí Vit Nam 31 CHƢƠNG 2: TÍNH ĐỘNG HỌC ROBOT HÀN ỐNG DẪN DẦU KHÍ 32 2.1 CU TRÚC, BC T DO CA ROBOT HÀN NG DN DU KHÍ 32 2.1.1 Cng hc 32 2.1.2 Bc t chuyng ca robot hàn ng du khí 33 LÝ THUYT KHNG HC 34 2.2.1 Các t thun nht, ma trn bii thun nht 34 2.2.3 Cách xây dng h trc t theo Denavit-Hartenberg 37 2.2.4 Các tham s ng hc Denavit-Hartenberg 39 2.2.5 Các ma trn Denavit-Hartenberg 39 2.3 THIT LP H NG HC CA ROBOT HÀN NG DU KHÍ 40 2.3.1 Các h ta 40 nh ma trn truyn 42 2.3.3 Thit lng hc robot 44 2.4.1 Bài tốn thun v v trí 45 2.4.2 Bài toán thun v vn tc 46 2.4.3 Bài toán thun v gia tc 48 2.4.4 Thut toán gii toán thun 48 2.5 Ging hc thun vào mơ hình robot hàn ng dn du khí 49 CHƢƠNG 3: THIẾT KẾ QUỸ ĐẠO CHUYỂN ĐỘNG CHO ROBOT HÀN ỐNG DẪN DẦU KHÍ 59 3.1 QU O CHUYNG CHO KHÂU CUI CA ROBOT 59 3.1.1- H to 59 o chuyng ca robot 59 3.2 KHNG HC ROBOT 60 c v v trí 60 c v vn tc 63 c v gia tc 65 u chng vector sai s 65 NG LC HC: 66 3.4 TÍNH TỐN BIÊN DNG HÀN 68 3.4.1 Mơ hình tốn hng gia cơng 68 KẾT LUẬN 81 TÀI LIỆU THAM KHẢO 82 DANH MỤC CÁC BÀNG, HÌNH VẼ Bng 2.1 Các tham s D-H 42 Hình 1.1 Trng cơng tác ca Robot Hình 1.2 Tay máy t góc Hình 1.3 Tay máy t Hình 1.4 Tay máy t tr .9 Hình 1.5 Tay máy t cu Hình 1.6 Tay máy khp bn l 10 Hình 1.7 Khp quay 10 Hình 1.8 Kh .11 Hình 1.9 Khp tr .11 Hình 1.10 Khp ren (khp vít me) 12 Hình 1.11 Khp cu 12 Hình 1.12 Khp phng 13 Hình 1.13 Khng 13 Hình 1.14 Hàn h n 14 Hình 1.15 Robot hàn 24 Hình 1.16 Robot hàn IRB 1410 ArcPack 24 Hình 1.17 Robot hàn ti xng thc hành ci hc bách khoa Hà Ni 25 Hình 1.18 Cu trúc c khí robot hàn ng dn du khí .25 Hình 1.19: Mơ hình khâu (ray dn hng) 26 Hình 1.20 Mơ hình khâu 26 Hình 1.21: Mơ hình khâu .27 Hình 1.22: Mơ hình khâu 27 Hình 1.23: Khâu 27 Hình 1.24: Khâu 28 Hình 2.1: Mơ hình robot hàn ng dn du khí 32 Hình 2.2: S ng hc ca robot hàn ng dn du khí 33 Hình 2.3 S chuyn trc t 35 Hình 2.4: Các góc quay Roll-Pitch Yaw ca Robot 36 Hình 2.5: Các h t gn cho robot 40 ng hc thun 49 Hình 2.9: Qu o chuyng c 51 Hình 2.10: T khâu thao tác theo trc X 51 Hình 2.11: T khâu thao tác theo trc Y 52 Hình 2.12: T khâu thao tác theo trc Z 52 th vn tc theo phng X .54 th vn tc theo phng Y .54 th vn tc theo phng Z 55 th vn tc góc theo phng X 55 th vn tc góc theo phng Y 56 th vn tc góc theo phng Z 56 th gia tu hàn theo phng x .57 th gia tu hàn theo phng Y 57 th gia tu hàn theo phng Z 58 Hình 3.1: Mơ t ng hàn robot thc hin 68 Hình 3.2 Qu o khâu thao tác .69 Hình 3.4 Qu o chuyng khâu .71 Hình 3.5 Qu o chuyng khâu .72 Hình 3.6 Qu o chuyng khâu .72 Hình 3.7 Qu o chuyng khâu .73 Hình 3.9 Qu o chuyng khâu .73 th vn tc khâu .74 th vn tc khâu khâu 74 th vn tc khâu .75 th vn tc khâu khâu 75 th gia tc khâu 76 th gia tc khâu 76 th gia tc khâu 77 th gia tc khâu 77 th moment lt lên khâu .78 th moment lt lên khâu .78 th moment lt lên khâu .79 th moment lt lên khâu .79 th moment lt lên khâu .80