robot final c est la fin

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

main.cpp

Committer:
aure
Date:
2017-03-23
Revision:
1:1d7dc9751783
Parent:
0:238a3e4fa7bc

File content as of revision 1:1d7dc9751783:

#include "mbed.h"
#include "LED_Debug.h"
#include "Robot.h"
#include "Bluetooth_HC05_LE_TRAME.h"

 
#define DEBUG 1 //entre ne mode debug                            oui=1 non =0
 
 
 
                                          //mot de passe PIN 1390
//Serial HC06(p13,p14);
Serial pc(USBTX,USBRX);


 
int main() {
 
   
    Bluetooth_HC05_LE_TRAME blu;
    Robot robot;
    LED_Debug d;
    
    
    if(DEBUG==1)
    {
    pc.printf("DEBUT DEBUG\r\n");
    }
   
 

  blu.envoyer("OKCOM\r\n");

   
 
    
////////////////////////////////////////////

        blu.resetBuffer();

///////////////////////////////////////////
   
   int copie;
   int i=0;
if(DEBUG==1)   //////////////////////////////////////////////DEBUG==1/////////////////
 {   
   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();
                                     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");
          
         }
   
     }
    }

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");
          
         }
   
     }
}
/////////////////////////////////////////////////////////////////////////////////////////////////////
}