7. Bài 5: Hệ thống cảnh báo tốc độ

Mục tiêu

Trong thành phố, di chuyển vượt tốc độ là hành vi vi phạm. Vì vậy, thiết bị đo tốc độ rất cần thiết để kiểm tra tốc độ chạy của xe. Nếu tốc độ của xe vượt mức quy định, hệ thống sẽ hiển thị số lần vi phạm và giá trị vận tốc lớn nhất của xe lên màn hình LCD.

Kết nối

Cảm biến khoảng cách (P3/P6)
Màn hình LCD OLED (I2C1)
Kết nối

Lắp ráp mô hình

Giới thiệu khối lệnh

Cách tính vận tốc

Để tính vận tốc xe, chúng ta sẽ sử dụng công thức sau:

v = S / t

Trong đó:

v là vận tốc
S là quãng đường
t là thời gian

Ta sẽ tiến hành đo khoảng cách đến xe trong 2 mốc thời gian khác nhau, từ đó tính ra quãng đường xe đi được:

S = Khoảng cách 1 - Khoảng cách 2

Thời gian di chuyển = thời gian giữa 2 mốc thời gian

Viết chương trình

Tạo 3 biến để chứa giá trị tốc độ, khoảng cách 1 và khoảng cách 2. Gán giá trị 0 cho các biến này
Khởi tạo cảm biến khoảng cách tại cổng P10/P13 và màn hình LCD:
Nếu phát hiện có xe đến gần (khoảng cách < 40cm), tiến hành đo khoảng cách tại 2 thời điểm cách nhau 1 giây và lưu giá trị vào biến tương ứng:
Lồng điều kiện nếu xe đang tiến lại gần (khoảng cách 2 < khoảng cách 1) vào bên trong:
Áp dụng công thức tính vận tốc vào và gán giá trị tính được vào biến tốc độ (thời gian là 1 giây):
Nếu tốc độ quá hạn mức quy định (15), ta tiến hành bật đèn LED thành màu đỏ và xóa màn hình LCD:
In dòng chữ “Vuot qua toc do” và giá trị tốc độ lên màn hình LCD (lấy thông tin từ biến tốc độ):
Lặp lại 2 nốt nhạc A5 và E3 liên tục 3 lần để báo hiệu:
Nếu tốc độ không vượt mức 15, bật đèn LED thành màu xanh và hiển thị giá trị tốc độ lên màn hình LCD
Tạm dừng chương trình trong 2 giây để xe rời khỏi
Tạm dừng toàn bộ chương trình trong 50ms ở cuối chương trình

Chương trình mẫu

Hệ thống cảnh báo tốc độ: Tại đây