![](/media/cache/group/Semtech_stack_color_logo_highres.jpg.50x50_q85.jpg)
Source code for the SX126xDVK1xAS Dev Kit. This example code has only been tested on the Nucleo L476RG
Dependencies: mbed DmTftLibrary SX126xLib
Demo/DemoApplication.cpp@1:b96176a4ccb8, 2018-03-09 (annotated)
- Committer:
- GregCr
- Date:
- Fri Mar 09 13:28:34 2018 +0000
- Revision:
- 1:b96176a4ccb8
- Parent:
- 0:e5420f1a8a1a
- Child:
- 2:8e1b4210df6b
V1.0
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
GregCr | 0:e5420f1a8a1a | 1 | /* |
GregCr | 0:e5420f1a8a1a | 2 | ______ _ |
GregCr | 0:e5420f1a8a1a | 3 | / _____) _ | | |
GregCr | 0:e5420f1a8a1a | 4 | ( (____ _____ ____ _| |_ _____ ____| |__ |
GregCr | 0:e5420f1a8a1a | 5 | \____ \| ___ | (_ _) ___ |/ ___) _ \ |
GregCr | 0:e5420f1a8a1a | 6 | _____) ) ____| | | || |_| ____( (___| | | | |
GregCr | 0:e5420f1a8a1a | 7 | (______/|_____)_|_|_| \__)_____)\____)_| |_| |
GregCr | 0:e5420f1a8a1a | 8 | (C)2016 Semtech |
GregCr | 0:e5420f1a8a1a | 9 | |
GregCr | 0:e5420f1a8a1a | 10 | Description: PingPong, PER demo implementation. |
GregCr | 0:e5420f1a8a1a | 11 | |
GregCr | 0:e5420f1a8a1a | 12 | Maintainer: Gregory Cristian & Gilbert Menth |
GregCr | 0:e5420f1a8a1a | 13 | */ |
GregCr | 0:e5420f1a8a1a | 14 | |
GregCr | 0:e5420f1a8a1a | 15 | #include "mbed.h" |
GregCr | 0:e5420f1a8a1a | 16 | #include "radio.h" |
GregCr | 0:e5420f1a8a1a | 17 | #include "sx126x-hal.h" |
GregCr | 0:e5420f1a8a1a | 18 | #include "Eeprom.h" |
GregCr | 0:e5420f1a8a1a | 19 | #include "DemoApplication.h" |
GregCr | 0:e5420f1a8a1a | 20 | |
GregCr | 0:e5420f1a8a1a | 21 | /*! |
GregCr | 0:e5420f1a8a1a | 22 | * \brief Defines the local payload buffer size |
GregCr | 0:e5420f1a8a1a | 23 | */ |
GregCr | 0:e5420f1a8a1a | 24 | #define BUFFER_SIZE 255 |
GregCr | 0:e5420f1a8a1a | 25 | |
GregCr | 0:e5420f1a8a1a | 26 | /*! |
GregCr | 0:e5420f1a8a1a | 27 | * \brief Defines the size of the token defining message type in the payload |
GregCr | 0:e5420f1a8a1a | 28 | * cf. above. |
GregCr | 0:e5420f1a8a1a | 29 | */ |
GregCr | 0:e5420f1a8a1a | 30 | #define PINGPONG_SIZE 4 |
GregCr | 0:e5420f1a8a1a | 31 | #define PER_SIZE 3 |
GregCr | 0:e5420f1a8a1a | 32 | |
GregCr | 0:e5420f1a8a1a | 33 | /*! |
GregCr | 0:e5420f1a8a1a | 34 | * \brief Define time used in PingPong demo to synch with cycle |
GregCr | 0:e5420f1a8a1a | 35 | * RX_TIMEOUT_MARGIN is the free time between each cycle (time reserve) |
GregCr | 0:e5420f1a8a1a | 36 | */ |
GregCr | 0:e5420f1a8a1a | 37 | #define RX_TIMEOUT_MARGIN 150 // ms |
GregCr | 0:e5420f1a8a1a | 38 | #define RX_TX_TRANSITION_WAIT 5 // ms |
GregCr | 0:e5420f1a8a1a | 39 | |
GregCr | 0:e5420f1a8a1a | 40 | |
GregCr | 0:e5420f1a8a1a | 41 | /*! |
GregCr | 0:e5420f1a8a1a | 42 | * \brief Define the possible message type for the Ping-Pong and PER apps |
GregCr | 0:e5420f1a8a1a | 43 | */ |
GregCr | 0:e5420f1a8a1a | 44 | const uint8_t PingMsg[] = "PING"; |
GregCr | 0:e5420f1a8a1a | 45 | const uint8_t PongMsg[] = "PONG"; |
GregCr | 0:e5420f1a8a1a | 46 | const uint8_t PerMsg[] = "PER"; |
GregCr | 0:e5420f1a8a1a | 47 | |
GregCr | 0:e5420f1a8a1a | 48 | /*! |
GregCr | 0:e5420f1a8a1a | 49 | * \brief Buffer and its size |
GregCr | 0:e5420f1a8a1a | 50 | */ |
GregCr | 0:e5420f1a8a1a | 51 | uint8_t BufferSize = BUFFER_SIZE; |
GregCr | 0:e5420f1a8a1a | 52 | uint8_t Buffer[BUFFER_SIZE]; |
GregCr | 0:e5420f1a8a1a | 53 | |
GregCr | 0:e5420f1a8a1a | 54 | /*! |
GregCr | 0:e5420f1a8a1a | 55 | * \brief Function to be executed on Radio Tx Done event |
GregCr | 0:e5420f1a8a1a | 56 | */ |
GregCr | 0:e5420f1a8a1a | 57 | void OnTxDone( void ); |
GregCr | 0:e5420f1a8a1a | 58 | |
GregCr | 0:e5420f1a8a1a | 59 | /*! |
GregCr | 0:e5420f1a8a1a | 60 | * \brief Function to be executed on Radio Rx Done event |
GregCr | 0:e5420f1a8a1a | 61 | */ |
GregCr | 0:e5420f1a8a1a | 62 | void OnRxDone( void ); |
GregCr | 0:e5420f1a8a1a | 63 | |
GregCr | 0:e5420f1a8a1a | 64 | /*! |
GregCr | 0:e5420f1a8a1a | 65 | * \brief Function executed on Radio Tx Timeout event |
GregCr | 0:e5420f1a8a1a | 66 | */ |
GregCr | 0:e5420f1a8a1a | 67 | void OnTxTimeout( void ); |
GregCr | 0:e5420f1a8a1a | 68 | |
GregCr | 0:e5420f1a8a1a | 69 | /*! |
GregCr | 0:e5420f1a8a1a | 70 | * \brief Function executed on Radio Rx Timeout event |
GregCr | 0:e5420f1a8a1a | 71 | */ |
GregCr | 0:e5420f1a8a1a | 72 | void OnRxTimeout( void ); |
GregCr | 0:e5420f1a8a1a | 73 | |
GregCr | 0:e5420f1a8a1a | 74 | /*! |
GregCr | 0:e5420f1a8a1a | 75 | * \brief Function executed on Radio Rx Error event |
GregCr | 0:e5420f1a8a1a | 76 | */ |
GregCr | 0:e5420f1a8a1a | 77 | void OnRxError( IrqErrorCode_t ); |
GregCr | 0:e5420f1a8a1a | 78 | |
GregCr | 0:e5420f1a8a1a | 79 | /*! |
GregCr | 0:e5420f1a8a1a | 80 | * \brief Function executed on Radio CAD Done event |
GregCr | 0:e5420f1a8a1a | 81 | */ |
GregCr | 0:e5420f1a8a1a | 82 | void OnCadDone( bool channelActivityDetected ); |
GregCr | 0:e5420f1a8a1a | 83 | |
GregCr | 0:e5420f1a8a1a | 84 | /*! |
GregCr | 0:e5420f1a8a1a | 85 | * \brief All the callbacks are stored in a structure |
GregCr | 0:e5420f1a8a1a | 86 | */ |
GregCr | 0:e5420f1a8a1a | 87 | RadioCallbacks_t RadioEvents = |
GregCr | 0:e5420f1a8a1a | 88 | { |
GregCr | 0:e5420f1a8a1a | 89 | &OnTxDone, // txDone |
GregCr | 0:e5420f1a8a1a | 90 | &OnRxDone, // rxDone |
GregCr | 0:e5420f1a8a1a | 91 | NULL, // rxPreambleDetect |
GregCr | 0:e5420f1a8a1a | 92 | NULL, // rxSyncWordDone |
GregCr | 0:e5420f1a8a1a | 93 | NULL, // rxHeaderDone |
GregCr | 0:e5420f1a8a1a | 94 | &OnTxTimeout, // txTimeout |
GregCr | 0:e5420f1a8a1a | 95 | &OnRxTimeout, // rxTimeout |
GregCr | 0:e5420f1a8a1a | 96 | &OnRxError, // rxError |
GregCr | 0:e5420f1a8a1a | 97 | &OnCadDone, // cadDone |
GregCr | 0:e5420f1a8a1a | 98 | }; |
GregCr | 0:e5420f1a8a1a | 99 | |
GregCr | 0:e5420f1a8a1a | 100 | // SPI |
GregCr | 1:b96176a4ccb8 | 101 | // mosi, miso, sclk, nss, dio0, dio1, dio2, dio3, rst, freqSel, deviceSel, antSwPower, callbacks... |
GregCr | 1:b96176a4ccb8 | 102 | SX126xHal Radio( D11, D12, D13, D7, D3, D5, NC, NC, A0, A1, A2, D8, &RadioEvents ); |
GregCr | 0:e5420f1a8a1a | 103 | |
GregCr | 0:e5420f1a8a1a | 104 | /*! |
GregCr | 0:e5420f1a8a1a | 105 | * \brief Tx LED toggling on transmition success |
GregCr | 0:e5420f1a8a1a | 106 | */ |
GregCr | 0:e5420f1a8a1a | 107 | DigitalOut TX_LED( A4 ); |
GregCr | 0:e5420f1a8a1a | 108 | |
GregCr | 0:e5420f1a8a1a | 109 | /*! |
GregCr | 0:e5420f1a8a1a | 110 | * \brief Rx LED toggling on reception success |
GregCr | 0:e5420f1a8a1a | 111 | */ |
GregCr | 0:e5420f1a8a1a | 112 | DigitalOut RX_LED( A5 ); |
GregCr | 0:e5420f1a8a1a | 113 | |
GregCr | 0:e5420f1a8a1a | 114 | /*! |
GregCr | 0:e5420f1a8a1a | 115 | * \brief Mask of IRQs |
GregCr | 0:e5420f1a8a1a | 116 | */ |
GregCr | 0:e5420f1a8a1a | 117 | uint16_t IrqMask = 0x0000; |
GregCr | 0:e5420f1a8a1a | 118 | |
GregCr | 0:e5420f1a8a1a | 119 | /*! |
GregCr | 0:e5420f1a8a1a | 120 | * \brief Locals parameters and status for radio API |
GregCr | 0:e5420f1a8a1a | 121 | * NEED TO BE OPTIMIZED, COPY OF STUCTURE ALREADY EXISTING |
GregCr | 0:e5420f1a8a1a | 122 | */ |
GregCr | 0:e5420f1a8a1a | 123 | PacketParams_t PacketParams; |
GregCr | 0:e5420f1a8a1a | 124 | PacketStatus_t PacketStatus; |
GregCr | 0:e5420f1a8a1a | 125 | ModulationParams_t ModulationParams; |
GregCr | 0:e5420f1a8a1a | 126 | |
GregCr | 0:e5420f1a8a1a | 127 | /*! |
GregCr | 0:e5420f1a8a1a | 128 | * \brief Flag to indicate if the demo is already running |
GregCr | 0:e5420f1a8a1a | 129 | */ |
GregCr | 0:e5420f1a8a1a | 130 | static bool DemoRunning = false; |
GregCr | 0:e5420f1a8a1a | 131 | |
GregCr | 0:e5420f1a8a1a | 132 | /*! |
GregCr | 0:e5420f1a8a1a | 133 | * \brief Frequency Error (only LSB) |
GregCr | 0:e5420f1a8a1a | 134 | */ |
GregCr | 0:e5420f1a8a1a | 135 | static double FreErrorLsb = 0.0; |
GregCr | 0:e5420f1a8a1a | 136 | |
GregCr | 0:e5420f1a8a1a | 137 | /*! |
GregCr | 0:e5420f1a8a1a | 138 | * \brief Flag holding the current internal state of the demo application |
GregCr | 0:e5420f1a8a1a | 139 | */ |
GregCr | 0:e5420f1a8a1a | 140 | static uint8_t DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 141 | |
GregCr | 0:e5420f1a8a1a | 142 | /*! |
GregCr | 0:e5420f1a8a1a | 143 | * \brief Ticker for master to synch Tx frames. Flags for PER and PingPong demo |
GregCr | 0:e5420f1a8a1a | 144 | * for Synch TX in cycle. |
GregCr | 0:e5420f1a8a1a | 145 | */ |
GregCr | 0:e5420f1a8a1a | 146 | Ticker SendNextPacket; |
GregCr | 0:e5420f1a8a1a | 147 | static bool SendNext = false; |
GregCr | 0:e5420f1a8a1a | 148 | |
GregCr | 0:e5420f1a8a1a | 149 | /*! |
GregCr | 0:e5420f1a8a1a | 150 | * \brief Hold last Rx packet number to compute PER in PER and PingPong demo |
GregCr | 0:e5420f1a8a1a | 151 | */ |
GregCr | 0:e5420f1a8a1a | 152 | static uint32_t PacketRxSequence = 0; |
GregCr | 0:e5420f1a8a1a | 153 | static uint32_t PacketRxSequencePrev = 0; |
GregCr | 0:e5420f1a8a1a | 154 | |
GregCr | 0:e5420f1a8a1a | 155 | void LedBlink( void ); |
GregCr | 0:e5420f1a8a1a | 156 | void InitializeDemoParameters( uint8_t modulation ); |
GregCr | 0:e5420f1a8a1a | 157 | uint16_t GetTimeOnAir( uint8_t modulation ); |
GregCr | 0:e5420f1a8a1a | 158 | void SendNextPacketEvent( void ); |
GregCr | 0:e5420f1a8a1a | 159 | |
GregCr | 0:e5420f1a8a1a | 160 | // ************************** RF Test Demo ****************************** |
GregCr | 0:e5420f1a8a1a | 161 | // * * |
GregCr | 0:e5420f1a8a1a | 162 | // * * |
GregCr | 0:e5420f1a8a1a | 163 | // * * |
GregCr | 0:e5420f1a8a1a | 164 | // ***************************************************************************** |
GregCr | 1:b96176a4ccb8 | 165 | uint8_t RunDemoTestRssi( void ) |
GregCr | 1:b96176a4ccb8 | 166 | { |
GregCr | 1:b96176a4ccb8 | 167 | uint8_t refreshDisplay = 0; |
GregCr | 1:b96176a4ccb8 | 168 | static uint16_t i; |
GregCr | 1:b96176a4ccb8 | 169 | |
GregCr | 1:b96176a4ccb8 | 170 | if( Eeprom.EepromData.DemoSettings.HoldDemo == true ) |
GregCr | 1:b96176a4ccb8 | 171 | { |
GregCr | 1:b96176a4ccb8 | 172 | return 0; |
GregCr | 1:b96176a4ccb8 | 173 | } |
GregCr | 1:b96176a4ccb8 | 174 | |
GregCr | 1:b96176a4ccb8 | 175 | if( DemoRunning == false ) |
GregCr | 1:b96176a4ccb8 | 176 | { |
GregCr | 1:b96176a4ccb8 | 177 | DemoRunning = true; |
GregCr | 1:b96176a4ccb8 | 178 | |
GregCr | 1:b96176a4ccb8 | 179 | printf( "Start RunDemoTestRssi\n\r" ); |
GregCr | 1:b96176a4ccb8 | 180 | |
GregCr | 1:b96176a4ccb8 | 181 | TX_LED = 0; |
GregCr | 1:b96176a4ccb8 | 182 | RX_LED = 0; |
GregCr | 1:b96176a4ccb8 | 183 | |
GregCr | 1:b96176a4ccb8 | 184 | Eeprom.EepromData.DemoSettings.CntPacketTx = 0; |
GregCr | 1:b96176a4ccb8 | 185 | Eeprom.EepromData.DemoSettings.CntPacketRxOK = 0; |
GregCr | 1:b96176a4ccb8 | 186 | Eeprom.EepromData.DemoSettings.CntPacketRxKO = 0; |
GregCr | 1:b96176a4ccb8 | 187 | |
GregCr | 1:b96176a4ccb8 | 188 | InitializeDemoParameters( Eeprom.EepromData.DemoSettings.ModulationType ); |
GregCr | 1:b96176a4ccb8 | 189 | |
GregCr | 1:b96176a4ccb8 | 190 | IrqMask = IRQ_RX_DONE | IRQ_CRC_ERROR | IRQ_RX_TX_TIMEOUT; |
GregCr | 1:b96176a4ccb8 | 191 | Radio.SetDioIrqParams( IrqMask, IrqMask, IRQ_RADIO_NONE, IRQ_RADIO_NONE ); |
GregCr | 1:b96176a4ccb8 | 192 | // Rx Continuous |
GregCr | 1:b96176a4ccb8 | 193 | if( Eeprom.EepromData.DemoSettings.BoostedRx == false ) |
GregCr | 1:b96176a4ccb8 | 194 | { |
GregCr | 1:b96176a4ccb8 | 195 | Radio.SetRx( 0xFFFFFF ); |
GregCr | 1:b96176a4ccb8 | 196 | } |
GregCr | 1:b96176a4ccb8 | 197 | else |
GregCr | 1:b96176a4ccb8 | 198 | { |
GregCr | 1:b96176a4ccb8 | 199 | Radio.SetRxBoosted( 0xFFFFFF ); |
GregCr | 1:b96176a4ccb8 | 200 | } |
GregCr | 1:b96176a4ccb8 | 201 | DemoInternalState = APP_IDLE; |
GregCr | 1:b96176a4ccb8 | 202 | i = 0; |
GregCr | 1:b96176a4ccb8 | 203 | } |
GregCr | 1:b96176a4ccb8 | 204 | |
GregCr | 1:b96176a4ccb8 | 205 | Radio.ProcessIrqs( ); |
GregCr | 1:b96176a4ccb8 | 206 | |
GregCr | 1:b96176a4ccb8 | 207 | if( i < 5000 ) |
GregCr | 1:b96176a4ccb8 | 208 | { |
GregCr | 1:b96176a4ccb8 | 209 | i++; |
GregCr | 1:b96176a4ccb8 | 210 | } |
GregCr | 1:b96176a4ccb8 | 211 | else |
GregCr | 1:b96176a4ccb8 | 212 | { |
GregCr | 1:b96176a4ccb8 | 213 | i = 0; |
GregCr | 1:b96176a4ccb8 | 214 | Eeprom.EepromData.DemoSettings.RssiValue = Radio.GetRssiInst( ); |
GregCr | 1:b96176a4ccb8 | 215 | refreshDisplay = 1; |
GregCr | 1:b96176a4ccb8 | 216 | } |
GregCr | 1:b96176a4ccb8 | 217 | |
GregCr | 1:b96176a4ccb8 | 218 | return refreshDisplay; |
GregCr | 1:b96176a4ccb8 | 219 | } |
GregCr | 0:e5420f1a8a1a | 220 | |
GregCr | 0:e5420f1a8a1a | 221 | uint8_t RunDemoSleepMode( void ) |
GregCr | 0:e5420f1a8a1a | 222 | { |
GregCr | 0:e5420f1a8a1a | 223 | SleepParams_t SleepParam; |
GregCr | 0:e5420f1a8a1a | 224 | |
GregCr | 0:e5420f1a8a1a | 225 | if( Eeprom.EepromData.DemoSettings.HoldDemo == true ) |
GregCr | 0:e5420f1a8a1a | 226 | { |
GregCr | 0:e5420f1a8a1a | 227 | return 0; |
GregCr | 0:e5420f1a8a1a | 228 | } |
GregCr | 0:e5420f1a8a1a | 229 | |
GregCr | 0:e5420f1a8a1a | 230 | if( DemoRunning == false ) |
GregCr | 0:e5420f1a8a1a | 231 | { |
GregCr | 0:e5420f1a8a1a | 232 | DemoRunning = true; |
GregCr | 0:e5420f1a8a1a | 233 | InitializeDemoParameters( PACKET_TYPE_LORA ); |
GregCr | 0:e5420f1a8a1a | 234 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 235 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 236 | |
GregCr | 0:e5420f1a8a1a | 237 | SleepParam.Fields.WakeUpRTC = 0; //!< Get out of sleep mode if wakeup signal received from RTC |
GregCr | 0:e5420f1a8a1a | 238 | SleepParam.Fields.Reset = 0; //!< |
GregCr | 0:e5420f1a8a1a | 239 | SleepParam.Fields.WarmStart = 1; //!< |
GregCr | 0:e5420f1a8a1a | 240 | Radio.SetSleep( SleepParam ); |
GregCr | 0:e5420f1a8a1a | 241 | } |
GregCr | 0:e5420f1a8a1a | 242 | else |
GregCr | 0:e5420f1a8a1a | 243 | { |
GregCr | 0:e5420f1a8a1a | 244 | LedBlink( ); |
GregCr | 0:e5420f1a8a1a | 245 | } |
GregCr | 0:e5420f1a8a1a | 246 | return 0; |
GregCr | 0:e5420f1a8a1a | 247 | } |
GregCr | 0:e5420f1a8a1a | 248 | |
GregCr | 0:e5420f1a8a1a | 249 | uint8_t RunDemoStandbyRcMode( void ) |
GregCr | 0:e5420f1a8a1a | 250 | { |
GregCr | 0:e5420f1a8a1a | 251 | if( Eeprom.EepromData.DemoSettings.HoldDemo == true ) |
GregCr | 0:e5420f1a8a1a | 252 | { |
GregCr | 0:e5420f1a8a1a | 253 | return 0; |
GregCr | 0:e5420f1a8a1a | 254 | } |
GregCr | 0:e5420f1a8a1a | 255 | |
GregCr | 0:e5420f1a8a1a | 256 | if( DemoRunning == false ) |
GregCr | 0:e5420f1a8a1a | 257 | { |
GregCr | 0:e5420f1a8a1a | 258 | DemoRunning = true; |
GregCr | 0:e5420f1a8a1a | 259 | InitializeDemoParameters( PACKET_TYPE_LORA ); |
GregCr | 0:e5420f1a8a1a | 260 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 261 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 262 | Radio.SetRegulatorMode( ( RadioRegulatorMode_t )Eeprom.EepromData.DemoSettings.RadioPowerMode ); |
GregCr | 0:e5420f1a8a1a | 263 | Radio.SetStandby( STDBY_RC ); |
GregCr | 0:e5420f1a8a1a | 264 | DemoRunning = true; |
GregCr | 0:e5420f1a8a1a | 265 | } |
GregCr | 0:e5420f1a8a1a | 266 | else |
GregCr | 0:e5420f1a8a1a | 267 | { |
GregCr | 0:e5420f1a8a1a | 268 | LedBlink( ); |
GregCr | 0:e5420f1a8a1a | 269 | } |
GregCr | 0:e5420f1a8a1a | 270 | return 0; |
GregCr | 0:e5420f1a8a1a | 271 | } |
GregCr | 0:e5420f1a8a1a | 272 | |
GregCr | 0:e5420f1a8a1a | 273 | uint8_t RunDemoStandbyXoscMode( void ) |
GregCr | 0:e5420f1a8a1a | 274 | { |
GregCr | 0:e5420f1a8a1a | 275 | if( Eeprom.EepromData.DemoSettings.HoldDemo == true ) |
GregCr | 0:e5420f1a8a1a | 276 | { |
GregCr | 0:e5420f1a8a1a | 277 | return 0; |
GregCr | 0:e5420f1a8a1a | 278 | } |
GregCr | 0:e5420f1a8a1a | 279 | if( DemoRunning == false ) |
GregCr | 0:e5420f1a8a1a | 280 | { |
GregCr | 0:e5420f1a8a1a | 281 | DemoRunning = true; |
GregCr | 0:e5420f1a8a1a | 282 | InitializeDemoParameters( PACKET_TYPE_LORA ); |
GregCr | 0:e5420f1a8a1a | 283 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 284 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 285 | Radio.SetRegulatorMode( ( RadioRegulatorMode_t )Eeprom.EepromData.DemoSettings.RadioPowerMode ); |
GregCr | 0:e5420f1a8a1a | 286 | Radio.SetStandby( STDBY_XOSC ); |
GregCr | 0:e5420f1a8a1a | 287 | DemoRunning = true; |
GregCr | 0:e5420f1a8a1a | 288 | } |
GregCr | 0:e5420f1a8a1a | 289 | else |
GregCr | 0:e5420f1a8a1a | 290 | { |
GregCr | 0:e5420f1a8a1a | 291 | LedBlink( ); |
GregCr | 0:e5420f1a8a1a | 292 | } |
GregCr | 0:e5420f1a8a1a | 293 | return 0; |
GregCr | 0:e5420f1a8a1a | 294 | } |
GregCr | 0:e5420f1a8a1a | 295 | |
GregCr | 0:e5420f1a8a1a | 296 | uint8_t RunDemoTxCw( void ) |
GregCr | 0:e5420f1a8a1a | 297 | { |
GregCr | 0:e5420f1a8a1a | 298 | if( Eeprom.EepromData.DemoSettings.HoldDemo == true ) |
GregCr | 0:e5420f1a8a1a | 299 | { |
GregCr | 0:e5420f1a8a1a | 300 | return 0; |
GregCr | 0:e5420f1a8a1a | 301 | } |
GregCr | 0:e5420f1a8a1a | 302 | |
GregCr | 0:e5420f1a8a1a | 303 | if( DemoRunning == false ) |
GregCr | 0:e5420f1a8a1a | 304 | { |
GregCr | 0:e5420f1a8a1a | 305 | DemoRunning = true; |
GregCr | 0:e5420f1a8a1a | 306 | InitializeDemoParameters( PACKET_TYPE_LORA ); |
GregCr | 0:e5420f1a8a1a | 307 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 308 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 309 | Radio.SetStandby( STDBY_RC ); |
GregCr | 0:e5420f1a8a1a | 310 | Radio.SetRegulatorMode( ( RadioRegulatorMode_t )Eeprom.EepromData.DemoSettings.RadioPowerMode ); |
GregCr | 0:e5420f1a8a1a | 311 | Radio.SetRfFrequency( Eeprom.EepromData.DemoSettings.Frequency ); |
GregCr | 1:b96176a4ccb8 | 312 | Radio.SetTxParams( Eeprom.EepromData.DemoSettings.TxPower, RADIO_RAMP_200_US ); |
GregCr | 0:e5420f1a8a1a | 313 | Radio.SetTxContinuousWave( ); |
GregCr | 0:e5420f1a8a1a | 314 | DemoRunning = true; |
GregCr | 0:e5420f1a8a1a | 315 | } |
GregCr | 0:e5420f1a8a1a | 316 | else |
GregCr | 0:e5420f1a8a1a | 317 | { |
GregCr | 0:e5420f1a8a1a | 318 | LedBlink( ); |
GregCr | 0:e5420f1a8a1a | 319 | } |
GregCr | 0:e5420f1a8a1a | 320 | return 0; |
GregCr | 0:e5420f1a8a1a | 321 | } |
GregCr | 0:e5420f1a8a1a | 322 | |
GregCr | 0:e5420f1a8a1a | 323 | uint8_t RunDemoTxContinuousModulation( void ) |
GregCr | 0:e5420f1a8a1a | 324 | { |
GregCr | 0:e5420f1a8a1a | 325 | uint8_t localPayloadSize = 250; |
GregCr | 0:e5420f1a8a1a | 326 | uint8_t i = 0; |
GregCr | 0:e5420f1a8a1a | 327 | |
GregCr | 0:e5420f1a8a1a | 328 | if( Eeprom.EepromData.DemoSettings.HoldDemo == true ) |
GregCr | 0:e5420f1a8a1a | 329 | { |
GregCr | 0:e5420f1a8a1a | 330 | return 0; |
GregCr | 0:e5420f1a8a1a | 331 | } |
GregCr | 0:e5420f1a8a1a | 332 | |
GregCr | 0:e5420f1a8a1a | 333 | Radio.ProcessIrqs( ); |
GregCr | 0:e5420f1a8a1a | 334 | |
GregCr | 0:e5420f1a8a1a | 335 | if( DemoRunning == false ) |
GregCr | 0:e5420f1a8a1a | 336 | { |
GregCr | 0:e5420f1a8a1a | 337 | DemoRunning = true; |
GregCr | 0:e5420f1a8a1a | 338 | InitializeDemoParameters( Eeprom.EepromData.DemoSettings.ModulationType ); |
GregCr | 0:e5420f1a8a1a | 339 | Radio.SetTxParams( Eeprom.EepromData.DemoSettings.TxPower, RADIO_RAMP_3400_US ); |
GregCr | 0:e5420f1a8a1a | 340 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 341 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 342 | IrqMask = IRQ_TX_DONE | IRQ_RX_TX_TIMEOUT; |
GregCr | 0:e5420f1a8a1a | 343 | Radio.SetDioIrqParams( IrqMask, IrqMask, IRQ_RADIO_NONE, IRQ_RADIO_NONE ); |
GregCr | 0:e5420f1a8a1a | 344 | for( i = 0; i < localPayloadSize; i++ ) |
GregCr | 0:e5420f1a8a1a | 345 | { |
GregCr | 0:e5420f1a8a1a | 346 | Buffer[i] = ( uint8_t )rand( ); |
GregCr | 0:e5420f1a8a1a | 347 | } |
GregCr | 0:e5420f1a8a1a | 348 | Radio.SendPayload( Buffer, localPayloadSize, 0xFFFFFF ); |
GregCr | 0:e5420f1a8a1a | 349 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 350 | } |
GregCr | 0:e5420f1a8a1a | 351 | else |
GregCr | 0:e5420f1a8a1a | 352 | { |
GregCr | 0:e5420f1a8a1a | 353 | switch( DemoInternalState ) |
GregCr | 0:e5420f1a8a1a | 354 | { |
GregCr | 0:e5420f1a8a1a | 355 | case APP_RX: |
GregCr | 0:e5420f1a8a1a | 356 | break; |
GregCr | 0:e5420f1a8a1a | 357 | |
GregCr | 0:e5420f1a8a1a | 358 | case APP_TX: |
GregCr | 0:e5420f1a8a1a | 359 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 360 | LedBlink( ); |
GregCr | 0:e5420f1a8a1a | 361 | // Send the next frame |
GregCr | 0:e5420f1a8a1a | 362 | IrqMask = IRQ_TX_DONE | IRQ_RX_TX_TIMEOUT; |
GregCr | 0:e5420f1a8a1a | 363 | Radio.SetDioIrqParams( IrqMask, IrqMask, IRQ_RADIO_NONE, IRQ_RADIO_NONE ); |
GregCr | 0:e5420f1a8a1a | 364 | |
GregCr | 0:e5420f1a8a1a | 365 | Radio.SendPayload( Buffer, localPayloadSize, 0xFFFFFF ); |
GregCr | 0:e5420f1a8a1a | 366 | // we prepare next payload during transmission |
GregCr | 0:e5420f1a8a1a | 367 | for( i = 0; i < localPayloadSize; i++ ) |
GregCr | 0:e5420f1a8a1a | 368 | { |
GregCr | 0:e5420f1a8a1a | 369 | Buffer[i] = ( uint8_t )rand( ); |
GregCr | 0:e5420f1a8a1a | 370 | } |
GregCr | 0:e5420f1a8a1a | 371 | break; |
GregCr | 0:e5420f1a8a1a | 372 | |
GregCr | 0:e5420f1a8a1a | 373 | case APP_RX_TIMEOUT: |
GregCr | 0:e5420f1a8a1a | 374 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 375 | break; |
GregCr | 0:e5420f1a8a1a | 376 | |
GregCr | 0:e5420f1a8a1a | 377 | case APP_RX_ERROR: |
GregCr | 0:e5420f1a8a1a | 378 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 379 | break; |
GregCr | 0:e5420f1a8a1a | 380 | |
GregCr | 0:e5420f1a8a1a | 381 | case APP_TX_TIMEOUT: |
GregCr | 0:e5420f1a8a1a | 382 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 383 | break; |
GregCr | 0:e5420f1a8a1a | 384 | |
GregCr | 0:e5420f1a8a1a | 385 | case APP_IDLE: |
GregCr | 0:e5420f1a8a1a | 386 | break; |
GregCr | 0:e5420f1a8a1a | 387 | |
GregCr | 0:e5420f1a8a1a | 388 | default: |
GregCr | 0:e5420f1a8a1a | 389 | break; |
GregCr | 0:e5420f1a8a1a | 390 | } |
GregCr | 0:e5420f1a8a1a | 391 | } |
GregCr | 0:e5420f1a8a1a | 392 | |
GregCr | 0:e5420f1a8a1a | 393 | return 0; |
GregCr | 0:e5420f1a8a1a | 394 | } |
GregCr | 0:e5420f1a8a1a | 395 | |
GregCr | 0:e5420f1a8a1a | 396 | uint8_t RunDemoRxContinuous( void ) |
GregCr | 0:e5420f1a8a1a | 397 | { |
GregCr | 0:e5420f1a8a1a | 398 | uint8_t refreshDisplay = 0; |
GregCr | 0:e5420f1a8a1a | 399 | |
GregCr | 0:e5420f1a8a1a | 400 | if( Eeprom.EepromData.DemoSettings.HoldDemo == true ) |
GregCr | 0:e5420f1a8a1a | 401 | { |
GregCr | 0:e5420f1a8a1a | 402 | return 0; |
GregCr | 0:e5420f1a8a1a | 403 | } |
GregCr | 0:e5420f1a8a1a | 404 | |
GregCr | 0:e5420f1a8a1a | 405 | if( DemoRunning == false ) |
GregCr | 0:e5420f1a8a1a | 406 | { |
GregCr | 0:e5420f1a8a1a | 407 | DemoRunning = true; |
GregCr | 0:e5420f1a8a1a | 408 | |
GregCr | 0:e5420f1a8a1a | 409 | printf( "Start RunDemoRxContinuous\n\r" ); |
GregCr | 0:e5420f1a8a1a | 410 | |
GregCr | 0:e5420f1a8a1a | 411 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 412 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 413 | |
GregCr | 0:e5420f1a8a1a | 414 | Eeprom.EepromData.DemoSettings.CntPacketTx = 0; |
GregCr | 0:e5420f1a8a1a | 415 | Eeprom.EepromData.DemoSettings.CntPacketRxOK = 0; |
GregCr | 0:e5420f1a8a1a | 416 | Eeprom.EepromData.DemoSettings.CntPacketRxKO = 0; |
GregCr | 0:e5420f1a8a1a | 417 | |
GregCr | 0:e5420f1a8a1a | 418 | InitializeDemoParameters( Eeprom.EepromData.DemoSettings.ModulationType ); |
GregCr | 0:e5420f1a8a1a | 419 | |
GregCr | 0:e5420f1a8a1a | 420 | // set preamble to max size to avoid filtering of the receiver on preamble lenght |
GregCr | 0:e5420f1a8a1a | 421 | if( Eeprom.EepromData.DemoSettings.ModulationType == PACKET_TYPE_LORA ) |
GregCr | 0:e5420f1a8a1a | 422 | { |
GregCr | 0:e5420f1a8a1a | 423 | PacketParams.Params.LoRa.PreambleLength = 0xFFFF; |
GregCr | 0:e5420f1a8a1a | 424 | PacketParams.Params.LoRa.HeaderType = ( RadioLoRaPacketLengthsMode_t )Eeprom.EepromData.DemoSettings.PacketParam2; |
GregCr | 0:e5420f1a8a1a | 425 | PacketParams.Params.LoRa.PayloadLength = Eeprom.EepromData.DemoSettings.PacketParam3; |
GregCr | 0:e5420f1a8a1a | 426 | PacketParams.Params.LoRa.CrcMode = ( RadioLoRaCrcModes_t ) Eeprom.EepromData.DemoSettings.PacketParam4; |
GregCr | 0:e5420f1a8a1a | 427 | PacketParams.Params.LoRa.InvertIQ = ( RadioLoRaIQModes_t ) Eeprom.EepromData.DemoSettings.PacketParam5; |
GregCr | 0:e5420f1a8a1a | 428 | Radio.SetPacketParams( &PacketParams ); |
GregCr | 0:e5420f1a8a1a | 429 | } |
GregCr | 0:e5420f1a8a1a | 430 | |
GregCr | 0:e5420f1a8a1a | 431 | IrqMask = IRQ_RX_DONE | IRQ_CRC_ERROR | IRQ_RX_TX_TIMEOUT; |
GregCr | 0:e5420f1a8a1a | 432 | Radio.SetDioIrqParams( IrqMask, IrqMask, IRQ_RADIO_NONE, IRQ_RADIO_NONE ); |
GregCr | 0:e5420f1a8a1a | 433 | // Rx Continuous |
GregCr | 0:e5420f1a8a1a | 434 | if( Eeprom.EepromData.DemoSettings.BoostedRx == false ) |
GregCr | 0:e5420f1a8a1a | 435 | { |
GregCr | 0:e5420f1a8a1a | 436 | Radio.SetRx( 0xFFFFFF ); |
GregCr | 0:e5420f1a8a1a | 437 | } |
GregCr | 0:e5420f1a8a1a | 438 | else |
GregCr | 0:e5420f1a8a1a | 439 | { |
GregCr | 0:e5420f1a8a1a | 440 | Radio.SetRxBoosted( 0xFFFFFF ); |
GregCr | 0:e5420f1a8a1a | 441 | } |
GregCr | 0:e5420f1a8a1a | 442 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 443 | |
GregCr | 0:e5420f1a8a1a | 444 | } |
GregCr | 0:e5420f1a8a1a | 445 | |
GregCr | 0:e5420f1a8a1a | 446 | if( Eeprom.EepromData.DemoSettings.MaxNumPacket > 0 ) // != Infinite |
GregCr | 0:e5420f1a8a1a | 447 | { |
GregCr | 0:e5420f1a8a1a | 448 | if( ( Eeprom.EepromData.DemoSettings.CntPacketRxOK + \ |
GregCr | 0:e5420f1a8a1a | 449 | Eeprom.EepromData.DemoSettings.CntPacketRxKO ) >= \ |
GregCr | 0:e5420f1a8a1a | 450 | Eeprom.EepromData.DemoSettings.MaxNumPacket ) |
GregCr | 0:e5420f1a8a1a | 451 | { |
GregCr | 0:e5420f1a8a1a | 452 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 453 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 454 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 455 | Radio.SetStandby( STDBY_RC ); |
GregCr | 0:e5420f1a8a1a | 456 | SendNextPacket.detach( ); |
GregCr | 0:e5420f1a8a1a | 457 | Eeprom.EepromData.DemoSettings.HoldDemo = true; |
GregCr | 0:e5420f1a8a1a | 458 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 459 | } |
GregCr | 0:e5420f1a8a1a | 460 | } |
GregCr | 0:e5420f1a8a1a | 461 | |
GregCr | 0:e5420f1a8a1a | 462 | Radio.ProcessIrqs( ); |
GregCr | 0:e5420f1a8a1a | 463 | |
GregCr | 0:e5420f1a8a1a | 464 | switch( DemoInternalState ) |
GregCr | 0:e5420f1a8a1a | 465 | { |
GregCr | 0:e5420f1a8a1a | 466 | case APP_TX: |
GregCr | 0:e5420f1a8a1a | 467 | break; |
GregCr | 0:e5420f1a8a1a | 468 | |
GregCr | 0:e5420f1a8a1a | 469 | case APP_RX: |
GregCr | 0:e5420f1a8a1a | 470 | RX_LED = !RX_LED; |
GregCr | 0:e5420f1a8a1a | 471 | Radio.GetPayload( Buffer, &BufferSize, BUFFER_SIZE ); |
GregCr | 0:e5420f1a8a1a | 472 | Radio.GetPacketStatus( &PacketStatus ); |
GregCr | 0:e5420f1a8a1a | 473 | if( Eeprom.EepromData.DemoSettings.ModulationType == PACKET_TYPE_LORA ) |
GregCr | 0:e5420f1a8a1a | 474 | { |
GregCr | 0:e5420f1a8a1a | 475 | Eeprom.EepromData.DemoSettings.RssiValue = PacketStatus.Params.LoRa.RssiPkt; |
GregCr | 0:e5420f1a8a1a | 476 | Eeprom.EepromData.DemoSettings.SnrValue = PacketStatus.Params.LoRa.SnrPkt; |
GregCr | 0:e5420f1a8a1a | 477 | if( ( PacketStatus.Params.LoRa.FreqError & 0x00080000 ) == 0x00080000 ) |
GregCr | 0:e5420f1a8a1a | 478 | { |
GregCr | 0:e5420f1a8a1a | 479 | PacketStatus.Params.LoRa.FreqError = 0xFFFFF - PacketStatus.Params.LoRa.FreqError; |
GregCr | 0:e5420f1a8a1a | 480 | } |
GregCr | 0:e5420f1a8a1a | 481 | Eeprom.EepromData.DemoSettings.FreqErrorEst = ( double )PacketStatus.Params.LoRa.FreqError * FreErrorLsb; |
GregCr | 0:e5420f1a8a1a | 482 | } |
GregCr | 0:e5420f1a8a1a | 483 | else // Eeprom.EepromData.DemoSettings.ModulationType == PACKET_TYPE_GFSK |
GregCr | 0:e5420f1a8a1a | 484 | { |
GregCr | 0:e5420f1a8a1a | 485 | Eeprom.EepromData.DemoSettings.RssiValue = PacketStatus.Params.Gfsk.RssiAvg; |
GregCr | 0:e5420f1a8a1a | 486 | Eeprom.EepromData.DemoSettings.SnrValue = 0; |
GregCr | 0:e5420f1a8a1a | 487 | } |
GregCr | 0:e5420f1a8a1a | 488 | |
GregCr | 0:e5420f1a8a1a | 489 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 490 | Eeprom.EepromData.DemoSettings.CntPacketRxOK ++; |
GregCr | 0:e5420f1a8a1a | 491 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 492 | break; |
GregCr | 0:e5420f1a8a1a | 493 | |
GregCr | 0:e5420f1a8a1a | 494 | case APP_RX_ERROR: |
GregCr | 0:e5420f1a8a1a | 495 | case APP_RX_TIMEOUT: |
GregCr | 0:e5420f1a8a1a | 496 | Eeprom.EepromData.DemoSettings.CntPacketRxKO ++; |
GregCr | 1:b96176a4ccb8 | 497 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 498 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 499 | break; |
GregCr | 0:e5420f1a8a1a | 500 | |
GregCr | 0:e5420f1a8a1a | 501 | case APP_TX_TIMEOUT: |
GregCr | 0:e5420f1a8a1a | 502 | break; |
GregCr | 0:e5420f1a8a1a | 503 | |
GregCr | 0:e5420f1a8a1a | 504 | case APP_IDLE: |
GregCr | 0:e5420f1a8a1a | 505 | break; |
GregCr | 0:e5420f1a8a1a | 506 | |
GregCr | 0:e5420f1a8a1a | 507 | default: |
GregCr | 0:e5420f1a8a1a | 508 | break; |
GregCr | 0:e5420f1a8a1a | 509 | } |
GregCr | 0:e5420f1a8a1a | 510 | return refreshDisplay; |
GregCr | 0:e5420f1a8a1a | 511 | } |
GregCr | 0:e5420f1a8a1a | 512 | |
GregCr | 0:e5420f1a8a1a | 513 | // ************************* PER Demo ****************************** |
GregCr | 0:e5420f1a8a1a | 514 | // * * |
GregCr | 0:e5420f1a8a1a | 515 | // * * |
GregCr | 0:e5420f1a8a1a | 516 | // * * |
GregCr | 0:e5420f1a8a1a | 517 | // ***************************************************************************** |
GregCr | 0:e5420f1a8a1a | 518 | uint8_t RunDemoApplicationPer( void ) |
GregCr | 0:e5420f1a8a1a | 519 | { |
GregCr | 0:e5420f1a8a1a | 520 | uint8_t i = 0; |
GregCr | 0:e5420f1a8a1a | 521 | uint8_t refreshDisplay = 0; |
GregCr | 0:e5420f1a8a1a | 522 | |
GregCr | 0:e5420f1a8a1a | 523 | if( Eeprom.EepromData.DemoSettings.HoldDemo == true ) |
GregCr | 0:e5420f1a8a1a | 524 | { |
GregCr | 0:e5420f1a8a1a | 525 | return 0; |
GregCr | 0:e5420f1a8a1a | 526 | } |
GregCr | 0:e5420f1a8a1a | 527 | |
GregCr | 0:e5420f1a8a1a | 528 | if( DemoRunning == false ) |
GregCr | 0:e5420f1a8a1a | 529 | { |
GregCr | 0:e5420f1a8a1a | 530 | DemoRunning = true; |
GregCr | 0:e5420f1a8a1a | 531 | |
GregCr | 0:e5420f1a8a1a | 532 | printf( "Start RunDemoApplicationPer\n\r" ); |
GregCr | 0:e5420f1a8a1a | 533 | |
GregCr | 0:e5420f1a8a1a | 534 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 535 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 536 | |
GregCr | 0:e5420f1a8a1a | 537 | Eeprom.EepromData.DemoSettings.CntPacketTx = 0; |
GregCr | 0:e5420f1a8a1a | 538 | Eeprom.EepromData.DemoSettings.CntPacketRxOK = 0; |
GregCr | 0:e5420f1a8a1a | 539 | Eeprom.EepromData.DemoSettings.CntPacketRxKO = 0; |
GregCr | 0:e5420f1a8a1a | 540 | Eeprom.EepromData.DemoSettings.RxTimeOutCount = 0; |
GregCr | 0:e5420f1a8a1a | 541 | |
GregCr | 0:e5420f1a8a1a | 542 | InitializeDemoParameters( Eeprom.EepromData.DemoSettings.ModulationType ); |
GregCr | 0:e5420f1a8a1a | 543 | |
GregCr | 0:e5420f1a8a1a | 544 | Eeprom.EepromData.DemoSettings.InterPacketDelay = GetTimeOnAir( Eeprom.EepromData.DemoSettings.ModulationType ) + RX_TX_TRANSITION_WAIT; |
GregCr | 0:e5420f1a8a1a | 545 | |
GregCr | 0:e5420f1a8a1a | 546 | if( Eeprom.EepromData.DemoSettings.Entity == MASTER ) |
GregCr | 0:e5420f1a8a1a | 547 | { |
GregCr | 0:e5420f1a8a1a | 548 | SendNextPacket.attach_us( &SendNextPacketEvent, ( uint32_t )( ( Eeprom.EepromData.DemoSettings.InterPacketDelay + RX_TIMEOUT_MARGIN ) * 1000 ) ); |
GregCr | 0:e5420f1a8a1a | 549 | DemoInternalState = APP_TX; |
GregCr | 0:e5420f1a8a1a | 550 | } |
GregCr | 0:e5420f1a8a1a | 551 | else |
GregCr | 0:e5420f1a8a1a | 552 | { |
GregCr | 1:b96176a4ccb8 | 553 | IrqMask = /*0xFFFF; */IRQ_HEADER_VALID | IRQ_RX_DONE | IRQ_CRC_ERROR | IRQ_RX_TX_TIMEOUT; |
GregCr | 0:e5420f1a8a1a | 554 | Radio.SetDioIrqParams( IrqMask, IrqMask, IRQ_RADIO_NONE, IRQ_RADIO_NONE ); |
GregCr | 0:e5420f1a8a1a | 555 | // Rx Single without timeout for the start |
GregCr | 0:e5420f1a8a1a | 556 | if( Eeprom.EepromData.DemoSettings.BoostedRx == false ) |
GregCr | 0:e5420f1a8a1a | 557 | { |
GregCr | 0:e5420f1a8a1a | 558 | Radio.SetRx( 0x0000 ); |
GregCr | 0:e5420f1a8a1a | 559 | } |
GregCr | 0:e5420f1a8a1a | 560 | else |
GregCr | 0:e5420f1a8a1a | 561 | { |
GregCr | 0:e5420f1a8a1a | 562 | Radio.SetRxBoosted( 0x0000 ); |
GregCr | 0:e5420f1a8a1a | 563 | } |
GregCr | 0:e5420f1a8a1a | 564 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 565 | } |
GregCr | 0:e5420f1a8a1a | 566 | } |
GregCr | 0:e5420f1a8a1a | 567 | |
GregCr | 0:e5420f1a8a1a | 568 | Radio.ProcessIrqs( ); |
GregCr | 0:e5420f1a8a1a | 569 | |
GregCr | 0:e5420f1a8a1a | 570 | if( Eeprom.EepromData.DemoSettings.MaxNumPacket > 0 ) // != Infinite |
GregCr | 0:e5420f1a8a1a | 571 | { |
GregCr | 0:e5420f1a8a1a | 572 | if( ( Eeprom.EepromData.DemoSettings.CntPacketRxOK + \ |
GregCr | 0:e5420f1a8a1a | 573 | Eeprom.EepromData.DemoSettings.CntPacketRxKO + \ |
GregCr | 0:e5420f1a8a1a | 574 | Eeprom.EepromData.DemoSettings.RxTimeOutCount) >= \ |
GregCr | 0:e5420f1a8a1a | 575 | Eeprom.EepromData.DemoSettings.MaxNumPacket ) |
GregCr | 0:e5420f1a8a1a | 576 | { |
GregCr | 0:e5420f1a8a1a | 577 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 578 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 579 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 580 | Radio.SetStandby( STDBY_RC ); |
GregCr | 0:e5420f1a8a1a | 581 | SendNextPacket.detach( ); |
GregCr | 0:e5420f1a8a1a | 582 | Eeprom.EepromData.DemoSettings.HoldDemo = true; |
GregCr | 0:e5420f1a8a1a | 583 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 584 | } |
GregCr | 0:e5420f1a8a1a | 585 | } |
GregCr | 0:e5420f1a8a1a | 586 | |
GregCr | 0:e5420f1a8a1a | 587 | switch( DemoInternalState ) |
GregCr | 0:e5420f1a8a1a | 588 | { |
GregCr | 0:e5420f1a8a1a | 589 | case PER_TX_START: |
GregCr | 0:e5420f1a8a1a | 590 | Eeprom.EepromData.DemoSettings.CntPacketTx++; |
GregCr | 0:e5420f1a8a1a | 591 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 592 | |
GregCr | 0:e5420f1a8a1a | 593 | Buffer[0] = 0x00; |
GregCr | 0:e5420f1a8a1a | 594 | Buffer[1] = ( Eeprom.EepromData.DemoSettings.CntPacketTx >> 24 ) & 0xFF; |
GregCr | 0:e5420f1a8a1a | 595 | Buffer[2] = ( Eeprom.EepromData.DemoSettings.CntPacketTx >> 16 ) & 0xFF; |
GregCr | 0:e5420f1a8a1a | 596 | Buffer[3] = ( Eeprom.EepromData.DemoSettings.CntPacketTx >> 8 ) & 0xFF; |
GregCr | 0:e5420f1a8a1a | 597 | Buffer[4] = Eeprom.EepromData.DemoSettings.CntPacketTx & 0xFF; |
GregCr | 0:e5420f1a8a1a | 598 | Buffer[5] = PerMsg[0]; |
GregCr | 0:e5420f1a8a1a | 599 | Buffer[6] = PerMsg[1]; |
GregCr | 0:e5420f1a8a1a | 600 | Buffer[7] = PerMsg[2]; |
GregCr | 0:e5420f1a8a1a | 601 | for( i = 8; i < Eeprom.EepromData.DemoSettings.PayloadLength; i++ ) |
GregCr | 0:e5420f1a8a1a | 602 | { |
GregCr | 0:e5420f1a8a1a | 603 | Buffer[i] = i; |
GregCr | 0:e5420f1a8a1a | 604 | } |
GregCr | 0:e5420f1a8a1a | 605 | TX_LED = !TX_LED; |
GregCr | 0:e5420f1a8a1a | 606 | IrqMask = 0xFFFF; //IRQ_TX_DONE | IRQ_RX_TX_TIMEOUT; |
GregCr | 0:e5420f1a8a1a | 607 | Radio.SetDioIrqParams( IrqMask, IrqMask, IRQ_RADIO_NONE, IRQ_RADIO_NONE ); |
GregCr | 0:e5420f1a8a1a | 608 | Radio.SendPayload( Buffer, Eeprom.EepromData.DemoSettings.PayloadLength, ( Eeprom.EepromData.DemoSettings.InterPacketDelay ) << 6 ); |
GregCr | 0:e5420f1a8a1a | 609 | break; |
GregCr | 0:e5420f1a8a1a | 610 | |
GregCr | 0:e5420f1a8a1a | 611 | case PER_RX_START: |
GregCr | 1:b96176a4ccb8 | 612 | IrqMask = /*0xFFFF;*/ IRQ_HEADER_VALID | IRQ_RX_DONE | IRQ_CRC_ERROR | IRQ_RX_TX_TIMEOUT; |
GregCr | 0:e5420f1a8a1a | 613 | Radio.SetDioIrqParams( IrqMask, IrqMask, IRQ_RADIO_NONE, IRQ_RADIO_NONE ); |
GregCr | 0:e5420f1a8a1a | 614 | if( Eeprom.EepromData.DemoSettings.BoostedRx == false ) |
GregCr | 0:e5420f1a8a1a | 615 | { |
GregCr | 0:e5420f1a8a1a | 616 | Radio.SetRx( ( Eeprom.EepromData.DemoSettings.InterPacketDelay + RX_TIMEOUT_MARGIN ) << 6 ); |
GregCr | 0:e5420f1a8a1a | 617 | } |
GregCr | 0:e5420f1a8a1a | 618 | else |
GregCr | 0:e5420f1a8a1a | 619 | { |
GregCr | 0:e5420f1a8a1a | 620 | Radio.SetRxBoosted( ( Eeprom.EepromData.DemoSettings.InterPacketDelay + RX_TIMEOUT_MARGIN ) << 6 ); |
GregCr | 0:e5420f1a8a1a | 621 | } |
GregCr | 0:e5420f1a8a1a | 622 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 623 | break; |
GregCr | 0:e5420f1a8a1a | 624 | |
GregCr | 0:e5420f1a8a1a | 625 | case APP_TX: |
GregCr | 0:e5420f1a8a1a | 626 | if( SendNext == true ) |
GregCr | 0:e5420f1a8a1a | 627 | { |
GregCr | 0:e5420f1a8a1a | 628 | SendNext = false; |
GregCr | 0:e5420f1a8a1a | 629 | if( Eeprom.EepromData.DemoSettings.MaxNumPacket == 0 ) |
GregCr | 0:e5420f1a8a1a | 630 | { |
GregCr | 0:e5420f1a8a1a | 631 | DemoInternalState = PER_TX_START; // Infinite -> send next |
GregCr | 0:e5420f1a8a1a | 632 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 633 | } |
GregCr | 0:e5420f1a8a1a | 634 | else if( Eeprom.EepromData.DemoSettings.CntPacketTx < \ |
GregCr | 0:e5420f1a8a1a | 635 | Eeprom.EepromData.DemoSettings.MaxNumPacket ) |
GregCr | 0:e5420f1a8a1a | 636 | { |
GregCr | 0:e5420f1a8a1a | 637 | DemoInternalState = PER_TX_START; // MaxNumPacket not sent |
GregCr | 0:e5420f1a8a1a | 638 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 639 | } |
GregCr | 0:e5420f1a8a1a | 640 | else // MaxNumPacket sent -> end of demo |
GregCr | 0:e5420f1a8a1a | 641 | { |
GregCr | 0:e5420f1a8a1a | 642 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 643 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 644 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 645 | Radio.SetStandby( STDBY_RC ); |
GregCr | 0:e5420f1a8a1a | 646 | SendNextPacket.detach( ); |
GregCr | 0:e5420f1a8a1a | 647 | Eeprom.EepromData.DemoSettings.HoldDemo = true; |
GregCr | 0:e5420f1a8a1a | 648 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 649 | } |
GregCr | 0:e5420f1a8a1a | 650 | } |
GregCr | 0:e5420f1a8a1a | 651 | break; |
GregCr | 0:e5420f1a8a1a | 652 | |
GregCr | 0:e5420f1a8a1a | 653 | case APP_RX: |
GregCr | 0:e5420f1a8a1a | 654 | RX_LED = !RX_LED; |
GregCr | 0:e5420f1a8a1a | 655 | Radio.GetPayload( Buffer, &BufferSize, BUFFER_SIZE ); |
GregCr | 0:e5420f1a8a1a | 656 | Radio.GetPacketStatus( &PacketStatus ); |
GregCr | 0:e5420f1a8a1a | 657 | if( Eeprom.EepromData.DemoSettings.ModulationType == PACKET_TYPE_LORA ) |
GregCr | 0:e5420f1a8a1a | 658 | { |
GregCr | 0:e5420f1a8a1a | 659 | Eeprom.EepromData.DemoSettings.RssiValue = PacketStatus.Params.LoRa.RssiPkt; |
GregCr | 0:e5420f1a8a1a | 660 | Eeprom.EepromData.DemoSettings.SnrValue = PacketStatus.Params.LoRa.SnrPkt; |
GregCr | 0:e5420f1a8a1a | 661 | if( ( PacketStatus.Params.LoRa.FreqError & 0x00080000 ) == 0x00080000 ) |
GregCr | 0:e5420f1a8a1a | 662 | { |
GregCr | 0:e5420f1a8a1a | 663 | PacketStatus.Params.LoRa.FreqError = 0xFFFFF - PacketStatus.Params.LoRa.FreqError; |
GregCr | 0:e5420f1a8a1a | 664 | } |
GregCr | 0:e5420f1a8a1a | 665 | Eeprom.EepromData.DemoSettings.FreqErrorEst = ( double )PacketStatus.Params.LoRa.FreqError * FreErrorLsb; |
GregCr | 0:e5420f1a8a1a | 666 | } |
GregCr | 0:e5420f1a8a1a | 667 | else // Eeprom.EepromData.DemoSettings.ModulationType == PACKET_TYPE_GFSK |
GregCr | 0:e5420f1a8a1a | 668 | { |
GregCr | 0:e5420f1a8a1a | 669 | Eeprom.EepromData.DemoSettings.RssiValue = PacketStatus.Params.Gfsk.RssiAvg; |
GregCr | 0:e5420f1a8a1a | 670 | Eeprom.EepromData.DemoSettings.SnrValue = 0; |
GregCr | 0:e5420f1a8a1a | 671 | if( ( PacketStatus.Params.Gfsk.FreqError & 0x00000800 ) == 0x00000800 ) |
GregCr | 0:e5420f1a8a1a | 672 | { |
GregCr | 0:e5420f1a8a1a | 673 | PacketStatus.Params.Gfsk.FreqError = 0x00000FFF - PacketStatus.Params.Gfsk.FreqError; |
GregCr | 0:e5420f1a8a1a | 674 | } |
GregCr | 0:e5420f1a8a1a | 675 | PacketStatus.Params.LoRa.FreqError = PacketStatus.Params.LoRa.FreqError / 2048; |
GregCr | 0:e5420f1a8a1a | 676 | Eeprom.EepromData.DemoSettings.FreqErrorEst = ( ( double )PacketStatus.Params.Gfsk.FreqError / 2048.0 ); |
GregCr | 0:e5420f1a8a1a | 677 | } |
GregCr | 0:e5420f1a8a1a | 678 | |
GregCr | 0:e5420f1a8a1a | 679 | DemoInternalState = PER_RX_START; |
GregCr | 0:e5420f1a8a1a | 680 | if( ( BufferSize >= PER_SIZE ) && ( strncmp( ( const char* )( Buffer + 5 ), ( const char* )PerMsg, PER_SIZE ) == 0 ) ) |
GregCr | 0:e5420f1a8a1a | 681 | { |
GregCr | 0:e5420f1a8a1a | 682 | ComputePerPayload( Buffer, BufferSize ); |
GregCr | 0:e5420f1a8a1a | 683 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 684 | } |
GregCr | 0:e5420f1a8a1a | 685 | else |
GregCr | 0:e5420f1a8a1a | 686 | { |
GregCr | 0:e5420f1a8a1a | 687 | Eeprom.EepromData.DemoSettings.RxTimeOutCount++; |
GregCr | 0:e5420f1a8a1a | 688 | } |
GregCr | 0:e5420f1a8a1a | 689 | break; |
GregCr | 0:e5420f1a8a1a | 690 | |
GregCr | 0:e5420f1a8a1a | 691 | case APP_RX_ERROR: |
GregCr | 0:e5420f1a8a1a | 692 | case APP_RX_TIMEOUT: |
GregCr | 0:e5420f1a8a1a | 693 | Eeprom.EepromData.DemoSettings.RxTimeOutCount++; |
GregCr | 0:e5420f1a8a1a | 694 | DemoInternalState = PER_RX_START; |
GregCr | 0:e5420f1a8a1a | 695 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 696 | break; |
GregCr | 0:e5420f1a8a1a | 697 | |
GregCr | 0:e5420f1a8a1a | 698 | case APP_TX_TIMEOUT: |
GregCr | 0:e5420f1a8a1a | 699 | printf( "Failure: timeout in Tx is shorter than the packet time on air\n\r" ); |
GregCr | 0:e5420f1a8a1a | 700 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 701 | Eeprom.EepromData.DemoSettings.HoldDemo = true; |
GregCr | 0:e5420f1a8a1a | 702 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 703 | break; |
GregCr | 0:e5420f1a8a1a | 704 | |
GregCr | 0:e5420f1a8a1a | 705 | case APP_IDLE: // do nothing |
GregCr | 0:e5420f1a8a1a | 706 | /* |
GregCr | 0:e5420f1a8a1a | 707 | val = Radio.GetSysErrors( ); |
GregCr | 0:e5420f1a8a1a | 708 | if( val.Value != 0x0000 ) |
GregCr | 0:e5420f1a8a1a | 709 | { |
GregCr | 0:e5420f1a8a1a | 710 | printf(" Dev Error = 0x%04x \n\r", val.Value ); |
GregCr | 0:e5420f1a8a1a | 711 | } |
GregCr | 0:e5420f1a8a1a | 712 | */ |
GregCr | 0:e5420f1a8a1a | 713 | break; |
GregCr | 0:e5420f1a8a1a | 714 | |
GregCr | 0:e5420f1a8a1a | 715 | default: |
GregCr | 0:e5420f1a8a1a | 716 | break; |
GregCr | 0:e5420f1a8a1a | 717 | } |
GregCr | 0:e5420f1a8a1a | 718 | return refreshDisplay; |
GregCr | 0:e5420f1a8a1a | 719 | } |
GregCr | 0:e5420f1a8a1a | 720 | |
GregCr | 0:e5420f1a8a1a | 721 | void ComputePerPayload( uint8_t *buffer, uint8_t bufferSize ) |
GregCr | 0:e5420f1a8a1a | 722 | { |
GregCr | 0:e5420f1a8a1a | 723 | uint32_t i = 0; |
GregCr | 0:e5420f1a8a1a | 724 | |
GregCr | 0:e5420f1a8a1a | 725 | Eeprom.EepromData.DemoSettings.CntPacketRxOK++; |
GregCr | 0:e5420f1a8a1a | 726 | PacketRxSequence = ( ( uint32_t )buffer[1] << 24 ) | \ |
GregCr | 0:e5420f1a8a1a | 727 | ( ( uint32_t )buffer[2] << 16 ) | \ |
GregCr | 0:e5420f1a8a1a | 728 | ( ( uint32_t )buffer[3] << 8 ) | \ |
GregCr | 0:e5420f1a8a1a | 729 | buffer[4]; |
GregCr | 0:e5420f1a8a1a | 730 | |
GregCr | 0:e5420f1a8a1a | 731 | if( ( PacketRxSequence <= PacketRxSequencePrev ) || \ |
GregCr | 0:e5420f1a8a1a | 732 | ( PacketRxSequencePrev == 0xFFFFFFFF ) ) |
GregCr | 0:e5420f1a8a1a | 733 | { |
GregCr | 0:e5420f1a8a1a | 734 | // Sequence went back => resynchronization |
GregCr | 0:e5420f1a8a1a | 735 | // Don't count missed packets this time |
GregCr | 0:e5420f1a8a1a | 736 | i = 0; |
GregCr | 0:e5420f1a8a1a | 737 | } |
GregCr | 0:e5420f1a8a1a | 738 | else |
GregCr | 0:e5420f1a8a1a | 739 | { |
GregCr | 0:e5420f1a8a1a | 740 | // Determine number of missed packets |
GregCr | 0:e5420f1a8a1a | 741 | i = PacketRxSequence - PacketRxSequencePrev - 1; |
GregCr | 0:e5420f1a8a1a | 742 | } |
GregCr | 0:e5420f1a8a1a | 743 | // Be ready for the next |
GregCr | 0:e5420f1a8a1a | 744 | PacketRxSequencePrev = PacketRxSequence; |
GregCr | 0:e5420f1a8a1a | 745 | // increment 'missed' counter for the RX session |
GregCr | 0:e5420f1a8a1a | 746 | Eeprom.EepromData.DemoSettings.CntPacketRxKO += i; |
GregCr | 0:e5420f1a8a1a | 747 | Eeprom.EepromData.DemoSettings.RxTimeOutCount = 0; |
GregCr | 0:e5420f1a8a1a | 748 | } |
GregCr | 0:e5420f1a8a1a | 749 | |
GregCr | 0:e5420f1a8a1a | 750 | // ************************ Ping Pong Demo ***************************** |
GregCr | 0:e5420f1a8a1a | 751 | // * * |
GregCr | 0:e5420f1a8a1a | 752 | // * * |
GregCr | 0:e5420f1a8a1a | 753 | // * * |
GregCr | 0:e5420f1a8a1a | 754 | // ***************************************************************************** |
GregCr | 0:e5420f1a8a1a | 755 | uint8_t RunDemoApplicationPingPong( void ) |
GregCr | 0:e5420f1a8a1a | 756 | { |
GregCr | 0:e5420f1a8a1a | 757 | uint8_t i = 0; |
GregCr | 0:e5420f1a8a1a | 758 | uint8_t refreshDisplay = 0; |
GregCr | 0:e5420f1a8a1a | 759 | |
GregCr | 0:e5420f1a8a1a | 760 | if( Eeprom.EepromData.DemoSettings.HoldDemo == true ) |
GregCr | 0:e5420f1a8a1a | 761 | { |
GregCr | 0:e5420f1a8a1a | 762 | return 0; // quit without refresh display |
GregCr | 0:e5420f1a8a1a | 763 | } |
GregCr | 0:e5420f1a8a1a | 764 | |
GregCr | 0:e5420f1a8a1a | 765 | if( DemoRunning == false ) |
GregCr | 0:e5420f1a8a1a | 766 | { |
GregCr | 0:e5420f1a8a1a | 767 | DemoRunning = true; |
GregCr | 0:e5420f1a8a1a | 768 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 769 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 770 | Eeprom.EepromData.DemoSettings.CntPacketTx = 0; |
GregCr | 0:e5420f1a8a1a | 771 | Eeprom.EepromData.DemoSettings.CntPacketRxOK = 0; |
GregCr | 0:e5420f1a8a1a | 772 | Eeprom.EepromData.DemoSettings.CntPacketRxOKSlave = 0; |
GregCr | 0:e5420f1a8a1a | 773 | Eeprom.EepromData.DemoSettings.CntPacketRxKO = 0; |
GregCr | 0:e5420f1a8a1a | 774 | Eeprom.EepromData.DemoSettings.CntPacketRxKOSlave = 0; |
GregCr | 0:e5420f1a8a1a | 775 | Eeprom.EepromData.DemoSettings.RxTimeOutCount = 0; |
GregCr | 0:e5420f1a8a1a | 776 | |
GregCr | 0:e5420f1a8a1a | 777 | InitializeDemoParameters( Eeprom.EepromData.DemoSettings.ModulationType ); |
GregCr | 0:e5420f1a8a1a | 778 | |
GregCr | 0:e5420f1a8a1a | 779 | Eeprom.EepromData.DemoSettings.InterPacketDelay = GetTimeOnAir( Eeprom.EepromData.DemoSettings.ModulationType ) + RX_TX_TRANSITION_WAIT; |
GregCr | 0:e5420f1a8a1a | 780 | |
GregCr | 0:e5420f1a8a1a | 781 | printf( "Start RunDemoApplicationPingPong.\n\r" ); |
GregCr | 0:e5420f1a8a1a | 782 | |
GregCr | 0:e5420f1a8a1a | 783 | if( Eeprom.EepromData.DemoSettings.Entity == MASTER ) |
GregCr | 0:e5420f1a8a1a | 784 | { |
GregCr | 0:e5420f1a8a1a | 785 | DemoInternalState = SEND_PING_MSG; |
GregCr | 0:e5420f1a8a1a | 786 | uint32_t temp = ( Eeprom.EepromData.DemoSettings.InterPacketDelay << 1 ) + RX_TIMEOUT_MARGIN; |
GregCr | 1:b96176a4ccb8 | 787 | float val = ( float )temp / 1000.0; |
GregCr | 0:e5420f1a8a1a | 788 | SendNextPacket.attach( &SendNextPacketEvent, val ); |
GregCr | 0:e5420f1a8a1a | 789 | } |
GregCr | 0:e5420f1a8a1a | 790 | else |
GregCr | 0:e5420f1a8a1a | 791 | { |
GregCr | 0:e5420f1a8a1a | 792 | IrqMask = IRQ_RX_DONE | IRQ_CRC_ERROR | IRQ_RX_TX_TIMEOUT; |
GregCr | 0:e5420f1a8a1a | 793 | Radio.SetDioIrqParams( IrqMask, IrqMask, IRQ_RADIO_NONE, IRQ_RADIO_NONE ); |
GregCr | 0:e5420f1a8a1a | 794 | // Rx Single without timeout for the start |
GregCr | 0:e5420f1a8a1a | 795 | RX_LED = !RX_LED; |
GregCr | 0:e5420f1a8a1a | 796 | |
GregCr | 0:e5420f1a8a1a | 797 | if( Eeprom.EepromData.DemoSettings.BoostedRx == false ) |
GregCr | 0:e5420f1a8a1a | 798 | { |
GregCr | 0:e5420f1a8a1a | 799 | Radio.SetRx( 0x0000 ); |
GregCr | 0:e5420f1a8a1a | 800 | } |
GregCr | 0:e5420f1a8a1a | 801 | else |
GregCr | 0:e5420f1a8a1a | 802 | { |
GregCr | 0:e5420f1a8a1a | 803 | Radio.SetRxBoosted( 0x0000 ); |
GregCr | 0:e5420f1a8a1a | 804 | } |
GregCr | 0:e5420f1a8a1a | 805 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 806 | } |
GregCr | 0:e5420f1a8a1a | 807 | } |
GregCr | 0:e5420f1a8a1a | 808 | |
GregCr | 0:e5420f1a8a1a | 809 | Radio.ProcessIrqs( ); |
GregCr | 0:e5420f1a8a1a | 810 | |
GregCr | 0:e5420f1a8a1a | 811 | if( Eeprom.EepromData.DemoSettings.Entity == MASTER ) |
GregCr | 0:e5420f1a8a1a | 812 | { |
GregCr | 0:e5420f1a8a1a | 813 | switch( DemoInternalState ) |
GregCr | 0:e5420f1a8a1a | 814 | { |
GregCr | 0:e5420f1a8a1a | 815 | case SEND_PING_MSG: |
GregCr | 0:e5420f1a8a1a | 816 | if( ( Eeprom.EepromData.DemoSettings.MaxNumPacket != 0 ) \ |
GregCr | 0:e5420f1a8a1a | 817 | && ( Eeprom.EepromData.DemoSettings.CntPacketTx >= Eeprom.EepromData.DemoSettings.MaxNumPacket ) ) |
GregCr | 0:e5420f1a8a1a | 818 | { |
GregCr | 0:e5420f1a8a1a | 819 | SendNextPacket.detach( ); |
GregCr | 0:e5420f1a8a1a | 820 | SendNext = false; |
GregCr | 0:e5420f1a8a1a | 821 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 822 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 823 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 824 | Radio.SetStandby( STDBY_RC ); |
GregCr | 0:e5420f1a8a1a | 825 | Eeprom.EepromData.DemoSettings.HoldDemo = true; |
GregCr | 0:e5420f1a8a1a | 826 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 827 | } |
GregCr | 0:e5420f1a8a1a | 828 | else |
GregCr | 0:e5420f1a8a1a | 829 | { |
GregCr | 0:e5420f1a8a1a | 830 | if( SendNext == true ) |
GregCr | 0:e5420f1a8a1a | 831 | { |
GregCr | 0:e5420f1a8a1a | 832 | SendNext = false; |
GregCr | 0:e5420f1a8a1a | 833 | Radio.SetStandby( STDBY_RC ); |
GregCr | 0:e5420f1a8a1a | 834 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 835 | Eeprom.EepromData.DemoSettings.CntPacketTx++; |
GregCr | 0:e5420f1a8a1a | 836 | // Send the next PING frame |
GregCr | 0:e5420f1a8a1a | 837 | Buffer[0] = ( Eeprom.EepromData.DemoSettings.CntPacketTx >> 24 ) & 0xFF; |
GregCr | 0:e5420f1a8a1a | 838 | Buffer[1] = ( Eeprom.EepromData.DemoSettings.CntPacketTx >> 16 ) & 0xFF; |
GregCr | 0:e5420f1a8a1a | 839 | Buffer[2] = ( Eeprom.EepromData.DemoSettings.CntPacketTx >> 8 ) & 0xFF; |
GregCr | 0:e5420f1a8a1a | 840 | Buffer[3] = ( Eeprom.EepromData.DemoSettings.CntPacketTx & 0xFF ); |
GregCr | 0:e5420f1a8a1a | 841 | Buffer[4] = PingMsg[0]; |
GregCr | 0:e5420f1a8a1a | 842 | Buffer[5] = PingMsg[1]; |
GregCr | 0:e5420f1a8a1a | 843 | Buffer[6] = PingMsg[2]; |
GregCr | 0:e5420f1a8a1a | 844 | Buffer[7] = PingMsg[3]; |
GregCr | 0:e5420f1a8a1a | 845 | for( i = 8; i < Eeprom.EepromData.DemoSettings.PayloadLength; i++ ) |
GregCr | 0:e5420f1a8a1a | 846 | { |
GregCr | 0:e5420f1a8a1a | 847 | Buffer[i] = i; |
GregCr | 0:e5420f1a8a1a | 848 | } |
GregCr | 0:e5420f1a8a1a | 849 | TX_LED = !TX_LED; |
GregCr | 0:e5420f1a8a1a | 850 | IrqMask = IRQ_TX_DONE | IRQ_RX_TX_TIMEOUT; |
GregCr | 0:e5420f1a8a1a | 851 | Radio.SetDioIrqParams( IrqMask, IrqMask, IRQ_RADIO_NONE, IRQ_RADIO_NONE ); |
GregCr | 0:e5420f1a8a1a | 852 | Radio.SendPayload( Buffer, Eeprom.EepromData.DemoSettings.PayloadLength, \ |
GregCr | 0:e5420f1a8a1a | 853 | Eeprom.EepromData.DemoSettings.InterPacketDelay << 6 ); |
GregCr | 0:e5420f1a8a1a | 854 | } |
GregCr | 0:e5420f1a8a1a | 855 | } |
GregCr | 0:e5420f1a8a1a | 856 | break; |
GregCr | 0:e5420f1a8a1a | 857 | |
GregCr | 0:e5420f1a8a1a | 858 | case APP_TX: |
GregCr | 0:e5420f1a8a1a | 859 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 860 | TX_LED = !TX_LED; |
GregCr | 0:e5420f1a8a1a | 861 | RX_LED = !RX_LED; |
GregCr | 0:e5420f1a8a1a | 862 | IrqMask = IRQ_RX_DONE | IRQ_CRC_ERROR | IRQ_RX_TX_TIMEOUT; |
GregCr | 0:e5420f1a8a1a | 863 | Radio.SetDioIrqParams( IrqMask, IrqMask, IRQ_RADIO_NONE, IRQ_RADIO_NONE ); |
GregCr | 0:e5420f1a8a1a | 864 | |
GregCr | 0:e5420f1a8a1a | 865 | if( Eeprom.EepromData.DemoSettings.BoostedRx == false ) |
GregCr | 0:e5420f1a8a1a | 866 | { |
GregCr | 0:e5420f1a8a1a | 867 | Radio.SetRx( ( ( Eeprom.EepromData.DemoSettings.InterPacketDelay << 1 ) + RX_TIMEOUT_MARGIN ) << 6 ); |
GregCr | 0:e5420f1a8a1a | 868 | } |
GregCr | 0:e5420f1a8a1a | 869 | else |
GregCr | 0:e5420f1a8a1a | 870 | { |
GregCr | 0:e5420f1a8a1a | 871 | Radio.SetRxBoosted( ( ( Eeprom.EepromData.DemoSettings.InterPacketDelay << 1 ) + RX_TIMEOUT_MARGIN ) << 6 ); |
GregCr | 0:e5420f1a8a1a | 872 | } |
GregCr | 0:e5420f1a8a1a | 873 | break; |
GregCr | 0:e5420f1a8a1a | 874 | |
GregCr | 0:e5420f1a8a1a | 875 | case APP_RX: |
GregCr | 0:e5420f1a8a1a | 876 | RX_LED = !RX_LED; |
GregCr | 0:e5420f1a8a1a | 877 | Radio.GetPayload( Buffer, &BufferSize, BUFFER_SIZE ); |
GregCr | 0:e5420f1a8a1a | 878 | Radio.GetPacketStatus( &PacketStatus ); |
GregCr | 0:e5420f1a8a1a | 879 | if( Eeprom.EepromData.ModulationParams.PacketType == PACKET_TYPE_LORA ) |
GregCr | 0:e5420f1a8a1a | 880 | { |
GregCr | 0:e5420f1a8a1a | 881 | Eeprom.EepromData.DemoSettings.RssiValue = PacketStatus.Params.LoRa.RssiPkt; |
GregCr | 0:e5420f1a8a1a | 882 | Eeprom.EepromData.DemoSettings.SnrValue = PacketStatus.Params.LoRa.SnrPkt; |
GregCr | 0:e5420f1a8a1a | 883 | } |
GregCr | 0:e5420f1a8a1a | 884 | else // Eeprom.EepromData.ModulationParams.PacketType == PACKET_TYPE_GFSK |
GregCr | 0:e5420f1a8a1a | 885 | { |
GregCr | 0:e5420f1a8a1a | 886 | Eeprom.EepromData.DemoSettings.RssiValue = PacketStatus.Params.Gfsk.RssiAvg; |
GregCr | 0:e5420f1a8a1a | 887 | Eeprom.EepromData.DemoSettings.SnrValue = 0; |
GregCr | 0:e5420f1a8a1a | 888 | } |
GregCr | 0:e5420f1a8a1a | 889 | |
GregCr | 0:e5420f1a8a1a | 890 | if( ( BufferSize >= PINGPONG_SIZE ) && ( strncmp( ( const char* )( Buffer + 8 ), ( const char* )PongMsg, PINGPONG_SIZE ) == 0 ) ) |
GregCr | 0:e5420f1a8a1a | 891 | { |
GregCr | 0:e5420f1a8a1a | 892 | ComputePingPongPayload( Buffer, BufferSize ); |
GregCr | 0:e5420f1a8a1a | 893 | } |
GregCr | 0:e5420f1a8a1a | 894 | else |
GregCr | 0:e5420f1a8a1a | 895 | { |
GregCr | 0:e5420f1a8a1a | 896 | Eeprom.EepromData.DemoSettings.CntPacketRxKO++; |
GregCr | 0:e5420f1a8a1a | 897 | } |
GregCr | 0:e5420f1a8a1a | 898 | DemoInternalState = SEND_PING_MSG; |
GregCr | 0:e5420f1a8a1a | 899 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 900 | break; |
GregCr | 0:e5420f1a8a1a | 901 | |
GregCr | 0:e5420f1a8a1a | 902 | case APP_RX_TIMEOUT: |
GregCr | 0:e5420f1a8a1a | 903 | case APP_RX_ERROR: |
GregCr | 0:e5420f1a8a1a | 904 | RX_LED = !RX_LED; |
GregCr | 0:e5420f1a8a1a | 905 | Eeprom.EepromData.DemoSettings.CntPacketRxKO++; |
GregCr | 0:e5420f1a8a1a | 906 | DemoInternalState = SEND_PING_MSG; |
GregCr | 0:e5420f1a8a1a | 907 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 908 | break; |
GregCr | 0:e5420f1a8a1a | 909 | |
GregCr | 0:e5420f1a8a1a | 910 | case APP_TX_TIMEOUT: |
GregCr | 0:e5420f1a8a1a | 911 | printf( "Failure: timeout in Tx is shorter than the packet time on air\n\r" ); |
GregCr | 0:e5420f1a8a1a | 912 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 913 | Eeprom.EepromData.DemoSettings.HoldDemo = true; |
GregCr | 0:e5420f1a8a1a | 914 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 915 | break; |
GregCr | 0:e5420f1a8a1a | 916 | |
GregCr | 0:e5420f1a8a1a | 917 | case APP_IDLE: // do nothing |
GregCr | 0:e5420f1a8a1a | 918 | break; |
GregCr | 0:e5420f1a8a1a | 919 | |
GregCr | 0:e5420f1a8a1a | 920 | default: |
GregCr | 0:e5420f1a8a1a | 921 | break; |
GregCr | 0:e5420f1a8a1a | 922 | } |
GregCr | 0:e5420f1a8a1a | 923 | } |
GregCr | 0:e5420f1a8a1a | 924 | else // SLAVE |
GregCr | 0:e5420f1a8a1a | 925 | { |
GregCr | 0:e5420f1a8a1a | 926 | switch( DemoInternalState ) |
GregCr | 0:e5420f1a8a1a | 927 | { |
GregCr | 0:e5420f1a8a1a | 928 | case SEND_PONG_MSG: |
GregCr | 0:e5420f1a8a1a | 929 | wait_ms( RX_TX_TRANSITION_WAIT ); |
GregCr | 0:e5420f1a8a1a | 930 | |
GregCr | 0:e5420f1a8a1a | 931 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 932 | // Send the next PING frame |
GregCr | 0:e5420f1a8a1a | 933 | Buffer[0] = ( Eeprom.EepromData.DemoSettings.CntPacketTx >> 24 ) & 0xFF; |
GregCr | 0:e5420f1a8a1a | 934 | Buffer[1] = ( Eeprom.EepromData.DemoSettings.CntPacketTx >> 16 ) & 0xFF; |
GregCr | 0:e5420f1a8a1a | 935 | Buffer[2] = ( Eeprom.EepromData.DemoSettings.CntPacketTx >> 8 ) & 0xFF; |
GregCr | 0:e5420f1a8a1a | 936 | Buffer[3] = ( Eeprom.EepromData.DemoSettings.CntPacketTx & 0xFF ); |
GregCr | 0:e5420f1a8a1a | 937 | Buffer[4] = ( ( Eeprom.EepromData.DemoSettings.CntPacketRxKO + \ |
GregCr | 0:e5420f1a8a1a | 938 | Eeprom.EepromData.DemoSettings.RxTimeOutCount ) >> 24 ) & 0xFF; |
GregCr | 0:e5420f1a8a1a | 939 | Buffer[5] = ( ( Eeprom.EepromData.DemoSettings.CntPacketRxKO + \ |
GregCr | 0:e5420f1a8a1a | 940 | Eeprom.EepromData.DemoSettings.RxTimeOutCount ) >> 16 ) & 0xFF; |
GregCr | 0:e5420f1a8a1a | 941 | Buffer[6] = ( ( Eeprom.EepromData.DemoSettings.CntPacketRxKO + \ |
GregCr | 0:e5420f1a8a1a | 942 | Eeprom.EepromData.DemoSettings.RxTimeOutCount ) >> 8 ) & 0xFF; |
GregCr | 0:e5420f1a8a1a | 943 | Buffer[7] = ( ( Eeprom.EepromData.DemoSettings.CntPacketRxKO + \ |
GregCr | 0:e5420f1a8a1a | 944 | Eeprom.EepromData.DemoSettings.RxTimeOutCount ) & 0xFF ); |
GregCr | 0:e5420f1a8a1a | 945 | Buffer[8] = PongMsg[0]; |
GregCr | 0:e5420f1a8a1a | 946 | Buffer[9] = PongMsg[1]; |
GregCr | 0:e5420f1a8a1a | 947 | Buffer[10] = PongMsg[2]; |
GregCr | 0:e5420f1a8a1a | 948 | Buffer[11] = PongMsg[3]; |
GregCr | 0:e5420f1a8a1a | 949 | for( i = 12; i < Eeprom.EepromData.DemoSettings.PayloadLength; i++ ) |
GregCr | 0:e5420f1a8a1a | 950 | { |
GregCr | 0:e5420f1a8a1a | 951 | Buffer[i] = i; |
GregCr | 0:e5420f1a8a1a | 952 | } |
GregCr | 0:e5420f1a8a1a | 953 | TX_LED = !TX_LED; |
GregCr | 0:e5420f1a8a1a | 954 | IrqMask = IRQ_TX_DONE | IRQ_RX_TX_TIMEOUT; |
GregCr | 0:e5420f1a8a1a | 955 | Radio.SetDioIrqParams( IrqMask, IrqMask, IRQ_RADIO_NONE, IRQ_RADIO_NONE ); |
GregCr | 0:e5420f1a8a1a | 956 | Radio.SendPayload( Buffer, Eeprom.EepromData.DemoSettings.PayloadLength, \ |
GregCr | 0:e5420f1a8a1a | 957 | ( Eeprom.EepromData.DemoSettings.InterPacketDelay ) << 6 ); |
GregCr | 0:e5420f1a8a1a | 958 | break; |
GregCr | 0:e5420f1a8a1a | 959 | |
GregCr | 0:e5420f1a8a1a | 960 | case APP_TX: |
GregCr | 0:e5420f1a8a1a | 961 | if( ( Eeprom.EepromData.DemoSettings.MaxNumPacket != 0 ) \ |
GregCr | 0:e5420f1a8a1a | 962 | && ( ( Eeprom.EepromData.DemoSettings.CntPacketRxOK + Eeprom.EepromData.DemoSettings.CntPacketRxKO + \ |
GregCr | 0:e5420f1a8a1a | 963 | Eeprom.EepromData.DemoSettings.RxTimeOutCount ) >= Eeprom.EepromData.DemoSettings.MaxNumPacket ) ) |
GregCr | 0:e5420f1a8a1a | 964 | { |
GregCr | 0:e5420f1a8a1a | 965 | SendNextPacket.detach( ); |
GregCr | 0:e5420f1a8a1a | 966 | SendNext = false; |
GregCr | 0:e5420f1a8a1a | 967 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 968 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 969 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 970 | Radio.SetStandby( STDBY_RC ); |
GregCr | 0:e5420f1a8a1a | 971 | Eeprom.EepromData.DemoSettings.HoldDemo = true; |
GregCr | 0:e5420f1a8a1a | 972 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 973 | } |
GregCr | 0:e5420f1a8a1a | 974 | else |
GregCr | 0:e5420f1a8a1a | 975 | { |
GregCr | 0:e5420f1a8a1a | 976 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 977 | TX_LED = !TX_LED; |
GregCr | 0:e5420f1a8a1a | 978 | RX_LED = !RX_LED; |
GregCr | 0:e5420f1a8a1a | 979 | IrqMask = IRQ_RX_DONE | IRQ_CRC_ERROR | IRQ_RX_TX_TIMEOUT; |
GregCr | 0:e5420f1a8a1a | 980 | Radio.SetDioIrqParams( IrqMask, IrqMask, IRQ_RADIO_NONE, IRQ_RADIO_NONE ); |
GregCr | 0:e5420f1a8a1a | 981 | if( Eeprom.EepromData.DemoSettings.BoostedRx == false ) |
GregCr | 0:e5420f1a8a1a | 982 | { |
GregCr | 0:e5420f1a8a1a | 983 | Radio.SetRx( ( ( Eeprom.EepromData.DemoSettings.InterPacketDelay << 1 ) + RX_TIMEOUT_MARGIN ) << 6 ); |
GregCr | 0:e5420f1a8a1a | 984 | } |
GregCr | 0:e5420f1a8a1a | 985 | else |
GregCr | 0:e5420f1a8a1a | 986 | { |
GregCr | 0:e5420f1a8a1a | 987 | Radio.SetRxBoosted( ( ( Eeprom.EepromData.DemoSettings.InterPacketDelay << 1 ) + RX_TIMEOUT_MARGIN) << 6 ); |
GregCr | 0:e5420f1a8a1a | 988 | } |
GregCr | 0:e5420f1a8a1a | 989 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 990 | } |
GregCr | 0:e5420f1a8a1a | 991 | break; |
GregCr | 0:e5420f1a8a1a | 992 | |
GregCr | 0:e5420f1a8a1a | 993 | case APP_RX: |
GregCr | 0:e5420f1a8a1a | 994 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 995 | RX_LED = !RX_LED; |
GregCr | 0:e5420f1a8a1a | 996 | Radio.GetPayload( Buffer, &BufferSize, BUFFER_SIZE ); |
GregCr | 0:e5420f1a8a1a | 997 | Radio.GetPacketStatus( &PacketStatus ); |
GregCr | 0:e5420f1a8a1a | 998 | if( Eeprom.EepromData.ModulationParams.PacketType == PACKET_TYPE_LORA ) |
GregCr | 0:e5420f1a8a1a | 999 | { |
GregCr | 0:e5420f1a8a1a | 1000 | Eeprom.EepromData.DemoSettings.RssiValue = PacketStatus.Params.LoRa.RssiPkt; |
GregCr | 0:e5420f1a8a1a | 1001 | Eeprom.EepromData.DemoSettings.SnrValue = PacketStatus.Params.LoRa.SnrPkt; |
GregCr | 0:e5420f1a8a1a | 1002 | } |
GregCr | 0:e5420f1a8a1a | 1003 | else // Eeprom.EepromData.ModulationParams.PacketType == PACKET_TYPE_GFSK |
GregCr | 0:e5420f1a8a1a | 1004 | { |
GregCr | 0:e5420f1a8a1a | 1005 | Eeprom.EepromData.DemoSettings.RssiValue = PacketStatus.Params.Gfsk.RssiAvg; |
GregCr | 0:e5420f1a8a1a | 1006 | Eeprom.EepromData.DemoSettings.SnrValue = 0; |
GregCr | 0:e5420f1a8a1a | 1007 | } |
GregCr | 0:e5420f1a8a1a | 1008 | |
GregCr | 0:e5420f1a8a1a | 1009 | if( ( BufferSize >= PINGPONG_SIZE ) && ( strncmp( ( const char* )( Buffer + 4 ), ( const char* )PingMsg, PINGPONG_SIZE ) == 0 ) ) |
GregCr | 0:e5420f1a8a1a | 1010 | { |
GregCr | 0:e5420f1a8a1a | 1011 | ComputePingPongPayload( Buffer, BufferSize ); |
GregCr | 0:e5420f1a8a1a | 1012 | DemoInternalState = SEND_PONG_MSG; |
GregCr | 0:e5420f1a8a1a | 1013 | } |
GregCr | 0:e5420f1a8a1a | 1014 | else |
GregCr | 0:e5420f1a8a1a | 1015 | { |
GregCr | 0:e5420f1a8a1a | 1016 | Eeprom.EepromData.DemoSettings.CntPacketRxKO++; |
GregCr | 0:e5420f1a8a1a | 1017 | RX_LED = !RX_LED; |
GregCr | 0:e5420f1a8a1a | 1018 | IrqMask = IRQ_RX_DONE | IRQ_CRC_ERROR | IRQ_RX_TX_TIMEOUT; |
GregCr | 0:e5420f1a8a1a | 1019 | Radio.SetDioIrqParams( IrqMask, IrqMask, IRQ_RADIO_NONE, IRQ_RADIO_NONE ); |
GregCr | 0:e5420f1a8a1a | 1020 | if( Eeprom.EepromData.DemoSettings.BoostedRx == false ) |
GregCr | 0:e5420f1a8a1a | 1021 | { |
GregCr | 0:e5420f1a8a1a | 1022 | Radio.SetRx( ( Eeprom.EepromData.DemoSettings.InterPacketDelay ) << 6 ); |
GregCr | 0:e5420f1a8a1a | 1023 | } |
GregCr | 0:e5420f1a8a1a | 1024 | else |
GregCr | 0:e5420f1a8a1a | 1025 | { |
GregCr | 0:e5420f1a8a1a | 1026 | Radio.SetRxBoosted( ( Eeprom.EepromData.DemoSettings.InterPacketDelay ) << 6 ); |
GregCr | 0:e5420f1a8a1a | 1027 | } |
GregCr | 0:e5420f1a8a1a | 1028 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 1029 | } |
GregCr | 0:e5420f1a8a1a | 1030 | break; |
GregCr | 0:e5420f1a8a1a | 1031 | |
GregCr | 0:e5420f1a8a1a | 1032 | case APP_RX_TIMEOUT: |
GregCr | 0:e5420f1a8a1a | 1033 | case APP_RX_ERROR: |
GregCr | 0:e5420f1a8a1a | 1034 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 1035 | Eeprom.EepromData.DemoSettings.RxTimeOutCount++; |
GregCr | 0:e5420f1a8a1a | 1036 | IrqMask = IRQ_RX_DONE | IRQ_CRC_ERROR | IRQ_RX_TX_TIMEOUT; |
GregCr | 0:e5420f1a8a1a | 1037 | Radio.SetDioIrqParams( IrqMask, IrqMask, IRQ_RADIO_NONE, IRQ_RADIO_NONE ); |
GregCr | 0:e5420f1a8a1a | 1038 | if( Eeprom.EepromData.DemoSettings.BoostedRx == false ) |
GregCr | 0:e5420f1a8a1a | 1039 | { |
GregCr | 0:e5420f1a8a1a | 1040 | Radio.SetRx( ( Eeprom.EepromData.DemoSettings.InterPacketDelay ) << 6 ); |
GregCr | 0:e5420f1a8a1a | 1041 | } |
GregCr | 0:e5420f1a8a1a | 1042 | else |
GregCr | 0:e5420f1a8a1a | 1043 | { |
GregCr | 0:e5420f1a8a1a | 1044 | Radio.SetRxBoosted( ( Eeprom.EepromData.DemoSettings.InterPacketDelay ) << 6 ); |
GregCr | 0:e5420f1a8a1a | 1045 | } |
GregCr | 0:e5420f1a8a1a | 1046 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 1047 | break; |
GregCr | 0:e5420f1a8a1a | 1048 | |
GregCr | 0:e5420f1a8a1a | 1049 | case APP_TX_TIMEOUT: |
GregCr | 0:e5420f1a8a1a | 1050 | printf( "Failure: timeout in Tx is shorter than the packet time on air\n\r" ); |
GregCr | 0:e5420f1a8a1a | 1051 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 1052 | Eeprom.EepromData.DemoSettings.HoldDemo = true; |
GregCr | 0:e5420f1a8a1a | 1053 | refreshDisplay = 1; |
GregCr | 0:e5420f1a8a1a | 1054 | break; |
GregCr | 0:e5420f1a8a1a | 1055 | |
GregCr | 0:e5420f1a8a1a | 1056 | case APP_IDLE: // do nothing |
GregCr | 0:e5420f1a8a1a | 1057 | break; |
GregCr | 0:e5420f1a8a1a | 1058 | |
GregCr | 0:e5420f1a8a1a | 1059 | default: |
GregCr | 0:e5420f1a8a1a | 1060 | break; |
GregCr | 0:e5420f1a8a1a | 1061 | } |
GregCr | 0:e5420f1a8a1a | 1062 | } |
GregCr | 0:e5420f1a8a1a | 1063 | return refreshDisplay; |
GregCr | 0:e5420f1a8a1a | 1064 | } |
GregCr | 0:e5420f1a8a1a | 1065 | |
GregCr | 0:e5420f1a8a1a | 1066 | void ComputePingPongPayload( uint8_t *buffer, uint8_t bufferSize ) |
GregCr | 0:e5420f1a8a1a | 1067 | { |
GregCr | 0:e5420f1a8a1a | 1068 | uint32_t i = 0; |
GregCr | 0:e5420f1a8a1a | 1069 | |
GregCr | 0:e5420f1a8a1a | 1070 | PacketRxSequence = ( ( uint32_t )buffer[0] << 24 ) | \ |
GregCr | 0:e5420f1a8a1a | 1071 | ( ( uint32_t )buffer[1] << 16 ) | \ |
GregCr | 0:e5420f1a8a1a | 1072 | ( ( uint32_t )buffer[2] << 8 ) | \ |
GregCr | 0:e5420f1a8a1a | 1073 | buffer[3]; |
GregCr | 0:e5420f1a8a1a | 1074 | |
GregCr | 0:e5420f1a8a1a | 1075 | if( Eeprom.EepromData.DemoSettings.Entity == MASTER ) |
GregCr | 0:e5420f1a8a1a | 1076 | { |
GregCr | 0:e5420f1a8a1a | 1077 | Eeprom.EepromData.DemoSettings.CntPacketRxKOSlave = |
GregCr | 0:e5420f1a8a1a | 1078 | ( ( uint32_t )buffer[4] << 24 ) | \ |
GregCr | 0:e5420f1a8a1a | 1079 | ( ( uint32_t )buffer[5] << 16 ) | \ |
GregCr | 0:e5420f1a8a1a | 1080 | ( ( uint32_t )buffer[6] << 8 ) | \ |
GregCr | 0:e5420f1a8a1a | 1081 | buffer[7]; |
GregCr | 0:e5420f1a8a1a | 1082 | if( PacketRxSequence > Eeprom.EepromData.DemoSettings.CntPacketRxKOSlave ) |
GregCr | 0:e5420f1a8a1a | 1083 | { |
GregCr | 0:e5420f1a8a1a | 1084 | Eeprom.EepromData.DemoSettings.CntPacketRxOKSlave = PacketRxSequence - \ |
GregCr | 0:e5420f1a8a1a | 1085 | Eeprom.EepromData.DemoSettings.CntPacketRxKOSlave; |
GregCr | 0:e5420f1a8a1a | 1086 | } |
GregCr | 0:e5420f1a8a1a | 1087 | else |
GregCr | 0:e5420f1a8a1a | 1088 | { |
GregCr | 0:e5420f1a8a1a | 1089 | Eeprom.EepromData.DemoSettings.CntPacketRxOKSlave = 0; |
GregCr | 0:e5420f1a8a1a | 1090 | } |
GregCr | 0:e5420f1a8a1a | 1091 | |
GregCr | 0:e5420f1a8a1a | 1092 | if( PacketRxSequence == Eeprom.EepromData.DemoSettings.CntPacketTx ) |
GregCr | 0:e5420f1a8a1a | 1093 | { |
GregCr | 0:e5420f1a8a1a | 1094 | Eeprom.EepromData.DemoSettings.CntPacketRxOK += 1; |
GregCr | 0:e5420f1a8a1a | 1095 | } |
GregCr | 0:e5420f1a8a1a | 1096 | else |
GregCr | 0:e5420f1a8a1a | 1097 | { |
GregCr | 0:e5420f1a8a1a | 1098 | Eeprom.EepromData.DemoSettings.CntPacketRxKO += 1; |
GregCr | 0:e5420f1a8a1a | 1099 | } |
GregCr | 0:e5420f1a8a1a | 1100 | } |
GregCr | 0:e5420f1a8a1a | 1101 | else |
GregCr | 0:e5420f1a8a1a | 1102 | { |
GregCr | 0:e5420f1a8a1a | 1103 | Eeprom.EepromData.DemoSettings.CntPacketRxOK += 1; |
GregCr | 0:e5420f1a8a1a | 1104 | if( ( PacketRxSequence <= PacketRxSequencePrev ) || \ |
GregCr | 0:e5420f1a8a1a | 1105 | ( PacketRxSequencePrev == 0 ) ) |
GregCr | 0:e5420f1a8a1a | 1106 | { |
GregCr | 0:e5420f1a8a1a | 1107 | // Sequence went back => resynchronization |
GregCr | 0:e5420f1a8a1a | 1108 | // Don't count missed packets this time |
GregCr | 0:e5420f1a8a1a | 1109 | i = 0; |
GregCr | 0:e5420f1a8a1a | 1110 | } |
GregCr | 0:e5420f1a8a1a | 1111 | else |
GregCr | 0:e5420f1a8a1a | 1112 | { |
GregCr | 0:e5420f1a8a1a | 1113 | // Determine number of missed packets |
GregCr | 0:e5420f1a8a1a | 1114 | i = PacketRxSequence - PacketRxSequencePrev - 1; |
GregCr | 0:e5420f1a8a1a | 1115 | } |
GregCr | 0:e5420f1a8a1a | 1116 | // Be ready for the next |
GregCr | 0:e5420f1a8a1a | 1117 | PacketRxSequencePrev = PacketRxSequence; |
GregCr | 0:e5420f1a8a1a | 1118 | Eeprom.EepromData.DemoSettings.CntPacketTx = PacketRxSequence; |
GregCr | 0:e5420f1a8a1a | 1119 | // increment 'missed' counter for the RX session |
GregCr | 0:e5420f1a8a1a | 1120 | Eeprom.EepromData.DemoSettings.CntPacketRxKO += i; |
GregCr | 0:e5420f1a8a1a | 1121 | Eeprom.EepromData.DemoSettings.RxTimeOutCount = 0; |
GregCr | 0:e5420f1a8a1a | 1122 | } |
GregCr | 0:e5420f1a8a1a | 1123 | } |
GregCr | 0:e5420f1a8a1a | 1124 | |
GregCr | 0:e5420f1a8a1a | 1125 | // ************************ Utils **************************** |
GregCr | 0:e5420f1a8a1a | 1126 | // * * |
GregCr | 0:e5420f1a8a1a | 1127 | // * * |
GregCr | 0:e5420f1a8a1a | 1128 | // * * |
GregCr | 0:e5420f1a8a1a | 1129 | // ***************************************************************************** |
GregCr | 0:e5420f1a8a1a | 1130 | |
GregCr | 0:e5420f1a8a1a | 1131 | uint8_t GetConnectedDevice( void ) |
GregCr | 0:e5420f1a8a1a | 1132 | { |
GregCr | 0:e5420f1a8a1a | 1133 | return( Radio.GetDeviceType( ) ); |
GregCr | 0:e5420f1a8a1a | 1134 | } |
GregCr | 0:e5420f1a8a1a | 1135 | |
GregCr | 1:b96176a4ccb8 | 1136 | uint8_t GetMatchingFrequency( void ) |
GregCr | 1:b96176a4ccb8 | 1137 | { |
GregCr | 1:b96176a4ccb8 | 1138 | return( Radio.GetFreqSelect( ) ); |
GregCr | 1:b96176a4ccb8 | 1139 | } |
GregCr | 1:b96176a4ccb8 | 1140 | |
GregCr | 0:e5420f1a8a1a | 1141 | void InitDemoApplication( void ) |
GregCr | 0:e5420f1a8a1a | 1142 | { |
GregCr | 0:e5420f1a8a1a | 1143 | RX_LED = 1; |
GregCr | 0:e5420f1a8a1a | 1144 | TX_LED = 1; |
GregCr | 0:e5420f1a8a1a | 1145 | |
GregCr | 0:e5420f1a8a1a | 1146 | Radio.Init( ); |
GregCr | 0:e5420f1a8a1a | 1147 | |
GregCr | 0:e5420f1a8a1a | 1148 | // Can also be set in LDO mode but consume more power |
GregCr | 0:e5420f1a8a1a | 1149 | Radio.SetRegulatorMode( ( RadioRegulatorMode_t )Eeprom.EepromData.DemoSettings.RadioPowerMode ); |
GregCr | 0:e5420f1a8a1a | 1150 | Radio.SetStandby( STDBY_RC ); |
GregCr | 0:e5420f1a8a1a | 1151 | |
GregCr | 0:e5420f1a8a1a | 1152 | memset( &Buffer, 0x00, BufferSize ); |
GregCr | 0:e5420f1a8a1a | 1153 | |
GregCr | 0:e5420f1a8a1a | 1154 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 1155 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 1156 | |
GregCr | 0:e5420f1a8a1a | 1157 | PacketRxSequence = 0; |
GregCr | 0:e5420f1a8a1a | 1158 | PacketRxSequencePrev = 0; |
GregCr | 0:e5420f1a8a1a | 1159 | Eeprom.EepromData.DemoSettings.CntPacketTx = 0; |
GregCr | 0:e5420f1a8a1a | 1160 | Eeprom.EepromData.DemoSettings.CntPacketRxOK = 0; |
GregCr | 0:e5420f1a8a1a | 1161 | Eeprom.EepromData.DemoSettings.CntPacketRxKO = 0; |
GregCr | 0:e5420f1a8a1a | 1162 | Eeprom.EepromData.DemoSettings.RxTimeOutCount = 0; |
GregCr | 0:e5420f1a8a1a | 1163 | } |
GregCr | 0:e5420f1a8a1a | 1164 | |
GregCr | 0:e5420f1a8a1a | 1165 | void StopDemoApplication( void ) |
GregCr | 0:e5420f1a8a1a | 1166 | { |
GregCr | 0:e5420f1a8a1a | 1167 | if( DemoRunning == true ) |
GregCr | 0:e5420f1a8a1a | 1168 | { |
GregCr | 0:e5420f1a8a1a | 1169 | Radio.CheckDeviceReady( ); |
GregCr | 0:e5420f1a8a1a | 1170 | |
GregCr | 0:e5420f1a8a1a | 1171 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 1172 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 1173 | DemoRunning = false; |
GregCr | 0:e5420f1a8a1a | 1174 | SendNext = false; |
GregCr | 0:e5420f1a8a1a | 1175 | PacketRxSequence = 0; |
GregCr | 0:e5420f1a8a1a | 1176 | PacketRxSequencePrev = 0; |
GregCr | 0:e5420f1a8a1a | 1177 | Eeprom.EepromData.DemoSettings.CntPacketTx = 0; |
GregCr | 0:e5420f1a8a1a | 1178 | Eeprom.EepromData.DemoSettings.CntPacketRxOK = 0; |
GregCr | 0:e5420f1a8a1a | 1179 | Eeprom.EepromData.DemoSettings.CntPacketRxKO = 0; |
GregCr | 0:e5420f1a8a1a | 1180 | Eeprom.EepromData.DemoSettings.RxTimeOutCount = 0; |
GregCr | 0:e5420f1a8a1a | 1181 | |
GregCr | 0:e5420f1a8a1a | 1182 | DemoInternalState = APP_IDLE; |
GregCr | 0:e5420f1a8a1a | 1183 | Radio.SetStandby( STDBY_RC ); |
GregCr | 0:e5420f1a8a1a | 1184 | Radio.ClearIrqStatus( IRQ_RADIO_ALL ); |
GregCr | 0:e5420f1a8a1a | 1185 | SendNextPacket.detach( ); |
GregCr | 0:e5420f1a8a1a | 1186 | } |
GregCr | 0:e5420f1a8a1a | 1187 | } |
GregCr | 0:e5420f1a8a1a | 1188 | |
GregCr | 0:e5420f1a8a1a | 1189 | /* |
GregCr | 0:e5420f1a8a1a | 1190 | * Function still being implemented >>> To be completed |
GregCr | 0:e5420f1a8a1a | 1191 | * WARNING: Computation is in float and his really slow |
GregCr | 0:e5420f1a8a1a | 1192 | * LongInterLeaving vs LegacyInterLeaving has no influence on TimeOnAir. |
GregCr | 0:e5420f1a8a1a | 1193 | */ |
GregCr | 0:e5420f1a8a1a | 1194 | uint16_t GetTimeOnAir( uint8_t modulation ) |
GregCr | 0:e5420f1a8a1a | 1195 | { |
GregCr | 0:e5420f1a8a1a | 1196 | uint16_t result = 2000; |
GregCr | 0:e5420f1a8a1a | 1197 | uint8_t LowDatarateOptimize = 0; |
GregCr | 0:e5420f1a8a1a | 1198 | |
GregCr | 0:e5420f1a8a1a | 1199 | if( modulation == PACKET_TYPE_LORA ) |
GregCr | 0:e5420f1a8a1a | 1200 | { |
GregCr | 0:e5420f1a8a1a | 1201 | volatile double loraBw = 0.0; |
GregCr | 0:e5420f1a8a1a | 1202 | volatile double FreqErrorUnits = 0.0; |
GregCr | 0:e5420f1a8a1a | 1203 | |
GregCr | 0:e5420f1a8a1a | 1204 | switch( Eeprom.EepromData.ModulationParams.Params.LoRa.Bandwidth ) |
GregCr | 0:e5420f1a8a1a | 1205 | { |
GregCr | 0:e5420f1a8a1a | 1206 | case LORA_BW_500: |
GregCr | 0:e5420f1a8a1a | 1207 | loraBw = 500e3; |
GregCr | 0:e5420f1a8a1a | 1208 | break; |
GregCr | 0:e5420f1a8a1a | 1209 | |
GregCr | 0:e5420f1a8a1a | 1210 | case LORA_BW_250: |
GregCr | 0:e5420f1a8a1a | 1211 | loraBw = 250e3; |
GregCr | 0:e5420f1a8a1a | 1212 | break; |
GregCr | 0:e5420f1a8a1a | 1213 | |
GregCr | 0:e5420f1a8a1a | 1214 | case LORA_BW_125: |
GregCr | 0:e5420f1a8a1a | 1215 | loraBw = 125e3; |
GregCr | 0:e5420f1a8a1a | 1216 | break; |
GregCr | 0:e5420f1a8a1a | 1217 | |
GregCr | 0:e5420f1a8a1a | 1218 | case LORA_BW_062: |
GregCr | 0:e5420f1a8a1a | 1219 | loraBw = 62e3; |
GregCr | 0:e5420f1a8a1a | 1220 | break; |
GregCr | 0:e5420f1a8a1a | 1221 | |
GregCr | 0:e5420f1a8a1a | 1222 | case LORA_BW_041: |
GregCr | 0:e5420f1a8a1a | 1223 | loraBw = 41e3; |
GregCr | 0:e5420f1a8a1a | 1224 | break; |
GregCr | 0:e5420f1a8a1a | 1225 | |
GregCr | 0:e5420f1a8a1a | 1226 | case LORA_BW_031: |
GregCr | 0:e5420f1a8a1a | 1227 | loraBw = 31e3; |
GregCr | 0:e5420f1a8a1a | 1228 | break; |
GregCr | 0:e5420f1a8a1a | 1229 | |
GregCr | 0:e5420f1a8a1a | 1230 | case LORA_BW_020: |
GregCr | 0:e5420f1a8a1a | 1231 | loraBw = 20e3; |
GregCr | 0:e5420f1a8a1a | 1232 | break; |
GregCr | 0:e5420f1a8a1a | 1233 | |
GregCr | 0:e5420f1a8a1a | 1234 | case LORA_BW_015: |
GregCr | 0:e5420f1a8a1a | 1235 | loraBw = 15e3; |
GregCr | 0:e5420f1a8a1a | 1236 | break; |
GregCr | 0:e5420f1a8a1a | 1237 | |
GregCr | 0:e5420f1a8a1a | 1238 | case LORA_BW_010: |
GregCr | 0:e5420f1a8a1a | 1239 | loraBw = 10e3; |
GregCr | 0:e5420f1a8a1a | 1240 | break; |
GregCr | 0:e5420f1a8a1a | 1241 | |
GregCr | 0:e5420f1a8a1a | 1242 | case LORA_BW_007: |
GregCr | 0:e5420f1a8a1a | 1243 | loraBw = 7e3; |
GregCr | 0:e5420f1a8a1a | 1244 | break; |
GregCr | 0:e5420f1a8a1a | 1245 | |
GregCr | 0:e5420f1a8a1a | 1246 | default: |
GregCr | 0:e5420f1a8a1a | 1247 | loraBw = 7e3; |
GregCr | 0:e5420f1a8a1a | 1248 | break; |
GregCr | 0:e5420f1a8a1a | 1249 | } |
GregCr | 0:e5420f1a8a1a | 1250 | |
GregCr | 0:e5420f1a8a1a | 1251 | /* Used to compute the freq Error */ |
GregCr | 0:e5420f1a8a1a | 1252 | FreqErrorUnits = FREQ_ERR; |
GregCr | 0:e5420f1a8a1a | 1253 | FreErrorLsb = FreqErrorUnits * ( ( double )loraBw / 1000 ) / 500; |
GregCr | 0:e5420f1a8a1a | 1254 | |
GregCr | 0:e5420f1a8a1a | 1255 | float ts = 1 << Eeprom.EepromData.ModulationParams.Params.LoRa.SpreadingFactor; // time for one symbol in ms |
GregCr | 0:e5420f1a8a1a | 1256 | ts = (float)ts / (float)loraBw; |
GregCr | 0:e5420f1a8a1a | 1257 | ts = ts * 1000; // from seconds to miliseconds |
GregCr | 0:e5420f1a8a1a | 1258 | |
GregCr | 0:e5420f1a8a1a | 1259 | float tPreamble = ( Eeprom.EepromData.PacketParams.Params.LoRa.PreambleLength + 4.25 + ( ( Eeprom.EepromData.ModulationParams.Params.LoRa.SpreadingFactor > 6 ) ? 2 : 0 )) * ts; // time of preamble |
GregCr | 0:e5420f1a8a1a | 1260 | |
GregCr | 0:e5420f1a8a1a | 1261 | switch( Eeprom.EepromData.ModulationParams.Params.LoRa.Bandwidth ) |
GregCr | 0:e5420f1a8a1a | 1262 | { |
GregCr | 0:e5420f1a8a1a | 1263 | case LORA_BW_500: |
GregCr | 0:e5420f1a8a1a | 1264 | break; |
GregCr | 0:e5420f1a8a1a | 1265 | |
GregCr | 0:e5420f1a8a1a | 1266 | case LORA_BW_250: |
GregCr | 0:e5420f1a8a1a | 1267 | if( Eeprom.EepromData.ModulationParams.Params.LoRa.SpreadingFactor == LORA_SF12 ) |
GregCr | 0:e5420f1a8a1a | 1268 | { |
GregCr | 0:e5420f1a8a1a | 1269 | LowDatarateOptimize = 1; |
GregCr | 0:e5420f1a8a1a | 1270 | } |
GregCr | 0:e5420f1a8a1a | 1271 | break; |
GregCr | 0:e5420f1a8a1a | 1272 | |
GregCr | 0:e5420f1a8a1a | 1273 | case LORA_BW_125: |
GregCr | 0:e5420f1a8a1a | 1274 | if( Eeprom.EepromData.ModulationParams.Params.LoRa.SpreadingFactor >= LORA_SF11 ) |
GregCr | 0:e5420f1a8a1a | 1275 | { |
GregCr | 0:e5420f1a8a1a | 1276 | LowDatarateOptimize = 1; |
GregCr | 0:e5420f1a8a1a | 1277 | } |
GregCr | 0:e5420f1a8a1a | 1278 | break; |
GregCr | 0:e5420f1a8a1a | 1279 | |
GregCr | 0:e5420f1a8a1a | 1280 | case LORA_BW_062: |
GregCr | 0:e5420f1a8a1a | 1281 | if( Eeprom.EepromData.ModulationParams.Params.LoRa.SpreadingFactor >= LORA_SF10 ) |
GregCr | 0:e5420f1a8a1a | 1282 | { |
GregCr | 0:e5420f1a8a1a | 1283 | LowDatarateOptimize = 1; |
GregCr | 0:e5420f1a8a1a | 1284 | } |
GregCr | 0:e5420f1a8a1a | 1285 | break; |
GregCr | 0:e5420f1a8a1a | 1286 | |
GregCr | 0:e5420f1a8a1a | 1287 | case LORA_BW_041: |
GregCr | 0:e5420f1a8a1a | 1288 | case LORA_BW_031: |
GregCr | 0:e5420f1a8a1a | 1289 | if( Eeprom.EepromData.ModulationParams.Params.LoRa.SpreadingFactor >= LORA_SF9 ) |
GregCr | 0:e5420f1a8a1a | 1290 | { |
GregCr | 0:e5420f1a8a1a | 1291 | LowDatarateOptimize = 1; |
GregCr | 0:e5420f1a8a1a | 1292 | } |
GregCr | 0:e5420f1a8a1a | 1293 | break; |
GregCr | 0:e5420f1a8a1a | 1294 | |
GregCr | 0:e5420f1a8a1a | 1295 | case LORA_BW_020: |
GregCr | 0:e5420f1a8a1a | 1296 | case LORA_BW_015: |
GregCr | 0:e5420f1a8a1a | 1297 | if( Eeprom.EepromData.ModulationParams.Params.LoRa.SpreadingFactor >= LORA_SF8 ) |
GregCr | 0:e5420f1a8a1a | 1298 | { |
GregCr | 0:e5420f1a8a1a | 1299 | LowDatarateOptimize = 1; |
GregCr | 0:e5420f1a8a1a | 1300 | } |
GregCr | 0:e5420f1a8a1a | 1301 | break; |
GregCr | 0:e5420f1a8a1a | 1302 | |
GregCr | 0:e5420f1a8a1a | 1303 | case LORA_BW_010: |
GregCr | 0:e5420f1a8a1a | 1304 | case LORA_BW_007: |
GregCr | 0:e5420f1a8a1a | 1305 | if( Eeprom.EepromData.ModulationParams.Params.LoRa.SpreadingFactor >= LORA_SF7 ) |
GregCr | 0:e5420f1a8a1a | 1306 | { |
GregCr | 0:e5420f1a8a1a | 1307 | LowDatarateOptimize = 1; |
GregCr | 0:e5420f1a8a1a | 1308 | } |
GregCr | 0:e5420f1a8a1a | 1309 | break; |
GregCr | 0:e5420f1a8a1a | 1310 | } |
GregCr | 0:e5420f1a8a1a | 1311 | |
GregCr | 0:e5420f1a8a1a | 1312 | float nData = ceil( ( float )( ( 8 * Eeprom.EepromData.PacketParams.Params.LoRa.PayloadLength + \ |
GregCr | 0:e5420f1a8a1a | 1313 | 16 * ( ( Eeprom.EepromData.PacketParams.Params.LoRa.CrcMode == LORA_CRC_OFF ) ? 0 : 1 ) + \ |
GregCr | 0:e5420f1a8a1a | 1314 | ( ( Eeprom.EepromData.PacketParams.Params.LoRa.HeaderType == LORA_PACKET_VARIABLE_LENGTH ) ? 20 : 0 ) - \ |
GregCr | 0:e5420f1a8a1a | 1315 | ( 4 * Eeprom.EepromData.ModulationParams.Params.LoRa.SpreadingFactor ) + 8 - \ |
GregCr | 0:e5420f1a8a1a | 1316 | ( 8 *( ( Eeprom.EepromData.ModulationParams.Params.LoRa.SpreadingFactor > 6 ) ? 1 : 0 ) ) ) / 4 ) ); |
GregCr | 0:e5420f1a8a1a | 1317 | |
GregCr | 0:e5420f1a8a1a | 1318 | nData = ceil( ( float )nData / ( ( float )( Eeprom.EepromData.ModulationParams.Params.LoRa.SpreadingFactor - \ |
GregCr | 0:e5420f1a8a1a | 1319 | ( LowDatarateOptimize * 2 ) ) ) * ( ( Eeprom.EepromData.ModulationParams.Params.LoRa.CodingRate % 4 ) + 4 ) ); |
GregCr | 0:e5420f1a8a1a | 1320 | |
GregCr | 0:e5420f1a8a1a | 1321 | float tPayload = nData * ts; |
GregCr | 0:e5420f1a8a1a | 1322 | |
GregCr | 0:e5420f1a8a1a | 1323 | float tHeader = 8 * ts; |
GregCr | 0:e5420f1a8a1a | 1324 | // Time on air [ms] |
GregCr | 0:e5420f1a8a1a | 1325 | float ToA = ceil( tPreamble + tPayload + tHeader ); |
GregCr | 0:e5420f1a8a1a | 1326 | |
GregCr | 0:e5420f1a8a1a | 1327 | result = ( uint16_t )ToA + ( ( uint16_t )ToA >> 1 ); // Set some margin |
GregCr | 0:e5420f1a8a1a | 1328 | } |
GregCr | 0:e5420f1a8a1a | 1329 | else if( modulation == PACKET_TYPE_GFSK ) |
GregCr | 0:e5420f1a8a1a | 1330 | { |
GregCr | 0:e5420f1a8a1a | 1331 | uint16_t packetBitCount = Eeprom.EepromData.PacketParams.Params.Gfsk.PreambleLength; |
GregCr | 0:e5420f1a8a1a | 1332 | |
GregCr | 0:e5420f1a8a1a | 1333 | packetBitCount += ( Eeprom.EepromData.PacketParams.Params.Gfsk.SyncWordLength + 1 ); |
GregCr | 0:e5420f1a8a1a | 1334 | packetBitCount += Eeprom.EepromData.PacketParams.Params.Gfsk.PayloadLength + 3; |
GregCr | 0:e5420f1a8a1a | 1335 | packetBitCount *= 8; |
GregCr | 0:e5420f1a8a1a | 1336 | // 1500 = 1000 * 1.5 : 1000 for translate s in ms and 1.5 is some margin |
GregCr | 0:e5420f1a8a1a | 1337 | result = ( uint16_t )( ceil( 1500 * ( float )packetBitCount / Eeprom.EepromData.ModulationParams.Params.Gfsk.BitRate ) ); |
GregCr | 0:e5420f1a8a1a | 1338 | } |
GregCr | 0:e5420f1a8a1a | 1339 | return result; |
GregCr | 0:e5420f1a8a1a | 1340 | } |
GregCr | 0:e5420f1a8a1a | 1341 | |
GregCr | 0:e5420f1a8a1a | 1342 | void InitializeDemoParameters( uint8_t modulation ) |
GregCr | 0:e5420f1a8a1a | 1343 | { |
GregCr | 0:e5420f1a8a1a | 1344 | Radio.SetStandby( STDBY_RC ); |
GregCr | 0:e5420f1a8a1a | 1345 | |
GregCr | 0:e5420f1a8a1a | 1346 | Radio.SetRegulatorMode( ( RadioRegulatorMode_t )Eeprom.EepromData.DemoSettings.RadioPowerMode ); |
GregCr | 0:e5420f1a8a1a | 1347 | |
GregCr | 0:e5420f1a8a1a | 1348 | printf("> InitializeDemoParameters\n\r"); |
GregCr | 0:e5420f1a8a1a | 1349 | if( modulation == PACKET_TYPE_LORA ) |
GregCr | 0:e5420f1a8a1a | 1350 | { |
GregCr | 0:e5420f1a8a1a | 1351 | printf("set param LORA for demo\n\r"); |
GregCr | 0:e5420f1a8a1a | 1352 | ModulationParams.PacketType = PACKET_TYPE_LORA; |
GregCr | 0:e5420f1a8a1a | 1353 | PacketParams.PacketType = PACKET_TYPE_LORA; |
GregCr | 0:e5420f1a8a1a | 1354 | |
GregCr | 0:e5420f1a8a1a | 1355 | ModulationParams.Params.LoRa.SpreadingFactor = ( RadioLoRaSpreadingFactors_t ) Eeprom.EepromData.DemoSettings.ModulationParam1; |
GregCr | 0:e5420f1a8a1a | 1356 | ModulationParams.Params.LoRa.Bandwidth = ( RadioLoRaBandwidths_t ) Eeprom.EepromData.DemoSettings.ModulationParam2; |
GregCr | 0:e5420f1a8a1a | 1357 | ModulationParams.Params.LoRa.CodingRate = ( RadioLoRaCodingRates_t ) Eeprom.EepromData.DemoSettings.ModulationParam3; |
GregCr | 0:e5420f1a8a1a | 1358 | |
GregCr | 0:e5420f1a8a1a | 1359 | PacketParams.Params.LoRa.PreambleLength = Eeprom.EepromData.DemoSettings.PacketParam1; |
GregCr | 0:e5420f1a8a1a | 1360 | PacketParams.Params.LoRa.HeaderType = ( RadioLoRaPacketLengthsMode_t )Eeprom.EepromData.DemoSettings.PacketParam2; |
GregCr | 0:e5420f1a8a1a | 1361 | PacketParams.Params.LoRa.PayloadLength = Eeprom.EepromData.DemoSettings.PacketParam3; |
GregCr | 0:e5420f1a8a1a | 1362 | PacketParams.Params.LoRa.CrcMode = ( RadioLoRaCrcModes_t ) Eeprom.EepromData.DemoSettings.PacketParam4; |
GregCr | 0:e5420f1a8a1a | 1363 | PacketParams.Params.LoRa.InvertIQ = ( RadioLoRaIQModes_t ) Eeprom.EepromData.DemoSettings.PacketParam5; |
GregCr | 0:e5420f1a8a1a | 1364 | |
GregCr | 0:e5420f1a8a1a | 1365 | Eeprom.EepromData.DemoSettings.PayloadLength = PacketParams.Params.LoRa.PayloadLength; |
GregCr | 1:b96176a4ccb8 | 1366 | |
GregCr | 1:b96176a4ccb8 | 1367 | if( ( ModulationParams.Params.LoRa.SpreadingFactor == LORA_SF6 ) || ( ModulationParams.Params.LoRa.SpreadingFactor == LORA_SF5 ) ) |
GregCr | 1:b96176a4ccb8 | 1368 | { |
GregCr | 1:b96176a4ccb8 | 1369 | if( PacketParams.Params.LoRa.PreambleLength < 12 ) |
GregCr | 1:b96176a4ccb8 | 1370 | { |
GregCr | 1:b96176a4ccb8 | 1371 | PacketParams.Params.LoRa.PreambleLength = 12; |
GregCr | 1:b96176a4ccb8 | 1372 | } |
GregCr | 1:b96176a4ccb8 | 1373 | } |
GregCr | 0:e5420f1a8a1a | 1374 | } |
GregCr | 0:e5420f1a8a1a | 1375 | else// if( modulation == PACKET_TYPE_GFSK ) |
GregCr | 0:e5420f1a8a1a | 1376 | { |
GregCr | 0:e5420f1a8a1a | 1377 | printf("set param GFSK for demo\n\r"); |
GregCr | 0:e5420f1a8a1a | 1378 | ModulationParams.PacketType = PACKET_TYPE_GFSK; |
GregCr | 0:e5420f1a8a1a | 1379 | PacketParams.PacketType = PACKET_TYPE_GFSK; |
GregCr | 0:e5420f1a8a1a | 1380 | |
GregCr | 0:e5420f1a8a1a | 1381 | ModulationParams.Params.Gfsk.BitRate = Eeprom.EepromData.DemoSettings.ModulationParam1; |
GregCr | 0:e5420f1a8a1a | 1382 | ModulationParams.Params.Gfsk.Fdev = Eeprom.EepromData.DemoSettings.ModulationParam2; |
GregCr | 0:e5420f1a8a1a | 1383 | ModulationParams.Params.Gfsk.ModulationShaping = ( RadioModShapings_t ) Eeprom.EepromData.DemoSettings.ModulationParam3; |
GregCr | 0:e5420f1a8a1a | 1384 | ModulationParams.Params.Gfsk.Bandwidth = ( RadioRxBandwidth_t ) Eeprom.EepromData.DemoSettings.ModulationParam4; |
GregCr | 0:e5420f1a8a1a | 1385 | PacketParams.Params.Gfsk.PreambleLength = Eeprom.EepromData.DemoSettings.PacketParam1; |
GregCr | 0:e5420f1a8a1a | 1386 | PacketParams.Params.Gfsk.PreambleMinDetect = ( RadioPreambleDetection_t )Eeprom.EepromData.DemoSettings.PacketParam2; |
GregCr | 0:e5420f1a8a1a | 1387 | PacketParams.Params.Gfsk.SyncWordLength = Eeprom.EepromData.DemoSettings.PacketParam3; |
GregCr | 0:e5420f1a8a1a | 1388 | PacketParams.Params.Gfsk.AddrComp = ( RadioAddressComp_t ) Eeprom.EepromData.DemoSettings.PacketParam4; |
GregCr | 0:e5420f1a8a1a | 1389 | PacketParams.Params.Gfsk.HeaderType = ( RadioPacketLengthModes_t )Eeprom.EepromData.DemoSettings.PacketParam5; |
GregCr | 0:e5420f1a8a1a | 1390 | PacketParams.Params.Gfsk.PayloadLength = Eeprom.EepromData.DemoSettings.PacketParam6; |
GregCr | 0:e5420f1a8a1a | 1391 | |
GregCr | 0:e5420f1a8a1a | 1392 | PacketParams.Params.Gfsk.CrcLength = ( RadioCrcTypes_t ) Eeprom.EepromData.DemoSettings.PacketParam7; |
GregCr | 0:e5420f1a8a1a | 1393 | PacketParams.Params.Gfsk.DcFree = ( RadioDcFree_t ) Eeprom.EepromData.DemoSettings.PacketParam8; |
GregCr | 0:e5420f1a8a1a | 1394 | |
GregCr | 0:e5420f1a8a1a | 1395 | Eeprom.EepromData.DemoSettings.PayloadLength = PacketParams.Params.Gfsk.PayloadLength; |
GregCr | 0:e5420f1a8a1a | 1396 | } |
GregCr | 0:e5420f1a8a1a | 1397 | |
GregCr | 0:e5420f1a8a1a | 1398 | Radio.SetStandby( STDBY_RC ); |
GregCr | 0:e5420f1a8a1a | 1399 | Radio.ClearIrqStatus( IRQ_RADIO_ALL ); |
GregCr | 0:e5420f1a8a1a | 1400 | Radio.SetPacketType( ModulationParams.PacketType ); |
GregCr | 0:e5420f1a8a1a | 1401 | Radio.SetModulationParams( &ModulationParams ); |
GregCr | 0:e5420f1a8a1a | 1402 | Radio.SetPacketParams( &PacketParams ); |
GregCr | 0:e5420f1a8a1a | 1403 | |
GregCr | 0:e5420f1a8a1a | 1404 | Radio.SetRfFrequency( Eeprom.EepromData.DemoSettings.Frequency ); |
GregCr | 0:e5420f1a8a1a | 1405 | Radio.SetBufferBaseAddresses( 0x00, 0x00 ); |
GregCr | 0:e5420f1a8a1a | 1406 | |
GregCr | 0:e5420f1a8a1a | 1407 | |
GregCr | 1:b96176a4ccb8 | 1408 | Radio.SetTxParams( Eeprom.EepromData.DemoSettings.TxPower, RADIO_RAMP_200_US ); |
GregCr | 0:e5420f1a8a1a | 1409 | |
GregCr | 0:e5420f1a8a1a | 1410 | // only used in GFSK |
GregCr | 0:e5420f1a8a1a | 1411 | Radio.SetSyncWord( ( uint8_t[] ){ 0x12, 0x34, 0x56, 0x78, 0x9A, 0xBC, 0xDE, 0xF0 } ); |
GregCr | 0:e5420f1a8a1a | 1412 | Radio.SetWhiteningSeed( 0x01FF ); |
GregCr | 0:e5420f1a8a1a | 1413 | |
GregCr | 0:e5420f1a8a1a | 1414 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 1415 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 1416 | } |
GregCr | 0:e5420f1a8a1a | 1417 | |
GregCr | 0:e5420f1a8a1a | 1418 | /*! |
GregCr | 0:e5420f1a8a1a | 1419 | * \brief Callback of ticker PerSendNextPacket |
GregCr | 0:e5420f1a8a1a | 1420 | */ |
GregCr | 0:e5420f1a8a1a | 1421 | void SendNextPacketEvent( void ) |
GregCr | 0:e5420f1a8a1a | 1422 | { |
GregCr | 0:e5420f1a8a1a | 1423 | SendNext = true; |
GregCr | 0:e5420f1a8a1a | 1424 | } |
GregCr | 0:e5420f1a8a1a | 1425 | |
GregCr | 0:e5420f1a8a1a | 1426 | void LedBlink( void ) |
GregCr | 0:e5420f1a8a1a | 1427 | { |
GregCr | 0:e5420f1a8a1a | 1428 | if( ( TX_LED == 0 ) && ( RX_LED == 0 ) ) |
GregCr | 0:e5420f1a8a1a | 1429 | { |
GregCr | 0:e5420f1a8a1a | 1430 | TX_LED = 1; |
GregCr | 0:e5420f1a8a1a | 1431 | } |
GregCr | 0:e5420f1a8a1a | 1432 | else if( ( TX_LED == 1 ) && ( RX_LED == 0 ) ) |
GregCr | 0:e5420f1a8a1a | 1433 | { |
GregCr | 0:e5420f1a8a1a | 1434 | RX_LED = 1; |
GregCr | 0:e5420f1a8a1a | 1435 | } |
GregCr | 0:e5420f1a8a1a | 1436 | else if( ( TX_LED == 1 ) && ( RX_LED == 1 ) ) |
GregCr | 0:e5420f1a8a1a | 1437 | { |
GregCr | 0:e5420f1a8a1a | 1438 | TX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 1439 | } |
GregCr | 0:e5420f1a8a1a | 1440 | else |
GregCr | 0:e5420f1a8a1a | 1441 | { |
GregCr | 0:e5420f1a8a1a | 1442 | RX_LED = 0; |
GregCr | 0:e5420f1a8a1a | 1443 | } |
GregCr | 0:e5420f1a8a1a | 1444 | } |
GregCr | 0:e5420f1a8a1a | 1445 | |
GregCr | 0:e5420f1a8a1a | 1446 | // ************************ Radio Callbacks **************************** |
GregCr | 0:e5420f1a8a1a | 1447 | // * * |
GregCr | 0:e5420f1a8a1a | 1448 | // * These functions are called through function pointer by the Radio low * |
GregCr | 0:e5420f1a8a1a | 1449 | // * level drivers * |
GregCr | 0:e5420f1a8a1a | 1450 | // * * |
GregCr | 0:e5420f1a8a1a | 1451 | // ***************************************************************************** |
GregCr | 0:e5420f1a8a1a | 1452 | void OnTxDone( void ) |
GregCr | 0:e5420f1a8a1a | 1453 | { |
GregCr | 0:e5420f1a8a1a | 1454 | DemoInternalState = APP_TX; |
GregCr | 0:e5420f1a8a1a | 1455 | } |
GregCr | 0:e5420f1a8a1a | 1456 | |
GregCr | 0:e5420f1a8a1a | 1457 | void OnRxDone( void ) |
GregCr | 0:e5420f1a8a1a | 1458 | { |
GregCr | 0:e5420f1a8a1a | 1459 | DemoInternalState = APP_RX; |
GregCr | 0:e5420f1a8a1a | 1460 | } |
GregCr | 0:e5420f1a8a1a | 1461 | |
GregCr | 0:e5420f1a8a1a | 1462 | void OnTxTimeout( void ) |
GregCr | 0:e5420f1a8a1a | 1463 | { |
GregCr | 0:e5420f1a8a1a | 1464 | DemoInternalState = APP_TX_TIMEOUT; |
GregCr | 0:e5420f1a8a1a | 1465 | } |
GregCr | 0:e5420f1a8a1a | 1466 | |
GregCr | 0:e5420f1a8a1a | 1467 | void OnRxTimeout( void ) |
GregCr | 0:e5420f1a8a1a | 1468 | { |
GregCr | 0:e5420f1a8a1a | 1469 | DemoInternalState = APP_RX_TIMEOUT; |
GregCr | 0:e5420f1a8a1a | 1470 | } |
GregCr | 0:e5420f1a8a1a | 1471 | |
GregCr | 0:e5420f1a8a1a | 1472 | void OnRxError( IrqErrorCode_t errorCode ) |
GregCr | 0:e5420f1a8a1a | 1473 | { |
GregCr | 0:e5420f1a8a1a | 1474 | DemoInternalState = APP_RX_ERROR; |
GregCr | 0:e5420f1a8a1a | 1475 | |
GregCr | 0:e5420f1a8a1a | 1476 | if( errorCode == IRQ_HEADER_ERROR_CODE ) |
GregCr | 0:e5420f1a8a1a | 1477 | { |
GregCr | 0:e5420f1a8a1a | 1478 | #ifdef ADV_DEBUG |
GregCr | 0:e5420f1a8a1a | 1479 | printf( ">> IRQ_HEADER_ERROR_CODE\n\r" ); |
GregCr | 0:e5420f1a8a1a | 1480 | #endif |
GregCr | 0:e5420f1a8a1a | 1481 | } |
GregCr | 0:e5420f1a8a1a | 1482 | else if( errorCode == IRQ_SYNCWORD_ERROR_CODE ) |
GregCr | 0:e5420f1a8a1a | 1483 | { |
GregCr | 0:e5420f1a8a1a | 1484 | #ifdef ADV_DEBUG |
GregCr | 0:e5420f1a8a1a | 1485 | printf( ">> IRQ_SYNCWORD_ERROR_CODE\n\r" ); |
GregCr | 0:e5420f1a8a1a | 1486 | #endif |
GregCr | 0:e5420f1a8a1a | 1487 | } |
GregCr | 0:e5420f1a8a1a | 1488 | else if( errorCode == IRQ_CRC_ERROR_CODE ) |
GregCr | 0:e5420f1a8a1a | 1489 | { |
GregCr | 0:e5420f1a8a1a | 1490 | #ifdef ADV_DEBUG |
GregCr | 0:e5420f1a8a1a | 1491 | printf( ">> IRQ_CRC_ERROR_CODE\n\r" ); |
GregCr | 0:e5420f1a8a1a | 1492 | #endif |
GregCr | 0:e5420f1a8a1a | 1493 | } |
GregCr | 0:e5420f1a8a1a | 1494 | else |
GregCr | 0:e5420f1a8a1a | 1495 | { |
GregCr | 0:e5420f1a8a1a | 1496 | #ifdef ADV_DEBUG |
GregCr | 0:e5420f1a8a1a | 1497 | printf( "unknown error\n\r" ); |
GregCr | 0:e5420f1a8a1a | 1498 | #endif |
GregCr | 0:e5420f1a8a1a | 1499 | } |
GregCr | 0:e5420f1a8a1a | 1500 | Radio.GetPacketStatus( &PacketStatus ); |
GregCr | 0:e5420f1a8a1a | 1501 | } |
GregCr | 0:e5420f1a8a1a | 1502 | |
GregCr | 0:e5420f1a8a1a | 1503 | void OnCadDone( bool channelActivityDetected ) |
GregCr | 0:e5420f1a8a1a | 1504 | { |
GregCr | 0:e5420f1a8a1a | 1505 | if( channelActivityDetected == true ) |
GregCr | 0:e5420f1a8a1a | 1506 | { |
GregCr | 0:e5420f1a8a1a | 1507 | DemoInternalState = CAD_DONE_CHANNEL_DETECTED; |
GregCr | 0:e5420f1a8a1a | 1508 | } |
GregCr | 0:e5420f1a8a1a | 1509 | else |
GregCr | 0:e5420f1a8a1a | 1510 | { |
GregCr | 0:e5420f1a8a1a | 1511 | DemoInternalState = CAD_DONE; |
GregCr | 0:e5420f1a8a1a | 1512 | } |
GregCr | 0:e5420f1a8a1a | 1513 | } |