#define trigPin 7
#define echoPin 6
#define led1 8
#define led2 10
void setup() {
Serial.begin (9600); //Khởi tạo chương trình
pinMode(trigPin, OUTPUT); //Cài đặt pin cho TrigPinn
pinMode(echoPin, INPUT); //Cài đặt pin cho Echopin
pinMode(led1, OUTPUT); //Cài đặt pin cho led
pinMode(led2, OUTPUT); //Cài đặt pin cho led
}
void loop() {
long duration, distance; //Khởi tạo biến
digitalWrite(trigPin, HIGH); //Bật sóng âm
delayMicroseconds(10); //Delay 10 micro giây
digitalWrite(trigPin, LOW); //Tắt sóng âm
duration = pulseIn(echoPin, HIGH); //Tính thời gian sóng âm di chuyển
distance = duration / 58; //Tính khoảng cách dựa vào thời gian sóng âm di chuyển
if (distance < 120) //Điều kiện nếu mực nước sông < 120cm thì bật đèn xanh
{
digitalWrite(led1, HIGH);
digitalWrite(led2, LOW);
}
else //Ngược lại thì bật đèn đỏ cảnh báo nguy hiểm
{
digitalWrite(led2, HIGH);
digitalWrite(led1, LOW);
}
delay(500); //delay 0,5 giây
}