ultrasound.ino

#define TRIGGER_PIN 2
#define ECHO_PIN 3
void ultrasound_init(){
  pinMode(TRIGGER_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
}

int ultrasound_read(){
   digitalWrite(TRIGGER_PIN, LOW);
   delayMicroseconds(10);
   digitalWrite(TRIGGER_PIN, HIGH);
   delayMicroseconds(10);
   digitalWrite(TRIGGER_PIN, LOW);
   return pulseIn(ECHO_PIN, HIGH)/58;
}

void setup(){
  ultrasound_init();
  Serial.begin(9600);
}

void loop(){
   Serial.print("Distance to closest object in cm:");
   Serial.println(ultrasound_read());
   delay(1000);
}