#define TRIG_PIN 3 // Connect TRIG to D3
#define ECHO_PIN 2 // Connect ECHO to D2

void setup() {
  // Initialize serial communication
  Serial.begin(9600);

  // Set TRIG_PIN as output and ECHO_PIN as input
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);

  Serial.println("Ultrasonic Sensor Test Initialized");
}

void loop() {
  // Send a 10-microsecond pulse to TRIG
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);

  // Read the time for the echo to return
  long duration = pulseIn(ECHO_PIN, HIGH);

  // Calculate the distance in centimeters
  float distance = (duration * 0.034) / 2;

  // Print the distance
  Serial.print("Distance: ");
  Serial.print(distance);
  Serial.println(" cm");

  delay(500);
}