sys/dev/wtap/wtap_hal/hal.c

   1 /*-
   2  * Copyright (c) 2010-2011 Monthadar Al Jaberi, TerraNet AB
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer,
  10  *    without modification.
  11  * 2. Redistributions in binary form must reproduce at minimum a disclaimer
  12  *    similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
  13  *    redistribution must be conditioned upon including a substantially
  14  *    similar Disclaimer requirement for further binary redistribution.
  15  *
  16  * NO WARRANTY
  17  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  18  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  19  * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
  20  * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
  21  * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
  22  * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  23  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  24  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
  25  * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  26  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
  27  * THE POSSIBILITY OF SUCH DAMAGES.
  28  *
  29  * $FreeBSD$
  30  */
  31 #include "hal.h"
  32 #include "../if_medium.h"
  33 #include "handler.h"
  34
  35 static void
  36 hal_tx_proc(void *arg, int npending)
  37 {
  38         struct wtap_hal *hal = (struct wtap_hal *)arg;
  39         struct packet *p;
  40
  41 #if 0
  42         DWTAP_PRINTF("%s\n", __func__);
  43 #endif
  44
  45         hal = (struct wtap_hal *)arg;
  46         for(;;){
  47                 p = medium_get_next_packet(hal->hal_md);
  48                 if(p == NULL)
  49                 return;
  50
  51                 hal->plugin->work(hal->plugin, p);
  52
  53 #if 0
  54                 DWTAP_PRINTF("[%d] freeing m=%p\n", p->id, p->m);
  55 #endif
  56                 m_free(p->m);
  57                 free(p, M_WTAP_PACKET);
  58         }
  59 }
  60
  61 void
  62 init_hal(struct wtap_hal *hal)
  63 {
  64
  65         DWTAP_PRINTF("%s\n", __func__);
  66         mtx_init(&hal->hal_mtx, "wtap_hal mtx", NULL, MTX_DEF | MTX_RECURSE);
  67
  68         hal->hal_md = (struct wtap_medium *)malloc(sizeof(struct wtap_medium),
  69             M_WTAP, M_NOWAIT | M_ZERO);
  70         bzero(hal->hal_md, sizeof(struct wtap_medium));
  71
  72         init_medium(hal->hal_md);
  73         /* register event handler for packets */
  74         TASK_INIT(&hal->hal_md->tx_handler->proc, 0, hal_tx_proc, hal);
  75 }
  76
  77 void
  78 register_plugin(struct wtap_hal *hal, struct wtap_plugin *plugin)
  79 {
  80
  81         plugin->init(plugin);
  82         hal->plugin = plugin;
  83 }
  84
  85 void
  86 deregister_plugin(struct wtap_hal *hal)
  87 {
  88
  89         hal->plugin->deinit(hal->plugin);
  90         hal->plugin = NULL; /* catch illegal usages */
  91 }
  92
  93 void
  94 deinit_hal(struct wtap_hal *hal)
  95 {
  96
  97         DWTAP_PRINTF("%s\n", __func__);
  98         deinit_medium(hal->hal_md);
  99         free(hal->hal_md, M_WTAP);
 100         mtx_destroy(&hal->hal_mtx);
 101 }
 102
 103 int32_t
 104 new_wtap(struct wtap_hal *hal, int32_t id)
 105 {
 106         static const uint8_t mac_pool[64][IEEE80211_ADDR_LEN] = {
 107             {0,152,154,152,150,151},
 108             {0,152,154,152,150,152},
 109             {0,152,154,152,150,153},
 110             {0,152,154,152,150,154},
 111             {0,152,154,152,150,155},
 112             {0,152,154,152,150,156},
 113             {0,152,154,152,150,157},
 114             {0,152,154,152,150,158},
 115             {0,152,154,152,151,151},
 116             {0,152,154,152,151,152},
 117             {0,152,154,152,151,153},
 118             {0,152,154,152,151,154},
 119             {0,152,154,152,151,155},
 120             {0,152,154,152,151,156},
 121             {0,152,154,152,151,157},
 122             {0,152,154,152,151,158},
 123             {0,152,154,152,152,151},
 124             {0,152,154,152,152,152},
 125             {0,152,154,152,152,153},
 126             {0,152,154,152,152,154},
 127             {0,152,154,152,152,155},
 128             {0,152,154,152,152,156},
 129             {0,152,154,152,152,157},
 130             {0,152,154,152,152,158},
 131             {0,152,154,152,153,151},
 132             {0,152,154,152,153,152},
 133             {0,152,154,152,153,153},
 134             {0,152,154,152,153,154},
 135             {0,152,154,152,153,155},
 136             {0,152,154,152,153,156},
 137             {0,152,154,152,153,157},
 138             {0,152,154,152,153,158},
 139             {0,152,154,152,154,151},
 140             {0,152,154,152,154,152},
 141             {0,152,154,152,154,153},
 142             {0,152,154,152,154,154},
 143             {0,152,154,152,154,155},
 144             {0,152,154,152,154,156},
 145             {0,152,154,152,154,157},
 146             {0,152,154,152,154,158},
 147             {0,152,154,152,155,151},
 148             {0,152,154,152,155,152},
 149             {0,152,154,152,155,153},
 150             {0,152,154,152,155,154},
 151             {0,152,154,152,155,155},
 152             {0,152,154,152,155,156},
 153             {0,152,154,152,155,157},
 154             {0,152,154,152,155,158},
 155             {0,152,154,152,156,151},
 156             {0,152,154,152,156,152},
 157             {0,152,154,152,156,153},
 158             {0,152,154,152,156,154},
 159             {0,152,154,152,156,155},
 160             {0,152,154,152,156,156},
 161             {0,152,154,152,156,157},
 162             {0,152,154,152,156,158},
 163             {0,152,154,152,157,151},
 164             {0,152,154,152,157,152},
 165             {0,152,154,152,157,153},
 166             {0,152,154,152,157,154},
 167             {0,152,154,152,157,155},
 168             {0,152,154,152,157,156},
 169             {0,152,154,152,157,157},
 170             {0,152,154,152,157,158}
 171             };
 172
 173         DWTAP_PRINTF("%s\n", __func__);
 174         uint8_t const *macaddr = mac_pool[id];
 175         if(hal->hal_devs[id] != NULL){
 176                 printf("error, wtap_id=%d already created\n", id);
 177                 return -1;
 178         }
 179
 180         hal->hal_devs[id] = (struct wtap_softc *)malloc(
 181             sizeof(struct wtap_softc), M_WTAP, M_NOWAIT | M_ZERO);
 182         bzero(hal->hal_devs[id], sizeof(struct wtap_softc));
 183         hal->hal_devs[id]->sc_md = hal->hal_md;
 184         hal->hal_devs[id]->id = id;
 185         mtx_init(&hal->hal_devs[id]->sc_mtx, "wtap_softc mtx", NULL,
 186             MTX_DEF | MTX_RECURSE);
 187
 188         if(wtap_attach(hal->hal_devs[id], macaddr)){
 189                 printf("%s, cant alloc new wtap\n", __func__);
 190                 return -1;
 191         }
 192
 193         return 0;
 194 }
 195
 196 int32_t
 197 free_wtap(struct wtap_hal *hal, int32_t id)
 198 {
 199
 200         DWTAP_PRINTF("%s\n", __func__);
 201         if(hal->hal_devs[id] == NULL){
 202                 printf("error, wtap_id=%d never created\n", id);
 203                 return -1;
 204         }
 205
 206         if(wtap_detach(hal->hal_devs[id]))
 207                 printf("%s, cant alloc new wtap\n", __func__);
 208         mtx_destroy(&hal->hal_devs[id]->sc_mtx);
 209         free(hal->hal_devs[id], M_WTAP);
 210         hal->hal_devs[id] = NULL;
 211         return 0;
 212 }
 213