ROBOT tìm ĐƯỜNG TRONG mê CUNG (có code) .......................................... ROBOT tìm ĐƯỜNG TRONG mê CUNG (có code) .......................................... ROBOT tìm ĐƯỜNG TRONG mê CUNG (có code) .......................................... ROBOT tìm ĐƯỜNG TRONG mê CUNG (có code) ..........................................
ROBOT TÌM ĐƯỜNG TRONG MÊ CUNG MỤC LỤC DANH MỤC CÁC HÌNH VẼ III DANH MỤC CÁC TỪ VIẾT TẮT IV CHƯƠNG TỔNG QUAN VỀ ĐỀ TÀI 1.1 GIỚI THIỆU 1.1.1 Lịch sử .1 1.1.2 Hướng thực CHƯƠNG NGUYÊN LÝ CHUNG CỦA ĐỀ TÀI 2.1 SƠ ĐỒ KHỐI 2.2 SƠ ĐỒ NGUYÊN LÝ 2.3 SƠ ĐỒ GIẢI THUẬT CHƯƠNG TÌM HIỂU LINH KIỆN 3.1 VI ĐIỀU KHIỂN ATMEGA328P 3.2 CẢM BIẾN VẬT CẢN HỒNG NGOẠI SHARP GP2Y0A02YK0F 11 3.3 MẠCH ĐIỀU KHIỂN ĐỘNG CƠ L298N 11 3.4 HÌNH ẢNH THI CƠNG PHẦN CỨNG 13 3.4.1 Hình ảnh mạch in 13 3.4.2 Hình ảnh thực tế mơ hình 16 CHƯƠNG NHẬN XÉT 17 4.1 NHẬN XÉT 17 CHƯƠNG KẾT LUẬN 18 5.1 KẾT LUẬN 18 5.2 HƯỚNG PHÁT TRIỂN 18 TÀI LIỆU THAM KHẢO 18 PHỤ LỤC A 19 DANH MỤC CÁC HÌNH VẼ DANH MỤC CÁC TỪ VIẾT TẮT UART Universal Asynchronous Receiver – Transmitter PWM Pulse Width Modulation MISO Master Input / Slave Output MOSI Master Output / Slave Input SCK Serial Clock IDE Intergrated Development Environment Trang 1/22 CHƯƠNG TỔNG QUAN VỀ ĐỀ TÀI 1.1 Giới thiệu Trong thời đại công nghiệp ngày nay, Robot ngày sử dụng phổ biến sản xuất sống hàng ngày người Robot có vai trò quan trọng khó thay được, giúp người việc điều kiện nguy hiểm, khó khăn Ngồi ra, Robot dùng lĩnh vực nguy hiểm không gian, quân sự, giải trí… Lĩnh vực Robot di động ngày có quan tâm nhà nghiên cứu xã hội 1.1.1 Lịch sử Khái niệm Robot theo nghĩa chung thường hiểu đồng nghĩa với khái niệm tự động hóa cơng nghiệp, điều phần vì: thứ nhất, Robot phần hệ thống tự động hóa, thứ hai tự thân việc trình bày miêu tả Robot sinh hoạt hàng ngày nhiều phóng đại 1.1.2 Hướng thực Trong đề tài thực thuật toán bám tường (wall-following) quy tắc nỗi tiếng để vượt qua mê cung, gọi quy tắc tay trái quy tắc tay phải Nếu mê cung liên thông đơn giản nghĩa tất tường kết nối với kết nối với đường bao mê cung, cách dò tay lên tường kết nối với nhạu kết nối với đường bao quanh mê cung, cách dò tay lên tường mê cung người đảm bảo khơng bị lạc tìm lối có lối dường bao; khơng có quay trở lại lối vào qua tất đường mê cung lần Robot tìm đường mê cung Trang 2/22 Hình 1-1: Mê cung bám tường trái Robot tìm đường mê cung Trang 3/22 CHƯƠNG NGUYÊN LÝ CHUNG CỦA ĐỀ TÀI 2.1 Sơ đồ khối Cảm biến hồng ngoại Sharp GP2Y0A02YK0F Khối nguồn Atmega328p Động Mạch điều khiển động L298N Servo DC giảm tốc GA12 Hình 2-1: Sơ đồ khối toàn mạch Khi cấp nguồn cho hệ thống, toàn mạch hoạt động cảm biến hồng ngoại đo khoảng cách gửi cho Atmega328p Sau đó, Atmega328p xử lí mạch điều khiển động thẳng, rẽ trái, rẽ phải, dừng hay tăng tốc độ 2.2 Sơ đồ ngun lý Hình 2-2: Sơ đồ ngun lí mơ Robot tìm đường mê cung Trang 4/22 2.3 Sơ đồ giải thuật Hình 2-3: Lưa đồ thuật tốn chương trình Robot tìm đường mê cung Trang 5/22 Trường hợp 1: Robot song song với tường Hình 2-4: Robot song song với tường trái Robot bắt đầu thẳng bám tường trái Robot song song với tường, thẳng đồng thời luôn so sánh x giá trị khoảng cách cho trước để biết được: Nếu dis2 nhỏ x lệch trái, Robot rẽ phải dis2 = x Nếu dis2 lớn x lệch phải, Robot rẽ trái dis2 = x Robot tìm đường mê cung Trang 6/22 Trường hợp 2: Robot bị chặn tường trái phía trước Hình 2-5: Robot bị chặn tường trái phía trước Robot đo giá trị khoảng cách dis2 dis1 Robot biết bị chặn trước đồng thời đo giá trị dis2 để biết bị chặn hay không Sau đó, Robot dừng lại rẽ phải, thẳng tiếp tục quay lại trường hợp Robot tìm đường mê cung Trang 8/22 Trường hợp 4: Robot bị chặn phía trước, trái phải Hình 2-7: Robot bị chặn phía trước, trái phải Robot tiếp tục đo khoảng cách ba cảm biến hồng ngoại biết bị chặn phía, nên rẽ phải 180 độ thẳng tiếp tục quay lại trường hợp Robot tìm đường mê cung Trang 9/22 CHƯƠNG TÌM HIỂU LINH KIỆN 3.1 Vi điều khiển Atmega328p Hình ảnh vi điều khiển Atmega328p Hình 3.1: Vi điều khiển Atmega328p • Kiến trúc: AVR 8bit • Xung nhịp lớn nhất: 20Mhz • Bộ nhớ chương trình (FLASH): 32KB • Bộ nhớ EEPROM: 1KB • Bộ nhớ RAM: 2KB • Điện áp hoạt động rộng: 1.8V - 5.5V • Số timer: timer gồm timer 8-bit timer 16-bit • Số kênh xung PWM: kênh (1timer kênh) Robot tìm đường mê cung Trang 10/22 Hình 3-2: Mạch ngun lí vi điều khiển Atmega328p tích hợp mạch nguồn, chân cảm biến Robot tìm đường mê cung Trang 11/22 3.2 Cảm biến vật cản hồng ngoại Sharp GP2Y0A02YK0F Hình 3-3: Cảm biến vật cản hồng ngoại Sharp GP2Y0A02YK0F GP2Y0A02YK0F cảm biến đo khoảng cách dùng tia hồng ngoại để đo khoảng cách tối đa 150cm Với độ ổn định cao, chống nhiễu tốt kích thước nhỏ gọn Giá trị trả analog nên dễ sử dụng Thông số kỹ thuật: • Phạm vi đo: 20150cm • Tín hiệu ra: Điện áp • Kích thước: 29.5 x 13 x 21.6mm • Điện áp: 4.5V - 5.5V 3.3 Mạch điều khiển động L298N IC L298 IC tích hợp nguyên khối gồm mạch cầu H bên Với điện áp làm tăng công suất đầu từ 5V – 47V, dòng lên đến 4A, L298 thích hợp úng dụng công suất nhỏ động DC loại vừa Robot tìm đường mê cung Trang 12/22 Hình 3-4: IC L298N Bốn chân INPUT: IN1, IN2, IN3, IN4 nối với chân 5, 7, 10, 12 L298 Đây chân tín hiệu điều khiển Bốn chân OUTPUT: OUT1, OUT2, OUT3, OUT4 (tương ứng với chân INPUT) nối với chân 2, 3, 13, 14 L298 Các chân nối với động Hai chân ENA ENB dùng để điều khiển mạch cầu H L298 Nếu mức logic “1” cho phép mạch cầu H hoạt động, mức “0” mạch cầu H khơng hoạt động Hình 3-5: Ngun lí module L298N Robot tìm đường mê cung Trang 13/22 3.4 Hình ảnh thi cơng phần cứng 3.4.1 Hình ảnh mạch in Hình 3-7: Hình ảnh 3D board mạch Hình 3-8: Hình ảnh board mạch in Robot tìm đường mê cung Trang 14/22 Hình 3-9: Hình ảnh 3D Module L298N Robot tìm đường mê cung Trang 15/22 Hình 3-10: Hình ảnh board mạch in Module L298N Robot tìm đường mê cung Trang 16/22 3.4.2 Hình ảnh thực tế mơ hình Hình 3-11: Hình ảnh board mạch thực tế Robot tìm đường mê cung Trang 17/22 CHƯƠNG NHẬN XÉT 4.1 Nhận xét Mơ hình Robot bám tường trái với tốc độ chậm Nếu chạy nhanh robot xử lí khơng kịp, thuật tốn chưa tối ưu Robot tìm đường mê cung Trang 18/22 CHƯƠNG KẾT LUẬN 5.1 Kết luận Sau thực đồ án em rút nhiều kinh nghiệm làm thực tế mơ hình hiểu rõ Gặp nhiều sai sót để rút kinh nghiệm tránh sai sót cho lần sau 5.2 Hướng phát triển Cần xử lí tối ưu, phát triển góc quét ổn định chạy tốc độ cao TÀI LIỆU THAM KHẢO Tiếng Việt: [1] http://arduino.vn/reference Tiếng Anh: [2] https://www.arduino.cc/en/Reference/ [3] https://wikipedia.org/wiki [4] http://umpippo.robotica.eng.br/Documentos/95_icar.pdf [5] http://www.cs.cmu.edu/~tyata/Abstract/ICRA98.pdf\ [6] ... đường bao quanh mê cung, cách dò tay lên tường mê cung người đảm bảo khơng bị lạc tìm lối có lối dường bao; khơng có quay trở lại lối vào qua tất đường mê cung lần Robot tìm đường mê cung Trang 2/22... lí mơ Robot tìm đường mê cung Trang 4/22 2.3 Sơ đồ giải thuật Hình 2-3: Lưa đồ thuật tốn chương trình Robot tìm đường mê cung Trang 5/22 Trường hợp 1: Robot song song với tường Hình 2-4: Robot. .. L298N Robot tìm đường mê cung Trang 15/22 Hình 3-10: Hình ảnh board mạch in Module L298N Robot tìm đường mê cung Trang 16/22 3.4.2 Hình ảnh thực tế mơ hình Hình 3-11: Hình ảnh board mạch thực tế Robot