#define ECHOPIN 8
#define TRIGPIN 9
const int Buzz = A3;
#define pinverd 11
#define pintaronja 12
#define pinvermell 13
void setup() {
// put your setup code here, to run once:
Serial.begin(115200);
pinMode(TRIGPIN, OUTPUT);
pinMode(ECHOPIN, INPUT);
pinMode(pinverd, OUTPUT);
pinMode(pintaronja, OUTPUT);
pinMode(pinvermell, OUTPUT);
}
void loop() {
// put your main code here, to run repeatedly:
digitalWrite(TRIGPIN,LOW);
delayMicroseconds(2);
digitalWrite(TRIGPIN, HIGH);
delayMicroseconds(10);
float temps = pulseIn(ECHOPIN,HIGH);
int distancia = int (temps * 0.0343 / 2);
delay (800);
Serial.print("distancia en CM: ");
Serial.println(temps / 58);
if ((distancia<200) & (distancia>101))
{digitalWrite(pinverd, HIGH);
digitalWrite(pintaronja, LOW);
digitalWrite(pinvermell, LOW);
digitalWrite(Buzz, LOW);
Serial.print("SEGUR");}
if ((distancia<100) & (distancia>51))
{digitalWrite(pinverd, LOW);
digitalWrite(pintaronja, HIGH);
digitalWrite(pinvermell, LOW);
digitalWrite(Buzz, LOW);
Serial.print("COMPTE");}
if ((distancia<50) & (distancia>0))
{digitalWrite(pinverd, LOW);
digitalWrite(pintaronja, LOW);
digitalWrite(pinvermell, HIGH);
digitalWrite(Buzz, HIGH);
Serial.print("PERILL");}
delay(500);
}