xref: /freebsd-13.1/sys/dev/netmap/netmap_mbq.c (revision 718cf2cc)
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