Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Fork of XBeeLib by
XBeeZB/XBeeZB.cpp@3:8662ebe83570, 2015-05-18 (annotated)
- Committer:
- spastor
- Date:
- Mon May 18 13:16:55 2015 +0200
- Revision:
- 3:8662ebe83570
- Parent:
- 2:2ee1b6d51df2
- Child:
- 4:629712865107
Automatic upload
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
spastor | 0:fcaad0dfa051 | 1 | /** |
spastor | 0:fcaad0dfa051 | 2 | * Copyright (c) 2015 Digi International Inc., |
spastor | 0:fcaad0dfa051 | 3 | * All rights not expressly granted are reserved. |
spastor | 0:fcaad0dfa051 | 4 | * |
spastor | 0:fcaad0dfa051 | 5 | * This Source Code Form is subject to the terms of the Mozilla Public |
spastor | 0:fcaad0dfa051 | 6 | * License, v. 2.0. If a copy of the MPL was not distributed with this file, |
spastor | 0:fcaad0dfa051 | 7 | * You can obtain one at http://mozilla.org/MPL/2.0/. |
spastor | 0:fcaad0dfa051 | 8 | * |
spastor | 0:fcaad0dfa051 | 9 | * Digi International Inc. 11001 Bren Road East, Minnetonka, MN 55343 |
spastor | 0:fcaad0dfa051 | 10 | * ======================================================================= |
spastor | 0:fcaad0dfa051 | 11 | */ |
spastor | 0:fcaad0dfa051 | 12 | |
spastor | 0:fcaad0dfa051 | 13 | #include "XBeeZB.h" |
spastor | 0:fcaad0dfa051 | 14 | #include "IO/IOSampleZB.h" |
spastor | 0:fcaad0dfa051 | 15 | #include "Frames/ZigbeeFrames.h" |
spastor | 0:fcaad0dfa051 | 16 | |
spastor | 0:fcaad0dfa051 | 17 | using namespace XBeeLib; |
spastor | 0:fcaad0dfa051 | 18 | |
spastor | 0:fcaad0dfa051 | 19 | /* Class constructor */ |
spastor | 0:fcaad0dfa051 | 20 | XBeeZB::XBeeZB(PinName tx, PinName rx, PinName reset, PinName rts, PinName cts, int baud) : |
spastor | 0:fcaad0dfa051 | 21 | XBee(tx, rx, reset, rts, cts, baud), _nw_role(UnknownRole), _joined_network(false), |
spastor | 0:fcaad0dfa051 | 22 | _vcc_exceeded_cnt(0), _broadcast_radious(0), _nd_handler(NULL), |
spastor | 0:fcaad0dfa051 | 23 | _rx_pkt_handler(NULL), _io_data_handler(NULL) |
spastor | 0:fcaad0dfa051 | 24 | { |
spastor | 0:fcaad0dfa051 | 25 | _reset_timeout = RESET_TIMEOUT_MS; |
spastor | 0:fcaad0dfa051 | 26 | } |
spastor | 0:fcaad0dfa051 | 27 | |
spastor | 0:fcaad0dfa051 | 28 | RadioStatus XBeeZB::init() |
spastor | 0:fcaad0dfa051 | 29 | { |
spastor | 0:fcaad0dfa051 | 30 | RadioStatus retval = XBee::init(); |
spastor | 0:fcaad0dfa051 | 31 | /* Determine the role of this device in the network */ |
spastor | 0:fcaad0dfa051 | 32 | switch(_fw_version & 0xFF00) { |
spastor | 3:8662ebe83570 | 33 | case 0x2100: |
spastor | 3:8662ebe83570 | 34 | _nw_role = Coordinator; |
spastor | 3:8662ebe83570 | 35 | break; |
spastor | 3:8662ebe83570 | 36 | case 0x2300: |
spastor | 3:8662ebe83570 | 37 | _nw_role = Router; |
spastor | 3:8662ebe83570 | 38 | break; |
spastor | 3:8662ebe83570 | 39 | case 0x2900: |
spastor | 3:8662ebe83570 | 40 | _nw_role = EndDevice; |
spastor | 3:8662ebe83570 | 41 | break; |
spastor | 3:8662ebe83570 | 42 | default: |
spastor | 3:8662ebe83570 | 43 | _nw_role = UnknownRole; |
spastor | 3:8662ebe83570 | 44 | break; |
spastor | 0:fcaad0dfa051 | 45 | } |
spastor | 0:fcaad0dfa051 | 46 | |
spastor | 0:fcaad0dfa051 | 47 | const RadioProtocol radioProtocol = get_radio_protocol(); |
spastor | 0:fcaad0dfa051 | 48 | if (radioProtocol != ZigBee) { |
spastor | 0:fcaad0dfa051 | 49 | digi_log(LogLevelError, "Radio protocol does not match, needed a %d got a %d\r\n", ZigBee, radioProtocol); |
spastor | 0:fcaad0dfa051 | 50 | retval = Failure; |
spastor | 0:fcaad0dfa051 | 51 | } |
spastor | 0:fcaad0dfa051 | 52 | assert(radioProtocol == ZigBee); |
spastor | 0:fcaad0dfa051 | 53 | |
spastor | 0:fcaad0dfa051 | 54 | return retval; |
spastor | 0:fcaad0dfa051 | 55 | } |
spastor | 0:fcaad0dfa051 | 56 | |
spastor | 0:fcaad0dfa051 | 57 | /* Class destructor */ |
spastor | 0:fcaad0dfa051 | 58 | XBeeZB::~XBeeZB() |
spastor | 0:fcaad0dfa051 | 59 | { |
spastor | 0:fcaad0dfa051 | 60 | unregister_node_discovery_cb(); |
spastor | 0:fcaad0dfa051 | 61 | unregister_receive_cb(); |
spastor | 0:fcaad0dfa051 | 62 | unregister_io_sample_cb(); |
spastor | 0:fcaad0dfa051 | 63 | } |
spastor | 0:fcaad0dfa051 | 64 | |
spastor | 0:fcaad0dfa051 | 65 | RadioStatus XBeeZB::set_channel_mask(uint16_t chmask) |
spastor | 0:fcaad0dfa051 | 66 | { |
spastor | 0:fcaad0dfa051 | 67 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 68 | |
spastor | 0:fcaad0dfa051 | 69 | cmdresp = set_param("SC", chmask); |
spastor | 0:fcaad0dfa051 | 70 | if (cmdresp != AtCmdFrame::AtCmdRespOk) { |
spastor | 0:fcaad0dfa051 | 71 | return Failure; |
spastor | 0:fcaad0dfa051 | 72 | } |
spastor | 0:fcaad0dfa051 | 73 | return Success; |
spastor | 0:fcaad0dfa051 | 74 | } |
spastor | 0:fcaad0dfa051 | 75 | |
spastor | 0:fcaad0dfa051 | 76 | RadioStatus XBeeZB::get_channel_mask(uint16_t * const chmask) |
spastor | 0:fcaad0dfa051 | 77 | { |
spastor | 0:fcaad0dfa051 | 78 | if (chmask == NULL) { |
spastor | 0:fcaad0dfa051 | 79 | return Failure; |
spastor | 0:fcaad0dfa051 | 80 | } |
spastor | 0:fcaad0dfa051 | 81 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 82 | |
spastor | 0:fcaad0dfa051 | 83 | uint32_t var32; |
spastor | 0:fcaad0dfa051 | 84 | cmdresp = get_param("SC", &var32); |
spastor | 0:fcaad0dfa051 | 85 | if (cmdresp != AtCmdFrame::AtCmdRespOk) |
spastor | 0:fcaad0dfa051 | 86 | return Failure; |
spastor | 0:fcaad0dfa051 | 87 | *chmask = var32; |
spastor | 0:fcaad0dfa051 | 88 | return Success; |
spastor | 0:fcaad0dfa051 | 89 | } |
spastor | 0:fcaad0dfa051 | 90 | |
spastor | 0:fcaad0dfa051 | 91 | RadioStatus XBeeZB::set_panid(uint64_t panid) |
spastor | 0:fcaad0dfa051 | 92 | { |
spastor | 0:fcaad0dfa051 | 93 | uint8_t panid_u8[8]; |
spastor | 0:fcaad0dfa051 | 94 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 95 | |
spastor | 0:fcaad0dfa051 | 96 | rmemcpy(panid_u8, (const uint8_t *) &panid, sizeof panid_u8); |
spastor | 0:fcaad0dfa051 | 97 | |
spastor | 0:fcaad0dfa051 | 98 | cmdresp = set_param("ID", panid_u8, sizeof panid_u8); |
spastor | 0:fcaad0dfa051 | 99 | if (cmdresp != AtCmdFrame::AtCmdRespOk) { |
spastor | 0:fcaad0dfa051 | 100 | return Failure; |
spastor | 0:fcaad0dfa051 | 101 | } |
spastor | 0:fcaad0dfa051 | 102 | return Success; |
spastor | 0:fcaad0dfa051 | 103 | } |
spastor | 0:fcaad0dfa051 | 104 | |
spastor | 0:fcaad0dfa051 | 105 | RadioStatus XBeeZB::get_operating_panid(uint64_t * const opanid) |
spastor | 0:fcaad0dfa051 | 106 | { |
spastor | 0:fcaad0dfa051 | 107 | if (opanid == NULL) { |
spastor | 0:fcaad0dfa051 | 108 | return Failure; |
spastor | 0:fcaad0dfa051 | 109 | } |
spastor | 0:fcaad0dfa051 | 110 | uint8_t opanid_u8[8]; |
spastor | 0:fcaad0dfa051 | 111 | uint16_t len = sizeof opanid_u8; |
spastor | 0:fcaad0dfa051 | 112 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 113 | |
spastor | 0:fcaad0dfa051 | 114 | cmdresp = get_param("OP", opanid_u8, &len); |
spastor | 0:fcaad0dfa051 | 115 | if (cmdresp != AtCmdFrame::AtCmdRespOk) { |
spastor | 0:fcaad0dfa051 | 116 | return Failure; |
spastor | 0:fcaad0dfa051 | 117 | } |
spastor | 0:fcaad0dfa051 | 118 | if (len != sizeof opanid_u8) { |
spastor | 0:fcaad0dfa051 | 119 | digi_log(LogLevelError, "XBeeZB::get_operating_panid: Read %d bytes instead of %d for OP", len, sizeof opanid_u8); |
spastor | 0:fcaad0dfa051 | 120 | return Failure; |
spastor | 0:fcaad0dfa051 | 121 | } |
spastor | 0:fcaad0dfa051 | 122 | rmemcpy((uint8_t *)opanid, opanid_u8, len); |
spastor | 0:fcaad0dfa051 | 123 | return Success; |
spastor | 0:fcaad0dfa051 | 124 | } |
spastor | 0:fcaad0dfa051 | 125 | |
spastor | 0:fcaad0dfa051 | 126 | RadioStatus XBeeZB::get_configured_panid(uint64_t * const panid) |
spastor | 0:fcaad0dfa051 | 127 | { |
spastor | 0:fcaad0dfa051 | 128 | if (panid == NULL) { |
spastor | 0:fcaad0dfa051 | 129 | return Failure; |
spastor | 0:fcaad0dfa051 | 130 | } |
spastor | 0:fcaad0dfa051 | 131 | uint8_t panid_u8[8]; |
spastor | 0:fcaad0dfa051 | 132 | uint16_t len = sizeof panid_u8; |
spastor | 0:fcaad0dfa051 | 133 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 134 | |
spastor | 0:fcaad0dfa051 | 135 | cmdresp = get_param("ID", panid_u8, &len); |
spastor | 0:fcaad0dfa051 | 136 | if (cmdresp != AtCmdFrame::AtCmdRespOk) { |
spastor | 0:fcaad0dfa051 | 137 | return Failure; |
spastor | 0:fcaad0dfa051 | 138 | } |
spastor | 0:fcaad0dfa051 | 139 | if (len != sizeof panid_u8) { |
spastor | 0:fcaad0dfa051 | 140 | digi_log(LogLevelError, "XBeeZB::get_configured_panid: Read %d bytes instead of %d for ID", len, sizeof panid_u8); |
spastor | 0:fcaad0dfa051 | 141 | return Failure; |
spastor | 0:fcaad0dfa051 | 142 | } |
spastor | 0:fcaad0dfa051 | 143 | rmemcpy((uint8_t *)panid, panid_u8, len); |
spastor | 0:fcaad0dfa051 | 144 | return Success; |
spastor | 0:fcaad0dfa051 | 145 | } |
spastor | 0:fcaad0dfa051 | 146 | |
spastor | 0:fcaad0dfa051 | 147 | RadioStatus XBeeZB::set_panid(const RemoteXBee& remote, uint64_t panid) |
spastor | 0:fcaad0dfa051 | 148 | { |
spastor | 0:fcaad0dfa051 | 149 | uint8_t panid_u8[8]; |
spastor | 0:fcaad0dfa051 | 150 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 151 | |
spastor | 0:fcaad0dfa051 | 152 | rmemcpy(panid_u8, (const uint8_t *) &panid, sizeof panid_u8); |
spastor | 0:fcaad0dfa051 | 153 | |
spastor | 0:fcaad0dfa051 | 154 | cmdresp = set_param(remote, "ID", panid_u8, sizeof panid_u8); |
spastor | 0:fcaad0dfa051 | 155 | if (cmdresp != AtCmdFrame::AtCmdRespOk) { |
spastor | 0:fcaad0dfa051 | 156 | return Failure; |
spastor | 0:fcaad0dfa051 | 157 | } |
spastor | 0:fcaad0dfa051 | 158 | return Success; |
spastor | 0:fcaad0dfa051 | 159 | } |
spastor | 0:fcaad0dfa051 | 160 | |
spastor | 0:fcaad0dfa051 | 161 | RadioStatus XBeeZB::get_operating_panid(const RemoteXBee& remote, uint64_t * const opanid) |
spastor | 0:fcaad0dfa051 | 162 | { |
spastor | 0:fcaad0dfa051 | 163 | if (opanid == NULL) { |
spastor | 0:fcaad0dfa051 | 164 | return Failure; |
spastor | 0:fcaad0dfa051 | 165 | } |
spastor | 0:fcaad0dfa051 | 166 | uint8_t opanid_u8[8]; |
spastor | 0:fcaad0dfa051 | 167 | uint16_t len = sizeof opanid_u8; |
spastor | 0:fcaad0dfa051 | 168 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 169 | |
spastor | 0:fcaad0dfa051 | 170 | cmdresp = get_param(remote, "OP", opanid_u8, &len); |
spastor | 0:fcaad0dfa051 | 171 | if (cmdresp != AtCmdFrame::AtCmdRespOk) { |
spastor | 0:fcaad0dfa051 | 172 | return Failure; |
spastor | 0:fcaad0dfa051 | 173 | } |
spastor | 0:fcaad0dfa051 | 174 | if (len != sizeof opanid_u8) { |
spastor | 0:fcaad0dfa051 | 175 | digi_log(LogLevelError, "XBeeZB::get_operating_panid: Read %d bytes instead of %d for OP", len, sizeof opanid_u8); |
spastor | 0:fcaad0dfa051 | 176 | return Failure; |
spastor | 0:fcaad0dfa051 | 177 | } |
spastor | 0:fcaad0dfa051 | 178 | rmemcpy((uint8_t *)opanid, opanid_u8, len); |
spastor | 0:fcaad0dfa051 | 179 | return Success; |
spastor | 0:fcaad0dfa051 | 180 | } |
spastor | 0:fcaad0dfa051 | 181 | |
spastor | 0:fcaad0dfa051 | 182 | RadioStatus XBeeZB::get_configured_panid(const RemoteXBee& remote, uint64_t * const panid) |
spastor | 0:fcaad0dfa051 | 183 | { |
spastor | 0:fcaad0dfa051 | 184 | if (panid == NULL) { |
spastor | 0:fcaad0dfa051 | 185 | return Failure; |
spastor | 0:fcaad0dfa051 | 186 | } |
spastor | 0:fcaad0dfa051 | 187 | uint8_t panid_u8[8]; |
spastor | 0:fcaad0dfa051 | 188 | uint16_t len = sizeof panid_u8; |
spastor | 0:fcaad0dfa051 | 189 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 190 | |
spastor | 0:fcaad0dfa051 | 191 | cmdresp = get_param(remote, "ID", panid_u8, &len); |
spastor | 0:fcaad0dfa051 | 192 | if (cmdresp != AtCmdFrame::AtCmdRespOk) { |
spastor | 0:fcaad0dfa051 | 193 | return Failure; |
spastor | 0:fcaad0dfa051 | 194 | } |
spastor | 0:fcaad0dfa051 | 195 | if (len != sizeof panid_u8) { |
spastor | 0:fcaad0dfa051 | 196 | digi_log(LogLevelError, "XBeeZB::get_configured_panid: Read %d bytes instead of %d for ID", len, sizeof panid_u8); |
spastor | 0:fcaad0dfa051 | 197 | return Failure; |
spastor | 0:fcaad0dfa051 | 198 | } |
spastor | 0:fcaad0dfa051 | 199 | rmemcpy((uint8_t *)panid, panid_u8, len); |
spastor | 0:fcaad0dfa051 | 200 | return Success; |
spastor | 0:fcaad0dfa051 | 201 | } |
spastor | 0:fcaad0dfa051 | 202 | |
spastor | 0:fcaad0dfa051 | 203 | RadioStatus XBeeZB::check_for_coordinator_at_start(bool enable) |
spastor | 0:fcaad0dfa051 | 204 | { |
spastor | 0:fcaad0dfa051 | 205 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 206 | |
spastor | 0:fcaad0dfa051 | 207 | cmdresp = set_param("JV", (uint8_t)enable); |
spastor | 0:fcaad0dfa051 | 208 | if (cmdresp != AtCmdFrame::AtCmdRespOk) |
spastor | 0:fcaad0dfa051 | 209 | return Failure; |
spastor | 0:fcaad0dfa051 | 210 | return Success; |
spastor | 0:fcaad0dfa051 | 211 | } |
spastor | 0:fcaad0dfa051 | 212 | |
spastor | 0:fcaad0dfa051 | 213 | RadioStatus XBeeZB::enable_network_encryption(bool enable) |
spastor | 0:fcaad0dfa051 | 214 | { |
spastor | 0:fcaad0dfa051 | 215 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 216 | |
spastor | 0:fcaad0dfa051 | 217 | cmdresp = set_param("EE", enable); |
spastor | 0:fcaad0dfa051 | 218 | if (cmdresp != AtCmdFrame::AtCmdRespOk) |
spastor | 0:fcaad0dfa051 | 219 | return Failure; |
spastor | 0:fcaad0dfa051 | 220 | return Success; |
spastor | 0:fcaad0dfa051 | 221 | } |
spastor | 0:fcaad0dfa051 | 222 | |
spastor | 0:fcaad0dfa051 | 223 | RadioStatus XBeeZB::set_encryption_key(const uint8_t * const key, const uint16_t length) |
spastor | 0:fcaad0dfa051 | 224 | { |
spastor | 0:fcaad0dfa051 | 225 | if (key == NULL || length == 0) { |
spastor | 0:fcaad0dfa051 | 226 | return Failure; |
spastor | 0:fcaad0dfa051 | 227 | } |
spastor | 0:fcaad0dfa051 | 228 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 229 | |
spastor | 0:fcaad0dfa051 | 230 | cmdresp = set_param("NK", key, length); |
spastor | 0:fcaad0dfa051 | 231 | if (cmdresp != AtCmdFrame::AtCmdRespOk) |
spastor | 0:fcaad0dfa051 | 232 | return Failure; |
spastor | 0:fcaad0dfa051 | 233 | return Success; |
spastor | 0:fcaad0dfa051 | 234 | } |
spastor | 0:fcaad0dfa051 | 235 | |
spastor | 0:fcaad0dfa051 | 236 | RadioStatus XBeeZB::set_tc_link_key(const uint8_t * const key, const uint16_t length) |
spastor | 0:fcaad0dfa051 | 237 | { |
spastor | 0:fcaad0dfa051 | 238 | if (key == NULL || length == 0) { |
spastor | 0:fcaad0dfa051 | 239 | return Failure; |
spastor | 0:fcaad0dfa051 | 240 | } |
spastor | 0:fcaad0dfa051 | 241 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 242 | |
spastor | 0:fcaad0dfa051 | 243 | cmdresp = set_param("KY", key, length); |
spastor | 0:fcaad0dfa051 | 244 | if (cmdresp != AtCmdFrame::AtCmdRespOk) |
spastor | 0:fcaad0dfa051 | 245 | return Failure; |
spastor | 0:fcaad0dfa051 | 246 | return Success; |
spastor | 0:fcaad0dfa051 | 247 | } |
spastor | 0:fcaad0dfa051 | 248 | |
spastor | 0:fcaad0dfa051 | 249 | RadioStatus XBeeZB::set_encryption_options(const uint8_t options) |
spastor | 0:fcaad0dfa051 | 250 | { |
spastor | 0:fcaad0dfa051 | 251 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 252 | |
spastor | 0:fcaad0dfa051 | 253 | cmdresp = set_param("EO", options); |
spastor | 0:fcaad0dfa051 | 254 | if (cmdresp != AtCmdFrame::AtCmdRespOk) |
spastor | 0:fcaad0dfa051 | 255 | return Failure; |
spastor | 0:fcaad0dfa051 | 256 | return Success; |
spastor | 0:fcaad0dfa051 | 257 | } |
spastor | 0:fcaad0dfa051 | 258 | |
spastor | 0:fcaad0dfa051 | 259 | void XBeeZB::radio_status_update(AtCmdFrame::ModemStatus modem_status) |
spastor | 0:fcaad0dfa051 | 260 | { |
spastor | 0:fcaad0dfa051 | 261 | /* Update the radio status variables */ |
spastor | 0:fcaad0dfa051 | 262 | if (modem_status == AtCmdFrame::HwReset) { |
spastor | 0:fcaad0dfa051 | 263 | _hw_reset_cnt++; |
spastor | 0:fcaad0dfa051 | 264 | _joined_network = false; |
spastor | 0:fcaad0dfa051 | 265 | } |
spastor | 0:fcaad0dfa051 | 266 | else if (modem_status == AtCmdFrame::WdReset) { |
spastor | 0:fcaad0dfa051 | 267 | _wd_reset_cnt++; |
spastor | 0:fcaad0dfa051 | 268 | _joined_network = false; |
spastor | 0:fcaad0dfa051 | 269 | } |
spastor | 0:fcaad0dfa051 | 270 | else if (modem_status == AtCmdFrame::JoinedNW) |
spastor | 0:fcaad0dfa051 | 271 | _joined_network = true; |
spastor | 0:fcaad0dfa051 | 272 | else if (modem_status == AtCmdFrame::Disassociated) |
spastor | 0:fcaad0dfa051 | 273 | _joined_network = false; |
spastor | 0:fcaad0dfa051 | 274 | else if (modem_status == AtCmdFrame::VccExceeded) |
spastor | 0:fcaad0dfa051 | 275 | _vcc_exceeded_cnt++; |
spastor | 0:fcaad0dfa051 | 276 | |
spastor | 0:fcaad0dfa051 | 277 | _modem_status = modem_status; |
spastor | 0:fcaad0dfa051 | 278 | |
spastor | 0:fcaad0dfa051 | 279 | digi_log(LogLevelDebug, "\r\nUpdating radio status: %02x\r\n", modem_status); |
spastor | 0:fcaad0dfa051 | 280 | } |
spastor | 0:fcaad0dfa051 | 281 | |
spastor | 3:8662ebe83570 | 282 | TxStatus XBeeZB::send_data(const RemoteXBee& remote, const uint8_t *const data, uint16_t len, bool syncr) |
spastor | 0:fcaad0dfa051 | 283 | { |
spastor | 0:fcaad0dfa051 | 284 | if (!remote.is_valid_addr64b()) |
spastor | 0:fcaad0dfa051 | 285 | return TxStatusInvalidAddr; |
spastor | 0:fcaad0dfa051 | 286 | |
spastor | 0:fcaad0dfa051 | 287 | const uint64_t remote64 = remote.get_addr64(); |
spastor | 0:fcaad0dfa051 | 288 | const uint16_t remote16 = remote.get_addr16(); |
spastor | 0:fcaad0dfa051 | 289 | |
spastor | 0:fcaad0dfa051 | 290 | TxFrameZB frame = TxFrameZB(remote64, remote16, _broadcast_radious, |
spastor | 0:fcaad0dfa051 | 291 | _tx_options, data, len); |
spastor | 3:8662ebe83570 | 292 | if (syncr) { |
spastor | 3:8662ebe83570 | 293 | return send_data(&frame); |
spastor | 3:8662ebe83570 | 294 | } else { |
spastor | 3:8662ebe83570 | 295 | frame.set_data(0, 0); /* Set frame id to 0 so there is no answer */ |
spastor | 3:8662ebe83570 | 296 | send_api_frame(&frame); |
spastor | 3:8662ebe83570 | 297 | return TxStatusSuccess; |
spastor | 3:8662ebe83570 | 298 | } |
spastor | 0:fcaad0dfa051 | 299 | } |
spastor | 0:fcaad0dfa051 | 300 | |
spastor | 0:fcaad0dfa051 | 301 | TxStatus XBeeZB::send_data(const RemoteXBee& remote, uint8_t source_ep, |
spastor | 0:fcaad0dfa051 | 302 | uint8_t dest_ep, uint16_t cluster_id, uint16_t profile_id, |
spastor | 3:8662ebe83570 | 303 | const uint8_t *const data, uint16_t len, bool syncr) |
spastor | 0:fcaad0dfa051 | 304 | { |
spastor | 0:fcaad0dfa051 | 305 | if (!remote.is_valid_addr64b()) |
spastor | 0:fcaad0dfa051 | 306 | return TxStatusInvalidAddr; |
spastor | 0:fcaad0dfa051 | 307 | |
spastor | 0:fcaad0dfa051 | 308 | const uint64_t remote64 = remote.get_addr64(); |
spastor | 0:fcaad0dfa051 | 309 | const uint16_t remote16 = remote.get_addr16(); |
spastor | 0:fcaad0dfa051 | 310 | |
spastor | 0:fcaad0dfa051 | 311 | TxFrameZB frame = TxFrameZB(remote64, remote16, source_ep, dest_ep, |
spastor | 0:fcaad0dfa051 | 312 | cluster_id, profile_id, _broadcast_radious, |
spastor | 0:fcaad0dfa051 | 313 | _tx_options, data, len); |
spastor | 3:8662ebe83570 | 314 | if (syncr) { |
spastor | 3:8662ebe83570 | 315 | return send_data(&frame); |
spastor | 3:8662ebe83570 | 316 | } else { |
spastor | 3:8662ebe83570 | 317 | frame.set_data(0, 0); /* Set frame id to 0 so there is no answer */ |
spastor | 3:8662ebe83570 | 318 | send_api_frame(&frame); |
spastor | 3:8662ebe83570 | 319 | return TxStatusSuccess; |
spastor | 3:8662ebe83570 | 320 | |
spastor | 3:8662ebe83570 | 321 | } |
spastor | 0:fcaad0dfa051 | 322 | } |
hbujanda | 2:2ee1b6d51df2 | 323 | |
spastor | 3:8662ebe83570 | 324 | TxStatus XBeeZB::send_data_to_coordinator(const uint8_t *const data, uint16_t len, bool syncr) |
spastor | 0:fcaad0dfa051 | 325 | { |
spastor | 0:fcaad0dfa051 | 326 | const uint64_t remaddr = ADDR64_COORDINATOR; |
spastor | 0:fcaad0dfa051 | 327 | |
spastor | 0:fcaad0dfa051 | 328 | TxFrameZB frame = TxFrameZB(remaddr, ADDR16_UNKNOWN, _broadcast_radious, |
spastor | 0:fcaad0dfa051 | 329 | _tx_options, data, len); |
spastor | 3:8662ebe83570 | 330 | if (syncr) { |
spastor | 3:8662ebe83570 | 331 | return send_data(&frame); |
spastor | 3:8662ebe83570 | 332 | } else { |
spastor | 3:8662ebe83570 | 333 | frame.set_data(0, 0); /* Set frame id to 0 so there is no answer */ |
spastor | 3:8662ebe83570 | 334 | send_api_frame(&frame); |
spastor | 3:8662ebe83570 | 335 | return TxStatusSuccess; |
spastor | 3:8662ebe83570 | 336 | } |
spastor | 0:fcaad0dfa051 | 337 | } |
spastor | 0:fcaad0dfa051 | 338 | |
hbujanda | 2:2ee1b6d51df2 | 339 | RemoteXBeeZB XBeeZB::get_remote_node_by_id(const char * const node_id) |
hbujanda | 2:2ee1b6d51df2 | 340 | { |
hbujanda | 2:2ee1b6d51df2 | 341 | uint64_t addr64; |
hbujanda | 2:2ee1b6d51df2 | 342 | uint16_t addr16; |
hbujanda | 2:2ee1b6d51df2 | 343 | _get_remote_node_by_id(node_id, &addr64, &addr16); |
hbujanda | 2:2ee1b6d51df2 | 344 | return RemoteXBeeZB(addr64, addr16); |
hbujanda | 2:2ee1b6d51df2 | 345 | } |
hbujanda | 2:2ee1b6d51df2 | 346 | |
spastor | 0:fcaad0dfa051 | 347 | NetworkRole XBeeZB::get_network_role() |
spastor | 0:fcaad0dfa051 | 348 | { |
spastor | 0:fcaad0dfa051 | 349 | return _nw_role; |
spastor | 0:fcaad0dfa051 | 350 | } |
spastor | 0:fcaad0dfa051 | 351 | |
spastor | 0:fcaad0dfa051 | 352 | bool XBeeZB::is_joined() |
spastor | 0:fcaad0dfa051 | 353 | { |
spastor | 0:fcaad0dfa051 | 354 | return _joined_network; |
spastor | 0:fcaad0dfa051 | 355 | } |
spastor | 0:fcaad0dfa051 | 356 | |
spastor | 0:fcaad0dfa051 | 357 | void XBeeZB::register_node_discovery_cb(node_discovery_zb_cb_t function) |
spastor | 0:fcaad0dfa051 | 358 | { |
spastor | 0:fcaad0dfa051 | 359 | if (_nd_handler == NULL) { |
spastor | 0:fcaad0dfa051 | 360 | _nd_handler = new FH_NodeDiscoveryZB(); |
spastor | 0:fcaad0dfa051 | 361 | register_frame_handler(_nd_handler); |
spastor | 0:fcaad0dfa051 | 362 | } |
spastor | 0:fcaad0dfa051 | 363 | _nd_handler->register_node_discovery_cb(function); |
spastor | 0:fcaad0dfa051 | 364 | } |
spastor | 0:fcaad0dfa051 | 365 | |
spastor | 0:fcaad0dfa051 | 366 | void XBeeZB::unregister_node_discovery_cb() |
spastor | 0:fcaad0dfa051 | 367 | { |
spastor | 0:fcaad0dfa051 | 368 | if (_nd_handler != NULL) { |
spastor | 0:fcaad0dfa051 | 369 | _nd_handler->unregister_node_discovery_cb(); |
spastor | 0:fcaad0dfa051 | 370 | unregister_frame_handler(_nd_handler); |
spastor | 0:fcaad0dfa051 | 371 | delete _nd_handler; |
spastor | 0:fcaad0dfa051 | 372 | _nd_handler = NULL; /* as delete does not set to NULL */ |
spastor | 0:fcaad0dfa051 | 373 | } |
spastor | 0:fcaad0dfa051 | 374 | } |
spastor | 0:fcaad0dfa051 | 375 | |
spastor | 0:fcaad0dfa051 | 376 | void XBeeZB::register_receive_cb(receive_zb_cb_t function) |
spastor | 0:fcaad0dfa051 | 377 | { |
spastor | 0:fcaad0dfa051 | 378 | if (_rx_pkt_handler == NULL) { |
spastor | 0:fcaad0dfa051 | 379 | _rx_pkt_handler = new FH_RxPacketZB(); |
spastor | 0:fcaad0dfa051 | 380 | register_frame_handler(_rx_pkt_handler); |
spastor | 0:fcaad0dfa051 | 381 | } |
spastor | 0:fcaad0dfa051 | 382 | _rx_pkt_handler->register_receive_cb(function); |
spastor | 0:fcaad0dfa051 | 383 | } |
spastor | 0:fcaad0dfa051 | 384 | |
spastor | 0:fcaad0dfa051 | 385 | void XBeeZB::unregister_receive_cb() |
spastor | 0:fcaad0dfa051 | 386 | { |
spastor | 0:fcaad0dfa051 | 387 | if (_rx_pkt_handler != NULL) { |
spastor | 0:fcaad0dfa051 | 388 | _rx_pkt_handler->unregister_receive_cb(); |
spastor | 0:fcaad0dfa051 | 389 | unregister_frame_handler(_rx_pkt_handler); |
spastor | 0:fcaad0dfa051 | 390 | delete _rx_pkt_handler; |
spastor | 0:fcaad0dfa051 | 391 | _rx_pkt_handler = NULL; /* as delete does not set to NULL */ |
spastor | 0:fcaad0dfa051 | 392 | } |
spastor | 0:fcaad0dfa051 | 393 | } |
spastor | 0:fcaad0dfa051 | 394 | |
spastor | 0:fcaad0dfa051 | 395 | void XBeeZB::register_io_sample_cb(io_data_cb_zb_t function) |
spastor | 0:fcaad0dfa051 | 396 | { |
spastor | 0:fcaad0dfa051 | 397 | if (_io_data_handler == NULL) { |
spastor | 0:fcaad0dfa051 | 398 | _io_data_handler = new FH_IoDataSampeZB(); |
spastor | 0:fcaad0dfa051 | 399 | register_frame_handler(_io_data_handler); |
spastor | 0:fcaad0dfa051 | 400 | } |
spastor | 0:fcaad0dfa051 | 401 | _io_data_handler->register_io_data_cb(function); |
spastor | 0:fcaad0dfa051 | 402 | } |
spastor | 0:fcaad0dfa051 | 403 | |
spastor | 0:fcaad0dfa051 | 404 | void XBeeZB::unregister_io_sample_cb() |
spastor | 0:fcaad0dfa051 | 405 | { |
spastor | 0:fcaad0dfa051 | 406 | if (_io_data_handler != NULL) { |
spastor | 0:fcaad0dfa051 | 407 | _io_data_handler->unregister_io_data_cb(); |
spastor | 0:fcaad0dfa051 | 408 | unregister_frame_handler(_io_data_handler); |
spastor | 0:fcaad0dfa051 | 409 | delete _io_data_handler; |
spastor | 0:fcaad0dfa051 | 410 | _io_data_handler = NULL; /* as delete does not set to NULL */ |
spastor | 0:fcaad0dfa051 | 411 | } |
spastor | 0:fcaad0dfa051 | 412 | } |
spastor | 0:fcaad0dfa051 | 413 | |
spastor | 0:fcaad0dfa051 | 414 | AtCmdFrame::AtCmdResp XBeeZB::get_param(const RemoteXBee& remote, const char * const param, uint32_t * const data) |
spastor | 0:fcaad0dfa051 | 415 | { |
spastor | 0:fcaad0dfa051 | 416 | if (!remote.is_valid_addr64b()) |
spastor | 0:fcaad0dfa051 | 417 | return AtCmdFrame::AtCmdRespInvalidAddr; |
spastor | 0:fcaad0dfa051 | 418 | |
spastor | 0:fcaad0dfa051 | 419 | const uint64_t remote64 = remote.get_addr64(); |
spastor | 0:fcaad0dfa051 | 420 | const uint16_t remote16 = remote.get_addr16(); |
spastor | 0:fcaad0dfa051 | 421 | uint16_t len = sizeof *data; |
spastor | 0:fcaad0dfa051 | 422 | AtCmdFrame::AtCmdResp atCmdResponse; |
spastor | 0:fcaad0dfa051 | 423 | |
spastor | 0:fcaad0dfa051 | 424 | AtCmdFrame cmd_frame = AtCmdFrame(remote64, remote16, param); |
spastor | 0:fcaad0dfa051 | 425 | atCmdResponse = send_at_cmd(&cmd_frame, (uint8_t *)data, &len, RadioRemote); |
spastor | 0:fcaad0dfa051 | 426 | |
spastor | 0:fcaad0dfa051 | 427 | if (atCmdResponse == AtCmdFrame::AtCmdRespOk && len > sizeof *data) |
spastor | 0:fcaad0dfa051 | 428 | atCmdResponse = AtCmdFrame::AtCmdRespLenMismatch; |
spastor | 0:fcaad0dfa051 | 429 | |
spastor | 0:fcaad0dfa051 | 430 | return atCmdResponse; |
spastor | 0:fcaad0dfa051 | 431 | } |
spastor | 0:fcaad0dfa051 | 432 | |
spastor | 0:fcaad0dfa051 | 433 | AtCmdFrame::AtCmdResp XBeeZB::set_param(const RemoteXBee& remote, const char * const param, uint32_t data) |
spastor | 0:fcaad0dfa051 | 434 | { |
spastor | 0:fcaad0dfa051 | 435 | if (!remote.is_valid_addr64b()) |
spastor | 0:fcaad0dfa051 | 436 | return AtCmdFrame::AtCmdRespInvalidAddr; |
spastor | 0:fcaad0dfa051 | 437 | |
spastor | 0:fcaad0dfa051 | 438 | const uint64_t remote64 = remote.get_addr64(); |
spastor | 0:fcaad0dfa051 | 439 | const uint16_t remote16 = remote.get_addr16(); |
spastor | 0:fcaad0dfa051 | 440 | |
spastor | 0:fcaad0dfa051 | 441 | AtCmdFrame cmd_frame = AtCmdFrame(remote64, remote16, param, data); |
spastor | 0:fcaad0dfa051 | 442 | return send_at_cmd(&cmd_frame, NULL, NULL, RadioRemote); |
spastor | 0:fcaad0dfa051 | 443 | } |
spastor | 0:fcaad0dfa051 | 444 | |
spastor | 0:fcaad0dfa051 | 445 | AtCmdFrame::AtCmdResp XBeeZB::set_param(const RemoteXBee& remote, const char * const param, const uint8_t * data, uint16_t len) |
spastor | 0:fcaad0dfa051 | 446 | { |
spastor | 0:fcaad0dfa051 | 447 | if (!remote.is_valid_addr64b()) |
spastor | 0:fcaad0dfa051 | 448 | return AtCmdFrame::AtCmdRespInvalidAddr; |
spastor | 0:fcaad0dfa051 | 449 | |
spastor | 0:fcaad0dfa051 | 450 | const uint64_t remote64 = remote.get_addr64(); |
spastor | 0:fcaad0dfa051 | 451 | const uint16_t remote16 = remote.get_addr16(); |
spastor | 0:fcaad0dfa051 | 452 | |
spastor | 0:fcaad0dfa051 | 453 | AtCmdFrame cmd_frame = AtCmdFrame(remote64, remote16, param, data, len); |
spastor | 0:fcaad0dfa051 | 454 | return send_at_cmd(&cmd_frame, NULL, NULL, RadioRemote); |
spastor | 0:fcaad0dfa051 | 455 | } |
spastor | 0:fcaad0dfa051 | 456 | |
spastor | 0:fcaad0dfa051 | 457 | AtCmdFrame::AtCmdResp XBeeZB::get_param(const RemoteXBee& remote, const char * const param, uint8_t * const data, uint16_t * const len) |
spastor | 0:fcaad0dfa051 | 458 | { |
spastor | 0:fcaad0dfa051 | 459 | |
spastor | 0:fcaad0dfa051 | 460 | if (!remote.is_valid_addr64b()) |
spastor | 0:fcaad0dfa051 | 461 | return AtCmdFrame::AtCmdRespInvalidAddr; |
spastor | 0:fcaad0dfa051 | 462 | |
spastor | 0:fcaad0dfa051 | 463 | const uint64_t remote64 = remote.get_addr64(); |
spastor | 0:fcaad0dfa051 | 464 | const uint16_t remote16 = remote.get_addr16(); |
spastor | 0:fcaad0dfa051 | 465 | |
spastor | 0:fcaad0dfa051 | 466 | AtCmdFrame cmd_frame = AtCmdFrame(remote64, remote16, param); |
spastor | 0:fcaad0dfa051 | 467 | return send_at_cmd(&cmd_frame, data, len, RadioRemote, false); |
spastor | 0:fcaad0dfa051 | 468 | } |
spastor | 0:fcaad0dfa051 | 469 | |
spastor | 0:fcaad0dfa051 | 470 | static void get_dio_cmd(XBeeZB::IoLine line, char * const iocmd) |
spastor | 0:fcaad0dfa051 | 471 | { |
spastor | 0:fcaad0dfa051 | 472 | if (line >= XBeeZB::DIO10) { |
spastor | 0:fcaad0dfa051 | 473 | iocmd[0] = 'P'; |
spastor | 0:fcaad0dfa051 | 474 | iocmd[1] = '0' + line - XBeeZB::DIO10; |
spastor | 0:fcaad0dfa051 | 475 | } else { |
spastor | 0:fcaad0dfa051 | 476 | iocmd[0] = 'D'; |
spastor | 0:fcaad0dfa051 | 477 | iocmd[1] = '0' + line; |
spastor | 0:fcaad0dfa051 | 478 | } |
spastor | 0:fcaad0dfa051 | 479 | iocmd[2] = '\0'; |
spastor | 0:fcaad0dfa051 | 480 | } |
spastor | 0:fcaad0dfa051 | 481 | |
spastor | 0:fcaad0dfa051 | 482 | RadioStatus XBeeZB::set_pin_config(const RemoteXBee& remote, IoLine line, IoMode mode) |
spastor | 0:fcaad0dfa051 | 483 | { |
spastor | 0:fcaad0dfa051 | 484 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 485 | char iocmd[3]; |
spastor | 0:fcaad0dfa051 | 486 | |
spastor | 0:fcaad0dfa051 | 487 | get_dio_cmd(line, iocmd); |
spastor | 0:fcaad0dfa051 | 488 | |
spastor | 0:fcaad0dfa051 | 489 | cmdresp = set_param(remote, iocmd, (uint8_t)mode); |
spastor | 0:fcaad0dfa051 | 490 | if (cmdresp != AtCmdFrame::AtCmdRespOk) { |
spastor | 0:fcaad0dfa051 | 491 | digi_log(LogLevelError, "set_pin_config: set_param returned %d\r\n", cmdresp); |
spastor | 0:fcaad0dfa051 | 492 | return Failure; |
spastor | 0:fcaad0dfa051 | 493 | } |
spastor | 0:fcaad0dfa051 | 494 | |
spastor | 0:fcaad0dfa051 | 495 | return Success; |
spastor | 0:fcaad0dfa051 | 496 | } |
spastor | 0:fcaad0dfa051 | 497 | |
spastor | 0:fcaad0dfa051 | 498 | RadioStatus XBeeZB::get_pin_config(const RemoteXBee& remote, IoLine line, IoMode * const mode) |
spastor | 0:fcaad0dfa051 | 499 | { |
spastor | 0:fcaad0dfa051 | 500 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 501 | char iocmd[3]; |
spastor | 0:fcaad0dfa051 | 502 | |
spastor | 0:fcaad0dfa051 | 503 | get_dio_cmd(line, iocmd); |
spastor | 0:fcaad0dfa051 | 504 | |
spastor | 0:fcaad0dfa051 | 505 | uint32_t var32; |
spastor | 0:fcaad0dfa051 | 506 | cmdresp = get_param(remote, iocmd, &var32); |
spastor | 0:fcaad0dfa051 | 507 | if (cmdresp != AtCmdFrame::AtCmdRespOk) { |
spastor | 0:fcaad0dfa051 | 508 | return Failure; |
spastor | 0:fcaad0dfa051 | 509 | } |
spastor | 0:fcaad0dfa051 | 510 | *mode = (IoMode)var32; |
spastor | 0:fcaad0dfa051 | 511 | |
spastor | 0:fcaad0dfa051 | 512 | return Success; |
spastor | 0:fcaad0dfa051 | 513 | } |
spastor | 0:fcaad0dfa051 | 514 | |
spastor | 0:fcaad0dfa051 | 515 | RadioStatus XBeeZB::set_dio(const RemoteXBee& remote, IoLine line, DioVal val) |
spastor | 0:fcaad0dfa051 | 516 | { |
spastor | 0:fcaad0dfa051 | 517 | if (val == Low) |
spastor | 0:fcaad0dfa051 | 518 | return set_pin_config(remote, line, DigitalOutLow); |
spastor | 0:fcaad0dfa051 | 519 | else |
spastor | 0:fcaad0dfa051 | 520 | return set_pin_config(remote, line, DigitalOutHigh); |
spastor | 0:fcaad0dfa051 | 521 | } |
spastor | 0:fcaad0dfa051 | 522 | |
spastor | 0:fcaad0dfa051 | 523 | RadioStatus XBeeZB::get_dio(const RemoteXBee& remote, IoLine line, DioVal * const val) |
spastor | 0:fcaad0dfa051 | 524 | { |
spastor | 3:8662ebe83570 | 525 | return get_iosample(remote).get_dio(line, val); |
spastor | 0:fcaad0dfa051 | 526 | } |
spastor | 0:fcaad0dfa051 | 527 | |
spastor | 0:fcaad0dfa051 | 528 | RadioStatus XBeeZB::get_adc(const RemoteXBee& remote, IoLine line, uint16_t * const val) |
spastor | 0:fcaad0dfa051 | 529 | { |
spastor | 3:8662ebe83570 | 530 | return get_iosample(remote).get_adc(line, val); |
spastor | 3:8662ebe83570 | 531 | } |
spastor | 0:fcaad0dfa051 | 532 | |
spastor | 3:8662ebe83570 | 533 | IOSampleZB XBeeZB::get_iosample(const RemoteXBee& remote) |
spastor | 3:8662ebe83570 | 534 | { |
spastor | 3:8662ebe83570 | 535 | uint8_t io_sample[MAX_IO_SAMPLE_ZB_LEN]; |
spastor | 3:8662ebe83570 | 536 | uint16_t len = sizeof io_sample; |
spastor | 3:8662ebe83570 | 537 | |
spastor | 3:8662ebe83570 | 538 | RadioStatus resp = _get_iosample(remote, io_sample, &len); |
spastor | 3:8662ebe83570 | 539 | if (resp != Success) { |
spastor | 3:8662ebe83570 | 540 | digi_log(LogLevelError, "XBeeZB::get_iosample failed to get an IOSample\r\n"); |
spastor | 3:8662ebe83570 | 541 | len = 0; |
spastor | 0:fcaad0dfa051 | 542 | } |
spastor | 0:fcaad0dfa051 | 543 | |
spastor | 3:8662ebe83570 | 544 | return IOSampleZB(io_sample, len); |
spastor | 0:fcaad0dfa051 | 545 | } |
spastor | 0:fcaad0dfa051 | 546 | |
spastor | 0:fcaad0dfa051 | 547 | static uint16_t get_dio_pr_mask(XBeeZB::IoLine line) |
spastor | 0:fcaad0dfa051 | 548 | { |
spastor | 0:fcaad0dfa051 | 549 | switch (line) { |
spastor | 0:fcaad0dfa051 | 550 | case XBeeZB::DIO4: |
spastor | 0:fcaad0dfa051 | 551 | return (1 << 0); |
spastor | 0:fcaad0dfa051 | 552 | case XBeeZB::DIO3_AD3: |
spastor | 0:fcaad0dfa051 | 553 | return (1 << 1); |
spastor | 0:fcaad0dfa051 | 554 | case XBeeZB::DIO2_AD2: |
spastor | 0:fcaad0dfa051 | 555 | return (1 << 2); |
spastor | 0:fcaad0dfa051 | 556 | case XBeeZB::DIO1_AD1: |
spastor | 0:fcaad0dfa051 | 557 | return (1 << 3); |
spastor | 0:fcaad0dfa051 | 558 | case XBeeZB::DIO0_AD0: |
spastor | 0:fcaad0dfa051 | 559 | return (1 << 4); |
spastor | 0:fcaad0dfa051 | 560 | case XBeeZB::DIO6: |
spastor | 0:fcaad0dfa051 | 561 | return (1 << 5); |
spastor | 0:fcaad0dfa051 | 562 | case XBeeZB::DIO5: |
spastor | 0:fcaad0dfa051 | 563 | return (1 << 8); |
spastor | 0:fcaad0dfa051 | 564 | case XBeeZB::DIO12: |
spastor | 0:fcaad0dfa051 | 565 | return (1 << 10); |
spastor | 0:fcaad0dfa051 | 566 | case XBeeZB::DIO10: |
spastor | 0:fcaad0dfa051 | 567 | return (1 << 11); |
spastor | 0:fcaad0dfa051 | 568 | case XBeeZB::DIO11: |
spastor | 0:fcaad0dfa051 | 569 | return (1 << 12); |
spastor | 0:fcaad0dfa051 | 570 | case XBeeZB::DIO7: |
spastor | 0:fcaad0dfa051 | 571 | return (1 << 13); |
spastor | 0:fcaad0dfa051 | 572 | default: |
spastor | 0:fcaad0dfa051 | 573 | return 0; |
spastor | 0:fcaad0dfa051 | 574 | } |
spastor | 0:fcaad0dfa051 | 575 | } |
spastor | 0:fcaad0dfa051 | 576 | |
spastor | 0:fcaad0dfa051 | 577 | RadioStatus XBeeZB::set_pin_pull_up(const RemoteXBee& remote, IoLine line, bool enable) |
spastor | 0:fcaad0dfa051 | 578 | { |
spastor | 0:fcaad0dfa051 | 579 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 580 | uint32_t var32; |
spastor | 0:fcaad0dfa051 | 581 | uint16_t pr; |
spastor | 0:fcaad0dfa051 | 582 | |
spastor | 0:fcaad0dfa051 | 583 | cmdresp = get_param(remote, "PR", &var32); |
spastor | 0:fcaad0dfa051 | 584 | if (cmdresp != AtCmdFrame::AtCmdRespOk) { |
spastor | 0:fcaad0dfa051 | 585 | return Failure; |
spastor | 0:fcaad0dfa051 | 586 | } |
spastor | 0:fcaad0dfa051 | 587 | pr = var32; |
spastor | 0:fcaad0dfa051 | 588 | |
spastor | 0:fcaad0dfa051 | 589 | const uint16_t dio_mask = get_dio_pr_mask(line); |
spastor | 0:fcaad0dfa051 | 590 | if (dio_mask == 0) { |
spastor | 0:fcaad0dfa051 | 591 | digi_log(LogLevelError, "XBeeZB::set_pin_pull_up: invalid pin %d\r\n", line); |
spastor | 0:fcaad0dfa051 | 592 | return Failure; |
spastor | 0:fcaad0dfa051 | 593 | } |
spastor | 0:fcaad0dfa051 | 594 | |
spastor | 0:fcaad0dfa051 | 595 | if (enable) { |
spastor | 0:fcaad0dfa051 | 596 | pr |= dio_mask; |
spastor | 0:fcaad0dfa051 | 597 | } else { |
spastor | 0:fcaad0dfa051 | 598 | pr &= ~dio_mask; |
spastor | 0:fcaad0dfa051 | 599 | } |
spastor | 0:fcaad0dfa051 | 600 | |
spastor | 0:fcaad0dfa051 | 601 | cmdresp = set_param(remote, "PR", pr); |
spastor | 0:fcaad0dfa051 | 602 | if (cmdresp != AtCmdFrame::AtCmdRespOk) |
spastor | 0:fcaad0dfa051 | 603 | return Failure; |
spastor | 0:fcaad0dfa051 | 604 | |
spastor | 0:fcaad0dfa051 | 605 | return Success; |
spastor | 0:fcaad0dfa051 | 606 | } |
spastor | 0:fcaad0dfa051 | 607 | |
spastor | 0:fcaad0dfa051 | 608 | static uint16_t get_dio_ic_mask(XBeeZB::IoLine line) |
spastor | 0:fcaad0dfa051 | 609 | { |
spastor | 0:fcaad0dfa051 | 610 | if (line < XBeeZB::DIO12) { |
spastor | 0:fcaad0dfa051 | 611 | return (1 << line); |
spastor | 0:fcaad0dfa051 | 612 | } |
spastor | 0:fcaad0dfa051 | 613 | return 0; |
spastor | 0:fcaad0dfa051 | 614 | } |
spastor | 0:fcaad0dfa051 | 615 | |
spastor | 0:fcaad0dfa051 | 616 | RadioStatus XBeeZB::enable_dio_change_detection(const RemoteXBee& remote, IoLine line, bool enable) |
spastor | 0:fcaad0dfa051 | 617 | { |
spastor | 0:fcaad0dfa051 | 618 | if (line > DIO11) { |
spastor | 0:fcaad0dfa051 | 619 | digi_log(LogLevelError, "XBeeZB::enable_dio_change_detection: pin not supported (%d)\r\n", line); |
spastor | 0:fcaad0dfa051 | 620 | return Failure; |
spastor | 0:fcaad0dfa051 | 621 | } |
spastor | 0:fcaad0dfa051 | 622 | |
spastor | 0:fcaad0dfa051 | 623 | AtCmdFrame::AtCmdResp cmdresp; |
spastor | 0:fcaad0dfa051 | 624 | uint32_t var32; |
spastor | 0:fcaad0dfa051 | 625 | uint16_t ic; |
spastor | 0:fcaad0dfa051 | 626 | |
spastor | 0:fcaad0dfa051 | 627 | cmdresp = get_param(remote, "IC", &var32); |
spastor | 0:fcaad0dfa051 | 628 | if (cmdresp != AtCmdFrame::AtCmdRespOk) { |
spastor | 0:fcaad0dfa051 | 629 | return Failure; |
spastor | 0:fcaad0dfa051 | 630 | } |
spastor | 0:fcaad0dfa051 | 631 | ic = var32; |
spastor | 0:fcaad0dfa051 | 632 | |
spastor | 0:fcaad0dfa051 | 633 | const uint16_t dio_mask = get_dio_ic_mask(line); |
spastor | 0:fcaad0dfa051 | 634 | if (dio_mask == 0) { |
spastor | 0:fcaad0dfa051 | 635 | digi_log(LogLevelError, "XBeeZB::enable_dio_change_detection: invalid pin %d\r\n", line); |
spastor | 0:fcaad0dfa051 | 636 | return Failure; |
spastor | 0:fcaad0dfa051 | 637 | } |
spastor | 0:fcaad0dfa051 | 638 | |
spastor | 0:fcaad0dfa051 | 639 | if (enable) { |
spastor | 0:fcaad0dfa051 | 640 | ic |= dio_mask; |
spastor | 0:fcaad0dfa051 | 641 | } else { |
spastor | 0:fcaad0dfa051 | 642 | ic &= ~dio_mask; |
spastor | 0:fcaad0dfa051 | 643 | } |
spastor | 0:fcaad0dfa051 | 644 | |
spastor | 0:fcaad0dfa051 | 645 | cmdresp = set_param(remote, "IC", ic); |
spastor | 0:fcaad0dfa051 | 646 | if (cmdresp != AtCmdFrame::AtCmdRespOk) |
spastor | 0:fcaad0dfa051 | 647 | return Failure; |
spastor | 0:fcaad0dfa051 | 648 | |
spastor | 0:fcaad0dfa051 | 649 | return Success; |
spastor | 0:fcaad0dfa051 | 650 | } |