#define echo 11
#define trig 12


#define piros 5
#define sarga1 4
#define sarga2 2
#define zold 3



void setup() {
  // put your setup code here, to run once:
  Serial.begin(9600);

  pinMode(echo, INPUT);
  pinMode(trig, INPUT);

  pinMode(piros, OUTPUT);
  pinMode(zold, OUTPUT);
  pinMode(sarga1, OUTPUT);
  pinMode(sarga2, OUTPUT);


}

void loop() {
  // put your main code here, to run repeatedly:
  digitalWrite(trig, LOW);
  delayMicroseconds(2);
  digitalWrite(trig, HIGH);
  delayMicroseconds(10);
  digitalWrite(trig, LOW);

int duration = pulseIn(echo,HIGH);

int tav = duration/58.2;
int kuszob = 10;

Serial.print(tav);


if(tav>(6) && tav<(14))
{
  digitalWrite(piros, LOW);
  digitalWrite(sarga1, LOW);
  digitalWrite(zold, HIGH);
  digitalWrite(sarga2, LOW);
}

else if (tav<20)
{
  digitalWrite(piros, HIGH);
  digitalWrite(sarga1, LOW);
  digitalWrite(zold, LOW);
  digitalWrite(sarga2, LOW);
}

else if(tav<(kuszob-4))
{
  digitalWrite(piros, LOW);
  digitalWrite(sarga1, HIGH);
  digitalWrite(zold, LOW);
  digitalWrite(sarga2, LOW);
}

else
{
  digitalWrite(piros, LOW);
  digitalWrite(sarga1, LOW);
  digitalWrite(zold, LOW);
  digitalWrite(sarga2, HIGH);
}
delay(300);

}