Система освещения светофора с датчиками

Я пытаюсь создать систему светофора с ультразвуковым датчиком дальности, а также светозависимым резистором. Я пытаюсь сделать так, чтобы по умолчанию было 2 секунды красного света, 1 секунда желтого, 2 секунды зеленого, затем 1 секунда желтого, затем это будет повторяться до тех пор, пока не произойдет что - то еще-у меня все работает нормально.

Тогда я хочу 2 разных состояния.

Тот, где, если что-то поставляется с датчиком 10 см, то раздастся звуковой сигнал, и желтый индикатор должен мигать 10 раз с интервалом 0,1 мс. Когда объект удаляется, он должен вернуться к настройкам по умолчанию.

Во-вторых, я хочу, чтобы, когда LDR обнаружит, что индикатор упал ниже определенного уровня, красный индикатор включится и будет гореть до тех пор, пока объект не приблизится к датчику. Когда объект находится рядом с датчиком, он должен затем выключить красный свет и включить зеленый свет.

Вот весь код, который у меня есть до сих пор, и я не могу понять, почему он не работает. Любая помощь будет признательна Спасибо

    #define ECHOPIN 3
    #define TRIGPIN 2
    float distance;
    long distancecm;


    int RED = 13; 
    int YELLOW = 12;
    int GREEN = 11;

    int piezoPin = 8;

    int sensorpin = A0;
    int sensorvalue = 0;


    void setup() {
      pinMode(RED, OUTPUT);
      pinMode(YELLOW, OUTPUT);
      pinMode(GREEN, OUTPUT);
      Serial.begin(9600);
      pinMode(ECHOPIN, INPUT);
      pinMode(TRIGPIN, OUTPUT);
      }


    void distancesensor()
      {
      digitalWrite(TRIGPIN, LOW);
      delayMicroseconds(2);
      digitalWrite(TRIGPIN,HIGH);
      delayMicroseconds(10);
      digitalWrite(TRIGPIN,LOW);
      distance = pulseIn(ECHOPIN, HIGH); 
      distancecm = distance/29.1/2;
      if (distancecm <=10);
        for (int j=1; j<=5; j=j+1)
        {
         tone(piezoPin, 1, 500);
         digitalWrite(YELLOW, HIGH);
         delay(100);
         break;
         }
    }


    void lightsensor()
      {
      sensorvalue = analogRead(sensorpin);
      if (sensorvalue > 500)
        digitalWrite(RED,HIGH);
        digitalWrite(TRIGPIN, LOW);
        delayMicroseconds(2);
        digitalWrite(TRIGPIN,HIGH);
        delayMicroseconds(10);
        digitalWrite(TRIGPIN,LOW);
        distance = pulseIn(ECHOPIN, HIGH);
        distance = distance/58;
        while (distance >10)
          digitalWrite(RED,LOW);
          digitalWrite(GREEN,HIGH);
          digitalWrite(TRIGPIN, LOW);
          delayMicroseconds(2);
          digitalWrite(TRIGPIN,HIGH);
          delayMicroseconds(10);
          digitalWrite(TRIGPIN,LOW);
          distance = pulseIn(ECHOPIN, HIGH);
          distance = distance/58;


       }




    void loop() {
      distancesensor;
      lightsensor;
      digitalWrite(RED, HIGH);          //RED ON
      delay(2000);                      //WAIT 2 SECONDS
      digitalWrite(RED, LOW);           //RED OFF  
      delay(200);
      distancesensor;
      lightsensor;
      digitalWrite(YELLOW, HIGH);       //YELLOW ON
      delay(1000);                      //WAIT 1 SECOND
      digitalWrite(YELLOW, LOW);        //YELLOW OFF
      delay(200);
      distancesensor;
      lightsensor;
      digitalWrite(GREEN, HIGH);        //GREEN ON  
      delay(2000);                      //WAIT 2 SECONDS
      digitalWrite(GREEN, LOW);         //GREEN OFF
      delay(200); 
      distancesensor;
      lightsensor;
      digitalWrite(YELLOW, HIGH);       //YELLOW ON
      delay(1000);                      //WAIT 1 SECOND
      digitalWrite(YELLOW, LOW);        //YELLOW OFF
      delay(200);
      distancesensor;
      lightsensor;
      //REPEAT
      }