ĐỒ ÁN XE TRÁNH VẬT CẢN VÀ TỰ ĐỖ

TRƯỜNG ĐẠI HỌC CÔNG NGHIỆP HÀ NỘI KHOA CÔNG NGHỆ KỸ THUẬT ĐIỆN TỬ VIỄN THÔNG BÁO CÁO ĐỒ ÁN TỐT NGHIỆP Đề tài: XE TRÁNH VẬT CẢN VÀ TỰ ĐỖ Giáo viên hướng dẫn : Sinh viên thực : Lớp : Điện tử Chuyên Ngành : Điện tử viễn thông Hà Nội ngày 17 tháng 04 năm 2021 Đồ án tốt nghiệp NHẬN XÉT CỦA GIẢNG VIÊN HƯỚNG DẪN Hà Nội, ngày… tháng năm 2021 Giảng viên hướng dẫn Trang NHẬN XÉT CỦA GIẢNG VIÊN PHẢN BIỆN Hà Nội, ngày… tháng năm 2021 Giảng viên phản biện Lời cảm ơn Trên thực tế khơng có thành cơng mà không gắn liền với hỗ trợ, giúp đỡ dù hay nhiều, dù trực tiếp hay gián tiếp người xung quanh.Trong trình làm đồ án tốt nghiệp em nhận nhiều giúp đỡ , đóng góp ý kiến bảo nhiệt tình Thầy Cơ, gia đình bạn bè Đầu tiên em xin gửi lời cảm ơn sâu sắc đến thầy … thầy hướng dẫn đề tài luận văn em, thầy nhiệt tình hỗ trợ em mặt thời gian em thực đề tài Thầy cung cấp cho em kiến thức quý báu, ln động viên em cố gắng hồn thành đề tài Em thật biết ơn thầy! Em xin cảm ơn thầy cô khoa dạy bảo em,cung cấp cho em học bổ ích kinh nghiệm quý báu không giúp em thực luận văn mà làm hành trang cho nghiệp em MỤC LỤC BÁO CÁO ĐỒ ÁN TỐT NGHIỆP LỜI MỞ ĐÂÙ .9 Tính cấp thiết đề tài Mục đích đề tài .9 Đối tượng phạm vi nghiên cứu Ý nghĩa khoa học thực tiễn đề tài 10 Ưu điểm nhược điểm đề tài 10 CHƯƠNG I: TỔNG QUAN VỀ ROBOT 11 Giới thiệu robot hình thành phát triển 11 1.1 Định nghĩa robot 11 1.2 Tình hình phát triển 11 Phân loại ứng dụng robot 13 2.1 Phân loại robot 13 2.2 Ứng dụng robot 14 CHƯƠNG II: GIỚI THIỆU VỀ ROBOT TỰ HÀNH TRÁNH VẬT CẢN 15 Giới thiệu robot tự hành tránh vật cản 15 Tổng quan robot tự hành tránh vật cản .15 2.1 Sự phát triển 16 2.2 Mơ hình hóa robot 16 2.3 Yêu cầu công nghệ nhu cầu thực tế 18 2.4 Ưu điểm, nhược điểm robot tự hành tránh vật cản .19 CHƯƠNG III: CẤU TẠO PHẦN CỨNG VÀ SƠ ĐỒ KẾT NỐI ROBOT TỰ HÀNH TRÁNH VẬT CẢN 22 Thông số chi tiết linh kiện mạch 23 1.1 Khối điều khiển trung tâm Arduino UNO R3 23 1.2 Khối điều khiển động Module L298 26 1.3 Khối hệ thống cảm biến SR04 27 1.4 Khối động RC Servo 29 1.5 Khối động Motor DC 31 1.6 Khối bánh xe 32 Sơ đồ mạch sơ đồ dây 34 2.1 Sơ đồ mạch 34 2.2 Sơ đồ nối dây 35 Danh sách chuẩn bị linh kiện thi cơng sản phẩm hồn thành .36 3.1 Danh sách linh kiện 36 3.2 Sản phẩm hoàn thành 38 3.3 Chương trình điều khiển 39 CHƯƠNG IV: KẾT LUẬN VÀ HƯỚNG PHÁT TRIỂN 46 Tài liệu tham khảo 47 DANH MỤC HÌNH ẢNH Hình Ứng dụng robot công nghiệp .12 Hình Ứng dụng robot nghiên cứu khoa họ 13 Hình Mơ hình hóa robot 16 Hình Mơ hình hóa robot 20 Hình Ứng dụng robot tự hành siêu thị 20 Hình Sơ đồ mạch hệ thống điều khiển xe tự hành tránh vật cản .22 Hình Mạch Ảrduino UNO R3 24 Hình Module L298 26 Hình Module L298 27 Hình 10 Loại micro servo Tower Pro 9g phổ biến 30 Hình 11 Bên micro servo 30 Đồ án tốt nghiệp Hình 12 Động Motor DC .31 Hình 13 Bánh xe V1 32 Hình 14 Pin 18650 Ultrafire 33 Hình 15 Sơ đồ mạch 34 Hình 16 Sơ đồ nối dây 35 Hình 17 Linh kiện cần chuẩn bị 37 Hình 18 Sản phẩm hoàn thành 38 Trang Tóm tắt luận văn  Ngày với phát triển khoa học công nghệ, hàng loạt hệ thống tự động đời với mục đích thay sức lao động người tăng suất lao động Có thể kể đến robot ứng dụng nhiều cơng nghiệp, có khả hoạt động theo chương trình lập trình sẵn với tốc độ độ xác cao Ngồi khoa học phát triển hệ robot gọi robot thông minh có khả tiếp nhận tri thức tư giống người, có khả phán đốn định mà không cần đến can thiệp người  Robot tự hành mảng quan trọng lĩnh vực robotic với nhiều cơng trình nghiên cứu giới Bài tốn đặt cho robot tự hành đa dạng, phải kể đến tốn điều khiển robot bám mục tiêu tránh vật cản Với toán này, yêu cầu đặt thời gian đáp ứng robot, độ tối ưu thuật toán độ phức tạp môi trường Nhiệm vụ luận văn giải vấn đề này.Đề tài luận văn thực việc dùng Arduino Uno R3 làm khối điều khiển trung tâm, áp dụng giải thuật để tránh vật cản với thông tin môi trường lấy từ cảm biến siêu âm SR04  Do hạn chế kiến thức nên kết hoạt động robot chưa tốt lắm, chưa thể đáp ứng với mơi trường , địa hình chật hẹp phức tạp Trong tương lai em hi vọng cải thiện giải thuật phần cứng để hoàn thiện robot LỜI MỞ ĐÂÙ Tính cấp thiết đề tài Hiện công nghiệp 4.0 phát triển mạnh rộng rãi hầu hết ứng dụng kinh tế quốc gia Một ứng dụng sử dụng gần ứng dụng công nghệ thông tin vào công nghệ chế tạo điều khiển robot thông minh Xu phát triển giới khoa học công nghệ ln có thay đổi mạnh mẽ Nền kinh tế tri thức với công nghệ thông tin kỹ thuật góp phần quan trọng vào việc nâng cao chất lượng sống người Trong kinh tế tri thức thực phát triển xã hội tách khỏi phát triển kỹ thuật công nghệ thông tin đặc biệt phát triển tin học, ngành khoa học công nghệ tạo sản phẩm robot nghiên cứu ứng dụng hình thành thập kỷ gần gọi Robotics Mục đích đề tài Mục đính đề tài áp dụng cơng nghệ thông tin vào kỹ thuật “Xây dựng xe tự hành có khả tự tránh vật cản” Đối tượng phạm vi nghiên cứu  Đối tượng nguyên cứu đề tài  Nghiên cứu nguyên lý đo khoảng cách cảm biến siêu âm SR04  Phương pháp điều khiển động ( theo phương thức tự hành)  Phạm vi nguyên cứu  Không gian làm việc xe mặt phẳng giới hạn tường, vật cản xem vật cản chiều tĩnh hoàn tĩnh Ý nghĩa khoa học thực tiễn đề tài  Ý nghĩa khoa học Xây dựng sở khoa học khả tự hành tránh vật cản robot sử dụng cảm biến siêu âm  Ý nghĩa thực tiễn đề tài Tiềm ứng dụng xe tự hành lớn, kể đến robot vận hành vật liệu, hàng hóa tịa nhà, nhà máy, cửa hàng, sân bay hay thư viện… Ưu điểm nhược điểm đề tài  Ưu điểm  Với thiết kế mơ hình xe tránh vật cản hoạt động bình thường ổn định, phần cứng phần mềm tương thích với kết hợp thêm thiết bị khác để phát triển mơ hình lớn hơn, dễ dàng hoạt động  Bên cạnh giá thành linh kiện ngồi thị trường lại rẻ dễ dàng tìm kiếm  Nhược điểm  Do thiếu điều kiện nên làm mơ hình cịn to cồng kềnh  Những địa hình khó khăn, góc hẹp xe cịn hoạt động hạn chế Sơ đồ mạch sơ đồ dây 2.1 Sơ đồ mạch Sơ đồ mạch Hình 15 Sơ đồ mạch 2.2 Sơ đồ nối dây Arduino Module L298 Servo SRF05 Nguồn VCC VCC REDC.TẮ C Nguồn GND GND BLACK 5V RED GND BROWN Đế Pin Bánh Xe Bánh Xe VCC 5V GND GND ECH O TRIG ~5 ~6 ORANG E ~9 ~10 IN-A ~11 IN-C 12 IN-D 13 IN-B OUT-A RED OUT-B BLAC K OUT-C RED OUT-D BLACK Sơ đồ nối dây Hình 16 Sơ đồ nối dây Danh sách chuẩn bị linh kiện thi công sản phẩm hoàn thành 3.1 Danh sách linh kiện  Một miếng nhựa mica tự chế để làm khung xe  Một cảm biến siêu âm SRF 04 SRF05  Một Broad Arduini UNO R3  Một module điều khiển động L298  Một Servo SG90  Khung đỡ cảm biến siêu âm  Khung đỡ Servo  Dây nối đực-cái, -cái  Nguồn nuôi ( pin ) Linh kiện cần chuẩn bị Hình 17 Linh kiện cần chuẩn bị 3.2 Sản phẩm hoàn thành Sản phẩm hồn thành Hình 18 Sản phẩm hồn thành 3.3 Chương trình điều khiển #include Servo myservo; // create servo object to control a servo int pos = 0; // variable to store the servo position /******** khai báo chân input/output**************/ const int trig = 6; // chân trig SRF-05 const int echo = 5; // chân echo SRF-05 int tien1=10; // chân IN - A Module L298 int tien2=11; // chân IN - C Module L298 int lui1=12; // chân IN - D Module L298 int lui2=13; // chân IN - B Module L298 int dongcoservo=9; // chân Orange Servo int gioihan = 25; int i; int x=0; unsigned long thoigian; // biến đo thời gian int khoangcach; // biến lưu khoảng cách int khoangcachtrai,khoangcachphai; void dokhoangcach(); void dithang(int duongdi); void disangtrai(); void disangphai(); void dilui(); void resetdongco(); void quaycbsangphai(); void quaycbsangtrai(); void setup() { // put your setup code here, to run once: myservo.attach(9); // attaches the servo on pin to the servo object pinMode(trig,OUTPUT); // chân trig phát tín hiệu pinMode(echo,INPUT); // chân echo nhận tín hiệu pinMode(tien1,OUTPUT); pinMode(tien2,OUTPUT); pinMode(lui1,OUTPUT); pinMode(lui2,OUTPUT); digitalWrite(tien1,LOW); digitalWrite(tien2,LOW); digitalWrite(lui1,LOW); digitalWrite(lui1,LOW); // Serial.begin(9600); myservo.write(90); delay(500); } void loop() { khoangcach=0; dokhoangcach(); if(khoangcach>gioihan||khoangcach==0) { dokhoangcach(); if(khoangcach>gioihan|| khoangcach==0) { dithang(); } } else { resetdongco(); quaycbsangtrai(); khoangcachtrai=khoangcach; quaycbsangphai(); khoangcachphai=khoangcach; if(khoangcachphai