Philippe Spino / XBeeLib

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

Fork of XBeeLib by Digi International Inc.

FrameHandlers/FH_RxPacket802.cpp@4:629712865107, 2015-06-01 (annotated)

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