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
__mbq_init(struct mbq * q)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
mbq_safe_init(struct mbq * q)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
mbq_init(struct mbq * q)63f9790aebSLuigi Rizzo void mbq_init(struct mbq *q)
64f9790aebSLuigi Rizzo {
65f9790aebSLuigi Rizzo __mbq_init(q);
66f9790aebSLuigi Rizzo }
67f9790aebSLuigi Rizzo
6817885a7bSLuigi Rizzo
__mbq_enqueue(struct mbq * q,struct mbuf * m)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
mbq_safe_enqueue(struct mbq * q,struct mbuf * m)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
mbq_enqueue(struct mbq * q,struct mbuf * m)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
__mbq_dequeue(struct mbq * q)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
mbq_safe_dequeue(struct mbq * q)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
mbq_dequeue(struct mbq * q)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 */
__mbq_purge(struct mbq * q,int safe)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
mbq_purge(struct mbq * q)148f9790aebSLuigi Rizzo void mbq_purge(struct mbq *q)
149f9790aebSLuigi Rizzo {
150f9790aebSLuigi Rizzo __mbq_purge(q, 0);
151f9790aebSLuigi Rizzo }
152f9790aebSLuigi Rizzo
15317885a7bSLuigi Rizzo
mbq_safe_purge(struct mbq * q)154f9790aebSLuigi Rizzo void mbq_safe_purge(struct mbq *q)
155f9790aebSLuigi Rizzo {
156f9790aebSLuigi Rizzo __mbq_purge(q, 1);
157f9790aebSLuigi Rizzo }
158f9790aebSLuigi Rizzo
15917885a7bSLuigi Rizzo
mbq_safe_fini(struct mbq * q)16037e3a6d3SLuigi Rizzo void mbq_safe_fini(struct mbq *q)
161f9790aebSLuigi Rizzo {
162f9790aebSLuigi Rizzo mtx_destroy(&q->lock);
163f9790aebSLuigi Rizzo }
164f9790aebSLuigi Rizzo
165f9790aebSLuigi Rizzo
mbq_fini(struct mbq * q)16637e3a6d3SLuigi Rizzo void mbq_fini(struct mbq *q)
167f9790aebSLuigi Rizzo {
168f9790aebSLuigi Rizzo }
169