David Zwart / Mbed 2 deprecated SX126X_PingPong_Demo

asd

Dependencies:   mbed SX126xLib

main_pingpong.cpp@2:6554e96e4596, 2021-07-05 (annotated)

Committer:
Madhouse226
Date:
Mon Jul 05 14:49:53 2021 +0000
Revision:
2:6554e96e4596
Parent:
1:ecd6c7ea3545 
asd

Who changed what in which revision?

UserRevisionLine numberNew contents of line
SemBen 0:ea5a948dfc97 1 /*!
SemBen 0:ea5a948dfc97 2 * \file main_pingpong.cpp
SemBen 0:ea5a948dfc97 3 *
SemBen 0:ea5a948dfc97 4 * \brief Ping-Pong implementation
SemBen 0:ea5a948dfc97 5 *
SemBen 0:ea5a948dfc97 6 * \copyright Revised BSD License, see section \ref LICENSE.
SemBen 0:ea5a948dfc97 7 *
SemBen 0:ea5a948dfc97 8 * \code
SemBen 0:ea5a948dfc97 9 * ______ _
SemBen 0:ea5a948dfc97 10 * / _____) _ | |
SemBen 0:ea5a948dfc97 11 * ( (____ _____ ____ _| |_ _____ ____| |__
SemBen 0:ea5a948dfc97 12 * \____ \| ___ | (_ _) ___ |/ ___) _ \
SemBen 0:ea5a948dfc97 13 * _____) ) ____| | | || |_| ____( (___| | | |
SemBen 0:ea5a948dfc97 14 * (______/|_____)_|_|_| \__)_____)\____)_| |_|
mverdy 1:ecd6c7ea3545 15 * (C)2013-2018 Semtech
SemBen 0:ea5a948dfc97 16 *
SemBen 0:ea5a948dfc97 17 * \endcode
SemBen 0:ea5a948dfc97 18 *
SemBen 0:ea5a948dfc97 19 */
SemBen 0:ea5a948dfc97 20
SemBen 0:ea5a948dfc97 21 #include "mbed.h"
SemBen 0:ea5a948dfc97 22 #include "sx126x-hal.h"
SemBen 0:ea5a948dfc97 23 #include "sx126x.h"
mverdy 1:ecd6c7ea3545 24 //#include "debug.h"
SemBen 0:ea5a948dfc97 25
mverdy 1:ecd6c7ea3545 26 #define SEND_PING_BEAT_US 200000
mverdy 1:ecd6c7ea3545 27 #define RX_TIMEOUT_US 200000
mverdy 1:ecd6c7ea3545 28
SemBen 0:ea5a948dfc97 29 /* Set this flag to '1' to display debug messages on the console */
SemBen 0:ea5a948dfc97 30 #define DEBUG_MESSAGE 1
SemBen 0:ea5a948dfc97 31
SemBen 0:ea5a948dfc97 32 /* Set this flag to '1' to use the LoRa modulation or to '0' to use FSK modulation */
SemBen 0:ea5a948dfc97 33 #define USE_MODEM_LORA 1
SemBen 0:ea5a948dfc97 34 #define USE_MODEM_FSK !USE_MODEM_LORA
SemBen 0:ea5a948dfc97 35
Madhouse226 2:6554e96e4596 36 #define RF_FREQUENCY 869524963 // hz // 868000000 // Hz
SemBen 0:ea5a948dfc97 37 #define TX_OUTPUT_POWER 14 // 14 dBm
SemBen 0:ea5a948dfc97 38
SemBen 0:ea5a948dfc97 39 #if USE_MODEM_LORA == 1
SemBen 0:ea5a948dfc97 40
Madhouse226 2:6554e96e4596 41 #define LORA_BANDWIDTH LORA_BW_125 // [0: 125 kHz,
SemBen 0:ea5a948dfc97 42 // 1: 250 kHz,
SemBen 0:ea5a948dfc97 43 // 2: 500 kHz,
SemBen 0:ea5a948dfc97 44 // 3: Reserved]
mverdy 1:ecd6c7ea3545 45 #define LORA_SPREADING_FACTOR LORA_SF7 // [SF7..SF12]
mverdy 1:ecd6c7ea3545 46 #define LORA_LOWDATARATEOPTIMIZE 0
Madhouse226 2:6554e96e4596 47 #define LORA_CODINGRATE LORA_CR_4_6 // [1: 4/5,
SemBen 0:ea5a948dfc97 48 // 2: 4/6,
SemBen 0:ea5a948dfc97 49 // 3: 4/7,
SemBen 0:ea5a948dfc97 50 // 4: 4/8]
SemBen 0:ea5a948dfc97 51 #define LORA_PREAMBLE_LENGTH 8 // Same for Tx and Rx
SemBen 0:ea5a948dfc97 52 #define LORA_SYMBOL_TIMEOUT 5 // Symbols
mverdy 1:ecd6c7ea3545 53 #define LORA_HEADER_TYPE LORA_PACKET_VARIABLE_LENGTH
SemBen 0:ea5a948dfc97 54 #define LORA_FHSS_ENABLED false
SemBen 0:ea5a948dfc97 55 #define LORA_NB_SYMB_HOP 4
mverdy 1:ecd6c7ea3545 56 #define LORA_IQ LORA_IQ_NORMAL
mverdy 1:ecd6c7ea3545 57 #define LORA_CRC_MODE LORA_CRC_OFF
SemBen 0:ea5a948dfc97 58
SemBen 0:ea5a948dfc97 59 #elif USE_MODEM_FSK == 1
SemBen 0:ea5a948dfc97 60
SemBen 0:ea5a948dfc97 61 #define FSK_FDEV 25000 // Hz
SemBen 0:ea5a948dfc97 62 #define FSK_DATARATE 19200 // bps
mverdy 1:ecd6c7ea3545 63 #define FSK_BANDWIDTH RX_BW_93800 // Hz
mverdy 1:ecd6c7ea3545 64 #define FSK_MODULATION_SHAPPING MOD_SHAPING_G_BT_05
SemBen 0:ea5a948dfc97 65 #define FSK_PREAMBLE_LENGTH 5 // Same for Tx and Rx
mverdy 1:ecd6c7ea3545 66 #define FSK_HEADER_TYPE RADIO_PACKET_VARIABLE_LENGTH
mverdy 1:ecd6c7ea3545 67 #define FSK_CRC_MODE RADIO_CRC_2_BYTES_CCIT
mverdy 1:ecd6c7ea3545 68 #define FSK_ADDR_FILTERING RADIO_ADDRESSCOMP_FILT_NODE;
mverdy 1:ecd6c7ea3545 69 #define FSK_WHITENING_MODE RADIO_DC_FREE_OFF
mverdy 1:ecd6c7ea3545 70 #define FSK_PREAMBLE_DETECTOR_MODE RADIO_PREAMBLE_DETECTOR_OFF
mverdy 1:ecd6c7ea3545 71 #define FSK_SYNCWORD_LENGTH 8
SemBen 0:ea5a948dfc97 72 #else
SemBen 0:ea5a948dfc97 73 #error "Please define a modem in the compiler options."
SemBen 0:ea5a948dfc97 74 #endif
SemBen 0:ea5a948dfc97 75
SemBen 0:ea5a948dfc97 76 #define RX_TIMEOUT_VALUE 3500 // in ms
Madhouse226 2:6554e96e4596 77 #define BUFFER_SIZE 64 // Define the payload size here
SemBen 0:ea5a948dfc97 78
SemBen 0:ea5a948dfc97 79 #if( defined ( TARGET_KL25Z ) || defined ( TARGET_LPC11U6X ) )
SemBen 0:ea5a948dfc97 80 DigitalOut led( LED2 );
SemBen 0:ea5a948dfc97 81 #else
SemBen 0:ea5a948dfc97 82 DigitalOut led( LED1 );
SemBen 0:ea5a948dfc97 83 #endif
SemBen 0:ea5a948dfc97 84
SemBen 0:ea5a948dfc97 85 /*
SemBen 0:ea5a948dfc97 86 * Callback functions prototypes
SemBen 0:ea5a948dfc97 87 */
SemBen 0:ea5a948dfc97 88 /*!
SemBen 0:ea5a948dfc97 89 * @brief Function to be executed on Radio Tx Done event
SemBen 0:ea5a948dfc97 90 */
SemBen 0:ea5a948dfc97 91 void OnTxDone( void );
SemBen 0:ea5a948dfc97 92
SemBen 0:ea5a948dfc97 93 /*!
SemBen 0:ea5a948dfc97 94 * @brief Function to be executed on Radio Rx Done event
SemBen 0:ea5a948dfc97 95 */
mverdy 1:ecd6c7ea3545 96 void OnRxDone( void );
SemBen 0:ea5a948dfc97 97
SemBen 0:ea5a948dfc97 98 /*!
SemBen 0:ea5a948dfc97 99 * @brief Function executed on Radio Tx Timeout event
SemBen 0:ea5a948dfc97 100 */
SemBen 0:ea5a948dfc97 101 void OnTxTimeout( void );
SemBen 0:ea5a948dfc97 102
SemBen 0:ea5a948dfc97 103 /*!
SemBen 0:ea5a948dfc97 104 * @brief Function executed on Radio Rx Timeout event
SemBen 0:ea5a948dfc97 105 */
SemBen 0:ea5a948dfc97 106 void OnRxTimeout( void );
SemBen 0:ea5a948dfc97 107
SemBen 0:ea5a948dfc97 108 /*!
SemBen 0:ea5a948dfc97 109 * @brief Function executed on Radio Rx Error event
SemBen 0:ea5a948dfc97 110 */
mverdy 1:ecd6c7ea3545 111 void OnRxError( IrqErrorCode_t errCode );
SemBen 0:ea5a948dfc97 112
SemBen 0:ea5a948dfc97 113 /*!
SemBen 0:ea5a948dfc97 114 * @brief Function executed on Radio Fhss Change Channel event
SemBen 0:ea5a948dfc97 115 */
SemBen 0:ea5a948dfc97 116 void OnFhssChangeChannel( uint8_t channelIndex );
mverdy 1:ecd6c7ea3545 117
mverdy 1:ecd6c7ea3545 118 typedef struct{
mverdy 1:ecd6c7ea3545 119 RadioPacketTypes_t packetType;
mverdy 1:ecd6c7ea3545 120 int8_t txPower;
mverdy 1:ecd6c7ea3545 121 RadioRampTimes_t txRampTime;
mverdy 1:ecd6c7ea3545 122 ModulationParams_t modParams;
mverdy 1:ecd6c7ea3545 123 PacketParams_t packetParams;
mverdy 1:ecd6c7ea3545 124 uint32_t rfFrequency;
mverdy 1:ecd6c7ea3545 125 uint16_t irqTx;
mverdy 1:ecd6c7ea3545 126 uint16_t irqRx;
mverdy 1:ecd6c7ea3545 127 uint32_t txTimeout;
mverdy 1:ecd6c7ea3545 128 uint32_t rxTimeout;
mverdy 1:ecd6c7ea3545 129 }RadioConfigurations_t;
mverdy 1:ecd6c7ea3545 130 RadioConfigurations_t radioConfiguration;
SemBen 0:ea5a948dfc97 131
SemBen 0:ea5a948dfc97 132 /*
SemBen 0:ea5a948dfc97 133 * Global variables declarations
SemBen 0:ea5a948dfc97 134 */
SemBen 0:ea5a948dfc97 135 typedef enum
SemBen 0:ea5a948dfc97 136 {
mverdy 1:ecd6c7ea3545 137 SEND_PACKET,
mverdy 1:ecd6c7ea3545 138 WAIT_SEND_DONE,
mverdy 1:ecd6c7ea3545 139 RECEIVE_PACKET,
mverdy 1:ecd6c7ea3545 140 WAIT_RECEIVE_DONE,
mverdy 1:ecd6c7ea3545 141 PACKET_RECEIVED,
SemBen 0:ea5a948dfc97 142 }AppStates_t;
mverdy 1:ecd6c7ea3545 143 volatile AppStates_t State = SEND_PACKET;
mverdy 1:ecd6c7ea3545 144
mverdy 1:ecd6c7ea3545 145 typedef struct{
mverdy 1:ecd6c7ea3545 146 bool rxDone;
mverdy 1:ecd6c7ea3545 147 bool rxError;
mverdy 1:ecd6c7ea3545 148 bool txDone;
mverdy 1:ecd6c7ea3545 149 bool rxTimeout;
mverdy 1:ecd6c7ea3545 150 bool txTimeout;
mverdy 1:ecd6c7ea3545 151 }RadioFlags_t;
mverdy 1:ecd6c7ea3545 152 RadioFlags_t radioFlags = {
mverdy 1:ecd6c7ea3545 153 .txDone = false,
mverdy 1:ecd6c7ea3545 154 .rxDone = false,
mverdy 1:ecd6c7ea3545 155 .rxError = false,
mverdy 1:ecd6c7ea3545 156 .rxTimeout = false,
mverdy 1:ecd6c7ea3545 157 .txTimeout = false,
mverdy 1:ecd6c7ea3545 158 };
SemBen 0:ea5a948dfc97 159
SemBen 0:ea5a948dfc97 160 /*!
SemBen 0:ea5a948dfc97 161 * Radio events function pointer
SemBen 0:ea5a948dfc97 162 */
mverdy 1:ecd6c7ea3545 163 static RadioCallbacks_t RadioEvents = {
mverdy 1:ecd6c7ea3545 164 .txDone = &OnTxDone,
mverdy 1:ecd6c7ea3545 165 .txTimeout = &OnTxTimeout,
mverdy 1:ecd6c7ea3545 166 .rxDone = &OnRxDone,
mverdy 1:ecd6c7ea3545 167 .rxPreambleDetect = NULL,
mverdy 1:ecd6c7ea3545 168 .rxHeaderDone = NULL,
mverdy 1:ecd6c7ea3545 169 .rxTimeout = &OnRxTimeout,
mverdy 1:ecd6c7ea3545 170 .rxError = &OnRxError,
mverdy 1:ecd6c7ea3545 171 .cadDone = NULL,
mverdy 1:ecd6c7ea3545 172 };
mverdy 1:ecd6c7ea3545 173
SemBen 0:ea5a948dfc97 174 /*
SemBen 0:ea5a948dfc97 175 * Global variables declarations
SemBen 0:ea5a948dfc97 176 */
SemBen 0:ea5a948dfc97 177 //Radio Radio( NULL );
mverdy 1:ecd6c7ea3545 178 #define MESSAGE_SIZE 4
mverdy 1:ecd6c7ea3545 179 typedef uint8_t Messages_t[MESSAGE_SIZE];
mverdy 1:ecd6c7ea3545 180 const Messages_t PingMsg = {'P', 'I', 'N', 'G'};
mverdy 1:ecd6c7ea3545 181 const Messages_t PongMsg = {'P', 'O', 'N', 'G'};
mverdy 1:ecd6c7ea3545 182 const Messages_t *messageToReceive = &PongMsg;
mverdy 1:ecd6c7ea3545 183 const Messages_t *messageToSend = &PingMsg;
SemBen 0:ea5a948dfc97 184
mverdy 1:ecd6c7ea3545 185 uint8_t BufferSize = BUFFER_SIZE;
SemBen 0:ea5a948dfc97 186 uint8_t Buffer[BUFFER_SIZE];
SemBen 0:ea5a948dfc97 187
mverdy 1:ecd6c7ea3545 188 int8_t RssiValue = 0;
mverdy 1:ecd6c7ea3545 189 int8_t SnrValue = 0;
mverdy 1:ecd6c7ea3545 190
mverdy 1:ecd6c7ea3545 191 void GetRssiSnr(int8_t *rssi, int8_t *snr);
mverdy 1:ecd6c7ea3545 192 SX126xHal Radio( D11, D12, D13, D7, D3, D5, NC, NC, A0, A1, A2, D8, &RadioEvents );
mverdy 1:ecd6c7ea3545 193
mverdy 1:ecd6c7ea3545 194 void SetToMaster(void);
mverdy 1:ecd6c7ea3545 195 void SetToSlave(void);
mverdy 1:ecd6c7ea3545 196 void RunMasterStateMachine();
mverdy 1:ecd6c7ea3545 197 void RunSlaveStateMachine();
mverdy 1:ecd6c7ea3545 198 void SetConfiguration(RadioConfigurations_t *config);
mverdy 1:ecd6c7ea3545 199 void ConfigureGeneralRadio(SX126xHal *radio, RadioConfigurations_t *config);
mverdy 1:ecd6c7ea3545 200 void ConfigureRadioTx(SX126xHal *radio, RadioConfigurations_t *config);
mverdy 1:ecd6c7ea3545 201 void ConfigureRadioRx(SX126xHal *radio, RadioConfigurations_t *config);
mverdy 1:ecd6c7ea3545 202 void PrepareBuffer(SX126xHal *radio, const Messages_t *messageToSend);
mverdy 1:ecd6c7ea3545 203 bool isMaster = true;
mverdy 1:ecd6c7ea3545 204 bool masterCanSend = true;
mverdy 1:ecd6c7ea3545 205 void MasterSendNextEvent(void){masterCanSend = true;}
mverdy 1:ecd6c7ea3545 206 bool slaveCanListen = false;
mverdy 1:ecd6c7ea3545 207 void SlaveListenNextEvent(void){slaveCanListen = true;}
mverdy 1:ecd6c7ea3545 208 Ticker masterSendNextTicker;
mverdy 1:ecd6c7ea3545 209 Ticker slaveListenNextTicker;
mverdy 1:ecd6c7ea3545 210
Madhouse226 2:6554e96e4596 211 int counter = 0;
Madhouse226 2:6554e96e4596 212
mverdy 1:ecd6c7ea3545 213 Serial serial(USBTX, USBRX);
mverdy 1:ecd6c7ea3545 214
SemBen 0:ea5a948dfc97 215 int main( void )
SemBen 0:ea5a948dfc97 216 {
mverdy 1:ecd6c7ea3545 217 Radio.Reset();
mverdy 1:ecd6c7ea3545 218 Radio.Init();
mverdy 1:ecd6c7ea3545 219 serial.baud(115200);
Madhouse226 2:6554e96e4596 220 // SetToMaster();
Madhouse226 2:6554e96e4596 221 SetToSlave();
mverdy 1:ecd6c7ea3545 222 SetConfiguration(&radioConfiguration);
mverdy 1:ecd6c7ea3545 223 ConfigureGeneralRadio(&Radio, &radioConfiguration);
mverdy 1:ecd6c7ea3545 224 while(true){
mverdy 1:ecd6c7ea3545 225 if(isMaster){
mverdy 1:ecd6c7ea3545 226 RunMasterStateMachine();
mverdy 1:ecd6c7ea3545 227 }
mverdy 1:ecd6c7ea3545 228 else{
mverdy 1:ecd6c7ea3545 229 RunSlaveStateMachine();
mverdy 1:ecd6c7ea3545 230 }
SemBen 0:ea5a948dfc97 231 }
mverdy 1:ecd6c7ea3545 232 }
mverdy 1:ecd6c7ea3545 233
mverdy 1:ecd6c7ea3545 234 void RunMasterStateMachine(){
mverdy 1:ecd6c7ea3545 235 switch(State){
mverdy 1:ecd6c7ea3545 236 case SEND_PACKET:{
mverdy 1:ecd6c7ea3545 237 if(masterCanSend == true){
mverdy 1:ecd6c7ea3545 238 masterCanSend = false;
mverdy 1:ecd6c7ea3545 239 masterSendNextTicker.attach_us(&MasterSendNextEvent, SEND_PING_BEAT_US);
mverdy 1:ecd6c7ea3545 240 PrepareBuffer(&Radio, messageToSend);
mverdy 1:ecd6c7ea3545 241 ConfigureRadioTx(&Radio, &radioConfiguration);
mverdy 1:ecd6c7ea3545 242 Radio.SetTx(radioConfiguration.txTimeout);
Madhouse226 2:6554e96e4596 243 printf("Ping... %d\n", ++counter);
mverdy 1:ecd6c7ea3545 244 State = WAIT_SEND_DONE;
mverdy 1:ecd6c7ea3545 245 }
mverdy 1:ecd6c7ea3545 246 break;
mverdy 1:ecd6c7ea3545 247 }
mverdy 1:ecd6c7ea3545 248
mverdy 1:ecd6c7ea3545 249 case WAIT_SEND_DONE:{
mverdy 1:ecd6c7ea3545 250 if(radioFlags.txDone){
mverdy 1:ecd6c7ea3545 251 radioFlags.txDone = false;
mverdy 1:ecd6c7ea3545 252 State = RECEIVE_PACKET;
mverdy 1:ecd6c7ea3545 253 }
mverdy 1:ecd6c7ea3545 254 if(radioFlags.txTimeout){
mverdy 1:ecd6c7ea3545 255 radioFlags.txTimeout = false;
mverdy 1:ecd6c7ea3545 256 State = SEND_PACKET;
SemBen 0:ea5a948dfc97 257 }
SemBen 0:ea5a948dfc97 258 break;
mverdy 1:ecd6c7ea3545 259 }
mverdy 1:ecd6c7ea3545 260
mverdy 1:ecd6c7ea3545 261 case RECEIVE_PACKET:{
mverdy 1:ecd6c7ea3545 262 ConfigureRadioRx(&Radio, &radioConfiguration);
mverdy 1:ecd6c7ea3545 263 Radio.SetRx(radioConfiguration.rxTimeout);
mverdy 1:ecd6c7ea3545 264 State = WAIT_RECEIVE_DONE;
SemBen 0:ea5a948dfc97 265 break;
mverdy 1:ecd6c7ea3545 266 }
mverdy 1:ecd6c7ea3545 267
mverdy 1:ecd6c7ea3545 268 case WAIT_RECEIVE_DONE:{
mverdy 1:ecd6c7ea3545 269 if(radioFlags.rxDone == true){
mverdy 1:ecd6c7ea3545 270 radioFlags.rxDone = false;
mverdy 1:ecd6c7ea3545 271 State = PACKET_RECEIVED;
SemBen 0:ea5a948dfc97 272 }
mverdy 1:ecd6c7ea3545 273 if(radioFlags.rxTimeout == true){
mverdy 1:ecd6c7ea3545 274 radioFlags.rxTimeout = false;
mverdy 1:ecd6c7ea3545 275 State = SEND_PACKET;
SemBen 0:ea5a948dfc97 276 }
SemBen 0:ea5a948dfc97 277 break;
mverdy 1:ecd6c7ea3545 278 }
mverdy 1:ecd6c7ea3545 279
mverdy 1:ecd6c7ea3545 280 case PACKET_RECEIVED:{
mverdy 1:ecd6c7ea3545 281 Radio.GetPayload( Buffer, &BufferSize, BUFFER_SIZE );
mverdy 1:ecd6c7ea3545 282 RssiValue = Radio.GetRssiInst();
mverdy 1:ecd6c7ea3545 283 GetRssiSnr(&RssiValue, &SnrValue);
mverdy 1:ecd6c7ea3545 284 if( strncmp(( const char* )Buffer, (const char*)messageToReceive, MESSAGE_SIZE ) == 0 ){
mverdy 1:ecd6c7ea3545 285 printf("...Pong\n");
mverdy 1:ecd6c7ea3545 286 State = SEND_PACKET;
SemBen 0:ea5a948dfc97 287 }
mverdy 1:ecd6c7ea3545 288 else if( strncmp(( const char* )Buffer, (const char*)messageToSend, MESSAGE_SIZE ) == 0 ){
mverdy 1:ecd6c7ea3545 289 // Another Master is in the air, swith to slave
mverdy 1:ecd6c7ea3545 290 SetToSlave();
SemBen 0:ea5a948dfc97 291 }
mverdy 1:ecd6c7ea3545 292 else{
mverdy 1:ecd6c7ea3545 293 printf("WRONG PAYLOAD\n");
mverdy 1:ecd6c7ea3545 294 SetToMaster();
mverdy 1:ecd6c7ea3545 295 }
SemBen 0:ea5a948dfc97 296 break;
SemBen 0:ea5a948dfc97 297 }
SemBen 0:ea5a948dfc97 298 }
SemBen 0:ea5a948dfc97 299 }
mverdy 1:ecd6c7ea3545 300
mverdy 1:ecd6c7ea3545 301 void RunSlaveStateMachine(){
mverdy 1:ecd6c7ea3545 302 switch(State){
mverdy 1:ecd6c7ea3545 303 case RECEIVE_PACKET:{
mverdy 1:ecd6c7ea3545 304 if(slaveCanListen == true){
mverdy 1:ecd6c7ea3545 305 slaveCanListen = false;
mverdy 1:ecd6c7ea3545 306 ConfigureRadioRx(&Radio, &radioConfiguration);
mverdy 1:ecd6c7ea3545 307 Radio.SetRx(radioConfiguration.rxTimeout);
mverdy 1:ecd6c7ea3545 308 slaveListenNextTicker.attach_us(&SlaveListenNextEvent, SEND_PING_BEAT_US - ( RX_TIMEOUT_US>>1 ));
mverdy 1:ecd6c7ea3545 309 State = WAIT_RECEIVE_DONE;
mverdy 1:ecd6c7ea3545 310 }
mverdy 1:ecd6c7ea3545 311 break;
mverdy 1:ecd6c7ea3545 312 }
mverdy 1:ecd6c7ea3545 313
mverdy 1:ecd6c7ea3545 314 case WAIT_RECEIVE_DONE:{
mverdy 1:ecd6c7ea3545 315 if(radioFlags.rxDone == true){
mverdy 1:ecd6c7ea3545 316 radioFlags.rxDone = false;
mverdy 1:ecd6c7ea3545 317 State = PACKET_RECEIVED;
mverdy 1:ecd6c7ea3545 318 }
mverdy 1:ecd6c7ea3545 319 if(radioFlags.rxTimeout == true){
mverdy 1:ecd6c7ea3545 320 radioFlags.rxTimeout = false;
mverdy 1:ecd6c7ea3545 321 SetToMaster();
mverdy 1:ecd6c7ea3545 322 }
mverdy 1:ecd6c7ea3545 323 break;
mverdy 1:ecd6c7ea3545 324 }
mverdy 1:ecd6c7ea3545 325
mverdy 1:ecd6c7ea3545 326 case PACKET_RECEIVED:{
mverdy 1:ecd6c7ea3545 327 Radio.GetPayload( Buffer, &BufferSize, BUFFER_SIZE );
mverdy 1:ecd6c7ea3545 328 RssiValue = Radio.GetRssiInst();
mverdy 1:ecd6c7ea3545 329 GetRssiSnr(&RssiValue, &SnrValue);
mverdy 1:ecd6c7ea3545 330 if( strncmp(( const char* )Buffer, (const char*)messageToReceive, MESSAGE_SIZE ) == 0 ){
mverdy 1:ecd6c7ea3545 331 printf("...Ping\n");
mverdy 1:ecd6c7ea3545 332 State = SEND_PACKET;
mverdy 1:ecd6c7ea3545 333 }
mverdy 1:ecd6c7ea3545 334 else{
mverdy 1:ecd6c7ea3545 335 SetToMaster();
mverdy 1:ecd6c7ea3545 336 }
mverdy 1:ecd6c7ea3545 337 break;
mverdy 1:ecd6c7ea3545 338 }
mverdy 1:ecd6c7ea3545 339
mverdy 1:ecd6c7ea3545 340 case SEND_PACKET:{
mverdy 1:ecd6c7ea3545 341 PrepareBuffer(&Radio, messageToSend);
mverdy 1:ecd6c7ea3545 342 ConfigureRadioTx(&Radio, &radioConfiguration);
mverdy 1:ecd6c7ea3545 343 printf("Pong...\n");
mverdy 1:ecd6c7ea3545 344 Radio.SetTx(radioConfiguration.txTimeout);
mverdy 1:ecd6c7ea3545 345 State = WAIT_SEND_DONE;
mverdy 1:ecd6c7ea3545 346 break;
mverdy 1:ecd6c7ea3545 347 }
mverdy 1:ecd6c7ea3545 348
mverdy 1:ecd6c7ea3545 349 case WAIT_SEND_DONE:{
mverdy 1:ecd6c7ea3545 350 if(radioFlags.txDone){
mverdy 1:ecd6c7ea3545 351 radioFlags.txDone = false;
mverdy 1:ecd6c7ea3545 352 State = RECEIVE_PACKET;
mverdy 1:ecd6c7ea3545 353 }
mverdy 1:ecd6c7ea3545 354 if(radioFlags.txTimeout){
mverdy 1:ecd6c7ea3545 355 radioFlags.txTimeout = false;
mverdy 1:ecd6c7ea3545 356 SetToMaster();
mverdy 1:ecd6c7ea3545 357 }
mverdy 1:ecd6c7ea3545 358 break;
mverdy 1:ecd6c7ea3545 359 }
mverdy 1:ecd6c7ea3545 360 }
mverdy 1:ecd6c7ea3545 361 }
mverdy 1:ecd6c7ea3545 362
mverdy 1:ecd6c7ea3545 363 void SetToMaster(){
mverdy 1:ecd6c7ea3545 364 printf("-->Master\n");
mverdy 1:ecd6c7ea3545 365 isMaster = true;
mverdy 1:ecd6c7ea3545 366 masterCanSend = true;
mverdy 1:ecd6c7ea3545 367 State = SEND_PACKET;
mverdy 1:ecd6c7ea3545 368 messageToReceive = &PongMsg;
mverdy 1:ecd6c7ea3545 369 messageToSend = &PingMsg;
mverdy 1:ecd6c7ea3545 370 }
mverdy 1:ecd6c7ea3545 371
mverdy 1:ecd6c7ea3545 372 void SetToSlave(){
mverdy 1:ecd6c7ea3545 373 slaveCanListen = false;
mverdy 1:ecd6c7ea3545 374 slaveListenNextTicker.attach_us(&SlaveListenNextEvent, SEND_PING_BEAT_US - ( RX_TIMEOUT_US>>1 ));
mverdy 1:ecd6c7ea3545 375 printf("--> Slave\n");
mverdy 1:ecd6c7ea3545 376 isMaster = false;
mverdy 1:ecd6c7ea3545 377 State = RECEIVE_PACKET;
mverdy 1:ecd6c7ea3545 378 messageToReceive = &PingMsg;
mverdy 1:ecd6c7ea3545 379 messageToSend = &PongMsg;
mverdy 1:ecd6c7ea3545 380 }
SemBen 0:ea5a948dfc97 381
SemBen 0:ea5a948dfc97 382 void OnTxDone( void )
SemBen 0:ea5a948dfc97 383 {
mverdy 1:ecd6c7ea3545 384 radioFlags.txDone = true;
SemBen 0:ea5a948dfc97 385 }
SemBen 0:ea5a948dfc97 386
mverdy 1:ecd6c7ea3545 387 void OnRxDone( void )
SemBen 0:ea5a948dfc97 388 {
mverdy 1:ecd6c7ea3545 389 radioFlags.rxDone = true;
SemBen 0:ea5a948dfc97 390 }
SemBen 0:ea5a948dfc97 391
SemBen 0:ea5a948dfc97 392 void OnTxTimeout( void )
SemBen 0:ea5a948dfc97 393 {
mverdy 1:ecd6c7ea3545 394 radioFlags.txTimeout = true;
SemBen 0:ea5a948dfc97 395 debug_if( DEBUG_MESSAGE, "> OnTxTimeout\n\r" );
SemBen 0:ea5a948dfc97 396 }
SemBen 0:ea5a948dfc97 397
SemBen 0:ea5a948dfc97 398 void OnRxTimeout( void )
SemBen 0:ea5a948dfc97 399 {
mverdy 1:ecd6c7ea3545 400 radioFlags.rxTimeout = true;
SemBen 0:ea5a948dfc97 401 debug_if( DEBUG_MESSAGE, "> OnRxTimeout\n\r" );
SemBen 0:ea5a948dfc97 402 }
SemBen 0:ea5a948dfc97 403
mverdy 1:ecd6c7ea3545 404 void OnRxError( IrqErrorCode_t errCode )
SemBen 0:ea5a948dfc97 405 {
mverdy 1:ecd6c7ea3545 406 radioFlags.rxError = true;
SemBen 0:ea5a948dfc97 407 debug_if( DEBUG_MESSAGE, "> OnRxError\n\r" );
mverdy 1:ecd6c7ea3545 408 }
mverdy 1:ecd6c7ea3545 409
mverdy 1:ecd6c7ea3545 410 void SetConfiguration(RadioConfigurations_t *config){
mverdy 1:ecd6c7ea3545 411 config->irqRx = IRQ_RX_DONE | IRQ_RX_TX_TIMEOUT;
mverdy 1:ecd6c7ea3545 412 config->irqTx = IRQ_TX_DONE | IRQ_RX_TX_TIMEOUT;
mverdy 1:ecd6c7ea3545 413 config->rfFrequency = RF_FREQUENCY;
mverdy 1:ecd6c7ea3545 414 config->txTimeout = 0;
mverdy 1:ecd6c7ea3545 415 config->rxTimeout = (uint32_t)(RX_TIMEOUT_US / 15.625);
mverdy 1:ecd6c7ea3545 416 config->txPower = TX_OUTPUT_POWER;
mverdy 1:ecd6c7ea3545 417 config->txRampTime = RADIO_RAMP_200_US;
mverdy 1:ecd6c7ea3545 418 #if USE_MODEM_LORA == 1
mverdy 1:ecd6c7ea3545 419 config->packetType = PACKET_TYPE_LORA;
mverdy 1:ecd6c7ea3545 420 config->modParams.PacketType = PACKET_TYPE_LORA;
mverdy 1:ecd6c7ea3545 421 config->modParams.Params.LoRa.Bandwidth = LORA_BANDWIDTH;
mverdy 1:ecd6c7ea3545 422 config->modParams.Params.LoRa.CodingRate = LORA_CODINGRATE;
mverdy 1:ecd6c7ea3545 423 config->modParams.Params.LoRa.LowDatarateOptimize = LORA_LOWDATARATEOPTIMIZE;
mverdy 1:ecd6c7ea3545 424 config->modParams.Params.LoRa.SpreadingFactor = LORA_SPREADING_FACTOR;
mverdy 1:ecd6c7ea3545 425 config->packetParams.PacketType = PACKET_TYPE_LORA;
mverdy 1:ecd6c7ea3545 426 config->packetParams.Params.LoRa.CrcMode = LORA_CRC_MODE;
mverdy 1:ecd6c7ea3545 427 config->packetParams.Params.LoRa.HeaderType = LORA_HEADER_TYPE;
mverdy 1:ecd6c7ea3545 428 config->packetParams.Params.LoRa.InvertIQ = LORA_IQ;
mverdy 1:ecd6c7ea3545 429 config->packetParams.Params.LoRa.PayloadLength = BUFFER_SIZE;
mverdy 1:ecd6c7ea3545 430 config->packetParams.Params.LoRa.PreambleLength = LORA_PREAMBLE_LENGTH;
mverdy 1:ecd6c7ea3545 431 #elif USE_MODEM_FSK == 1
mverdy 1:ecd6c7ea3545 432 config->packetType = PACKET_TYPE_GFSK;
mverdy 1:ecd6c7ea3545 433 config->modParams.PacketType = PACKET_TYPE_GFSK;
mverdy 1:ecd6c7ea3545 434 config->modParams.Params.Gfsk.Bandwidth = FSK_BANDWIDTH;
mverdy 1:ecd6c7ea3545 435 config->modParams.Params.Gfsk.BitRate = 1024000000 / FSK_DATARATE;
mverdy 1:ecd6c7ea3545 436 config->modParams.Params.Gfsk.Fdev = FSK_FDEV * 1.048576;
mverdy 1:ecd6c7ea3545 437 config->modParams.Params.Gfsk.ModulationShaping = FSK_MODULATION_SHAPPING;
mverdy 1:ecd6c7ea3545 438 config->packetParams.PacketType = PACKET_TYPE_GFSK;
mverdy 1:ecd6c7ea3545 439 config->packetParams.Params.Gfsk.AddrComp = FSK_ADDR_FILTERING;
mverdy 1:ecd6c7ea3545 440 config->packetParams.Params.Gfsk.CrcLength = FSK_CRC_MODE;
mverdy 1:ecd6c7ea3545 441 config->packetParams.Params.Gfsk.DcFree = FSK_WHITENING_MODE;
mverdy 1:ecd6c7ea3545 442 config->packetParams.Params.Gfsk.HeaderType = FSK_HEADER_TYPE;
mverdy 1:ecd6c7ea3545 443 config->packetParams.Params.Gfsk.PayloadLength = BUFFER_SIZE;
mverdy 1:ecd6c7ea3545 444 config->packetParams.Params.Gfsk.PreambleLength = FSK_PREAMBLE_LENGTH;
mverdy 1:ecd6c7ea3545 445 config->packetParams.Params.Gfsk.PreambleMinDetect = FSK_PREAMBLE_DETECTOR_MODE;
mverdy 1:ecd6c7ea3545 446 config->packetParams.Params.Gfsk.SyncWordLength = FSK_SYNCWORD_LENGTH;
mverdy 1:ecd6c7ea3545 447 #endif
mverdy 1:ecd6c7ea3545 448 }
mverdy 1:ecd6c7ea3545 449
mverdy 1:ecd6c7ea3545 450 void ConfigureGeneralRadio(SX126xHal *radio, RadioConfigurations_t *config){
mverdy 1:ecd6c7ea3545 451 radio->SetPacketType(config->packetType);
mverdy 1:ecd6c7ea3545 452 radio->SetPacketParams(&config->packetParams);
mverdy 1:ecd6c7ea3545 453 radio->SetModulationParams(&config->modParams);
mverdy 1:ecd6c7ea3545 454 radio->SetRfFrequency(config->rfFrequency);
mverdy 1:ecd6c7ea3545 455 radio->SetTxParams(config->txPower, config->txRampTime);
mverdy 1:ecd6c7ea3545 456 radio->SetInterruptMode();
mverdy 1:ecd6c7ea3545 457 if(config->packetType == PACKET_TYPE_GFSK){
mverdy 1:ecd6c7ea3545 458 uint8_t syncword[8] = {0xF0, 0x0F, 0x55, 0xAA, 0xF0, 0x0F, 0x55, 0xAA};
mverdy 1:ecd6c7ea3545 459 radio->SetSyncWord(syncword);
mverdy 1:ecd6c7ea3545 460 }
mverdy 1:ecd6c7ea3545 461 }
mverdy 1:ecd6c7ea3545 462
mverdy 1:ecd6c7ea3545 463 void ConfigureRadioTx(SX126xHal *radio, RadioConfigurations_t *config){
mverdy 1:ecd6c7ea3545 464 radio->SetDioIrqParams(config->irqTx, config->irqTx, IRQ_RADIO_NONE, IRQ_RADIO_NONE);
mverdy 1:ecd6c7ea3545 465 }
mverdy 1:ecd6c7ea3545 466
mverdy 1:ecd6c7ea3545 467 void ConfigureRadioRx(SX126xHal *radio, RadioConfigurations_t *config){
mverdy 1:ecd6c7ea3545 468 radio->SetDioIrqParams(config->irqRx, config->irqRx, IRQ_RADIO_NONE, IRQ_RADIO_NONE);
mverdy 1:ecd6c7ea3545 469 }
mverdy 1:ecd6c7ea3545 470
mverdy 1:ecd6c7ea3545 471 void PrepareBuffer(SX126xHal *radio, const Messages_t *messageToSend){
mverdy 1:ecd6c7ea3545 472 radio->SetPayload((uint8_t*)messageToSend, MESSAGE_SIZE);
mverdy 1:ecd6c7ea3545 473 }
mverdy 1:ecd6c7ea3545 474
mverdy 1:ecd6c7ea3545 475 void GetRssiSnr(int8_t *rssi, int8_t *snr)
mverdy 1:ecd6c7ea3545 476 {
mverdy 1:ecd6c7ea3545 477 PacketStatus_t pkt_stat;
mverdy 1:ecd6c7ea3545 478 Radio.GetPacketStatus(&pkt_stat);
mverdy 1:ecd6c7ea3545 479 #if USE_MODEM_LORA == 1
mverdy 1:ecd6c7ea3545 480 *rssi = pkt_stat.Params.LoRa.RssiPkt;
mverdy 1:ecd6c7ea3545 481 *snr = pkt_stat.Params.LoRa.SnrPkt;
mverdy 1:ecd6c7ea3545 482 #else
mverdy 1:ecd6c7ea3545 483 *rssi = pkt_stat.Params.Gfsk.RssiSync;
mverdy 1:ecd6c7ea3545 484 #endif
mverdy 1:ecd6c7ea3545 485 }