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