Luis Mendivil / XBeeLib_Test

XBee modules

Dependencies:   DigiLogger

Fork of XBeeLib by Digi International Inc.

XBee802/XBee802.cpp@2:2ee1b6d51df2, 2015-05-14 (annotated)

Committer:
hbujanda
Date:
Thu May 14 16:21:39 2015 +0200
Revision:
2:2ee1b6d51df2
Parent:
1:794d1d3e4a08
Child:
3:8662ebe83570
Automatic upload

Who changed what in which revision?

UserRevisionLine numberNew 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 #include "XBee802.h"
spastor 0:fcaad0dfa051 13 #include "IO/IOSample802.h"
spastor 0:fcaad0dfa051 14 #include "Frames/802_Frames.h"
spastor 0:fcaad0dfa051 15 #include "FrameHandlers/FH_ModemStatus.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 XBee802::XBee802(PinName tx, PinName rx, PinName reset, PinName rts, PinName cts, int baud) :
spastor 0:fcaad0dfa051 21 XBee(tx, rx, reset, rts, cts, baud),
spastor 0:fcaad0dfa051 22 _sync_lost_cnt(0), _nd_handler(NULL), _rx_64b_handler(NULL), _rx_16b_handler(NULL),
spastor 0:fcaad0dfa051 23 _io_data_64b_handler(NULL), _io_data_16b_handler(NULL)
spastor 0:fcaad0dfa051 24 {
spastor 0:fcaad0dfa051 25
spastor 0:fcaad0dfa051 26 _reset_timeout = RESET_TIMEOUT_MS;
spastor 0:fcaad0dfa051 27 }
spastor 0:fcaad0dfa051 28
spastor 0:fcaad0dfa051 29 /* Class destructor */
spastor 0:fcaad0dfa051 30 XBee802::~XBee802()
spastor 0:fcaad0dfa051 31 {
spastor 0:fcaad0dfa051 32 unregister_node_discovery_cb();
spastor 0:fcaad0dfa051 33 unregister_receive_cb();
spastor 0:fcaad0dfa051 34 unregister_io_sample_cb();
spastor 0:fcaad0dfa051 35 }
spastor 0:fcaad0dfa051 36
spastor 0:fcaad0dfa051 37 RadioStatus XBee802::init()
spastor 0:fcaad0dfa051 38 {
spastor 0:fcaad0dfa051 39 RadioStatus retval = XBee::init();
spastor 0:fcaad0dfa051 40 const RadioProtocol radioProtocol = get_radio_protocol();
spastor 0:fcaad0dfa051 41 if (radioProtocol != Raw_802_15_4) {
spastor 0:fcaad0dfa051 42 digi_log(LogLevelError, "Radio protocol does not match, needed a %d got a %d\r\n", Raw_802_15_4, radioProtocol);
spastor 0:fcaad0dfa051 43 retval = Failure;
spastor 0:fcaad0dfa051 44 }
spastor 0:fcaad0dfa051 45 assert(radioProtocol == Raw_802_15_4);
spastor 0:fcaad0dfa051 46
spastor 0:fcaad0dfa051 47 return retval;
spastor 0:fcaad0dfa051 48 }
spastor 0:fcaad0dfa051 49
spastor 0:fcaad0dfa051 50 RadioStatus XBee802::set_channel(uint8_t channel)
spastor 0:fcaad0dfa051 51 {
spastor 0:fcaad0dfa051 52 AtCmdFrame::AtCmdResp cmdresp;
spastor 0:fcaad0dfa051 53
spastor 0:fcaad0dfa051 54 if (is_PRO()) {
spastor 0:fcaad0dfa051 55 if (channel < 0x0C || channel > 0x17) {
spastor 0:fcaad0dfa051 56 return Failure;
spastor 0:fcaad0dfa051 57 }
spastor 0:fcaad0dfa051 58 } else {
spastor 0:fcaad0dfa051 59 if (channel < 0x0B || channel > 0x1A) {
spastor 0:fcaad0dfa051 60 return Failure;
spastor 0:fcaad0dfa051 61 }
spastor 0:fcaad0dfa051 62 }
spastor 0:fcaad0dfa051 63
spastor 0:fcaad0dfa051 64 cmdresp = set_param("CH", channel);
spastor 0:fcaad0dfa051 65 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
spastor 0:fcaad0dfa051 66 return Failure;
spastor 0:fcaad0dfa051 67 }
spastor 0:fcaad0dfa051 68 return Success;
spastor 0:fcaad0dfa051 69 }
spastor 0:fcaad0dfa051 70
spastor 0:fcaad0dfa051 71 RadioStatus XBee802::get_channel(uint8_t * const channel)
spastor 0:fcaad0dfa051 72 {
spastor 0:fcaad0dfa051 73 if (channel == NULL) {
spastor 0:fcaad0dfa051 74 return Failure;
spastor 0:fcaad0dfa051 75 }
spastor 0:fcaad0dfa051 76 AtCmdFrame::AtCmdResp cmdresp;
spastor 0:fcaad0dfa051 77
spastor 0:fcaad0dfa051 78 uint32_t var32;
spastor 0:fcaad0dfa051 79 cmdresp = get_param("CH", &var32);
spastor 0:fcaad0dfa051 80 if (cmdresp != AtCmdFrame::AtCmdRespOk)
spastor 0:fcaad0dfa051 81 return Failure;
spastor 0:fcaad0dfa051 82 *channel = var32;
spastor 0:fcaad0dfa051 83 return Success;
spastor 0:fcaad0dfa051 84 }
spastor 0:fcaad0dfa051 85
spastor 0:fcaad0dfa051 86 RadioStatus XBee802::set_panid(uint16_t panid)
spastor 0:fcaad0dfa051 87 {
spastor 0:fcaad0dfa051 88 AtCmdFrame::AtCmdResp cmdresp;
spastor 0:fcaad0dfa051 89
spastor 0:fcaad0dfa051 90 cmdresp = set_param("ID", panid);
spastor 0:fcaad0dfa051 91 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
spastor 0:fcaad0dfa051 92 return Failure;
spastor 0:fcaad0dfa051 93 }
spastor 0:fcaad0dfa051 94 return Success;
spastor 0:fcaad0dfa051 95 }
spastor 0:fcaad0dfa051 96
spastor 0:fcaad0dfa051 97 RadioStatus XBee802::get_panid(uint16_t * const panid)
spastor 0:fcaad0dfa051 98 {
spastor 0:fcaad0dfa051 99 if (panid == NULL) {
spastor 0:fcaad0dfa051 100 return Failure;
spastor 0:fcaad0dfa051 101 }
spastor 0:fcaad0dfa051 102 AtCmdFrame::AtCmdResp cmdresp;
spastor 0:fcaad0dfa051 103
spastor 0:fcaad0dfa051 104 uint32_t var32;
spastor 0:fcaad0dfa051 105 cmdresp = get_param("ID", &var32);
spastor 0:fcaad0dfa051 106 if (cmdresp != AtCmdFrame::AtCmdRespOk)
spastor 0:fcaad0dfa051 107 return Failure;
spastor 0:fcaad0dfa051 108 *panid = var32;
spastor 0:fcaad0dfa051 109 return Success;
spastor 0:fcaad0dfa051 110 }
spastor 0:fcaad0dfa051 111
spastor 0:fcaad0dfa051 112 RadioStatus XBee802::set_network_address(uint16_t addr16)
spastor 0:fcaad0dfa051 113 {
spastor 0:fcaad0dfa051 114 AtCmdFrame::AtCmdResp cmdresp;
spastor 0:fcaad0dfa051 115
spastor 0:fcaad0dfa051 116 cmdresp = set_param("MY", addr16);
spastor 0:fcaad0dfa051 117 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
spastor 0:fcaad0dfa051 118 return Failure;
spastor 0:fcaad0dfa051 119 }
spastor 0:fcaad0dfa051 120 return Success;
spastor 0:fcaad0dfa051 121 }
spastor 0:fcaad0dfa051 122
spastor 0:fcaad0dfa051 123 void XBee802::radio_status_update(AtCmdFrame::ModemStatus modem_status)
spastor 0:fcaad0dfa051 124 {
spastor 0:fcaad0dfa051 125 /* Update the radio status variables */
spastor 0:fcaad0dfa051 126 if (modem_status == AtCmdFrame::HwReset)
spastor 0:fcaad0dfa051 127 _hw_reset_cnt++;
spastor 0:fcaad0dfa051 128 else if (modem_status == AtCmdFrame::WdReset)
spastor 0:fcaad0dfa051 129 _wd_reset_cnt++;
spastor 0:fcaad0dfa051 130 else if (modem_status == AtCmdFrame::SyncLost)
spastor 0:fcaad0dfa051 131 _sync_lost_cnt++;
spastor 0:fcaad0dfa051 132
spastor 0:fcaad0dfa051 133 _modem_status = modem_status;
spastor 0:fcaad0dfa051 134
spastor 0:fcaad0dfa051 135 digi_log(LogLevelDebug, "\r\nUpdating radio status: %02x\r\n", modem_status);
spastor 0:fcaad0dfa051 136 }
spastor 0:fcaad0dfa051 137
spastor 0:fcaad0dfa051 138 TxStatus XBee802::send_data(const RemoteXBee& remote, const uint8_t *const data, uint16_t len)
spastor 0:fcaad0dfa051 139 {
spastor 0:fcaad0dfa051 140 if (remote.is_valid_addr64b()) {
spastor 0:fcaad0dfa051 141 const uint64_t remote64 = remote.get_addr64();
spastor 0:fcaad0dfa051 142
spastor 0:fcaad0dfa051 143 digi_log(LogLevelDebug, "send_data ADDR64: %08x:%08x\r\n", UINT64_HI32(remote64), UINT64_LO32(remote64));
spastor 0:fcaad0dfa051 144
spastor 0:fcaad0dfa051 145 TxFrame802 frame = TxFrame802(remote64, _tx_options, data, len);
spastor 0:fcaad0dfa051 146
spastor 0:fcaad0dfa051 147 return send_data(&frame);
spastor 0:fcaad0dfa051 148 }
spastor 0:fcaad0dfa051 149
spastor 0:fcaad0dfa051 150 if (remote.is_valid_addr16b()) {
spastor 0:fcaad0dfa051 151 const uint16_t remote16 = remote.get_addr16();
spastor 0:fcaad0dfa051 152
spastor 0:fcaad0dfa051 153 digi_log(LogLevelDebug, "send_data ADDR16: %04x\r\n", remote16);
spastor 0:fcaad0dfa051 154
spastor 0:fcaad0dfa051 155 TxFrame802 frame = TxFrame802(remote16, _tx_options, data, len);
spastor 0:fcaad0dfa051 156
spastor 0:fcaad0dfa051 157 return send_data(&frame);
spastor 0:fcaad0dfa051 158 }
spastor 0:fcaad0dfa051 159
spastor 0:fcaad0dfa051 160 return TxStatusInvalidAddr;
spastor 0:fcaad0dfa051 161 }
spastor 0:fcaad0dfa051 162
hbujanda 2:2ee1b6d51df2 163 TxStatus XBee802::send_data_asyncr(const RemoteXBee& remote, const uint8_t *const data, uint16_t len)
spastor 0:fcaad0dfa051 164 {
hbujanda 2:2ee1b6d51df2 165 if (remote.is_valid_addr64b()) {
hbujanda 2:2ee1b6d51df2 166 const uint64_t remote64 = remote.get_addr64();
hbujanda 2:2ee1b6d51df2 167
hbujanda 2:2ee1b6d51df2 168 digi_log(LogLevelDebug, "send_data ADDR64: %08x:%08x\r\n", UINT64_HI32(remote64), UINT64_LO32(remote64));
hbujanda 2:2ee1b6d51df2 169
hbujanda 2:2ee1b6d51df2 170 TxFrame802 frame = TxFrame802(remote64, _tx_options, data, len);
hbujanda 2:2ee1b6d51df2 171
hbujanda 2:2ee1b6d51df2 172 send_api_frame(&frame);
hbujanda 2:2ee1b6d51df2 173 return TxStatusSuccess;
hbujanda 2:2ee1b6d51df2 174 }
hbujanda 2:2ee1b6d51df2 175
hbujanda 2:2ee1b6d51df2 176 if (remote.is_valid_addr16b()) {
hbujanda 2:2ee1b6d51df2 177 const uint16_t remote16 = remote.get_addr16();
hbujanda 2:2ee1b6d51df2 178
hbujanda 2:2ee1b6d51df2 179 digi_log(LogLevelDebug, "send_data ADDR16: %04x\r\n", remote16);
hbujanda 2:2ee1b6d51df2 180
hbujanda 2:2ee1b6d51df2 181 TxFrame802 frame = TxFrame802(remote16, _tx_options, data, len);
hbujanda 2:2ee1b6d51df2 182
hbujanda 2:2ee1b6d51df2 183 send_api_frame(&frame);
hbujanda 2:2ee1b6d51df2 184 return TxStatusSuccess;
hbujanda 2:2ee1b6d51df2 185 }
hbujanda 2:2ee1b6d51df2 186
hbujanda 2:2ee1b6d51df2 187 return TxStatusInvalidAddr;
hbujanda 1:794d1d3e4a08 188 }
hbujanda 1:794d1d3e4a08 189
hbujanda 2:2ee1b6d51df2 190 RemoteXBee802 XBee802::get_remote_node_by_id(const char * const node_id)
hbujanda 1:794d1d3e4a08 191 {
hbujanda 2:2ee1b6d51df2 192 uint64_t addr64;
hbujanda 2:2ee1b6d51df2 193 uint16_t addr16;
hbujanda 2:2ee1b6d51df2 194 _get_remote_node_by_id(node_id, &addr64, &addr16);
hbujanda 2:2ee1b6d51df2 195 return RemoteXBee802(addr64, addr16);
spastor 0:fcaad0dfa051 196 }
spastor 0:fcaad0dfa051 197
spastor 0:fcaad0dfa051 198 void XBee802::register_node_discovery_cb(node_discovery_802_cb_t function)
spastor 0:fcaad0dfa051 199 {
spastor 0:fcaad0dfa051 200 if (_nd_handler == NULL) {
spastor 0:fcaad0dfa051 201 _nd_handler = new FH_NodeDiscovery802();
spastor 0:fcaad0dfa051 202 register_frame_handler(_nd_handler);
spastor 0:fcaad0dfa051 203 }
spastor 0:fcaad0dfa051 204 _nd_handler->register_node_discovery_cb(function);
spastor 0:fcaad0dfa051 205 }
spastor 0:fcaad0dfa051 206
spastor 0:fcaad0dfa051 207 void XBee802::unregister_node_discovery_cb()
spastor 0:fcaad0dfa051 208 {
spastor 0:fcaad0dfa051 209 if (_nd_handler != NULL) {
spastor 0:fcaad0dfa051 210 _nd_handler->unregister_node_discovery_cb();
spastor 0:fcaad0dfa051 211 unregister_frame_handler(_nd_handler);
spastor 0:fcaad0dfa051 212 delete _nd_handler;
spastor 0:fcaad0dfa051 213 _nd_handler = NULL; /* as delete does not set to NULL */
spastor 0:fcaad0dfa051 214 }
spastor 0:fcaad0dfa051 215 }
spastor 0:fcaad0dfa051 216
spastor 0:fcaad0dfa051 217 void XBee802::register_receive_cb(receive_802_cb_t function)
spastor 0:fcaad0dfa051 218 {
spastor 0:fcaad0dfa051 219 if (_rx_64b_handler == NULL) {
spastor 0:fcaad0dfa051 220 _rx_64b_handler = new FH_RxPacket64b802();
spastor 0:fcaad0dfa051 221 register_frame_handler(_rx_64b_handler);
spastor 0:fcaad0dfa051 222 }
spastor 0:fcaad0dfa051 223 _rx_64b_handler->register_receive_cb(function);
spastor 0:fcaad0dfa051 224
spastor 0:fcaad0dfa051 225 if (_rx_16b_handler == NULL) {
spastor 0:fcaad0dfa051 226 _rx_16b_handler = new FH_RxPacket16b802();
spastor 0:fcaad0dfa051 227 register_frame_handler(_rx_16b_handler);
spastor 0:fcaad0dfa051 228 }
spastor 0:fcaad0dfa051 229 _rx_16b_handler->register_receive_cb(function);
spastor 0:fcaad0dfa051 230 }
spastor 0:fcaad0dfa051 231
spastor 0:fcaad0dfa051 232 void XBee802::unregister_receive_cb()
spastor 0:fcaad0dfa051 233 {
spastor 0:fcaad0dfa051 234 if (_rx_64b_handler != NULL) {
spastor 0:fcaad0dfa051 235 _rx_64b_handler->unregister_receive_cb();
spastor 0:fcaad0dfa051 236 unregister_frame_handler(_rx_64b_handler);
spastor 0:fcaad0dfa051 237 delete _rx_64b_handler;
spastor 0:fcaad0dfa051 238 _rx_64b_handler = NULL; /* as delete does not set to NULL */
spastor 0:fcaad0dfa051 239 }
spastor 0:fcaad0dfa051 240
spastor 0:fcaad0dfa051 241 if (_rx_16b_handler != NULL) {
spastor 0:fcaad0dfa051 242 _rx_16b_handler->unregister_receive_cb();
spastor 0:fcaad0dfa051 243 unregister_frame_handler(_rx_16b_handler);
spastor 0:fcaad0dfa051 244 delete _rx_16b_handler;
spastor 0:fcaad0dfa051 245 _rx_16b_handler = NULL; /* as delete does not set to NULL */
spastor 0:fcaad0dfa051 246 }
spastor 0:fcaad0dfa051 247 }
spastor 0:fcaad0dfa051 248
spastor 0:fcaad0dfa051 249 void XBee802::register_io_sample_cb(io_data_cb_802_t function)
spastor 0:fcaad0dfa051 250 {
spastor 0:fcaad0dfa051 251 if (_io_data_64b_handler == NULL) {
spastor 0:fcaad0dfa051 252 _io_data_64b_handler = new FH_IoDataSampe64b802();
spastor 0:fcaad0dfa051 253 register_frame_handler(_io_data_64b_handler);
spastor 0:fcaad0dfa051 254 }
spastor 0:fcaad0dfa051 255 _io_data_64b_handler->register_io_data_cb(function);
spastor 0:fcaad0dfa051 256
spastor 0:fcaad0dfa051 257 if (_io_data_16b_handler == NULL) {
spastor 0:fcaad0dfa051 258 _io_data_16b_handler = new FH_IoDataSampe16b802();
spastor 0:fcaad0dfa051 259 register_frame_handler(_io_data_16b_handler);
spastor 0:fcaad0dfa051 260 }
spastor 0:fcaad0dfa051 261 _io_data_16b_handler->register_io_data_cb(function);
spastor 0:fcaad0dfa051 262 }
spastor 0:fcaad0dfa051 263
spastor 0:fcaad0dfa051 264 void XBee802::unregister_io_sample_cb()
spastor 0:fcaad0dfa051 265 {
spastor 0:fcaad0dfa051 266 if (_io_data_64b_handler != NULL) {
spastor 0:fcaad0dfa051 267 _io_data_64b_handler->unregister_io_data_cb();
spastor 0:fcaad0dfa051 268 unregister_frame_handler(_io_data_64b_handler);
spastor 0:fcaad0dfa051 269 delete _io_data_64b_handler;
spastor 0:fcaad0dfa051 270 _io_data_64b_handler = NULL; /* as delete does not set to NULL */
spastor 0:fcaad0dfa051 271 }
spastor 0:fcaad0dfa051 272
spastor 0:fcaad0dfa051 273 if (_io_data_16b_handler != NULL) {
spastor 0:fcaad0dfa051 274 _io_data_16b_handler->unregister_io_data_cb();
spastor 0:fcaad0dfa051 275 unregister_frame_handler(_io_data_16b_handler);
spastor 0:fcaad0dfa051 276 delete _io_data_16b_handler;
spastor 0:fcaad0dfa051 277 _io_data_16b_handler = NULL; /* as delete does not set to NULL */
spastor 0:fcaad0dfa051 278 }
spastor 0:fcaad0dfa051 279 }
spastor 0:fcaad0dfa051 280
spastor 0:fcaad0dfa051 281 AtCmdFrame::AtCmdResp XBee802::get_param(const RemoteXBee& remote, const char * const param, uint32_t * const data)
spastor 0:fcaad0dfa051 282 {
spastor 0:fcaad0dfa051 283 uint16_t len = sizeof *data;
spastor 0:fcaad0dfa051 284 AtCmdFrame::AtCmdResp atCmdResponse;
spastor 0:fcaad0dfa051 285
spastor 0:fcaad0dfa051 286 if (remote.is_valid_addr64b()) {
spastor 0:fcaad0dfa051 287 const uint64_t dev_addr64 = remote.get_addr64();
spastor 0:fcaad0dfa051 288
spastor 0:fcaad0dfa051 289 AtCmdFrame cmd_frame = AtCmdFrame(dev_addr64, param);
spastor 0:fcaad0dfa051 290 atCmdResponse = send_at_cmd(&cmd_frame, (uint8_t *)data, &len, RadioRemote);
spastor 0:fcaad0dfa051 291 } else if (remote.is_valid_addr16b()) {
spastor 0:fcaad0dfa051 292 const uint16_t dev_addr16 = remote.get_addr16();
spastor 0:fcaad0dfa051 293
spastor 0:fcaad0dfa051 294 AtCmdFrame cmd_frame = AtCmdFrame(dev_addr16, param);
spastor 0:fcaad0dfa051 295 atCmdResponse = send_at_cmd(&cmd_frame, (uint8_t *)data, &len, RadioRemote);
spastor 0:fcaad0dfa051 296 } else {
spastor 0:fcaad0dfa051 297 return AtCmdFrame::AtCmdRespInvalidAddr;
spastor 0:fcaad0dfa051 298 }
spastor 0:fcaad0dfa051 299
spastor 0:fcaad0dfa051 300 if (atCmdResponse == AtCmdFrame::AtCmdRespOk && len > sizeof *data) {
spastor 0:fcaad0dfa051 301 atCmdResponse = AtCmdFrame::AtCmdRespLenMismatch;
spastor 0:fcaad0dfa051 302 }
spastor 0:fcaad0dfa051 303
spastor 0:fcaad0dfa051 304 return atCmdResponse;
spastor 0:fcaad0dfa051 305 }
spastor 0:fcaad0dfa051 306
spastor 0:fcaad0dfa051 307 AtCmdFrame::AtCmdResp XBee802::set_param(const RemoteXBee& remote, const char * const param, uint32_t data)
spastor 0:fcaad0dfa051 308 {
spastor 0:fcaad0dfa051 309 if (remote.is_valid_addr64b()) {
spastor 0:fcaad0dfa051 310 const uint64_t dev_addr64 = remote.get_addr64();
spastor 0:fcaad0dfa051 311
spastor 0:fcaad0dfa051 312 AtCmdFrame cmd_frame = AtCmdFrame(dev_addr64, param, data);
spastor 0:fcaad0dfa051 313 return send_at_cmd(&cmd_frame, NULL, NULL, RadioRemote);
spastor 0:fcaad0dfa051 314 }
spastor 0:fcaad0dfa051 315
spastor 0:fcaad0dfa051 316 if (remote.is_valid_addr16b()) {
spastor 0:fcaad0dfa051 317 const uint16_t dev_addr16 = remote.get_addr16();
spastor 0:fcaad0dfa051 318
spastor 0:fcaad0dfa051 319 AtCmdFrame cmd_frame = AtCmdFrame(dev_addr16, param, data);
spastor 0:fcaad0dfa051 320 return send_at_cmd(&cmd_frame, NULL, NULL, RadioRemote);
spastor 0:fcaad0dfa051 321 }
spastor 0:fcaad0dfa051 322
spastor 0:fcaad0dfa051 323 return AtCmdFrame::AtCmdRespInvalidAddr;
spastor 0:fcaad0dfa051 324 }
spastor 0:fcaad0dfa051 325
spastor 0:fcaad0dfa051 326 AtCmdFrame::AtCmdResp XBee802::set_param(const RemoteXBee& remote, const char * const param, const uint8_t * data, uint16_t len)
spastor 0:fcaad0dfa051 327 {
spastor 0:fcaad0dfa051 328 if (remote.is_valid_addr64b()) {
spastor 0:fcaad0dfa051 329 const uint64_t dev_addr64 = remote.get_addr64();
spastor 0:fcaad0dfa051 330
spastor 0:fcaad0dfa051 331 AtCmdFrame cmd_frame = AtCmdFrame(dev_addr64, param, data, len);
spastor 0:fcaad0dfa051 332 return send_at_cmd(&cmd_frame, NULL, NULL, RadioRemote);
spastor 0:fcaad0dfa051 333 }
spastor 0:fcaad0dfa051 334
spastor 0:fcaad0dfa051 335 if (remote.is_valid_addr16b()) {
spastor 0:fcaad0dfa051 336 const uint16_t dev_addr16 = remote.get_addr16();
spastor 0:fcaad0dfa051 337
spastor 0:fcaad0dfa051 338 AtCmdFrame cmd_frame = AtCmdFrame(dev_addr16, param, data, len);
spastor 0:fcaad0dfa051 339 return send_at_cmd(&cmd_frame, NULL, NULL, RadioRemote);
spastor 0:fcaad0dfa051 340 }
spastor 0:fcaad0dfa051 341
spastor 0:fcaad0dfa051 342 return AtCmdFrame::AtCmdRespInvalidAddr;
spastor 0:fcaad0dfa051 343 }
spastor 0:fcaad0dfa051 344
spastor 0:fcaad0dfa051 345 AtCmdFrame::AtCmdResp XBee802::get_param(const RemoteXBee& remote, const char * const param, uint8_t * const data, uint16_t * const len)
spastor 0:fcaad0dfa051 346 {
spastor 0:fcaad0dfa051 347 if (remote.is_valid_addr64b()) {
spastor 0:fcaad0dfa051 348 uint64_t dev_addr64 = remote.get_addr64();
spastor 0:fcaad0dfa051 349
spastor 0:fcaad0dfa051 350 AtCmdFrame cmd_frame = AtCmdFrame(dev_addr64, param);
spastor 0:fcaad0dfa051 351 return send_at_cmd(&cmd_frame, data, len, RadioRemote, false);
spastor 0:fcaad0dfa051 352 }
spastor 0:fcaad0dfa051 353
spastor 0:fcaad0dfa051 354 if (remote.is_valid_addr16b()) {
spastor 0:fcaad0dfa051 355 uint16_t dev_addr16 = remote.get_addr16();
spastor 0:fcaad0dfa051 356
spastor 0:fcaad0dfa051 357 AtCmdFrame cmd_frame = AtCmdFrame(dev_addr16, param);
spastor 0:fcaad0dfa051 358 return send_at_cmd(&cmd_frame, data, len, RadioRemote, false);
spastor 0:fcaad0dfa051 359 }
spastor 0:fcaad0dfa051 360
spastor 0:fcaad0dfa051 361 return AtCmdFrame::AtCmdRespInvalidAddr;
spastor 0:fcaad0dfa051 362 }
spastor 0:fcaad0dfa051 363
spastor 0:fcaad0dfa051 364 static void get_dio_cmd(XBee802::IoLine line, char * const iocmd)
spastor 0:fcaad0dfa051 365 {
spastor 0:fcaad0dfa051 366 if (line >= XBee802::PWM0) {
spastor 0:fcaad0dfa051 367 iocmd[0] = 'P';
spastor 0:fcaad0dfa051 368 iocmd[1] = '0' + line - XBee802::PWM0;
spastor 0:fcaad0dfa051 369 } else {
spastor 0:fcaad0dfa051 370 iocmd[0] = 'D';
spastor 0:fcaad0dfa051 371 iocmd[1] = '0' + line;
spastor 0:fcaad0dfa051 372 }
spastor 0:fcaad0dfa051 373 iocmd[2] = '\0';
spastor 0:fcaad0dfa051 374 }
spastor 0:fcaad0dfa051 375
spastor 0:fcaad0dfa051 376 RadioStatus XBee802::set_pin_config(const RemoteXBee& remote, IoLine line, IoMode mode)
spastor 0:fcaad0dfa051 377 {
spastor 0:fcaad0dfa051 378 AtCmdFrame::AtCmdResp cmdresp;
spastor 0:fcaad0dfa051 379 char iocmd[3];
spastor 0:fcaad0dfa051 380
spastor 0:fcaad0dfa051 381 get_dio_cmd(line, iocmd);
spastor 0:fcaad0dfa051 382
spastor 0:fcaad0dfa051 383 cmdresp = set_param(remote, iocmd, (uint8_t)mode);
spastor 0:fcaad0dfa051 384 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
spastor 0:fcaad0dfa051 385 digi_log(LogLevelError, "set_pin_config: set_param returned %d\r\n", cmdresp);
spastor 0:fcaad0dfa051 386 return Failure;
spastor 0:fcaad0dfa051 387 }
spastor 0:fcaad0dfa051 388
spastor 0:fcaad0dfa051 389 return Success;
spastor 0:fcaad0dfa051 390 }
spastor 0:fcaad0dfa051 391
spastor 0:fcaad0dfa051 392 RadioStatus XBee802::get_pin_config(const RemoteXBee& remote, IoLine line, IoMode * const mode)
spastor 0:fcaad0dfa051 393 {
spastor 0:fcaad0dfa051 394 AtCmdFrame::AtCmdResp cmdresp;
spastor 0:fcaad0dfa051 395 char iocmd[3];
spastor 0:fcaad0dfa051 396
spastor 0:fcaad0dfa051 397 get_dio_cmd(line, iocmd);
spastor 0:fcaad0dfa051 398
spastor 0:fcaad0dfa051 399 uint32_t var32;
spastor 0:fcaad0dfa051 400 cmdresp = get_param(remote, iocmd, &var32);
spastor 0:fcaad0dfa051 401 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
spastor 0:fcaad0dfa051 402 return Failure;
spastor 0:fcaad0dfa051 403 }
spastor 0:fcaad0dfa051 404 *mode = (IoMode)var32;
spastor 0:fcaad0dfa051 405
spastor 0:fcaad0dfa051 406 return Success;
spastor 0:fcaad0dfa051 407 }
spastor 0:fcaad0dfa051 408
spastor 0:fcaad0dfa051 409 RadioStatus XBee802::set_dio(const RemoteXBee& remote, IoLine line, DioVal val)
spastor 0:fcaad0dfa051 410 {
spastor 0:fcaad0dfa051 411 if (line > DI8) {
spastor 0:fcaad0dfa051 412 digi_log(LogLevelError, "set_dio: Pin %d not supported as IO\r\n", line);
spastor 0:fcaad0dfa051 413 return Failure;
spastor 0:fcaad0dfa051 414 }
spastor 0:fcaad0dfa051 415
spastor 0:fcaad0dfa051 416 if (val == Low) {
spastor 0:fcaad0dfa051 417 return set_pin_config(remote, line, DigitalOutLow);
spastor 0:fcaad0dfa051 418 } else {
spastor 0:fcaad0dfa051 419 return set_pin_config(remote, line, DigitalOutHigh);
spastor 0:fcaad0dfa051 420 }
spastor 0:fcaad0dfa051 421 }
spastor 0:fcaad0dfa051 422
spastor 0:fcaad0dfa051 423 RadioStatus XBee802::get_dio(const RemoteXBee& remote, IoLine line, DioVal * const val)
spastor 0:fcaad0dfa051 424 {
spastor 0:fcaad0dfa051 425 uint8_t io_sample[MAX_IO_SAMPLE_BUF_LEN];
spastor 0:fcaad0dfa051 426 uint16_t len;
spastor 0:fcaad0dfa051 427
spastor 0:fcaad0dfa051 428 if (line > DI8) {
spastor 0:fcaad0dfa051 429 digi_log(LogLevelError, "get_dio: Pin %d not supported as IO\r\n", line);
spastor 0:fcaad0dfa051 430 return Failure;
spastor 0:fcaad0dfa051 431 }
spastor 0:fcaad0dfa051 432
spastor 0:fcaad0dfa051 433 RadioStatus resp = get_iosample(remote, io_sample, &len);
spastor 0:fcaad0dfa051 434 if (resp != Success)
spastor 0:fcaad0dfa051 435 return resp;
spastor 0:fcaad0dfa051 436
spastor 0:fcaad0dfa051 437 IOSample802 ioSample = IOSample802(io_sample, len);
spastor 0:fcaad0dfa051 438 return ioSample.get_dio(line, val);
spastor 0:fcaad0dfa051 439 }
spastor 0:fcaad0dfa051 440
spastor 0:fcaad0dfa051 441 RadioStatus XBee802::get_adc(const RemoteXBee& remote, IoLine line, uint16_t * const val)
spastor 0:fcaad0dfa051 442 {
spastor 0:fcaad0dfa051 443 uint8_t io_sample[MAX_IO_SAMPLE_BUF_LEN];
spastor 0:fcaad0dfa051 444 uint16_t len;
spastor 0:fcaad0dfa051 445
spastor 0:fcaad0dfa051 446 if (line > DIO5_AD5) {
spastor 0:fcaad0dfa051 447 digi_log(LogLevelError, "get_adc: Pin %d not supported as ADC\r\n", line);
spastor 0:fcaad0dfa051 448 return Failure;
spastor 0:fcaad0dfa051 449 }
spastor 0:fcaad0dfa051 450
spastor 0:fcaad0dfa051 451 RadioStatus resp = get_iosample(remote, io_sample, &len);
spastor 0:fcaad0dfa051 452 if (resp != Success) {
spastor 0:fcaad0dfa051 453 return resp;
spastor 0:fcaad0dfa051 454 }
spastor 0:fcaad0dfa051 455
spastor 0:fcaad0dfa051 456 IOSample802 ioSample = IOSample802(io_sample, len);
spastor 0:fcaad0dfa051 457 return ioSample.get_adc(line, val);
spastor 0:fcaad0dfa051 458 }
spastor 0:fcaad0dfa051 459
spastor 0:fcaad0dfa051 460 RadioStatus XBee802::set_pwm(const RemoteXBee& remote, IoLine line, float duty_cycle)
spastor 0:fcaad0dfa051 461 {
spastor 0:fcaad0dfa051 462 AtCmdFrame::AtCmdResp cmdresp;
spastor 0:fcaad0dfa051 463 char iocmd[3] = { 'M', '0', '\0' };
spastor 0:fcaad0dfa051 464
spastor 0:fcaad0dfa051 465 if (line != PWM0 && line != PWM1) {
spastor 0:fcaad0dfa051 466 return Failure;
spastor 0:fcaad0dfa051 467 }
spastor 0:fcaad0dfa051 468 if (line == PWM1) {
spastor 0:fcaad0dfa051 469 iocmd[1] = '1';
spastor 0:fcaad0dfa051 470 }
spastor 0:fcaad0dfa051 471
spastor 0:fcaad0dfa051 472 uint16_t pwm_val = (uint16_t)(duty_cycle * DR_PWM_MAX_VAL / 100);
spastor 0:fcaad0dfa051 473
spastor 0:fcaad0dfa051 474 cmdresp = set_param(remote, iocmd, pwm_val);
spastor 0:fcaad0dfa051 475 if (cmdresp != AtCmdFrame::AtCmdRespOk)
spastor 0:fcaad0dfa051 476 return Failure;
spastor 0:fcaad0dfa051 477
spastor 0:fcaad0dfa051 478 return Success;
spastor 0:fcaad0dfa051 479 }
spastor 0:fcaad0dfa051 480
spastor 0:fcaad0dfa051 481 static uint8_t get_dio_mask(XBee802::IoLine line)
spastor 0:fcaad0dfa051 482 {
spastor 0:fcaad0dfa051 483 switch (line) {
spastor 0:fcaad0dfa051 484 case XBee802::DIO4_AD4:
spastor 0:fcaad0dfa051 485 return (1 << 0);
spastor 0:fcaad0dfa051 486 case XBee802::DIO3_AD3:
spastor 0:fcaad0dfa051 487 return (1 << 1);
spastor 0:fcaad0dfa051 488 case XBee802::DIO2_AD2:
spastor 0:fcaad0dfa051 489 return (1 << 2);
spastor 0:fcaad0dfa051 490 case XBee802::DIO1_AD1:
spastor 0:fcaad0dfa051 491 return (1 << 3);
spastor 0:fcaad0dfa051 492 case XBee802::DIO0_AD0:
spastor 0:fcaad0dfa051 493 return (1 << 4);
spastor 0:fcaad0dfa051 494 case XBee802::DIO6:
spastor 0:fcaad0dfa051 495 return (1 << 5);
spastor 0:fcaad0dfa051 496 case XBee802::DI8:
spastor 0:fcaad0dfa051 497 return (1 << 6);
spastor 0:fcaad0dfa051 498 default:
spastor 0:fcaad0dfa051 499 return 0;
spastor 0:fcaad0dfa051 500 }
spastor 0:fcaad0dfa051 501 }
spastor 0:fcaad0dfa051 502
spastor 0:fcaad0dfa051 503 RadioStatus XBee802::set_pin_pull_up(const RemoteXBee& remote, IoLine line, bool enable)
spastor 0:fcaad0dfa051 504 {
spastor 0:fcaad0dfa051 505 AtCmdFrame::AtCmdResp cmdresp;
spastor 0:fcaad0dfa051 506 uint32_t var32;
spastor 0:fcaad0dfa051 507 uint8_t pr;
spastor 0:fcaad0dfa051 508
spastor 0:fcaad0dfa051 509 cmdresp = get_param(remote, "PR", &var32);
spastor 0:fcaad0dfa051 510 if (cmdresp != AtCmdFrame::AtCmdRespOk)
spastor 0:fcaad0dfa051 511 return Failure;
spastor 0:fcaad0dfa051 512 pr = var32;
spastor 0:fcaad0dfa051 513
spastor 0:fcaad0dfa051 514 const uint8_t dio_mask = get_dio_mask(line);
spastor 0:fcaad0dfa051 515 if (dio_mask == 0) {
spastor 0:fcaad0dfa051 516 digi_log(LogLevelError, "XBee802::set_pin_pull_up: invalid pin %d\r\n", line);
spastor 0:fcaad0dfa051 517 return Failure;
spastor 0:fcaad0dfa051 518 }
spastor 0:fcaad0dfa051 519
spastor 0:fcaad0dfa051 520 if (enable) {
spastor 0:fcaad0dfa051 521 pr |= dio_mask;
spastor 0:fcaad0dfa051 522 } else {
spastor 0:fcaad0dfa051 523 pr &= ~dio_mask;
spastor 0:fcaad0dfa051 524 }
spastor 0:fcaad0dfa051 525
spastor 0:fcaad0dfa051 526 cmdresp = set_param(remote, "PR", pr);
spastor 0:fcaad0dfa051 527 if (cmdresp != AtCmdFrame::AtCmdRespOk)
spastor 0:fcaad0dfa051 528 return Failure;
spastor 0:fcaad0dfa051 529
spastor 0:fcaad0dfa051 530 return Success;
spastor 0:fcaad0dfa051 531 }
spastor 0:fcaad0dfa051 532
spastor 0:fcaad0dfa051 533 static uint8_t get_dio_ic_mask(XBee802::IoLine line)
spastor 0:fcaad0dfa051 534 {
spastor 0:fcaad0dfa051 535 if (line < XBee802::DI8) {
spastor 0:fcaad0dfa051 536 return (1 << line);
spastor 0:fcaad0dfa051 537 }
spastor 0:fcaad0dfa051 538 return 0;
spastor 0:fcaad0dfa051 539 }
spastor 0:fcaad0dfa051 540
spastor 0:fcaad0dfa051 541 RadioStatus XBee802::enable_dio_change_detection(const RemoteXBee& remote, IoLine line, bool enable)
spastor 0:fcaad0dfa051 542 {
spastor 0:fcaad0dfa051 543 if (line > DIO7) {
spastor 0:fcaad0dfa051 544 digi_log(LogLevelError, "XBee802::enable_dio_change_detection: pin not supported (%d)\r\n", line);
spastor 0:fcaad0dfa051 545 return Failure;
spastor 0:fcaad0dfa051 546 }
spastor 0:fcaad0dfa051 547
spastor 0:fcaad0dfa051 548 AtCmdFrame::AtCmdResp cmdresp;
spastor 0:fcaad0dfa051 549 uint32_t var32;
spastor 0:fcaad0dfa051 550 uint8_t ic;
spastor 0:fcaad0dfa051 551
spastor 0:fcaad0dfa051 552 cmdresp = get_param(remote, "IC", &var32);
spastor 0:fcaad0dfa051 553 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
spastor 0:fcaad0dfa051 554 return Failure;
spastor 0:fcaad0dfa051 555 }
spastor 0:fcaad0dfa051 556 ic = var32;
spastor 0:fcaad0dfa051 557
spastor 0:fcaad0dfa051 558 const uint8_t dio_mask = get_dio_ic_mask(line);
spastor 0:fcaad0dfa051 559 if (dio_mask == 0) {
spastor 0:fcaad0dfa051 560 digi_log(LogLevelError, "XBeeZB::enable_dio_change_detection: invalid pin %d\r\n", line);
spastor 0:fcaad0dfa051 561 return Failure;
spastor 0:fcaad0dfa051 562 }
spastor 0:fcaad0dfa051 563
spastor 0:fcaad0dfa051 564 if (enable) {
spastor 0:fcaad0dfa051 565 ic |= dio_mask;
spastor 0:fcaad0dfa051 566 } else {
spastor 0:fcaad0dfa051 567 ic &= ~dio_mask;
spastor 0:fcaad0dfa051 568 }
spastor 0:fcaad0dfa051 569
spastor 0:fcaad0dfa051 570 cmdresp = set_param(remote, "IC", ic);
spastor 0:fcaad0dfa051 571 if (cmdresp != AtCmdFrame::AtCmdRespOk)
spastor 0:fcaad0dfa051 572 return Failure;
spastor 0:fcaad0dfa051 573
spastor 0:fcaad0dfa051 574 return Success;
spastor 0:fcaad0dfa051 575 }
spastor 0:fcaad0dfa051 576
spastor 0:fcaad0dfa051 577 #ifdef GET_PWM_AVAILABLE
spastor 0:fcaad0dfa051 578 RadioStatus XBee802::get_pwm(const RemoteXBee& remote, IoLine line, float * const duty_cycle)
spastor 0:fcaad0dfa051 579 {
spastor 0:fcaad0dfa051 580 AtCmdFrame::AtCmdResp cmdresp;
spastor 0:fcaad0dfa051 581 char iocmd[3] = { 'M', '0', '\0' };
spastor 0:fcaad0dfa051 582
spastor 0:fcaad0dfa051 583 if (line != PWM0 && line != PWM1)
spastor 0:fcaad0dfa051 584 return Failure;
spastor 0:fcaad0dfa051 585
spastor 0:fcaad0dfa051 586 if (line == PWM1)
spastor 0:fcaad0dfa051 587 iocmd[1] = '1';
spastor 0:fcaad0dfa051 588
spastor 0:fcaad0dfa051 589 uint16_t pwm_val;
spastor 0:fcaad0dfa051 590
spastor 0:fcaad0dfa051 591 cmdresp = get_param(remote, iocmd, &pwm_val);
spastor 0:fcaad0dfa051 592 if (cmdresp != AtCmdFrame::AtCmdRespOk)
spastor 0:fcaad0dfa051 593 return Failure;
spastor 0:fcaad0dfa051 594
spastor 0:fcaad0dfa051 595 *duty_cycle = (float)(pwm_val * 100 / DR_PWM_MAX_VAL);
spastor 0:fcaad0dfa051 596
spastor 0:fcaad0dfa051 597 return Success;
spastor 0:fcaad0dfa051 598 }
spastor 0:fcaad0dfa051 599 #endif