/* Ultrasonic rilevatore distanza

Rilevatore distanza minore di 5cm.
funzione

HC-SR04 Ping distance sensor
VCC to arduino 5v - GND to arduino GND

 */
#define dEBUG
#include "rover.h"
#include "Servo.h"


void setup() {
    abilita();
    //Debug
#ifdef DEBUG
Serial.begin(9600);
#endif
Serial.begin(9600); // Need for distanceMonitor
}

void loop() {
if (distanceCheck()) {
    digitalWrite(13,HIGH);
} else {
    digitalWrite(13,LOW);
}
Serial.println(distanceMonitor());
delay(50);
}