Étape 4: programme :
Code pour un dispositif d’aide de déficience visuelle ultrasonique open source
const int TRIG = 8 ;
const int ECHO = 7 ;
const int BUZZ = 5 ;
const int LED1 = 12 ;
const int LED2 = 13 ;
void setup() {}
pinMode (TRIG, sortie) ;
pinMode (entrée, ECHO) ;
pinMode (BUZZ, sortie) ;
pinMode (LED1, sortie) ;
pinMode (LED2, sortie) ;
Serial.Begin(9600) ;
}
void loop() {}
longue durée, pouces, cm ;
digitalWrite (TRIG, faible) ;
delayMicroseconds(2) ;
digitalWrite (TRIG, élevé) ;
delayMicroseconds(10) ;
digitalWrite (TRIG, faible) ;
durée = pulseIn (ECHO, élevé) ;
po = Durée / 74 / 2 ;
cm = durée / 29 / 2 ;
Serial.Print(inches) ;
Serial.Print ("in") ;
Serial.Print(cm) ;
Serial.Print("cm") ;
Serial.println() ;
Si {(cm < 80)
ton (BUZZ, (80 - cm) * 75, 25) ;
digitalWrite (LED1, élevé) ;
digitalWrite (LED2, faible) ;
} else {}
ton (BUZZ, 0, 50) ;
digitalWrite (LED1, faible) ;
digitalWrite (LED2, élevé) ;
}
Delay(100) ;
}