(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi

(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi(Luận án tiến sĩ) Phát triển các thuật toán thông minh điều khiển chuyển động của hệ thống robot dạng tay máy đôi

BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐẠI HỌC BÁCH KHOA HÀ NỘI ——————— * ——————— LƯU THỊ HUẾ PHÁT TRIỂN CÁC THUẬT TỐN THƠNG MINH ĐIỀU KHIỂN CHUYỂN ĐỘNG CỦA HỆ THỐNG ROBOT DẠNG TAY MÁY ĐÔI LUẬN ÁN TIẾN SĨ KỸ THUẬT ĐIỀU KHIỂN VÀ TỰ ĐỘNG HÓA Hà Nội - 2021 BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐẠI HỌC BÁCH KHOA HÀ NỘI ——————— * ——————— LƯU THỊ HUẾ PHÁT TRIỂN CÁC THUẬT TỐN THƠNG MINH ĐIỀU KHIỂN CHUYỂN ĐỘNG CỦA HỆ THỐNG ROBOT DẠNG TAY MÁY ĐÔI Ngành: Kỹ thuật điều khiển tự động hóa Mã số: 9520216 LUẬN ÁN TIẾN SĨ KỸ THUẬT ĐIỀU KHIỂN VÀ TỰ ĐỘNG HÓA NGƯỜI HƯỚNG DẪN KHOA HỌC PGS TS NGUYỄN PHẠM THỤC ANH TS DƯƠNG MINH ĐỨC Hà Nội - 2021 LỜI CAM ĐOAN Tơi xin cam đoan cơng trình nghiên cứu hướng dẫn PGS TS Nguyễn Phạm Thục Anh TS Dương Minh Đức Các kết trình bày luận án trung thực chưa tác giả khác công bố Các thơng tin trích dẫn luận án xác, rõ nguồn gốc Hà Nội, ngày tháng năm 2021 Người hướng dẫn khoa học Nghiên cứu sinh PGS.TS Nguyễn Phạm Thục Anh Lưu Thị Huế TS Dương Minh Đức i LỜI CẢM ƠN Luận án hồn thành Bộ mơn Tự động hóa cơng nghiệp viện Điện, trường Đại học Bách Khoa Hà Nội, hướng dẫn tận tình, chu đáo, đầy trách nhiệm PGS.TS Nguyễn Phạm Thục Anh TS Dương Minh Đức Tác giả xin bày tỏ lòng biết ơn sâu sắc đến cô Nguyễn Phạm Thục Anh thầy Dương Minh Đức cảm thấy may mắn vinh dự nhận dìu dắt, hướng dẫn thầy đường nghiên cứu khoa học Tác giả xin gửi lời cảm ơn sâu sắc tới TS Nguyễn Danh Duy TS Võ Duy Thành, giảng viên mơn Tự động hóa cơng nghiệp – Viện Điện, Đại học Bách khoa Hà nội giúp đỡ phần xây dựng thực nghiệm, mạch đo cho luận án Tác giả xin trân trọng gửi lời cảm ơn đến Ban Giám hiệu, Phòng sau Đại học, Ban Chủ nhiệm viện Điện, Trường Đại học Bách Khoa Hà Nội, đặc biệt thầy cô giáo Bộ mơn Tự động hóa cơng nghiệp ln giúp đỡ, động viên, tạo môi trường học tập nghiên cứu thuận lợi cho tác giả Tác giả xin bày tỏ lòng biết ơn đến Ban Giám hiệu trường Đại học Điện lực, anh chị đồng nghiệp công tác Khoa Kỹ thuật điện, Trường Đại học Điện lực tạo điều kiện thuận lợi, giúp đỡ động viên tác giả suốt trình học tập nghiên cứu Lời cảm ơn sau cùng, tác giả xin dành cho gia đình, người ln u thương, chia sẻ, động viên tác giả vượt qua khó khăn để hoàn thành luận án Nghiên cứu sinh ii Mục lục Lời cam đoan i Lời cảm ơn ii Danh mục chữ viết tắt vi Danh mục kí hiệu tốn học vii Danh mục hình vẽ x Danh mục bảng biểu xi Mở đầu Chương TỔNG QUAN VỀ CÁC PHƯƠNG PHÁP ĐIỀU KHIỂN CHO HỆ THỐNG ROBOT DẠNG TAY MÁY ĐÔI 1.1 Tổng quan hệ thống robot dạng tay máy đôi ứng dụng 1.2 Tổng quan cơng trình nghiên cứu phương pháp điều khiển hệ thống robot dạng tay máy đôi 1.2.1 Các phương pháp điều khiển 1.2.2 Các phương pháp điều khiển nâng cao 1.3 Bộ quan sát 1.4 Kết luận chương Chương ĐỘNG HỌC VÀ ĐỘNG LỰC HỌC CỦA HỆ TAY MÁY ĐÔI 2.1 Nguyên lý cấu tạo làm việc hệ tay máy đôi 2.2 Các ràng buộc hình học để giữ liên lạc khâu tác động cuối robot với đối tượng 2.2.1 Mối quan hệ tay máy thứ đối tượng 2.2.2 Mối quan hệ tay máy thứ hai đối tượng 2.2.3 Mối quan hệ gữa vị trí đối tượng khâu tác động cuối tay máy 2.3 Động lực học hệ thống 2.3.1 Động hệ thống 2.3.2 Thế hệ thống 2.3.3 Phương trình động lực học hệ thống 2.4 Kết luận chương 4 10 13 15 16 17 17 18 18 19 20 20 21 23 24 30 Chương THIẾT KẾ ĐIỀU KHIỂN CƠ BẢN CHO HỆ TAY MÁY ĐÔI 31 3.1 Thiết kế điều khiển cho hệ tay máy đơi dùng thuật tốn tựa mơ hình 31 3.1.1 Điều khiển lực cho hệ tay máy đôi 32 iii 3.1.2 Điều khiển góc xoay đối tượng 3.1.3 Điều khiển vị trí đối tượng 3.1.4 Mô hệ tay máy dùng điều khiển tựa mơ hình 3.2 Thiết kế điều khiển cho hệ tay máy đơi dựa mơ hình quan sát GPI 3.2.1 Thiết kế quan sát GPI cho hệ tay máy đôi 3.2.2 Phân tích kẹp ổn định đối tượng robot tay máy đôi 3.2.3 Mô điều khiển cho hệ tay máy đôi dùng quan sát GPI 3.3 Kết luận chương 34 36 39 42 42 45 48 51 Chương NGHIÊN CỨU ĐIỀU KHIỂN THÔNG MINH CHO HỆ TAY MÁY ĐÔI 4.1 Điều khiển thích nghi cho hệ tay máy đôi sử dụng mạng noron xuyên tâm 4.1.1 Thuật toán điều khiển 4.1.2 Thiết kế mạng noron RBF 4.1.3 Xây dựng luật cập nhật trọng số 4.1.4 Mô kiểm chứng 4.2 Điều khiển thích nghi lai lực/ vị trí 4.2.1 Thiết kế lực tác động lên đối tượng 4.2.2 Điều khiển lai lực/ vị trí 4.2.3 Mô kiểm chứng Matlab/Simulink 4.3 Điều khiển thích nghi lai lực/vị trí sử dụng quan sát thích nghi 4.3.1 Thiết kế quan sát thích nghi 4.3.2 Điều khiển thích nghi lai lực/vị trí dựa quan sát thích nghi noron 4.4 Kết luận chương 53 53 53 57 59 60 64 64 65 66 71 71 74 87 Chương THỰC NGHIỆM 89 5.1 Thiết kế chế tạo mơ hình thực nghiệm tay máy đôi 89 5.2 Động lực học hệ tay máy đôi - đối tượng thực nghiệm 90 5.3 Mô với tay máy đôi – đối tượng, tay máy có hai bậc tự 91 5.4 Cấu trúc hoạt động hệ thống thực nghiệm 97 5.4.1 Các thiết bị phần cứng 98 5.4.2 Phần mềm điều khiển 98 5.4.3 Board kết nối 99 5.5 Mơ hình thực nghiệm toàn hệ thống 100 5.6 Thử nghiệm hệ thống 100 5.6.1 Điều khiển hỗn hợp lực vị trí đối tượng chuyển động theo trục x 101 5.6.2 Điều khiển hỗn hợp lực vị trí đối tượng chuyển động theo trục y 103 5.6.3 Điều khiển hỗn hợp lực hướng đối tượng 104 5.6.4 Điều khiển hỗn hợp lực, vị trí chuyển động theo trục x hướng đối tượng 105 iv 5.6.5 Điều khiển hỗn hợp lực, vị trí chuyển động theo trục y hướng đối tượng 106 5.6.6 Điều khiển hỗn hợp lực, vị trí chuyển động theo trục x trục y đối tượng 107 5.7 Kết luật chương 108 Kết luận chung luận án 110 Danh mục cơng trình khoa học 111 TÀI LIỆU THAM KHẢO 112 Phụ lục 122 v DANH MỤC CÁC CHỮ VIẾT TẮT Ký hiệu viết tắt Tiếng Anh Tiếng Việt ĐK Control Điều khiển GPI Generalized Integral GA Genetic Algorithm Thuật toán di truyền NN Neural network Mạng noron DOF Degrees of freedom Bậc tự RBFNN Radial basis function neural Mạng noron xuyên tâm network RBF Radial basis function SOSMC Second-order sliding mode Điều khiển trượt bậc hai control MRAC Model-reference control FFNN Feedforward neural network Mạng noron truyền thẳng NAO Neuro-adaptive observer Quan sát thích nghi noron Proportional Tỉ lệ tích phân tổng quát Xuyên tâm adaptive Điều khiển thích nghi tham chiếu mơ hình vi DANH MỤC CÁC KÝ HIỆU TỐN HỌC TT 10 11 12 13 14 15 Ký hiệu 16 (.) 17 18 19 20 21 22 23 24 25 26 27 (.) (.) ε Γ Ks , Λ g qi s fi λi θij θ ∆θ ∆(.) τ (.)T (.)−1 (.)+ I tr(·) diag(·) sgn(·) Mô tả Góc quay khớp tay máy thứ i Mặt trượt Lực vng góc với bề mặt đối tượng Lực song song với bề mặt đối tượng Góc khớp thứ j tay máy thứ i Góc xoay đối tượng Sai số góc xoay đối tượng Sai số Mô men tác động lên khớp Tham số, hàm ước lượng Ma trận chuyển vị Ma trận nghịch đảo Ma trận giả đảo Sai số ước lượng Tổng Đạo hàm cấp Đạo hàm cấp Chuẩn Sai số xấp xỉ Ma trận tham số Tham số điều khiển Gia tốc trọng trường g = 9, 8m/s2 Định nghĩa Ma trận đơn vị Vết ma trận Ma trận đường chéo Hàm dấu vii DANH MỤC CÁC HÌNH VẼ Hình Hình Hình Hình Hình Hình Hình Hình Hình 1.1: 1.2: 1.3: 1.4: 1.5: 1.6: 1.7: 1.8: 1.9: Định nghĩa phân cấp thao tác robot dạng tay máy đôi Hệ thống robot dạng tay máy đôi phối hợp FRIDA robot tay máy đôi ABB Lắp ráp với tay máy đôi công nghiệp thuộc dự án SMErobotics Robot tay máy đôi Motoman DA20 lắp ráp ghế Robot hạng nặng Hitachi để dọn dẹp FUKUSHIMA Bộ điều khiển tay máy đôi Hai robot PUMA uốn cong linh hoạt Robot tay máy đôi Stanford khám phá tàu đắm bị bỏ hoang Hình 1.10: Robot RIBA Nhật Bản nâng bệnh nhân từ giường lên xe lăn Hình 1.11: Robot tay máy đôi Motoman pha chế thuốc chống ung thư Hình 1.12: Tổng quan phương pháp điều khiển phối hợp chuyển động hệ tay máy đôi 10 Hình Hình Hình Hình Hình 2.1: 2.2: 2.3: 2.4: 2.5: Mơ hình tay máy đơi thao tác đối tượng Mối quan hệ vị trí đối tượng tay máy thứ Mối quan hệ vị trí đối tượng tay máy thứ hai Mô tả trọng tâm khâu tay máy thứ Mô tả trọng tâm khâu tay máy thứ hai Hình Hình Hình Hình Hình Hình Hình Hình Hình Hình Hình Hình Hình 3.1: 3.2: 3.3: 3.4: 3.5: 3.6: 3.7: 3.8: 3.9: 3.10: 3.11: 3.12: 3.13: Lực khâu tác động cuối tay máy tác động lên đối tượng Mô men khớp tay máy thứ Mô men khớp tay máy thứ hai Vị trí đối tượng chuyển động theo trục x Vị trí đối tượng chuyển động theo trục y Hướng đối tượng Sơ đồ khối hệ thống, điều khiển quan sát Vận tốc khớp tay máy thứ ước lượng chúng Vận tốc khớp tay máy thứ hai ước lượng chúng Vận tốc đối tượng ước lượng chúng Lực tiếp xúc ước lượng chúng Sai số ước lượng lực tay máy đôi Lực tác động khâu tác động cuối 40 40 40 41 41 41 48 49 49 49 50 50 51 Hình Hình Hình Hình 4.1: 4.2: 4.3: 4.4: Sơ đồ khối điều khiển sử dụng RBFNN Cấu trúc RBFNN Quỹ đạo chuyển động đối tượng theo trục x Quỹ đạo chuyển động đối tượng theo trục y 57 58 61 62 viii 17 18 19 21 22 Hình 19 Sơ đồ khối quỹ đạo Hình 20 Sơ đồ khối tín hiệu phản hồi 8) Code dùng thực nghiệm 8.1 Kalman function function [X_k, P_k, K] = Kalman(X_mea, P_old, t , X_k_old) %#codegen dt = 7e-4; A = [1,0;0,1]; 133 B = [dt;0]; U = X_mea(2); if abs(U)