Gestion du Traffic Adaptatif- Code du mbed coordinateur
Dependencies: XBeeLib mbed mbed-rtos EthernetInterface
main.cpp
- Committer:
- leomerel
- Date:
- 2018-11-29
- Revision:
- 24:bbde0b873a37
- Parent:
- 23:2a6ea31d8e23
- Child:
- 25:fdb28df21d44
File content as of revision 24:bbde0b873a37:
//SQLUT #include "mbed.h" #include "XBeeLib.h" #include "rtos.h" #if defined(ENABLE_LOGGING) #include "DigiLoggerMbedSerial.h" using namespace DigiLog; #endif #define REMOTE_NODE_ADDR64_MSB ((uint32_t)0x0013A200) //#error "Replace next define with the LSB of the remote module's 64-bit address (SL parameter)" #define REMOTE_NODE_ADDR64_LSB1 ((uint32_t)0x40C0E3A1) // adresse du recepteur 1 #define REMOTE_NODE_ADDR64_LSB2 ((uint32_t)0x4086DA0E) // adresse du recepteur 2 #define REMOTE_NODE_ADDR64_1 UINT64(REMOTE_NODE_ADDR64_MSB, REMOTE_NODE_ADDR64_LSB1) #define REMOTE_NODE_ADDR64_2 UINT64(REMOTE_NODE_ADDR64_MSB, REMOTE_NODE_ADDR64_LSB2) using namespace XBeeLib; //feux gauche //rouge DigitalOut feu_rouge(p12); //orange DigitalOut feu_orange(p14); //vert DigitalOut feu_vert(p16); DigitalOut led1(LED1); //Nombre de voitures au feu int voituresFeu1 = 0; int voituresFeu2 = 0; DigitalIn boutonPlus(p24); DigitalIn boutonMoins(p23); Thread t_nbVoiture; //Thread t_receive; Thread t_feuRouge; Thread t_gestion; Serial *log_serial; XBeeZB xbee = XBeeZB(RADIO_TX, RADIO_RX, RADIO_RESET, NC, NC, 9600); const RemoteXBeeZB remoteDevice1 = RemoteXBeeZB(REMOTE_NODE_ADDR64_1); const RemoteXBeeZB remoteDevice2 = RemoteXBeeZB(REMOTE_NODE_ADDR64_2); static void send_explicit_data_to_remote_node(XBeeZB& xbee, const RemoteXBeeZB& RemoteDevice,int message) { const uint8_t dstEP = 0xE8; const uint8_t srcEP = 0xE8; const uint16_t clusterID = 0x0011; const uint16_t profileID = 0xC105; char data1[]="r"; // demande a un recepteur de passer au rouge char data2[]="v"; // demande a un recepteur de passer au vert char data3[]="e"; if (message ==0){ const TxStatus txStatus = xbee.send_data(RemoteDevice, dstEP, srcEP, clusterID, profileID, (const uint8_t *)data1, strlen(data1)); } else if (message ==1){ const TxStatus txStatus = xbee.send_data(RemoteDevice, dstEP, srcEP, clusterID, profileID, (const uint8_t *)data2, strlen(data2)); } else { const TxStatus txStatus = xbee.send_data(RemoteDevice, dstEP, srcEP, clusterID, profileID, (const uint8_t *)data3, strlen(data3)); } } /** Callback function, invoked at packet reception */ static void receive_cb(const RemoteXBeeZB& remote, bool broadcast, const uint8_t *const data, uint16_t len) { const uint64_t remote_addr64 = remote.get_addr64(); //log_serial->printf("\r\nGot a %s RX packet [%08x:%08x|%04x], len %d\r\nData: ", broadcast ? "BROADCAST" : "UNICAST", UINT64_HI32(remote_addr64), UINT64_LO32(remote_addr64), remote.get_addr16(), len); //log_serial->printf("\r\nAdresse 1: [%08x] ----- Adresse 2 : [%08x]\r\n", UINT64_LO32(remote_addr64), UINT64_LO32(REMOTE_NODE_ADDR64_LSB1)); /*for (int i = 0; i < len; i++) log_serial->printf("%02x ", data[i]);*/ if (data[0]==0x6D){ // baisse le compteur de voiture au feu 1 if ( UINT64_LO32(remote_addr64) == UINT64_LO32(REMOTE_NODE_ADDR64_LSB1) && (voituresFeu1!=0)){ voituresFeu1--; } // baisse le compteur de voiture au feu 2 else if ( (UINT64_LO32(remote_addr64)==UINT64_LO32(REMOTE_NODE_ADDR64_LSB2)) && (voituresFeu2!=0)){ voituresFeu2--; } log_serial->printf("Nombre de voitures feu 1 : %d",voituresFeu1); log_serial->printf("Nombre de voitures feu 2 : %d",voituresFeu2); } else if (data[0]==0x70){ // augmente le compteur de voiture au feu 1 if ( UINT64_LO32(remote_addr64) == UINT64_LO32(REMOTE_NODE_ADDR64_LSB1)){ voituresFeu1++; } // augmente le compteur de voiture au feu 2 else if ( UINT64_LO32(remote_addr64) == UINT64_LO32(REMOTE_NODE_ADDR64_LSB2)){ voituresFeu2++; } log_serial->printf("Nombre de voitures feu 1 : %d",voituresFeu1); log_serial->printf("Nombre de voitures feu 2 : %d",voituresFeu2); } else if (data[0]==0x72){ // demande au r2 de passer au vert if ( UINT64_LO32(remote_addr64) == UINT64_LO32(REMOTE_NODE_ADDR64_LSB1)){ log_serial->printf("r2 passe au vert"); send_explicit_data_to_remote_node(xbee, remoteDevice2,0); } // demande au r1 de passer au vert else if ( UINT64_LO32(remote_addr64) == UINT64_LO32(REMOTE_NODE_ADDR64_LSB2)){ log_serial->printf("r1 passe au vert"); send_explicit_data_to_remote_node(xbee, remoteDevice1,0); } } /*else if (data[0]==0x73){ send_explicit_data_to_remote_node(xbee, remoteDevice1,0); }*/ log_serial->printf("\r\n"); } /*void nbVoiture() { while(1) { if(boutonPlus){ nombreDeVoiture++; } if(boutonMoins && nombreDeVoiture>0){ nombreDeVoiture--; } printf("Nombre de voitures : %d \r\n", nombreDeVoiture); } }*/ void connect_Xbee() { log_serial = new Serial(DEBUG_TX, DEBUG_RX); log_serial->baud(9600); log_serial->printf("Sample application to demo how to receive unicast and broadcast data with the XBeeZB\r\n\r\n"); log_serial->printf(XB_LIB_BANNER); #if defined(ENABLE_LOGGING) new DigiLoggerMbedSerial(log_serial, LogLevelInfo); #endif /* Register callbacks */ xbee.register_receive_cb(&receive_cb); RadioStatus const radioStatus = xbee.init(); MBED_ASSERT(radioStatus == Success); /* Wait until the device has joined the network */ log_serial->printf("Waiting for device to join the network: "); while (!xbee.is_joined()) { wait_ms(1000); log_serial->printf("."); } log_serial->printf("OK\r\n"); } void set_feuRouge() { while(1) { Thread::signal_wait(0x1); feu_vert = 0; feu_orange = 1; Thread::wait(2000); feu_orange = 0; feu_rouge = 1; send_explicit_data_to_remote_node(xbee, remoteDevice1,0); } } void gestion() { int i=0; while(1) { Thread::wait(100); if(i==40){ send_explicit_data_to_remote_node(xbee, remoteDevice2,1); } if(i==80){ send_explicit_data_to_remote_node(xbee, remoteDevice1,1); i=0; } i++; } } int main() { connect_Xbee(); t_feuRouge.start(set_feuRouge); t_gestion.start(gestion); while (true) { //nécessaire pour lire (constamment) la valeur recue uint32_t receive_value = xbee.process_rx_frames(); if(voituresFeu1 >= 10){led1=1;} else{led1=0;} } }