LoRa_Node_STM32F103C8T6
Dependencies: mbed mbed-STM32F103C8T6 OneWireCRC_LoRa_Node SX1276Lib_LoRa_Node
RFM95W.cpp@0:cc04364f049a, 2018-04-19 (annotated)
- Committer:
- lukas_formanek
- Date:
- Thu Apr 19 14:09:56 2018 +0000
- Revision:
- 0:cc04364f049a
- Child:
- 1:a54ff5e2c2f3
19.4.2018
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
lukas_formanek | 0:cc04364f049a | 1 | #include "RFM95W.h" |
lukas_formanek | 0:cc04364f049a | 2 | |
lukas_formanek | 0:cc04364f049a | 3 | RFM95W rfm; // Globalna instancia |
lukas_formanek | 0:cc04364f049a | 4 | |
lukas_formanek | 0:cc04364f049a | 5 | //--------------------------- Callback funkcie --------------------------------- |
lukas_formanek | 0:cc04364f049a | 6 | void TxDone(void){rfm.OnTxDone();}; |
lukas_formanek | 0:cc04364f049a | 7 | |
lukas_formanek | 0:cc04364f049a | 8 | void RxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr ){rfm.OnRxDone(payload,size,rssi,snr);}; |
lukas_formanek | 0:cc04364f049a | 9 | |
lukas_formanek | 0:cc04364f049a | 10 | void TxTimeout(void){rfm.OnTxTimeout();}; |
lukas_formanek | 0:cc04364f049a | 11 | |
lukas_formanek | 0:cc04364f049a | 12 | void RxTimeout(void){rfm.OnRxTimeout();}; |
lukas_formanek | 0:cc04364f049a | 13 | |
lukas_formanek | 0:cc04364f049a | 14 | void RxError(void){rfm.OnRxError();}; |
lukas_formanek | 0:cc04364f049a | 15 | |
lukas_formanek | 0:cc04364f049a | 16 | void CadDone(bool channelActivityDetected){rfm.OnCadDone(channelActivityDetected);}; |
lukas_formanek | 0:cc04364f049a | 17 | //------------------------------------------------------------------------------ |
lukas_formanek | 0:cc04364f049a | 18 | |
lukas_formanek | 0:cc04364f049a | 19 | RFM95W::RFM95W() |
lukas_formanek | 0:cc04364f049a | 20 | : radio(NULL), |
lukas_formanek | 0:cc04364f049a | 21 | indicationLed(LED), |
lukas_formanek | 0:cc04364f049a | 22 | noise(NOISE_PIN) |
lukas_formanek | 0:cc04364f049a | 23 | { |
lukas_formanek | 0:cc04364f049a | 24 | // messageNumbers ={[0 ... 254] = NULL}; |
lukas_formanek | 0:cc04364f049a | 25 | for(uint16_t i=0; i<MAX_DEVICES;i++) |
lukas_formanek | 0:cc04364f049a | 26 | messageNumbers[i]=NULL; |
lukas_formanek | 0:cc04364f049a | 27 | memset(receivedMessage, '\0', sizeof(receivedMessage)); |
lukas_formanek | 0:cc04364f049a | 28 | ledState = 0; |
lukas_formanek | 0:cc04364f049a | 29 | timeOnAirSec = 0.3; |
lukas_formanek | 0:cc04364f049a | 30 | indicationLed = 1; |
lukas_formanek | 0:cc04364f049a | 31 | messageNumber = NODE_ID; |
lukas_formanek | 0:cc04364f049a | 32 | }; |
lukas_formanek | 0:cc04364f049a | 33 | |
lukas_formanek | 0:cc04364f049a | 34 | void RFM95W::OnLedTick() |
lukas_formanek | 0:cc04364f049a | 35 | { |
lukas_formanek | 0:cc04364f049a | 36 | if(ledState<6) { |
lukas_formanek | 0:cc04364f049a | 37 | indicationLed = !indicationLed; |
lukas_formanek | 0:cc04364f049a | 38 | } else { |
lukas_formanek | 0:cc04364f049a | 39 | ledState = 0; |
lukas_formanek | 0:cc04364f049a | 40 | indicationLed = 1; |
lukas_formanek | 0:cc04364f049a | 41 | ledTicker.detach(); |
lukas_formanek | 0:cc04364f049a | 42 | } |
lukas_formanek | 0:cc04364f049a | 43 | ledState++; |
lukas_formanek | 0:cc04364f049a | 44 | } |
lukas_formanek | 0:cc04364f049a | 45 | |
lukas_formanek | 0:cc04364f049a | 46 | void RFM95W::SendAck(uint8_t addr, uint8_t messageNumber) |
lukas_formanek | 0:cc04364f049a | 47 | { |
lukas_formanek | 0:cc04364f049a | 48 | uint8_t ack[3]; |
lukas_formanek | 0:cc04364f049a | 49 | snprintf((char *)ack, sizeof(ack), "%d%d%c", addr, GATEWAY_ID, messageNumber); |
lukas_formanek | 0:cc04364f049a | 50 | PC.printf("Sending Ack : %s \r\n",ack); |
lukas_formanek | 0:cc04364f049a | 51 | radio.Send(ack, 3); |
lukas_formanek | 0:cc04364f049a | 52 | }; |
lukas_formanek | 0:cc04364f049a | 53 | |
lukas_formanek | 0:cc04364f049a | 54 | void RFM95W::OnTxDone( void ) |
lukas_formanek | 0:cc04364f049a | 55 | { |
lukas_formanek | 0:cc04364f049a | 56 | radio.Sleep(); |
lukas_formanek | 0:cc04364f049a | 57 | radio.Rx(0); |
lukas_formanek | 0:cc04364f049a | 58 | }; |
lukas_formanek | 0:cc04364f049a | 59 | |
lukas_formanek | 0:cc04364f049a | 60 | void RFM95W::OnRxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr ) |
lukas_formanek | 0:cc04364f049a | 61 | { |
lukas_formanek | 0:cc04364f049a | 62 | radio.Sleep(); |
lukas_formanek | 0:cc04364f049a | 63 | // debug("%d \r\n", payload[0]-'0'); |
lukas_formanek | 0:cc04364f049a | 64 | if(payload[0]-'0' == GATEWAY_ID) { |
lukas_formanek | 0:cc04364f049a | 65 | // moje ID - adresa brany, konverzia na cislo |
lukas_formanek | 0:cc04364f049a | 66 | uint8_t MsgFrom = payload[1]-'0'; // konverzia na cislo |
lukas_formanek | 0:cc04364f049a | 67 | SendAck(MsgFrom,payload[2]); |
lukas_formanek | 0:cc04364f049a | 68 | PC.printf("MSG from : %d , message number received= %d \r\n",MsgFrom,payload[2]); |
lukas_formanek | 0:cc04364f049a | 69 | if(payload[2] == messageNumbers[MsgFrom]) |
lukas_formanek | 0:cc04364f049a | 70 | { |
lukas_formanek | 0:cc04364f049a | 71 | PC.printf("--------------------- Ta ista sprava -------------------- \r\n"); |
lukas_formanek | 0:cc04364f049a | 72 | return; |
lukas_formanek | 0:cc04364f049a | 73 | } |
lukas_formanek | 0:cc04364f049a | 74 | messageNumbers[MsgFrom] = payload[2]; |
lukas_formanek | 0:cc04364f049a | 75 | |
lukas_formanek | 0:cc04364f049a | 76 | payload[2] = 48; // ASCII hodnota cisla 0 |
lukas_formanek | 0:cc04364f049a | 77 | PC.printf("Message number saved= %d \r\n",messageNumbers[MsgFrom]); |
lukas_formanek | 0:cc04364f049a | 78 | snprintf((char *)receivedMessage, BUFF_SIZE, "%d|%d|%s|\r\n", rssi, snr, payload); |
lukas_formanek | 0:cc04364f049a | 79 | |
lukas_formanek | 0:cc04364f049a | 80 | // debug_if( DEBUG_MESSAGE, "> OnRxDone\n\r" ); |
lukas_formanek | 0:cc04364f049a | 81 | ledTicker.attach(callback(this,&RFM95W::OnLedTick), LED_BLIK_PERIOD); |
lukas_formanek | 0:cc04364f049a | 82 | indicationLed=0; |
lukas_formanek | 0:cc04364f049a | 83 | |
lukas_formanek | 0:cc04364f049a | 84 | return; |
lukas_formanek | 0:cc04364f049a | 85 | } |
lukas_formanek | 0:cc04364f049a | 86 | radio.Rx(0); // som zakomentil :P |
lukas_formanek | 0:cc04364f049a | 87 | }; |
lukas_formanek | 0:cc04364f049a | 88 | |
lukas_formanek | 0:cc04364f049a | 89 | void RFM95W::OnTxTimeout( void ) |
lukas_formanek | 0:cc04364f049a | 90 | { |
lukas_formanek | 0:cc04364f049a | 91 | radio.Sleep(); |
lukas_formanek | 0:cc04364f049a | 92 | Init(); |
lukas_formanek | 0:cc04364f049a | 93 | radio.Rx(0); |
lukas_formanek | 0:cc04364f049a | 94 | }; |
lukas_formanek | 0:cc04364f049a | 95 | |
lukas_formanek | 0:cc04364f049a | 96 | void RFM95W::OnRxTimeout( void ) |
lukas_formanek | 0:cc04364f049a | 97 | { |
lukas_formanek | 0:cc04364f049a | 98 | radio.Sleep(); |
lukas_formanek | 0:cc04364f049a | 99 | radio.Rx(0); |
lukas_formanek | 0:cc04364f049a | 100 | }; |
lukas_formanek | 0:cc04364f049a | 101 | |
lukas_formanek | 0:cc04364f049a | 102 | void RFM95W::OnRxError( void ) |
lukas_formanek | 0:cc04364f049a | 103 | { |
lukas_formanek | 0:cc04364f049a | 104 | radio.Sleep(); |
lukas_formanek | 0:cc04364f049a | 105 | PC.printf("Chyba prijatia ! \r\n"); |
lukas_formanek | 0:cc04364f049a | 106 | radio.Rx(0); |
lukas_formanek | 0:cc04364f049a | 107 | }; |
lukas_formanek | 0:cc04364f049a | 108 | |
lukas_formanek | 0:cc04364f049a | 109 | void RFM95W::OnCadDone( bool channelActivityDetected ){}; |
lukas_formanek | 0:cc04364f049a | 110 | |
lukas_formanek | 0:cc04364f049a | 111 | void RFM95W::SendValue(uint8_t addr, float value) |
lukas_formanek | 0:cc04364f049a | 112 | { |
lukas_formanek | 0:cc04364f049a | 113 | snprintf((char *)sendBuffer, BUFF_SIZE, "%d%d%c|%.2f|",GATEWAY_ID, NODE_ID, messageNumber, value); |
lukas_formanek | 0:cc04364f049a | 114 | }; |
lukas_formanek | 0:cc04364f049a | 115 | |
lukas_formanek | 0:cc04364f049a | 116 | float RFM95W::CalculateRandomTime() |
lukas_formanek | 0:cc04364f049a | 117 | { |
lukas_formanek | 0:cc04364f049a | 118 | uint8_t number; |
lukas_formanek | 0:cc04364f049a | 119 | while(number == 0) {number = rand() % 1200;} |
lukas_formanek | 0:cc04364f049a | 120 | return (TimeOnAirSec * (number / 200.0)); |
lukas_formanek | 0:cc04364f049a | 121 | }; |
lukas_formanek | 0:cc04364f049a | 122 | |
lukas_formanek | 0:cc04364f049a | 123 | void RFM95W::Init( void ) |
lukas_formanek | 0:cc04364f049a | 124 | { |
lukas_formanek | 0:cc04364f049a | 125 | PC.printf( "\n\n\r------- RFM95W GATEWAY -------\n\r" ); |
lukas_formanek | 0:cc04364f049a | 126 | // Initialize Radio driver |
lukas_formanek | 0:cc04364f049a | 127 | radioEvents.TxDone = TxDone; |
lukas_formanek | 0:cc04364f049a | 128 | radioEvents.RxDone = RxDone; |
lukas_formanek | 0:cc04364f049a | 129 | radioEvents.RxError = RxError; |
lukas_formanek | 0:cc04364f049a | 130 | radioEvents.TxTimeout = TxTimeout; |
lukas_formanek | 0:cc04364f049a | 131 | radioEvents.RxTimeout = RxTimeout; |
lukas_formanek | 0:cc04364f049a | 132 | radioEvents.CadDone = CadDone; |
lukas_formanek | 0:cc04364f049a | 133 | radio.Init( &radioEvents ); |
lukas_formanek | 0:cc04364f049a | 134 | // verify the connection with the board |
lukas_formanek | 0:cc04364f049a | 135 | while( radio.Read( REG_VERSION ) == 0x00 ) { |
lukas_formanek | 0:cc04364f049a | 136 | PC.printf( "Radiovy modul nie je pripojeny!\n\r", NULL ); |
lukas_formanek | 0:cc04364f049a | 137 | wait(1); |
lukas_formanek | 0:cc04364f049a | 138 | } |
lukas_formanek | 0:cc04364f049a | 139 | |
lukas_formanek | 0:cc04364f049a | 140 | // debug_if( ( DEBUG_MESSAGE & ( Radio.DetectBoardType( ) == SX1276MB1LAS ) ) , "\n\r > TYP: RFM95W < \n\r" ); |
lukas_formanek | 0:cc04364f049a | 141 | // debug_if( ( DEBUG_MESSAGE & ( Radio.DetectBoardType( ) == SX1276MB1MAS ) ) , "\n\r > TYP: RFM95W < \n\r" ); |
lukas_formanek | 0:cc04364f049a | 142 | radio.SetChannel( RF_FREQUENCY ); |
lukas_formanek | 0:cc04364f049a | 143 | #if USE_MODEM_LORA == 1 |
lukas_formanek | 0:cc04364f049a | 144 | |
lukas_formanek | 0:cc04364f049a | 145 | // debug_if( LORA_FHSS_ENABLED, "\n\r > LORA FHSS Mod < \n\n\r"); |
lukas_formanek | 0:cc04364f049a | 146 | // debug_if( !LORA_FHSS_ENABLED, "\n\r > LORA Mod < \n\n\r"); |
lukas_formanek | 0:cc04364f049a | 147 | PC.printf("\n\r > LORA Mod < \n\n\r"); |
lukas_formanek | 0:cc04364f049a | 148 | radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH, |
lukas_formanek | 0:cc04364f049a | 149 | LORA_SPREADING_FACTOR, LORA_CODINGRATE, |
lukas_formanek | 0:cc04364f049a | 150 | LORA_PREAMBLE_LENGTH, LORA_FIX_LENGTH_PAYLOAD_ON, |
lukas_formanek | 0:cc04364f049a | 151 | LORA_CRC_ENABLED, LORA_FHSS_ENABLED, LORA_NB_SYMB_HOP, |
lukas_formanek | 0:cc04364f049a | 152 | LORA_IQ_INVERSION_ON, 2000000 ); |
lukas_formanek | 0:cc04364f049a | 153 | |
lukas_formanek | 0:cc04364f049a | 154 | radio.SetRxConfig( MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR, |
lukas_formanek | 0:cc04364f049a | 155 | LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH, |
lukas_formanek | 0:cc04364f049a | 156 | LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, 0, |
lukas_formanek | 0:cc04364f049a | 157 | LORA_CRC_ENABLED, LORA_FHSS_ENABLED, LORA_NB_SYMB_HOP, |
lukas_formanek | 0:cc04364f049a | 158 | LORA_IQ_INVERSION_ON, true ); |
lukas_formanek | 0:cc04364f049a | 159 | |
lukas_formanek | 0:cc04364f049a | 160 | #elif USE_MODEM_FSK == 1 |
lukas_formanek | 0:cc04364f049a | 161 | |
lukas_formanek | 0:cc04364f049a | 162 | PC.printf("\n\r > FSK Mod < \n\n\r"); |
lukas_formanek | 0:cc04364f049a | 163 | radio.SetTxConfig( MODEM_FSK, TX_OUTPUT_POWER, FSK_FDEV, 0, |
lukas_formanek | 0:cc04364f049a | 164 | FSK_DATARATE, 0, |
lukas_formanek | 0:cc04364f049a | 165 | FSK_PREAMBLE_LENGTH, FSK_FIX_LENGTH_PAYLOAD_ON, |
lukas_formanek | 0:cc04364f049a | 166 | FSK_CRC_ENABLED, 0, 0, 0, 2000000 ); |
lukas_formanek | 0:cc04364f049a | 167 | |
lukas_formanek | 0:cc04364f049a | 168 | radio.SetRxConfig( MODEM_FSK, FSK_BANDWIDTH, FSK_DATARATE, |
lukas_formanek | 0:cc04364f049a | 169 | 0, FSK_AFC_BANDWIDTH, FSK_PREAMBLE_LENGTH, |
lukas_formanek | 0:cc04364f049a | 170 | 0, FSK_FIX_LENGTH_PAYLOAD_ON, 0, FSK_CRC_ENABLED, |
lukas_formanek | 0:cc04364f049a | 171 | 0, 0, false, true ); |
lukas_formanek | 0:cc04364f049a | 172 | |
lukas_formanek | 0:cc04364f049a | 173 | #else |
lukas_formanek | 0:cc04364f049a | 174 | |
lukas_formanek | 0:cc04364f049a | 175 | #error "Nie je definovany typ modemu." |
lukas_formanek | 0:cc04364f049a | 176 | |
lukas_formanek | 0:cc04364f049a | 177 | #endif |
lukas_formanek | 0:cc04364f049a | 178 | // Konfiguracia pre moznost max. vysielacieho vykonu |
lukas_formanek | 0:cc04364f049a | 179 | uint8_t paConfig; |
lukas_formanek | 0:cc04364f049a | 180 | paConfig = radio.Read( REG_PACONFIG ); |
lukas_formanek | 0:cc04364f049a | 181 | paConfig |= RF_PACONFIG_PASELECT_PABOOST; |
lukas_formanek | 0:cc04364f049a | 182 | radio.Write( REG_PACONFIG, paConfig ); |
lukas_formanek | 0:cc04364f049a | 183 | |
lukas_formanek | 0:cc04364f049a | 184 | PC.printf("________Start aplikacie________\r\n" ); |
lukas_formanek | 0:cc04364f049a | 185 | timeOnAirSec = (radio.TimeOnAir( MODEM_LORA, 10)/1000.0); // time on air v ms |
lukas_formanek | 0:cc04364f049a | 186 | PC.printf( "\n\n\r------- Time on air : %f sec. -------\n\r", timeOnAirSec); |
lukas_formanek | 0:cc04364f049a | 187 | indicationLed = 1; |
lukas_formanek | 0:cc04364f049a | 188 | InitRandom(); |
lukas_formanek | 0:cc04364f049a | 189 | messageNumber = rand(); |
lukas_formanek | 0:cc04364f049a | 190 | radio.Rx(0); |
lukas_formanek | 0:cc04364f049a | 191 | }; |
lukas_formanek | 0:cc04364f049a | 192 | |
lukas_formanek | 0:cc04364f049a | 193 | void RFM95W::InitRandom() |
lukas_formanek | 0:cc04364f049a | 194 | { |
lukas_formanek | 0:cc04364f049a | 195 | uint32_t seed; |
lukas_formanek | 0:cc04364f049a | 196 | uint8_t loops = 3; |
lukas_formanek | 0:cc04364f049a | 197 | for (int i=0; i<(32*loops); i++) { |
lukas_formanek | 0:cc04364f049a | 198 | seed ^= noise.read_u16(); |
lukas_formanek | 0:cc04364f049a | 199 | if (seed & 1<31) { // shift left and wrap. |
lukas_formanek | 0:cc04364f049a | 200 | seed <<= 1; |
lukas_formanek | 0:cc04364f049a | 201 | seed |= 1; |
lukas_formanek | 0:cc04364f049a | 202 | } else |
lukas_formanek | 0:cc04364f049a | 203 | seed <<= 1; |
lukas_formanek | 0:cc04364f049a | 204 | } |
lukas_formanek | 0:cc04364f049a | 205 | srand(seed); |
lukas_formanek | 0:cc04364f049a | 206 | }; |