int PING = 2; int LED = 13; int hoechstgeschwindigkeit = 5; // erlaubte Höchstgeschwindigkeit in cm/s void setup () { Serial.begin(9600); pinMode(13, OUTPUT); } void loop() { pinMode(PING, OUTPUT); // Entfernungsmessung Nr. 1 digitalWrite(PING, LOW); delay(2); digitalWrite(PING, HIGH); delay(5); digitalWrite(PING, LOW); pinMode(PING, INPUT); int dauer1 = pulseIn(PING, HIGH); Serial.print("Entfernung 1 zum Objekt: "); int entfernung1 = 0.0343 * dauer1 / 2; Serial.print(entfernung1); Serial.println(" cm"); delay(500); pinMode(PING, OUTPUT); // Entfernungsmessung Nr. 2 digitalWrite(PING, LOW); delay(2); digitalWrite(PING, HIGH); delay(5); digitalWrite(PING, LOW); pinMode(PING, INPUT); int dauer2 = pulseIn(PING, HIGH); Serial.print("Entfernung 2 zum Objekt: "); int entfernung2 = 0.0343 * dauer2 / 2; Serial.print(entfernung2); Serial.println(" cm"); int geschwindigkeit = (entfernung1 - entfernung2) / 0.5; // v = s / t Serial.print(geschwindigkeit); Serial.print(" cm/s --> "); if (geschwindigkeit <= hoechstgeschwindigkeit) { Serial.println("Geschwindigkeit ok"); } else { Serial.println("Geschwindigkeit zu hoch"); digitalWrite(LED, HIGH); delay(1500); digitalWrite(LED, LOW); } Serial.println(); delay(4000); }