const int Trig = 4; const int Echo = 5; void setup() { Serial.begin(115200); pinMode(Trig, OUTPUT); pinMode(Echo, INPUT); } void loop() { int cm = ping(Trig, Echo); Serial.print(""); Serial.println(cm); delay(1000); } int ping(int Trig, int Echo) { long duration, distanceCm; digitalWrite(Trig, LOW); delayMicroseconds(4); digitalWrite(Trig, HIGH); delayMicroseconds(10); digitalWrite(Trig, LOW); dur = pulseIn(Echo, HIGH); distanceCm = dur * 10 / 294/ 2; return dist; }