const int trigPin = 7;
const int echoPin = 8;
void setup() {
  // put your setup code here, to run once:
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(9, OUTPUT);
pinMode(2, OUTPUT);
pinMode(3, OUTPUT);
pinMode(4, OUTPUT);
pinMode(5, OUTPUT);
pinMode(6, OUTPUT);
pinMode(11, OUTPUT);
pinMode(12, OUTPUT);
pinMode(13, OUTPUT);
Serial.begin(9600);
}

void loop() {
  // put your main code here, to run repeatedly:


int distance = 0;
//Serial.println("Distance: " +  String(distance) + " cm");

int timer_red = 15;
int timer_orange = 5;
int timer_green = 15;
int color_holder = 0;


for(timer_red; timer_red > 0; timer_red--)
{
  digitalWrite(9, HIGH);
  digitalWrite(2, LOW);
  digitalWrite(3, LOW);
  digitalWrite(4, LOW);
  digitalWrite(5, LOW);
  digitalWrite(6, HIGH);
  color_holder = 1;
  if(color_holder == 1)
  {
    digitalWrite(trigPin, LOW);
    delayMicroseconds(2);
    digitalWrite(trigPin, HIGH);
    delayMicroseconds(10);
    digitalWrite(trigPin, LOW);
    long duration = pulseIn(echoPin,HIGH);
    distance = duration * 0.0343 / 2;
    Serial.println("Distance: " +  String(distance) + " cm");
    if(color_holder == 1 && distance <= 10)
    {

      digitalWrite(11, LOW);
      digitalWrite(12, LOW);

      for(int police = 0; police != 2; police++)
      {

        if(police % 2 != 0)
        {
          digitalWrite(11, HIGH);
          digitalWrite(12, LOW);
          tone(13, 50);
          delay(1000);
          noTone(13);
          delay(100);
          delay(500);
          
        }
        else
        {
          digitalWrite(11, LOW);
          digitalWrite(12, HIGH);
          delay(500);
        }
      }
    }
    else{
      digitalWrite(11, LOW);
      digitalWrite(12, LOW);
    }
  }
  Serial.println("Red Timer: " + String(timer_red));
  delay(1000);

  if(timer_red == 1)
  {
    digitalWrite(9, LOW);
    digitalWrite(2, LOW);
    digitalWrite(3, LOW);
    digitalWrite(4, LOW);
    digitalWrite(5, LOW);
    digitalWrite(6, LOW);
    digitalWrite(11, LOW);
    digitalWrite(12, LOW);
  }

}

for(timer_orange; timer_orange > 0; timer_orange--)
{
  digitalWrite(9, LOW);
  digitalWrite(2, HIGH);
  digitalWrite(3, LOW);
  digitalWrite(4, LOW);
  digitalWrite(5, HIGH);
  digitalWrite(6, LOW);
  color_holder = 1;
  if(color_holder == 1)
  {
    digitalWrite(trigPin, LOW);
    delayMicroseconds(2);
    digitalWrite(trigPin, HIGH);
    delayMicroseconds(10);
    digitalWrite(trigPin, LOW);
    long duration = pulseIn(echoPin,HIGH);
    distance = duration * 0.0343 / 2;
    Serial.println("Distance: " +  String(distance) + " cm");
    if(color_holder == 1 && distance <= 10)
    {

      digitalWrite(11, LOW);
      digitalWrite(12, LOW);

      for(int police = 0; police != 2; police++)
      {

        if(police % 2 != 0)
        {
          digitalWrite(11, HIGH);
          digitalWrite(12, LOW);
          delay(500);
          tone(13, 50);
          delay(1000);
          noTone(13);
          delay(100);
          delay(500);
          
        }
        else
        {
          digitalWrite(11, LOW);
          digitalWrite(12, HIGH);
          delay(500);
        }
      }
    }
    else{
      digitalWrite(11, LOW);
      digitalWrite(12, LOW);
    }
  }
  Serial.println("Orange Timer: " + String(timer_orange));
  delay(1000);

  if(timer_orange == 1)
  {
    digitalWrite(9, LOW);
    digitalWrite(2, LOW);
    digitalWrite(3, LOW);
    digitalWrite(4, LOW);
    digitalWrite(5, LOW);
    digitalWrite(6, LOW);
    digitalWrite(11, LOW);
    digitalWrite(12, LOW);
  }
}

for(timer_green; timer_green > 0; timer_green--)
{
  digitalWrite(9, LOW);
  digitalWrite(2, LOW);
  digitalWrite(3, HIGH);
  digitalWrite(4, HIGH);
  digitalWrite(5, LOW);
  digitalWrite(6, LOW);
  color_holder = 3;

  if(color_holder == 3)
  {
    digitalWrite(trigPin, LOW);
    delayMicroseconds(2);
    digitalWrite(trigPin, HIGH);
    delayMicroseconds(10);
    digitalWrite(trigPin, LOW);
    long duration = pulseIn(echoPin,HIGH);
    distance = duration * 0.0343 / 2;
    Serial.println("Distance: " +  String(distance) + " cm");
    if(color_holder == 3 && distance >= 100)
    {

      digitalWrite(11, LOW);
      digitalWrite(12, LOW);

      for(int police = 0; police != 2; police++)
      {

        if(police % 2 != 0)
        {
          digitalWrite(11, HIGH);
          digitalWrite(12, LOW);
          delay(500);
          tone(13, 50);
          delay(1000);
          noTone(13);
          delay(100);
          delay(500);
          
        }
        else
        {
          digitalWrite(11, LOW);
          digitalWrite(12, HIGH);
          delay(500);
        }
      }
    }
    else{
      digitalWrite(11, LOW);
      digitalWrite(12, LOW);
    }
  }
  Serial.println("Green Timer: " + String(timer_green));
  delay(1000);


  if(timer_green == 3)
  {
    digitalWrite(9, LOW);
    digitalWrite(2, LOW);
    digitalWrite(3, LOW);
    digitalWrite(4, LOW);
    digitalWrite(5, LOW);
    digitalWrite(6, LOW);
    digitalWrite(11, LOW);
    digitalWrite(12, LOW);
  }
}
}