Luận văn thạc sĩ kỹ thuật điều khiển tay máy 3 bậc tự do theo thuật toán pid cải tiến

BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐẠI HỌC KỸ THUẬT CÔNG NGHỆ TP HCM - PHẠM CÔNG VŨ Đề tài: ĐIỀU KHIỂN TAY MÁY BẬC TỰ DO THEO THUẬT TOÁN PID CẢI TIẾN LUẬN VĂN THẠC SĨ Chuyên ngành : Kỹ thuật điện Mã số ngành: 60520202 TP HỒ CHÍ MINH, tháng … năm …… BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐẠI HỌC KỸ THUẬT CÔNG NGHỆ TP HCM - PHẠM CÔNG VŨ Đề tài: ĐIỀU KHIỂN TAY MÁY BẬC TỰ DO THEO THUẬT TOÁN PID CẢI TIẾN LUẬN VĂN THẠC SĨ Chuyên ngành : Kỹ thuật điện Mã số ngành: 60520202 HƯỚNG DẪN KHOA HỌC: TS Đồng Văn Hướng TP HỒ CHÍ MINH, tháng … năm …… CƠNG TRÌNH ĐƯỢC HỒN THÀNH TẠI TRƯỜNG ĐẠI HỌC KỸ THUẬT CƠNG NGHỆ TP HCM Cán hướng dẫn khoa học : TS Đồng Văn Hướng Luận văn Thạc sĩ bảo vệ Trường Đại học Kỹ thuật Công nghệ TP HCM ngày … tháng … năm … Thành phần Hội đồng đánh giá Luận văn Thạc sĩ gồm: (Ghi rõ họ, tên, học hàm, học vị Hội đồng chấm bảo vệ Luận văn Thạc sĩ) …………………………………………………………… …………………………………………………………… …………………………………………………………… …………………………………………………………… …………………………………………………………… Xác nhận Chủ tịch Hội đồng đánh giá Luận sau Luận văn sửa chữa (nếu có) Chủ tịch Hội đồng đánh giá LV TRƯỜNG ĐH KỸ THUẬT CÔNG NGHỆ TP HCM PHÒNG QLKH - ĐTSĐH CỘNG HÒA XÃ HỘI CHỦ NGHĨA VIỆT NAM Độc lập - Tự - Hạnh phúc TP HCM, ngày … tháng… năm 20 … NHIỆM VỤ LUẬN VĂN THẠC SĨ Họ tên học viên: Phạm Cơng Vũ Giới tính: Nam Ngày, tháng, năm sinh: 26/03/1977 Nơi sinh:Biên Hòa Chuyên ngành: Kỹ thuật điện MSHV:1181031075 I- TÊN ĐỀ TÀI: ĐIỀU KHIỂN TAY MÁY BẬC TỰ DO THEO THUẬT TOÁN PID CẢI TIẾN II- NHIỆM VỤ VÀ NỘI DUNG: - Tìm hiểu tổng quan phương pháp điều khiển robot - Lập phương trình động học ngược - Lập trình điều khiển tay máy scara theo thuật tốn PID LabVIEW - Mơ 3D LabVIEW - Thiết kế thi công robot III- NGÀY GIAO NHIỆM VỤ: 21/06/2012 IV- NGÀY HOÀN THÀNH NHIỆM VỤ: 12/2012 V- CÁN BỘ HƯỚNG DẪN: TS Đồng Văn Hướng CÁN BỘ HƯỚNG DẪN Đồng Văn Hướng KHOA QUẢN LÝ CHUYÊN NGÀNH MỤC LỤC CHƢƠNG GIỚI THIỆU LUẬN VĂN 1.1 Đặt vấn đề - 1.2 Mục tiêu đề tài 1.3 Nội dung nghiên cứu - 1.4 Phương pháp thực - 1.5 Điểm luận văn - 1.6 Giá trị thực tiễn luận văn - 1.7 Bố cục luận văn CHƢƠNG CƠ SỞ LÝ THUYẾT - 2.1 TỔNG QUAN VỀ ROBOT CÔNG NGHIỆP - 2.1.1 Lịch sử phát triển 2.1.2 Phân loại Robot công nghiệp - 2.1.3 Ứng dụng robot 2.1.4 Tổng quan tình hình nghiên cứu Robot ngồi nước CHƢƠNG CÁC PHƢƠNG PHÁP ĐIỀU KHIỂN ROBOT - 3.1 Phương pháp điều khiển động lực học ngược CHƢƠNG ĐỘNG HỌC TAY MÁY VÀ ĐIỀU KHIỂN TAY MÁY 4.1 Giải tốn phép biến đổi giải tích 4.2 Lưu đồ thuật toán điều khiển Robot 11 4.3 Ngơn ngữ lập trình LabVIEW - 13 4.3.1 Giới thiệu 13 4.3.2 Lập trình LabVIEW - 14 4.3.3 Mô 3D LabVIEW - 15 CHƢƠNG THIẾT KẾ ROBOT VÀ LẬP TRÌNH CHO ROBOT THEO PID CẢI TIẾN 5.1 Thuật toán điều khiển PID cải tiến cho robot 16 5.2 Thiết kế phần khí tay máy robot - 18 5.3 Thiết kế phần điện - 19 CHƢƠNG KẾT LUẬN VÀ HƢỚNG PHÁT TRIỂN 20 TÀI LIỆU THAM KHẢO CHƢƠNG GIỚI THIỆU LUẬN VĂN 1.1 ĐẶT VẤN ĐỀ: Trong q trình cơng nghiệp hóa đại hóa nước ta, việc nghiên cứu thiết kế chế tạo robot công nghiệp để ứng dụng vào sản xuất có ý nghĩa quan trọng, đặc biệt giai đoạn hội nhập kinh tế Việc tự động hóa q trình sản xuất với có mặt robot làm tăng khả mềm dẻo hệ thống sản xuất, tăng chất lượng sản phẩm đặc biệt làm giảm giá thành sản phẩm để tăng tính cạnh tranh Ngồi ra, robot cơng nghiệp cịn có tính quan trọng khác làm việc môi trường khắc nghiệt mà người tham gia vào như: mơi trường nhiều khói bụi, mơi trường độc hại hóa chất, mơi trường nhiệt độ cao… Hiện nay, giới có nhiều nghiên cứu ứng dụng robot vào trình sản xuất robot hàn nhà máy sản xuất ô tô, robot lắp máy, robot đào đường hầm, robot cấp phôi máy gia công chi tiết khí, robot quay camera sân vận động, robot tự động nâng hàng… Tuy nhiên Việt Nam việc nghiên cứu chế tạo robot giai đoạn bắt đầu, chủ yếu dừng lại mức độ chế thử, số chuyển giao vào trình sản xuất Các robot chưa có tính thích nghi ứng với mơi trường thay đổi mà chủ yếu hoạt động theo chương trình định trước Việc nghiên cứu điều khiển để nâng cao độ xác robot cịn nhà khoa học nước quan tâm nhiều Đối với hệ điều khiển robot, việc lựa chọn sử dụng biến đổi, loại động điện, thiết bị đo lường, cảm biến, điều khiển đặc biệt phương pháp điều khiển có ảnh hưởng lớn đến chất lượng điều khiển bám xác quỹ đạo hệ Các cơng trình nghiên cứu hệ thống điều khiển robot tập trung chủ yếu theo hai hướng sử dụng mơ hình có tính đặc tính phi tuyến ước lượng để đơn giản việc phân tích thiết kế đề thuật toán điều khiển nhằm nâng cao chất lượng đáp ứng robot Các phương pháp điều khiển thông thường sử dụng biện pháp phân tích gián tiếp thơng qua mơ hình làm việc hệ, song lại không cung cấp thông tin cách đầy đủ toàn hệ thống Cịn phương pháp phân tích trực tiếp ngoại trừ tiêu chuẩn Lyapunov cho việc phân tích ổn định phương pháp mặt phẳng pha giới hạn hệ phi tuyến có hai biến trạng thái, chưa có phương pháp cụ thể khác Phương pháp điều khiển phân ly phi tuyến có nhược điểm hệ thống điều khiển có tính phi tuyến cao, độ phức tạp điều khiển lớn, khó có khả thực thực tế 3 Phương pháp điều khiển thích nghi theo mơ hình chuẩn thực đơn giản cho mơ hình tuyến tính với giả thuyết bỏ qua liên hệ động lực học chuyển động thành phần hệ Ngoài ra, ổn định hệ thống kín vấn đề khó giải với tính phi tuyến cao mơ hình chuẩn Phương pháp điều khiển thích nghi theo sai lệch có luật điều khiển thích nghi đơn giản hóa cách áp dụng phương pháp điều khiển thích nghi suy giảm phân ly, phương pháp ln tồn sai lệch quỹ đạo trình điều khiển thực không phù hợp với yêu cầu hệ thống điều khiển xác quỹ đạo Phương pháp điều khiển robot cánh tay bậc tự theo thuật tốn PID cải tiến có đầy đủ yếu tố cho việc thiết kế điều khiển có tính theo yêu cầu đề Tính ổn định điều khiển PID cải tiến rộng bền vững tác động bên 1.2 MỤC TIÊU CỦA ĐỀ TÀI: Để thực đề tài cần thực công việc: - Thiết kế lập trình cho robot theo thuật tốn PID cải tiến - Mô 3D LabVIEW 1.3 NỘI DUNG NGHIÊN CỨU - Để đạt mục tiêu cần giải vấn đề sau: + Lập phương trình động học ngược + Các phép tốn LabVIEW + Mô 3D LabVIEW + Thiết kế phần - điện robot + Thuật toán điều khiển PID cải tiến cho robot 1.4 PHƢƠNG PHÁP NGHIÊN CỨU: - Trao đổi với giáo viên hướng dẫn nhiệm vụ giao vấn đề có liên quan - Tìm hiểu lý thuyết điều khiển cánh tay bậc tự thuật toán PID làm sở cho việc thiết kế điều khiển cho robot - Tham khảo sách, báo mạng robot - Thiết kế phần - điện robot - Nghiên cứu Thuật toán điều khiển PID cải tiến cho robot 1.5 ĐIỂM MỚI CỦA LUẬN VĂN: Nghiên cứu nhiệm vụ yêu cầu ổn định, tin cậy hệ robot tay máy để phù hợp với tình hình kinh tế phát triển Tìm hiểu cấu trúc hoạt động robot theo thuật toán PID cải tiến mô 3D LabVIEW 1.6 GIÁ TRI THỰC TIỄN CỦA LUẬN VĂN: Hệ tay máy bậc tự Scara sử dụng nhiều công nghiệp giới Đề tài “ Điều khiển tay máy bậc tự theo thuật toán PID cải tiến” góp phần vào việc phát triển nghiên cứu robot Việt Nam, nhằm mục đích phục vụ cho công tác đào tạo nghiên cứu trường đại học, cao đẳng trung cấp chuyên nghiệp 1.7 BỐ CỤC LUẬN VĂN: Luận văn gồm chương:  Chương 1: Giới thiệu luận văn  Chương 2: Cơ sở lý thuyết  Chương 3: Các phương pháp điều khiển robot  Chương 4: Động học tay máy điều khiển tay máy  Chương 5: Thiết kế robot lập trình robot theo PID cải tiến  Chương 6: Kết thực nghiệm kết luận Phụ lục tài liệu tham khảo CHƢƠNG CƠ SỞ LÝ THUYẾT 2.1 TỔNG QUAN VỀ ROBOT CÔNG NGHIỆP 2.1.1 Lịch sử phát triển Thuật ngữ “Robot” lần xuất năm 1922 tác phẩm “Rosum’s Universal Robot “ Karal Capek Theo tiếng Séc Robot người làm tạp dịch Trong tác phẩm nhân vật Rosum trai ông tạo máy gần giống người để hầu hạ người Hơn 20 năm sau, ước mơ viễn tưởng Karel Capek bắt đầu thực Ngay sau chiến tranh giới lần thứ 2, Mỹ xuất tay máy chép hình điều khiển từ xa, phịng thí nghiệm phóng xạ Năm 1959, Devol Engelber chế tạo Robot công nghiệp công ty Unimation Năm 1967 Nhật Bản nhập Robot công nghiệp từ công ty AMF Mỹ Đến năm 1990 có 40 cơng ty Nhật, có cơng ty khổng lồ Hitachi, Mitsubishi Honda đưa thị trường nhiều loại Robot tiếng Những robot thực chất nối kết khâu khí cấu điều khiển từ xa với khả lập trình máy cơng cụ điều khiển số Từ năm 70, việc nghiên cứu nâng cao tính robot ý nhiều đến lắp đặt thêm 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 vi tính sở xử lý thông tin từ cảm biến lực thị giác Vào thời gian công ty IBM chế tạo Robot có cảm biến xúc giác cảm biến lực điều khiển máy vi tính để lắp ráp máy in gồm 20 cụm chi tiết Những năm 90 áp dụng rộng rãi tiến khoa học vi xử lý công nghệ thông tin, số lượng Robot công nghiệp tăng nhanh, giá thành giảm rõ rệt, tính có nhiều bước tiến vượt bậc Nhờ Robot cơng nghiệp có vị trí quan trọng dây truyền sản xuất đại Ngày nay, chuyên ngành khoa học nghiên cứu Robot “Robotics” trở thành lĩnh vực rộng khoa học, bao gồm vấn đề cấu trúc cấu động học, động lực học, lập trình quỹ đạo, cảm biến tín hiệu, điều khiển chuyển động v.v… Có thể nói, Robot tổ hợp khả hoạt động linh hoạt cấu điều khiển từ xa với mức độ “tri thức” ngày phong phú hệ thống điều khiển theo chương trình số kỹ thuật chế tạo cảm biến, cơng nghệ lập trình phát triển trí khơn nhân tạo, hệ chun gia Trong năm sau này, việc nâng cao tính hoạt động robot khơng ngừng phát triển Các robot trang bị thêm loại cảm biến khác để nhận biết môi trường chung quanh, với thành tựu to lớn lĩnh vực Tin học - Điện tử tạo hệ robot với nhiều tính đăc biệt, Số lượng robot ngày gia tăng, giá thành ngày giảm Nhờ vậy, robot cơng nghiệp có vị trí quan trọng dây chuyền sản xuất đại 2.1.2 Phân loại Robot công nghiệp 2.1.2.1 Theo chủng loại, mức độ điều khiển, nhận biết thông tin tay máy-người máy sản xuất giới phân loại IR thành hệ sau: Thế hệ 1: Thế hệ có kiểu điều khiển theo chu kỳ dạng chương trình cứng khơng có khả nhận biết thơng tin Thế hệ 2: Thế hệ có điều khiển theo chu kỳ dạng chương trình mềm bước đầu có khả nhận biết thơng tin Thế hệ 3: Thế hệ có kiều điều khiển dạng tinh khơn, có khả nhận biết thơng tin bước đầu có số chức lý trí người 2.1.2.2 Phân loại tay máy theo cấu trúc sơ đồ động: Thông thường cấu trúc chấp hành tay máy cơng nghiệp mơ hình hóa dạng chuỗi động với khâu khớp nguyên lý máy với giả thuyết sau: - Chỉ sử dụng khớp động loại ( khớp quay, khớp tịnh tiến, khớp vít) - Trục quay hướng tịnh tiến khớp song song hay vng góc với - Chuỗi động chuỗi động hở đơn giản Tuy nhiên thực tế, tay máy chun dùng ta chun mơn hố đặc biệt đảm bảo giá thành giá đầu tư vào tay máy thấp, người ta không thiết lúc phải chế tạo tay máy có đủ số ba khớp động cho cấu trúc xác định vị trí 2.1.2.3 Phân loại theo kết cấu : Theo kết cấu tay máy người ta phân thành robot kiểu toạ độ Đề các, Kiểu toạ độ trụ, kiểu toạ độ cầu, kiểu toạ độ góc, robot kiểu SCARA 2.1.2.4 Phân loại theo hệ thống truyền động : Có dạng truyền động phổ biến : Hệ truyền động điện : Thường dùng động điện chiều (DC : Direct Current) động bước (step motor) Loại truyền động dễ điều khiển, kết cấu gọn 7 Hệ truyền động khí nén : có kết cấu gọn nhẹ không cần dẫn ngược lại phải gắn liền với trung tâm tạo khí nén Hệ làm việc với cơng suất trung bình nhỏ, xác, thường thích hợp với robot hoạt động theo chương trình định sẳn với thao tác đơn giản “nhấc lên - đặt xuống” 2.1.3 Ứng dụng ROBOT: Robot sử dụng rộng rãi nhiều ngành cơng nghiệp khác Có thể phân loại ứng dụng cong nghiệp robot làm lĩnh vực chính: Vận chuyển, bốc dỡ vật liệu, gia cơng, lắp ráp thăm dò ứng dụng khác 2.1.4 Tổng quan tình hình nghiên cứu Robot ngồi nước Ngày nay, tự động hóa ngành kỹ thuật cao phát triển mạnh mẽ ứng dụng rộng rãi nhiều lĩnh vực đời sống xã hội Đặc biệt dây chuyền sản xuất công nghiệp, tay máy người máy sử dụng rộng rãi nhằm thay sức lao dộng người, góp phần nâng cao suất, chất lượng, giãm giá thành sản phẩm Ở nước ta thập niên qua, tình hình ứng dụng robot có thay đổi lớn Nhiều doanh nghiệp phải nhập thiết bị robot dây chuyền sản xuất Do nhu cầu thực tế đặt vậy, đòi hỏi phải nghiên cứu đào tạo hệ thống robot để phát triển ngành nước ta Một số đề tài nghiên cứu khoa học nước ta từ trước như: - Đề tài 58A-03 với nội dung nghiên cứu ứng dụng robot kỹ thuật bảo hộ lao - Đề tài 52B.0301: “Ứng dụng tay máy – người máy công nghiệp” - Đề tài KC.03.02 “Nghiên cứu thiết kế chế tạo robot phục vụ sản xuất điều động kiện môi trường độc hại khơng an tồn” Trong năm 1980, robot cơng nghiệp có bước phát triển mạnh mẽ, yêu cầu cao tự động hóa linh hoạt kinh tế thám hiểm không gian công nghệ ô tô Vào năm 1990, nhiều công ty Bắc Mỹ, Châu Âu Nhật Bản sử dụng rộng rãi robot nhiều lĩnh vực công nghiệp 8 Chƣơng CÁC PHƢƠNG PHÁP ĐIỀU KHIỂN ROBOT 3.1 Phương pháp điều khiển động lực học ngược Nguyên lý phương pháp chọn luật điều khiển phù hợp để khử thành phần phi tuyến phương trình động lực học phân ly đặc tính động lực học khớp nối  (t )  H (q ).q (t )  h(q , q )  g (q ) (3 – ) Nếu ta biết tham số robot ta tính ma trận H, h, g từ có luật điều khiển  dk  H (q )U  h(q , q )  g (q ) (3 – ) cân  dk   với điều kiện H(q)  q  U q (vectơ điều khiển phụ ) Như động lực học hệ thống kín phân tích thành hệ phương trình vi phân tuyến tính hệ số q  U Với robot n khớp nối tương đương với n hệ độc lập Chọn U tín hiệu điều khiển phụ có cấu trúc PID Lúc đó: t  U = qd + KD (qd – q) + KP (qd – q) + KI (q d  q)dt (3–3) đó: dq , q biến khớp đặt biến khớp thực khớp qd , q tốc độ đặt tốc độ thực khớp qd - e qd qd q qd + Kp e + U e KDe +KI e(t )dt  Tính H(q)U +h (q,q) +g(q)  Robot Hình 3.1: Sơ đồ cấu trúc hệ điều khiển động lực học ngược Và phương trình sai số tương ứng là: ,, , ,, ,   KD   KP   KI (3 – ) q Các hệ số KD, KP, KI chọn theo điều kiện ổn định Lyapunov để sai số quỹ đạo chuyển động chuẩn quỹ đạo chuyển động thực hội tụ điểm không phụ thuộc vào điều kiện ban đầu Ưu điểm phương pháp khử tính phi tuyến ràng buộc phương trình động lực học Nhược điểm phải biết đầy đủ xác thơng số đặc tính động lực học robot, đồng thời phát sinh tính tốn phụ Thuật tốn tính tốn điều khiển U liên quan phép tính lượng giác nên phải thực số phép nhân ma trận vectơ ma trận phụ Thời gian tính tốn lớn yếu tố ảnh hưởng đến hạn chế phương pháp Chƣơng ĐỘNG HỌC TAY MÁY VÀ ĐIỀU KHIỂN TAY MÁY 4.1 Giải toán phép biến đổi giải tích Nội dung tốn phát biểu sau: “Cho trước số khâu, số khớp, loại khớp, kích thước di động khâu thành viên, cho trước vị trí hướng khâu tác động cuối hệ tọa độ Descarters Ta phải xác định vị trí khâu thành viên thong qua tọa độ suy rộng chúng cho khâu tác động cuối đạt vị trí hướng yêu cầu” Nếu so với tốn thuận có đáp số ngược lại tốn ngược có vơ số đáp số, lý mơ tả vị trí tương đối khâu thành viên ánh xạ theo chiều thuận mà khơng có chiều nghịch Để giải vấn đề nhằm chọn nghiệm tối ưu, người ta đưa ràng buộc động học bên vùng khơng gian hoạt động Hoặc đặt vấn đề phải tối ưu hóa hoạt động tay máy theo hàm mục tiêu cụ thể để chọn lời giải tối ưu Để giải toán ngược trước tiên ta đưa tốn mục tiêu giải tốn với ràng buộc Hình 4-1: Cánh tay máy bậc tự vị trí ban đầu Thiết lập thơng số ban đầu Chiều dài Link (d1-mm) Chiều dài Link (d2-mm) Giải toán động học ngược 110 95 10 Gọi M(X,Y) điểm cuối tay máy Hình 4-2: tốn động học ngược Ta có: Cos   ( X  Y  d12  d 22 ) /(  d1  d ) Sin    cos  22 K  d1  d  cos  K  d  sin  Suy : 1  a tan 2( X , Y )  a tan 2( K 1, K ) ( Rad )   a tan 2(cos  , sin  ) ( Rad ) 11 4.2 Lưu đồ thuật toán điều khiển robot 12 Hình 3-4: Lƣu đồ thuật tốn điều khiển robot 3.4 NGƠN NGỮ LẬP TRÌNH LabVIEW 3.4 13 4.3 Giới thiệu phần mềm LabVIEW  LabVIEW gì? LabVIEW công cụ phần mềm hàng đầu công nghiệp việc phát triển hệ thống thiết kế, điều khiển kiểm tra Kể từ đời năm 1986, kỹ sư nhà khoa học toàn giới tin cậy vào NI LabVIEW nhờ chất lượng ngày cao, hiệu sản xuất lớn Tên gọi LabVIEW? LabVIEW viết tắt : Laboratory Virtural Instrumentation Engineering Workbench (công cụ kĩ thuật- thiết bị ảo phịng thí nghiệm)  Lịch sử: LabVIEW thành lập vào năm: 1976 công ty National Instruments (NI) chủ yếu ứng dụng điều khiển, đo lường Năm 1986 LabVIEW cho đời phiên Labview 6.1 … Và phiên LabVIEW 2009 Hình 4-3: Giao diện phần mềm LabVIEW phiên 2009  LabVIEW làm gì? LabVIEW phần mềm lập trình Graphic (hay lập trình G) Labview dùng nhiều phịng thí nghiệm, lĩnh vực khoa học kỹ thuật như: tự động hóa, điều khiển, điện tử, điện tử, hàng khơng, hóa sinh, điện tử y sinh,… Hiện phiên 14 LabVIEW cho hệ điều hành Windows, Linux, hãng NI phát triển mô-đun LabVIEW cho máy hỗ trợ cá nhân (PDA) Các ứng dụng LabVIEW tóm tắt sau: - Thu thập tín hiệu từ thiết bị bên ngồi cảm biến nhiệt độ, hình ảnh từ webcam, vận tốc động cơ,… - Giao tiếp với thiết bị ngoại vi thông qua chuẩn giao tiếp: RS232, RS485, USB, PCI, Ethernet Để điều khiển thiết bị nơi người làm việc được, ví dụ : Một robot máy xúc điều khiển để làm việc đáy biển, nơi mà người khó thực tốt nhiệm vụ đặc biệt… - Mô xử lí tín hiệu thu nhận để phục vụ mục đích nghiên cứu hay mục đích hệ thống mà người lập trình mong muốn - Xây dựng giao diện người dùng cách nhanh chóng thẩm mỹ nhiều so với ngôn ngữ lập trình khác Visual Basic, Matlab,… - Cho phép thực thuật toán điều khiển PID, Logic mờ ( Fuzzy Logic), cách nhanh chóng thơng qua chức tích hợp sẵn LabVIEW - Cho phép kết hợp với nhiều ngơn ngữ lập trình truyền thống C, C++, Matlab … 4.4 Lập trình với LabVIEW Để làm việc với phần mềm LabVIEW ta thao tác cửa sổ Front Panel Block Diagram Hai cửa sổ xuất sau ta khởi động phần mềm LabVIEW Hình 4-4: Giao diện làm việc phần mềm LabVIEW, a- cửa sổ Front Panel, b- cửa sổ Block Diagram 15 Cửa sổ Front Panel hay gọi giao diện người dùng Của sổ dùng để khởi tạo Control (Input) Indicator (ouput) Nghĩa cửa sổ ta thiết lập thơng số đầu vào ứng dụng thấy kết khảo sát hay tính tốn ứng dụng Cửa sổ Block Diagram cửa sổ dùng để người lập trình khởi tạo, viết thuật tốn cho ứng dụng Nó bao gồm hàm tốn học (cộng, trừ, nhân, chia, đạo hàm, tích phân, ma trận…), hàm lặp (while loop), hàm tạo trễ… Nghĩa cửa sổ Block Diagram chứa thuật toán giải toán ứng dụng mà người lập trình khởi tạo, điều khiển hiển thị kết cửa sổ Front Panel Các hàm tính tốn có liên quan sổ Block Diagram nối với dây dẫn theo kiểu truyền tín hiệu Đây lợi điểm LabVIEW so với phần mềm khác tính trực quan dễ làm việc Để hình dung LabVIEW làm việc sao, tác giả đưa tốn nhỏ giải phần mềm 4.5 Mô 3D LabVIEW Với toolkit 3D Picture Control LabVIEW cho phép mô động học, động lực học hệ thống vật lý từ đơn giản đến phức tạp, cánh tay robot… Có thể nói LabVIEW ngơn ngữ lập trình-mơ mạnh mẽ Cịn nhiều toolkit khác mà giới hạn đề tài tác giả khơng thể trình bày hết Trong phần đề tài tác giả ứng dụng LabVIEW để giao tiếp với thiết bị phần cứng để điều khiển Robot cánh tay bậc tự Hình 4-5: Ứng dụng LabVIEW để mô cánh tay robot bậc tự Chƣơng 16 THIẾT KẾ ROBOT VÀ LẬP TRÌNH CHO ROBOT THEO PID CẢI TIẾN 5.1 Thuật toán điều khiển PID cải tiến cho robot Khâu tỉ lệ, tích phân, vi phân cộng lại với để tính tốn đầu điều khiển PID Định nghĩa u(t) đầu điều khiển, biểu thức cuối giải thuật PID là: Trong thơng số điều chỉnh là: Độ lợi tỉ lệ, KP Giá trị lớn đáp ứng nhanh sai số lớn, bù khâu tỉ lệ lớn Một giá trị độ lợi tỉ lệ lớn dẫn đến trình ổn định dao động Độ lợi tích phân, Ki Giá trị lớn kéo theo sai số ổn định bị khử nhanh Đổi lại độ vọt lố lớn: sai số âm tích phân suốt đáp ứng độ phải triệt tiêu tích phân sai số dương trước tiến tới trạng thái ổn định Độ lợi vi phân Kd: Giá trị lớn giảm độ vọt lố, lại chậm đáp ứng độ dẫn đến ổn định khuếch đại nhiễu tín hiệu phép vi phân sai số * Các cải tiến thuật toán PID Thuật toán PID xuất vài thử thách ứng dụng điều khiển, khắc phục cải tiến nhỏ biểu thức PID Tích phân khởi động Một vấn đề phổ biến PID lý tưởng Tích phân khởi động, nơi xảy thay đổi điểm đặt lớn (tức thay đổi dương) khâu tích phân tích lũy sai số đáng kể lúc tăng (khởi động), làm vọt lố trì liên tục việc tăng sai số tích lũy bị gián đoạn Có thể khắc phục điều cách: • Thiết đặt giá trị tích phân ban đầu cho điều khiển tới giá trị mong muốn • Tăng điểm đặt với độ dốc thích hợp • Khơng cho phép chức tích phân PV vào vùng điều khiển • Giới hạn khoảng thời gian vượt q sai số tích phân tính tốn • Ngăn khơng cho khâu tích phân tích lũy biên xác định trước * Các hạn chế điều khiển PID Trong điều khiển PID dùng cho nhiều tốn điều khiển, thường đạt kết ý mà không cần cải tiến hay chí điều chỉnh nào, chúng yếu vài ứng dụng, thường khơng cho ta điều khiển tối ưu Khó khăn điều khiển PID ... TẠO TRƯỜNG ĐẠI HỌC KỸ THUẬT CÔNG NGHỆ TP HCM - PHẠM CÔNG VŨ Đề tài: ĐIỀU KHIỂN TAY MÁY BẬC TỰ DO THEO THUẬT TOÁN PID CẢI TIẾN LUẬN VĂN THẠC SĨ Chuyên ngành : Kỹ thuật điện Mã số ngành:... để điều khiển Robot cánh tay bậc tự Hình 4-5: Ứng dụng LabVIEW để mô cánh tay robot bậc tự Chƣơng 16 THIẾT KẾ ROBOT VÀ LẬP TRÌNH CHO ROBOT THEO PID CẢI TIẾN 5.1 Thuật toán điều khiển PID cải tiến. .. LabVIEW 1.6 GIÁ TRI THỰC TIỄN CỦA LUẬN VĂN: Hệ tay máy bậc tự Scara sử dụng nhiều công nghiệp giới Đề tài “ Điều khiển tay máy bậc tự theo thuật toán PID cải tiến? ?? góp phần vào việc phát triển