How to measure water in a reservoir

Dependencies:   Cayenne-MQTT-mbed Cayenne-LPP

Revision:
0:7bfeb237e600
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/mbed-lora-radio-drv/SX1272/SX1272_LoRaRadio.cpp	Fri Mar 08 11:34:56 2019 +0000
@@ -0,0 +1,2174 @@
+/**
+ / _____)             _              | |
+( (____  _____ ____ _| |_ _____  ____| |__
+ \____ \| ___ |    (_   _) ___ |/ ___)  _ \
+ _____) ) ____| | | || |_| ____( (___| | | |
+(______/|_____)_|_|_| \__)_____)\____)_| |_|
+    (C)2013 Semtech
+ ___ _____ _   ___ _  _____ ___  ___  ___ ___
+/ __|_   _/_\ / __| |/ / __/ _ \| _ \/ __| __|
+\__ \ | |/ _ \ (__| ' <| _| (_) |   / (__| _|
+|___/ |_/_/ \_\___|_|\_\_| \___/|_|_\\___|___|
+embedded.connectivity.solutions===============
+
+Description: Radio driver for Semtech SX1272 LoRa radio chip. Implements LoRaRadio class.
+
+License: Revised BSD License, see LICENSE.TXT file include in the project
+
+Maintainer: Miguel Luis ( Semtech ), Gregory Cristian ( Semtech ) and Daniel Jaeckle ( STACKFORCE )
+
+
+Copyright (c) 2017, Arm Limited and affiliates.
+
+SPDX-License-Identifier: BSD-3-Clause
+*/
+
+#include <stdio.h>
+#include <math.h> //rint
+#include <string.h>
+#include "mbed.h"
+
+#include "SX1272_LoRaRadio.h"
+#include "sx1272Regs-Fsk.h"
+#include "sx1272Regs-LoRa.h"
+
+#ifdef DEVICE_SPI
+
+#if defined(FEATURE_COMMON_PAL)
+#include "mbed_trace.h"
+#define TRACE_GROUP "LRAD"
+#else
+#define tr_debug(...) (void(0)) //dummies if feature common pal is not added
+#define tr_info(...)  (void(0)) //dummies if feature common pal is not added
+#define tr_error(...) (void(0)) //dummies if feature common pal is not added
+#endif //defined(FEATURE_COMMON_PAL)
+
+#ifdef MBED_SX1272_LORA_RADIO_SPI_FREQUENCY
+#define SPI_FREQUENCY    MBED_SX1272_LORA_RADIO_SPI_FREQUENCY
+#else
+#define SPI_FREQUENCY    8000000
+#endif
+
+// Sync word for Private LoRa networks
+#define LORA_MAC_PRIVATE_SYNCWORD                   0x12
+// Sync word for Public LoRa networks
+#define LORA_MAC_PUBLIC_SYNCWORD                    0x34
+
+// SX1272 definitions
+#define XTAL_FREQ                                   32000000
+#define FREQ_STEP                                   61.03515625
+
+
+
+enum RadioVariant {
+    SX1272UNDEFINED = 0,
+    SX1272MB2XAS,
+    SX1272MB1DCS
+};
+
+/*!
+ * FSK bandwidth definition
+ */
+typedef struct
+{
+    uint32_t bandwidth;
+    uint8_t  register_value;
+} fsk_bw_t;
+
+/*!
+ * Radio registers definition
+ */
+typedef struct
+{
+    modem_type  modem;
+    uint8_t     addr;
+    uint8_t     value;
+} radio_registers_t;
+
+/*!
+ * Constant values need to compute the RSSI value
+ */
+#define RSSI_OFFSET                                 -139
+
+#define RADIO_INIT_REGISTERS_VALUE                \
+{                                                 \
+    { MODEM_FSK , REG_LNA                , 0x23 },\
+    { MODEM_FSK , REG_RXCONFIG           , 0x1E },\
+    { MODEM_FSK , REG_RSSICONFIG         , 0xD2 },\
+    { MODEM_FSK , REG_AFCFEI             , 0x01 },\
+    { MODEM_FSK , REG_PREAMBLEDETECT     , 0xAA },\
+    { MODEM_FSK , REG_OSC                , 0x07 },\
+    { MODEM_FSK , REG_SYNCCONFIG         , 0x12 },\
+    { MODEM_FSK , REG_SYNCVALUE1         , 0xC1 },\
+    { MODEM_FSK , REG_SYNCVALUE2         , 0x94 },\
+    { MODEM_FSK , REG_SYNCVALUE3         , 0xC1 },\
+    { MODEM_FSK , REG_PACKETCONFIG1      , 0xD8 },\
+    { MODEM_FSK , REG_FIFOTHRESH         , 0x8F },\
+    { MODEM_FSK , REG_IMAGECAL           , 0x02 },\
+    { MODEM_FSK , REG_DIOMAPPING1        , 0x00 },\
+    { MODEM_FSK , REG_DIOMAPPING2        , 0x30 },\
+    { MODEM_LORA, REG_LR_DETECTOPTIMIZE  , 0x43 },\
+    { MODEM_LORA, REG_LR_PAYLOADMAXLENGTH, 0x40 },\
+}
+
+const fsk_bw_t fsk_bandwidths[] =
+{
+    { 2600  , 0x17 },
+    { 3100  , 0x0F },
+    { 3900  , 0x07 },
+    { 5200  , 0x16 },
+    { 6300  , 0x0E },
+    { 7800  , 0x06 },
+    { 10400 , 0x15 },
+    { 12500 , 0x0D },
+    { 15600 , 0x05 },
+    { 20800 , 0x14 },
+    { 25000 , 0x0C },
+    { 31300 , 0x04 },
+    { 41700 , 0x13 },
+    { 50000 , 0x0B },
+    { 62500 , 0x03 },
+    { 83333 , 0x12 },
+    { 100000, 0x0A },
+    { 125000, 0x02 },
+    { 166700, 0x11 },
+    { 200000, 0x09 },
+    { 250000, 0x01 },
+    { 300000, 0x00 }, // Invalid bandwidth
+};
+
+/**
+ * SPI read/write masks
+ */
+#define SPI_WRITE_CMD   0x80
+#define SPI_READ_CMD    0x7F
+
+/**
+ * Signals
+ */
+#define SIG_DIO0    0x01
+#define SIG_DIO1    0x02
+#define SIG_DIO2    0x04
+#define SIG_DIO3    0x08
+#define SIG_DIO4    0x10
+#define SIG_DIO5    0x20
+#define SIG_TIMOUT  0x40
+
+/**
+ * Radio hardware registers initialization
+ */
+static const radio_registers_t radio_reg_init[] = RADIO_INIT_REGISTERS_VALUE;
+
+
+/**
+ * Constructor
+ */
+SX1272_LoRaRadio::SX1272_LoRaRadio(PinName spi_mosi,
+                                   PinName spi_miso,
+                                   PinName spi_sclk,
+                                   PinName nss,
+                                   PinName reset,
+                                   PinName dio0,
+                                   PinName dio1,
+                                   PinName dio2,
+                                   PinName dio3,
+                                   PinName dio4,
+                                   PinName dio5,
+                                   PinName rf_switch_ctl1,
+                                   PinName rf_switch_ctl2,
+                                   PinName txctl,
+                                   PinName rxctl,
+                                   PinName antswitch,
+                                   PinName pwr_amp_ctl,
+                                   PinName tcxo)
+    :   _spi(spi_mosi, spi_miso, spi_sclk),
+        _chip_select(nss, 1),
+        _reset_ctl(reset),
+        _dio0_ctl(dio0), _dio1_ctl(dio1), _dio2_ctl(dio2), _dio3_ctl(dio3), _dio4_ctl(dio4), _dio5_ctl(dio5),
+        _rf_switch_ctl1(rf_switch_ctl1, 0), _rf_switch_ctl2(rf_switch_ctl2, 0), _txctl(txctl, 0), _rxctl(rxctl, 0),
+        _ant_switch(antswitch, PIN_INPUT, PullUp, 0),
+        _pwr_amp_ctl(pwr_amp_ctl),
+        _tcxo(tcxo)
+
+#ifdef MBED_CONF_RTOS_PRESENT
+        , irq_thread(osPriorityRealtime, 1024)
+#endif
+{
+    _rf_ctrls.ant_switch = antswitch;
+    _rf_ctrls.pwr_amp_ctl = pwr_amp_ctl;
+    _rf_ctrls.rf_switch_ctl1 = rf_switch_ctl1;
+    _rf_ctrls.rf_switch_ctl2 = rf_switch_ctl2;
+    _rf_ctrls.rxctl = rxctl;
+    _rf_ctrls.txctl = txctl;
+
+    _dio4_pin = dio4;
+    _dio5_pin = dio5;
+
+    _radio_events = NULL;
+
+    if (tcxo != NC) {
+        _tcxo = 1;
+    }
+
+    radio_is_active = false;
+
+#ifdef MBED_CONF_RTOS_PRESENT
+    irq_thread.start(mbed::callback(this, &SX1272_LoRaRadio::rf_irq_task));
+#endif
+}
+
+/**
+ * Destructor
+ */
+SX1272_LoRaRadio::~SX1272_LoRaRadio()
+{
+
+}
+
+/*****************************************************************************
+ * Public APIs                                                               *
+ ****************************************************************************/
+
+/**
+ * Acquire lock
+ */
+void SX1272_LoRaRadio::lock(void)
+{
+    mutex.lock();
+}
+
+/**
+ * Release lock
+ */
+void SX1272_LoRaRadio::unlock(void)
+{
+    mutex.unlock();
+}
+
+/**
+ * Initializes radio module
+ */
+void SX1272_LoRaRadio::init_radio(radio_events_t *events)
+{
+    _radio_events = events;
+
+    // Reset the radio transceiver
+    radio_reset();
+
+    // Setup radio variant type
+    set_sx1272_variant_type();
+
+    // setup SPI frequency
+    // default is 8MHz although, configurable through
+    // SPI_FREQUENCY macro
+    setup_spi();
+
+    // set radio mode to sleep
+    set_operation_mode(RF_OPMODE_SLEEP);
+
+    // Setup radio registers to defaults
+    setup_registers();
+
+    // set modem type - defaults to FSK here
+    set_modem(MODEM_FSK);
+
+    // set state to be idle
+    _rf_settings.state = RF_IDLE;
+
+    // Setup interrupts on DIO pins
+    setup_interrupts();
+}
+
+/**
+ * TODO: The purpose of this API is unclear.
+ *       Need to start an internal discussion.
+ */
+bool SX1272_LoRaRadio::check_rf_frequency(uint32_t frequency)
+{
+    // Implement check. Currently all frequencies are supported ? What band ?
+    return true;
+}
+
+/**
+ * Sets up carrier frequency
+ */
+void SX1272_LoRaRadio::set_channel(uint32_t freq)
+{
+    _rf_settings.channel = freq;
+    freq = (uint32_t) ((double) freq / (double) FREQ_STEP);
+    write_to_register(REG_FRFMSB, (uint8_t) ((freq >> 16) & 0xFF));
+    write_to_register(REG_FRFMID, (uint8_t) ((freq >> 8) & 0xFF));
+    write_to_register(REG_FRFLSB, (uint8_t) (freq & 0xFF));
+}
+
+/**
+ * Returns current status of the radio state machine
+ */
+uint8_t SX1272_LoRaRadio::get_status(void)
+{
+    return _rf_settings.state;
+}
+
+/**
+ * sets the radio module to sleep
+ */
+
+void SX1272_LoRaRadio::sleep()
+{
+    // stop timers
+    tx_timeout_timer.detach();
+    rx_timeout_timer.detach();
+
+    // put module in sleep mode
+    set_operation_mode(RF_OPMODE_SLEEP);
+}
+
+/**
+ * Sets up operation mode
+ */
+void SX1272_LoRaRadio::set_operation_mode(uint8_t mode)
+{
+    if (mode == RF_OPMODE_SLEEP) {
+        set_low_power_mode(true);
+    } else {
+        set_low_power_mode(false);
+        set_antenna_switch(mode);
+    }
+
+    write_to_register(REG_OPMODE, (read_register(REG_OPMODE) & RF_OPMODE_MASK) | mode);
+}
+
+/**
+ * Sets the modem type to use
+ *
+ * At initialization FSK is chosen. Later stack or application
+ * can choose to change.
+ */
+void SX1272_LoRaRadio::set_modem(uint8_t modem )
+{
+    if ((read_register(REG_OPMODE) & RFLR_OPMODE_LONGRANGEMODE_ON) != 0 ) {
+        _rf_settings.modem = MODEM_LORA;
+    } else {
+        _rf_settings.modem = MODEM_FSK;
+    }
+
+    if(_rf_settings.modem == modem ) {
+        // if the modem is already set
+        return;
+    }
+
+    _rf_settings.modem = modem;
+
+    switch(_rf_settings.modem)
+    {
+    default:
+    case MODEM_FSK:
+        // before changing modem mode, put the module to sleep
+        sleep();
+        write_to_register(REG_OPMODE, (read_register(REG_OPMODE) & RFLR_OPMODE_LONGRANGEMODE_MASK)
+                                      | RFLR_OPMODE_LONGRANGEMODE_OFF);
+
+        // Datasheet Tables 28, 29 DIO mapping
+        write_to_register(REG_DIOMAPPING1, 0x00); // sets DIO0-DI03 in default mode
+        write_to_register(REG_DIOMAPPING2, 0x30); // bits 4-5 are turned on i.e.,
+                                                  //  DIO5 and DIO4=ModeReady
+        break;
+    case MODEM_LORA:
+        sleep();
+        write_to_register(REG_OPMODE, (read_register(REG_OPMODE) & RFLR_OPMODE_LONGRANGEMODE_MASK)
+                                      | RFLR_OPMODE_LONGRANGEMODE_ON);
+
+        // Datasheet Tables 17 DIO mapping for LoRa
+        // set to defaults
+        write_to_register(REG_DIOMAPPING1, 0x00); // DIO0 - DIO3 defaults
+        write_to_register(REG_DIOMAPPING2, 0x00); // DIO4 - DIO5 defaults
+
+        break;
+    }
+}
+
+/**
+ * Can be used by application/stack or the driver itself
+ * Ref: Datasheet 7.2.2 Manual Reset
+ */
+void SX1272_LoRaRadio::radio_reset()
+{
+    _reset_ctl.output();
+    _reset_ctl = 0;
+    wait_ms(2);
+    _reset_ctl.input();
+    wait_ms(6);
+}
+
+/**
+ * Sets up receiver related configurations
+ *
+ * Must be called before setting the radio in rx mode
+ */
+void SX1272_LoRaRadio::set_rx_config(radio_modems_t modem, uint32_t bandwidth,
+                         uint32_t datarate, uint8_t coderate,
+                         uint32_t bandwidth_afc, uint16_t preamble_len,
+                         uint16_t symb_timeout, bool fix_len,
+                         uint8_t payload_len,
+                         bool crc_on, bool freq_hop_on, uint8_t hop_period,
+                         bool iq_inverted, bool rx_continuous)
+{
+    set_modem(modem);
+
+    switch (modem) {
+        case MODEM_FSK:
+            _rf_settings.fsk.bandwidth = bandwidth;
+            _rf_settings.fsk.datarate = datarate;
+            _rf_settings.fsk.bandwidth_afc = bandwidth_afc;
+            _rf_settings.fsk.fix_len = fix_len;
+            _rf_settings.fsk.payload_len = payload_len;
+            _rf_settings.fsk.crc_on = crc_on;
+            _rf_settings.fsk.iq_inverted = iq_inverted;
+            _rf_settings.fsk.rx_continuous = rx_continuous;
+            _rf_settings.fsk.preamble_len = preamble_len;
+            _rf_settings.fsk.rx_single_timeout =
+                    symb_timeout * ((1.0 / (double) datarate) * 8.0) * 1e3;
+
+            datarate = (uint16_t) ((double) XTAL_FREQ / (double) datarate);
+            write_to_register(REG_BITRATEMSB, (uint8_t) (datarate >> 8));
+            write_to_register(REG_BITRATELSB, (uint8_t) (datarate & 0xFF));
+
+            write_to_register(REG_RXBW, get_fsk_bw_reg_val(bandwidth));
+            write_to_register(REG_AFCBW, get_fsk_bw_reg_val(bandwidth_afc));
+
+            write_to_register(REG_PREAMBLEMSB, (uint8_t) ((preamble_len >> 8) & 0xFF));
+            write_to_register(REG_PREAMBLELSB, (uint8_t) (preamble_len & 0xFF));
+
+            if (fix_len == 1) {
+                write_to_register(REG_PAYLOADLENGTH, payload_len);
+            } else {
+                write_to_register(REG_PAYLOADLENGTH, 0xFF); // Set payload length to the maximum
+            }
+
+            write_to_register(REG_PACKETCONFIG1, (read_register(REG_PACKETCONFIG1) & RF_PACKETCONFIG1_CRC_MASK
+                          & RF_PACKETCONFIG1_PACKETFORMAT_MASK)
+                          | ((fix_len == 1) ?
+                                  RF_PACKETCONFIG1_PACKETFORMAT_FIXED :
+                                  RF_PACKETCONFIG1_PACKETFORMAT_VARIABLE)
+                          | (crc_on << 4));
+
+            // TODO why packet mode 2 ?
+            write_to_register(REG_PACKETCONFIG2, (read_register(REG_PACKETCONFIG2) | RF_PACKETCONFIG2_DATAMODE_PACKET));
+
+            break;
+
+        case MODEM_LORA:
+            _rf_settings.lora.bandwidth = bandwidth;
+            _rf_settings.lora.datarate = datarate;
+            _rf_settings.lora.coderate = coderate;
+            _rf_settings.lora.preamble_len = preamble_len;
+            _rf_settings.lora.fix_len = fix_len;
+            _rf_settings.lora.payload_len = payload_len;
+            _rf_settings.lora.crc_on = crc_on;
+            _rf_settings.lora.freq_hop_on = freq_hop_on;
+            _rf_settings.lora.hop_period = hop_period;
+            _rf_settings.lora.iq_inverted = iq_inverted;
+            _rf_settings.lora.rx_continuous = rx_continuous;
+
+            if (datarate > 12) {
+                datarate = 12;
+            } else if (datarate < 6) {
+                datarate = 6;
+            }
+
+            if (((bandwidth == 0) && ((datarate == 11) || (datarate == 12)))
+                    || ((bandwidth == 1) && (datarate == 12))) {
+                _rf_settings.lora.low_datarate_optimize = 0x01;
+            } else {
+                _rf_settings.lora.low_datarate_optimize = 0x00;
+            }
+
+            write_to_register(REG_LR_MODEMCONFIG1, (read_register(REG_LR_MODEMCONFIG1) & RFLR_MODEMCONFIG1_BW_MASK
+                          & RFLR_MODEMCONFIG1_CODINGRATE_MASK
+                          & RFLR_MODEMCONFIG1_IMPLICITHEADER_MASK
+                          & RFLR_MODEMCONFIG1_RXPAYLOADCRC_MASK & RFLR_MODEMCONFIG1_LOWDATARATEOPTIMIZE_MASK)
+                          | (bandwidth << 6)
+                          | (coderate << 3) | (fix_len << 2) | (crc_on << 1)
+                          | _rf_settings.lora.low_datarate_optimize);
+
+            write_to_register(REG_LR_MODEMCONFIG2, (read_register(REG_LR_MODEMCONFIG2) & RFLR_MODEMCONFIG2_SF_MASK
+                          & RFLR_MODEMCONFIG2_SYMBTIMEOUTMSB_MASK)
+                          | (datarate << 4)
+                          | ((symb_timeout >> 8)
+                          & ~RFLR_MODEMCONFIG2_SYMBTIMEOUTMSB_MASK));
+
+            write_to_register(REG_LR_SYMBTIMEOUTLSB, (uint8_t) (symb_timeout & 0xFF));
+
+            write_to_register(REG_LR_PREAMBLEMSB, (uint8_t) ((preamble_len >> 8) & 0xFF));
+            write_to_register(REG_LR_PREAMBLELSB, (uint8_t) (preamble_len & 0xFF));
+
+            if (fix_len == 1) {
+                write_to_register(REG_LR_PAYLOADLENGTH, payload_len);
+            }
+
+            if (_rf_settings.lora.freq_hop_on == true) {
+                write_to_register( REG_LR_PLLHOP, (read_register(REG_LR_PLLHOP) & RFLR_PLLHOP_FASTHOP_MASK)
+                          | RFLR_PLLHOP_FASTHOP_ON);
+                write_to_register( REG_LR_HOPPERIOD, _rf_settings.lora.hop_period);
+            }
+
+            if (datarate == 6) {
+                write_to_register( REG_LR_DETECTOPTIMIZE, (read_register(REG_LR_DETECTOPTIMIZE) & RFLR_DETECTIONOPTIMIZE_MASK)
+                              | RFLR_DETECTIONOPTIMIZE_SF6);
+                write_to_register( REG_LR_DETECTIONTHRESHOLD, RFLR_DETECTIONTHRESH_SF6);
+            } else {
+                write_to_register(REG_LR_DETECTOPTIMIZE, (read_register(REG_LR_DETECTOPTIMIZE) & RFLR_DETECTIONOPTIMIZE_MASK)
+                              | RFLR_DETECTIONOPTIMIZE_SF7_TO_SF12);
+                write_to_register( REG_LR_DETECTIONTHRESHOLD, RFLR_DETECTIONTHRESH_SF7_TO_SF12);
+            }
+
+            break;
+
+        default:
+            break;
+    }
+}
+
+/**
+ * Sets up transmitter related configuration
+ *
+ * Must be called before putting the radio module in Tx mode or trying
+ * to send
+ */
+void SX1272_LoRaRadio::set_tx_config(radio_modems_t modem, int8_t power,
+                                     uint32_t fdev, uint32_t bandwidth,
+                                     uint32_t datarate, uint8_t coderate,
+                                     uint16_t preamble_len, bool fix_len,
+                                     bool crc_on, bool freq_hop_on,
+                                     uint8_t hop_period, bool iq_inverted,
+                                     uint32_t timeout)
+{
+    set_modem(modem);
+    set_rf_tx_power(power);
+
+    switch (modem) {
+        case MODEM_FSK:
+            _rf_settings.fsk.power = power;
+            _rf_settings.fsk.f_dev = fdev;
+            _rf_settings.fsk.bandwidth = bandwidth;
+            _rf_settings.fsk.datarate = datarate;
+            _rf_settings.fsk.preamble_len = preamble_len;
+            _rf_settings.fsk.fix_len = fix_len;
+            _rf_settings.fsk.crc_on = crc_on;
+            _rf_settings.fsk.iq_inverted = iq_inverted;
+            _rf_settings.fsk.tx_timeout = timeout;
+
+            fdev = (uint16_t) ((double) fdev / (double) FREQ_STEP);
+            write_to_register( REG_FDEVMSB, (uint8_t) (fdev >> 8));
+            write_to_register( REG_FDEVLSB, (uint8_t) (fdev & 0xFF));
+
+            datarate = (uint16_t) ((double) XTAL_FREQ / (double) datarate);
+            write_to_register( REG_BITRATEMSB, (uint8_t) (datarate >> 8));
+            write_to_register( REG_BITRATELSB, (uint8_t) (datarate & 0xFF));
+
+            write_to_register( REG_PREAMBLEMSB, (preamble_len >> 8) & 0x00FF);
+            write_to_register( REG_PREAMBLELSB, preamble_len & 0xFF);
+
+
+            write_to_register(REG_PACKETCONFIG1, (read_register(REG_PACKETCONFIG1)
+                              & RF_PACKETCONFIG1_CRC_MASK
+                              & RF_PACKETCONFIG1_PACKETFORMAT_MASK)
+                              | ((fix_len == 1) ?
+                              RF_PACKETCONFIG1_PACKETFORMAT_FIXED :
+                              RF_PACKETCONFIG1_PACKETFORMAT_VARIABLE)
+                              | (crc_on << 4));
+
+            //cfg_mode = read_register(REG_PACKETCONFIG2);
+            write_to_register(REG_PACKETCONFIG2, read_register(REG_PACKETCONFIG2)
+                             | RF_PACKETCONFIG2_DATAMODE_PACKET);
+
+            break;
+
+        case MODEM_LORA:
+            _rf_settings.lora.power = power;
+            _rf_settings.lora.bandwidth = bandwidth;
+            _rf_settings.lora.datarate = datarate;
+            _rf_settings.lora.coderate = coderate;
+            _rf_settings.lora.preamble_len = preamble_len;
+            _rf_settings.lora.fix_len = fix_len;
+            _rf_settings.lora.freq_hop_on = freq_hop_on;
+            _rf_settings.lora.hop_period = hop_period;
+            _rf_settings.lora.crc_on = crc_on;
+            _rf_settings.lora.iq_inverted = iq_inverted;
+            _rf_settings.lora.tx_timeout = timeout;
+
+            if (datarate > 12) {
+                datarate = 12;
+            } else if (datarate < 6) {
+                datarate = 6;
+            }
+            if (((bandwidth == 0) && ((datarate == 11) || (datarate == 12)))
+                    || ((bandwidth == 1) && (datarate == 12))) {
+                _rf_settings.lora.low_datarate_optimize = 0x01;
+            } else {
+                _rf_settings.lora.low_datarate_optimize = 0x00;
+            }
+
+            if (_rf_settings.lora.freq_hop_on == true) {
+                write_to_register(REG_LR_PLLHOP, (read_register(REG_LR_PLLHOP)
+                                & RFLR_PLLHOP_FASTHOP_MASK)
+                                | RFLR_PLLHOP_FASTHOP_ON);
+                write_to_register(REG_LR_HOPPERIOD, _rf_settings.lora.hop_period);
+            }
+
+            write_to_register(REG_LR_MODEMCONFIG1, (read_register(REG_LR_MODEMCONFIG1) &
+                    RFLR_MODEMCONFIG1_BW_MASK &
+                    RFLR_MODEMCONFIG1_CODINGRATE_MASK &
+                    RFLR_MODEMCONFIG1_IMPLICITHEADER_MASK &
+                    RFLR_MODEMCONFIG1_RXPAYLOADCRC_MASK &
+                    RFLR_MODEMCONFIG1_LOWDATARATEOPTIMIZE_MASK)
+                            | (bandwidth << 6) | (coderate << 3)
+                            | (fix_len << 2) | (crc_on << 1)
+                            | _rf_settings.lora.low_datarate_optimize);
+
+            write_to_register(REG_LR_MODEMCONFIG2,
+                              (read_register(REG_LR_MODEMCONFIG2) &
+                              RFLR_MODEMCONFIG2_SF_MASK) | (datarate << 4));
+
+            write_to_register( REG_LR_PREAMBLEMSB, (preamble_len >> 8) & 0x00FF);
+            write_to_register( REG_LR_PREAMBLELSB, preamble_len & 0xFF);
+
+            if (datarate == 6) {
+                write_to_register(REG_LR_DETECTOPTIMIZE,
+                                  (read_register(REG_LR_DETECTOPTIMIZE) &
+                                  RFLR_DETECTIONOPTIMIZE_MASK) |
+                                  RFLR_DETECTIONOPTIMIZE_SF6);
+                write_to_register( REG_LR_DETECTIONTHRESHOLD,
+                RFLR_DETECTIONTHRESH_SF6);
+            } else {
+                write_to_register(REG_LR_DETECTOPTIMIZE,
+                                  (read_register(REG_LR_DETECTOPTIMIZE) &
+                                                 RFLR_DETECTIONOPTIMIZE_MASK) |
+                                                 RFLR_DETECTIONOPTIMIZE_SF7_TO_SF12);
+                write_to_register(REG_LR_DETECTIONTHRESHOLD,
+                                  RFLR_DETECTIONTHRESH_SF7_TO_SF12);
+            }
+
+            break;
+    }
+}
+
+/**
+ * Calculates time on Air i.e., dwell time for a single packet
+ *
+ * Crucial for the stack in order to calculate dwell time so as to control
+ * duty cycling.
+ */
+uint32_t SX1272_LoRaRadio::time_on_air(radio_modems_t modem, uint8_t pkt_len)
+{
+    uint32_t airtime = 0;
+
+    switch (modem) {
+        case MODEM_FSK: {
+            airtime = rint((8 * (_rf_settings.fsk.preamble_len
+                                    + ((read_register( REG_SYNCCONFIG)
+                                            & ~RF_SYNCCONFIG_SYNCSIZE_MASK) + 1)
+                                    + ((_rf_settings.fsk.fix_len == 0x01) ?
+                                            0.0 : 1.0)
+                                    + (((read_register( REG_PACKETCONFIG1)
+                                            & ~RF_PACKETCONFIG1_ADDRSFILTERING_MASK)
+                                            != 0x00) ? 1.0 : 0) + pkt_len
+                                    + ((_rf_settings.fsk.crc_on == 0x01) ?
+                                            2.0 : 0))
+                            / _rf_settings.fsk.datarate) * 1e3);
+        }
+            break;
+        case MODEM_LORA: {
+            double bw = 0.0;
+            switch (_rf_settings.lora.bandwidth) {
+                case 0: // 125 kHz
+                    bw = 125e3;
+                    break;
+                case 1: // 250 kHz
+                    bw = 250e3;
+                    break;
+                case 2: // 500 kHz
+                    bw = 500e3;
+                    break;
+            }
+
+            // Symbol rate : time for one symbol (secs)
+            double rs = bw / (1 << _rf_settings.lora.datarate);
+            double ts = 1 / rs;
+            // time of preamble
+            double preamble_time = (_rf_settings.lora.preamble_len + 4.25) * ts;
+            // Symbol length of payload and time
+            double tmp = ceil((8 * pkt_len - 4 * _rf_settings.lora.datarate + 28
+                            + 16 * _rf_settings.lora.crc_on -
+                            (_rf_settings.lora.fix_len ? 20 : 0))
+                            / (double) (4 * (_rf_settings.lora.datarate -
+                                       ((_rf_settings.lora.low_datarate_optimize
+                                                    > 0) ? 2 : 0)))) *
+                                                    (_rf_settings.lora.coderate + 4);
+            double n_payload = 8 + ((tmp > 0) ? tmp : 0);
+            double t_payload = n_payload * ts;
+            // Time on air
+            double t_onair = preamble_time + t_payload;
+            // return ms secs
+            airtime = floor(t_onair * 1e3 + 0.999);
+        }
+            break;
+    }
+    return airtime;
+}
+
+/**
+ * Prepares and sends the radio packet out in the air
+ */
+void SX1272_LoRaRadio::send(uint8_t *buffer, uint8_t size)
+{
+    uint32_t tx_timeout = 0;
+
+    switch (_rf_settings.modem) {
+        case MODEM_FSK:
+
+            _rf_settings.fsk_packet_handler.nb_bytes = 0;
+            _rf_settings.fsk_packet_handler.size = size;
+
+            // FIFO operations can not take place in Sleep mode
+            if ((read_register(REG_OPMODE) & ~RF_OPMODE_MASK) == RF_OPMODE_SLEEP) {
+                standby();
+                wait_ms(1);
+            }
+
+            if (_rf_settings.fsk.fix_len == false) {
+                write_fifo((uint8_t *) &size, 1);
+            } else {
+                write_to_register(REG_PAYLOADLENGTH, size);
+            }
+
+            if ((size > 0) && (size <= 64)) {
+                _rf_settings.fsk_packet_handler.chunk_size = size;
+            } else {
+                memcpy(_data_buffer, buffer, size);
+                _rf_settings.fsk_packet_handler.chunk_size = 32;
+            }
+
+            // write payload buffer
+            write_fifo(buffer, _rf_settings.fsk_packet_handler.chunk_size);
+            _rf_settings.fsk_packet_handler.nb_bytes +=
+                    _rf_settings.fsk_packet_handler.chunk_size;
+            tx_timeout = _rf_settings.fsk.tx_timeout;
+
+            break;
+        case MODEM_LORA:
+            if (_rf_settings.lora.iq_inverted == true) {
+                write_to_register(REG_LR_INVERTIQ, ((read_register(REG_LR_INVERTIQ) &
+                                  RFLR_INVERTIQ_TX_MASK &
+                                  RFLR_INVERTIQ_RX_MASK) |
+                                  RFLR_INVERTIQ_RX_OFF | RFLR_INVERTIQ_TX_ON));
+                write_to_register(REG_LR_INVERTIQ2, RFLR_INVERTIQ2_ON);
+            } else {
+                write_to_register(REG_LR_INVERTIQ, ((read_register(REG_LR_INVERTIQ) &
+                                  RFLR_INVERTIQ_TX_MASK &
+                                  RFLR_INVERTIQ_RX_MASK) |
+                                  RFLR_INVERTIQ_RX_OFF | RFLR_INVERTIQ_TX_OFF));
+                write_to_register( REG_LR_INVERTIQ2, RFLR_INVERTIQ2_OFF);
+            }
+
+            _rf_settings.lora_packet_handler.size = size;
+
+            // Initializes the payload size
+            write_to_register(REG_LR_PAYLOADLENGTH, size);
+
+            // Full buffer used for Tx
+            write_to_register(REG_LR_FIFOTXBASEADDR, 0);
+            write_to_register(REG_LR_FIFOADDRPTR, 0);
+
+            // FIFO operations can not take place in Sleep mode
+            if ((read_register(REG_OPMODE) & ~RF_OPMODE_MASK) == RF_OPMODE_SLEEP) {
+                standby();
+                wait_ms(1);
+            }
+            // write payload buffer
+            write_fifo(buffer, size);
+            tx_timeout = _rf_settings.lora.tx_timeout;
+
+            break;
+    }
+
+    // transmit
+    transmit(tx_timeout);
+}
+
+/**
+ * Actual TX - Transmit routine
+ *
+ * A DIO0 interrupt let the state machine know that a a packet is
+ * successfully sent, otherwise a TxTimeout is invoked.
+ * TxTimeout should never happen in normal circumstances as the radio should
+ * be able to send a packet out in the air no matter what.
+ */
+void SX1272_LoRaRadio::transmit(uint32_t timeout)
+{
+    switch (_rf_settings.modem) {
+
+        case MODEM_FSK:
+            // DIO0=PacketSent
+            // DIO1=FifoEmpty
+            // DIO2=FifoFull
+            // DIO3=FifoEmpty
+            // DIO4=LowBat
+            // DIO5=ModeReady
+            write_to_register(REG_DIOMAPPING1,(read_register(REG_DIOMAPPING1) &
+                              RF_DIOMAPPING1_DIO0_MASK &
+                              RF_DIOMAPPING1_DIO1_MASK &
+                              RF_DIOMAPPING1_DIO2_MASK) |
+                              RF_DIOMAPPING1_DIO1_01);
+
+            write_to_register(REG_DIOMAPPING2, (read_register(REG_DIOMAPPING2) &
+                              RF_DIOMAPPING2_DIO4_MASK &
+                              RF_DIOMAPPING2_MAP_MASK));
+            _rf_settings.fsk_packet_handler.fifo_thresh =
+                              read_register(REG_FIFOTHRESH) & 0x3F;
+
+            break;
+
+        case MODEM_LORA:
+
+            if (_rf_settings.lora.freq_hop_on == true) {
+                write_to_register(REG_LR_IRQFLAGSMASK,
+                                  RFLR_IRQFLAGS_RXTIMEOUT |
+                                  RFLR_IRQFLAGS_RXDONE |
+                                  RFLR_IRQFLAGS_PAYLOADCRCERROR |
+                                  RFLR_IRQFLAGS_VALIDHEADER |
+                                  RFLR_IRQFLAGS_CADDONE |
+                                  RFLR_IRQFLAGS_CADDETECTED);
+
+                // DIO0=tx_done, DIO2=fhss_change_channel
+
+                write_to_register(REG_DIOMAPPING1, (read_register(REG_DIOMAPPING1) &
+                                  RFLR_DIOMAPPING1_DIO0_MASK &
+                                  RFLR_DIOMAPPING1_DIO2_MASK) |
+                                  RFLR_DIOMAPPING1_DIO0_01 |
+                                  RFLR_DIOMAPPING1_DIO2_00);
+            } else {
+                write_to_register(REG_LR_IRQFLAGSMASK,
+                                  RFLR_IRQFLAGS_RXTIMEOUT |
+                                  RFLR_IRQFLAGS_RXDONE |
+                                  RFLR_IRQFLAGS_PAYLOADCRCERROR |
+                                  RFLR_IRQFLAGS_VALIDHEADER |
+                                  RFLR_IRQFLAGS_CADDONE |
+                                  RFLR_IRQFLAGS_FHSSCHANGEDCHANNEL |
+                                  RFLR_IRQFLAGS_CADDETECTED);
+
+                // DIO0=tx_done
+                write_to_register(REG_DIOMAPPING1,(read_register(REG_DIOMAPPING1) &
+                                  RFLR_DIOMAPPING1_DIO0_MASK) |
+                                  RFLR_DIOMAPPING1_DIO0_01);
+            }
+
+            break;
+    }
+
+    _rf_settings.state = RF_TX_RUNNING;
+    tx_timeout_timer.attach_us(callback(this, &SX1272_LoRaRadio::timeout_irq_isr), timeout*1e3);
+    set_operation_mode(RF_OPMODE_TRANSMITTER);
+}
+
+/**
+ * Sets the radio module in receive mode
+ *
+ * A DIO4 interrupt let's the state machine know that a preamble is detected
+ * and finally a DIO0 interrupt let's the state machine know that a packet is
+ * ready to be read from the FIFO
+ */
+void SX1272_LoRaRadio::receive(uint32_t timeout)
+{
+    switch (_rf_settings.modem) {
+        case MODEM_FSK:
+            if (timeout == 0 && _rf_settings.fsk.rx_continuous == false) {
+                // user messed up probably timeout was 0 but mode was not
+                // continuous, force it to be continuous
+                _rf_settings.fsk.rx_continuous = true;
+            }
+
+            // DIO0=PayloadReady
+            // DIO1=FifoLevel
+            // DIO2=SyncAddr
+            // DIO3=FifoEmpty
+            // DIO4=Preamble
+            // DIO5=ModeReady
+            write_to_register(REG_DIOMAPPING1, (read_register(REG_DIOMAPPING1) &
+                              RF_DIOMAPPING1_DIO0_MASK &
+                              RF_DIOMAPPING1_DIO1_MASK &
+                              RF_DIOMAPPING1_DIO2_MASK) |
+                              RF_DIOMAPPING1_DIO0_00 |
+                              RF_DIOMAPPING1_DIO1_00 |
+                              RF_DIOMAPPING1_DIO2_11);
+
+            write_to_register(REG_DIOMAPPING2, (read_register(REG_DIOMAPPING2) &
+                              RF_DIOMAPPING2_DIO4_MASK &
+                              RF_DIOMAPPING2_MAP_MASK) |
+                              RF_DIOMAPPING2_DIO4_11 |
+                              RF_DIOMAPPING2_MAP_PREAMBLEDETECT);
+
+            _rf_settings.fsk_packet_handler.fifo_thresh =
+                              read_register(REG_FIFOTHRESH) & 0x3F;
+
+            write_to_register(REG_RXCONFIG, RF_RXCONFIG_AFCAUTO_ON |
+                              RF_RXCONFIG_AGCAUTO_ON |
+                              RF_RXCONFIG_RXTRIGER_PREAMBLEDETECT);
+
+            _rf_settings.fsk_packet_handler.preamble_detected = 0;
+            _rf_settings.fsk_packet_handler.sync_word_detected = 0;
+            _rf_settings.fsk_packet_handler.nb_bytes = 0;
+            _rf_settings.fsk_packet_handler.size = 0;
+
+            break;
+
+        case MODEM_LORA:
+            if (timeout == 0 && _rf_settings.lora.rx_continuous == false) {
+                // user messed up probably timeout was 0 but mode was not
+                // continuous, force it to be continuous
+                _rf_settings.lora.rx_continuous = true;
+            }
+
+            if (_rf_settings.lora.iq_inverted == true) {
+                write_to_register(REG_LR_INVERTIQ, ((read_register(REG_LR_INVERTIQ) &
+                                  RFLR_INVERTIQ_TX_MASK &
+                                  RFLR_INVERTIQ_RX_MASK) |
+                                  RFLR_INVERTIQ_RX_ON |
+                                  RFLR_INVERTIQ_TX_OFF));
+                write_to_register(REG_LR_INVERTIQ2, RFLR_INVERTIQ2_ON);
+            } else {
+                write_to_register(REG_LR_INVERTIQ, ((read_register(REG_LR_INVERTIQ) &
+                                  RFLR_INVERTIQ_TX_MASK &
+                                  RFLR_INVERTIQ_RX_MASK) |
+                                  RFLR_INVERTIQ_RX_OFF |
+                                  RFLR_INVERTIQ_TX_OFF));
+                write_to_register( REG_LR_INVERTIQ2, RFLR_INVERTIQ2_OFF);
+            }
+
+            if (_rf_settings.lora.freq_hop_on == true) {
+                write_to_register(REG_LR_IRQFLAGSMASK,
+                                  RFLR_IRQFLAGS_VALIDHEADER |
+                                  RFLR_IRQFLAGS_TXDONE |
+                                  RFLR_IRQFLAGS_CADDONE |
+                                  RFLR_IRQFLAGS_CADDETECTED);
+
+                // DIO0=rx_done, DIO2=fhss_change_channel
+                write_to_register(REG_DIOMAPPING1, (read_register(REG_DIOMAPPING1) &
+                                  RFLR_DIOMAPPING1_DIO0_MASK &
+                                  RFLR_DIOMAPPING1_DIO2_MASK) |
+                                  RFLR_DIOMAPPING1_DIO0_00 |
+                                  RFLR_DIOMAPPING1_DIO2_00);
+            } else {
+                write_to_register(REG_LR_IRQFLAGSMASK,
+                                  RFLR_IRQFLAGS_VALIDHEADER |
+                                  RFLR_IRQFLAGS_TXDONE |
+                                  RFLR_IRQFLAGS_CADDONE |
+                                  RFLR_IRQFLAGS_FHSSCHANGEDCHANNEL |
+                                  RFLR_IRQFLAGS_CADDETECTED);
+
+                // DIO0=rx_done
+                write_to_register(REG_DIOMAPPING1, (read_register(REG_DIOMAPPING1) &
+                                  RFLR_DIOMAPPING1_DIO0_MASK) |
+                                  RFLR_DIOMAPPING1_DIO0_00);
+            }
+
+            write_to_register(REG_LR_FIFORXBASEADDR, 0);
+            write_to_register(REG_LR_FIFOADDRPTR, 0);
+
+            break;
+    }
+
+    memset(_data_buffer, 0, (size_t) MAX_DATA_BUFFER_SIZE_SX172);
+
+    _rf_settings.state = RF_RX_RUNNING;
+
+    if (timeout != 0) {
+        rx_timeout_timer.attach_us(callback(this,
+                                            &SX1272_LoRaRadio::timeout_irq_isr),
+                                            timeout*1e3);
+    }
+
+    if (_rf_settings.modem == MODEM_FSK) {
+        set_operation_mode(RF_OPMODE_RECEIVER);
+
+        if (_rf_settings.fsk.rx_continuous == false) {
+            rx_timeout_sync_word.attach_us(callback(this,
+                                     &SX1272_LoRaRadio::timeout_irq_isr),
+                                     _rf_settings.fsk.rx_single_timeout * 1e3);
+        }
+
+        return;
+    }
+
+    // If mode is LoRa set mode
+    if (_rf_settings.lora.rx_continuous == true) {
+        set_operation_mode(RFLR_OPMODE_RECEIVER);
+    } else {
+        set_operation_mode(RFLR_OPMODE_RECEIVER_SINGLE);
+    }
+}
+
+/**
+ * Puts a limit on the size of payload the module can handle
+ * By default it is MAX, i.e., 256 bytes
+ */
+void SX1272_LoRaRadio::set_max_payload_length(radio_modems_t modem, uint8_t max)
+{
+    set_modem(modem);
+
+    switch (modem) {
+        case MODEM_FSK:
+            if (_rf_settings.fsk.fix_len == false) {
+                write_to_register(REG_PAYLOADLENGTH, max);
+            }
+            break;
+        case MODEM_LORA:
+            write_to_register(REG_LR_PAYLOADMAXLENGTH, max);
+            break;
+    }
+}
+
+/**
+ * TODO: Making sure if this API is valid only for LoRa modulation ?
+ *
+ * Indicates if the node is part of a private or public network
+ */
+void SX1272_LoRaRadio::set_public_network(bool enable)
+{
+    set_modem(MODEM_LORA);
+
+    _rf_settings.lora.public_network = enable;
+    if (enable == true) {
+        // Change lora modem SyncWord
+        write_to_register(REG_LR_SYNCWORD, LORA_MAC_PUBLIC_SYNCWORD);
+    } else {
+        // Change lora modem SyncWord
+        write_to_register(REG_LR_SYNCWORD, LORA_MAC_PRIVATE_SYNCWORD);
+    }
+
+}
+
+/**
+ * Perform carrier sensing
+ *
+ * Checks for a certain time if the RSSI is above a given threshold.
+ * This threshold determines if there is already a transmission going on
+ * in the channel or not.
+ *
+ */
+bool SX1272_LoRaRadio::perform_carrier_sense(radio_modems_t modem,
+                                   uint32_t freq,
+                                   int16_t rssi_threshold,
+                                   uint32_t max_carrier_sense_time)
+{
+    bool status = true;
+    int16_t rssi = 0;
+
+    set_modem(modem);
+    set_channel(freq);
+    set_operation_mode(RF_OPMODE_RECEIVER);
+
+    // hold on a bit, radio turn-around time
+    wait_ms(1);
+
+    Timer elapsed_time;
+    elapsed_time.start();
+
+    // Perform carrier sense for maxCarrierSenseTime
+    while (elapsed_time.read_ms() < (int)max_carrier_sense_time) {
+        rssi = get_rssi(modem);
+
+        if (rssi > rssi_threshold) {
+            status = false;
+            break;
+        }
+    }
+
+    sleep();
+    return status;
+}
+
+/**
+ * Channel Activity detection (can be done only in LoRa mode)
+ *
+ * If any activity on the channel is detected, an interrupt is asserted on
+ * DIO3. A callback will be generated to the stack/application upon the
+ * assertion of DIO3.
+ */
+void SX1272_LoRaRadio::start_cad()
+{
+    uint8_t reg_val;
+
+    switch (_rf_settings.modem) {
+        case MODEM_FSK:
+            break;
+        case MODEM_LORA:
+            write_to_register(REG_LR_IRQFLAGSMASK,
+                              RFLR_IRQFLAGS_RXTIMEOUT |
+                              RFLR_IRQFLAGS_RXDONE |
+                              RFLR_IRQFLAGS_PAYLOADCRCERROR |
+                              RFLR_IRQFLAGS_VALIDHEADER |
+                              RFLR_IRQFLAGS_TXDONE |
+                              RFLR_IRQFLAGS_FHSSCHANGEDCHANNEL);
+
+            // DIO3=CADDone
+            reg_val = read_register(REG_DIOMAPPING1);
+            write_to_register(REG_DIOMAPPING1, (reg_val &
+                              RFLR_DIOMAPPING1_DIO3_MASK) |
+                              RFLR_DIOMAPPING1_DIO3_00);
+
+            set_operation_mode(RFLR_OPMODE_CAD);
+
+            _rf_settings.state = RF_CAD;
+
+            break;
+        default:
+            break;
+    }
+}
+
+/**
+ * Set transmission in continuous wave mode
+ */
+void SX1272_LoRaRadio::set_tx_continuous_wave(uint32_t freq, int8_t power,
+                                              uint16_t time)
+{
+    uint8_t reg_val;
+
+    set_channel(freq);
+    set_tx_config(MODEM_FSK, power, 0, 0, 4800, 0, 5, false, false, 0, 0, 0, time);
+    reg_val = read_register(REG_PACKETCONFIG2);
+
+    write_to_register( REG_PACKETCONFIG2, (reg_val & RF_PACKETCONFIG2_DATAMODE_MASK ) );
+    // Disable radio interrupts
+    write_to_register( REG_DIOMAPPING1, RF_DIOMAPPING1_DIO0_11 | RF_DIOMAPPING1_DIO1_11 );
+    write_to_register( REG_DIOMAPPING2, RF_DIOMAPPING2_DIO4_10 | RF_DIOMAPPING2_DIO5_10 );
+
+    _rf_settings.state = RF_TX_RUNNING;
+    tx_timeout_timer.attach_us(callback(this, &SX1272_LoRaRadio::timeout_irq_isr), time*1e3);
+    set_operation_mode(RF_OPMODE_TRANSMITTER);
+}
+
+/**
+ * Put radio in Standby mode
+ */
+void SX1272_LoRaRadio::standby( void )
+{
+    tx_timeout_timer.detach();
+    rx_timeout_timer.detach();
+
+    set_operation_mode(RF_OPMODE_STANDBY);
+    _rf_settings.state = RF_IDLE;
+}
+
+/**
+ * Generates 32 bit random number based upon RSSI monitoring
+ * Used for various calculation by the stack for example dev nonce
+ *
+ * When this API is used modem is set in LoRa mode and all interrupts are
+ * masked. If the user had been using FSK mode, it should be noted that a
+ * change of mode is required again because the registers have changed.
+ * In addition to that RX and TX configuration APIs should be called again in
+ * order to have correct desires setup.
+ */
+uint32_t SX1272_LoRaRadio::random()
+{
+    uint8_t i;
+    uint32_t rnd = 0;
+
+    // Set LoRa modem ON
+    set_modem(MODEM_LORA);
+
+    // Disable LoRa modem interrupts, i.e., mask all interrupts
+    write_to_register(REG_LR_IRQFLAGSMASK, RFLR_IRQFLAGS_RXTIMEOUT | RFLR_IRQFLAGS_RXDONE
+                      | RFLR_IRQFLAGS_PAYLOADCRCERROR | RFLR_IRQFLAGS_VALIDHEADER
+                      | RFLR_IRQFLAGS_TXDONE | RFLR_IRQFLAGS_CADDONE
+                      | RFLR_IRQFLAGS_FHSSCHANGEDCHANNEL | RFLR_IRQFLAGS_CADDETECTED);
+
+    // Set radio in continuous reception
+    set_operation_mode(RF_OPMODE_RECEIVER);
+
+    for (i = 0; i < 32; i++) {
+        wait_ms(1);
+        // Unfiltered RSSI value reading. Only takes the LSB value
+        rnd |= ((uint32_t) read_register(REG_LR_RSSIWIDEBAND) & 0x01) << i;
+    }
+
+    sleep();
+
+    return rnd;
+}
+
+
+/*****************************************************************************
+ * Private APIs                                                              *
+ ****************************************************************************/
+#ifdef MBED_CONF_RTOS_PRESENT
+/**
+ * Thread task handling IRQs
+ */
+void SX1272_LoRaRadio::rf_irq_task(void)
+{
+    for (;;) {
+        osEvent event = irq_thread.signal_wait(0, osWaitForever);
+        if (event.status != osEventSignal) {
+            continue;
+        }
+
+        lock();
+        if (event.value.signals & SIG_DIO0) {
+            handle_dio0_irq();
+        }
+        if (event.value.signals & SIG_DIO1) {
+            handle_dio1_irq();
+        }
+        if (event.value.signals & SIG_DIO2) {
+            handle_dio2_irq();
+        }
+        if (event.value.signals & SIG_DIO3) {
+            handle_dio3_irq();
+        }
+        if (event.value.signals & SIG_DIO4) {
+            handle_dio4_irq();
+        }
+        if (event.value.signals & SIG_DIO5) {
+            handle_dio5_irq();
+        }
+        if (event.value.signals & SIG_TIMOUT) {
+            handle_timeout_irq();
+        }
+        unlock();
+    }
+}
+#endif
+
+/**
+ * Writes a single byte to a given register
+ */
+void SX1272_LoRaRadio::write_to_register(uint8_t addr, uint8_t data)
+{
+    write_to_register(addr, &data, 1);
+}
+
+/**
+ * Writes multiple bytes to a given register
+ */
+void SX1272_LoRaRadio::write_to_register(uint8_t addr, uint8_t *data, uint8_t size)
+{
+    // set chip-select low
+    _chip_select = 0;
+
+    // set write command
+    _spi.write(addr | SPI_WRITE_CMD);
+
+    // write data
+    for (uint8_t i = 0; i < size; i++) {
+        _spi.write(data[i]);
+    }
+
+    // set chip-select high
+    _chip_select = 1;
+}
+
+/**
+ * Reads the value of a single register
+ */
+uint8_t SX1272_LoRaRadio::read_register(uint8_t addr)
+{
+    uint8_t data;
+    read_register(addr, &data, 1);
+    return data;
+}
+
+/**
+ * Reads multiple values from a given register
+ */
+void SX1272_LoRaRadio::read_register(uint8_t addr, uint8_t *buffer, uint8_t size)
+{
+    // set chip-select low
+    _chip_select = 0;
+
+    // set read command
+    _spi.write(addr & SPI_READ_CMD);
+
+    // read buffers
+    for (uint8_t i = 0; i < size; i++) {
+        buffer[i] = _spi.write(0);
+    }
+
+    // set chip-select high
+    _chip_select = 1;
+}
+
+/**
+ * Writes to FIIO provided by the chip
+ */
+void SX1272_LoRaRadio::write_fifo(uint8_t *buffer, uint8_t size)
+{
+    write_to_register(0, buffer, size);
+}
+
+/**
+ * Reads from the FIFO provided by the chip
+ */
+void SX1272_LoRaRadio::read_fifo(uint8_t *buffer, uint8_t size)
+{
+    read_register(0, buffer, size);
+}
+
+/**
+ * Gets FSK bandwidth values
+ *
+ * Gives either normal bandwidths or bandwidths for
+ * AFC (auto frequency correction)
+ */
+uint8_t SX1272_LoRaRadio::get_fsk_bw_reg_val(uint32_t bandwidth)
+{
+    uint8_t i;
+
+    for (i = 0; i < (sizeof(fsk_bandwidths) / sizeof(fsk_bw_t)) - 1; i++) {
+        if ((bandwidth >= fsk_bandwidths[i].bandwidth)
+                && (bandwidth < fsk_bandwidths[i + 1].bandwidth)) {
+            return fsk_bandwidths[i].register_value;
+        }
+    }
+    // ERROR: Value not found
+    // This should never happen
+    while (1);
+}
+
+/**
+ * Sets the radio modules to default position (off)
+ *
+ * Historically they were being called as Antenna switches, so we kept the name.
+ * In essence these are control latches over duplexer which either let
+ * TX submodule or RX submodule circuitry enabled at a time.
+ */
+void SX1272_LoRaRadio::default_antenna_switch_ctrls()
+{
+    if (_rf_ctrls.pwr_amp_ctl != NC) {
+        _pwr_amp_ctl = 0;
+    }
+
+    if (_rf_ctrls.rf_switch_ctl1 != NC && _rf_ctrls.rf_switch_ctl2 != NC) {
+        _rf_switch_ctl1 = 0;
+        _rf_switch_ctl2 = 0;
+    }
+
+    if (_rf_ctrls.txctl != NC && _rf_ctrls.rxctl != NC) {
+        _txctl = 0;
+        _rxctl = 0;
+    }
+}
+
+/**
+ * Gets the power amplifier configuration register
+ */
+uint8_t SX1272_LoRaRadio::get_pa_conf_reg()
+{
+    if (radio_variant == SX1272UNDEFINED) {
+        return RF_PACONFIG_PASELECT_PABOOST;
+    } else if (radio_variant == SX1272MB1DCS) {
+        return RF_PACONFIG_PASELECT_PABOOST;
+    } else {
+        return RF_PACONFIG_PASELECT_RFO;
+    }
+}
+
+/**
+ * Get RSSI from the module
+ */
+int16_t SX1272_LoRaRadio::get_rssi(radio_modems_t modem)
+{
+    int16_t rssi = 0;
+
+    switch( modem )
+    {
+    case MODEM_FSK:
+        rssi = -(read_register(REG_RSSIVALUE) >> 1 );
+        break;
+    case MODEM_LORA:
+        rssi = RSSI_OFFSET + read_register(REG_LR_RSSIVALUE);
+        break;
+    default:
+        rssi = -1;
+        break;
+    }
+    return rssi;
+}
+
+/**
+ * Sets the transmit power for the module
+ */
+#if defined ( TARGET_MOTE_L152RC )
+static const uint8_t pa_boost_table[20] = {0, 0, 0, 0, 0, 1, 2, 3, 3, 4, 5, 6, 7, 8, 9, 10, 11, 13, 14, 15};
+static const uint8_t RFO_table[11] = {1, 1, 1, 2, 2, 3, 4, 5, 6, 8, 9};
+#endif
+
+void SX1272_LoRaRadio::set_rf_tx_power(int8_t power)
+{
+    uint8_t pa_config = 0;
+    uint8_t pa_dac = 0;
+
+    pa_config = read_register(REG_PACONFIG);
+    pa_dac = read_register(REG_PADAC);
+
+#if defined ( TARGET_MOTE_L152RC )
+    if(power > 19) {
+        pa_config = (pa_config & RF_PACONFIG_PASELECT_MASK) | RF_PACONFIG_PASELECT_RFO;
+        pa_config = (pa_config & RFLR_PACONFIG_OUTPUTPOWER_MASK) | RFO_table[power - 20];
+    }
+    else
+    {
+        pa_config = (pa_config & RF_PACONFIG_PASELECT_MASK) | RF_PACONFIG_PASELECT_PABOOST;
+        pa_config = (pa_config & RFLR_PACONFIG_OUTPUTPOWER_MASK) | pa_boost_table[power];
+    }
+#else
+    pa_config = (pa_config & RF_PACONFIG_PASELECT_MASK) | get_pa_conf_reg();
+
+    if ((pa_config & RF_PACONFIG_PASELECT_PABOOST)
+            == RF_PACONFIG_PASELECT_PABOOST) {
+        if (power > 17) {
+            pa_dac = (pa_dac & RF_PADAC_20DBM_MASK) | RF_PADAC_20DBM_ON;
+        } else {
+            pa_dac = (pa_dac & RF_PADAC_20DBM_MASK) | RF_PADAC_20DBM_OFF;
+        }
+        if ((pa_dac & RF_PADAC_20DBM_ON) == RF_PADAC_20DBM_ON) {
+            if (power < 5) {
+                power = 5;
+            }
+            if (power > 20) {
+                power = 20;
+            }
+            pa_config = (pa_config & RFLR_PACONFIG_OUTPUTPOWER_MASK)
+                    | (uint8_t) ((uint16_t) (power - 5) & 0x0F);
+        } else {
+            if (power < 2) {
+                power = 2;
+            }
+            if (power > 17) {
+                power = 17;
+            }
+            pa_config = (pa_config & RFLR_PACONFIG_OUTPUTPOWER_MASK)
+                    | (uint8_t) ((uint16_t) (power - 2) & 0x0F);
+        }
+    } else {
+        if (power < -1) {
+            power = -1;
+        }
+        if (power > 14) {
+            power = 14;
+        }
+        pa_config = (pa_config & RFLR_PACONFIG_OUTPUTPOWER_MASK)
+                | (uint8_t) ((uint16_t) (power + 1) & 0x0F);
+    }
+#endif
+    write_to_register(REG_PACONFIG, pa_config);
+    write_to_register(REG_PADAC, pa_dac);
+}
+
+/**
+ * Sets the radio registers to defaults
+ */
+void SX1272_LoRaRadio::setup_registers()
+{
+    for (unsigned int i = 0; i < sizeof(radio_reg_init) / sizeof(radio_registers_t); i++) {
+        set_modem(radio_reg_init[i].modem);
+        write_to_register(radio_reg_init[i].addr, radio_reg_init[i].value);
+    }
+}
+
+/**
+ * Set the radio module variant
+ */
+void SX1272_LoRaRadio::set_sx1272_variant_type()
+{
+    if (_rf_ctrls.ant_switch != NC){
+        _ant_switch.input();
+        wait_ms(1);
+        if (_ant_switch == 1) {
+            radio_variant = SX1272MB1DCS;
+        } else {
+            radio_variant = SX1272MB2XAS;
+        }
+        _ant_switch.output();
+        wait_ms(1);
+    } else {
+        radio_variant = SX1272UNDEFINED;
+    }
+}
+
+/**
+ * Sets up radio latch position according to the
+ * radio mode
+ */
+void SX1272_LoRaRadio::set_antenna_switch(uint8_t mode)
+{
+    // here we got to do ifdef for changing controls
+    // as some pins might be NC
+    switch (mode) {
+        case RFLR_OPMODE_TRANSMITTER:
+            if (_rf_ctrls.rf_switch_ctl1 != NC
+                && _rf_ctrls.rf_switch_ctl2 != NC) {
+                // module is in transmit mode and RF latch switches
+                // are connected. Check if power amplifier boost is
+                // setup or not
+                if ((read_register(REG_PACONFIG) & RF_PACONFIG_PASELECT_PABOOST)
+                                       == RF_PACONFIG_PASELECT_PABOOST) {
+                    _rf_switch_ctl1 = 1;
+                    _rf_switch_ctl2 = 0;
+                } else {
+                    // power amplifier not selected
+                    _rf_switch_ctl1 = 0;
+                    _rf_switch_ctl2 = 1;
+                }
+            } else if (_rf_ctrls.txctl != NC && _rf_ctrls.rxctl != NC) {
+                // module is in transmit mode and tx/rx submodule control
+                // pins are connected
+                _txctl = 1;
+                _rxctl = 0;
+            } else if (_rf_ctrls.ant_switch != NC){
+                _ant_switch = 1;
+            } else {
+                // None of the control pins are connected.
+            }
+            break;
+        case RFLR_OPMODE_RECEIVER:
+        case RFLR_OPMODE_RECEIVER_SINGLE:
+        case RFLR_OPMODE_CAD:
+            if (_rf_ctrls.rf_switch_ctl1 != NC
+                && _rf_ctrls.rf_switch_ctl2 != NC) {
+                // radio is in reception or CAD mode and RF latch switches
+                // are connected
+                _rf_switch_ctl1 = 1;
+                _rf_switch_ctl2 = 1;
+            } else if (_rf_ctrls.txctl != NC && _rf_ctrls.rxctl != NC) {
+                _txctl = 0;
+                _rxctl = 1;
+            } else if (_rf_ctrls.ant_switch != NC) {
+                _ant_switch = 0;
+            } else {
+                // None of the control pins are connected.
+            }
+            break;
+        default:
+            // Enforce default case  when any connected control pin is kept low.
+            if (_rf_ctrls.rf_switch_ctl1 != NC
+                && _rf_ctrls.rf_switch_ctl2 != NC) {
+                // radio is in reception or CAD mode and RF latch switches
+                // are connected
+                _rf_switch_ctl1 = 0;
+                _rf_switch_ctl2 = 0;
+            } else if (_rf_ctrls.txctl != NC && _rf_ctrls.rxctl != NC) {
+                _txctl = 0;
+                _rxctl = 0;
+            } else if (_rf_ctrls.ant_switch != NC) {
+                _ant_switch = 0;
+            } else {
+                // None of the control pins are connected.
+            }
+            break;
+    }
+}
+
+/**
+ * Sets up frequency for SPI module
+ * Reference DataSheet: 4.3 SPI Interface
+ */
+void SX1272_LoRaRadio::setup_spi()
+{
+    // SPI bus frequency
+    uint32_t spi_freq = SPI_FREQUENCY;
+
+    // Hold chip-select high
+    _chip_select = 1;
+    _spi.format(8, 0);
+
+#if defined (TARGET_KL25Z)
+    //bus-clock frequency is halved -> double the SPI frequency to compensate
+    _spi.frequency(spi_freq * 2);
+#else
+    // otherwise use default SPI frequency which is 8 MHz
+    _spi.frequency(spi_freq);
+#endif
+    // 100 us wait to settle down
+    wait(0.1);
+}
+
+/**
+ * Attaches ISRs to interrupt pins
+ */
+void SX1272_LoRaRadio::setup_interrupts()
+{
+    _dio0_ctl.rise(callback(this, &SX1272_LoRaRadio::dio0_irq_isr));
+    _dio1_ctl.rise(callback(this, &SX1272_LoRaRadio::dio1_irq_isr));
+    _dio2_ctl.rise(callback(this, &SX1272_LoRaRadio::dio2_irq_isr));
+    _dio3_ctl.rise(callback(this, &SX1272_LoRaRadio::dio3_irq_isr));
+    if (_dio4_pin != NC) {
+        _dio4_ctl.rise(callback(this, &SX1272_LoRaRadio::dio4_irq_isr));
+    }
+    if (_dio5_pin != NC) {
+        _dio5_ctl.rise(callback(this, &SX1272_LoRaRadio::dio5_irq_isr));
+    }
+}
+
+/**
+ * Sets the module in low power mode by disconnecting
+ * TX and RX submodules, turning off power amplifier etc.
+ */
+void SX1272_LoRaRadio::set_low_power_mode(bool status)
+{
+    if (radio_is_active != status) {
+        radio_is_active = status;
+
+        if (status == false) {
+            if (_rf_ctrls.rf_switch_ctl1 != NC) {
+                _rf_switch_ctl1 = 0;
+            }
+            if (_rf_ctrls.rf_switch_ctl2 != NC) {
+                _rf_switch_ctl2 = 0;
+            }
+
+            if (_rf_ctrls.pwr_amp_ctl != NC) {
+                _pwr_amp_ctl = 0;
+            }
+
+            if (_rf_ctrls.txctl != NC) {
+                _txctl = 0;
+            }
+
+            if (_rf_ctrls.txctl != NC) {
+                _rxctl = 0;
+            }
+
+            if (_rf_ctrls.ant_switch != NC) {
+                _ant_switch = 0;
+            }
+        } else {
+            default_antenna_switch_ctrls();
+        }
+    }
+}
+
+/*****************************************************************************
+ * Interrupt service routines (ISRs) - set signals to the irq_thread         *
+ ****************************************************************************/
+void SX1272_LoRaRadio::dio0_irq_isr()
+{
+#ifdef MBED_CONF_RTOS_PRESENT
+   irq_thread.signal_set(SIG_DIO0);
+#else
+   handle_dio0_irq();
+#endif
+}
+
+void SX1272_LoRaRadio::dio1_irq_isr()
+{
+#ifdef MBED_CONF_RTOS_PRESENT
+    irq_thread.signal_set(SIG_DIO1);
+#else
+    handle_dio1_irq();
+#endif
+}
+
+void SX1272_LoRaRadio::dio2_irq_isr()
+{
+#ifdef MBED_CONF_RTOS_PRESENT
+    irq_thread.signal_set(SIG_DIO2);
+#else
+    handle_dio2_irq();
+#endif
+}
+
+void SX1272_LoRaRadio::dio3_irq_isr()
+{
+#ifdef MBED_CONF_RTOS_PRESENT
+    irq_thread.signal_set(SIG_DIO3);
+#else
+    handle_dio3_irq();
+#endif
+}
+
+void SX1272_LoRaRadio::dio4_irq_isr()
+{
+#ifdef MBED_CONF_RTOS_PRESENT
+    irq_thread.signal_set(SIG_DIO4);
+#else
+    handle_dio4_irq();
+#endif
+}
+
+void SX1272_LoRaRadio::dio5_irq_isr()
+{
+#ifdef MBED_CONF_RTOS_PRESENT
+    irq_thread.signal_set(SIG_DIO5);
+#else
+    handle_dio5_irq();
+#endif
+}
+
+// This is not a hardware interrupt
+// we invoke it ourselves based upon
+// our timers
+void SX1272_LoRaRadio::timeout_irq_isr()
+{
+#ifdef MBED_CONF_RTOS_PRESENT
+    irq_thread.signal_set(SIG_TIMOUT);
+#else
+    handle_timeout_irq();
+#endif
+}
+
+/******************************************************************************
+ * Interrupt Handlers                                                         *
+ *****************************************************************************/
+
+void SX1272_LoRaRadio::handle_dio0_irq()
+{
+    volatile uint8_t irqFlags = 0;
+
+    switch (_rf_settings.state) {
+        case RF_RX_RUNNING:
+            switch (_rf_settings.modem) {
+                case MODEM_FSK:
+                    if (_rf_settings.fsk.crc_on == true) {
+                        irqFlags = read_register(REG_IRQFLAGS2);
+                        if ((irqFlags & RF_IRQFLAGS2_CRCOK)
+                                != RF_IRQFLAGS2_CRCOK) {
+                            // Clear Irqs
+                            write_to_register(REG_IRQFLAGS1, RF_IRQFLAGS1_RSSI |
+                                              RF_IRQFLAGS1_PREAMBLEDETECT |
+                                              RF_IRQFLAGS1_SYNCADDRESSMATCH);
+                            write_to_register(REG_IRQFLAGS2, RF_IRQFLAGS2_FIFOOVERRUN);
+
+
+                            if (_rf_settings.fsk.rx_continuous == false) {
+                                rx_timeout_sync_word.detach();
+                                _rf_settings.state = RF_IDLE;
+                            } else {
+                                // Continuous mode restart Rx chain
+                                write_to_register(REG_RXCONFIG,
+                                                  read_register(REG_RXCONFIG) |
+                                                  RF_RXCONFIG_RESTARTRXWITHOUTPLLLOCK);
+                            }
+
+                            rx_timeout_timer.detach();
+
+                            if ((_radio_events != NULL)
+                                    && (_radio_events->rx_error)) {
+                                _radio_events->rx_error();
+                            }
+                            _rf_settings.fsk_packet_handler.preamble_detected = 0;
+                            _rf_settings.fsk_packet_handler.sync_word_detected = 0;
+                            _rf_settings.fsk_packet_handler.nb_bytes = 0;
+                            _rf_settings.fsk_packet_handler.size = 0;
+                            // break from here, a CRC error happened, RX_ERROR
+                            // was notified. No need to go any further
+                            break;
+                        }
+                    }
+
+                    // Read received packet size
+                    if ((_rf_settings.fsk_packet_handler.size == 0)
+                            && (_rf_settings.fsk_packet_handler.nb_bytes == 0)) {
+                        if (_rf_settings.fsk.fix_len == false) {
+                            read_fifo((uint8_t*) &_rf_settings.fsk_packet_handler.size, 1);
+                        } else {
+                            _rf_settings.fsk_packet_handler.size = read_register(REG_PAYLOADLENGTH);
+                        }
+                        read_fifo(_data_buffer + _rf_settings.fsk_packet_handler.nb_bytes,
+                                _rf_settings.fsk_packet_handler.size - _rf_settings.fsk_packet_handler.nb_bytes);
+                        _rf_settings.fsk_packet_handler.nb_bytes +=
+                                (_rf_settings.fsk_packet_handler.size - _rf_settings.fsk_packet_handler.nb_bytes);
+                    } else {
+                        read_fifo(_data_buffer + _rf_settings.fsk_packet_handler.nb_bytes,
+                                _rf_settings.fsk_packet_handler.size - _rf_settings.fsk_packet_handler.nb_bytes);
+                        _rf_settings.fsk_packet_handler.nb_bytes +=
+                                (_rf_settings.fsk_packet_handler.size - _rf_settings.fsk_packet_handler.nb_bytes);
+                    }
+
+                    if (_rf_settings.fsk.rx_continuous == false) {
+                        _rf_settings.state = RF_IDLE;
+                        rx_timeout_sync_word.detach();
+                    } else {
+                        // Continuous mode restart Rx chain
+                        write_to_register(REG_RXCONFIG, read_register(REG_RXCONFIG)
+                                        | RF_RXCONFIG_RESTARTRXWITHOUTPLLLOCK);
+                    }
+
+                    rx_timeout_timer.detach();
+
+                    if ((_radio_events != NULL) && (_radio_events->rx_done)) {
+                        _radio_events->rx_done(
+                                _data_buffer,
+                                _rf_settings.fsk_packet_handler.size,
+                                _rf_settings.fsk_packet_handler.rssi_value, 0);
+                    }
+                    _rf_settings.fsk_packet_handler.preamble_detected = 0;
+                    _rf_settings.fsk_packet_handler.sync_word_detected = 0;
+                    _rf_settings.fsk_packet_handler.nb_bytes = 0;
+                    _rf_settings.fsk_packet_handler.size = 0;
+                    break;
+                case MODEM_LORA: {
+                    int8_t snr = 0;
+
+                    // Clear Irq
+                    write_to_register(REG_LR_IRQFLAGS, RFLR_IRQFLAGS_RXDONE);
+
+                    irqFlags = read_register(REG_LR_IRQFLAGS);
+                    if ((irqFlags & RFLR_IRQFLAGS_PAYLOADCRCERROR_MASK)
+                            == RFLR_IRQFLAGS_PAYLOADCRCERROR) {
+                        // Clear Irq
+                        write_to_register(REG_LR_IRQFLAGS,
+                                          RFLR_IRQFLAGS_PAYLOADCRCERROR);
+
+                        if (_rf_settings.lora.rx_continuous == false) {
+                            _rf_settings.state = RF_IDLE;
+                        }
+                        rx_timeout_timer.detach();
+
+                        if ((_radio_events != NULL)
+                                && (_radio_events->rx_error)) {
+                            _radio_events->rx_error();
+                        }
+                        break;
+                    }
+
+                    _rf_settings.lora_packet_handler.snr_value = read_register(REG_LR_PKTSNRVALUE);
+                    if (_rf_settings.lora_packet_handler.snr_value & 0x80) // The SNR sign bit is 1
+                            {
+                        // Invert and divide by 4
+                        snr = ((~_rf_settings.lora_packet_handler.snr_value + 1) & 0xFF) >> 2;
+                        snr = -snr;
+                    } else {
+                        // Divide by 4
+                        snr =(_rf_settings.lora_packet_handler.snr_value & 0xFF) >> 2;
+                    }
+
+                    int16_t rssi = read_register(REG_LR_PKTRSSIVALUE);
+                    if (snr < 0) {
+                        _rf_settings.lora_packet_handler.rssi_value =
+                                RSSI_OFFSET + rssi + (rssi >> 4) + snr;
+                    } else {
+                        _rf_settings.lora_packet_handler.rssi_value =
+                                RSSI_OFFSET + rssi + (rssi >> 4);
+                    }
+
+                    _rf_settings.lora_packet_handler.size = read_register(REG_LR_RXNBBYTES);
+                    read_fifo(_data_buffer, _rf_settings.lora_packet_handler.size);
+
+                    if (_rf_settings.lora.rx_continuous == false) {
+                        _rf_settings.state = RF_IDLE;
+                    }
+                    rx_timeout_timer.detach();
+
+                    if ((_radio_events != NULL)
+                            && (_radio_events->rx_done)) {
+                        _radio_events->rx_done(
+                                _data_buffer,
+                                _rf_settings.lora_packet_handler.size,
+                                _rf_settings.lora_packet_handler.rssi_value,
+                                _rf_settings.lora_packet_handler.snr_value);
+                    }
+                }
+                    break;
+                default:
+                    break;
+            }
+            break;
+        case RF_TX_RUNNING:
+            tx_timeout_timer.detach();
+            // TxDone interrupt
+            switch (_rf_settings.modem) {
+                case MODEM_LORA:
+                    // Clear Irq
+                    write_to_register( REG_LR_IRQFLAGS, RFLR_IRQFLAGS_TXDONE);
+                    // Intentional fall through
+                case MODEM_FSK:
+                default:
+                    _rf_settings.state = RF_IDLE;
+                    if ((_radio_events != NULL)
+                            && (_radio_events->tx_done)) {
+                        _radio_events->tx_done();
+                    }
+                    break;
+            }
+            break;
+        default:
+            break;
+    }
+}
+
+void SX1272_LoRaRadio::handle_dio1_irq()
+{
+
+    switch(_rf_settings.state )
+       {
+           case RF_RX_RUNNING:
+               switch(_rf_settings.modem ) {
+               case MODEM_FSK:
+                   // FifoLevel interrupt
+                   // Read received packet size
+                   if( ( _rf_settings.fsk_packet_handler.size == 0 ) && ( _rf_settings.fsk_packet_handler.nb_bytes == 0 ) )
+                   {
+                       if( _rf_settings.fsk.fix_len == false )
+                       {
+                           read_fifo( ( uint8_t* )&_rf_settings.fsk_packet_handler.size, 1 );
+                       }
+                       else
+                       {
+                           _rf_settings.fsk_packet_handler.size = read_register(REG_PAYLOADLENGTH);
+                       }
+                   }
+
+                   if( ( _rf_settings.fsk_packet_handler.size - _rf_settings.fsk_packet_handler.nb_bytes ) > _rf_settings.fsk_packet_handler.fifo_thresh )
+                   {
+                       read_fifo( ( _data_buffer + _rf_settings.fsk_packet_handler.nb_bytes ), _rf_settings.fsk_packet_handler.fifo_thresh );
+                       _rf_settings.fsk_packet_handler.nb_bytes += _rf_settings.fsk_packet_handler.fifo_thresh;
+                   }
+                   else
+                   {
+                       read_fifo( ( _data_buffer + _rf_settings.fsk_packet_handler.nb_bytes ), _rf_settings.fsk_packet_handler.size - _rf_settings.fsk_packet_handler.nb_bytes );
+                       _rf_settings.fsk_packet_handler.nb_bytes += ( _rf_settings.fsk_packet_handler.size - _rf_settings.fsk_packet_handler.nb_bytes );
+                   }
+                   break;
+               case MODEM_LORA:
+                   // Sync time out
+                   rx_timeout_timer.detach( );
+                   _rf_settings.state = RF_IDLE;
+                   if ((_radio_events != NULL) && (_radio_events->rx_timeout)) {
+                        _radio_events->rx_timeout();
+                    }
+                   break;
+               default:
+                   break;
+               }
+               break;
+           case RF_TX_RUNNING:
+               switch( _rf_settings.modem )
+               {
+               case MODEM_FSK:
+                   // FifoLevel interrupt
+                   if( ( _rf_settings.fsk_packet_handler.size - _rf_settings.fsk_packet_handler.nb_bytes ) > _rf_settings.fsk_packet_handler.chunk_size )
+                   {
+                       write_fifo(( _data_buffer + _rf_settings.fsk_packet_handler.nb_bytes ), _rf_settings.fsk_packet_handler.chunk_size );
+                       _rf_settings.fsk_packet_handler.nb_bytes += _rf_settings.fsk_packet_handler.chunk_size;
+                   }
+                   else
+                   {
+                       // Write the last chunk of data
+                       write_fifo( _data_buffer + _rf_settings.fsk_packet_handler.nb_bytes, _rf_settings.fsk_packet_handler.size - _rf_settings.fsk_packet_handler.nb_bytes );
+                       _rf_settings.fsk_packet_handler.nb_bytes += _rf_settings.fsk_packet_handler.size - _rf_settings.fsk_packet_handler.nb_bytes;
+                   }
+                   break;
+               case MODEM_LORA:
+                   break;
+               default:
+                   break;
+               }
+               break;
+           default:
+               break;
+       }
+}
+
+void SX1272_LoRaRadio::handle_dio2_irq(void)
+{
+    switch(_rf_settings.state )
+    {
+        case RF_RX_RUNNING:
+            switch( _rf_settings.modem )
+            {
+            case MODEM_FSK:
+
+                // DIO4 must have been asserted to set preamble_detected to true
+                if( ( _rf_settings.fsk_packet_handler.preamble_detected == 1 ) && ( _rf_settings.fsk_packet_handler.sync_word_detected == 0 ) )
+                {
+                    if (_rf_settings.fsk.rx_continuous == false) {
+                        rx_timeout_sync_word.detach( );
+                    }
+
+                    _rf_settings.fsk_packet_handler.sync_word_detected = 1;
+
+                    _rf_settings.fsk_packet_handler.rssi_value = -( read_register( REG_RSSIVALUE ) >> 1 );
+
+                    _rf_settings.fsk_packet_handler.afc_value = ( int32_t )( double )( ( ( uint16_t )read_register( REG_AFCMSB ) << 8 ) |
+                                                                           ( uint16_t )read_register( REG_AFCLSB ) ) *
+                                                                           ( double )FREQ_STEP;
+                    _rf_settings.fsk_packet_handler.rx_gain = ( read_register( REG_LNA ) >> 5 ) & 0x07;
+                }
+                break;
+            case MODEM_LORA:
+                if( _rf_settings.lora.freq_hop_on == true )
+                {
+                    // Clear Irq
+                    write_to_register( REG_LR_IRQFLAGS, RFLR_IRQFLAGS_FHSSCHANGEDCHANNEL );
+
+                    if( ( _radio_events != NULL ) && (_radio_events->fhss_change_channel ) )
+                    {
+                        _radio_events->fhss_change_channel((read_register( REG_LR_HOPCHANNEL ) & RFLR_HOPCHANNEL_CHANNEL_MASK ));
+                    }
+                }
+                break;
+            default:
+                break;
+            }
+            break;
+        case RF_TX_RUNNING:
+            switch( _rf_settings.modem )
+            {
+            case MODEM_FSK:
+                break;
+            case MODEM_LORA:
+                if( _rf_settings.lora.freq_hop_on == true )
+                {
+                    // Clear Irq
+                    write_to_register( REG_LR_IRQFLAGS, RFLR_IRQFLAGS_FHSSCHANGEDCHANNEL );
+
+                    if( (_radio_events != NULL ) && ( _radio_events->fhss_change_channel ) )
+                    {
+                        _radio_events->fhss_change_channel((read_register( REG_LR_HOPCHANNEL ) & RFLR_HOPCHANNEL_CHANNEL_MASK ));
+                    }
+                }
+                break;
+            default:
+                break;
+            }
+            break;
+        default:
+            break;
+    }
+}
+
+void SX1272_LoRaRadio::handle_dio3_irq( void )
+{
+    switch( _rf_settings.modem )
+    {
+    case MODEM_FSK:
+        break;
+    case MODEM_LORA:
+        if( ( read_register( REG_LR_IRQFLAGS ) & RFLR_IRQFLAGS_CADDETECTED ) == RFLR_IRQFLAGS_CADDETECTED )
+        {
+            // Clear Irq
+            write_to_register( REG_LR_IRQFLAGS, RFLR_IRQFLAGS_CADDETECTED | RFLR_IRQFLAGS_CADDONE );
+            if( ( _radio_events != NULL ) && ( _radio_events->cad_done ) )
+            {
+                _radio_events->cad_done( true );
+            }
+        }
+        else
+        {
+            // Clear Irq
+            write_to_register( REG_LR_IRQFLAGS, RFLR_IRQFLAGS_CADDONE );
+            if( ( _radio_events != NULL ) && ( _radio_events->cad_done ) )
+            {
+                _radio_events->cad_done( false );
+            }
+        }
+        break;
+    default:
+        break;
+    }
+}
+
+void SX1272_LoRaRadio::handle_dio4_irq(void)
+{
+    // is asserted when a preamble is detected (FSK modem only)
+    switch (_rf_settings.modem) {
+        case MODEM_FSK: {
+            if (_rf_settings.fsk_packet_handler.preamble_detected == 0) {
+                _rf_settings.fsk_packet_handler.preamble_detected = 1;
+            }
+        }
+            break;
+        case MODEM_LORA:
+            break;
+        default:
+            break;
+    }
+}
+
+void SX1272_LoRaRadio::handle_dio5_irq()
+{
+    switch( _rf_settings.modem )
+    {
+    case MODEM_FSK:
+        break;
+    case MODEM_LORA:
+        break;
+    default:
+        break;
+    }
+}
+
+
+void SX1272_LoRaRadio::handle_timeout_irq()
+{
+    switch(_rf_settings.state )
+     {
+     case RF_RX_RUNNING:
+         if( _rf_settings.modem == MODEM_FSK ) {
+             _rf_settings.fsk_packet_handler.preamble_detected = 0;
+             _rf_settings.fsk_packet_handler.sync_word_detected = 0;
+             _rf_settings.fsk_packet_handler.nb_bytes = 0;
+             _rf_settings.fsk_packet_handler.size = 0;
+
+             // Clear Irqs
+             write_to_register(REG_IRQFLAGS1, RF_IRQFLAGS1_RSSI |
+                                         RF_IRQFLAGS1_PREAMBLEDETECT |
+                                         RF_IRQFLAGS1_SYNCADDRESSMATCH);
+             write_to_register( REG_IRQFLAGS2, RF_IRQFLAGS2_FIFOOVERRUN);
+
+             if( _rf_settings.fsk.rx_continuous == true )
+             {
+                 // Continuous mode restart Rx chain
+                 write_to_register( REG_RXCONFIG, read_register(REG_RXCONFIG) |
+                                    RF_RXCONFIG_RESTARTRXWITHOUTPLLLOCK);
+             }
+             else
+             {
+                 _rf_settings.state = RF_IDLE;
+                 rx_timeout_sync_word.attach_us(callback(this, &SX1272_LoRaRadio::timeout_irq_isr),
+                                              _rf_settings.fsk.rx_single_timeout * 1e3);
+             }
+         }
+
+         if((_radio_events != NULL) && (_radio_events->rx_timeout)) {
+             _radio_events->rx_timeout();
+         }
+
+         break;
+
+     case RF_TX_RUNNING:
+         // Tx timeout shouldn't happen.
+         // But it has been observed that when it happens it is a result of a
+         // corrupted SPI transfer
+         // The workaround is to put the radio in a known state.
+         // Thus, we re-initialize it.
+
+         // Reset the radio
+         radio_reset( );
+
+         // Initialize radio default values
+         set_operation_mode( RF_OPMODE_SLEEP );
+
+         setup_registers();
+
+         set_modem(MODEM_FSK);
+
+         // Restore previous network type setting.
+         set_public_network(_rf_settings.lora.public_network);
+
+         _rf_settings.state = RF_IDLE;
+         if( ( _radio_events != NULL ) && ( _radio_events->tx_timeout ) )
+         {
+             _radio_events->tx_timeout( );
+         }
+         break;
+     default:
+         break;
+     }
+}
+
+#endif //DEVICE_SPI
+