RIOT-OS/RIOT
RIOT-OS/RIOT
1
0
Fork 0
mirror of https://github.com/RIOT-OS/RIOT.git synced 2024-12-29 04:50:03 +01:00
Code Releases Activity
12fad002da
RIOT/sys/net/gnrc/link_layer/gomach/gomach_internal.c
zhuoshuguo 0c53762a1f gnrc_gomach: address comment.
2017-12-19 11:37:48 +01:00

1441 lines
49 KiB
C
Raw Blame History

/*
* Copyright (C) 2017 INRIA
*
* This file is subject to the terms and conditions of the GNU Lesser
* General Public License v2.1. See the file LICENSE in the top level
* directory for more details.
*/
/**
* @ingroup net_gnrc_gomach
* @{
*
* @file
* @brief Implementation of GoMacH's internal functions.
*
* @author Shuguo Zhuo <shuguo.zhuo@inria.fr>
* @}
*/
#include <stdbool.h>
#include "periph/rtt.h"
#include "random.h"
#include "net/gnrc.h"
#include "net/gnrc/mac/types.h"
#include "net/gnrc/mac/mac.h"
#include "net/gnrc/mac/internal.h"
#include "net/gnrc/gomach/hdr.h"
#include "net/gnrc/gomach/gomach.h"
#include "net/gnrc/gomach/timeout.h"
#include "net/gnrc/gomach/types.h"
#include "include/gomach_internal.h"
#include "net/gnrc/netif/ieee802154.h"
#include "net/netdev/ieee802154.h"
#define ENABLE_DEBUG (0)
#include "debug.h"
#ifndef LOG_LEVEL
/**
* @brief Default log level define
*/
#define LOG_LEVEL LOG_WARNING
#endif
#include "log.h"
int _gnrc_gomach_transmit(gnrc_netif_t *netif, gnrc_pktsnip_t *pkt)
{
netdev_t *dev = netif->dev;
netdev_ieee802154_t *state = (netdev_ieee802154_t *)netif->dev;
gnrc_netif_hdr_t *netif_hdr;
gnrc_pktsnip_t *vec_snip;
const uint8_t *src, *dst = NULL;
int res = 0;
size_t n, src_len, dst_len;
uint8_t mhr[IEEE802154_MAX_HDR_LEN];
uint8_t flags = (uint8_t)(state->flags & NETDEV_IEEE802154_SEND_MASK);
le_uint16_t dev_pan = byteorder_btols(byteorder_htons(state->pan));
flags |= IEEE802154_FCF_TYPE_DATA;
if (pkt == NULL) {
DEBUG("_send_ieee802154: pkt was NULL\n");
return -EINVAL;
}
if (pkt->type != GNRC_NETTYPE_NETIF) {
DEBUG("_send_ieee802154: first header is not generic netif header\n");
return -EBADMSG;
}
netif_hdr = pkt->data;
/* prepare destination address */
if (netif_hdr->flags & /* If any of these flags is set assume broadcast */
(GNRC_NETIF_HDR_FLAGS_BROADCAST | GNRC_NETIF_HDR_FLAGS_MULTICAST)) {
dst = ieee802154_addr_bcast;
dst_len = IEEE802154_ADDR_BCAST_LEN;
}
else {
dst = gnrc_netif_hdr_get_dst_addr(netif_hdr);
dst_len = netif_hdr->dst_l2addr_len;
}
src_len = netif_hdr->src_l2addr_len;
if (src_len > 0) {
src = gnrc_netif_hdr_get_src_addr(netif_hdr);
}
else {
src_len = netif->l2addr_len;
src = netif->l2addr;
}
/* fill MAC header, seq should be set by device */
if ((res = ieee802154_set_frame_hdr(mhr, src, src_len,
dst, dst_len, dev_pan,
dev_pan, flags, state->seq++)) == 0) {
DEBUG("_send_ieee802154: Error preperaring frame\n");
return -EINVAL;
}
/* prepare packet for sending */
vec_snip = gnrc_pktbuf_get_iovec(pkt, &n);
if (vec_snip != NULL) {
struct iovec *vector;
pkt = vec_snip; /* reassign for later release; vec_snip is prepended to pkt */
vector = (struct iovec *)pkt->data;
vector[0].iov_base = mhr;
vector[0].iov_len = (size_t)res;
#ifdef MODULE_NETSTATS_L2
if (netif_hdr->flags &
(GNRC_NETIF_HDR_FLAGS_BROADCAST | GNRC_NETIF_HDR_FLAGS_MULTICAST)) {
netif->dev->stats.tx_mcast_count++;
}
else {
netif->dev->stats.tx_unicast_count++;
}
#endif
#ifdef MODULE_GNRC_MAC
if (netif->mac.mac_info & GNRC_NETIF_MAC_INFO_CSMA_ENABLED) {
res = csma_sender_csma_ca_send(dev, vector, n, &netif->mac.csma_conf);
}
else {
res = dev->driver->send(dev, vector, n);
}
#else
res = dev->driver->send(dev, vector, n);
#endif
}
else {
return -ENOBUFS;
}
/* release old data */
gnrc_pktbuf_release(pkt);
return res;
}
static gnrc_pktsnip_t *_make_netif_hdr(uint8_t *mhr)
{
gnrc_pktsnip_t *snip;
uint8_t src[IEEE802154_LONG_ADDRESS_LEN], dst[IEEE802154_LONG_ADDRESS_LEN];
int src_len, dst_len;
le_uint16_t _pan_tmp; /* TODO: hand-up PAN IDs to GNRC? */
dst_len = ieee802154_get_dst(mhr, dst, &_pan_tmp);
src_len = ieee802154_get_src(mhr, src, &_pan_tmp);
if ((dst_len < 0) || (src_len < 0)) {
DEBUG("_make_netif_hdr: unable to get addresses\n");
return NULL;
}
/* allocate space for header */
snip = gnrc_netif_hdr_build(src, (size_t)src_len, dst, (size_t)dst_len);
if (snip == NULL) {
DEBUG("_make_netif_hdr: no space left in packet buffer\n");
return NULL;
}
/* set broadcast flag for broadcast destination */
if ((dst_len == 2) && (dst[0] == 0xff) && (dst[1] == 0xff)) {
gnrc_netif_hdr_t *hdr = snip->data;
hdr->flags |= GNRC_NETIF_HDR_FLAGS_BROADCAST;
}
return snip;
}
static int _parse_packet(gnrc_netif_t *netif, gnrc_pktsnip_t *pkt,
gnrc_gomach_packet_info_t *info)
{
assert(info != NULL);
assert(pkt != NULL);
netdev_ieee802154_t *state = (netdev_ieee802154_t *)netif->dev;
/* Get the packet sequence number */
info->seq = ieee802154_get_seq(pkt->next->data);
gnrc_pktsnip_t *netif_snip = _make_netif_hdr(pkt->next->data);
if (netif_snip == NULL) {
DEBUG("gomach: no space left in packet buffer\n");
gnrc_pktbuf_release(pkt);
return -ENODATA;
}
gnrc_netif_hdr_t *netif_hdr = netif_snip->data;
netif_hdr->lqi = netif->mac.prot.gomach.rx_pkt_lqi;
netif_hdr->rssi = netif->mac.prot.gomach.rx_pkt_rssi;
netif_hdr->if_pid = netif->pid;
pkt->type = state->proto;
gnrc_pktbuf_remove_snip(pkt, pkt->next);
LL_APPEND(pkt, netif_snip);
gnrc_pktsnip_t *gomach_snip = NULL;
gnrc_gomach_hdr_t *gomach_hdr = NULL;
netif_snip = gnrc_pktsnip_search_type(pkt, GNRC_NETTYPE_NETIF);
if (netif_snip == NULL) {
return -ENODATA;
}
else {
netif_hdr = netif_snip->data;
}
if (netif_hdr->dst_l2addr_len > sizeof(info->dst_addr)) {
return -ENODATA;
}
if (netif_hdr->src_l2addr_len > sizeof(info->src_addr)) {
return -ENODATA;
}
/* Dissect GoMacH header, Every frame has header as first member */
gomach_hdr = (gnrc_gomach_hdr_t *) pkt->data;
switch (gomach_hdr->type) {
case GNRC_GOMACH_FRAME_BEACON: {
gomach_snip = gnrc_pktbuf_mark(pkt, sizeof(gnrc_gomach_frame_beacon_t),
GNRC_NETTYPE_GOMACH);
break;
}
case GNRC_GOMACH_FRAME_PREAMBLE: {
gomach_snip = gnrc_pktbuf_mark(pkt, sizeof(gnrc_gomach_frame_preamble_t),
GNRC_NETTYPE_GOMACH);
break;
}
case GNRC_GOMACH_FRAME_PREAMBLE_ACK: {
gomach_snip = gnrc_pktbuf_mark(pkt, sizeof(gnrc_gomach_frame_preamble_ack_t),
GNRC_NETTYPE_GOMACH);
break;
}
case GNRC_GOMACH_FRAME_DATA: {
gomach_snip = gnrc_pktbuf_mark(pkt, sizeof(gnrc_gomach_frame_data_t),
GNRC_NETTYPE_GOMACH);
break;
}
case GNRC_GOMACH_FRAME_ANNOUNCE: {
gomach_snip = gnrc_pktbuf_mark(pkt, sizeof(gnrc_gomach_frame_announce_t),
GNRC_NETTYPE_GOMACH);
break;
}
case GNRC_GOMACH_FRAME_BROADCAST: {
gomach_snip = gnrc_pktbuf_mark(pkt, sizeof(gnrc_gomach_frame_broadcast_t),
GNRC_NETTYPE_GOMACH);
break;
}
default: {
return -ENODATA;
}
}
/* Memory location may have changed while marking. */
gomach_hdr = gomach_snip->data;
/* Get the destination address. */
switch (gomach_hdr->type) {
case GNRC_GOMACH_FRAME_PREAMBLE: {
info->dst_addr = ((gnrc_gomach_frame_preamble_t *)gomach_hdr)->dst_addr;
break;
}
case GNRC_GOMACH_FRAME_PREAMBLE_ACK: {
info->dst_addr = ((gnrc_gomach_frame_preamble_ack_t *)gomach_hdr)->dst_addr;
break;
}
case GNRC_GOMACH_FRAME_DATA: {
if (netif_hdr->dst_l2addr_len) {
info->dst_addr.len = netif_hdr->dst_l2addr_len;
memcpy(info->dst_addr.addr,
gnrc_netif_hdr_get_dst_addr(netif_hdr),
netif_hdr->dst_l2addr_len);
}
break;
}
default: {
break;
}
}
/* Get the source address. */
if (netif_hdr->src_l2addr_len) {
info->src_addr.len = netif_hdr->src_l2addr_len;
memcpy(info->src_addr.addr,
gnrc_netif_hdr_get_src_addr(netif_hdr),
netif_hdr->src_l2addr_len);
}
info->header = gomach_hdr;
return 0;
}
uint64_t gnrc_gomach_phase_now(gnrc_netif_t *netif)
{
assert(netif != NULL);
uint64_t phase_now = xtimer_now_usec64();
/* in case timer overflows */
if (phase_now < netif->mac.prot.gomach.last_wakeup_phase_us) {
uint64_t gap_to_full = GNRC_GOMACH_PHASE_MAX -
netif->mac.prot.gomach.last_wakeup_phase_us;
phase_now += gap_to_full;
}
else {
phase_now = phase_now - netif->mac.prot.gomach.last_wakeup_phase_us;
}
return phase_now;
}
void gnrc_gomach_set_netdev_state(gnrc_netif_t *netif, netopt_state_t devstate)
{
assert(netif != NULL);
netif->dev->driver->set(netif->dev,
NETOPT_STATE,
&devstate,
sizeof(devstate));
#if (GNRC_GOMACH_ENABLE_DUTYCYLE_RECORD == 1)
if (devstate == NETOPT_STATE_IDLE) {
if (!(netif->mac.prot.gomach.gomach_info & GNRC_GOMACH_INTERNAL_INFO_RADIO_IS_ON)) {
netif->mac.prot.gomach.last_radio_on_time_ticks = xtimer_now_usec64();
netif->mac.prot.gomach.gomach_info |= GNRC_GOMACH_INTERNAL_INFO_RADIO_IS_ON;
}
return;
}
else if ((devstate == NETOPT_STATE_SLEEP) &&
(netif->mac.prot.gomach.gomach_info & GNRC_GOMACH_INTERNAL_INFO_RADIO_IS_ON)) {
netif->mac.prot.gomach.radio_off_time_ticks = xtimer_now_usec64();
netif->mac.prot.gomach.awake_duration_sum_ticks +=
(netif->mac.prot.gomach.radio_off_time_ticks -
netif->mac.prot.gomach.last_radio_on_time_ticks);
netif->mac.prot.gomach.gomach_info &= ~GNRC_GOMACH_INTERNAL_INFO_RADIO_IS_ON;
}
#endif
}
int gnrc_gomach_send(gnrc_netif_t *netif, gnrc_pktsnip_t *pkt, netopt_enable_t csma_enable)
{
assert(netif != NULL);
assert(pkt != NULL);
/* Enable/disable CSMA according to the input. */
netif->dev->driver->set(netif->dev, NETOPT_CSMA, &csma_enable,
sizeof(netopt_enable_t));
gnrc_gomach_set_tx_finish(netif, false);
gnrc_netif_set_tx_feedback(netif, TX_FEEDBACK_UNDEF);
return _gnrc_gomach_transmit(netif, pkt);
}
int gnrc_gomach_send_preamble_ack(gnrc_netif_t *netif, gnrc_gomach_packet_info_t *info)
{
assert(netif != NULL);
assert(info != NULL);
gnrc_pktsnip_t *gomach_pkt = NULL;
gnrc_pktsnip_t *pkt = NULL;
gnrc_netif_hdr_t *nethdr_preamble_ack = NULL;
/* Start assemble the preamble-ACK packet according to preamble packet info. */
gnrc_gomach_frame_preamble_ack_t gomach_preamble_ack_hdr;
gomach_preamble_ack_hdr.header.type = GNRC_GOMACH_FRAME_PREAMBLE_ACK;
gomach_preamble_ack_hdr.dst_addr = info->src_addr;
/* Tell the preamble sender the device's (preamble-ACK sender) current phase.
* This is to allow the preamble sender to deduce the exact phase of the receiver. */
gomach_preamble_ack_hdr.phase_in_us = gnrc_gomach_phase_now(netif);
pkt = gnrc_pktbuf_add(NULL, &gomach_preamble_ack_hdr, sizeof(gomach_preamble_ack_hdr),
GNRC_NETTYPE_GOMACH);
if (pkt == NULL) {
LOG_ERROR("ERROR: [GOMACH]: pktbuf add failed in gnrc_gomach_send_preamble_ack().\n");
return -ENOBUFS;
}
gomach_pkt = pkt;
pkt = gnrc_pktbuf_add(pkt, NULL, sizeof(gnrc_netif_hdr_t), GNRC_NETTYPE_NETIF);
if (pkt == NULL) {
LOG_ERROR("ERROR: [GOMACH]: netif_hdr add failed in gnrc_gomach_send_preamble_ack().\n");
gnrc_pktbuf_release(gomach_pkt);
return -ENOBUFS;
}
gomach_pkt = pkt;
gnrc_pktsnip_t *netif_snip = gnrc_pktsnip_search_type(pkt, GNRC_NETTYPE_NETIF);
if (netif_snip == NULL) {
LOG_ERROR("[GOMACH]: NO netif_hdr found in gnrc_gomach_send_preamble_ack().\n");
gnrc_pktbuf_release(gomach_pkt);
return -ENOBUFS;
}
else {
nethdr_preamble_ack = netif_snip->data;
}
/* Construct NETIF header and insert address for preamble-ACK packet. */
gnrc_netif_hdr_init(nethdr_preamble_ack, 0, 0);
/* Send preamble-ACK as broadcast. */
nethdr_preamble_ack->flags |= GNRC_NETIF_HDR_FLAGS_BROADCAST;
int res = gnrc_gomach_send(netif, pkt, NETOPT_DISABLE);
if (res < 0) {
LOG_ERROR("ERROR: [GOMACH]: send preamble-ack failed in"
" gnrc_gomach_send_preamble_ack().\n");
gnrc_pktbuf_release(gomach_pkt);
}
return res;
}
static bool _assemble_beacon(gnrc_netif_t *netif, uint8_t total_tdma_slot_num,
uint8_t total_tdma_node_num, uint8_t *slots_list,
gnrc_gomach_l2_id_t *id_list, gnrc_pktsnip_t **pkt,
gnrc_pktsnip_t **gomach_pkt,
gnrc_gomach_frame_beacon_t *gomach_beaocn_hdr)
{
/* If there are slots to allocate, add the slots list and the ID list to
* the beacon! */
netif->mac.rx.vtdma_manag.total_slots_num = total_tdma_slot_num;
/* Add the slots list to the beacon. */
*pkt = gnrc_pktbuf_add(NULL, slots_list, total_tdma_node_num * sizeof(uint8_t),
GNRC_NETTYPE_GOMACH);
if (*pkt == NULL) {
LOG_ERROR("ERROR: [GOMACH]: pktbuf add failed in gnrc_gomach_send_beacon().\n");
return false;
}
*gomach_pkt = *pkt;
/* Add the ID list to the beacon. */
*pkt = gnrc_pktbuf_add(*pkt, id_list, total_tdma_node_num * sizeof(gnrc_gomach_l2_id_t),
GNRC_NETTYPE_GOMACH);
if (*pkt == NULL) {
LOG_ERROR("ERROR: [GOMACH]: pktbuf add failed in gnrc_gomach_send_beacon().\n");
gnrc_pktbuf_release(*gomach_pkt);
return false;
}
*gomach_pkt = *pkt;
/* Add the GoMacH header to the beacon. */
*pkt = gnrc_pktbuf_add(*pkt, gomach_beaocn_hdr, sizeof(gnrc_gomach_frame_beacon_t),
GNRC_NETTYPE_GOMACH);
if (*pkt == NULL) {
LOG_ERROR("ERROR: [GOMACH]: pktbuf add failed in gnrc_gomach_send_beacon().\n");
gnrc_pktbuf_release(*gomach_pkt);
return false;
}
return true;
}
int gnrc_gomach_send_beacon(gnrc_netif_t *netif)
{
assert(netif != NULL);
uint8_t i;
uint8_t j = 0;
uint8_t total_tdma_node_num = 0;
uint8_t total_tdma_slot_num = 0;
gnrc_pktsnip_t *pkt = NULL;
gnrc_pktsnip_t *gomach_pkt = NULL;
gnrc_netif_hdr_t *nethdr_beacon = NULL;
/* Start assemble the beacon packet */
gnrc_gomach_frame_beacon_t gomach_beaocn_hdr;
gomach_beaocn_hdr.header.type = GNRC_GOMACH_FRAME_BEACON;
gomach_beaocn_hdr.sub_channel_seq = netif->mac.prot.gomach.sub_channel_seq;
/* Start generating the slots list and the related ID list for guiding
* the following vTMDA procedure (slotted transmission). */
netif->mac.rx.vtdma_manag.total_slots_num = 0;
gnrc_gomach_l2_id_t id_list[GNRC_GOMACH_SLOSCH_UNIT_COUNT];
uint8_t slots_list[GNRC_GOMACH_SLOSCH_UNIT_COUNT];
/* Check the maximum number of slots that can be allocated to senders. */
uint16_t max_slot_num = (GNRC_GOMACH_SUPERFRAME_DURATION_US - gnrc_gomach_phase_now(netif)) /
GNRC_GOMACH_VTDMA_SLOT_SIZE_US;
for (i = 0; i < GNRC_GOMACH_SLOSCH_UNIT_COUNT; i++) {
if (netif->mac.rx.slosch_list[i].queue_indicator > 0) {
/* Record the device's (that will be allocated slots) address to the ID list. */
memcpy(id_list[j].addr,
netif->mac.rx.slosch_list[i].node_addr.addr,
netif->mac.rx.slosch_list[i].node_addr.len);
/* Record the number of allocated slots to the slots list. */
slots_list[j] = netif->mac.rx.slosch_list[i].queue_indicator;
total_tdma_node_num++;
total_tdma_slot_num += slots_list[j];
/* If there is no room for allocating more slots, stop. */
if (total_tdma_slot_num >= max_slot_num) {
uint8_t redueced_slots_num;
redueced_slots_num = total_tdma_slot_num - max_slot_num;
slots_list[j] -= redueced_slots_num;
total_tdma_slot_num -= redueced_slots_num;
break;
}
j++;
/* If reach the maximum sender ID number limit, stop. */
if (total_tdma_node_num >= GNRC_GOMACH_MAX_ALLOC_SENDER_NUM) {
break;
}
}
}
gomach_beaocn_hdr.schedulelist_size = total_tdma_node_num;
if (total_tdma_node_num > 0) {
if (!_assemble_beacon(netif, total_tdma_slot_num, total_tdma_node_num,
slots_list, id_list, &pkt, &gomach_pkt, &gomach_beaocn_hdr)) {
return -ENOBUFS;
}
gomach_pkt = pkt;
}
else {
/* If there is no slots to allocate, quit sending beacon! */
return -ENOBUFS;
}
/* Add the Netif header. */
pkt = gnrc_pktbuf_add(pkt, NULL, sizeof(gnrc_netif_hdr_t), GNRC_NETTYPE_NETIF);
if (pkt == NULL) {
LOG_ERROR("ERROR: [GOMACH]: pktbuf add failed in gnrc_gomach_send_beacon().\n");
gnrc_pktbuf_release(gomach_pkt);
return -ENOBUFS;
}
gomach_pkt = pkt;
gnrc_pktsnip_t *beacon_netif_snip = gnrc_pktsnip_search_type(pkt, GNRC_NETTYPE_NETIF);
if (beacon_netif_snip == NULL) {
LOG_ERROR("[GOMACH]: NO netif_hdr found in send_beacon().\n");
gnrc_pktbuf_release(pkt);
return -ENOBUFS;
}
else {
nethdr_beacon = beacon_netif_snip->data;
}
/* Construct NETIF header. */
gnrc_netif_hdr_init(nethdr_beacon, 0, 0);
/* Send beacon as broadcast*/
nethdr_beacon->flags |= GNRC_NETIF_HDR_FLAGS_BROADCAST;
int res;
if (gnrc_gomach_get_unintd_preamble(netif)) {
/* Use csma for collision avoidance if we found ongoing preamble transmission. */
res = gnrc_gomach_send(netif, pkt, NETOPT_ENABLE);
}
else {
/* Send the beacon without CSMA if there is no ongoing preamble transmission. */
res = gnrc_gomach_send(netif, pkt, NETOPT_DISABLE);
}
if (res < 0) {
LOG_ERROR("ERROR: [GOMACH]: send beacon failed, release it.\n");
gnrc_pktbuf_release(pkt);
}
else {
gnrc_gomach_set_timeout(netif, GNRC_GOMACH_TIMEOUT_NO_TX_ISR,
GNRC_GOMACH_NO_TX_ISR_US);
}
return res;
}
int gnrc_gomach_dispatch_defer(gnrc_pktsnip_t *buffer[], gnrc_pktsnip_t *pkt)
{
assert(buffer != NULL);
assert(pkt != NULL);
for (unsigned i = 0; i < GNRC_MAC_DISPATCH_BUFFER_SIZE; i++) {
/* Buffer will be filled bottom-up and emptied completely so no holes */
if (buffer[i] == NULL) {
buffer[i] = pkt;
return 0;
}
}
gnrc_pktbuf_release(pkt);
LOG_ERROR("ERROR: [GOMACH]: dispatch buffer full, drop pkt.\n");
return -ENOBUFS;
}
void gnrc_gomach_indicator_update(gnrc_netif_t *netif, gnrc_pktsnip_t *pkt,
gnrc_gomach_packet_info_t *pa_info)
{
assert(netif != NULL);
assert(pkt != NULL);
assert(pa_info != NULL);
gnrc_gomach_frame_data_t *gomach_data_hdr = NULL;
gnrc_pktsnip_t *gomach_snip = gnrc_pktsnip_search_type(pkt, GNRC_NETTYPE_GOMACH);
if (gomach_snip == NULL) {
LOG_ERROR("[GOMACH]: No gomach header found in gnrc_gomach_indicator_update().\n");
return;
}
else {
gomach_data_hdr = gomach_snip->data;
}
if (gomach_data_hdr == NULL) {
LOG_ERROR("[GOMACH]: GoMacH's data header is null.\n");
return;
}
uint8_t i;
/* Check whether the device has been registered or not. */
for (i = 0; i < GNRC_GOMACH_SLOSCH_UNIT_COUNT; i++) {
if (memcmp(&netif->mac.rx.slosch_list[i].node_addr.addr,
&pa_info->src_addr.addr,
pa_info->src_addr.len) == 0) {
/* Update the sender's queue-length indicator. */
netif->mac.rx.slosch_list[i].queue_indicator = gomach_data_hdr->queue_indicator;
return;
}
}
/* The sender has not registered yet. */
for (i = 0; i < GNRC_GOMACH_SLOSCH_UNIT_COUNT; i++) {
if ((netif->mac.rx.slosch_list[i].node_addr.len == 0) ||
(netif->mac.rx.slosch_list[i].queue_indicator == 0)) {
netif->mac.rx.slosch_list[i].node_addr.len = pa_info->src_addr.len;
memcpy(netif->mac.rx.slosch_list[i].node_addr.addr,
pa_info->src_addr.addr,
pa_info->src_addr.len);
/* Update the sender's queue-length indicator. */
netif->mac.rx.slosch_list[i].queue_indicator = gomach_data_hdr->queue_indicator;
return;
}
}
}
bool gnrc_gomach_check_duplicate(gnrc_netif_t *netif, gnrc_gomach_packet_info_t *pa_info)
{
assert(netif != NULL);
assert(pa_info != NULL);
uint8_t i;
/* First check if we can found the same source sender ID in the recorded info units. */
for (i = 0; i < GNRC_GOMACH_DUPCHK_BUFFER_SIZE; i++) {
if (memcmp(&netif->mac.rx.check_dup_pkt.last_nodes[i].node_addr.addr,
&pa_info->src_addr.addr,
pa_info->src_addr.len) == 0) {
netif->mac.rx.check_dup_pkt.last_nodes[i].life_cycle = 0;
if (netif->mac.rx.check_dup_pkt.last_nodes[i].seq == pa_info->seq) {
/* Found same MAC sequence, this is duplicate packet . */
return true;
}
else {
netif->mac.rx.check_dup_pkt.last_nodes[i].seq = pa_info->seq;
return false;
}
}
}
/* Look for a free info unit */
for (i = 0; i < GNRC_GOMACH_DUPCHK_BUFFER_SIZE; i++) {
if (netif->mac.rx.check_dup_pkt.last_nodes[i].node_addr.len == 0) {
netif->mac.rx.check_dup_pkt.last_nodes[i].node_addr.len = pa_info->src_addr.len;
memcpy(netif->mac.rx.check_dup_pkt.last_nodes[i].node_addr.addr,
pa_info->src_addr.addr,
pa_info->src_addr.len);
netif->mac.rx.check_dup_pkt.last_nodes[i].seq = pa_info->seq;
netif->mac.rx.check_dup_pkt.last_nodes[i].life_cycle = 0;
return false;
}
}
return false;
}
static void _cp_packet_process_preamble(gnrc_netif_t *netif,
gnrc_gomach_packet_info_t *info,
gnrc_pktsnip_t *pkt)
{
if (memcmp(&netif->l2addr, &info->dst_addr.addr,
netif->l2addr_len) == 0) {
/* Get a preamble packet that is for the device itself. */
gnrc_gomach_set_got_preamble(netif, true);
/* If reception is not going on, reply preamble-ack. */
if (gnrc_gomach_get_netdev_state(netif) == NETOPT_STATE_IDLE) {
/* Disable auto-ack. */
gnrc_gomach_set_autoack(netif, NETOPT_DISABLE);
int res = gnrc_gomach_send_preamble_ack(netif, info);
if (res < 0) {
LOG_ERROR("ERROR: [GOMACH]: send preamble-ACK failed: %d.\n", res);
}
/* Enable Auto ACK again for data reception. */
gnrc_gomach_set_autoack(netif, NETOPT_ENABLE);
}
}
else {
/* Receives unintended preamble that is not for the device. */
gnrc_gomach_set_unintd_preamble(netif, true);
}
gnrc_pktbuf_release(pkt);
}
static void _cp_packet_process_data(gnrc_netif_t *netif,
gnrc_gomach_packet_info_t *info,
gnrc_pktsnip_t *pkt)
{
if (memcmp(&netif->l2addr, &info->dst_addr.addr,
netif->l2addr_len) == 0) {
/* The data is for itself, now update the sender's queue-length indicator. */
gnrc_gomach_indicator_update(netif, pkt, info);
/* Check that whether this is a duplicate packet. */
if ((gnrc_gomach_check_duplicate(netif, info))) {
gnrc_pktbuf_release(pkt);
LOG_DEBUG("[GOMACH]: received a duplicate packet.\n");
return;
}
gnrc_gomach_dispatch_defer(netif->mac.rx.dispatch_buffer, pkt);
gnrc_mac_dispatch(&netif->mac.rx);
#if (GNRC_GOMACH_ENABLE_DUTYCYLE_RECORD == 1)
/* Output radio duty-cycle ratio */
uint64_t duty;
duty = xtimer_now_usec64();
duty = (netif->mac.prot.gomach.awake_duration_sum_ticks) * 100 /
(duty - netif->mac.prot.gomach.system_start_time_ticks);
printf("[GoMacH]: achieved radio duty-cycle: %lu %% \n", (uint32_t)duty);
#endif
}
else {
/* If the data is not for the device, release it. */
gnrc_pktbuf_release(pkt);
}
}
static inline void _cp_packet_process_bcast(gnrc_netif_t *netif,
gnrc_pktsnip_t *pkt)
{
/* Receive a broadcast packet, quit the listening period to avoid receive duplicate
* broadcast packet. */
gnrc_gomach_set_quit_cycle(netif, true);
gnrc_gomach_dispatch_defer(netif->mac.rx.dispatch_buffer, pkt);
gnrc_mac_dispatch(&netif->mac.rx);
}
void gnrc_gomach_cp_packet_process(gnrc_netif_t *netif)
{
assert(netif != NULL);
gnrc_pktsnip_t *pkt;
gnrc_gomach_packet_info_t receive_packet_info;
while ((pkt = gnrc_priority_pktqueue_pop(&netif->mac.rx.queue)) != NULL) {
/* Parse the received packet, fetch key MAC informations. */
int res = _parse_packet(netif, pkt, &receive_packet_info);
if (res != 0) {
LOG_DEBUG("[GOMACH] CP: Packet could not be parsed: %i\n", res);
gnrc_pktbuf_release(pkt);
continue;
}
switch (receive_packet_info.header->type) {
case GNRC_GOMACH_FRAME_PREAMBLE: {
_cp_packet_process_preamble(netif, &receive_packet_info, pkt);
break;
}
case GNRC_GOMACH_FRAME_DATA: {
_cp_packet_process_data(netif, &receive_packet_info, pkt);
break;
}
case GNRC_GOMACH_FRAME_BROADCAST: {
_cp_packet_process_bcast(netif, pkt);
break;
}
default: {
gnrc_pktbuf_release(pkt);
break;
}
}
}
}
void gnrc_gomach_init_choose_subchannel(gnrc_netif_t *netif)
{
assert(netif != NULL);
uint16_t subchannel_seq, own_id;
own_id = 0;
own_id = netif->l2addr[netif->l2addr_len - 2];
own_id = own_id << 8;
own_id |= netif->l2addr[netif->l2addr_len - 1];
/* First randomly set a sub-channel sequence, which ranges from 12 to 25. */
subchannel_seq = 12 + (own_id % 14);
/* Find a free sub-channel sequence. */
int i = 0;
for (i = 0; i < 14; i++) {
uint16_t check_seq = subchannel_seq - 11;
check_seq = (1 << check_seq);
if (check_seq & netif->mac.prot.gomach.subchannel_occu_flags) {
LOG_INFO("INFO: [GOMACH]: sub-channel already occupied, find a new one.\n");
own_id += 1;
subchannel_seq = 12 + (own_id % 14);
}
else {
break;
}
}
netif->mac.prot.gomach.sub_channel_seq = subchannel_seq;
}
int gnrc_gomach_send_preamble(gnrc_netif_t *netif, netopt_enable_t csma_enable)
{
assert(netif != NULL);
gnrc_pktsnip_t *pkt;
gnrc_netif_hdr_t *nethdr_preamble;
gnrc_pktsnip_t *gomach_pkt;
/* Assemble the preamble packet. */
gnrc_gomach_frame_preamble_t gomach_preamble_hdr;
gomach_preamble_hdr.header.type = GNRC_GOMACH_FRAME_PREAMBLE;
memcpy(gomach_preamble_hdr.dst_addr.addr,
netif->mac.tx.current_neighbor->l2_addr,
netif->mac.tx.current_neighbor->l2_addr_len);
gomach_preamble_hdr.dst_addr.len = netif->mac.tx.current_neighbor->l2_addr_len;
pkt = gnrc_pktbuf_add(NULL, &gomach_preamble_hdr, sizeof(gomach_preamble_hdr),
GNRC_NETTYPE_GOMACH);
if (pkt == NULL) {
LOG_ERROR("ERROR: [GOMACH]: pktbuf add failed in gnrc_gomach_send_preamble().\n");
return -ENOBUFS;
}
gomach_pkt = pkt;
pkt = gnrc_pktbuf_add(pkt, NULL, sizeof(gnrc_netif_hdr_t), GNRC_NETTYPE_NETIF);
if (pkt == NULL) {
LOG_ERROR("ERROR: [GOMACH]: netif add failed in gnrc_gomach_send_preamble().\n");
gnrc_pktbuf_release(gomach_pkt);
return -ENOBUFS;
}
gomach_pkt = pkt;
gnrc_pktsnip_t *netif_snip = gnrc_pktsnip_search_type(pkt, GNRC_NETTYPE_NETIF);
if (netif_snip == NULL) {
LOG_ERROR("[GOMACH]: No netif_hdr found in gnrc_gomach_send_preamble().\n");
gnrc_pktbuf_release(gomach_pkt);
return -ENOBUFS;
}
else {
nethdr_preamble = netif_snip->data;
}
/* Construct NETIF header and initiate address fields. */
gnrc_netif_hdr_init(nethdr_preamble, 0, 0);
/* Send preamble packet as broadcast. */
nethdr_preamble->flags |= GNRC_NETIF_HDR_FLAGS_BROADCAST;
return gnrc_gomach_send(netif, pkt, csma_enable);
}
int gnrc_gomach_bcast_subchann_seq(gnrc_netif_t *netif, netopt_enable_t use_csma)
{
assert(netif != NULL);
gnrc_pktsnip_t *pkt;
gnrc_pktsnip_t *gomach_pkt;
gnrc_netif_hdr_t *nethdr_announce;
/* Assemble the sub-channel sequence announce packet. */
gnrc_gomach_frame_announce_t gomach_announce_hdr;
gomach_announce_hdr.header.type = GNRC_GOMACH_FRAME_ANNOUNCE;
gomach_announce_hdr.subchannel_seq = netif->mac.prot.gomach.sub_channel_seq;
pkt = gnrc_pktbuf_add(NULL, &gomach_announce_hdr, sizeof(gomach_announce_hdr),
GNRC_NETTYPE_GOMACH);
if (pkt == NULL) {
LOG_ERROR("ERROR: [GOMACH]: pktbuf add failed in gnrc_gomach_bcast_subchann_seq().\n");
return -ENOBUFS;
}
gomach_pkt = pkt;
pkt = gnrc_pktbuf_add(pkt, NULL, sizeof(gnrc_netif_hdr_t), GNRC_NETTYPE_NETIF);
if (pkt == NULL) {
gnrc_pktbuf_release(gomach_pkt);
LOG_ERROR("ERROR: [GOMACH]: netif add failed in gnrc_gomach_bcast_subchann_seq().\n");
return -ENOBUFS;
}
gnrc_pktsnip_t *netif_snip = gnrc_pktsnip_search_type(pkt, GNRC_NETTYPE_NETIF);
if (netif_snip == NULL) {
LOG_ERROR("[GOMACH]: No netif_hdr found in gnrc_gomach_bcast_subchann_seq().\n");
gnrc_pktbuf_release(pkt);
return -ENOBUFS;
}
else {
nethdr_announce = netif_snip->data;
}
/* Construct NETIF header and initiate address fields. */
gnrc_netif_hdr_init(nethdr_announce, 0, 0);
/* Send the packet as broadcast. */
nethdr_announce->flags |= GNRC_NETIF_HDR_FLAGS_BROADCAST;
return gnrc_gomach_send(netif, pkt, use_csma);
}
void gnrc_gomach_process_preamble_ack(gnrc_netif_t *netif, gnrc_pktsnip_t *pkt)
{
assert(netif != NULL);
assert(pkt != NULL);
gnrc_gomach_frame_preamble_ack_t *gomach_preamble_ack_hdr = NULL;
gnrc_pktsnip_t *gomach_snip = gnrc_pktsnip_search_type(pkt, GNRC_NETTYPE_GOMACH);
if (gomach_snip == NULL) {
LOG_ERROR("[GOMACH]: No gomach_snip found in gnrc_gomach_process_preamble_ack().\n");
return;
}
else {
gomach_preamble_ack_hdr = gomach_snip->data;
}
if (gomach_preamble_ack_hdr == NULL) {
LOG_ERROR("[GOMACH]: preamble_ack_hdr is null.\n");
return;
}
/* Mark the neighbor as phase-known */
netif->mac.tx.current_neighbor->mac_type = GNRC_GOMACH_TYPE_KNOWN;
/* Fetch and deduce the exact wake-up phase of the neighbor. */
long int phase_us = gnrc_gomach_phase_now(netif) -
gomach_preamble_ack_hdr->phase_in_us;
if (phase_us < 0) {
phase_us += GNRC_GOMACH_SUPERFRAME_DURATION_US;
}
if (((uint32_t)phase_us > (GNRC_GOMACH_SUPERFRAME_DURATION_US - GNRC_GOMACH_CP_MIN_GAP_US)) ||
((uint32_t)phase_us < GNRC_GOMACH_CP_MIN_GAP_US)) {
LOG_DEBUG("[GOMACH] t2u: own phase is close to the neighbor's.\n");
gnrc_gomach_set_phase_backoff(netif, true);
/* Set a random phase-backoff value. */
netif->mac.prot.gomach.backoff_phase_us =
random_uint32_range(GNRC_GOMACH_CP_MIN_GAP_US,
(GNRC_GOMACH_SUPERFRAME_DURATION_US - GNRC_GOMACH_CP_MIN_GAP_US));
}
netif->mac.tx.current_neighbor->cp_phase = phase_us;
/* Record the public-channel phase of the neighbor. */
if (gnrc_gomach_get_enter_new_cycle(netif) &&
((uint32_t)phase_us > gnrc_gomach_phase_now(netif))) {
if (gnrc_gomach_get_on_pubchan_1(netif)) {
netif->mac.tx.current_neighbor->pub_chanseq = netif->mac.prot.gomach.pub_channel_2;
}
else {
netif->mac.tx.current_neighbor->pub_chanseq = netif->mac.prot.gomach.pub_channel_1;
}
}
else {
if (gnrc_gomach_get_on_pubchan_1(netif)) {
netif->mac.tx.current_neighbor->pub_chanseq = netif->mac.prot.gomach.pub_channel_1;
}
else {
netif->mac.tx.current_neighbor->pub_chanseq = netif->mac.prot.gomach.pub_channel_2;
}
}
}
static inline void _wait_preamble_ack_preamble(gnrc_netif_t *netif,
gnrc_pktsnip_t *pkt)
{
/* Found other ongoing preamble transmission, quit its own t2u for
* collision avoidance. */
gnrc_pktbuf_release(pkt);
LOG_DEBUG("[GOMACH] t2u: found other preamble, quit t2u.\n");
gnrc_gomach_set_quit_cycle(netif, true);
}
static bool _wait_preamble_ack_preambleack(gnrc_netif_t *netif,
gnrc_gomach_packet_info_t *info,
gnrc_pktsnip_t *pkt)
{
if ((memcmp(&netif->l2addr, &info->dst_addr.addr,
netif->l2addr_len) == 0) &&
(memcmp(&netif->mac.tx.current_neighbor->l2_addr,
&info->src_addr.addr,
netif->mac.tx.current_neighbor->l2_addr_len) == 0)) {
/* Got preamble-ACK from targeted device. */
gnrc_gomach_set_got_preamble_ack(netif, true);
/* Analyze the preamble-ACK to get phase-locked with the neighbor device. */
gnrc_gomach_process_preamble_ack(netif, pkt);
gnrc_pktbuf_release(pkt);
gnrc_priority_pktqueue_flush(&netif->mac.rx.queue);
return false;
}
/* Preamble-ACK is not from targeted device. release it. */
gnrc_pktbuf_release(pkt);
return true;
}
static bool _wait_preamble_ack_data(gnrc_netif_t *netif,
gnrc_gomach_packet_info_t *info,
gnrc_pktsnip_t *pkt)
{
if (memcmp(&netif->l2addr, &info->dst_addr.addr,
netif->l2addr_len) == 0) {
/* The data is for itself, now update the sender's queue-length indicator. */
gnrc_gomach_indicator_update(netif, pkt, info);
/* Check that whether this is a duplicate packet. */
if ((gnrc_gomach_check_duplicate(netif, info))) {
gnrc_pktbuf_release(pkt);
LOG_DEBUG("[GOMACH] t2u: received a duplicate packet.\n");
return false;
}
gnrc_gomach_dispatch_defer(netif->mac.rx.dispatch_buffer, pkt);
gnrc_mac_dispatch(&netif->mac.rx);
}
else {
/* If the data is not for the device, release it. */
gnrc_pktbuf_release(pkt);
}
return true;
}
static inline void _wait_preamble_ack_bcast(gnrc_netif_t *netif,
gnrc_pktsnip_t *pkt)
{
/* Release the received broadcast pkt. Only receive broadcast packets in CP,
* thus to reduce complexity. */
gnrc_gomach_set_quit_cycle(netif, true);
gnrc_pktbuf_release(pkt);
LOG_DEBUG("WARNING: [GOMACH] t2u: receive a broadcast packet, quit t2u.\n");
}
void gnrc_gomach_process_pkt_in_wait_preamble_ack(gnrc_netif_t *netif)
{
assert(netif != NULL);
gnrc_pktsnip_t *pkt;
gnrc_gomach_packet_info_t receive_packet_info;
while ((pkt = gnrc_priority_pktqueue_pop(&netif->mac.rx.queue)) != NULL) {
/* Parse the received packet. */
int res = _parse_packet(netif, pkt, &receive_packet_info);
if (res != 0) {
LOG_DEBUG("[GOMACH] t2u: Packet could not be parsed: %i\n", res);
gnrc_pktbuf_release(pkt);
continue;
}
switch (receive_packet_info.header->type) {
case GNRC_GOMACH_FRAME_PREAMBLE: {
_wait_preamble_ack_preamble(netif, pkt);
break;
}
case GNRC_GOMACH_FRAME_PREAMBLE_ACK: {
if (!_wait_preamble_ack_preambleack(netif, &receive_packet_info, pkt)) {
return;
}
break;
}
case GNRC_GOMACH_FRAME_DATA: {
if (!_wait_preamble_ack_data(netif, &receive_packet_info, pkt)) {
return;
}
break;
}
case GNRC_GOMACH_FRAME_BROADCAST: {
_wait_preamble_ack_bcast(netif, pkt);
break;
}
default: {
gnrc_pktbuf_release(pkt);
break;
}
}
}
}
int gnrc_gomach_send_data(gnrc_netif_t *netif, netopt_enable_t csma_enable)
{
assert(netif != NULL);
gnrc_pktsnip_t *pkt = netif->mac.tx.packet;
assert(pkt != NULL);
/* Insert GoMacH header above NETIF header. */
gnrc_gomach_frame_data_t *gomach_data_hdr_pointer;
gnrc_pktsnip_t *gomach_snip = gnrc_pktsnip_search_type(pkt, GNRC_NETTYPE_GOMACH);
if (gomach_snip != NULL) {
gomach_data_hdr_pointer = gomach_snip->data;
}
else {
gomach_data_hdr_pointer = NULL;
}
if (gomach_data_hdr_pointer == NULL) {
/* No GoMacH header yet, build one. */
gnrc_gomach_frame_data_t gomach_data_hdr;
gomach_data_hdr.header.type = GNRC_GOMACH_FRAME_DATA;
/* Set the queue-length indicator according to its current queue situation. */
gomach_data_hdr.queue_indicator =
gnrc_priority_pktqueue_length(&netif->mac.tx.current_neighbor->queue);
/* Save the payload pointer. */
gnrc_pktsnip_t *payload = netif->mac.tx.packet->next;
pkt->next = gnrc_pktbuf_add(pkt->next, &gomach_data_hdr, sizeof(gomach_data_hdr),
GNRC_NETTYPE_GOMACH);
if (pkt->next == NULL) {
LOG_ERROR("ERROR: [GOMACH]: pktbuf add failed in gnrc_gomach_send_data().\n");
/* Make append payload after netif header again. */
netif->mac.tx.packet->next = payload;
return -ENOBUFS;
}
}
else {
/* GoMacH header exists, update the queue-indicator. */
gomach_data_hdr_pointer->queue_indicator =
gnrc_priority_pktqueue_length(&netif->mac.tx.current_neighbor->queue);
}
gnrc_pktbuf_hold(netif->mac.tx.packet, 1);
/* Send the data packet here. */
return gnrc_gomach_send(netif, netif->mac.tx.packet, csma_enable);
}
bool gnrc_gomach_find_next_tx_neighbor(gnrc_netif_t *netif)
{
assert(netif != NULL);
int next = -1;
/* If current neighbor pointer is not NULL, it means we have pending packet from last
* t2u or t2k or bcast to send. In this case, return immediately. */
if (netif->mac.tx.current_neighbor != NULL) {
return true;
}
/* First check whether we have broadcast packet to send. */
if (gnrc_priority_pktqueue_length(&netif->mac.tx.neighbors[0].queue) > 0) {
next = 0;
}
else {
/* Find the next neighbor to send data packet to. */
/* Don't always start checking with ID 0, take turns to check every neighbor's queue,
* thus to be more fair. */
uint8_t j = netif->mac.tx.last_tx_neighbor_id + 1;
if (j >= GNRC_MAC_NEIGHBOR_COUNT) {
j = 1;
}
for (uint8_t i = 1; i < GNRC_MAC_NEIGHBOR_COUNT; i++) {
if (gnrc_priority_pktqueue_length(&netif->mac.tx.neighbors[j].queue) > 0) {
netif->mac.tx.last_tx_neighbor_id = j;
next = (int) j;
break;
}
else {
j++;
if (j >= GNRC_MAC_NEIGHBOR_COUNT) {
j = 1;
}
}
}
}
if (next >= 0) {
gnrc_pktsnip_t *pkt = gnrc_priority_pktqueue_pop(&netif->mac.tx.neighbors[next].queue);
if (pkt != NULL) {
netif->mac.tx.packet = pkt;
netif->mac.tx.current_neighbor = &netif->mac.tx.neighbors[next];
netif->mac.tx.tx_seq = 0;
netif->mac.tx.t2u_retry_counter = 0;
return true;
}
else {
return false;
}
}
return false;
}
void gnrc_gomach_beacon_process(gnrc_netif_t *netif, gnrc_pktsnip_t *pkt)
{
assert(netif != NULL);
assert(pkt != NULL);
gnrc_gomach_frame_beacon_t *gomach_beacon_hdr = NULL;
gnrc_pktsnip_t *gomach_snip = NULL;
gnrc_gomach_l2_id_t *id_list;
uint8_t *slots_list;
uint8_t schedulelist_size = 0;
bool got_allocated_slots;
uint8_t id_position;
gnrc_pktsnip_t *beacon_snip = gnrc_pktsnip_search_type(pkt, GNRC_NETTYPE_GOMACH);
if (beacon_snip == NULL) {
LOG_ERROR("[GOMACH]: No beacon-snip found in gnrc_gomach_beacon_process().\n");
return;
}
else {
gomach_beacon_hdr = beacon_snip->data;
}
if (gomach_beacon_hdr == NULL) {
LOG_ERROR("ERROR: [GOMACH]: GoMacH's beacon header is null.\n");
return;
}
schedulelist_size = gomach_beacon_hdr->schedulelist_size;
netif->mac.tx.vtdma_para.sub_channel_seq = gomach_beacon_hdr->sub_channel_seq;
if (schedulelist_size == 0) {
/* No allocated slots. */
netif->mac.tx.vtdma_para.slots_num = 0;
netif->mac.tx.vtdma_para.slots_position = 0;
return;
}
/* Take the ID-list out. */
gomach_snip = gnrc_pktbuf_mark(pkt, schedulelist_size * sizeof(gnrc_gomach_l2_id_t),
GNRC_NETTYPE_GOMACH);
id_list = gomach_snip->data;
/* Take the slots-list out. */
slots_list = pkt->data;
/* Check whether this device has been allocated slots. */
int i = 0;
got_allocated_slots = false;
id_position = 0;
for (i = 0; i < schedulelist_size; i++) {
if (memcmp(netif->l2addr, id_list[i].addr, netif->l2addr_len) == 0) {
got_allocated_slots = true;
id_position = i;
break;
}
}
if (got_allocated_slots == true) {
/* Find the slots number and the related slots position. */
netif->mac.tx.vtdma_para.slots_num = slots_list[id_position];
uint8_t slots_position = 0;
for (i = 0; i < id_position; i++) {
slots_position += slots_list[i];
}
netif->mac.tx.vtdma_para.slots_position = slots_position;
}
else {
/* No allocated slots. */
netif->mac.tx.vtdma_para.slots_num = 0;
netif->mac.tx.vtdma_para.slots_position = 0;
}
}
void gnrc_gomach_packet_process_in_wait_beacon(gnrc_netif_t *netif)
{
assert(netif != NULL);
gnrc_pktsnip_t *pkt;
gnrc_gomach_packet_info_t receive_packet_info;
while ((pkt = gnrc_priority_pktqueue_pop(&netif->mac.rx.queue)) != NULL) {
/* Parse the received packet. */
int res = _parse_packet(netif, pkt, &receive_packet_info);
if (res != 0) {
LOG_DEBUG("[GOMACH] t2k: Packet could not be parsed: %i\n", res);
gnrc_pktbuf_release(pkt);
continue;
}
switch (receive_packet_info.header->type) {
case GNRC_GOMACH_FRAME_BEACON: {
if (memcmp(&netif->mac.tx.current_neighbor->l2_addr,
&receive_packet_info.src_addr.addr,
netif->mac.tx.current_neighbor->l2_addr_len) == 0) {
gnrc_gomach_clear_timeout(netif, GNRC_GOMACH_TIMEOUT_WAIT_BEACON);
gnrc_gomach_beacon_process(netif, pkt);
}
gnrc_pktbuf_release(pkt);
break;
}
case GNRC_GOMACH_FRAME_PREAMBLE: {
/* Release preamble packet no matter the preamble is for it or not,
* and quit the t2k procedure. */
gnrc_gomach_set_quit_cycle(netif, true);
gnrc_pktbuf_release(pkt);
break;
}
case GNRC_GOMACH_FRAME_DATA: {
/* It is unlikely that we will received a data for us here.
* This means the device' CP is close with its destination's. */
if (memcmp(&netif->l2addr, &receive_packet_info.dst_addr.addr,
netif->l2addr_len) == 0) {
gnrc_gomach_indicator_update(netif, pkt, &receive_packet_info);
if ((gnrc_gomach_check_duplicate(netif, &receive_packet_info))) {
gnrc_pktbuf_release(pkt);
LOG_DEBUG("[GOMACH]: received a duplicate packet.\n");
return;
}
gnrc_gomach_dispatch_defer(netif->mac.rx.dispatch_buffer, pkt);
gnrc_mac_dispatch(&netif->mac.rx);
}
else {
gnrc_pktbuf_release(pkt);
}
break;
}
case GNRC_GOMACH_FRAME_BROADCAST: {
gnrc_gomach_set_quit_cycle(netif, true);
gnrc_pktbuf_release(pkt);
break;
}
default: {
gnrc_pktbuf_release(pkt);
break;
}
}
}
}
void gnrc_gomach_packet_process_in_vtdma(gnrc_netif_t *netif)
{
assert(netif != NULL);
gnrc_pktsnip_t *pkt;
gnrc_gomach_packet_info_t receive_packet_info;
while ((pkt = gnrc_priority_pktqueue_pop(&netif->mac.rx.queue)) != NULL) {
/* Parse the received packet. */
int res = _parse_packet(netif, pkt, &receive_packet_info);
if (res != 0) {
LOG_DEBUG("[GOMACH] vtdma: Packet could not be parsed: %i\n", res);
gnrc_pktbuf_release(pkt);
continue;
}
switch (receive_packet_info.header->type) {
case GNRC_GOMACH_FRAME_DATA: {
gnrc_gomach_indicator_update(netif, pkt, &receive_packet_info);
if ((gnrc_gomach_check_duplicate(netif, &receive_packet_info))) {
gnrc_pktbuf_release(pkt);
LOG_DEBUG("[GOMACH] vtdma: received a duplicate packet.\n");
return;
}
gnrc_gomach_dispatch_defer(netif->mac.rx.dispatch_buffer, pkt);
gnrc_mac_dispatch(&netif->mac.rx);
break;
}
default: {
gnrc_pktbuf_release(pkt);
break;
}
}
}
}
void gnrc_gomach_update_neighbor_phase(gnrc_netif_t *netif)
{
assert(netif != NULL);
for (uint8_t i = 1; i < GNRC_MAC_NEIGHBOR_COUNT; i++) {
if (netif->mac.tx.neighbors[i].mac_type == GNRC_GOMACH_TYPE_KNOWN) {
long int tmp = netif->mac.tx.neighbors[i].cp_phase -
netif->mac.prot.gomach.backoff_phase_us;
if (tmp < 0) {
tmp += GNRC_GOMACH_SUPERFRAME_DURATION_US;
/* Toggle the neighbor's public channel phase if tmp < 0. */
if (netif->mac.tx.neighbors[i].pub_chanseq ==
netif->mac.prot.gomach.pub_channel_1) {
netif->mac.tx.neighbors[i].pub_chanseq = netif->mac.prot.gomach.pub_channel_2;
}
else {
netif->mac.tx.neighbors[i].pub_chanseq = netif->mac.prot.gomach.pub_channel_1;
}
}
netif->mac.tx.neighbors[i].cp_phase = (uint32_t)tmp;
}
}
}
void gnrc_gomach_update_neighbor_pubchan(gnrc_netif_t *netif)
{
assert(netif != NULL);
/* Toggle this device's current channel. */
if (netif->mac.prot.gomach.cur_pub_channel == netif->mac.prot.gomach.pub_channel_1) {
netif->mac.prot.gomach.cur_pub_channel = netif->mac.prot.gomach.pub_channel_2;
}
else {
netif->mac.prot.gomach.cur_pub_channel = netif->mac.prot.gomach.pub_channel_1;
}
/* Toggle TX neighbors' current channel. */
for (uint8_t i = 1; i < GNRC_MAC_NEIGHBOR_COUNT; i++) {
if (netif->mac.tx.neighbors[i].mac_type == GNRC_GOMACH_TYPE_KNOWN) {
if (netif->mac.tx.neighbors[i].pub_chanseq == netif->mac.prot.gomach.pub_channel_1) {
netif->mac.tx.neighbors[i].pub_chanseq = netif->mac.prot.gomach.pub_channel_2;
}
else {
netif->mac.tx.neighbors[i].pub_chanseq = netif->mac.prot.gomach.pub_channel_1;
}
}
}
}
View Git Blame Copy Permalink