Почему при необходимости загорается зеленый свет?

Question

Итак, вот чего я пытаюсь достичь, когда ультразвуковой датчик обнаруживает расстояние меньше определенного значения, тогда свет должен стать зеленым, позволяя движению транспорта.

Вот код

       int pir = 2;
int rojo = 12;
int amarillo = 11;
int verde = 10;
int led = 3;
const int pingPin2 = 9; // Trigger Pin of Ultrasonic Sensor
const int echoPin2 = 8;
void setup() {
  pinMode(pir, INPUT);
  pinMode(led, OUTPUT);
  Serial.begin(9600);
  pinMode(verde, OUTPUT); //It declares the green pin as output 
  pinMode(amarillo, OUTPUT); //It declares the yellow pin as output 
  pinMode(rojo, OUTPUT);
}

void loop() {
  int distance2;
  distance2 = calculatedistance(pingPin2, echoPin2);
  if (distance2 <= 0.1) {
    digitalWrite(rojo, LOW);
    digitalWrite(verde, HIGH);
    delay(500);
  }

  digitalWrite(verde, HIGH); //It turns on the green led 
  delay(15000); //wait 15 seconds 
  digitalWrite(verde, LOW); //It turns off the green led 
  delay(250); //wait 0.25 seconds

  digitalWrite(amarillo, HIGH); //It turns on the yellow led 
  delay(3000); //wait 3 seconds 
  digitalWrite(amarillo, LOW); //It turns off the yellow led 
  delay(250); //wait 0.25 seconds
  int val = digitalRead(pir);
  Serial.println(val);
  int val1 = digitalRead(rojo);
  digitalWrite(rojo, HIGH); //It turns the red led 

  unsigned long int redStartTime = millis();
  while (millis() - redStartTime <= 15000) {
    delay(100);
    int val = digitalRead(pir);
    if (val == HIGH) {
      digitalWrite(led, HIGH);

    } else {
      digitalWrite(led, LOW);
    }
  }
  digitalWrite(rojo, LOW);
}

long microsecondsToCentimeters(long microseconds) {
  return microseconds / 29 / 2;
}
int calculatedistance(int pingPin, int echoPin) {
  long duration, inches, cm, meter;
  pinMode(pingPin, OUTPUT);
  digitalWrite(pingPin, LOW);
  delayMicroseconds(2);
  digitalWrite(pingPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(pingPin, LOW);

  pinMode(echoPin, INPUT);
  duration = pulseIn(echoPin, HIGH);

  cm = microsecondsToCentimeters(duration);
  meter = cm / 100;
  return meter;
}

Может ли кто-нибудь помочь мне добиться желаемых результатов. Также еще один вопрос, если я хочу проверить значение переменной с помощью printf или чего-то подобного в этой среде, как мне это сделать? заранее спасибо

Answer 1

Как увидеть printf? Учитывая отсутствие экрана. Вы можете записывать (т.е. регистрировать) вывод в файл, предполагая, что у вас есть файловая система.

Ваш вопрос: Посмотрите на "цикл пустоты"

      distance2 = calculatedistance(pingPin2, echoPin2);
if (distance2 <= [CERTAIN_AMOUNT])
{
    digitalWrite(rojo, LOW);
    digitalWrite(verde, HIGH);
    delay(500);
}