Lukas Formanek / Mbed 2 deprecated LoRa_Access_Point

LoRa Access Point 1.5.2018

Dependencies:   mbed ds3231 SX1276Lib_LoRa_Access_Point

RFM95W.cpp@6:1ee035ae2a2c, 2018-05-01 (annotated)

Committer:
lukas_formanek
Date:
Tue May 01 11:26:11 2018 +0000
Revision:
6:1ee035ae2a2c
Parent:
5:19b34c4d27a1
Child:
8:5d99fbf255d6
LoRa_Access_Point

Who changed what in which revision?

UserRevisionLine numberNew contents of line
lukas_formanek 0:ea088908ad26 1 #include "RFM95W.h"
lukas_formanek 0:ea088908ad26 2
lukas_formanek 5:19b34c4d27a1 3 RFM95W rfm;
lukas_formanek 0:ea088908ad26 4
lukas_formanek 0:ea088908ad26 5 //--------------------------- Callback funkcie ---------------------------------
lukas_formanek 5:19b34c4d27a1 6 void TxDone(void)
lukas_formanek 5:19b34c4d27a1 7 {
lukas_formanek 5:19b34c4d27a1 8 rfm.OnTxDone();
lukas_formanek 5:19b34c4d27a1 9 };
lukas_formanek 0:ea088908ad26 10
lukas_formanek 5:19b34c4d27a1 11 void RxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr )
lukas_formanek 5:19b34c4d27a1 12 {
lukas_formanek 5:19b34c4d27a1 13 rfm.OnRxDone(payload,size,rssi,snr);
lukas_formanek 5:19b34c4d27a1 14 };
lukas_formanek 0:ea088908ad26 15
lukas_formanek 5:19b34c4d27a1 16 void TxTimeout(void)
lukas_formanek 5:19b34c4d27a1 17 {
lukas_formanek 5:19b34c4d27a1 18 rfm.OnTxTimeout();
lukas_formanek 5:19b34c4d27a1 19 };
lukas_formanek 0:ea088908ad26 20
lukas_formanek 5:19b34c4d27a1 21 void RxTimeout(void)
lukas_formanek 5:19b34c4d27a1 22 {
lukas_formanek 5:19b34c4d27a1 23 rfm.OnRxTimeout();
lukas_formanek 5:19b34c4d27a1 24 };
lukas_formanek 0:ea088908ad26 25
lukas_formanek 5:19b34c4d27a1 26 void RxError(void)
lukas_formanek 5:19b34c4d27a1 27 {
lukas_formanek 5:19b34c4d27a1 28 rfm.OnRxError();
lukas_formanek 5:19b34c4d27a1 29 };
lukas_formanek 0:ea088908ad26 30
lukas_formanek 5:19b34c4d27a1 31 void CadDone(bool channelActivityDetected)
lukas_formanek 5:19b34c4d27a1 32 {
lukas_formanek 5:19b34c4d27a1 33 rfm.OnCadDone(channelActivityDetected);
lukas_formanek 5:19b34c4d27a1 34 };
lukas_formanek 0:ea088908ad26 35 //------------------------------------------------------------------------------
lukas_formanek 0:ea088908ad26 36
lukas_formanek 0:ea088908ad26 37 RFM95W::RFM95W()
lukas_formanek 0:ea088908ad26 38 : radio(NULL),
lukas_formanek 3:7a3ddda464bf 39 indicationLed(LED_PIN),
lukas_formanek 3:7a3ddda464bf 40 noise(NOISE_PIN)
lukas_formanek 0:ea088908ad26 41 {
lukas_formanek 5:19b34c4d27a1 42 for(uint16_t i=0; i<MAX_DEVICES; i++)
lukas_formanek 3:7a3ddda464bf 43 messageNumbers[i]=NULL;
lukas_formanek 0:ea088908ad26 44 memset(receivedMessage, '\0', sizeof(receivedMessage));
lukas_formanek 0:ea088908ad26 45 ledState = 0;
lukas_formanek 0:ea088908ad26 46 timeOnAirSec = 0.3;
lukas_formanek 0:ea088908ad26 47 indicationLed = 1;
lukas_formanek 3:7a3ddda464bf 48 messageNumber = GATEWAY_ID;
lukas_formanek 3:7a3ddda464bf 49 sendCounter = 0;
lukas_formanek 3:7a3ddda464bf 50 receivedAck = false;
lukas_formanek 0:ea088908ad26 51 };
lukas_formanek 0:ea088908ad26 52
lukas_formanek 0:ea088908ad26 53 void RFM95W::OnLedTick()
lukas_formanek 0:ea088908ad26 54 {
lukas_formanek 0:ea088908ad26 55 if(ledState<6) {
lukas_formanek 0:ea088908ad26 56 indicationLed = !indicationLed;
lukas_formanek 0:ea088908ad26 57 } else {
lukas_formanek 0:ea088908ad26 58 ledState = 0;
lukas_formanek 0:ea088908ad26 59 indicationLed = 1;
lukas_formanek 0:ea088908ad26 60 ledTicker.detach();
lukas_formanek 0:ea088908ad26 61 }
lukas_formanek 0:ea088908ad26 62 ledState++;
lukas_formanek 0:ea088908ad26 63 }
lukas_formanek 0:ea088908ad26 64
lukas_formanek 3:7a3ddda464bf 65 void RFM95W::SendMessage()
lukas_formanek 3:7a3ddda464bf 66 {
lukas_formanek 3:7a3ddda464bf 67 snprintf((char *)ack, 3, "%c%c%c",GATEWAY_ID, sendBuffer[0], messageNumber);
lukas_formanek 6:1ee035ae2a2c 68 radio.Send( sendBuffer, 15 );
lukas_formanek 3:7a3ddda464bf 69 }
lukas_formanek 3:7a3ddda464bf 70
lukas_formanek 0:ea088908ad26 71 void RFM95W::SendAck(uint8_t addr, uint8_t messageNumber)
lukas_formanek 0:ea088908ad26 72 {
lukas_formanek 0:ea088908ad26 73 uint8_t ack[3];
lukas_formanek 3:7a3ddda464bf 74 snprintf((char *)ack, sizeof(ack), "%c%c%c", addr, GATEWAY_ID, messageNumber);
lukas_formanek 0:ea088908ad26 75 pc.printf("Sending Ack : %s \r\n",ack);
lukas_formanek 0:ea088908ad26 76 radio.Send(ack, 3);
lukas_formanek 0:ea088908ad26 77 };
lukas_formanek 0:ea088908ad26 78
lukas_formanek 3:7a3ddda464bf 79 float RFM95W::CalculateRandomTime()
lukas_formanek 3:7a3ddda464bf 80 {
lukas_formanek 4:e20eb5efd859 81 uint8_t number = rand() % 1500;;
lukas_formanek 5:19b34c4d27a1 82 while(number == 0) {
lukas_formanek 5:19b34c4d27a1 83 number = rand() % 1500;
lukas_formanek 5:19b34c4d27a1 84 }
lukas_formanek 4:e20eb5efd859 85 return (timeOnAirSec * (number / 150.0));
lukas_formanek 3:7a3ddda464bf 86 };
lukas_formanek 3:7a3ddda464bf 87
lukas_formanek 3:7a3ddda464bf 88 void RFM95W::OnCheckAck()
lukas_formanek 3:7a3ddda464bf 89 {
lukas_formanek 3:7a3ddda464bf 90 if((receivedAck == false) && (sendCounter < MAX_RESENDS))
lukas_formanek 4:e20eb5efd859 91 sendTicker.attach(callback(this,&RFM95W::OnSendAgain), CalculateRandomTime());
lukas_formanek 5:19b34c4d27a1 92 else if((receivedAck == false) && (sendCounter >= MAX_RESENDS)) {
lukas_formanek 4:e20eb5efd859 93 messageNumber++;
lukas_formanek 4:e20eb5efd859 94 if(messageNumber>255)
lukas_formanek 4:e20eb5efd859 95 messageNumber = 0;
lukas_formanek 3:7a3ddda464bf 96 }
lukas_formanek 3:7a3ddda464bf 97 ackTicker.detach();
lukas_formanek 3:7a3ddda464bf 98 };
lukas_formanek 3:7a3ddda464bf 99
lukas_formanek 3:7a3ddda464bf 100 void RFM95W::OnSendAgain()
lukas_formanek 3:7a3ddda464bf 101 {
lukas_formanek 4:e20eb5efd859 102 pc.printf("On send again \r\n");
lukas_formanek 3:7a3ddda464bf 103 SendMessage();
lukas_formanek 3:7a3ddda464bf 104 sendCounter++;
lukas_formanek 3:7a3ddda464bf 105 sendTicker.detach();
lukas_formanek 3:7a3ddda464bf 106 };
lukas_formanek 3:7a3ddda464bf 107
lukas_formanek 0:ea088908ad26 108 void RFM95W::OnTxDone( void )
lukas_formanek 0:ea088908ad26 109 {
lukas_formanek 0:ea088908ad26 110 radio.Sleep();
lukas_formanek 3:7a3ddda464bf 111 if(sendingAck)
lukas_formanek 3:7a3ddda464bf 112 sendingAck = false;
lukas_formanek 5:19b34c4d27a1 113 else {
lukas_formanek 4:e20eb5efd859 114 pc.printf("OnTxDone !\r\n");
lukas_formanek 3:7a3ddda464bf 115 receivedAck = false;
lukas_formanek 3:7a3ddda464bf 116 ackTicker.attach(callback(this,&RFM95W::OnCheckAck),timeOnAirSec*3);
lukas_formanek 3:7a3ddda464bf 117 }
lukas_formanek 0:ea088908ad26 118 radio.Rx(0);
lukas_formanek 0:ea088908ad26 119 };
lukas_formanek 0:ea088908ad26 120
lukas_formanek 0:ea088908ad26 121 void RFM95W::OnRxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr )
lukas_formanek 0:ea088908ad26 122 {
lukas_formanek 0:ea088908ad26 123 radio.Sleep();
lukas_formanek 3:7a3ddda464bf 124 if(payload[0] == GATEWAY_ID) {
lukas_formanek 6:1ee035ae2a2c 125 uint8_t msgFrom = payload[1];
lukas_formanek 3:7a3ddda464bf 126 indicationLed=0;
lukas_formanek 3:7a3ddda464bf 127 ledTicker.attach(callback(this,&RFM95W::OnLedTick), LED_BLIK_PERIOD);
lukas_formanek 5:19b34c4d27a1 128 if((size == 3) && (strncmp( ( const char* )payload, ( const char* )ack, 3 ) == 0) ) {
lukas_formanek 3:7a3ddda464bf 129 receivedAck = true;
lukas_formanek 5:19b34c4d27a1 130 wifi.ConfirmReceivedAck(msgFrom);
lukas_formanek 3:7a3ddda464bf 131 pc.printf("Received Ack : %s \r\n",ack);
lukas_formanek 3:7a3ddda464bf 132 messageNumber++;
lukas_formanek 3:7a3ddda464bf 133 if(messageNumber>255)
lukas_formanek 3:7a3ddda464bf 134 messageNumber = 0;
lukas_formanek 5:19b34c4d27a1 135 radio.Rx(0);
lukas_formanek 0:ea088908ad26 136 return;
lukas_formanek 0:ea088908ad26 137 }
lukas_formanek 5:19b34c4d27a1 138 sendingAck = true;
lukas_formanek 5:19b34c4d27a1 139 SendAck(msgFrom,payload[2]);
lukas_formanek 5:19b34c4d27a1 140 pc.printf("MSG from : %c , message number received= %d \r\n",msgFrom,payload[2]);
lukas_formanek 5:19b34c4d27a1 141 if(payload[2] == messageNumbers[msgFrom]) {
lukas_formanek 5:19b34c4d27a1 142 pc.printf("--------------------- Ta ista sprava -------------------- \r\n");
lukas_formanek 5:19b34c4d27a1 143 return;
lukas_formanek 5:19b34c4d27a1 144 }
lukas_formanek 5:19b34c4d27a1 145 messageNumbers[msgFrom] = payload[2];
lukas_formanek 6:1ee035ae2a2c 146 payload[2] = 48;
lukas_formanek 3:7a3ddda464bf 147 memmove(payload, payload+4, size - 4 + 1); // orezem prve styri bajty
lukas_formanek 3:7a3ddda464bf 148 snprintf((char *)receivedMessage, BUFF_SIZE, "%d|%d|%d|%d|%s|\r\n", rssi, snr, GATEWAY_ID, msgFrom, payload);
lukas_formanek 0:ea088908ad26 149 wifi.SendMessage((char *)receivedMessage);
lukas_formanek 0:ea088908ad26 150 return;
lukas_formanek 0:ea088908ad26 151 }
lukas_formanek 5:19b34c4d27a1 152 radio.Rx(0);
lukas_formanek 0:ea088908ad26 153 };
lukas_formanek 0:ea088908ad26 154
lukas_formanek 0:ea088908ad26 155 void RFM95W::OnTxTimeout( void )
lukas_formanek 0:ea088908ad26 156 {
lukas_formanek 0:ea088908ad26 157 radio.Sleep();
lukas_formanek 0:ea088908ad26 158 Init();
lukas_formanek 0:ea088908ad26 159 };
lukas_formanek 0:ea088908ad26 160
lukas_formanek 0:ea088908ad26 161 void RFM95W::OnRxTimeout( void )
lukas_formanek 0:ea088908ad26 162 {
lukas_formanek 0:ea088908ad26 163 radio.Sleep();
lukas_formanek 0:ea088908ad26 164 radio.Rx(0);
lukas_formanek 0:ea088908ad26 165 };
lukas_formanek 0:ea088908ad26 166
lukas_formanek 0:ea088908ad26 167 void RFM95W::OnRxError( void )
lukas_formanek 0:ea088908ad26 168 {
lukas_formanek 0:ea088908ad26 169 radio.Sleep();
lukas_formanek 0:ea088908ad26 170 pc.printf("Chyba prijatia ! \r\n");
lukas_formanek 0:ea088908ad26 171 radio.Rx(0);
lukas_formanek 0:ea088908ad26 172 };
lukas_formanek 0:ea088908ad26 173
lukas_formanek 5:19b34c4d27a1 174 void RFM95W::OnCadDone( bool channelActivityDetected ) {};
lukas_formanek 0:ea088908ad26 175
lukas_formanek 3:7a3ddda464bf 176 void RFM95W::SendValue(uint8_t addr, float value)
lukas_formanek 3:7a3ddda464bf 177 {
lukas_formanek 3:7a3ddda464bf 178 snprintf((char *)sendBuffer, BUFF_SIZE, "%c%c%c|%.2f|",addr, GATEWAY_ID, messageNumber, value);
lukas_formanek 3:7a3ddda464bf 179 sendCounter = 0;
lukas_formanek 3:7a3ddda464bf 180 receivedAck = false;
lukas_formanek 5:19b34c4d27a1 181 SendMessage();
lukas_formanek 4:e20eb5efd859 182 };
lukas_formanek 4:e20eb5efd859 183
lukas_formanek 4:e20eb5efd859 184 void RFM95W::SendValue(uint8_t addr, int value)
lukas_formanek 4:e20eb5efd859 185 {
lukas_formanek 4:e20eb5efd859 186 snprintf((char *)sendBuffer, BUFF_SIZE, "%c%c%c|%d|",addr, GATEWAY_ID, messageNumber, value);
lukas_formanek 4:e20eb5efd859 187 sendCounter = 0;
lukas_formanek 4:e20eb5efd859 188 receivedAck = false;
lukas_formanek 5:19b34c4d27a1 189 SendMessage();
lukas_formanek 4:e20eb5efd859 190 };
lukas_formanek 4:e20eb5efd859 191
lukas_formanek 4:e20eb5efd859 192 void RFM95W::SendMessage(char* message)
lukas_formanek 4:e20eb5efd859 193 {
lukas_formanek 4:e20eb5efd859 194 snprintf((char *)sendBuffer, BUFF_SIZE, "%s", message);
lukas_formanek 4:e20eb5efd859 195 sendBuffer[0] = (char)sendBuffer[0];
lukas_formanek 4:e20eb5efd859 196 sendBuffer[1] = (char)GATEWAY_ID;
lukas_formanek 4:e20eb5efd859 197 sendBuffer[2] = (char)messageNumber;
lukas_formanek 4:e20eb5efd859 198 sendCounter = 0;
lukas_formanek 4:e20eb5efd859 199 receivedAck = false;
lukas_formanek 4:e20eb5efd859 200
lukas_formanek 4:e20eb5efd859 201 pc.printf("%s",sendBuffer);
lukas_formanek 5:19b34c4d27a1 202 SendMessage();
lukas_formanek 3:7a3ddda464bf 203 };
lukas_formanek 3:7a3ddda464bf 204
lukas_formanek 0:ea088908ad26 205 void RFM95W::Init( void )
lukas_formanek 0:ea088908ad26 206 {
lukas_formanek 0:ea088908ad26 207 pc.printf( "\n\n\r------- RFM95W GATEWAY -------\n\r" );
lukas_formanek 0:ea088908ad26 208 // Initialize Radio driver
lukas_formanek 0:ea088908ad26 209 radioEvents.TxDone = TxDone;
lukas_formanek 0:ea088908ad26 210 radioEvents.RxDone = RxDone;
lukas_formanek 0:ea088908ad26 211 radioEvents.RxError = RxError;
lukas_formanek 0:ea088908ad26 212 radioEvents.TxTimeout = TxTimeout;
lukas_formanek 0:ea088908ad26 213 radioEvents.RxTimeout = RxTimeout;
lukas_formanek 0:ea088908ad26 214 radioEvents.CadDone = CadDone;
lukas_formanek 0:ea088908ad26 215 radio.Init( &radioEvents );
lukas_formanek 0:ea088908ad26 216 // verify the connection with the board
lukas_formanek 0:ea088908ad26 217 while( radio.Read( REG_VERSION ) == 0x00 ) {
lukas_formanek 0:ea088908ad26 218 pc.printf( "Radiovy modul nie je pripojeny!\n\r", NULL );
lukas_formanek 0:ea088908ad26 219 wait(1);
lukas_formanek 0:ea088908ad26 220 }
lukas_formanek 0:ea088908ad26 221 radio.SetChannel( RF_FREQUENCY );
lukas_formanek 0:ea088908ad26 222 #if USE_MODEM_LORA == 1
lukas_formanek 2:0499e1d037a5 223 pc.printf("\n\r > LORA Mod < \n\n\r");
lukas_formanek 0:ea088908ad26 224 radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH,
lukas_formanek 0:ea088908ad26 225 LORA_SPREADING_FACTOR, LORA_CODINGRATE,
lukas_formanek 0:ea088908ad26 226 LORA_PREAMBLE_LENGTH, LORA_FIX_LENGTH_PAYLOAD_ON,
lukas_formanek 0:ea088908ad26 227 LORA_CRC_ENABLED, LORA_FHSS_ENABLED, LORA_NB_SYMB_HOP,
lukas_formanek 0:ea088908ad26 228 LORA_IQ_INVERSION_ON, 2000000 );
lukas_formanek 0:ea088908ad26 229
lukas_formanek 0:ea088908ad26 230 radio.SetRxConfig( MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR,
lukas_formanek 0:ea088908ad26 231 LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH,
lukas_formanek 0:ea088908ad26 232 LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, 0,
lukas_formanek 0:ea088908ad26 233 LORA_CRC_ENABLED, LORA_FHSS_ENABLED, LORA_NB_SYMB_HOP,
lukas_formanek 0:ea088908ad26 234 LORA_IQ_INVERSION_ON, true );
lukas_formanek 0:ea088908ad26 235
lukas_formanek 0:ea088908ad26 236 #elif USE_MODEM_FSK == 1
lukas_formanek 0:ea088908ad26 237
lukas_formanek 2:0499e1d037a5 238 pc.printf("\n\r > FSK Mod < \n\n\r");
lukas_formanek 0:ea088908ad26 239 radio.SetTxConfig( MODEM_FSK, TX_OUTPUT_POWER, FSK_FDEV, 0,
lukas_formanek 0:ea088908ad26 240 FSK_DATARATE, 0,
lukas_formanek 0:ea088908ad26 241 FSK_PREAMBLE_LENGTH, FSK_FIX_LENGTH_PAYLOAD_ON,
lukas_formanek 0:ea088908ad26 242 FSK_CRC_ENABLED, 0, 0, 0, 2000000 );
lukas_formanek 0:ea088908ad26 243
lukas_formanek 0:ea088908ad26 244 radio.SetRxConfig( MODEM_FSK, FSK_BANDWIDTH, FSK_DATARATE,
lukas_formanek 0:ea088908ad26 245 0, FSK_AFC_BANDWIDTH, FSK_PREAMBLE_LENGTH,
lukas_formanek 0:ea088908ad26 246 0, FSK_FIX_LENGTH_PAYLOAD_ON, 0, FSK_CRC_ENABLED,
lukas_formanek 0:ea088908ad26 247 0, 0, false, true );
lukas_formanek 0:ea088908ad26 248
lukas_formanek 0:ea088908ad26 249 #else
lukas_formanek 0:ea088908ad26 250
lukas_formanek 0:ea088908ad26 251 #error "Nie je definovany typ modemu."
lukas_formanek 0:ea088908ad26 252
lukas_formanek 0:ea088908ad26 253 #endif
lukas_formanek 0:ea088908ad26 254 // Konfiguracia pre moznost max. vysielacieho vykonu
lukas_formanek 0:ea088908ad26 255 uint8_t paConfig;
lukas_formanek 0:ea088908ad26 256 paConfig = radio.Read( REG_PACONFIG );
lukas_formanek 0:ea088908ad26 257 paConfig |= RF_PACONFIG_PASELECT_PABOOST;
lukas_formanek 0:ea088908ad26 258 radio.Write( REG_PACONFIG, paConfig );
lukas_formanek 5:19b34c4d27a1 259
lukas_formanek 0:ea088908ad26 260 pc.printf("________Start aplikacie________\r\n" );
lukas_formanek 2:0499e1d037a5 261 timeOnAirSec = (radio.TimeOnAir( MODEM_LORA, 10)/1000.0); // time on air v ms
lukas_formanek 0:ea088908ad26 262 pc.printf( "\n\n\r------- Time on air : %f sec. -------\n\r", timeOnAirSec);
lukas_formanek 0:ea088908ad26 263 indicationLed = 1;
lukas_formanek 3:7a3ddda464bf 264 InitRandom();
lukas_formanek 3:7a3ddda464bf 265 messageNumber = rand();
lukas_formanek 0:ea088908ad26 266 radio.Rx(0);
lukas_formanek 0:ea088908ad26 267 };
lukas_formanek 0:ea088908ad26 268
lukas_formanek 3:7a3ddda464bf 269 void RFM95W::InitRandom()
lukas_formanek 3:7a3ddda464bf 270 {
lukas_formanek 3:7a3ddda464bf 271 uint32_t seed;
lukas_formanek 3:7a3ddda464bf 272 uint8_t loops = 3;
lukas_formanek 3:7a3ddda464bf 273 for (int i=0; i<(32*loops); i++) {
lukas_formanek 3:7a3ddda464bf 274 seed ^= noise.read_u16();
lukas_formanek 5:19b34c4d27a1 275 if (seed & 1<31) {
lukas_formanek 3:7a3ddda464bf 276 seed <<= 1;
lukas_formanek 3:7a3ddda464bf 277 seed |= 1;
lukas_formanek 3:7a3ddda464bf 278 } else
lukas_formanek 3:7a3ddda464bf 279 seed <<= 1;
lukas_formanek 3:7a3ddda464bf 280 }
lukas_formanek 3:7a3ddda464bf 281 srand(seed);
lukas_formanek 3:7a3ddda464bf 282 };