Library to easily communicate with XBee modules.

Dependencies:   DigiLogger

Dependents:   WaterLogger XbeeGateway XBee_Cooker ProjetReceiver ... more

Use XBee radio modules to easily improve your project with wireless connectivity. You can enable entire networks of connected devices. XBees can exchange data with other modules in the network and configure remote modules as well as trigger actions or collect sensor data on XBee nodes without needing additional external microcontrollers. Using this documentation and configuration tools with XBee modules, it is easy to develop these types of applications and more.

/media/uploads/spastor/xbee-xbeepro-series1.jpg

The XBee mbed Library is a ready-to-import mbed extension that dramatically reduces development time for XBee projects on the mbed platforms. There are many modular examples, making it an easy and smooth process to add wireless networking to a whole range of useful applications.

Info

Currently 802.15.4 (Series 1 and 2), ZigBee (Series 2) and DigiMesh (Series 1 and 2) modules are supported. The libraries can be extended to support other protocols like DigiMesh point-to-point, WiFi, etc.

User manual

The user manual can be found at this project's Wiki pages:

  1. Configuring the library
  2. Debugging the library
  3. Initializing modules
  4. Resetting the local module
  5. Receiving Data from other module
  6. Sending data to another module
  7. Discovering nodes in the network
  8. Configuring local and remote modules
  9. Handling modem status changes
  10. Handling remote modules DIOs, ADCs and PWMs
  11. Handling IO Data Samples from other module
  12. Radio Power Management

Ready to use examples

There are a lot of ready to use examples to get started quickly.
Make sure you have a valid example setup before running the examples:

Examples for ZigBee modules

Import programXBeeZB_Receive_Data

ZigBee Receive Data example for mbed XBeeLib By Digi

Import programXBeeZB_Send_Data

ZigBee Send Data example for mbed XBeeLib By Digi

Import programXBeeZB_module_config

ZigBee network configuration example for mbed XBeeLib By Digi

Import programXBeeZB_AT_Commands

ZigBee AT Commands example for mbed XBeeLib By Digi

Import programXBeeZB_dio_adc

ZigBee DIOs and ADCs example for mbed XBeeLib By Digi

Import programXBeeZB_IO_Sample_Callback

ZigBee IO Sampling Callback example for mbed XBeeLib By Digi

Import programXBeeZB_modem_status

ZigBee Modem Status example for mbed XBeeLib By Digi

Import programXBeeZB_node_discovery

ZigBee Node Discovery example for mbed XBeeLib By Digi

Import programXBeeZB_power_mngmnt_cyclic_sleep

ZigBee Power Management using Cyclic Sleep example for mbed XBeeLib By Digi

Import programXBeeZB_power_mngmnt_pin_sleep

ZigBee Power Management using Pin Sleep example for mbed XBeeLib By Digi

Examples for 802.15.4 modules

Import programXBee802_Receive_Data

802.15.4 Receive Data example for mbed XBeeLib By Digi

Import programXBee802_Send_Data

802.15.4 Send Data example for mbed XBeeLib By Digi

Import programXBee802_module_config

802.15.4 network configuration example for mbed XBeeLib By Digi

Import programXBee802_AT_Commands

802.15.4 AT Commands example for mbed XBeeLib By Digi

Import programXBee802_dio_adc_pwm

802.15.4 DIOs, ADCs and PWM example for mbed XBeeLib By Digi

Import programXBee802_IO_Sample_Callback

802.15.4 IO Sampling Callback example for mbed XBeeLib By Digi

Import programXBee802_node_discovery

802.15.4 Node Discovery example for mbed XBeeLib By Digi

Import programXBee802_power_mngmnt_cyclic_sleep

802.15.4 Power Management using Cyclic Sleep example for mbed XBeeLib By Digi

Import programXBee802_power_mngmnt_pin_sleep

802.15.4 Power Management using Pin Sleep example for mbed XBeeLib By Digi

Examples for DigiMesh modules

Import programXBeeDM_Receive_Data

DigiMesh Receive Data example for mbed XBeeLib By Digi

Import programXBeeDM_Send_Data

DigiMesh Send Data example for mbed XBeeLib By Digi

Import programXBeeDM_module_config

DigiMesh network configuration example for mbed XBeeLib By Digi

Import programXBeeDM_AT_Commands

DigiMesh AT Commands example for mbed XBeeLib By Digi

Import programXBeeDM_dio_adc_pwm

DigiMEsh DIOs, ADCs and PWMs example for mbed XBeeLib By Digi

Import programXBeeDM_IO_Sample_Callback

DigiMesh IO Sampling Callback example for mbed XBeeLib By Digi

Import programXBeeDM_modem_status

DigiMesh Modem Status example for mbed XBeeLib By Digi

Import programXBeeDM_node_discovery

DigiMesh Node Discovery example for mbed XBeeLib By Digi

Import programXBeeDM_power_mngmnt_asyncr_cyclic_sleep

DigiMesh Power Management using Asynchronous Cyclic Sleep example for mbed XBeeLib By Digi

Import programXBeeDM_power_mngmnt_pin_sleep

DigiMesh Power Management using Pin Sleep example for mbed XBeeLib By Digi

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