wayne roberts / Mbed OS utility_sx12xx

Text menu driven ANSI/VT100 console test utility for LoRa transceivers

radio chip selection

Radio chip driver is not included, allowing choice of radio device.
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 LR1110, then import LR1110 driver into your program.
If you're using NAmote72 or Murata discovery, then you must import only sx127x driver.
If you're using Type1SJ select target DISCO_L072CZ_LRWAN1 and import sx126x driver into your program.

This is VT100 text-based menu driven test program for SX12xx transceiver devices.
Serial console is divided into horizontally into top half and bottom half.
The bottom half serves as scrolling area to log activity.
The top half serves as menu, to configure the radio.
For all devices, the serial console operates at 115200 8N1, and requires terminal with ANSI-VT100 capability, such as putty/teraterm/minicom etc.
Use program only with keyboard up/down/left/right keys. Enter to change an item, or number for value item. Some items are single bit, requiring only enter key to toggle. Others with fixed choices give a drop-down menu.

radio_sx128x.cpp@4:fa31fdf4ec8d, 2018-11-25 (annotated)

Committer:
Wayne Roberts
Date:
Sun Nov 25 15:34:40 2018 -0800
Revision:
4:fa31fdf4ec8d
Parent:
3:56fc764dee0a
Child:
5:1e5cb7139acb
add PA-off and xtal trim

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Wayne Roberts 1:0817a150122b 1 #include "radio.h"
Wayne Roberts 1:0817a150122b 2 #ifdef SX128x_H
Wayne Roberts 1:0817a150122b 3
Wayne Roberts 1:0817a150122b 4 #include <float.h>
Wayne Roberts 1:0817a150122b 5
Wayne Roberts 1:0817a150122b 6 #ifdef TARGET_FF_ARDUINO /* pins of SX126xDVK1xAS board */
Wayne Roberts 1:0817a150122b 7 #define NRST_PIN A0
Wayne Roberts 1:0817a150122b 8 SPI spi(D11, D12, D13); // mosi, miso, sclk
Wayne Roberts 1:0817a150122b 9 // spi, nss, busy, dio1
Wayne Roberts 1:0817a150122b 10 SX128x Radio::radio(spi, D7, D3, D5, NRST_PIN);
Wayne Roberts 1:0817a150122b 11
Wayne Roberts 1:0817a150122b 12 #define LED_ON 1
Wayne Roberts 1:0817a150122b 13 #define LED_OFF 0
Wayne Roberts 1:0817a150122b 14 DigitalOut tx_led(A4);
Wayne Roberts 1:0817a150122b 15 DigitalOut rx_led(A5);
Wayne Roberts 1:0817a150122b 16
Wayne Roberts 1:0817a150122b 17
Wayne Roberts 1:0817a150122b 18 DigitalOut ant_sw(A3);
Wayne Roberts 1:0817a150122b 19 DigitalOut cps(D6); // SE2436L
Wayne Roberts 1:0817a150122b 20
Wayne Roberts 1:0817a150122b 21 bool fe_enable; // SE2436L
Wayne Roberts 1:0817a150122b 22
Wayne Roberts 1:0817a150122b 23 void Radio::chipModeChange()
Wayne Roberts 1:0817a150122b 24 {
Wayne Roberts 1:0817a150122b 25 if (radio.chipMode == CHIPMODE_NONE) {
Wayne Roberts 1:0817a150122b 26 cps = 0;
Wayne Roberts 1:0817a150122b 27 tx_led = LED_OFF;
Wayne Roberts 1:0817a150122b 28 rx_led = LED_OFF;
Wayne Roberts 1:0817a150122b 29 } else if (radio.chipMode == CHIPMODE_TX) {
Wayne Roberts 1:0817a150122b 30 cps = fe_enable;
Wayne Roberts 1:0817a150122b 31 tx_led = LED_ON;
Wayne Roberts 1:0817a150122b 32 rx_led = LED_OFF;
Wayne Roberts 1:0817a150122b 33 } else if (radio.chipMode == CHIPMODE_RX) {
Wayne Roberts 1:0817a150122b 34 cps = fe_enable;
Wayne Roberts 1:0817a150122b 35 tx_led = LED_OFF;
Wayne Roberts 1:0817a150122b 36 rx_led = LED_ON;
Wayne Roberts 1:0817a150122b 37 }
Wayne Roberts 1:0817a150122b 38 }
Wayne Roberts 1:0817a150122b 39 #endif /* TARGET_FF_ARDUINO */
Wayne Roberts 1:0817a150122b 40
Wayne Roberts 1:0817a150122b 41 const char* const Radio::chipNum_str = "SX1280";
Wayne Roberts 1:0817a150122b 42
Wayne Roberts 1:0817a150122b 43 uint8_t Radio::tx_param_buf[2];
Wayne Roberts 1:0817a150122b 44
Wayne Roberts 1:0817a150122b 45 ModulationParams_t Radio::Radio::mpFLRC, Radio::Radio::mpBLE_GFSK, Radio::mpLORA;
Wayne Roberts 1:0817a150122b 46 PacketParams_t Radio::ppGFSK, Radio::ppFLRC, Radio::ppLORA, Radio::ppBLE;
Wayne Roberts 1:0817a150122b 47
Wayne Roberts 1:0817a150122b 48 const RadioEvents_t* Radio::RadioEvents;
Wayne Roberts 1:0817a150122b 49 LowPowerTimer Radio::lpt;
Wayne Roberts 1:0817a150122b 50 uint8_t Radio::pktType;
Wayne Roberts 3:56fc764dee0a 51 uint16_t Radio::ppg;
Wayne Roberts 1:0817a150122b 52
Wayne Roberts 1:0817a150122b 53 const char* const Radio::pktType_strs[] = {
Wayne Roberts 1:0817a150122b 54 "GFSK ",
Wayne Roberts 1:0817a150122b 55 "LORA ",
Wayne Roberts 1:0817a150122b 56 "RANGING",
Wayne Roberts 1:0817a150122b 57 "FLRC ",
Wayne Roberts 1:0817a150122b 58 "BLE ",
Wayne Roberts 1:0817a150122b 59 NULL
Wayne Roberts 1:0817a150122b 60 };
Wayne Roberts 1:0817a150122b 61
Wayne Roberts 2:ea9245bb1c53 62 unsigned Radio::pktType_read(bool fw)
Wayne Roberts 1:0817a150122b 63 {
Wayne Roberts 1:0817a150122b 64 return radio.getPacketType();
Wayne Roberts 1:0817a150122b 65 }
Wayne Roberts 1:0817a150122b 66
Wayne Roberts 2:ea9245bb1c53 67 menuMode_e Radio::pktType_write(unsigned idx)
Wayne Roberts 1:0817a150122b 68 {
Wayne Roberts 1:0817a150122b 69 radio.setPacketType(idx);
Wayne Roberts 1:0817a150122b 70 return MENUMODE_REINIT_MENU;
Wayne Roberts 1:0817a150122b 71 }
Wayne Roberts 1:0817a150122b 72
Wayne Roberts 1:0817a150122b 73 const char* Radio::tx_ramp_strs[] = {
Wayne Roberts 1:0817a150122b 74 "2 ", // 0
Wayne Roberts 1:0817a150122b 75 "4 ", // 1
Wayne Roberts 1:0817a150122b 76 "6 ", // 2
Wayne Roberts 1:0817a150122b 77 "8 ", // 3
Wayne Roberts 1:0817a150122b 78 "10", // 4
Wayne Roberts 1:0817a150122b 79 "12", // 5
Wayne Roberts 1:0817a150122b 80 "16", // 6
Wayne Roberts 1:0817a150122b 81 "20", // 7
Wayne Roberts 1:0817a150122b 82 NULL
Wayne Roberts 1:0817a150122b 83 };
Wayne Roberts 1:0817a150122b 84
Wayne Roberts 2:ea9245bb1c53 85 unsigned Radio::tx_ramp_read(bool fw)
Wayne Roberts 1:0817a150122b 86 {
Wayne Roberts 1:0817a150122b 87 PaPwrCtrl_t PaPwrCtrl;
Wayne Roberts 1:0817a150122b 88 PaPwrCtrl.octet = radio.readReg(REG_ADDR_PA_PWR_CTRL, 1);
Wayne Roberts 1:0817a150122b 89
Wayne Roberts 1:0817a150122b 90 switch (PaPwrCtrl.bits.ramp_time) {
Wayne Roberts 1:0817a150122b 91 case 0: tx_param_buf[1] = RADIO_RAMP_02_US; break;
Wayne Roberts 1:0817a150122b 92 case 1: tx_param_buf[1] = RADIO_RAMP_04_US; break;
Wayne Roberts 1:0817a150122b 93 case 2: tx_param_buf[1] = RADIO_RAMP_06_US; break;
Wayne Roberts 1:0817a150122b 94 case 3: tx_param_buf[1] = RADIO_RAMP_08_US; break;
Wayne Roberts 1:0817a150122b 95 case 4: tx_param_buf[1] = RADIO_RAMP_10_US; break;
Wayne Roberts 1:0817a150122b 96 case 5: tx_param_buf[1] = RADIO_RAMP_12_US; break;
Wayne Roberts 1:0817a150122b 97 case 6: tx_param_buf[1] = RADIO_RAMP_16_US; break;
Wayne Roberts 1:0817a150122b 98 case 7: tx_param_buf[1] = RADIO_RAMP_20_US; break;
Wayne Roberts 1:0817a150122b 99 }
Wayne Roberts 1:0817a150122b 100
Wayne Roberts 1:0817a150122b 101 return PaPwrCtrl.bits.ramp_time;
Wayne Roberts 1:0817a150122b 102 }
Wayne Roberts 1:0817a150122b 103
Wayne Roberts 2:ea9245bb1c53 104 menuMode_e Radio::tx_ramp_write(unsigned val)
Wayne Roberts 1:0817a150122b 105 {
Wayne Roberts 1:0817a150122b 106 switch (val) {
Wayne Roberts 1:0817a150122b 107 case 0: tx_param_buf[1] = RADIO_RAMP_02_US; break;
Wayne Roberts 1:0817a150122b 108 case 1: tx_param_buf[1] = RADIO_RAMP_04_US; break;
Wayne Roberts 1:0817a150122b 109 case 2: tx_param_buf[1] = RADIO_RAMP_06_US; break;
Wayne Roberts 1:0817a150122b 110 case 3: tx_param_buf[1] = RADIO_RAMP_08_US; break;
Wayne Roberts 1:0817a150122b 111 case 4: tx_param_buf[1] = RADIO_RAMP_10_US; break;
Wayne Roberts 1:0817a150122b 112 case 5: tx_param_buf[1] = RADIO_RAMP_12_US; break;
Wayne Roberts 1:0817a150122b 113 case 6: tx_param_buf[1] = RADIO_RAMP_16_US; break;
Wayne Roberts 1:0817a150122b 114 case 7: tx_param_buf[1] = RADIO_RAMP_20_US; break;
Wayne Roberts 1:0817a150122b 115 }
Wayne Roberts 1:0817a150122b 116
Wayne Roberts 1:0817a150122b 117 radio.xfer(OPCODE_SET_TX_PARAMS, 2, 0, tx_param_buf);
Wayne Roberts 1:0817a150122b 118
Wayne Roberts 1:0817a150122b 119 return MENUMODE_REDRAW;
Wayne Roberts 1:0817a150122b 120 }
Wayne Roberts 1:0817a150122b 121
Wayne Roberts 1:0817a150122b 122 #define TX_PWR_OFFSET 18
Wayne Roberts 1:0817a150122b 123
Wayne Roberts 1:0817a150122b 124 void Radio::tx_dbm_print()
Wayne Roberts 1:0817a150122b 125 {
Wayne Roberts 1:0817a150122b 126 PaPwrCtrl_t PaPwrCtrl;
Wayne Roberts 1:0817a150122b 127
Wayne Roberts 1:0817a150122b 128 PaPwrCtrl.octet = radio.readReg(REG_ADDR_PA_PWR_CTRL, 1);
Wayne Roberts 1:0817a150122b 129 pc.printf("%d", PaPwrCtrl.bits.tx_pwr - TX_PWR_OFFSET);
Wayne Roberts 1:0817a150122b 130
Wayne Roberts 1:0817a150122b 131 tx_param_buf[0] = PaPwrCtrl.bits.tx_pwr;
Wayne Roberts 1:0817a150122b 132 }
Wayne Roberts 1:0817a150122b 133
Wayne Roberts 1:0817a150122b 134 bool Radio::tx_dbm_write(const char* str)
Wayne Roberts 1:0817a150122b 135 {
Wayne Roberts 1:0817a150122b 136 int dbm;
Wayne Roberts 1:0817a150122b 137 sscanf(str, "%d", &dbm);
Wayne Roberts 1:0817a150122b 138
Wayne Roberts 1:0817a150122b 139 tx_param_buf[0] = dbm + TX_PWR_OFFSET;
Wayne Roberts 1:0817a150122b 140 radio.xfer(OPCODE_SET_TX_PARAMS, 2, 0, tx_param_buf);
Wayne Roberts 1:0817a150122b 141 return false;
Wayne Roberts 1:0817a150122b 142 }
Wayne Roberts 1:0817a150122b 143
Wayne Roberts 1:0817a150122b 144 const uint8_t ramp_us[] = {
Wayne Roberts 1:0817a150122b 145 2, // 0
Wayne Roberts 1:0817a150122b 146 4, // 1
Wayne Roberts 1:0817a150122b 147 6, // 2
Wayne Roberts 1:0817a150122b 148 8, // 3
Wayne Roberts 1:0817a150122b 149 10, // 4
Wayne Roberts 1:0817a150122b 150 12, // 5
Wayne Roberts 1:0817a150122b 151 16, // 6
Wayne Roberts 1:0817a150122b 152 20 // 7
Wayne Roberts 1:0817a150122b 153 };
Wayne Roberts 1:0817a150122b 154
Wayne Roberts 1:0817a150122b 155 const char* const Radio::opmode_status_strs[] = {
Wayne Roberts 1:0817a150122b 156 "<0> ", // 0
Wayne Roberts 1:0817a150122b 157 "<1> ", // 1
Wayne Roberts 1:0817a150122b 158 "STDBY_RC ", // 2
Wayne Roberts 1:0817a150122b 159 "STDBY_XOSC", // 3
Wayne Roberts 1:0817a150122b 160 "FS ", // 4
Wayne Roberts 1:0817a150122b 161 "RX ", // 5
Wayne Roberts 1:0817a150122b 162 "TX ", // 6
Wayne Roberts 1:0817a150122b 163 "<7> ", // 7
Wayne Roberts 1:0817a150122b 164 NULL
Wayne Roberts 1:0817a150122b 165 };
Wayne Roberts 1:0817a150122b 166
Wayne Roberts 1:0817a150122b 167 const char* const Radio::opmode_select_strs[] = {
Wayne Roberts 1:0817a150122b 168 "SLEEP ", // 0
Wayne Roberts 1:0817a150122b 169 "STDBY_RC ", // 1
Wayne Roberts 1:0817a150122b 170 "STDBY_XOSC", // 2
Wayne Roberts 1:0817a150122b 171 "FS ", // 3
Wayne Roberts 1:0817a150122b 172 "RX ", // 4
Wayne Roberts 1:0817a150122b 173 "TX ", // 5
Wayne Roberts 1:0817a150122b 174 NULL
Wayne Roberts 1:0817a150122b 175 };
Wayne Roberts 1:0817a150122b 176
Wayne Roberts 2:ea9245bb1c53 177 unsigned Radio::opmode_read(bool forWriting)
Wayne Roberts 1:0817a150122b 178 {
Wayne Roberts 1:0817a150122b 179 status_t status;
Wayne Roberts 1:0817a150122b 180 status.octet = radio.xfer(OPCODE_GET_STATUS, 0, 0, NULL);
Wayne Roberts 1:0817a150122b 181
Wayne Roberts 1:0817a150122b 182 if (forWriting) {
Wayne Roberts 1:0817a150122b 183 /* translate opmode_status_strs to opmode_select_strs */
Wayne Roberts 1:0817a150122b 184 switch (status.bits.chipMode) {
Wayne Roberts 1:0817a150122b 185 case 2: return 1; // STDBY_RC
Wayne Roberts 1:0817a150122b 186 case 3: return 2; //STDBY_XOSC
Wayne Roberts 1:0817a150122b 187 case 4: return 3; //FS
Wayne Roberts 1:0817a150122b 188 case 5: return 4; // RX
Wayne Roberts 1:0817a150122b 189 case 6: return 5; // TX
Wayne Roberts 1:0817a150122b 190 default: return 0;
Wayne Roberts 1:0817a150122b 191 }
Wayne Roberts 1:0817a150122b 192 } else
Wayne Roberts 1:0817a150122b 193 return status.bits.chipMode;
Wayne Roberts 1:0817a150122b 194 }
Wayne Roberts 1:0817a150122b 195
Wayne Roberts 2:ea9245bb1c53 196 menuMode_e Radio::opmode_write(unsigned sel)
Wayne Roberts 1:0817a150122b 197 {
Wayne Roberts 1:0817a150122b 198 switch (sel) {
Wayne Roberts 1:0817a150122b 199 case 0: // SLEEP
Wayne Roberts 1:0817a150122b 200 radio.setSleep(true);
Wayne Roberts 1:0817a150122b 201 break;
Wayne Roberts 1:0817a150122b 202 case 1: // STDBY_RC
Wayne Roberts 1:0817a150122b 203 radio.setStandby(STDBY_RC);
Wayne Roberts 1:0817a150122b 204 break;
Wayne Roberts 1:0817a150122b 205 case 2: // STDBY_XOSC
Wayne Roberts 1:0817a150122b 206 radio.setStandby(STDBY_XOSC);
Wayne Roberts 1:0817a150122b 207 break; case 3: // FS
Wayne Roberts 1:0817a150122b 208 radio.setFS();
Wayne Roberts 1:0817a150122b 209 break;
Wayne Roberts 1:0817a150122b 210 case 4: // RX
Wayne Roberts 1:0817a150122b 211 radio.start_rx(0);
Wayne Roberts 1:0817a150122b 212 break;
Wayne Roberts 1:0817a150122b 213 case 5: // TX
Wayne Roberts 1:0817a150122b 214 {
Wayne Roberts 1:0817a150122b 215 uint8_t buf[3];
Wayne Roberts 1:0817a150122b 216 buf[0] = radio.periodBase;
Wayne Roberts 1:0817a150122b 217 buf[0] = 0;
Wayne Roberts 1:0817a150122b 218 buf[1] = 0;
Wayne Roberts 1:0817a150122b 219 radio.xfer(OPCODE_SET_TX, 3, 0, buf);
Wayne Roberts 1:0817a150122b 220 }
Wayne Roberts 1:0817a150122b 221 break;
Wayne Roberts 1:0817a150122b 222 } // ..switch (menuState.sel_idx)
Wayne Roberts 1:0817a150122b 223
Wayne Roberts 1:0817a150122b 224 return MENUMODE_REDRAW;
Wayne Roberts 1:0817a150122b 225 }
Wayne Roberts 1:0817a150122b 226
Wayne Roberts 1:0817a150122b 227 uint8_t Radio::get_payload_length()
Wayne Roberts 1:0817a150122b 228 {
Wayne Roberts 1:0817a150122b 229 uint8_t reg8;
Wayne Roberts 1:0817a150122b 230
Wayne Roberts 1:0817a150122b 231 pktType = radio.getPacketType();
Wayne Roberts 1:0817a150122b 232
Wayne Roberts 1:0817a150122b 233 switch (pktType) {
Wayne Roberts 1:0817a150122b 234 case PACKET_TYPE_FLRC:
Wayne Roberts 1:0817a150122b 235 case PACKET_TYPE_GFSK:
Wayne Roberts 1:0817a150122b 236 reg8 = radio.readReg(REG_ADDR_PAYLOAD_LEN, 1);
Wayne Roberts 1:0817a150122b 237 ppGFSK.gfskFLRC.PayloadLength = reg8;
Wayne Roberts 1:0817a150122b 238 ppFLRC.gfskFLRC.PayloadLength = reg8;
Wayne Roberts 1:0817a150122b 239 return ppFLRC.gfskFLRC.PayloadLength;
Wayne Roberts 1:0817a150122b 240 case PACKET_TYPE_RANGING:
Wayne Roberts 1:0817a150122b 241 case PACKET_TYPE_LORA:
Wayne Roberts 1:0817a150122b 242 ppLORA.lora.PayloadLength = radio.readReg(REG_ADDR_LORA_TX_PAYLOAD_LENGTH, 1);
Wayne Roberts 1:0817a150122b 243 return ppLORA.lora.PayloadLength;
Wayne Roberts 1:0817a150122b 244 case PACKET_TYPE_BLE:
Wayne Roberts 1:0817a150122b 245 return 0; // TODO BLE
Wayne Roberts 1:0817a150122b 246 }
Wayne Roberts 1:0817a150122b 247
Wayne Roberts 1:0817a150122b 248 return 0;
Wayne Roberts 1:0817a150122b 249 }
Wayne Roberts 1:0817a150122b 250
Wayne Roberts 1:0817a150122b 251 void Radio::set_payload_length(uint8_t len)
Wayne Roberts 1:0817a150122b 252 {
Wayne Roberts 1:0817a150122b 253 pktType = radio.getPacketType();
Wayne Roberts 1:0817a150122b 254
Wayne Roberts 1:0817a150122b 255 switch (pktType) {
Wayne Roberts 1:0817a150122b 256 case PACKET_TYPE_FLRC:
Wayne Roberts 1:0817a150122b 257 ppFLRC.gfskFLRC.PayloadLength = len;
Wayne Roberts 1:0817a150122b 258 ppGFSK.gfskFLRC.PayloadLength = len;
Wayne Roberts 1:0817a150122b 259 radio.xfer(OPCODE_SET_PACKET_PARAMS, 7, 0, ppFLRC.buf);
Wayne Roberts 1:0817a150122b 260 break;
Wayne Roberts 1:0817a150122b 261 case PACKET_TYPE_GFSK:
Wayne Roberts 1:0817a150122b 262 ppFLRC.gfskFLRC.PayloadLength = len;
Wayne Roberts 1:0817a150122b 263 ppGFSK.gfskFLRC.PayloadLength = len;
Wayne Roberts 1:0817a150122b 264 radio.xfer(OPCODE_SET_PACKET_PARAMS, 7, 0, ppGFSK.buf);
Wayne Roberts 1:0817a150122b 265 break;
Wayne Roberts 1:0817a150122b 266 case PACKET_TYPE_RANGING:
Wayne Roberts 1:0817a150122b 267 case PACKET_TYPE_LORA:
Wayne Roberts 1:0817a150122b 268 ppLORA.lora.PayloadLength = len;
Wayne Roberts 1:0817a150122b 269 radio.xfer(OPCODE_SET_PACKET_PARAMS, 5, 0, ppLORA.buf);
Wayne Roberts 1:0817a150122b 270 break;
Wayne Roberts 1:0817a150122b 271 case PACKET_TYPE_BLE:
Wayne Roberts 1:0817a150122b 272 // TODO BLE
Wayne Roberts 1:0817a150122b 273 break;
Wayne Roberts 1:0817a150122b 274 }
Wayne Roberts 1:0817a150122b 275 }
Wayne Roberts 1:0817a150122b 276
Wayne Roberts 1:0817a150122b 277 void Radio::tx_payload_length_print()
Wayne Roberts 1:0817a150122b 278 {
Wayne Roberts 1:0817a150122b 279 pc.printf("%u", get_payload_length());
Wayne Roberts 1:0817a150122b 280 }
Wayne Roberts 1:0817a150122b 281
Wayne Roberts 1:0817a150122b 282 bool Radio::tx_payload_length_write(const char* txt)
Wayne Roberts 1:0817a150122b 283 {
Wayne Roberts 1:0817a150122b 284 unsigned len;
Wayne Roberts 1:0817a150122b 285
Wayne Roberts 1:0817a150122b 286 sscanf(txt, "%u", &len);
Wayne Roberts 1:0817a150122b 287
Wayne Roberts 1:0817a150122b 288 set_payload_length(len);
Wayne Roberts 1:0817a150122b 289
Wayne Roberts 1:0817a150122b 290 return false;
Wayne Roberts 1:0817a150122b 291 }
Wayne Roberts 1:0817a150122b 292
Wayne Roberts 1:0817a150122b 293 void Radio::hw_reset()
Wayne Roberts 1:0817a150122b 294 {
Wayne Roberts 1:0817a150122b 295 radio.hw_reset();
Wayne Roberts 3:56fc764dee0a 296
Wayne Roberts 3:56fc764dee0a 297 manualRngDelay = false;
Wayne Roberts 1:0817a150122b 298 }
Wayne Roberts 1:0817a150122b 299
Wayne Roberts 1:0817a150122b 300 void Radio::clearIrqFlags()
Wayne Roberts 1:0817a150122b 301 {
Wayne Roberts 1:0817a150122b 302 uint8_t buf[2];
Wayne Roberts 1:0817a150122b 303 buf[0] = 0xff;
Wayne Roberts 1:0817a150122b 304 buf[1] = 0xff;
Wayne Roberts 1:0817a150122b 305 radio.xfer(OPCODE_CLEAR_IRQ_STATUS, 2, 0, buf);
Wayne Roberts 1:0817a150122b 306 }
Wayne Roberts 1:0817a150122b 307
Wayne Roberts 1:0817a150122b 308 void Radio::readChip()
Wayne Roberts 1:0817a150122b 309 {
Wayne Roberts 1:0817a150122b 310 uint8_t reg8;
Wayne Roberts 1:0817a150122b 311
Wayne Roberts 1:0817a150122b 312 reg8 = radio.readReg(REG_ADDR_PKTCTRL0, 1);
Wayne Roberts 1:0817a150122b 313 ppGFSK.gfskFLRC.HeaderType = reg8 & 0x20;
Wayne Roberts 1:0817a150122b 314 ppFLRC.gfskFLRC.HeaderType = reg8 & 0x20;
Wayne Roberts 1:0817a150122b 315
Wayne Roberts 1:0817a150122b 316 reg8 = radio.readReg(REG_ADDR_PKTCTRL1, 1);
Wayne Roberts 1:0817a150122b 317 ppGFSK.gfskFLRC.PreambleLength = reg8 & 0x70;
Wayne Roberts 1:0817a150122b 318 ppFLRC.gfskFLRC.PreambleLength = reg8 & 0x70;
Wayne Roberts 1:0817a150122b 319 ppGFSK.gfskFLRC.SyncWordLength = reg8 & 0x0e;
Wayne Roberts 1:0817a150122b 320 ppFLRC.gfskFLRC.SyncWordLength = reg8 & 0x06;
Wayne Roberts 1:0817a150122b 321 if (ppFLRC.gfskFLRC.SyncWordLength == 0x06)
Wayne Roberts 1:0817a150122b 322 ppFLRC.gfskFLRC.SyncWordLength = FLRC_SYNC_WORD_LEN_P32S;
Wayne Roberts 1:0817a150122b 323
Wayne Roberts 1:0817a150122b 324 reg8 = radio.readReg(REG_ADDR_PKT_SYNC_ADRS_CTRL, 1);
Wayne Roberts 1:0817a150122b 325 ppGFSK.gfskFLRC.SyncWordMatch = reg8 & 0x70;
Wayne Roberts 1:0817a150122b 326 ppFLRC.gfskFLRC.SyncWordMatch = reg8 & 0x70;
Wayne Roberts 1:0817a150122b 327
Wayne Roberts 1:0817a150122b 328 reg8 = radio.readReg(REG_ADDR_PAYLOAD_LEN, 1);
Wayne Roberts 1:0817a150122b 329 ppGFSK.gfskFLRC.PayloadLength = reg8;
Wayne Roberts 1:0817a150122b 330 ppFLRC.gfskFLRC.PayloadLength = reg8;
Wayne Roberts 1:0817a150122b 331
Wayne Roberts 1:0817a150122b 332 reg8 = radio.readReg(REG_ADDR_PKT_TX_HEADER, 1); // TODO hi bit of payload length
Wayne Roberts 1:0817a150122b 333 ppBLE.ble.ConnectionState = reg8 & 0xe0;
Wayne Roberts 1:0817a150122b 334 ppBLE.ble.BleTestPayload = reg8 & 0x1c;
Wayne Roberts 1:0817a150122b 335
Wayne Roberts 1:0817a150122b 336 reg8 = radio.readReg(REG_ADDR_PKT_BITSTREAM_CTRL, 1);
Wayne Roberts 1:0817a150122b 337 ppBLE.ble.CrcLength = reg8 & 0x30;
Wayne Roberts 1:0817a150122b 338 ppBLE.ble.Whitening = reg8 & 0x08;
Wayne Roberts 1:0817a150122b 339 ppGFSK.gfskFLRC.CRCLength = reg8 & 0x30;
Wayne Roberts 1:0817a150122b 340 ppFLRC.gfskFLRC.CRCLength = reg8 & 0x30;
Wayne Roberts 1:0817a150122b 341 ppGFSK.gfskFLRC.Whitening = reg8 & 0x08;
Wayne Roberts 1:0817a150122b 342 ppFLRC.gfskFLRC.Whitening = reg8 & 0x08;
Wayne Roberts 1:0817a150122b 343
Wayne Roberts 3:56fc764dee0a 344 LoRaPktPar0.octet = radio.readReg(REG_ADDR_LORA_PKTPAR0, 1);
Wayne Roberts 3:56fc764dee0a 345 switch (LoRaPktPar0.bits.modem_bw) {
Wayne Roberts 3:56fc764dee0a 346 case 2: mpLORA.lora.bandwidth = LORA_BW_200; break;
Wayne Roberts 3:56fc764dee0a 347 case 3: mpLORA.lora.bandwidth = LORA_BW_400; break;
Wayne Roberts 3:56fc764dee0a 348 case 4: mpLORA.lora.bandwidth = LORA_BW_800; break;
Wayne Roberts 3:56fc764dee0a 349 case 5: mpLORA.lora.bandwidth = LORA_BW_1600; break;
Wayne Roberts 1:0817a150122b 350 }
Wayne Roberts 3:56fc764dee0a 351 mpLORA.lora.spreadingFactor = LoRaPktPar0.bits.modem_sf << 4;
Wayne Roberts 1:0817a150122b 352
Wayne Roberts 1:0817a150122b 353 {
Wayne Roberts 1:0817a150122b 354 LoRaPktPar1_t LoRaPktPar1;
Wayne Roberts 1:0817a150122b 355 LoRaPktPar1.octet = radio.readReg(REG_ADDR_LORA_PKTPAR1, 1);
Wayne Roberts 1:0817a150122b 356 mpLORA.lora.codingRate = LoRaPktPar1.bits.coding_rate;
Wayne Roberts 1:0817a150122b 357 ppLORA.lora.InvertIQ = LoRaPktPar1.bits.rxinvert_iq ? LORA_IQ_INVERTED : LORA_IQ_STD;
Wayne Roberts 1:0817a150122b 358 ppLORA.lora.HeaderType = LoRaPktPar1.bits.implicit_header ? IMPLICIT_HEADER : EXPLICIT_HEADER;
Wayne Roberts 1:0817a150122b 359 // LoRaPktPar1.bits.ppm_offset
Wayne Roberts 1:0817a150122b 360 }
Wayne Roberts 1:0817a150122b 361
Wayne Roberts 1:0817a150122b 362 {
Wayne Roberts 1:0817a150122b 363 LoRaPreambleReg_t LoRaPreambleReg;
Wayne Roberts 1:0817a150122b 364 LoRaPreambleReg.octet = radio.readReg(REG_ADDR_LORA_PREAMBLE, 1);
Wayne Roberts 1:0817a150122b 365 ppLORA.lora.PreambleLength = LoRaPreambleReg.bits.preamble_symb1_nb * (1 << LoRaPreambleReg.bits.preamble_symb_nb_exp);
Wayne Roberts 1:0817a150122b 366 }
Wayne Roberts 1:0817a150122b 367 ppLORA.lora.PayloadLength = radio.readReg(REG_ADDR_LORA_TX_PAYLOAD_LENGTH, 1);
Wayne Roberts 1:0817a150122b 368
Wayne Roberts 1:0817a150122b 369 {
Wayne Roberts 1:0817a150122b 370 LoRaLrCtl_t LoRaLrCtl;
Wayne Roberts 1:0817a150122b 371 LoRaLrCtl.octet = radio.readReg(REG_ADDR_LORA_LRCTL, 1);
Wayne Roberts 1:0817a150122b 372 ppLORA.lora.crc = LoRaLrCtl.octet & 0x20; // LoRaLrCtl.bits.crc_en
Wayne Roberts 1:0817a150122b 373 }
Wayne Roberts 1:0817a150122b 374
Wayne Roberts 1:0817a150122b 375 {
Wayne Roberts 1:0817a150122b 376 RegRxBw_t RegRxBw;
Wayne Roberts 1:0817a150122b 377 unsigned bps;
Wayne Roberts 1:0817a150122b 378 FloraPreambleHi_t FloraPreambleHi;
Wayne Roberts 1:0817a150122b 379 float mi, fdev_hz;
Wayne Roberts 1:0817a150122b 380 unsigned freqDev;
Wayne Roberts 1:0817a150122b 381 FskModDfH_t FskModDfH;
Wayne Roberts 1:0817a150122b 382 FskModDfH.octet = radio.readReg(REG_ADDR_FSK_MODDFH, 1);
Wayne Roberts 1:0817a150122b 383 freqDev = FskModDfH.bits.freqDev;
Wayne Roberts 1:0817a150122b 384 freqDev <<= 8;
Wayne Roberts 1:0817a150122b 385 freqDev |= radio.readReg(REG_ADDR_FSK_MODDFL, 1);
Wayne Roberts 1:0817a150122b 386 //printf("freqDev %x, %x\r\n", freqDev, freqDev);
Wayne Roberts 1:0817a150122b 387 fdev_hz = freqDev * PLL_STEP_HZ;
Wayne Roberts 1:0817a150122b 388 //printf("fdev hz:%f\r\n", fdev_hz);
Wayne Roberts 1:0817a150122b 389
Wayne Roberts 1:0817a150122b 390 FloraPreambleHi.octet = radio.readReg(REG_ADDR_FLORA_PREAMBLE_HI, 1);
Wayne Roberts 1:0817a150122b 391 switch (FloraPreambleHi.bits.data_rate) {
Wayne Roberts 1:0817a150122b 392 case 0:
Wayne Roberts 1:0817a150122b 393 bps = 2.0e6;
Wayne Roberts 1:0817a150122b 394 //mpFLRC.flrc.bitrateBandwidth = ??; // 2.6
Wayne Roberts 1:0817a150122b 395 break;
Wayne Roberts 1:0817a150122b 396 case 1:
Wayne Roberts 1:0817a150122b 397 bps = 1.6e6;
Wayne Roberts 1:0817a150122b 398 //mpFLRC.flrc.bitrateBandwidth = ??; // 2.08
Wayne Roberts 1:0817a150122b 399 break;
Wayne Roberts 1:0817a150122b 400 case 2:
Wayne Roberts 1:0817a150122b 401 bps = 1.0e6;
Wayne Roberts 1:0817a150122b 402 mpFLRC.flrc.bitrateBandwidth = FLRC_BR_1_300_BW_1_2; // 1.3
Wayne Roberts 1:0817a150122b 403 break;
Wayne Roberts 1:0817a150122b 404 case 3:
Wayne Roberts 1:0817a150122b 405 bps = 0.8e6;
Wayne Roberts 1:0817a150122b 406 mpFLRC.flrc.bitrateBandwidth = FLRC_BR_1_000_BW_1_2; // 1.04
Wayne Roberts 1:0817a150122b 407 break;
Wayne Roberts 1:0817a150122b 408 case 4:
Wayne Roberts 1:0817a150122b 409 bps = 0.5e6;
Wayne Roberts 1:0817a150122b 410 mpFLRC.flrc.bitrateBandwidth = FLRC_BR_0_650_BW_0_6; // 0.65
Wayne Roberts 1:0817a150122b 411 break;
Wayne Roberts 1:0817a150122b 412 case 5:
Wayne Roberts 1:0817a150122b 413 bps = 0.4e6;
Wayne Roberts 1:0817a150122b 414 mpFLRC.flrc.bitrateBandwidth = FLRC_BR_0_520_BW_0_6; // 0.52
Wayne Roberts 1:0817a150122b 415 break;
Wayne Roberts 1:0817a150122b 416 case 6:
Wayne Roberts 1:0817a150122b 417 bps = 0.25e6;
Wayne Roberts 1:0817a150122b 418 mpFLRC.flrc.bitrateBandwidth = FLRC_BR_0_325_BW_0_3; // 0.325
Wayne Roberts 1:0817a150122b 419 break;
Wayne Roberts 1:0817a150122b 420 case 7:
Wayne Roberts 1:0817a150122b 421 bps = 0.125e6;
Wayne Roberts 1:0817a150122b 422 mpFLRC.flrc.bitrateBandwidth = FLRC_BR_0_260_BW_0_3; // 0.26
Wayne Roberts 1:0817a150122b 423 break;
Wayne Roberts 1:0817a150122b 424 }
Wayne Roberts 1:0817a150122b 425
Wayne Roberts 1:0817a150122b 426 mi = (fdev_hz * 2.0) / bps;
Wayne Roberts 1:0817a150122b 427 if (mi > 0.35) {
Wayne Roberts 1:0817a150122b 428 mi -= 0.5;
Wayne Roberts 1:0817a150122b 429 mi /= 0.25;
Wayne Roberts 1:0817a150122b 430 mpBLE_GFSK.gfskBle.ModulationIndex = ((uint8_t)mi) + 1;
Wayne Roberts 1:0817a150122b 431 } else
Wayne Roberts 1:0817a150122b 432 mpBLE_GFSK.gfskBle.ModulationIndex = 0;
Wayne Roberts 1:0817a150122b 433
Wayne Roberts 1:0817a150122b 434 RegRxBw.octet = radio.readReg(REG_ADDR_RXBW, 1);
Wayne Roberts 1:0817a150122b 435
Wayne Roberts 1:0817a150122b 436 //printf("rx ");
Wayne Roberts 1:0817a150122b 437 switch (RegRxBw.bits.bw) {
Wayne Roberts 1:0817a150122b 438 case 0:
Wayne Roberts 1:0817a150122b 439 //printf("2.4");
Wayne Roberts 1:0817a150122b 440 if (FloraPreambleHi.bits.data_rate == 0)
Wayne Roberts 1:0817a150122b 441 mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_2_000_BW_2_4;
Wayne Roberts 1:0817a150122b 442 if (FloraPreambleHi.bits.data_rate == 1)
Wayne Roberts 1:0817a150122b 443 mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_1_600_BW_2_4;
Wayne Roberts 1:0817a150122b 444 if (FloraPreambleHi.bits.data_rate == 2)
Wayne Roberts 1:0817a150122b 445 mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_1_000_BW_2_4;
Wayne Roberts 1:0817a150122b 446 if (FloraPreambleHi.bits.data_rate == 3)
Wayne Roberts 1:0817a150122b 447 mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_800_BW_2_4;
Wayne Roberts 1:0817a150122b 448 break;
Wayne Roberts 1:0817a150122b 449 case 1:
Wayne Roberts 1:0817a150122b 450 //printf("1.2");
Wayne Roberts 1:0817a150122b 451 if (FloraPreambleHi.bits.data_rate == 2)
Wayne Roberts 1:0817a150122b 452 mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_1_000_BW_1_2;
Wayne Roberts 1:0817a150122b 453 if (FloraPreambleHi.bits.data_rate == 3)
Wayne Roberts 1:0817a150122b 454 mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_800_BW_1_2;
Wayne Roberts 1:0817a150122b 455 if (FloraPreambleHi.bits.data_rate == 4)
Wayne Roberts 1:0817a150122b 456 mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_500_BW_1_2;
Wayne Roberts 1:0817a150122b 457 if (FloraPreambleHi.bits.data_rate == 5)
Wayne Roberts 1:0817a150122b 458 mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_400_BW_1_2;
Wayne Roberts 1:0817a150122b 459 break;
Wayne Roberts 1:0817a150122b 460 case 2:
Wayne Roberts 1:0817a150122b 461 //printf("0.6");
Wayne Roberts 1:0817a150122b 462 if (FloraPreambleHi.bits.data_rate == 4)
Wayne Roberts 1:0817a150122b 463 mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_500_BW_0_6;
Wayne Roberts 1:0817a150122b 464 if (FloraPreambleHi.bits.data_rate == 5)
Wayne Roberts 1:0817a150122b 465 mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_400_BW_0_6;
Wayne Roberts 1:0817a150122b 466 if (FloraPreambleHi.bits.data_rate == 6)
Wayne Roberts 1:0817a150122b 467 mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_250_BW_0_6;
Wayne Roberts 1:0817a150122b 468 break;
Wayne Roberts 1:0817a150122b 469 case 3:
Wayne Roberts 1:0817a150122b 470 //printf("0.3");
Wayne Roberts 1:0817a150122b 471 if (FloraPreambleHi.bits.data_rate == 6)
Wayne Roberts 1:0817a150122b 472 mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_250_BW_0_3;
Wayne Roberts 1:0817a150122b 473 if (FloraPreambleHi.bits.data_rate == 7)
Wayne Roberts 1:0817a150122b 474 mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_125_BW_0_3;
Wayne Roberts 1:0817a150122b 475 break;
Wayne Roberts 1:0817a150122b 476 }
Wayne Roberts 1:0817a150122b 477 //printf("MHz bw:%u\r\n", RegRxBw.bits.bw);
Wayne Roberts 1:0817a150122b 478 mpBLE_GFSK.gfskBle.bitrateBandwidth = reg8;
Wayne Roberts 1:0817a150122b 479 }
Wayne Roberts 1:0817a150122b 480
Wayne Roberts 1:0817a150122b 481 {
Wayne Roberts 1:0817a150122b 482 FskCfg_t FskCfg;
Wayne Roberts 1:0817a150122b 483 FskCfg.octet = radio.readReg(REG_ADDR_FSK_CFG, 1);
Wayne Roberts 1:0817a150122b 484 //printf("gf_bt:%u\r\n", FskCfg.bits.gf_bt);
Wayne Roberts 1:0817a150122b 485 mpBLE_GFSK.gfskBle.ModulationShaping = FskCfg.bits.gf_bt << 4;
Wayne Roberts 1:0817a150122b 486 mpFLRC.flrc.ModulationShaping = mpBLE_GFSK.gfskBle.ModulationShaping;
Wayne Roberts 1:0817a150122b 487 }
Wayne Roberts 1:0817a150122b 488
Wayne Roberts 1:0817a150122b 489 {
Wayne Roberts 1:0817a150122b 490 PktBitStreamCtrl_t PktBitStreamCtrl;
Wayne Roberts 1:0817a150122b 491 PktBitStreamCtrl.octet = radio.readReg(REG_ADDR_PKT_BITSTREAM_CTRL, 1);
Wayne Roberts 1:0817a150122b 492 mpFLRC.flrc.CodingRate = PktBitStreamCtrl.octet & 0x06; // PktBitStreamCtrl.bits.flora_coding_rate
Wayne Roberts 1:0817a150122b 493 }
Wayne Roberts 1:0817a150122b 494
Wayne Roberts 1:0817a150122b 495 }
Wayne Roberts 1:0817a150122b 496
Wayne Roberts 1:0817a150122b 497 void Radio::rxDone(uint8_t size, const pktStatus_t* pktStatus)
Wayne Roberts 1:0817a150122b 498 {
Wayne Roberts 1:0817a150122b 499 float rssi, snr;
Wayne Roberts 1:0817a150122b 500
Wayne Roberts 1:0817a150122b 501 if (pktStatus->ble_gfsk_flrc.sync.syncAddrsCode == 0) {
Wayne Roberts 1:0817a150122b 502 int8_t s = pktStatus->lora.snr;
Wayne Roberts 1:0817a150122b 503 rssi = -pktStatus->lora.rssiSync / 2.0;
Wayne Roberts 1:0817a150122b 504 snr = s / 4.0;
Wayne Roberts 1:0817a150122b 505 } else {
Wayne Roberts 1:0817a150122b 506 rssi = -pktStatus->ble_gfsk_flrc.rssiSync / 2.0;
Wayne Roberts 1:0817a150122b 507 snr = FLT_MIN;
Wayne Roberts 1:0817a150122b 508 }
Wayne Roberts 1:0817a150122b 509
Wayne Roberts 1:0817a150122b 510 RadioEvents->RxDone(size, rssi, snr);
Wayne Roberts 1:0817a150122b 511 }
Wayne Roberts 1:0817a150122b 512
Wayne Roberts 1:0817a150122b 513 void Radio::txDoneBottom()
Wayne Roberts 1:0817a150122b 514 {
Wayne Roberts 1:0817a150122b 515 if (RadioEvents->TxDone_botHalf)
Wayne Roberts 1:0817a150122b 516 RadioEvents->TxDone_botHalf();
Wayne Roberts 1:0817a150122b 517 }
Wayne Roberts 1:0817a150122b 518
Wayne Roberts 2:ea9245bb1c53 519 void Radio::cadDone(bool det)
Wayne Roberts 2:ea9245bb1c53 520 {
Wayne Roberts 2:ea9245bb1c53 521 log_printf("cadDone ");
Wayne Roberts 2:ea9245bb1c53 522 if (det)
Wayne Roberts 2:ea9245bb1c53 523 pc.printf("CadDetected");
Wayne Roberts 2:ea9245bb1c53 524
Wayne Roberts 2:ea9245bb1c53 525 pc.printf("\r\n");
Wayne Roberts 2:ea9245bb1c53 526 }
Wayne Roberts 2:ea9245bb1c53 527
Wayne Roberts 1:0817a150122b 528 void Radio::boardInit(const RadioEvents_t* e)
Wayne Roberts 1:0817a150122b 529 {
Wayne Roberts 1:0817a150122b 530 hw_reset();
Wayne Roberts 1:0817a150122b 531
Wayne Roberts 1:0817a150122b 532 radio.txDone = txDoneBottom;
Wayne Roberts 1:0817a150122b 533 radio.rxDone = rxDone;
Wayne Roberts 2:ea9245bb1c53 534 radio.cadDone = cadDone;
Wayne Roberts 1:0817a150122b 535
Wayne Roberts 1:0817a150122b 536 radio.chipModeChange = chipModeChange;
Wayne Roberts 1:0817a150122b 537
Wayne Roberts 1:0817a150122b 538 readChip();
Wayne Roberts 1:0817a150122b 539
Wayne Roberts 1:0817a150122b 540 RadioEvents = e;
Wayne Roberts 1:0817a150122b 541
Wayne Roberts 1:0817a150122b 542 fe_enable = true;
Wayne Roberts 1:0817a150122b 543
Wayne Roberts 1:0817a150122b 544 lpt.start();
Wayne Roberts 1:0817a150122b 545 }
Wayne Roberts 1:0817a150122b 546
Wayne Roberts 1:0817a150122b 547 void Radio::tx_carrier()
Wayne Roberts 1:0817a150122b 548 {
Wayne Roberts 1:0817a150122b 549 radio.xfer(OPCODE_SET_TX_CARRIER, 0, 0, NULL);
Wayne Roberts 2:ea9245bb1c53 550
Wayne Roberts 2:ea9245bb1c53 551 radio.chipMode = CHIPMODE_TX;
Wayne Roberts 2:ea9245bb1c53 552 chipModeChange();
Wayne Roberts 1:0817a150122b 553 }
Wayne Roberts 1:0817a150122b 554
Wayne Roberts 1:0817a150122b 555 void Radio::tx_preamble()
Wayne Roberts 1:0817a150122b 556 {
Wayne Roberts 1:0817a150122b 557 radio.xfer(OPCODE_SET_TX_PREAMBLE, 0, 0, NULL);
Wayne Roberts 2:ea9245bb1c53 558
Wayne Roberts 2:ea9245bb1c53 559 radio.chipMode = CHIPMODE_TX;
Wayne Roberts 2:ea9245bb1c53 560 chipModeChange();
Wayne Roberts 1:0817a150122b 561 }
Wayne Roberts 1:0817a150122b 562
Wayne Roberts 3:56fc764dee0a 563 void Radio::rngTx()
Wayne Roberts 3:56fc764dee0a 564 {
Wayne Roberts 3:56fc764dee0a 565 IrqFlags_t irqEnable;
Wayne Roberts 3:56fc764dee0a 566 uint8_t buf[8];
Wayne Roberts 3:56fc764dee0a 567
Wayne Roberts 3:56fc764dee0a 568 if (!manualRngDelay)
Wayne Roberts 3:56fc764dee0a 569 rngUpdateDelayCal();
Wayne Roberts 3:56fc764dee0a 570
Wayne Roberts 3:56fc764dee0a 571 irqEnable.word = 0;
Wayne Roberts 3:56fc764dee0a 572 irqEnable.bits.TxDone = 1;
Wayne Roberts 3:56fc764dee0a 573 irqEnable.bits.RxTxTimeout = 1;
Wayne Roberts 3:56fc764dee0a 574 irqEnable.bits.RangingMasterTimeout = 1;
Wayne Roberts 3:56fc764dee0a 575 irqEnable.bits.RangingMasterResultValid = 1;
Wayne Roberts 3:56fc764dee0a 576 irqEnable.bits.RangingMasterRequestValid = 1;
Wayne Roberts 3:56fc764dee0a 577
Wayne Roberts 3:56fc764dee0a 578 buf[0] = irqEnable.word >> 8; // enable bits
Wayne Roberts 3:56fc764dee0a 579 buf[1] = irqEnable.word; // enable bits
Wayne Roberts 3:56fc764dee0a 580
Wayne Roberts 3:56fc764dee0a 581 irqEnable.bits.RangingMasterTimeout = 0;
Wayne Roberts 3:56fc764dee0a 582 irqEnable.bits.RangingMasterResultValid = 0;
Wayne Roberts 3:56fc764dee0a 583 irqEnable.bits.RangingMasterRequestValid = 0;
Wayne Roberts 3:56fc764dee0a 584 buf[2] = irqEnable.word >> 8; // dio1
Wayne Roberts 3:56fc764dee0a 585 buf[3] = irqEnable.word; // dio1
Wayne Roberts 3:56fc764dee0a 586
Wayne Roberts 3:56fc764dee0a 587 buf[4] = 0; // dio2
Wayne Roberts 3:56fc764dee0a 588 buf[5] = 0; // dio2
Wayne Roberts 3:56fc764dee0a 589 buf[6] = 0; // dio3
Wayne Roberts 3:56fc764dee0a 590 buf[7] = 0; // dio3
Wayne Roberts 3:56fc764dee0a 591 radio.xfer(OPCODE_SET_DIO_IRQ_PARAMS, 8, 0, buf);
Wayne Roberts 3:56fc764dee0a 592
Wayne Roberts 3:56fc764dee0a 593 log_printf("rngTx\r\n");
Wayne Roberts 3:56fc764dee0a 594
Wayne Roberts 3:56fc764dee0a 595 buf[0] = radio.periodBase;
Wayne Roberts 3:56fc764dee0a 596 /* no timeout */
Wayne Roberts 3:56fc764dee0a 597 buf[1] = 0;
Wayne Roberts 3:56fc764dee0a 598 buf[2] = 0;
Wayne Roberts 3:56fc764dee0a 599 radio.xfer(OPCODE_SET_TX, 3, 0, buf);
Wayne Roberts 3:56fc764dee0a 600
Wayne Roberts 3:56fc764dee0a 601 radio.chipMode = CHIPMODE_TX;
Wayne Roberts 3:56fc764dee0a 602 chipModeChange();
Wayne Roberts 3:56fc764dee0a 603 }
Wayne Roberts 3:56fc764dee0a 604
Wayne Roberts 1:0817a150122b 605 void Radio::txPkt()
Wayne Roberts 1:0817a150122b 606 {
Wayne Roberts 1:0817a150122b 607 uint8_t txlen = 0;
Wayne Roberts 1:0817a150122b 608
Wayne Roberts 1:0817a150122b 609 pktType = radio.getPacketType();
Wayne Roberts 1:0817a150122b 610
Wayne Roberts 1:0817a150122b 611 switch (pktType) {
Wayne Roberts 1:0817a150122b 612 case PACKET_TYPE_FLRC:
Wayne Roberts 1:0817a150122b 613 case PACKET_TYPE_GFSK:
Wayne Roberts 1:0817a150122b 614 txlen = radio.readReg(REG_ADDR_PAYLOAD_LEN, 1);
Wayne Roberts 1:0817a150122b 615 break;
Wayne Roberts 1:0817a150122b 616 case PACKET_TYPE_BLE:
Wayne Roberts 1:0817a150122b 617 return; // TODO BLE
Wayne Roberts 1:0817a150122b 618 case PACKET_TYPE_RANGING:
Wayne Roberts 3:56fc764dee0a 619 rngTx();
Wayne Roberts 3:56fc764dee0a 620 return;
Wayne Roberts 1:0817a150122b 621 case PACKET_TYPE_LORA:
Wayne Roberts 1:0817a150122b 622 txlen = radio.readReg(REG_ADDR_LORA_TX_PAYLOAD_LENGTH, 1);
Wayne Roberts 1:0817a150122b 623 break;
Wayne Roberts 1:0817a150122b 624 }
Wayne Roberts 1:0817a150122b 625 log_printf("txPkt%u\r\n", txlen);
Wayne Roberts 1:0817a150122b 626
Wayne Roberts 3:56fc764dee0a 627 radio.setBufferBase(0, 0);
Wayne Roberts 3:56fc764dee0a 628
Wayne Roberts 1:0817a150122b 629 radio.start_tx(txlen, 0);
Wayne Roberts 1:0817a150122b 630
Wayne Roberts 1:0817a150122b 631 }
Wayne Roberts 1:0817a150122b 632
Wayne Roberts 1:0817a150122b 633 #define REGBW_2_4MHZ 0
Wayne Roberts 1:0817a150122b 634 #define REGBW_1_2MHZ 1
Wayne Roberts 1:0817a150122b 635 #define REGBW_0_6MHZ 2
Wayne Roberts 1:0817a150122b 636 #define REGBW_0_3MHZ 3
Wayne Roberts 1:0817a150122b 637
Wayne Roberts 2:ea9245bb1c53 638 unsigned Radio::gfsk_flrc_bpsbw_read(bool fw)
Wayne Roberts 1:0817a150122b 639 {
Wayne Roberts 1:0817a150122b 640 unsigned n = UINT_MAX;
Wayne Roberts 1:0817a150122b 641 RegRxBw_t RegRxBw;
Wayne Roberts 1:0817a150122b 642 FloraPreambleHi_t FloraPreambleHi;
Wayne Roberts 1:0817a150122b 643 pktType = radio.getPacketType();
Wayne Roberts 1:0817a150122b 644
Wayne Roberts 1:0817a150122b 645 FloraPreambleHi.octet = radio.readReg(REG_ADDR_FLORA_PREAMBLE_HI, 1);
Wayne Roberts 1:0817a150122b 646
Wayne Roberts 1:0817a150122b 647 RegRxBw.octet = radio.readReg(REG_ADDR_RXBW, 1);
Wayne Roberts 1:0817a150122b 648
Wayne Roberts 1:0817a150122b 649 if (pktType == PACKET_TYPE_GFSK) {
Wayne Roberts 1:0817a150122b 650 switch (FloraPreambleHi.bits.data_rate) {
Wayne Roberts 1:0817a150122b 651 case 0:
Wayne Roberts 1:0817a150122b 652 n = 0; // 2Mbps, 2.4MHz
Wayne Roberts 1:0817a150122b 653 break;
Wayne Roberts 1:0817a150122b 654 case 1:
Wayne Roberts 1:0817a150122b 655 n = 1; // 1.6Mbps, 2.4MHz
Wayne Roberts 1:0817a150122b 656 break;
Wayne Roberts 1:0817a150122b 657 case 2:
Wayne Roberts 1:0817a150122b 658 if (RegRxBw.bits.bw == REGBW_2_4MHZ)
Wayne Roberts 1:0817a150122b 659 n = 2;
Wayne Roberts 1:0817a150122b 660 else if (RegRxBw.bits.bw == REGBW_1_2MHZ)
Wayne Roberts 1:0817a150122b 661 n = 3;
Wayne Roberts 1:0817a150122b 662 break;
Wayne Roberts 1:0817a150122b 663 case 3:
Wayne Roberts 1:0817a150122b 664 if (RegRxBw.bits.bw == REGBW_2_4MHZ) // 0.8Mbps 2.4 2.4MHz
Wayne Roberts 1:0817a150122b 665 n = 4;
Wayne Roberts 1:0817a150122b 666 else if (RegRxBw.bits.bw == REGBW_1_2MHZ) // 0.8Mbps 1.2MHz
Wayne Roberts 1:0817a150122b 667 n = 5;
Wayne Roberts 1:0817a150122b 668 break;
Wayne Roberts 1:0817a150122b 669 case 4:
Wayne Roberts 1:0817a150122b 670 if (RegRxBw.bits.bw == REGBW_1_2MHZ) // 0.5Mbps 1.2MHz
Wayne Roberts 1:0817a150122b 671 n = 6;
Wayne Roberts 1:0817a150122b 672 else if (RegRxBw.bits.bw == REGBW_0_6MHZ) // 0.5Mbps 0.6MHz
Wayne Roberts 1:0817a150122b 673 n = 7;
Wayne Roberts 1:0817a150122b 674 break;
Wayne Roberts 1:0817a150122b 675 case 5:
Wayne Roberts 1:0817a150122b 676 if (RegRxBw.bits.bw == REGBW_1_2MHZ) // 0.4Mbps 1.2MHz
Wayne Roberts 1:0817a150122b 677 n = 8;
Wayne Roberts 1:0817a150122b 678 else if (RegRxBw.bits.bw == REGBW_0_6MHZ) // 0.4Mbps 0.6MHz
Wayne Roberts 1:0817a150122b 679 n = 9;
Wayne Roberts 1:0817a150122b 680 break;
Wayne Roberts 1:0817a150122b 681 case 6:
Wayne Roberts 1:0817a150122b 682 if (RegRxBw.bits.bw == REGBW_0_6MHZ) // 0.25Mbps 0.6MHz
Wayne Roberts 1:0817a150122b 683 n = 10;
Wayne Roberts 1:0817a150122b 684 else if (RegRxBw.bits.bw == REGBW_0_3MHZ) // 0.25Mbps 0.3MHz
Wayne Roberts 1:0817a150122b 685 n = 11;
Wayne Roberts 1:0817a150122b 686 break;
Wayne Roberts 1:0817a150122b 687 case 7:
Wayne Roberts 1:0817a150122b 688 n = 12; // 0.125Mbps, assume bw=0.3MHz
Wayne Roberts 1:0817a150122b 689 break;
Wayne Roberts 1:0817a150122b 690 } // ..switch (FloraPreambleHi.bits.data_rate)
Wayne Roberts 1:0817a150122b 691 } else if (pktType == PACKET_TYPE_FLRC) {
Wayne Roberts 1:0817a150122b 692 n = FloraPreambleHi.bits.data_rate;
Wayne Roberts 1:0817a150122b 693 // datarate, bits 5,6,7.. bw bits 0,1,2
Wayne Roberts 1:0817a150122b 694 switch (FloraPreambleHi.bits.data_rate) {
Wayne Roberts 1:0817a150122b 695 case 0:
Wayne Roberts 1:0817a150122b 696 break;
Wayne Roberts 1:0817a150122b 697 case 1:
Wayne Roberts 1:0817a150122b 698 break;
Wayne Roberts 1:0817a150122b 699 case 2:
Wayne Roberts 1:0817a150122b 700 mpFLRC.flrc.bitrateBandwidth = FLRC_BR_1_300_BW_1_2;
Wayne Roberts 1:0817a150122b 701 break;
Wayne Roberts 1:0817a150122b 702 case 3:
Wayne Roberts 1:0817a150122b 703 mpFLRC.flrc.bitrateBandwidth = FLRC_BR_1_000_BW_1_2;
Wayne Roberts 1:0817a150122b 704 break;
Wayne Roberts 1:0817a150122b 705 case 4:
Wayne Roberts 1:0817a150122b 706 mpFLRC.flrc.bitrateBandwidth = FLRC_BR_0_650_BW_0_6;
Wayne Roberts 1:0817a150122b 707 break;
Wayne Roberts 1:0817a150122b 708 case 5:
Wayne Roberts 1:0817a150122b 709 mpFLRC.flrc.bitrateBandwidth = FLRC_BR_0_520_BW_0_6;
Wayne Roberts 1:0817a150122b 710 break;
Wayne Roberts 1:0817a150122b 711 case 6:
Wayne Roberts 1:0817a150122b 712 mpFLRC.flrc.bitrateBandwidth = FLRC_BR_0_325_BW_0_3;
Wayne Roberts 1:0817a150122b 713 break;
Wayne Roberts 1:0817a150122b 714 case 7:
Wayne Roberts 1:0817a150122b 715 mpFLRC.flrc.bitrateBandwidth = FLRC_BR_0_260_BW_0_3;
Wayne Roberts 1:0817a150122b 716 break;
Wayne Roberts 1:0817a150122b 717 } // ..switch (FloraPreambleHi.bits.data_rate)
Wayne Roberts 1:0817a150122b 718 }
Wayne Roberts 1:0817a150122b 719
Wayne Roberts 1:0817a150122b 720 return n;
Wayne Roberts 1:0817a150122b 721 }
Wayne Roberts 1:0817a150122b 722
Wayne Roberts 2:ea9245bb1c53 723 menuMode_e Radio::gfsk_flrc_bpsbw_write(unsigned sidx)
Wayne Roberts 1:0817a150122b 724 {
Wayne Roberts 1:0817a150122b 725 pktType = radio.getPacketType();
Wayne Roberts 1:0817a150122b 726
Wayne Roberts 1:0817a150122b 727 if (pktType == PACKET_TYPE_GFSK) {
Wayne Roberts 1:0817a150122b 728 switch (sidx) {
Wayne Roberts 1:0817a150122b 729 case 0: mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_2_000_BW_2_4; break;
Wayne Roberts 1:0817a150122b 730 case 1: mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_1_600_BW_2_4; break;
Wayne Roberts 1:0817a150122b 731 case 2: mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_1_000_BW_2_4; break;
Wayne Roberts 1:0817a150122b 732 case 3: mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_1_000_BW_1_2; break;
Wayne Roberts 1:0817a150122b 733 case 4: mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_800_BW_2_4; break;
Wayne Roberts 1:0817a150122b 734 case 5: mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_800_BW_1_2; break;
Wayne Roberts 1:0817a150122b 735 case 6: mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_500_BW_1_2; break;
Wayne Roberts 1:0817a150122b 736 case 7: mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_500_BW_0_6; break;
Wayne Roberts 1:0817a150122b 737 case 8: mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_400_BW_1_2; break;
Wayne Roberts 1:0817a150122b 738 case 9: mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_400_BW_0_6; break;
Wayne Roberts 1:0817a150122b 739 case 10: mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_250_BW_0_6; break;
Wayne Roberts 1:0817a150122b 740 case 11: mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_250_BW_0_3; break;
Wayne Roberts 1:0817a150122b 741 case 12: mpBLE_GFSK.gfskBle.bitrateBandwidth = GFSK_BLE_BR_0_125_BW_0_3; break;
Wayne Roberts 1:0817a150122b 742 }
Wayne Roberts 1:0817a150122b 743 radio.xfer(OPCODE_SET_MODULATION_PARAMS, 3, 0, mpBLE_GFSK.buf);
Wayne Roberts 1:0817a150122b 744 } else if (pktType == PACKET_TYPE_FLRC) {
Wayne Roberts 1:0817a150122b 745 switch (sidx) {
Wayne Roberts 1:0817a150122b 746 case 2: mpFLRC.flrc.bitrateBandwidth = FLRC_BR_1_300_BW_1_2; break;
Wayne Roberts 1:0817a150122b 747 case 3: mpFLRC.flrc.bitrateBandwidth = FLRC_BR_1_000_BW_1_2; break;
Wayne Roberts 1:0817a150122b 748 case 4: mpFLRC.flrc.bitrateBandwidth = FLRC_BR_0_650_BW_0_6; break;
Wayne Roberts 1:0817a150122b 749 case 5: mpFLRC.flrc.bitrateBandwidth = FLRC_BR_0_520_BW_0_6; break;
Wayne Roberts 1:0817a150122b 750 case 6: mpFLRC.flrc.bitrateBandwidth = FLRC_BR_0_325_BW_0_3; break;
Wayne Roberts 1:0817a150122b 751 case 7: mpFLRC.flrc.bitrateBandwidth = FLRC_BR_0_260_BW_0_3; break;
Wayne Roberts 1:0817a150122b 752 default:
Wayne Roberts 1:0817a150122b 753 return MENUMODE_REDRAW;
Wayne Roberts 1:0817a150122b 754 }
Wayne Roberts 1:0817a150122b 755 radio.xfer(OPCODE_SET_MODULATION_PARAMS, 3, 0, mpFLRC.buf);
Wayne Roberts 1:0817a150122b 756 }
Wayne Roberts 1:0817a150122b 757
Wayne Roberts 1:0817a150122b 758 return MENUMODE_REDRAW;
Wayne Roberts 1:0817a150122b 759 }
Wayne Roberts 1:0817a150122b 760
Wayne Roberts 3:56fc764dee0a 761 static const char* const gfsk_bpsbw[] = {
Wayne Roberts 1:0817a150122b 762 " 2.0Mbps 2.4MHz", //0 GFSK_BLE_BR_2_000_BW_2_4 0x04 // Mbps:2 bw:2.4MHz
Wayne Roberts 1:0817a150122b 763 " 1.6Mbps 2.4MHz", //1 GFSK_BLE_BR_1_600_BW_2_4 0x28 // Mbps:1.6 bw:2.4MHz
Wayne Roberts 1:0817a150122b 764 " 1.0Mbps 2.4MHz", //2 GFSK_BLE_BR_1_000_BW_2_4 0x4C // Mbps:1 bw:2.4MHz
Wayne Roberts 1:0817a150122b 765 " 1.0Mbps 1.2MHz", //3 GFSK_BLE_BR_1_000_BW_1_2 0x45 // Mbps:1 bw:1.2MHz
Wayne Roberts 1:0817a150122b 766 " 0.8Mbps 2.4MHz", //4 GFSK_BLE_BR_0_800_BW_2_4 0x70 // Mbps:0.8 bw:2.4MHz
Wayne Roberts 1:0817a150122b 767 " 0.8Mbps 1.2MHz", //5 GFSK_BLE_BR_0_800_BW_1_2 0x69 // Mbps:0.8 bw:1.2MHz
Wayne Roberts 1:0817a150122b 768 " 0.5Mbps 1.2MHz", //6 GFSK_BLE_BR_0_500_BW_1_2 0x8D // Mbps:0.5 bw:1.2MHz
Wayne Roberts 1:0817a150122b 769 " 0.5Mbps 0.6MHz", //7 GFSK_BLE_BR_0_500_BW_0_6 0x86 // Mbps:0.5 bw:0.6MHz
Wayne Roberts 1:0817a150122b 770 " 0.4Mbps 1.2MHz", //8 GFSK_BLE_BR_0_400_BW_1_2 0xB1 // Mbps:0.4 bw:1.2MHz
Wayne Roberts 1:0817a150122b 771 " 0.4Mbps 0.6MHz", //9 GFSK_BLE_BR_0_400_BW_0_6 0xAA // Mbps:0.4 bw:0.6MHz
Wayne Roberts 1:0817a150122b 772 " 0.25Mbps 0.6MHz", //10 GFSK_BLE_BR_0_250_BW_0_6 0xCE // Mbps:0.25 bw:0.6MHz
Wayne Roberts 1:0817a150122b 773 " 0.25Mbps 0.3MHz", //11 GFSK_BLE_BR_0_250_BW_0_3 0xC7 // Mbps:0.25 bw:0.3MHz
Wayne Roberts 1:0817a150122b 774 "0.125Mbps 0.3MHz", //12 GFSK_BLE_BR_0_125_BW_0_3 0xEF // Mbps:0.125 bw:0.3MHz
Wayne Roberts 1:0817a150122b 775 // 01234567890123456
Wayne Roberts 1:0817a150122b 776 NULL
Wayne Roberts 1:0817a150122b 777 };
Wayne Roberts 1:0817a150122b 778
Wayne Roberts 2:ea9245bb1c53 779 const dropdown_item_t Radio::gfsk_bitrate_item = { _ITEM_DROPDOWN, gfsk_bpsbw, gfsk_bpsbw, gfsk_flrc_bpsbw_read, gfsk_flrc_bpsbw_write};
Wayne Roberts 1:0817a150122b 780
Wayne Roberts 1:0817a150122b 781 void Radio::modindex_print()
Wayne Roberts 1:0817a150122b 782 {
Wayne Roberts 1:0817a150122b 783 float mi, Mbps, fdev_hz;
Wayne Roberts 1:0817a150122b 784 unsigned bps, freqDev;
Wayne Roberts 1:0817a150122b 785 FskModDfH_t FskModDfH;
Wayne Roberts 1:0817a150122b 786 FloraPreambleHi_t FloraPreambleHi;
Wayne Roberts 1:0817a150122b 787
Wayne Roberts 1:0817a150122b 788 FloraPreambleHi.octet = radio.readReg(REG_ADDR_FLORA_PREAMBLE_HI, 1);
Wayne Roberts 1:0817a150122b 789 switch (FloraPreambleHi.bits.data_rate) {
Wayne Roberts 1:0817a150122b 790 case 0: Mbps = 2.0; break;
Wayne Roberts 1:0817a150122b 791 case 1: Mbps = 1.6; break;
Wayne Roberts 1:0817a150122b 792 case 2: Mbps = 1.0; break;
Wayne Roberts 1:0817a150122b 793 case 3: Mbps = 0.8; break;
Wayne Roberts 1:0817a150122b 794 case 4: Mbps = 0.5; break;
Wayne Roberts 1:0817a150122b 795 case 5: Mbps = 0.4; break;
Wayne Roberts 1:0817a150122b 796 case 6: Mbps = 0.25; break;
Wayne Roberts 1:0817a150122b 797 case 7: Mbps = 0.125; break;
Wayne Roberts 1:0817a150122b 798 }
Wayne Roberts 1:0817a150122b 799
Wayne Roberts 1:0817a150122b 800 FskModDfH.octet = radio.readReg(REG_ADDR_FSK_MODDFH, 1);
Wayne Roberts 1:0817a150122b 801 freqDev = FskModDfH.bits.freqDev;
Wayne Roberts 1:0817a150122b 802 freqDev <<= 8;
Wayne Roberts 1:0817a150122b 803 freqDev |= radio.readReg(REG_ADDR_FSK_MODDFL, 1);
Wayne Roberts 1:0817a150122b 804
Wayne Roberts 1:0817a150122b 805 fdev_hz = freqDev * PLL_STEP_HZ;
Wayne Roberts 1:0817a150122b 806 bps = Mbps * 1e6;
Wayne Roberts 1:0817a150122b 807 mi = (fdev_hz * 2.0) / bps;
Wayne Roberts 1:0817a150122b 808
Wayne Roberts 1:0817a150122b 809 pc.printf("%.2f", mi);
Wayne Roberts 1:0817a150122b 810 }
Wayne Roberts 1:0817a150122b 811
Wayne Roberts 1:0817a150122b 812 bool Radio::modindex_write(const char* valStr)
Wayne Roberts 1:0817a150122b 813 {
Wayne Roberts 1:0817a150122b 814 float f;
Wayne Roberts 1:0817a150122b 815
Wayne Roberts 1:0817a150122b 816 if (sscanf(valStr, "%f", &f) == 1) {
Wayne Roberts 1:0817a150122b 817 log_printf("scanned %f from \"%s\"\r\n", f);
Wayne Roberts 1:0817a150122b 818 if (f > 0.35) {
Wayne Roberts 1:0817a150122b 819 f -= 0.5;
Wayne Roberts 1:0817a150122b 820 f /= 0.25;
Wayne Roberts 1:0817a150122b 821 log_printf("set modindex:%f\r\n", f);
Wayne Roberts 1:0817a150122b 822 mpBLE_GFSK.gfskBle.ModulationIndex = ((uint8_t)f) + 1;
Wayne Roberts 1:0817a150122b 823 log_printf("to set %02x\r\n", mpBLE_GFSK.gfskBle.ModulationIndex);
Wayne Roberts 1:0817a150122b 824 } else
Wayne Roberts 1:0817a150122b 825 mpBLE_GFSK.gfskBle.ModulationIndex = 0;
Wayne Roberts 1:0817a150122b 826
Wayne Roberts 1:0817a150122b 827 radio.xfer(OPCODE_SET_MODULATION_PARAMS, 3, 0, mpBLE_GFSK.buf);
Wayne Roberts 1:0817a150122b 828 }
Wayne Roberts 1:0817a150122b 829 return false;
Wayne Roberts 1:0817a150122b 830 }
Wayne Roberts 1:0817a150122b 831
Wayne Roberts 4:fa31fdf4ec8d 832 const value_item_t Radio::gfsk_modindex_item = { _ITEM_VALUE, 5, modindex_print, modindex_write };
Wayne Roberts 1:0817a150122b 833
Wayne Roberts 3:56fc764dee0a 834 static const char* const gfsk_flrc_bts[] = {
Wayne Roberts 1:0817a150122b 835 "off",
Wayne Roberts 1:0817a150122b 836 "1.0",
Wayne Roberts 1:0817a150122b 837 "0.5",
Wayne Roberts 1:0817a150122b 838 "0.3",
Wayne Roberts 1:0817a150122b 839 NULL
Wayne Roberts 1:0817a150122b 840 };
Wayne Roberts 1:0817a150122b 841
Wayne Roberts 2:ea9245bb1c53 842 unsigned Radio::gfsk_flrc_bt_read(bool fw)
Wayne Roberts 1:0817a150122b 843 {
Wayne Roberts 1:0817a150122b 844 FskCfg_t FskCfg;
Wayne Roberts 1:0817a150122b 845 FskCfg.octet = radio.readReg(REG_ADDR_FSK_CFG, 1);
Wayne Roberts 1:0817a150122b 846 return FskCfg.bits.gf_bt;
Wayne Roberts 1:0817a150122b 847 }
Wayne Roberts 1:0817a150122b 848
Wayne Roberts 2:ea9245bb1c53 849 menuMode_e Radio::gfsk_flrc_bt_write(unsigned sidx)
Wayne Roberts 1:0817a150122b 850 {
Wayne Roberts 1:0817a150122b 851 mpBLE_GFSK.gfskBle.ModulationShaping = sidx << 4;
Wayne Roberts 1:0817a150122b 852 radio.xfer(OPCODE_SET_MODULATION_PARAMS, 3, 0, mpBLE_GFSK.buf);
Wayne Roberts 1:0817a150122b 853 return MENUMODE_REDRAW;
Wayne Roberts 1:0817a150122b 854 }
Wayne Roberts 1:0817a150122b 855
Wayne Roberts 2:ea9245bb1c53 856 const dropdown_item_t Radio::gfsk_flrc_bt_item = { _ITEM_DROPDOWN, gfsk_flrc_bts, gfsk_flrc_bts, gfsk_flrc_bt_read, gfsk_flrc_bt_write};
Wayne Roberts 1:0817a150122b 857
Wayne Roberts 3:56fc764dee0a 858 static const char* const gfsk_flrc_pblLens[] = {
Wayne Roberts 1:0817a150122b 859 "4",
Wayne Roberts 1:0817a150122b 860 "8",
Wayne Roberts 1:0817a150122b 861 "12",
Wayne Roberts 1:0817a150122b 862 "16",
Wayne Roberts 1:0817a150122b 863 "20",
Wayne Roberts 1:0817a150122b 864 "24",
Wayne Roberts 1:0817a150122b 865 "28",
Wayne Roberts 1:0817a150122b 866 "32",
Wayne Roberts 1:0817a150122b 867 NULL,
Wayne Roberts 1:0817a150122b 868 };
Wayne Roberts 1:0817a150122b 869
Wayne Roberts 2:ea9245bb1c53 870 unsigned Radio::gfsk_flrc_pl_read(bool fw)
Wayne Roberts 1:0817a150122b 871 {
Wayne Roberts 1:0817a150122b 872 PktCtrl1_t PktCtrl1;
Wayne Roberts 1:0817a150122b 873 PktCtrl1.octet = radio.readReg(REG_ADDR_PKTCTRL1, 1);
Wayne Roberts 1:0817a150122b 874 ppFLRC.gfskFLRC.PreambleLength = PktCtrl1.octet & 0x70;
Wayne Roberts 1:0817a150122b 875 ppGFSK.gfskFLRC.PreambleLength = ppFLRC.gfskFLRC.PreambleLength;
Wayne Roberts 1:0817a150122b 876 return PktCtrl1.gfsk.preamble_len;
Wayne Roberts 1:0817a150122b 877 }
Wayne Roberts 1:0817a150122b 878
Wayne Roberts 2:ea9245bb1c53 879 menuMode_e Radio::gfsk_flrc_pl_write(unsigned sidx)
Wayne Roberts 1:0817a150122b 880 {
Wayne Roberts 1:0817a150122b 881 ppFLRC.gfskFLRC.PreambleLength = sidx << 4;
Wayne Roberts 1:0817a150122b 882 ppGFSK.gfskFLRC.PreambleLength = ppFLRC.gfskFLRC.PreambleLength;
Wayne Roberts 1:0817a150122b 883 radio.xfer(OPCODE_SET_PACKET_PARAMS, 7, 0, ppGFSK.buf);
Wayne Roberts 1:0817a150122b 884 return MENUMODE_REDRAW;
Wayne Roberts 1:0817a150122b 885 }
Wayne Roberts 1:0817a150122b 886
Wayne Roberts 2:ea9245bb1c53 887 const dropdown_item_t Radio::gfsk_flrc_preamble_item = { _ITEM_DROPDOWN, gfsk_flrc_pblLens, gfsk_flrc_pblLens, gfsk_flrc_pl_read, gfsk_flrc_pl_write};
Wayne Roberts 1:0817a150122b 888
Wayne Roberts 3:56fc764dee0a 889 static const char* const gfsk_syncLens[] = {
Wayne Roberts 1:0817a150122b 890 "1", // 0
Wayne Roberts 1:0817a150122b 891 "2", // 1
Wayne Roberts 1:0817a150122b 892 "3", // 2
Wayne Roberts 1:0817a150122b 893 "4", // 3
Wayne Roberts 1:0817a150122b 894 "5", // 4
Wayne Roberts 1:0817a150122b 895 NULL,
Wayne Roberts 1:0817a150122b 896 };
Wayne Roberts 1:0817a150122b 897
Wayne Roberts 2:ea9245bb1c53 898 unsigned Radio::gfsk_synclen_read(bool fw)
Wayne Roberts 1:0817a150122b 899 {
Wayne Roberts 1:0817a150122b 900 PktCtrl1_t PktCtrl1;
Wayne Roberts 1:0817a150122b 901 PktCtrl1.octet = radio.readReg(REG_ADDR_PKTCTRL1, 1);
Wayne Roberts 1:0817a150122b 902
Wayne Roberts 1:0817a150122b 903 ppGFSK.gfskFLRC.SyncWordLength = PktCtrl1.octet & 0x0e;
Wayne Roberts 1:0817a150122b 904 ppFLRC.gfskFLRC.SyncWordLength = PktCtrl1.octet & 0x06;
Wayne Roberts 1:0817a150122b 905
Wayne Roberts 1:0817a150122b 906 return PktCtrl1.gfsk.sync_adrs_len;
Wayne Roberts 1:0817a150122b 907 }
Wayne Roberts 1:0817a150122b 908
Wayne Roberts 2:ea9245bb1c53 909 menuMode_e Radio::gfsk_synclen_write(unsigned sidx)
Wayne Roberts 1:0817a150122b 910 {
Wayne Roberts 1:0817a150122b 911 ppGFSK.gfskFLRC.SyncWordLength = sidx << 1;
Wayne Roberts 1:0817a150122b 912 //log_printf("SWL %u %02x\r\n", sidx, ppGFSK.gfskFLRC.SyncWordLength);
Wayne Roberts 1:0817a150122b 913 radio.xfer(OPCODE_SET_PACKET_PARAMS, 7, 0, ppGFSK.buf);
Wayne Roberts 1:0817a150122b 914 //return MENUMODE_NONE;
Wayne Roberts 1:0817a150122b 915 return MENUMODE_REDRAW;
Wayne Roberts 1:0817a150122b 916 }
Wayne Roberts 1:0817a150122b 917
Wayne Roberts 2:ea9245bb1c53 918 const dropdown_item_t Radio::gfsk_synclen_item = { _ITEM_DROPDOWN, gfsk_syncLens, gfsk_syncLens, gfsk_synclen_read, gfsk_synclen_write};
Wayne Roberts 1:0817a150122b 919
Wayne Roberts 1:0817a150122b 920 bool Radio::gfsk_flrc_fixvar_read()
Wayne Roberts 1:0817a150122b 921 {
Wayne Roberts 1:0817a150122b 922 PktCtrl0_t PktCtrl0;
Wayne Roberts 1:0817a150122b 923 PktCtrl0.octet = radio.readReg(REG_ADDR_PKTCTRL0, 1);
Wayne Roberts 1:0817a150122b 924
Wayne Roberts 1:0817a150122b 925 ppGFSK.gfskFLRC.HeaderType = PktCtrl0.octet & 0x20;
Wayne Roberts 1:0817a150122b 926 ppFLRC.gfskFLRC.HeaderType = PktCtrl0.octet & 0x20;
Wayne Roberts 1:0817a150122b 927
Wayne Roberts 1:0817a150122b 928 return PktCtrl0.bits.pkt_len_format;
Wayne Roberts 1:0817a150122b 929 }
Wayne Roberts 1:0817a150122b 930
Wayne Roberts 1:0817a150122b 931 bool Radio::gfsk_flrc_fixvar_push()
Wayne Roberts 1:0817a150122b 932 {
Wayne Roberts 1:0817a150122b 933 PacketParams_t* pp;
Wayne Roberts 1:0817a150122b 934 pktType = radio.getPacketType();
Wayne Roberts 1:0817a150122b 935
Wayne Roberts 1:0817a150122b 936 if (pktType == PACKET_TYPE_FLRC)
Wayne Roberts 1:0817a150122b 937 pp = &ppFLRC;
Wayne Roberts 1:0817a150122b 938 else if (pktType == PACKET_TYPE_GFSK)
Wayne Roberts 1:0817a150122b 939 pp = &ppGFSK;
Wayne Roberts 1:0817a150122b 940 else
Wayne Roberts 1:0817a150122b 941 return false;
Wayne Roberts 1:0817a150122b 942
Wayne Roberts 1:0817a150122b 943 if (pp->gfskFLRC.HeaderType == RADIO_PACKET_VARIABLE_LENGTH)
Wayne Roberts 1:0817a150122b 944 pp->gfskFLRC.HeaderType = RADIO_PACKET_FIXED_LENGTH;
Wayne Roberts 1:0817a150122b 945 else
Wayne Roberts 1:0817a150122b 946 pp->gfskFLRC.HeaderType = RADIO_PACKET_VARIABLE_LENGTH;
Wayne Roberts 1:0817a150122b 947
Wayne Roberts 1:0817a150122b 948 radio.xfer(OPCODE_SET_PACKET_PARAMS, 7, 0, pp->buf);
Wayne Roberts 1:0817a150122b 949
Wayne Roberts 1:0817a150122b 950 return pp->gfskFLRC.HeaderType == RADIO_PACKET_VARIABLE_LENGTH;
Wayne Roberts 1:0817a150122b 951 }
Wayne Roberts 1:0817a150122b 952
Wayne Roberts 1:0817a150122b 953 const toggle_item_t Radio::gfsk_flrc_fixvar_item = { _ITEM_TOGGLE,
Wayne Roberts 1:0817a150122b 954 "fixed ",
Wayne Roberts 1:0817a150122b 955 "variable",
Wayne Roberts 1:0817a150122b 956 gfsk_flrc_fixvar_read, gfsk_flrc_fixvar_push
Wayne Roberts 1:0817a150122b 957 };
Wayne Roberts 1:0817a150122b 958
Wayne Roberts 3:56fc764dee0a 959 static const char* const gfsk_flrc_crclens[] = {
Wayne Roberts 1:0817a150122b 960 "0 off",
Wayne Roberts 1:0817a150122b 961 "1 byte",
Wayne Roberts 1:0817a150122b 962 "2 bytes",
Wayne Roberts 1:0817a150122b 963 NULL,
Wayne Roberts 1:0817a150122b 964 };
Wayne Roberts 1:0817a150122b 965
Wayne Roberts 2:ea9245bb1c53 966 unsigned Radio::gfsk_flrc_crclen_read(bool fw)
Wayne Roberts 1:0817a150122b 967 {
Wayne Roberts 1:0817a150122b 968 PktBitStreamCtrl_t PktBitStreamCtrl;
Wayne Roberts 1:0817a150122b 969 PktBitStreamCtrl.octet = radio.readReg(REG_ADDR_PKT_BITSTREAM_CTRL, 1);
Wayne Roberts 1:0817a150122b 970 ppGFSK.gfskFLRC.CRCLength = PktBitStreamCtrl.octet & 0x30;
Wayne Roberts 1:0817a150122b 971 return PktBitStreamCtrl.bits.crc_mode;
Wayne Roberts 1:0817a150122b 972 }
Wayne Roberts 1:0817a150122b 973
Wayne Roberts 2:ea9245bb1c53 974 menuMode_e Radio::gfsk_flrc_crclen_write(unsigned sidx)
Wayne Roberts 1:0817a150122b 975 {
Wayne Roberts 1:0817a150122b 976 pktType = radio.getPacketType();
Wayne Roberts 1:0817a150122b 977
Wayne Roberts 1:0817a150122b 978 ppGFSK.gfskFLRC.CRCLength = (sidx & 3) << 4;
Wayne Roberts 1:0817a150122b 979 ppFLRC.gfskFLRC.CRCLength = (sidx & 3) << 4;
Wayne Roberts 1:0817a150122b 980
Wayne Roberts 1:0817a150122b 981 if (pktType == PACKET_TYPE_GFSK)
Wayne Roberts 1:0817a150122b 982 radio.xfer(OPCODE_SET_PACKET_PARAMS, 7, 0, ppGFSK.buf);
Wayne Roberts 1:0817a150122b 983 else if (pktType == PACKET_TYPE_FLRC)
Wayne Roberts 1:0817a150122b 984 radio.xfer(OPCODE_SET_PACKET_PARAMS, 7, 0, ppFLRC.buf);
Wayne Roberts 1:0817a150122b 985
Wayne Roberts 1:0817a150122b 986 return MENUMODE_REDRAW;
Wayne Roberts 1:0817a150122b 987 }
Wayne Roberts 1:0817a150122b 988
Wayne Roberts 2:ea9245bb1c53 989 const dropdown_item_t Radio::gfsk_flrc_crclen_item = { _ITEM_DROPDOWN, gfsk_flrc_crclens, gfsk_flrc_crclens, gfsk_flrc_crclen_read, gfsk_flrc_crclen_write};
Wayne Roberts 1:0817a150122b 990
Wayne Roberts 1:0817a150122b 991 bool Radio::gfsk_flrc_whit_read()
Wayne Roberts 1:0817a150122b 992 {
Wayne Roberts 1:0817a150122b 993 PktBitStreamCtrl_t PktBitStreamCtrl;
Wayne Roberts 1:0817a150122b 994 PktBitStreamCtrl.octet = radio.readReg(REG_ADDR_PKT_BITSTREAM_CTRL, 1);
Wayne Roberts 1:0817a150122b 995 ppGFSK.gfskFLRC.Whitening = PktBitStreamCtrl.octet & 0x08;
Wayne Roberts 1:0817a150122b 996 ppFLRC.gfskFLRC.Whitening = PktBitStreamCtrl.octet & 0x08;
Wayne Roberts 1:0817a150122b 997 return PktBitStreamCtrl.bits.whit_disable;
Wayne Roberts 1:0817a150122b 998 }
Wayne Roberts 1:0817a150122b 999
Wayne Roberts 1:0817a150122b 1000 bool Radio::gfsk_flrc_whit_push()
Wayne Roberts 1:0817a150122b 1001 {
Wayne Roberts 1:0817a150122b 1002 pktType = radio.getPacketType();
Wayne Roberts 1:0817a150122b 1003
Wayne Roberts 1:0817a150122b 1004 if (ppGFSK.gfskFLRC.Whitening == WHITENING_DISABLE)
Wayne Roberts 1:0817a150122b 1005 ppGFSK.gfskFLRC.Whitening = WHITENING_ENABLE;
Wayne Roberts 1:0817a150122b 1006 else
Wayne Roberts 1:0817a150122b 1007 ppGFSK.gfskFLRC.Whitening = WHITENING_DISABLE;
Wayne Roberts 1:0817a150122b 1008
Wayne Roberts 1:0817a150122b 1009 ppFLRC.gfskFLRC.Whitening = ppGFSK.gfskFLRC.Whitening;
Wayne Roberts 1:0817a150122b 1010
Wayne Roberts 1:0817a150122b 1011 if (pktType == PACKET_TYPE_GFSK)
Wayne Roberts 1:0817a150122b 1012 radio.xfer(OPCODE_SET_PACKET_PARAMS, 7, 0, ppGFSK.buf);
Wayne Roberts 1:0817a150122b 1013 else if (pktType == PACKET_TYPE_FLRC)
Wayne Roberts 1:0817a150122b 1014 radio.xfer(OPCODE_SET_PACKET_PARAMS, 7, 0, ppFLRC.buf);
Wayne Roberts 1:0817a150122b 1015
Wayne Roberts 1:0817a150122b 1016 return ppGFSK.gfskFLRC.Whitening == WHITENING_DISABLE;
Wayne Roberts 1:0817a150122b 1017 }
Wayne Roberts 1:0817a150122b 1018
Wayne Roberts 1:0817a150122b 1019 const toggle_item_t Radio::gfsk_flrc_whit_item = { _ITEM_TOGGLE,
Wayne Roberts 1:0817a150122b 1020 "ENABLE ",
Wayne Roberts 1:0817a150122b 1021 "DISABLE",
Wayne Roberts 1:0817a150122b 1022 gfsk_flrc_whit_read, gfsk_flrc_whit_push
Wayne Roberts 1:0817a150122b 1023 };
Wayne Roberts 1:0817a150122b 1024
Wayne Roberts 1:0817a150122b 1025 void Radio::gfsk_flrc_crcinit_print()
Wayne Roberts 1:0817a150122b 1026 {
Wayne Roberts 1:0817a150122b 1027 unsigned val = radio.readReg(0x9c8, 2);
Wayne Roberts 1:0817a150122b 1028 pc.printf("0x%04x", val);
Wayne Roberts 1:0817a150122b 1029 }
Wayne Roberts 1:0817a150122b 1030
Wayne Roberts 1:0817a150122b 1031 bool Radio::gfsk_flrc_crcinit_write(const char* txt)
Wayne Roberts 1:0817a150122b 1032 {
Wayne Roberts 1:0817a150122b 1033 unsigned val;
Wayne Roberts 1:0817a150122b 1034 sscanf(txt, "%x", &val);
Wayne Roberts 1:0817a150122b 1035 radio.writeReg(0x9c8, val, 2);
Wayne Roberts 1:0817a150122b 1036 return false;
Wayne Roberts 1:0817a150122b 1037 }
Wayne Roberts 1:0817a150122b 1038
Wayne Roberts 1:0817a150122b 1039 const value_item_t Radio::gfsk_flrc_crcinit_item = { _ITEM_VALUE, 7, gfsk_flrc_crcinit_print, gfsk_flrc_crcinit_write };
Wayne Roberts 1:0817a150122b 1040
Wayne Roberts 1:0817a150122b 1041 void Radio::gfsk_flrc_crcpoly_print(void)
Wayne Roberts 1:0817a150122b 1042 {
Wayne Roberts 1:0817a150122b 1043 unsigned val = radio.readReg(0x9c6, 2);
Wayne Roberts 1:0817a150122b 1044 pc.printf("0x%04x", val);
Wayne Roberts 1:0817a150122b 1045 }
Wayne Roberts 1:0817a150122b 1046
Wayne Roberts 1:0817a150122b 1047 bool Radio::gfsk_flrc_crcpoly_write(const char* txt)
Wayne Roberts 1:0817a150122b 1048 {
Wayne Roberts 1:0817a150122b 1049 unsigned val;
Wayne Roberts 1:0817a150122b 1050 sscanf(txt, "%x", &val);
Wayne Roberts 1:0817a150122b 1051 radio.writeReg(0x9c6, val, 2);
Wayne Roberts 1:0817a150122b 1052 return false;
Wayne Roberts 1:0817a150122b 1053 }
Wayne Roberts 1:0817a150122b 1054
Wayne Roberts 1:0817a150122b 1055 const value_item_t Radio::gfsk_flrc_crcpoly_item = { _ITEM_VALUE, 7, gfsk_flrc_crcpoly_print, gfsk_flrc_crcpoly_write };
Wayne Roberts 1:0817a150122b 1056
Wayne Roberts 1:0817a150122b 1057 bool Radio::gfsk_flrc_sync1en_read()
Wayne Roberts 1:0817a150122b 1058 {
Wayne Roberts 1:0817a150122b 1059 PktSyncAdrs_t PktSyncAdrs;
Wayne Roberts 1:0817a150122b 1060 PktSyncAdrs.octet = radio.readReg(REG_ADDR_PKT_SYNC_ADRS_CTRL, 1);
Wayne Roberts 1:0817a150122b 1061
Wayne Roberts 1:0817a150122b 1062 ppGFSK.gfskFLRC.SyncWordMatch = PktSyncAdrs.octet & 0x70;
Wayne Roberts 1:0817a150122b 1063 ppFLRC.gfskFLRC.SyncWordMatch = PktSyncAdrs.octet & 0x70;
Wayne Roberts 1:0817a150122b 1064
Wayne Roberts 1:0817a150122b 1065 return PktSyncAdrs.gfskflrc.sync_addr_mask & 1;
Wayne Roberts 1:0817a150122b 1066 }
Wayne Roberts 1:0817a150122b 1067
Wayne Roberts 1:0817a150122b 1068 bool Radio::gfsk_flrc_sync2en_read()
Wayne Roberts 1:0817a150122b 1069 {
Wayne Roberts 1:0817a150122b 1070 PktSyncAdrs_t PktSyncAdrs;
Wayne Roberts 1:0817a150122b 1071 PktSyncAdrs.octet = radio.readReg(REG_ADDR_PKT_SYNC_ADRS_CTRL, 1);
Wayne Roberts 1:0817a150122b 1072
Wayne Roberts 1:0817a150122b 1073 ppGFSK.gfskFLRC.SyncWordMatch = PktSyncAdrs.octet & 0x70;
Wayne Roberts 1:0817a150122b 1074 ppFLRC.gfskFLRC.SyncWordMatch = PktSyncAdrs.octet & 0x70;
Wayne Roberts 1:0817a150122b 1075
Wayne Roberts 1:0817a150122b 1076 return ppGFSK.gfskFLRC.SyncWordMatch & 0x20;
Wayne Roberts 1:0817a150122b 1077 }
Wayne Roberts 1:0817a150122b 1078
Wayne Roberts 1:0817a150122b 1079 bool Radio::gfsk_flrc_sync3en_read()
Wayne Roberts 1:0817a150122b 1080 {
Wayne Roberts 1:0817a150122b 1081 PktSyncAdrs_t PktSyncAdrs;
Wayne Roberts 1:0817a150122b 1082 PktSyncAdrs.octet = radio.readReg(REG_ADDR_PKT_SYNC_ADRS_CTRL, 1);
Wayne Roberts 1:0817a150122b 1083
Wayne Roberts 1:0817a150122b 1084 ppGFSK.gfskFLRC.SyncWordMatch = PktSyncAdrs.octet & 0x70;
Wayne Roberts 1:0817a150122b 1085 ppFLRC.gfskFLRC.SyncWordMatch = PktSyncAdrs.octet & 0x70;
Wayne Roberts 1:0817a150122b 1086
Wayne Roberts 1:0817a150122b 1087 return ppGFSK.gfskFLRC.SyncWordMatch & 0x40;
Wayne Roberts 1:0817a150122b 1088 //return PktSyncAdrs.gfskflrc.sync_addr_mask & 4;
Wayne Roberts 1:0817a150122b 1089 }
Wayne Roberts 1:0817a150122b 1090
Wayne Roberts 1:0817a150122b 1091 bool Radio::gfsk_flrc_sync1en_push()
Wayne Roberts 1:0817a150122b 1092 {
Wayne Roberts 1:0817a150122b 1093 if (ppGFSK.gfskFLRC.SyncWordMatch & 0x10)
Wayne Roberts 1:0817a150122b 1094 ppGFSK.gfskFLRC.SyncWordMatch &= ~0x10;
Wayne Roberts 1:0817a150122b 1095 else
Wayne Roberts 1:0817a150122b 1096 ppGFSK.gfskFLRC.SyncWordMatch |= 0x10;
Wayne Roberts 1:0817a150122b 1097
Wayne Roberts 1:0817a150122b 1098 radio.xfer(OPCODE_SET_PACKET_PARAMS, 7, 0, ppGFSK.buf);
Wayne Roberts 1:0817a150122b 1099
Wayne Roberts 1:0817a150122b 1100 ppFLRC.gfskFLRC.SyncWordMatch = ppGFSK.gfskFLRC.SyncWordMatch;
Wayne Roberts 1:0817a150122b 1101
Wayne Roberts 1:0817a150122b 1102 return ppGFSK.gfskFLRC.SyncWordMatch & 0x10;
Wayne Roberts 1:0817a150122b 1103 }
Wayne Roberts 1:0817a150122b 1104
Wayne Roberts 1:0817a150122b 1105 bool Radio::gfsk_flrc_sync2en_push()
Wayne Roberts 1:0817a150122b 1106 {
Wayne Roberts 1:0817a150122b 1107 if (ppGFSK.gfskFLRC.SyncWordMatch & 0x20)
Wayne Roberts 1:0817a150122b 1108 ppGFSK.gfskFLRC.SyncWordMatch &= ~0x20;
Wayne Roberts 1:0817a150122b 1109 else
Wayne Roberts 1:0817a150122b 1110 ppGFSK.gfskFLRC.SyncWordMatch |= 0x20;
Wayne Roberts 1:0817a150122b 1111
Wayne Roberts 1:0817a150122b 1112 radio.xfer(OPCODE_SET_PACKET_PARAMS, 7, 0, ppGFSK.buf);
Wayne Roberts 1:0817a150122b 1113
Wayne Roberts 1:0817a150122b 1114 ppFLRC.gfskFLRC.SyncWordMatch = ppGFSK.gfskFLRC.SyncWordMatch;
Wayne Roberts 1:0817a150122b 1115
Wayne Roberts 1:0817a150122b 1116 return ppGFSK.gfskFLRC.SyncWordMatch & 0x20;
Wayne Roberts 1:0817a150122b 1117 }
Wayne Roberts 1:0817a150122b 1118
Wayne Roberts 1:0817a150122b 1119 bool Radio::gfsk_flrc_sync3en_push()
Wayne Roberts 1:0817a150122b 1120 {
Wayne Roberts 1:0817a150122b 1121 if (ppGFSK.gfskFLRC.SyncWordMatch & 0x40)
Wayne Roberts 1:0817a150122b 1122 ppGFSK.gfskFLRC.SyncWordMatch &= ~0x40;
Wayne Roberts 1:0817a150122b 1123 else
Wayne Roberts 1:0817a150122b 1124 ppGFSK.gfskFLRC.SyncWordMatch |= 0x40;
Wayne Roberts 1:0817a150122b 1125
Wayne Roberts 1:0817a150122b 1126 radio.xfer(OPCODE_SET_PACKET_PARAMS, 7, 0, ppGFSK.buf);
Wayne Roberts 1:0817a150122b 1127
Wayne Roberts 1:0817a150122b 1128 ppFLRC.gfskFLRC.SyncWordMatch = ppGFSK.gfskFLRC.SyncWordMatch;
Wayne Roberts 1:0817a150122b 1129
Wayne Roberts 1:0817a150122b 1130 return ppGFSK.gfskFLRC.SyncWordMatch & 0x40;
Wayne Roberts 1:0817a150122b 1131 }
Wayne Roberts 1:0817a150122b 1132
Wayne Roberts 1:0817a150122b 1133 const toggle_item_t Radio::gfsk_flrc_sync1en_item = { _ITEM_TOGGLE, "off:", " ON:", gfsk_flrc_sync1en_read, gfsk_flrc_sync1en_push};
Wayne Roberts 1:0817a150122b 1134 const toggle_item_t Radio::gfsk_flrc_sync2en_item = { _ITEM_TOGGLE, "off:", " ON:", gfsk_flrc_sync2en_read, gfsk_flrc_sync2en_push};
Wayne Roberts 1:0817a150122b 1135 const toggle_item_t Radio::gfsk_flrc_sync3en_item = { _ITEM_TOGGLE, "off:", " ON:", gfsk_flrc_sync3en_read, gfsk_flrc_sync3en_push};
Wayne Roberts 1:0817a150122b 1136
Wayne Roberts 1:0817a150122b 1137 void Radio::gfsk_flrc_sync1_print(void)
Wayne Roberts 1:0817a150122b 1138 {
Wayne Roberts 1:0817a150122b 1139 uint64_t val;
Wayne Roberts 1:0817a150122b 1140 uint32_t val32 = radio.readReg(REG_ADDR_PKT_SYNC_ADRS_1+1, 4);
Wayne Roberts 1:0817a150122b 1141 uint32_t upper = radio.readReg(REG_ADDR_PKT_SYNC_ADRS_1, 1);
Wayne Roberts 1:0817a150122b 1142 val = upper;
Wayne Roberts 1:0817a150122b 1143 val <<= 32;
Wayne Roberts 1:0817a150122b 1144 val |= val32;
Wayne Roberts 1:0817a150122b 1145 pc.printf("%llx", val);
Wayne Roberts 1:0817a150122b 1146 }
Wayne Roberts 1:0817a150122b 1147
Wayne Roberts 1:0817a150122b 1148 void Radio::gfsk_flrc_sync2_print(void)
Wayne Roberts 1:0817a150122b 1149 {
Wayne Roberts 1:0817a150122b 1150 uint64_t val;
Wayne Roberts 1:0817a150122b 1151 uint32_t val32 = radio.readReg(REG_ADDR_PKT_SYNC_ADRS_2+1, 4);
Wayne Roberts 1:0817a150122b 1152 uint32_t upper = radio.readReg(REG_ADDR_PKT_SYNC_ADRS_2, 1);
Wayne Roberts 1:0817a150122b 1153 val = upper;
Wayne Roberts 1:0817a150122b 1154 val <<= 32;
Wayne Roberts 1:0817a150122b 1155 val |= val32;
Wayne Roberts 1:0817a150122b 1156 pc.printf("%llx", val);
Wayne Roberts 1:0817a150122b 1157 }
Wayne Roberts 1:0817a150122b 1158
Wayne Roberts 1:0817a150122b 1159 void Radio::gfsk_flrc_sync3_print(void)
Wayne Roberts 1:0817a150122b 1160 {
Wayne Roberts 1:0817a150122b 1161 uint64_t val;
Wayne Roberts 1:0817a150122b 1162 uint32_t val32 = radio.readReg(REG_ADDR_PKT_SYNC_ADRS_3+1, 4);
Wayne Roberts 1:0817a150122b 1163 uint32_t upper = radio.readReg(REG_ADDR_PKT_SYNC_ADRS_3, 1);
Wayne Roberts 1:0817a150122b 1164 val = upper;
Wayne Roberts 1:0817a150122b 1165 val <<= 32;
Wayne Roberts 1:0817a150122b 1166 val |= val32;
Wayne Roberts 1:0817a150122b 1167 pc.printf("%llx", val);
Wayne Roberts 1:0817a150122b 1168 }
Wayne Roberts 1:0817a150122b 1169
Wayne Roberts 1:0817a150122b 1170 bool Radio::gfsk_flrc_sync1_write(const char* txt)
Wayne Roberts 1:0817a150122b 1171 {
Wayne Roberts 1:0817a150122b 1172 uint32_t val32, upper;
Wayne Roberts 1:0817a150122b 1173 uint64_t val;
Wayne Roberts 1:0817a150122b 1174 sscanf(txt, "%llx", &val);
Wayne Roberts 1:0817a150122b 1175
Wayne Roberts 1:0817a150122b 1176 val32 = val;
Wayne Roberts 1:0817a150122b 1177 val >>= 32;
Wayne Roberts 1:0817a150122b 1178 upper = val;
Wayne Roberts 1:0817a150122b 1179
Wayne Roberts 1:0817a150122b 1180 radio.writeReg(REG_ADDR_PKT_SYNC_ADRS_1, upper, 1);
Wayne Roberts 1:0817a150122b 1181 radio.writeReg(REG_ADDR_PKT_SYNC_ADRS_1+1, val32, 4);
Wayne Roberts 1:0817a150122b 1182
Wayne Roberts 1:0817a150122b 1183 return false;
Wayne Roberts 1:0817a150122b 1184 }
Wayne Roberts 1:0817a150122b 1185
Wayne Roberts 1:0817a150122b 1186 bool Radio::gfsk_flrc_sync2_write(const char* txt)
Wayne Roberts 1:0817a150122b 1187 {
Wayne Roberts 1:0817a150122b 1188 uint32_t val32, upper;
Wayne Roberts 1:0817a150122b 1189 uint64_t val;
Wayne Roberts 1:0817a150122b 1190 sscanf(txt, "%llx", &val);
Wayne Roberts 1:0817a150122b 1191
Wayne Roberts 1:0817a150122b 1192 val32 = val;
Wayne Roberts 1:0817a150122b 1193 val >>= 32;
Wayne Roberts 1:0817a150122b 1194 upper = val;
Wayne Roberts 1:0817a150122b 1195
Wayne Roberts 1:0817a150122b 1196 radio.writeReg(REG_ADDR_PKT_SYNC_ADRS_2, upper, 1);
Wayne Roberts 1:0817a150122b 1197 radio.writeReg(REG_ADDR_PKT_SYNC_ADRS_2+1, val32, 4);
Wayne Roberts 1:0817a150122b 1198
Wayne Roberts 1:0817a150122b 1199 return false;
Wayne Roberts 1:0817a150122b 1200 }
Wayne Roberts 1:0817a150122b 1201
Wayne Roberts 1:0817a150122b 1202 bool Radio::gfsk_flrc_sync3_write(const char* txt)
Wayne Roberts 1:0817a150122b 1203 {
Wayne Roberts 1:0817a150122b 1204 uint32_t val32, upper;
Wayne Roberts 1:0817a150122b 1205 uint64_t val;
Wayne Roberts 1:0817a150122b 1206 sscanf(txt, "%llx", &val);
Wayne Roberts 1:0817a150122b 1207
Wayne Roberts 1:0817a150122b 1208 val32 = val;
Wayne Roberts 1:0817a150122b 1209 val >>= 32;
Wayne Roberts 1:0817a150122b 1210 upper = val;
Wayne Roberts 1:0817a150122b 1211
Wayne Roberts 1:0817a150122b 1212 radio.writeReg(REG_ADDR_PKT_SYNC_ADRS_3, upper, 1);
Wayne Roberts 1:0817a150122b 1213 radio.writeReg(REG_ADDR_PKT_SYNC_ADRS_3+1, val32, 4);
Wayne Roberts 1:0817a150122b 1214
Wayne Roberts 1:0817a150122b 1215 return false;
Wayne Roberts 1:0817a150122b 1216 }
Wayne Roberts 1:0817a150122b 1217
Wayne Roberts 1:0817a150122b 1218 const value_item_t Radio::gfsk_flrc_sync1_item = { _ITEM_VALUE, 10, gfsk_flrc_sync1_print, gfsk_flrc_sync1_write };
Wayne Roberts 1:0817a150122b 1219 const value_item_t Radio::gfsk_flrc_sync2_item = { _ITEM_VALUE, 10, gfsk_flrc_sync2_print, gfsk_flrc_sync2_write };
Wayne Roberts 1:0817a150122b 1220 const value_item_t Radio::gfsk_flrc_sync3_item = { _ITEM_VALUE, 10, gfsk_flrc_sync3_print, gfsk_flrc_sync3_write };
Wayne Roberts 1:0817a150122b 1221
Wayne Roberts 1:0817a150122b 1222
Wayne Roberts 1:0817a150122b 1223 const menu_t Radio::gfsk_menu[] = {
Wayne Roberts 4:fa31fdf4ec8d 1224 { {FIRST_CHIP_MENU_ROW+1, 1}, NULL, &gfsk_bitrate_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1225 { {FIRST_CHIP_MENU_ROW+1, 19}, "mod index:", &gfsk_modindex_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1226 { {FIRST_CHIP_MENU_ROW+1, 35}, "BT:", &gfsk_flrc_bt_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1227 { {FIRST_CHIP_MENU_ROW+1, 43}, "PreambleLength:", &gfsk_flrc_preamble_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1228 { {FIRST_CHIP_MENU_ROW+1, 61}, "SyncLength:", &gfsk_synclen_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 1:0817a150122b 1229
Wayne Roberts 4:fa31fdf4ec8d 1230 { {FIRST_CHIP_MENU_ROW+2, 1}, "Length:", &gfsk_flrc_fixvar_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1231 { {FIRST_CHIP_MENU_ROW+2, 18}, "crcLength:", &gfsk_flrc_crclen_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1232 { {FIRST_CHIP_MENU_ROW+2, 37}, "whitening:", &gfsk_flrc_whit_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1233 { {FIRST_CHIP_MENU_ROW+2, 57}, "crcInit:", &gfsk_flrc_crcinit_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1234 { {FIRST_CHIP_MENU_ROW+2, 72}, "poly:", &gfsk_flrc_crcpoly_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 1:0817a150122b 1235
Wayne Roberts 4:fa31fdf4ec8d 1236 { {FIRST_CHIP_MENU_ROW+3, 1}, "sync1 ", &gfsk_flrc_sync1en_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1237 { {FIRST_CHIP_MENU_ROW+3, 15}, NULL, &gfsk_flrc_sync1_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1238 { {FIRST_CHIP_MENU_ROW+3, 27}, "sync2 ", &gfsk_flrc_sync2en_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1239 { {FIRST_CHIP_MENU_ROW+3, 41}, NULL, &gfsk_flrc_sync2_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1240 { {FIRST_CHIP_MENU_ROW+3, 53}, "sync3 ", &gfsk_flrc_sync3en_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1241 { {FIRST_CHIP_MENU_ROW+3, 65}, NULL, &gfsk_flrc_sync3_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 1:0817a150122b 1242
Wayne Roberts 1:0817a150122b 1243 { {0, 0}, NULL, NULL }
Wayne Roberts 1:0817a150122b 1244 };
Wayne Roberts 1:0817a150122b 1245
Wayne Roberts 3:56fc764dee0a 1246 static const char* const flrc_bpsbw[] = {
Wayne Roberts 1:0817a150122b 1247 "2.6",
Wayne Roberts 1:0817a150122b 1248 "2.08",
Wayne Roberts 1:0817a150122b 1249 "1.3Mb/s 1.2MHz",
Wayne Roberts 1:0817a150122b 1250 "1.04Mb/s 1.2MHz",
Wayne Roberts 1:0817a150122b 1251 "0.65Mb/s 0.6MHz",
Wayne Roberts 1:0817a150122b 1252 "0.52Mb/s 0.6MHz",
Wayne Roberts 1:0817a150122b 1253 "0.325Mb/s 0.3MHz",
Wayne Roberts 1:0817a150122b 1254 "0.26Mb/s 0.3MHz",
Wayne Roberts 1:0817a150122b 1255 NULL
Wayne Roberts 1:0817a150122b 1256 };
Wayne Roberts 1:0817a150122b 1257
Wayne Roberts 2:ea9245bb1c53 1258 const dropdown_item_t Radio::flrc_bitrate_item = { _ITEM_DROPDOWN, flrc_bpsbw, flrc_bpsbw, gfsk_flrc_bpsbw_read, gfsk_flrc_bpsbw_write};
Wayne Roberts 1:0817a150122b 1259
Wayne Roberts 3:56fc764dee0a 1260 static const char* const flrc_crs[] = {
Wayne Roberts 1:0817a150122b 1261 "1/2",
Wayne Roberts 1:0817a150122b 1262 "3/4",
Wayne Roberts 1:0817a150122b 1263 "1 ",
Wayne Roberts 1:0817a150122b 1264 NULL
Wayne Roberts 1:0817a150122b 1265 };
Wayne Roberts 2:ea9245bb1c53 1266 unsigned Radio::flrc_cr_read(bool fw)
Wayne Roberts 1:0817a150122b 1267 {
Wayne Roberts 1:0817a150122b 1268 PktBitStreamCtrl_t PktBitStreamCtrl;
Wayne Roberts 1:0817a150122b 1269 PktBitStreamCtrl.octet = radio.readReg(REG_ADDR_PKT_BITSTREAM_CTRL, 1);
Wayne Roberts 1:0817a150122b 1270
Wayne Roberts 1:0817a150122b 1271 mpFLRC.flrc.CodingRate = PktBitStreamCtrl.octet & 0x06; // PktBitStreamCtrl.bits.flora_coding_rate
Wayne Roberts 1:0817a150122b 1272
Wayne Roberts 1:0817a150122b 1273 return PktBitStreamCtrl.bits.flora_coding_rate;
Wayne Roberts 1:0817a150122b 1274 }
Wayne Roberts 1:0817a150122b 1275
Wayne Roberts 2:ea9245bb1c53 1276 menuMode_e Radio::flrc_cr_write(unsigned sidx)
Wayne Roberts 1:0817a150122b 1277 {
Wayne Roberts 1:0817a150122b 1278 mpFLRC.flrc.CodingRate = sidx << 1;
Wayne Roberts 1:0817a150122b 1279 radio.xfer(OPCODE_SET_MODULATION_PARAMS, 3, 0, mpFLRC.buf);
Wayne Roberts 1:0817a150122b 1280 return MENUMODE_REDRAW;
Wayne Roberts 1:0817a150122b 1281 }
Wayne Roberts 1:0817a150122b 1282
Wayne Roberts 2:ea9245bb1c53 1283 const dropdown_item_t Radio::flrc_cr_item = { _ITEM_DROPDOWN, flrc_crs, flrc_crs, flrc_cr_read, flrc_cr_write};
Wayne Roberts 1:0817a150122b 1284
Wayne Roberts 3:56fc764dee0a 1285 static const char* const flrc_syncLens[] = {
Wayne Roberts 1:0817a150122b 1286 "SYNC OFF ",
Wayne Roberts 1:0817a150122b 1287 "16BIT SYNC",
Wayne Roberts 1:0817a150122b 1288 "32BIT SYNC",
Wayne Roberts 1:0817a150122b 1289 NULL
Wayne Roberts 1:0817a150122b 1290 };
Wayne Roberts 1:0817a150122b 1291
Wayne Roberts 2:ea9245bb1c53 1292 unsigned Radio::flrc_synclen_read(bool fw)
Wayne Roberts 1:0817a150122b 1293 {
Wayne Roberts 1:0817a150122b 1294 PktCtrl1_t PktCtrl1;
Wayne Roberts 1:0817a150122b 1295 PktCtrl1.octet = radio.readReg(REG_ADDR_PKTCTRL1, 1);
Wayne Roberts 1:0817a150122b 1296 ppFLRC.gfskFLRC.SyncWordLength = PktCtrl1.octet & 0x06;
Wayne Roberts 1:0817a150122b 1297 if (ppFLRC.gfskFLRC.SyncWordLength == 0x06) {
Wayne Roberts 1:0817a150122b 1298 ppFLRC.gfskFLRC.SyncWordLength = FLRC_SYNC_WORD_LEN_P32S;
Wayne Roberts 1:0817a150122b 1299 return 2;
Wayne Roberts 1:0817a150122b 1300 }
Wayne Roberts 1:0817a150122b 1301
Wayne Roberts 1:0817a150122b 1302 return PktCtrl1.flrc.sync_adrs_len;
Wayne Roberts 1:0817a150122b 1303 }
Wayne Roberts 1:0817a150122b 1304
Wayne Roberts 2:ea9245bb1c53 1305 menuMode_e Radio::flrc_synclen_write(unsigned sidx)
Wayne Roberts 1:0817a150122b 1306 {
Wayne Roberts 1:0817a150122b 1307 ppFLRC.gfskFLRC.SyncWordLength = sidx << 1;
Wayne Roberts 1:0817a150122b 1308 radio.xfer(OPCODE_SET_PACKET_PARAMS, 7, 0, ppFLRC.buf);
Wayne Roberts 1:0817a150122b 1309 return MENUMODE_REDRAW;
Wayne Roberts 1:0817a150122b 1310 }
Wayne Roberts 1:0817a150122b 1311
Wayne Roberts 2:ea9245bb1c53 1312 const dropdown_item_t Radio::flrc_synclen_item = { _ITEM_DROPDOWN, flrc_syncLens, flrc_syncLens, flrc_synclen_read, flrc_synclen_write};
Wayne Roberts 1:0817a150122b 1313
Wayne Roberts 1:0817a150122b 1314
Wayne Roberts 1:0817a150122b 1315 const menu_t Radio::flrc_menu[] = {
Wayne Roberts 4:fa31fdf4ec8d 1316 { {FIRST_CHIP_MENU_ROW+1, 1}, NULL, &flrc_bitrate_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1317 { {FIRST_CHIP_MENU_ROW+1, 20}, "cr:", &flrc_cr_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1318 { {FIRST_CHIP_MENU_ROW+1, 27}, "BT:", &gfsk_flrc_bt_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1319 { {FIRST_CHIP_MENU_ROW+1, 34}, "PreambleLength:", &gfsk_flrc_preamble_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1320 { {FIRST_CHIP_MENU_ROW+1, 52}, "SyncLength:", &flrc_synclen_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 1:0817a150122b 1321
Wayne Roberts 4:fa31fdf4ec8d 1322 { {FIRST_CHIP_MENU_ROW+2, 1}, "Length:", &gfsk_flrc_fixvar_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1323 { {FIRST_CHIP_MENU_ROW+2, 18}, "crcLength:", &gfsk_flrc_crclen_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1324 { {FIRST_CHIP_MENU_ROW+2, 38}, "whitening:", &gfsk_flrc_whit_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1325 { {FIRST_CHIP_MENU_ROW+2, 58}, "crcInit:", &gfsk_flrc_crcinit_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1326 { {FIRST_CHIP_MENU_ROW+2, 73}, "poly:", &gfsk_flrc_crcpoly_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 1:0817a150122b 1327
Wayne Roberts 4:fa31fdf4ec8d 1328 { {FIRST_CHIP_MENU_ROW+3, 1}, "sync1 ", &gfsk_flrc_sync1en_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1329 { {FIRST_CHIP_MENU_ROW+3, 12}, NULL, &gfsk_flrc_sync1_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1330 { {FIRST_CHIP_MENU_ROW+3, 24}, "sync2 ", &gfsk_flrc_sync2en_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1331 { {FIRST_CHIP_MENU_ROW+3, 35}, NULL, &gfsk_flrc_sync2_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1332 { {FIRST_CHIP_MENU_ROW+3, 47}, "sync3 ", &gfsk_flrc_sync3en_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1333 { {FIRST_CHIP_MENU_ROW+3, 59}, NULL, &gfsk_flrc_sync3_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 1:0817a150122b 1334
Wayne Roberts 1:0817a150122b 1335 { {0, 0}, NULL, NULL }
Wayne Roberts 1:0817a150122b 1336 };
Wayne Roberts 1:0817a150122b 1337
Wayne Roberts 3:56fc764dee0a 1338 bool Radio::manualRngDelay;
Wayne Roberts 3:56fc764dee0a 1339 const uint16_t Radio::rngDelays[3][6] = {
Wayne Roberts 3:56fc764dee0a 1340 10299, 10271, 10244, 10242, 10230, 10246,
Wayne Roberts 3:56fc764dee0a 1341 11486, 11474, 11453, 11426, 11417, 11401,
Wayne Roberts 3:56fc764dee0a 1342 13308, 13493, 13528, 13515, 13430, 13376
Wayne Roberts 3:56fc764dee0a 1343 };
Wayne Roberts 3:56fc764dee0a 1344
Wayne Roberts 3:56fc764dee0a 1345 void Radio::rngUpdateDelayCal()
Wayne Roberts 3:56fc764dee0a 1346 {
Wayne Roberts 3:56fc764dee0a 1347 LoRaPktPar0.octet = radio.readReg(REG_ADDR_LORA_PKTPAR0, 1);
Wayne Roberts 3:56fc764dee0a 1348
Wayne Roberts 3:56fc764dee0a 1349 if (LoRaPktPar0.bits.modem_bw > 2 && LoRaPktPar0.bits.modem_sf < 11) {
Wayne Roberts 3:56fc764dee0a 1350 uint32_t delayCal = radio.readReg(REG_ADDR_LORA_DELAY_CAL, 3);
Wayne Roberts 3:56fc764dee0a 1351 delayCal &= ~0x3fffff;
Wayne Roberts 3:56fc764dee0a 1352 delayCal |= rngDelays[LoRaPktPar0.bits.modem_bw-3][LoRaPktPar0.bits.modem_sf-5];
Wayne Roberts 3:56fc764dee0a 1353 /*log_printf("%u = rngDelays[%u][%u]\r\n",
Wayne Roberts 3:56fc764dee0a 1354 rngDelays[LoRaPktPar0.bits.modem_bw-3][LoRaPktPar0.bits.modem_sf-5],
Wayne Roberts 3:56fc764dee0a 1355 LoRaPktPar0.bits.modem_bw-3, LoRaPktPar0.bits.modem_sf-5
Wayne Roberts 3:56fc764dee0a 1356 );*/
Wayne Roberts 3:56fc764dee0a 1357 radio.writeReg(REG_ADDR_LORA_DELAY_CAL, delayCal, 3);
Wayne Roberts 3:56fc764dee0a 1358 }
Wayne Roberts 3:56fc764dee0a 1359 }
Wayne Roberts 3:56fc764dee0a 1360
Wayne Roberts 3:56fc764dee0a 1361 static const char* const lora_bws[] = {
Wayne Roberts 1:0817a150122b 1362 " 50KHz", // 0
Wayne Roberts 1:0817a150122b 1363 " 100KHz", // 1
Wayne Roberts 1:0817a150122b 1364 " 200KHz", // 2
Wayne Roberts 1:0817a150122b 1365 " 400KHz", // 3
Wayne Roberts 1:0817a150122b 1366 " 800KHz", // 4
Wayne Roberts 1:0817a150122b 1367 "1600KHz", // 5
Wayne Roberts 1:0817a150122b 1368 NULL
Wayne Roberts 1:0817a150122b 1369 };
Wayne Roberts 1:0817a150122b 1370
Wayne Roberts 3:56fc764dee0a 1371 const float Radio::bwMHzs[] = { 0.05, 0.1, 0.2, 0.4, 0.8, 1.6 };
Wayne Roberts 3:56fc764dee0a 1372
Wayne Roberts 3:56fc764dee0a 1373 LoRaPktPar0_t Radio::LoRaPktPar0;
Wayne Roberts 3:56fc764dee0a 1374
Wayne Roberts 1:0817a150122b 1375 unsigned Radio::lora_bw_read(bool fw)
Wayne Roberts 1:0817a150122b 1376 {
Wayne Roberts 1:0817a150122b 1377 LoRaPktPar0.octet = radio.readReg(REG_ADDR_LORA_PKTPAR0, 1);
Wayne Roberts 1:0817a150122b 1378
Wayne Roberts 1:0817a150122b 1379 return LoRaPktPar0.bits.modem_bw;
Wayne Roberts 1:0817a150122b 1380 }
Wayne Roberts 1:0817a150122b 1381
Wayne Roberts 1:0817a150122b 1382 menuMode_e Radio::lora_bw_write(unsigned sidx)
Wayne Roberts 1:0817a150122b 1383 {
Wayne Roberts 1:0817a150122b 1384 switch (sidx) {
Wayne Roberts 1:0817a150122b 1385 case 0: mpLORA.lora.bandwidth = LORA_BW_50; break;
Wayne Roberts 1:0817a150122b 1386 case 1: mpLORA.lora.bandwidth = LORA_BW_100; break;
Wayne Roberts 1:0817a150122b 1387 case 2: mpLORA.lora.bandwidth = LORA_BW_200; break;
Wayne Roberts 1:0817a150122b 1388 case 3: mpLORA.lora.bandwidth = LORA_BW_400; break;
Wayne Roberts 1:0817a150122b 1389 case 4: mpLORA.lora.bandwidth = LORA_BW_800; break;
Wayne Roberts 1:0817a150122b 1390 case 5: mpLORA.lora.bandwidth = LORA_BW_1600; break;
Wayne Roberts 1:0817a150122b 1391 }
Wayne Roberts 1:0817a150122b 1392 radio.xfer(OPCODE_SET_MODULATION_PARAMS, 3, 0, mpLORA.buf);
Wayne Roberts 1:0817a150122b 1393
Wayne Roberts 3:56fc764dee0a 1394 if (pktType == PACKET_TYPE_RANGING) {
Wayne Roberts 3:56fc764dee0a 1395 manualRngDelay = false;
Wayne Roberts 3:56fc764dee0a 1396 rngUpdateDelayCal();
Wayne Roberts 3:56fc764dee0a 1397 }
Wayne Roberts 3:56fc764dee0a 1398
Wayne Roberts 1:0817a150122b 1399 return MENUMODE_REDRAW;
Wayne Roberts 1:0817a150122b 1400 }
Wayne Roberts 1:0817a150122b 1401
Wayne Roberts 1:0817a150122b 1402 const dropdown_item_t Radio::lora_bw_item = { _ITEM_DROPDOWN, lora_bws, lora_bws, lora_bw_read, lora_bw_write};
Wayne Roberts 1:0817a150122b 1403
Wayne Roberts 1:0817a150122b 1404 void Radio::lora_sf_print()
Wayne Roberts 1:0817a150122b 1405 {
Wayne Roberts 1:0817a150122b 1406 LoRaPktPar0.octet = radio.readReg(REG_ADDR_LORA_PKTPAR0, 1);
Wayne Roberts 1:0817a150122b 1407
Wayne Roberts 1:0817a150122b 1408 pc.printf("%u", LoRaPktPar0.bits.modem_sf);
Wayne Roberts 1:0817a150122b 1409 }
Wayne Roberts 1:0817a150122b 1410
Wayne Roberts 1:0817a150122b 1411 bool Radio::lora_sf_write(const char* str)
Wayne Roberts 1:0817a150122b 1412 {
Wayne Roberts 1:0817a150122b 1413 unsigned n;
Wayne Roberts 1:0817a150122b 1414 if (sscanf(str, "%u", &n) == 1) {
Wayne Roberts 1:0817a150122b 1415 mpLORA.lora.spreadingFactor = n << 4;
Wayne Roberts 1:0817a150122b 1416 radio.xfer(OPCODE_SET_MODULATION_PARAMS, 3, 0, mpLORA.buf);
Wayne Roberts 3:56fc764dee0a 1417
Wayne Roberts 3:56fc764dee0a 1418 if (pktType == PACKET_TYPE_RANGING) {
Wayne Roberts 3:56fc764dee0a 1419 manualRngDelay = false;
Wayne Roberts 3:56fc764dee0a 1420 rngUpdateDelayCal();
Wayne Roberts 3:56fc764dee0a 1421 }
Wayne Roberts 1:0817a150122b 1422 }
Wayne Roberts 1:0817a150122b 1423 return false;
Wayne Roberts 1:0817a150122b 1424 }
Wayne Roberts 1:0817a150122b 1425
Wayne Roberts 1:0817a150122b 1426 const value_item_t Radio::lora_sf_item = { _ITEM_VALUE, 3, lora_sf_print, lora_sf_write };
Wayne Roberts 1:0817a150122b 1427
Wayne Roberts 3:56fc764dee0a 1428 static const char* const lora_crs[] = {
Wayne Roberts 1:0817a150122b 1429 "4/5 ",
Wayne Roberts 1:0817a150122b 1430 "4/6 ",
Wayne Roberts 1:0817a150122b 1431 "4/7 ",
Wayne Roberts 1:0817a150122b 1432 "4/8 ",
Wayne Roberts 1:0817a150122b 1433 "4/5 LI",
Wayne Roberts 1:0817a150122b 1434 "4/6 LI",
Wayne Roberts 1:0817a150122b 1435 "4/7 LI",
Wayne Roberts 1:0817a150122b 1436 NULL
Wayne Roberts 1:0817a150122b 1437 };
Wayne Roberts 1:0817a150122b 1438
Wayne Roberts 2:ea9245bb1c53 1439 unsigned Radio::lora_cr_read(bool fw)
Wayne Roberts 1:0817a150122b 1440 {
Wayne Roberts 1:0817a150122b 1441 LoRaPktPar1_t LoRaPktPar1;
Wayne Roberts 1:0817a150122b 1442 LoRaPktPar1.octet = radio.readReg(REG_ADDR_LORA_PKTPAR1, 1);
Wayne Roberts 1:0817a150122b 1443 mpLORA.lora.codingRate = LoRaPktPar1.bits.coding_rate;
Wayne Roberts 1:0817a150122b 1444 return LoRaPktPar1.bits.coding_rate;
Wayne Roberts 1:0817a150122b 1445 }
Wayne Roberts 1:0817a150122b 1446
Wayne Roberts 2:ea9245bb1c53 1447 menuMode_e Radio::lora_cr_write(unsigned sidx)
Wayne Roberts 1:0817a150122b 1448 {
Wayne Roberts 1:0817a150122b 1449 mpLORA.lora.codingRate = sidx;
Wayne Roberts 1:0817a150122b 1450 radio.xfer(OPCODE_SET_MODULATION_PARAMS, 3, 0, mpLORA.buf);
Wayne Roberts 1:0817a150122b 1451 return MENUMODE_REDRAW;
Wayne Roberts 1:0817a150122b 1452 }
Wayne Roberts 1:0817a150122b 1453
Wayne Roberts 2:ea9245bb1c53 1454 const dropdown_item_t Radio::lora_cr_item = { _ITEM_DROPDOWN, lora_crs, lora_crs, lora_cr_read, lora_cr_write};
Wayne Roberts 1:0817a150122b 1455
Wayne Roberts 1:0817a150122b 1456 void Radio::lora_pblLen_print()
Wayne Roberts 1:0817a150122b 1457 {
Wayne Roberts 1:0817a150122b 1458 LoRaPreambleReg_t LoRaPreambleReg;
Wayne Roberts 1:0817a150122b 1459 LoRaPreambleReg.octet = radio.readReg(REG_ADDR_LORA_PREAMBLE, 1);
Wayne Roberts 1:0817a150122b 1460 ppLORA.lora.PreambleLength = (1 << LoRaPreambleReg.bits.preamble_symb_nb_exp) * LoRaPreambleReg.bits.preamble_symb1_nb;
Wayne Roberts 1:0817a150122b 1461 pc.printf("%u", ppLORA.lora.PreambleLength);
Wayne Roberts 1:0817a150122b 1462 }
Wayne Roberts 1:0817a150122b 1463
Wayne Roberts 1:0817a150122b 1464 bool Radio::lora_pblLen_write(const char* str)
Wayne Roberts 1:0817a150122b 1465 {
Wayne Roberts 1:0817a150122b 1466 unsigned val, exp, mant;
Wayne Roberts 1:0817a150122b 1467 sscanf(str, "%u", &val);
Wayne Roberts 1:0817a150122b 1468
Wayne Roberts 1:0817a150122b 1469 for (exp = 0; exp < 16; exp++) {
Wayne Roberts 1:0817a150122b 1470 mant = val / (1 << exp);
Wayne Roberts 1:0817a150122b 1471 if (mant < 16)
Wayne Roberts 1:0817a150122b 1472 break;
Wayne Roberts 1:0817a150122b 1473 }
Wayne Roberts 1:0817a150122b 1474
Wayne Roberts 1:0817a150122b 1475 ppLORA.lora.PreambleLength = (exp << 4) + mant;
Wayne Roberts 1:0817a150122b 1476 radio.xfer(OPCODE_SET_PACKET_PARAMS, 5, 0, ppLORA.buf);
Wayne Roberts 1:0817a150122b 1477
Wayne Roberts 1:0817a150122b 1478 return false;
Wayne Roberts 1:0817a150122b 1479 }
Wayne Roberts 1:0817a150122b 1480
Wayne Roberts 1:0817a150122b 1481 const value_item_t Radio::lora_pblLen_item = { _ITEM_VALUE, 5, lora_pblLen_print, lora_pblLen_write};
Wayne Roberts 1:0817a150122b 1482
Wayne Roberts 1:0817a150122b 1483 bool Radio::lora_fixlen_read()
Wayne Roberts 1:0817a150122b 1484 {
Wayne Roberts 1:0817a150122b 1485 LoRaPktPar1_t LoRaPktPar1;
Wayne Roberts 1:0817a150122b 1486 LoRaPktPar1.octet = radio.readReg(REG_ADDR_LORA_PKTPAR1, 1);
Wayne Roberts 1:0817a150122b 1487 ppLORA.lora.HeaderType = LoRaPktPar1.bits.implicit_header ? IMPLICIT_HEADER : EXPLICIT_HEADER;
Wayne Roberts 1:0817a150122b 1488 return LoRaPktPar1.bits.implicit_header;
Wayne Roberts 1:0817a150122b 1489 }
Wayne Roberts 1:0817a150122b 1490
Wayne Roberts 1:0817a150122b 1491 bool Radio::lora_fixlen_push()
Wayne Roberts 1:0817a150122b 1492 {
Wayne Roberts 1:0817a150122b 1493 if (ppLORA.lora.HeaderType == EXPLICIT_HEADER)
Wayne Roberts 1:0817a150122b 1494 ppLORA.lora.HeaderType = IMPLICIT_HEADER;
Wayne Roberts 1:0817a150122b 1495 else
Wayne Roberts 1:0817a150122b 1496 ppLORA.lora.HeaderType = EXPLICIT_HEADER;
Wayne Roberts 1:0817a150122b 1497
Wayne Roberts 1:0817a150122b 1498 radio.xfer(OPCODE_SET_PACKET_PARAMS, 5, 0, ppLORA.buf);
Wayne Roberts 1:0817a150122b 1499 return ppLORA.lora.HeaderType == EXPLICIT_HEADER;
Wayne Roberts 1:0817a150122b 1500 }
Wayne Roberts 1:0817a150122b 1501
Wayne Roberts 1:0817a150122b 1502 const toggle_item_t Radio::lora_fixlen_item = { _ITEM_TOGGLE,
Wayne Roberts 1:0817a150122b 1503 "EXPLICIT", // 0
Wayne Roberts 1:0817a150122b 1504 "IMPLICIT", // 1
Wayne Roberts 1:0817a150122b 1505 lora_fixlen_read, lora_fixlen_push
Wayne Roberts 1:0817a150122b 1506 };
Wayne Roberts 1:0817a150122b 1507
Wayne Roberts 1:0817a150122b 1508 bool Radio::lora_crcon_read()
Wayne Roberts 1:0817a150122b 1509 {
Wayne Roberts 1:0817a150122b 1510 LoRaLrCtl_t LoRaLrCtl;
Wayne Roberts 1:0817a150122b 1511 LoRaLrCtl.octet = radio.readReg(REG_ADDR_LORA_LRCTL, 1);
Wayne Roberts 1:0817a150122b 1512 ppLORA.lora.crc = LoRaLrCtl.octet & 0x20; // LoRaLrCtl.bits.crc_en
Wayne Roberts 1:0817a150122b 1513 return LoRaLrCtl.bits.crc_en;
Wayne Roberts 1:0817a150122b 1514 }
Wayne Roberts 1:0817a150122b 1515
Wayne Roberts 1:0817a150122b 1516 bool Radio::lora_crcon_push()
Wayne Roberts 1:0817a150122b 1517 {
Wayne Roberts 1:0817a150122b 1518 if (ppLORA.lora.crc == LORA_CRC_ENABLE)
Wayne Roberts 1:0817a150122b 1519 ppLORA.lora.crc = LORA_CRC_DISABLE;
Wayne Roberts 1:0817a150122b 1520 else
Wayne Roberts 1:0817a150122b 1521 ppLORA.lora.crc = LORA_CRC_ENABLE;
Wayne Roberts 1:0817a150122b 1522
Wayne Roberts 1:0817a150122b 1523 radio.xfer(OPCODE_SET_PACKET_PARAMS, 5, 0, ppLORA.buf);
Wayne Roberts 1:0817a150122b 1524
Wayne Roberts 1:0817a150122b 1525 return ppLORA.lora.crc == LORA_CRC_ENABLE;
Wayne Roberts 1:0817a150122b 1526 }
Wayne Roberts 1:0817a150122b 1527
Wayne Roberts 1:0817a150122b 1528 const toggle_item_t Radio::lora_crcon_item = { _ITEM_TOGGLE,
Wayne Roberts 1:0817a150122b 1529 "CRC_DISABLE", // 0
Wayne Roberts 1:0817a150122b 1530 "CRC_ENABLE ", // 1
Wayne Roberts 1:0817a150122b 1531 lora_crcon_read, lora_crcon_push
Wayne Roberts 1:0817a150122b 1532 };
Wayne Roberts 1:0817a150122b 1533
Wayne Roberts 1:0817a150122b 1534 bool Radio::lora_iqinv_read()
Wayne Roberts 1:0817a150122b 1535 {
Wayne Roberts 1:0817a150122b 1536 LoRaPktPar1_t LoRaPktPar1;
Wayne Roberts 1:0817a150122b 1537 LoRaPktPar1.octet = radio.readReg(REG_ADDR_LORA_PKTPAR1, 1);
Wayne Roberts 1:0817a150122b 1538 ppLORA.lora.InvertIQ = LoRaPktPar1.bits.rxinvert_iq ? LORA_IQ_STD : LORA_IQ_INVERTED;
Wayne Roberts 1:0817a150122b 1539 return LoRaPktPar1.bits.rxinvert_iq ? 0 : 1;
Wayne Roberts 1:0817a150122b 1540 }
Wayne Roberts 1:0817a150122b 1541
Wayne Roberts 1:0817a150122b 1542 bool Radio::lora_iqinv_push()
Wayne Roberts 1:0817a150122b 1543 {
Wayne Roberts 1:0817a150122b 1544 if (ppLORA.lora.InvertIQ == LORA_IQ_STD)
Wayne Roberts 1:0817a150122b 1545 ppLORA.lora.InvertIQ = LORA_IQ_INVERTED;
Wayne Roberts 1:0817a150122b 1546 else
Wayne Roberts 1:0817a150122b 1547 ppLORA.lora.InvertIQ = LORA_IQ_STD;
Wayne Roberts 1:0817a150122b 1548
Wayne Roberts 1:0817a150122b 1549 radio.xfer(OPCODE_SET_PACKET_PARAMS, 5, 0, ppLORA.buf);
Wayne Roberts 1:0817a150122b 1550
Wayne Roberts 1:0817a150122b 1551 return ppLORA.lora.InvertIQ == LORA_IQ_STD;
Wayne Roberts 1:0817a150122b 1552 }
Wayne Roberts 1:0817a150122b 1553
Wayne Roberts 1:0817a150122b 1554 const toggle_item_t Radio::lora_iqinv_item = { _ITEM_TOGGLE,
Wayne Roberts 1:0817a150122b 1555 "IQ_STD", // 0
Wayne Roberts 1:0817a150122b 1556 "IQ_INV", // 1
Wayne Roberts 1:0817a150122b 1557 lora_iqinv_read, lora_iqinv_push
Wayne Roberts 1:0817a150122b 1558 };
Wayne Roberts 1:0817a150122b 1559
Wayne Roberts 3:56fc764dee0a 1560 void Radio::lora_ppg_print()
Wayne Roberts 3:56fc764dee0a 1561 {
Wayne Roberts 3:56fc764dee0a 1562 uint8_t val;
Wayne Roberts 3:56fc764dee0a 1563 ppg = radio.readReg(REG_ADDR_LORA_SYNC, 2);
Wayne Roberts 3:56fc764dee0a 1564
Wayne Roberts 3:56fc764dee0a 1565 val = (ppg >> 8) & 0xf0;
Wayne Roberts 3:56fc764dee0a 1566 val |= (ppg & 0xf0) >> 4;
Wayne Roberts 3:56fc764dee0a 1567 pc.printf("%02x", val);
Wayne Roberts 3:56fc764dee0a 1568 }
Wayne Roberts 3:56fc764dee0a 1569
Wayne Roberts 3:56fc764dee0a 1570 bool Radio::lora_ppg_write(const char* txt)
Wayne Roberts 3:56fc764dee0a 1571 {
Wayne Roberts 3:56fc764dee0a 1572 unsigned val;
Wayne Roberts 3:56fc764dee0a 1573 if (sscanf(txt, "%x", &val) == 1) {
Wayne Roberts 3:56fc764dee0a 1574 ppg &= 0x0707;
Wayne Roberts 3:56fc764dee0a 1575 ppg |= (val & 0xf0) << 8;
Wayne Roberts 3:56fc764dee0a 1576 ppg |= (val & 0x0f) << 4;
Wayne Roberts 3:56fc764dee0a 1577 radio.writeReg(REG_ADDR_LORA_SYNC, ppg, 2);
Wayne Roberts 3:56fc764dee0a 1578 }
Wayne Roberts 3:56fc764dee0a 1579 return false;
Wayne Roberts 3:56fc764dee0a 1580 }
Wayne Roberts 3:56fc764dee0a 1581
Wayne Roberts 3:56fc764dee0a 1582 const value_item_t Radio::lora_ppg_item = { _ITEM_VALUE, 4, lora_ppg_print, lora_ppg_write};
Wayne Roberts 3:56fc764dee0a 1583
Wayne Roberts 2:ea9245bb1c53 1584 void Radio::cad_push()
Wayne Roberts 2:ea9245bb1c53 1585 {
Wayne Roberts 2:ea9245bb1c53 1586 radio.setCAD();
Wayne Roberts 2:ea9245bb1c53 1587 }
Wayne Roberts 2:ea9245bb1c53 1588
Wayne Roberts 2:ea9245bb1c53 1589 const button_item_t Radio::lora_cad_item = { _ITEM_BUTTON, "CAD", cad_push };
Wayne Roberts 2:ea9245bb1c53 1590
Wayne Roberts 3:56fc764dee0a 1591 static const char* const lora_cadsymbs[] = {
Wayne Roberts 2:ea9245bb1c53 1592 " 1",
Wayne Roberts 2:ea9245bb1c53 1593 " 2",
Wayne Roberts 2:ea9245bb1c53 1594 " 4",
Wayne Roberts 2:ea9245bb1c53 1595 " 8",
Wayne Roberts 2:ea9245bb1c53 1596 "16",
Wayne Roberts 2:ea9245bb1c53 1597 NULL
Wayne Roberts 2:ea9245bb1c53 1598 };
Wayne Roberts 2:ea9245bb1c53 1599
Wayne Roberts 2:ea9245bb1c53 1600 unsigned Radio::lora_cadsymbs_read(bool forWriting)
Wayne Roberts 2:ea9245bb1c53 1601 {
Wayne Roberts 2:ea9245bb1c53 1602 unsigned n = radio.readReg(REG_ADDR_LORA_FE_GAIN, 1);
Wayne Roberts 2:ea9245bb1c53 1603 return n >> 5;
Wayne Roberts 2:ea9245bb1c53 1604 }
Wayne Roberts 2:ea9245bb1c53 1605
Wayne Roberts 2:ea9245bb1c53 1606 menuMode_e Radio::lora_cadsymbs_write(unsigned sidx)
Wayne Roberts 2:ea9245bb1c53 1607 {
Wayne Roberts 2:ea9245bb1c53 1608 uint8_t buf = sidx << 5;
Wayne Roberts 2:ea9245bb1c53 1609 radio.xfer(OPCODE_SET_CAD_PARAM, 1, 0, &buf);
Wayne Roberts 2:ea9245bb1c53 1610 return MENUMODE_REDRAW;
Wayne Roberts 2:ea9245bb1c53 1611 }
Wayne Roberts 2:ea9245bb1c53 1612
Wayne Roberts 2:ea9245bb1c53 1613 const dropdown_item_t Radio::lora_cadsymbs_item = { _ITEM_DROPDOWN, lora_cadsymbs, lora_cadsymbs, lora_cadsymbs_read, lora_cadsymbs_write};
Wayne Roberts 2:ea9245bb1c53 1614
Wayne Roberts 1:0817a150122b 1615 const menu_t Radio::lora_menu[] = {
Wayne Roberts 4:fa31fdf4ec8d 1616 { {FIRST_CHIP_MENU_ROW+1, 1}, NULL, &lora_bw_item, FLAG_MSGTYPE_ALL, &rng_delay_item},
Wayne Roberts 4:fa31fdf4ec8d 1617 { {FIRST_CHIP_MENU_ROW+1, 12}, "sf:", &lora_sf_item, FLAG_MSGTYPE_ALL, &rng_delay_item},
Wayne Roberts 4:fa31fdf4ec8d 1618 { {FIRST_CHIP_MENU_ROW+1, 20}, "cr:", &lora_cr_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1619 { {FIRST_CHIP_MENU_ROW+1, 30}, "PreambleLength:", &lora_pblLen_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1620 { {FIRST_CHIP_MENU_ROW+2, 1}, NULL, &lora_fixlen_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1621 { {FIRST_CHIP_MENU_ROW+2, 12}, NULL, &lora_crcon_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1622 { {FIRST_CHIP_MENU_ROW+2, 25}, NULL, &lora_iqinv_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1623 { {FIRST_CHIP_MENU_ROW+2, 35}, "ppg:", &lora_ppg_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 2:ea9245bb1c53 1624
Wayne Roberts 4:fa31fdf4ec8d 1625 { {FIRST_CHIP_MENU_ROW+3, 1}, NULL, &lora_cad_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1626 { {FIRST_CHIP_MENU_ROW+3, 5}, "symbols:", &lora_cadsymbs_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 2:ea9245bb1c53 1627
Wayne Roberts 1:0817a150122b 1628 { {0, 0}, NULL, NULL }
Wayne Roberts 1:0817a150122b 1629 };
Wayne Roberts 1:0817a150122b 1630
Wayne Roberts 3:56fc764dee0a 1631 bool Radio::tmp;
Wayne Roberts 3:56fc764dee0a 1632
Wayne Roberts 3:56fc764dee0a 1633 bool Radio::rng_role_read()
Wayne Roberts 3:56fc764dee0a 1634 {
Wayne Roberts 3:56fc764dee0a 1635 //RngCfg0_t RngCfg0;
Wayne Roberts 3:56fc764dee0a 1636 //RngCfg0.octet = radio.readReg(REG_ADDR_RNGCFG0, 1);
Wayne Roberts 3:56fc764dee0a 1637
Wayne Roberts 3:56fc764dee0a 1638 //return !RngCfg0.bits.ranging_resp_en;
Wayne Roberts 3:56fc764dee0a 1639 //log_printf("%02x ranging_resp_en: %u\r\n", RngCfg0.octet, RngCfg0.bits.ranging_resp_en);
Wayne Roberts 3:56fc764dee0a 1640 return tmp;
Wayne Roberts 3:56fc764dee0a 1641 }
Wayne Roberts 3:56fc764dee0a 1642
Wayne Roberts 3:56fc764dee0a 1643 bool Radio::rng_role_push()
Wayne Roberts 3:56fc764dee0a 1644 {
Wayne Roberts 3:56fc764dee0a 1645 uint8_t buf;
Wayne Roberts 3:56fc764dee0a 1646 /*
Wayne Roberts 3:56fc764dee0a 1647 RngCfg0_t RngCfg0;
Wayne Roberts 3:56fc764dee0a 1648 RngCfg0.octet = radio.readReg(REG_ADDR_RNGCFG0, 1);
Wayne Roberts 3:56fc764dee0a 1649
Wayne Roberts 3:56fc764dee0a 1650 buf = RngCfg0.bits.ranging_resp_en ? 0 : 1;
Wayne Roberts 3:56fc764dee0a 1651 log_printf("role %02x %u\r\n", RngCfg0.octet, buf);
Wayne Roberts 3:56fc764dee0a 1652 radio.xfer(OPCODE_SET_RANGING_ROLE, 1, 0, &buf);
Wayne Roberts 3:56fc764dee0a 1653 return buf;
Wayne Roberts 3:56fc764dee0a 1654 */
Wayne Roberts 3:56fc764dee0a 1655 tmp ^= true;
Wayne Roberts 3:56fc764dee0a 1656 buf = tmp;
Wayne Roberts 3:56fc764dee0a 1657 radio.xfer(OPCODE_SET_RANGING_ROLE, 1, 0, &buf);
Wayne Roberts 3:56fc764dee0a 1658 return tmp;
Wayne Roberts 3:56fc764dee0a 1659 }
Wayne Roberts 3:56fc764dee0a 1660
Wayne Roberts 3:56fc764dee0a 1661 const toggle_item_t Radio::rng_role_item = { _ITEM_TOGGLE,
Wayne Roberts 3:56fc764dee0a 1662 " SLAVE", // 0
Wayne Roberts 3:56fc764dee0a 1663 "MASTER", // 1
Wayne Roberts 3:56fc764dee0a 1664 rng_role_read, rng_role_push
Wayne Roberts 3:56fc764dee0a 1665 };
Wayne Roberts 3:56fc764dee0a 1666
Wayne Roberts 3:56fc764dee0a 1667 void Radio::rng_id_send_print()
Wayne Roberts 3:56fc764dee0a 1668 {
Wayne Roberts 3:56fc764dee0a 1669 pc.printf("%08x", radio.readReg(REG_ADDR_LORA_MASTER_REQ_ID, 4));
Wayne Roberts 3:56fc764dee0a 1670 }
Wayne Roberts 3:56fc764dee0a 1671
Wayne Roberts 3:56fc764dee0a 1672 bool Radio::rng_id_send_write(const char* txt)
Wayne Roberts 3:56fc764dee0a 1673 {
Wayne Roberts 3:56fc764dee0a 1674 unsigned n;
Wayne Roberts 3:56fc764dee0a 1675 sscanf(txt, "%x", &n);
Wayne Roberts 3:56fc764dee0a 1676 radio.writeReg(REG_ADDR_LORA_MASTER_REQ_ID, n, 4);
Wayne Roberts 3:56fc764dee0a 1677 return false;
Wayne Roberts 3:56fc764dee0a 1678 }
Wayne Roberts 3:56fc764dee0a 1679
Wayne Roberts 3:56fc764dee0a 1680 const value_item_t Radio::rng_id_send_item = { _ITEM_VALUE, 9, rng_id_send_print, rng_id_send_write};
Wayne Roberts 3:56fc764dee0a 1681
Wayne Roberts 3:56fc764dee0a 1682 void Radio::rng_slave_id_print()
Wayne Roberts 3:56fc764dee0a 1683 {
Wayne Roberts 3:56fc764dee0a 1684 pc.printf("%08x", radio.readReg(REG_ADDR_LORA_SLAVE_ID, 4));
Wayne Roberts 3:56fc764dee0a 1685 }
Wayne Roberts 3:56fc764dee0a 1686
Wayne Roberts 3:56fc764dee0a 1687 bool Radio::rng_slave_id_write(const char* txt)
Wayne Roberts 3:56fc764dee0a 1688 {
Wayne Roberts 3:56fc764dee0a 1689 unsigned n;
Wayne Roberts 3:56fc764dee0a 1690 sscanf(txt, "%x", &n);
Wayne Roberts 3:56fc764dee0a 1691 radio.writeReg(REG_ADDR_LORA_SLAVE_ID, n, 4);
Wayne Roberts 3:56fc764dee0a 1692 return false;
Wayne Roberts 3:56fc764dee0a 1693 }
Wayne Roberts 3:56fc764dee0a 1694
Wayne Roberts 3:56fc764dee0a 1695 const value_item_t Radio::rng_slave_id_item = { _ITEM_VALUE, 9, rng_slave_id_print, rng_slave_id_write};
Wayne Roberts 3:56fc764dee0a 1696
Wayne Roberts 3:56fc764dee0a 1697 unsigned Radio::rng_idLength_read(bool forWriting)
Wayne Roberts 3:56fc764dee0a 1698 {
Wayne Roberts 3:56fc764dee0a 1699 RngDebTh2_t RngDebTh2;
Wayne Roberts 3:56fc764dee0a 1700 RngDebTh2.octet = radio.readReg(REG_ADDR_LORA_RNGDEBTH2, 1);
Wayne Roberts 3:56fc764dee0a 1701 return RngDebTh2.bits.ranging_id_check_length;
Wayne Roberts 3:56fc764dee0a 1702 }
Wayne Roberts 3:56fc764dee0a 1703
Wayne Roberts 3:56fc764dee0a 1704 menuMode_e Radio::rng_idLength_write(unsigned sidx)
Wayne Roberts 3:56fc764dee0a 1705 {
Wayne Roberts 3:56fc764dee0a 1706 RngDebTh2_t RngDebTh2;
Wayne Roberts 3:56fc764dee0a 1707 RngDebTh2.octet = radio.readReg(REG_ADDR_LORA_RNGDEBTH2, 1);
Wayne Roberts 3:56fc764dee0a 1708 RngDebTh2.bits.ranging_id_check_length = sidx;
Wayne Roberts 3:56fc764dee0a 1709 radio.writeReg(REG_ADDR_LORA_RNGDEBTH2, RngDebTh2.octet, 1);
Wayne Roberts 3:56fc764dee0a 1710 return MENUMODE_REDRAW;
Wayne Roberts 3:56fc764dee0a 1711 }
Wayne Roberts 3:56fc764dee0a 1712
Wayne Roberts 3:56fc764dee0a 1713 static const char* const rngLens[] = {
Wayne Roberts 3:56fc764dee0a 1714 " 8 bits",
Wayne Roberts 3:56fc764dee0a 1715 "16 bits",
Wayne Roberts 3:56fc764dee0a 1716 "24 bits",
Wayne Roberts 3:56fc764dee0a 1717 "32 bits",
Wayne Roberts 3:56fc764dee0a 1718 NULL
Wayne Roberts 3:56fc764dee0a 1719 };
Wayne Roberts 3:56fc764dee0a 1720
Wayne Roberts 3:56fc764dee0a 1721 const dropdown_item_t Radio::rng_idLength_item = { _ITEM_DROPDOWN, rngLens, rngLens, rng_idLength_read, rng_idLength_write};
Wayne Roberts 3:56fc764dee0a 1722
Wayne Roberts 3:56fc764dee0a 1723
Wayne Roberts 3:56fc764dee0a 1724 void Radio::rng_delay_print(void)
Wayne Roberts 3:56fc764dee0a 1725 {
Wayne Roberts 3:56fc764dee0a 1726 if (pktType == PACKET_TYPE_RANGING) {
Wayne Roberts 3:56fc764dee0a 1727 pc.printf("%u", radio.readReg(REG_ADDR_LORA_DELAY_CAL, 3) & 0x3fffff);
Wayne Roberts 3:56fc764dee0a 1728 }
Wayne Roberts 3:56fc764dee0a 1729 }
Wayne Roberts 3:56fc764dee0a 1730
Wayne Roberts 3:56fc764dee0a 1731 bool Radio::rng_delay_write(const char* txt)
Wayne Roberts 3:56fc764dee0a 1732 {
Wayne Roberts 3:56fc764dee0a 1733 unsigned n;
Wayne Roberts 3:56fc764dee0a 1734 uint32_t delayCal = radio.readReg(REG_ADDR_LORA_DELAY_CAL, 3);
Wayne Roberts 3:56fc764dee0a 1735 sscanf(txt, "%u", &n);
Wayne Roberts 3:56fc764dee0a 1736 delayCal &= ~0x3fffff;
Wayne Roberts 3:56fc764dee0a 1737 delayCal |= n;
Wayne Roberts 3:56fc764dee0a 1738 radio.writeReg(REG_ADDR_LORA_DELAY_CAL, delayCal, 3);
Wayne Roberts 3:56fc764dee0a 1739
Wayne Roberts 3:56fc764dee0a 1740 manualRngDelay = true;
Wayne Roberts 3:56fc764dee0a 1741 return false;
Wayne Roberts 3:56fc764dee0a 1742 }
Wayne Roberts 3:56fc764dee0a 1743
Wayne Roberts 3:56fc764dee0a 1744 const value_item_t Radio::rng_delay_item = { _ITEM_VALUE, 7, rng_delay_print, rng_delay_write };
Wayne Roberts 3:56fc764dee0a 1745
Wayne Roberts 3:56fc764dee0a 1746 unsigned Radio::rng_resultMux_read(bool)
Wayne Roberts 3:56fc764dee0a 1747 {
Wayne Roberts 3:56fc764dee0a 1748 RngCfg1_t RngCfg1;
Wayne Roberts 3:56fc764dee0a 1749 RngCfg1.octet = radio.readReg(REG_ADDR_RNGCFG1, 1);
Wayne Roberts 3:56fc764dee0a 1750 return RngCfg1.bits.ranging_result_mux_sel;
Wayne Roberts 3:56fc764dee0a 1751 }
Wayne Roberts 3:56fc764dee0a 1752
Wayne Roberts 3:56fc764dee0a 1753 menuMode_e Radio::rng_resultMux_write(unsigned sidx)
Wayne Roberts 3:56fc764dee0a 1754 {
Wayne Roberts 3:56fc764dee0a 1755 RngCfg1_t RngCfg1;
Wayne Roberts 3:56fc764dee0a 1756 RngCfg1.octet = radio.readReg(REG_ADDR_RNGCFG1, 1);
Wayne Roberts 3:56fc764dee0a 1757 RngCfg1.bits.ranging_result_mux_sel = sidx;
Wayne Roberts 3:56fc764dee0a 1758 radio.writeReg(REG_ADDR_RNGCFG1, RngCfg1.octet, 1);
Wayne Roberts 3:56fc764dee0a 1759 return MENUMODE_REDRAW;
Wayne Roberts 3:56fc764dee0a 1760 }
Wayne Roberts 3:56fc764dee0a 1761
Wayne Roberts 3:56fc764dee0a 1762 static const char* const rngResults[] = {
Wayne Roberts 3:56fc764dee0a 1763 " raw ",
Wayne Roberts 3:56fc764dee0a 1764 " rssiAvg ",
Wayne Roberts 3:56fc764dee0a 1765 " debiased ",
Wayne Roberts 3:56fc764dee0a 1766 "finalFilter",
Wayne Roberts 3:56fc764dee0a 1767 NULL
Wayne Roberts 3:56fc764dee0a 1768 };
Wayne Roberts 3:56fc764dee0a 1769
Wayne Roberts 3:56fc764dee0a 1770 const dropdown_item_t Radio::rng_resultMux_item = { _ITEM_DROPDOWN, rngResults, rngResults, rng_resultMux_read, rng_resultMux_write};
Wayne Roberts 3:56fc764dee0a 1771
Wayne Roberts 3:56fc764dee0a 1772
Wayne Roberts 3:56fc764dee0a 1773 void Radio::rng_wndFltSize_print()
Wayne Roberts 3:56fc764dee0a 1774 {
Wayne Roberts 3:56fc764dee0a 1775 pc.printf("%u", radio.readReg(REG_ADDR_RNGFLTWNDSIZE, 1));
Wayne Roberts 3:56fc764dee0a 1776 }
Wayne Roberts 3:56fc764dee0a 1777
Wayne Roberts 3:56fc764dee0a 1778 bool Radio::rng_wndFltSize_write(const char* txt)
Wayne Roberts 3:56fc764dee0a 1779 {
Wayne Roberts 3:56fc764dee0a 1780 unsigned n;
Wayne Roberts 3:56fc764dee0a 1781 sscanf(txt, "%u", &n);
Wayne Roberts 3:56fc764dee0a 1782 radio.writeReg(REG_ADDR_RNGFLTWNDSIZE, n, 1);
Wayne Roberts 3:56fc764dee0a 1783 return false;
Wayne Roberts 3:56fc764dee0a 1784 }
Wayne Roberts 3:56fc764dee0a 1785
Wayne Roberts 3:56fc764dee0a 1786 const value_item_t Radio::rng_wndFltSize_item = { _ITEM_VALUE, 4, rng_wndFltSize_print, rng_wndFltSize_write};
Wayne Roberts 3:56fc764dee0a 1787
Wayne Roberts 3:56fc764dee0a 1788
Wayne Roberts 3:56fc764dee0a 1789
Wayne Roberts 3:56fc764dee0a 1790
Wayne Roberts 3:56fc764dee0a 1791 void Radio::rng_rngRssiThresh_print()
Wayne Roberts 3:56fc764dee0a 1792 {
Wayne Roberts 3:56fc764dee0a 1793 RngDebTh4H_t RngDebTh4H;
Wayne Roberts 3:56fc764dee0a 1794 RngDebTh4H.octet = radio.readReg(REG_ADDR_RNGDEBTH4H, 1);
Wayne Roberts 3:56fc764dee0a 1795 pc.printf("%u", RngDebTh4H.bits.rng_rssi_threshold);
Wayne Roberts 3:56fc764dee0a 1796 }
Wayne Roberts 3:56fc764dee0a 1797
Wayne Roberts 3:56fc764dee0a 1798 bool Radio::rng_rngRssiThresh_write(const char* txt)
Wayne Roberts 3:56fc764dee0a 1799 {
Wayne Roberts 3:56fc764dee0a 1800 unsigned n;
Wayne Roberts 3:56fc764dee0a 1801 RngDebTh4H_t RngDebTh4H;
Wayne Roberts 3:56fc764dee0a 1802 RngDebTh4H.octet = radio.readReg(REG_ADDR_RNGDEBTH4H, 1);
Wayne Roberts 3:56fc764dee0a 1803 sscanf(txt, "%u", &n);
Wayne Roberts 3:56fc764dee0a 1804 RngDebTh4H.bits.rng_rssi_threshold = n;
Wayne Roberts 3:56fc764dee0a 1805 radio.writeReg(REG_ADDR_RNGDEBTH4H, RngDebTh4H.octet, 1);
Wayne Roberts 3:56fc764dee0a 1806 return false;
Wayne Roberts 3:56fc764dee0a 1807 }
Wayne Roberts 3:56fc764dee0a 1808
Wayne Roberts 3:56fc764dee0a 1809 const value_item_t Radio::rng_rngRssiThresh_item = { _ITEM_VALUE, 4, rng_rngRssiThresh_print, rng_rngRssiThresh_write};
Wayne Roberts 3:56fc764dee0a 1810
Wayne Roberts 3:56fc764dee0a 1811 const menu_t Radio::rng_menu[] = {
Wayne Roberts 4:fa31fdf4ec8d 1812 { {FIRST_CHIP_MENU_ROW+3, 19}, NULL, &rng_role_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1813 { {FIRST_CHIP_MENU_ROW+3, 28}, "ID to send:", &rng_id_send_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1814 { {FIRST_CHIP_MENU_ROW+3, 49}, "slave ID:", &rng_slave_id_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1815 { {FIRST_CHIP_MENU_ROW+3, 67}, NULL, &rng_idLength_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1816 { {FIRST_CHIP_MENU_ROW+4, 1}, "delay:", &rng_delay_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1817 { {FIRST_CHIP_MENU_ROW+4, 14}, "resultMux:", &rng_resultMux_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1818 { {FIRST_CHIP_MENU_ROW+4, 37}, "windowFilterSize:", &rng_wndFltSize_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1819 { {FIRST_CHIP_MENU_ROW+4, 59}, "rngRssiThresh:", &rng_rngRssiThresh_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 3:56fc764dee0a 1820
Wayne Roberts 3:56fc764dee0a 1821 { {0, 0}, NULL, NULL }
Wayne Roberts 3:56fc764dee0a 1822 };
Wayne Roberts 3:56fc764dee0a 1823
Wayne Roberts 4:fa31fdf4ec8d 1824 void Radio::xta_print()
Wayne Roberts 4:fa31fdf4ec8d 1825 {
Wayne Roberts 4:fa31fdf4ec8d 1826 uint8_t trim = radio.readReg(REG_ADDR_XTA_TRIM, 1);
Wayne Roberts 4:fa31fdf4ec8d 1827 pc.printf("%02x", trim);
Wayne Roberts 4:fa31fdf4ec8d 1828 }
Wayne Roberts 4:fa31fdf4ec8d 1829
Wayne Roberts 4:fa31fdf4ec8d 1830 bool Radio::xta_write(const char* txt)
Wayne Roberts 4:fa31fdf4ec8d 1831 {
Wayne Roberts 4:fa31fdf4ec8d 1832 unsigned trim;
Wayne Roberts 4:fa31fdf4ec8d 1833 if (sscanf(txt, "%x", &trim) == 1)
Wayne Roberts 4:fa31fdf4ec8d 1834 radio.writeReg(REG_ADDR_XTA_TRIM, trim, 1);
Wayne Roberts 4:fa31fdf4ec8d 1835
Wayne Roberts 4:fa31fdf4ec8d 1836 return false;
Wayne Roberts 4:fa31fdf4ec8d 1837 }
Wayne Roberts 4:fa31fdf4ec8d 1838
Wayne Roberts 4:fa31fdf4ec8d 1839 const value_item_t Radio::xta_item = { _ITEM_VALUE, 3, xta_print, xta_write};
Wayne Roberts 4:fa31fdf4ec8d 1840
Wayne Roberts 4:fa31fdf4ec8d 1841 void Radio::xtb_print()
Wayne Roberts 4:fa31fdf4ec8d 1842 {
Wayne Roberts 4:fa31fdf4ec8d 1843 uint8_t trim = radio.readReg(REG_ADDR_XTB_TRIM, 1);
Wayne Roberts 4:fa31fdf4ec8d 1844 pc.printf("%02x", trim);
Wayne Roberts 4:fa31fdf4ec8d 1845 }
Wayne Roberts 4:fa31fdf4ec8d 1846
Wayne Roberts 4:fa31fdf4ec8d 1847 bool Radio::xtb_write(const char* txt)
Wayne Roberts 4:fa31fdf4ec8d 1848 {
Wayne Roberts 4:fa31fdf4ec8d 1849 unsigned trim;
Wayne Roberts 4:fa31fdf4ec8d 1850 if (sscanf(txt, "%x", &trim) == 1)
Wayne Roberts 4:fa31fdf4ec8d 1851 radio.writeReg(REG_ADDR_XTB_TRIM, trim, 1);
Wayne Roberts 4:fa31fdf4ec8d 1852
Wayne Roberts 4:fa31fdf4ec8d 1853 return false;
Wayne Roberts 4:fa31fdf4ec8d 1854 }
Wayne Roberts 4:fa31fdf4ec8d 1855
Wayne Roberts 4:fa31fdf4ec8d 1856 const value_item_t Radio::xtb_item = { _ITEM_VALUE, 3, xtb_print, xtb_write};
Wayne Roberts 4:fa31fdf4ec8d 1857
Wayne Roberts 1:0817a150122b 1858 const menu_t Radio::common_menu[] = {
Wayne Roberts 4:fa31fdf4ec8d 1859 { {FIRST_CHIP_MENU_ROW, 1}, "XTA:", &xta_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 4:fa31fdf4ec8d 1860 { {FIRST_CHIP_MENU_ROW, 8}, "XTB:", &xtb_item, FLAG_MSGTYPE_ALL },
Wayne Roberts 1:0817a150122b 1861 { {0, 0}, NULL, NULL }
Wayne Roberts 1:0817a150122b 1862 };
Wayne Roberts 1:0817a150122b 1863
Wayne Roberts 1:0817a150122b 1864 const menu_t* Radio::get_modem_menu()
Wayne Roberts 1:0817a150122b 1865 {
Wayne Roberts 1:0817a150122b 1866 pktType = radio.getPacketType();
Wayne Roberts 1:0817a150122b 1867
Wayne Roberts 1:0817a150122b 1868 if (pktType == PACKET_TYPE_RANGING || pktType == PACKET_TYPE_LORA) {
Wayne Roberts 1:0817a150122b 1869 return lora_menu;
Wayne Roberts 1:0817a150122b 1870 } else if (pktType == PACKET_TYPE_FLRC) {
Wayne Roberts 1:0817a150122b 1871 return flrc_menu;
Wayne Roberts 1:0817a150122b 1872 } else if (pktType == PACKET_TYPE_GFSK) {
Wayne Roberts 1:0817a150122b 1873 return gfsk_menu;
Wayne Roberts 1:0817a150122b 1874 }
Wayne Roberts 1:0817a150122b 1875
Wayne Roberts 1:0817a150122b 1876 return NULL;
Wayne Roberts 1:0817a150122b 1877 }
Wayne Roberts 1:0817a150122b 1878
Wayne Roberts 3:56fc764dee0a 1879 const menu_t* Radio::get_modem_sub_menu()
Wayne Roberts 3:56fc764dee0a 1880 {
Wayne Roberts 3:56fc764dee0a 1881 if (pktType == PACKET_TYPE_RANGING) {
Wayne Roberts 3:56fc764dee0a 1882 return rng_menu;
Wayne Roberts 3:56fc764dee0a 1883 }
Wayne Roberts 3:56fc764dee0a 1884 return NULL;
Wayne Roberts 3:56fc764dee0a 1885 }
Wayne Roberts 1:0817a150122b 1886
Wayne Roberts 1:0817a150122b 1887 bool Radio::service(int8_t statusRow)
Wayne Roberts 1:0817a150122b 1888 {
Wayne Roberts 1:0817a150122b 1889 static pktStatus_t prevPktStatus;
Wayne Roberts 1:0817a150122b 1890 static IrqFlags_t prevIrqFlags;
Wayne Roberts 1:0817a150122b 1891 IrqFlags_t irqFlags;
Wayne Roberts 1:0817a150122b 1892 bool ret = false;
Wayne Roberts 1:0817a150122b 1893 static us_timestamp_t prev_now;
Wayne Roberts 1:0817a150122b 1894 us_timestamp_t now = lpt.read_us();
Wayne Roberts 1:0817a150122b 1895
Wayne Roberts 1:0817a150122b 1896 radio.service();
Wayne Roberts 1:0817a150122b 1897
Wayne Roberts 1:0817a150122b 1898 if (statusRow > 0 && now-prev_now > 50000) {
Wayne Roberts 1:0817a150122b 1899 int cmp = 0;
Wayne Roberts 1:0817a150122b 1900 pktStatus_t pktStatus;
Wayne Roberts 1:0817a150122b 1901 uint8_t buf[6];
Wayne Roberts 1:0817a150122b 1902 radio.xfer(OPCODE_GET_IRQ_STATUS, 0, 3, buf);
Wayne Roberts 1:0817a150122b 1903 irqFlags.word = buf[1] << 8;
Wayne Roberts 1:0817a150122b 1904 irqFlags.word |= buf[2];
Wayne Roberts 1:0817a150122b 1905
Wayne Roberts 1:0817a150122b 1906 if (rx_led == LED_ON) {
Wayne Roberts 1:0817a150122b 1907 uint8_t slen;
Wayne Roberts 1:0817a150122b 1908 if (pktType == PACKET_TYPE_LORA || pktType == PACKET_TYPE_RANGING)
Wayne Roberts 1:0817a150122b 1909 slen = 3;
Wayne Roberts 1:0817a150122b 1910 else
Wayne Roberts 1:0817a150122b 1911 slen = 6;
Wayne Roberts 1:0817a150122b 1912
Wayne Roberts 1:0817a150122b 1913 radio.xfer(OPCODE_GET_PACKET_STATUS, 0, slen, pktStatus.buf);
Wayne Roberts 2:ea9245bb1c53 1914 cmp = memcmp(prevPktStatus.buf, pktStatus.buf, slen);
Wayne Roberts 1:0817a150122b 1915 }
Wayne Roberts 1:0817a150122b 1916
Wayne Roberts 1:0817a150122b 1917 if (irqFlags.word != prevIrqFlags.word || cmp) {
Wayne Roberts 3:56fc764dee0a 1918 IrqFlags_t clearIrqFlags;
Wayne Roberts 3:56fc764dee0a 1919 clearIrqFlags.word = 0;
Wayne Roberts 3:56fc764dee0a 1920
Wayne Roberts 1:0817a150122b 1921 pc.printf("\e[%u;1f", statusRow); // set (force) cursor to row;column
Wayne Roberts 1:0817a150122b 1922
Wayne Roberts 1:0817a150122b 1923 if (cmp) {
Wayne Roberts 1:0817a150122b 1924 if (pktType == PACKET_TYPE_FLRC || pktType == PACKET_TYPE_BLE || pktType == PACKET_TYPE_GFSK) {
Wayne Roberts 1:0817a150122b 1925 if (pktStatus.ble_gfsk_flrc.errors.SyncError)
Wayne Roberts 1:0817a150122b 1926 pc.printf("SyncError ");
Wayne Roberts 1:0817a150122b 1927 if (pktStatus.ble_gfsk_flrc.errors.LengthError)
Wayne Roberts 1:0817a150122b 1928 pc.printf("LengthError ");
Wayne Roberts 1:0817a150122b 1929 if (pktStatus.ble_gfsk_flrc.errors.CrcError)
Wayne Roberts 1:0817a150122b 1930 pc.printf("CrcError ");
Wayne Roberts 1:0817a150122b 1931 if (pktStatus.ble_gfsk_flrc.errors.AbortErr)
Wayne Roberts 1:0817a150122b 1932 pc.printf("AbortErr ");
Wayne Roberts 1:0817a150122b 1933 if (pktStatus.ble_gfsk_flrc.errors.headerReceived)
Wayne Roberts 1:0817a150122b 1934 pc.printf("headerReceived ");
Wayne Roberts 1:0817a150122b 1935 if (pktStatus.ble_gfsk_flrc.errors.packetReceived)
Wayne Roberts 1:0817a150122b 1936 pc.printf("packetReceived ");
Wayne Roberts 1:0817a150122b 1937 if (pktStatus.ble_gfsk_flrc.errors.pktCtrlBusy)
Wayne Roberts 1:0817a150122b 1938 pc.printf("pktCtrlBusy ");
Wayne Roberts 1:0817a150122b 1939 }
Wayne Roberts 1:0817a150122b 1940 memcpy(prevPktStatus.buf, pktStatus.buf, sizeof(pktStatus_t));
Wayne Roberts 1:0817a150122b 1941 pc.printf(" | ");
Wayne Roberts 1:0817a150122b 1942 }
Wayne Roberts 1:0817a150122b 1943
Wayne Roberts 1:0817a150122b 1944 if (irqFlags.bits.TxDone)
Wayne Roberts 1:0817a150122b 1945 pc.printf("TxDone ");
Wayne Roberts 1:0817a150122b 1946 if (irqFlags.bits.RxDone)
Wayne Roberts 1:0817a150122b 1947 pc.printf("RxDone ");
Wayne Roberts 1:0817a150122b 1948 if (irqFlags.bits.SyncWordValid)
Wayne Roberts 1:0817a150122b 1949 pc.printf("SyncWordValid ");
Wayne Roberts 1:0817a150122b 1950 if (irqFlags.bits.SyncWordError)
Wayne Roberts 1:0817a150122b 1951 pc.printf("SyncWordError ");
Wayne Roberts 1:0817a150122b 1952 if (irqFlags.bits.HeaderValid)
Wayne Roberts 1:0817a150122b 1953 pc.printf("HeaderValid ");
Wayne Roberts 1:0817a150122b 1954 if (irqFlags.bits.HeaderError)
Wayne Roberts 1:0817a150122b 1955 pc.printf("HeaderError ");
Wayne Roberts 1:0817a150122b 1956 if (irqFlags.bits.CrcError)
Wayne Roberts 1:0817a150122b 1957 pc.printf("CrcError ");
Wayne Roberts 3:56fc764dee0a 1958 if (irqFlags.bits.RangingSlaveResponseDone) {
Wayne Roberts 1:0817a150122b 1959 pc.printf("RangingSlaveResponseDone ");
Wayne Roberts 3:56fc764dee0a 1960 clearIrqFlags.bits.RangingSlaveResponseDone = 1;
Wayne Roberts 3:56fc764dee0a 1961 } if (irqFlags.bits.RangingSlaveRequestDiscard) {
Wayne Roberts 1:0817a150122b 1962 pc.printf("RangingSlaveRequestDiscard ");
Wayne Roberts 3:56fc764dee0a 1963 clearIrqFlags.bits.RangingSlaveRequestDiscard = 1;
Wayne Roberts 3:56fc764dee0a 1964 } if (irqFlags.bits.RangingMasterResultValid) {
Wayne Roberts 1:0817a150122b 1965 pc.printf("RangingMasterResultValid ");
Wayne Roberts 3:56fc764dee0a 1966 } if (irqFlags.bits.RangingMasterTimeout) {
Wayne Roberts 3:56fc764dee0a 1967 radio.chipMode = CHIPMODE_NONE;
Wayne Roberts 3:56fc764dee0a 1968 chipModeChange();
Wayne Roberts 1:0817a150122b 1969 pc.printf("RangingMasterTimeout ");
Wayne Roberts 3:56fc764dee0a 1970 clearIrqFlags.bits.RangingMasterTimeout = 1;
Wayne Roberts 3:56fc764dee0a 1971 } if (irqFlags.bits.RangingMasterRequestValid) {
Wayne Roberts 1:0817a150122b 1972 pc.printf("RangingMasterRequestValid ");
Wayne Roberts 3:56fc764dee0a 1973 clearIrqFlags.bits.RangingMasterRequestValid = 1;
Wayne Roberts 3:56fc764dee0a 1974 } if (irqFlags.bits.CadDone)
Wayne Roberts 1:0817a150122b 1975 pc.printf("CadDone ");
Wayne Roberts 1:0817a150122b 1976 if (irqFlags.bits.CadDetected)
Wayne Roberts 1:0817a150122b 1977 pc.printf("CadDetected ");
Wayne Roberts 1:0817a150122b 1978 if (irqFlags.bits.RxTxTimeout)
Wayne Roberts 1:0817a150122b 1979 pc.printf("RxTxTimeout ");
Wayne Roberts 1:0817a150122b 1980 if (irqFlags.bits.PreambleDetected)
Wayne Roberts 1:0817a150122b 1981 pc.printf("PreambleDetected ");
Wayne Roberts 1:0817a150122b 1982
Wayne Roberts 1:0817a150122b 1983 pc.printf("\e[K");
Wayne Roberts 1:0817a150122b 1984 ret = true;
Wayne Roberts 1:0817a150122b 1985
Wayne Roberts 1:0817a150122b 1986 prevIrqFlags.word = irqFlags.word;
Wayne Roberts 3:56fc764dee0a 1987
Wayne Roberts 3:56fc764dee0a 1988 if (irqFlags.bits.RangingMasterResultValid) {
Wayne Roberts 3:56fc764dee0a 1989 float m;
Wayne Roberts 3:56fc764dee0a 1990 unsigned rngResult, rngRssi;
Wayne Roberts 3:56fc764dee0a 1991 radio.chipMode = CHIPMODE_NONE;
Wayne Roberts 3:56fc764dee0a 1992 chipModeChange();
Wayne Roberts 3:56fc764dee0a 1993 rngResult = radio.readReg(REG_ADDR_RNGRESULT, 3);
Wayne Roberts 3:56fc764dee0a 1994 // Distance [m] = RangingResult*150/(2^12*BwMHz)
Wayne Roberts 3:56fc764dee0a 1995 m = rngResult * 150 / (4096*bwMHzs[LoRaPktPar0.bits.modem_bw]);
Wayne Roberts 3:56fc764dee0a 1996 rngRssi = radio.readReg(REG_ADDR_RNGRSSI, 1);
Wayne Roberts 3:56fc764dee0a 1997 log_printf("%u rngResult %.2fm, RngRssi:%u bw%.1f\r\n", rngResult, m, rngRssi, bwMHzs[LoRaPktPar0.bits.modem_bw]);
Wayne Roberts 3:56fc764dee0a 1998 clearIrqFlags.bits.RangingMasterResultValid = 1;
Wayne Roberts 3:56fc764dee0a 1999 }
Wayne Roberts 3:56fc764dee0a 2000
Wayne Roberts 3:56fc764dee0a 2001 if (irqFlags.bits.RangingSlaveResponseDone)
Wayne Roberts 3:56fc764dee0a 2002 log_printf("RangingSlaveResponseDone\r\n");
Wayne Roberts 3:56fc764dee0a 2003 if (irqFlags.bits.RangingSlaveRequestDiscard)
Wayne Roberts 3:56fc764dee0a 2004 log_printf("RangingSlaveRequestDiscard\r\n");
Wayne Roberts 3:56fc764dee0a 2005 if (irqFlags.bits.RangingMasterRequestValid)
Wayne Roberts 3:56fc764dee0a 2006 log_printf("RangingMasterRequestValid\r\n");
Wayne Roberts 3:56fc764dee0a 2007
Wayne Roberts 3:56fc764dee0a 2008 if (clearIrqFlags.word != 0) {
Wayne Roberts 3:56fc764dee0a 2009 buf[0] = clearIrqFlags.word >> 8;
Wayne Roberts 3:56fc764dee0a 2010 buf[1] = (uint8_t)clearIrqFlags.word;
Wayne Roberts 3:56fc764dee0a 2011 radio.xfer(OPCODE_CLEAR_IRQ_STATUS, 2, 0, buf);
Wayne Roberts 3:56fc764dee0a 2012 }
Wayne Roberts 3:56fc764dee0a 2013 } // ..if change
Wayne Roberts 1:0817a150122b 2014
Wayne Roberts 1:0817a150122b 2015 prev_now = now;
Wayne Roberts 1:0817a150122b 2016 }
Wayne Roberts 1:0817a150122b 2017
Wayne Roberts 1:0817a150122b 2018 return ret;
Wayne Roberts 1:0817a150122b 2019 }
Wayne Roberts 1:0817a150122b 2020
Wayne Roberts 1:0817a150122b 2021 void Radio::Rx()
Wayne Roberts 1:0817a150122b 2022 {
Wayne Roberts 3:56fc764dee0a 2023 if (pktType == PACKET_TYPE_RANGING) {
Wayne Roberts 3:56fc764dee0a 2024 IrqFlags_t irqEnable;
Wayne Roberts 3:56fc764dee0a 2025 uint8_t buf[8];
Wayne Roberts 3:56fc764dee0a 2026
Wayne Roberts 3:56fc764dee0a 2027 if (!manualRngDelay)
Wayne Roberts 3:56fc764dee0a 2028 rngUpdateDelayCal();
Wayne Roberts 3:56fc764dee0a 2029
Wayne Roberts 3:56fc764dee0a 2030 irqEnable.word = 0;
Wayne Roberts 3:56fc764dee0a 2031 irqEnable.bits.RxDone = 1;
Wayne Roberts 3:56fc764dee0a 2032 irqEnable.bits.RxTxTimeout = 1;
Wayne Roberts 3:56fc764dee0a 2033 irqEnable.bits.RangingSlaveResponseDone = 1;
Wayne Roberts 3:56fc764dee0a 2034 irqEnable.bits.RangingSlaveRequestDiscard = 1;
Wayne Roberts 3:56fc764dee0a 2035 irqEnable.bits.RangingMasterRequestValid = 1;
Wayne Roberts 3:56fc764dee0a 2036
Wayne Roberts 3:56fc764dee0a 2037 buf[0] = irqEnable.word >> 8; // enable bits
Wayne Roberts 3:56fc764dee0a 2038 buf[1] = irqEnable.word; // enable bits
Wayne Roberts 3:56fc764dee0a 2039
Wayne Roberts 3:56fc764dee0a 2040 irqEnable.bits.RangingSlaveResponseDone = 0;
Wayne Roberts 3:56fc764dee0a 2041 irqEnable.bits.RangingSlaveRequestDiscard = 0;
Wayne Roberts 3:56fc764dee0a 2042 irqEnable.bits.RangingMasterRequestValid = 0;
Wayne Roberts 3:56fc764dee0a 2043 buf[2] = irqEnable.word >> 8; // dio1
Wayne Roberts 3:56fc764dee0a 2044 buf[3] = irqEnable.word; // dio1
Wayne Roberts 3:56fc764dee0a 2045
Wayne Roberts 3:56fc764dee0a 2046 buf[4] = 0; // dio2
Wayne Roberts 3:56fc764dee0a 2047 buf[5] = 0; // dio2
Wayne Roberts 3:56fc764dee0a 2048 buf[6] = 0; // dio3
Wayne Roberts 3:56fc764dee0a 2049 buf[7] = 0; // dio3
Wayne Roberts 3:56fc764dee0a 2050 radio.xfer(OPCODE_SET_DIO_IRQ_PARAMS, 8, 0, buf);
Wayne Roberts 3:56fc764dee0a 2051
Wayne Roberts 3:56fc764dee0a 2052 buf[0] = radio.periodBase;
Wayne Roberts 3:56fc764dee0a 2053 /* receive packets forever */
Wayne Roberts 3:56fc764dee0a 2054 buf[1] = 0xff;
Wayne Roberts 3:56fc764dee0a 2055 buf[2] = 0xff;
Wayne Roberts 3:56fc764dee0a 2056 radio.xfer(OPCODE_SET_RX, 3, 0, buf);
Wayne Roberts 3:56fc764dee0a 2057
Wayne Roberts 3:56fc764dee0a 2058 radio.chipMode = CHIPMODE_RX;
Wayne Roberts 3:56fc764dee0a 2059 chipModeChange();
Wayne Roberts 3:56fc764dee0a 2060 } else
Wayne Roberts 3:56fc764dee0a 2061 radio.start_rx(0);
Wayne Roberts 1:0817a150122b 2062 }
Wayne Roberts 1:0817a150122b 2063
Wayne Roberts 1:0817a150122b 2064 void Radio::setFS()
Wayne Roberts 1:0817a150122b 2065 {
Wayne Roberts 1:0817a150122b 2066 radio.setFS();
Wayne Roberts 1:0817a150122b 2067 }
Wayne Roberts 1:0817a150122b 2068
Wayne Roberts 3:56fc764dee0a 2069 void Radio::test()
Wayne Roberts 3:56fc764dee0a 2070 {
Wayne Roberts 3:56fc764dee0a 2071 /*
Wayne Roberts 3:56fc764dee0a 2072 RngCfg0_t RngCfg0;
Wayne Roberts 3:56fc764dee0a 2073 RngCfg0.octet = radio.readReg(REG_ADDR_RNGCFG0, 1);
Wayne Roberts 3:56fc764dee0a 2074
Wayne Roberts 3:56fc764dee0a 2075 log_printf("Rngcfg0 %02x\r\n", RngCfg0.octet);*/
Wayne Roberts 3:56fc764dee0a 2076 unsigned a;
Wayne Roberts 3:56fc764dee0a 2077 log_printf("%02x ", radio.readReg(0x910, 1));
Wayne Roberts 3:56fc764dee0a 2078 for (a = 0x911; a < 0x980; a++) {
Wayne Roberts 3:56fc764dee0a 2079 pc.printf("%02x ", radio.readReg(a, 1));
Wayne Roberts 3:56fc764dee0a 2080 if ((a & 0x1f) == 0x1f)
Wayne Roberts 3:56fc764dee0a 2081 pc.printf("\r\n%03x ", a+1);
Wayne Roberts 3:56fc764dee0a 2082 }
Wayne Roberts 3:56fc764dee0a 2083 pc.printf("\r\n");
Wayne Roberts 3:56fc764dee0a 2084 }
Wayne Roberts 1:0817a150122b 2085
Wayne Roberts 4:fa31fdf4ec8d 2086 unsigned Radio::read_register(unsigned addr)
Wayne Roberts 4:fa31fdf4ec8d 2087 {
Wayne Roberts 4:fa31fdf4ec8d 2088 return radio.readReg(addr, 1);
Wayne Roberts 4:fa31fdf4ec8d 2089 }
Wayne Roberts 4:fa31fdf4ec8d 2090
Wayne Roberts 4:fa31fdf4ec8d 2091 void Radio::write_register(unsigned addr, unsigned val)
Wayne Roberts 4:fa31fdf4ec8d 2092 {
Wayne Roberts 4:fa31fdf4ec8d 2093 radio.writeReg(addr, val, 1);
Wayne Roberts 4:fa31fdf4ec8d 2094 }
Wayne Roberts 4:fa31fdf4ec8d 2095
Wayne Roberts 1:0817a150122b 2096 #endif /* ..SX126x_H */