xref: /freebsd/sys/dev/wtap/if_medium.c (revision 04d198028975d9b9fa18d64f2be53aca08f07259)
1*04d19802SAdrian Chadd /*-
2*04d19802SAdrian Chadd  * Copyright (c) 2010-2011 Monthadar Al Jaberi, TerraNet AB
3*04d19802SAdrian Chadd  * All rights reserved.
4*04d19802SAdrian Chadd  *
5*04d19802SAdrian Chadd  * Redistribution and use in source and binary forms, with or without
6*04d19802SAdrian Chadd  * modification, are permitted provided that the following conditions
7*04d19802SAdrian Chadd  * are met:
8*04d19802SAdrian Chadd  * 1. Redistributions of source code must retain the above copyright
9*04d19802SAdrian Chadd  *    notice, this list of conditions and the following disclaimer,
10*04d19802SAdrian Chadd  *    without modification.
11*04d19802SAdrian Chadd  * 2. Redistributions in binary form must reproduce at minimum a disclaimer
12*04d19802SAdrian Chadd  *    similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
13*04d19802SAdrian Chadd  *    redistribution must be conditioned upon including a substantially
14*04d19802SAdrian Chadd  *    similar Disclaimer requirement for further binary redistribution.
15*04d19802SAdrian Chadd  *
16*04d19802SAdrian Chadd  * NO WARRANTY
17*04d19802SAdrian Chadd  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
18*04d19802SAdrian Chadd  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
19*04d19802SAdrian Chadd  * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
20*04d19802SAdrian Chadd  * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
21*04d19802SAdrian Chadd  * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
22*04d19802SAdrian Chadd  * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
23*04d19802SAdrian Chadd  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
24*04d19802SAdrian Chadd  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
25*04d19802SAdrian Chadd  * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
26*04d19802SAdrian Chadd  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
27*04d19802SAdrian Chadd  * THE POSSIBILITY OF SUCH DAMAGES.
28*04d19802SAdrian Chadd  *
29*04d19802SAdrian Chadd  * $FreeBSD$
30*04d19802SAdrian Chadd  */
31*04d19802SAdrian Chadd #include "if_wtapvar.h"
32*04d19802SAdrian Chadd #include "if_medium.h"
33*04d19802SAdrian Chadd 
34*04d19802SAdrian Chadd void
35*04d19802SAdrian Chadd init_medium(struct wtap_medium *md)
36*04d19802SAdrian Chadd {
37*04d19802SAdrian Chadd 
38*04d19802SAdrian Chadd 	DWTAP_PRINTF("%s\n", __func__);
39*04d19802SAdrian Chadd 	STAILQ_INIT(&md->md_pktbuf);
40*04d19802SAdrian Chadd 	mtx_init(&md->md_mtx, "wtap_medium mtx", NULL, MTX_DEF | MTX_RECURSE);
41*04d19802SAdrian Chadd 
42*04d19802SAdrian Chadd 	/* Event handler for sending packets between wtaps */
43*04d19802SAdrian Chadd 	struct eventhandler *eh = (struct eventhandler *)
44*04d19802SAdrian Chadd 	    malloc(sizeof(struct eventhandler), M_WTAP, M_NOWAIT | M_ZERO);
45*04d19802SAdrian Chadd 	eh->tq = taskqueue_create("wtap_tx_taskq",  M_NOWAIT | M_ZERO,
46*04d19802SAdrian Chadd 	    taskqueue_thread_enqueue, &eh->tq);
47*04d19802SAdrian Chadd 	taskqueue_start_threads(&eh->tq, 1, PI_NET, "%s taskq", "wtap_medium");
48*04d19802SAdrian Chadd 	md->tx_handler = eh;
49*04d19802SAdrian Chadd 	/* Mark medium closed by default */
50*04d19802SAdrian Chadd 	md->open = 0;
51*04d19802SAdrian Chadd }
52*04d19802SAdrian Chadd 
53*04d19802SAdrian Chadd void
54*04d19802SAdrian Chadd deinit_medium(struct wtap_medium *md)
55*04d19802SAdrian Chadd {
56*04d19802SAdrian Chadd 
57*04d19802SAdrian Chadd 	DWTAP_PRINTF("%s\n", __func__);
58*04d19802SAdrian Chadd 	taskqueue_free(md->tx_handler->tq);
59*04d19802SAdrian Chadd 	free(md->tx_handler, M_WTAP);
60*04d19802SAdrian Chadd }
61*04d19802SAdrian Chadd 
62*04d19802SAdrian Chadd int
63*04d19802SAdrian Chadd medium_transmit(struct wtap_medium *md, int id, struct mbuf*m)
64*04d19802SAdrian Chadd {
65*04d19802SAdrian Chadd 
66*04d19802SAdrian Chadd 	mtx_lock(&md->md_mtx);
67*04d19802SAdrian Chadd 	if (md->open == 0){
68*04d19802SAdrian Chadd 		DWTAP_PRINTF("[%d] dropping m=%p\n", id, m);
69*04d19802SAdrian Chadd 		m_free(m);
70*04d19802SAdrian Chadd 		mtx_unlock(&md->md_mtx);
71*04d19802SAdrian Chadd 		return 0;
72*04d19802SAdrian Chadd 	}
73*04d19802SAdrian Chadd 
74*04d19802SAdrian Chadd 	DWTAP_PRINTF("[%d] transmiting m=%p\n", id, m);
75*04d19802SAdrian Chadd 	struct packet *p = (struct packet *)malloc(sizeof(struct packet),
76*04d19802SAdrian Chadd 	    M_WTAP_PACKET, M_ZERO | M_NOWAIT);
77*04d19802SAdrian Chadd 	p->id = id;
78*04d19802SAdrian Chadd 	p->m = m;
79*04d19802SAdrian Chadd 
80*04d19802SAdrian Chadd 	STAILQ_INSERT_TAIL(&md->md_pktbuf, p, pf_list);
81*04d19802SAdrian Chadd 	taskqueue_enqueue(md->tx_handler->tq, &md->tx_handler->proc);
82*04d19802SAdrian Chadd 	mtx_unlock(&md->md_mtx);
83*04d19802SAdrian Chadd 
84*04d19802SAdrian Chadd       return 0;
85*04d19802SAdrian Chadd }
86*04d19802SAdrian Chadd 
87*04d19802SAdrian Chadd struct packet *
88*04d19802SAdrian Chadd medium_get_next_packet(struct wtap_medium *md)
89*04d19802SAdrian Chadd {
90*04d19802SAdrian Chadd 	struct packet *p;
91*04d19802SAdrian Chadd 
92*04d19802SAdrian Chadd 	mtx_lock(&md->md_mtx);
93*04d19802SAdrian Chadd 	p = STAILQ_FIRST(&md->md_pktbuf);
94*04d19802SAdrian Chadd 	if (p == NULL){
95*04d19802SAdrian Chadd 		mtx_unlock(&md->md_mtx);
96*04d19802SAdrian Chadd 		return NULL;
97*04d19802SAdrian Chadd 	}
98*04d19802SAdrian Chadd 
99*04d19802SAdrian Chadd 	STAILQ_REMOVE_HEAD(&md->md_pktbuf, pf_list);
100*04d19802SAdrian Chadd 	mtx_unlock(&md->md_mtx);
101*04d19802SAdrian Chadd 	return p;
102*04d19802SAdrian Chadd }
103*04d19802SAdrian Chadd 
104*04d19802SAdrian Chadd void
105*04d19802SAdrian Chadd medium_open(struct wtap_medium *md)
106*04d19802SAdrian Chadd {
107*04d19802SAdrian Chadd 
108*04d19802SAdrian Chadd 	mtx_lock(&md->md_mtx);
109*04d19802SAdrian Chadd 	md->open = 1;
110*04d19802SAdrian Chadd 	mtx_unlock(&md->md_mtx);
111*04d19802SAdrian Chadd }
112*04d19802SAdrian Chadd 
113*04d19802SAdrian Chadd void
114*04d19802SAdrian Chadd medium_close(struct wtap_medium *md)
115*04d19802SAdrian Chadd {
116*04d19802SAdrian Chadd 
117*04d19802SAdrian Chadd 	mtx_lock(&md->md_mtx);
118*04d19802SAdrian Chadd 	md->open = 0;
119*04d19802SAdrian Chadd 	mtx_unlock(&md->md_mtx);
120*04d19802SAdrian Chadd }
121