Philippe Spino / XBeeLib

project de marde si tu touch le no-homo s'applique pas

Fork of XBeeLib by Digi International Inc.

FrameHandlers/FH_AtCmdResp.cpp@6:06522f3a6642, 2016-07-28 (annotated)

Committer:
hbujanda
Date:
Thu Jul 28 10:17:20 2016 +0200
Revision:
6:06522f3a6642
Parent:
4:629712865107 
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
spastor 0:fcaad0dfa051 13 #include "FrameHandlers/FH_AtCmdResp.h"
spastor 0:fcaad0dfa051 14 #include "Frames/ApiFrame.h"
spastor 0:fcaad0dfa051 15
spastor 0:fcaad0dfa051 16 using namespace XBeeLib;
spastor 0:fcaad0dfa051 17
spastor 0:fcaad0dfa051 18 /** Class constructor */
spastor 4:629712865107 19 FH_AtCmdResp::FH_AtCmdResp() :
spastor 0:fcaad0dfa051 20 FrameHandler(ApiFrame::AtCmdResp), at_cmd_resp_cb(NULL)
spastor 0:fcaad0dfa051 21 {
spastor 0:fcaad0dfa051 22 }
spastor 0:fcaad0dfa051 23
spastor 4:629712865107 24 FH_AtCmdResp::FH_AtCmdResp(ApiFrame::ApiFrameType type) :
spastor 0:fcaad0dfa051 25 FrameHandler(type), at_cmd_resp_cb(NULL)
spastor 0:fcaad0dfa051 26 {
spastor 0:fcaad0dfa051 27 }
spastor 0:fcaad0dfa051 28
spastor 0:fcaad0dfa051 29 /** Class destructor */
spastor 0:fcaad0dfa051 30 FH_AtCmdResp::~FH_AtCmdResp()
spastor 0:fcaad0dfa051 31 {
spastor 0:fcaad0dfa051 32 }
spastor 0:fcaad0dfa051 33
spastor 0:fcaad0dfa051 34 void FH_AtCmdResp::register_at_cmd_resp_cb(at_cmd_resp_cb_t function)
spastor 0:fcaad0dfa051 35 {
spastor 4:629712865107 36 at_cmd_resp_cb = function;
spastor 0:fcaad0dfa051 37 }
spastor 0:fcaad0dfa051 38
spastor 0:fcaad0dfa051 39 void FH_AtCmdResp::unregister_at_cmd_resp_cb()
spastor 0:fcaad0dfa051 40 {
spastor 0:fcaad0dfa051 41 at_cmd_resp_cb = NULL;
spastor 0:fcaad0dfa051 42 }
spastor 0:fcaad0dfa051 43
spastor 0:fcaad0dfa051 44 void FH_AtCmdResp::process_frame_data(const ApiFrame * const frame)
spastor 0:fcaad0dfa051 45 {
spastor 4:629712865107 46 /* The caller checks that the type matches, so no need to check it here again */
spastor 4:629712865107 47
spastor 4:629712865107 48 if (at_cmd_resp_cb == NULL) {
spastor 0:fcaad0dfa051 49 return;
spastor 4:629712865107 50 }
spastor 4:629712865107 51
spastor 0:fcaad0dfa051 52 at_cmd_resp_cb(frame->get_data(), frame->get_data_len());
spastor 0:fcaad0dfa051 53 }
spastor 0:fcaad0dfa051 54
spastor 0:fcaad0dfa051 55
spastor 0:fcaad0dfa051 56 /** Class constructor */
spastor 4:629712865107 57 FH_NodeDiscoveryZB::FH_NodeDiscoveryZB() :
spastor 0:fcaad0dfa051 58 FH_AtCmdResp(ApiFrame::AtCmdResp), node_discovery_cb(NULL)
spastor 0:fcaad0dfa051 59 {
spastor 0:fcaad0dfa051 60 }
spastor 0:fcaad0dfa051 61
spastor 0:fcaad0dfa051 62 /** Class destructor */
spastor 0:fcaad0dfa051 63 FH_NodeDiscoveryZB::~FH_NodeDiscoveryZB()
spastor 0:fcaad0dfa051 64 {
spastor 0:fcaad0dfa051 65 }
spastor 0:fcaad0dfa051 66
spastor 0:fcaad0dfa051 67 void FH_NodeDiscoveryZB::register_node_discovery_cb(node_discovery_zb_cb_t function)
spastor 0:fcaad0dfa051 68 {
spastor 4:629712865107 69 node_discovery_cb = function;
spastor 0:fcaad0dfa051 70 }
spastor 0:fcaad0dfa051 71
spastor 0:fcaad0dfa051 72 void FH_NodeDiscoveryZB::unregister_node_discovery_cb()
spastor 0:fcaad0dfa051 73 {
spastor 0:fcaad0dfa051 74 node_discovery_cb = NULL;
spastor 0:fcaad0dfa051 75 }
spastor 0:fcaad0dfa051 76
spastor 0:fcaad0dfa051 77
spastor 0:fcaad0dfa051 78 void FH_NodeDiscoveryZB::process_frame_data(const ApiFrame *const frame)
spastor 0:fcaad0dfa051 79 {
spastor 4:629712865107 80 /* The caller checks that the type matches, so no need to check it here again */
spastor 4:629712865107 81
spastor 0:fcaad0dfa051 82 if (node_discovery_cb == NULL) {
spastor 0:fcaad0dfa051 83 return;
spastor 0:fcaad0dfa051 84 }
spastor 0:fcaad0dfa051 85
spastor 4:629712865107 86 if (frame->get_data_at(ATCMD_RESP_CMD_LOW_OFFSET) != 'N' ||
spastor 0:fcaad0dfa051 87 frame->get_data_at(ATCMD_RESP_CMD_HIGH_OFFSET) != 'D') {
spastor 0:fcaad0dfa051 88 return;
spastor 0:fcaad0dfa051 89 }
spastor 4:629712865107 90
spastor 0:fcaad0dfa051 91 if (frame->get_data_at(ATCMD_RESP_STATUS_OFFSET) != AtCmdFrame::AtCmdRespOk) {
spastor 0:fcaad0dfa051 92 return;
spastor 0:fcaad0dfa051 93 }
spastor 0:fcaad0dfa051 94
spastor 0:fcaad0dfa051 95 const uint8_t * const data = frame->get_data(); /* The data payload we get here is the full AT command response payload, excluding the frameid. Keep that in mind for the offsets */
spastor 0:fcaad0dfa051 96 const uint16_t addr16 = UINT16(data[ATCMD_RESP_NW_ADDR_H_OFFSET], data[ATCMD_RESP_NW_ADDR_L_OFFSET]);
spastor 0:fcaad0dfa051 97 const uint64_t addr64 = addr64_from_uint8_t(&data[ATCMD_RESP_SH_ADDR_L_OFFSET]);
spastor 0:fcaad0dfa051 98 const char * const node_id = (const char *)&data[ATCMD_RESP_NI_OFFSET];
spastor 0:fcaad0dfa051 99 RemoteXBeeZB remote = RemoteXBeeZB(addr64, addr16);
spastor 0:fcaad0dfa051 100
spastor 0:fcaad0dfa051 101 node_discovery_cb(remote, node_id);
spastor 0:fcaad0dfa051 102 }
spastor 0:fcaad0dfa051 103
spastor 0:fcaad0dfa051 104
spastor 0:fcaad0dfa051 105
spastor 0:fcaad0dfa051 106 /** Class constructor */
spastor 4:629712865107 107 FH_NodeDiscovery802::FH_NodeDiscovery802() :
spastor 0:fcaad0dfa051 108 FH_AtCmdResp(ApiFrame::AtCmdResp), node_discovery_cb(NULL)
spastor 0:fcaad0dfa051 109 {
spastor 0:fcaad0dfa051 110 }
spastor 0:fcaad0dfa051 111
spastor 0:fcaad0dfa051 112 /** Class destructor */
spastor 0:fcaad0dfa051 113 FH_NodeDiscovery802::~FH_NodeDiscovery802()
spastor 0:fcaad0dfa051 114 {
spastor 0:fcaad0dfa051 115 }
spastor 0:fcaad0dfa051 116
spastor 0:fcaad0dfa051 117 void FH_NodeDiscovery802::register_node_discovery_cb(node_discovery_802_cb_t function)
spastor 0:fcaad0dfa051 118 {
spastor 4:629712865107 119 node_discovery_cb = function;
spastor 0:fcaad0dfa051 120 }
spastor 0:fcaad0dfa051 121
spastor 0:fcaad0dfa051 122 void FH_NodeDiscovery802::unregister_node_discovery_cb()
spastor 0:fcaad0dfa051 123 {
spastor 0:fcaad0dfa051 124 node_discovery_cb = NULL;
spastor 0:fcaad0dfa051 125 }
spastor 0:fcaad0dfa051 126
spastor 0:fcaad0dfa051 127
spastor 0:fcaad0dfa051 128 void FH_NodeDiscovery802::process_frame_data(const ApiFrame *const frame)
spastor 0:fcaad0dfa051 129 {
spastor 4:629712865107 130 /* The caller checks that the type matches, so no need to check it here again */
spastor 0:fcaad0dfa051 131
spastor 0:fcaad0dfa051 132 if (node_discovery_cb == NULL) {
spastor 0:fcaad0dfa051 133 return;
spastor 0:fcaad0dfa051 134 }
spastor 0:fcaad0dfa051 135
spastor 4:629712865107 136 if (frame->get_data_at(ATCMD_RESP_CMD_LOW_OFFSET) != 'N' ||
spastor 0:fcaad0dfa051 137 frame->get_data_at(ATCMD_RESP_CMD_HIGH_OFFSET) != 'D') {
spastor 0:fcaad0dfa051 138 return;
spastor 0:fcaad0dfa051 139 }
spastor 0:fcaad0dfa051 140
spastor 0:fcaad0dfa051 141 if (frame->get_data_at(ATCMD_RESP_STATUS_OFFSET) != AtCmdFrame::AtCmdRespOk) {
spastor 0:fcaad0dfa051 142 return;
spastor 0:fcaad0dfa051 143 }
spastor 0:fcaad0dfa051 144
spastor 4:629712865107 145 const uint16_t min_atnd_response_with_data = sizeof (uint16_t) + sizeof(uint64_t);
spastor 0:fcaad0dfa051 146 if (frame->get_data_len() < min_atnd_response_with_data) {
spastor 0:fcaad0dfa051 147 /* Do not process the ATND "OK" response */
spastor 0:fcaad0dfa051 148 return;
spastor 0:fcaad0dfa051 149 }
spastor 0:fcaad0dfa051 150
spastor 0:fcaad0dfa051 151 const uint8_t * const data = frame->get_data();
spastor 0:fcaad0dfa051 152 const uint16_t addr16 = UINT16(data[ATCMD_RESP_NW_ADDR_H_OFFSET], data[ATCMD_RESP_NW_ADDR_L_OFFSET]);
spastor 0:fcaad0dfa051 153 const uint64_t addr64 = addr64_from_uint8_t(&data[ATCMD_RESP_SH_ADDR_L_OFFSET]);
spastor 0:fcaad0dfa051 154 #if 0
spastor 0:fcaad0dfa051 155 const uint8_t signal_strength = data[ATCMD_802_RESP_SIGN_STR_OFFSET];
spastor 0:fcaad0dfa051 156 #endif
spastor 0:fcaad0dfa051 157 const RemoteXBee802 remote = RemoteXBee802(addr64, addr16);
spastor 0:fcaad0dfa051 158 const char * const nodeid = (const char *)(&data[ATCMD_802_RESP_NI_OFFSET]);
spastor 0:fcaad0dfa051 159
spastor 0:fcaad0dfa051 160 node_discovery_cb(remote, nodeid);
spastor 0:fcaad0dfa051 161 }
hbujanda 6:06522f3a6642 162
hbujanda 6:06522f3a6642 163 /** Class constructor */
hbujanda 6:06522f3a6642 164 FH_NodeDiscoveryDM::FH_NodeDiscoveryDM() :
hbujanda 6:06522f3a6642 165 FH_AtCmdResp(ApiFrame::AtCmdResp), node_discovery_cb(NULL)
hbujanda 6:06522f3a6642 166 {
hbujanda 6:06522f3a6642 167 }
hbujanda 6:06522f3a6642 168
hbujanda 6:06522f3a6642 169 /** Class destructor */
hbujanda 6:06522f3a6642 170 FH_NodeDiscoveryDM::~FH_NodeDiscoveryDM()
hbujanda 6:06522f3a6642 171 {
hbujanda 6:06522f3a6642 172 }
hbujanda 6:06522f3a6642 173
hbujanda 6:06522f3a6642 174 void FH_NodeDiscoveryDM::register_node_discovery_cb(node_discovery_dm_cb_t function)
hbujanda 6:06522f3a6642 175 {
hbujanda 6:06522f3a6642 176 node_discovery_cb = function;
hbujanda 6:06522f3a6642 177 }
hbujanda 6:06522f3a6642 178
hbujanda 6:06522f3a6642 179 void FH_NodeDiscoveryDM::unregister_node_discovery_cb()
hbujanda 6:06522f3a6642 180 {
hbujanda 6:06522f3a6642 181 node_discovery_cb = NULL;
hbujanda 6:06522f3a6642 182 }
hbujanda 6:06522f3a6642 183
hbujanda 6:06522f3a6642 184
hbujanda 6:06522f3a6642 185 void FH_NodeDiscoveryDM::process_frame_data(const ApiFrame *const frame)
hbujanda 6:06522f3a6642 186 {
hbujanda 6:06522f3a6642 187 /* The caller checks that the type matches, so no need to check it here again */
hbujanda 6:06522f3a6642 188
hbujanda 6:06522f3a6642 189 if (node_discovery_cb == NULL) {
hbujanda 6:06522f3a6642 190 return;
hbujanda 6:06522f3a6642 191 }
hbujanda 6:06522f3a6642 192
hbujanda 6:06522f3a6642 193 if (frame->get_data_at(ATCMD_RESP_CMD_LOW_OFFSET) != 'N' ||
hbujanda 6:06522f3a6642 194 frame->get_data_at(ATCMD_RESP_CMD_HIGH_OFFSET) != 'D') {
hbujanda 6:06522f3a6642 195 return;
hbujanda 6:06522f3a6642 196 }
hbujanda 6:06522f3a6642 197
hbujanda 6:06522f3a6642 198 if (frame->get_data_at(ATCMD_RESP_STATUS_OFFSET) != AtCmdFrame::AtCmdRespOk) {
hbujanda 6:06522f3a6642 199 return;
hbujanda 6:06522f3a6642 200 }
hbujanda 6:06522f3a6642 201
hbujanda 6:06522f3a6642 202 const uint8_t * const data = frame->get_data(); /* The data payload we get here is the full AT command response payload, excluding the frameid. Keep that in mind for the offsets */
hbujanda 6:06522f3a6642 203 const uint64_t addr64 = addr64_from_uint8_t(&data[ATCMD_RESP_SH_ADDR_L_OFFSET]);
hbujanda 6:06522f3a6642 204 const char * const node_id = (const char *)&data[ATCMD_RESP_NI_OFFSET];
hbujanda 6:06522f3a6642 205 RemoteXBeeDM remote = RemoteXBeeDM(addr64);
hbujanda 6:06522f3a6642 206
hbujanda 6:06522f3a6642 207 node_discovery_cb(remote, node_id);
hbujanda 6:06522f3a6642 208 }