robot final c est la fin

Dependencies:   AFFICHAGE Bluetooth_HC05_LE_TRAME Deplacement LED_Debug PATTERN LED SRF05 m3pi mbed ROBOT

Revision:
1:1d7dc9751783
Parent:
0:238a3e4fa7bc
--- a/main.cpp	Fri Mar 17 18:17:06 2017 +0000
+++ b/main.cpp	Thu Mar 23 12:49:54 2017 +0000
@@ -4,6 +4,7 @@
 #include "Bluetooth_HC05_LE_TRAME.h"
 
  
+#define DEBUG 1 //entre ne mode debug                            oui=1 non =0
  
  
  
@@ -14,21 +15,24 @@
 
  
 int main() {
-    
+ 
+   
     Bluetooth_HC05_LE_TRAME blu;
     Robot robot;
     LED_Debug d;
     
     
-    d.add();
-    pc.printf("DEBUT\r\n");
+    if(DEBUG==1)
+    {
+    pc.printf("DEBUT DEBUG\r\n");
+    }
    
-   pc.printf("CONFIGURATION BAUDS OK\r\n");
+ 
 
-  blu.envoyer("bonjour\r\n");
-   d.add();
+  blu.envoyer("OKCOM\r\n");
+
    
-  
+ 
     
 ////////////////////////////////////////////
 
@@ -38,91 +42,81 @@
    
    int copie;
    int i=0;
-   
+if(DEBUG==1)   //////////////////////////////////////////////DEBUG==1/////////////////
+ {   
    while(1)
    {
-   
-    if (blu.donneesRecue()==1) {
-        d.resetCpt();
-         
-         pc.printf(" 0k1\r\n");
-         
-        
-       
-   
-                 
-                 int compteur=0;
-                 char buffer[100];
-                 ///////////////////////////////////////////////OK rematrre apres
-             while(blu.donneesRecue()==1)
-                 {
-                     buffer[0]=blu.recevoir(1);
-                     pc.printf("recevoir=     %c\r\n",buffer[0]);
-                     
-                    
-                    // buffer[compteur]=toto;
-                    //  compteur++;
-                      
-                      
-                     }
-                     pc.printf(" ok2\r\n");
-                    // blu.resetBuffer();
-                 ////////////////////////////////////////////    
-                     pc.printf(" ok3\r\n");
-                    // char*recu=blu.recevoir(1);
-                     //char *recu=&buffer[0];
-                     /////////////////////////////////////////// test
-                     
-                    
-                     
-                     ///////////////////////////////////////
-                     
         
-            
-             pc.printf(" ok4\r\n");
-             pc.printf("envoi =    %c ",buffer[0]);
-             pc.printf(" ok5\r\n");
-             blu.envoyer("hello\r\n");
-             pc.printf(" ok6\r\n");
-             blu.envoyer("salut je suis un robot\r\n");
-             pc.printf(" ok7\r\n");
-            
-       
-              
-           
-              //////////////////////////////////////////
-            
-             pc.printf(" ok8\r\n");
-             ////////////////////////////////////////////////
-             pc.printf("ROBOT ACTION\r\n");
-             d.add();
-           
-            
-            
-           // robot.action(recu[0]);
-           pc.printf("%c \r\n",buffer[0]);
-           
-             pc.printf(" ok9\r\n");
-             
-             robot.action(buffer[0]);
-             
-             d.add();
-             pc.printf("ROBOT ACTION FIN\r\n");
-             pc.printf(" ok10\r\n");
-             ////////////////////////////////////////////////////
-             
+        if (blu.donneesRecue()==1)
+        {   
+        pc.printf("1\r\n");
+                  
+                                 int compteur=0;
+                             while(blu.donneesRecue()==1)
+                                 {
+                                  pc.printf("11\r\n");
+                                  blu.recevoir();
+                                  pc.printf("12\r\n");
+                                     }
+                                     pc.printf("13\r\n");
+                                     char*recu=blu.getBuf();
+                                     for(i=0;i<blu.getLongueurTrame();i++)
+                                     {
+                                         printf("recu%d = %c\r\n",i,recu[i]);
+                                    }
+                                     pc.printf("14\r\n");
+                    // blu.envoyer(strcat(recu,"\r\n"));
+                     pc.printf("15\r\n");
+                             robot.action(recu[2],recu[0],recu[1]);
+                             pc.printf("16\r\n");
+                      blu.envoyer("ok\r\n");  
+                      pc.printf("17\r\n");
+                      
+                 blu.resetBuffer();
+                 pc.printf("18\r\n");
+                //  wait(2);
+                  pc.printf("19\r\n");
           
-    
-    ///////////////////////////////////////
-    
-    blu.resetBuffer();
-    pc.printf(" ok11\r\n");
-    ////////////////////////////////
-    
-    wait(2);
-     pc.printf(" ok12\r\n");
+         }
+   
+     }
+    }
+
+else    //DEBUG==0////////////////////////////////////////////////////////////////////
+{
+     while(1)
+   {
         
-   }
+        if (blu.donneesRecue()==1)
+        {   
+        pc.printf("1\r\n");
+                  
+                                 int compteur=0;
+                             while(blu.donneesRecue()==1)
+                                 {
+                                  pc.printf("11\r\n");
+                                  blu.recevoir();
+                                  pc.printf("12\r\n");
+                                     }
+                                     pc.printf("13\r\n");
+                                     char*recu=blu.getBuf();
+                                     pc.printf("14\r\n");
+                    // blu.envoyer(strcat(recu,"\r\n"));
+                     pc.printf("15\r\n");
+                             robot.action(recu[2],recu[0],recu[1]);
+                             pc.printf("16\r\n");
+                      blu.envoyer("ok\r\n");  
+                      pc.printf("17\r\n");
+                      
+                 blu.resetBuffer();
+                 pc.printf("18\r\n");
+                //  wait(2);
+                  pc.printf("19\r\n");
+          
+         }
    
+     }
 }
+/////////////////////////////////////////////////////////////////////////////////////////////////////
 }
+