/* 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()) { // Verifica se la distanza di un oggetto e' minore di minDistance = 10cm digitalWrite(13,HIGH); } else { digitalWrite(13,LOW); } Serial.println(distanceMonitor()); // Ritorna la distanza di un oggetto in cm delay(50); }