Polytech school project. RICM4 students, see http://air.imag.fr/index.php/Projets-2016-2017-Station_de_pompage_connect%C3%A9e for more information
Dependencies: SX1272Lib mbed WakeUp
Fork of SX1272PingPong by
main.cpp
- Committer:
- chevamax
- Date:
- 2017-04-01
- Revision:
- 17:cce0eada6d82
- Parent:
- 16:85fb5e37def7
File content as of revision 17:cce0eada6d82:
#include "mbed.h" #include "main.h" #include "sx1272-hal.h" #include "debug.h" #include "trame.h" #include "ordre.h" #include "pompe.h" #include "WakeUp.h" #include "niveau.h" /* Set this flag to '1' to display debug messages on the console */ #define DEBUG_MESSAGE 1 #define ID_DEVICE 0x24 #define ID_STATION 0x55 #define TEMPS_ECOUTE_ORDRE_SECONDE 20.0 #define TEMPS_ATTENTE_ACK 60.0 #define SLEEP_TIME 30000 //ms /* Set this flag to '1' to use the LoRa modulation or to '0' to use FSK modulation */ #define USE_MODEM_LORA 1 #define USE_MODEM_FSK !USE_MODEM_LORA #define RF_FREQUENCY 865000000 // Hz #define TX_OUTPUT_POWER 14 // 14 dBm #if USE_MODEM_LORA == 1 #define LORA_BANDWIDTH 2 // [0: 125 kHz, // 1: 250 kHz, // 2: 500 kHz, // 3: Reserved] #define LORA_SPREADING_FACTOR 7 // [SF7..SF12] #define LORA_CODINGRATE 1 // [1: 4/5, // 2: 4/6, // 3: 4/7, // 4: 4/8] #define LORA_PREAMBLE_LENGTH 8 // Same for Tx and Rx #define LORA_SYMBOL_TIMEOUT 5 // Symbols #define LORA_FIX_LENGTH_PAYLOAD_ON false #define LORA_FHSS_ENABLED false #define LORA_NB_SYMB_HOP 4 #define LORA_IQ_INVERSION_ON false #define LORA_CRC_ENABLED true #elif USE_MODEM_FSK == 1 #define FSK_FDEV 25000 // Hz #define FSK_DATARATE 19200 // bps #define FSK_BANDWIDTH 50000 // Hz #define FSK_AFC_BANDWIDTH 83333 // Hz #define FSK_PREAMBLE_LENGTH 5 // Same for Tx and Rx #define FSK_FIX_LENGTH_PAYLOAD_ON false #define FSK_CRC_ENABLED true #else #error "Please define a modem in the compiler options." #endif #define RX_TIMEOUT_VALUE 3500000//3500000 // in us #define BUFFER_SIZE 32 // Define the payload size here #if( defined ( TARGET_KL25Z ) || defined ( TARGET_LPC11U6X ) ) DigitalOut led(LED2); #else DigitalOut led(LED1); #endif /* * Global variables declarations */ typedef enum { LOWPOWER = 0, IDLE, RX, RX_TIMEOUT, RX_ERROR, TX, TX_TIMEOUT, CAD, CAD_DONE }AppStates_t; volatile AppStates_t State = LOWPOWER; /*! * Radio events function pointer */ static RadioEvents_t RadioEvents; /* * Global variables declarations */ SX1272MB2xAS Radio( NULL ); uint16_t BufferSize = BUFFER_SIZE; uint8_t Buffer[BUFFER_SIZE]; int16_t RssiValue = 0.0; int8_t SnrValue = 0.0; //Fonction permettant de faire dormir la carte //LE DEEPSLEEP Ne fonctionne pas ! void dormir(){ debug_if(DEBUG_MESSAGE,"dodo\r\n"); Radio.Sleep(); WakeUp::set_ms(SLEEP_TIME); sleep(); wait(5); } Timer ecouterOrdre; int main() { uint8_t i; debug_if(DEBUG_MESSAGE, "\n\n\r SX1272 Cuve Demo Application \n\n\r" ); // Initialize Radio driver RadioEvents.TxDone = OnTxDone; RadioEvents.RxDone = OnRxDone; RadioEvents.RxError = OnRxError; RadioEvents.TxTimeout = OnTxTimeout; RadioEvents.RxTimeout = OnRxTimeout; Radio.Init( &RadioEvents ); // verify the connection with the board while( Radio.Read( REG_VERSION ) == 0x00 ) { debug_if(DEBUG_MESSAGE, "Radio could not be detected!\n\r", NULL ); wait( 1 ); } debug_if( ( DEBUG_MESSAGE & ( Radio.DetectBoardType( ) == SX1272MB2XAS ) ) , "\n\r > Board Type: SX1272MB2xAS < \n\r" ); Radio.SetChannel( RF_FREQUENCY ); #if USE_MODEM_LORA == 1 debug_if( LORA_FHSS_ENABLED, "\n\n\r > LORA FHSS Mode < \n\n\r"); debug_if( !LORA_FHSS_ENABLED, "\n\n\r > LORA Mode < \n\n\r"); Radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH, LORA_SPREADING_FACTOR, LORA_CODINGRATE, LORA_PREAMBLE_LENGTH, LORA_FIX_LENGTH_PAYLOAD_ON, LORA_CRC_ENABLED, LORA_FHSS_ENABLED, LORA_NB_SYMB_HOP, LORA_IQ_INVERSION_ON, 2000000 ); Radio.SetRxConfig( MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR, LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH, LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, 0, LORA_CRC_ENABLED, LORA_FHSS_ENABLED, LORA_NB_SYMB_HOP, LORA_IQ_INVERSION_ON, true ); #elif USE_MODEM_FSK == 1 debug_if(DEBUG_MESSAGE,"\n\n\r > FSK Mode < \n\n\r"); Radio.SetTxConfig( MODEM_FSK, TX_OUTPUT_POWER, FSK_FDEV, 0, FSK_DATARATE, 0, FSK_PREAMBLE_LENGTH, FSK_FIX_LENGTH_PAYLOAD_ON, FSK_CRC_ENABLED, 0, 0, 0, 2000000 ); Radio.SetRxConfig( MODEM_FSK, FSK_BANDWIDTH, FSK_DATARATE, 0, FSK_AFC_BANDWIDTH, FSK_PREAMBLE_LENGTH, 0, FSK_FIX_LENGTH_PAYLOAD_ON, 0, FSK_CRC_ENABLED, 0, 0, false, true ); #else #error "Please define a modem in the compiler options." #endif debug_if( DEBUG_MESSAGE, "Starting Cuve loop\r\n" ); led = 0; //Initialisation Pompe pompe(PC_5); pompe.arreterPompe(); Niveau cuve(PC_8,PC_3,PC_2,PC_6); TrameData dataPaquet(ID_DEVICE,ID_STATION, 8, pompe.etat(), 0xF, 0xA); bool enAttenteOrdre = false; bool enAttenteAck = false; //The low-power oscillator can be quite inaccurate on some targets //this function calibrates it against the main clock WakeUp::calibrate(); //Debut programme while( 1 ) { switch( State ) { case RX: if( enAttenteOrdre || enAttenteAck ) { if( BufferSize > 0 ) { debug_if( DEBUG_MESSAGE, "2\r\n"); debug_if(DEBUG_MESSAGE,(const char* )Buffer); debug_if( DEBUG_MESSAGE, " "); debug_if(DEBUG_MESSAGE,(const char* ) ID_DEVICE); Ordre trameRecue((char*)Buffer); //Si message recu alors trouver ordre correspondant et faire traitement if( trameRecue.getIdRecepteur() == (char) ID_DEVICE ) { debug_if( DEBUG_MESSAGE, "ID DEVICE OK\r\n"); if( trameRecue.getIdEmetteur() == (char) ID_STATION ){ debug_if( DEBUG_MESSAGE, "ID STATION OK\r\n"); if(enAttenteOrdre){ //Ordre pour nous led = !led; debug_if( DEBUG_MESSAGE, "...Ordre recu \r\n" ); Ordre o((char *) Buffer); if(trameRecue.getOrdreAFaire()==1) o.executerOrdre(pompe, cuve, o.getNiveauCuve()); dormir(); enAttenteOrdre = false; Radio.Rx( RX_TIMEOUT_VALUE ); } else if(trameRecue.getOrdreAFaire()==0 && enAttenteAck){ debug_if( DEBUG_MESSAGE, "ACK recu\r\n"); enAttenteAck = false; ecouterOrdre.reset(); enAttenteOrdre = true; Radio.Rx( RX_TIMEOUT_VALUE ); } else{ //mauvais ACK on concidère que c'est OK debug_if( DEBUG_MESSAGE, "mauvais ACK recu\r\n"); enAttenteAck = false; ecouterOrdre.reset(); enAttenteOrdre = true; Radio.Rx( RX_TIMEOUT_VALUE ); } }else{ debug_if( DEBUG_MESSAGE, "autre station\r\n"); Radio.Rx( RX_TIMEOUT_VALUE ); } } else // valid reception but not for us { // Start again debug_if( DEBUG_MESSAGE, "Reception message pour quelqu'un d'autre\r\n"); Radio.Rx( RX_TIMEOUT_VALUE ); } } } State = LOWPOWER; break; case TX: led = !led; debug_if( DEBUG_MESSAGE && !enAttenteAck, "Envoi des donnees...\r\n" ); debug_if( DEBUG_MESSAGE && enAttenteAck, "En attente ACK\r\n"); Radio.Rx( RX_TIMEOUT_VALUE ); State = LOWPOWER; break; case RX_TIMEOUT: Radio.Rx( RX_TIMEOUT_VALUE ); State = LOWPOWER; break; case RX_ERROR: //Erreur CRC, faire une demande de renvoi //TODO debug_if( DEBUG_MESSAGE, "Erreur CRC \r\n"); Radio.Rx( RX_TIMEOUT_VALUE ); State = LOWPOWER; break; case TX_TIMEOUT: Radio.Rx( RX_TIMEOUT_VALUE ); State = LOWPOWER; break; case LOWPOWER: if(!enAttenteOrdre && !enAttenteAck){ //Corps de l'application //On envoie les données debug_if( DEBUG_MESSAGE, "envoie3\r\n"); dataPaquet.mettreAJourEtatPompe((char) pompe.etat()); dataPaquet.mettreAJourNiveauCuve(cuve.getNiveauCuve()); dataPaquet.mettreAJourNiveauBatterie((char) 0xA); // Send the data char * trame = dataPaquet.creerTrame(); strcpy( ( char* ) Buffer, trame); for (i = TAILLE_TRAME_DATA; i < BufferSize; i++ ) { Buffer[i] = i - 4; } wait_ms( 10 ); //Initialisation des variables de controle enAttenteAck = true; debug_if( DEBUG_MESSAGE, "Debut timer \r\n"); ecouterOrdre.start(); Radio.Send( Buffer, BufferSize ); }else{ ecouterOrdre.stop(); if(enAttenteAck && (ecouterOrdre.read() > TEMPS_ATTENTE_ACK)){ debug_if( DEBUG_MESSAGE, "delaisAttente ack depasse. Reemission.\r\n"); ecouterOrdre.stop(); ecouterOrdre.reset(); enAttenteAck = false; }else if(enAttenteOrdre && (ecouterOrdre.read() > TEMPS_ECOUTE_ORDRE_SECONDE)){ debug_if( DEBUG_MESSAGE, "delaisAttente depasse. Dormir.\r\n"); ecouterOrdre.stop(); ecouterOrdre.reset(); dormir(); debug_if( DEBUG_MESSAGE, "fin dodo\r\n"); enAttenteOrdre = false; } else ecouterOrdre.start(); } break; default: State = LOWPOWER; break; } } } void OnTxDone( void ) { Radio.Sleep( ); State = TX; debug_if( DEBUG_MESSAGE, "> OnTxDone\n\r" ); } void OnRxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr) { Radio.Sleep( ); BufferSize = size; memcpy( Buffer, payload, BufferSize ); RssiValue = rssi; SnrValue = snr; State = RX; debug_if( DEBUG_MESSAGE, "> OnRxDone\n\r" ); } void OnTxTimeout( void ) { Radio.Sleep( ); State = TX_TIMEOUT; debug_if( DEBUG_MESSAGE, "> OnTxTimeout\n\r" ); } void OnRxTimeout( void ) { Radio.Sleep( ); Buffer[ BufferSize ] = 0; State = RX_TIMEOUT; debug_if( DEBUG_MESSAGE, "." ); } void OnRxError( void ) { Radio.Sleep( ); State = RX_ERROR; debug_if( DEBUG_MESSAGE, "> OnRxError\n\r" ); }