Akash Vibhute / Mbed 2 deprecated DISCO-L072CZ-LRWAN1_LoRa_USB_Rx

First attempt at LoRa USB Rx

Dependencies:   BufferedSerial SX1276GenericLib mbed

Fork of DISCO-L072CZ-LRWAN1_LoRa_PingPong by ST

main.cpp@11:17b932171aee, 2018-01-02 (annotated)

Committer:
akashvibhute
Date:
Tue Jan 02 06:32:31 2018 +0000
Revision:
11:17b932171aee
Parent:
10:f84959c2e044 
First attempt at LoRa USB Rx

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Helmut64 0:c43b6919ae15 1 /*
Helmut64 0:c43b6919ae15 2 * Copyright (c) 2017 Helmut Tschemernjak
Helmut64 0:c43b6919ae15 3 * 30826 Garbsen (Hannover) Germany
Helmut64 0:c43b6919ae15 4 * Licensed under the Apache License, Version 2.0);
Helmut64 0:c43b6919ae15 5 */
Helmut64 0:c43b6919ae15 6 #include "main.h"
Helmut64 0:c43b6919ae15 7
Helmut64 0:c43b6919ae15 8 DigitalOut myled(LED1);
Helmut64 0:c43b6919ae15 9 BufferedSerial *ser;
Helmut64 0:c43b6919ae15 10
akashvibhute 11:17b932171aee 11
akashvibhute 11:17b932171aee 12 #ifdef FEATURE_LORA
akashvibhute 11:17b932171aee 13
akashvibhute 11:17b932171aee 14 /* Set this flag to '1' to display debug messages on the console */
akashvibhute 11:17b932171aee 15 #define DEBUG_MESSAGE 0
akashvibhute 11:17b932171aee 16
akashvibhute 11:17b932171aee 17 /* Set this flag to '1' to use the LoRa modulation or to '0' to use FSK modulation */
akashvibhute 11:17b932171aee 18 #define USE_MODEM_LORA 1
akashvibhute 11:17b932171aee 19 #define USE_MODEM_FSK !USE_MODEM_LORA
akashvibhute 11:17b932171aee 20 #define RF_FREQUENCY 915000000//RF_FREQUENCY_868_1 // Hz
akashvibhute 11:17b932171aee 21 #define TX_OUTPUT_POWER 20 // 14 dBm
akashvibhute 11:17b932171aee 22
akashvibhute 11:17b932171aee 23 #if USE_MODEM_LORA == 1
akashvibhute 11:17b932171aee 24
akashvibhute 11:17b932171aee 25 #define LORA_BANDWIDTH 125000 // LoRa default, details in SX1276::BandwidthMap
akashvibhute 11:17b932171aee 26 #define LORA_SPREADING_FACTOR LORA_SF12
akashvibhute 11:17b932171aee 27 #define LORA_CODINGRATE LORA_ERROR_CODING_RATE_4_5
akashvibhute 11:17b932171aee 28
akashvibhute 11:17b932171aee 29 #define LORA_PREAMBLE_LENGTH 8 // Same for Tx and Rx
akashvibhute 11:17b932171aee 30 #define LORA_SYMBOL_TIMEOUT 5 // Symbols
akashvibhute 11:17b932171aee 31 #define LORA_FIX_LENGTH_PAYLOAD_ON false
akashvibhute 11:17b932171aee 32 #define LORA_FHSS_ENABLED false
akashvibhute 11:17b932171aee 33 #define LORA_NB_SYMB_HOP 4
akashvibhute 11:17b932171aee 34 #define LORA_IQ_INVERSION_ON false
akashvibhute 11:17b932171aee 35 #define LORA_CRC_ENABLED true
akashvibhute 11:17b932171aee 36
akashvibhute 11:17b932171aee 37 #elif USE_MODEM_FSK == 1
akashvibhute 11:17b932171aee 38
akashvibhute 11:17b932171aee 39 #define FSK_FDEV 25000 // Hz
akashvibhute 11:17b932171aee 40 #define FSK_DATARATE 19200 // bps
akashvibhute 11:17b932171aee 41 #define FSK_BANDWIDTH 50000 // Hz
akashvibhute 11:17b932171aee 42 #define FSK_AFC_BANDWIDTH 83333 // Hz
akashvibhute 11:17b932171aee 43 #define FSK_PREAMBLE_LENGTH 5 // Same for Tx and Rx
akashvibhute 11:17b932171aee 44 #define FSK_FIX_LENGTH_PAYLOAD_ON false
akashvibhute 11:17b932171aee 45 #define FSK_CRC_ENABLED true
akashvibhute 11:17b932171aee 46
akashvibhute 11:17b932171aee 47 #else
akashvibhute 11:17b932171aee 48 #error "Please define a modem in the compiler options."
akashvibhute 11:17b932171aee 49 #endif
akashvibhute 11:17b932171aee 50
akashvibhute 11:17b932171aee 51
akashvibhute 11:17b932171aee 52 #define RX_TIMEOUT_VALUE 8000//3500 // in ms
akashvibhute 11:17b932171aee 53
akashvibhute 11:17b932171aee 54 //#define BUFFER_SIZE 32 // Define the payload size here
akashvibhute 11:17b932171aee 55 #define BUFFER_SIZE 4//64 // Define the payload size here
akashvibhute 11:17b932171aee 56
akashvibhute 11:17b932171aee 57 /*
akashvibhute 11:17b932171aee 58 * Global variables declarations
akashvibhute 11:17b932171aee 59 */
akashvibhute 11:17b932171aee 60 typedef enum
akashvibhute 11:17b932171aee 61 {
akashvibhute 11:17b932171aee 62 LOWPOWER = 0,
akashvibhute 11:17b932171aee 63 IDLE,
akashvibhute 11:17b932171aee 64
akashvibhute 11:17b932171aee 65 RX,
akashvibhute 11:17b932171aee 66 RX_TIMEOUT,
akashvibhute 11:17b932171aee 67 RX_ERROR,
akashvibhute 11:17b932171aee 68
akashvibhute 11:17b932171aee 69 TX,
akashvibhute 11:17b932171aee 70 TX_TIMEOUT,
akashvibhute 11:17b932171aee 71
akashvibhute 11:17b932171aee 72 CAD,
akashvibhute 11:17b932171aee 73 CAD_DONE
akashvibhute 11:17b932171aee 74 } AppStates_t;
akashvibhute 11:17b932171aee 75
akashvibhute 11:17b932171aee 76 volatile AppStates_t State = LOWPOWER;
akashvibhute 11:17b932171aee 77
akashvibhute 11:17b932171aee 78 /*!
akashvibhute 11:17b932171aee 79 * Radio events function pointer
akashvibhute 11:17b932171aee 80 */
akashvibhute 11:17b932171aee 81 static RadioEvents_t RadioEvents;
akashvibhute 11:17b932171aee 82
akashvibhute 11:17b932171aee 83 /*
akashvibhute 11:17b932171aee 84 * Global variables declarations
akashvibhute 11:17b932171aee 85 */
akashvibhute 11:17b932171aee 86 SX1276Generic *Radio;
akashvibhute 11:17b932171aee 87
akashvibhute 11:17b932171aee 88
akashvibhute 11:17b932171aee 89 //const uint8_t PingMsg[] = { 0xff, 0xff, 0x00, 0x00, 'P', 'I', 'N', 'G'};// "PING";
akashvibhute 11:17b932171aee 90 const uint8_t PingMsg[] = { 'P', 'I', 'N', 'G'};// "PING";
akashvibhute 11:17b932171aee 91 //const uint8_t PongMsg[] = { 0xff, 0xff, 0x00, 0x00, 'P', 'O', 'N', 'G'};// "PONG";
akashvibhute 11:17b932171aee 92 const uint8_t PongMsg[] = { 'P', 'O', 'N', 'G'};// "PONG";
akashvibhute 11:17b932171aee 93
akashvibhute 11:17b932171aee 94 uint16_t BufferSize = BUFFER_SIZE;
akashvibhute 11:17b932171aee 95 uint8_t *Buffer;
akashvibhute 11:17b932171aee 96
akashvibhute 11:17b932171aee 97 DigitalOut *led3;
akashvibhute 11:17b932171aee 98 DigitalOut *led = new DigitalOut(LED1);
akashvibhute 11:17b932171aee 99
akashvibhute 11:17b932171aee 100 uint8_t i;
akashvibhute 11:17b932171aee 101 bool isMaster = false;
akashvibhute 11:17b932171aee 102
akashvibhute 11:17b932171aee 103 uint8_t SX1276DataTx[4];
akashvibhute 11:17b932171aee 104 uint8_t SX1276DataRx[4];
akashvibhute 11:17b932171aee 105 bool mode = false; // false is slave, true is master
akashvibhute 11:17b932171aee 106
akashvibhute 11:17b932171aee 107 uint8_t serialRxBuffer[4];
Helmut64 0:c43b6919ae15 108 int main() {
Helmut64 0:c43b6919ae15 109 SystemClock_Config();
Helmut64 0:c43b6919ae15 110 ser = new BufferedSerial(USBTX, USBRX);
akashvibhute 11:17b932171aee 111 ser->baud(115200);
Helmut64 0:c43b6919ae15 112 ser->format(8);
Helmut64 0:c43b6919ae15 113 ser->printf("Hello World\n\r");
Helmut64 0:c43b6919ae15 114 myled = 1;
Helmut64 0:c43b6919ae15 115
akashvibhute 11:17b932171aee 116 #if( defined ( TARGET_KL25Z ) || defined ( TARGET_LPC11U6X ) )
akashvibhute 11:17b932171aee 117 DigitalOut *led = new DigitalOut(LED2);
akashvibhute 11:17b932171aee 118 #elif defined(TARGET_NUCLEO_L073RZ)
akashvibhute 11:17b932171aee 119 DigitalOut *led = new DigitalOut(LED4); // RX red
akashvibhute 11:17b932171aee 120 led3 = new DigitalOut(LED3); // TX blue
akashvibhute 11:17b932171aee 121 #else
akashvibhute 11:17b932171aee 122 DigitalOut *led = new DigitalOut(LED1);
akashvibhute 11:17b932171aee 123 led3 = led;
akashvibhute 11:17b932171aee 124 #endif
akashvibhute 11:17b932171aee 125
akashvibhute 11:17b932171aee 126 Buffer = new uint8_t[BUFFER_SIZE];
akashvibhute 11:17b932171aee 127 *led3 = 1;
akashvibhute 11:17b932171aee 128
akashvibhute 11:17b932171aee 129 #ifdef B_L072Z_LRWAN1_LORA
akashvibhute 11:17b932171aee 130 Radio = new SX1276Generic(NULL, MURATA_SX1276,
akashvibhute 11:17b932171aee 131 LORA_SPI_MOSI, LORA_SPI_MISO, LORA_SPI_SCLK, LORA_CS, LORA_RESET,
akashvibhute 11:17b932171aee 132 LORA_DIO0, LORA_DIO1, LORA_DIO2, LORA_DIO3, LORA_DIO4, LORA_DIO5,
akashvibhute 11:17b932171aee 133 LORA_ANT_RX, LORA_ANT_TX, LORA_ANT_BOOST, LORA_TCXO);
akashvibhute 11:17b932171aee 134 #else // RFM95
akashvibhute 11:17b932171aee 135 Radio = new SX1276Generic(NULL, RFM95_SX1276,
akashvibhute 11:17b932171aee 136 LORA_SPI_MOSI, LORA_SPI_MISO, LORA_SPI_SCLK, LORA_CS, LORA_RESET,
akashvibhute 11:17b932171aee 137 LORA_DIO0, LORA_DIO1, LORA_DIO2, LORA_DIO3, LORA_DIO4, LORA_DIO5);
akashvibhute 11:17b932171aee 138
akashvibhute 11:17b932171aee 139 #endif
akashvibhute 11:17b932171aee 140
akashvibhute 11:17b932171aee 141
akashvibhute 11:17b932171aee 142 isMaster = true;
akashvibhute 11:17b932171aee 143
akashvibhute 11:17b932171aee 144 dprintf("SX1276 Ping Pong Demo Application" );
akashvibhute 11:17b932171aee 145 dprintf("Freqency: %.1f", (double)RF_FREQUENCY/1000000.0);
akashvibhute 11:17b932171aee 146 dprintf("TXPower: %d dBm", TX_OUTPUT_POWER);
akashvibhute 11:17b932171aee 147 #if USE_MODEM_LORA == 1
akashvibhute 11:17b932171aee 148 dprintf("Bandwidth: %d Hz", LORA_BANDWIDTH);
akashvibhute 11:17b932171aee 149 dprintf("Spreading factor: SF%d", LORA_SPREADING_FACTOR);
akashvibhute 11:17b932171aee 150 #elif USE_MODEM_FSK == 1
akashvibhute 11:17b932171aee 151 dprintf("Bandwidth: %d kHz", FSK_BANDWIDTH);
akashvibhute 11:17b932171aee 152 dprintf("Baudrate: %d", FSK_DATARATE);
akashvibhute 11:17b932171aee 153 #endif
akashvibhute 11:17b932171aee 154 // Initialize Radio driver
akashvibhute 11:17b932171aee 155 RadioEvents.TxDone = OnTxDone;
akashvibhute 11:17b932171aee 156 RadioEvents.RxDone = OnRxDone;
akashvibhute 11:17b932171aee 157 RadioEvents.RxError = OnRxError;
akashvibhute 11:17b932171aee 158 RadioEvents.TxTimeout = OnTxTimeout;
akashvibhute 11:17b932171aee 159 RadioEvents.RxTimeout = OnRxTimeout;
akashvibhute 11:17b932171aee 160 if (Radio->Init( &RadioEvents ) == false) {
akashvibhute 11:17b932171aee 161 while(1) {
akashvibhute 11:17b932171aee 162 dprintf("Radio could not be detected!");
akashvibhute 11:17b932171aee 163 wait( 1 );
akashvibhute 11:17b932171aee 164 }
akashvibhute 11:17b932171aee 165 }
akashvibhute 11:17b932171aee 166
akashvibhute 11:17b932171aee 167
akashvibhute 11:17b932171aee 168 switch(Radio->DetectBoardType()) {
akashvibhute 11:17b932171aee 169 case SX1276MB1LAS:
akashvibhute 11:17b932171aee 170 if (DEBUG_MESSAGE)
akashvibhute 11:17b932171aee 171 dprintf(" > Board Type: SX1276MB1LAS <");
akashvibhute 11:17b932171aee 172 break;
akashvibhute 11:17b932171aee 173 case SX1276MB1MAS:
akashvibhute 11:17b932171aee 174 if (DEBUG_MESSAGE)
akashvibhute 11:17b932171aee 175 dprintf(" > Board Type: SX1276MB1LAS <");
akashvibhute 11:17b932171aee 176 case MURATA_SX1276:
akashvibhute 11:17b932171aee 177 if (DEBUG_MESSAGE)
akashvibhute 11:17b932171aee 178 dprintf(" > Board Type: MURATA_SX1276_STM32L0 <");
akashvibhute 11:17b932171aee 179 break;
akashvibhute 11:17b932171aee 180 case RFM95_SX1276:
akashvibhute 11:17b932171aee 181 if (DEBUG_MESSAGE)
akashvibhute 11:17b932171aee 182 dprintf(" > HopeRF RFM95xx <");
akashvibhute 11:17b932171aee 183 break;
akashvibhute 11:17b932171aee 184 default:
akashvibhute 11:17b932171aee 185 dprintf(" > Board Type: unknown <");
akashvibhute 11:17b932171aee 186 }
akashvibhute 11:17b932171aee 187
akashvibhute 11:17b932171aee 188 Radio->SetChannel(RF_FREQUENCY );
akashvibhute 11:17b932171aee 189
akashvibhute 11:17b932171aee 190 #if USE_MODEM_LORA == 1
akashvibhute 11:17b932171aee 191
akashvibhute 11:17b932171aee 192 if (LORA_FHSS_ENABLED)
akashvibhute 11:17b932171aee 193 dprintf(" > LORA FHSS Mode <");
akashvibhute 11:17b932171aee 194 if (!LORA_FHSS_ENABLED)
akashvibhute 11:17b932171aee 195 dprintf(" > LORA Mode <");
akashvibhute 11:17b932171aee 196
akashvibhute 11:17b932171aee 197 Radio->SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH,
akashvibhute 11:17b932171aee 198 LORA_SPREADING_FACTOR, LORA_CODINGRATE,
akashvibhute 11:17b932171aee 199 LORA_PREAMBLE_LENGTH, LORA_FIX_LENGTH_PAYLOAD_ON,
akashvibhute 11:17b932171aee 200 LORA_CRC_ENABLED, LORA_FHSS_ENABLED, LORA_NB_SYMB_HOP,
akashvibhute 11:17b932171aee 201 LORA_IQ_INVERSION_ON, 2000 );
akashvibhute 11:17b932171aee 202
akashvibhute 11:17b932171aee 203 Radio->SetRxConfig( MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR,
akashvibhute 11:17b932171aee 204 LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH,
akashvibhute 11:17b932171aee 205 LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, 0,
akashvibhute 11:17b932171aee 206 LORA_CRC_ENABLED, LORA_FHSS_ENABLED, LORA_NB_SYMB_HOP,
akashvibhute 11:17b932171aee 207 LORA_IQ_INVERSION_ON, true );
akashvibhute 11:17b932171aee 208
akashvibhute 11:17b932171aee 209 #elif USE_MODEM_FSK == 1
akashvibhute 11:17b932171aee 210
akashvibhute 11:17b932171aee 211 dprintf(" > FSK Mode <");
akashvibhute 11:17b932171aee 212 Radio->SetTxConfig( MODEM_FSK, TX_OUTPUT_POWER, FSK_FDEV, 0,
akashvibhute 11:17b932171aee 213 FSK_DATARATE, 0,
akashvibhute 11:17b932171aee 214 FSK_PREAMBLE_LENGTH, FSK_FIX_LENGTH_PAYLOAD_ON,
akashvibhute 11:17b932171aee 215 FSK_CRC_ENABLED, 0, 0, 0, 2000 );
akashvibhute 11:17b932171aee 216
akashvibhute 11:17b932171aee 217 Radio->SetRxConfig( MODEM_FSK, FSK_BANDWIDTH, FSK_DATARATE,
akashvibhute 11:17b932171aee 218 0, FSK_AFC_BANDWIDTH, FSK_PREAMBLE_LENGTH,
akashvibhute 11:17b932171aee 219 0, FSK_FIX_LENGTH_PAYLOAD_ON, 0, FSK_CRC_ENABLED,
akashvibhute 11:17b932171aee 220 0, 0, false, true );
akashvibhute 11:17b932171aee 221
akashvibhute 11:17b932171aee 222 #else
akashvibhute 11:17b932171aee 223
akashvibhute 11:17b932171aee 224 #error "Please define a modem in the compiler options."
akashvibhute 11:17b932171aee 225
akashvibhute 11:17b932171aee 226 #endif
akashvibhute 11:17b932171aee 227
akashvibhute 11:17b932171aee 228 if (DEBUG_MESSAGE)
akashvibhute 11:17b932171aee 229 dprintf("Starting Rx loop");
akashvibhute 11:17b932171aee 230
akashvibhute 11:17b932171aee 231
akashvibhute 11:17b932171aee 232 Radio->Rx( RX_TIMEOUT_VALUE );
akashvibhute 11:17b932171aee 233 /*
akashvibhute 11:17b932171aee 234 SX1276DataTx[0] = 0x0A;
akashvibhute 11:17b932171aee 235 SX1276DataTx[1] = 0x0B;
akashvibhute 11:17b932171aee 236 SX1276DataTx[2] = 0x0C;
akashvibhute 11:17b932171aee 237 SX1276DataTx[3] = 0x0D;
akashvibhute 11:17b932171aee 238 */
akashvibhute 11:17b932171aee 239
akashvibhute 11:17b932171aee 240 while(1)
akashvibhute 11:17b932171aee 241 SX1276Comm(0, 1);
akashvibhute 11:17b932171aee 242 //SX1276PingPong();
akashvibhute 11:17b932171aee 243
akashvibhute 11:17b932171aee 244
Helmut64 0:c43b6919ae15 245 }
Helmut64 0:c43b6919ae15 246
Helmut64 0:c43b6919ae15 247
Helmut64 0:c43b6919ae15 248
Helmut64 0:c43b6919ae15 249
Helmut64 0:c43b6919ae15 250 void SystemClock_Config(void)
Helmut64 0:c43b6919ae15 251 {
Helmut64 0:c43b6919ae15 252 #ifdef B_L072Z_LRWAN1_LORA
Helmut64 0:c43b6919ae15 253 /*
Helmut64 0:c43b6919ae15 254 * The L072Z_LRWAN1_LORA clock setup is somewhat differnt from the Nucleo board.
Helmut64 0:c43b6919ae15 255 * It has no LSE.
Helmut64 0:c43b6919ae15 256 */
Helmut64 0:c43b6919ae15 257 RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
Helmut64 0:c43b6919ae15 258 RCC_OscInitTypeDef RCC_OscInitStruct = {0};
Helmut64 0:c43b6919ae15 259
Helmut64 0:c43b6919ae15 260 /* Enable HSE Oscillator and Activate PLL with HSE as source */
Helmut64 0:c43b6919ae15 261 RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI;
Helmut64 0:c43b6919ae15 262 RCC_OscInitStruct.HSEState = RCC_HSE_OFF;
Helmut64 0:c43b6919ae15 263 RCC_OscInitStruct.HSIState = RCC_HSI_ON;
Helmut64 0:c43b6919ae15 264 RCC_OscInitStruct.HSICalibrationValue = RCC_HSICALIBRATION_DEFAULT;
Helmut64 0:c43b6919ae15 265 RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
Helmut64 0:c43b6919ae15 266 RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSI;
Helmut64 0:c43b6919ae15 267 RCC_OscInitStruct.PLL.PLLMUL = RCC_PLLMUL_6;
Helmut64 0:c43b6919ae15 268 RCC_OscInitStruct.PLL.PLLDIV = RCC_PLLDIV_3;
Helmut64 0:c43b6919ae15 269
Helmut64 0:c43b6919ae15 270 if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK) {
Helmut64 0:c43b6919ae15 271 // Error_Handler();
Helmut64 0:c43b6919ae15 272 }
Helmut64 0:c43b6919ae15 273
Helmut64 0:c43b6919ae15 274 /* Set Voltage scale1 as MCU will run at 32MHz */
Helmut64 0:c43b6919ae15 275 __HAL_RCC_PWR_CLK_ENABLE();
Helmut64 0:c43b6919ae15 276 __HAL_PWR_VOLTAGESCALING_CONFIG(PWR_REGULATOR_VOLTAGE_SCALE1);
Helmut64 0:c43b6919ae15 277
Helmut64 0:c43b6919ae15 278 /* Poll VOSF bit of in PWR_CSR. Wait until it is reset to 0 */
Helmut64 0:c43b6919ae15 279 while (__HAL_PWR_GET_FLAG(PWR_FLAG_VOS) != RESET) {};
Helmut64 0:c43b6919ae15 280
Helmut64 0:c43b6919ae15 281 /* Select PLL as system clock source and configure the HCLK, PCLK1 and PCLK2
Helmut64 0:c43b6919ae15 282 clocks dividers */
Helmut64 0:c43b6919ae15 283 RCC_ClkInitStruct.ClockType = (RCC_CLOCKTYPE_SYSCLK | RCC_CLOCKTYPE_HCLK | RCC_CLOCKTYPE_PCLK1 | RCC_CLOCKTYPE_PCLK2);
Helmut64 0:c43b6919ae15 284 RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
Helmut64 0:c43b6919ae15 285 RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
Helmut64 0:c43b6919ae15 286 RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV1;
Helmut64 0:c43b6919ae15 287 RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
Helmut64 0:c43b6919ae15 288 if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_1) != HAL_OK) {
Helmut64 0:c43b6919ae15 289 // Error_Handler();
Helmut64 0:c43b6919ae15 290 }
Helmut64 0:c43b6919ae15 291 #endif
Helmut64 0:c43b6919ae15 292 }
Helmut64 0:c43b6919ae15 293
Helmut64 0:c43b6919ae15 294 void dump(const char *title, const void *data, int len, bool dwords)
Helmut64 0:c43b6919ae15 295 {
Helmut64 0:c43b6919ae15 296 dprintf("dump(\"%s\", 0x%x, %d bytes)", title, data, len);
Helmut64 0:c43b6919ae15 297
Helmut64 0:c43b6919ae15 298 int i, j, cnt;
Helmut64 0:c43b6919ae15 299 unsigned char *u;
Helmut64 0:c43b6919ae15 300 const int width = 16;
Helmut64 0:c43b6919ae15 301 const int seppos = 7;
Helmut64 0:c43b6919ae15 302
Helmut64 0:c43b6919ae15 303 cnt = 0;
Helmut64 0:c43b6919ae15 304 u = (unsigned char *)data;
Helmut64 0:c43b6919ae15 305 while (len > 0) {
Helmut64 0:c43b6919ae15 306 ser->printf("%08x: ", (unsigned int)data + cnt);
Helmut64 0:c43b6919ae15 307 if (dwords) {
Helmut64 0:c43b6919ae15 308 unsigned int *ip = ( unsigned int *)u;
Helmut64 0:c43b6919ae15 309 ser->printf(" 0x%08x\r\n", *ip);
Helmut64 0:c43b6919ae15 310 u+= 4;
Helmut64 0:c43b6919ae15 311 len -= 4;
Helmut64 0:c43b6919ae15 312 cnt += 4;
Helmut64 0:c43b6919ae15 313 continue;
Helmut64 0:c43b6919ae15 314 }
Helmut64 0:c43b6919ae15 315 cnt += width;
Helmut64 0:c43b6919ae15 316 j = len < width ? len : width;
Helmut64 0:c43b6919ae15 317 for (i = 0; i < j; i++) {
Helmut64 0:c43b6919ae15 318 ser->printf("%2.2x ", *(u + i));
Helmut64 0:c43b6919ae15 319 if (i == seppos)
Helmut64 0:c43b6919ae15 320 ser->putc(' ');
Helmut64 0:c43b6919ae15 321 }
Helmut64 0:c43b6919ae15 322 ser->putc(' ');
Helmut64 0:c43b6919ae15 323 if (j < width) {
Helmut64 0:c43b6919ae15 324 i = width - j;
Helmut64 0:c43b6919ae15 325 if (i > seppos + 1)
Helmut64 0:c43b6919ae15 326 ser->putc(' ');
Helmut64 0:c43b6919ae15 327 while (i--) {
Helmut64 0:c43b6919ae15 328 printf("%s", " ");
Helmut64 0:c43b6919ae15 329 }
Helmut64 0:c43b6919ae15 330 }
Helmut64 0:c43b6919ae15 331 for (i = 0; i < j; i++) {
Helmut64 0:c43b6919ae15 332 int c = *(u + i);
Helmut64 0:c43b6919ae15 333 if (c >= ' ' && c <= '~')
Helmut64 0:c43b6919ae15 334 ser->putc(c);
Helmut64 0:c43b6919ae15 335 else
Helmut64 0:c43b6919ae15 336 ser->putc('.');
Helmut64 0:c43b6919ae15 337 if (i == seppos)
Helmut64 0:c43b6919ae15 338 ser->putc(' ');
Helmut64 0:c43b6919ae15 339 }
Helmut64 0:c43b6919ae15 340 len -= width;
Helmut64 0:c43b6919ae15 341 u += width;
Helmut64 0:c43b6919ae15 342 ser->printf("\r\n");
Helmut64 0:c43b6919ae15 343 }
Helmut64 0:c43b6919ae15 344 ser->printf("--\r\n");
Helmut64 0:c43b6919ae15 345 }
akashvibhute 11:17b932171aee 346
akashvibhute 11:17b932171aee 347
akashvibhute 11:17b932171aee 348
akashvibhute 11:17b932171aee 349
akashvibhute 11:17b932171aee 350 int SX1276PingPong()
akashvibhute 11:17b932171aee 351 {
akashvibhute 11:17b932171aee 352
akashvibhute 11:17b932171aee 353
akashvibhute 11:17b932171aee 354 while( 1 )
akashvibhute 11:17b932171aee 355 {
akashvibhute 11:17b932171aee 356 #ifdef TARGET_STM32L4
akashvibhute 11:17b932171aee 357 WatchDogUpdate();
akashvibhute 11:17b932171aee 358 #endif
akashvibhute 11:17b932171aee 359
akashvibhute 11:17b932171aee 360 switch( State )
akashvibhute 11:17b932171aee 361 {
akashvibhute 11:17b932171aee 362 case RX:
akashvibhute 11:17b932171aee 363 *led3 = 0;
akashvibhute 11:17b932171aee 364 if( isMaster == true )
akashvibhute 11:17b932171aee 365 {
akashvibhute 11:17b932171aee 366 if( BufferSize > 0 )
akashvibhute 11:17b932171aee 367 {
akashvibhute 11:17b932171aee 368 if( memcmp(Buffer, PongMsg, sizeof(PongMsg)) == 0 )
akashvibhute 11:17b932171aee 369 {
akashvibhute 11:17b932171aee 370 *led = !*led;
akashvibhute 11:17b932171aee 371 dprintf( "...Pong" );
akashvibhute 11:17b932171aee 372 // Send the next PING frame
akashvibhute 11:17b932171aee 373 memcpy(Buffer, PingMsg, sizeof(PingMsg));
akashvibhute 11:17b932171aee 374 // We fill the buffer with numbers for the payload
akashvibhute 11:17b932171aee 375 for( i = sizeof(PingMsg); i < BufferSize; i++ )
akashvibhute 11:17b932171aee 376 {
akashvibhute 11:17b932171aee 377 Buffer[i] = i - sizeof(PingMsg);
akashvibhute 11:17b932171aee 378 }
akashvibhute 11:17b932171aee 379 //wait_ms( 10 );
akashvibhute 11:17b932171aee 380 Radio->Send( Buffer, BufferSize );
akashvibhute 11:17b932171aee 381 }
akashvibhute 11:17b932171aee 382 else if( memcmp(Buffer, PingMsg, sizeof(PingMsg)) == 0 )
akashvibhute 11:17b932171aee 383 { // A master already exists then become a slave
akashvibhute 11:17b932171aee 384 dprintf( "...Ping" );
akashvibhute 11:17b932171aee 385 *led = !*led;
akashvibhute 11:17b932171aee 386 isMaster = false;
akashvibhute 11:17b932171aee 387 // Send the next PONG frame
akashvibhute 11:17b932171aee 388 memcpy(Buffer, PongMsg, sizeof(PongMsg));
akashvibhute 11:17b932171aee 389 // We fill the buffer with numbers for the payload
akashvibhute 11:17b932171aee 390 for( i = sizeof(PongMsg); i < BufferSize; i++ )
akashvibhute 11:17b932171aee 391 {
akashvibhute 11:17b932171aee 392 Buffer[i] = i - sizeof(PongMsg);
akashvibhute 11:17b932171aee 393 }
akashvibhute 11:17b932171aee 394 //wait_ms( 10 );
akashvibhute 11:17b932171aee 395 Radio->Send( Buffer, BufferSize );
akashvibhute 11:17b932171aee 396 }
akashvibhute 11:17b932171aee 397 else // valid reception but neither a PING or a PONG message
akashvibhute 11:17b932171aee 398 { // Set device as master ans start again
akashvibhute 11:17b932171aee 399 isMaster = true;
akashvibhute 11:17b932171aee 400 Radio->Rx( RX_TIMEOUT_VALUE );
akashvibhute 11:17b932171aee 401 }
akashvibhute 11:17b932171aee 402 }
akashvibhute 11:17b932171aee 403 }
akashvibhute 11:17b932171aee 404 else
akashvibhute 11:17b932171aee 405 {
akashvibhute 11:17b932171aee 406 if( BufferSize > 0 )
akashvibhute 11:17b932171aee 407 {
akashvibhute 11:17b932171aee 408 if( memcmp(Buffer, PingMsg, sizeof(PingMsg)) == 0 )
akashvibhute 11:17b932171aee 409 {
akashvibhute 11:17b932171aee 410 *led = !*led;
akashvibhute 11:17b932171aee 411 dprintf( "...Ping" );
akashvibhute 11:17b932171aee 412 // Send the reply to the PING string
akashvibhute 11:17b932171aee 413 memcpy(Buffer, PongMsg, sizeof(PongMsg));
akashvibhute 11:17b932171aee 414 // We fill the buffer with numbers for the payload
akashvibhute 11:17b932171aee 415 for( i = sizeof(PongMsg); i < BufferSize; i++ )
akashvibhute 11:17b932171aee 416 {
akashvibhute 11:17b932171aee 417 Buffer[i] = i - sizeof(PongMsg);
akashvibhute 11:17b932171aee 418 }
akashvibhute 11:17b932171aee 419 //wait_ms( 10 );
akashvibhute 11:17b932171aee 420 Radio->Send( Buffer, BufferSize );
akashvibhute 11:17b932171aee 421 }
akashvibhute 11:17b932171aee 422 else // valid reception but not a PING as expected
akashvibhute 11:17b932171aee 423 { // Set device as master and start again
akashvibhute 11:17b932171aee 424 isMaster = true;
akashvibhute 11:17b932171aee 425 Radio->Rx( RX_TIMEOUT_VALUE );
akashvibhute 11:17b932171aee 426 }
akashvibhute 11:17b932171aee 427 }
akashvibhute 11:17b932171aee 428 }
akashvibhute 11:17b932171aee 429 State = LOWPOWER;
akashvibhute 11:17b932171aee 430 break;
akashvibhute 11:17b932171aee 431 case TX:
akashvibhute 11:17b932171aee 432 *led3 = 1;
akashvibhute 11:17b932171aee 433 if( isMaster == true )
akashvibhute 11:17b932171aee 434 {
akashvibhute 11:17b932171aee 435 dprintf("Ping..." );
akashvibhute 11:17b932171aee 436 }
akashvibhute 11:17b932171aee 437 else
akashvibhute 11:17b932171aee 438 {
akashvibhute 11:17b932171aee 439 dprintf("Pong..." );
akashvibhute 11:17b932171aee 440 }
akashvibhute 11:17b932171aee 441 Radio->Rx( RX_TIMEOUT_VALUE );
akashvibhute 11:17b932171aee 442 State = LOWPOWER;
akashvibhute 11:17b932171aee 443 break;
akashvibhute 11:17b932171aee 444 case RX_TIMEOUT:
akashvibhute 11:17b932171aee 445 if( isMaster == true )
akashvibhute 11:17b932171aee 446 {
akashvibhute 11:17b932171aee 447 // Send the next PING frame
akashvibhute 11:17b932171aee 448 memcpy(Buffer, PingMsg, sizeof(PingMsg));
akashvibhute 11:17b932171aee 449 for( i = sizeof(PingMsg); i < BufferSize; i++ )
akashvibhute 11:17b932171aee 450 {
akashvibhute 11:17b932171aee 451 Buffer[i] = i - sizeof(PingMsg);
akashvibhute 11:17b932171aee 452 }
akashvibhute 11:17b932171aee 453 //wait_ms( 10 );
akashvibhute 11:17b932171aee 454 Radio->Send( Buffer, BufferSize );
akashvibhute 11:17b932171aee 455 }
akashvibhute 11:17b932171aee 456 else
akashvibhute 11:17b932171aee 457 {
akashvibhute 11:17b932171aee 458 Radio->Rx( RX_TIMEOUT_VALUE );
akashvibhute 11:17b932171aee 459 }
akashvibhute 11:17b932171aee 460 State = LOWPOWER;
akashvibhute 11:17b932171aee 461 break;
akashvibhute 11:17b932171aee 462 case RX_ERROR:
akashvibhute 11:17b932171aee 463 // We have received a Packet with a CRC error, send reply as if packet was correct
akashvibhute 11:17b932171aee 464 if( isMaster == true )
akashvibhute 11:17b932171aee 465 {
akashvibhute 11:17b932171aee 466 // Send the next PING frame
akashvibhute 11:17b932171aee 467 memcpy(Buffer, PingMsg, sizeof(PingMsg));
akashvibhute 11:17b932171aee 468 for( i = 4; i < BufferSize; i++ )
akashvibhute 11:17b932171aee 469 {
akashvibhute 11:17b932171aee 470 Buffer[i] = i - 4;
akashvibhute 11:17b932171aee 471 }
akashvibhute 11:17b932171aee 472 //wait_ms( 10 );
akashvibhute 11:17b932171aee 473 Radio->Send( Buffer, BufferSize );
akashvibhute 11:17b932171aee 474 }
akashvibhute 11:17b932171aee 475 else
akashvibhute 11:17b932171aee 476 {
akashvibhute 11:17b932171aee 477 // Send the next PONG frame
akashvibhute 11:17b932171aee 478 memcpy(Buffer, PongMsg, sizeof(PongMsg));
akashvibhute 11:17b932171aee 479 for( i = sizeof(PongMsg); i < BufferSize; i++ )
akashvibhute 11:17b932171aee 480 {
akashvibhute 11:17b932171aee 481 Buffer[i] = i - sizeof(PongMsg);
akashvibhute 11:17b932171aee 482 }
akashvibhute 11:17b932171aee 483 //wait_ms( 10 );
akashvibhute 11:17b932171aee 484 Radio->Send( Buffer, BufferSize );
akashvibhute 11:17b932171aee 485 }
akashvibhute 11:17b932171aee 486 State = LOWPOWER;
akashvibhute 11:17b932171aee 487 break;
akashvibhute 11:17b932171aee 488 case TX_TIMEOUT:
akashvibhute 11:17b932171aee 489 Radio->Rx( RX_TIMEOUT_VALUE );
akashvibhute 11:17b932171aee 490 State = LOWPOWER;
akashvibhute 11:17b932171aee 491 break;
akashvibhute 11:17b932171aee 492 case LOWPOWER:
akashvibhute 11:17b932171aee 493 sleep();
akashvibhute 11:17b932171aee 494 break;
akashvibhute 11:17b932171aee 495 default:
akashvibhute 11:17b932171aee 496 State = LOWPOWER;
akashvibhute 11:17b932171aee 497 break;
akashvibhute 11:17b932171aee 498 }
akashvibhute 11:17b932171aee 499 }
akashvibhute 11:17b932171aee 500 }
akashvibhute 11:17b932171aee 501
akashvibhute 11:17b932171aee 502 void OnTxDone(void *radio)
akashvibhute 11:17b932171aee 503 {
akashvibhute 11:17b932171aee 504 Radio->Sleep( );
akashvibhute 11:17b932171aee 505 State = TX;
akashvibhute 11:17b932171aee 506 if (DEBUG_MESSAGE)
akashvibhute 11:17b932171aee 507 dprintf("> OnTxDone");
akashvibhute 11:17b932171aee 508 }
akashvibhute 11:17b932171aee 509
akashvibhute 11:17b932171aee 510 void OnRxDone(void *radio, uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr)
akashvibhute 11:17b932171aee 511 {
akashvibhute 11:17b932171aee 512 Radio->Sleep( );
akashvibhute 11:17b932171aee 513 BufferSize = size;
akashvibhute 11:17b932171aee 514 memcpy( Buffer, payload, BufferSize );
akashvibhute 11:17b932171aee 515 State = RX;
akashvibhute 11:17b932171aee 516 if (DEBUG_MESSAGE)
akashvibhute 11:17b932171aee 517 dprintf("> OnRxDone: RssiValue=%d dBm, SnrValue=%d", rssi, snr);
akashvibhute 11:17b932171aee 518 //dump("Data:", payload, size);
akashvibhute 11:17b932171aee 519 //ser->printf("Rx Data ~%x%x%x%x\n", payload[0], payload[1], payload[2], payload[3]);
akashvibhute 11:17b932171aee 520 ser->printf("~%02x%02x%02x%02x\n", Buffer[0], Buffer[1], Buffer[2], Buffer[3]);
akashvibhute 11:17b932171aee 521 }
akashvibhute 11:17b932171aee 522
akashvibhute 11:17b932171aee 523 void OnTxTimeout(void *radio)
akashvibhute 11:17b932171aee 524 {
akashvibhute 11:17b932171aee 525 *led3 = 0;
akashvibhute 11:17b932171aee 526 Radio->Sleep( );
akashvibhute 11:17b932171aee 527 State = TX_TIMEOUT;
akashvibhute 11:17b932171aee 528 if(DEBUG_MESSAGE)
akashvibhute 11:17b932171aee 529 dprintf("> OnTxTimeout");
akashvibhute 11:17b932171aee 530 }
akashvibhute 11:17b932171aee 531
akashvibhute 11:17b932171aee 532 void OnRxTimeout(void *radio)
akashvibhute 11:17b932171aee 533 {
akashvibhute 11:17b932171aee 534 *led3 = 0;
akashvibhute 11:17b932171aee 535 Radio->Sleep( );
akashvibhute 11:17b932171aee 536 Buffer[BufferSize-1] = 0;
akashvibhute 11:17b932171aee 537 State = RX_TIMEOUT;
akashvibhute 11:17b932171aee 538 if (DEBUG_MESSAGE)
akashvibhute 11:17b932171aee 539 dprintf("> OnRxTimeout");
akashvibhute 11:17b932171aee 540 }
akashvibhute 11:17b932171aee 541
akashvibhute 11:17b932171aee 542 void OnRxError(void *radio)
akashvibhute 11:17b932171aee 543 {
akashvibhute 11:17b932171aee 544 Radio->Sleep( );
akashvibhute 11:17b932171aee 545 State = RX_ERROR;
akashvibhute 11:17b932171aee 546 if (DEBUG_MESSAGE)
akashvibhute 11:17b932171aee 547 dprintf("> OnRxError");
akashvibhute 11:17b932171aee 548 }
akashvibhute 11:17b932171aee 549
akashvibhute 11:17b932171aee 550 #endif
akashvibhute 11:17b932171aee 551
akashvibhute 11:17b932171aee 552
akashvibhute 11:17b932171aee 553 int SX1276Comm(bool mode, bool ack)
akashvibhute 11:17b932171aee 554 {
akashvibhute 11:17b932171aee 555
akashvibhute 11:17b932171aee 556
akashvibhute 11:17b932171aee 557 Radio->Rx( RX_TIMEOUT_VALUE );
akashvibhute 11:17b932171aee 558 wait_ms(100);
akashvibhute 11:17b932171aee 559
akashvibhute 11:17b932171aee 560
akashvibhute 11:17b932171aee 561
akashvibhute 11:17b932171aee 562
akashvibhute 11:17b932171aee 563 /*switch( State ) {
akashvibhute 11:17b932171aee 564
akashvibhute 11:17b932171aee 565 case RX:
akashvibhute 11:17b932171aee 566 Radio->Rx( RX_TIMEOUT_VALUE );
akashvibhute 11:17b932171aee 567
akashvibhute 11:17b932171aee 568 //memcpy(Buffer, commData, sizeof(Buffer));
akashvibhute 11:17b932171aee 569 //ser->printf("Rx Data\n\r", Buffer[0], Buffer[1], Buffer[2], Buffer[3]);
akashvibhute 11:17b932171aee 570
akashvibhute 11:17b932171aee 571 //State = LOWPOWER;
akashvibhute 11:17b932171aee 572 break;
akashvibhute 11:17b932171aee 573 case TX:
akashvibhute 11:17b932171aee 574
akashvibhute 11:17b932171aee 575 //State = LOWPOWER;
akashvibhute 11:17b932171aee 576 break;
akashvibhute 11:17b932171aee 577 case RX_TIMEOUT:
akashvibhute 11:17b932171aee 578
akashvibhute 11:17b932171aee 579 Radio->Rx( RX_TIMEOUT_VALUE );
akashvibhute 11:17b932171aee 580 //State = LOWPOWER;
akashvibhute 11:17b932171aee 581 break;
akashvibhute 11:17b932171aee 582 case RX_ERROR:
akashvibhute 11:17b932171aee 583
akashvibhute 11:17b932171aee 584 //wait_ms(10);
akashvibhute 11:17b932171aee 585 //Radio->Rx( RX_TIMEOUT_VALUE );
akashvibhute 11:17b932171aee 586 State = LOWPOWER;
akashvibhute 11:17b932171aee 587 break;
akashvibhute 11:17b932171aee 588 case TX_TIMEOUT:
akashvibhute 11:17b932171aee 589
akashvibhute 11:17b932171aee 590 //State = LOWPOWER;
akashvibhute 11:17b932171aee 591 break;
akashvibhute 11:17b932171aee 592 case LOWPOWER:
akashvibhute 11:17b932171aee 593 sleep();
akashvibhute 11:17b932171aee 594 break;
akashvibhute 11:17b932171aee 595 default:
akashvibhute 11:17b932171aee 596 //State = LOWPOWER;
akashvibhute 11:17b932171aee 597 break;
akashvibhute 11:17b932171aee 598 }
akashvibhute 11:17b932171aee 599 */
akashvibhute 11:17b932171aee 600 }