#Define EchoPin = 3; #Define TriggerPin = 4; #include SoftwareSerial mySerial(4, 3); // RX, TX void setup() { //pinMode(6,OUTPUT); // mySerial.begin(4800); pinMode(TriggerPin, OUTPUT); pinMode(EchoPin, INPUT); } void loop() { int cm = ping(TriggerPin, EchoPin); mySerial.print("Distance in cm:"); mySerial.println(cm); delay(500); } int ping(int TriggerPin, int EchoPin) { long duration, distanceCm; digitalWrite(TriggerPin, LOW); delayMicroseconds(100); digitalWrite(TriggerPin, HIGH); delayMicroseconds(200); digitalWrite(TriggerPin, LOW); duration = pulseIn(EchoPin, HIGH); distanceCm= duration*0.039/2; //distanceCm = duration * 10 / 292/ 2; return distanceCm; }