MỞ ĐẦU gây nay Robot được sử dụng trong nhiều lĩnh vực từ phục vụ sản xuất trong, các nhà máy, trợ giúp các công việc nghiên cứu trên mặt đất, đưới đại dương, trong, không gian và thậm chỉ trên cả bề mặt sao hỏa. Robot công nghiệp lá một thí dụ tiêu biểu vẻ hệ cơ điện tử, một hệ bao hàm nhiều lĩnh vực trong nó như: cơ học, kĩ thuật điện-điện tử, kĩ thuật điền khiển, kĩ thuật đo-xử lý số liệu, kĩ thuật lập trình, Càng ngày ngành robot cảng phát triển, nó đem lại những thay đổi quan trọng. trong chế tạo sản phẩm và nâng cao nắng xuất chất lượng ở nhiều ngành công, nghiệp. Chỉnh vì vậy vấn để điều khiển cho Robot công nghiệp đang là mỗi quan tâm hàng đâu của cơ điện lử và điểu khiển học.
Thực lề công nghiệp đặt ra cho điều khiển học một bài toán: thiết kế bộ điều khiển đâm bảo cho cơ cấu tác động cuỗi của robot có khả năng bảm theo một quỹ đạo cho trước hoặc bảm theo chuyển động, của một vật. Vì thể, tôi đã chọn luận văn "Nghiên cứu tiết kế hệ thông điều khiển bam’, đưới sự hướng dẫn của thầy giáo T5. Mục đích của luận văn là thiết kế bộ điều khiển bam theo quỹ đạo đặt trước cho điểm tac động cuỗi của cảnh tay robot. Pham vi nghiên cứu của luận văn bao gồm.
tìm hiển lý thuyết về robot, thiết kế các bộ điển khiển Fuzzy Logic, PID và thích. nghi va mé phéng bang phan mém Matlab. Phuong phap nghign ei: Phan lich x4y dimg mé hinh Loan hoo céa Robot va tính toán thiết kế bộ điểu khiển phù hợp. Sau đẻ, thuc hign mé phong bing Matab để kiểm tra đánh giá các bộ điễu khiển Tatận văn được trình bảy gôm 4 chương, Chương 1: Cơ sở lý thuyết về Robot Trinh bay lý thuyết chung về robot công nghiệp, bao g6m động học và động lực học robot, cũng như các phương phán điều khiển Robot.
Chương 2: Mô hình điều khiển Robot Planar Nghiên cứu thiết kế hệ thông điều khiển bám. Nguyễn Văn Quyền MỞ ĐẦU gây nay Robot được sử dụng trong nhiều lĩnh vực từ phục vụ sản xuất trong, các nhà máy, trợ giúp các công việc nghiên cứu trên mặt đất, đưới đại dương, trong, không gian và thậm chỉ trên cả bề mặt sao hỏa. Robot công nghiệp lá một thí dụ tiêu biểu vẻ hệ cơ điện tử, một hệ bao hàm nhiều lĩnh vực trong nó như: cơ học, kĩ thuật điện-điện tử, kĩ thuật điền khiển, kĩ thuật đo-xử lý số liệu, kĩ thuật lập trình, Càng ngày ngành robot cảng phát triển, nó đem lại những thay đổi quan trọng. trong chế tạo sản phẩm và nâng cao nắng xuất chất lượng ở nhiều ngành công, nghiệp.
Chỉnh vì vậy vấn để điều khiển cho Robot công nghiệp đang là mỗi quan tâm hàng đâu của cơ điện lử và điểu khiển học. Thực lề công nghiệp đặt ra cho điều khiển học một bài toán: thiết kế bộ điều khiển đâm bảo cho cơ cấu tác động cuỗi của robot có khả năng bảm theo một quỹ đạo cho trước hoặc bảm theo chuyển động, của một vật. Vì thể, tôi đã chọn luận văn "Nghiên cứu tiết kế hệ thông điều khiển bam’, đưới sự hướng dẫn của thầy giáo T5. Mục đích của luận văn là thiết kế bộ điều khiển bam theo quỹ đạo đặt trước cho điểm tac động cuỗi của cảnh tay robot.
Pham vi nghiên cứu của luận văn bao gồm. tìm hiển lý thuyết về robot, thiết kế các bộ điển khiển Fuzzy Logic, PID và thích. nghi va mé phéng bang phan mém Matlab. Phuong phap nghign ei: Phan lich x4y dimg mé hinh Loan hoo céa Robot va tính toán thiết kế bộ điểu khiển phù hợp.
Sau đẻ, thuc hign mé phong bing Matab để kiểm tra đánh giá các bộ điễu khiển Tatận văn được trình bảy gôm 4 chương, Chương 1: Cơ sở lý thuyết về Robot Trinh bay lý thuyết chung về robot công nghiệp, bao g6m động học và động lực học robot, cũng như các phương phán điều khiển Robot. Chương 2: Mô hình điều khiển Robot Planar Nghiên cứu thiết kế hệ thông điều khiển bám. Nguyễn Văn Quyền Linh 3. Luật điển khiển Fuzzy PD II 80 Tlinh 3.
Đập íng với bộ điều khiển Tu 81 Linh 3.44, Sai lệch với bộ điều khiên Fuzzy PDI Hình 3. Dap ứng với bộ điều khiển Fuzzy PD+I. sài ca sec Hình 3. Sai lệch với hộ điền khiển Fuzzy PD+I Hình 3.47, Mô hinh Fuzzy chỉnh định PID.
Dap tng voi bé diéu khién Fuzzy chỉnh định PID.49 Sai lệch với bộ điển khiển Pnzzy chinh dink PID. Dap ứng với bộ điển khiển Fnzzy chỉnh định PID.$L Sai lệch với bộ điều Fuzzy chỉnh định PID, 86 Linh 3. Dap tng với bộ điền khiển Fnzzy chỉnh định PID. Sai lệch với bộ điều khiên Fuzzy chỉnh định PID.
Dắp ứng với bộ điều khiển Fuzzy chỉnh định PID. Sai lệch với bộ điều Puzzy chỉnh định PID. 88 vii Nghiên cứu thiết kế hệ thông điều khiển bám. Nguyễn Văn Quyền Danh mục các bảng Bảng 1.
Tham số PID. Bang DH cia robot. 42 Nghiên cứu thiết kế hệ thông điều khiển bám. Nguyễn Văn Quyền Danh mục các hình vẽ, dỗ thị Linh 1.1 Llinh anh vé robot trong céng nghiép.
Biéu dign Vecto khdng gian. Biểu điễn khung tọa độ Hình 1. Phép tịnh tiền trục tọa độ Hình 1. Biểu điển điểm trong tọa độ tịnh tiên.
Phép quay trục lọa độ - Hinh 1. Phép quay cô định XYZ. Phép quay Euler Lũnh 1. Các vectơ định vị trí và hướng của †ay máy Ilinh I.
Zi-l vàai chéo nhau Hình 1. Zi- ee Hình 1. Xác định cáo tiền khớp. Biểu điễn tham sé bang DH - " Hình 1.
Biểu điễn phép phânly biến. kimerirrreereeuee TẾ, Hình I.16 Biểu diễn nghiệm đơn phương Irình dic tinh„ 23 Hình I. Biểu dién nghiệm kép phương trình đặc tính - a Tinh 1. Biéu điễn 2 nghiệm phúc của phương trình đặc tỉnh aA Hình 1 19.
Mô hình phương pháp điển khiển phi tryển - 24 1ũinh 1. Mô hình điền khiển PD bù trọng trường Hình 1. So dé khéi của bộ điều khiến PID. Đô thị PV theo thời gian, ba gia trị Kp.
Đô thi PV theo thi gian, tương ung voi 3 " a Hinh 1.24, Dé thi PV theo thoi gian, voi 3 gid tt] Kd. cesses senasetsstisieie Hình 1. Câu trúc hộ điều khiển Fuzzy Trình I. Mô hình mở nhiêu đầu vàn-một đâu ra Hình 1.
Suy điễn mờ I đầu vào và 1 luật. Suy diễn mở hai đầu vào và 1 luật Hình 2.Hệ trục tọa độ của robot Planar.2 Biểu diễn tạa độ robot Planar.3 Mô hình bộ điều khiển Fuzzy-PID Hinh 2.3 M6 hinh bé digu khién Fuzzy PD41.4 Mô hình bộ điều khiển Fuzzy-Chinh diah Pil Hình 3. Mô hình robot. Điều khiến phì tụ đụn vào mô hình.
Dap ứng quỹ đạo với bộ điều khiển mô hình 54 v Nghiên cứu thiết kế hệ thông điều khiển bám.1 Mô hinh trong Matlab.2 Kết quả mô phống = nh nh he htntnhtrerenenrrrnerrreremrsir 52 3.1 Bộ điểu khiển phủ tuyến trên co sở mô hình: 52 3. 2 Bộ điều khẩn PID truyền thẳng °+ nen nh nh thrntreremrrrnrrrririiriee 56 66 3.3 Bộ điều khiển thích nghỉ mô hình ngược 3.4 Hộ điều khiến Puzzy [.ogic"' Chương4: KẾT LUẬN. D0) iit Nghiên cứu thiết kế hệ thông điều khiển bám. Nguyễn Văn Quyền Linh 3.
Sai lệch vị trí với bộ điền khiển mô hình. Đáp ứng quỹ đạo với rnô hình sai lệch Linh 3. Sai lệch quỹ đạo với mô hình sai lệch. Mô hình điều khiển PID.
Dáp ứng quý đạo với bộ điển khiển PID. 8ai lệch quỹ đạo với bé didu khién PID. Đáp ứng quỹ đạo với bộ điều khiển ID. Sai lệch quỹ đạo với bệ điều khiển PID.
Pap img quỹ đạo với bộ điều khiển PID. Sai lệch quỹ đạo với bệ điều khiến PID. Dap tng quY đạo với bộ điều khiển PID. Sai lệch quỹ đạo với bộ điều khiển PID.
Dáp ứng quỹ đạo với bộ điều khiển PID. Sai lệch quỹ đạo với bộ điều khiển PID. Dáp ứng quỹ đạo với bộ điểu khiển PID. 8ai lệch quỹ đạo với bộ điều khiến PID.
Đáp ứng quỹ đạo với bộ điều khiển ID. Sai lệch quỹ đạo với bệ điều khiến PID. Pap img quỹ đạo với bê điển khiển PID. Sai lệch quỹ đạo với bộ điều khiển PID.
Mô hình điển khiến thích nghỉ 7 1lình 3. Dáp ứng quỹ đao với bộ điều khiển thích nghỉ Hình 3. Sai lệch qưỹ đạo với bộ điều khiển thích nghỉ. Đáp ứng quỹ đạo với bộ điều khiển thịch nghi.
Sai lệch quỹ đạo với bộ điều khiển thích nghỉ.29, Mé hinh điều khiển Fuzzy - PID. Luật chỉnh định Fuzzy. Đắp ứng với bê điều khiển Fuzzy - PID TTình 3. Sai lệch với hộ điều khiển Fuzzy - PID Llinh 3.
Dap tng véi bé diéu khién Fuzzy -PID 4 SH VỊ Hình 3. 3ai lệch với bộ điều khiển Fuzzy -PID. Mỏ hình điển khiến Fuzzy -PID2. Luật chỉnh định Fuzzy.
Dap ting với bộ điều khiển Fuzzy PID2. Sai lệch với bộ điều khiển Fuzzy PID2. Đáp ứng với bộ điều khiển Fuzzy PID3. Sai lệch với bộ điền khiến Fuzzy PID2.
Mỗ hình điêu khiển Fuzzy PD-T ọ Nghiên cứu thiết kế hệ thông điều khiển bám. Nguyễn Văn Quyền Linh 3. Luật điển khiển Fuzzy PD II 80 Tlinh 3. Đập íng với bộ điều khiển Tu 81 Linh 3.44, Sai lệch với bộ điều khiên Fuzzy PDI Hình 3.
Dap ứng với bộ điều khiển Fuzzy PD+I. sài ca sec Hình 3. Sai lệch với hộ điền khiển Fuzzy PD+I Hình 3.47, Mô hinh Fuzzy chỉnh định PID. Dap tng voi bé diéu khién Fuzzy chỉnh định PID.49 Sai lệch với bộ điển khiển Pnzzy chinh dink PID.
Dap ứng với bộ điển khiển Fnzzy chỉnh định PID.$L Sai lệch với bộ điều Fuzzy chỉnh định PID, 86 Linh 3. Dap tng với bộ điền khiển Fnzzy chỉnh định PID. Sai lệch với bộ điều khiên Fuzzy chỉnh định PID. Dắp ứng với bộ điều khiển Fuzzy chỉnh định PID.
Sai lệch với bộ điều Puzzy chỉnh định PID. 88 vii 'Nghiễn củu thiết kế hệ thông, điều khiển bám. Nguyễn Văn Quyền Dưa ra mô hình động học và động lực học cho Robot Planar, để từ đó thiể kế các bộ điền khiển. Chương 3: Mô phỏng Matlab Trình bảy kết quả mồ phóng đáp ứng vị trí của Robot Planar, với các bộ điền khiển khác nhan.
Chương 4: Kết luận "Nêu ra những kết quả đạt được của luận văn. Học viên xin gửi lời cảm on chân thành đến các thấy cô thuộc bộ môn Điền khiển tự động và bộ môn Tự động hóa xí nghiệp công nghiệp trưởng Dại học Bách Khoa, đặc biệt là TS.Kguyễn Văn Hòa đã tận tỉnh hướng đâ , giúp đỡ học viên trong suốt quá trình làm luận văn. 11à nội, Ngày 01, tháng, 08, năm 2012 Học viên Nguyễn Văn Quyền 'Nghiễn củu thiết kế hệ thông, điều khiển bám.