carte esclave petit robot

Dependencies:   mbed Herkulex_Library_2019 actions_Gr ident_crac actions_Pr

Revision:
42:a7300d563596
Parent:
41:a71d06f292ac
Child:
43:7fff7f4d79a1
--- a/main.cpp	Fri May 24 19:36:51 2019 +0000
+++ b/main.cpp	Sat May 25 00:59:11 2019 +0000
@@ -13,7 +13,7 @@
 signed char FIFO_lecture=0;//Position du fifo de lecture des messages CAN
 unsigned char EtatGameEnd=0;
 
-char cote;
+char cote=0;
 
 
 void canProcessRx(void);
@@ -53,7 +53,6 @@
 #ifdef ROBOT_BIG
     pc.printf("\nGros robot\n\n");
     deverouillage_torque();
-    positionControl(doigt,384,100,BLED_ON,2);
     wait(0.5);
 #endif
 
@@ -62,6 +61,9 @@
 
     pc.printf("\nLAUNCHED");
     while(1) {
+        /*setTorque(doigt,TORQUE_FREE,2);
+        pc.printf("pos : %d\n", getPos(doigt,2));
+        wait_ms(10.0);*/
         canProcessRx();
         f_mesure();//dt35