Diff: analyzer.cpp

Revision:

11:9c0786fc06b4

Parent:

10:61b4d6c67dd7

Child:

12:16390cea4420

--- a/analyzer.cpp	Mon Apr 07 18:33:53 2014 +0000
+++ b/analyzer.cpp	Tue Apr 08 13:46:22 2014 +0000
@@ -10,39 +10,50 @@
  
 Analyzer::Analyzer()
 {
-    string pan("ACE");
-    
-    trame = new Trame(p13, p14);
-    trame->sendATCommand("ID", pan.c_str(), pan.length());// Set le PANID selon le fichier de config
-    trame->sendATCommand("WR", 0, 0);    // Écrit la valeur du PANID en mémoire
-    trame->sendATCommand("AC", 0, 0);    // Applique les changements effectués
-    
-    /*allMouvement[0x0002] = new Mouvement(0x0002, 0x0002, "Z vertical, main face au ciel");
-    allMouvement[0x0003] = new Mouvement(0x0003, 0x0003, "Z vertical, main face au ciel INVERSE");
-    allMouvement[0x0004] = new Mouvement(0x0004, 0x0004, "Z vertical, main face au sol");
-    allMouvement[0x0005] = new Mouvement(0x0005, 0x0005, "Z vertical, main face au sol INVERSE");
-    allMouvement[0x0006] = new Mouvement(0x0006, 0x0006, "Z horizontal");
-    allMouvement[0x0007] = new Mouvement(0x0007, 0x0007, "Z horizontal INVERSE");
-
-    allMouvement[0x0020] = new Mouvement(0x0020, 0x0020, "X vertical, main face au ciel");
-    allMouvement[0x0030] = new Mouvement(0x0030, 0x0030, "X vertical, main face au ciel INVERSE");
-    allMouvement[0x0040] = new Mouvement(0x0040, 0x0040, "X vertical, main face au sol");
-    allMouvement[0x0050] = new Mouvement(0x0050, 0x0050, "X vertical, main face au sol INVERSE");
-    allMouvement[0x0060] = new Mouvement(0x0060, 0x0060, "X horizontal");
-    allMouvement[0x0070] = new Mouvement(0x0070, 0x0070, "X horizontal INVERSE");
-
-    allMouvement[0x0200] = new Mouvement(0x0200, 0x0200, "Y vertical, main face au ciel");
-    allMouvement[0x0300] = new Mouvement(0x0300, 0x0300, "Y vertical, main face au ciel INVERSE");
-    allMouvement[0x0400] = new Mouvement(0x0400, 0x0400, "Y vertical, main face au sol");
-    allMouvement[0x0500] = new Mouvement(0x0500, 0x0500, "Y vertical, main face au sol INVERSE");
-    allMouvement[0x0600] = new Mouvement(0x0600, 0x0600, "Y horizontal");
-    allMouvement[0x0700] = new Mouvement(0x0700, 0x0700, "Y horizontal INVERSE");*/
 }
  
 Analyzer::~Analyzer()
 {
     allMouvement.clear();
 }
+
+void Analyzer::initialize()
+{
+    string pan("ACE");
+    
+    DigitalOut reset(p8);
+    reset = 0;
+    wait(0.4);
+    reset = 1;
+    
+    /*trame = new Trame(p13, p14);
+    trame->sendATCommand("ID", pan.c_str(), pan.length());// Set le PANID selon le fichier de config
+    trame->sendATCommand("WR", 0, 0);    // Écrit la valeur du PANID en mémoire
+    trame->sendATCommand("AC", 0, 0);    // Applique les changements effectués*/
+    
+    //wait(1);
+    
+    allMouvement[0x0002] = new Mouvement(0x0002, 0x0002, "Z vertical, vers le ciel");
+    allMouvement[0x0003] = new Mouvement(0x0003, 0x0003, "Z vertical, vers le ciel INVERSE");
+    allMouvement[0x0004] = new Mouvement(0x0004, 0x0004, "Z vertical, vers le sol");
+    allMouvement[0x0005] = new Mouvement(0x0005, 0x0005, "Z vertical, vers le sol INVERSE");
+    allMouvement[0x0006] = new Mouvement(0x0006, 0x0006, "Z horizontal");
+    allMouvement[0x0007] = new Mouvement(0x0007, 0x0007, "Z horizontal INVERSE");
+
+    allMouvement[0x0020] = new Mouvement(0x0020, 0x0020, "X vertical, vers le ciel");
+    allMouvement[0x0030] = new Mouvement(0x0030, 0x0030, "X vertical, vers le ciel INVERSE");
+    allMouvement[0x0040] = new Mouvement(0x0040, 0x0040, "X vertical, vers le sol");
+    allMouvement[0x0050] = new Mouvement(0x0050, 0x0050, "X vertical, vers le sol INVERSE");
+    allMouvement[0x0060] = new Mouvement(0x0060, 0x0060, "X horizontal");
+    allMouvement[0x0070] = new Mouvement(0x0070, 0x0070, "X horizontal INVERSE");
+
+    allMouvement[0x0200] = new Mouvement(0x0200, 0x0200, "Y vertical, vers le ciel");
+    allMouvement[0x0300] = new Mouvement(0x0300, 0x0300, "Y vertical, vers le ciel INVERSE");
+    allMouvement[0x0400] = new Mouvement(0x0400, 0x0400, "Y vertical, vers le sol");
+    allMouvement[0x0500] = new Mouvement(0x0500, 0x0500, "Y vertical, vers le sol INVERSE");
+    allMouvement[0x0600] = new Mouvement(0x0600, 0x0600, "Y horizontal");
+    allMouvement[0x0700] = new Mouvement(0x0700, 0x0700, "Y horizontal INVERSE");
+}
  
 void Analyzer::setMinMax(signed char* values)
 {
@@ -67,20 +78,20 @@
     {
         if(x.initial > SEUIL_DETECTION)
         {
-            code_mouvement = 0x1 << 9; // 0010
+            code_mouvement |= 0x1 << 9; // 0010
         }
         else if(x.initial < -SEUIL_DETECTION)
         {       
-            code_mouvement = 0x2 << 9; // 0100
+            code_mouvement |= 0x2 << 9; // 0100
         }
         else
         {
-            code_mouvement = 0x3 << 9; // 0110
+            code_mouvement |= 0x3 << 9; // 0110
         }
         
         if(!x.sens)
         {
-            code_mouvement = 0x1 << 8; // 0xx1 
+            code_mouvement |= 0x1 << 8; // 0xx1 
         }
     }
     
@@ -89,20 +100,20 @@
     {
         if(y.initial > SEUIL_DETECTION)
         {
-            code_mouvement = 0x1 << 5; // 0xxx 0010
+            code_mouvement |= 0x1 << 5; // 0xxx 0010
         }
         else if(y.initial < -SEUIL_DETECTION)
         {
-            code_mouvement = 0x2 << 5; // 0xxx 0100
+            code_mouvement |= 0x2 << 5; // 0xxx 0100
         }
         else
         {
-            code_mouvement = 0x3 << 5; // 0xxx 0110
+            code_mouvement |= 0x3 << 5; // 0xxx 0110
         }
         
         if(!y.sens)
         {
-            code_mouvement = 0x1 << 4; // 0xxx 0yy1 
+            code_mouvement |= 0x1 << 4; // 0xxx 0yy1 
         }
     }
     
@@ -111,26 +122,31 @@
     {
         if(z.initial > SEUIL_DETECTION)
         {
-            code_mouvement = 1 << 1; // 0xxx 0yyy 0010
+            code_mouvement |= 1 << 1; // 0xxx 0yyy 0010
         }
         else if(z.initial < -SEUIL_DETECTION)
         {
-            code_mouvement = 2 << 1; // 0xxx 0yyy 0100
+            code_mouvement |= 2 << 1; // 0xxx 0yyy 0100
         }
         else
         {
-            code_mouvement = 3 << 1; // 0xxx 0yyy 0110
+            code_mouvement |= 3 << 1; // 0xxx 0yyy 0110
         }
         
         if(!z.sens)
         {
-            code_mouvement = 1 << 0; // 0xxx 0yyy 0zz1
+            code_mouvement |= 1 << 0; // 0xxx 0yyy 0zz1
         }
     }
 
+    map<int,Mouvement*>::iterator it;
+    it = allMouvement.find(code_mouvement);
+    pc.printf("\n\r code mouvement: %x", code_mouvement);
+    
     pc.printf("\n\r mouvement: %s, %s, %s", deplacement[0] ? "vrai" : "faux",
                                             deplacement[1] ? "vrai" : "faux",
                                             deplacement[2] ? "vrai" : "faux");
+                                            
     // pc.printf("\n\rInit: %i, min: %i, max: %i, sens: %s", x.initial, x.min, x.max, x.sens ? "acceleration":"deceleration");
     // pc.printf("\n\rInit: %i, min: %i, max: %i, sens: %s", y.initial, y.min, y.max, y.sens ? "acceleration":"deceleration");
     // pc.printf("\n\rInit: %i, min: %i, max: %i, sens: %s", z.initial, z.min, z.max, z.sens ? "acceleration":"deceleration");
@@ -153,6 +169,12 @@
     Analyzer *an = (Analyzer*)analyzer;
     delete an;    
 }
+
+extern "C" void Analyzer_C_Initialize(void *analyzer)
+{
+    Analyzer *an = (Analyzer*)analyzer;
+    an->initialize();
+}
  
 extern "C" void Analyzer_C_setMinMax(signed char* values, void *analyzer)
 {