CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

97 2 0
CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Đang tải... (xem toàn văn)

Tài liệu hạn chế xem trước, để xem đầy đủ mời bạn chọn Tải xuống

Thông tin tài liệu

NHẬN XÉT CỦA GIÁO VIÊN HƯỚNG DẪN NHẬN XÉT CỦA GIÁO VIÊN PHẢN BIỆN MỤC LỤC Trang BẢNG KÝ HIỆU VIẾT TẮT CHƯƠNG 1: TỔNG QUAN VỀ MOBILE ROBOT 1.1- Lịch sử nghiên cứu 1.1.1- Lịch sử phát triển xe AGV 1.1.2- Phân loại xe AGV 1.1.3- Chiến lược phát triển công nghiệp robot quốc gia 11 1.2- Mục tiêu đề tài 15 1.3- Phương pháp thực đề tài 15 CHƯƠNG 2: THIẾT KẾ HỆ THỐNG CƠ KHÍ AGV ROBOT 17 2.1- Lựa chọn phương án thiết kế 17 2.1.1- Lựa chọn phương án thiết kế khí 17 2.1.2- Lựa chọn động 20 2.1.3- Phương án để thiết kế điều khiển 22 CHƯƠNG 3: MÔ HÌNH ĐỘNG HỌC, ĐỘNG LỰC HỌC AGV 26 ROBOT 3.1- Tính tốn động học 26 3.2- Tính tốn động lực học 28 3.3- Tính chọn cấu nâng hạ hàng hóa 33 CHƯƠNG 4- THIẾT KẾ HỆ THỐNG ĐIỆN 36 4.1- Các linh kiện sử dụng 36 4.1.1- Module Wifi ESP32 36 4.1.2- Cảm biến siêu âm 38 4.1.3- Module hạ áp LM2596 39 4.1.4- Module điều khiển động DC BTS 7960 43A 40 4.1.5- Bộ nguồn 43 4.1.6- Mạch dò line 45 4.2- Sơ đồ mạch nguyên lý sơ đồ khối điều khiển 47 CHƯƠNG 5- THIẾT KẾ HỆ THỐNG ĐIỀU KHIỂN VÀ THUẬT 52 TOÁN 5.1- Phần mềm lập trình điều khiển 52 5.2- Sơ đồ thuật toán điều khiển 53 5.3- Code điều khiển 53 CHƯƠNG 6- HỒN THIỆN SẢN PHẨM 54 6.1- Hồn thiện lắp ráp khí 54 6.1.1- Lắp ráp khung robot 55 6.1.2- Lắp ráp cụm phận khác 56 6.2- Hồn thiện code nạp chương trình vào vi điều khiển 63 6.3- Chạy thực nghiệm mơ hình robot AGV vận chuyển hàng hóa 63 CHƯƠNG 7: KẾT LUẬN VÀ HƯỚNG PHÁT TRIỂN 64 7.1- Các yêu cầu cho thiết bị 64 7.2- Mức độ hoàn thành 64 7.3- Đánh giá 64 7.4- Kết luận 65 7.5- Hướng phát triển 65 LỜI KẾT 66 TÀI LIỆU THAM KHẢO 67 PHỤ LỤC 68 BẢNG KÝ HIỆU VIẾT TẮT STT Kí hiệu Chú thích q Đơn vị Ma trận vị trí θ Góc robot so với phương ngang Rad ϑ Vận tốc tuyến tính robot m/s Vận tốc bánh phải, trái m/s Vận tốc góc robot Rad/s vR ,vL ω R Bán kính bánh xe mm L Nửa khoảng cách bánh xe mm K tt Động tịnh tiến thân xe J Kb Động quay bánh xe J 10 vt Vận tốc dài xe m/s Vận tốc dài bánh phải, trái m/s 11 v wR , v wL 12 J wR , J wR 13 mb Khối lượng bánh xe Kg 14 mt Khối lượng thân xe Kg 15 M dc Momen động N.m 16 M mst Momen hao tổn trục N.m 17 u 19 Kg/m2 Hệ số tổn thất trục động M msl 18 Momen quán tính bánh k Momen ma sát lăn N.m Hệ số ma sát bánh xe mặt đường 20 g Gia tốc trọng trường m/ s2 21 Vn tc gúc ca bỏnh Rad/s 22 ă Gia tốc góc bánh rad/ s2 Gia tốc dài m/ s2 Vận tốc điểm đầu A, điểm cuối B m/s 23 a Va,Vb 24 25 t Thời gian xe di chuyển s Pdc 26 27 ξ Công suất động Ma trận vị trí robot W CHƯƠNG 1: TỔNG QUAN VỀ MOBILE ROBOT 1.1- Lịch sử nghiên cứu 1.1.1- Lịch sử phát triển xe AGV Robot đời từ kỷ trước công nguyên Chu Mục Vương (Trung Quốc) người Yan Shi phác thảo ý tưởng máy tự động khí đầu tiên. Đến năm 1927, robot điện tử lần xuất phim ảnh Năm 1948, nguyên lý tảng robot tự động hóa đời, tạo tiền đề cho robot học sau Cho tới năm 1961, Mobile Robot điện tử giới đời, đặt tên Unimate.Trong loại Mobile Robot áp dụng lĩnh vực cơng nghiệp, Robot tự hành mặt đất AGV( Autonomous Guided Vehicles) giới quan tâm đến Hệ thống xe tự hành (AGV) tồn từ năm 1953 Barrett Electronics Of Northbrook, bang Illinois – USA, Savant Automation of Walker, bang Michigan – USA Một nhà phát minh sáng chế phương pháp tự động hoá người xe tải kéo mà sử dụng nhà máy nhiều năm nhờ vào giấc mơ Robot tự hành AGV chế tạo để vận chuyển phôi gia công vào năm 70, vấn đề định hướng xe tự hành vấn đề quan trọng Ban đầu AGV xe kéo nhỏ chạy theo đường dẫn Công nghệ năm 70 điều khiển hệ thống để nâng cao khả tính linh hoạt xe AGV, xe khơng dùng để kéo, đẩy hàng kho, mà có chức trung gian , kết nối trình sản xuất, lắp ráp, phân loại hàng hóa Trải qua nhiều năm, công nghệ phát triển mạnh hơn, trình tự hành, AGV lập trình để giao tiếp với robot khác nhằm đảm bảo sản phẩm chuyển qua trạm, kho nơi mà sau chúng giữ lại chuyển đến vị trí khác 1.1.2- Phân loại xe AGV Xe AGV sử dụng với mục đích chung để chuyển hàng nhà máy, kho chứa sản phẩm Hình 1.1- Sơ đồ vận hành xe AGV nhà máy Ngày nay, xe AGV có nhiều dòng sản phẩm khác thị trường Các sản phẩm AGV bao gồm:  Xe kéo (Towing Vehicle) Xe kéo xuất dòng xe AGV thịnh hành thị trường Loại kéo nhiều toa hàng khác trở từ 8000 đến 60000 pounds Ưu điểm hệ thống xe kéo:  Khả chun chở lớn;  Có thể dự đốn lên kế hoạch tính hiệu việc chuyên chở việc đảm bảo an toàn;  Tính an tồn tốt Hình 1.2- Xe AGV kéo hàng  Xe chở ( Unit Load Vehicle) Xe chở trang bị tâng khay chứa nâng, hạ chuyênr động băng tải, đai xích Ưu điểm xe chở:  Tải trọng phân phối di chuyển theo yêu cầu;  Thời gian đáp ứng nhanh gọn;  Giảm hư hại tài sản;  Đường linh hoạt;  Giảm thiếu tắc nghẽn giao thơng chun chở Hình 1.3- Xe AGV chở hàng  Xe đẩy ( Cart Vehicle) 10 delay(30); if (digitalRead(sw3)==0) { while (digitalRead(sw3)==0); mode=1; vx=0; val=1; tick(1); lcd.clear(); lcd.print(" AUTO MODE "); delay(1000); lcd.clear(); lcd.print(" LINE finding "); while (line()==0) tien(); dung(); tick(2); } } } while (mode==1) { lcd.clear(); lcd.setCursor(0,0);lcd.print("Select: Done: "); lcd.setCursor(15,0);lcd.print(cnt); lcd.setCursor(0,1);lcd.print("From: -> To: "); while(mode==1) { lcd.setCursor(5,1);lcd.print(loca1); lcd.setCursor(14,1);lcd.print(loca2); 83 if (SerialBT.available()) { char c=SerialBT.read(); Serial.write(c); if(c=='L') {vx=1;val=1;} else if(c=='H') {loca1++;if(loca1>4) loca1=1;Serial.println(loca1);} else if(c=='I') {loca2++;if(loca2>4) loca2=1;Serial.println(loca2);} else if(c=='K') {vx=0;val=0;} } bool dem=read_sw1(); if(dem==1){ if(millis()-time14) loca1=1; tick(1); time1=millis(); } if (digitalRead(sw2)==0) 84 { delay(30); if (digitalRead(sw2)==0) { while (digitalRead(sw2)==0); tick(1); loca2++; if (loca2>4) loca2=1; } } if (digitalRead(sw3)==0) // start { delay(30); if (digitalRead(sw3)==0) { while (digitalRead(sw3)==0); tick(1); if (loca1==0 || loca2==0 || loca1==loca2) tick(2); else { mode=2; vx=1; val=0; // nút start tick(1); lcd.clear(); goto lineFollow; } 85 } } if (vx==0 && val==0) //back { mode=0; tick(1); lcd.clear(); } if (vx==1 && val==1) { //run if (loca1==0||loca2==0||loca1==loca2) tick(2); else { mode=2; vx=1; val=0; tick(1); lcd.clear(); goto lineFollow; } } } } lineFollow: while (mode==2) // line Follow { lcd.setCursor(0,0); lcd.print(" RUNNING : "); 86 lcd.setCursor(14,0); lcd.print(cnt); lcd.setCursor(0,1); lcd.print("From: -> To: "); lcd.setCursor(5,1); lcd.print(loca1); lcd.setCursor(14,1); lcd.print(loca2); if (loca1==1) { timTRAI(); timNGA4(1); // trai timDUNG(); tick(1); banlen(); delay(2000);bandung(); quaydau(); if (loca2==2) { timNGA4(0); timDUNG(); } else if (loca2==3) { timNGA4(1); timNGA4(1); timDUNG(); } else 87 { timNGA4(1); timNGA4(2); timDUNG(); } tick(1); delay(1000); quaydau(); lui(); delay(1000); dung(); banxuong();delay(2000);bandung(); tick(2); lcd.clear(); lcd.print(" GO HOME! if (loca2==2) { timNGA4(1); timPHAI(); timDUNG(); } else if (loca2==3) { timNGA4(2); timNGA4(0); timPHAI(); timDUNG(); } 88 "); else { timNGA4(1); timNGA4(0); timPHAI(); timDUNG(); } tick(3); lcd.clear(); lcd.print(" DONE! "); quaydau(); lui(); delay(2000); dung(); tick(3); mode=1; cnt++; break; } else if (loca1==2) { timTRAI(); timNGA4(2); // phai timDUNG(); tick(1); lcd.setCursor(5,1); lcd.print(loca1); banlen(); delay(2000);bandung(); quaydau(); 89 if (loca2==1) { timNGA4(0); timDUNG(); } else if (loca2==3) { timNGA4(2); timNGA4(1); timDUNG(); } else { timNGA4(2); timNGA4(2); timDUNG(); } tick(1); lcd.setCursor(14,1); lcd.print(loca2); delay(1000); quaydau(); lui(); delay(1000); dung(); banxuong();delay(2000);bandung(); tick(2); lcd.clear(); lcd.print(" GO HOME! if (loca2==1) 90 "); { timNGA4(2); timPHAI(); timDUNG(); } else if (loca2==3) { timNGA4(2); timNGA4(0); timPHAI(); timDUNG(); } else { timNGA4(1); timNGA4(0); timPHAI(); timDUNG(); } tick(3); lcd.clear(); lcd.print(" DONE! "); quaydau(); lui(); delay(2000); dung(); tick(3); mode=1; cnt++; 91 Serial1.readString(); break; } else if (loca1==3) { timTRAI(); timNGA4(0); timNGA4(1); // trai timDUNG(); tick(1); lcd.setCursor(5,1); lcd.print(loca1); banlen(); delay(2000);bandung(); quaydau(); if (loca2==1) { timNGA4(2); timNGA4(2); timDUNG(); } else if (loca2==2) { timNGA4(2); timNGA4(1); timDUNG(); } 92 else // { timNGA4(0); timDUNG(); } tick(1); lcd.setCursor(14,1); lcd.print(loca2); delay(1000); quaydau(); lui(); delay(1000); dung(); banxuong();delay(2000);bandung(); tick(2); lcd.clear(); lcd.print(" GO HOME! if (loca2==1) { timNGA4(2); timPHAI(); timDUNG(); } else if (loca2==2) { timNGA4(1); timPHAI(); timDUNG(); } else // 93 "); { timNGA4(1); timNGA4(0); timPHAI(); timDUNG(); } tick(3); lcd.clear(); lcd.print(" DONE! "); quaydau(); lui(); delay(2000); dung(); tick(3); mode=1; cnt++; break; } else if (loca1==4) { timTRAI(); timNGA4(0); timNGA4(2); // phai timDUNG(); tick(1); lcd.setCursor(5,1); lcd.print(loca1); banlen(); delay(2000);bandung(); quaydau(); 94 if (loca2==1) { timNGA4(1); timNGA4(2); timDUNG(); } else if (loca2==2) { timNGA4(1); timNGA4(1); timDUNG(); } else // { timNGA4(0); timDUNG(); } tick(1); lcd.setCursor(14,1); lcd.print(loca2); delay(1000); quaydau(); lui(); delay(1000); dung(); banxuong();delay(2000);bandung(); tick(2); lcd.clear(); lcd.print(" GO HOME! if (loca2==1) 95 "); { timNGA4(2); timPHAI(); timDUNG(); } else if (loca2==2) { timNGA4(1); timPHAI(); timDUNG(); } else // { timNGA4(2); timNGA4(0); timPHAI(); timDUNG(); } tick(3); lcd.clear(); lcd.print(" DONE! "); quaydau(); lui(); delay(2000); dung(); tick(3); mode=1; cnt++; break; 96 } } } 97 ... khiển 22 CHƯƠNG 3: MƠ HÌNH ĐỘNG HỌC, ĐỘNG LỰC HỌC AGV 26 ROBOT 3. 1- Tính tốn động học 26 3. 2- Tính tốn động lực học 28 3. 3- Tính chọn cấu nâng hạ hàng hóa 33 CHƯƠNG 4- THIẾT KẾ HỆ THỐNG ĐIỆN 36 4.1-... kích thước nhỏ CHƯƠNG 3: MƠ HÌNH ĐỘNG HỌC, ĐỘNG LỰC HỌC AGV ROBOT 3. 1- Tính tốn động học 26 Hình 3. 1- Hệ tọa độ robot Hệ tọa độ tuyệt đối ( hệ tọa độ gốc) hệ tọa độ cố định đặt môi trường biểu... chọn động Động chi tiết thiếu mơ hình robot AGV vận chuyển hàng Tùy thuộc vào tải trọng công suất hoạt động mà ta lựa chọn động khác cho mơ hình Sau đây, nhóm liệt kê số động thường sử dụng mô hình

Ngày đăng: 16/10/2022, 18:46

Hình ảnh liên quan

BẢNG KÝ HIỆU VIẾT TẮT 5 - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

5.

Xem tại trang 4 của tài liệu.
BẢNG KÝ HIỆU VIẾT TẮT - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT
BẢNG KÝ HIỆU VIẾT TẮT Xem tại trang 6 của tài liệu.
Hình 1.1- Sơ đồ vận hành xe AGV trong nhà máy - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 1.1.

Sơ đồ vận hành xe AGV trong nhà máy Xem tại trang 9 của tài liệu.
Hình 1.2- Xe AGV kéo hàng - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 1.2.

Xe AGV kéo hàng Xem tại trang 10 của tài liệu.
Hình 1.3- Xe AGV chở hàng - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 1.3.

Xe AGV chở hàng Xem tại trang 10 của tài liệu.
Hình 1.4- Xe AGV nâng hàng - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 1.4.

Xe AGV nâng hàng Xem tại trang 11 của tài liệu.
- Xe di chuyển trên địa hình bằng phẳng, khơng có dốc nghiêng. -   Xe di chuyển tự do trong không gian nhà máy. - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

e.

di chuyển trên địa hình bằng phẳng, khơng có dốc nghiêng. - Xe di chuyển tự do trong không gian nhà máy Xem tại trang 18 của tài liệu.
Hình 2.1- Một số loại rơ le thông dụng - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 2.1.

Một số loại rơ le thông dụng Xem tại trang 23 của tài liệu.
Hình 2.3- Vi điều khiển ATMEGA - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 2.3.

Vi điều khiển ATMEGA Xem tại trang 25 của tài liệu.
Hình 3.1- Hệ tọa độ robot - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 3.1.

Hệ tọa độ robot Xem tại trang 27 của tài liệu.
Hình 2.3- Cấu tạo động cơ Takanawa - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 2.3.

Cấu tạo động cơ Takanawa Xem tại trang 33 của tài liệu.
Hình 2.4- Xylanh điện hàng trình 50mm - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 2.4.

Xylanh điện hàng trình 50mm Xem tại trang 35 của tài liệu.
Hình 4.1- Module Wifi ESP32 - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 4.1.

Module Wifi ESP32 Xem tại trang 37 của tài liệu.
Hình 4.2- Sơ đồ chân kết nối ESP32 - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 4.2.

Sơ đồ chân kết nối ESP32 Xem tại trang 39 của tài liệu.
Hình 4.5- Module điều khiển động cơ DC BTS7960 43A - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 4.5.

Module điều khiển động cơ DC BTS7960 43A Xem tại trang 41 của tài liệu.
Hình 4.4- Module LM2596 - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 4.4.

Module LM2596 Xem tại trang 41 của tài liệu.
Hình 4.7- Mơ hình mạch cầu H - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 4.7.

Mơ hình mạch cầu H Xem tại trang 43 của tài liệu.
Hình 4.9- Động cơ quay nghịch 4.1.5- Bộ nguồn - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 4.9.

Động cơ quay nghịch 4.1.5- Bộ nguồn Xem tại trang 44 của tài liệu.
Hình 4.11- Cảm biến quang trở - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 4.11.

Cảm biến quang trở Xem tại trang 47 của tài liệu.
Hình 4.14- Phần mềm thiết kế mạch Altium - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 4.14.

Phần mềm thiết kế mạch Altium Xem tại trang 48 của tài liệu.
 Mô phỏng mạch PCB 3D, đem lại hình ảnh ,mạch điện trung thực trong khơng gian 3 chiều, hỗ trợ MCAD-ECAD, liên kết trực tiếp với mơ hình STEP, kiểm tra khoảng cách cách điện , cấu hình cả 2D và 3D. - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

ph.

ỏng mạch PCB 3D, đem lại hình ảnh ,mạch điện trung thực trong khơng gian 3 chiều, hỗ trợ MCAD-ECAD, liên kết trực tiếp với mơ hình STEP, kiểm tra khoảng cách cách điện , cấu hình cả 2D và 3D Xem tại trang 49 của tài liệu.
Hình 4.15- Sơ đồ mạch nguyên lí của mạch điều khiển - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 4.15.

Sơ đồ mạch nguyên lí của mạch điều khiển Xem tại trang 49 của tài liệu.
Hình 4.16- Mạch 2D PCB - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 4.16.

Mạch 2D PCB Xem tại trang 50 của tài liệu.
Hình 4.18- Sơ đồ khối hoạt động của robot AGV - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 4.18.

Sơ đồ khối hoạt động của robot AGV Xem tại trang 51 của tài liệu.
Hình 5.1- Giao diện lập trình trên phần mềm Arduino IDE - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 5.1.

Giao diện lập trình trên phần mềm Arduino IDE Xem tại trang 54 của tài liệu.
Hình 6.1- Quy trình thiết kế - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 6.1.

Quy trình thiết kế Xem tại trang 55 của tài liệu.
Hình 6.3- Robot trên phẩn mềm SolidWorks - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 6.3.

Robot trên phẩn mềm SolidWorks Xem tại trang 56 của tài liệu.
Hình 6.4- Khung robot trên phẩn mềm SolidWorks - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 6.4.

Khung robot trên phẩn mềm SolidWorks Xem tại trang 57 của tài liệu.
Hình 6.8- Ống dẫn hướng - CHƯƠNG 3 mô HÌNH ĐỘNG học, ĐỘNG lực học AGV ROBOT

Hình 6.8.

Ống dẫn hướng Xem tại trang 63 của tài liệu.

Mục lục

    BẢNG KÝ HIỆU VIẾT TẮT

    2.1- Lựa chọn các phương án thiết kế

    2.1.1- Lựa chọn phương án thiết kế cơ khí

    Đặc điểm và yêu cầu của xe:

    Phương án thiết kế cơ khí:

    2.1.2- Lựa chọn động cơ

    CHƯƠNG 4- THIẾT KẾ HỆ THỐNG ĐIỆN

    CHƯƠNG 6- HOÀN THIỆN SẢN PHẨM

    CHƯƠNG 7: KẾT LUẬN VÀ HƯỚNG PHÁT TRIỂN

    7.1- Các yêu cầu cho thiết bị

Tài liệu cùng người dùng

Tài liệu liên quan