FRC_equipe1 / Mbed 2 deprecated FRC_2019

Dependencies:   mbed

Revision:
20:a1b5d032b422
Parent:
19:dad67302af25
Child:
22:f18eee9c8714
Child:
23:bb1535360a98
--- a/main.cpp	Wed Jun 05 13:25:52 2019 +0000
+++ b/main.cpp	Wed Jun 05 14:45:45 2019 +0000
@@ -13,15 +13,18 @@
     Timer timer_dbug;
     timer_dbug.start();
     
+    AnalogIn cny_g(A2);
+    AnalogIn cny_d(A3);
+    
     while(1)
     {
-        automate_testDeplacement(robot);
+        //automate_testDeplacement(robot);
         
         if(timer_dbug.read() > 0.5f)
         {
-            dbug.printf("PosX : %d --- PosY : %d\n\r", robot.pos(Robot::X), robot.pos(Robot::Y));
-            dbug.printf("Angle : %d degres\n\r", robot.pos(Robot::THETA) / 10 );
-            sauter_lignes(25);
+            dbug.printf( "CNY Gauche : %f\n\r", cny_g.read() );
+            dbug.printf( "CNY Droit  : %f\n\r", cny_d.read() );
+            sauter_lignes(20);
             timer_dbug.stop();
             timer_dbug.reset();
             timer_dbug.start();