code petit robot pour homologation

Fork of CRAC-Strat_2017_HOMOLOGATION_PETIT_ROBOT by CRAC Team

Revision:
15:c2fc239e85df
Parent:
14:c8fc06c4887f
--- a/Telemetre/Telemetre.cpp	Fri Mar 31 16:20:26 2017 +0000
+++ b/Telemetre/Telemetre.cpp	Thu May 11 12:55:52 2017 +0000
@@ -1,9 +1,7 @@
 # include "Telemetre.h"
 
-#define TELEMETRE_PROFONDEUR 50
 
-T_LISTE_MODULES listeModules;
-
+T_MODULE listeModules[NOMBRE_OBJETS];
 /*********************************************************************************************************/
 /* FUNCTION NAME: SendTelemetreID                                                                        */
 /* DESCRIPTION  : Envoie un message sans donnée, c'est-à-dire contenant uniquement un ID, sur le bus CAN */
@@ -44,48 +42,63 @@
 }
 
 void initModules(void){
-    
-    
-    /*listeModules ={true, 1350,    0},
-                    {true,    0, 1150}};*/
-    
-    listeModules.module1.x=600;
-    listeModules.module1.y=1000;
-    listeModules.module1.existe = true;
-    listeModules.module1.timeout = 0;
-    
-    listeModules.module2.x=600;
-    listeModules.module2.y=200;
-    listeModules.module2.existe = true;
-    listeModules.module2.timeout = 0;
-    
-    listeModules.module3.x=1100;
-    listeModules.module3.y=500;
-    listeModules.module3.existe = true;
-    listeModules.module3.timeout = 0;
+
+    listeModules[0].x = 0;
+    listeModules[0].y = 1100;
     
-    listeModules.module4.x=1400;
-    listeModules.module4.y=900;
-    listeModules.module4.existe = true;
-    listeModules.module4.timeout = 0;
-    
-    listeModules.module5.x=1850;
-    listeModules.module5.y=800;
-    listeModules.module5.existe = true;
-    listeModules.module5.timeout = 0;
+    listeModules[1].x = 200;
+    listeModules[1].y = 950;
+        
+    listeModules[2].x = 600;
+    listeModules[2].y = 200;
+        
+    listeModules[3].x = 600;
+    listeModules[3].y = 1000;
+        
+    listeModules[4].x = 1100;
+    listeModules[4].y = 500;
+        
+    listeModules[5].x = 1350;
+    listeModules[5].y = 0;
+        
+    listeModules[6].x = 1400;
+    listeModules[6].y = 900;
+        
+    listeModules[7].x = 1850;
+    listeModules[7].y = 800;
+        
+    listeModules[8].x = 0;
+    listeModules[8].y = 1850;
+        
+    listeModules[9].x = 200;
+    listeModules[9].y = 2050;
+        
+    listeModules[10].x = 600;
+    listeModules[10].y = 2000;
+        
+    listeModules[11].x = 600;
+    listeModules[11].y = 2800;
     
-    listeModules.fusee1.x = 1350;
-    listeModules.fusee1.y = 0;
-    listeModules.fusee1.nb_module = 4;
-    listeModules.fusee1.timeout = 0 ;
+    listeModules[12].x = 1100;
+    listeModules[12].y = 2500;
+    
+    listeModules[13].x = 1350;
+    listeModules[13].y = 0;
     
-    listeModules.fusee2.x = 0;
-    listeModules.fusee2.y = 1150;
-    listeModules.fusee2.nb_module = 4;
-    listeModules.fusee2.timeout = 0;
-
+    listeModules[14].x = 1400;
+    listeModules[14].y = 2100;
+    
+    listeModules[15].x = 1850;
+    listeModules[15].y = 2200;
 }
 
+signed short returnX(int indiceTab){
+    return listeModules[indiceTab].x;
+    }
+    
+signed short returnY(int indiceTab){
+    return listeModules[indiceTab].y;
+    }
 
 void processData(int objectType, signed short x, signed short y, int nb_module){
     switch(objectType){
@@ -95,10 +108,10 @@
         
         case MODULE:
             //
-            if( (x == listeModules.module1.x) && (y == listeModules.module1.y) ){
+            /*if( (x == listeModules.module1.x) && (y == listeModules.module1.y) ){
                     printf("module 1");
                     listeModules.module1.timeout ++;
-                }            
+                }       */     
         break;
         
         case BALLE: