xref: /freebsd-src/sys/dev/netmap/netmap_mbq.c (revision 2ff63af9b88c7413b7d71715b5532625752a248e)
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