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