#include <ErriezHCSR04.h>

// Pin defines
#define TRIG_PIN    2
#define ECHO_PIN    3

// Create sensor object
ErriezHCSR04 hcsr04(TRIG_PIN, ECHO_PIN);


void setup()
{
    // Initialize serial port
    delay(500);
    Serial.begin(115200);
    while (!Serial) {
        ;
    }
    Serial.println(F("\nErriez HC-SR04 ultrasonic distance sensor example\n"));

    // Initialize pins
    hcsr04.begin();
}

void loop()
{
    int16_t distance;

    // Measure distance in centimeter
    distance = hcsr04.getDistance();

    // Print distance
    Serial.print(F("Distance: "));
    if (distance >= 0) {
        Serial.print(distance);
        Serial.println(F(" cm"));
    } else {
        Serial.println(F("-"));
    }

    // Wait
    delay(250);
}

void loop()
{
    float distance;

    // Measure distance in Inch
    distance = hcsr04.getDistanceInch();

    // Print distance
    Serial.print(F("Distance: "));
    if (distance >= 0) {
        Serial.print(distance);
        Serial.println(F("\""));
    } else {
        Serial.println(("-"));
    }

    // Wait
    delay(250);
}