(LUẬN văn THẠC sĩ) tổng quan về omni direction robot

BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐẠI HỌC SƯ PHẠM KỸ THUẬT THÀNH PHỐ HỒ CHÍ MINH LUẬN VĂN THẠC SĨ PHẠM LÊ LONG TRIỀU TỔNG QUAN VỀ OMNI DIRECTION ROBOT NGÀNH: KỸ THUẬT ĐIỆN SKC007430 Tp Hồ Chí Minh, tháng 10/2017 TIEU LUAN MOI download : skknchat123@gmail.com BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƢỜNG ĐẠI HỌC SƢ PHẠM KỸ THUẬT THÀNH PHỐ HỒ CHÍ MINH LUẬN VĂN THẠC SỸ PHẠM LÊ LONG TRIỀU TỔNG QUAN VỀ OMNI DIRECTION ROBOT NGÀNH: KỸ THUẬT ĐIỆN – 60520202 Tp Hồ Chí Minh, tháng 10/2017 TIEU LUAN MOI download : skknchat123@gmail.com BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƢỜNG ĐẠI HỌC SƢ PHẠM KỸ THUẬT THÀNH PHỐ HỒ CHÍ MINH LUẬN VĂN THẠC SỸ PHẠM LÊ LONG TRIỀU TỔNG QUAN VỀ OMNI DIRECTION ROBOT NGÀNH: KỸ THUẬT ĐIỆN – 60520202 Hƣớng dẫn khoa học: PGS.TS NGUYỄN THANH PHƢƠNG Tp Hồ Chí Minh, tháng 10/2017 TIEU LUAN MOI download : skknchat123@gmail.com TIEU LUAN MOI download : skknchat123@gmail.com TIEU LUAN MOI download : skknchat123@gmail.com LÝ LỊCH KHOA HỌC I LÝ LỊCH SƠ LƢỢC: Họ & tên: PHẠM LÊ LONG TRIỀU Giới tính: Nam Ngày, tháng, năm sinh: 10-03-1991 Nơi sinh: Đồng Nai Quê quán: Quảng Nam Dân tộc: Kinh Chỗ riêng địa liên lạc: Tổ 25b,Ấp trần cao vân,Xã Bàu Hàm 2,Thống Nhất,Đồng Nai Điện thoại quan: Điện thoại riêng: 0968228908 Fax: E-mail: longtrieu719@gmail.com II QUÁ TRÌNH ĐÀO TẠO: Đại học: Hệ đào tạo: Đại học quy Thời gian đào tạo từ 09/2009 đến 10/ 2014 Nơi học (trƣờng, thành phố): Đại học Sƣ Phạm Kỹ Thuật, Tp Hồ Chí Minh Ngành học: Sƣ Phạm Kỹ Thuật Điện cơng nghiệp Tên đồ án, luận án môn thi tốt nghiệp:ỨNG DỤNG MẠNG WAVELET TRONG DỰ BÁO NGẮN HẠN PHỤ TẢI ĐIỆN KHU VỰC TP.HCM Ngày & nơi bảo vệ đồ án, luận án thi tốt nghiệp: 20/04/2014, Đại học sƣ phạm kỹ thuật Tp Hồ Chí Minh Ngƣời hƣớng dẫn: TS.Lê Chí Kiên III Q TRÌNH CƠNG TÁC CHUYÊN MÔN KỂ TỪ KHI TỐT NGHIỆP ĐẠI HỌC: Thời gian Từ 11/2014 đến 6/2017 Từ 7/2017 đến Nơi công tác Trung Tâm Phát Triển Qũy Đất Huyện Thống Nhất, Tỉnh Đồng Nai Công ty Cổ Phẩn Sản Xuất Kinh Doanh Thiết Bị Điện TTC Công việc đảm nhiệm Nhân Viên Kỹ sƣ Điện i TIEU LUAN MOI download : skknchat123@gmail.com LỜI CAM ĐOAN Tôi cam đoan cơng trình nghiên cứu tơi Các số liệu, kết nêu luận văn trung thực chƣa đƣợc cơng bố cơng trình khác Tp Hồ Chí Minh, ngày……tháng……năm 2017 (Ký tên ghi rõ họ tên) Phạm Lê Long Triều ii TIEU LUAN MOI download : skknchat123@gmail.com LỜI CẢM ƠN Trong thời gian học tập nghiên cứu trƣờng, Tơi hồn thành đề tài tốt nghiệp cao học Có đƣợc thành này, Tơi nhận đƣợc nhiều hỗ trợ giúp đỡ tận tình thầy cơ, gia đình, quan bạn bè thời gian học tập vừa qua Tôi xin bày tỏ lòng biết ơn chân thành đến Thầy PGS.TS Nguyễn Thanh Phƣơng, Trƣờng Đại học Kỹ Thuật Công Nghệ TP.HCM, ngƣời tận tình hƣớng dẫn, giúp đỡ, truyền đạt kinh nghiệm để Tơi hồn thành luận văn Xin chân thành cảm ơn đến tất quí Thầy Cô trƣờng Đại Học Sƣ Phạm Kỹ Thuật Tp Hồ Chí Minh trang bị cho tơi lƣợng kiến thức bổ ích, đặc biệt xin chân thành cảm ơn q Thầy Cơ Khoa Điện – Điện Tử tạo điều kiện thuận lợi hỗ trợ cho Tôi trình học tập nhƣ thời gian làm luận văn tốt nghiệp Tôi xin gởi lời cảm ơn chân thành đến đồng nghiệp, gia đình, bạn bè giúp đỡ cho nhiều để vƣợt qua khó khăn, tạo cho Tơi niềm tin nỗ lực phấn đấu để hoàn thành luận văn Xin chân thành cảm ơn ! Tp Hồ Chí Minh, tháng 10/2017 Học viên thực Phạm Lê Long Triều iii TIEU LUAN MOI download : skknchat123@gmail.com TÓM TẮT Đề tài ― TỔNG QUAN VỀ OMNIDIRECTION ROBOT ‖ đƣợc tiến hành khoảng thời gian 1,5 năm trƣờng Đại Học Sƣ Phạm Kỹ Thuật TP.HCM Sau thời gian nghiên cứu đề tài đƣợc triền khai tập trung giải vấn đề sau:  Tìm hiểu mơ hình tốn học robot di động đa hƣớng bánh (OMR)  Tìm hiểu phƣơng pháp điều khiển trƣợt tích phân (Integal Sliding Mode Control – ISMC) cho robot di động đa hƣớng bánh  Mô robot bám theo quỹ đạo tham chiếu điều khiển sử dụng Matlab Simulink cho robot di động đa hƣớng bánh (OMR)  Xây dựng mơ hình thực nghiệm  Nhận xét kết đạt đƣợc hạn chế mơ hình iv TIEU LUAN MOI download : skknchat123@gmail.com ABSTRACT Thesis ―OVERVIEW OF OMNIDIRECTIONAL ROBOT ‖ has been done for one and a half years at HO CHI MINH University of Technology And Education The thesis‘s content focused on:  Learn about mathematical model of the three-wheel mobile omnidirectional robot (OMR)  Learn about Integal Sliding Mode Control for the three-wheel mobile omni-directional robot (OMR)  Simulation of the reference robot trajectory using Matlab Simulink for OMR  Construct model experiment  Comment on the results and limitations of the model v TIEU LUAN MOI download : skknchat123@gmail.com /////////////////////////////////////////////////////////////////////////////////////////// */ if (val == 0) // tien { Serial.println(" ,Tien "); lcd.setCursor(0, 0); lcd.print("Tien "); digitalWrite(52,0); digitalWrite(in1_1, 1); // dc1 digitalWrite(in2_1, 0); analogWrite(pwm_1, 160 ); digitalWrite(in1_2, 1); digitalWrite(in2_2, 0); // dc2 analogWrite(pwm_2, 80 ); digitalWrite(in1_3, 0); digitalWrite(in2_3, 1); // dc3 analogWrite(pwm_3, 80 ); } if (val == 1) // lui { Serial.println(" ,Lui"); 71 TIEU LUAN MOI download : skknchat123@gmail.com //dco quay thuan ; lcd.setCursor(0, 0); lcd.print("Lui "); digitalWrite(52,0); digitalWrite(in1_1, 0); // dc1 digitalWrite(in2_1, 1); analogWrite(pwm_1, 160 ); digitalWrite(in1_2, 0); digitalWrite(in2_2, 1); // dc2 analogWrite(pwm_2, 80 ); digitalWrite(in1_3, 1); digitalWrite(in2_3, 0); // dc3 analogWrite(pwm_3, 80 ); } if (val == 2) // sang phai { Serial.println(" ,Sang phai "); //dco quay thuan ; lcd.setCursor(0, 0); lcd.print("Sang phai "); digitalWrite(52,0); 72 TIEU LUAN MOI download : skknchat123@gmail.com analogWrite(pwm_1, ); // dc1 digitalWrite(in1_2, 1); digitalWrite(in2_2, 0); // dc2 analogWrite(pwm_2, 255 ); digitalWrite(in1_3, 1); digitalWrite(in2_3, 0); // dc3 analogWrite(pwm_3, 255 ); } if (val == 3) // sang trai { Serial.println(" ,Sang trai"); //dco quay thuan ; lcd.setCursor(0, 0); lcd.print("Sang trai "); digitalWrite(52,0); analogWrite(pwm_1, ); // dc1 digitalWrite(in1_2, 0); digitalWrite(in2_2, 1); // dc2 analogWrite(pwm_2, 255 ); digitalWrite(in1_3, 0); digitalWrite(in2_3, 1); // dc3 analogWrite(pwm_3, 255 ); 73 TIEU LUAN MOI download : skknchat123@gmail.com } if (val == 4) // dung { Serial.println(" ,Dung "); lcd.setCursor(0, 0); lcd.print("Dung "); analogWrite(pwm_1, ); analogWrite(pwm_2, ); analogWrite(pwm_3, ); t=0; //dco quay thuan ; } if (val == 5) // thuan { Serial.println(" ,Quay Thuan "); //dco quay thuan ; lcd.setCursor(0, 0); lcd.print("Quay Thuan "); digitalWrite(52,0); digitalWrite(in1_1, 1); // dc1 digitalWrite(in2_1, 0); analogWrite(pwm_1, 100 ); digitalWrite(in1_2, 0); 74 TIEU LUAN MOI download : skknchat123@gmail.com digitalWrite(in2_2, 1); // dc2 analogWrite(pwm_2, 100 ); digitalWrite(in1_3, 1); digitalWrite(in2_3, 0); // dc3 analogWrite(pwm_3, 100 ); } if (val == 6) // nghich { Serial.println(" ,Quay nghich "); //dco quay nghich lcd.setCursor(0, 0); lcd.print("Quay Nghich "); digitalWrite(52,0); digitalWrite(in1_1, 0); // dc1 digitalWrite(in2_1, 1); analogWrite(pwm_1, 100 ); digitalWrite(in1_2, 1); digitalWrite(in2_2, 0); // dc2 analogWrite(pwm_2, 100 ); digitalWrite(in1_3, 0); digitalWrite(in2_3, 1); // dc3 75 TIEU LUAN MOI download : skknchat123@gmail.com analogWrite(pwm_3, 100 ); } } } // gan gia tri if (val == 10) { digitalWrite(52,0); //lcd.clear(); Serial.print(","); // x0 Serial.print(x_dat); Serial.print(",");// Serial.print(x_thuc); Serial.print(","); // y0 Serial.print(y_dat); Serial.print(",");// Serial.print(y_thuc); Serial.print(","); // goc Serial.print(gochientai); Serial.print(",");// kp 76 TIEU LUAN MOI download : skknchat123@gmail.com Serial.print(kp); Serial.print(","); //ki Serial.print(ki); Serial.print(","); // kd Serial.print(kd); Serial.print(","); // u1 Serial.print(u1); Serial.print(","); // u2 Serial.print(u2); Serial.print(","); // u3 10 Serial.println(u3); lcd.setCursor(0, 0); lcd.print("x="); lcd.print(x_thuc); lcd.setCursor(0, 1); lcd.print("y="); lcd.print(y_thuc); 77 TIEU LUAN MOI download : skknchat123@gmail.com x_dat = a1*(25*sin(t)+35)+ a2*(25*sin(t)+35)+x; // A1 =0, x = y_dat = a1*(25*cos(t)+35)+ a2*(25*sin(0.5*t)+35)+y; // t= 0, x = -50 + fuzzy->setInput(1, quangduonght); fuzzy->setInput(2, de); fuzzy->setInput(3, quangduonght); fuzzy->setInput(4, de); fuzzy->setInput(5, quangduonght); fuzzy->setInput(6, de); fuzzy->fuzzify(); float outputP_tam = fuzzy->defuzzify(1); float outputD_tam = fuzzy->defuzzify(2); float outputI_tam = fuzzy->defuzzify(3); kp = outputP_tam *10 ; ki = outputI_tam *0.001; kd = outputD_tam *100; x_thuc = khoangcach_x0(); y_thuc = khoangcach_y0(); if(x_thuc >100) { x_thuc = 100; 78 TIEU LUAN MOI download : skknchat123@gmail.com } if(y_thuc >100) { y_thuc = 100; } //sua tam gochientai = goc(); //gochientai = 237; error_x = x_thuc - x_dat; error_y = y_thuc - y_dat; quangduonght = sqrt(error_x*error_x + error_y*error_y); quangduonght = quangduonght / 100; if(quangduonght > 1){ quangduonght = 1; } if(quangduonght < 0){ quangduonght = 0; } v1 =(kp*error_y)+ki*(error_y+preError_y)+kd*(error_y- preError_y); v2 =- (sqrt(3)/2)*kp*error_x+ki*(error_x+preError_x)+kd*(error_xpreError_x)+(0.5)*(kp*error_y)+ki*(error_y+preError_y)+kd*(error_y-preError_y); v3 = (sqrt(3)/2)*kp*error_x+ki*(error_x+preError_x)+kd*(error_x- 79 TIEU LUAN MOI download : skknchat123@gmail.com preError_x)+(0.5)*(kp*error_y)+ki*(error_y+preError_y)+kd*(error_y-preError_y); preError_y = error_y; preError_x = error_x; duty1 = abs(v1); duty2 = abs(v2); duty3 = abs(v3); if(duty1 > 1500){ duty1 = 1500; } if(duty2 > 1500){ duty2 = 1500; } if(duty3 > 1500){ duty3 = 1500; } u1 = map(duty1, 0, 1500, 60 , 250); u2 = map(duty2, 0, 1500, 60 , 250); u3 = map(duty3, 0, 1500, 60 , 250); // chuong trinh chinh //11111111111111//////////////*****************/////////////// if (gochientai < (gocdat + 10)) { 80 TIEU LUAN MOI download : skknchat123@gmail.com //dco quay nghich digitalWrite(in1_1, 0); digitalWrite(in2_1, 1); analogWrite(pwm_1, 100 ); // dc1 digitalWrite(in1_2, 1); digitalWrite(in2_2, 0); analogWrite(pwm_2,100 ); //dc2 digitalWrite(in1_3, 0); digitalWrite(in2_3, 1); analogWrite(pwm_3, 100); // dc3 } //22222222222222222222222222222222222222222 if (gochientai > (gocdat - 10)) { //dco quay thuan ; digitalWrite(in1_1, 1); digitalWrite(in2_1, 0); analogWrite(pwm_1, 100); // dc1 digitalWrite(in1_2, 0); digitalWrite(in2_2, 1); analogWrite(pwm_2, 100); //dc2 81 TIEU LUAN MOI download : skknchat123@gmail.com digitalWrite(in1_3, 1); digitalWrite(in2_3, 0); analogWrite(pwm_3, 100); // dc3 } //3333333333333333333333333333 if (gochientai = (gocdat - 10) ) { // bam xung cho dong co if (v1 > 0) { digitalWrite(in1_1, 1); // dc1 digitalWrite(in2_1, 0); analogWrite(pwm_1, u1 +3); } if (v1 < 0) { digitalWrite(in1_1, 0); // dc1 digitalWrite(in2_1, 1); analogWrite(pwm_1, u1+3); } if (v1 == 0) { analogWrite(pwm_1, ); } // dong co 82 TIEU LUAN MOI download : skknchat123@gmail.com if (v2 > 0) { digitalWrite(in1_2, 0); digitalWrite(in2_2, 1); // dc2 analogWrite(pwm_2, u2 ); } if (v2 < 0) { digitalWrite(in1_2, 1); digitalWrite(in2_2, 0); // dc2 analogWrite(pwm_2, u2 ); } if (v2 == 0) { analogWrite(pwm_2, ); } // dong co if (v3 > 0) { digitalWrite(in1_3, 1); digitalWrite(in2_3, 0); // dc3 analogWrite(pwm_3, u3 ); } if (v3 < 0) { digitalWrite(in1_3, 0); digitalWrite(in2_3, 1); // dc3 83 TIEU LUAN MOI download : skknchat123@gmail.com analogWrite(pwm_3, u3); } if (v3 == 0) { analogWrite(pwm_3, ); } } } } Code Pidc.m V = kp* [ex;ey] + ki*[tpex;tpey] + kd * [dhex;dhey] u1 = V'*[0;1] + pdthe; u2 = V'*[-sqrt(3)/2;-0.5] + pdthe; u3 = V'*[sqrt(3)/2;-0.5] + pdthe; sys(1) = u1; sys(2) = u2; sys(3) = u3; Code Quangduong.m ex = u(1); ey = u(2); u = sqrt(ex*ex + ey*ey) sys(1) = u; 84 TIEU LUAN MOI download : skknchat123@gmail.com S K L 0 TIEU LUAN MOI download : skknchat123@gmail.com ... định chọn đề tài ― Tổng Quan Về Omni Direction Robot? ?? Sử dụng lý thuyết ổn định Lyapunov, điều khiển trƣợt tích phân (ISMC) đƣợc thiết kế để điều khiển chuyển động Omnidirection Robot, sử dụng phần... ĐÀO TẠO TRƢỜNG ĐẠI HỌC SƢ PHẠM KỸ THUẬT THÀNH PHỐ HỒ CHÍ MINH LUẬN VĂN THẠC SỸ PHẠM LÊ LONG TRIỀU TỔNG QUAN VỀ OMNI DIRECTION ROBOT NGÀNH: KỸ THUẬT ĐIỆN – 60520202 Hƣớng dẫn khoa học: PGS.TS NGUYỄN... quỹ đạo hình vng 54 Hình 6: Robot omni chạy theo quỹ đạo hình trịn .55 xi TIEU LUAN MOI download : skknchat123@gmail.com Chƣơng 1: TỔNG QUAN 1 Tổng Quan Về RoBot Theo trình phát triển xã