CRAC Team / command_AX12_petit_robot_V4tempo

code ax12 petit robot 12/05/2017

Fork of command_AX12_petit_robot_V3 by CRAC Team

Diff: AX12/AX12.cpp

Revision:
4:888b32bc5b63
Parent:
2:99b1cb0d9f5e
Child:
7:ad4a19e26b84
--- a/AX12/AX12.cpp	Wed Apr 19 15:53:45 2017 +0000
+++ b/AX12/AX12.cpp	Tue May 02 12:06:47 2017 +0000
@@ -1281,16 +1281,14 @@
       printf("\nread_and_test");
       #endif
       
-    if( _ID==0x01)                                                              //ID Socle
+    if( _ID==0x12)                                                              
     { k=1;}
-    else if( _ID==0x02)                                                         //ID Bas
+    else if( _ID==0x04)                                                      
     { k=6;}
-    else if( _ID==0x05)                                                         //ID Milieu
+    else if( _ID==0x07)                                                       
     { k=11;}
-    else if( _ID==0x0D)                                                         //ID Haut
+    else if( _ID==0x0F)                                                     
     { k=16;}
-    else if( _ID==0x09)                                                         //ID Ventouse
-    { k=21;}
     
     val_angle = (unsigned short) (angle/0.3);
     val_reche = (unsigned short) Tab[k] + ((unsigned short)Tab[k+1]<<8);