Nghiên cứu luận điều khiển thích nghi dựa trên cơ sở mô hình và ứng dụng robot scada

BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐẠI HỌC BÁCH KHOA HÀ NỘI - VŨ DUY THUẬN NGHIÊN CỨU LUẬN ĐIỀU KHIỂN THÍCH NGHI DỰA TRÊN CƠ SỞ MƠ HÌNH VÀ ỨNG DỤNG ROBOT SCADA LUẬN VĂN THẠC SĨ KHOA HỌC CHUYÊN NGÀNH: TỰ ĐỘNG HÓA Hà Nội - 2008 BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐẠI HỌC BÁCH KHOA HÀ NỘI - VŨ DUY THUẬN NGHIÊN CỨU LUẬN ĐIỀU KHIỂN THÍCH NGHI DỰA TRÊN CƠ SỞ MƠ HÌNH VÀ ỨNG DỤNG ROBOT SCADA LUẬN VĂN THẠC SĨ KHOA HỌC CHUYÊN NGÀNH: TỰ ĐỘNG HÓA NGƯỜI HƯỚNG DẪN KHOA HỌC: TS NGUYỄN PHẠM THỤC ANH Hà Nội - 2008 MỤC LỤC Chương TỔNG QUAN CÁC HỆ THỐNG ROBOT 1.1 Giới thiệu chung 1.1.1 Cấu tạo Robot 1.1.2 Các chuyển động Robot 1.1.3 Các cấu hình Robot 1.1.4 Hệ thống truyền động 1.1.5 Hệ thống cảm biến 1.2 Phân loại Robot cơng nghiệp 10 1.2.1 Phân loại theo dạng hình học không gian làm việc 10 1.2.2 Phân loại theo phương pháp điều khiển 11 1.2.3 Phân loại theo số bậc tự 11 1.2.4 Phân loại theo hệ thống truyền động 12 1.3 Ứng dụng Robot 12 1.3.1 Ưu điểm Robot 12 1.3.2 Các xu ứng dụng Robot 13 1.4 Tổng quan phương pháp điều khiển tự động cho Robot 13 Chương PHƯƠNG TRÌNH ĐỘNG LỰC HỌC ROBOT SCARA 15 2.1 ROBOT SCARA 15 2.2 Bài tốn động học vị trí Robot 16 2.3 Xây dựng động học vị trí Robot SCARA 17 2.4 Phương trình động học ngược robot SCARA 20 2.5 Động lực học robot SCARA 23 2.5.1 Hàm Lagrange vấn đề động lực học 24 2.5.2 Phương trình động lực học Robot 25 Chương LÝ THUYẾT ĐIỀU KHIỂN ROBOT 34 3.1 Khái niệm chung hệ thống điều khiển tự động 34 3.1.1 Điều khiển khớp độc lập 35 3.1.2 Hàm truyền chuyển động khớp động 35 3.1.3 Lý thuyết điều khiển ổn định Lyapunov 37 3.2 Phương pháp điều khiển cổ điển 41 3.3 Phương pháp điều khiển đại 42 3.3.1 Điều khiển logic mờ 42 3.3.2 Điều khiển trượt 43 3.3.3 Điều khiển thích nghi 44 3.4 Ứng dụng vào robot SCARA 48 3.4.1 Điều khiển theo luật PD bù trọng lực 48 3.4.2 Luật điều khiển Lee-Slotine 49 3.4.3 Luật điều khiển thích nghi dựa sở mơ hình 52 Chương MƠ PHỎNG TRÊN MATLAB SIMULINK 54 4.1 Thông số hệ thống 54 4.2 Kết mô Matlab-Simulink 55 4.2.1 Luật điều khiển PD bù trọng trường 55 4.2.2 Luật điều khiển Lee-Slotine 58 4.2.3 Luật điều khiển thích nghi dựa sở mơ hình 60 Kết luận 62 Các tài liệu tham khảo TÓM TẮT Luận văn nghiên cứu lý thuyết điều khiển thích nghi sở mơ hình ứng dụng vào Robot SCARA, kiểm nghiệm tính đắn áp dụng vào robot, đưa cơng thức tính động học thuận nghịch, động lực học, tổng hợp hệ truyền động Thiết kế điều khiển áp dụng tiêu chuẩn Lyapunov Đánh giá chất lượng tĩnh động mơ hình hóa, so sánh phương pháp điều khiển để rút kết luận cho phương pháp -1- Chương TỔNG QUAN CÁC HỆ THỐNG ROBOT 1.1 Giới thiệu chung Nhu cầu nâng cao chất lượng sản phẩm ngày đòi hỏi ứng dụng rộng rãi phương tiện tự động hóa sản xuất Xu hướng tạo dây chuyền thiết bị tự động có tính linh hoạt cao hình thành Thuật ngữ “Robot” xuất năm 1922 tác phẩm “Rossum’s Universal Robot” Karel Capek Hơn 20 năm sau, Hoa Kỳ xuất tay máy chép hình điều khiển từ xa phịng thí nghiệm vật liệu phóng xạ Vào năm 50 xuất loại tay máy chép hình thủy lực điện từ tay máy Minotaur I Handyman General Electric… Robot công nghiệp đưa vào ứng dụng vào năm 1961 nhà máy ô tô General Motor Trenton, New Jersey, Hoa Kỳ Năm 1967, Nhật Bản nhập robot công nghiệp từ công ty AMF Hoa Kỳ đến năm 1990 có 40 cơng ty Nhật Bản đưa loại robot tiếng Những năm 70, việc nghiên cứu nâng cao tính robot ý nhiều đến lắp đặt thêm loại cảm biến ngoại tín hiệu để nhận biết mơi trường làm việc Tại trường đại học tổng hợp Stanford, người ta tạo loại robot lắp ráp tự động điều khiển máy vi tính sở xử lý thông tin từ cảm biến thị giác Từ năm 80 90, áp dụng rộng rãi tiến khoa học kỹ thuật, vi xử lý công nghệ thông tin, số lượng robot cơng nghiệp tăng lên, giá thành giảm tính vượt trội Nhờ vậy, robot cơng nghiệp có vị trí quan trọng dây chuyền tự động sản xuất đại -2- Robot công nghiệp định nghĩa cấu máy lập trình được, có khả làm việc cách tự động không cần trợ giúp người tay máy hợp tác với Ứng dụng Robot: nhằm nâng cao suất dây chuyền công nghệ, giảm giá thành, nâng cao chất lượng khả cạnh tranh sản phẩm đồng thời cải thiện điều kiện lao động Thông thường, robot công nghiệp dùng lĩnh vực: đúc, gia công áp lực, hàn nhiệt luyện, gia ông lắp rắp… 1.1.1 Cấu tạo Robot Robot có cấu tạo mơ theo đặc điểm cấu tạo cánh tay người Cũng hiểu robot tập hợp phận cấu khí thiết kế để hình thành khối có chuyển động tương đối nhau, gọi khâu động Trong phần liên kết khâu động gọi khớp động hay gọi phần tử thực thực chuyển động để vận hành tay máy động điện , xylanh dầu ép, xylanh khí nén, … Phần quan trọng khác tay máy phận hay khâu tác động cuối để thao tác đối tượng làm việc – thường tay gắp đầu công cụ chuyên dùng Tay máy hay gọi cánh tay khí robot cơng nghiệp thơng thường chuỗi động hở tạo thành từ nhiều khâu kết nối với nhờ khớp động Khâu cuối tay máy thường có dạng tay gắp gấn dụng cụ công tác Mỗi khâu động tay máy có nguồn dẫn đơng riêng, lượng chuyển động truyền đến cho chúng điều khiển sở tín hiệu nhận từ phận phản hồi cảm biến nhằm thông báo trạng thái hoạt động khâu chấp hành, vấn đề đặc biệt quan tâm vị trí vận tốc dịch chuyển khâu cuối – khâu thể kết tổng hợp chuyển đông khâu thành phần -3- Các Robot công nghiệp ngày thường đặt đế gắ theo sở mơ hình có ưu điểm so với luật điều khiển PD bù trọng trường luật điều khiển thích nghi LeeSlotine - 68 - Luật điều khiển thích nghi theo sở mơ hình đảm bảo yêu cầu độ xác, đồng thời đảm bảo đáp ứng mặt thời gian nên việc chọn luật điều khiển phù hợp với tay máy robot SCARA KẾT LUẬN Sau thời gian nghiên cứu, tính tốn mơ robot SCARA Các mơ máy tính cho thấy điều khiển thiết kế đáp ứng yêu cầu Bộ điều khiển thích nghi sở mơ hình bám theo tốt tín hiệu đặt hệ thống hoạt động ổn định Do việc sử dụng điều khiển thích nghi sở mơ hình để hạn chế dao động Robot cần thiết Để đánh giá xác hơn, điều khiển thích nghi cần kiểm chứng mơ hình thực nghiệm robot SCARA Đây hướng để nghiên cứu sâu phương pháp điều khiển robot lý thuyết thực nghiệm ...BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐẠI HỌC BÁCH KHOA HÀ NỘI - VŨ DUY THUẬN NGHI? ?N CỨU LUẬN ĐIỀU KHIỂN THÍCH NGHI DỰA TRÊN CƠ SỞ MƠ HÌNH VÀ ỨNG DỤNG ROBOT SCADA LUẬN VĂN THẠC... Các tài liệu tham khảo TÓM TẮT Luận văn nghi? ?n cứu lý thuyết điều khiển thích nghi sở mơ hình ứng dụng vào Robot SCARA, kiểm nghi? ??m tính đắn áp dụng vào robot, đưa cơng thức tính động học thuận... 3.4 Ứng dụng vào robot SCARA 48 3.4.1 Điều khiển theo luật PD bù trọng lực 48 3.4.2 Luật điều khiển Lee-Slotine 49 3.4.3 Luật điều khiển thích nghi dựa sở mơ hình 52 Chương MƠ PHỎNG TRÊN MATLAB