#define TRIG 7
#define ECHO 6

//HCsr Code
long baca(int pinTrig, int pinEcho) {
  pinMode(pinTrig, OUTPUT);
  digitalWrite(pinTrig, LOW);
  digitalWrite(pinTrig, HIGH);

  delayMicroseconds(10);
  digitalWrite(pinTrig, LOW);
  pinMode(pinTrig, INPUT);

  return pulseIn(pinEcho, HIGH);
}
void setup() {
  // put your setup code here, to run once:
    Serial.begin(9600);

}

void loop() {
  // put your main code here, to run repeatedly:
    int cm = 0;
  cm = (0.03446 * baca(TRIG, ECHO)) / 2;

  Serial.print(cm);
  Serial.println(" cm");

  delay(500);

}