Sketch Sensore ultrasuoni by Gabry1609 for Chimera Revo

int trigger = 3;
int echo = 2;
int rosso  = A1;
int giallo = A2;
int verde = A0;
void setup() {
pinMode( trigger, OUTPUT );
pinMode( echo, INPUT );
pinMode( rosso, OUTPUT );
pinMode( giallo, OUTPUT );
pinMode( verde, OUTPUT );
Serial.begin( 9600 );
Serial.println( "Sensore ultrasuoni: ");
}
void loop() {
//settiamo a low l'uscita del trigger
digitalWrite( trigger, LOW );
//inviamo un impulso di 10ms sul trigger
digitalWrite( trigger, HIGH );
delayMicroseconds( 10 );
//risettiamo a low l'uscita del trigger
digitalWrite( trigger, LOW );
long duration = pulseIn( echo, HIGH );
long r = 0.034 * duration / 2;
Serial.print( "durata: " );
Serial.print( duration );
Serial.print( " , " );
Serial.print( "distanza: " );
//dopo 38ms siamo fuori portata dal sensore
if( duration > 38000 )  Serial.println( "distanza eccessiva o fuori portata");
else { Serial.print( r ); Serial.println( "cm" );}
if( r > 5) digitalWrite(giallo, HIGH);
else { digitalWrite(rosso, HIGH);}
if( r > 30) digitalWrite(verde, HIGH), digitalWrite(giallo, LOW), digitalWrite(rosso, LOW);
delay( 150 );
digitalWrite(rosso, LOW);
digitalWrite(giallo, LOW);
digitalWrite(verde, LOW);
}