Vergil Cola / Mbed OS MQTTGateway2

Fork of my original MQTTGateway

Dependencies:   mbed-http

XbeeMonitor/XBeeLib/FrameHandlers/FH_RxPacketZB.cpp@0:a1734fe1ec4b, 2017-04-08 (annotated)

Committer:
vpcola
Date:
Sat Apr 08 14:43:14 2017 +0000
Revision:
0:a1734fe1ec4b
Initial commit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
vpcola 0:a1734fe1ec4b 1 /**
vpcola 0:a1734fe1ec4b 2 * Copyright (c) 2015 Digi International Inc.,
vpcola 0:a1734fe1ec4b 3 * All rights not expressly granted are reserved.
vpcola 0:a1734fe1ec4b 4 *
vpcola 0:a1734fe1ec4b 5 * This Source Code Form is subject to the terms of the Mozilla Public
vpcola 0:a1734fe1ec4b 6 * License, v. 2.0. If a copy of the MPL was not distributed with this file,
vpcola 0:a1734fe1ec4b 7 * You can obtain one at http://mozilla.org/MPL/2.0/.
vpcola 0:a1734fe1ec4b 8 *
vpcola 0:a1734fe1ec4b 9 * Digi International Inc. 11001 Bren Road East, Minnetonka, MN 55343
vpcola 0:a1734fe1ec4b 10 * =======================================================================
vpcola 0:a1734fe1ec4b 11 */
vpcola 0:a1734fe1ec4b 12
vpcola 0:a1734fe1ec4b 13 #include "FH_RxPacketZB.h"
vpcola 0:a1734fe1ec4b 14
vpcola 0:a1734fe1ec4b 15 using namespace XBeeLib;
vpcola 0:a1734fe1ec4b 16
vpcola 0:a1734fe1ec4b 17 /** Class constructor */
vpcola 0:a1734fe1ec4b 18 FH_RxPacketZB::FH_RxPacketZB() : FrameHandler(ApiFrame::RxPacketAO0), receive_cb(NULL)
vpcola 0:a1734fe1ec4b 19 {
vpcola 0:a1734fe1ec4b 20 }
vpcola 0:a1734fe1ec4b 21
vpcola 0:a1734fe1ec4b 22 /** Class destructor */
vpcola 0:a1734fe1ec4b 23 FH_RxPacketZB::~FH_RxPacketZB()
vpcola 0:a1734fe1ec4b 24 {
vpcola 0:a1734fe1ec4b 25 }
vpcola 0:a1734fe1ec4b 26
vpcola 0:a1734fe1ec4b 27 void FH_RxPacketZB::register_receive_cb(receive_zb_cb_t function)
vpcola 0:a1734fe1ec4b 28 {
vpcola 0:a1734fe1ec4b 29 receive_cb = function;
vpcola 0:a1734fe1ec4b 30 }
vpcola 0:a1734fe1ec4b 31
vpcola 0:a1734fe1ec4b 32 void FH_RxPacketZB::unregister_receive_cb(void)
vpcola 0:a1734fe1ec4b 33 {
vpcola 0:a1734fe1ec4b 34 receive_cb = NULL;
vpcola 0:a1734fe1ec4b 35 }
vpcola 0:a1734fe1ec4b 36
vpcola 0:a1734fe1ec4b 37 /* ZB RX packet offsets */
vpcola 0:a1734fe1ec4b 38 #define ZB_RX_ADDR16_MSB_OFFSET 8
vpcola 0:a1734fe1ec4b 39 #define ZB_RX_ADDR16_LSB_OFFSET 9
vpcola 0:a1734fe1ec4b 40 #define ZB_RX_OPTIONS_OFFSET 10
vpcola 0:a1734fe1ec4b 41 #define ZB_RX_DATA_OFFSET 11
vpcola 0:a1734fe1ec4b 42 #define ZB_RX_OVERHEAD (8+2+1)
vpcola 0:a1734fe1ec4b 43
vpcola 0:a1734fe1ec4b 44 #define BROADCAST_PACKET 0x02
vpcola 0:a1734fe1ec4b 45
vpcola 0:a1734fe1ec4b 46 void FH_RxPacketZB::process_frame_data(const ApiFrame *const frame)
vpcola 0:a1734fe1ec4b 47 {
vpcola 0:a1734fe1ec4b 48 /* The caller checks that the type matches, so no need to check it here again */
vpcola 0:a1734fe1ec4b 49
vpcola 0:a1734fe1ec4b 50 if (receive_cb == NULL) {
vpcola 0:a1734fe1ec4b 51 return;
vpcola 0:a1734fe1ec4b 52 }
vpcola 0:a1734fe1ec4b 53
vpcola 0:a1734fe1ec4b 54 /* We got a rx packet, decode it... */
vpcola 0:a1734fe1ec4b 55 const uint8_t *datap = frame->get_data();
vpcola 0:a1734fe1ec4b 56 const uint64_t sender64 = addr64_from_uint8_t(datap);
vpcola 0:a1734fe1ec4b 57 const uint16_t sender16 = ADDR16(datap[ZB_RX_ADDR16_MSB_OFFSET], datap[ZB_RX_ADDR16_LSB_OFFSET]);
vpcola 0:a1734fe1ec4b 58 const uint8_t rx_options = datap[ZB_RX_OPTIONS_OFFSET];
vpcola 0:a1734fe1ec4b 59 const RemoteXBeeZB sender = RemoteXBeeZB(sender64, sender16);
vpcola 0:a1734fe1ec4b 60
vpcola 0:a1734fe1ec4b 61 receive_cb(sender, rx_options & BROADCAST_PACKET, &datap[ZB_RX_DATA_OFFSET], frame->get_data_len() - ZB_RX_OVERHEAD);
vpcola 0:a1734fe1ec4b 62 }