1718cf2ccSPedro F. Giffuni /*-
2*4d846d26SWarner Losh * SPDX-License-Identifier: BSD-2-Clause
3718cf2ccSPedro 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 */
31f9790aebSLuigi Rizzo
32f9790aebSLuigi Rizzo
33f9790aebSLuigi Rizzo #ifdef linux
34f9790aebSLuigi Rizzo #include "bsd_glue.h"
3537e3a6d3SLuigi Rizzo #elif defined (_WIN32)
3637e3a6d3SLuigi Rizzo #include "win_glue.h"
37f9790aebSLuigi Rizzo #else /* __FreeBSD__ */
38f9790aebSLuigi Rizzo #include <sys/param.h>
39f9790aebSLuigi Rizzo #include <sys/lock.h>
40f9790aebSLuigi Rizzo #include <sys/mutex.h>
41f9790aebSLuigi Rizzo #include <sys/systm.h>
42f9790aebSLuigi Rizzo #include <sys/mbuf.h>
43f9790aebSLuigi Rizzo #endif /* __FreeBSD__ */
44f9790aebSLuigi Rizzo
45f9790aebSLuigi Rizzo #include "netmap_mbq.h"
46f9790aebSLuigi Rizzo
47f9790aebSLuigi Rizzo
__mbq_init(struct mbq * q)48f9790aebSLuigi Rizzo static inline void __mbq_init(struct mbq *q)
49f9790aebSLuigi Rizzo {
50f9790aebSLuigi Rizzo q->head = q->tail = NULL;
51f9790aebSLuigi Rizzo q->count = 0;
52f9790aebSLuigi Rizzo }
53f9790aebSLuigi Rizzo
5417885a7bSLuigi Rizzo
mbq_safe_init(struct mbq * q)55f9790aebSLuigi Rizzo void mbq_safe_init(struct mbq *q)
56f9790aebSLuigi Rizzo {
57f9790aebSLuigi Rizzo mtx_init(&q->lock, "mbq", NULL, MTX_SPIN);
58f9790aebSLuigi Rizzo __mbq_init(q);
59f9790aebSLuigi Rizzo }
60f9790aebSLuigi Rizzo
6117885a7bSLuigi Rizzo
mbq_init(struct mbq * q)62f9790aebSLuigi Rizzo void mbq_init(struct mbq *q)
63f9790aebSLuigi Rizzo {
64f9790aebSLuigi Rizzo __mbq_init(q);
65f9790aebSLuigi Rizzo }
66f9790aebSLuigi Rizzo
6717885a7bSLuigi Rizzo
__mbq_enqueue(struct mbq * q,struct mbuf * m)68f9790aebSLuigi Rizzo static inline void __mbq_enqueue(struct mbq *q, struct mbuf *m)
69f9790aebSLuigi Rizzo {
70f9790aebSLuigi Rizzo m->m_nextpkt = NULL;
71f9790aebSLuigi Rizzo if (q->tail) {
72f9790aebSLuigi Rizzo q->tail->m_nextpkt = m;
73f9790aebSLuigi Rizzo q->tail = m;
74f9790aebSLuigi Rizzo } else {
75f9790aebSLuigi Rizzo q->head = q->tail = m;
76f9790aebSLuigi Rizzo }
77f9790aebSLuigi Rizzo q->count++;
78f9790aebSLuigi Rizzo }
79f9790aebSLuigi Rizzo
8017885a7bSLuigi Rizzo
mbq_safe_enqueue(struct mbq * q,struct mbuf * m)81f9790aebSLuigi Rizzo void mbq_safe_enqueue(struct mbq *q, struct mbuf *m)
82f9790aebSLuigi Rizzo {
83997b054cSLuigi Rizzo mbq_lock(q);
84f9790aebSLuigi Rizzo __mbq_enqueue(q, m);
85997b054cSLuigi Rizzo mbq_unlock(q);
86f9790aebSLuigi Rizzo }
87f9790aebSLuigi Rizzo
8817885a7bSLuigi Rizzo
mbq_enqueue(struct mbq * q,struct mbuf * m)89f9790aebSLuigi Rizzo void mbq_enqueue(struct mbq *q, struct mbuf *m)
90f9790aebSLuigi Rizzo {
91f9790aebSLuigi Rizzo __mbq_enqueue(q, m);
92f9790aebSLuigi Rizzo }
93f9790aebSLuigi Rizzo
9417885a7bSLuigi Rizzo
__mbq_dequeue(struct mbq * q)95f9790aebSLuigi Rizzo static inline struct mbuf *__mbq_dequeue(struct mbq *q)
96f9790aebSLuigi Rizzo {
97f9790aebSLuigi Rizzo struct mbuf *ret = NULL;
98f9790aebSLuigi Rizzo
99f9790aebSLuigi Rizzo if (q->head) {
100f9790aebSLuigi Rizzo ret = q->head;
101f9790aebSLuigi Rizzo q->head = ret->m_nextpkt;
102f9790aebSLuigi Rizzo if (q->head == NULL) {
103f9790aebSLuigi Rizzo q->tail = NULL;
104f9790aebSLuigi Rizzo }
105f9790aebSLuigi Rizzo q->count--;
106f9790aebSLuigi Rizzo ret->m_nextpkt = NULL;
107f9790aebSLuigi Rizzo }
108f9790aebSLuigi Rizzo
109f9790aebSLuigi Rizzo return ret;
110f9790aebSLuigi Rizzo }
111f9790aebSLuigi Rizzo
11217885a7bSLuigi Rizzo
mbq_safe_dequeue(struct mbq * q)113f9790aebSLuigi Rizzo struct mbuf *mbq_safe_dequeue(struct mbq *q)
114f9790aebSLuigi Rizzo {
115f9790aebSLuigi Rizzo struct mbuf *ret;
116f9790aebSLuigi Rizzo
117997b054cSLuigi Rizzo mbq_lock(q);
118f9790aebSLuigi Rizzo ret = __mbq_dequeue(q);
119997b054cSLuigi Rizzo mbq_unlock(q);
120f9790aebSLuigi Rizzo
121f9790aebSLuigi Rizzo return ret;
122f9790aebSLuigi Rizzo }
123f9790aebSLuigi Rizzo
12417885a7bSLuigi Rizzo
mbq_dequeue(struct mbq * q)125f9790aebSLuigi Rizzo struct mbuf *mbq_dequeue(struct mbq *q)
126f9790aebSLuigi Rizzo {
127f9790aebSLuigi Rizzo return __mbq_dequeue(q);
128f9790aebSLuigi Rizzo }
129f9790aebSLuigi Rizzo
13017885a7bSLuigi Rizzo
131f9790aebSLuigi Rizzo /* XXX seems pointless to have a generic purge */
__mbq_purge(struct mbq * q,int safe)132f9790aebSLuigi Rizzo static void __mbq_purge(struct mbq *q, int safe)
133f9790aebSLuigi Rizzo {
134f9790aebSLuigi Rizzo struct mbuf *m;
135f9790aebSLuigi Rizzo
136f9790aebSLuigi Rizzo for (;;) {
137f9790aebSLuigi Rizzo m = safe ? mbq_safe_dequeue(q) : mbq_dequeue(q);
138f9790aebSLuigi Rizzo if (m) {
139f9790aebSLuigi Rizzo m_freem(m);
140f9790aebSLuigi Rizzo } else {
141f9790aebSLuigi Rizzo break;
142f9790aebSLuigi Rizzo }
143f9790aebSLuigi Rizzo }
144f9790aebSLuigi Rizzo }
145f9790aebSLuigi Rizzo
14617885a7bSLuigi Rizzo
mbq_purge(struct mbq * q)147f9790aebSLuigi Rizzo void mbq_purge(struct mbq *q)
148f9790aebSLuigi Rizzo {
149f9790aebSLuigi Rizzo __mbq_purge(q, 0);
150f9790aebSLuigi Rizzo }
151f9790aebSLuigi Rizzo
15217885a7bSLuigi Rizzo
mbq_safe_purge(struct mbq * q)153f9790aebSLuigi Rizzo void mbq_safe_purge(struct mbq *q)
154f9790aebSLuigi Rizzo {
155f9790aebSLuigi Rizzo __mbq_purge(q, 1);
156f9790aebSLuigi Rizzo }
157f9790aebSLuigi Rizzo
15817885a7bSLuigi Rizzo
mbq_safe_fini(struct mbq * q)15937e3a6d3SLuigi Rizzo void mbq_safe_fini(struct mbq *q)
160f9790aebSLuigi Rizzo {
161f9790aebSLuigi Rizzo mtx_destroy(&q->lock);
162f9790aebSLuigi Rizzo }
163f9790aebSLuigi Rizzo
164f9790aebSLuigi Rizzo
mbq_fini(struct mbq * q)16537e3a6d3SLuigi Rizzo void mbq_fini(struct mbq *q)
166f9790aebSLuigi Rizzo {
167f9790aebSLuigi Rizzo }
168