Create a LoRa Modem from the SX1272PingPong example
Fork of SX1272PingPong by
main.cpp@15:9c3805baa6c1, 2017-01-25 (annotated)
- Committer:
- jerem28
- Date:
- Wed Jan 25 12:18:50 2017 +0000
- Revision:
- 15:9c3805baa6c1
- Parent:
- 14:3c9348ac486c
SX1272 Receiver/Transmitter program based on SX1272PingPong program
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
GregCr | 0:1ed39951ab7b | 1 | #include "mbed.h" |
GregCr | 4:5ece30264cd9 | 2 | #include "main.h" |
GregCr | 13:edb9b443c1dd | 3 | #include "sx1272-hal.h" |
GregCr | 8:f956dee63a56 | 4 | #include "debug.h" |
GregCr | 0:1ed39951ab7b | 5 | |
jerem28 | 14:3c9348ac486c | 6 | /* CONFIGURATION */ |
jerem28 | 14:3c9348ac486c | 7 | |
jerem28 | 14:3c9348ac486c | 8 | #define NODE_ADDR 0x411A |
jerem28 | 14:3c9348ac486c | 9 | |
GregCr | 0:1ed39951ab7b | 10 | /* Set this flag to '1' to display debug messages on the console */ |
GregCr | 13:edb9b443c1dd | 11 | #define DEBUG_MESSAGE 1 |
GregCr | 0:1ed39951ab7b | 12 | |
jerem28 | 14:3c9348ac486c | 13 | #define RX_MODE 1 |
jerem28 | 14:3c9348ac486c | 14 | |
jerem28 | 14:3c9348ac486c | 15 | #define TX_MODE !RX_MODE |
jerem28 | 14:3c9348ac486c | 16 | |
jerem28 | 14:3c9348ac486c | 17 | /* Set the mode RX_MODE or TX_MODE */ |
jerem28 | 14:3c9348ac486c | 18 | #define MODE TX_MODE |
jerem28 | 14:3c9348ac486c | 19 | |
jerem28 | 14:3c9348ac486c | 20 | /* Set the delay (according the duty cycle for the ISM band of the frequency RF_FREQUENCY */ |
jerem28 | 14:3c9348ac486c | 21 | |
jerem28 | 14:3c9348ac486c | 22 | #define DUTY_CYCLE 0.01 |
jerem28 | 14:3c9348ac486c | 23 | //#define DELAY_NEXT_TX_IN_MILLISEC ((int)((timeOnAirInMilli / DUTY_CYCLE)-timeOnAirInMilli)) |
jerem28 | 14:3c9348ac486c | 24 | |
jerem28 | 14:3c9348ac486c | 25 | #define DELAY_NEXT_TX_IN_MILLISEC 5000 |
jerem28 | 14:3c9348ac486c | 26 | |
GregCr | 0:1ed39951ab7b | 27 | /* Set this flag to '1' to use the LoRa modulation or to '0' to use FSK modulation */ |
GregCr | 5:f2431c4fe3bb | 28 | #define USE_MODEM_LORA 1 |
GregCr | 0:1ed39951ab7b | 29 | #define USE_MODEM_FSK !USE_MODEM_LORA |
GregCr | 0:1ed39951ab7b | 30 | |
jerem28 | 14:3c9348ac486c | 31 | #define RF_FREQUENCY 868100000 // Hz |
GregCr | 0:1ed39951ab7b | 32 | #define TX_OUTPUT_POWER 14 // 14 dBm |
GregCr | 0:1ed39951ab7b | 33 | |
GregCr | 0:1ed39951ab7b | 34 | #if USE_MODEM_LORA == 1 |
GregCr | 0:1ed39951ab7b | 35 | |
jerem28 | 14:3c9348ac486c | 36 | #define LORA_BANDWIDTH 0 // [0: 125 kHz, |
GregCr | 0:1ed39951ab7b | 37 | // 1: 250 kHz, |
GregCr | 0:1ed39951ab7b | 38 | // 2: 500 kHz, |
GregCr | 0:1ed39951ab7b | 39 | // 3: Reserved] |
jerem28 | 14:3c9348ac486c | 40 | #define LORA_SPREADING_FACTOR 12 // [SF7..SF12] |
GregCr | 0:1ed39951ab7b | 41 | #define LORA_CODINGRATE 1 // [1: 4/5, |
GregCr | 0:1ed39951ab7b | 42 | // 2: 4/6, |
GregCr | 0:1ed39951ab7b | 43 | // 3: 4/7, |
GregCr | 0:1ed39951ab7b | 44 | // 4: 4/8] |
GregCr | 0:1ed39951ab7b | 45 | #define LORA_PREAMBLE_LENGTH 8 // Same for Tx and Rx |
GregCr | 0:1ed39951ab7b | 46 | #define LORA_SYMBOL_TIMEOUT 5 // Symbols |
GregCr | 0:1ed39951ab7b | 47 | #define LORA_FIX_LENGTH_PAYLOAD_ON false |
GregCr | 3:8b9e2a4df4b5 | 48 | #define LORA_FHSS_ENABLED false |
GregCr | 3:8b9e2a4df4b5 | 49 | #define LORA_NB_SYMB_HOP 4 |
GregCr | 0:1ed39951ab7b | 50 | #define LORA_IQ_INVERSION_ON false |
GregCr | 3:8b9e2a4df4b5 | 51 | #define LORA_CRC_ENABLED true |
GregCr | 3:8b9e2a4df4b5 | 52 | |
GregCr | 0:1ed39951ab7b | 53 | #elif USE_MODEM_FSK == 1 |
GregCr | 0:1ed39951ab7b | 54 | |
GregCr | 2:59e108728d71 | 55 | #define FSK_FDEV 25000 // Hz |
GregCr | 2:59e108728d71 | 56 | #define FSK_DATARATE 19200 // bps |
GregCr | 2:59e108728d71 | 57 | #define FSK_BANDWIDTH 50000 // Hz |
GregCr | 2:59e108728d71 | 58 | #define FSK_AFC_BANDWIDTH 83333 // Hz |
GregCr | 0:1ed39951ab7b | 59 | #define FSK_PREAMBLE_LENGTH 5 // Same for Tx and Rx |
GregCr | 0:1ed39951ab7b | 60 | #define FSK_FIX_LENGTH_PAYLOAD_ON false |
GregCr | 3:8b9e2a4df4b5 | 61 | #define FSK_CRC_ENABLED true |
GregCr | 3:8b9e2a4df4b5 | 62 | |
GregCr | 0:1ed39951ab7b | 63 | #else |
GregCr | 0:1ed39951ab7b | 64 | #error "Please define a modem in the compiler options." |
GregCr | 0:1ed39951ab7b | 65 | #endif |
GregCr | 0:1ed39951ab7b | 66 | |
jerem28 | 14:3c9348ac486c | 67 | #define RX_TIMEOUT_VALUE 1000000000 // in us |
jerem28 | 14:3c9348ac486c | 68 | #define BUFFER_SIZE 17 // Define the payload size here |
jerem28 | 14:3c9348ac486c | 69 | |
jerem28 | 14:3c9348ac486c | 70 | |
jerem28 | 14:3c9348ac486c | 71 | Serial pc(USBTX,USBRX); |
GregCr | 0:1ed39951ab7b | 72 | |
GregCr | 8:f956dee63a56 | 73 | #if( defined ( TARGET_KL25Z ) || defined ( TARGET_LPC11U6X ) ) |
GregCr | 3:8b9e2a4df4b5 | 74 | DigitalOut led(LED2); |
GregCr | 3:8b9e2a4df4b5 | 75 | #else |
GregCr | 3:8b9e2a4df4b5 | 76 | DigitalOut led(LED1); |
GregCr | 3:8b9e2a4df4b5 | 77 | #endif |
GregCr | 3:8b9e2a4df4b5 | 78 | |
GregCr | 0:1ed39951ab7b | 79 | /* |
GregCr | 0:1ed39951ab7b | 80 | * Global variables declarations |
GregCr | 0:1ed39951ab7b | 81 | */ |
mluis | 10:7af820d1e1df | 82 | typedef enum |
mluis | 10:7af820d1e1df | 83 | { |
mluis | 10:7af820d1e1df | 84 | LOWPOWER = 0, |
mluis | 10:7af820d1e1df | 85 | IDLE, |
mluis | 10:7af820d1e1df | 86 | |
mluis | 10:7af820d1e1df | 87 | RX, |
mluis | 10:7af820d1e1df | 88 | RX_TIMEOUT, |
mluis | 10:7af820d1e1df | 89 | RX_ERROR, |
mluis | 10:7af820d1e1df | 90 | |
mluis | 10:7af820d1e1df | 91 | TX, |
mluis | 10:7af820d1e1df | 92 | TX_TIMEOUT, |
mluis | 10:7af820d1e1df | 93 | |
mluis | 10:7af820d1e1df | 94 | CAD, |
mluis | 10:7af820d1e1df | 95 | CAD_DONE |
mluis | 10:7af820d1e1df | 96 | }AppStates_t; |
GregCr | 0:1ed39951ab7b | 97 | |
mluis | 10:7af820d1e1df | 98 | volatile AppStates_t State = LOWPOWER; |
mluis | 10:7af820d1e1df | 99 | |
mluis | 10:7af820d1e1df | 100 | /*! |
mluis | 10:7af820d1e1df | 101 | * Radio events function pointer |
mluis | 10:7af820d1e1df | 102 | */ |
mluis | 10:7af820d1e1df | 103 | static RadioEvents_t RadioEvents; |
mluis | 10:7af820d1e1df | 104 | |
mluis | 10:7af820d1e1df | 105 | /* |
mluis | 10:7af820d1e1df | 106 | * Global variables declarations |
mluis | 10:7af820d1e1df | 107 | */ |
GregCr | 13:edb9b443c1dd | 108 | SX1272MB2xAS Radio( NULL ); |
GregCr | 0:1ed39951ab7b | 109 | uint16_t BufferSize = BUFFER_SIZE; |
GregCr | 0:1ed39951ab7b | 110 | uint8_t Buffer[BUFFER_SIZE]; |
GregCr | 0:1ed39951ab7b | 111 | |
jerem28 | 14:3c9348ac486c | 112 | int16_t RssiValue = 0; |
jerem28 | 14:3c9348ac486c | 113 | int8_t SnrValue = 0; |
jerem28 | 14:3c9348ac486c | 114 | |
jerem28 | 14:3c9348ac486c | 115 | ModemType Modem; |
jerem28 | 14:3c9348ac486c | 116 | |
jerem28 | 14:3c9348ac486c | 117 | uint16_t SeqNum = 0; |
jerem28 | 14:3c9348ac486c | 118 | |
jerem28 | 14:3c9348ac486c | 119 | // Address of the Source Node |
jerem28 | 14:3c9348ac486c | 120 | uint16_t NodeSrcAddr = NODE_ADDR; |
jerem28 | 14:3c9348ac486c | 121 | |
jerem28 | 14:3c9348ac486c | 122 | void hexprintf(Serial* pc, const uint8_t* buffer, uint16_t size) |
jerem28 | 14:3c9348ac486c | 123 | { |
jerem28 | 14:3c9348ac486c | 124 | for(uint16_t count = 0; count < size; count++) |
jerem28 | 14:3c9348ac486c | 125 | { |
jerem28 | 14:3c9348ac486c | 126 | pc->printf("%02x", buffer[count]); |
jerem28 | 14:3c9348ac486c | 127 | } |
jerem28 | 14:3c9348ac486c | 128 | } |
jerem28 | 14:3c9348ac486c | 129 | const uint8_t Msg[] = "TEST**##abcdefghijklmnopqrstuvwxyz#0123456789#ABCDEFGHIJKLMNOPQRSTUVWXYZ#0123456789#abcdefghijklmnopqrstuvwxyz#0123456789#ABCDEFGHIJKLMNOPQRSTUVWXYZ#0123456789#abcdefghijklmnopqrstuvwxyz#0123456789#ABCDEFGHIJKLMNOPQRSTUVWXYZ#0123456789#abcdefghijklmnopqrs#"; /* abc.. is for padding */ |
GregCr | 0:1ed39951ab7b | 130 | |
GregCr | 0:1ed39951ab7b | 131 | int main() |
GregCr | 0:1ed39951ab7b | 132 | { |
jerem28 | 14:3c9348ac486c | 133 | |
jerem28 | 14:3c9348ac486c | 134 | pc.format(8, Serial::None, 1); |
jerem28 | 14:3c9348ac486c | 135 | pc.baud(115200); |
GregCr | 0:1ed39951ab7b | 136 | |
jerem28 | 14:3c9348ac486c | 137 | debug( ">INFO RX/TX Modem \r\n\n" ); |
jerem28 | 14:3c9348ac486c | 138 | |
mluis | 10:7af820d1e1df | 139 | // Initialize Radio driver |
mluis | 10:7af820d1e1df | 140 | RadioEvents.TxDone = OnTxDone; |
mluis | 10:7af820d1e1df | 141 | RadioEvents.RxDone = OnRxDone; |
mluis | 10:7af820d1e1df | 142 | RadioEvents.RxError = OnRxError; |
mluis | 10:7af820d1e1df | 143 | RadioEvents.TxTimeout = OnTxTimeout; |
mluis | 10:7af820d1e1df | 144 | RadioEvents.RxTimeout = OnRxTimeout; |
mluis | 10:7af820d1e1df | 145 | Radio.Init( &RadioEvents ); |
GregCr | 0:1ed39951ab7b | 146 | |
GregCr | 7:c1bbd6c56979 | 147 | // verify the connection with the board |
GregCr | 7:c1bbd6c56979 | 148 | while( Radio.Read( REG_VERSION ) == 0x00 ) |
GregCr | 2:59e108728d71 | 149 | { |
GregCr | 7:c1bbd6c56979 | 150 | debug( "Radio could not be detected!\n\r", NULL ); |
GregCr | 7:c1bbd6c56979 | 151 | wait( 1 ); |
GregCr | 2:59e108728d71 | 152 | } |
GregCr | 7:c1bbd6c56979 | 153 | |
GregCr | 13:edb9b443c1dd | 154 | debug_if( ( DEBUG_MESSAGE & ( Radio.DetectBoardType( ) == SX1272MB2XAS ) ) , "\n\r > Board Type: SX1272MB2xAS < \n\r" ); |
GregCr | 13:edb9b443c1dd | 155 | |
GregCr | 0:1ed39951ab7b | 156 | Radio.SetChannel( RF_FREQUENCY ); |
GregCr | 0:1ed39951ab7b | 157 | |
GregCr | 0:1ed39951ab7b | 158 | #if USE_MODEM_LORA == 1 |
GregCr | 3:8b9e2a4df4b5 | 159 | |
GregCr | 7:c1bbd6c56979 | 160 | debug_if( LORA_FHSS_ENABLED, "\n\n\r > LORA FHSS Mode < \n\n\r"); |
GregCr | 7:c1bbd6c56979 | 161 | debug_if( !LORA_FHSS_ENABLED, "\n\n\r > LORA Mode < \n\n\r"); |
GregCr | 7:c1bbd6c56979 | 162 | |
GregCr | 0:1ed39951ab7b | 163 | Radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH, |
GregCr | 0:1ed39951ab7b | 164 | LORA_SPREADING_FACTOR, LORA_CODINGRATE, |
GregCr | 0:1ed39951ab7b | 165 | LORA_PREAMBLE_LENGTH, LORA_FIX_LENGTH_PAYLOAD_ON, |
GregCr | 3:8b9e2a4df4b5 | 166 | LORA_CRC_ENABLED, LORA_FHSS_ENABLED, LORA_NB_SYMB_HOP, |
GregCr | 7:c1bbd6c56979 | 167 | LORA_IQ_INVERSION_ON, 2000000 ); |
GregCr | 0:1ed39951ab7b | 168 | |
GregCr | 0:1ed39951ab7b | 169 | Radio.SetRxConfig( MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR, |
GregCr | 0:1ed39951ab7b | 170 | LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH, |
mluis | 9:e764990e45df | 171 | LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, 0, |
GregCr | 3:8b9e2a4df4b5 | 172 | LORA_CRC_ENABLED, LORA_FHSS_ENABLED, LORA_NB_SYMB_HOP, |
GregCr | 3:8b9e2a4df4b5 | 173 | LORA_IQ_INVERSION_ON, true ); |
GregCr | 0:1ed39951ab7b | 174 | |
GregCr | 0:1ed39951ab7b | 175 | #elif USE_MODEM_FSK == 1 |
GregCr | 0:1ed39951ab7b | 176 | |
GregCr | 7:c1bbd6c56979 | 177 | debug("\n\n\r > FSK Mode < \n\n\r"); |
GregCr | 0:1ed39951ab7b | 178 | Radio.SetTxConfig( MODEM_FSK, TX_OUTPUT_POWER, FSK_FDEV, 0, |
GregCr | 0:1ed39951ab7b | 179 | FSK_DATARATE, 0, |
GregCr | 0:1ed39951ab7b | 180 | FSK_PREAMBLE_LENGTH, FSK_FIX_LENGTH_PAYLOAD_ON, |
GregCr | 7:c1bbd6c56979 | 181 | FSK_CRC_ENABLED, 0, 0, 0, 2000000 ); |
GregCr | 0:1ed39951ab7b | 182 | |
GregCr | 0:1ed39951ab7b | 183 | Radio.SetRxConfig( MODEM_FSK, FSK_BANDWIDTH, FSK_DATARATE, |
GregCr | 0:1ed39951ab7b | 184 | 0, FSK_AFC_BANDWIDTH, FSK_PREAMBLE_LENGTH, |
mluis | 9:e764990e45df | 185 | 0, FSK_FIX_LENGTH_PAYLOAD_ON, 0, FSK_CRC_ENABLED, |
GregCr | 3:8b9e2a4df4b5 | 186 | 0, 0, false, true ); |
GregCr | 0:1ed39951ab7b | 187 | |
GregCr | 0:1ed39951ab7b | 188 | #else |
GregCr | 0:1ed39951ab7b | 189 | |
GregCr | 0:1ed39951ab7b | 190 | #error "Please define a modem in the compiler options." |
GregCr | 0:1ed39951ab7b | 191 | |
GregCr | 0:1ed39951ab7b | 192 | #endif |
jerem28 | 14:3c9348ac486c | 193 | led = 0; |
jerem28 | 14:3c9348ac486c | 194 | #if MODE == RX_MODE |
jerem28 | 14:3c9348ac486c | 195 | debug_if( DEBUG_MESSAGE, ">INFO Starting RX loop\r\n" ); |
jerem28 | 14:3c9348ac486c | 196 | |
jerem28 | 14:3c9348ac486c | 197 | // start RX |
GregCr | 0:1ed39951ab7b | 198 | Radio.Rx( RX_TIMEOUT_VALUE ); |
jerem28 | 14:3c9348ac486c | 199 | State = LOWPOWER; |
GregCr | 0:1ed39951ab7b | 200 | |
jerem28 | 14:3c9348ac486c | 201 | #elif MODE == TX_MODE |
jerem28 | 14:3c9348ac486c | 202 | debug_if( DEBUG_MESSAGE, ">INFO Starting TX loop\r\n" ); |
jerem28 | 14:3c9348ac486c | 203 | State = TX; |
jerem28 | 14:3c9348ac486c | 204 | |
jerem28 | 14:3c9348ac486c | 205 | #else |
jerem28 | 14:3c9348ac486c | 206 | #error "Please define a valid mode (RX_MODE, TX_MODE)." |
jerem28 | 14:3c9348ac486c | 207 | #endif |
jerem28 | 14:3c9348ac486c | 208 | |
jerem28 | 14:3c9348ac486c | 209 | // TODO ECHO_MODE : RX_MODE then TX_MODE |
jerem28 | 14:3c9348ac486c | 210 | |
GregCr | 0:1ed39951ab7b | 211 | while( 1 ) |
GregCr | 0:1ed39951ab7b | 212 | { |
GregCr | 0:1ed39951ab7b | 213 | switch( State ) |
GregCr | 0:1ed39951ab7b | 214 | { |
GregCr | 0:1ed39951ab7b | 215 | case RX: |
GregCr | 0:1ed39951ab7b | 216 | if( BufferSize > 0 ) |
GregCr | 0:1ed39951ab7b | 217 | { |
jerem28 | 14:3c9348ac486c | 218 | led = !led; // Invert LED |
jerem28 | 14:3c9348ac486c | 219 | |
jerem28 | 14:3c9348ac486c | 220 | |
jerem28 | 14:3c9348ac486c | 221 | // TODO ADD tmst | number | Internal timestamp of "RX finished" event (32b unsigned) |
jerem28 | 14:3c9348ac486c | 222 | |
jerem28 | 15:9c3805baa6c1 | 223 | pc.printf(">INFO RX modem=%d size=%d rssi=%d snr=%d freq=%d bw=%d sf=%d cr=%d buffer=", |
jerem28 | 15:9c3805baa6c1 | 224 | Modem, BufferSize, RssiValue, SnrValue, RF_FREQUENCY, LORA_BANDWIDTH, LORA_SPREADING_FACTOR, LORA_CODINGRATE ); |
jerem28 | 14:3c9348ac486c | 225 | hexprintf(&pc, Buffer, BufferSize); |
jerem28 | 14:3c9348ac486c | 226 | pc.printf("\r\n"); |
jerem28 | 14:3c9348ac486c | 227 | |
jerem28 | 14:3c9348ac486c | 228 | pc.printf("RX;%d;%d;%d;%d;%d;%d;%d;%d;", |
jerem28 | 14:3c9348ac486c | 229 | Modem, BufferSize, RssiValue, SnrValue, RF_FREQUENCY, LORA_BANDWIDTH, LORA_SPREADING_FACTOR, LORA_CODINGRATE ); |
jerem28 | 14:3c9348ac486c | 230 | hexprintf(&pc, Buffer, BufferSize); |
jerem28 | 14:3c9348ac486c | 231 | pc.printf("\r\n"); |
jerem28 | 14:3c9348ac486c | 232 | // wait_ms( 10 ); |
jerem28 | 14:3c9348ac486c | 233 | Radio.Rx( RX_TIMEOUT_VALUE ); |
GregCr | 0:1ed39951ab7b | 234 | } |
jerem28 | 14:3c9348ac486c | 235 | |
GregCr | 0:1ed39951ab7b | 236 | State = LOWPOWER; |
GregCr | 0:1ed39951ab7b | 237 | break; |
GregCr | 0:1ed39951ab7b | 238 | case RX_TIMEOUT: |
jerem28 | 14:3c9348ac486c | 239 | Radio.Rx( RX_TIMEOUT_VALUE ); |
GregCr | 0:1ed39951ab7b | 240 | State = LOWPOWER; |
GregCr | 0:1ed39951ab7b | 241 | break; |
GregCr | 0:1ed39951ab7b | 242 | case RX_ERROR: |
jerem28 | 14:3c9348ac486c | 243 | // We have received a Packet with a CRC error |
jerem28 | 14:3c9348ac486c | 244 | pc.printf(">INFO RX_ERROR size=%d\r\n", BufferSize); |
jerem28 | 14:3c9348ac486c | 245 | pc.printf("RX_ERROR;%d\r\n", BufferSize); |
jerem28 | 14:3c9348ac486c | 246 | Radio.Rx( RX_TIMEOUT_VALUE ); |
GregCr | 0:1ed39951ab7b | 247 | State = LOWPOWER; |
GregCr | 0:1ed39951ab7b | 248 | break; |
GregCr | 0:1ed39951ab7b | 249 | case TX_TIMEOUT: |
jerem28 | 14:3c9348ac486c | 250 | pc.printf(">TX: TIMEOUT\r\n"); |
jerem28 | 14:3c9348ac486c | 251 | case TX: |
jerem28 | 14:3c9348ac486c | 252 | int timeOnAirInMilli = Radio.TimeOnAir(Modem,BufferSize)/1000; |
jerem28 | 14:3c9348ac486c | 253 | if(DELAY_NEXT_TX_IN_MILLISEC!=0) { |
jerem28 | 14:3c9348ac486c | 254 | pc.printf(">INFO: wait %.4f sec before TX\r\n", DELAY_NEXT_TX_IN_MILLISEC/1000.0); |
jerem28 | 14:3c9348ac486c | 255 | wait_ms( DELAY_NEXT_TX_IN_MILLISEC ); |
jerem28 | 14:3c9348ac486c | 256 | } |
jerem28 | 14:3c9348ac486c | 257 | led = !led; // Invert LED |
jerem28 | 14:3c9348ac486c | 258 | memcpy(( char* )Buffer, ( char* ) Msg, BufferSize); |
jerem28 | 14:3c9348ac486c | 259 | ++SeqNum; |
jerem28 | 14:3c9348ac486c | 260 | |
jerem28 | 14:3c9348ac486c | 261 | TemperatureValue = Radio.Read( REG_TEMP ); |
jerem28 | 14:3c9348ac486c | 262 | |
jerem28 | 14:3c9348ac486c | 263 | /* refresh counters in payload (big endian, for readability) */ |
jerem28 | 14:3c9348ac486c | 264 | Buffer[4] = (uint8_t)(SeqNum >> 8); /* MSB */ |
jerem28 | 14:3c9348ac486c | 265 | Buffer[5] = (uint8_t)(SeqNum & 0x00FF); /* LSB */ |
jerem28 | 14:3c9348ac486c | 266 | Buffer[6] = (uint8_t)(NodeSrcAddr >> 8); /* MSB */ |
jerem28 | 14:3c9348ac486c | 267 | Buffer[7] = (uint8_t)(NodeSrcAddr & 0x00FF); /* LSB */ |
jerem28 | 14:3c9348ac486c | 268 | Buffer[8] = (uint8_t)(TemperatureValue >> 8); /* MSB */ |
jerem28 | 14:3c9348ac486c | 269 | Buffer[9] = (uint8_t)(TemperatureValue & 0x00FF); /* LSB */ |
jerem28 | 14:3c9348ac486c | 270 | |
jerem28 | 14:3c9348ac486c | 271 | /* send packet */ |
jerem28 | 14:3c9348ac486c | 272 | pc.printf(">TX: temp=%d src=%4x seqnum=%u size=%d timeOnAir=%.4f\r\n", TemperatureValue, NodeSrcAddr, SeqNum, BufferSize, timeOnAirInMilli/1000.0); |
jerem28 | 14:3c9348ac486c | 273 | wait_ms( 10 ); |
jerem28 | 14:3c9348ac486c | 274 | Radio.Send( Buffer, BufferSize ); |
GregCr | 0:1ed39951ab7b | 275 | State = LOWPOWER; |
jerem28 | 14:3c9348ac486c | 276 | break; |
GregCr | 0:1ed39951ab7b | 277 | case LOWPOWER: |
GregCr | 0:1ed39951ab7b | 278 | break; |
GregCr | 0:1ed39951ab7b | 279 | default: |
GregCr | 0:1ed39951ab7b | 280 | State = LOWPOWER; |
GregCr | 0:1ed39951ab7b | 281 | break; |
GregCr | 0:1ed39951ab7b | 282 | } |
GregCr | 0:1ed39951ab7b | 283 | } |
GregCr | 0:1ed39951ab7b | 284 | } |
GregCr | 0:1ed39951ab7b | 285 | |
GregCr | 0:1ed39951ab7b | 286 | void OnTxDone( void ) |
GregCr | 0:1ed39951ab7b | 287 | { |
GregCr | 5:f2431c4fe3bb | 288 | Radio.Sleep( ); |
GregCr | 0:1ed39951ab7b | 289 | State = TX; |
GregCr | 7:c1bbd6c56979 | 290 | debug_if( DEBUG_MESSAGE, "> OnTxDone\n\r" ); |
GregCr | 0:1ed39951ab7b | 291 | } |
GregCr | 0:1ed39951ab7b | 292 | |
GregCr | 4:5ece30264cd9 | 293 | void OnRxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr) |
GregCr | 0:1ed39951ab7b | 294 | { |
GregCr | 0:1ed39951ab7b | 295 | Radio.Sleep( ); |
GregCr | 0:1ed39951ab7b | 296 | BufferSize = size; |
GregCr | 0:1ed39951ab7b | 297 | memcpy( Buffer, payload, BufferSize ); |
GregCr | 0:1ed39951ab7b | 298 | RssiValue = rssi; |
GregCr | 0:1ed39951ab7b | 299 | SnrValue = snr; |
GregCr | 0:1ed39951ab7b | 300 | State = RX; |
GregCr | 7:c1bbd6c56979 | 301 | debug_if( DEBUG_MESSAGE, "> OnRxDone\n\r" ); |
GregCr | 0:1ed39951ab7b | 302 | } |
GregCr | 0:1ed39951ab7b | 303 | |
GregCr | 0:1ed39951ab7b | 304 | void OnTxTimeout( void ) |
GregCr | 0:1ed39951ab7b | 305 | { |
GregCr | 0:1ed39951ab7b | 306 | Radio.Sleep( ); |
GregCr | 0:1ed39951ab7b | 307 | State = TX_TIMEOUT; |
GregCr | 7:c1bbd6c56979 | 308 | debug_if( DEBUG_MESSAGE, "> OnTxTimeout\n\r" ); |
GregCr | 0:1ed39951ab7b | 309 | } |
GregCr | 0:1ed39951ab7b | 310 | |
GregCr | 0:1ed39951ab7b | 311 | void OnRxTimeout( void ) |
GregCr | 0:1ed39951ab7b | 312 | { |
GregCr | 0:1ed39951ab7b | 313 | Radio.Sleep( ); |
GregCr | 1:126d70d374f6 | 314 | Buffer[ BufferSize ] = 0; |
GregCr | 0:1ed39951ab7b | 315 | State = RX_TIMEOUT; |
GregCr | 7:c1bbd6c56979 | 316 | debug_if( DEBUG_MESSAGE, "> OnRxTimeout\n\r" ); |
GregCr | 0:1ed39951ab7b | 317 | } |
GregCr | 0:1ed39951ab7b | 318 | |
GregCr | 0:1ed39951ab7b | 319 | void OnRxError( void ) |
GregCr | 0:1ed39951ab7b | 320 | { |
GregCr | 0:1ed39951ab7b | 321 | Radio.Sleep( ); |
GregCr | 0:1ed39951ab7b | 322 | State = RX_ERROR; |
GregCr | 7:c1bbd6c56979 | 323 | debug_if( DEBUG_MESSAGE, "> OnRxError\n\r" ); |
GregCr | 0:1ed39951ab7b | 324 | } |