ultrasonic hcsr04 3 level

 

/*-----------------------------------------------------

'    

'     TRIG --> Pin 7

'     ECHO --> Pin 6

'     Baud Rate 9600 bps

'     asun86.com

'-----------------------------------------------------*/

 

 

//pin Ultrasonik

#define trigPin 7

#define echoPin 6

 

#define ledAman 8

#define led1 9

#define led2 10

#define led3 11

 

 

 

void setup() {

  Serial.begin (9600);

  pinMode(trigPin, OUTPUT);

  pinMode(echoPin, INPUT);

 

  pinMode(ledAman, OUTPUT);

  pinMode(led1, OUTPUT);

  pinMode(led2, OUTPUT);

  pinMode(led3, OUTPUT);

 

}

 

void loop() {

  long duration, distance;

  digitalWrite(trigPin, LOW);

  delayMicroseconds(2);

  digitalWrite(trigPin, HIGH);

  delayMicroseconds(10);

  digitalWrite(trigPin, LOW);

  duration = pulseIn(echoPin, HIGH);

  distance = (duration/2) / 29.1;

 

 

  if (distance >= 16)

  {

    digitalWrite(ledAman, HIGH);

      digitalWrite(led1, LOW);

      digitalWrite(led2, LOW);

      digitalWrite(led3,LOW);

  }

  else {

    digitalWrite(ledAman,LOW);

  }

 

  if (distance <= 15)

  {

      digitalWrite(led1, HIGH);

      digitalWrite(led2, LOW);

      digitalWrite(led3,LOW);

  }

 

  if (distance < 10) {

      digitalWrite(led2, HIGH);

      digitalWrite(led1, LOW);

      digitalWrite(led3,LOW);     

  }

 

  if (distance < 5) {

    digitalWrite(led3, HIGH);

    digitalWrite(led2, LOW);

    digitalWrite(led1, LOW);

}

 

  delay(500);

}