CHƯƠNG 1: TỔNG QUAN 1.1 Mục tiêu thiết kế Thiết kế mobile robot chạy trên sa bàn bám line với độ ổn định tốt, hoàn thành sa bàn đúng yêu cầu (sa bàn được cho trước hình dạng, các kích thước) và tốc độ tối đa được cho tùy vào mục đích robot. Hình dạng sa bàn: Hình 1.1 Sa bàn line yêu cầu 1.2 Sơ lược về xe dò line Xe dò line – xe dò đường (Line following Robot) là một loại robot di động, di chuyển bằng chuyến động quay của các bánh xe, đảo hướng bằng các nguyên lý đặc biệt và bám theo một đường line nhất định được dáng trên sa bàn. Xe dò line là một ứng dụng nhỏ về một hệ thống (máy) cơ điện tử, nhưng nó đóng vai trò là cơ sở cho việc các sản phẩm cơ điện có quy mô lớn hơn như: robot vận chuyển hàng hóa trong công nghiệp AGV, robot tránh vật cản… Đối với sinh viên như chúng em, đây là một đề tài hấp dẫn và thiết thực, chi phí rẻ, cơ hội thực hành tốt, từ đó giúp tạo nền tảng thực nghiệm nghiên cứu và chế tạo cho bản thân ở các đề tài sau. 15 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat DO.TRUOC Với mục tiêu thiết kế ban đầu ở phần 1.1 và việc tìm hiểu định hướng thiết kế chế tạo xe dò line, nhóm chúng em định hướng thiết kế xe đua dò line.
Dưới đây là một số mẫu xe đua dò line do nhóm tìm hiểu.3 Một số thiết kế điển hình 1.1 Tình hình nghiên cứu trong nước Xe đua dò line: cuộc thi MCR (Micom Rally Car) Đại học Trà Vinh năm 2017 Hình 1.2 Xe đua dò line cuộc thi MCR Đại học Trà Vinh 2017 và sơ đồ nguyên lý Thông số kỹ thuật chính: - Motor trái và Motor phải: là hai động cơ DC dẫn động 2 bánh xe sau của xe. 16 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat DO.TRUOC - Motor lái: Một động cơ RC Servo làm nhiệm vụ bẻ lái 2 bánh xe trước của xe. - Modul H-Drive: Sử dụng IC chuyên dụng L298, nhận tín hiệu từ vi điều khiển và thực hiện chức năng điều khiển tốc độ 2 động cơ sau. - Tốc độ tối đa có thể đạt được: 1,6m/s.
- Modul vi điều khiển: Sử vi điều khiển thông dụng là PIC16F887 của hãng Microchip, chức năng nhận tín hiệu từ cảm biến dò line để điều khiển hai động cơ sau giúp xe chạy đúng hướng. - Modul cảm biến dò line: Sử dụng nguyên lý phản xả ánh xáng, và truyền tín hiệu vị trí của xe về cho vi điều khiển. Giải thuật cảm biến: so sánh. - Khối nguồn Pin: Sử dụng 2 nguồn điện DC là 5V (cung cấp cho vi điều khiển, cảm biến) và 12V (cung cấp cho động cơ).
- Khung xe làm bằng vật liệu mica và nhựa dẻo vì kích thước tối đa cho bề rộng của xe là 300 mm, bề cao là 150 mm, chiều dài, trọng lượng, và chất liệu của xe là tùy ý nên khung xe phải được thiết kế sao cho đảm bảo quy định này, ngoài ra xe không thể quá dài hoặc quá nặng làm ảnh hưởng đến tốc độ cũng như khả năng lái của xe khi vào cua. Nhận xét: o Ưu điểm: kết cấu 4 bánh giúp dễ lấy thăng bằng và khó bị lật, bánh lái phía trước giúp dễ dàng vào cua làm cho bán kính cua nhỏ. o Nhược điểm: 4 bánh sau dễ bị trượt khi vào cua vì 4 điểm tiếp xúc không cùng nằm trên một mặt phẳng.2 Tình hình nghiên cứu ngoài nước 1.1 CartisX04: Xe đua dò line về nhất cuộc thi Japanese Robotrace Contest 2014 17 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat DO.3 Hình ảnh thực tế và sơ đồ nguyên lý xe đua đội CartisX04 Thông số kỹ thuật chính: - Tốc độ tốt nhất để đảm bảo xe bám line tốt: v = 1. - Vi điều khiển: sử dụng STM32F103RE và dùng giải thuật điều khiển học đường giúp tăng tốc độ ở những lần chạy sau.
- Kết cấu: 2 cặp bánh dẫn động bởi 2 động cơ và 1 bánh lái ở phía trước: o 2 Động cơ dẫn động: Maxon DCX10L x 2; Tốc độ 6780 rpm, điện áp 12 V, dòng điện 0,682, Moment 2,05 mNm. o Động cơ điều khiển bánh trước Steering Motor: Maxon RE10. - Đường kính bánh xe: 25 mm. - Encoder: ENX 10 EASY loại 1024 count / rotation.
- Chiều dài 175 mm, Chiều rộng 153 mm, Khoảng cách 2 bánh 2 bên 130mm, Trọng tâm giữa 4 bánh cao 7 mm. - Gyro sensor (cảm biến góc quay) Invensense ISZ-650 x2 cái. - Cảm biến dò line: cảm biến hồng ngoại SHARP GP2S700 x6 cái chia thành 3 cặp đặt song song, được tính xấp xỉ theo trọng số (tài liệu PDF), Khoảng cách cảm biến và 18 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat DO.TRUOC sàn 3mm (datasheet), Kích thước cảm biến 4x3x2 mm, Che chắn bằng nhựa đen phía dưới màu xanh lá. - Pin Li-Polymer [1] 4.
Nhận xét: o Ưu điểm: kết cấu 4 bánh sau giúp dễ lấy thăng bằng và khó bị lật, bánh lái phía trước giúp dễ dàng vào cua làm cho bán kính cua nhỏ. Sử dụng cảm biến góc quay giúp tăng độ chính xác điều khiển. o Nhược điểm: 4 bánh sau dễ bị trượt khi vào cua, kết cấu cơ khí phức tạp.2 Chariot [2]: Về nhì cuộc thi LV Bots April line following.4 Hình ảnh thực tế và sơ đồ nguyên lý xe Chariot Thông số kỹ thuật chính: - Trọng lượng: 210 (gram). - Kích thước:145 ×90 ×70 mm - Kết cấu xe: 2 bánh sau chủ động (Bánh răng kim loại 35 – 115 - 5Dx30L mm, D = 30mm), 1 bánh trước tự lựa (D=9,5mm).
- Phần điện: Động cơ: DC Servo, cảm biến hồng ngoại gồm 6 sensor QTR-8RC. - Phần cứng điều khiển: vi điều khiển A- Start 32u4 Mini LV (MCU Atmega32u4), cấu trúc điều khiển tập trung, bộ điều khiển PID. - Nguồn: sử dụng bộ điều chỉnh điện áp 7,5 V D24V25F7. 19 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat DO.TRUOC - Vận tốc trung bình chạy trong cuộc đua là 1,17m/s.
- Vận tốc tối đa: 2 m/s. Mạch cảm biến QTR-8RC, QTR-8A Hình 1.5 Mạch cảm biến phản xạ QTR-8RC, QTR-8A Thông số kỹ thuật Kích thước: 2,95 "x 0,5" x 0,125 ". Điện áp hoạt động: 3. Cung cấp hiện tại: 100 mA.
Định dạng đầu ra: 8 tín hiệu tương thích I / O kỹ thuật số có thể được đọc dưới dạng xung cao được định thời. Khoảng cách phát hiện tối ưu: 0,125 "(3 mm). Khoảng cách giữa 2 cảm biến liên tiếp: 0,375 "(9,525 mm). Trọng lượng không có chân cắm: 0,11 oz (3,09 g).
Nhận xét: o Ưu điểm: Kết cấu đơn giản, mô hình động học đơn giản, dễ điều khiển. Tiếp xúc 3 điểm nên khả năng bám đường tốt. 20 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat DO.TRUOC Khi chế tạo chỉ quan tâm độ đồng trục của 2 bánh xe sau. Trọng tâm xe gần 2 bánh chủ động giúp moment quán tính giảm khi xe qua cua hạn chế sự trượt.
o Nhược điểm: Dễ lật khi vào cua, cần tính toán Chuyển động đảo hướng theo nguyên lý 2 bánh vi sai nên dễ bị trượt khi vào cua ở tốc độ cao.3 Robot Pika của đội Mechatron vô địch Cyberbot 2015 tại Poznan Hình 1.6 Hình ảnh thực tế và sơ đồ nguyên lý xe đua đội Robot Pika Thông số kỹ thuật chính: - Kích thước: 280x180x50 (mm). - Kết cấu: 4 bánh: 2 bánh cao su dẫn động bởi 2 động cơ (D=34mm), 2 bánh mắt trâu đặt ở dãy cảm biến có đường kính nhỏ hơn nhiều nên có thể đảm bảo 2 bánh sau luôn tiếp xúc mặt đất (1 trong 2 bánh trước hở). - Vận tốc tối đa: 2,7 (m/s), vận tốc trung bình: 1,7 (m/s). Nhận xét: o Ưu điểm: xe cân bằng tốt khó bị lật khi vào cua.
o Nhược điểm: 4 bánh tiếp xúc mặt đường không tốt.4 Xe dò line FireBall 21 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat DO.7 Hình ảnh thực tế và sơ đồ nguyên lý xe đua đội FireBall Thông số kỹ thuật chính: - Kích thước 182 ×130 ×60mm. - Đường kính bánh xe: 60mm. - Vận tốc trung bình: 1,5m/s. Vận tốc tối đa 3m/s.
- Cảm biến: 8x cảm biến hồng ngoại QTR-8RC. - Khoảng cách giữa 2 cảm biến 9,525mm. Nhận xét: o Ưu điểm: Khi vào cua khó lật hơn xe 3 bánh, 4 bánh chuyển động nên cua gấp dễ dàng. o Nhược điểm: Xảy ra hiện tượng trượt bánh khi cua, khó đảm bảo tiếp xúc giữa 4 điểm với mặt đường.3 Tiêu chí chung của các nghiên cứu tham khảo - Vận tốc các xe nằm trong khoảng: 1,5 đến 4,2 m/s - Kích thước nhỏ hơn: 280x180x40 - Trọng lượng nhỏ hơn: 500g 22 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat DO.4 Đầu bài thiết kế Thiết kế xe đua dò line chạy trên sa huỳnh có quỹ đạo cho trước, với các thông số: Vận tốc tối đa (nằm trong khoảng vận tốc thường đạt được với mobile robot bám line ví dụ trong phần 1.
Bán kính cong tối thiểu: Rmin = 500mm. Sai số bám line trên đoạn thẳng và cong: emax = ± 18 mm. Các tiêu chí phụ để phù hợp với đầu bài được nêu ở phần 1. Tuy nhiên trong quá trình thực nghiệm, vì điều kiện không cho phép nên động cơ nhóm mua không đáp ứng được điều kiện có thể điều khiển được ở tốc độ 2m/s (thời gian xác lập của động cơ lớn tsettling time = 0.13s), nên đầu bài được hiệu chỉnh: vmax = 0,7 m/s.
23 | P a g e TIEU LUAN MOI download : skknchat123@gmail.com moi nhat DO.TRUOC Tính toán sai số bám line: với giả thuyết ban đầu: Bề rộng đường line: 19 mm (Cách xác định khoảng cách giữa 2 cảm biến liên tiếp theo bề rộng line: Theo tài liệu [3]) - Bề rộng line là 19mm tương ứng với giá trị của khoảng cách giữa hai cảm biến quang liên tiếp được chọn là 12,5 mm. Nội suy tuyến tính suy ra khoảng cách tối đa giữa 2 cảm biến gần nhất để cảm biến có thể hoạt động tốt là: 13 mm. - Giả sử sử dụng: 7 cảm biến. Bề rộng của dãy cảm biến: > 13x6 = 78 mm.
Suy ra sai số lớn nhất giữa tâm xe với tâm cảm biến theo thuật toán là: e1 =78/2 = 36mm - Giả sử ta sử dụng thuật toán xấp xỉ theo trọng số thì sai số lớn nhất giữa tâm cảm biến theo thuật toán và tâm line là: e 2 = 2,6[3], suy ra sai số bám line lớn nhất là: 38,6 mm. Do đó điều một giá trị < 38,6mm.