#include "LoRaModem.h"

// SX1278
int16_t Modem_SX1278::begin(const LoraPins &lora_pins, const Configuration::LoRa &lora_config, const uint16_t preambleLength, void (*setFlag)()) {
  float _frequencyRx = (float)lora_config.frequencyRx / 1000000;
  float BWkHz        = (float)lora_config.signalBandwidth / 1000;

  SPI.begin(lora_pins.Sck, lora_pins.Miso, lora_pins.Mosi, lora_pins.CS);
  _module = new Module(lora_pins.CS, lora_pins.IRQ, lora_pins.Reset);

  _radio        = new SX1278(_module);
  int16_t state = _radio->begin(_frequencyRx, BWkHz, lora_config.spreadingFactor, lora_config.codingRate4, RADIOLIB_SX127X_SYNC_WORD, lora_config.power, preambleLength, lora_config.gainRx);
  if (state != RADIOLIB_ERR_NONE) {
    return state;
  }

  state = _radio->setCRC(true);
  if (state != RADIOLIB_ERR_NONE) {
    return state;
  }

  _radio->setDio0Action(setFlag, RISING);

  if (lora_config.tx_enable && lora_config.power > 17) {
    _radio->setCurrentLimit(140);
  }
  return RADIOLIB_ERR_NONE;
}

int16_t Modem_SX1278::readData(String &str) {
  return _radio->readData(str);
}

int16_t Modem_SX1278::setFrequency(float freq) {
  return _radio->setFrequency(freq);
}

int16_t Modem_SX1278::startReceive() {
  return _radio->startReceive();
}

int16_t Modem_SX1278::startTransmit(String &str) {
  return _radio->startTransmit(str);
}

int16_t Modem_SX1278::receive(String &str) {
  return _radio->receive(str);
}

float Modem_SX1278::getRSSI() {
  return _radio->getRSSI();
}

float Modem_SX1278::getSNR() {
  return _radio->getSNR();
}

float Modem_SX1278::getFrequencyError() {
  return _radio->getFrequencyError();
}

uint8_t Modem_SX1278::getModemStatus() {
  return _radio->getModemStatus();
}

// SX1262
int16_t Modem_SX1262::begin(const LoraPins &lora_pins, const Configuration::LoRa &lora_config, const uint16_t preambleLength, void (*setFlag)()) {
  float _frequencyRx = (float)lora_config.frequencyRx / 1000000;
  float BWkHz        = (float)lora_config.signalBandwidth / 1000;

  SPI.begin(lora_pins.Sck, lora_pins.Miso, lora_pins.Mosi, lora_pins.CS);
  _module = new Module(lora_pins.CS, lora_pins.IRQ, lora_pins.Reset, 13);

  _radio        = new SX1262(_module);
  int16_t state = _radio->begin(_frequencyRx, BWkHz, lora_config.spreadingFactor, lora_config.codingRate4, RADIOLIB_SX126X_SYNC_WORD_PRIVATE, lora_config.power, preambleLength);
  if (state != RADIOLIB_ERR_NONE) {
    return state;
  }

  state = _radio->setCRC(true);
  if (state != RADIOLIB_ERR_NONE) {
    return state;
  }

  _radio->setDio1Action(setFlag);

  if (lora_config.tx_enable && lora_config.power > 17) {
    _radio->setCurrentLimit(140);
  }
  return RADIOLIB_ERR_NONE;
}

int16_t Modem_SX1262::readData(String &str) {
  return _radio->readData(str);
}

int16_t Modem_SX1262::setFrequency(float freq) {
  return _radio->setFrequency(freq);
}

int16_t Modem_SX1262::startReceive() {
  return _radio->startReceive();
}

int16_t Modem_SX1262::startTransmit(String &str) {
  return _radio->startTransmit(str);
}

int16_t Modem_SX1262::receive(String &str) {
  return _radio->receive(str);
}

float Modem_SX1262::getRSSI() {
  return _radio->getRSSI();
}

float Modem_SX1262::getSNR() {
  return _radio->getSNR();
}

float Modem_SX1262::getFrequencyError() {
  return _radio->getFrequencyError();
}

uint8_t Modem_SX1262::getModemStatus() {
  return 0;
}