1*718cf2ccSPedro F. Giffuni /*- 2*718cf2ccSPedro F. Giffuni * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 3*718cf2ccSPedro F. Giffuni * 437e3a6d3SLuigi Rizzo * Copyright (C) 2013-2014 Vincenzo Maffione 537e3a6d3SLuigi Rizzo * All rights reserved. 6f9790aebSLuigi Rizzo * 7f9790aebSLuigi Rizzo * Redistribution and use in source and binary forms, with or without 8f9790aebSLuigi Rizzo * modification, are permitted provided that the following conditions 9f9790aebSLuigi Rizzo * are met: 10f9790aebSLuigi Rizzo * 1. Redistributions of source code must retain the above copyright 11f9790aebSLuigi Rizzo * notice, this list of conditions and the following disclaimer. 12f9790aebSLuigi Rizzo * 2. Redistributions in binary form must reproduce the above copyright 13f9790aebSLuigi Rizzo * notice, this list of conditions and the following disclaimer in the 14f9790aebSLuigi Rizzo * documentation and/or other materials provided with the distribution. 15f9790aebSLuigi Rizzo * 16f9790aebSLuigi Rizzo * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 17f9790aebSLuigi Rizzo * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18f9790aebSLuigi Rizzo * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19f9790aebSLuigi Rizzo * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 20f9790aebSLuigi Rizzo * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21f9790aebSLuigi Rizzo * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22f9790aebSLuigi Rizzo * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23f9790aebSLuigi Rizzo * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24f9790aebSLuigi Rizzo * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25f9790aebSLuigi Rizzo * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26f9790aebSLuigi Rizzo * SUCH DAMAGE. 27f9790aebSLuigi Rizzo */ 28f9790aebSLuigi Rizzo 29f9790aebSLuigi Rizzo /* 30f9790aebSLuigi Rizzo * $FreeBSD$ 31f9790aebSLuigi Rizzo */ 32f9790aebSLuigi Rizzo 33f9790aebSLuigi Rizzo 34f9790aebSLuigi Rizzo #ifdef linux 35f9790aebSLuigi Rizzo #include "bsd_glue.h" 3637e3a6d3SLuigi Rizzo #elif defined (_WIN32) 3737e3a6d3SLuigi Rizzo #include "win_glue.h" 38f9790aebSLuigi Rizzo #else /* __FreeBSD__ */ 39f9790aebSLuigi Rizzo #include <sys/param.h> 40f9790aebSLuigi Rizzo #include <sys/lock.h> 41f9790aebSLuigi Rizzo #include <sys/mutex.h> 42f9790aebSLuigi Rizzo #include <sys/systm.h> 43f9790aebSLuigi Rizzo #include <sys/mbuf.h> 44f9790aebSLuigi Rizzo #endif /* __FreeBSD__ */ 45f9790aebSLuigi Rizzo 46f9790aebSLuigi Rizzo #include "netmap_mbq.h" 47f9790aebSLuigi Rizzo 48f9790aebSLuigi Rizzo 49f9790aebSLuigi Rizzo static inline void __mbq_init(struct mbq *q) 50f9790aebSLuigi Rizzo { 51f9790aebSLuigi Rizzo q->head = q->tail = NULL; 52f9790aebSLuigi Rizzo q->count = 0; 53f9790aebSLuigi Rizzo } 54f9790aebSLuigi Rizzo 5517885a7bSLuigi Rizzo 56f9790aebSLuigi Rizzo void mbq_safe_init(struct mbq *q) 57f9790aebSLuigi Rizzo { 58f9790aebSLuigi Rizzo mtx_init(&q->lock, "mbq", NULL, MTX_SPIN); 59f9790aebSLuigi Rizzo __mbq_init(q); 60f9790aebSLuigi Rizzo } 61f9790aebSLuigi Rizzo 6217885a7bSLuigi Rizzo 63f9790aebSLuigi Rizzo void mbq_init(struct mbq *q) 64f9790aebSLuigi Rizzo { 65f9790aebSLuigi Rizzo __mbq_init(q); 66f9790aebSLuigi Rizzo } 67f9790aebSLuigi Rizzo 6817885a7bSLuigi Rizzo 69f9790aebSLuigi Rizzo static inline void __mbq_enqueue(struct mbq *q, struct mbuf *m) 70f9790aebSLuigi Rizzo { 71f9790aebSLuigi Rizzo m->m_nextpkt = NULL; 72f9790aebSLuigi Rizzo if (q->tail) { 73f9790aebSLuigi Rizzo q->tail->m_nextpkt = m; 74f9790aebSLuigi Rizzo q->tail = m; 75f9790aebSLuigi Rizzo } else { 76f9790aebSLuigi Rizzo q->head = q->tail = m; 77f9790aebSLuigi Rizzo } 78f9790aebSLuigi Rizzo q->count++; 79f9790aebSLuigi Rizzo } 80f9790aebSLuigi Rizzo 8117885a7bSLuigi Rizzo 82f9790aebSLuigi Rizzo void mbq_safe_enqueue(struct mbq *q, struct mbuf *m) 83f9790aebSLuigi Rizzo { 84997b054cSLuigi Rizzo mbq_lock(q); 85f9790aebSLuigi Rizzo __mbq_enqueue(q, m); 86997b054cSLuigi Rizzo mbq_unlock(q); 87f9790aebSLuigi Rizzo } 88f9790aebSLuigi Rizzo 8917885a7bSLuigi Rizzo 90f9790aebSLuigi Rizzo void mbq_enqueue(struct mbq *q, struct mbuf *m) 91f9790aebSLuigi Rizzo { 92f9790aebSLuigi Rizzo __mbq_enqueue(q, m); 93f9790aebSLuigi Rizzo } 94f9790aebSLuigi Rizzo 9517885a7bSLuigi Rizzo 96f9790aebSLuigi Rizzo static inline struct mbuf *__mbq_dequeue(struct mbq *q) 97f9790aebSLuigi Rizzo { 98f9790aebSLuigi Rizzo struct mbuf *ret = NULL; 99f9790aebSLuigi Rizzo 100f9790aebSLuigi Rizzo if (q->head) { 101f9790aebSLuigi Rizzo ret = q->head; 102f9790aebSLuigi Rizzo q->head = ret->m_nextpkt; 103f9790aebSLuigi Rizzo if (q->head == NULL) { 104f9790aebSLuigi Rizzo q->tail = NULL; 105f9790aebSLuigi Rizzo } 106f9790aebSLuigi Rizzo q->count--; 107f9790aebSLuigi Rizzo ret->m_nextpkt = NULL; 108f9790aebSLuigi Rizzo } 109f9790aebSLuigi Rizzo 110f9790aebSLuigi Rizzo return ret; 111f9790aebSLuigi Rizzo } 112f9790aebSLuigi Rizzo 11317885a7bSLuigi Rizzo 114f9790aebSLuigi Rizzo struct mbuf *mbq_safe_dequeue(struct mbq *q) 115f9790aebSLuigi Rizzo { 116f9790aebSLuigi Rizzo struct mbuf *ret; 117f9790aebSLuigi Rizzo 118997b054cSLuigi Rizzo mbq_lock(q); 119f9790aebSLuigi Rizzo ret = __mbq_dequeue(q); 120997b054cSLuigi Rizzo mbq_unlock(q); 121f9790aebSLuigi Rizzo 122f9790aebSLuigi Rizzo return ret; 123f9790aebSLuigi Rizzo } 124f9790aebSLuigi Rizzo 12517885a7bSLuigi Rizzo 126f9790aebSLuigi Rizzo struct mbuf *mbq_dequeue(struct mbq *q) 127f9790aebSLuigi Rizzo { 128f9790aebSLuigi Rizzo return __mbq_dequeue(q); 129f9790aebSLuigi Rizzo } 130f9790aebSLuigi Rizzo 13117885a7bSLuigi Rizzo 132f9790aebSLuigi Rizzo /* XXX seems pointless to have a generic purge */ 133f9790aebSLuigi Rizzo static void __mbq_purge(struct mbq *q, int safe) 134f9790aebSLuigi Rizzo { 135f9790aebSLuigi Rizzo struct mbuf *m; 136f9790aebSLuigi Rizzo 137f9790aebSLuigi Rizzo for (;;) { 138f9790aebSLuigi Rizzo m = safe ? mbq_safe_dequeue(q) : mbq_dequeue(q); 139f9790aebSLuigi Rizzo if (m) { 140f9790aebSLuigi Rizzo m_freem(m); 141f9790aebSLuigi Rizzo } else { 142f9790aebSLuigi Rizzo break; 143f9790aebSLuigi Rizzo } 144f9790aebSLuigi Rizzo } 145f9790aebSLuigi Rizzo } 146f9790aebSLuigi Rizzo 14717885a7bSLuigi Rizzo 148f9790aebSLuigi Rizzo void mbq_purge(struct mbq *q) 149f9790aebSLuigi Rizzo { 150f9790aebSLuigi Rizzo __mbq_purge(q, 0); 151f9790aebSLuigi Rizzo } 152f9790aebSLuigi Rizzo 15317885a7bSLuigi Rizzo 154f9790aebSLuigi Rizzo void mbq_safe_purge(struct mbq *q) 155f9790aebSLuigi Rizzo { 156f9790aebSLuigi Rizzo __mbq_purge(q, 1); 157f9790aebSLuigi Rizzo } 158f9790aebSLuigi Rizzo 15917885a7bSLuigi Rizzo 16037e3a6d3SLuigi Rizzo void mbq_safe_fini(struct mbq *q) 161f9790aebSLuigi Rizzo { 162f9790aebSLuigi Rizzo mtx_destroy(&q->lock); 163f9790aebSLuigi Rizzo } 164f9790aebSLuigi Rizzo 165f9790aebSLuigi Rizzo 16637e3a6d3SLuigi Rizzo void mbq_fini(struct mbq *q) 167f9790aebSLuigi Rizzo { 168f9790aebSLuigi Rizzo } 169