joey QUANTIN / Mbed 2 deprecated pixy2_10_0042

ultra

Dependencies:   SRF05 mbed pixy

Diff: main.cpp

Revision:
0:b3230a65c9b1
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Fri Jun 09 23:21:14 2017 +0000
@@ -0,0 +1,37 @@
+#include "mbed.h"
+#include "fct.h"
+#include "Pixy.h"
+#include "PixyLink.h"
+#include "SRF05.h"
+
+#define V_max 25
+#define V_recherche 25
+#define K 0.1
+DigitalOut cs(p13);
+DigitalIn bp(p14);
+Serial pc (USBTX,USBRX);
+SRF05 us_arr(p8,p24);
+
+int main()
+{
+    MotG.period(PERIOD);
+    MotD.period(PERIOD);
+    float us_arriere;
+    Vitmoteur(0.0,0.0);
+    while(1) {
+        
+        //printf("Us_arriere : %.1f\n\r", us_arr.read());
+        us_arriere=us_arr.read();
+        if(us_arriere>20) {
+            Vitmoteur(-30,-30);
+        }
+        else{
+            Vitmoteur(0,0);
+            }
+    }
+
+}
+
+
+
+