Franzls Technik Forum

Code: Alles auswählen

/*    Gleiskontakt mit HC-SR04 Ultraschallsensor
 *     
 */


long dauer=0; 
long entfernung=0; 

int ledgruen  =3; 
int ledrot    =13; 
int trigger   =9;               // orange
int echo      =8;               // grün

void setup() {
  Serial.begin (9600);          // Monitor starten
  
  pinMode(ledgruen, OUTPUT);
  pinMode(ledrot, OUTPUT);
  
  pinMode(trigger, OUTPUT);     
  pinMode(echo, INPUT);         
}

void loop() {
  digitalWrite(trigger, LOW); 
  delay(5); 
  
  digitalWrite(trigger, HIGH); 
  delay(10);
  
  digitalWrite(trigger, LOW);
  
  dauer = pulseIn(echo, HIGH); 
  entfernung = (dauer/2) * 0.03432 ; 
  
  if (entfernung >  1000 || entfernung <  0) {    
    Serial.print("Ungenauer Wert: "); 
    Serial.print(entfernung); 
    Serial.println(" cm");
    
    digitalWrite(ledgruen, LOW);
    digitalWrite(ledrot, LOW);
    delay(1000); 
    
  } else {
    
    Serial.print(entfernung); 
    Serial.println(" cm");
  
    if (entfernung > 20) {
      digitalWrite(ledgruen, HIGH);
      digitalWrite(ledrot, LOW);
      delay(1000);  
           
    } else if (entfernung < 20) {
      
      digitalWrite(ledgruen, LOW);
      digitalWrite(ledrot, HIGH);
      delay(500); 
    }
  } 
}