#define ECHO_PIN 5
#define TRIG_PIN 6
void setup()
{
pinMode(TRIG_PIN, OUTPUT);
pinMode(ECHO_PIN, INPUT);
pinMode(LED_BUILTIN, OUTPUT);
Serial.begin(115200);
}
void loop()
{
float distance = readDistance();
bool nearby = distance < 100;
digitalWrite(LED_BUILTIN,nearby);
Serial.print("Measured Distance: ");
Serial.println(readDistance());
Serial.print("Measured Bool: ");
Serial.println(nearby);
delay(1000);
}
float readDistance()
{
digitalWrite(TRIG_PIN, LOW);
delayMicroseconds(2);
digitalWrite(TRIG_PIN, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PIN, LOW);
int duration = pulseIn(ECHO_PIN, HIGH);
return duration * 0.034 / 2;
}