Time is good

Dependencies:   RoboClaw mbed

Fork of Robot2016_2-0 by ARES

Revision:
76:a862cb10559c
Parent:
67:244bc1cc6678
--- a/Functions/func.cpp	Thu May 05 04:36:59 2016 +0000
+++ b/Functions/func.cpp	Thu May 05 06:34:13 2016 +0000
@@ -145,17 +145,19 @@
 
 void homologation(void)
 {
-    goHomeZ();
-    ZMot.mm(50, HAUT);
-    goHomeL();
-    goHomeR();
-    LMot.mm(50, HAUT);
-    RMot.mm(50, HAUT);
+    //goHomeZ();
+    //ZMot.mm(50, HAUT);
+    //goHomeL();
+    //goHomeR();
+    //LMot.mm(50, HAUT);
+    //RMot.mm(50, HAUT);
     while(START==0) logger.printf("%1.3f\t%1.3f\t%1.3f\n\r", capt1.read(), capt2.read(), capt3.read());
     roboclaw.SpeedAccelM1M2(accel_dista, vitesse_dista, vitesse_dista);
     while(1) {
         while(capt2.read() < SEUIL) checkAround();
-        while(1) roboclaw.SpeedAccelM1M2(accel_dista, 0, 0);
+        roboclaw.ForwardM1(0);
+        roboclaw.ForwardM2(0);
+        while(1);
     }
 }