#define HC_TRIG 2 #define HC_ECHO 3 unsigned long duration; uint16_t distance; void setup() { Serial.begin(9600); pinMode(HC_TRIG, OUTPUT); pinMode(HC_ECHO, INPUT); digitalWrite(HC_TRIG, LOW); } void loop() { digitalWrite(HC_TRIG, LOW); delayMicroseconds(2); digitalWrite(HC_TRIG, HIGH); delayMicroseconds(10); digitalWrite(HC_TRIG, LOW); // Timeout of 30,000 µs // (about 5 metres) duration = pulseIn(HC_ECHO, HIGH, 30000); if (duration == 0) { Serial.println("Distance: Out of Range!"); } else { distance = duration / 58; Serial.print("Distance = "); Serial.print(distance); Serial.println(" cm"); } delay(100); }