plm150/Radio-Rx/main.cpp

#include <cox.h>
 
Timer tRSSI;
struct timeval tRxStarted, tRxDone;
int16_t rssiRxStarted;
char buf[20];
int8_t modem;
Radio::LoRaSF_t sf;
Radio::LoRaCR_t cr = Radio::CR_4_5;
Radio::LoRaBW_t bw;
bool iqInverted;
uint8_t syncword;
uint32_t freq;
 
static void printRxDone(void *args) {
  static uint16_t success = 0;
  RadioPacket *rxFrame = (RadioPacket *) args;
 
  printf(
    "[%lu.%06lu] Rx is done!: RSSI:%d dB, SNR:%d, CRC:%s, Length:%u, (",
    (uint32_t) tRxDone.tv_sec, tRxDone.tv_usec,
    rxFrame->power,
    rxFrame->meta.LoRa.snr,
    rxFrame->result == RadioPacket::SUCCESS ? "OK" : "FAIL",
    rxFrame->len
  );
  uint16_t i;
  for (i = 0; i < rxFrame->len; i++)
    printf("%02X ", rxFrame->buf[i]);
  printf("\b), # of Rx:%u\n", (rxFrame->result == RadioPacket::SUCCESS) ? ++success : success);
 
  delete rxFrame;
}
 
static void eventOnRxDone(void *ctx, GPIOInterruptInfo_t *intrInfo) {
  tRxDone = intrInfo->timeEnteredISR;
  RadioPacket *rxFrame = new RadioPacket(125);
 
  if (!rxFrame) {
    printf("Out of memory to read frame\n");
    SubGHzRadio.flushBuffer();
    return;
  }
 
  SubGHzRadio.readFrame(rxFrame);
  postTask(printRxDone, (void *) rxFrame);
  // SubGHzRadio.cca();
}
 
static void eventOnChannelBusy(void *ctx, GPIOInterruptInfo_t *) {
  printf("Channel Busy!!\n");
}
 
static void printRxStarted(void *args) {
  printf(
    "[%lu.%06lu] Rx is started... (%d dB)\n",
    (uint32_t) tRxStarted.tv_sec, tRxStarted.tv_usec, rssiRxStarted
  );
}
 
static void taskRSSI(void *) {
  struct timeval tNow;
  gettimeofday(&tNow, nullptr);
  printf("[%lu.%06lu] RSSI: %d dB\n", (uint32_t) tNow.tv_sec, tNow.tv_usec, SubGHzRadio.getRssi());
  // SubGHzRadio.cca();
}
 
static void eventKeyStroke(SerialPort &) {
  reboot();
}
 
static void appStart() {
  Serial.stopInput(); // to receive key stroke not string
  Serial.onReceive(eventKeyStroke);
 
  /* All parameters are specified. */
  SubGHzRadio.begin();
 
  if (modem == 0) {
    SubGHzRadio.setRadio(sf, bw, cr, true, iqInverted);
  } else {
    // SX1276.setModemFsk();
    // SX1276.setDataRate(50000);
    // SX1276.setBandwidth(50000);
    // SX1276.setAfcBandwidth(83333);
    // SX1276.setFdev(25000);
  }
 
  SubGHzRadio.setChannel(freq);
  SubGHzRadio.onRxDone = eventOnRxDone;
  SubGHzRadio.onChannelBusy = eventOnChannelBusy;
  SubGHzRadio.wakeup();
  // SubGHzRadio.cca();
 
  tRSSI.onFired(taskRSSI, NULL);
  // tRSSI.startPeriodic(1000);
}
 
static void inputFrequency(SerialPort &);
static void askFrequency() {
  printf("Enter frequency in unit of Hz [917100000]:");
  Serial.onReceive(inputFrequency);
  Serial.inputKeyboard(buf, sizeof(buf));
}
 
static void inputFrequency(SerialPort &) {
  if (strlen(buf) == 0) {
    freq = 917100000;
  } else {
    freq = (uint32_t) strtoul(buf, NULL, 0);
    if (freq == 0) {
      printf("* Invalid frequency.\n");
      askFrequency();
      return;
    }
  }
 
  printf("* Frequency: %lu\n", freq);
  appStart();
}
 
static void inputSyncword(SerialPort &);
static void askSyncword() {
  printf("Enter syncword [0x12]:");
  Serial.onReceive(inputSyncword);
  Serial.inputKeyboard(buf, sizeof(buf));
}
 
static void inputSyncword(SerialPort &) {
  if (strlen(buf) == 0) {
    syncword = 0x12;
  } else {
    uint8_t sw = (uint8_t) strtoul(buf, NULL, 0);
    if (sw == 0) {
      printf("* Invalid syncword.\n");
      askSyncword();
      return;
    }
 
    syncword = sw;
  }
 
  printf("* Syncword: 0x%02X\n", syncword);
  askFrequency();
}
 
static void inputIQ(SerialPort &);
static void askIQ() {
  printf("Set IQ (1:normal, 2:inverted) [1]:");
  Serial.onReceive(inputIQ);
  Serial.inputKeyboard(buf, sizeof(buf));
}
 
static void inputIQ(SerialPort &) {
  if (strlen(buf) == 0 || strcmp(buf, "1") == 0) {
    printf("* Normal selected.\n");
    iqInverted = false;
  } else if (strcmp(buf, "2") == 0) {
    printf("* Inverted selected.\n");
    iqInverted = true;
  } else {
    printf("* Unknown IQ mode\n");
    askIQ();
    return;
  }
  askSyncword();
}
 
static void inputBW(SerialPort &);
static void askBW() {
  printf("Set bandwidth (1:125kHz, 2:250kHz, 3:500kHz) [1]:");
  Serial.onReceive(inputBW);
  Serial.inputKeyboard(buf, sizeof(buf));
}
 
static void inputBW(SerialPort &) {
  if (strlen(buf) == 0 || strcmp(buf, "1") == 0) {
    printf("* 125kHz selected.\n");
    bw = Radio::BW_125kHz;
  } else if (strcmp(buf, "2") == 0) {
    printf("* 250kHz selected.\n");
    bw = Radio::BW_250kHz;
  } else if (strcmp(buf, "3") == 0) {
    printf("* 500kHz selected.\n");
    bw = Radio::BW_500kHz;
  } else {
    printf("* Unknown SF\n");
    askBW();
    return;
  }
  askIQ();
}
 
static void inputSF(SerialPort &);
static void askSF() {
  printf("Set SF (7, 8, 9, 10, 11, 12) [7]:");
  Serial.onReceive(inputSF);
  Serial.inputKeyboard(buf, sizeof(buf));
}
 
static void inputSF(SerialPort &) {
  if (strlen(buf) == 0 || strcmp(buf, "7") == 0) {
    printf("* SF7 selected.\n");
    sf = Radio::SF7;
  } else if (strcmp(buf, "8") == 0) {
    printf("* SF8 selected.\n");
    sf = Radio::SF8;
  } else if (strcmp(buf, "9") == 0) {
    printf("* SF9 selected.\n");
    sf = Radio::SF9;
  } else if (strcmp(buf, "10") == 0) {
    printf("* SF10 selected.\n");
    sf = Radio::SF10;
  } else if (strcmp(buf, "11") == 0) {
    printf("* SF11 selected.\n");
    sf = Radio::SF11;
  } else if (strcmp(buf, "12") == 0) {
    printf("* SF12 selected.\n");
    sf = Radio::SF12;
  } else {
    printf("* Unknown SF: ");
    for (uint8_t i = 0; i < strlen(buf); i++) {
      printf(" 0x%02x", buf[i]);
    }
    printf("\n");
    askSF();
    return;
  }
  askBW();
}
 
static void inputModem(SerialPort &);
static void askModem() {
  printf("Select modem (1: LoRa, 2:FSK) [1]:");
  Serial.onReceive(inputModem);
  Serial.inputKeyboard(buf, sizeof(buf));
}
 
static void inputModem(SerialPort &) {
  if (strlen(buf) == 0 || strcmp(buf, "1") == 0) {
    printf("* LoRa selected.\n");
    modem = 0;
    askSF();
  } else if (strcmp(buf, "2") == 0) {
    printf("* FSK selected.\n");
    modem = 1;
    appStart();
  } else {
    printf("* Unknown modem\n");
    askModem();
  }
}
 
void setup(void) {
  Serial.begin(115200);
  printf("\n*** [PLM150] Sub GHz Radio Rx Control Example ***\n");
 
#if 1
  Serial.listen();
  askModem();
#else
  modem = 0;
  sf = Radio::SF12;
  cr = Radio::CR_4_5;
  bw = Radio::BW_125kHz;
  iq = true;
  syncword = 0x12;
  appStart();
#endif
}