Microsoft Word KTRobot ThuyetMinh Nhom4 docx TRƯỜNG ĐẠI HỌC BÁCH KHOA HÀ NỘI ĐỒ ÁN MÔN HỌC BÀI TẬP DÀI ROBOT YASKAWA EP4000D Giảng viên hướng dẫn PGS TS Nguyễn Phạm Thục Anh Bộ môn Tự động hóa công ng[.]
TRƯỜNG ĐẠI HỌC BÁCH KHOA HÀ NỘI ĐỒ ÁN MÔN HỌC BÀI TẬP DÀI : ROBOT YASKAWA EP4000D Giảng viên hướng dẫn: Bộ môn: Viện: PGS TS Nguyễn Phạm Thục Anh Tự động hóa cơng nghiệp Điện Nhóm: Thành viên: Nguyễn Thế Thiết - 20181767 Quách Cao Hiển - 20181465 Nguyễn Công Minh - 20181650 Bùi Trung Nghĩa - 20181672 Nguyễn Đình Chí - 20181350 Đào Cơng Đồn - 20181393 Trần Minh Hoàng - 20181496 Đỗ Tuấn Quang - 20181710 Vũ Mạnh Hùng - 20181513 Nguyễn Sách Dương - 20181439 HÀ NỘI, 1/2022 Lời mở đầu Trong năm gần phát triển mãnh mẽ lĩnh vực khoa học, ứng dụng chúng ngành công nghiệp, điện tử nhằm nâng cao suất chất lượng sản phẩm Đặc biệt, robot công nghiệp phận cấu thành thiếu việc tạo hệ thống tự động sản xuất có tính linh hoạt cao thị trường hàng hóa cạnh tranh Gần nửa kỷ có mặt sản xuất, robot cơng nghiệp có lịch sử phát triển hấp dẫn Ngày robot công nghiệp dùng rộng rãi nhiều lĩnh vực sản xuất Điều xuất phát từ ưu điểm loại robot chọn lựa đúc kết lại qua năm ứng dụng nhiều nước Với đề tài “Tìm hiểu robot yaskawa ep4000d”, nhóm em tìm hiểu vấn đề cấu trúc cấu động học, động lực học, lập trình quỹ đạo, điều khiển chuyển động,… Các vấn đề đề cập chương : Chương I: Giới thiệu chung robot yaskawa ep4000d Chương II: Động học thuận vị trí robot Chương III: Ma trận Jacoby Chương IV: Động học đảo vị trí robot Chương IV: Thiết kế quỹ đạo chuyển động khớp Chương IV: Mơ hình động lực học đối tượng toolbox simscape/matlab Qua việc thiết kế đồ án mơn học, giúp nhóm em hiểu rõ gỡ mắc q trình học mơn Kỹ thuật Robot Hiểu ứng dụng thực tế robot công nghiệp Tuy nhiên nội dung mẻ, nguồn tài liệu ỏi với tầm hiểu biết cịn hạn chế nên khơng tránh khỏi sai sót Em xin chân thành cảm ơn Nguyễn Phạm Thục Anh giảng dạy giúp đỡ chúng em hồn thành đồ án mơn học MỤC LỤC CHƯƠNG GIỚI THIỆU CHUNG VỀ ROBOT YASKAWA EP4000D 1.1 Giới thiệu Robot Yaskawa ep4000d 1.2 Ứng dụng Robot công nghiệp 1.3 Kết cấu khí, thông số kĩ thuật 1.4 1.3.1 Kết cấu khí 1.3.2 Thông số kĩ thuật 1.3.3 Bộ điều khiển Robot .9 Hình ảnh hoạt động 10 CHƯƠNG ĐỘNG HỌC THUẬN VỊ TRÍ ROBOT 11 2.1 Tính tốn động học thuận 11 2.2 Xây dựng phần mềm giao diện động học thuận vị trí 13 CHƯƠNG MA TRẬN JACOBY 15 3.1 Tính tốn ma trận Jacoby .15 3.2 Các bước tính tốn ma trận Jacoby sử dụng thuật toán ma trận JH .15 3.3 Chương trình tính tốn Matlab .17 3.4 Xây dựng phần mềm giao diện tính tốn Jacoby 18 CHƯƠNG ĐỘNG HỌC ĐẢO VỊ TRÍ ROBOT 19 4.1 Cơ sở lý thuyết .19 4.2 Tính động học đảo .19 4.3 Xây dựng giao diện nhập xuất liệu hiển thị kết 20 CHƯƠNG 5.1 THIẾT KẾ QUỸ ĐẠO CHUYỂN ĐỘNG CÁC KHỚP 21 Các toán thiết kế quỹ đạo .21 5.1.1 Chuyển động PTP (Point to Point) .21 5.1.2 Chuyển động thông qua số điểm trung gian 21 5.1.3 Chuyển động có ràng buộc tốc độ gia tốc 22 5.2 Thiết kế quỹ đạo chuyển động PTP .22 5.3 Tính tốn thiết kế quỹ đạo chuyển động 22 CHƯƠNG XÂY DỰNG MƠ HÌNH ĐỘNG LỰC HỌC CHO ĐỐI TƯỢNG TRÊN TOOLBOX SIMSCAPE/MATLAB 25 6.1 Thiết kế robot Solid Work 25 6.2 Mơ hình đối tượng Matlab 27 KẾT LUẬN .29 TÀI LIỆU THAM KHẢO .30 PHỤ LỤC .31 Chi tiết xây dựng giao diện động học thuận 31 Chi tiết xây dựng giao diện ma trận Jacoby 34 Chi tiết xây dựng động học nghịch 37 Chi tiết xây dựng quỹ đạo bậc 38 Chi tiết xây dựng mơ hình đối tượng Matlab 39 Nhiệm vụ thành viên nhóm 44 DANH MỤC HÌNH VẼ Hình 1.1 Robot Yaskawa EP4000d Hình 1.2 Robot nhìn từ phía trước Hình 1.3 Robot nhìn từ xuống .7 Hình 1.4 Mặt đáy robot .7 Hình 1.5 Mặt cắt cấu cuối Hình 1.6 Kích thước vùng làm việc robot Hình 1.7 Robot làm việc cơng nghiệp 10 Hình 1.8 Hình ảnh robot gắp sản phẩm 10 Hình 2.1 Hệ trục tọa độ Robot 11 Hình 2.2 Giao diện menu 13 Hình 2.3 Giao diện động học thuận 14 Hình 3.1 Xác định ma trận Tin 15 Hình 3.2 Giao diện Jacoby 18 Hình 4.1 Giao diện động học đảo 20 Hình 5.1 Chuyển động PTP 21 Hình 5.2 Chuyển động thông qua số điểm trung gian .21 Hình 5.3 Chuyển động có ràng buộc tốc độ gia tốc 22 Hình 5.4 Đồ thị khớp 24 Hình 6.1 Phần chân đế robot 25 Hình 6.2 Phần nối thứ 25 Hình 6.3 Phần nối thứ hai .26 Hình 6.4 Phần nối thứ ba 26 Hình 6.5 Cơ cấu tác động .27 Hình 6.6 Tổng hợp mơ hình robot 27 Hình 6.7.Mơ hình điều khiển 28 DANH MỤC BẢNG BIỂU Bảng 1.1 Thông số kỹ thuật Robot Bảng 1.2 Thông số điều khiển .9 Bảng 2.1 Bảng thông số Denavit-Hartenberg 11 Bảng 0.1 Nhiệm vụ thành viên .44 CHƯƠNG GIỚI THIỆU CHUNG VỀ ROBOT YASKAWA EP4000D 1.1 Giới thiệu Robot Yaskawa ep4000d Robot EP4000D hãng YASKAWA Nhật Bản thiết kế chế tạo Hãng thành lập năm 1915 với lịch sử 100 năm, tập đoàn hàng đầu giới sản xuất cung cấp sản phẩm lĩnh vực robot công nghiệp, biến tần, truyền động điện Các robot EP4000D có trọng tải 200 kg, chiều ngang ngang 3,505 mm tầm với thẳng đứng 2,629 mm Thiết kế gọn nhẹ robot cho phép làm việc không gian chật hẹp cách kinh hoạt Đây loại robot có sáu trục quay vận hành khí nén kết hợp với động điện, giúp robot vận hành cách linh hoạt, di truyển dễ dàng dến vị trí đảm bảo độ xác robot cơng việc Hình 1.1 Robot Yaskawa EP4000d 1.2 Ứng dụng Robot công nghiệp Robot EP4000D phát triển để ứng dụng vào dây truyền sản xuất công nghiệp với phù hợp với nhiều cơng việc khác như: • • • • • Robot gắp (Handling) Robot nâng bốc, đóng gói ( Picking/packing, palletizing) Robot hàn, hàn điểm ( Arc handling, spot welding) Robot sơn ( Painting) Robot lắp ráp ( Assembly/distributing) Do việc sử dụng sản phẩm robot EP4000D Yaskawa đảm bảo tính tương thích, độ quán chất lượng dịch vụ cao việc tự động hóa máy móc, dây chuyền sản xuất Yaskawa cung cấp tát loại robot để giải toán đáp ứng yêu cầu khác khách hàng 1.3 Kết cấu khí, thơng số kĩ thuật 1.3.1 Kết cấu khí Hình 1.2 Robot nhìn từ phía trước Hình 1.3 Robot nhìn từ xuống Hình 1.4 Mặt đáy robot Hình 1.5 Mặt cắt cấu cuối Hình 1.6 Kích thước vùng làm việc robot Hình ảnh bên cho ta thấy kích thước robot, vùng làm việc robot vùng có màu xanh 1.3.2 Thơng số kĩ thuật Bảng 1.1 Thơng số kỹ thuật Robot THƠNG SỐ KỸ THUẬT CỦA ROBOT Cấu trúc Trục điều khiển Tải trọng Tầm dọc Tầm ngang Độ lặp lại Phạm vi chuyển động tối đa Trục S Trục L Trục U Trục R Trục B Trục T EP4000D Standard Press Robot Kiểu cánh tay nối dọc 200 kg (441 lbs.) 2,614 mm (103ꞌꞌ) 3,505 mm(138ꞌꞌ) ±0.5 mm(0.02ꞌꞌ) ±150o +25o/-122o +53o/-70o ±360o ±120o ±360o Trục S Trục L Trục U Trục R Trục B Trục T Tốc độ tối đa Khối lượng Phanh Điện tiêu thụ Momen cho phép Trục R Trục B Trục T Trục R Trục B Trục T* Lực quán tính cho phép I/O Lines Air Lines *Đáng giá trục T song song với sàn 90o/s 90o/s 90o/s 80o/s 80o/s 160o/s 3,100 kg Tất trục 22 kVA 1,274 N • m 2,156 N • m 0N•m 84.5 kg • m2 330 kg • m2 80 kg • m2 34 wires (0.5 mm2) – 3/8ꞌꞌ air lines 1.3.3 Bộ điều khiển Robot Robot dùng diều khiển DX100, giúp người vận hành dễ dàng lập trình điều khiển robot, dễ dàng kết nối robot với hệ thống dây chuyền sản xuất Dưới thông số kĩ thuật điều khiển Bảng 1.2 Thông số điều khiển THƠNG SỐ BỘ ĐIỀU KHIỂN DX100** Kích thước (mm) 1,200 (w) x 1,000 (h) x 650 (d) (47.2ꞌꞌ x 39.4ꞌꞌ x 25.6ꞌꞌ) Khối lượng Hệ thống làm mát Nhiệt độ môi trường xung quanh Độ ẩm tương đối Yêu cầu điện Tối đa 250 kg (551.3 lbs.) Làm mát gián tiếp Trong trình hoạt động: 0o đến 45o C (32o đến 113o F) Trong trình vận chuyển lưu trữ: -10o đến 60o C ( 14o đến 140o F) Tối đa 90% không ngưng tụ pha 240/480/575 VAC mức 50/60 Hz Digital I/O NPN - Tiêu chuẩn PNP - Tuỳ chọn I/O tiêu chuẩn: 40 đầu vào/40 đầu bao gồm 16 đầu vào/16 đầu hệ thống 24 đầu vào/24 đầu người dùng 32 đầu Transistor, đầu Relay Tối đa I/O (tuỳ chọn): 2,048 đầu vào/2,048 đầu Phản hồi vị trí Bộ nhớ chương trình Bằng mã hoá tuyệt đối JOB: 200,000 bước, 10,000 lần truy cập Tiêu chuẩn CIO Ladder: 15,000 bước Mở rộng: 20,000 bước ... dụng nhiều nước Với đề tài “Tìm hiểu robot yaskawa ep4000d? ??, nhóm em tìm hiểu vấn đề cấu trúc cấu động học, động lực học, lập trình quỹ đạo, điều khiển chuyển động,… Các vấn đề đề cập chương : Chương... Nhiệm vụ thành viên .44 CHƯƠNG GIỚI THIỆU CHUNG VỀ ROBOT YASKAWA EP4000D 1.1 Giới thiệu Robot Yaskawa ep4000d Robot EP4000D hãng YASKAWA Nhật Bản thiết kế chế tạo Hãng thành lập năm 1915... IV: Mơ hình động lực học đối tượng toolbox simscape/matlab Qua việc thiết kế đồ án mơn học, giúp nhóm em hiểu rõ gỡ mắc q trình học mơn Kỹ thuật Robot Hiểu ứng dụng thực tế robot công nghiệp Tuy