robot final c est la fin
Dependencies: AFFICHAGE Bluetooth_HC05_LE_TRAME Deplacement LED_Debug PATTERN LED SRF05 m3pi mbed ROBOT
Diff: main.cpp
- 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"); + + } + } } +///////////////////////////////////////////////////////////////////////////////////////////////////// } +