Bas Vuyk / XBeeLib_Master

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 Digi International Inc.

XBeeDM/XBeeDM.cpp@7:3ac2a461ce76, 2016-07-28 (annotated)

Committer:
hbujanda
Date:
Thu Jul 28 15:36:36 2016 +0200
Revision:
7:3ac2a461ce76
Parent:
6:06522f3a6642
Child:
8:b5f4a0e92249
Automatic upload

Who changed what in which revision?

UserRevisionLine numberNew contents of line
hbujanda 6:06522f3a6642 1 /**
hbujanda 6:06522f3a6642 2 * Copyright (c) 2015 Digi International Inc.,
hbujanda 6:06522f3a6642 3 * All rights not expressly granted are reserved.
hbujanda 6:06522f3a6642 4 *
hbujanda 6:06522f3a6642 5 * This Source Code Form is subject to the terms of the Mozilla Public
hbujanda 6:06522f3a6642 6 * License, v. 2.0. If a copy of the MPL was not distributed with this file,
hbujanda 6:06522f3a6642 7 * You can obtain one at http://mozilla.org/MPL/2.0/.
hbujanda 6:06522f3a6642 8 *
hbujanda 6:06522f3a6642 9 * Digi International Inc. 11001 Bren Road East, Minnetonka, MN 55343
hbujanda 6:06522f3a6642 10 * =======================================================================
hbujanda 6:06522f3a6642 11 */
hbujanda 6:06522f3a6642 12
hbujanda 6:06522f3a6642 13 #include "XBeeDM.h"
hbujanda 6:06522f3a6642 14 #include "IO/IOSampleDM.h"
hbujanda 6:06522f3a6642 15 #include "Frames/DigiMeshFrames.h"
hbujanda 6:06522f3a6642 16
hbujanda 6:06522f3a6642 17 using namespace XBeeLib;
hbujanda 6:06522f3a6642 18
hbujanda 6:06522f3a6642 19 #define BROADCAST_RADIUS_USE_NH 0x00
hbujanda 6:06522f3a6642 20
hbujanda 6:06522f3a6642 21 /* Class constructor */
hbujanda 6:06522f3a6642 22 XBeeDM::XBeeDM(PinName tx, PinName rx, PinName reset, PinName rts, PinName cts, int baud) :
hbujanda 6:06522f3a6642 23 XBee(tx, rx, reset, rts, cts, baud), _nd_handler(NULL), _rx_pkt_handler(NULL), _io_data_handler(NULL)
hbujanda 6:06522f3a6642 24 {
hbujanda 6:06522f3a6642 25 }
hbujanda 6:06522f3a6642 26
hbujanda 6:06522f3a6642 27 RadioStatus XBeeDM::init()
hbujanda 6:06522f3a6642 28 {
hbujanda 6:06522f3a6642 29 RadioStatus retval = XBee::init();
hbujanda 6:06522f3a6642 30
hbujanda 6:06522f3a6642 31 const RadioProtocol radioProtocol = get_radio_protocol();
hbujanda 6:06522f3a6642 32 if (radioProtocol != DigiMesh) {
hbujanda 6:06522f3a6642 33 digi_log(LogLevelError, "Radio protocol does not match, needed a %d got a %d\r\n", DigiMesh, radioProtocol);
hbujanda 6:06522f3a6642 34 retval = Failure;
hbujanda 6:06522f3a6642 35 }
hbujanda 6:06522f3a6642 36 assert(radioProtocol == DigiMesh);
hbujanda 6:06522f3a6642 37
hbujanda 6:06522f3a6642 38 return retval;
hbujanda 6:06522f3a6642 39 }
hbujanda 6:06522f3a6642 40
hbujanda 6:06522f3a6642 41 /* Class destructor */
hbujanda 6:06522f3a6642 42 XBeeDM::~XBeeDM()
hbujanda 6:06522f3a6642 43 {
hbujanda 6:06522f3a6642 44 unregister_node_discovery_cb();
hbujanda 6:06522f3a6642 45 unregister_receive_cb();
hbujanda 6:06522f3a6642 46 unregister_io_sample_cb();
hbujanda 6:06522f3a6642 47 }
hbujanda 6:06522f3a6642 48
hbujanda 6:06522f3a6642 49 RadioStatus XBeeDM::set_channel(uint8_t channel)
hbujanda 6:06522f3a6642 50 {
hbujanda 6:06522f3a6642 51 AtCmdFrame::AtCmdResp cmdresp;
hbujanda 6:06522f3a6642 52
hbujanda 6:06522f3a6642 53 /* Pro and Non-Pro modules have different channels available. The at
hbujanda 6:06522f3a6642 54 command will return an error if the selected channel is not available */
hbujanda 6:06522f3a6642 55 cmdresp = set_param("CH", channel);
hbujanda 6:06522f3a6642 56 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
hbujanda 6:06522f3a6642 57 return Failure;
hbujanda 6:06522f3a6642 58 }
hbujanda 6:06522f3a6642 59 return Success;
hbujanda 6:06522f3a6642 60 }
hbujanda 6:06522f3a6642 61
hbujanda 6:06522f3a6642 62 RadioStatus XBeeDM::get_channel(uint8_t * const channel)
hbujanda 6:06522f3a6642 63 {
hbujanda 6:06522f3a6642 64 if (channel == NULL) {
hbujanda 6:06522f3a6642 65 return Failure;
hbujanda 6:06522f3a6642 66 }
hbujanda 6:06522f3a6642 67 AtCmdFrame::AtCmdResp cmdresp;
hbujanda 6:06522f3a6642 68
hbujanda 6:06522f3a6642 69 uint32_t var32;
hbujanda 6:06522f3a6642 70 cmdresp = get_param("CH", &var32);
hbujanda 6:06522f3a6642 71 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
hbujanda 6:06522f3a6642 72 return Failure;
hbujanda 6:06522f3a6642 73 }
hbujanda 6:06522f3a6642 74 *channel = var32;
hbujanda 6:06522f3a6642 75 return Success;
hbujanda 6:06522f3a6642 76 }
hbujanda 6:06522f3a6642 77
hbujanda 6:06522f3a6642 78 RadioStatus XBeeDM::set_network_id(uint16_t network_id)
hbujanda 6:06522f3a6642 79 {
hbujanda 6:06522f3a6642 80 AtCmdFrame::AtCmdResp cmdresp;
hbujanda 6:06522f3a6642 81
hbujanda 6:06522f3a6642 82 cmdresp = set_param("ID", network_id);
hbujanda 6:06522f3a6642 83 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
hbujanda 6:06522f3a6642 84 return Failure;
hbujanda 6:06522f3a6642 85 }
hbujanda 6:06522f3a6642 86 return Success;
hbujanda 6:06522f3a6642 87 }
hbujanda 6:06522f3a6642 88
hbujanda 6:06522f3a6642 89 RadioStatus XBeeDM::get_network_id(uint16_t * const network_id)
hbujanda 6:06522f3a6642 90 {
hbujanda 6:06522f3a6642 91 if (network_id == NULL) {
hbujanda 6:06522f3a6642 92 return Failure;
hbujanda 6:06522f3a6642 93 }
hbujanda 6:06522f3a6642 94 AtCmdFrame::AtCmdResp cmdresp;
hbujanda 6:06522f3a6642 95
hbujanda 6:06522f3a6642 96 uint32_t var32;
hbujanda 6:06522f3a6642 97 cmdresp = get_param("ID", &var32);
hbujanda 6:06522f3a6642 98 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
hbujanda 6:06522f3a6642 99 return Failure;
hbujanda 6:06522f3a6642 100 }
hbujanda 6:06522f3a6642 101 *network_id = var32;
hbujanda 6:06522f3a6642 102 return Success;
hbujanda 6:06522f3a6642 103 }
hbujanda 6:06522f3a6642 104
hbujanda 6:06522f3a6642 105 RadioStatus XBeeDM::get_node_discovery_timeout(uint16_t * const timeout_ms)
hbujanda 6:06522f3a6642 106 {
hbujanda 6:06522f3a6642 107 AtCmdFrame::AtCmdResp cmdresp;
hbujanda 6:06522f3a6642 108 uint32_t var32;
hbujanda 6:06522f3a6642 109
hbujanda 6:06522f3a6642 110 cmdresp = get_param("N?", &var32);
hbujanda 6:06522f3a6642 111 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
hbujanda 6:06522f3a6642 112 return Failure;
hbujanda 6:06522f3a6642 113 }
hbujanda 6:06522f3a6642 114 *timeout_ms = (uint16_t)var32;
hbujanda 6:06522f3a6642 115
hbujanda 6:06522f3a6642 116 return Success;
hbujanda 6:06522f3a6642 117 }
hbujanda 6:06522f3a6642 118
hbujanda 6:06522f3a6642 119 RadioStatus XBeeDM::get_node_discovery_timeout(uint16_t * const timeout_ms, bool * const wait_for_complete_timeout)
hbujanda 6:06522f3a6642 120 {
hbujanda 6:06522f3a6642 121 const RadioStatus status = get_node_discovery_timeout(timeout_ms);
hbujanda 6:06522f3a6642 122
hbujanda 6:06522f3a6642 123 *wait_for_complete_timeout = false;
hbujanda 6:06522f3a6642 124
hbujanda 6:06522f3a6642 125 return status;
hbujanda 6:06522f3a6642 126 }
hbujanda 6:06522f3a6642 127
hbujanda 6:06522f3a6642 128 RadioStatus XBeeDM::set_network_security_key(const uint8_t * const key, const uint16_t length)
hbujanda 6:06522f3a6642 129 {
hbujanda 6:06522f3a6642 130 if (key == NULL || length == 0 || length > 16) {
hbujanda 6:06522f3a6642 131 return Failure;
hbujanda 6:06522f3a6642 132 }
hbujanda 6:06522f3a6642 133 AtCmdFrame::AtCmdResp cmdresp;
hbujanda 6:06522f3a6642 134
hbujanda 6:06522f3a6642 135 cmdresp = set_param("NK", key, length);
hbujanda 6:06522f3a6642 136 return cmdresp == AtCmdFrame::AtCmdRespOk ? Success : Failure;
hbujanda 6:06522f3a6642 137 }
hbujanda 6:06522f3a6642 138
hbujanda 6:06522f3a6642 139 RadioStatus XBeeDM::set_encryption_options(const uint8_t options)
hbujanda 6:06522f3a6642 140 {
hbujanda 6:06522f3a6642 141 AtCmdFrame::AtCmdResp cmdresp;
hbujanda 6:06522f3a6642 142
hbujanda 6:06522f3a6642 143 cmdresp = set_param("EO", options);
hbujanda 6:06522f3a6642 144 return cmdresp == AtCmdFrame::AtCmdRespOk ? Success : Failure;
hbujanda 6:06522f3a6642 145 }
hbujanda 6:06522f3a6642 146
hbujanda 6:06522f3a6642 147 void XBeeDM::radio_status_update(AtCmdFrame::ModemStatus modem_status)
hbujanda 6:06522f3a6642 148 {
hbujanda 6:06522f3a6642 149 /* Update the radio status variables */
hbujanda 6:06522f3a6642 150 if (modem_status == AtCmdFrame::HwReset) {
hbujanda 6:06522f3a6642 151 _hw_reset_cnt++;
hbujanda 6:06522f3a6642 152 } else if (modem_status == AtCmdFrame::WdReset) {
hbujanda 6:06522f3a6642 153 _wd_reset_cnt++;
hbujanda 6:06522f3a6642 154 }
hbujanda 6:06522f3a6642 155
hbujanda 6:06522f3a6642 156 _modem_status = modem_status;
hbujanda 6:06522f3a6642 157
hbujanda 6:06522f3a6642 158 digi_log(LogLevelDebug, "\r\nUpdating radio status: %02x\r\n", modem_status);
hbujanda 6:06522f3a6642 159 }
hbujanda 6:06522f3a6642 160
hbujanda 6:06522f3a6642 161 TxStatus XBeeDM::send_data(const RemoteXBee& remote, const uint8_t *const data, uint16_t len, bool syncr)
hbujanda 6:06522f3a6642 162 {
hbujanda 6:06522f3a6642 163 if (!remote.is_valid_addr64b()) {
hbujanda 6:06522f3a6642 164 return TxStatusInvalidAddr;
hbujanda 6:06522f3a6642 165 }
hbujanda 6:06522f3a6642 166
hbujanda 6:06522f3a6642 167 const uint64_t remote64 = remote.get_addr64();
hbujanda 6:06522f3a6642 168 const uint16_t remote16 = remote.get_addr16();
hbujanda 6:06522f3a6642 169
hbujanda 6:06522f3a6642 170 TxFrameDM frame = TxFrameDM(remote64, remote16, BROADCAST_RADIUS_USE_NH,
hbujanda 6:06522f3a6642 171 _tx_options, data, len);
hbujanda 6:06522f3a6642 172 if (syncr) {
hbujanda 6:06522f3a6642 173 return send_data(&frame);
hbujanda 6:06522f3a6642 174 } else {
hbujanda 6:06522f3a6642 175 frame.set_data(0, 0); /* Set frame id to 0 so there is no answer */
hbujanda 6:06522f3a6642 176 send_api_frame(&frame);
hbujanda 6:06522f3a6642 177 return TxStatusSuccess;
hbujanda 6:06522f3a6642 178 }
hbujanda 6:06522f3a6642 179 }
hbujanda 6:06522f3a6642 180
hbujanda 6:06522f3a6642 181 TxStatus XBeeDM::send_data(const RemoteXBee& remote, uint8_t source_ep,
hbujanda 6:06522f3a6642 182 uint8_t dest_ep, uint16_t cluster_id, uint16_t profile_id,
hbujanda 6:06522f3a6642 183 const uint8_t *const data, uint16_t len, bool syncr)
hbujanda 6:06522f3a6642 184 {
hbujanda 6:06522f3a6642 185 if (!remote.is_valid_addr64b()) {
hbujanda 6:06522f3a6642 186 return TxStatusInvalidAddr;
hbujanda 6:06522f3a6642 187 }
hbujanda 6:06522f3a6642 188
hbujanda 6:06522f3a6642 189 const uint64_t remote64 = remote.get_addr64();
hbujanda 6:06522f3a6642 190 const uint16_t remote16 = remote.get_addr16();
hbujanda 6:06522f3a6642 191
hbujanda 6:06522f3a6642 192 TxFrameDM frame = TxFrameDM(remote64, remote16, source_ep, dest_ep,
hbujanda 6:06522f3a6642 193 cluster_id, profile_id, BROADCAST_RADIUS_USE_NH,
hbujanda 6:06522f3a6642 194 _tx_options, data, len);
hbujanda 6:06522f3a6642 195 if (syncr) {
hbujanda 6:06522f3a6642 196 return send_data(&frame);
hbujanda 6:06522f3a6642 197 } else {
hbujanda 6:06522f3a6642 198 frame.set_data(0, 0); /* Set frame id to 0 so there is no answer */
hbujanda 6:06522f3a6642 199 send_api_frame(&frame);
hbujanda 6:06522f3a6642 200 return TxStatusSuccess;
hbujanda 6:06522f3a6642 201 }
hbujanda 6:06522f3a6642 202 }
hbujanda 6:06522f3a6642 203
hbujanda 6:06522f3a6642 204 TxStatus XBeeDM::send_data_to_coordinator(const uint8_t *const data, uint16_t len, bool syncr)
hbujanda 6:06522f3a6642 205 {
hbujanda 6:06522f3a6642 206 const uint64_t remaddr = ADDR64_COORDINATOR;
hbujanda 6:06522f3a6642 207
hbujanda 6:06522f3a6642 208 TxFrameDM frame = TxFrameDM(remaddr, ADDR16_UNKNOWN, BROADCAST_RADIUS_USE_NH, _tx_options, data, len);
hbujanda 6:06522f3a6642 209 if (syncr) {
hbujanda 6:06522f3a6642 210 return send_data(&frame);
hbujanda 6:06522f3a6642 211 } else {
hbujanda 6:06522f3a6642 212 frame.set_data(0, 0); /* Set frame id to 0 so there is no answer */
hbujanda 6:06522f3a6642 213 send_api_frame(&frame);
hbujanda 6:06522f3a6642 214 return TxStatusSuccess;
hbujanda 6:06522f3a6642 215 }
hbujanda 6:06522f3a6642 216 }
hbujanda 6:06522f3a6642 217
hbujanda 6:06522f3a6642 218 RemoteXBeeDM XBeeDM::get_remote_node_by_id(const char * const node_id)
hbujanda 6:06522f3a6642 219 {
hbujanda 6:06522f3a6642 220 uint64_t addr64;
hbujanda 6:06522f3a6642 221 uint16_t addr16;
hbujanda 6:06522f3a6642 222 _get_remote_node_by_id(node_id, &addr64, &addr16);
hbujanda 6:06522f3a6642 223 return RemoteXBeeDM(addr64);
hbujanda 6:06522f3a6642 224 }
hbujanda 6:06522f3a6642 225
hbujanda 6:06522f3a6642 226 XBeeDM::AssocStatus XBeeDM::get_assoc_status(void)
hbujanda 6:06522f3a6642 227 {
hbujanda 6:06522f3a6642 228 return (AssocStatus)get_AI();
hbujanda 6:06522f3a6642 229 }
hbujanda 6:06522f3a6642 230
hbujanda 6:06522f3a6642 231 void XBeeDM::register_node_discovery_cb(node_discovery_dm_cb_t function)
hbujanda 6:06522f3a6642 232 {
hbujanda 6:06522f3a6642 233 if (_nd_handler == NULL) {
hbujanda 6:06522f3a6642 234 _nd_handler = new FH_NodeDiscoveryDM();
hbujanda 6:06522f3a6642 235 register_frame_handler(_nd_handler);
hbujanda 6:06522f3a6642 236 }
hbujanda 6:06522f3a6642 237 _nd_handler->register_node_discovery_cb(function);
hbujanda 6:06522f3a6642 238 }
hbujanda 6:06522f3a6642 239
hbujanda 6:06522f3a6642 240 void XBeeDM::unregister_node_discovery_cb()
hbujanda 6:06522f3a6642 241 {
hbujanda 6:06522f3a6642 242 if (_nd_handler != NULL) {
hbujanda 6:06522f3a6642 243 _nd_handler->unregister_node_discovery_cb();
hbujanda 6:06522f3a6642 244 unregister_frame_handler(_nd_handler);
hbujanda 6:06522f3a6642 245 delete _nd_handler;
hbujanda 6:06522f3a6642 246 _nd_handler = NULL; /* as delete does not set to NULL */
hbujanda 6:06522f3a6642 247 }
hbujanda 6:06522f3a6642 248 }
hbujanda 6:06522f3a6642 249
hbujanda 6:06522f3a6642 250 void XBeeDM::register_receive_cb(receive_dm_cb_t function)
hbujanda 6:06522f3a6642 251 {
hbujanda 6:06522f3a6642 252 if (_rx_pkt_handler == NULL) {
hbujanda 6:06522f3a6642 253 _rx_pkt_handler = new FH_RxPacketDM();
hbujanda 6:06522f3a6642 254 register_frame_handler(_rx_pkt_handler);
hbujanda 6:06522f3a6642 255 }
hbujanda 6:06522f3a6642 256 _rx_pkt_handler->register_receive_cb(function);
hbujanda 6:06522f3a6642 257 }
hbujanda 6:06522f3a6642 258
hbujanda 6:06522f3a6642 259 void XBeeDM::unregister_receive_cb()
hbujanda 6:06522f3a6642 260 {
hbujanda 6:06522f3a6642 261 if (_rx_pkt_handler != NULL) {
hbujanda 6:06522f3a6642 262 _rx_pkt_handler->unregister_receive_cb();
hbujanda 6:06522f3a6642 263 unregister_frame_handler(_rx_pkt_handler);
hbujanda 6:06522f3a6642 264 delete _rx_pkt_handler;
hbujanda 6:06522f3a6642 265 _rx_pkt_handler = NULL; /* as delete does not set to NULL */
hbujanda 6:06522f3a6642 266 }
hbujanda 6:06522f3a6642 267 }
hbujanda 6:06522f3a6642 268
hbujanda 6:06522f3a6642 269 void XBeeDM::register_io_sample_cb(io_data_cb_dm_t function)
hbujanda 6:06522f3a6642 270 {
hbujanda 6:06522f3a6642 271 if (_io_data_handler == NULL) {
hbujanda 6:06522f3a6642 272 _io_data_handler = new FH_IoDataSampeDM();
hbujanda 6:06522f3a6642 273 register_frame_handler(_io_data_handler);
hbujanda 6:06522f3a6642 274 }
hbujanda 6:06522f3a6642 275 _io_data_handler->register_io_data_cb(function);
hbujanda 6:06522f3a6642 276 }
hbujanda 6:06522f3a6642 277
hbujanda 6:06522f3a6642 278 void XBeeDM::unregister_io_sample_cb()
hbujanda 6:06522f3a6642 279 {
hbujanda 6:06522f3a6642 280 if (_io_data_handler != NULL) {
hbujanda 6:06522f3a6642 281 _io_data_handler->unregister_io_data_cb();
hbujanda 6:06522f3a6642 282 unregister_frame_handler(_io_data_handler);
hbujanda 6:06522f3a6642 283 delete _io_data_handler;
hbujanda 6:06522f3a6642 284 _io_data_handler = NULL; /* as delete does not set to NULL */
hbujanda 6:06522f3a6642 285 }
hbujanda 6:06522f3a6642 286 }
hbujanda 6:06522f3a6642 287
hbujanda 6:06522f3a6642 288 AtCmdFrame::AtCmdResp XBeeDM::get_param(const RemoteXBee& remote, const char * const param, uint32_t * const data)
hbujanda 6:06522f3a6642 289 {
hbujanda 6:06522f3a6642 290 if (!remote.is_valid_addr64b()) {
hbujanda 6:06522f3a6642 291 return AtCmdFrame::AtCmdRespInvalidAddr;
hbujanda 6:06522f3a6642 292 }
hbujanda 6:06522f3a6642 293
hbujanda 6:06522f3a6642 294 const uint64_t remote64 = remote.get_addr64();
hbujanda 6:06522f3a6642 295 const uint16_t remote16 = remote.get_addr16();
hbujanda 6:06522f3a6642 296 uint16_t len = sizeof *data;
hbujanda 6:06522f3a6642 297 AtCmdFrame::AtCmdResp atCmdResponse;
hbujanda 6:06522f3a6642 298
hbujanda 6:06522f3a6642 299 AtCmdFrame cmd_frame = AtCmdFrame(remote64, remote16, param);
hbujanda 6:06522f3a6642 300 atCmdResponse = send_at_cmd(&cmd_frame, (uint8_t *)data, &len, RadioRemote);
hbujanda 6:06522f3a6642 301
hbujanda 6:06522f3a6642 302 if (atCmdResponse == AtCmdFrame::AtCmdRespOk && len > sizeof *data) {
hbujanda 6:06522f3a6642 303 atCmdResponse = AtCmdFrame::AtCmdRespLenMismatch;
hbujanda 6:06522f3a6642 304 }
hbujanda 6:06522f3a6642 305
hbujanda 6:06522f3a6642 306 return atCmdResponse;
hbujanda 6:06522f3a6642 307 }
hbujanda 6:06522f3a6642 308
hbujanda 6:06522f3a6642 309 AtCmdFrame::AtCmdResp XBeeDM::set_param(const RemoteXBee& remote, const char * const param, uint32_t data)
hbujanda 6:06522f3a6642 310 {
hbujanda 6:06522f3a6642 311 if (!remote.is_valid_addr64b()) {
hbujanda 6:06522f3a6642 312 return AtCmdFrame::AtCmdRespInvalidAddr;
hbujanda 6:06522f3a6642 313 }
hbujanda 6:06522f3a6642 314
hbujanda 6:06522f3a6642 315 const uint64_t remote64 = remote.get_addr64();
hbujanda 6:06522f3a6642 316 const uint16_t remote16 = remote.get_addr16();
hbujanda 6:06522f3a6642 317
hbujanda 6:06522f3a6642 318 AtCmdFrame cmd_frame = AtCmdFrame(remote64, remote16, param, data);
hbujanda 6:06522f3a6642 319 return send_at_cmd(&cmd_frame, NULL, NULL, RadioRemote);
hbujanda 6:06522f3a6642 320 }
hbujanda 6:06522f3a6642 321
hbujanda 6:06522f3a6642 322 AtCmdFrame::AtCmdResp XBeeDM::set_param(const RemoteXBee& remote, const char * const param, const uint8_t * data, uint16_t len)
hbujanda 6:06522f3a6642 323 {
hbujanda 6:06522f3a6642 324 if (!remote.is_valid_addr64b()) {
hbujanda 6:06522f3a6642 325 return AtCmdFrame::AtCmdRespInvalidAddr;
hbujanda 6:06522f3a6642 326 }
hbujanda 6:06522f3a6642 327
hbujanda 6:06522f3a6642 328 const uint64_t remote64 = remote.get_addr64();
hbujanda 6:06522f3a6642 329 const uint16_t remote16 = remote.get_addr16();
hbujanda 6:06522f3a6642 330
hbujanda 6:06522f3a6642 331 AtCmdFrame cmd_frame = AtCmdFrame(remote64, remote16, param, data, len);
hbujanda 6:06522f3a6642 332 return send_at_cmd(&cmd_frame, NULL, NULL, RadioRemote);
hbujanda 6:06522f3a6642 333 }
hbujanda 6:06522f3a6642 334
hbujanda 6:06522f3a6642 335 AtCmdFrame::AtCmdResp XBeeDM::get_param(const RemoteXBee& remote, const char * const param, uint8_t * const data, uint16_t * const len)
hbujanda 6:06522f3a6642 336 {
hbujanda 6:06522f3a6642 337
hbujanda 6:06522f3a6642 338 if (!remote.is_valid_addr64b()) {
hbujanda 6:06522f3a6642 339 return AtCmdFrame::AtCmdRespInvalidAddr;
hbujanda 6:06522f3a6642 340 }
hbujanda 6:06522f3a6642 341
hbujanda 6:06522f3a6642 342 const uint64_t remote64 = remote.get_addr64();
hbujanda 6:06522f3a6642 343 const uint16_t remote16 = remote.get_addr16();
hbujanda 6:06522f3a6642 344
hbujanda 6:06522f3a6642 345 AtCmdFrame cmd_frame = AtCmdFrame(remote64, remote16, param);
hbujanda 6:06522f3a6642 346 return send_at_cmd(&cmd_frame, data, len, RadioRemote, false);
hbujanda 6:06522f3a6642 347 }
hbujanda 6:06522f3a6642 348
hbujanda 6:06522f3a6642 349 static void get_dio_cmd(XBeeDM::IoLine line, char * const iocmd)
hbujanda 6:06522f3a6642 350 {
hbujanda 6:06522f3a6642 351 if (line >= XBeeDM::DIO10_PWM0) {
hbujanda 6:06522f3a6642 352 iocmd[0] = 'P';
hbujanda 6:06522f3a6642 353 iocmd[1] = '0' + line - XBeeDM::DIO10_PWM0;
hbujanda 6:06522f3a6642 354 } else {
hbujanda 6:06522f3a6642 355 iocmd[0] = 'D';
hbujanda 6:06522f3a6642 356 iocmd[1] = '0' + line;
hbujanda 6:06522f3a6642 357 }
hbujanda 6:06522f3a6642 358 iocmd[2] = '\0';
hbujanda 6:06522f3a6642 359 }
hbujanda 6:06522f3a6642 360
hbujanda 6:06522f3a6642 361 RadioStatus XBeeDM::set_pin_config(const RemoteXBee& remote, IoLine line, IoMode mode)
hbujanda 6:06522f3a6642 362 {
hbujanda 6:06522f3a6642 363 AtCmdFrame::AtCmdResp cmdresp;
hbujanda 6:06522f3a6642 364 char iocmd[3];
hbujanda 6:06522f3a6642 365
hbujanda 6:06522f3a6642 366 get_dio_cmd(line, iocmd);
hbujanda 6:06522f3a6642 367
hbujanda 6:06522f3a6642 368 cmdresp = set_param(remote, iocmd, (uint8_t)mode);
hbujanda 6:06522f3a6642 369 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
hbujanda 6:06522f3a6642 370 digi_log(LogLevelError, "set_pin_config: set_param returned %d\r\n", cmdresp);
hbujanda 6:06522f3a6642 371 return Failure;
hbujanda 6:06522f3a6642 372 }
hbujanda 6:06522f3a6642 373
hbujanda 6:06522f3a6642 374 return Success;
hbujanda 6:06522f3a6642 375 }
hbujanda 6:06522f3a6642 376
hbujanda 6:06522f3a6642 377 RadioStatus XBeeDM::get_pin_config(const RemoteXBee& remote, IoLine line, IoMode * const mode)
hbujanda 6:06522f3a6642 378 {
hbujanda 6:06522f3a6642 379 AtCmdFrame::AtCmdResp cmdresp;
hbujanda 6:06522f3a6642 380 char iocmd[3];
hbujanda 6:06522f3a6642 381
hbujanda 6:06522f3a6642 382 get_dio_cmd(line, iocmd);
hbujanda 6:06522f3a6642 383
hbujanda 6:06522f3a6642 384 uint32_t var32;
hbujanda 6:06522f3a6642 385 cmdresp = get_param(remote, iocmd, &var32);
hbujanda 6:06522f3a6642 386 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
hbujanda 6:06522f3a6642 387 return Failure;
hbujanda 6:06522f3a6642 388 }
hbujanda 6:06522f3a6642 389 *mode = (IoMode)var32;
hbujanda 6:06522f3a6642 390
hbujanda 6:06522f3a6642 391 return Success;
hbujanda 6:06522f3a6642 392 }
hbujanda 6:06522f3a6642 393
hbujanda 6:06522f3a6642 394 RadioStatus XBeeDM::set_dio(const RemoteXBee& remote, IoLine line, DioVal val)
hbujanda 6:06522f3a6642 395 {
hbujanda 6:06522f3a6642 396 return set_pin_config(remote, line, val == Low ? DigitalOutLow : DigitalOutHigh);
hbujanda 6:06522f3a6642 397 }
hbujanda 6:06522f3a6642 398
hbujanda 6:06522f3a6642 399 RadioStatus XBeeDM::get_dio(const RemoteXBee& remote, IoLine line, DioVal * const val)
hbujanda 6:06522f3a6642 400 {
hbujanda 6:06522f3a6642 401 return get_iosample(remote).get_dio(line, val);
hbujanda 6:06522f3a6642 402 }
hbujanda 6:06522f3a6642 403
hbujanda 6:06522f3a6642 404 RadioStatus XBeeDM::get_adc(const RemoteXBee& remote, IoLine line, uint16_t * const val)
hbujanda 6:06522f3a6642 405 {
hbujanda 6:06522f3a6642 406 return get_iosample(remote).get_adc(line, val);
hbujanda 6:06522f3a6642 407 }
hbujanda 6:06522f3a6642 408
hbujanda 6:06522f3a6642 409 RadioStatus XBeeDM::set_pwm(const RemoteXBee& remote, IoLine line, float duty_cycle)
hbujanda 6:06522f3a6642 410 {
hbujanda 6:06522f3a6642 411 AtCmdFrame::AtCmdResp cmdresp;
hbujanda 6:06522f3a6642 412 char iocmd[3] = { 'M', '0', '\0' };
hbujanda 6:06522f3a6642 413
hbujanda 6:06522f3a6642 414 if (line != DIO10_PWM0 && line != DIO11_PWM1) {
hbujanda 6:06522f3a6642 415 return Failure;
hbujanda 6:06522f3a6642 416 }
hbujanda 6:06522f3a6642 417 if (line == DIO11_PWM1) {
hbujanda 6:06522f3a6642 418 iocmd[1] = '1';
hbujanda 6:06522f3a6642 419 }
hbujanda 6:06522f3a6642 420
hbujanda 6:06522f3a6642 421 uint16_t pwm_val = (uint16_t)(duty_cycle * DR_PWM_MAX_VAL / 100);
hbujanda 6:06522f3a6642 422
hbujanda 6:06522f3a6642 423 cmdresp = set_param(remote, iocmd, pwm_val);
hbujanda 6:06522f3a6642 424 return cmdresp == AtCmdFrame::AtCmdRespOk ? Success : Failure;
hbujanda 6:06522f3a6642 425 }
hbujanda 6:06522f3a6642 426
hbujanda 6:06522f3a6642 427 IOSampleDM XBeeDM::get_iosample(const RemoteXBee& remote)
hbujanda 6:06522f3a6642 428 {
hbujanda 6:06522f3a6642 429 uint8_t io_sample[MAX_IO_SAMPLE_DM_LEN];
hbujanda 6:06522f3a6642 430 uint16_t len = sizeof io_sample;
hbujanda 6:06522f3a6642 431
hbujanda 6:06522f3a6642 432 RadioStatus resp = _get_iosample(remote, io_sample, &len);
hbujanda 6:06522f3a6642 433 if (resp != Success) {
hbujanda 6:06522f3a6642 434 digi_log(LogLevelError, "XBeeDM::get_iosample failed to get an IOSample\r\n");
hbujanda 6:06522f3a6642 435 len = 0;
hbujanda 6:06522f3a6642 436 }
hbujanda 6:06522f3a6642 437
hbujanda 6:06522f3a6642 438 return IOSampleDM(io_sample, len);
hbujanda 6:06522f3a6642 439 }
hbujanda 6:06522f3a6642 440
hbujanda 6:06522f3a6642 441 static uint16_t get_dio_pr_mask(XBeeDM::IoLine line)
hbujanda 6:06522f3a6642 442 {
hbujanda 6:06522f3a6642 443 switch (line) {
hbujanda 6:06522f3a6642 444 case XBeeDM::DIO4:
hbujanda 6:06522f3a6642 445 return (1 << 0);
hbujanda 6:06522f3a6642 446 case XBeeDM::DIO3_AD3:
hbujanda 6:06522f3a6642 447 return (1 << 1);
hbujanda 6:06522f3a6642 448 case XBeeDM::DIO2_AD2:
hbujanda 6:06522f3a6642 449 return (1 << 2);
hbujanda 6:06522f3a6642 450 case XBeeDM::DIO1_AD1:
hbujanda 6:06522f3a6642 451 return (1 << 3);
hbujanda 6:06522f3a6642 452 case XBeeDM::DIO0_AD0:
hbujanda 6:06522f3a6642 453 return (1 << 4);
hbujanda 6:06522f3a6642 454 case XBeeDM::DIO6:
hbujanda 6:06522f3a6642 455 return (1 << 5);
hbujanda 6:06522f3a6642 456 case XBeeDM::DIO8:
hbujanda 6:06522f3a6642 457 return (1 << 6);
hbujanda 6:06522f3a6642 458 case XBeeDM::DIO5:
hbujanda 6:06522f3a6642 459 return (1 << 8);
hbujanda 6:06522f3a6642 460 case XBeeDM::DIO9:
hbujanda 6:06522f3a6642 461 return (1 << 9);
hbujanda 6:06522f3a6642 462 case XBeeDM::DIO12:
hbujanda 6:06522f3a6642 463 return (1 << 10);
hbujanda 6:06522f3a6642 464 case XBeeDM::DIO10_PWM0:
hbujanda 6:06522f3a6642 465 return (1 << 11);
hbujanda 6:06522f3a6642 466 case XBeeDM::DIO11_PWM1:
hbujanda 6:06522f3a6642 467 return (1 << 12);
hbujanda 6:06522f3a6642 468 case XBeeDM::DIO7:
hbujanda 6:06522f3a6642 469 return (1 << 13);
hbujanda 6:06522f3a6642 470 default:
hbujanda 6:06522f3a6642 471 return 0;
hbujanda 6:06522f3a6642 472 }
hbujanda 6:06522f3a6642 473 }
hbujanda 6:06522f3a6642 474
hbujanda 6:06522f3a6642 475 RadioStatus XBeeDM::set_pin_pull_up(const RemoteXBee& remote, IoLine line, bool enable)
hbujanda 6:06522f3a6642 476 {
hbujanda 6:06522f3a6642 477 AtCmdFrame::AtCmdResp cmdresp;
hbujanda 6:06522f3a6642 478 uint32_t var32;
hbujanda 6:06522f3a6642 479 uint16_t pr;
hbujanda 6:06522f3a6642 480
hbujanda 6:06522f3a6642 481 cmdresp = get_param(remote, "PR", &var32);
hbujanda 6:06522f3a6642 482 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
hbujanda 6:06522f3a6642 483 return Failure;
hbujanda 6:06522f3a6642 484 }
hbujanda 6:06522f3a6642 485 pr = var32;
hbujanda 6:06522f3a6642 486
hbujanda 6:06522f3a6642 487 const uint16_t dio_mask = get_dio_pr_mask(line);
hbujanda 6:06522f3a6642 488 if (dio_mask == 0) {
hbujanda 6:06522f3a6642 489 digi_log(LogLevelError, "XBeeDM::set_pin_pull_up: invalid pin %d\r\n", line);
hbujanda 6:06522f3a6642 490 return Failure;
hbujanda 6:06522f3a6642 491 }
hbujanda 6:06522f3a6642 492
hbujanda 6:06522f3a6642 493 if (enable) {
hbujanda 6:06522f3a6642 494 pr |= dio_mask;
hbujanda 6:06522f3a6642 495 } else {
hbujanda 6:06522f3a6642 496 pr &= ~dio_mask;
hbujanda 6:06522f3a6642 497 }
hbujanda 6:06522f3a6642 498
hbujanda 6:06522f3a6642 499 cmdresp = set_param(remote, "PR", pr);
hbujanda 6:06522f3a6642 500 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
hbujanda 6:06522f3a6642 501 return Failure;
hbujanda 6:06522f3a6642 502 }
hbujanda 6:06522f3a6642 503
hbujanda 6:06522f3a6642 504 return Success;
hbujanda 6:06522f3a6642 505 }
hbujanda 6:06522f3a6642 506
hbujanda 6:06522f3a6642 507 static uint16_t get_dio_ic_mask(XBeeDM::IoLine line)
hbujanda 6:06522f3a6642 508 {
hbujanda 6:06522f3a6642 509 if (line <= XBeeDM::DIO12) {
hbujanda 6:06522f3a6642 510 return (1 << line);
hbujanda 6:06522f3a6642 511 }
hbujanda 6:06522f3a6642 512 return 0;
hbujanda 6:06522f3a6642 513 }
hbujanda 6:06522f3a6642 514
hbujanda 6:06522f3a6642 515 RadioStatus XBeeDM::enable_dio_change_detection(const RemoteXBee& remote, IoLine line, bool enable)
hbujanda 6:06522f3a6642 516 {
hbujanda 6:06522f3a6642 517 if (line > DIO12) {
hbujanda 6:06522f3a6642 518 digi_log(LogLevelError, "XBeeDM::enable_dio_change_detection: pin not supported (%d)\r\n", line);
hbujanda 6:06522f3a6642 519 return Failure;
hbujanda 6:06522f3a6642 520 }
hbujanda 6:06522f3a6642 521
hbujanda 6:06522f3a6642 522 AtCmdFrame::AtCmdResp cmdresp;
hbujanda 6:06522f3a6642 523 uint32_t var32;
hbujanda 6:06522f3a6642 524 uint16_t ic;
hbujanda 6:06522f3a6642 525
hbujanda 6:06522f3a6642 526 cmdresp = get_param(remote, "IC", &var32);
hbujanda 6:06522f3a6642 527 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
hbujanda 6:06522f3a6642 528 return Failure;
hbujanda 6:06522f3a6642 529 }
hbujanda 6:06522f3a6642 530 ic = var32;
hbujanda 6:06522f3a6642 531
hbujanda 6:06522f3a6642 532 const uint16_t dio_mask = get_dio_ic_mask(line);
hbujanda 6:06522f3a6642 533 if (dio_mask == 0) {
hbujanda 6:06522f3a6642 534 digi_log(LogLevelError, "XBeeDM::enable_dio_change_detection: invalid pin %d\r\n", line);
hbujanda 6:06522f3a6642 535 return Failure;
hbujanda 6:06522f3a6642 536 }
hbujanda 6:06522f3a6642 537
hbujanda 6:06522f3a6642 538 if (enable) {
hbujanda 6:06522f3a6642 539 ic |= dio_mask;
hbujanda 6:06522f3a6642 540 } else {
hbujanda 6:06522f3a6642 541 ic &= ~dio_mask;
hbujanda 6:06522f3a6642 542 }
hbujanda 6:06522f3a6642 543
hbujanda 6:06522f3a6642 544 cmdresp = set_param(remote, "IC", ic);
hbujanda 6:06522f3a6642 545 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
hbujanda 6:06522f3a6642 546 return Failure;
hbujanda 6:06522f3a6642 547 }
hbujanda 6:06522f3a6642 548
hbujanda 6:06522f3a6642 549 return Success;
hbujanda 6:06522f3a6642 550 }
hbujanda 7:3ac2a461ce76 551
hbujanda 7:3ac2a461ce76 552 RadioStatus XBeeDM::config_poll_destination(const RemoteXBee& destination)
hbujanda 7:3ac2a461ce76 553 {
hbujanda 7:3ac2a461ce76 554 uint32_t dh;
hbujanda 7:3ac2a461ce76 555 uint32_t dl;
hbujanda 7:3ac2a461ce76 556
hbujanda 7:3ac2a461ce76 557 if (destination.is_valid_addr64b()) {
hbujanda 7:3ac2a461ce76 558 const uint64_t dest64 = destination.get_addr64();
hbujanda 7:3ac2a461ce76 559 dh = (uint32_t)((dest64 >> 32) & 0xFFFFFFFF);
hbujanda 7:3ac2a461ce76 560 dl = (uint32_t)((dest64 & 0xFFFFFFFF));
hbujanda 7:3ac2a461ce76 561 } else {
hbujanda 7:3ac2a461ce76 562 digi_log(LogLevelError, "config_poll_destination: Invalid destination");
hbujanda 7:3ac2a461ce76 563 return Failure;
hbujanda 7:3ac2a461ce76 564 }
hbujanda 7:3ac2a461ce76 565
hbujanda 7:3ac2a461ce76 566 AtCmdFrame::AtCmdResp cmdresp;
hbujanda 7:3ac2a461ce76 567
hbujanda 7:3ac2a461ce76 568 cmdresp = set_param("DH", dh);
hbujanda 7:3ac2a461ce76 569 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
hbujanda 7:3ac2a461ce76 570 digi_log(LogLevelError, "config_poll_destination: error %d:\r\n", cmdresp);
hbujanda 7:3ac2a461ce76 571 return Failure;
hbujanda 7:3ac2a461ce76 572 }
hbujanda 7:3ac2a461ce76 573
hbujanda 7:3ac2a461ce76 574 cmdresp = set_param("DL", dl);
hbujanda 7:3ac2a461ce76 575 if (cmdresp != AtCmdFrame::AtCmdRespOk) {
hbujanda 7:3ac2a461ce76 576 digi_log(LogLevelError, "config_poll_destination: error %d:\r\n", cmdresp);
hbujanda 7:3ac2a461ce76 577 return Failure;
hbujanda 7:3ac2a461ce76 578 }
hbujanda 7:3ac2a461ce76 579
hbujanda 7:3ac2a461ce76 580 return Success;
hbujanda 7:3ac2a461ce76 581 }