Vergil Cola / Mbed OS MQTTGateway2

Fork of my original MQTTGateway

Dependencies:   mbed-http

XbeeMonitor/XBeeLib/FrameHandlers/FH_RxPacket802.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_RxPacket802.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_RxPacket64b802::FH_RxPacket64b802() : FrameHandler(ApiFrame::RxPacket64Bit),
vpcola 0:a1734fe1ec4b 19 receive_cb(NULL)
vpcola 0:a1734fe1ec4b 20 {
vpcola 0:a1734fe1ec4b 21 }
vpcola 0:a1734fe1ec4b 22
vpcola 0:a1734fe1ec4b 23 /** Class destructor */
vpcola 0:a1734fe1ec4b 24 FH_RxPacket64b802::~FH_RxPacket64b802()
vpcola 0:a1734fe1ec4b 25 {
vpcola 0:a1734fe1ec4b 26 }
vpcola 0:a1734fe1ec4b 27
vpcola 0:a1734fe1ec4b 28 void FH_RxPacket64b802::register_receive_cb(receive_802_cb_t function)
vpcola 0:a1734fe1ec4b 29 {
vpcola 0:a1734fe1ec4b 30 receive_cb = function;
vpcola 0:a1734fe1ec4b 31 }
vpcola 0:a1734fe1ec4b 32
vpcola 0:a1734fe1ec4b 33 void FH_RxPacket64b802::unregister_receive_cb(void)
vpcola 0:a1734fe1ec4b 34 {
vpcola 0:a1734fe1ec4b 35 receive_cb = NULL;
vpcola 0:a1734fe1ec4b 36 }
vpcola 0:a1734fe1ec4b 37
vpcola 0:a1734fe1ec4b 38 /* 802.15.4 RX packet offsets */
vpcola 0:a1734fe1ec4b 39 #define RX_802_RSSI_OFFSET 8
vpcola 0:a1734fe1ec4b 40 #define RX_802_OPTIONS_OFFSET 9
vpcola 0:a1734fe1ec4b 41 #define RX_802_DATA_OFFSET 10
vpcola 0:a1734fe1ec4b 42 #define RX_802_OVERHEAD (8+1+1)
vpcola 0:a1734fe1ec4b 43
vpcola 0:a1734fe1ec4b 44 #define BROADCAST_PACKET 0x02
vpcola 0:a1734fe1ec4b 45
vpcola 0:a1734fe1ec4b 46 void FH_RxPacket64b802::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 uint8_t rx_options = datap[RX_802_OPTIONS_OFFSET];
vpcola 0:a1734fe1ec4b 58 const RemoteXBee802 sender = RemoteXBee802(sender64);
vpcola 0:a1734fe1ec4b 59
vpcola 0:a1734fe1ec4b 60 receive_cb(sender, rx_options & BROADCAST_PACKET, &datap[RX_802_DATA_OFFSET], frame->get_data_len() - RX_802_OVERHEAD);
vpcola 0:a1734fe1ec4b 61 }
vpcola 0:a1734fe1ec4b 62
vpcola 0:a1734fe1ec4b 63
vpcola 0:a1734fe1ec4b 64 /** Class constructor */
vpcola 0:a1734fe1ec4b 65 FH_RxPacket16b802::FH_RxPacket16b802() : FrameHandler(ApiFrame::RxPacket16Bit),
vpcola 0:a1734fe1ec4b 66 receive_cb(NULL)
vpcola 0:a1734fe1ec4b 67 {
vpcola 0:a1734fe1ec4b 68 }
vpcola 0:a1734fe1ec4b 69
vpcola 0:a1734fe1ec4b 70 /** Class destructor */
vpcola 0:a1734fe1ec4b 71 FH_RxPacket16b802::~FH_RxPacket16b802()
vpcola 0:a1734fe1ec4b 72 {
vpcola 0:a1734fe1ec4b 73 }
vpcola 0:a1734fe1ec4b 74
vpcola 0:a1734fe1ec4b 75 void FH_RxPacket16b802::register_receive_cb(receive_802_cb_t function)
vpcola 0:a1734fe1ec4b 76 {
vpcola 0:a1734fe1ec4b 77 receive_cb = function;
vpcola 0:a1734fe1ec4b 78 }
vpcola 0:a1734fe1ec4b 79
vpcola 0:a1734fe1ec4b 80 void FH_RxPacket16b802::unregister_receive_cb(void)
vpcola 0:a1734fe1ec4b 81 {
vpcola 0:a1734fe1ec4b 82 receive_cb = NULL;
vpcola 0:a1734fe1ec4b 83 }
vpcola 0:a1734fe1ec4b 84
vpcola 0:a1734fe1ec4b 85 /* 802.15.4 RX packet offsets */
vpcola 0:a1734fe1ec4b 86 #define RX_802_ADDR16_MSB_OFFSET 0
vpcola 0:a1734fe1ec4b 87 #define RX_802_ADDR16_LSB_OFFSET 1
vpcola 0:a1734fe1ec4b 88 #define RX_802_RSSI_OFFSET2 2
vpcola 0:a1734fe1ec4b 89 #define RX_802_OPTIONS_OFFSET2 3
vpcola 0:a1734fe1ec4b 90 #define RX_802_DATA_OFFSET2 4
vpcola 0:a1734fe1ec4b 91 #define RX_802_OVERHEAD2 (2+1+1)
vpcola 0:a1734fe1ec4b 92
vpcola 0:a1734fe1ec4b 93 void FH_RxPacket16b802::process_frame_data(const ApiFrame *const frame)
vpcola 0:a1734fe1ec4b 94 {
vpcola 0:a1734fe1ec4b 95 /* The caller checks that the type matches, so no need to check it here again */
vpcola 0:a1734fe1ec4b 96
vpcola 0:a1734fe1ec4b 97 if (receive_cb == NULL) {
vpcola 0:a1734fe1ec4b 98 return;
vpcola 0:a1734fe1ec4b 99 }
vpcola 0:a1734fe1ec4b 100
vpcola 0:a1734fe1ec4b 101 /* We got a rx packet, decode it... */
vpcola 0:a1734fe1ec4b 102 const uint8_t *datap = frame->get_data();
vpcola 0:a1734fe1ec4b 103 const uint16_t sender16 = ADDR16(datap[RX_802_ADDR16_MSB_OFFSET], datap[RX_802_ADDR16_LSB_OFFSET]);
vpcola 0:a1734fe1ec4b 104 const uint8_t rx_options = datap[RX_802_OPTIONS_OFFSET2];
vpcola 0:a1734fe1ec4b 105 const RemoteXBee802 sender = RemoteXBee802(sender16);
vpcola 0:a1734fe1ec4b 106
vpcola 0:a1734fe1ec4b 107 receive_cb(sender, rx_options & BROADCAST_PACKET, &datap[RX_802_DATA_OFFSET2], frame->get_data_len() - RX_802_OVERHEAD2);
vpcola 0:a1734fe1ec4b 108 }