mirror of
https://github.com/RIOT-OS/RIOT.git
synced 2024-12-29 04:50:03 +01:00
114 lines
2.9 KiB
C
114 lines
2.9 KiB
C
/*
|
|
* Copyright (C) 2019 Freie Universität Berlin
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
/**
|
|
* @{
|
|
*
|
|
* @file
|
|
* @author Martine Lenders <m.lenders@fu-berlin.de>
|
|
*/
|
|
|
|
#include <assert.h>
|
|
|
|
#include "net/gnrc/pktqueue.h"
|
|
#include "net/gnrc/netif/conf.h"
|
|
#include "net/gnrc/netif/internal.h"
|
|
#include "net/gnrc/netif/pktq.h"
|
|
|
|
#define ENABLE_DEBUG 0
|
|
#include "debug.h"
|
|
|
|
static mutex_t _pool_lock = MUTEX_INIT;
|
|
static gnrc_pktqueue_t _pool[CONFIG_GNRC_NETIF_PKTQ_POOL_SIZE];
|
|
|
|
static gnrc_pktqueue_t *_get_free_entry(gnrc_pktsnip_t *pkt)
|
|
{
|
|
gnrc_pktqueue_t *entry = NULL;
|
|
|
|
mutex_lock(&_pool_lock);
|
|
for (unsigned i = 0; i < CONFIG_GNRC_NETIF_PKTQ_POOL_SIZE; i++) {
|
|
if (_pool[i].pkt == NULL) {
|
|
_pool[i].pkt = pkt;
|
|
entry = &_pool[i];
|
|
break;
|
|
}
|
|
}
|
|
mutex_unlock(&_pool_lock);
|
|
|
|
return entry;
|
|
}
|
|
|
|
unsigned gnrc_netif_pktq_usage(void)
|
|
{
|
|
unsigned res = 0;
|
|
|
|
for (unsigned i = 0; i < CONFIG_GNRC_NETIF_PKTQ_POOL_SIZE; i++) {
|
|
if (_pool[i].pkt != NULL) {
|
|
res++;
|
|
}
|
|
}
|
|
return res;
|
|
}
|
|
|
|
int gnrc_netif_pktq_put(gnrc_netif_t *netif, gnrc_pktsnip_t *pkt)
|
|
{
|
|
assert(netif != NULL);
|
|
assert(pkt != NULL);
|
|
|
|
gnrc_pktqueue_t *entry = _get_free_entry(pkt);
|
|
|
|
if (entry == NULL) {
|
|
return -1;
|
|
}
|
|
gnrc_pktqueue_add(&netif->send_queue.queue, entry);
|
|
return 0;
|
|
}
|
|
|
|
void gnrc_netif_pktq_sched_get(gnrc_netif_t *netif)
|
|
{
|
|
#if CONFIG_GNRC_NETIF_PKTQ_TIMER_US > 0
|
|
assert(netif != NULL);
|
|
netif->send_queue.dequeue_msg.type = GNRC_NETIF_PKTQ_DEQUEUE_MSG;
|
|
/* Prevent timer from firing while we add this.
|
|
* Otherwise the system might crash: The timer handler sets
|
|
* netif->send_queue.dequeue_msg.sender_pid to KERNEL_PID_ISR while
|
|
* the message is added to the timer, causing the next round of the timer
|
|
* handler to try to send the message to IPC, leaving the system in an
|
|
* invalid state. */
|
|
unsigned state = irq_disable();
|
|
xtimer_set_msg(&netif->send_queue.dequeue_timer,
|
|
CONFIG_GNRC_NETIF_PKTQ_TIMER_US,
|
|
&netif->send_queue.dequeue_msg, netif->pid);
|
|
irq_restore(state);
|
|
#elif CONFIG_GNRC_NETIF_PKTQ_TIMER_US == 0
|
|
assert(netif != NULL);
|
|
netif->send_queue.dequeue_msg.type = GNRC_NETIF_PKTQ_DEQUEUE_MSG;
|
|
if (msg_send(&netif->send_queue.dequeue_msg, netif->pid) < 0) {
|
|
DEBUG("gnrc_netif_pktq: couldn't schedule packet (msg queue is full)\n");
|
|
}
|
|
#else
|
|
(void)netif;
|
|
#endif /* CONFIG_GNRC_NETIF_PKTQ_TIMER_US >= 0 */
|
|
}
|
|
|
|
int gnrc_netif_pktq_push_back(gnrc_netif_t *netif, gnrc_pktsnip_t *pkt)
|
|
{
|
|
assert(netif != NULL);
|
|
assert(pkt != NULL);
|
|
|
|
gnrc_pktqueue_t *entry = _get_free_entry(pkt);
|
|
|
|
if (entry == NULL) {
|
|
return -1;
|
|
}
|
|
LL_PREPEND(netif->send_queue.queue, entry);
|
|
return 0;
|
|
}
|
|
|
|
/** @} */
|