git.piffa.net Git - rover/blob - libraries/rover/examples/ultrasonic/ultrasonic.ino

   1 /* Ultrasonic rilevatore distanza
   2
   3 Rilevatore distanza minore di 5cm.
   4 funzione
   5
   6 HC-SR04 Ping distance sensor
   7 VCC to arduino 5v - GND to arduino GND
   8
   9  */
  10 #define dEBUG
  11 #include "rover.h"
  12 #include "Servo.h"
  13
  14
  15 void setup() {
  16     abilita();
  17     //Debug
  18 #ifdef DEBUG
  19 Serial.begin(9600);
  20 #endif
  21 Serial.begin(9600); // Need for distanceMonitor
  22 }
  23
  24 void loop() {
  25 if (distanceCheck()) { // Verifica se la distanza di un oggetto e' minore di minDistance = 10cm
  26     digitalWrite(13,HIGH);
  27 } else {
  28     digitalWrite(13,LOW);
  29 }
  30 Serial.println(distanceMonitor()); // Ritorna la distanza di un oggetto in cm
  31 delay(50);
  32 }