Thông tin tài liệu
BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐẠI HỌC BÁCH KHOA HÀ NỘI Hà Thanh Hải MƠ HÌNH HĨA ĐỘNG LỰC HỌC VÀ ĐIỀU KHIỂN ROBOT GIA CÔNG PHAY LUẬN ÁN TIẾN SĨ KỸ THUẬT CƠ KHÍ Hà Nội – 2020 i luan an BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐẠI HỌC BÁCH KHOA HÀ NỘI Hà Thanh Hải MƠ HÌNH HĨA ĐỘNG LỰC HỌC VÀ ĐIỀU KHIỂN ROBOT GIA CƠNG PHAY Ngành: Kỹ thuật khí Mã số: 9520103 LUẬN ÁN TIẾN SĨ KỸ THUẬT CƠ KHÍ NGƯỜI HƯỚNG DẪN KHOA HỌC: PGS TS Phan Bùi Khôi PGS.TS Hoàng Vĩnh Sinh Hà Nội – 2020 ii luan an LỜI CAM ĐOAN Tôi xin cam đoan tất nội dung luận án “Mơ hình hóa động lực học điều khiển robot gia công phay” thực hướng dẫn tập thể cán hướng dẫn: PGS.TS Phan Bùi Khôi PGS.TS Hoàng Vĩnh Sinh Các kết nêu luận án trung thực chưa tác giả khác cơng bố cơng trình nghiên cứu nào! Hà Nội, ngày tháng năm 2020 Người hướng dẫn Khoa học Người hướng dẫn Khoa học Nghiên cứu sinh PGS.TS Phan Bùi Khơi PGS.TS Hồng Vĩnh Sinh Hà Thanh Hải i luan an LỜI CẢM ƠN Lời đầu tiên, nghiên cứu sinh xin chân thành cảm ơn dạy, tạo điều kiện giúp đỡ quí báu q thầy Bộ mơn Gia cơng vật liệu Dụng cụ công nghiệp, Bộ môn Cơ học ứng dụng, Khoa Cơ khí, Trường Đại học Bách khoa Hà Nội, nơi nghiên cứu sinh học tập nghiên cứu q trình hồn thành luận án Tiếp đến, nghiên cứu sinh xin cảm ơn nhà khoa học, bạn bè, đồng nghiệp giúp đỡ, bảo, đóng góp ý kiến cho nghiên cứu sinh để nghiên cứu sinh hoàn thành luận án Luận án khơng thể hồn thành khơng có dạy, hướng dẫn tận tình, q giá thầy hướng dẫn Sự hướng dẫn mệt mỏi thầy giúp nghiên cứu sinh vượt qua nhiều khó khăn, nhiều giới hạn để hoàn thành luận án Nghiên cứu sinh xin bày tỏ cảm ơn sâu sắc đến PGS.TS Phan Bùi Khơi, PGS.TS Hồng Vĩnh Sinh dành nhiều cơng sức hướng dẫn nghiên cứu sinh suốt trình nghiên cứu Nghiên cứu sinh xin gửi lời cảm ơn chân thành đến bạn bè, đồng nghiệp Trường Cao đẳng cơng trình thị, động viên, hỗ trợ, tạo điều kiện giúp đỡ nghiên cứu trình nghiên cứu Cuối cùng, nghiên cứu sinh xin dành biết ơn tới vợ, con, bố, mẹ, người thân gia đình động viên, chia sẻ, hi sinh lớn lao để nghiên cứu sinh hoàn thành luận án Hà Nội, ngày tháng năm 2020 NGHIÊN CỨU SINH Hà Thanh Hải ii luan an MỤC LỤC LỜI CAM ĐOAN i LỜI CẢM ƠN ii MỤC LỤC .iii DANH MỤC CÁC KÝ HIỆU VÀ CHỮ VIẾT TẮT v DANH MỤC CÁC BẢNG x DANH MỤC CÁC HÌNH VẼ VÀ ĐỒ THỊ .xi MỞ ĐẦU CHƯƠNG TỔNG QUAN CÁC VẤN ĐỀ NGHIÊN CỨU 1.1 Tổng quan gia cơng khí robot cơng nghiệp 1.1.1 Sự phát triển gia công khí robot cơng nghiệp 1.1.2 Ưu việc gia cơng khí robot 1.1.3 Những vấn đề gia cơng khí robot cơng nghiệp 1.2 Cơ sở động học, động lực học tạo hình gia cơng phay 10 1.2.1 Cơ sở động học phay tạo hình bề mặt chi tiết 10 1.2.2 Các thông số động học trình cắt phay 10 1.2.3 Tổng quan lực cắt phương pháp xác định lực cắt phay 14 1.2.3.1 Tổng quan mơ hình xác định lực cắt phay 15 1.2.3.2 Các thành phần lực cắt gia công phay 15 1.3 Cơ sở động lực học gia công phay robot 20 1.3.1 Sự cần thiết khảo sát động lực học robot gia công 20 1.3.2 Phương trình động lực học tổng quát robot 20 1.3.3 Các yếu tố ảnh hưởng đến động lực học robot gia công 21 1.4 Tổng quan tình hình nghiên cứu ngồi nước mơ hình hóa động lực học điều khiển robot gia công phay 21 1.5 Các vấn đề nghiên cứu luận án 23 Kết luận chương 24 CHƯƠNG ĐỘNG HỌC TẠO HÌNH CỦA ROBOT TRONG GIA CƠNG CƠ KHÍ 26 2.1 Cơ sở động học gia cơng tạo hình bề mặt 26 2.1.1 Cơ sở động học tạo hình bề mặt tự dụng cụ 26 2.1.2 Phương pháp tạo hình bề mặt tự 28 2.2 Cơ sở thực động học tạo hình robot gia công 28 2.2.1 Đặc trưng hình học dụng cụ 28 2.2.2 Đặc trưng hình học bề mặt gia công 28 2.2.3 Phương pháp tam diện trùng theo 28 2.3 Động học thiết kế quỹ đạo chuyển động robot 29 2.3.1 Động học robot gia cơng khí 29 2.3.2 Giải toán động học 33 iii luan an 2.3.3 Thiết kế quỹ đạo chuyển động theo yêu cầu thao tác công nghệ 36 2.4 Khảo sát số toán cụ thể 39 Kết luận chương 56 CHƯƠNG ĐỘNG LỰC HỌC ROBOT TRONG GIA CÔNG 57 3.1 Thiết lập phương trình vi phân chuyển động robot 57 3.1.1 Ma trận khối lượng suy rộng hệ robot- bàn máy 58 3.1.2 Lực suy rộng lực Coriolis lực ly tâm 59 3.1.3 Lực suy rộng lực tác dụng lên robot 59 3.1.4 Lực suy rộng của lực không 59 3.1.5 Lực suy rộng lực dẫn động 61 3.2 Các mơ hính tính lực cắt 63 3.3 Bài toán động lực học hệ robot – bàn máy gia cơng khí 66 3.4 Bài toán xác định phản lực liên kết khớp 67 3.5 Bài tốn hiệu chỉnh tính tốn lực cắt q trình hệ robot – bàn máy thực gia công phay 68 3.6 Khảo sát số toán cụ thể 70 Kết luận chương 97 CHƯƠNG ĐIỀU KHIỂN ROBOT TRONG GIA CÔNG 99 4.1 Điều khiển hệ robot – bàn máy gia công 100 4.1.1 Điều khiển bám quỹ đạo cho robot gia công phay 100 4.1.2 Điều khiển động lực học ngược + PD không gian khớp cho hệ robot - bàn máy 102 4.1.3 Điều khiển động lực học ngược kết hợp với vịng ngồi PD không gian thao tác cho hệ robot - bàn máy 104 4.2 Điều khiển hệ robot - bàn máy không gian khớp dựa động lực học ngược + PD + Hiệu chuẩn tính tốn lực cắt 105 4.2.1 Cấu trúc điều khiển động lực học ngược + PD + Hiệu chuẩn tính toán lực cắt 105 4.2.2 Thuật toán hiệu chuẩn tính tốn lực cắt 106 4.3 Điều khiển mờ cho hệ robot – bàn máy gia công 106 4.3.1 Cơ sở điều khiển mờ 107 4.3.2 Bộ điều khiển mờ cho gia công phay 108 4.4 Khảo sát số toán cụ thể 112 Kết luận chương 133 KẾT LUẬN VÀ HƯỚNG NGHIÊN CỨU TIẾP THEO 135 DANH MỤC CÁC CƠNG TRÌNH ĐÃ CƠNG BỐ CỦA LUẬN ÁN 137 DANH MỤC TÀI LIỆU THAM KHẢO 138 PHỤ LỤC iv luan an DANH MỤC CÁC KÝ HIỆU VÀ CHỮ VIẾT TẮT Ký hiệu Diễn giải Đơn vị m/ph mm v/ph mm/rg mm/vg mm/ph mm mm mm độ Fdttb Tốc độ cắt Đường kính dao phay Số vịng quay dao Lượng chạy dao Lượng chạy dao vòng Lượng chạy dao phút Chiều sâu cắt Chiều sâu phay Chiều rộng phay Góc tiếp xúc Số dao phay Chiều dày cắt Chiều dày cắt nhỏ Chiều dày cắt lớn Chiều dày cắt trung bình Góc tiếp xúc tức thời Chiều rộng cắt Góc nghiêng lưỡi cắt góc nâng lưỡi cắt Diện tích phay Số đồng thời tham gia cắt lớp cắt Diện tích cắt thứ i cắt Diện tích cắt trung bình phay F Ft Fr Fz Fx Fy pi q Mz yp xp qp Lực cắt tổng Lực tiếp tuyến (lực vòng) Lực hướng tâm (lực hướng kính) Lực chiều trục (lực theo phương z) Lực nằm ngang (lực theo phương x) Lực thẳng (lực theo phương y) Lực tiếp tuyến tác dụng lên thứ i lực cắt đơn vị Mô men xoắn cắt dao Số mũ ảnh hưởng lượng chạy dao Số mũ ảnh hưởng chiều sâu phay to đến lực cắt Ft Số mũ ảnh hưởng D đến Ft N N N N N N N N/mm2 Nmm v D n Sz Sv Sph h0 h B Z a amin amax atb i b Fdt Nz fi v luan an mm mm mm độ mm độ độ mm2 mm2 mm2 St Ex a(t) as(t) ad(t) R i Ftra,i Ft,i Fr,i Fa,i Kc Ktc Krc Kac Ke Kte Kre Kae Kt Kr Ka Fxyz,tool Ti(i) (z) i-1 Ai AT Góc vào dao Góc dao chiều dày phoi cắt chiều dày tĩnh dao chuyển động chiều dày động dao rung động Bán kính dao phay Góc vị trí thứ i tham gia cắt Chu kỳ chuyển động Góc xoắn (góc nghiêng cạnh cắt dao) Góc kề Vector biểu diễn lực cắt, tiếp tuyến, hướng tâm hướng trục cho thứ i cắt Lực tiếp tuyến i cắt Lực hướng tâm i cắt Lực chiều trục i cắt Vector hệ số hệ số lực cắt tiếp tuyến, hướng tâm hướng trục cho mơ hình lực tuyến tính Hệ số lực cắt tiếp tuyến cho mơ hình lực tuyến tính Hệ số lực cắt hướng tâm cho mơ hình lực tuyến tính Hệ số lực cắt chiều trục cho mơ hình lực tuyến tính Vector hệ số hệ số lực cắt theo phương tiếp tuyến, hướng kính hướng trục mơ hình lực cắt tuyến tính Hệ số lực cắt theo phương tiếp tuyến với mơ hình lực tuyến tính Hệ số lực cắt theo phương hướng kính với mơ hình lực tuyến tính Hệ số lực cắt theo phương hướng trục với mơ hình lực tuyến tính hệ số lực cắt theo hướng tiếp tuyến cho mơ hình lực phi tuyến hệ số lực cắt theo hướng tâm cho mô hình lực phi tuyến hệ số lực cắt theo hướng trục cho mơ hình lực phi tuyến Vector biểu diễn lực cắt theo phương x, y, z Ma trận chuyển đổi hệ trục từ hệ trục tra sang hệ trục xyz Góc lệch hướng tâm Góc hợp lực dFri với trục dao Ma trận biến đổi tọa độ nhất, biểu diễn vị trí hướng tọa độ Oixiyizi hệ tọa độ Oi-1xi-1yi-1zi-1 Ma trận chuyển vị ma trân A vi luan an độ độ mm mm mm mm độ độ độ N N N N N/mm2 N/mm2 N/mm2 N/mm N/mm N/mm N/mm N/mm2 N/mm2 N/mm2 N độ độ θi di i cij Ci i-1 i-1 ri Ai Ci ri f(q,p) p q qi p q Góc quay quanh trục zi-1 để trục xi-1 chuyển đến trục x’i (x’i// xi) Khoảng dịch chuyển tịnh tiến dọc theo trục zi-1 để gốc tọa độ Oi-1 chuyển đến Hi-1, giao điểm trục xi trục zi-1 Khoảng dịch chuyển tịnh tiến dọc theo trục xi để Hi-1 chuyến đến gốc tọa độ Oi Góc quay quanh trục xi cho trục z’i-1 (z’i-1// zi-1) chuyển đến trục zi Phần tử hàng thứ i cột thứ j ma trận Ma trận côsin hướng hệ tọa độ Oixiyizi hệ tọa độ Oi-1xi-1yi-1zi-1 Vector biểu diễn vị trí tọa độ gốc Oi hệ tọa độ Oi1xi-1yi-1zi-1 Ma trận biểu diễn vị trí hướng cho hệ tọa độ Oixiyizi hệ tọa độ sở O0x0y0z0 Ma trận côsin hướng hệ tọa độ Oixiyizi hệ tọa độ sở O0x0y0z0 Vector biểu diễn vị trí tọa độ gốc Oi hệ tọa độ O0x0y0z0 Hệ phương trình động học dạng ma trận Vector định vị tọa độ thao tác dụng cụ cắt Vector tọa độ khớp Vị trí khớp i robot Vector vận tốc dụng cụ cắt Vector vận tốc khớp robot p q Vector gia tốc dụng cụ cắt Vector gia tốc khớp robot Jq Jp J q1 Ma trận Jacobian hàm f với biến q Ma trận Jacobian hàm f với biến p Ma trận nghịch đảo ma trận Jq J p1 Ma trận nghịch đảo ma trận Jp Jq Đạo hàm ma trận Jacobian Jq theo thời gian t Jp Đạo hàm ma trận Jacobian Jp theo thời gian t Hj vr L Hành trình lớn robot thực theo phương j Vận tốc tương đối dụng cụ đối tượng gia công Tổng chiều dài gia công ứng với hành trình Lj vii luan an độ, rad mm mm độ, rad mm m rad, m rad, m m/s rad/s, m/s m/s2 rad/s2, m/s2 mm m/s mm Ci Thời gian gia cơng ứng với hành trình Lj Khoảng di chuyển bàn máy cần thực theo phương j Thời gian gia cơng Ma trận biểu diễn vị trí hướng khâu i (hệ tọa độ Cixciycizci) (i = 1,2,…,n) hệ tọa độ sở O0x0y0z0 Ma trận cosin hướng khâu i hệ tọa độ sở O0x0y0z0 Ma trận đạo hàm ma trận Ci CiT Ma trận chuyển vị ma trận Ci rCi Vector xác định vị trí khối tâm khâu i hệ tọa độ sở O0x0y0z0 Ma trận khối lượng suy rộng Khối lượng khâu i Vận tốc khối tâm khâu i hệ tọa độ O0x0y0z0 Vận tốc góc khâu thứ i robot hệ tọa độ O0x0y0z0 Tốn tử sóng vector vận tốc góc thứ i t_ Hj t A Ci Ci M(q) mi vCi i ωi JTi JRi ci ci (q, q) (k,l;j) G q gj U g i Q Fc Mc s mm s mm kg m/s rad/s rad/s Ma trận Jacobi vector tọa độ khối tâm khâu i theo vector tọa độ khớp Ma trận Jacobi vector vận tốc góc khâu i theo vector đạo hàm tọa độ khớp Ten xơ quán tính khâu i khối tâm Ci biểu diễn hệ tọa độ khối tâm khâu i Vector lực suy rộng lực quán tính Coriolis quán tính ly tâm tác dụng lên robot Ký hiệu Christofel số loại Vector lực suy rộng ứng với lực bảo tồn (lực có thế) Lực suy rộng lực bảo toàn ứng với tọa độ suy rộng qj Vector lực suy rộng lực dẫn động Thế hệ robot Gia tốc trọng trường Lực dẫn động ứng với khớp i khớp tịnh tiến ngẫu lực ứng với khớp quay Vector lực suy rộng lực không (lực cắt, lực ngồi khơng thế…) Vector lực cắt Vector mô men cắt viii luan an J m/s2 N N PL1.8 Sơ đồ thuật giải toán điều khiển động lực học ngược kết hợp vịng ngồi PD khơng gian thao tác Hình Sơ đồ thuật giải toán điều khiển động lực học ngược kết hợp vịng ngồi PD khơng gian thao tác luan an PL1.9 Sơ đồ thuật giải toán điều khiển mờ a Sơ đồ thuật giải toán điều khiển mờ Hình Sơ đồ thuật giải tốn điều khiển mờ 10 luan an PL2 Xác định thông số động học động lực hệ robot – bàn máy PL2.1 Các thông số động học hệ robot - bàn máy PL2.1.1 Các thông số động học đặc điểm kỹ thuật robot Robot thiết kế theo mẫu robot gia cơng khí hãng Asea Brown Boveri: Robot thiết kế theo mẫu robot IRB 6660-205/1.9 a Bộ thơng số kích thước hình học robot Hình 10 Thơng số kích thước hình học robot b Đặc tính kỹ thuật robot Bảng Thông số kỹ thuật robot Tầm với (m) 1,93 Khả Trọng tâm Số trục Độ lặp lại tải robot robot vị trí (kg) (mm) (mm) 205+15 375 0,01 Robot chịu thêm 500kg thân Bảng Thông số chuyển động Trục Phạm vi di chuyển làm việc Trục 1: -1800 đến + 1800 Trục 2: -420 đến + 850 Trục 3: -200 đến + 1200 Trục 2-3: 200 đến 1600 Trục 4: -3000 đến + 3000 Trục 5: -1200 đến + 1200 Trục 6: -3600 đến + 3600 Mô men xoắn lớn khớp 4, 5, 11 luan an Khối lượng robot (kg) 2383 Tốc độ làm việc tối đa trục 1300/s 1300/s 1300/s 1500/s 1200/s 1900/s Trục 4: Trục 5: Trục 6: 1177 Nm 1177 Nm 620 Nm Điện áp, tần số Công suất robot Bảng Thông số kỹ thuật điện cho robot 200600 V, 50/60 Hz 3,8 kW Bảng Chú thích kích thước hình 10 Kích thước Diễn giải kích thước (A) Kích thước lên đến 750 mm (B) Phạm vi làm việc tối đa (C) Phạm vi làm việc tối đa c Phạm vi làm việc robot thao tác cơng nghệ Hình 11 Phạm vi làm việc robot thao tác công nghệ Bảng Phạm vi làm việc robot Số vị trí A B C D E F G H K Vị trí (mm) X Z 1193 1794,5 575 1903,2 751,5 1162,7 632,2 351,1 793,3 -37,9 1932,4 914,8 1579,6 1833 1043,4 2083,2 997,3 -60,4 12 luan an Trục -42 -42 50 85 85 50 85 Góc (°) Trục -20 28 120 120 15 -20 -20 107,4 Robot thiết kế theo mẫu robot IRB 7600-500/2.55 a Bộ thơng số kích thước hình học robot Hình 12 Thơng số kích thước hình học robot b Đặc tính kỹ thuật robot Bảng Thông số kỹ thuật robot Khả Trọng tâm Số trục Độ lặp lại Khối lượng tải robot robot vị trí robot (kg) (mm) (mm) (kg) 2,55 500 360 0,01 4229 Robot chịu thêm 55kg cánh tay, 550kg khung robot trục Tầm với (m) Bảng Thông số chuyển động Bảng Trục Phạm vi di chuyển làm việc Trục 1: +1800 đến -1800 Trục 2: +850 đến - 600 Trục 3: +600 đến -1800 Trục 4: +3000 đến -3000 Trục 5: +1000 đến -1000 Trục 6: +3000 đến -3000 Mô men xoắn lớn khớp 4, 5, Trục 4: 2990 Nm Trục 5: 2990 Nm Trục 6: 1354 Nm Tốc độ làm việc tối đa trục 750/s 500/s 550/s 1000/s 1000/s 1600/s Bảng Thông số kỹ thuật điện cho robot Điện áp, tần số 200600 V, 50/60 Hz Công suất robot 3,4 kW c Phạm vi làm việc robot thao tác cơng nghệ 13 luan an Hình 13 Phạm vi làm việc robot thao tác cơng nghệ PL2.1.2 Các thơng số hình học bàn máy Hình 14 Các thơng số động học bàn máy phay thân bơm thủy lực Hình 15 Các thông số động học bàn máy phay cánh tuabin 14 luan an PL2.2 Các thông số động lực học hệ robot - bàn máy xác định qua phần mềm thiết kế Autodesk Inventor Professional Thông số động lực học robot thiết kế theo mẫu robot IRB 6660-205/1.9 a Khâu robot Hình 16 Các thông số động lực học khâu robot b Khâu robot Hình 17 Các thơng số động lực học khâu robot c Khâu robot Hình 18 Các thơng số động lực học khâu robot 15 luan an d Khâu robot Hình 19 Các thơng số động lực học khâu robot e Khâu robot Hình 20 Các thơng số động lực học khâu robot f Khâu robot Hình 21 Các thơng số động lực học khâu robot 16 luan an Thông số động lực học robot thiết kế theo mẫu robot IRB 7600-500/2.55 a Khâu robot: Hình 22 Các thông số động lực học khâu robot b Khâu robot: Hình 23 Các thơng số động lực học khâu robot c Khâu robot: Hình 24 Các thơng số động lực học khâu robot 17 luan an d Khâu robot: Hình 25 Các thơng số động lực học khâu robot e Khâu robot: Hình 26 Các thông số động lực học khâu robot Thông số động lực học bàn máy a Bàn máy B (Khâu hệ robot - bàn máy) Hình 27 Các thơng số động lực học bàn máy B 18 luan an b Bàn máy d (Khâu hệ robot - bàn máy) Hình 28 Các thông số động lực học bàn máy D PL3 Bản vẽ chi tiết gia cơng Hình 29 Thân bơm thủy lực 19 luan an Hình 30 Cánh tuabin Hình 31 Mẫu khn đúc 20 luan an Hình 32 Mẫu khn đúc Hình 33 Thân bơm thủy lực 21 luan an Hình 34 Mẫu đúc trượt Hình 35 Thân đế 22 luan an Hình 36 Mẫu đúc thân bơm thủy lực 23 luan an ... tốn ảnh hưởng lực cắt đến động lực học điều khiển robot gia công Nghiên cứu động học, động lực học điều khiển robot tác hợp (hệ robot bàn máy) gia cơng gồm có: nghiên cứu động học robot với thiết... định lực cắt gia cơng, làm tăng độ xác hiệu gia công robot 1.2 Cơ sở động học, động lực học tạo hình gia cơng phay 1.2.1 Cơ sở động học phay tạo hình bề mặt chi tiết Để gia cơng phay tạo hình. .. thiết kế điều khiển để điều khiển robot thực xác thao tác cơng nghệ Các điều khiển áp dụng cho robot điều khiển truyền thống điều khiển PD, PID, điều khiển động học ngược, điều khiển đại điều khiển
Ngày đăng: 01/02/2023, 08:51
Xem thêm:
