#define TRG 10 #define ECH 11 #define HIGHTIME 10 void setup() { Serial.begin(9600); pinMode(TRG, OUTPUT); pinMode(ECH, INPUT); } void loop() { int diff; float dis; digitalWrite(TRG, HIGH); delayMicroseconds(HIGHTIME); digitalWrite(TRG, LOW); diff = pulseIn(ECH, HIGH); dis = (float)diff * 0.01715; Serial.print(dis); Serial.println(""); delay(100); }