long duration,inches,cm;
const int trigPin=8;
const int echoPin=7;
int ledr = 5;
int ledb = 4;
int ledg = 2;
long dist=0;
void setup() {
// put your setup code here, to run once:
pinMode(ledb, OUTPUT);
pinMode(ledg, OUTPUT);
pinMode(ledr, OUTPUT);
pinMode(trigPin,OUTPUT);
pinMode(echoPin,INPUT);
Serial.begin(9600);
}
void loop() {
// put your main code here, to run repeatedly:
digitalWrite(trigPin,LOW);
delayMicroseconds(2);
digitalWrite(trigPin,HIGH);
delayMicroseconds(5);
digitalWrite(trigPin,LOW);
duration=pulseIn(echoPin,HIGH);
dist=duration/29/2;
cm=dist;
if(dist<=50){
digitalWrite(ledr,LOW);
digitalWrite(ledg,HIGH);
digitalWrite(ledb,HIGH);
Serial.println(dist);
}
else if(dist<=100){
digitalWrite(ledb,LOW);
digitalWrite(ledr,HIGH);
digitalWrite(ledg,HIGH);
Serial.println(dist);
}
else{
digitalWrite(ledg,LOW);
digitalWrite(ledr,HIGH);
digitalWrite(ledb,HIGH);
Serial.println(dist);
}
delay(100);
}
|
