Semtech
/
SX126X_PingPong_Demo
SX126X_PingPong_Template
Diff: main_pingpong.cpp
- Revision:
- 1:ecd6c7ea3545
- Parent:
- 0:ea5a948dfc97
--- a/main_pingpong.cpp Tue Oct 09 14:07:38 2018 +0000 +++ b/main_pingpong.cpp Tue Oct 16 15:12:01 2018 +0000 @@ -12,7 +12,7 @@ * \____ \| ___ | (_ _) ___ |/ ___) _ \ * _____) ) ____| | | || |_| ____( (___| | | | * (______/|_____)_|_|_| \__)_____)\____)_| |_| - * (C)2013-2017 Semtech + * (C)2013-2018 Semtech * * \endcode * @@ -21,8 +21,11 @@ #include "mbed.h" #include "sx126x-hal.h" #include "sx126x.h" -#include "debug.h" +//#include "debug.h" +#define SEND_PING_BEAT_US 200000 +#define RX_TIMEOUT_US 200000 + /* Set this flag to '1' to display debug messages on the console */ #define DEBUG_MESSAGE 1 @@ -35,33 +38,37 @@ #if USE_MODEM_LORA == 1 - #define LORA_BANDWIDTH 2 // [0: 125 kHz, + #define LORA_BANDWIDTH LORA_BW_500 // [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, + #define LORA_SPREADING_FACTOR LORA_SF7 // [SF7..SF12] + #define LORA_LOWDATARATEOPTIMIZE 0 + #define LORA_CODINGRATE LORA_CR_4_5 // [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_HEADER_TYPE LORA_PACKET_VARIABLE_LENGTH #define LORA_FHSS_ENABLED false #define LORA_NB_SYMB_HOP 4 - #define LORA_IQ_INVERSION_ON false - #define LORA_CRC_ENABLED true + #define LORA_IQ LORA_IQ_NORMAL + #define LORA_CRC_MODE LORA_CRC_OFF #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_BANDWIDTH RX_BW_93800 // Hz + #define FSK_MODULATION_SHAPPING MOD_SHAPING_G_BT_05 #define FSK_PREAMBLE_LENGTH 5 // Same for Tx and Rx - #define FSK_FIX_LENGTH_PAYLOAD_ON false - #define FSK_CRC_ENABLED true - + #define FSK_HEADER_TYPE RADIO_PACKET_VARIABLE_LENGTH + #define FSK_CRC_MODE RADIO_CRC_2_BYTES_CCIT + #define FSK_ADDR_FILTERING RADIO_ADDRESSCOMP_FILT_NODE; + #define FSK_WHITENING_MODE RADIO_DC_FREE_OFF + #define FSK_PREAMBLE_DETECTOR_MODE RADIO_PREAMBLE_DETECTOR_OFF + #define FSK_SYNCWORD_LENGTH 8 #else #error "Please define a modem in the compiler options." #endif @@ -86,7 +93,7 @@ /*! * @brief Function to be executed on Radio Rx Done event */ -void OnRxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr ); +void OnRxDone( void ); /*! * @brief Function executed on Radio Tx Timeout event @@ -101,304 +108,375 @@ /*! * @brief Function executed on Radio Rx Error event */ -void OnRxError( void ); +void OnRxError( IrqErrorCode_t errCode ); /*! * @brief Function executed on Radio Fhss Change Channel event */ void OnFhssChangeChannel( uint8_t channelIndex ); - -/*! - * @brief Function executed on CAD Done event - */ -void OnCadDone( void ); + +typedef struct{ + RadioPacketTypes_t packetType; + int8_t txPower; + RadioRampTimes_t txRampTime; + ModulationParams_t modParams; + PacketParams_t packetParams; + uint32_t rfFrequency; + uint16_t irqTx; + uint16_t irqRx; + uint32_t txTimeout; + uint32_t rxTimeout; +}RadioConfigurations_t; +RadioConfigurations_t radioConfiguration; /* * Global variables declarations */ typedef enum { - LOWPOWER = 0, - IDLE, - - RX, - RX_TIMEOUT, - RX_ERROR, - - TX, - TX_TIMEOUT, - - CAD, - CAD_DONE + SEND_PACKET, + WAIT_SEND_DONE, + RECEIVE_PACKET, + WAIT_RECEIVE_DONE, + PACKET_RECEIVED, }AppStates_t; - -volatile AppStates_t State = LOWPOWER; +volatile AppStates_t State = SEND_PACKET; + +typedef struct{ + bool rxDone; + bool rxError; + bool txDone; + bool rxTimeout; + bool txTimeout; +}RadioFlags_t; +RadioFlags_t radioFlags = { + .txDone = false, + .rxDone = false, + .rxError = false, + .rxTimeout = false, + .txTimeout = false, +}; /*! * Radio events function pointer */ -static RadioCallbacks_t RadioEvents; - +static RadioCallbacks_t RadioEvents = { + .txDone = &OnTxDone, + .txTimeout = &OnTxTimeout, + .rxDone = &OnRxDone, + .rxPreambleDetect = NULL, + .rxHeaderDone = NULL, + .rxTimeout = &OnRxTimeout, + .rxError = &OnRxError, + .cadDone = NULL, +}; + /* * Global variables declarations */ //Radio Radio( NULL ); +#define MESSAGE_SIZE 4 +typedef uint8_t Messages_t[MESSAGE_SIZE]; +const Messages_t PingMsg = {'P', 'I', 'N', 'G'}; +const Messages_t PongMsg = {'P', 'O', 'N', 'G'}; +const Messages_t *messageToReceive = &PongMsg; +const Messages_t *messageToSend = &PingMsg; -const uint8_t PingMsg[] = "PING"; -const uint8_t PongMsg[] = "PONG"; - -uint16_t BufferSize = BUFFER_SIZE; +uint8_t BufferSize = BUFFER_SIZE; uint8_t Buffer[BUFFER_SIZE]; -int16_t RssiValue = 0.0; -int8_t SnrValue = 0.0; - +int8_t RssiValue = 0; +int8_t SnrValue = 0; + +void GetRssiSnr(int8_t *rssi, int8_t *snr); +SX126xHal Radio( D11, D12, D13, D7, D3, D5, NC, NC, A0, A1, A2, D8, &RadioEvents ); + +void SetToMaster(void); +void SetToSlave(void); +void RunMasterStateMachine(); +void RunSlaveStateMachine(); +void SetConfiguration(RadioConfigurations_t *config); +void ConfigureGeneralRadio(SX126xHal *radio, RadioConfigurations_t *config); +void ConfigureRadioTx(SX126xHal *radio, RadioConfigurations_t *config); +void ConfigureRadioRx(SX126xHal *radio, RadioConfigurations_t *config); +void PrepareBuffer(SX126xHal *radio, const Messages_t *messageToSend); +bool isMaster = true; +bool masterCanSend = true; +void MasterSendNextEvent(void){masterCanSend = true;} +bool slaveCanListen = false; +void SlaveListenNextEvent(void){slaveCanListen = true;} +Ticker masterSendNextTicker; +Ticker slaveListenNextTicker; + +Serial serial(USBTX, USBRX); + int main( void ) { - uint8_t i; - bool isMaster = true; - - debug( "\n\n\r SX1272 Ping Pong 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( "Radio could not be detected!\n\r", NULL ); - wait( 1 ); + Radio.Reset(); + Radio.Init(); + serial.baud(115200); + SetToMaster(); + SetConfiguration(&radioConfiguration); + ConfigureGeneralRadio(&Radio, &radioConfiguration); + while(true){ + if(isMaster){ + RunMasterStateMachine(); + } + else{ + RunSlaveStateMachine(); + } } - - 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, 2000 ); - - 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("\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, 2000 ); - - 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 Ping-Pong loop\r\n" ); - - led = 0; - - Radio.Rx( RX_TIMEOUT_VALUE ); - - while( 1 ) - { - switch( State ) - { - case RX: - if( isMaster == true ) - { - if( BufferSize > 0 ) - { - if( strncmp( ( const char* )Buffer, ( const char* )PongMsg, 4 ) == 0 ) - { - led = !led; - debug( "...Pong\r\n" ); - // Send the next PING frame - strcpy( ( char* )Buffer, ( char* )PingMsg ); - // We fill the buffer with numbers for the payload - for( i = 4; i < BufferSize; i++ ) - { - Buffer[i] = i - 4; - } - wait_ms( 10 ); - Radio.Send( Buffer, BufferSize ); - } - else if( strncmp( ( const char* )Buffer, ( const char* )PingMsg, 4 ) == 0 ) - { // A master already exists then become a slave - debug( "...Ping\r\n" ); - led = !led; - isMaster = false; - // Send the next PONG frame - strcpy( ( char* )Buffer, ( char* )PongMsg ); - // We fill the buffer with numbers for the payload - for( i = 4; i < BufferSize; i++ ) - { - Buffer[i] = i - 4; - } - wait_ms( 10 ); - Radio.Send( Buffer, BufferSize ); - } - else // valid reception but neither a PING or a PONG message - { // Set device as master ans start again - isMaster = true; - Radio.Rx( RX_TIMEOUT_VALUE ); - } - } +} + +void RunMasterStateMachine(){ + switch(State){ + case SEND_PACKET:{ + if(masterCanSend == true){ + masterCanSend = false; + masterSendNextTicker.attach_us(&MasterSendNextEvent, SEND_PING_BEAT_US); + PrepareBuffer(&Radio, messageToSend); + ConfigureRadioTx(&Radio, &radioConfiguration); + Radio.SetTx(radioConfiguration.txTimeout); + printf("Ping...\n"); + State = WAIT_SEND_DONE; + } + break; + } + + case WAIT_SEND_DONE:{ + if(radioFlags.txDone){ + radioFlags.txDone = false; + State = RECEIVE_PACKET; + } + if(radioFlags.txTimeout){ + radioFlags.txTimeout = false; + State = SEND_PACKET; } - else - { - if( BufferSize > 0 ) - { - if( strncmp( ( const char* )Buffer, ( const char* )PingMsg, 4 ) == 0 ) - { - led = !led; - debug( "...Ping\r\n" ); - // Send the reply to the PING string - strcpy( ( char* )Buffer, ( char* )PongMsg ); - // We fill the buffer with numbers for the payload - for( i = 4; i < BufferSize; i++ ) - { - Buffer[i] = i - 4; - } - wait_ms( 10 ); - Radio.Send( Buffer, BufferSize ); - } - else // valid reception but not a PING as expected - { // Set device as master and start again - isMaster = true; - Radio.Rx( RX_TIMEOUT_VALUE ); - } - } - } - State = LOWPOWER; break; - case TX: - led = !led; - if( isMaster == true ) - { - debug( "Ping...\r\n" ); - } - else - { - debug( "Pong...\r\n" ); - } - Radio.Rx( RX_TIMEOUT_VALUE ); - State = LOWPOWER; + } + + case RECEIVE_PACKET:{ + ConfigureRadioRx(&Radio, &radioConfiguration); + Radio.SetRx(radioConfiguration.rxTimeout); + State = WAIT_RECEIVE_DONE; break; - case RX_TIMEOUT: - if( isMaster == true ) - { - // Send the next PING frame - strcpy( ( char* )Buffer, ( char* )PingMsg ); - for( i = 4; i < BufferSize; i++ ) - { - Buffer[i] = i - 4; - } - wait_ms( 10 ); - Radio.Send( Buffer, BufferSize ); + } + + case WAIT_RECEIVE_DONE:{ + if(radioFlags.rxDone == true){ + radioFlags.rxDone = false; + State = PACKET_RECEIVED; } - else - { - Radio.Rx( RX_TIMEOUT_VALUE ); + if(radioFlags.rxTimeout == true){ + radioFlags.rxTimeout = false; + State = SEND_PACKET; } - State = LOWPOWER; break; - case RX_ERROR: - // We have received a Packet with a CRC error, send reply as if packet was correct - if( isMaster == true ) - { - // Send the next PING frame - strcpy( ( char* )Buffer, ( char* )PingMsg ); - for( i = 4; i < BufferSize; i++ ) - { - Buffer[i] = i - 4; - } - wait_ms( 10 ); - Radio.Send( Buffer, BufferSize ); + } + + case PACKET_RECEIVED:{ + Radio.GetPayload( Buffer, &BufferSize, BUFFER_SIZE ); + RssiValue = Radio.GetRssiInst(); + GetRssiSnr(&RssiValue, &SnrValue); + if( strncmp(( const char* )Buffer, (const char*)messageToReceive, MESSAGE_SIZE ) == 0 ){ + printf("...Pong\n"); + State = SEND_PACKET; } - else - { - // Send the next PONG frame - strcpy( ( char* )Buffer, ( char* )PongMsg ); - for( i = 4; i < BufferSize; i++ ) - { - Buffer[i] = i - 4; - } - wait_ms( 10 ); - Radio.Send( Buffer, BufferSize ); + else if( strncmp(( const char* )Buffer, (const char*)messageToSend, MESSAGE_SIZE ) == 0 ){ + // Another Master is in the air, swith to slave + SetToSlave(); } - State = LOWPOWER; - break; - case TX_TIMEOUT: - Radio.Rx( RX_TIMEOUT_VALUE ); - State = LOWPOWER; - break; - case LOWPOWER: - break; - default: - State = LOWPOWER; + else{ + printf("WRONG PAYLOAD\n"); + SetToMaster(); + } break; } } } + +void RunSlaveStateMachine(){ + switch(State){ + case RECEIVE_PACKET:{ + if(slaveCanListen == true){ + slaveCanListen = false; + ConfigureRadioRx(&Radio, &radioConfiguration); + Radio.SetRx(radioConfiguration.rxTimeout); + slaveListenNextTicker.attach_us(&SlaveListenNextEvent, SEND_PING_BEAT_US - ( RX_TIMEOUT_US>>1 )); + State = WAIT_RECEIVE_DONE; + } + break; + } + + case WAIT_RECEIVE_DONE:{ + if(radioFlags.rxDone == true){ + radioFlags.rxDone = false; + State = PACKET_RECEIVED; + } + if(radioFlags.rxTimeout == true){ + radioFlags.rxTimeout = false; + SetToMaster(); + } + break; + } + + case PACKET_RECEIVED:{ + Radio.GetPayload( Buffer, &BufferSize, BUFFER_SIZE ); + RssiValue = Radio.GetRssiInst(); + GetRssiSnr(&RssiValue, &SnrValue); + if( strncmp(( const char* )Buffer, (const char*)messageToReceive, MESSAGE_SIZE ) == 0 ){ + printf("...Ping\n"); + State = SEND_PACKET; + } + else{ + SetToMaster(); + } + break; + } + + case SEND_PACKET:{ + PrepareBuffer(&Radio, messageToSend); + ConfigureRadioTx(&Radio, &radioConfiguration); + printf("Pong...\n"); + Radio.SetTx(radioConfiguration.txTimeout); + State = WAIT_SEND_DONE; + break; + } + + case WAIT_SEND_DONE:{ + if(radioFlags.txDone){ + radioFlags.txDone = false; + State = RECEIVE_PACKET; + } + if(radioFlags.txTimeout){ + radioFlags.txTimeout = false; + SetToMaster(); + } + break; + } + } +} + +void SetToMaster(){ + printf("-->Master\n"); + isMaster = true; + masterCanSend = true; + State = SEND_PACKET; + messageToReceive = &PongMsg; + messageToSend = &PingMsg; +} + +void SetToSlave(){ + slaveCanListen = false; + slaveListenNextTicker.attach_us(&SlaveListenNextEvent, SEND_PING_BEAT_US - ( RX_TIMEOUT_US>>1 )); + printf("--> Slave\n"); + isMaster = false; + State = RECEIVE_PACKET; + messageToReceive = &PingMsg; + messageToSend = &PongMsg; +} void OnTxDone( void ) { - Radio.Sleep( ); - State = TX; - debug_if( DEBUG_MESSAGE, "> OnTxDone\n\r" ); + radioFlags.txDone = true; } -void OnRxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr ) +void OnRxDone( void ) { - Radio.Sleep( ); - BufferSize = size; - memcpy( Buffer, payload, BufferSize ); - RssiValue = rssi; - SnrValue = snr; - State = RX; - debug_if( DEBUG_MESSAGE, "> OnRxDone\n\r" ); + radioFlags.rxDone = true; } void OnTxTimeout( void ) { - Radio.Sleep( ); - State = TX_TIMEOUT; + radioFlags.txTimeout = true; debug_if( DEBUG_MESSAGE, "> OnTxTimeout\n\r" ); } void OnRxTimeout( void ) { - Radio.Sleep( ); - Buffer[BufferSize] = 0; - State = RX_TIMEOUT; + radioFlags.rxTimeout = true; debug_if( DEBUG_MESSAGE, "> OnRxTimeout\n\r" ); } -void OnRxError( void ) +void OnRxError( IrqErrorCode_t errCode ) { - Radio.Sleep( ); - State = RX_ERROR; + radioFlags.rxError = true; debug_if( DEBUG_MESSAGE, "> OnRxError\n\r" ); -} \ No newline at end of file +} + +void SetConfiguration(RadioConfigurations_t *config){ + config->irqRx = IRQ_RX_DONE | IRQ_RX_TX_TIMEOUT; + config->irqTx = IRQ_TX_DONE | IRQ_RX_TX_TIMEOUT; + config->rfFrequency = RF_FREQUENCY; + config->txTimeout = 0; + config->rxTimeout = (uint32_t)(RX_TIMEOUT_US / 15.625); + config->txPower = TX_OUTPUT_POWER; + config->txRampTime = RADIO_RAMP_200_US; + #if USE_MODEM_LORA == 1 + config->packetType = PACKET_TYPE_LORA; + config->modParams.PacketType = PACKET_TYPE_LORA; + config->modParams.Params.LoRa.Bandwidth = LORA_BANDWIDTH; + config->modParams.Params.LoRa.CodingRate = LORA_CODINGRATE; + config->modParams.Params.LoRa.LowDatarateOptimize = LORA_LOWDATARATEOPTIMIZE; + config->modParams.Params.LoRa.SpreadingFactor = LORA_SPREADING_FACTOR; + config->packetParams.PacketType = PACKET_TYPE_LORA; + config->packetParams.Params.LoRa.CrcMode = LORA_CRC_MODE; + config->packetParams.Params.LoRa.HeaderType = LORA_HEADER_TYPE; + config->packetParams.Params.LoRa.InvertIQ = LORA_IQ; + config->packetParams.Params.LoRa.PayloadLength = BUFFER_SIZE; + config->packetParams.Params.LoRa.PreambleLength = LORA_PREAMBLE_LENGTH; + #elif USE_MODEM_FSK == 1 + config->packetType = PACKET_TYPE_GFSK; + config->modParams.PacketType = PACKET_TYPE_GFSK; + config->modParams.Params.Gfsk.Bandwidth = FSK_BANDWIDTH; + config->modParams.Params.Gfsk.BitRate = 1024000000 / FSK_DATARATE; + config->modParams.Params.Gfsk.Fdev = FSK_FDEV * 1.048576; + config->modParams.Params.Gfsk.ModulationShaping = FSK_MODULATION_SHAPPING; + config->packetParams.PacketType = PACKET_TYPE_GFSK; + config->packetParams.Params.Gfsk.AddrComp = FSK_ADDR_FILTERING; + config->packetParams.Params.Gfsk.CrcLength = FSK_CRC_MODE; + config->packetParams.Params.Gfsk.DcFree = FSK_WHITENING_MODE; + config->packetParams.Params.Gfsk.HeaderType = FSK_HEADER_TYPE; + config->packetParams.Params.Gfsk.PayloadLength = BUFFER_SIZE; + config->packetParams.Params.Gfsk.PreambleLength = FSK_PREAMBLE_LENGTH; + config->packetParams.Params.Gfsk.PreambleMinDetect = FSK_PREAMBLE_DETECTOR_MODE; + config->packetParams.Params.Gfsk.SyncWordLength = FSK_SYNCWORD_LENGTH; + #endif +} + +void ConfigureGeneralRadio(SX126xHal *radio, RadioConfigurations_t *config){ + radio->SetPacketType(config->packetType); + radio->SetPacketParams(&config->packetParams); + radio->SetModulationParams(&config->modParams); + radio->SetRfFrequency(config->rfFrequency); + radio->SetTxParams(config->txPower, config->txRampTime); + radio->SetInterruptMode(); + if(config->packetType == PACKET_TYPE_GFSK){ + uint8_t syncword[8] = {0xF0, 0x0F, 0x55, 0xAA, 0xF0, 0x0F, 0x55, 0xAA}; + radio->SetSyncWord(syncword); + } +} + +void ConfigureRadioTx(SX126xHal *radio, RadioConfigurations_t *config){ + radio->SetDioIrqParams(config->irqTx, config->irqTx, IRQ_RADIO_NONE, IRQ_RADIO_NONE); +} + +void ConfigureRadioRx(SX126xHal *radio, RadioConfigurations_t *config){ + radio->SetDioIrqParams(config->irqRx, config->irqRx, IRQ_RADIO_NONE, IRQ_RADIO_NONE); +} + +void PrepareBuffer(SX126xHal *radio, const Messages_t *messageToSend){ + radio->SetPayload((uint8_t*)messageToSend, MESSAGE_SIZE); +} + +void GetRssiSnr(int8_t *rssi, int8_t *snr) +{ + PacketStatus_t pkt_stat; + Radio.GetPacketStatus(&pkt_stat); + #if USE_MODEM_LORA == 1 + *rssi = pkt_stat.Params.LoRa.RssiPkt; + *snr = pkt_stat.Params.LoRa.SnrPkt; + #else + *rssi = pkt_stat.Params.Gfsk.RssiSync; + #endif +}