fp
Dependencies: libmDot-mbed5 ISL29011
examples/src/dot_util.cpp@21:09d05faf0e13, 2017-06-09 (annotated)
- Committer:
- Mike Fiore
- Date:
- Fri Jun 09 08:31:21 2017 -0500
- Revision:
- 21:09d05faf0e13
- Parent:
- 15:364df461110f
- Child:
- 24:d80afce304c6
update Dot-Examples to support Dot 3.x.x releases - new channel plans, LBT, & external channel plan functionality. Also a few bug fixes.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
mfiore | 0:a151a6350d7f | 1 | #include "dot_util.h" |
Mike Fiore |
7:724cb82a113e | 2 | #if defined(TARGET_XDOT_L151CC) |
Mike Fiore |
7:724cb82a113e | 3 | #include "xdot_low_power.h" |
Mike Fiore |
7:724cb82a113e | 4 | #endif |
Mike Fiore |
7:724cb82a113e | 5 | |
Mike Fiore |
7:724cb82a113e | 6 | #if defined(TARGET_MTS_MDOT_F411RE) |
Mike Fiore |
7:724cb82a113e | 7 | uint32_t portA[6]; |
Mike Fiore |
7:724cb82a113e | 8 | uint32_t portB[6]; |
Mike Fiore |
7:724cb82a113e | 9 | uint32_t portC[6]; |
Mike Fiore |
7:724cb82a113e | 10 | uint32_t portD[6]; |
Mike Fiore |
7:724cb82a113e | 11 | uint32_t portH[6]; |
Mike Fiore |
7:724cb82a113e | 12 | #endif |
Mike Fiore |
7:724cb82a113e | 13 | |
mfiore | 0:a151a6350d7f | 14 | |
mfiore | 0:a151a6350d7f | 15 | void display_config() { |
mfiore | 0:a151a6350d7f | 16 | // display configuration and library version information |
Mike Fiore |
10:4d0b765f7b9e | 17 | logInfo("====================="); |
mfiore | 0:a151a6350d7f | 18 | logInfo("general configuration"); |
Mike Fiore |
10:4d0b765f7b9e | 19 | logInfo("====================="); |
Mike Fiore |
10:4d0b765f7b9e | 20 | logInfo("version ------------------ %s", dot->getId().c_str()); |
Mike Fiore |
10:4d0b765f7b9e | 21 | logInfo("device ID/EUI ------------ %s", mts::Text::bin2hexString(dot->getDeviceId()).c_str()); |
Mike Fiore |
21:09d05faf0e13 | 22 | logInfo("default channel plan ----- %s", mDot::FrequencyBandStr(dot->getDefaultFrequencyBand()).c_str()); |
Mike Fiore |
21:09d05faf0e13 | 23 | logInfo("current channel plan ----- %s", mDot::FrequencyBandStr(dot->getFrequencyBand()).c_str()); |
Mike Fiore |
21:09d05faf0e13 | 24 | if (lora::ChannelPlan::IsPlanFixed(dot->getFrequencyBand())) { |
Mike Fiore |
10:4d0b765f7b9e | 25 | logInfo("frequency sub band ------- %u", dot->getFrequencySubBand()); |
mfiore | 1:c4915e00d2ce | 26 | } |
Mike Fiore |
10:4d0b765f7b9e | 27 | logInfo("public network ----------- %s", dot->getPublicNetwork() ? "on" : "off"); |
Mike Fiore |
10:4d0b765f7b9e | 28 | logInfo("========================="); |
mfiore | 0:a151a6350d7f | 29 | logInfo("credentials configuration"); |
Mike Fiore |
10:4d0b765f7b9e | 30 | logInfo("========================="); |
Mike Fiore |
10:4d0b765f7b9e | 31 | logInfo("device class ------------- %s", dot->getClass().c_str()); |
Mike Fiore |
10:4d0b765f7b9e | 32 | logInfo("network join mode -------- %s", mDot::JoinModeStr(dot->getJoinMode()).c_str()); |
Mike Fiore |
11:d2e31743433a | 33 | if (dot->getJoinMode() == mDot::MANUAL || dot->getJoinMode() == mDot::PEER_TO_PEER) { |
Mike Fiore |
10:4d0b765f7b9e | 34 | logInfo("network address ---------- %s", mts::Text::bin2hexString(dot->getNetworkAddress()).c_str()); |
Mike Fiore |
10:4d0b765f7b9e | 35 | logInfo("network session key------- %s", mts::Text::bin2hexString(dot->getNetworkSessionKey()).c_str()); |
Mike Fiore |
10:4d0b765f7b9e | 36 | logInfo("data session key---------- %s", mts::Text::bin2hexString(dot->getDataSessionKey()).c_str()); |
Mike Fiore |
8:e667f4a507b1 | 37 | } else { |
Mike Fiore |
10:4d0b765f7b9e | 38 | logInfo("network name ------------- %s", dot->getNetworkName().c_str()); |
Mike Fiore |
10:4d0b765f7b9e | 39 | logInfo("network phrase ----------- %s", dot->getNetworkPassphrase().c_str()); |
Mike Fiore |
10:4d0b765f7b9e | 40 | logInfo("network EUI -------------- %s", mts::Text::bin2hexString(dot->getNetworkId()).c_str()); |
Mike Fiore |
10:4d0b765f7b9e | 41 | logInfo("network KEY -------------- %s", mts::Text::bin2hexString(dot->getNetworkKey()).c_str()); |
Mike Fiore |
8:e667f4a507b1 | 42 | } |
Mike Fiore |
10:4d0b765f7b9e | 43 | logInfo("========================"); |
mfiore | 0:a151a6350d7f | 44 | logInfo("communication parameters"); |
Mike Fiore |
10:4d0b765f7b9e | 45 | logInfo("========================"); |
Mike Fiore |
11:d2e31743433a | 46 | if (dot->getJoinMode() == mDot::PEER_TO_PEER) { |
Mike Fiore |
11:d2e31743433a | 47 | logInfo("TX frequency ------------- %lu", dot->getTxFrequency()); |
Mike Fiore |
11:d2e31743433a | 48 | } else { |
Mike Fiore |
11:d2e31743433a | 49 | logInfo("acks --------------------- %s, %u attempts", dot->getAck() > 0 ? "on" : "off", dot->getAck()); |
Mike Fiore |
11:d2e31743433a | 50 | } |
Mike Fiore |
10:4d0b765f7b9e | 51 | logInfo("TX datarate -------------- %s", mDot::DataRateStr(dot->getTxDataRate()).c_str()); |
Mike Fiore |
10:4d0b765f7b9e | 52 | logInfo("TX power ----------------- %lu dBm", dot->getTxPower()); |
Mike Fiore |
21:09d05faf0e13 | 53 | logInfo("antenna gain ------------- %u dBm", dot->getAntennaGain()); |
Mike Fiore |
21:09d05faf0e13 | 54 | logInfo("LBT ---------------------- %s", dot->getLbtTimeUs() ? "on" : "off"); |
Mike Fiore |
21:09d05faf0e13 | 55 | if (dot->getLbtTimeUs()) { |
Mike Fiore |
21:09d05faf0e13 | 56 | logInfo("LBT time ----------------- %lu us", dot->getLbtTimeUs()); |
Mike Fiore |
21:09d05faf0e13 | 57 | logInfo("LBT threshold ------------ %d dBm", dot->getLbtThreshold()); |
Mike Fiore |
21:09d05faf0e13 | 58 | } |
mfiore | 0:a151a6350d7f | 59 | } |
mfiore | 0:a151a6350d7f | 60 | |
Mike Fiore |
5:97ed5f2f099e | 61 | 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) { |
mfiore | 0:a151a6350d7f | 62 | std::string current_network_name = dot->getNetworkName(); |
mfiore | 0:a151a6350d7f | 63 | std::string current_network_passphrase = dot->getNetworkPassphrase(); |
mfiore | 0:a151a6350d7f | 64 | uint8_t current_frequency_sub_band = dot->getFrequencySubBand(); |
mfiore | 0:a151a6350d7f | 65 | bool current_public_network = dot->getPublicNetwork(); |
mfiore | 0:a151a6350d7f | 66 | uint8_t current_ack = dot->getAck(); |
mfiore | 0:a151a6350d7f | 67 | |
mfiore | 0:a151a6350d7f | 68 | if (current_network_name != network_name) { |
mfiore | 0:a151a6350d7f | 69 | logInfo("changing network name from \"%s\" to \"%s\"", current_network_name.c_str(), network_name.c_str()); |
mfiore | 0:a151a6350d7f | 70 | if (dot->setNetworkName(network_name) != mDot::MDOT_OK) { |
mfiore | 0:a151a6350d7f | 71 | logError("failed to set network name to \"%s\"", network_name.c_str()); |
mfiore | 0:a151a6350d7f | 72 | } |
mfiore | 0:a151a6350d7f | 73 | } |
mfiore | 0:a151a6350d7f | 74 | |
mfiore | 0:a151a6350d7f | 75 | if (current_network_passphrase != network_passphrase) { |
mfiore | 0:a151a6350d7f | 76 | logInfo("changing network passphrase from \"%s\" to \"%s\"", current_network_passphrase.c_str(), network_passphrase.c_str()); |
mfiore | 0:a151a6350d7f | 77 | if (dot->setNetworkPassphrase(network_passphrase) != mDot::MDOT_OK) { |
mfiore | 0:a151a6350d7f | 78 | logError("failed to set network passphrase to \"%s\"", network_passphrase.c_str()); |
mfiore | 0:a151a6350d7f | 79 | } |
mfiore | 0:a151a6350d7f | 80 | } |
mfiore | 0:a151a6350d7f | 81 | |
Mike Fiore |
21:09d05faf0e13 | 82 | if (lora::ChannelPlan::IsPlanFixed(dot->getFrequencyBand())) { |
Mike Fiore |
21:09d05faf0e13 | 83 | if (current_frequency_sub_band != frequency_sub_band) { |
Mike Fiore |
21:09d05faf0e13 | 84 | logInfo("changing frequency sub band from %u to %u", current_frequency_sub_band, frequency_sub_band); |
Mike Fiore |
21:09d05faf0e13 | 85 | if (dot->setFrequencySubBand(frequency_sub_band) != mDot::MDOT_OK) { |
Mike Fiore |
21:09d05faf0e13 | 86 | logError("failed to set frequency sub band to %u", frequency_sub_band); |
Mike Fiore |
21:09d05faf0e13 | 87 | } |
Mike Fiore |
21:09d05faf0e13 | 88 | } |
mfiore | 0:a151a6350d7f | 89 | } |
mfiore | 0:a151a6350d7f | 90 | |
mfiore | 0:a151a6350d7f | 91 | if (current_public_network != public_network) { |
Mike Fiore |
10:4d0b765f7b9e | 92 | logInfo("changing public network from %s to %s", current_public_network ? "on" : "off", public_network ? "on" : "off"); |
mfiore | 0:a151a6350d7f | 93 | if (dot->setPublicNetwork(public_network) != mDot::MDOT_OK) { |
Mike Fiore |
10:4d0b765f7b9e | 94 | logError("failed to set public network to %s", public_network ? "on" : "off"); |
mfiore | 0:a151a6350d7f | 95 | } |
mfiore | 0:a151a6350d7f | 96 | } |
mfiore | 0:a151a6350d7f | 97 | |
mfiore | 0:a151a6350d7f | 98 | if (current_ack != ack) { |
mfiore | 0:a151a6350d7f | 99 | logInfo("changing acks from %u to %u", current_ack, ack); |
mfiore | 0:a151a6350d7f | 100 | if (dot->setAck(ack) != mDot::MDOT_OK) { |
mfiore | 0:a151a6350d7f | 101 | logError("failed to set acks to %u", ack); |
mfiore | 0:a151a6350d7f | 102 | } |
mfiore | 0:a151a6350d7f | 103 | } |
mfiore | 0:a151a6350d7f | 104 | } |
mfiore | 0:a151a6350d7f | 105 | |
Mike Fiore |
5:97ed5f2f099e | 106 | 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) { |
Mike Fiore |
5:97ed5f2f099e | 107 | std::vector<uint8_t> current_network_id = dot->getNetworkId(); |
Mike Fiore |
5:97ed5f2f099e | 108 | std::vector<uint8_t> current_network_key = dot->getNetworkKey(); |
Mike Fiore |
5:97ed5f2f099e | 109 | uint8_t current_frequency_sub_band = dot->getFrequencySubBand(); |
Mike Fiore |
5:97ed5f2f099e | 110 | bool current_public_network = dot->getPublicNetwork(); |
Mike Fiore |
5:97ed5f2f099e | 111 | uint8_t current_ack = dot->getAck(); |
Mike Fiore |
5:97ed5f2f099e | 112 | |
Mike Fiore |
5:97ed5f2f099e | 113 | std::vector<uint8_t> network_id_vector(network_id, network_id + 8); |
Mike Fiore |
5:97ed5f2f099e | 114 | std::vector<uint8_t> network_key_vector(network_key, network_key + 16); |
Mike Fiore |
5:97ed5f2f099e | 115 | |
Mike Fiore |
5:97ed5f2f099e | 116 | if (current_network_id != network_id_vector) { |
Mike Fiore |
5:97ed5f2f099e | 117 | logInfo("changing network ID from \"%s\" to \"%s\"", mts::Text::bin2hexString(current_network_id).c_str(), mts::Text::bin2hexString(network_id_vector).c_str()); |
Mike Fiore |
5:97ed5f2f099e | 118 | if (dot->setNetworkId(network_id_vector) != mDot::MDOT_OK) { |
Mike Fiore |
5:97ed5f2f099e | 119 | logError("failed to set network ID to \"%s\"", mts::Text::bin2hexString(network_id_vector).c_str()); |
Mike Fiore |
5:97ed5f2f099e | 120 | } |
Mike Fiore |
5:97ed5f2f099e | 121 | } |
Mike Fiore |
5:97ed5f2f099e | 122 | |
Mike Fiore |
5:97ed5f2f099e | 123 | if (current_network_key != network_key_vector) { |
Mike Fiore |
5:97ed5f2f099e | 124 | logInfo("changing network KEY from \"%s\" to \"%s\"", mts::Text::bin2hexString(current_network_key).c_str(), mts::Text::bin2hexString(network_key_vector).c_str()); |
Mike Fiore |
5:97ed5f2f099e | 125 | if (dot->setNetworkKey(network_key_vector) != mDot::MDOT_OK) { |
Mike Fiore |
5:97ed5f2f099e | 126 | logError("failed to set network KEY to \"%s\"", mts::Text::bin2hexString(network_key_vector).c_str()); |
Mike Fiore |
5:97ed5f2f099e | 127 | } |
Mike Fiore |
5:97ed5f2f099e | 128 | } |
Mike Fiore |
5:97ed5f2f099e | 129 | |
Mike Fiore |
21:09d05faf0e13 | 130 | if (lora::ChannelPlan::IsPlanFixed(dot->getFrequencyBand())) { |
Mike Fiore |
21:09d05faf0e13 | 131 | if (current_frequency_sub_band != frequency_sub_band) { |
Mike Fiore |
21:09d05faf0e13 | 132 | logInfo("changing frequency sub band from %u to %u", current_frequency_sub_band, frequency_sub_band); |
Mike Fiore |
21:09d05faf0e13 | 133 | if (dot->setFrequencySubBand(frequency_sub_band) != mDot::MDOT_OK) { |
Mike Fiore |
21:09d05faf0e13 | 134 | logError("failed to set frequency sub band to %u", frequency_sub_band); |
Mike Fiore |
21:09d05faf0e13 | 135 | } |
Mike Fiore |
21:09d05faf0e13 | 136 | } |
Mike Fiore |
5:97ed5f2f099e | 137 | } |
Mike Fiore |
5:97ed5f2f099e | 138 | |
Mike Fiore |
5:97ed5f2f099e | 139 | if (current_public_network != public_network) { |
Mike Fiore |
10:4d0b765f7b9e | 140 | logInfo("changing public network from %s to %s", current_public_network ? "on" : "off", public_network ? "on" : "off"); |
Mike Fiore |
5:97ed5f2f099e | 141 | if (dot->setPublicNetwork(public_network) != mDot::MDOT_OK) { |
Mike Fiore |
10:4d0b765f7b9e | 142 | logError("failed to set public network to %s", public_network ? "on" : "off"); |
Mike Fiore |
5:97ed5f2f099e | 143 | } |
Mike Fiore |
5:97ed5f2f099e | 144 | } |
Mike Fiore |
5:97ed5f2f099e | 145 | |
Mike Fiore |
5:97ed5f2f099e | 146 | if (current_ack != ack) { |
Mike Fiore |
5:97ed5f2f099e | 147 | logInfo("changing acks from %u to %u", current_ack, ack); |
Mike Fiore |
5:97ed5f2f099e | 148 | if (dot->setAck(ack) != mDot::MDOT_OK) { |
Mike Fiore |
5:97ed5f2f099e | 149 | logError("failed to set acks to %u", ack); |
Mike Fiore |
5:97ed5f2f099e | 150 | } |
Mike Fiore |
5:97ed5f2f099e | 151 | } |
Mike Fiore |
5:97ed5f2f099e | 152 | } |
Mike Fiore |
5:97ed5f2f099e | 153 | |
Mike Fiore |
8:e667f4a507b1 | 154 | 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) { |
Mike Fiore |
8:e667f4a507b1 | 155 | std::vector<uint8_t> current_network_address = dot->getNetworkAddress(); |
Mike Fiore |
8:e667f4a507b1 | 156 | std::vector<uint8_t> current_network_session_key = dot->getNetworkSessionKey(); |
Mike Fiore |
8:e667f4a507b1 | 157 | std::vector<uint8_t> current_data_session_key = dot->getDataSessionKey(); |
Mike Fiore |
8:e667f4a507b1 | 158 | uint8_t current_frequency_sub_band = dot->getFrequencySubBand(); |
Mike Fiore |
8:e667f4a507b1 | 159 | bool current_public_network = dot->getPublicNetwork(); |
Mike Fiore |
8:e667f4a507b1 | 160 | uint8_t current_ack = dot->getAck(); |
Mike Fiore |
8:e667f4a507b1 | 161 | |
Mike Fiore |
8:e667f4a507b1 | 162 | std::vector<uint8_t> network_address_vector(network_address, network_address + 4); |
Mike Fiore |
8:e667f4a507b1 | 163 | std::vector<uint8_t> network_session_key_vector(network_session_key, network_session_key + 16); |
Mike Fiore |
8:e667f4a507b1 | 164 | std::vector<uint8_t> data_session_key_vector(data_session_key, data_session_key + 16); |
Mike Fiore |
8:e667f4a507b1 | 165 | |
Mike Fiore |
8:e667f4a507b1 | 166 | if (current_network_address != network_address_vector) { |
Mike Fiore |
8:e667f4a507b1 | 167 | logInfo("changing network address from \"%s\" to \"%s\"", mts::Text::bin2hexString(current_network_address).c_str(), mts::Text::bin2hexString(network_address_vector).c_str()); |
Mike Fiore |
8:e667f4a507b1 | 168 | if (dot->setNetworkAddress(network_address_vector) != mDot::MDOT_OK) { |
Mike Fiore |
8:e667f4a507b1 | 169 | logError("failed to set network address to \"%s\"", mts::Text::bin2hexString(network_address_vector).c_str()); |
Mike Fiore |
8:e667f4a507b1 | 170 | } |
Mike Fiore |
8:e667f4a507b1 | 171 | } |
Mike Fiore |
8:e667f4a507b1 | 172 | |
Mike Fiore |
8:e667f4a507b1 | 173 | if (current_network_session_key != network_session_key_vector) { |
Mike Fiore |
8:e667f4a507b1 | 174 | 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()); |
Mike Fiore |
8:e667f4a507b1 | 175 | if (dot->setNetworkSessionKey(network_session_key_vector) != mDot::MDOT_OK) { |
Mike Fiore |
8:e667f4a507b1 | 176 | logError("failed to set network session key to \"%s\"", mts::Text::bin2hexString(network_session_key_vector).c_str()); |
Mike Fiore |
8:e667f4a507b1 | 177 | } |
Mike Fiore |
8:e667f4a507b1 | 178 | } |
Mike Fiore |
8:e667f4a507b1 | 179 | |
Mike Fiore |
8:e667f4a507b1 | 180 | if (current_data_session_key != data_session_key_vector) { |
Mike Fiore |
8:e667f4a507b1 | 181 | 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()); |
Mike Fiore |
8:e667f4a507b1 | 182 | if (dot->setDataSessionKey(data_session_key_vector) != mDot::MDOT_OK) { |
Mike Fiore |
8:e667f4a507b1 | 183 | logError("failed to set data session key to \"%s\"", mts::Text::bin2hexString(data_session_key_vector).c_str()); |
Mike Fiore |
8:e667f4a507b1 | 184 | } |
Mike Fiore |
8:e667f4a507b1 | 185 | } |
Mike Fiore |
8:e667f4a507b1 | 186 | |
Mike Fiore |
8:e667f4a507b1 | 187 | if (current_frequency_sub_band != frequency_sub_band) { |
Mike Fiore |
8:e667f4a507b1 | 188 | logInfo("changing frequency sub band from %u to %u", current_frequency_sub_band, frequency_sub_band); |
Mike Fiore |
8:e667f4a507b1 | 189 | if (dot->setFrequencySubBand(frequency_sub_band) != mDot::MDOT_OK) { |
Mike Fiore |
8:e667f4a507b1 | 190 | logError("failed to set frequency sub band to %u", frequency_sub_band); |
Mike Fiore |
8:e667f4a507b1 | 191 | } |
Mike Fiore |
8:e667f4a507b1 | 192 | } |
Mike Fiore |
8:e667f4a507b1 | 193 | |
Mike Fiore |
8:e667f4a507b1 | 194 | if (current_public_network != public_network) { |
Mike Fiore |
10:4d0b765f7b9e | 195 | logInfo("changing public network from %s to %s", current_public_network ? "on" : "off", public_network ? "on" : "off"); |
Mike Fiore |
8:e667f4a507b1 | 196 | if (dot->setPublicNetwork(public_network) != mDot::MDOT_OK) { |
Mike Fiore |
10:4d0b765f7b9e | 197 | logError("failed to set public network to %s", public_network ? "on" : "off"); |
Mike Fiore |
8:e667f4a507b1 | 198 | } |
Mike Fiore |
8:e667f4a507b1 | 199 | } |
Mike Fiore |
8:e667f4a507b1 | 200 | |
Mike Fiore |
8:e667f4a507b1 | 201 | if (current_ack != ack) { |
Mike Fiore |
8:e667f4a507b1 | 202 | logInfo("changing acks from %u to %u", current_ack, ack); |
Mike Fiore |
8:e667f4a507b1 | 203 | if (dot->setAck(ack) != mDot::MDOT_OK) { |
Mike Fiore |
8:e667f4a507b1 | 204 | logError("failed to set acks to %u", ack); |
Mike Fiore |
8:e667f4a507b1 | 205 | } |
Mike Fiore |
8:e667f4a507b1 | 206 | } |
Mike Fiore |
8:e667f4a507b1 | 207 | } |
Mike Fiore |
8:e667f4a507b1 | 208 | |
Mike Fiore |
11:d2e31743433a | 209 | 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) { |
Mike Fiore |
11:d2e31743433a | 210 | std::vector<uint8_t> current_network_address = dot->getNetworkAddress(); |
Mike Fiore |
11:d2e31743433a | 211 | std::vector<uint8_t> current_network_session_key = dot->getNetworkSessionKey(); |
Mike Fiore |
11:d2e31743433a | 212 | std::vector<uint8_t> current_data_session_key = dot->getDataSessionKey(); |
Mike Fiore |
11:d2e31743433a | 213 | uint32_t current_tx_frequency = dot->getTxFrequency(); |
Mike Fiore |
11:d2e31743433a | 214 | uint8_t current_tx_datarate = dot->getTxDataRate(); |
Mike Fiore |
11:d2e31743433a | 215 | uint8_t current_tx_power = dot->getTxPower(); |
Mike Fiore |
11:d2e31743433a | 216 | |
Mike Fiore |
11:d2e31743433a | 217 | std::vector<uint8_t> network_address_vector(network_address, network_address + 4); |
Mike Fiore |
11:d2e31743433a | 218 | std::vector<uint8_t> network_session_key_vector(network_session_key, network_session_key + 16); |
Mike Fiore |
11:d2e31743433a | 219 | std::vector<uint8_t> data_session_key_vector(data_session_key, data_session_key + 16); |
Mike Fiore |
11:d2e31743433a | 220 | |
Mike Fiore |
11:d2e31743433a | 221 | if (current_network_address != network_address_vector) { |
Mike Fiore |
11:d2e31743433a | 222 | logInfo("changing network address from \"%s\" to \"%s\"", mts::Text::bin2hexString(current_network_address).c_str(), mts::Text::bin2hexString(network_address_vector).c_str()); |
Mike Fiore |
11:d2e31743433a | 223 | if (dot->setNetworkAddress(network_address_vector) != mDot::MDOT_OK) { |
Mike Fiore |
11:d2e31743433a | 224 | logError("failed to set network address to \"%s\"", mts::Text::bin2hexString(network_address_vector).c_str()); |
Mike Fiore |
11:d2e31743433a | 225 | } |
Mike Fiore |
11:d2e31743433a | 226 | } |
Mike Fiore |
11:d2e31743433a | 227 | |
Mike Fiore |
11:d2e31743433a | 228 | if (current_network_session_key != network_session_key_vector) { |
Mike Fiore |
11:d2e31743433a | 229 | 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()); |
Mike Fiore |
11:d2e31743433a | 230 | if (dot->setNetworkSessionKey(network_session_key_vector) != mDot::MDOT_OK) { |
Mike Fiore |
11:d2e31743433a | 231 | logError("failed to set network session key to \"%s\"", mts::Text::bin2hexString(network_session_key_vector).c_str()); |
Mike Fiore |
11:d2e31743433a | 232 | } |
Mike Fiore |
11:d2e31743433a | 233 | } |
Mike Fiore |
11:d2e31743433a | 234 | |
Mike Fiore |
11:d2e31743433a | 235 | if (current_data_session_key != data_session_key_vector) { |
Mike Fiore |
11:d2e31743433a | 236 | 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()); |
Mike Fiore |
11:d2e31743433a | 237 | if (dot->setDataSessionKey(data_session_key_vector) != mDot::MDOT_OK) { |
Mike Fiore |
11:d2e31743433a | 238 | logError("failed to set data session key to \"%s\"", mts::Text::bin2hexString(data_session_key_vector).c_str()); |
Mike Fiore |
11:d2e31743433a | 239 | } |
Mike Fiore |
11:d2e31743433a | 240 | } |
Mike Fiore |
11:d2e31743433a | 241 | |
Mike Fiore |
11:d2e31743433a | 242 | if (current_tx_frequency != tx_frequency) { |
Mike Fiore |
11:d2e31743433a | 243 | logInfo("changing TX frequency from %lu to %lu", current_tx_frequency, tx_frequency); |
Mike Fiore |
11:d2e31743433a | 244 | if (dot->setTxFrequency(tx_frequency) != mDot::MDOT_OK) { |
Mike Fiore |
11:d2e31743433a | 245 | logError("failed to set TX frequency to %lu", tx_frequency); |
Mike Fiore |
11:d2e31743433a | 246 | } |
Mike Fiore |
11:d2e31743433a | 247 | } |
Mike Fiore |
11:d2e31743433a | 248 | |
Mike Fiore |
11:d2e31743433a | 249 | if (current_tx_datarate != tx_datarate) { |
Mike Fiore |
11:d2e31743433a | 250 | logInfo("changing TX datarate from %u to %u", current_tx_datarate, tx_datarate); |
Mike Fiore |
11:d2e31743433a | 251 | if (dot->setTxDataRate(tx_datarate) != mDot::MDOT_OK) { |
Mike Fiore |
11:d2e31743433a | 252 | logError("failed to set TX datarate to %u", tx_datarate); |
Mike Fiore |
11:d2e31743433a | 253 | } |
Mike Fiore |
11:d2e31743433a | 254 | } |
Mike Fiore |
11:d2e31743433a | 255 | |
Mike Fiore |
11:d2e31743433a | 256 | if (current_tx_power != tx_power) { |
Mike Fiore |
11:d2e31743433a | 257 | logInfo("changing TX power from %u to %u", current_tx_power, tx_power); |
Mike Fiore |
11:d2e31743433a | 258 | if (dot->setTxPower(tx_power) != mDot::MDOT_OK) { |
Mike Fiore |
11:d2e31743433a | 259 | logError("failed to set TX power to %u", tx_power); |
Mike Fiore |
11:d2e31743433a | 260 | } |
Mike Fiore |
11:d2e31743433a | 261 | } |
Mike Fiore |
11:d2e31743433a | 262 | } |
Mike Fiore |
11:d2e31743433a | 263 | |
Mike Fiore |
15:364df461110f | 264 | void update_network_link_check_config(uint8_t link_check_count, uint8_t link_check_threshold) { |
Mike Fiore |
15:364df461110f | 265 | uint8_t current_link_check_count = dot->getLinkCheckCount(); |
Mike Fiore |
15:364df461110f | 266 | uint8_t current_link_check_threshold = dot->getLinkCheckThreshold(); |
Mike Fiore |
15:364df461110f | 267 | |
Mike Fiore |
15:364df461110f | 268 | if (current_link_check_count != link_check_count) { |
Mike Fiore |
15:364df461110f | 269 | logInfo("changing link check count from %u to %u", current_link_check_count, link_check_count); |
Mike Fiore |
15:364df461110f | 270 | if (dot->setLinkCheckCount(link_check_count) != mDot::MDOT_OK) { |
Mike Fiore |
15:364df461110f | 271 | logError("failed to set link check count to %u", link_check_count); |
Mike Fiore |
15:364df461110f | 272 | } |
Mike Fiore |
15:364df461110f | 273 | } |
Mike Fiore |
15:364df461110f | 274 | |
Mike Fiore |
15:364df461110f | 275 | if (current_link_check_threshold != link_check_threshold) { |
Mike Fiore |
15:364df461110f | 276 | logInfo("changing link check threshold from %u to %u", current_link_check_threshold, link_check_threshold); |
Mike Fiore |
15:364df461110f | 277 | if (dot->setLinkCheckThreshold(link_check_threshold) != mDot::MDOT_OK) { |
Mike Fiore |
15:364df461110f | 278 | logError("failed to set link check threshold to %u", link_check_threshold); |
Mike Fiore |
15:364df461110f | 279 | } |
Mike Fiore |
15:364df461110f | 280 | } |
Mike Fiore |
15:364df461110f | 281 | } |
Mike Fiore |
15:364df461110f | 282 | |
mfiore | 0:a151a6350d7f | 283 | void join_network() { |
mfiore | 0:a151a6350d7f | 284 | int32_t j_attempts = 0; |
mfiore | 0:a151a6350d7f | 285 | int32_t ret = mDot::MDOT_ERROR; |
mfiore | 0:a151a6350d7f | 286 | |
mfiore | 0:a151a6350d7f | 287 | // attempt to join the network |
mfiore | 0:a151a6350d7f | 288 | while (ret != mDot::MDOT_OK) { |
mfiore | 0:a151a6350d7f | 289 | logInfo("attempt %d to join network", ++j_attempts); |
mfiore | 0:a151a6350d7f | 290 | ret = dot->joinNetwork(); |
mfiore | 0:a151a6350d7f | 291 | if (ret != mDot::MDOT_OK) { |
mfiore | 0:a151a6350d7f | 292 | logError("failed to join network %d:%s", ret, mDot::getReturnCodeString(ret).c_str()); |
mfiore | 0:a151a6350d7f | 293 | // in some frequency bands we need to wait until another channel is available before transmitting again |
mfiore | 0:a151a6350d7f | 294 | uint32_t delay_s = (dot->getNextTxMs() / 1000) + 1; |
mfiore | 0:a151a6350d7f | 295 | if (delay_s < 2) { |
mfiore | 0:a151a6350d7f | 296 | logInfo("waiting %lu s until next free channel", delay_s); |
mfiore | 0:a151a6350d7f | 297 | wait(delay_s); |
mfiore | 0:a151a6350d7f | 298 | } else { |
mfiore | 0:a151a6350d7f | 299 | logInfo("sleeping %lu s until next free channel", delay_s); |
mfiore | 0:a151a6350d7f | 300 | dot->sleep(delay_s, mDot::RTC_ALARM, false); |
mfiore | 0:a151a6350d7f | 301 | } |
mfiore | 0:a151a6350d7f | 302 | } |
mfiore | 0:a151a6350d7f | 303 | } |
mfiore | 0:a151a6350d7f | 304 | } |
mfiore | 0:a151a6350d7f | 305 | |
mfiore | 0:a151a6350d7f | 306 | void sleep_wake_rtc_only(bool deepsleep) { |
mfiore | 0:a151a6350d7f | 307 | // in some frequency bands we need to wait until another channel is available before transmitting again |
mfiore | 0:a151a6350d7f | 308 | // wait at least 10s between transmissions |
mfiore | 0:a151a6350d7f | 309 | uint32_t delay_s = dot->getNextTxMs() / 1000; |
mfiore | 0:a151a6350d7f | 310 | if (delay_s < 10) { |
mfiore | 0:a151a6350d7f | 311 | delay_s = 10; |
mfiore | 0:a151a6350d7f | 312 | } |
mfiore | 0:a151a6350d7f | 313 | |
mfiore | 0:a151a6350d7f | 314 | logInfo("%ssleeping %lus", deepsleep ? "deep" : "", delay_s); |
mfiore | 0:a151a6350d7f | 315 | logInfo("application will %s after waking up", deepsleep ? "execute from beginning" : "resume"); |
Mike Fiore |
7:724cb82a113e | 316 | |
Mike Fiore |
7:724cb82a113e | 317 | // lowest current consumption in sleep mode can only be achieved by configuring IOs as analog inputs with no pull resistors |
Mike Fiore |
7:724cb82a113e | 318 | // the library handles all internal IOs automatically, but the external IOs are the application's responsibility |
Mike Fiore |
7:724cb82a113e | 319 | // certain IOs may require internal pullup or pulldown resistors because leaving them floating would cause extra current consumption |
Mike Fiore |
7:724cb82a113e | 320 | // for xDot: UART_*, I2C_*, SPI_*, GPIO*, WAKE |
Mike Fiore |
7:724cb82a113e | 321 | // for mDot: XBEE_*, USBTX, USBRX, PB_0, PB_1 |
Mike Fiore |
7:724cb82a113e | 322 | // steps are: |
Mike Fiore |
7:724cb82a113e | 323 | // * save IO configuration |
Mike Fiore |
7:724cb82a113e | 324 | // * configure IOs to reduce current consumption |
Mike Fiore |
7:724cb82a113e | 325 | // * sleep |
Mike Fiore |
7:724cb82a113e | 326 | // * restore IO configuration |
Mike Fiore |
7:724cb82a113e | 327 | if (! deepsleep) { |
Mike Fiore |
7:724cb82a113e | 328 | // save the GPIO state. |
Mike Fiore |
7:724cb82a113e | 329 | sleep_save_io(); |
Mike Fiore |
7:724cb82a113e | 330 | |
Mike Fiore |
7:724cb82a113e | 331 | // configure GPIOs for lowest current |
Mike Fiore |
7:724cb82a113e | 332 | sleep_configure_io(); |
Mike Fiore |
7:724cb82a113e | 333 | } |
mfiore | 0:a151a6350d7f | 334 | |
mfiore | 0:a151a6350d7f | 335 | // go to sleep/deepsleep for delay_s seconds and wake using the RTC alarm |
mfiore | 0:a151a6350d7f | 336 | dot->sleep(delay_s, mDot::RTC_ALARM, deepsleep); |
Mike Fiore |
7:724cb82a113e | 337 | |
Mike Fiore |
7:724cb82a113e | 338 | if (! deepsleep) { |
Mike Fiore |
7:724cb82a113e | 339 | // restore the GPIO state. |
Mike Fiore |
7:724cb82a113e | 340 | sleep_restore_io(); |
Mike Fiore |
7:724cb82a113e | 341 | } |
mfiore | 0:a151a6350d7f | 342 | } |
mfiore | 0:a151a6350d7f | 343 | |
mfiore | 0:a151a6350d7f | 344 | void sleep_wake_interrupt_only(bool deepsleep) { |
mfiore | 0:a151a6350d7f | 345 | #if defined (TARGET_XDOT_L151CC) |
mfiore | 0:a151a6350d7f | 346 | if (deepsleep) { |
mfiore | 0:a151a6350d7f | 347 | // for xDot, WAKE pin (connected to S2 on xDot-DK) is the only pin that can wake the processor from deepsleep |
mfiore | 0:a151a6350d7f | 348 | // it is automatically configured when INTERRUPT or RTC_ALARM_OR_INTERRUPT is the wakeup source and deepsleep is true in the mDot::sleep call |
mfiore | 0:a151a6350d7f | 349 | } else { |
mfiore | 0:a151a6350d7f | 350 | // configure WAKE pin (connected to S2 on xDot-DK) as the pin that will wake the xDot from low power modes |
mfiore | 0:a151a6350d7f | 351 | // other pins can be confgured instead: GPIO0-3 or UART_RX |
mfiore | 0:a151a6350d7f | 352 | dot->setWakePin(WAKE); |
mfiore | 0:a151a6350d7f | 353 | } |
mfiore | 0:a151a6350d7f | 354 | |
mfiore | 2:ffac7b141b72 | 355 | logInfo("%ssleeping until interrupt on %s pin", deepsleep ? "deep" : "", deepsleep ? "WAKE" : mDot::pinName2Str(dot->getWakePin()).c_str()); |
mfiore | 0:a151a6350d7f | 356 | #else |
Mike Fiore |
7:724cb82a113e | 357 | |
mfiore | 0:a151a6350d7f | 358 | if (deepsleep) { |
mfiore | 0:a151a6350d7f | 359 | // for mDot, XBEE_DIO7 pin is the only pin that can wake the processor from deepsleep |
mfiore | 0:a151a6350d7f | 360 | // it is automatically configured when INTERRUPT or RTC_ALARM_OR_INTERRUPT is the wakeup source and deepsleep is true in the mDot::sleep call |
mfiore | 0:a151a6350d7f | 361 | } else { |
mfiore | 0:a151a6350d7f | 362 | // configure XBEE_DIO7 pin as the pin that will wake the mDot from low power modes |
mfiore | 0:a151a6350d7f | 363 | // other pins can be confgured instead: XBEE_DIO2-6, XBEE_DI8, XBEE_DIN |
mfiore | 0:a151a6350d7f | 364 | dot->setWakePin(XBEE_DIO7); |
mfiore | 0:a151a6350d7f | 365 | } |
mfiore | 0:a151a6350d7f | 366 | |
mfiore | 2:ffac7b141b72 | 367 | logInfo("%ssleeping until interrupt on %s pin", deepsleep ? "deep" : "", deepsleep ? "DIO7" : mDot::pinName2Str(dot->getWakePin()).c_str()); |
mfiore | 0:a151a6350d7f | 368 | #endif |
mfiore | 0:a151a6350d7f | 369 | |
mfiore | 0:a151a6350d7f | 370 | logInfo("application will %s after waking up", deepsleep ? "execute from beginning" : "resume"); |
Mike Fiore |
7:724cb82a113e | 371 | |
Mike Fiore |
7:724cb82a113e | 372 | // lowest current consumption in sleep mode can only be achieved by configuring IOs as analog inputs with no pull resistors |
Mike Fiore |
7:724cb82a113e | 373 | // the library handles all internal IOs automatically, but the external IOs are the application's responsibility |
Mike Fiore |
7:724cb82a113e | 374 | // certain IOs may require internal pullup or pulldown resistors because leaving them floating would cause extra current consumption |
Mike Fiore |
7:724cb82a113e | 375 | // for xDot: UART_*, I2C_*, SPI_*, GPIO*, WAKE |
Mike Fiore |
7:724cb82a113e | 376 | // for mDot: XBEE_*, USBTX, USBRX, PB_0, PB_1 |
Mike Fiore |
7:724cb82a113e | 377 | // steps are: |
Mike Fiore |
7:724cb82a113e | 378 | // * save IO configuration |
Mike Fiore |
7:724cb82a113e | 379 | // * configure IOs to reduce current consumption |
Mike Fiore |
7:724cb82a113e | 380 | // * sleep |
Mike Fiore |
7:724cb82a113e | 381 | // * restore IO configuration |
Mike Fiore |
7:724cb82a113e | 382 | if (! deepsleep) { |
Mike Fiore |
7:724cb82a113e | 383 | // save the GPIO state. |
Mike Fiore |
7:724cb82a113e | 384 | sleep_save_io(); |
Mike Fiore |
7:724cb82a113e | 385 | |
Mike Fiore |
7:724cb82a113e | 386 | // configure GPIOs for lowest current |
Mike Fiore |
7:724cb82a113e | 387 | sleep_configure_io(); |
Mike Fiore |
7:724cb82a113e | 388 | } |
mfiore | 0:a151a6350d7f | 389 | |
mfiore | 0:a151a6350d7f | 390 | // go to sleep/deepsleep and wake on rising edge of configured wake pin (only the WAKE pin in deepsleep) |
mfiore | 0:a151a6350d7f | 391 | // since we're not waking on the RTC alarm, the interval is ignored |
mfiore | 0:a151a6350d7f | 392 | dot->sleep(0, mDot::INTERRUPT, deepsleep); |
Mike Fiore |
7:724cb82a113e | 393 | |
Mike Fiore |
7:724cb82a113e | 394 | if (! deepsleep) { |
Mike Fiore |
7:724cb82a113e | 395 | // restore the GPIO state. |
Mike Fiore |
7:724cb82a113e | 396 | sleep_restore_io(); |
Mike Fiore |
7:724cb82a113e | 397 | } |
mfiore | 0:a151a6350d7f | 398 | } |
mfiore | 0:a151a6350d7f | 399 | |
mfiore | 0:a151a6350d7f | 400 | void sleep_wake_rtc_or_interrupt(bool deepsleep) { |
mfiore | 0:a151a6350d7f | 401 | // in some frequency bands we need to wait until another channel is available before transmitting again |
mfiore | 0:a151a6350d7f | 402 | // wait at least 10s between transmissions |
mfiore | 0:a151a6350d7f | 403 | uint32_t delay_s = dot->getNextTxMs() / 1000; |
mfiore | 0:a151a6350d7f | 404 | if (delay_s < 10) { |
mfiore | 0:a151a6350d7f | 405 | delay_s = 10; |
mfiore | 0:a151a6350d7f | 406 | } |
mfiore | 0:a151a6350d7f | 407 | |
mfiore | 0:a151a6350d7f | 408 | #if defined (TARGET_XDOT_L151CC) |
mfiore | 0:a151a6350d7f | 409 | if (deepsleep) { |
mfiore | 0:a151a6350d7f | 410 | // for xDot, WAKE pin (connected to S2 on xDot-DK) is the only pin that can wake the processor from deepsleep |
mfiore | 0:a151a6350d7f | 411 | // it is automatically configured when INTERRUPT or RTC_ALARM_OR_INTERRUPT is the wakeup source and deepsleep is true in the mDot::sleep call |
mfiore | 0:a151a6350d7f | 412 | } else { |
mfiore | 0:a151a6350d7f | 413 | // configure WAKE pin (connected to S2 on xDot-DK) as the pin that will wake the xDot from low power modes |
mfiore | 0:a151a6350d7f | 414 | // other pins can be confgured instead: GPIO0-3 or UART_RX |
mfiore | 0:a151a6350d7f | 415 | dot->setWakePin(WAKE); |
mfiore | 0:a151a6350d7f | 416 | } |
mfiore | 0:a151a6350d7f | 417 | |
mfiore | 2:ffac7b141b72 | 418 | logInfo("%ssleeping %lus or until interrupt on %s pin", deepsleep ? "deep" : "", delay_s, deepsleep ? "WAKE" : mDot::pinName2Str(dot->getWakePin()).c_str()); |
mfiore | 0:a151a6350d7f | 419 | #else |
mfiore | 0:a151a6350d7f | 420 | if (deepsleep) { |
mfiore | 0:a151a6350d7f | 421 | // for mDot, XBEE_DIO7 pin is the only pin that can wake the processor from deepsleep |
mfiore | 0:a151a6350d7f | 422 | // it is automatically configured when INTERRUPT or RTC_ALARM_OR_INTERRUPT is the wakeup source and deepsleep is true in the mDot::sleep call |
mfiore | 0:a151a6350d7f | 423 | } else { |
mfiore | 0:a151a6350d7f | 424 | // configure XBEE_DIO7 pin as the pin that will wake the mDot from low power modes |
mfiore | 0:a151a6350d7f | 425 | // other pins can be confgured instead: XBEE_DIO2-6, XBEE_DI8, XBEE_DIN |
mfiore | 0:a151a6350d7f | 426 | dot->setWakePin(XBEE_DIO7); |
mfiore | 0:a151a6350d7f | 427 | } |
mfiore | 0:a151a6350d7f | 428 | |
mfiore | 2:ffac7b141b72 | 429 | logInfo("%ssleeping %lus or until interrupt on %s pin", deepsleep ? "deep" : "", delay_s, deepsleep ? "DIO7" : mDot::pinName2Str(dot->getWakePin()).c_str()); |
mfiore | 0:a151a6350d7f | 430 | #endif |
mfiore | 0:a151a6350d7f | 431 | |
mfiore | 0:a151a6350d7f | 432 | logInfo("application will %s after waking up", deepsleep ? "execute from beginning" : "resume"); |
mfiore | 0:a151a6350d7f | 433 | |
Mike Fiore |
7:724cb82a113e | 434 | // lowest current consumption in sleep mode can only be achieved by configuring IOs as analog inputs with no pull resistors |
Mike Fiore |
7:724cb82a113e | 435 | // the library handles all internal IOs automatically, but the external IOs are the application's responsibility |
Mike Fiore |
7:724cb82a113e | 436 | // certain IOs may require internal pullup or pulldown resistors because leaving them floating would cause extra current consumption |
Mike Fiore |
7:724cb82a113e | 437 | // for xDot: UART_*, I2C_*, SPI_*, GPIO*, WAKE |
Mike Fiore |
7:724cb82a113e | 438 | // for mDot: XBEE_*, USBTX, USBRX, PB_0, PB_1 |
Mike Fiore |
7:724cb82a113e | 439 | // steps are: |
Mike Fiore |
7:724cb82a113e | 440 | // * save IO configuration |
Mike Fiore |
7:724cb82a113e | 441 | // * configure IOs to reduce current consumption |
Mike Fiore |
7:724cb82a113e | 442 | // * sleep |
Mike Fiore |
7:724cb82a113e | 443 | // * restore IO configuration |
Mike Fiore |
7:724cb82a113e | 444 | if (! deepsleep) { |
Mike Fiore |
7:724cb82a113e | 445 | // save the GPIO state. |
Mike Fiore |
7:724cb82a113e | 446 | sleep_save_io(); |
Mike Fiore |
7:724cb82a113e | 447 | |
Mike Fiore |
7:724cb82a113e | 448 | // configure GPIOs for lowest current |
Mike Fiore |
7:724cb82a113e | 449 | sleep_configure_io(); |
Mike Fiore |
7:724cb82a113e | 450 | } |
Mike Fiore |
7:724cb82a113e | 451 | |
mfiore | 0:a151a6350d7f | 452 | // 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) |
mfiore | 0:a151a6350d7f | 453 | // whichever comes first will wake the xDot |
mfiore | 0:a151a6350d7f | 454 | dot->sleep(delay_s, mDot::RTC_ALARM_OR_INTERRUPT, deepsleep); |
Mike Fiore |
7:724cb82a113e | 455 | |
Mike Fiore |
7:724cb82a113e | 456 | if (! deepsleep) { |
Mike Fiore |
7:724cb82a113e | 457 | // restore the GPIO state. |
Mike Fiore |
7:724cb82a113e | 458 | sleep_restore_io(); |
Mike Fiore |
7:724cb82a113e | 459 | } |
Mike Fiore |
7:724cb82a113e | 460 | } |
Mike Fiore |
7:724cb82a113e | 461 | |
Mike Fiore |
7:724cb82a113e | 462 | void sleep_save_io() { |
Mike Fiore |
7:724cb82a113e | 463 | #if defined(TARGET_XDOT_L151CC) |
Mike Fiore |
7:724cb82a113e | 464 | xdot_save_gpio_state(); |
Mike Fiore |
7:724cb82a113e | 465 | #else |
Mike Fiore |
7:724cb82a113e | 466 | portA[0] = GPIOA->MODER; |
Mike Fiore |
7:724cb82a113e | 467 | portA[1] = GPIOA->OTYPER; |
Mike Fiore |
7:724cb82a113e | 468 | portA[2] = GPIOA->OSPEEDR; |
Mike Fiore |
7:724cb82a113e | 469 | portA[3] = GPIOA->PUPDR; |
Mike Fiore |
7:724cb82a113e | 470 | portA[4] = GPIOA->AFR[0]; |
Mike Fiore |
7:724cb82a113e | 471 | portA[5] = GPIOA->AFR[1]; |
Mike Fiore |
7:724cb82a113e | 472 | |
Mike Fiore |
7:724cb82a113e | 473 | portB[0] = GPIOB->MODER; |
Mike Fiore |
7:724cb82a113e | 474 | portB[1] = GPIOB->OTYPER; |
Mike Fiore |
7:724cb82a113e | 475 | portB[2] = GPIOB->OSPEEDR; |
Mike Fiore |
7:724cb82a113e | 476 | portB[3] = GPIOB->PUPDR; |
Mike Fiore |
7:724cb82a113e | 477 | portB[4] = GPIOB->AFR[0]; |
Mike Fiore |
7:724cb82a113e | 478 | portB[5] = GPIOB->AFR[1]; |
Mike Fiore |
7:724cb82a113e | 479 | |
Mike Fiore |
7:724cb82a113e | 480 | portC[0] = GPIOC->MODER; |
Mike Fiore |
7:724cb82a113e | 481 | portC[1] = GPIOC->OTYPER; |
Mike Fiore |
7:724cb82a113e | 482 | portC[2] = GPIOC->OSPEEDR; |
Mike Fiore |
7:724cb82a113e | 483 | portC[3] = GPIOC->PUPDR; |
Mike Fiore |
7:724cb82a113e | 484 | portC[4] = GPIOC->AFR[0]; |
Mike Fiore |
7:724cb82a113e | 485 | portC[5] = GPIOC->AFR[1]; |
Mike Fiore |
7:724cb82a113e | 486 | |
Mike Fiore |
7:724cb82a113e | 487 | portD[0] = GPIOD->MODER; |
Mike Fiore |
7:724cb82a113e | 488 | portD[1] = GPIOD->OTYPER; |
Mike Fiore |
7:724cb82a113e | 489 | portD[2] = GPIOD->OSPEEDR; |
Mike Fiore |
7:724cb82a113e | 490 | portD[3] = GPIOD->PUPDR; |
Mike Fiore |
7:724cb82a113e | 491 | portD[4] = GPIOD->AFR[0]; |
Mike Fiore |
7:724cb82a113e | 492 | portD[5] = GPIOD->AFR[1]; |
Mike Fiore |
7:724cb82a113e | 493 | |
Mike Fiore |
7:724cb82a113e | 494 | portH[0] = GPIOH->MODER; |
Mike Fiore |
7:724cb82a113e | 495 | portH[1] = GPIOH->OTYPER; |
Mike Fiore |
7:724cb82a113e | 496 | portH[2] = GPIOH->OSPEEDR; |
Mike Fiore |
7:724cb82a113e | 497 | portH[3] = GPIOH->PUPDR; |
Mike Fiore |
7:724cb82a113e | 498 | portH[4] = GPIOH->AFR[0]; |
Mike Fiore |
7:724cb82a113e | 499 | portH[5] = GPIOH->AFR[1]; |
Mike Fiore |
7:724cb82a113e | 500 | #endif |
Mike Fiore |
7:724cb82a113e | 501 | } |
Mike Fiore |
7:724cb82a113e | 502 | |
Mike Fiore |
7:724cb82a113e | 503 | void sleep_configure_io() { |
Mike Fiore |
7:724cb82a113e | 504 | #if defined(TARGET_XDOT_L151CC) |
Mike Fiore |
7:724cb82a113e | 505 | // GPIO Ports Clock Enable |
Mike Fiore |
7:724cb82a113e | 506 | __GPIOA_CLK_ENABLE(); |
Mike Fiore |
7:724cb82a113e | 507 | __GPIOB_CLK_ENABLE(); |
Mike Fiore |
7:724cb82a113e | 508 | __GPIOC_CLK_ENABLE(); |
Mike Fiore |
7:724cb82a113e | 509 | __GPIOH_CLK_ENABLE(); |
Mike Fiore |
7:724cb82a113e | 510 | |
Mike Fiore |
7:724cb82a113e | 511 | GPIO_InitTypeDef GPIO_InitStruct; |
Mike Fiore |
7:724cb82a113e | 512 | |
Mike Fiore |
7:724cb82a113e | 513 | // UART1_TX, UART1_RTS & UART1_CTS to analog nopull - RX could be a wakeup source |
Mike Fiore |
7:724cb82a113e | 514 | GPIO_InitStruct.Pin = GPIO_PIN_9 | GPIO_PIN_11 | GPIO_PIN_12; |
Mike Fiore |
7:724cb82a113e | 515 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 516 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 517 | HAL_GPIO_Init(GPIOA, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 518 | |
Mike Fiore |
7:724cb82a113e | 519 | // I2C_SDA & I2C_SCL to analog nopull |
Mike Fiore |
7:724cb82a113e | 520 | GPIO_InitStruct.Pin = GPIO_PIN_8 | GPIO_PIN_9; |
Mike Fiore |
7:724cb82a113e | 521 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 522 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 523 | HAL_GPIO_Init(GPIOB, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 524 | |
Mike Fiore |
7:724cb82a113e | 525 | // SPI_MOSI, SPI_MISO, SPI_SCK, & SPI_NSS to analog nopull |
Mike Fiore |
7:724cb82a113e | 526 | GPIO_InitStruct.Pin = GPIO_PIN_12 | GPIO_PIN_13 | GPIO_PIN_14 | GPIO_PIN_15; |
Mike Fiore |
7:724cb82a113e | 527 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 528 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 529 | HAL_GPIO_Init(GPIOB, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 530 | |
Mike Fiore |
7:724cb82a113e | 531 | // iterate through potential wake pins - leave the configured wake pin alone if one is needed |
Mike Fiore |
7:724cb82a113e | 532 | if (dot->getWakePin() != WAKE || dot->getWakeMode() == mDot::RTC_ALARM) { |
Mike Fiore |
7:724cb82a113e | 533 | GPIO_InitStruct.Pin = GPIO_PIN_0; |
Mike Fiore |
7:724cb82a113e | 534 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 535 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 536 | HAL_GPIO_Init(GPIOA, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 537 | } |
Mike Fiore |
7:724cb82a113e | 538 | if (dot->getWakePin() != GPIO0 || dot->getWakeMode() == mDot::RTC_ALARM) { |
Mike Fiore |
7:724cb82a113e | 539 | GPIO_InitStruct.Pin = GPIO_PIN_4; |
Mike Fiore |
7:724cb82a113e | 540 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 541 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 542 | HAL_GPIO_Init(GPIOA, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 543 | } |
Mike Fiore |
7:724cb82a113e | 544 | if (dot->getWakePin() != GPIO1 || dot->getWakeMode() == mDot::RTC_ALARM) { |
Mike Fiore |
7:724cb82a113e | 545 | GPIO_InitStruct.Pin = GPIO_PIN_5; |
Mike Fiore |
7:724cb82a113e | 546 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 547 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 548 | HAL_GPIO_Init(GPIOA, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 549 | } |
Mike Fiore |
7:724cb82a113e | 550 | if (dot->getWakePin() != GPIO2 || dot->getWakeMode() == mDot::RTC_ALARM) { |
Mike Fiore |
7:724cb82a113e | 551 | GPIO_InitStruct.Pin = GPIO_PIN_0; |
Mike Fiore |
7:724cb82a113e | 552 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 553 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 554 | HAL_GPIO_Init(GPIOB, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 555 | } |
Mike Fiore |
7:724cb82a113e | 556 | if (dot->getWakePin() != GPIO3 || dot->getWakeMode() == mDot::RTC_ALARM) { |
Mike Fiore |
7:724cb82a113e | 557 | GPIO_InitStruct.Pin = GPIO_PIN_2; |
Mike Fiore |
7:724cb82a113e | 558 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 559 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 560 | HAL_GPIO_Init(GPIOB, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 561 | } |
Mike Fiore |
7:724cb82a113e | 562 | if (dot->getWakePin() != UART1_RX || dot->getWakeMode() == mDot::RTC_ALARM) { |
Mike Fiore |
7:724cb82a113e | 563 | GPIO_InitStruct.Pin = GPIO_PIN_10; |
Mike Fiore |
7:724cb82a113e | 564 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 565 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 566 | HAL_GPIO_Init(GPIOA, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 567 | } |
Mike Fiore |
7:724cb82a113e | 568 | #else |
Mike Fiore |
7:724cb82a113e | 569 | /* GPIO Ports Clock Enable */ |
Mike Fiore |
7:724cb82a113e | 570 | __GPIOA_CLK_ENABLE(); |
Mike Fiore |
7:724cb82a113e | 571 | __GPIOB_CLK_ENABLE(); |
Mike Fiore |
7:724cb82a113e | 572 | __GPIOC_CLK_ENABLE(); |
Mike Fiore |
7:724cb82a113e | 573 | |
Mike Fiore |
7:724cb82a113e | 574 | GPIO_InitTypeDef GPIO_InitStruct; |
Mike Fiore |
7:724cb82a113e | 575 | |
Mike Fiore |
7:724cb82a113e | 576 | // XBEE_DOUT, XBEE_DIN, XBEE_DO8, XBEE_RSSI, USBTX, USBRX, PA_12, PA_13, PA_14 & PA_15 to analog nopull |
Mike Fiore |
7:724cb82a113e | 577 | GPIO_InitStruct.Pin = GPIO_PIN_2 | GPIO_PIN_6 | GPIO_PIN_8 | GPIO_PIN_9 | GPIO_PIN_10 |
Mike Fiore |
7:724cb82a113e | 578 | | GPIO_PIN_12 | GPIO_PIN_13 | GPIO_PIN_14 | GPIO_PIN_15; |
Mike Fiore |
7:724cb82a113e | 579 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 580 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 581 | HAL_GPIO_Init(GPIOA, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 582 | |
Mike Fiore |
7:724cb82a113e | 583 | // PB_0, PB_1, PB_3 & PB_4 to analog nopull |
Mike Fiore |
7:724cb82a113e | 584 | GPIO_InitStruct.Pin = GPIO_PIN_0 | GPIO_PIN_1 | GPIO_PIN_3 | GPIO_PIN_4; |
Mike Fiore |
7:724cb82a113e | 585 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 586 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 587 | HAL_GPIO_Init(GPIOB, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 588 | |
Mike Fiore |
7:724cb82a113e | 589 | // PC_9 & PC_13 to analog nopull |
Mike Fiore |
7:724cb82a113e | 590 | GPIO_InitStruct.Pin = GPIO_PIN_9 | GPIO_PIN_13; |
Mike Fiore |
7:724cb82a113e | 591 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 592 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 593 | HAL_GPIO_Init(GPIOC, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 594 | |
Mike Fiore |
7:724cb82a113e | 595 | // iterate through potential wake pins - leave the configured wake pin alone if one is needed |
Mike Fiore |
7:724cb82a113e | 596 | // XBEE_DIN - PA3 |
Mike Fiore |
7:724cb82a113e | 597 | // XBEE_DIO2 - PA5 |
Mike Fiore |
7:724cb82a113e | 598 | // XBEE_DIO3 - PA4 |
Mike Fiore |
7:724cb82a113e | 599 | // XBEE_DIO4 - PA7 |
Mike Fiore |
7:724cb82a113e | 600 | // XBEE_DIO5 - PC1 |
Mike Fiore |
7:724cb82a113e | 601 | // XBEE_DIO6 - PA1 |
Mike Fiore |
7:724cb82a113e | 602 | // XBEE_DIO7 - PA0 |
Mike Fiore |
7:724cb82a113e | 603 | // XBEE_SLEEPRQ - PA11 |
Mike Fiore |
7:724cb82a113e | 604 | |
Mike Fiore |
7:724cb82a113e | 605 | if (dot->getWakePin() != XBEE_DIN || dot->getWakeMode() == mDot::RTC_ALARM) { |
Mike Fiore |
7:724cb82a113e | 606 | GPIO_InitStruct.Pin = GPIO_PIN_3; |
Mike Fiore |
7:724cb82a113e | 607 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 608 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 609 | HAL_GPIO_Init(GPIOA, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 610 | } |
Mike Fiore |
7:724cb82a113e | 611 | |
Mike Fiore |
7:724cb82a113e | 612 | if (dot->getWakePin() != XBEE_DIO2 || dot->getWakeMode() == mDot::RTC_ALARM) { |
Mike Fiore |
7:724cb82a113e | 613 | GPIO_InitStruct.Pin = GPIO_PIN_5; |
Mike Fiore |
7:724cb82a113e | 614 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 615 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 616 | HAL_GPIO_Init(GPIOA, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 617 | } |
Mike Fiore |
7:724cb82a113e | 618 | |
Mike Fiore |
7:724cb82a113e | 619 | if (dot->getWakePin() != XBEE_DIO3 || dot->getWakeMode() == mDot::RTC_ALARM) { |
Mike Fiore |
7:724cb82a113e | 620 | GPIO_InitStruct.Pin = GPIO_PIN_4; |
Mike Fiore |
7:724cb82a113e | 621 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 622 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 623 | HAL_GPIO_Init(GPIOA, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 624 | } |
Mike Fiore |
7:724cb82a113e | 625 | |
Mike Fiore |
7:724cb82a113e | 626 | if (dot->getWakePin() != XBEE_DIO4 || dot->getWakeMode() == mDot::RTC_ALARM) { |
Mike Fiore |
7:724cb82a113e | 627 | GPIO_InitStruct.Pin = GPIO_PIN_7; |
Mike Fiore |
7:724cb82a113e | 628 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 629 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 630 | HAL_GPIO_Init(GPIOA, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 631 | } |
Mike Fiore |
7:724cb82a113e | 632 | |
Mike Fiore |
7:724cb82a113e | 633 | if (dot->getWakePin() != XBEE_DIO5 || dot->getWakeMode() == mDot::RTC_ALARM) { |
Mike Fiore |
7:724cb82a113e | 634 | GPIO_InitStruct.Pin = GPIO_PIN_1; |
Mike Fiore |
7:724cb82a113e | 635 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 636 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 637 | HAL_GPIO_Init(GPIOC, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 638 | } |
Mike Fiore |
7:724cb82a113e | 639 | |
Mike Fiore |
7:724cb82a113e | 640 | if (dot->getWakePin() != XBEE_DIO6 || dot->getWakeMode() == mDot::RTC_ALARM) { |
Mike Fiore |
7:724cb82a113e | 641 | GPIO_InitStruct.Pin = GPIO_PIN_1; |
Mike Fiore |
7:724cb82a113e | 642 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 643 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 644 | HAL_GPIO_Init(GPIOA, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 645 | } |
Mike Fiore |
7:724cb82a113e | 646 | |
Mike Fiore |
7:724cb82a113e | 647 | if (dot->getWakePin() != XBEE_DIO7 || dot->getWakeMode() == mDot::RTC_ALARM) { |
Mike Fiore |
7:724cb82a113e | 648 | GPIO_InitStruct.Pin = GPIO_PIN_0; |
Mike Fiore |
7:724cb82a113e | 649 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 650 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 651 | HAL_GPIO_Init(GPIOA, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 652 | } |
Mike Fiore |
7:724cb82a113e | 653 | |
Mike Fiore |
7:724cb82a113e | 654 | if (dot->getWakePin() != XBEE_SLEEPRQ|| dot->getWakeMode() == mDot::RTC_ALARM) { |
Mike Fiore |
7:724cb82a113e | 655 | GPIO_InitStruct.Pin = GPIO_PIN_11; |
Mike Fiore |
7:724cb82a113e | 656 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
Mike Fiore |
7:724cb82a113e | 657 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
Mike Fiore |
7:724cb82a113e | 658 | HAL_GPIO_Init(GPIOA, &GPIO_InitStruct); |
Mike Fiore |
7:724cb82a113e | 659 | } |
Mike Fiore |
7:724cb82a113e | 660 | #endif |
Mike Fiore |
7:724cb82a113e | 661 | } |
Mike Fiore |
7:724cb82a113e | 662 | |
Mike Fiore |
7:724cb82a113e | 663 | void sleep_restore_io() { |
Mike Fiore |
7:724cb82a113e | 664 | #if defined(TARGET_XDOT_L151CC) |
Mike Fiore |
7:724cb82a113e | 665 | xdot_restore_gpio_state(); |
Mike Fiore |
7:724cb82a113e | 666 | #else |
Mike Fiore |
7:724cb82a113e | 667 | GPIOA->MODER = portA[0]; |
Mike Fiore |
7:724cb82a113e | 668 | GPIOA->OTYPER = portA[1]; |
Mike Fiore |
7:724cb82a113e | 669 | GPIOA->OSPEEDR = portA[2]; |
Mike Fiore |
7:724cb82a113e | 670 | GPIOA->PUPDR = portA[3]; |
Mike Fiore |
7:724cb82a113e | 671 | GPIOA->AFR[0] = portA[4]; |
Mike Fiore |
7:724cb82a113e | 672 | GPIOA->AFR[1] = portA[5]; |
Mike Fiore |
7:724cb82a113e | 673 | |
Mike Fiore |
7:724cb82a113e | 674 | GPIOB->MODER = portB[0]; |
Mike Fiore |
7:724cb82a113e | 675 | GPIOB->OTYPER = portB[1]; |
Mike Fiore |
7:724cb82a113e | 676 | GPIOB->OSPEEDR = portB[2]; |
Mike Fiore |
7:724cb82a113e | 677 | GPIOB->PUPDR = portB[3]; |
Mike Fiore |
7:724cb82a113e | 678 | GPIOB->AFR[0] = portB[4]; |
Mike Fiore |
7:724cb82a113e | 679 | GPIOB->AFR[1] = portB[5]; |
Mike Fiore |
7:724cb82a113e | 680 | |
Mike Fiore |
7:724cb82a113e | 681 | GPIOC->MODER = portC[0]; |
Mike Fiore |
7:724cb82a113e | 682 | GPIOC->OTYPER = portC[1]; |
Mike Fiore |
7:724cb82a113e | 683 | GPIOC->OSPEEDR = portC[2]; |
Mike Fiore |
7:724cb82a113e | 684 | GPIOC->PUPDR = portC[3]; |
Mike Fiore |
7:724cb82a113e | 685 | GPIOC->AFR[0] = portC[4]; |
Mike Fiore |
7:724cb82a113e | 686 | GPIOC->AFR[1] = portC[5]; |
Mike Fiore |
7:724cb82a113e | 687 | |
Mike Fiore |
7:724cb82a113e | 688 | GPIOD->MODER = portD[0]; |
Mike Fiore |
7:724cb82a113e | 689 | GPIOD->OTYPER = portD[1]; |
Mike Fiore |
7:724cb82a113e | 690 | GPIOD->OSPEEDR = portD[2]; |
Mike Fiore |
7:724cb82a113e | 691 | GPIOD->PUPDR = portD[3]; |
Mike Fiore |
7:724cb82a113e | 692 | GPIOD->AFR[0] = portD[4]; |
Mike Fiore |
7:724cb82a113e | 693 | GPIOD->AFR[1] = portD[5]; |
Mike Fiore |
7:724cb82a113e | 694 | |
Mike Fiore |
7:724cb82a113e | 695 | GPIOH->MODER = portH[0]; |
Mike Fiore |
7:724cb82a113e | 696 | GPIOH->OTYPER = portH[1]; |
Mike Fiore |
7:724cb82a113e | 697 | GPIOH->OSPEEDR = portH[2]; |
Mike Fiore |
7:724cb82a113e | 698 | GPIOH->PUPDR = portH[3]; |
Mike Fiore |
7:724cb82a113e | 699 | GPIOH->AFR[0] = portH[4]; |
Mike Fiore |
7:724cb82a113e | 700 | GPIOH->AFR[1] = portH[5]; |
Mike Fiore |
7:724cb82a113e | 701 | #endif |
mfiore | 0:a151a6350d7f | 702 | } |
mfiore | 0:a151a6350d7f | 703 | |
mfiore | 0:a151a6350d7f | 704 | void send_data(std::vector<uint8_t> data) { |
mfiore | 0:a151a6350d7f | 705 | uint32_t ret; |
mfiore | 0:a151a6350d7f | 706 | |
mfiore | 0:a151a6350d7f | 707 | ret = dot->send(data); |
mfiore | 0:a151a6350d7f | 708 | if (ret != mDot::MDOT_OK) { |
Mike Fiore |
11:d2e31743433a | 709 | logError("failed to send data to %s [%d][%s]", dot->getJoinMode() == mDot::PEER_TO_PEER ? "peer" : "gateway", ret, mDot::getReturnCodeString(ret).c_str()); |
mfiore | 0:a151a6350d7f | 710 | } else { |
Mike Fiore |
11:d2e31743433a | 711 | logInfo("successfully sent data to %s", dot->getJoinMode() == mDot::PEER_TO_PEER ? "peer" : "gateway"); |
mfiore | 0:a151a6350d7f | 712 | } |
mfiore | 0:a151a6350d7f | 713 | } |