Diff: examples/src/dot_util.cpp

Revision:

26:99458ed6fd31

Parent:

25:2ddd7643c423

--- a/examples/src/dot_util.cpp	Sun Feb 04 00:59:13 2018 +0000
+++ /dev/null	Thu Jan 01 00:00:00 1970 +0000
@@ -1,714 +0,0 @@
-#include "dot_util.h"
-#if defined(TARGET_XDOT_L151CC)
-#include "xdot_low_power.h"
-#endif
-
-#if defined(TARGET_MTS_MDOT_F411RE)
-uint32_t portA[6];
-uint32_t portB[6];
-uint32_t portC[6];
-uint32_t portD[6];
-uint32_t portH[6];
-#endif
-
-
-void display_config() {
-    // display configuration and library version information
-    logInfo("=====================");
-    logInfo("general configuration");
-    logInfo("=====================");
-    logInfo("version ------------------ %s", dot->getId().c_str());
-    logInfo("device ID/EUI ------------ %s", mts::Text::bin2hexString(dot->getDeviceId()).c_str());
-    logInfo("default channel plan ----- %s", mDot::FrequencyBandStr(dot->getDefaultFrequencyBand()).c_str());
-    logInfo("current channel plan ----- %s", mDot::FrequencyBandStr(dot->getFrequencyBand()).c_str());
-    if (lora::ChannelPlan::IsPlanFixed(dot->getFrequencyBand())) {
-        logInfo("frequency sub band ------- %u", dot->getFrequencySubBand());
-    }
-    logInfo("public network ----------- %s", dot->getPublicNetwork() ? "on" : "off");
-    logInfo("=========================");
-    logInfo("credentials configuration");
-    logInfo("=========================");
-    logInfo("device class ------------- %s", dot->getClass().c_str());
-    logInfo("network join mode -------- %s", mDot::JoinModeStr(dot->getJoinMode()).c_str());
-    if (dot->getJoinMode() == mDot::MANUAL || dot->getJoinMode() == mDot::PEER_TO_PEER) {
-	logInfo("network address ---------- %s", mts::Text::bin2hexString(dot->getNetworkAddress()).c_str());
-	logInfo("network session key------- %s", mts::Text::bin2hexString(dot->getNetworkSessionKey()).c_str());
-	logInfo("data session key---------- %s", mts::Text::bin2hexString(dot->getDataSessionKey()).c_str());
-    } else {
-	logInfo("network name ------------- %s", dot->getNetworkName().c_str());
-	logInfo("network phrase ----------- %s", dot->getNetworkPassphrase().c_str());
-	logInfo("network EUI -------------- %s", mts::Text::bin2hexString(dot->getNetworkId()).c_str());
-	logInfo("network KEY -------------- %s", mts::Text::bin2hexString(dot->getNetworkKey()).c_str());
-    }
-    logInfo("========================");
-    logInfo("communication parameters");
-    logInfo("========================");
-    if (dot->getJoinMode() == mDot::PEER_TO_PEER) {
-	logInfo("TX frequency ------------- %lu", dot->getTxFrequency());
-    } else {
-	logInfo("acks --------------------- %s, %u attempts", dot->getAck() > 0 ? "on" : "off", dot->getAck());
-    }
-    logInfo("TX datarate -------------- %s", mDot::DataRateStr(dot->getTxDataRate()).c_str());
-    logInfo("TX power ----------------- %lu dBm", dot->getTxPower());
-    logInfo("antenna gain ------------- %u dBm", dot->getAntennaGain());
-    logInfo("LBT ---------------------- %s", dot->getLbtTimeUs() ? "on" : "off");
-    if (dot->getLbtTimeUs()) {
-	logInfo("LBT time ----------------- %lu us", dot->getLbtTimeUs());
-	logInfo("LBT threshold ------------ %d dBm", dot->getLbtThreshold());
-    }
-}
-
-void update_ota_config_name_phrase(std::string network_name, std::string network_passphrase, uint8_t frequency_sub_band, bool public_network, uint8_t ack) {
-    std::string current_network_name = dot->getNetworkName();
-    std::string current_network_passphrase = dot->getNetworkPassphrase();
-    uint8_t current_frequency_sub_band = dot->getFrequencySubBand();
-    bool current_public_network = dot->getPublicNetwork();
-    uint8_t current_ack = dot->getAck();
-    
-    if (current_network_name != network_name) {
-        logInfo("changing network name from \"%s\" to \"%s\"", current_network_name.c_str(), network_name.c_str());
-        if (dot->setNetworkName(network_name) != mDot::MDOT_OK) {
-            logError("failed to set network name to \"%s\"", network_name.c_str());
-        }
-    }
-    
-    if (current_network_passphrase != network_passphrase) {
-        logInfo("changing network passphrase from \"%s\" to \"%s\"", current_network_passphrase.c_str(), network_passphrase.c_str());
-        if (dot->setNetworkPassphrase(network_passphrase) != mDot::MDOT_OK) {
-            logError("failed to set network passphrase to \"%s\"", network_passphrase.c_str());
-        }
-    }
-    
-    if (lora::ChannelPlan::IsPlanFixed(dot->getFrequencyBand())) {
-	if (current_frequency_sub_band != frequency_sub_band) {
-	    logInfo("changing frequency sub band from %u to %u", current_frequency_sub_band, frequency_sub_band);
-	    if (dot->setFrequencySubBand(frequency_sub_band) != mDot::MDOT_OK) {
-		logError("failed to set frequency sub band to %u", frequency_sub_band);
-	    }
-	}
-    }
-    
-    if (current_public_network != public_network) {
-        logInfo("changing public network from %s to %s", current_public_network ? "on" : "off", public_network ? "on" : "off");
-        if (dot->setPublicNetwork(public_network) != mDot::MDOT_OK) {
-            logError("failed to set public network to %s", public_network ? "on" : "off");
-        }
-    }
-    
-    if (current_ack != ack) {
-        logInfo("changing acks from %u to %u", current_ack, ack);
-        if (dot->setAck(ack) != mDot::MDOT_OK) {
-            logError("failed to set acks to %u", ack);
-        }
-    }
-}
-
-void update_ota_config_id_key(uint8_t *network_id, uint8_t *network_key, uint8_t frequency_sub_band, bool public_network, uint8_t ack) {
-    std::vector<uint8_t> current_network_id = dot->getNetworkId();
-    std::vector<uint8_t> current_network_key = dot->getNetworkKey();
-    uint8_t current_frequency_sub_band = dot->getFrequencySubBand();
-    bool current_public_network = dot->getPublicNetwork();
-    uint8_t current_ack = dot->getAck();
-
-    std::vector<uint8_t> network_id_vector(network_id, network_id + 8);
-    std::vector<uint8_t> network_key_vector(network_key, network_key + 16);
-    
-    if (current_network_id != network_id_vector) {
-        logInfo("changing network ID from \"%s\" to \"%s\"", mts::Text::bin2hexString(current_network_id).c_str(), mts::Text::bin2hexString(network_id_vector).c_str());
-        if (dot->setNetworkId(network_id_vector) != mDot::MDOT_OK) {
-            logError("failed to set network ID to \"%s\"", mts::Text::bin2hexString(network_id_vector).c_str());
-        }
-    }
-    
-    if (current_network_key != network_key_vector) {
-        logInfo("changing network KEY from \"%s\" to \"%s\"", mts::Text::bin2hexString(current_network_key).c_str(), mts::Text::bin2hexString(network_key_vector).c_str());
-        if (dot->setNetworkKey(network_key_vector) != mDot::MDOT_OK) {
-            logError("failed to set network KEY to \"%s\"", mts::Text::bin2hexString(network_key_vector).c_str());
-        }
-    }
-    
-    if (lora::ChannelPlan::IsPlanFixed(dot->getFrequencyBand())) {
-	if (current_frequency_sub_band != frequency_sub_band) {
-	    logInfo("changing frequency sub band from %u to %u", current_frequency_sub_band, frequency_sub_band);
-	    if (dot->setFrequencySubBand(frequency_sub_band) != mDot::MDOT_OK) {
-		logError("failed to set frequency sub band to %u", frequency_sub_band);
-	    }
-	}
-    }
-    
-    if (current_public_network != public_network) {
-        logInfo("changing public network from %s to %s", current_public_network ? "on" : "off", public_network ? "on" : "off");
-        if (dot->setPublicNetwork(public_network) != mDot::MDOT_OK) {
-            logError("failed to set public network to %s", public_network ? "on" : "off");
-        }
-    }
-    
-    if (current_ack != ack) {
-        logInfo("changing acks from %u to %u", current_ack, ack);
-        if (dot->setAck(ack) != mDot::MDOT_OK) {
-            logError("failed to set acks to %u", ack);
-        }
-    }
-}
-
-void update_manual_config(uint8_t *network_address, uint8_t *network_session_key, uint8_t *data_session_key, uint8_t frequency_sub_band, bool public_network, uint8_t ack) {
-    std::vector<uint8_t> current_network_address = dot->getNetworkAddress();
-    std::vector<uint8_t> current_network_session_key = dot->getNetworkSessionKey();
-    std::vector<uint8_t> current_data_session_key = dot->getDataSessionKey();
-    uint8_t current_frequency_sub_band = dot->getFrequencySubBand();
-    bool current_public_network = dot->getPublicNetwork();
-    uint8_t current_ack = dot->getAck();
-
-    std::vector<uint8_t> network_address_vector(network_address, network_address + 4);
-    std::vector<uint8_t> network_session_key_vector(network_session_key, network_session_key + 16);
-    std::vector<uint8_t> data_session_key_vector(data_session_key, data_session_key + 16);
-
-    if (current_network_address != network_address_vector) {
-        logInfo("changing network address from \"%s\" to \"%s\"", mts::Text::bin2hexString(current_network_address).c_str(), mts::Text::bin2hexString(network_address_vector).c_str());
-        if (dot->setNetworkAddress(network_address_vector) != mDot::MDOT_OK) {
-            logError("failed to set network address to \"%s\"", mts::Text::bin2hexString(network_address_vector).c_str());
-        }
-    }
-    
-    if (current_network_session_key != network_session_key_vector) {
-        logInfo("changing network session key from \"%s\" to \"%s\"", mts::Text::bin2hexString(current_network_session_key).c_str(), mts::Text::bin2hexString(network_session_key_vector).c_str());
-        if (dot->setNetworkSessionKey(network_session_key_vector) != mDot::MDOT_OK) {
-            logError("failed to set network session key to \"%s\"", mts::Text::bin2hexString(network_session_key_vector).c_str());
-        }
-    }
-    
-    if (current_data_session_key != data_session_key_vector) {
-        logInfo("changing data session key from \"%s\" to \"%s\"", mts::Text::bin2hexString(current_data_session_key).c_str(), mts::Text::bin2hexString(data_session_key_vector).c_str());
-        if (dot->setDataSessionKey(data_session_key_vector) != mDot::MDOT_OK) {
-            logError("failed to set data session key to \"%s\"", mts::Text::bin2hexString(data_session_key_vector).c_str());
-        }
-    }
-    
-    if (current_frequency_sub_band != frequency_sub_band) {
-        logInfo("changing frequency sub band from %u to %u", current_frequency_sub_band, frequency_sub_band);
-        if (dot->setFrequencySubBand(frequency_sub_band) != mDot::MDOT_OK) {
-            logError("failed to set frequency sub band to %u", frequency_sub_band);
-        }
-    }
-    
-    if (current_public_network != public_network) {
-        logInfo("changing public network from %s to %s", current_public_network ? "on" : "off", public_network ? "on" : "off");
-        if (dot->setPublicNetwork(public_network) != mDot::MDOT_OK) {
-            logError("failed to set public network to %s", public_network ? "on" : "off");
-        }
-    }
-    
-    if (current_ack != ack) {
-        logInfo("changing acks from %u to %u", current_ack, ack);
-        if (dot->setAck(ack) != mDot::MDOT_OK) {
-            logError("failed to set acks to %u", ack);
-        }
-    }
-}
-
-void update_peer_to_peer_config(uint8_t *network_address, uint8_t *network_session_key, uint8_t *data_session_key, uint32_t tx_frequency, uint8_t tx_datarate, uint8_t tx_power) {
-    std::vector<uint8_t> current_network_address = dot->getNetworkAddress();
-    std::vector<uint8_t> current_network_session_key = dot->getNetworkSessionKey();
-    std::vector<uint8_t> current_data_session_key = dot->getDataSessionKey();
-    uint32_t current_tx_frequency = dot->getTxFrequency();
-    uint8_t current_tx_datarate = dot->getTxDataRate();
-    uint8_t current_tx_power = dot->getTxPower();
-
-    std::vector<uint8_t> network_address_vector(network_address, network_address + 4);
-    std::vector<uint8_t> network_session_key_vector(network_session_key, network_session_key + 16);
-    std::vector<uint8_t> data_session_key_vector(data_session_key, data_session_key + 16);
-
-    if (current_network_address != network_address_vector) {
-        logInfo("changing network address from \"%s\" to \"%s\"", mts::Text::bin2hexString(current_network_address).c_str(), mts::Text::bin2hexString(network_address_vector).c_str());
-        if (dot->setNetworkAddress(network_address_vector) != mDot::MDOT_OK) {
-            logError("failed to set network address to \"%s\"", mts::Text::bin2hexString(network_address_vector).c_str());
-        }
-    }
-    
-    if (current_network_session_key != network_session_key_vector) {
-        logInfo("changing network session key from \"%s\" to \"%s\"", mts::Text::bin2hexString(current_network_session_key).c_str(), mts::Text::bin2hexString(network_session_key_vector).c_str());
-        if (dot->setNetworkSessionKey(network_session_key_vector) != mDot::MDOT_OK) {
-            logError("failed to set network session key to \"%s\"", mts::Text::bin2hexString(network_session_key_vector).c_str());
-        }
-    }
-    
-    if (current_data_session_key != data_session_key_vector) {
-        logInfo("changing data session key from \"%s\" to \"%s\"", mts::Text::bin2hexString(current_data_session_key).c_str(), mts::Text::bin2hexString(data_session_key_vector).c_str());
-        if (dot->setDataSessionKey(data_session_key_vector) != mDot::MDOT_OK) {
-            logError("failed to set data session key to \"%s\"", mts::Text::bin2hexString(data_session_key_vector).c_str());
-        }
-    }
-    
-    if (current_tx_frequency != tx_frequency) {
-	logInfo("changing TX frequency from %lu to %lu", current_tx_frequency, tx_frequency);
-	if (dot->setTxFrequency(tx_frequency) != mDot::MDOT_OK) {
-	    logError("failed to set TX frequency to %lu", tx_frequency);
-	}
-    }
-
-    if (current_tx_datarate != tx_datarate) {
-	logInfo("changing TX datarate from %u to %u", current_tx_datarate, tx_datarate);
-	if (dot->setTxDataRate(tx_datarate) != mDot::MDOT_OK) {
-	    logError("failed to set TX datarate to %u", tx_datarate);
-	}
-    }
-
-    if (current_tx_power != tx_power) {
-	logInfo("changing TX power from %u to %u", current_tx_power, tx_power);
-	if (dot->setTxPower(tx_power) != mDot::MDOT_OK) {
-	    logError("failed to set TX power to %u", tx_power);
-	}
-    }
-}
-
-void update_network_link_check_config(uint8_t link_check_count, uint8_t link_check_threshold) {
-    uint8_t current_link_check_count = dot->getLinkCheckCount();
-    uint8_t current_link_check_threshold = dot->getLinkCheckThreshold();
-
-    if (current_link_check_count != link_check_count) {
-	logInfo("changing link check count from %u to %u", current_link_check_count, link_check_count);
-	if (dot->setLinkCheckCount(link_check_count) != mDot::MDOT_OK) {
-	    logError("failed to set link check count to %u", link_check_count);
-	}
-    }
-
-    if (current_link_check_threshold != link_check_threshold) {
-	logInfo("changing link check threshold from %u to %u", current_link_check_threshold, link_check_threshold);
-	if (dot->setLinkCheckThreshold(link_check_threshold) != mDot::MDOT_OK) {
-	    logError("failed to set link check threshold to %u", link_check_threshold);
-	}
-    }
-}
-
-void join_network() {
-    int32_t j_attempts = 0;
-    int32_t ret = mDot::MDOT_ERROR;
-    
-    // attempt to join the network
-    while (ret != mDot::MDOT_OK) {
-        logInfo("attempt %d to join network", ++j_attempts);
-        ret = dot->joinNetwork();
-        if (ret != mDot::MDOT_OK) {
-            logError("failed to join network %d:%s", ret, mDot::getReturnCodeString(ret).c_str());
-            // in some frequency bands we need to wait until another channel is available before transmitting again
-            uint32_t delay_s = (dot->getNextTxMs() / 1000) + 1;
-            if (delay_s < 2) {
-                logInfo("waiting %lu s until next free channel", delay_s);
-                wait(delay_s);
-            } else {
-                logInfo("sleeping %lu s until next free channel", delay_s);
-                dot->sleep(delay_s, mDot::RTC_ALARM, false);
-            }
-        }
-    }
-}
-
-void sleep_wake_rtc_only(bool deepsleep) {
-    // in some frequency bands we need to wait until another channel is available before transmitting again
-    // wait at least 10s between transmissions
-    uint32_t delay_s = dot->getNextTxMs() / 1000;
-    if (delay_s < 10) {
-        delay_s = 10;
-    }
-    
-    logInfo("%ssleeping %lus", deepsleep ? "deep" : "", delay_s);
-    logInfo("application will %s after waking up", deepsleep ? "execute from beginning" : "resume");
-
-    // lowest current consumption in sleep mode can only be achieved by configuring IOs as analog inputs with no pull resistors
-    // the library handles all internal IOs automatically, but the external IOs are the application's responsibility
-    // certain IOs may require internal pullup or pulldown resistors because leaving them floating would cause extra current consumption
-    // for xDot: UART_*, I2C_*, SPI_*, GPIO*, WAKE
-    // for mDot: XBEE_*, USBTX, USBRX, PB_0, PB_1
-    // steps are:
-    //   * save IO configuration
-    //   * configure IOs to reduce current consumption
-    //   * sleep
-    //   * restore IO configuration
-    if (! deepsleep) {
-	// save the GPIO state.
-	sleep_save_io();
-
-	// configure GPIOs for lowest current
-	sleep_configure_io();
-    }
-    
-    // go to sleep/deepsleep for delay_s seconds and wake using the RTC alarm
-    dot->sleep(delay_s, mDot::RTC_ALARM, deepsleep);
-
-    if (! deepsleep) {
-	// restore the GPIO state.
-	sleep_restore_io();
-    }
-}
-
-void sleep_wake_interrupt_only(bool deepsleep) {
-#if defined (TARGET_XDOT_L151CC)
-    if (deepsleep) {
-        // for xDot, WAKE pin (connected to S2 on xDot-DK) is the only pin that can wake the processor from deepsleep
-        // it is automatically configured when INTERRUPT or RTC_ALARM_OR_INTERRUPT is the wakeup source and deepsleep is true in the mDot::sleep call
-    } else {
-        // configure WAKE pin (connected to S2 on xDot-DK) as the pin that will wake the xDot from low power modes
-        //      other pins can be confgured instead: GPIO0-3 or UART_RX
-        dot->setWakePin(WAKE);    
-    }
-
-    logInfo("%ssleeping until interrupt on %s pin", deepsleep ? "deep" : "", deepsleep ? "WAKE" : mDot::pinName2Str(dot->getWakePin()).c_str());
-#else
-
-    if (deepsleep) {
-        // for mDot, XBEE_DIO7 pin is the only pin that can wake the processor from deepsleep
-        // it is automatically configured when INTERRUPT or RTC_ALARM_OR_INTERRUPT is the wakeup source and deepsleep is true in the mDot::sleep call
-    } else {
-        // configure XBEE_DIO7 pin as the pin that will wake the mDot from low power modes
-        //      other pins can be confgured instead: XBEE_DIO2-6, XBEE_DI8, XBEE_DIN
-        dot->setWakePin(XBEE_DIO7);    
-    }
-
-    logInfo("%ssleeping until interrupt on %s pin", deepsleep ? "deep" : "", deepsleep ? "DIO7" : mDot::pinName2Str(dot->getWakePin()).c_str());
-#endif
-
-    logInfo("application will %s after waking up", deepsleep ? "execute from beginning" : "resume");
-
-    // lowest current consumption in sleep mode can only be achieved by configuring IOs as analog inputs with no pull resistors
-    // the library handles all internal IOs automatically, but the external IOs are the application's responsibility
-    // certain IOs may require internal pullup or pulldown resistors because leaving them floating would cause extra current consumption
-    // for xDot: UART_*, I2C_*, SPI_*, GPIO*, WAKE
-    // for mDot: XBEE_*, USBTX, USBRX, PB_0, PB_1
-    // steps are:
-    //   * save IO configuration
-    //   * configure IOs to reduce current consumption
-    //   * sleep
-    //   * restore IO configuration
-    if (! deepsleep) {
-	// save the GPIO state.
-	sleep_save_io();
-
-	// configure GPIOs for lowest current
-	sleep_configure_io();
-    }
-    
-    // go to sleep/deepsleep and wake on rising edge of configured wake pin (only the WAKE pin in deepsleep)
-    // since we're not waking on the RTC alarm, the interval is ignored
-    dot->sleep(0, mDot::INTERRUPT, deepsleep);
-
-    if (! deepsleep) {
-	// restore the GPIO state.
-	sleep_restore_io();
-    }
-}
-
-void sleep_wake_rtc_or_interrupt(bool deepsleep) {
-    // in some frequency bands we need to wait until another channel is available before transmitting again
-    // wait at least 10s between transmissions
-    uint32_t delay_s = dot->getNextTxMs() / 1000;
-    if (delay_s < 10) {
-        delay_s = 10;
-    }
-
-#if defined (TARGET_XDOT_L151CC)
-    if (deepsleep) {
-        // for xDot, WAKE pin (connected to S2 on xDot-DK) is the only pin that can wake the processor from deepsleep
-        // it is automatically configured when INTERRUPT or RTC_ALARM_OR_INTERRUPT is the wakeup source and deepsleep is true in the mDot::sleep call
-    } else {
-        // configure WAKE pin (connected to S2 on xDot-DK) as the pin that will wake the xDot from low power modes
-        //      other pins can be confgured instead: GPIO0-3 or UART_RX
-        dot->setWakePin(WAKE);    
-    }
-
-    logInfo("%ssleeping %lus or until interrupt on %s pin", deepsleep ? "deep" : "", delay_s, deepsleep ? "WAKE" : mDot::pinName2Str(dot->getWakePin()).c_str());
-#else
-    if (deepsleep) {
-        // for mDot, XBEE_DIO7 pin is the only pin that can wake the processor from deepsleep
-        // it is automatically configured when INTERRUPT or RTC_ALARM_OR_INTERRUPT is the wakeup source and deepsleep is true in the mDot::sleep call
-    } else {
-        // configure XBEE_DIO7 pin as the pin that will wake the mDot from low power modes
-        //      other pins can be confgured instead: XBEE_DIO2-6, XBEE_DI8, XBEE_DIN
-        dot->setWakePin(XBEE_DIO7);    
-    }
-
-    logInfo("%ssleeping %lus or until interrupt on %s pin", deepsleep ? "deep" : "", delay_s, deepsleep ? "DIO7" : mDot::pinName2Str(dot->getWakePin()).c_str());
-#endif
-
-    logInfo("application will %s after waking up", deepsleep ? "execute from beginning" : "resume");
-
-    // lowest current consumption in sleep mode can only be achieved by configuring IOs as analog inputs with no pull resistors
-    // the library handles all internal IOs automatically, but the external IOs are the application's responsibility
-    // certain IOs may require internal pullup or pulldown resistors because leaving them floating would cause extra current consumption
-    // for xDot: UART_*, I2C_*, SPI_*, GPIO*, WAKE
-    // for mDot: XBEE_*, USBTX, USBRX, PB_0, PB_1
-    // steps are:
-    //   * save IO configuration
-    //   * configure IOs to reduce current consumption
-    //   * sleep
-    //   * restore IO configuration
-    if (! deepsleep) {
-	// save the GPIO state.
-	sleep_save_io();
-
-	// configure GPIOs for lowest current
-	sleep_configure_io();
-    }
-    
-    // go to sleep/deepsleep and wake using the RTC alarm after delay_s seconds or rising edge of configured wake pin (only the WAKE pin in deepsleep)
-    // whichever comes first will wake the xDot
-    dot->sleep(delay_s, mDot::RTC_ALARM_OR_INTERRUPT, deepsleep);
-
-    if (! deepsleep) {
-	// restore the GPIO state.
-	sleep_restore_io();
-    }
-}
-
-void sleep_save_io() {
-#if defined(TARGET_XDOT_L151CC)
-	xdot_save_gpio_state();
-#else
-	portA[0] = GPIOA->MODER;
-	portA[1] = GPIOA->OTYPER;
-	portA[2] = GPIOA->OSPEEDR;
-	portA[3] = GPIOA->PUPDR;
-	portA[4] = GPIOA->AFR[0];
-	portA[5] = GPIOA->AFR[1];
-
-	portB[0] = GPIOB->MODER;
-	portB[1] = GPIOB->OTYPER;
-	portB[2] = GPIOB->OSPEEDR;
-	portB[3] = GPIOB->PUPDR;
-	portB[4] = GPIOB->AFR[0];
-	portB[5] = GPIOB->AFR[1];
-
-	portC[0] = GPIOC->MODER;
-	portC[1] = GPIOC->OTYPER;
-	portC[2] = GPIOC->OSPEEDR;
-	portC[3] = GPIOC->PUPDR;
-	portC[4] = GPIOC->AFR[0];
-	portC[5] = GPIOC->AFR[1];
-
-	portD[0] = GPIOD->MODER;
-	portD[1] = GPIOD->OTYPER;
-	portD[2] = GPIOD->OSPEEDR;
-	portD[3] = GPIOD->PUPDR;
-	portD[4] = GPIOD->AFR[0];
-	portD[5] = GPIOD->AFR[1];
-
-	portH[0] = GPIOH->MODER;
-	portH[1] = GPIOH->OTYPER;
-	portH[2] = GPIOH->OSPEEDR;
-	portH[3] = GPIOH->PUPDR;
-	portH[4] = GPIOH->AFR[0];
-	portH[5] = GPIOH->AFR[1];
-#endif
-}
-
-void sleep_configure_io() {
-#if defined(TARGET_XDOT_L151CC)
-    // GPIO Ports Clock Enable
-    __GPIOA_CLK_ENABLE();
-    __GPIOB_CLK_ENABLE();
-    __GPIOC_CLK_ENABLE();
-    __GPIOH_CLK_ENABLE();
-
-    GPIO_InitTypeDef GPIO_InitStruct;
-
-    // UART1_TX, UART1_RTS & UART1_CTS to analog nopull - RX could be a wakeup source
-    GPIO_InitStruct.Pin = GPIO_PIN_9 | GPIO_PIN_11 | GPIO_PIN_12;
-    GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-    GPIO_InitStruct.Pull = GPIO_NOPULL;
-    HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
-
-    // I2C_SDA & I2C_SCL to analog nopull
-    GPIO_InitStruct.Pin = GPIO_PIN_8 | GPIO_PIN_9;
-    GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-    GPIO_InitStruct.Pull = GPIO_NOPULL;
-    HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
-
-    // SPI_MOSI, SPI_MISO, SPI_SCK, & SPI_NSS to analog nopull
-    GPIO_InitStruct.Pin = GPIO_PIN_12 | GPIO_PIN_13 | GPIO_PIN_14 | GPIO_PIN_15;
-    GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-    GPIO_InitStruct.Pull = GPIO_NOPULL;
-    HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
-
-    // iterate through potential wake pins - leave the configured wake pin alone if one is needed
-    if (dot->getWakePin() != WAKE || dot->getWakeMode() == mDot::RTC_ALARM) {
-        GPIO_InitStruct.Pin = GPIO_PIN_0;
-        GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-        GPIO_InitStruct.Pull = GPIO_NOPULL;
-        HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
-    }
-    if (dot->getWakePin() != GPIO0 || dot->getWakeMode() == mDot::RTC_ALARM) {
-        GPIO_InitStruct.Pin = GPIO_PIN_4;
-        GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-        GPIO_InitStruct.Pull = GPIO_NOPULL;
-        HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
-    }
-    if (dot->getWakePin() != GPIO1 || dot->getWakeMode() == mDot::RTC_ALARM) {
-        GPIO_InitStruct.Pin = GPIO_PIN_5;
-        GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-        GPIO_InitStruct.Pull = GPIO_NOPULL;
-        HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
-    }
-    if (dot->getWakePin() != GPIO2 || dot->getWakeMode() == mDot::RTC_ALARM) {
-        GPIO_InitStruct.Pin = GPIO_PIN_0;
-        GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-        GPIO_InitStruct.Pull = GPIO_NOPULL;
-        HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
-    }
-    if (dot->getWakePin() != GPIO3 || dot->getWakeMode() == mDot::RTC_ALARM) {
-        GPIO_InitStruct.Pin = GPIO_PIN_2;
-        GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-        GPIO_InitStruct.Pull = GPIO_NOPULL;
-        HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
-    }
-    if (dot->getWakePin() != UART1_RX || dot->getWakeMode() == mDot::RTC_ALARM) {
-        GPIO_InitStruct.Pin = GPIO_PIN_10;
-        GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-        GPIO_InitStruct.Pull = GPIO_NOPULL;
-        HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
-    }
-#else
-    /* GPIO Ports Clock Enable */
-    __GPIOA_CLK_ENABLE();
-    __GPIOB_CLK_ENABLE();
-    __GPIOC_CLK_ENABLE();
-
-    GPIO_InitTypeDef GPIO_InitStruct;
-
-    // XBEE_DOUT, XBEE_DIN, XBEE_DO8, XBEE_RSSI, USBTX, USBRX, PA_12, PA_13, PA_14 & PA_15 to analog nopull
-    GPIO_InitStruct.Pin = GPIO_PIN_2 | GPIO_PIN_6 | GPIO_PIN_8 | GPIO_PIN_9 | GPIO_PIN_10 
-                | GPIO_PIN_12 | GPIO_PIN_13 | GPIO_PIN_14 | GPIO_PIN_15;
-    GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-    GPIO_InitStruct.Pull = GPIO_NOPULL;
-    HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);    
-
-    // PB_0, PB_1, PB_3 & PB_4 to analog nopull
-    GPIO_InitStruct.Pin = GPIO_PIN_0 | GPIO_PIN_1 | GPIO_PIN_3 | GPIO_PIN_4;
-    GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-    GPIO_InitStruct.Pull = GPIO_NOPULL;
-    HAL_GPIO_Init(GPIOB, &GPIO_InitStruct); 
-
-    // PC_9 & PC_13 to analog nopull
-    GPIO_InitStruct.Pin = GPIO_PIN_9 | GPIO_PIN_13;
-    GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-    GPIO_InitStruct.Pull = GPIO_NOPULL;
-    HAL_GPIO_Init(GPIOC, &GPIO_InitStruct); 
-
-    // iterate through potential wake pins - leave the configured wake pin alone if one is needed
-    // XBEE_DIN - PA3
-    // XBEE_DIO2 - PA5
-    // XBEE_DIO3 - PA4
-    // XBEE_DIO4 - PA7
-    // XBEE_DIO5 - PC1
-    // XBEE_DIO6 - PA1
-    // XBEE_DIO7 - PA0
-    // XBEE_SLEEPRQ - PA11
-                
-    if (dot->getWakePin() != XBEE_DIN || dot->getWakeMode() == mDot::RTC_ALARM) {
-        GPIO_InitStruct.Pin = GPIO_PIN_3;
-        GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-        GPIO_InitStruct.Pull = GPIO_NOPULL;
-        HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
-    }
-
-    if (dot->getWakePin() != XBEE_DIO2 || dot->getWakeMode() == mDot::RTC_ALARM) {
-        GPIO_InitStruct.Pin = GPIO_PIN_5;
-        GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-        GPIO_InitStruct.Pull = GPIO_NOPULL;
-        HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
-    }
-
-    if (dot->getWakePin() != XBEE_DIO3 || dot->getWakeMode() == mDot::RTC_ALARM) {
-        GPIO_InitStruct.Pin = GPIO_PIN_4;
-        GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-        GPIO_InitStruct.Pull = GPIO_NOPULL;
-        HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
-    }
-
-         if (dot->getWakePin() != XBEE_DIO4 || dot->getWakeMode() == mDot::RTC_ALARM) {
-        GPIO_InitStruct.Pin = GPIO_PIN_7;
-        GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-        GPIO_InitStruct.Pull = GPIO_NOPULL;
-        HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
-    }
-
-     if (dot->getWakePin() != XBEE_DIO5 || dot->getWakeMode() == mDot::RTC_ALARM) {
-        GPIO_InitStruct.Pin = GPIO_PIN_1;
-        GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-        GPIO_InitStruct.Pull = GPIO_NOPULL;
-        HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
-    }
-
-     if (dot->getWakePin() != XBEE_DIO6 || dot->getWakeMode() == mDot::RTC_ALARM) {
-        GPIO_InitStruct.Pin = GPIO_PIN_1;
-        GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-        GPIO_InitStruct.Pull = GPIO_NOPULL;
-        HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
-    }
-
-     if (dot->getWakePin() != XBEE_DIO7 || dot->getWakeMode() == mDot::RTC_ALARM) {
-        GPIO_InitStruct.Pin = GPIO_PIN_0;
-        GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-        GPIO_InitStruct.Pull = GPIO_NOPULL;
-        HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
-    }
-
-     if (dot->getWakePin() != XBEE_SLEEPRQ|| dot->getWakeMode() == mDot::RTC_ALARM) {
-        GPIO_InitStruct.Pin = GPIO_PIN_11;
-        GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
-        GPIO_InitStruct.Pull = GPIO_NOPULL;
-        HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
-    }
-#endif
-}
-
-void sleep_restore_io() {
-#if defined(TARGET_XDOT_L151CC)
-    xdot_restore_gpio_state();
-#else
-    GPIOA->MODER = portA[0];
-    GPIOA->OTYPER = portA[1];
-    GPIOA->OSPEEDR = portA[2];
-    GPIOA->PUPDR = portA[3];
-    GPIOA->AFR[0] = portA[4];
-    GPIOA->AFR[1] = portA[5];
-
-    GPIOB->MODER = portB[0];
-    GPIOB->OTYPER = portB[1];
-    GPIOB->OSPEEDR = portB[2];
-    GPIOB->PUPDR = portB[3];
-    GPIOB->AFR[0] = portB[4];
-    GPIOB->AFR[1] = portB[5];
-
-    GPIOC->MODER = portC[0];
-    GPIOC->OTYPER = portC[1];
-    GPIOC->OSPEEDR = portC[2];
-    GPIOC->PUPDR = portC[3];
-    GPIOC->AFR[0] = portC[4];
-    GPIOC->AFR[1] = portC[5];
-
-    GPIOD->MODER = portD[0];
-    GPIOD->OTYPER = portD[1];
-    GPIOD->OSPEEDR = portD[2];
-    GPIOD->PUPDR = portD[3];
-    GPIOD->AFR[0] = portD[4];
-    GPIOD->AFR[1] = portD[5];
-
-    GPIOH->MODER = portH[0];
-    GPIOH->OTYPER = portH[1];
-    GPIOH->OSPEEDR = portH[2];
-    GPIOH->PUPDR = portH[3];
-    GPIOH->AFR[0] = portH[4];
-    GPIOH->AFR[1] = portH[5];
-#endif
-}
-
-void send_data(std::vector<uint8_t> data) {
-    int32_t ret;
-
-    ret = dot->send(data);
-    if (ret != mDot::MDOT_OK) {
-        logError("failed to send data to %s [%d][%s]", dot->getJoinMode() == mDot::PEER_TO_PEER ? "peer" : "gateway", ret, mDot::getReturnCodeString(ret).c_str());
-    } else {
-        logInfo("successfully sent data to %s", dot->getJoinMode() == mDot::PEER_TO_PEER ? "peer" : "gateway");
-    }
-}
-