Diff: main.cpp

Revision:

0:ef0410ccfc84

diff -r 000000000000 -r ef0410ccfc84 main.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Thu Feb 09 14:56:56 2017 +0000
@@ -0,0 +1,53 @@
+#include "mbed.h"
+#include "hcsr04.h"
+HCSR04 sensor (D15, D14);
+Serial pc(USBTX, USBRX);
+
+
+DigitalOut dcm01(D6);
+DigitalOut dcm02(D7);
+DigitalOut dcm03(D4);
+DigitalOut dcm04(D5);
+float dist;
+
+int main()
+{
+
+    pc.baud(115200);
+
+
+    while(1) {
+        sensor.start();
+        dist=sensor.get_dist_cm();
+        pc.printf("%dcm\t", sensor.get_dist_cm());
+
+
+        if (dist > 20) {
+
+            dcm01 = 0;
+            dcm02 = 1;
+            dcm03 = 0;
+            dcm04 = 1;
+           
+            
+
+        }
+
+        if (dist < 20) {
+
+            dcm01 = 1;
+            dcm02 = 0;
+            dcm03 = 0;
+            dcm04 = 1;
+           
+            
+
+        }
+
+
+
+
+
+    }//Chiusa while
+}//Chiusa main
+