X-Git-Url: http://git.piffa.net/web?p=rover;a=blobdiff_plain;f=prototypes%2Fultra%2Fcheck_func_lib%2Fcheck_func_lib.ino;fp=prototypes%2Fultra%2Fcheck_func_lib%2Fcheck_func_lib.ino;h=ea25c4c2799fc015ebd18c2badc7b1f5abdeb278;hp=0000000000000000000000000000000000000000;hb=d6c0bac94a34f180f91f1a95712eb83efa6aeac2;hpb=cf5e92a6f4481506b8b360322d25b4be821cc741

diff --git a/prototypes/ultra/check_func_lib/check_func_lib.ino b/prototypes/ultra/check_func_lib/check_func_lib.ino
new file mode 100644
index 0000000..ea25c4c
--- /dev/null
+++ b/prototypes/ultra/check_func_lib/check_func_lib.ino
@@ -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()) {
+    digitalWrite(13,HIGH);
+} else {
+    digitalWrite(13,LOW);
+}
+Serial.println(distanceMonitor());
+delay(50);
+}