Merge branch 'functions' into macchina

[rover] / prototypes / ultra / check_func_lib / check_func_lib.ino

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 (file)
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);
+}