Proyecto L.U.V.I.A (ayuda a bajo costo discapacidad Visual ultrasónico) (4 / 6 paso)

Paso 4: programa:

const int TRIG = 8;
const int eco = 7;
const int BUZZ = 5;
const int LED1 = 12;
const int LED2 = 13;

void setup() {}
pinMode (TRIG, salida);
pinMode (eco, entrada);
pinMode (BUZZ, salida);
pinMode (LED1, salida);
pinMode (LED2, salida);
Serial.Begin(9600);
}

void loop() {}
larga duración, pulgadas, cm;

digitalWrite (TRIG, LOW);
delayMicroseconds(2);
digitalWrite (TRIG, alto);
delayMicroseconds(10);
digitalWrite (TRIG, LOW);

duración = pulseIn (eco, alta);
pulgadas = duración / 74 / 2;
cm = duración / 29 / 2;

Serial.Print(inches);
Serial.Print ("in");
Serial.Print(cm);
Serial.Print("cm");
Serial.println();
Si (cm < 80) {}
tono (BUZZ, (80 - cm) * 75, 25);
digitalWrite (LED 1, elevado);
digitalWrite (LED2, LOW);
} else {}
tono (BUZZ, 0, 50);
digitalWrite (LED 1, bajo);
digitalWrite (LED2, alto);
}

Delay(100);
}