Sử dụng cảm biến hồng ngoại, em hãy lập trình để robot di chuyển theo vạch đen trên nền nhà màu sáng
Bài 2. Sử dụng cảm biến hồng ngoại, em hãy lập trình để robot di chuyển theo vạch đen trên nền nhà màu sáng.
Đầu tiên ta cần lấy thông số để nhận biết khi nào các mắt bên trong và bên ngoài đường đen. Chúng ta sẽ chỉ cần dùng hai mắt ở giữa là A6 và A7 với các đường đơn giản.
Chương trình mẫu:
Sau đó chúng ta đo thông số khi các mắt nằm trong và ngoài đường đen rồi tính trung bình cho từng mắt. Ví dụ với 2 mắt A6, A7 sau:
Mắt | Trong đường đen | Ngoài đường đen | Giá trị trung bình |
A6 | 870 | 656 | 763 |
A7 | 903 | 701 | 802 |
Tiếp theo chúng ta tiến hành so sánh với giá trị trung bình vừa có được:
- Nếu mắt A6 > giá trị trung bình ⇒ Mắt A6 đang trong vạch đen và ngược lại.
- Nếu mắt A7 > giá trị trung bình ⇒ Mắt A7 đang trong vạch đen và ngược lại.
Chúng ta có hai mắt nên sẽ có 3 trường hợp xảy ra khi để robot trên vạch đen.
A6 | A7 |
Trong đường đen | Trong đường đen |
Ngoài đường đen | Trong đường đen |
Trong đường đen | Ngoài đường đen |
Bình luận