]> git.piffa.net Git - rover/blobdiff - libraries/rover/examples/ultrasonic/ultrasonic.ino
Merge branch 'functions' into macchina
[rover] / libraries / rover / examples / ultrasonic / ultrasonic.ino
diff --git a/libraries/rover/examples/ultrasonic/ultrasonic.ino b/libraries/rover/examples/ultrasonic/ultrasonic.ino
new file mode 100644 (file)
index 0000000..b26408a
--- /dev/null
@@ -0,0 +1,32 @@
+/* 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);
+}