repeat message down a chain, adding to the payload at each repeating device
radio chip selection
Radio chip driver is not included, because options are available.
If you're using SX1272 or SX1276, then import sx127x driver into your program.
if you're using SX1261 or SX1262, then import sx126x driver into your program.
if you're using SX1280, then import sx1280 driver into your program.
If you're using NAmote72 or Murata discovery, then you must import only sx127x driver.
network architecture
UNIT 0x00
transmitting only device: mandatory.UNIT 0x01
: repeating device- Uni-directional network: Each unit can only receive message from
UNIT_ID - 1
(previous unit) UINT n
receiving only deviceLAST_UNIT
: mandatory; prints payload onto UART.
configuration
Each device in the network is uniquely identified by:
UNIT_ID
: ID byte designating address of this device.UNIT_LAST
: If defined, this device prints payload onto serial port instead of re-transmitting payload.
All devices in network must be configured identically with the following:
TX_INTERVAL_US
: how often to take measurement and send toUNIT_ID+1
(time of complete cycle).MAX_TX_LENGTH
: Maximum size of payload, in bytes. Payload is sent in fragments when exceeds this value; aka size of each fragment.TXRX_PADDING_US
: Time allotted for RX-TX turnaround and CPU overheadMAX_TX_ATTEMPTS
: Count of transmit retries permittedSPREADING_FACTOR
LoRa configuration of datarateCF_MHZ
: Operating radio frequency
Duration of retry interval is auto-calculated from LoRa modem configuration (bandwidth/sf) and MAX_TX_LENGTH
.
Take care that TX_INTERVAL_US
value is appropriate relative to total retry interval (interval * MAX_TX_ATTEMPTS
)
main.cpp@1:7dbf0926e146, 2018-07-05 (annotated)
- Committer:
- Wayne Roberts
- Date:
- Thu Jul 05 17:43:35 2018 -0700
- Revision:
- 1:7dbf0926e146
- Parent:
- 0:d88677306896
- Child:
- 2:534be88a25dc
use sx12xx_hal
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Wayne Roberts |
0:d88677306896 | 1 | #include "radio.h" |
Wayne Roberts |
0:d88677306896 | 2 | |
Wayne Roberts |
1:7dbf0926e146 | 3 | #define UNIT_ID 0x03 /* 0x00: first unit */ |
Wayne Roberts |
0:d88677306896 | 4 | //#define UNIT_LAST |
Wayne Roberts |
0:d88677306896 | 5 | |
Wayne Roberts |
0:d88677306896 | 6 | // test large sample, large pkt size #define N_SMP 10 |
Wayne Roberts |
0:d88677306896 | 7 | typedef struct __attribute__((__packed__)) msg { |
Wayne Roberts |
0:d88677306896 | 8 | uint8_t unit_id; |
Wayne Roberts |
0:d88677306896 | 9 | uint8_t flags; |
Wayne Roberts |
0:d88677306896 | 10 | uint16_t sample; |
Wayne Roberts |
0:d88677306896 | 11 | |
Wayne Roberts |
0:d88677306896 | 12 | #ifdef N_SMP |
Wayne Roberts |
0:d88677306896 | 13 | uint16_t samples[N_SMP]; |
Wayne Roberts |
0:d88677306896 | 14 | #endif |
Wayne Roberts |
0:d88677306896 | 15 | } message_t; |
Wayne Roberts |
0:d88677306896 | 16 | |
Wayne Roberts |
0:d88677306896 | 17 | #define TX_INTERVAL_US 5000000 |
Wayne Roberts |
0:d88677306896 | 18 | #define MAX_TX_LENGTH 64 |
Wayne Roberts |
0:d88677306896 | 19 | #define TXRX_PADDING_US 10000 |
Wayne Roberts |
0:d88677306896 | 20 | #define MAX_TX_ATTEMPTS 4 |
Wayne Roberts |
0:d88677306896 | 21 | #define SPREADING_FACTOR 9 |
Wayne Roberts |
0:d88677306896 | 22 | #define CF_MHZ 917.6 |
Wayne Roberts |
0:d88677306896 | 23 | |
Wayne Roberts |
0:d88677306896 | 24 | #define EXPECTED_LENGTH (UNIT_ID * sizeof(message_t)) |
Wayne Roberts |
0:d88677306896 | 25 | //#define MEASURED_MAX_ERR (TX_INTERVAL_US / 4000) // +/-100ppm allowance |
Wayne Roberts |
0:d88677306896 | 26 | #define MEASURED_MAX_ERR (TX_INTERVAL_US / 300) // +/-Xppm allowance |
Wayne Roberts |
0:d88677306896 | 27 | |
Wayne Roberts |
0:d88677306896 | 28 | #if defined(SX127x_H) |
Wayne Roberts |
0:d88677306896 | 29 | #define RX_STARTUP_US 1500 |
Wayne Roberts |
0:d88677306896 | 30 | #elif defined(SX126x_H) |
Wayne Roberts |
0:d88677306896 | 31 | #define RX_STARTUP_US 1000 |
Wayne Roberts |
1:7dbf0926e146 | 32 | #elif defined(SX128x_H) |
Wayne Roberts |
1:7dbf0926e146 | 33 | #define RX_STARTUP_US 1000 |
Wayne Roberts |
0:d88677306896 | 34 | #endif |
Wayne Roberts |
0:d88677306896 | 35 | unsigned rxStartup_us = RX_STARTUP_US; |
Wayne Roberts |
0:d88677306896 | 36 | |
Wayne Roberts |
0:d88677306896 | 37 | RawSerial pc(USBTX, USBRX); |
Wayne Roberts |
0:d88677306896 | 38 | |
Wayne Roberts |
0:d88677306896 | 39 | #ifdef TARGET_DISCO_L072CZ_LRWAN1 |
Wayne Roberts |
0:d88677306896 | 40 | AnalogIn ain(A0); |
Wayne Roberts |
1:7dbf0926e146 | 41 | #elif defined(TARGET_MOTE_L152RC) |
Wayne Roberts |
1:7dbf0926e146 | 42 | AnalogIn ain(A0); |
Wayne Roberts |
0:d88677306896 | 43 | #else |
Wayne Roberts |
0:d88677306896 | 44 | #ifdef TARGET_FF_MORPHO |
Wayne Roberts |
0:d88677306896 | 45 | AnalogIn ain(PC_4); // pin unused by arduino shields |
Wayne Roberts |
0:d88677306896 | 46 | #endif /* TARGET_FF_MORPHO */ |
Wayne Roberts |
0:d88677306896 | 47 | #endif /* !TARGET_DISCO_L072CZ_LRWAN1 */ |
Wayne Roberts |
0:d88677306896 | 48 | |
Wayne Roberts |
0:d88677306896 | 49 | uint8_t forward[255]; |
Wayne Roberts |
0:d88677306896 | 50 | uint8_t forwardLen; |
Wayne Roberts |
0:d88677306896 | 51 | uint8_t forwardLenTransmitted; |
Wayne Roberts |
0:d88677306896 | 52 | uint8_t forwardLenAckd; |
Wayne Roberts |
0:d88677306896 | 53 | int prevFrag; |
Wayne Roberts |
0:d88677306896 | 54 | volatile us_timestamp_t forwardedAt; |
Wayne Roberts |
0:d88677306896 | 55 | |
Wayne Roberts |
0:d88677306896 | 56 | volatile us_timestamp_t lastRxIrqAt; |
Wayne Roberts |
0:d88677306896 | 57 | volatile us_timestamp_t measuredInterval, measuredIntervalSaved; |
Wayne Roberts |
0:d88677306896 | 58 | |
Wayne Roberts |
0:d88677306896 | 59 | |
Wayne Roberts |
0:d88677306896 | 60 | enum _state_ { |
Wayne Roberts |
0:d88677306896 | 61 | /* 0 */ STATE_NONE = 0, |
Wayne Roberts |
0:d88677306896 | 62 | /* 1 */ STATE_GET_REQ, |
Wayne Roberts |
0:d88677306896 | 63 | #ifndef UNIT_LAST |
Wayne Roberts |
0:d88677306896 | 64 | /* 2 */ STATE_ACK_WAITING, |
Wayne Roberts |
0:d88677306896 | 65 | /* 3 */ STATE_TX_FORWARD, |
Wayne Roberts |
0:d88677306896 | 66 | #endif /* UNIT_LAST */ |
Wayne Roberts |
0:d88677306896 | 67 | } state; |
Wayne Roberts |
0:d88677306896 | 68 | |
Wayne Roberts |
0:d88677306896 | 69 | void stateToString(enum _state_ s, char* out) |
Wayne Roberts |
0:d88677306896 | 70 | { |
Wayne Roberts |
0:d88677306896 | 71 | const char* str; |
Wayne Roberts |
0:d88677306896 | 72 | |
Wayne Roberts |
0:d88677306896 | 73 | switch (s) { |
Wayne Roberts |
0:d88677306896 | 74 | case STATE_NONE: str = "NONE"; break; |
Wayne Roberts |
0:d88677306896 | 75 | case STATE_GET_REQ: str = "GET_REQ"; break; |
Wayne Roberts |
0:d88677306896 | 76 | #ifndef UNIT_LAST |
Wayne Roberts |
0:d88677306896 | 77 | case STATE_ACK_WAITING: str = "ACK_WAITING"; break; |
Wayne Roberts |
0:d88677306896 | 78 | case STATE_TX_FORWARD: str = "TX_FORWARD"; break; |
Wayne Roberts |
0:d88677306896 | 79 | #endif /* UNIT_LAST */ |
Wayne Roberts |
0:d88677306896 | 80 | default: |
Wayne Roberts |
0:d88677306896 | 81 | sprintf(out, "??%u??", s); |
Wayne Roberts |
0:d88677306896 | 82 | return; |
Wayne Roberts |
0:d88677306896 | 83 | } |
Wayne Roberts |
0:d88677306896 | 84 | |
Wayne Roberts |
0:d88677306896 | 85 | strcpy(out, str); |
Wayne Roberts |
0:d88677306896 | 86 | } |
Wayne Roberts |
0:d88677306896 | 87 | |
Wayne Roberts |
0:d88677306896 | 88 | typedef union { |
Wayne Roberts |
0:d88677306896 | 89 | struct { |
Wayne Roberts |
0:d88677306896 | 90 | uint8_t attempt : 3; // 0,1,2 |
Wayne Roberts |
0:d88677306896 | 91 | uint8_t fragNum : 4; // 3,4,5,6 |
Wayne Roberts |
0:d88677306896 | 92 | uint8_t fragLast : 1; // 7 |
Wayne Roberts |
0:d88677306896 | 93 | } bits; |
Wayne Roberts |
0:d88677306896 | 94 | uint8_t octet; |
Wayne Roberts |
0:d88677306896 | 95 | } pkt_flags_t; |
Wayne Roberts |
0:d88677306896 | 96 | |
Wayne Roberts |
0:d88677306896 | 97 | volatile struct _f_ { |
Wayne Roberts |
0:d88677306896 | 98 | uint8_t _sleep_ : 1; // 0 |
Wayne Roberts |
0:d88677306896 | 99 | uint8_t mbedTImeout_forwarderStarted: 1; // 1 |
Wayne Roberts |
0:d88677306896 | 100 | uint8_t run : 1; // 2 |
Wayne Roberts |
0:d88677306896 | 101 | } flags; |
Wayne Roberts |
0:d88677306896 | 102 | |
Wayne Roberts |
0:d88677306896 | 103 | |
Wayne Roberts |
0:d88677306896 | 104 | static uint16_t crc16( uint8_t *buffer, uint16_t length ) |
Wayne Roberts |
0:d88677306896 | 105 | { |
Wayne Roberts |
0:d88677306896 | 106 | uint16_t i; |
Wayne Roberts |
0:d88677306896 | 107 | // The CRC calculation follows CCITT |
Wayne Roberts |
0:d88677306896 | 108 | const uint16_t polynom = 0x1021; |
Wayne Roberts |
0:d88677306896 | 109 | // CRC initial value |
Wayne Roberts |
0:d88677306896 | 110 | uint16_t crc = 0x0000; |
Wayne Roberts |
0:d88677306896 | 111 | |
Wayne Roberts |
0:d88677306896 | 112 | if( buffer == NULL ) |
Wayne Roberts |
0:d88677306896 | 113 | { |
Wayne Roberts |
0:d88677306896 | 114 | return 0; |
Wayne Roberts |
0:d88677306896 | 115 | } |
Wayne Roberts |
0:d88677306896 | 116 | |
Wayne Roberts |
0:d88677306896 | 117 | for( i = 0; i < length; ++i ) |
Wayne Roberts |
0:d88677306896 | 118 | { |
Wayne Roberts |
0:d88677306896 | 119 | uint16_t j; |
Wayne Roberts |
0:d88677306896 | 120 | crc ^= ( uint16_t ) buffer[i] << 8; |
Wayne Roberts |
0:d88677306896 | 121 | for( j = 0; j < 8; ++j ) |
Wayne Roberts |
0:d88677306896 | 122 | { |
Wayne Roberts |
0:d88677306896 | 123 | crc = ( crc & 0x8000 ) ? ( crc << 1 ) ^ polynom : ( crc << 1 ); |
Wayne Roberts |
0:d88677306896 | 124 | } |
Wayne Roberts |
0:d88677306896 | 125 | } |
Wayne Roberts |
0:d88677306896 | 126 | |
Wayne Roberts |
0:d88677306896 | 127 | return crc; |
Wayne Roberts |
0:d88677306896 | 128 | } |
Wayne Roberts |
0:d88677306896 | 129 | |
Wayne Roberts |
0:d88677306896 | 130 | #ifdef UNIT_LAST |
Wayne Roberts |
0:d88677306896 | 131 | void print_payload() |
Wayne Roberts |
0:d88677306896 | 132 | { |
Wayne Roberts |
0:d88677306896 | 133 | unsigned n; |
Wayne Roberts |
0:d88677306896 | 134 | |
Wayne Roberts |
0:d88677306896 | 135 | for (n = 0; n < forwardLen; n += sizeof(message_t)) { |
Wayne Roberts |
0:d88677306896 | 136 | const message_t* m = (message_t*)&forward[n]; |
Wayne Roberts |
0:d88677306896 | 137 | |
Wayne Roberts |
0:d88677306896 | 138 | pc.printf("unit %02x: %02x, %u\r\n", m->unit_id, m->flags, m->sample); |
Wayne Roberts |
0:d88677306896 | 139 | } |
Wayne Roberts |
0:d88677306896 | 140 | |
Wayne Roberts |
0:d88677306896 | 141 | } |
Wayne Roberts |
0:d88677306896 | 142 | #endif /* UNIT_LAST */ |
Wayne Roberts |
0:d88677306896 | 143 | |
Wayne Roberts |
0:d88677306896 | 144 | LowPowerTimeout mbedTimeout_nextRx; |
Wayne Roberts |
0:d88677306896 | 145 | volatile unsigned retryInterval_us; |
Wayne Roberts |
0:d88677306896 | 146 | volatile us_timestamp_t rxStartAt; |
Wayne Roberts |
0:d88677306896 | 147 | |
Wayne Roberts |
0:d88677306896 | 148 | |
Wayne Roberts |
0:d88677306896 | 149 | void setupNext() |
Wayne Roberts |
0:d88677306896 | 150 | { |
Wayne Roberts |
0:d88677306896 | 151 | state = STATE_GET_REQ; |
Wayne Roberts |
0:d88677306896 | 152 | forwardLen = 0; |
Wayne Roberts |
0:d88677306896 | 153 | prevFrag = -1; |
Wayne Roberts |
0:d88677306896 | 154 | pc.printf("->GET_REQ "); |
Wayne Roberts |
0:d88677306896 | 155 | if (measuredInterval > 0) { |
Wayne Roberts |
0:d88677306896 | 156 | flags._sleep_ = 1; |
Wayne Roberts |
0:d88677306896 | 157 | Radio::Sleep(); |
Wayne Roberts |
0:d88677306896 | 158 | pc.printf("SLEEP mi:%llu ", measuredInterval); |
Wayne Roberts |
0:d88677306896 | 159 | measuredInterval = 0; // single use |
Wayne Roberts |
0:d88677306896 | 160 | } else { |
Wayne Roberts |
0:d88677306896 | 161 | flags._sleep_ = 0; |
Wayne Roberts |
1:7dbf0926e146 | 162 | Radio::Rx(0); |
Wayne Roberts |
0:d88677306896 | 163 | |
Wayne Roberts |
0:d88677306896 | 164 | rxStartAt = 0; // starting of continuous rx not used |
Wayne Roberts |
0:d88677306896 | 165 | |
Wayne Roberts |
0:d88677306896 | 166 | pc.printf("RX "); |
Wayne Roberts |
0:d88677306896 | 167 | } |
Wayne Roberts |
0:d88677306896 | 168 | |
Wayne Roberts |
0:d88677306896 | 169 | memset(forward, 0xff, EXPECTED_LENGTH); |
Wayne Roberts |
0:d88677306896 | 170 | } |
Wayne Roberts |
0:d88677306896 | 171 | |
Wayne Roberts |
0:d88677306896 | 172 | LowPowerTimeout mbedTImeout_forwarder; |
Wayne Roberts |
0:d88677306896 | 173 | |
Wayne Roberts |
1:7dbf0926e146 | 174 | |
Wayne Roberts |
0:d88677306896 | 175 | #ifndef UNIT_LAST |
Wayne Roberts |
0:d88677306896 | 176 | volatile uint8_t txCurs; |
Wayne Roberts |
0:d88677306896 | 177 | |
Wayne Roberts |
0:d88677306896 | 178 | LowPowerTicker tickerRetry; |
Wayne Roberts |
1:7dbf0926e146 | 179 | volatile us_timestamp_t txStartAt; |
Wayne Roberts |
0:d88677306896 | 180 | |
Wayne Roberts |
0:d88677306896 | 181 | void retry_cb() |
Wayne Roberts |
0:d88677306896 | 182 | { |
Wayne Roberts |
0:d88677306896 | 183 | unsigned c; |
Wayne Roberts |
0:d88677306896 | 184 | pkt_flags_t f; |
Wayne Roberts |
0:d88677306896 | 185 | |
Wayne Roberts |
1:7dbf0926e146 | 186 | Radio::Standby(); |
Wayne Roberts |
1:7dbf0926e146 | 187 | |
Wayne Roberts |
0:d88677306896 | 188 | f.octet = Radio::radio.tx_buf[1]; |
Wayne Roberts |
0:d88677306896 | 189 | pc.printf("attempt%u", f.bits.attempt); |
Wayne Roberts |
0:d88677306896 | 190 | if (++f.bits.attempt >= MAX_TX_ATTEMPTS) { |
Wayne Roberts |
0:d88677306896 | 191 | pc.printf(" lastTry"); |
Wayne Roberts |
0:d88677306896 | 192 | tickerRetry.detach(); |
Wayne Roberts |
1:7dbf0926e146 | 193 | #if (UNIT_ID == 0x00) |
Wayne Roberts |
1:7dbf0926e146 | 194 | flags._sleep_ = 1; |
Wayne Roberts |
1:7dbf0926e146 | 195 | #else |
Wayne Roberts |
0:d88677306896 | 196 | setupNext(); |
Wayne Roberts |
0:d88677306896 | 197 | #endif /* UNIT_ID != 0x00 */ |
Wayne Roberts |
0:d88677306896 | 198 | pc.printf("\r\n"); |
Wayne Roberts |
0:d88677306896 | 199 | return; |
Wayne Roberts |
0:d88677306896 | 200 | } |
Wayne Roberts |
0:d88677306896 | 201 | pc.printf("->%u\r\n", f.bits.attempt); |
Wayne Roberts |
0:d88677306896 | 202 | Radio::radio.tx_buf[1] = f.octet; |
Wayne Roberts |
0:d88677306896 | 203 | |
Wayne Roberts |
0:d88677306896 | 204 | c = crc16(Radio::radio.tx_buf, txCurs-2); |
Wayne Roberts |
0:d88677306896 | 205 | Radio::radio.tx_buf[txCurs-2] = c >> 8; |
Wayne Roberts |
0:d88677306896 | 206 | Radio::radio.tx_buf[txCurs-1] = c; |
Wayne Roberts |
0:d88677306896 | 207 | |
Wayne Roberts |
1:7dbf0926e146 | 208 | txStartAt = Radio::lpt.read_us(); |
Wayne Roberts |
0:d88677306896 | 209 | Radio::Send(txCurs, 0, 0, 0); |
Wayne Roberts |
0:d88677306896 | 210 | state = STATE_ACK_WAITING; |
Wayne Roberts |
0:d88677306896 | 211 | } |
Wayne Roberts |
0:d88677306896 | 212 | |
Wayne Roberts |
0:d88677306896 | 213 | uint8_t _tx_forward() |
Wayne Roberts |
0:d88677306896 | 214 | { |
Wayne Roberts |
0:d88677306896 | 215 | unsigned fwdLen; |
Wayne Roberts |
0:d88677306896 | 216 | unsigned c; |
Wayne Roberts |
0:d88677306896 | 217 | uint8_t added, avail, toSendLen, stop = MAX_TX_LENGTH-2; |
Wayne Roberts |
0:d88677306896 | 218 | pkt_flags_t f; |
Wayne Roberts |
0:d88677306896 | 219 | |
Wayne Roberts |
0:d88677306896 | 220 | tickerRetry.attach_us(retry_cb, retryInterval_us); |
Wayne Roberts |
0:d88677306896 | 221 | |
Wayne Roberts |
0:d88677306896 | 222 | if (forwardLen < EXPECTED_LENGTH) { |
Wayne Roberts |
0:d88677306896 | 223 | pc.printf("\e[31mmissing %u bytes\e[0m ", EXPECTED_LENGTH - forwardLen); |
Wayne Roberts |
0:d88677306896 | 224 | fwdLen = EXPECTED_LENGTH; |
Wayne Roberts |
0:d88677306896 | 225 | } |
Wayne Roberts |
0:d88677306896 | 226 | fwdLen = forwardLen; |
Wayne Roberts |
0:d88677306896 | 227 | |
Wayne Roberts |
0:d88677306896 | 228 | f.octet = Radio::radio.tx_buf[1]; |
Wayne Roberts |
0:d88677306896 | 229 | |
Wayne Roberts |
0:d88677306896 | 230 | txCurs = 0; |
Wayne Roberts |
0:d88677306896 | 231 | Radio::radio.tx_buf[txCurs++] = UNIT_ID; |
Wayne Roberts |
0:d88677306896 | 232 | txCurs++; // placeholder for flags to be added at end |
Wayne Roberts |
0:d88677306896 | 233 | |
Wayne Roberts |
0:d88677306896 | 234 | toSendLen = fwdLen - forwardLenAckd; |
Wayne Roberts |
0:d88677306896 | 235 | forwardLenTransmitted = forwardLenAckd; |
Wayne Roberts |
0:d88677306896 | 236 | added = 0; |
Wayne Roberts |
0:d88677306896 | 237 | while ((txCurs + sizeof(message_t)) < stop && added < toSendLen) { |
Wayne Roberts |
0:d88677306896 | 238 | memcpy(Radio::radio.tx_buf + txCurs, forward + forwardLenTransmitted, sizeof(message_t)); |
Wayne Roberts |
0:d88677306896 | 239 | forwardLenTransmitted += sizeof(message_t); |
Wayne Roberts |
0:d88677306896 | 240 | txCurs += sizeof(message_t); |
Wayne Roberts |
0:d88677306896 | 241 | added += sizeof(message_t); |
Wayne Roberts |
0:d88677306896 | 242 | } |
Wayne Roberts |
0:d88677306896 | 243 | |
Wayne Roberts |
0:d88677306896 | 244 | avail = stop - txCurs; |
Wayne Roberts |
0:d88677306896 | 245 | if (avail >= sizeof(message_t)) { |
Wayne Roberts |
0:d88677306896 | 246 | message_t* mptr = (message_t*)(Radio::radio.tx_buf + txCurs); |
Wayne Roberts |
0:d88677306896 | 247 | mptr->unit_id = UNIT_ID; |
Wayne Roberts |
0:d88677306896 | 248 | mptr->flags = 0x00; |
Wayne Roberts |
0:d88677306896 | 249 | mptr->sample = ain.read_u16(); |
Wayne Roberts |
0:d88677306896 | 250 | #ifdef N_SMP |
Wayne Roberts |
0:d88677306896 | 251 | for (c = 0; c < N_SMP; c++) |
Wayne Roberts |
0:d88677306896 | 252 | mptr->samples[c] = ain.read_u16(); |
Wayne Roberts |
0:d88677306896 | 253 | #endif |
Wayne Roberts |
0:d88677306896 | 254 | txCurs += sizeof(message_t); |
Wayne Roberts |
0:d88677306896 | 255 | |
Wayne Roberts |
0:d88677306896 | 256 | f.bits.fragLast = 1; |
Wayne Roberts |
0:d88677306896 | 257 | } |
Wayne Roberts |
0:d88677306896 | 258 | |
Wayne Roberts |
0:d88677306896 | 259 | Radio::radio.tx_buf[1] = f.octet; |
Wayne Roberts |
0:d88677306896 | 260 | |
Wayne Roberts |
0:d88677306896 | 261 | c = crc16(Radio::radio.tx_buf, txCurs); |
Wayne Roberts |
0:d88677306896 | 262 | Radio::radio.tx_buf[txCurs++] = c >> 8; |
Wayne Roberts |
0:d88677306896 | 263 | Radio::radio.tx_buf[txCurs++] = c; |
Wayne Roberts |
0:d88677306896 | 264 | |
Wayne Roberts |
1:7dbf0926e146 | 265 | /*Radio::set_tx_dbm(17); |
Wayne Roberts |
1:7dbf0926e146 | 266 | Radio::PrintStatus();*/ |
Wayne Roberts |
0:d88677306896 | 267 | Radio::Send(txCurs, 0, 0, 0); |
Wayne Roberts |
0:d88677306896 | 268 | state = STATE_ACK_WAITING; |
Wayne Roberts |
0:d88677306896 | 269 | flags._sleep_ = 0; |
Wayne Roberts |
0:d88677306896 | 270 | |
Wayne Roberts |
0:d88677306896 | 271 | return txCurs; |
Wayne Roberts |
0:d88677306896 | 272 | } // .._tx_forward() |
Wayne Roberts |
0:d88677306896 | 273 | |
Wayne Roberts |
0:d88677306896 | 274 | volatile us_timestamp_t prevFwdStart; |
Wayne Roberts |
0:d88677306896 | 275 | |
Wayne Roberts |
0:d88677306896 | 276 | void tx_forward_cb() |
Wayne Roberts |
0:d88677306896 | 277 | { |
Wayne Roberts |
0:d88677306896 | 278 | unsigned dur; |
Wayne Roberts |
0:d88677306896 | 279 | uint8_t txlen; |
Wayne Roberts |
0:d88677306896 | 280 | us_timestamp_t now; |
Wayne Roberts |
0:d88677306896 | 281 | |
Wayne Roberts |
0:d88677306896 | 282 | now = Radio::lpt.read_us(); |
Wayne Roberts |
0:d88677306896 | 283 | |
Wayne Roberts |
0:d88677306896 | 284 | if (measuredIntervalSaved != 0) // in case nothing received |
Wayne Roberts |
0:d88677306896 | 285 | mbedTImeout_forwarder.attach_us(tx_forward_cb, measuredIntervalSaved); |
Wayne Roberts |
0:d88677306896 | 286 | |
Wayne Roberts |
0:d88677306896 | 287 | Radio::radio.tx_buf[1] = 0; //initialize flags |
Wayne Roberts |
0:d88677306896 | 288 | forwardLenAckd = 0; |
Wayne Roberts |
0:d88677306896 | 289 | |
Wayne Roberts |
0:d88677306896 | 290 | txlen = _tx_forward(); |
Wayne Roberts |
0:d88677306896 | 291 | |
Wayne Roberts |
0:d88677306896 | 292 | flags.mbedTImeout_forwarderStarted = 0; |
Wayne Roberts |
0:d88677306896 | 293 | |
Wayne Roberts |
0:d88677306896 | 294 | dur = Radio::lora_toa_us(txlen); |
Wayne Roberts |
0:d88677306896 | 295 | pc.printf("\e[7mtx_forward_cb %d", now - prevFwdStart - TX_INTERVAL_US); |
Wayne Roberts |
0:d88677306896 | 296 | pc.printf(" dur%u\e[0m\r\n", dur); |
Wayne Roberts |
0:d88677306896 | 297 | prevFwdStart = now; |
Wayne Roberts |
0:d88677306896 | 298 | } |
Wayne Roberts |
0:d88677306896 | 299 | #else // ..UNIT_LAST: |
Wayne Roberts |
0:d88677306896 | 300 | void uart_forward_cb() |
Wayne Roberts |
0:d88677306896 | 301 | { |
Wayne Roberts |
0:d88677306896 | 302 | if (measuredIntervalSaved != 0) // in case nothing received |
Wayne Roberts |
0:d88677306896 | 303 | mbedTImeout_forwarder.attach_us(uart_forward_cb, measuredIntervalSaved); |
Wayne Roberts |
0:d88677306896 | 304 | |
Wayne Roberts |
0:d88677306896 | 305 | forwardLenAckd = 0; |
Wayne Roberts |
0:d88677306896 | 306 | print_payload(); |
Wayne Roberts |
0:d88677306896 | 307 | |
Wayne Roberts |
0:d88677306896 | 308 | setupNext(); |
Wayne Roberts |
0:d88677306896 | 309 | |
Wayne Roberts |
0:d88677306896 | 310 | flags.mbedTImeout_forwarderStarted = 0; |
Wayne Roberts |
0:d88677306896 | 311 | } |
Wayne Roberts |
0:d88677306896 | 312 | #endif /* UNIT_LAST */ |
Wayne Roberts |
0:d88677306896 | 313 | |
Wayne Roberts |
0:d88677306896 | 314 | void nextRxStartCB() |
Wayne Roberts |
0:d88677306896 | 315 | { |
Wayne Roberts |
0:d88677306896 | 316 | unsigned us; |
Wayne Roberts |
0:d88677306896 | 317 | |
Wayne Roberts |
1:7dbf0926e146 | 318 | Radio::Rx(0); |
Wayne Roberts |
0:d88677306896 | 319 | rxStartAt = Radio::lpt.read_us(); |
Wayne Roberts |
0:d88677306896 | 320 | flags._sleep_ = 0; |
Wayne Roberts |
0:d88677306896 | 321 | |
Wayne Roberts |
0:d88677306896 | 322 | us = (MAX_TX_ATTEMPTS * retryInterval_us) + (MAX_TX_ATTEMPTS * TXRX_PADDING_US); |
Wayne Roberts |
0:d88677306896 | 323 | |
Wayne Roberts |
0:d88677306896 | 324 | pc.printf("nextRxStartCB for %uus\r\n", us); |
Wayne Roberts |
0:d88677306896 | 325 | } |
Wayne Roberts |
0:d88677306896 | 326 | |
Wayne Roberts |
0:d88677306896 | 327 | |
Wayne Roberts |
0:d88677306896 | 328 | void txDoneCB() |
Wayne Roberts |
0:d88677306896 | 329 | { |
Wayne Roberts |
0:d88677306896 | 330 | char str[32]; |
Wayne Roberts |
0:d88677306896 | 331 | |
Wayne Roberts |
1:7dbf0926e146 | 332 | Radio::Rx(0); |
Wayne Roberts |
0:d88677306896 | 333 | stateToString(state, str); |
Wayne Roberts |
0:d88677306896 | 334 | pc.printf("%s:txDone->Rx\r\n", str); |
Wayne Roberts |
0:d88677306896 | 335 | } |
Wayne Roberts |
0:d88677306896 | 336 | |
Wayne Roberts |
0:d88677306896 | 337 | void rxDoneCB(uint8_t size, float rssi, float snr) |
Wayne Roberts |
0:d88677306896 | 338 | { |
Wayne Roberts |
0:d88677306896 | 339 | pkt_flags_t f; |
Wayne Roberts |
0:d88677306896 | 340 | char str[32]; |
Wayne Roberts |
0:d88677306896 | 341 | us_timestamp_t rxIrqAt = Radio::irqAt; |
Wayne Roberts |
0:d88677306896 | 342 | |
Wayne Roberts |
0:d88677306896 | 343 | stateToString(state, str); |
Wayne Roberts |
0:d88677306896 | 344 | pc.printf("\e[33mrxDoneCB() %u rssi:%.1fdBm snr:%.1fdB %s ID:%02x\e[0m ", size, rssi, snr, str, Radio::radio.rx_buf[0]); |
Wayne Roberts |
0:d88677306896 | 345 | if (state == STATE_GET_REQ) { |
Wayne Roberts |
0:d88677306896 | 346 | uint8_t len; |
Wayne Roberts |
0:d88677306896 | 347 | unsigned c, rxc; |
Wayne Roberts |
0:d88677306896 | 348 | if (Radio::radio.rx_buf[0] != UNIT_ID-1) { |
Wayne Roberts |
0:d88677306896 | 349 | pc.printf("\r\n"); |
Wayne Roberts |
0:d88677306896 | 350 | return; |
Wayne Roberts |
0:d88677306896 | 351 | } |
Wayne Roberts |
0:d88677306896 | 352 | if (size < 4) { |
Wayne Roberts |
0:d88677306896 | 353 | /* minimum: header + crc */ |
Wayne Roberts |
0:d88677306896 | 354 | pc.printf("\r\n"); |
Wayne Roberts |
0:d88677306896 | 355 | return; |
Wayne Roberts |
0:d88677306896 | 356 | } |
Wayne Roberts |
0:d88677306896 | 357 | f.octet = Radio::radio.rx_buf[1]; |
Wayne Roberts |
0:d88677306896 | 358 | |
Wayne Roberts |
0:d88677306896 | 359 | c = crc16(Radio::radio.rx_buf, size-2); |
Wayne Roberts |
0:d88677306896 | 360 | rxc = Radio::radio.rx_buf[size-2]; |
Wayne Roberts |
0:d88677306896 | 361 | rxc <<= 8; |
Wayne Roberts |
0:d88677306896 | 362 | rxc |= Radio::radio.rx_buf[size-1]; |
Wayne Roberts |
0:d88677306896 | 363 | if (c != rxc) { |
Wayne Roberts |
0:d88677306896 | 364 | pc.printf("\e[31mfrom%02x c:%04x rxc:%04x\e[0m\r\n", Radio::radio.rx_buf[0], c, rxc); |
Wayne Roberts |
0:d88677306896 | 365 | for (unsigned n = 0; n < size; n++) |
Wayne Roberts |
0:d88677306896 | 366 | pc.printf("%02x ", Radio::radio.rx_buf[n]); |
Wayne Roberts |
0:d88677306896 | 367 | pc.printf("\r\n"); |
Wayne Roberts |
0:d88677306896 | 368 | return; |
Wayne Roberts |
0:d88677306896 | 369 | } |
Wayne Roberts |
0:d88677306896 | 370 | //noRxTimeout.detach(); |
Wayne Roberts |
0:d88677306896 | 371 | |
Wayne Roberts |
0:d88677306896 | 372 | pc.printf(" attempt%u frag%u fragLast%u ", f.bits.attempt, f.bits.fragNum, f.bits.fragLast); |
Wayne Roberts |
0:d88677306896 | 373 | if (state == STATE_GET_REQ && flags.mbedTImeout_forwarderStarted == 0 && f.bits.fragLast) { |
Wayne Roberts |
0:d88677306896 | 374 | us_timestamp_t now; |
Wayne Roberts |
0:d88677306896 | 375 | unsigned sinceRxDone, us; |
Wayne Roberts |
0:d88677306896 | 376 | mbedTImeout_forwarder.detach(); |
Wayne Roberts |
0:d88677306896 | 377 | now = Radio::lpt.read_us(); |
Wayne Roberts |
0:d88677306896 | 378 | sinceRxDone = now - rxIrqAt; |
Wayne Roberts |
0:d88677306896 | 379 | us = retryInterval_us * (MAX_TX_ATTEMPTS - f.bits.attempt); |
Wayne Roberts |
0:d88677306896 | 380 | int target_us = us - sinceRxDone; |
Wayne Roberts |
0:d88677306896 | 381 | // tx to occur after time given for all potential retries |
Wayne Roberts |
0:d88677306896 | 382 | #ifndef UNIT_LAST |
Wayne Roberts |
0:d88677306896 | 383 | mbedTImeout_forwarder.attach_us(tx_forward_cb, target_us); |
Wayne Roberts |
0:d88677306896 | 384 | #else |
Wayne Roberts |
0:d88677306896 | 385 | mbedTImeout_forwarder.attach_us(uart_forward_cb, target_us); |
Wayne Roberts |
0:d88677306896 | 386 | #endif /* UNIT_LAST */ |
Wayne Roberts |
0:d88677306896 | 387 | pc.printf("schedule forward %u, forwarding in %dus. sinceRxDone:%u\r\n", MAX_TX_ATTEMPTS - f.bits.attempt, target_us, sinceRxDone); |
Wayne Roberts |
0:d88677306896 | 388 | flags.mbedTImeout_forwarderStarted = 1; |
Wayne Roberts |
0:d88677306896 | 389 | forwardedAt = now + target_us; |
Wayne Roberts |
0:d88677306896 | 390 | } |
Wayne Roberts |
0:d88677306896 | 391 | |
Wayne Roberts |
0:d88677306896 | 392 | Radio::radio.tx_buf[0] = UNIT_ID; // OK, send ACK |
Wayne Roberts |
1:7dbf0926e146 | 393 | /*YYY Radio::set_tx_dbm(17); |
Wayne Roberts |
1:7dbf0926e146 | 394 | Radio::PrintStatus();*/ |
Wayne Roberts |
0:d88677306896 | 395 | Radio::Send(1, 0, 0, 0); |
Wayne Roberts |
0:d88677306896 | 396 | |
Wayne Roberts |
0:d88677306896 | 397 | |
Wayne Roberts |
0:d88677306896 | 398 | if (prevFrag != f.bits.fragNum) { |
Wayne Roberts |
0:d88677306896 | 399 | len = size - 4; // -4: header ... crc |
Wayne Roberts |
0:d88677306896 | 400 | memcpy(forward + forwardLen, Radio::radio.rx_buf+2, len); |
Wayne Roberts |
0:d88677306896 | 401 | forwardLen += len; |
Wayne Roberts |
0:d88677306896 | 402 | |
Wayne Roberts |
0:d88677306896 | 403 | prevFrag = f.bits.fragNum; |
Wayne Roberts |
0:d88677306896 | 404 | } |
Wayne Roberts |
0:d88677306896 | 405 | |
Wayne Roberts |
0:d88677306896 | 406 | if (f.bits.fragNum == 0) { |
Wayne Roberts |
0:d88677306896 | 407 | unsigned attemptOffset = retryInterval_us * f.bits.attempt; |
Wayne Roberts |
0:d88677306896 | 408 | if (rxStartAt == 0) { |
Wayne Roberts |
0:d88677306896 | 409 | pc.printf("\e[7m"); |
Wayne Roberts |
0:d88677306896 | 410 | } |
Wayne Roberts |
0:d88677306896 | 411 | pc.printf("lastRxIrqAt:%u measuredInterval:%llu ", lastRxIrqAt, measuredInterval); |
Wayne Roberts |
0:d88677306896 | 412 | if (lastRxIrqAt != 0) { |
Wayne Roberts |
0:d88677306896 | 413 | us_timestamp_t thisMeas; |
Wayne Roberts |
0:d88677306896 | 414 | int err_; |
Wayne Roberts |
0:d88677306896 | 415 | unsigned abserr; |
Wayne Roberts |
0:d88677306896 | 416 | thisMeas = (rxIrqAt - attemptOffset) - lastRxIrqAt; |
Wayne Roberts |
0:d88677306896 | 417 | err_ = thisMeas - TX_INTERVAL_US; |
Wayne Roberts |
0:d88677306896 | 418 | if (TX_INTERVAL_US > thisMeas) |
Wayne Roberts |
0:d88677306896 | 419 | abserr = TX_INTERVAL_US - thisMeas; |
Wayne Roberts |
0:d88677306896 | 420 | else |
Wayne Roberts |
0:d88677306896 | 421 | abserr = thisMeas - TX_INTERVAL_US; |
Wayne Roberts |
0:d88677306896 | 422 | |
Wayne Roberts |
0:d88677306896 | 423 | pc.printf(" this:%llu err_:%d ", thisMeas, err_); |
Wayne Roberts |
0:d88677306896 | 424 | if (abserr < MEASURED_MAX_ERR) { |
Wayne Roberts |
0:d88677306896 | 425 | int rxPrecedency = 0; |
Wayne Roberts |
0:d88677306896 | 426 | unsigned sinceRxDone, _us_; |
Wayne Roberts |
0:d88677306896 | 427 | unsigned pktDur = Radio::lora_toa_us(size); |
Wayne Roberts |
0:d88677306896 | 428 | us_timestamp_t firstAttemptStartedAt = (rxIrqAt - attemptOffset) - pktDur; |
Wayne Roberts |
0:d88677306896 | 429 | |
Wayne Roberts |
0:d88677306896 | 430 | measuredInterval = thisMeas; |
Wayne Roberts |
0:d88677306896 | 431 | _us_ = measuredInterval; |
Wayne Roberts |
0:d88677306896 | 432 | pc.printf("->%llu ", measuredInterval); |
Wayne Roberts |
0:d88677306896 | 433 | |
Wayne Roberts |
0:d88677306896 | 434 | if (rxStartAt != 0) { |
Wayne Roberts |
0:d88677306896 | 435 | rxPrecedency = firstAttemptStartedAt - rxStartAt; |
Wayne Roberts |
0:d88677306896 | 436 | if (rxPrecedency > 0) |
Wayne Roberts |
0:d88677306896 | 437 | _us_ += rxPrecedency / 2; |
Wayne Roberts |
0:d88677306896 | 438 | else |
Wayne Roberts |
0:d88677306896 | 439 | _us_ += rxPrecedency; |
Wayne Roberts |
0:d88677306896 | 440 | } |
Wayne Roberts |
0:d88677306896 | 441 | |
Wayne Roberts |
0:d88677306896 | 442 | _us_ -= rxStartup_us; |
Wayne Roberts |
0:d88677306896 | 443 | _us_ -= retryInterval_us; // TODO |
Wayne Roberts |
0:d88677306896 | 444 | mbedTimeout_nextRx.detach(); |
Wayne Roberts |
0:d88677306896 | 445 | sinceRxDone = Radio::lpt.read_us() - rxIrqAt; |
Wayne Roberts |
0:d88677306896 | 446 | mbedTimeout_nextRx.attach_us(nextRxStartCB, _us_ - sinceRxDone); |
Wayne Roberts |
0:d88677306896 | 447 | pc.printf("nextRx:%u ao%u rxPrecedency:%d pktDur%u ri%u sinceRxDone%u ", _us_ - sinceRxDone, attemptOffset, rxPrecedency, pktDur, retryInterval_us, sinceRxDone); |
Wayne Roberts |
0:d88677306896 | 448 | |
Wayne Roberts |
0:d88677306896 | 449 | if (measuredIntervalSaved == 0) |
Wayne Roberts |
0:d88677306896 | 450 | measuredIntervalSaved = measuredInterval; |
Wayne Roberts |
0:d88677306896 | 451 | else { |
Wayne Roberts |
0:d88677306896 | 452 | measuredIntervalSaved += measuredInterval; |
Wayne Roberts |
0:d88677306896 | 453 | measuredIntervalSaved /= 2; |
Wayne Roberts |
0:d88677306896 | 454 | } |
Wayne Roberts |
0:d88677306896 | 455 | |
Wayne Roberts |
0:d88677306896 | 456 | rxStartAt = 0; |
Wayne Roberts |
0:d88677306896 | 457 | } else |
Wayne Roberts |
0:d88677306896 | 458 | pc.printf("\e[31mtoo-much-err\e[0m\r\n"); |
Wayne Roberts |
0:d88677306896 | 459 | |
Wayne Roberts |
0:d88677306896 | 460 | pc.printf("\r\n"); |
Wayne Roberts |
0:d88677306896 | 461 | } // ..if (lastRxIrqAt != 0) |
Wayne Roberts |
0:d88677306896 | 462 | |
Wayne Roberts |
0:d88677306896 | 463 | lastRxIrqAt = rxIrqAt - attemptOffset; |
Wayne Roberts |
0:d88677306896 | 464 | |
Wayne Roberts |
0:d88677306896 | 465 | pc.printf("\e[0m"); |
Wayne Roberts |
0:d88677306896 | 466 | } // ..if (f.bits.fragNum == 0) |
Wayne Roberts |
0:d88677306896 | 467 | |
Wayne Roberts |
0:d88677306896 | 468 | } // ..if (state == STATE_GET_REQ) |
Wayne Roberts |
0:d88677306896 | 469 | #ifndef UNIT_LAST |
Wayne Roberts |
0:d88677306896 | 470 | else if (state == STATE_ACK_WAITING) { |
Wayne Roberts |
0:d88677306896 | 471 | |
Wayne Roberts |
0:d88677306896 | 472 | if (Radio::radio.rx_buf[0] == UNIT_ID+1) { |
Wayne Roberts |
0:d88677306896 | 473 | pkt_flags_t f; |
Wayne Roberts |
0:d88677306896 | 474 | f.octet = Radio::radio.tx_buf[1]; |
Wayne Roberts |
0:d88677306896 | 475 | |
Wayne Roberts |
0:d88677306896 | 476 | tickerRetry.detach(); |
Wayne Roberts |
0:d88677306896 | 477 | forwardLenAckd = forwardLenTransmitted; |
Wayne Roberts |
0:d88677306896 | 478 | if (f.bits.fragLast) { |
Wayne Roberts |
0:d88677306896 | 479 | pc.printf("ackOk-last "); |
Wayne Roberts |
0:d88677306896 | 480 | #if (UNIT_ID == 0x00) |
Wayne Roberts |
0:d88677306896 | 481 | pc.printf("->SLEEP "); |
Wayne Roberts |
0:d88677306896 | 482 | flags._sleep_ = 1; |
Wayne Roberts |
0:d88677306896 | 483 | Radio::Sleep(); |
Wayne Roberts |
0:d88677306896 | 484 | #else |
Wayne Roberts |
0:d88677306896 | 485 | setupNext(); |
Wayne Roberts |
0:d88677306896 | 486 | #endif /* UNIT_ID != 0x00 */ |
Wayne Roberts |
0:d88677306896 | 487 | } else { |
Wayne Roberts |
0:d88677306896 | 488 | f.bits.fragNum++; |
Wayne Roberts |
0:d88677306896 | 489 | f.bits.attempt = 0; |
Wayne Roberts |
0:d88677306896 | 490 | Radio::radio.tx_buf[1] = f.octet; |
Wayne Roberts |
0:d88677306896 | 491 | _tx_forward(); |
Wayne Roberts |
0:d88677306896 | 492 | pc.printf("ackOk->%u ", f.bits.fragNum); |
Wayne Roberts |
0:d88677306896 | 493 | } |
Wayne Roberts |
0:d88677306896 | 494 | } else |
Wayne Roberts |
0:d88677306896 | 495 | pc.printf("ack from different ID %02x\r\n", Radio::radio.rx_buf[0]); |
Wayne Roberts |
0:d88677306896 | 496 | } |
Wayne Roberts |
0:d88677306896 | 497 | #endif /* UNIT_LAST */ |
Wayne Roberts |
0:d88677306896 | 498 | |
Wayne Roberts |
0:d88677306896 | 499 | pc.printf("\r\n"); |
Wayne Roberts |
0:d88677306896 | 500 | } // ..rxDoneCB() |
Wayne Roberts |
0:d88677306896 | 501 | |
Wayne Roberts |
0:d88677306896 | 502 | #if (UNIT_ID == 0x00) && !defined(UNIT_LAST) |
Wayne Roberts |
0:d88677306896 | 503 | LowPowerTicker lpTicker; |
Wayne Roberts |
0:d88677306896 | 504 | |
Wayne Roberts |
0:d88677306896 | 505 | void tx_ticker_cb(void) { |
Wayne Roberts |
0:d88677306896 | 506 | unsigned c; |
Wayne Roberts |
0:d88677306896 | 507 | pkt_flags_t f; |
Wayne Roberts |
0:d88677306896 | 508 | message_t* mptr; |
Wayne Roberts |
0:d88677306896 | 509 | |
Wayne Roberts |
0:d88677306896 | 510 | tickerRetry.attach_us(retry_cb, retryInterval_us); |
Wayne Roberts |
0:d88677306896 | 511 | |
Wayne Roberts |
0:d88677306896 | 512 | f.bits.attempt = 0; |
Wayne Roberts |
0:d88677306896 | 513 | f.bits.fragNum = 0; |
Wayne Roberts |
0:d88677306896 | 514 | f.bits.fragLast = 1; |
Wayne Roberts |
0:d88677306896 | 515 | |
Wayne Roberts |
1:7dbf0926e146 | 516 | Radio::Standby(); |
Wayne Roberts |
1:7dbf0926e146 | 517 | |
Wayne Roberts |
0:d88677306896 | 518 | txCurs = 0; |
Wayne Roberts |
0:d88677306896 | 519 | Radio::radio.tx_buf[txCurs++] = UNIT_ID; |
Wayne Roberts |
0:d88677306896 | 520 | Radio::radio.tx_buf[txCurs++] = f.octet; |
Wayne Roberts |
0:d88677306896 | 521 | |
Wayne Roberts |
0:d88677306896 | 522 | mptr = (message_t*)(Radio::radio.tx_buf + txCurs); |
Wayne Roberts |
0:d88677306896 | 523 | mptr->unit_id = UNIT_ID; |
Wayne Roberts |
0:d88677306896 | 524 | mptr->flags = 0x00; |
Wayne Roberts |
0:d88677306896 | 525 | mptr->sample = ain.read_u16(); |
Wayne Roberts |
0:d88677306896 | 526 | #ifdef N_SMP |
Wayne Roberts |
0:d88677306896 | 527 | for (c = 0; c < N_SMP; c++) |
Wayne Roberts |
0:d88677306896 | 528 | mptr->samples[c] = ain.read_u16(); |
Wayne Roberts |
0:d88677306896 | 529 | #endif |
Wayne Roberts |
0:d88677306896 | 530 | txCurs += sizeof(message_t); |
Wayne Roberts |
0:d88677306896 | 531 | |
Wayne Roberts |
0:d88677306896 | 532 | c = crc16(Radio::radio.tx_buf, txCurs); |
Wayne Roberts |
0:d88677306896 | 533 | Radio::radio.tx_buf[txCurs++] = c >> 8; |
Wayne Roberts |
0:d88677306896 | 534 | Radio::radio.tx_buf[txCurs++] = c; |
Wayne Roberts |
0:d88677306896 | 535 | |
Wayne Roberts |
0:d88677306896 | 536 | Radio::Send(txCurs, 0, 0, 0); |
Wayne Roberts |
1:7dbf0926e146 | 537 | txStartAt = Radio::lpt.read_us(); |
Wayne Roberts |
0:d88677306896 | 538 | state = STATE_ACK_WAITING; |
Wayne Roberts |
1:7dbf0926e146 | 539 | pc.printf("tx_ticker_cb:%u\r\n", mptr->sample); |
Wayne Roberts |
0:d88677306896 | 540 | flags._sleep_ = 0; |
Wayne Roberts |
0:d88677306896 | 541 | } |
Wayne Roberts |
0:d88677306896 | 542 | #endif /* UNIT_ID == 0x00 */ |
Wayne Roberts |
0:d88677306896 | 543 | |
Wayne Roberts |
1:7dbf0926e146 | 544 | |
Wayne Roberts |
0:d88677306896 | 545 | void uart_rx() |
Wayne Roberts |
0:d88677306896 | 546 | { |
Wayne Roberts |
0:d88677306896 | 547 | char str[32]; |
Wayne Roberts |
0:d88677306896 | 548 | |
Wayne Roberts |
0:d88677306896 | 549 | char ch = pc.getc(); |
Wayne Roberts |
0:d88677306896 | 550 | switch (ch) { |
Wayne Roberts |
0:d88677306896 | 551 | case '+': |
Wayne Roberts |
0:d88677306896 | 552 | rxStartup_us += 500; |
Wayne Roberts |
0:d88677306896 | 553 | pc.printf("rxStartup_us:%u\r\n", rxStartup_us); |
Wayne Roberts |
0:d88677306896 | 554 | break; |
Wayne Roberts |
0:d88677306896 | 555 | case '-': |
Wayne Roberts |
0:d88677306896 | 556 | if (rxStartup_us > 500) |
Wayne Roberts |
0:d88677306896 | 557 | rxStartup_us -= 500; |
Wayne Roberts |
0:d88677306896 | 558 | pc.printf("rxStartup_us:%u\r\n", rxStartup_us); |
Wayne Roberts |
0:d88677306896 | 559 | break; |
Wayne Roberts |
0:d88677306896 | 560 | case '.': |
Wayne Roberts |
1:7dbf0926e146 | 561 | //Radio::PrintStatus(); |
Wayne Roberts |
0:d88677306896 | 562 | printf("UNIT_ID:%02x ", UNIT_ID); |
Wayne Roberts |
0:d88677306896 | 563 | printf(" measuredInterval:%llu\r\n", measuredInterval); |
Wayne Roberts |
0:d88677306896 | 564 | stateToString(state, str); |
Wayne Roberts |
0:d88677306896 | 565 | printf("_sleep_:%u %s\r\n", flags._sleep_, str); |
Wayne Roberts |
0:d88677306896 | 566 | break; |
Wayne Roberts |
0:d88677306896 | 567 | case 'r': |
Wayne Roberts |
0:d88677306896 | 568 | flags.run ^= 1; |
Wayne Roberts |
0:d88677306896 | 569 | printf("\r\nrun %u\r\n", flags.run); |
Wayne Roberts |
0:d88677306896 | 570 | if (flags.run == 0) { |
Wayne Roberts |
0:d88677306896 | 571 | #ifndef UNIT_LAST |
Wayne Roberts |
0:d88677306896 | 572 | tickerRetry.detach(); |
Wayne Roberts |
0:d88677306896 | 573 | #endif /* !UNIT_LAST */ |
Wayne Roberts |
0:d88677306896 | 574 | mbedTImeout_forwarder.detach(); |
Wayne Roberts |
0:d88677306896 | 575 | mbedTimeout_nextRx.detach(); |
Wayne Roberts |
0:d88677306896 | 576 | |
Wayne Roberts |
0:d88677306896 | 577 | flags._sleep_ = 1; |
Wayne Roberts |
0:d88677306896 | 578 | Radio::Sleep(); |
Wayne Roberts |
0:d88677306896 | 579 | } |
Wayne Roberts |
0:d88677306896 | 580 | break; |
Wayne Roberts |
0:d88677306896 | 581 | } // ..switch (ch) |
Wayne Roberts |
0:d88677306896 | 582 | } |
Wayne Roberts |
0:d88677306896 | 583 | |
Wayne Roberts |
1:7dbf0926e146 | 584 | RadioEvents_t rev = { 0 }; |
Wayne Roberts |
1:7dbf0926e146 | 585 | |
Wayne Roberts |
0:d88677306896 | 586 | int main() |
Wayne Roberts |
0:d88677306896 | 587 | { |
Wayne Roberts |
0:d88677306896 | 588 | flags.run = 1; |
Wayne Roberts |
0:d88677306896 | 589 | pc.baud(115200); |
Wayne Roberts |
0:d88677306896 | 590 | pc.printf("\r\nreset\r\n"); |
Wayne Roberts |
1:7dbf0926e146 | 591 | |
Wayne Roberts |
1:7dbf0926e146 | 592 | rev.TxDone_botHalf = txDoneCB; |
Wayne Roberts |
1:7dbf0926e146 | 593 | rev.RxDone = rxDoneCB; |
Wayne Roberts |
1:7dbf0926e146 | 594 | Radio::Init(&rev); |
Wayne Roberts |
0:d88677306896 | 595 | |
Wayne Roberts |
1:7dbf0926e146 | 596 | Radio::SetChannel(CF_MHZ * 1000000); |
Wayne Roberts |
1:7dbf0926e146 | 597 | Radio::LoRaModemConfig(500, SPREADING_FACTOR, 1); |
Wayne Roberts |
1:7dbf0926e146 | 598 | Radio::LoRaPacketConfig(8, false, true, false); // preambleLen, fixLen, crcOn, invIQ |
Wayne Roberts |
1:7dbf0926e146 | 599 | |
Wayne Roberts |
1:7dbf0926e146 | 600 | Radio::set_tx_dbm(17); |
Wayne Roberts |
0:d88677306896 | 601 | |
Wayne Roberts |
0:d88677306896 | 602 | /* max TX length + turnaround + ACK length */ |
Wayne Roberts |
0:d88677306896 | 603 | retryInterval_us = Radio::lora_toa_us(MAX_TX_LENGTH) + TXRX_PADDING_US + Radio::lora_toa_us(1); |
Wayne Roberts |
0:d88677306896 | 604 | #ifdef UNIT_LAST |
Wayne Roberts |
0:d88677306896 | 605 | pc.printf("LAST "); |
Wayne Roberts |
0:d88677306896 | 606 | #endif |
Wayne Roberts |
0:d88677306896 | 607 | pc.printf("UNIT_ID:%02x retryInterval_us:%u\r\n", UNIT_ID, retryInterval_us); |
Wayne Roberts |
0:d88677306896 | 608 | |
Wayne Roberts |
0:d88677306896 | 609 | flags._sleep_ = 0; |
Wayne Roberts |
0:d88677306896 | 610 | state = STATE_NONE; |
Wayne Roberts |
0:d88677306896 | 611 | |
Wayne Roberts |
0:d88677306896 | 612 | #if (UNIT_ID == 0x00) && !defined(UNIT_LAST) |
Wayne Roberts |
0:d88677306896 | 613 | lpTicker.attach_us(tx_ticker_cb, TX_INTERVAL_US); |
Wayne Roberts |
0:d88677306896 | 614 | #else |
Wayne Roberts |
1:7dbf0926e146 | 615 | //Radio::PrintStatus(); |
Wayne Roberts |
0:d88677306896 | 616 | |
Wayne Roberts |
0:d88677306896 | 617 | setupNext(); |
Wayne Roberts |
0:d88677306896 | 618 | |
Wayne Roberts |
0:d88677306896 | 619 | measuredInterval = 0; |
Wayne Roberts |
0:d88677306896 | 620 | lastRxIrqAt = 0; |
Wayne Roberts |
0:d88677306896 | 621 | measuredIntervalSaved = 0; |
Wayne Roberts |
0:d88677306896 | 622 | #endif /* UNIT_ID != 0x00 */ |
Wayne Roberts |
0:d88677306896 | 623 | |
Wayne Roberts |
0:d88677306896 | 624 | if (sleep_manager_can_deep_sleep()) |
Wayne Roberts |
0:d88677306896 | 625 | sleep_manager_lock_deep_sleep(); // prevent deep sleep |
Wayne Roberts |
0:d88677306896 | 626 | |
Wayne Roberts |
0:d88677306896 | 627 | for (;;) { |
Wayne Roberts |
0:d88677306896 | 628 | if (pc.readable()) { |
Wayne Roberts |
0:d88677306896 | 629 | uart_rx(); |
Wayne Roberts |
0:d88677306896 | 630 | } |
Wayne Roberts |
0:d88677306896 | 631 | |
Wayne Roberts |
0:d88677306896 | 632 | if (flags._sleep_ == 0) { |
Wayne Roberts |
0:d88677306896 | 633 | Radio::service(); |
Wayne Roberts |
0:d88677306896 | 634 | } else |
Wayne Roberts |
0:d88677306896 | 635 | sleep_manager_sleep_auto();; |
Wayne Roberts |
0:d88677306896 | 636 | |
Wayne Roberts |
0:d88677306896 | 637 | } // ..for (;;) |
Wayne Roberts |
0:d88677306896 | 638 | } |
Wayne Roberts |
0:d88677306896 | 639 |