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