ieee80211_netbsd.c revision 1.31.2.7
1 1.31.2.7 phil /* $NetBSD: ieee80211_netbsd.c,v 1.31.2.7 2018/08/15 17:07:03 phil Exp $ */ 2 1.31.2.2 phil 3 1.31.2.1 phil /*- 4 1.31.2.1 phil * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 5 1.31.2.1 phil * 6 1.31.2.1 phil * Copyright (c) 2003-2009 Sam Leffler, Errno Consulting 7 1.1 dyoung * All rights reserved. 8 1.1 dyoung * 9 1.1 dyoung * Redistribution and use in source and binary forms, with or without 10 1.1 dyoung * modification, are permitted provided that the following conditions 11 1.1 dyoung * are met: 12 1.1 dyoung * 1. Redistributions of source code must retain the above copyright 13 1.1 dyoung * notice, this list of conditions and the following disclaimer. 14 1.1 dyoung * 2. Redistributions in binary form must reproduce the above copyright 15 1.1 dyoung * notice, this list of conditions and the following disclaimer in the 16 1.1 dyoung * documentation and/or other materials provided with the distribution. 17 1.1 dyoung * 18 1.1 dyoung * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 19 1.1 dyoung * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 20 1.1 dyoung * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 21 1.1 dyoung * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 22 1.1 dyoung * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 23 1.1 dyoung * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 24 1.1 dyoung * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 25 1.1 dyoung * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 26 1.1 dyoung * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 27 1.1 dyoung * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 28 1.1 dyoung */ 29 1.1 dyoung 30 1.1 dyoung #include <sys/cdefs.h> 31 1.31.2.2 phil /* __FBSDID("$FreeBSD$"); */ 32 1.31.2.7 phil __KERNEL_RCSID(0, "$NetBSD: ieee80211_netbsd.c,v 1.31.2.7 2018/08/15 17:07:03 phil Exp $"); 33 1.1 dyoung 34 1.1 dyoung /* 35 1.31.2.2 phil * IEEE 802.11 support (NetBSD-specific code) 36 1.1 dyoung */ 37 1.31.2.2 phil 38 1.31.2.1 phil #include "opt_wlan.h" 39 1.31.2.1 phil 40 1.31.2.2 phil #include <sys/atomic.h> 41 1.1 dyoung #include <sys/param.h> 42 1.31.2.1 phil #include <sys/systm.h> 43 1.1 dyoung #include <sys/kernel.h> 44 1.31.2.1 phil #include <sys/malloc.h> 45 1.31.2.1 phil #include <sys/mbuf.h> 46 1.31.2.1 phil #include <sys/module.h> 47 1.1 dyoung #include <sys/proc.h> 48 1.1 dyoung #include <sys/sysctl.h> 49 1.31.2.2 phil #include <sys/syslog.h> 50 1.1 dyoung 51 1.1 dyoung #include <sys/socket.h> 52 1.1 dyoung 53 1.31.2.1 phil #include <net/bpf.h> 54 1.1 dyoung #include <net/if.h> 55 1.31.2.1 phil #include <net/if_dl.h> 56 1.31.2.2 phil #include <net/if_ether.h> 57 1.1 dyoung #include <net/if_media.h> 58 1.31.2.1 phil #include <net/if_types.h> 59 1.1 dyoung #include <net/route.h> 60 1.1 dyoung 61 1.1 dyoung #include <net80211/ieee80211_var.h> 62 1.31.2.1 phil #include <net80211/ieee80211_input.h> 63 1.1 dyoung 64 1.31.2.4 phil static const struct sysctlnode * 65 1.31.2.4 phil ieee80211_sysctl_treetop(struct sysctllog **log); 66 1.31.2.4 phil static void ieee80211_sysctl_setup(void); 67 1.31.2.4 phil 68 1.31.2.4 phil /* NNN in .h file? */ 69 1.31.2.4 phil #define SYSCTL_HANDLER_ARGS SYSCTLFN_ARGS 70 1.26 pooka 71 1.1 dyoung #ifdef IEEE80211_DEBUG 72 1.31.2.1 phil static int ieee80211_debug = 0; 73 1.1 dyoung #endif 74 1.1 dyoung 75 1.31.2.4 phil #ifdef notyet 76 1.31.2.3 phil static struct if_clone *wlan_cloner; 77 1.31.2.3 phil #endif 78 1.31.2.3 phil /* notyet */ 79 1.8 skrll 80 1.31.2.1 phil static const char wlanname[] = "wlan"; 81 1.8 skrll 82 1.31.2.4 phil int 83 1.31.2.4 phil ieee80211_init0(void) 84 1.31.2.4 phil { 85 1.31.2.4 phil ieee80211_sysctl_setup(); 86 1.31.2.4 phil return 0; 87 1.31.2.4 phil } 88 1.31.2.4 phil 89 1.31.2.5 phil /* 90 1.31.2.6 phil * "taskqueue" support for doing FreeBSD style taskqueue operations using 91 1.31.2.6 phil * NetBSD's workqueue to do the actual function calls for the work. 92 1.31.2.6 phil * Many features of the FreeBSD taskqueue are not implemented. This should 93 1.31.2.6 phil * be enough features for the 802.11 stack to run its tasks and time delayed 94 1.31.2.6 phil * tasks. 95 1.31.2.5 phil */ 96 1.31.2.6 phil 97 1.31.2.6 phil void 98 1.31.2.6 phil ieee80211_runwork(struct work *work2do, void *arg) 99 1.31.2.5 phil { 100 1.31.2.5 phil struct task *work_task = (struct task *) work2do; 101 1.31.2.6 phil #ifdef IEEE80211_DEBUG 102 1.31.2.6 phil printf ("runwork: %s (t_arg is 0x%lx)\n", 103 1.31.2.6 phil work_task->t_func_name, (long)work_task->t_arg); 104 1.31.2.6 phil #endif 105 1.31.2.5 phil mutex_enter(&work_task->t_mutex); 106 1.31.2.5 phil work_task->t_onqueue = 0; 107 1.31.2.5 phil mutex_exit(&work_task->t_mutex); 108 1.31.2.5 phil 109 1.31.2.5 phil work_task->t_func(work_task->t_arg, 0); 110 1.31.2.5 phil } 111 1.31.2.5 phil 112 1.31.2.6 phil void 113 1.31.2.6 phil taskqueue_enqueue(struct workqueue *wq, struct task *task_item) 114 1.31.2.5 phil { 115 1.31.2.5 phil mutex_enter(&task_item->t_mutex); 116 1.31.2.5 phil if (!task_item->t_onqueue) { 117 1.31.2.5 phil workqueue_enqueue(wq, &task_item->t_work, NULL); 118 1.31.2.5 phil task_item->t_onqueue = 1; 119 1.31.2.5 phil } 120 1.31.2.5 phil mutex_exit(&task_item->t_mutex); 121 1.31.2.5 phil } 122 1.31.2.5 phil 123 1.31.2.6 phil void 124 1.31.2.6 phil taskqueue_drain(struct workqueue *wq, struct task *task_item) 125 1.31.2.5 phil { 126 1.31.2.5 phil workqueue_wait(wq, &task_item->t_work); 127 1.31.2.5 phil } 128 1.31.2.5 phil 129 1.31.2.6 phil static void 130 1.31.2.6 phil taskqueue_callout_enqueue(void *arg) 131 1.31.2.6 phil { 132 1.31.2.6 phil struct timeout_task *timeout_task = arg; 133 1.31.2.6 phil mutex_enter(&timeout_task->to_task.t_mutex); 134 1.31.2.6 phil timeout_task->to_scheduled = 0; 135 1.31.2.6 phil mutex_exit(&timeout_task->to_task.t_mutex); 136 1.31.2.6 phil 137 1.31.2.6 phil taskqueue_enqueue(timeout_task->to_wq, (struct task*) timeout_task); 138 1.31.2.6 phil } 139 1.31.2.6 phil 140 1.31.2.6 phil int 141 1.31.2.6 phil taskqueue_enqueue_timeout(struct workqueue *queue, 142 1.31.2.6 phil struct timeout_task *timeout_task, int nticks) 143 1.31.2.6 phil { 144 1.31.2.6 phil mutex_enter(&timeout_task->to_task.t_mutex); 145 1.31.2.6 phil if (!timeout_task->to_scheduled) { 146 1.31.2.6 phil callout_reset(&timeout_task->to_callout, nticks, 147 1.31.2.6 phil taskqueue_callout_enqueue, timeout_task); 148 1.31.2.6 phil timeout_task->to_scheduled = 1; 149 1.31.2.6 phil } 150 1.31.2.6 phil mutex_exit(&timeout_task->to_task.t_mutex); 151 1.31.2.6 phil 152 1.31.2.6 phil return -1; 153 1.31.2.6 phil } 154 1.31.2.6 phil 155 1.31.2.6 phil int 156 1.31.2.6 phil taskqueue_cancel_timeout(struct workqueue *queue, 157 1.31.2.6 phil struct timeout_task *timeout_task, u_int *pendp) 158 1.31.2.6 phil { 159 1.31.2.7 phil // printf ("taskqueue_cancel_timeout called\n"); 160 1.31.2.6 phil return -1; 161 1.31.2.6 phil } 162 1.31.2.6 phil 163 1.31.2.6 phil void 164 1.31.2.6 phil taskqueue_drain_timeout(struct workqueue *queue, 165 1.31.2.6 phil struct timeout_task *timeout_task) 166 1.31.2.6 phil { 167 1.31.2.7 phil // printf ("taskqueue_drain_timeout called\n"); 168 1.31.2.6 phil } 169 1.31.2.6 phil 170 1.31.2.5 phil 171 1.31.2.3 phil static __unused int 172 1.31.2.3 phil wlan_clone_create(struct if_clone *ifc, int unit, void * params) 173 1.8 skrll { 174 1.31.2.1 phil struct ieee80211_clone_params cp; 175 1.31.2.1 phil struct ieee80211vap *vap; 176 1.31.2.1 phil struct ieee80211com *ic; 177 1.31.2.1 phil int error; 178 1.8 skrll 179 1.31.2.1 phil error = copyin(params, &cp, sizeof(cp)); 180 1.31.2.1 phil if (error) 181 1.31.2.1 phil return error; 182 1.31.2.1 phil ic = ieee80211_find_com(cp.icp_parent); 183 1.31.2.1 phil if (ic == NULL) 184 1.31.2.1 phil return ENXIO; 185 1.31.2.1 phil if (cp.icp_opmode >= IEEE80211_OPMODE_MAX) { 186 1.31.2.1 phil ic_printf(ic, "%s: invalid opmode %d\n", __func__, 187 1.31.2.1 phil cp.icp_opmode); 188 1.31.2.1 phil return EINVAL; 189 1.31.2.1 phil } 190 1.31.2.1 phil if ((ic->ic_caps & ieee80211_opcap[cp.icp_opmode]) == 0) { 191 1.31.2.1 phil ic_printf(ic, "%s mode not supported\n", 192 1.31.2.1 phil ieee80211_opmode_name[cp.icp_opmode]); 193 1.31.2.1 phil return EOPNOTSUPP; 194 1.31.2.1 phil } 195 1.31.2.1 phil if ((cp.icp_flags & IEEE80211_CLONE_TDMA) && 196 1.31.2.1 phil #ifdef IEEE80211_SUPPORT_TDMA 197 1.31.2.1 phil (ic->ic_caps & IEEE80211_C_TDMA) == 0 198 1.31.2.1 phil #else 199 1.31.2.1 phil (1) 200 1.31.2.1 phil #endif 201 1.31.2.1 phil ) { 202 1.31.2.1 phil ic_printf(ic, "TDMA not supported\n"); 203 1.31.2.1 phil return EOPNOTSUPP; 204 1.31.2.1 phil } 205 1.31.2.1 phil vap = ic->ic_vap_create(ic, wlanname, unit, 206 1.31.2.1 phil cp.icp_opmode, cp.icp_flags, cp.icp_bssid, 207 1.31.2.1 phil cp.icp_flags & IEEE80211_CLONE_MACADDR ? 208 1.31.2.1 phil cp.icp_macaddr : ic->ic_macaddr); 209 1.26 pooka 210 1.31.2.1 phil return (vap == NULL ? EIO : 0); 211 1.31.2.1 phil } 212 1.22 matt 213 1.31.2.3 phil static __unused void 214 1.31.2.1 phil wlan_clone_destroy(struct ifnet *ifp) 215 1.31.2.1 phil { 216 1.31.2.1 phil struct ieee80211vap *vap = ifp->if_softc; 217 1.31.2.1 phil struct ieee80211com *ic = vap->iv_ic; 218 1.12 yamt 219 1.31.2.1 phil ic->ic_vap_delete(vap); 220 1.8 skrll } 221 1.8 skrll 222 1.10 thorpej void 223 1.31.2.1 phil ieee80211_vap_destroy(struct ieee80211vap *vap) 224 1.10 thorpej { 225 1.31.2.2 phil #ifdef notyet 226 1.31.2.1 phil CURVNET_SET(vap->iv_ifp->if_vnet); 227 1.31.2.1 phil if_clone_destroyif(wlan_cloner, vap->iv_ifp); 228 1.31.2.1 phil CURVNET_RESTORE(); 229 1.31.2.2 phil #else 230 1.31.2.3 phil printf ("vap_destroy called ... what next?\n"); 231 1.31.2.2 phil #endif 232 1.10 thorpej } 233 1.10 thorpej 234 1.31.2.2 phil #ifdef notyet 235 1.31.2.1 phil int 236 1.31.2.1 phil ieee80211_sysctl_msecs_ticks(SYSCTL_HANDLER_ARGS) 237 1.1 dyoung { 238 1.31.2.1 phil int msecs = ticks_to_msecs(*(int *)arg1); 239 1.2 dyoung int error, t; 240 1.30 maxv 241 1.31.2.1 phil error = sysctl_handle_int(oidp, &msecs, 0, req); 242 1.31.2.1 phil if (error || !req->newptr) 243 1.30 maxv return error; 244 1.31.2.1 phil t = msecs_to_ticks(msecs); 245 1.31.2.1 phil *(int *)arg1 = (t < 1) ? 1 : t; 246 1.30 maxv return 0; 247 1.1 dyoung } 248 1.1 dyoung 249 1.1 dyoung static int 250 1.31.2.1 phil ieee80211_sysctl_inact(SYSCTL_HANDLER_ARGS) 251 1.1 dyoung { 252 1.31.2.1 phil int inact = (*(int *)arg1) * IEEE80211_INACT_WAIT; 253 1.31.2.1 phil int error; 254 1.2 dyoung 255 1.31.2.1 phil error = sysctl_handle_int(oidp, &inact, 0, req); 256 1.31.2.1 phil if (error || !req->newptr) 257 1.31.2.1 phil return error; 258 1.31.2.1 phil *(int *)arg1 = inact / IEEE80211_INACT_WAIT; 259 1.31.2.1 phil return 0; 260 1.2 dyoung } 261 1.31.2.4 phil #endif 262 1.2 dyoung 263 1.31.2.1 phil static int 264 1.31.2.4 phil ieee80211_sysctl_parent(SYSCTLFN_ARGS) 265 1.2 dyoung { 266 1.31.2.4 phil struct ieee80211vap *vap; 267 1.31.2.4 phil char pname[IFNAMSIZ]; 268 1.31.2.4 phil struct sysctlnode node; 269 1.2 dyoung 270 1.31.2.4 phil node = *rnode; 271 1.31.2.4 phil vap = node.sysctl_data; 272 1.31.2.4 phil strlcpy(pname, vap->iv_ifp->if_xname, IFNAMSIZ); 273 1.31.2.4 phil node.sysctl_data = pname; 274 1.31.2.4 phil return sysctl_lookup(SYSCTLFN_CALL(&node)); 275 1.1 dyoung } 276 1.1 dyoung 277 1.31.2.4 phil #ifdef notyet 278 1.31.2.1 phil static int 279 1.31.2.1 phil ieee80211_sysctl_radar(SYSCTL_HANDLER_ARGS) 280 1.1 dyoung { 281 1.31.2.1 phil struct ieee80211com *ic = arg1; 282 1.31.2.1 phil int t = 0, error; 283 1.1 dyoung 284 1.31.2.1 phil error = sysctl_handle_int(oidp, &t, 0, req); 285 1.31.2.1 phil if (error || !req->newptr) 286 1.31.2.1 phil return error; 287 1.31.2.1 phil IEEE80211_LOCK(ic); 288 1.31.2.1 phil ieee80211_dfs_notify_radar(ic, ic->ic_curchan); 289 1.31.2.1 phil IEEE80211_UNLOCK(ic); 290 1.31.2.1 phil return 0; 291 1.2 dyoung } 292 1.2 dyoung 293 1.2 dyoung /* 294 1.31.2.1 phil * For now, just restart everything. 295 1.2 dyoung * 296 1.31.2.1 phil * Later on, it'd be nice to have a separate VAP restart to 297 1.31.2.1 phil * full-device restart. 298 1.30 maxv */ 299 1.31.2.1 phil static int 300 1.31.2.1 phil ieee80211_sysctl_vap_restart(SYSCTL_HANDLER_ARGS) 301 1.2 dyoung { 302 1.31.2.1 phil struct ieee80211vap *vap = arg1; 303 1.31.2.1 phil int t = 0, error; 304 1.1 dyoung 305 1.31.2.1 phil error = sysctl_handle_int(oidp, &t, 0, req); 306 1.31.2.1 phil if (error || !req->newptr) 307 1.31.2.1 phil return error; 308 1.2 dyoung 309 1.31.2.1 phil ieee80211_restart_all(vap->iv_ic); 310 1.31.2.1 phil return 0; 311 1.2 dyoung } 312 1.31.2.2 phil #endif /* notyet */ 313 1.2 dyoung 314 1.31.2.1 phil void 315 1.31.2.1 phil ieee80211_sysctl_attach(struct ieee80211com *ic) 316 1.31.2.1 phil { 317 1.2 dyoung } 318 1.2 dyoung 319 1.31.2.1 phil void 320 1.31.2.1 phil ieee80211_sysctl_detach(struct ieee80211com *ic) 321 1.2 dyoung { 322 1.2 dyoung } 323 1.2 dyoung 324 1.31.2.4 phil /* 325 1.31.2.4 phil * Setup sysctl(3) MIB, net.ieee80211.* 326 1.31.2.4 phil * 327 1.31.2.4 phil * TBD condition CTLFLAG_PERMANENT on being a module or not 328 1.31.2.4 phil */ 329 1.31.2.4 phil static struct sysctllog *ieee80211_sysctllog; 330 1.31.2.4 phil static void 331 1.31.2.4 phil ieee80211_sysctl_setup(void) 332 1.31.2.4 phil { 333 1.31.2.4 phil int rc; 334 1.31.2.4 phil const struct sysctlnode *rnode; 335 1.31.2.4 phil 336 1.31.2.4 phil if ((rnode = ieee80211_sysctl_treetop(&ieee80211_sysctllog)) == NULL) 337 1.31.2.4 phil return; 338 1.31.2.4 phil 339 1.31.2.4 phil #ifdef notyet 340 1.31.2.4 phil if ((rc = sysctl_createv(&ieee80211_sysctllog, 0, &rnode, NULL, 341 1.31.2.4 phil CTLFLAG_PERMANENT, CTLTYPE_NODE, "nodes", "client/peer stations", 342 1.31.2.4 phil ieee80211_sysctl_node, 0, NULL, 0, CTL_CREATE, CTL_EOL)) != 0) 343 1.31.2.4 phil goto err; 344 1.31.2.4 phil #endif 345 1.31.2.4 phil 346 1.31.2.4 phil #ifdef IEEE80211_DEBUG 347 1.31.2.4 phil /* control debugging printfs */ 348 1.31.2.4 phil if ((rc = sysctl_createv(&ieee80211_sysctllog, 0, &rnode, NULL, 349 1.31.2.4 phil CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT, 350 1.31.2.4 phil "debug", SYSCTL_DESCR("control debugging printfs"), 351 1.31.2.4 phil NULL, 0, &ieee80211_debug, 0, CTL_CREATE, CTL_EOL)) != 0) 352 1.31.2.4 phil goto err; 353 1.31.2.4 phil #endif 354 1.31.2.4 phil 355 1.31.2.4 phil #ifdef notyet 356 1.31.2.4 phil ieee80211_rssadapt_sysctl_setup(&ieee80211_sysctllog); 357 1.31.2.4 phil #endif 358 1.31.2.4 phil 359 1.31.2.4 phil return; 360 1.31.2.4 phil err: 361 1.31.2.4 phil printf("%s: sysctl_createv failed (rc = %d)\n", __func__, rc); 362 1.31.2.4 phil } 363 1.31.2.4 phil 364 1.31.2.4 phil /* 365 1.31.2.4 phil * Create or get top of sysctl tree net.link.ieee80211. 366 1.31.2.4 phil */ 367 1.31.2.4 phil static const struct sysctlnode * 368 1.31.2.4 phil ieee80211_sysctl_treetop(struct sysctllog **log) 369 1.31.2.4 phil { 370 1.31.2.4 phil int rc; 371 1.31.2.4 phil const struct sysctlnode *rnode; 372 1.31.2.4 phil 373 1.31.2.4 phil if ((rc = sysctl_createv(log, 0, NULL, &rnode, 374 1.31.2.4 phil CTLFLAG_PERMANENT, CTLTYPE_NODE, "link", 375 1.31.2.4 phil "link-layer statistics and controls", 376 1.31.2.4 phil NULL, 0, NULL, 0, CTL_NET, PF_LINK, CTL_EOL)) != 0) 377 1.31.2.4 phil goto err; 378 1.31.2.4 phil 379 1.31.2.4 phil if ((rc = sysctl_createv(log, 0, &rnode, &rnode, 380 1.31.2.4 phil CTLFLAG_PERMANENT, CTLTYPE_NODE, "ieee80211", 381 1.31.2.4 phil "IEEE 802.11 WLAN statistics and controls", 382 1.31.2.4 phil NULL, 0, NULL, 0, CTL_CREATE, CTL_EOL)) != 0) 383 1.31.2.4 phil goto err; 384 1.31.2.4 phil 385 1.31.2.4 phil return rnode; 386 1.31.2.4 phil err: 387 1.31.2.4 phil printf("%s: sysctl_createv failed, rc = %d\n", __func__, rc); 388 1.31.2.4 phil return NULL; 389 1.31.2.4 phil } 390 1.31.2.4 phil 391 1.31.2.1 phil void 392 1.31.2.1 phil ieee80211_sysctl_vattach(struct ieee80211vap *vap) 393 1.2 dyoung { 394 1.31.2.4 phil int rc; 395 1.31.2.4 phil const struct sysctlnode *cnode, *rnode; 396 1.31.2.4 phil char num[sizeof("vap") + 14]; /* sufficient for 32 bits */ 397 1.31.2.4 phil 398 1.31.2.4 phil if ((rnode = ieee80211_sysctl_treetop(NULL)) == NULL) 399 1.31.2.4 phil return; 400 1.31.2.4 phil 401 1.31.2.4 phil snprintf(num, sizeof(num), "vap%u", vap->iv_ifp->if_index); 402 1.31.2.4 phil 403 1.31.2.4 phil if ((rc = sysctl_createv(&vap->iv_sysctllog, 0, &rnode, &rnode, 404 1.31.2.4 phil CTLFLAG_PERMANENT, CTLTYPE_NODE, num, SYSCTL_DESCR("virtual AP"), 405 1.31.2.4 phil NULL, 0, NULL, 0, CTL_CREATE, CTL_EOL)) != 0) 406 1.31.2.4 phil goto err; 407 1.31.2.4 phil 408 1.31.2.4 phil /* control debugging printfs */ 409 1.31.2.4 phil if ((rc = sysctl_createv(&vap->iv_sysctllog, 0, &rnode, &cnode, 410 1.31.2.4 phil CTLFLAG_PERMANENT|CTLFLAG_READONLY, CTLTYPE_STRING, 411 1.31.2.4 phil "parent", SYSCTL_DESCR("parent device"), 412 1.31.2.4 phil ieee80211_sysctl_parent, 0, (void *)vap, IFNAMSIZ, 413 1.31.2.4 phil CTL_CREATE, CTL_EOL)) != 0) 414 1.31.2.4 phil goto err; 415 1.31.2.4 phil 416 1.31.2.4 phil 417 1.31.2.2 phil #ifdef notyet 418 1.31.2.1 phil struct ifnet *ifp = vap->iv_ifp; 419 1.31.2.1 phil struct sysctl_ctx_list *ctx; 420 1.31.2.1 phil struct sysctl_oid *oid; 421 1.31.2.1 phil char num[14]; /* sufficient for 32 bits */ 422 1.31.2.1 phil 423 1.31.2.1 phil ctx = (struct sysctl_ctx_list *) IEEE80211_MALLOC(sizeof(struct sysctl_ctx_list), 424 1.31.2.1 phil M_DEVBUF, IEEE80211_M_NOWAIT | IEEE80211_M_ZERO); 425 1.31.2.1 phil if (ctx == NULL) { 426 1.31.2.1 phil if_printf(ifp, "%s: cannot allocate sysctl context!\n", 427 1.31.2.1 phil __func__); 428 1.2 dyoung return; 429 1.31.2.1 phil } 430 1.31.2.1 phil sysctl_ctx_init(ctx); 431 1.31.2.1 phil snprintf(num, sizeof(num), "%u", ifp->if_dunit); 432 1.31.2.1 phil oid = SYSCTL_ADD_NODE(ctx, &SYSCTL_NODE_CHILDREN(_net, wlan), 433 1.31.2.1 phil OID_AUTO, num, CTLFLAG_RD, NULL, ""); 434 1.31.2.1 phil SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 435 1.31.2.1 phil "%parent", CTLTYPE_STRING | CTLFLAG_RD, vap->iv_ic, 0, 436 1.31.2.1 phil ieee80211_sysctl_parent, "A", "parent device"); 437 1.31.2.1 phil SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 438 1.31.2.1 phil "driver_caps", CTLFLAG_RW, &vap->iv_caps, 0, 439 1.31.2.1 phil "driver capabilities"); 440 1.2 dyoung #ifdef IEEE80211_DEBUG 441 1.31.2.1 phil vap->iv_debug = ieee80211_debug; 442 1.31.2.1 phil SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 443 1.31.2.1 phil "debug", CTLFLAG_RW, &vap->iv_debug, 0, 444 1.31.2.1 phil "control debugging printfs"); 445 1.30 maxv #endif 446 1.31.2.1 phil SYSCTL_ADD_INT(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 447 1.31.2.1 phil "bmiss_max", CTLFLAG_RW, &vap->iv_bmiss_max, 0, 448 1.31.2.1 phil "consecutive beacon misses before scanning"); 449 1.31.2.1 phil /* XXX inherit from tunables */ 450 1.31.2.1 phil SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 451 1.31.2.1 phil "inact_run", CTLTYPE_INT | CTLFLAG_RW, &vap->iv_inact_run, 0, 452 1.31.2.1 phil ieee80211_sysctl_inact, "I", 453 1.31.2.1 phil "station inactivity timeout (sec)"); 454 1.31.2.1 phil SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 455 1.31.2.1 phil "inact_probe", CTLTYPE_INT | CTLFLAG_RW, &vap->iv_inact_probe, 0, 456 1.31.2.1 phil ieee80211_sysctl_inact, "I", 457 1.31.2.1 phil "station inactivity probe timeout (sec)"); 458 1.31.2.1 phil SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 459 1.31.2.1 phil "inact_auth", CTLTYPE_INT | CTLFLAG_RW, &vap->iv_inact_auth, 0, 460 1.31.2.1 phil ieee80211_sysctl_inact, "I", 461 1.31.2.1 phil "station authentication timeout (sec)"); 462 1.31.2.1 phil SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 463 1.31.2.1 phil "inact_init", CTLTYPE_INT | CTLFLAG_RW, &vap->iv_inact_init, 0, 464 1.31.2.1 phil ieee80211_sysctl_inact, "I", 465 1.31.2.1 phil "station initial state timeout (sec)"); 466 1.31.2.1 phil if (vap->iv_htcaps & IEEE80211_HTC_HT) { 467 1.31.2.1 phil SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 468 1.31.2.1 phil "ampdu_mintraffic_bk", CTLFLAG_RW, 469 1.31.2.1 phil &vap->iv_ampdu_mintraffic[WME_AC_BK], 0, 470 1.31.2.1 phil "BK traffic tx aggr threshold (pps)"); 471 1.31.2.1 phil SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 472 1.31.2.1 phil "ampdu_mintraffic_be", CTLFLAG_RW, 473 1.31.2.1 phil &vap->iv_ampdu_mintraffic[WME_AC_BE], 0, 474 1.31.2.1 phil "BE traffic tx aggr threshold (pps)"); 475 1.31.2.1 phil SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 476 1.31.2.1 phil "ampdu_mintraffic_vo", CTLFLAG_RW, 477 1.31.2.1 phil &vap->iv_ampdu_mintraffic[WME_AC_VO], 0, 478 1.31.2.1 phil "VO traffic tx aggr threshold (pps)"); 479 1.31.2.1 phil SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 480 1.31.2.1 phil "ampdu_mintraffic_vi", CTLFLAG_RW, 481 1.31.2.1 phil &vap->iv_ampdu_mintraffic[WME_AC_VI], 0, 482 1.31.2.1 phil "VI traffic tx aggr threshold (pps)"); 483 1.31.2.1 phil } 484 1.31.2.1 phil 485 1.31.2.1 phil SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 486 1.31.2.1 phil "force_restart", CTLTYPE_INT | CTLFLAG_RW, vap, 0, 487 1.31.2.1 phil ieee80211_sysctl_vap_restart, "I", 488 1.31.2.1 phil "force a VAP restart"); 489 1.31.2.1 phil 490 1.31.2.1 phil if (vap->iv_caps & IEEE80211_C_DFS) { 491 1.31.2.1 phil SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 492 1.31.2.1 phil "radar", CTLTYPE_INT | CTLFLAG_RW, vap->iv_ic, 0, 493 1.31.2.1 phil ieee80211_sysctl_radar, "I", "simulate radar event"); 494 1.31.2.1 phil } 495 1.31.2.1 phil vap->iv_sysctl = ctx; 496 1.31.2.1 phil vap->iv_oid = oid; 497 1.31.2.2 phil #endif 498 1.31.2.4 phil return; 499 1.31.2.4 phil err: 500 1.31.2.4 phil printf("%s: sysctl_createv failed, rc = %d\n", __func__, rc); 501 1.31.2.1 phil } 502 1.2 dyoung 503 1.31.2.1 phil void 504 1.31.2.1 phil ieee80211_sysctl_vdetach(struct ieee80211vap *vap) 505 1.31.2.1 phil { 506 1.31.2.2 phil #ifdef notyet 507 1.31.2.1 phil if (vap->iv_sysctl != NULL) { 508 1.31.2.1 phil sysctl_ctx_free(vap->iv_sysctl); 509 1.31.2.1 phil IEEE80211_FREE(vap->iv_sysctl, M_DEVBUF); 510 1.31.2.1 phil vap->iv_sysctl = NULL; 511 1.31.2.1 phil } 512 1.31.2.2 phil #endif 513 1.1 dyoung } 514 1.1 dyoung 515 1.31.2.2 phil 516 1.1 dyoung int 517 1.1 dyoung ieee80211_node_dectestref(struct ieee80211_node *ni) 518 1.1 dyoung { 519 1.31.2.1 phil /* XXX need equivalent of atomic_dec_and_test */ 520 1.31.2.1 phil atomic_subtract_int(&ni->ni_refcnt, 1); 521 1.31.2.2 phil return atomic_cas_uint(&ni->ni_refcnt, 0, 1) == 0; 522 1.2 dyoung } 523 1.2 dyoung 524 1.2 dyoung void 525 1.15 degroote ieee80211_drain_ifq(struct ifqueue *ifq) 526 1.15 degroote { 527 1.15 degroote struct ieee80211_node *ni; 528 1.15 degroote struct mbuf *m; 529 1.15 degroote 530 1.15 degroote for (;;) { 531 1.15 degroote IF_DEQUEUE(ifq, m); 532 1.15 degroote if (m == NULL) 533 1.15 degroote break; 534 1.15 degroote 535 1.31.2.2 phil ni = (struct ieee80211_node *)m_get_rcvif_NOMPSAFE(m); 536 1.31.2.2 phil FBSDKASSERT(ni != NULL, ("frame w/o node")); 537 1.15 degroote ieee80211_free_node(ni); 538 1.31.2.2 phil ieee80211_free_mbuf(m); 539 1.15 degroote } 540 1.15 degroote } 541 1.15 degroote 542 1.15 degroote void 543 1.31.2.1 phil ieee80211_flush_ifq(struct ifqueue *ifq, struct ieee80211vap *vap) 544 1.2 dyoung { 545 1.31.2.1 phil struct ieee80211_node *ni; 546 1.31.2.1 phil struct mbuf *m, **mprev; 547 1.2 dyoung 548 1.31.2.2 phil IFQ_LOCK(ifq); 549 1.31.2.1 phil mprev = &ifq->ifq_head; 550 1.31.2.1 phil while ((m = *mprev) != NULL) { 551 1.31.2.2 phil ni = (struct ieee80211_node *)m_get_rcvif_NOMPSAFE(m); 552 1.31.2.1 phil if (ni != NULL && ni->ni_vap == vap) { 553 1.31.2.1 phil *mprev = m->m_nextpkt; /* remove from list */ 554 1.31.2.1 phil ifq->ifq_len--; 555 1.2 dyoung 556 1.31.2.1 phil ieee80211_free_node(ni); /* reclaim ref */ 557 1.31.2.2 phil ieee80211_free_mbuf(m); 558 1.31.2.1 phil } else 559 1.31.2.1 phil mprev = &m->m_nextpkt; 560 1.31.2.1 phil } 561 1.31.2.1 phil /* recalculate tail ptr */ 562 1.31.2.1 phil m = ifq->ifq_head; 563 1.31.2.1 phil for (; m != NULL && m->m_nextpkt != NULL; m = m->m_nextpkt) 564 1.31.2.1 phil ; 565 1.31.2.1 phil ifq->ifq_tail = m; 566 1.31.2.2 phil IFQ_UNLOCK(ifq); 567 1.2 dyoung } 568 1.2 dyoung 569 1.1 dyoung /* 570 1.31.2.1 phil * As above, for mbufs allocated with m_gethdr/MGETHDR 571 1.31.2.1 phil * or initialized by M_COPY_PKTHDR. 572 1.31.2.1 phil */ 573 1.31.2.1 phil #define MC_ALIGN(m, len) \ 574 1.31.2.1 phil do { \ 575 1.31.2.1 phil (m)->m_data += rounddown2(MCLBYTES - (len), sizeof(long)); \ 576 1.31.2.1 phil } while (/* CONSTCOND */ 0) 577 1.31.2.1 phil 578 1.31.2.1 phil /* 579 1.1 dyoung * Allocate and setup a management frame of the specified 580 1.1 dyoung * size. We return the mbuf and a pointer to the start 581 1.1 dyoung * of the contiguous data area that's been reserved based 582 1.1 dyoung * on the packet length. The data area is forced to 32-bit 583 1.1 dyoung * alignment and the buffer length to a multiple of 4 bytes. 584 1.1 dyoung * This is done mainly so beacon frames (that require this) 585 1.1 dyoung * can use this interface too. 586 1.1 dyoung */ 587 1.1 dyoung struct mbuf * 588 1.31.2.1 phil ieee80211_getmgtframe(uint8_t **frm, int headroom, int pktlen) 589 1.1 dyoung { 590 1.1 dyoung struct mbuf *m; 591 1.1 dyoung u_int len; 592 1.1 dyoung 593 1.1 dyoung /* 594 1.1 dyoung * NB: we know the mbuf routines will align the data area 595 1.1 dyoung * so we don't need to do anything special. 596 1.1 dyoung */ 597 1.31.2.1 phil len = roundup2(headroom + pktlen, 4); 598 1.31.2.2 phil FBSDKASSERT(len <= MCLBYTES, ("802.11 mgt frame too large: %u", len)); 599 1.31.2.1 phil if (len < MINCLSIZE) { 600 1.31.2.1 phil m = m_gethdr(M_NOWAIT, MT_DATA); 601 1.1 dyoung /* 602 1.1 dyoung * Align the data in case additional headers are added. 603 1.1 dyoung * This should only happen when a WEP header is added 604 1.1 dyoung * which only happens for shared key authentication mgt 605 1.1 dyoung * frames which all fit in MHLEN. 606 1.1 dyoung */ 607 1.1 dyoung if (m != NULL) 608 1.31.2.5 phil MH_ALIGN(m, len); 609 1.30 maxv } else { 610 1.31.2.1 phil m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 611 1.31.2.1 phil if (m != NULL) 612 1.31.2.1 phil MC_ALIGN(m, len); 613 1.30 maxv } 614 1.1 dyoung if (m != NULL) { 615 1.31.2.1 phil m->m_data += headroom; 616 1.1 dyoung *frm = m->m_data; 617 1.1 dyoung } 618 1.1 dyoung return m; 619 1.1 dyoung } 620 1.1 dyoung 621 1.31.2.1 phil #ifndef __NO_STRICT_ALIGNMENT 622 1.31.2.1 phil /* 623 1.31.2.1 phil * Re-align the payload in the mbuf. This is mainly used (right now) 624 1.31.2.1 phil * to handle IP header alignment requirements on certain architectures. 625 1.31.2.1 phil */ 626 1.31.2.1 phil struct mbuf * 627 1.31.2.1 phil ieee80211_realign(struct ieee80211vap *vap, struct mbuf *m, size_t align) 628 1.31.2.1 phil { 629 1.31.2.1 phil int pktlen, space; 630 1.31.2.1 phil struct mbuf *n; 631 1.31.2.1 phil 632 1.31.2.1 phil pktlen = m->m_pkthdr.len; 633 1.31.2.1 phil space = pktlen + align; 634 1.31.2.1 phil if (space < MINCLSIZE) 635 1.31.2.1 phil n = m_gethdr(M_NOWAIT, MT_DATA); 636 1.31.2.1 phil else { 637 1.31.2.1 phil n = m_getjcl(M_NOWAIT, MT_DATA, M_PKTHDR, 638 1.31.2.1 phil space <= MCLBYTES ? MCLBYTES : 639 1.31.2.1 phil #if MJUMPAGESIZE != MCLBYTES 640 1.31.2.1 phil space <= MJUMPAGESIZE ? MJUMPAGESIZE : 641 1.31.2.1 phil #endif 642 1.31.2.1 phil space <= MJUM9BYTES ? MJUM9BYTES : MJUM16BYTES); 643 1.31.2.1 phil } 644 1.31.2.1 phil if (__predict_true(n != NULL)) { 645 1.31.2.1 phil m_move_pkthdr(n, m); 646 1.31.2.1 phil n->m_data = (caddr_t)(ALIGN(n->m_data + align) - align); 647 1.31.2.1 phil m_copydata(m, 0, pktlen, mtod(n, caddr_t)); 648 1.31.2.1 phil n->m_len = pktlen; 649 1.31.2.1 phil } else { 650 1.31.2.1 phil IEEE80211_DISCARD(vap, IEEE80211_MSG_ANY, 651 1.31.2.1 phil mtod(m, const struct ieee80211_frame *), NULL, 652 1.31.2.1 phil "%s", "no mbuf to realign"); 653 1.31.2.1 phil vap->iv_stats.is_rx_badalign++; 654 1.31.2.1 phil } 655 1.31.2.1 phil m_freem(m); 656 1.31.2.1 phil return n; 657 1.31.2.1 phil } 658 1.31.2.1 phil #endif /* !__NO_STRICT_ALIGNMENT */ 659 1.31.2.1 phil 660 1.31.2.1 phil int 661 1.31.2.1 phil ieee80211_add_callback(struct mbuf *m, 662 1.31.2.1 phil void (*func)(struct ieee80211_node *, void *, int), void *arg) 663 1.31.2.1 phil { 664 1.31.2.1 phil struct m_tag *mtag; 665 1.31.2.1 phil struct ieee80211_cb *cb; 666 1.31.2.1 phil 667 1.31.2.2 phil mtag = m_tag_get(/*MTAG_ABI_NET80211*/ NET80211_TAG_CALLBACK, 668 1.31.2.1 phil sizeof(struct ieee80211_cb), M_NOWAIT); 669 1.31.2.1 phil if (mtag == NULL) 670 1.31.2.1 phil return 0; 671 1.31.2.1 phil 672 1.31.2.1 phil cb = (struct ieee80211_cb *)(mtag+1); 673 1.31.2.1 phil cb->func = func; 674 1.31.2.1 phil cb->arg = arg; 675 1.31.2.1 phil m_tag_prepend(m, mtag); 676 1.31.2.1 phil m->m_flags |= M_TXCB; 677 1.31.2.1 phil return 1; 678 1.31.2.1 phil } 679 1.31.2.1 phil 680 1.31.2.1 phil int 681 1.31.2.1 phil ieee80211_add_xmit_params(struct mbuf *m, 682 1.31.2.1 phil const struct ieee80211_bpf_params *params) 683 1.31.2.1 phil { 684 1.31.2.1 phil struct m_tag *mtag; 685 1.31.2.1 phil struct ieee80211_tx_params *tx; 686 1.31.2.1 phil 687 1.31.2.2 phil mtag = m_tag_get(/*MTAG_ABI_NET80211*/ NET80211_TAG_XMIT_PARAMS, 688 1.31.2.1 phil sizeof(struct ieee80211_tx_params), M_NOWAIT); 689 1.31.2.1 phil if (mtag == NULL) 690 1.31.2.1 phil return (0); 691 1.31.2.1 phil 692 1.31.2.1 phil tx = (struct ieee80211_tx_params *)(mtag+1); 693 1.31.2.1 phil memcpy(&tx->params, params, sizeof(struct ieee80211_bpf_params)); 694 1.31.2.1 phil m_tag_prepend(m, mtag); 695 1.31.2.1 phil return (1); 696 1.31.2.1 phil } 697 1.31.2.1 phil 698 1.31.2.1 phil int 699 1.31.2.1 phil ieee80211_get_xmit_params(struct mbuf *m, 700 1.31.2.1 phil struct ieee80211_bpf_params *params) 701 1.31.2.1 phil { 702 1.31.2.1 phil struct m_tag *mtag; 703 1.31.2.1 phil struct ieee80211_tx_params *tx; 704 1.31.2.1 phil 705 1.31.2.2 phil mtag = m_tag_find(m, /*MTAG_ABI_NET80211,*/ NET80211_TAG_XMIT_PARAMS, 706 1.31.2.1 phil NULL); 707 1.31.2.1 phil if (mtag == NULL) 708 1.31.2.1 phil return (-1); 709 1.31.2.1 phil tx = (struct ieee80211_tx_params *)(mtag + 1); 710 1.31.2.1 phil memcpy(params, &tx->params, sizeof(struct ieee80211_bpf_params)); 711 1.31.2.1 phil return (0); 712 1.31.2.1 phil } 713 1.31.2.1 phil 714 1.1 dyoung void 715 1.31.2.1 phil ieee80211_process_callback(struct ieee80211_node *ni, 716 1.31.2.1 phil struct mbuf *m, int status) 717 1.31.2.1 phil { 718 1.31.2.1 phil struct m_tag *mtag; 719 1.31.2.1 phil 720 1.31.2.2 phil mtag = m_tag_find(m, /*MTAG_ABI_NET80211,*/ NET80211_TAG_CALLBACK, NULL); 721 1.31.2.1 phil if (mtag != NULL) { 722 1.31.2.1 phil struct ieee80211_cb *cb = (struct ieee80211_cb *)(mtag+1); 723 1.31.2.1 phil cb->func(ni, cb->arg, status); 724 1.31.2.1 phil } 725 1.31.2.1 phil } 726 1.31.2.1 phil 727 1.31.2.1 phil /* 728 1.31.2.1 phil * Add RX parameters to the given mbuf. 729 1.31.2.1 phil * 730 1.31.2.1 phil * Returns 1 if OK, 0 on error. 731 1.31.2.1 phil */ 732 1.31.2.1 phil int 733 1.31.2.1 phil ieee80211_add_rx_params(struct mbuf *m, const struct ieee80211_rx_stats *rxs) 734 1.31.2.1 phil { 735 1.31.2.1 phil struct m_tag *mtag; 736 1.31.2.1 phil struct ieee80211_rx_params *rx; 737 1.31.2.1 phil 738 1.31.2.2 phil mtag = m_tag_get(/*MTAG_ABI_NET80211,*/ NET80211_TAG_RECV_PARAMS, 739 1.31.2.1 phil sizeof(struct ieee80211_rx_stats), M_NOWAIT); 740 1.31.2.1 phil if (mtag == NULL) 741 1.31.2.1 phil return (0); 742 1.31.2.1 phil 743 1.31.2.1 phil rx = (struct ieee80211_rx_params *)(mtag + 1); 744 1.31.2.1 phil memcpy(&rx->params, rxs, sizeof(*rxs)); 745 1.31.2.1 phil m_tag_prepend(m, mtag); 746 1.31.2.1 phil return (1); 747 1.31.2.1 phil } 748 1.31.2.1 phil 749 1.31.2.1 phil int 750 1.31.2.1 phil ieee80211_get_rx_params(struct mbuf *m, struct ieee80211_rx_stats *rxs) 751 1.31.2.1 phil { 752 1.31.2.1 phil struct m_tag *mtag; 753 1.31.2.1 phil struct ieee80211_rx_params *rx; 754 1.31.2.1 phil 755 1.31.2.2 phil mtag = m_tag_find(m, /*MTAG_ABI_NET80211,*/ NET80211_TAG_RECV_PARAMS, 756 1.31.2.1 phil NULL); 757 1.31.2.1 phil if (mtag == NULL) 758 1.31.2.1 phil return (-1); 759 1.31.2.1 phil rx = (struct ieee80211_rx_params *)(mtag + 1); 760 1.31.2.1 phil memcpy(rxs, &rx->params, sizeof(*rxs)); 761 1.31.2.1 phil return (0); 762 1.31.2.1 phil } 763 1.31.2.1 phil 764 1.31.2.1 phil const struct ieee80211_rx_stats * 765 1.31.2.1 phil ieee80211_get_rx_params_ptr(struct mbuf *m) 766 1.31.2.1 phil { 767 1.31.2.1 phil struct m_tag *mtag; 768 1.31.2.1 phil struct ieee80211_rx_params *rx; 769 1.31.2.1 phil 770 1.31.2.2 phil mtag = m_tag_find(m, /*MTAG_ABI_NET80211,*/ NET80211_TAG_RECV_PARAMS, 771 1.31.2.1 phil NULL); 772 1.31.2.1 phil if (mtag == NULL) 773 1.31.2.1 phil return (NULL); 774 1.31.2.1 phil rx = (struct ieee80211_rx_params *)(mtag + 1); 775 1.31.2.1 phil return (&rx->params); 776 1.31.2.1 phil } 777 1.31.2.1 phil 778 1.31.2.1 phil 779 1.31.2.1 phil /* 780 1.31.2.1 phil * Add TOA parameters to the given mbuf. 781 1.31.2.1 phil */ 782 1.31.2.1 phil int 783 1.31.2.1 phil ieee80211_add_toa_params(struct mbuf *m, const struct ieee80211_toa_params *p) 784 1.31.2.1 phil { 785 1.31.2.1 phil struct m_tag *mtag; 786 1.31.2.1 phil struct ieee80211_toa_params *rp; 787 1.31.2.1 phil 788 1.31.2.2 phil mtag = m_tag_get(/*MTAG_ABI_NET80211,*/ NET80211_TAG_TOA_PARAMS, 789 1.31.2.1 phil sizeof(struct ieee80211_toa_params), M_NOWAIT); 790 1.31.2.1 phil if (mtag == NULL) 791 1.31.2.1 phil return (0); 792 1.31.2.1 phil 793 1.31.2.1 phil rp = (struct ieee80211_toa_params *)(mtag + 1); 794 1.31.2.1 phil memcpy(rp, p, sizeof(*rp)); 795 1.31.2.1 phil m_tag_prepend(m, mtag); 796 1.31.2.1 phil return (1); 797 1.31.2.1 phil } 798 1.31.2.1 phil 799 1.31.2.1 phil int 800 1.31.2.1 phil ieee80211_get_toa_params(struct mbuf *m, struct ieee80211_toa_params *p) 801 1.31.2.1 phil { 802 1.31.2.1 phil struct m_tag *mtag; 803 1.31.2.1 phil struct ieee80211_toa_params *rp; 804 1.31.2.1 phil 805 1.31.2.2 phil mtag = m_tag_find(m, /*MTAG_ABI_NET80211,*/ NET80211_TAG_TOA_PARAMS, 806 1.31.2.1 phil NULL); 807 1.31.2.1 phil if (mtag == NULL) 808 1.31.2.1 phil return (0); 809 1.31.2.1 phil rp = (struct ieee80211_toa_params *)(mtag + 1); 810 1.31.2.1 phil if (p != NULL) 811 1.31.2.1 phil memcpy(p, rp, sizeof(*p)); 812 1.31.2.1 phil return (1); 813 1.31.2.1 phil } 814 1.31.2.1 phil 815 1.31.2.1 phil /* 816 1.31.2.1 phil * Transmit a frame to the parent interface. 817 1.31.2.1 phil */ 818 1.31.2.1 phil int 819 1.31.2.1 phil ieee80211_parent_xmitpkt(struct ieee80211com *ic, struct mbuf *m) 820 1.1 dyoung { 821 1.31.2.1 phil int error; 822 1.31.2.7 phil 823 1.31.2.1 phil /* 824 1.31.2.1 phil * Assert the IC TX lock is held - this enforces the 825 1.31.2.1 phil * processing -> queuing order is maintained 826 1.31.2.1 phil */ 827 1.31.2.1 phil IEEE80211_TX_LOCK_ASSERT(ic); 828 1.31.2.1 phil error = ic->ic_transmit(ic, m); 829 1.31.2.1 phil if (error) { 830 1.31.2.1 phil struct ieee80211_node *ni; 831 1.31.2.1 phil 832 1.31.2.2 phil ni = (struct ieee80211_node *)m_get_rcvif_NOMPSAFE(m); 833 1.31.2.1 phil 834 1.31.2.1 phil /* XXX number of fragments */ 835 1.31.2.1 phil if_inc_counter(ni->ni_vap->iv_ifp, IFCOUNTER_OERRORS, 1); 836 1.31.2.1 phil ieee80211_free_node(ni); 837 1.31.2.1 phil ieee80211_free_mbuf(m); 838 1.31.2.1 phil } 839 1.31.2.1 phil return (error); 840 1.1 dyoung } 841 1.1 dyoung 842 1.31.2.1 phil /* 843 1.31.2.1 phil * Transmit a frame to the VAP interface. 844 1.31.2.1 phil */ 845 1.31.2.1 phil int 846 1.31.2.1 phil ieee80211_vap_xmitpkt(struct ieee80211vap *vap, struct mbuf *m) 847 1.31.2.1 phil { 848 1.31.2.1 phil struct ifnet *ifp = vap->iv_ifp; 849 1.31.2.1 phil 850 1.31.2.1 phil /* 851 1.31.2.1 phil * When transmitting via the VAP, we shouldn't hold 852 1.31.2.1 phil * any IC TX lock as the VAP TX path will acquire it. 853 1.31.2.1 phil */ 854 1.31.2.1 phil IEEE80211_TX_UNLOCK_ASSERT(vap->iv_ic); 855 1.31.2.1 phil 856 1.31.2.1 phil return (ifp->if_transmit(ifp, m)); 857 1.31.2.1 phil 858 1.31.2.1 phil } 859 1.31.2.1 phil 860 1.1 dyoung void 861 1.31.2.1 phil get_random_bytes(void *p, size_t n) 862 1.1 dyoung { 863 1.31.2.1 phil uint8_t *dp = p; 864 1.1 dyoung 865 1.31.2.1 phil while (n > 0) { 866 1.31.2.1 phil uint32_t v = arc4random(); 867 1.31.2.1 phil size_t nb = n > sizeof(uint32_t) ? sizeof(uint32_t) : n; 868 1.31.2.1 phil bcopy(&v, dp, n > sizeof(uint32_t) ? sizeof(uint32_t) : n); 869 1.31.2.1 phil dp += sizeof(uint32_t), n -= nb; 870 1.31.2.1 phil } 871 1.31.2.1 phil } 872 1.3 dyoung 873 1.31.2.1 phil /* 874 1.31.2.1 phil * Helper function for events that pass just a single mac address. 875 1.31.2.1 phil */ 876 1.31.2.1 phil static void 877 1.31.2.1 phil notify_macaddr(struct ifnet *ifp, int op, const uint8_t mac[IEEE80211_ADDR_LEN]) 878 1.31.2.1 phil { 879 1.31.2.1 phil struct ieee80211_join_event iev; 880 1.31.2.6 phil printf ("NNN notify_macaddr called\n"); 881 1.31.2.1 phil CURVNET_SET(ifp->if_vnet); 882 1.7 dyoung memset(&iev, 0, sizeof(iev)); 883 1.31.2.1 phil IEEE80211_ADDR_COPY(iev.iev_addr, mac); 884 1.31.2.1 phil rt_ieee80211msg(ifp, op, &iev, sizeof(iev)); 885 1.31.2.1 phil CURVNET_RESTORE(); 886 1.31.2.1 phil } 887 1.31.2.1 phil 888 1.31.2.1 phil void 889 1.31.2.1 phil ieee80211_notify_node_join(struct ieee80211_node *ni, int newassoc) 890 1.31.2.1 phil { 891 1.31.2.1 phil struct ieee80211vap *vap = ni->ni_vap; 892 1.31.2.1 phil struct ifnet *ifp = vap->iv_ifp; 893 1.31.2.1 phil 894 1.31.2.1 phil CURVNET_SET_QUIET(ifp->if_vnet); 895 1.31.2.1 phil IEEE80211_NOTE(vap, IEEE80211_MSG_NODE, ni, "%snode join", 896 1.31.2.1 phil (ni == vap->iv_bss) ? "bss " : ""); 897 1.31.2.1 phil 898 1.31.2.1 phil if (ni == vap->iv_bss) { 899 1.31.2.1 phil notify_macaddr(ifp, newassoc ? 900 1.31.2.1 phil RTM_IEEE80211_ASSOC : RTM_IEEE80211_REASSOC, ni->ni_bssid); 901 1.1 dyoung if_link_state_change(ifp, LINK_STATE_UP); 902 1.16 christos } else { 903 1.31.2.1 phil notify_macaddr(ifp, newassoc ? 904 1.31.2.1 phil RTM_IEEE80211_JOIN : RTM_IEEE80211_REJOIN, ni->ni_macaddr); 905 1.1 dyoung } 906 1.31.2.1 phil CURVNET_RESTORE(); 907 1.1 dyoung } 908 1.1 dyoung 909 1.1 dyoung void 910 1.31.2.1 phil ieee80211_notify_node_leave(struct ieee80211_node *ni) 911 1.1 dyoung { 912 1.31.2.1 phil struct ieee80211vap *vap = ni->ni_vap; 913 1.31.2.1 phil struct ifnet *ifp = vap->iv_ifp; 914 1.1 dyoung 915 1.31.2.1 phil CURVNET_SET_QUIET(ifp->if_vnet); 916 1.31.2.1 phil IEEE80211_NOTE(vap, IEEE80211_MSG_NODE, ni, "%snode leave", 917 1.31.2.1 phil (ni == vap->iv_bss) ? "bss " : ""); 918 1.3 dyoung 919 1.31.2.1 phil if (ni == vap->iv_bss) { 920 1.1 dyoung rt_ieee80211msg(ifp, RTM_IEEE80211_DISASSOC, NULL, 0); 921 1.1 dyoung if_link_state_change(ifp, LINK_STATE_DOWN); 922 1.1 dyoung } else { 923 1.1 dyoung /* fire off wireless event station leaving */ 924 1.31.2.1 phil notify_macaddr(ifp, RTM_IEEE80211_LEAVE, ni->ni_macaddr); 925 1.1 dyoung } 926 1.31.2.1 phil CURVNET_RESTORE(); 927 1.1 dyoung } 928 1.1 dyoung 929 1.1 dyoung void 930 1.31.2.1 phil ieee80211_notify_scan_done(struct ieee80211vap *vap) 931 1.1 dyoung { 932 1.31.2.1 phil struct ifnet *ifp = vap->iv_ifp; 933 1.1 dyoung 934 1.31.2.1 phil IEEE80211_DPRINTF(vap, IEEE80211_MSG_SCAN, "%s\n", "notify scan done"); 935 1.1 dyoung 936 1.1 dyoung /* dispatch wireless event indicating scan completed */ 937 1.31.2.1 phil CURVNET_SET(ifp->if_vnet); 938 1.1 dyoung rt_ieee80211msg(ifp, RTM_IEEE80211_SCAN, NULL, 0); 939 1.31.2.1 phil CURVNET_RESTORE(); 940 1.1 dyoung } 941 1.1 dyoung 942 1.1 dyoung void 943 1.31.2.1 phil ieee80211_notify_replay_failure(struct ieee80211vap *vap, 944 1.1 dyoung const struct ieee80211_frame *wh, const struct ieee80211_key *k, 945 1.31.2.1 phil u_int64_t rsc, int tid) 946 1.1 dyoung { 947 1.31.2.1 phil struct ifnet *ifp = vap->iv_ifp; 948 1.1 dyoung 949 1.31.2.1 phil IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_CRYPTO, wh->i_addr2, 950 1.31.2.1 phil "%s replay detected tid %d <rsc %ju, csc %ju, keyix %u rxkeyix %u>", 951 1.31.2.1 phil k->wk_cipher->ic_name, tid, (intmax_t) rsc, 952 1.31.2.1 phil (intmax_t) k->wk_keyrsc[tid], 953 1.8 skrll k->wk_keyix, k->wk_rxkeyix); 954 1.1 dyoung 955 1.1 dyoung if (ifp != NULL) { /* NB: for cipher test modules */ 956 1.1 dyoung struct ieee80211_replay_event iev; 957 1.1 dyoung 958 1.1 dyoung IEEE80211_ADDR_COPY(iev.iev_dst, wh->i_addr1); 959 1.1 dyoung IEEE80211_ADDR_COPY(iev.iev_src, wh->i_addr2); 960 1.1 dyoung iev.iev_cipher = k->wk_cipher->ic_cipher; 961 1.8 skrll if (k->wk_rxkeyix != IEEE80211_KEYIX_NONE) 962 1.8 skrll iev.iev_keyix = k->wk_rxkeyix; 963 1.8 skrll else 964 1.8 skrll iev.iev_keyix = k->wk_keyix; 965 1.31.2.1 phil iev.iev_keyrsc = k->wk_keyrsc[tid]; 966 1.1 dyoung iev.iev_rsc = rsc; 967 1.31.2.1 phil CURVNET_SET(ifp->if_vnet); 968 1.1 dyoung rt_ieee80211msg(ifp, RTM_IEEE80211_REPLAY, &iev, sizeof(iev)); 969 1.31.2.1 phil CURVNET_RESTORE(); 970 1.1 dyoung } 971 1.1 dyoung } 972 1.1 dyoung 973 1.1 dyoung void 974 1.31.2.1 phil ieee80211_notify_michael_failure(struct ieee80211vap *vap, 975 1.1 dyoung const struct ieee80211_frame *wh, u_int keyix) 976 1.1 dyoung { 977 1.31.2.1 phil struct ifnet *ifp = vap->iv_ifp; 978 1.1 dyoung 979 1.31.2.1 phil IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_CRYPTO, wh->i_addr2, 980 1.31.2.1 phil "michael MIC verification failed <keyix %u>", keyix); 981 1.31.2.1 phil vap->iv_stats.is_rx_tkipmic++; 982 1.1 dyoung 983 1.1 dyoung if (ifp != NULL) { /* NB: for cipher test modules */ 984 1.1 dyoung struct ieee80211_michael_event iev; 985 1.1 dyoung 986 1.1 dyoung IEEE80211_ADDR_COPY(iev.iev_dst, wh->i_addr1); 987 1.1 dyoung IEEE80211_ADDR_COPY(iev.iev_src, wh->i_addr2); 988 1.1 dyoung iev.iev_cipher = IEEE80211_CIPHER_TKIP; 989 1.1 dyoung iev.iev_keyix = keyix; 990 1.31.2.1 phil CURVNET_SET(ifp->if_vnet); 991 1.1 dyoung rt_ieee80211msg(ifp, RTM_IEEE80211_MICHAEL, &iev, sizeof(iev)); 992 1.31.2.1 phil CURVNET_RESTORE(); 993 1.1 dyoung } 994 1.1 dyoung } 995 1.1 dyoung 996 1.1 dyoung void 997 1.31.2.1 phil ieee80211_notify_wds_discover(struct ieee80211_node *ni) 998 1.1 dyoung { 999 1.31.2.1 phil struct ieee80211vap *vap = ni->ni_vap; 1000 1.31.2.1 phil struct ifnet *ifp = vap->iv_ifp; 1001 1.31.2.1 phil 1002 1.31.2.1 phil notify_macaddr(ifp, RTM_IEEE80211_WDS, ni->ni_macaddr); 1003 1.31.2.1 phil } 1004 1.31.2.1 phil 1005 1.31.2.1 phil void 1006 1.31.2.1 phil ieee80211_notify_csa(struct ieee80211com *ic, 1007 1.31.2.1 phil const struct ieee80211_channel *c, int mode, int count) 1008 1.31.2.1 phil { 1009 1.31.2.1 phil struct ieee80211_csa_event iev; 1010 1.31.2.1 phil struct ieee80211vap *vap; 1011 1.31.2.1 phil struct ifnet *ifp; 1012 1.1 dyoung 1013 1.31.2.1 phil memset(&iev, 0, sizeof(iev)); 1014 1.31.2.1 phil iev.iev_flags = c->ic_flags; 1015 1.31.2.1 phil iev.iev_freq = c->ic_freq; 1016 1.31.2.1 phil iev.iev_ieee = c->ic_ieee; 1017 1.31.2.1 phil iev.iev_mode = mode; 1018 1.31.2.1 phil iev.iev_count = count; 1019 1.31.2.1 phil TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next) { 1020 1.31.2.1 phil ifp = vap->iv_ifp; 1021 1.31.2.1 phil CURVNET_SET(ifp->if_vnet); 1022 1.31.2.1 phil rt_ieee80211msg(ifp, RTM_IEEE80211_CSA, &iev, sizeof(iev)); 1023 1.31.2.1 phil CURVNET_RESTORE(); 1024 1.31.2.1 phil } 1025 1.31.2.1 phil } 1026 1.31.2.1 phil 1027 1.31.2.1 phil void 1028 1.31.2.1 phil ieee80211_notify_radar(struct ieee80211com *ic, 1029 1.31.2.1 phil const struct ieee80211_channel *c) 1030 1.31.2.1 phil { 1031 1.31.2.1 phil struct ieee80211_radar_event iev; 1032 1.31.2.1 phil struct ieee80211vap *vap; 1033 1.31.2.1 phil struct ifnet *ifp; 1034 1.31.2.1 phil 1035 1.31.2.1 phil memset(&iev, 0, sizeof(iev)); 1036 1.31.2.1 phil iev.iev_flags = c->ic_flags; 1037 1.31.2.1 phil iev.iev_freq = c->ic_freq; 1038 1.31.2.1 phil iev.iev_ieee = c->ic_ieee; 1039 1.31.2.1 phil TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next) { 1040 1.31.2.1 phil ifp = vap->iv_ifp; 1041 1.31.2.1 phil CURVNET_SET(ifp->if_vnet); 1042 1.31.2.1 phil rt_ieee80211msg(ifp, RTM_IEEE80211_RADAR, &iev, sizeof(iev)); 1043 1.31.2.1 phil CURVNET_RESTORE(); 1044 1.31.2.1 phil } 1045 1.31.2.1 phil } 1046 1.31.2.1 phil 1047 1.31.2.1 phil void 1048 1.31.2.1 phil ieee80211_notify_cac(struct ieee80211com *ic, 1049 1.31.2.1 phil const struct ieee80211_channel *c, enum ieee80211_notify_cac_event type) 1050 1.31.2.1 phil { 1051 1.31.2.1 phil struct ieee80211_cac_event iev; 1052 1.31.2.1 phil struct ieee80211vap *vap; 1053 1.31.2.1 phil struct ifnet *ifp; 1054 1.31.2.1 phil 1055 1.31.2.1 phil memset(&iev, 0, sizeof(iev)); 1056 1.31.2.1 phil iev.iev_flags = c->ic_flags; 1057 1.31.2.1 phil iev.iev_freq = c->ic_freq; 1058 1.31.2.1 phil iev.iev_ieee = c->ic_ieee; 1059 1.31.2.1 phil iev.iev_type = type; 1060 1.31.2.1 phil TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next) { 1061 1.31.2.1 phil ifp = vap->iv_ifp; 1062 1.31.2.1 phil CURVNET_SET(ifp->if_vnet); 1063 1.31.2.1 phil rt_ieee80211msg(ifp, RTM_IEEE80211_CAC, &iev, sizeof(iev)); 1064 1.31.2.1 phil CURVNET_RESTORE(); 1065 1.31.2.1 phil } 1066 1.31.2.1 phil } 1067 1.31.2.1 phil 1068 1.31.2.1 phil void 1069 1.31.2.1 phil ieee80211_notify_node_deauth(struct ieee80211_node *ni) 1070 1.31.2.1 phil { 1071 1.31.2.1 phil struct ieee80211vap *vap = ni->ni_vap; 1072 1.31.2.1 phil struct ifnet *ifp = vap->iv_ifp; 1073 1.31.2.1 phil 1074 1.31.2.1 phil IEEE80211_NOTE(vap, IEEE80211_MSG_NODE, ni, "%s", "node deauth"); 1075 1.31.2.1 phil 1076 1.31.2.1 phil notify_macaddr(ifp, RTM_IEEE80211_DEAUTH, ni->ni_macaddr); 1077 1.31.2.1 phil } 1078 1.31.2.1 phil 1079 1.31.2.1 phil void 1080 1.31.2.1 phil ieee80211_notify_node_auth(struct ieee80211_node *ni) 1081 1.31.2.1 phil { 1082 1.31.2.1 phil struct ieee80211vap *vap = ni->ni_vap; 1083 1.31.2.1 phil struct ifnet *ifp = vap->iv_ifp; 1084 1.31.2.1 phil 1085 1.31.2.1 phil IEEE80211_NOTE(vap, IEEE80211_MSG_NODE, ni, "%s", "node auth"); 1086 1.31.2.1 phil 1087 1.31.2.1 phil notify_macaddr(ifp, RTM_IEEE80211_AUTH, ni->ni_macaddr); 1088 1.31.2.1 phil } 1089 1.31.2.1 phil 1090 1.31.2.1 phil void 1091 1.31.2.1 phil ieee80211_notify_country(struct ieee80211vap *vap, 1092 1.31.2.1 phil const uint8_t bssid[IEEE80211_ADDR_LEN], const uint8_t cc[2]) 1093 1.31.2.1 phil { 1094 1.31.2.1 phil struct ifnet *ifp = vap->iv_ifp; 1095 1.31.2.1 phil struct ieee80211_country_event iev; 1096 1.31.2.1 phil 1097 1.31.2.1 phil memset(&iev, 0, sizeof(iev)); 1098 1.31.2.1 phil IEEE80211_ADDR_COPY(iev.iev_addr, bssid); 1099 1.31.2.1 phil iev.iev_cc[0] = cc[0]; 1100 1.31.2.1 phil iev.iev_cc[1] = cc[1]; 1101 1.31.2.1 phil CURVNET_SET(ifp->if_vnet); 1102 1.31.2.1 phil rt_ieee80211msg(ifp, RTM_IEEE80211_COUNTRY, &iev, sizeof(iev)); 1103 1.31.2.1 phil CURVNET_RESTORE(); 1104 1.31.2.1 phil } 1105 1.31.2.1 phil 1106 1.31.2.1 phil void 1107 1.31.2.1 phil ieee80211_notify_radio(struct ieee80211com *ic, int state) 1108 1.31.2.1 phil { 1109 1.31.2.1 phil struct ieee80211_radio_event iev; 1110 1.31.2.1 phil struct ieee80211vap *vap; 1111 1.31.2.1 phil struct ifnet *ifp; 1112 1.31.2.1 phil 1113 1.31.2.1 phil memset(&iev, 0, sizeof(iev)); 1114 1.31.2.1 phil iev.iev_state = state; 1115 1.31.2.1 phil TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next) { 1116 1.31.2.1 phil ifp = vap->iv_ifp; 1117 1.31.2.1 phil CURVNET_SET(ifp->if_vnet); 1118 1.31.2.1 phil rt_ieee80211msg(ifp, RTM_IEEE80211_RADIO, &iev, sizeof(iev)); 1119 1.31.2.1 phil CURVNET_RESTORE(); 1120 1.1 dyoung } 1121 1.31.2.1 phil } 1122 1.31.2.1 phil 1123 1.31.2.3 phil #ifdef notyet 1124 1.31.2.1 phil void 1125 1.31.2.1 phil ieee80211_load_module(const char *modname) 1126 1.31.2.1 phil { 1127 1.31.2.2 phil struct thread *td = curthread; 1128 1.31.2.2 phil 1129 1.31.2.2 phil if (suser(td) == 0 && securelevel_gt(td->td_ucred, 0) == 0) { 1130 1.31.2.2 phil mtx_lock(&Giant); 1131 1.31.2.2 phil (void) linker_load_module(modname, NULL, NULL, NULL, NULL); 1132 1.31.2.2 phil mtx_unlock(&Giant); 1133 1.31.2.2 phil } 1134 1.1 dyoung } 1135 1.31.2.3 phil #endif 1136 1.31 maxv 1137 1.31.2.2 phil #ifdef notyet 1138 1.31.2.1 phil static eventhandler_tag wlan_bpfevent; 1139 1.31.2.1 phil static eventhandler_tag wlan_ifllevent; 1140 1.31.2.1 phil 1141 1.31.2.1 phil static void 1142 1.31.2.1 phil bpf_track(void *arg, struct ifnet *ifp, int dlt, int attach) 1143 1.31.2.1 phil { 1144 1.31.2.6 phil /* NB: identify vap's by if_init */ // NNN won't work with urtwn ... 1145 1.31.2.1 phil if (dlt == DLT_IEEE802_11_RADIO && 1146 1.31.2.1 phil ifp->if_init == ieee80211_init) { 1147 1.31.2.1 phil struct ieee80211vap *vap = ifp->if_softc; 1148 1.31.2.1 phil /* 1149 1.31.2.1 phil * Track bpf radiotap listener state. We mark the vap 1150 1.31.2.1 phil * to indicate if any listener is present and the com 1151 1.31.2.1 phil * to indicate if any listener exists on any associated 1152 1.31.2.1 phil * vap. This flag is used by drivers to prepare radiotap 1153 1.31.2.1 phil * state only when needed. 1154 1.31.2.1 phil */ 1155 1.31.2.1 phil if (attach) { 1156 1.31.2.1 phil ieee80211_syncflag_ext(vap, IEEE80211_FEXT_BPF); 1157 1.31.2.1 phil if (vap->iv_opmode == IEEE80211_M_MONITOR) 1158 1.31.2.1 phil atomic_add_int(&vap->iv_ic->ic_montaps, 1); 1159 1.31.2.1 phil } else if (!bpf_peers_present(vap->iv_rawbpf)) { 1160 1.31.2.1 phil ieee80211_syncflag_ext(vap, -IEEE80211_FEXT_BPF); 1161 1.31.2.1 phil if (vap->iv_opmode == IEEE80211_M_MONITOR) 1162 1.31.2.1 phil atomic_subtract_int(&vap->iv_ic->ic_montaps, 1); 1163 1.31.2.1 phil } 1164 1.31.2.1 phil } 1165 1.31.2.1 phil } 1166 1.31 maxv 1167 1.31 maxv /* 1168 1.31.2.1 phil * Change MAC address on the vap (if was not started). 1169 1.31 maxv */ 1170 1.31.2.1 phil static void 1171 1.31.2.1 phil wlan_iflladdr(void *arg __unused, struct ifnet *ifp) 1172 1.31 maxv { 1173 1.31.2.6 phil /* NB: identify vap's by if_init */ // NNN wont work on urtwn 1174 1.31.2.1 phil if (ifp->if_init == ieee80211_init && 1175 1.31.2.1 phil (ifp->if_flags & IFF_UP) == 0) { 1176 1.31.2.1 phil struct ieee80211vap *vap = ifp->if_softc; 1177 1.31 maxv 1178 1.31.2.1 phil IEEE80211_ADDR_COPY(vap->iv_myaddr, IF_LLADDR(ifp)); 1179 1.31.2.1 phil } 1180 1.31 maxv } 1181 1.31.2.2 phil #endif 1182 1.31.2.2 phil 1183 1.31.2.2 phil void 1184 1.31.2.2 phil if_inc_counter(struct ifnet *ifp, ift_counter ifc, int64_t value) 1185 1.31.2.2 phil { 1186 1.31.2.2 phil switch (ifc) { 1187 1.31.2.2 phil case IFCOUNTER_IPACKETS: 1188 1.31.2.2 phil ifp->if_data.ifi_ipackets += value; 1189 1.31.2.2 phil break; 1190 1.31.2.2 phil case IFCOUNTER_IERRORS: 1191 1.31.2.2 phil ifp->if_data.ifi_ierrors += value; 1192 1.31.2.2 phil break; 1193 1.31.2.2 phil case IFCOUNTER_OPACKETS: 1194 1.31.2.2 phil ifp->if_data.ifi_opackets += value; 1195 1.31.2.2 phil break; 1196 1.31.2.2 phil case IFCOUNTER_OERRORS: 1197 1.31.2.2 phil ifp->if_data.ifi_oerrors += value; 1198 1.31.2.2 phil break; 1199 1.31.2.2 phil case IFCOUNTER_COLLISIONS: 1200 1.31.2.2 phil ifp->if_data.ifi_collisions += value; 1201 1.31.2.2 phil break; 1202 1.31.2.2 phil case IFCOUNTER_IBYTES: 1203 1.31.2.2 phil ifp->if_data.ifi_ibytes += value; 1204 1.31.2.2 phil break; 1205 1.31.2.2 phil case IFCOUNTER_OBYTES: 1206 1.31.2.2 phil ifp->if_data.ifi_obytes += value; 1207 1.31.2.2 phil break; 1208 1.31.2.2 phil case IFCOUNTER_IMCASTS: 1209 1.31.2.2 phil ifp->if_data.ifi_imcasts += value; 1210 1.31.2.2 phil break; 1211 1.31.2.2 phil case IFCOUNTER_OMCASTS: 1212 1.31.2.2 phil ifp->if_data.ifi_omcasts += value; 1213 1.31.2.2 phil break; 1214 1.31.2.2 phil case IFCOUNTER_IQDROPS: 1215 1.31.2.2 phil ifp->if_data.ifi_iqdrops += value; 1216 1.31.2.2 phil break; 1217 1.31.2.2 phil case IFCOUNTER_OQDROPS: 1218 1.31.2.2 phil /* ifp->if_data.ifi_oqdrops += value; No such field, just ignore it q*/ 1219 1.31.2.2 phil break; 1220 1.31.2.2 phil case IFCOUNTER_NOPROTO: 1221 1.31.2.2 phil ifp->if_data.ifi_noproto += value; 1222 1.31.2.2 phil break; 1223 1.31.2.2 phil default: 1224 1.31.2.2 phil panic("if_inc_counter: non-existant counter"); 1225 1.31.2.2 phil } 1226 1.31.2.2 phil } 1227 1.31.2.2 phil 1228 1.31 maxv 1229 1.31.2.2 phil #ifdef notyet 1230 1.31 maxv /* 1231 1.31.2.1 phil * Module glue. 1232 1.31 maxv * 1233 1.31.2.1 phil * NB: the module name is "wlan" for compatibility with NetBSD. 1234 1.31 maxv */ 1235 1.31.2.1 phil static int 1236 1.31.2.1 phil wlan_modevent(module_t mod, int type, void *unused) 1237 1.31 maxv { 1238 1.31.2.1 phil switch (type) { 1239 1.31.2.1 phil case MOD_LOAD: 1240 1.31.2.1 phil if (bootverbose) 1241 1.31.2.1 phil printf("wlan: <802.11 Link Layer>\n"); 1242 1.31.2.1 phil wlan_bpfevent = EVENTHANDLER_REGISTER(bpf_track, 1243 1.31.2.1 phil bpf_track, 0, EVENTHANDLER_PRI_ANY); 1244 1.31.2.1 phil wlan_ifllevent = EVENTHANDLER_REGISTER(iflladdr_event, 1245 1.31.2.1 phil wlan_iflladdr, NULL, EVENTHANDLER_PRI_ANY); 1246 1.31.2.1 phil wlan_cloner = if_clone_simple(wlanname, wlan_clone_create, 1247 1.31.2.1 phil wlan_clone_destroy, 0); 1248 1.31.2.1 phil return 0; 1249 1.31.2.1 phil case MOD_UNLOAD: 1250 1.31.2.1 phil if_clone_detach(wlan_cloner); 1251 1.31.2.1 phil EVENTHANDLER_DEREGISTER(bpf_track, wlan_bpfevent); 1252 1.31.2.1 phil EVENTHANDLER_DEREGISTER(iflladdr_event, wlan_ifllevent); 1253 1.31.2.1 phil return 0; 1254 1.31 maxv } 1255 1.31.2.1 phil return EINVAL; 1256 1.31 maxv } 1257 1.31.2.1 phil 1258 1.31.2.1 phil static moduledata_t wlan_mod = { 1259 1.31.2.1 phil wlanname, 1260 1.31.2.1 phil wlan_modevent, 1261 1.31.2.1 phil 0 1262 1.31.2.1 phil }; 1263 1.31.2.1 phil DECLARE_MODULE(wlan, wlan_mod, SI_SUB_DRIVERS, SI_ORDER_FIRST); 1264 1.31.2.1 phil MODULE_VERSION(wlan, 1); 1265 1.31.2.1 phil MODULE_DEPEND(wlan, ether, 1, 1, 1); 1266 1.31.2.2 phil #endif 1267 1.31.2.2 phil 1268 1.31.2.1 phil #ifdef IEEE80211_ALQ 1269 1.31.2.1 phil MODULE_DEPEND(wlan, alq, 1, 1, 1); 1270 1.31.2.1 phil #endif /* IEEE80211_ALQ */ 1271 1.31.2.1 phil 1272 1.31.2.2 phil /* Missing support for if_printf in NetBSD ... */ 1273 1.31.2.2 phil int 1274 1.31.2.2 phil if_printf(struct ifnet *ifp, const char *fmt, ...) 1275 1.31.2.2 phil { 1276 1.31.2.2 phil char if_fmt[256]; 1277 1.31.2.2 phil va_list ap; 1278 1.31.2.2 phil 1279 1.31.2.2 phil snprintf(if_fmt, sizeof(if_fmt), "%s: %s", ifp->if_xname, fmt); 1280 1.31.2.2 phil va_start(ap, fmt); 1281 1.31.2.2 phil vlog(LOG_INFO, if_fmt, ap); 1282 1.31.2.2 phil va_end(ap); 1283 1.31.2.2 phil return (0); 1284 1.31.2.2 phil } 1285 1.31.2.2 phil 1286 1.31.2.2 phil /* 1287 1.31.2.2 phil * Set the m_data pointer of a newly-allocated mbuf 1288 1.31.2.2 phil * to place an object of the specified size at the 1289 1.31.2.2 phil * end of the mbuf, longword aligned. 1290 1.31.2.2 phil */ 1291 1.31.2.2 phil void 1292 1.31.2.2 phil m_align(struct mbuf *m, int len) 1293 1.31.2.2 phil { 1294 1.31.2.2 phil int adjust; 1295 1.31.2.2 phil 1296 1.31.2.2 phil KASSERT(len != M_COPYALL); 1297 1.31.2.2 phil 1298 1.31.2.2 phil if (m->m_flags & M_EXT) 1299 1.31.2.2 phil adjust = m->m_ext.ext_size - len; 1300 1.31.2.2 phil else if (m->m_flags & M_PKTHDR) 1301 1.31.2.2 phil adjust = MHLEN - len; 1302 1.31.2.2 phil else 1303 1.31.2.2 phil adjust = MLEN - len; 1304 1.31.2.2 phil m->m_data += adjust &~ (sizeof(long)-1); 1305 1.31.2.2 phil } 1306 1.31.2.2 phil 1307 1.31.2.2 phil /* 1308 1.31.2.2 phil * Append the specified data to the indicated mbuf chain, 1309 1.31.2.2 phil * Extend the mbuf chain if the new data does not fit in 1310 1.31.2.2 phil * existing space. 1311 1.31.2.2 phil * 1312 1.31.2.2 phil * Return 1 if able to complete the job; otherwise 0. 1313 1.31.2.2 phil */ 1314 1.31.2.2 phil int 1315 1.31.2.2 phil m_append(struct mbuf *m0, int len, const void *cpv) 1316 1.31.2.2 phil { 1317 1.31.2.2 phil struct mbuf *m, *n; 1318 1.31.2.2 phil int remainder, space; 1319 1.31.2.2 phil const char *cp = cpv; 1320 1.31.2.2 phil 1321 1.31.2.2 phil KASSERT(len != M_COPYALL); 1322 1.31.2.2 phil for (m = m0; m->m_next != NULL; m = m->m_next) 1323 1.31.2.2 phil continue; 1324 1.31.2.2 phil remainder = len; 1325 1.31.2.2 phil space = M_TRAILINGSPACE(m); 1326 1.31.2.2 phil if (space > 0) { 1327 1.31.2.2 phil /* 1328 1.31.2.2 phil * Copy into available space. 1329 1.31.2.2 phil */ 1330 1.31.2.2 phil if (space > remainder) 1331 1.31.2.2 phil space = remainder; 1332 1.31.2.2 phil memmove(mtod(m, char *) + m->m_len, cp, space); 1333 1.31.2.2 phil m->m_len += space; 1334 1.31.2.2 phil cp = cp + space, remainder -= space; 1335 1.31.2.2 phil } 1336 1.31.2.2 phil while (remainder > 0) { 1337 1.31.2.2 phil /* 1338 1.31.2.2 phil * Allocate a new mbuf; could check space 1339 1.31.2.2 phil * and allocate a cluster instead. 1340 1.31.2.2 phil */ 1341 1.31.2.2 phil n = m_get(M_DONTWAIT, m->m_type); 1342 1.31.2.2 phil if (n == NULL) 1343 1.31.2.2 phil break; 1344 1.31.2.2 phil n->m_len = min(MLEN, remainder); 1345 1.31.2.2 phil memmove(mtod(n, void *), cp, n->m_len); 1346 1.31.2.2 phil cp += n->m_len, remainder -= n->m_len; 1347 1.31.2.2 phil m->m_next = n; 1348 1.31.2.2 phil m = n; 1349 1.31.2.2 phil } 1350 1.31.2.2 phil if (m0->m_flags & M_PKTHDR) 1351 1.31.2.2 phil m0->m_pkthdr.len += len - remainder; 1352 1.31.2.2 phil return (remainder == 0); 1353 1.31.2.2 phil } 1354 1.31.2.2 phil 1355 1.31.2.2 phil /* 1356 1.31.2.2 phil * Create a writable copy of the mbuf chain. While doing this 1357 1.31.2.2 phil * we compact the chain with a goal of producing a chain with 1358 1.31.2.2 phil * at most two mbufs. The second mbuf in this chain is likely 1359 1.31.2.2 phil * to be a cluster. The primary purpose of this work is to create 1360 1.31.2.2 phil * a writable packet for encryption, compression, etc. The 1361 1.31.2.2 phil * secondary goal is to linearize the data so the data can be 1362 1.31.2.2 phil * passed to crypto hardware in the most efficient manner possible. 1363 1.31.2.2 phil */ 1364 1.31.2.2 phil struct mbuf * 1365 1.31.2.2 phil m_unshare(struct mbuf *m0, int how) 1366 1.31.2.2 phil { 1367 1.31.2.2 phil struct mbuf *m, *mprev; 1368 1.31.2.2 phil struct mbuf *n, *mfirst, *mlast; 1369 1.31.2.2 phil int len, off; 1370 1.31.2.2 phil 1371 1.31.2.2 phil mprev = NULL; 1372 1.31.2.2 phil for (m = m0; m != NULL; m = mprev->m_next) { 1373 1.31.2.2 phil /* 1374 1.31.2.2 phil * Regular mbufs are ignored unless there's a cluster 1375 1.31.2.2 phil * in front of it that we can use to coalesce. We do 1376 1.31.2.2 phil * the latter mainly so later clusters can be coalesced 1377 1.31.2.2 phil * also w/o having to handle them specially (i.e. convert 1378 1.31.2.2 phil * mbuf+cluster -> cluster). This optimization is heavily 1379 1.31.2.2 phil * influenced by the assumption that we're running over 1380 1.31.2.2 phil * Ethernet where MCLBYTES is large enough that the max 1381 1.31.2.2 phil * packet size will permit lots of coalescing into a 1382 1.31.2.2 phil * single cluster. This in turn permits efficient 1383 1.31.2.2 phil * crypto operations, especially when using hardware. 1384 1.31.2.2 phil */ 1385 1.31.2.2 phil if ((m->m_flags & M_EXT) == 0) { 1386 1.31.2.2 phil if (mprev && (mprev->m_flags & M_EXT) && 1387 1.31.2.2 phil m->m_len <= M_TRAILINGSPACE(mprev)) { 1388 1.31.2.2 phil /* XXX: this ignores mbuf types */ 1389 1.31.2.3 phil memcpy(mtod(mprev, __uint8_t *) + mprev->m_len, 1390 1.31.2.3 phil mtod(m, __uint8_t *), m->m_len); 1391 1.31.2.2 phil mprev->m_len += m->m_len; 1392 1.31.2.2 phil mprev->m_next = m->m_next; /* unlink from chain */ 1393 1.31.2.2 phil m_free(m); /* reclaim mbuf */ 1394 1.31.2.2 phil } else { 1395 1.31.2.2 phil mprev = m; 1396 1.31.2.2 phil } 1397 1.31.2.2 phil continue; 1398 1.31.2.2 phil } 1399 1.31.2.2 phil /* 1400 1.31.2.2 phil * Writable mbufs are left alone (for now). 1401 1.31.2.2 phil */ 1402 1.31.2.2 phil if (!M_READONLY(m)) { 1403 1.31.2.2 phil mprev = m; 1404 1.31.2.2 phil continue; 1405 1.31.2.2 phil } 1406 1.31.2.2 phil 1407 1.31.2.2 phil /* 1408 1.31.2.2 phil * Not writable, replace with a copy or coalesce with 1409 1.31.2.2 phil * the previous mbuf if possible (since we have to copy 1410 1.31.2.2 phil * it anyway, we try to reduce the number of mbufs and 1411 1.31.2.2 phil * clusters so that future work is easier). 1412 1.31.2.2 phil */ 1413 1.31.2.2 phil FBSDKASSERT(m->m_flags & M_EXT, ("m_flags 0x%x", m->m_flags)); 1414 1.31.2.2 phil /* NB: we only coalesce into a cluster or larger */ 1415 1.31.2.2 phil if (mprev != NULL && (mprev->m_flags & M_EXT) && 1416 1.31.2.2 phil m->m_len <= M_TRAILINGSPACE(mprev)) { 1417 1.31.2.2 phil /* XXX: this ignores mbuf types */ 1418 1.31.2.3 phil memcpy(mtod(mprev, __uint8_t *) + mprev->m_len, 1419 1.31.2.3 phil mtod(m, __uint8_t *), m->m_len); 1420 1.31.2.2 phil mprev->m_len += m->m_len; 1421 1.31.2.2 phil mprev->m_next = m->m_next; /* unlink from chain */ 1422 1.31.2.2 phil m_free(m); /* reclaim mbuf */ 1423 1.31.2.2 phil continue; 1424 1.31.2.2 phil } 1425 1.31.2.2 phil 1426 1.31.2.2 phil /* 1427 1.31.2.2 phil * Allocate new space to hold the copy and copy the data. 1428 1.31.2.2 phil * We deal with jumbo mbufs (i.e. m_len > MCLBYTES) by 1429 1.31.2.2 phil * splitting them into clusters. We could just malloc a 1430 1.31.2.2 phil * buffer and make it external but too many device drivers 1431 1.31.2.2 phil * don't know how to break up the non-contiguous memory when 1432 1.31.2.2 phil * doing DMA. 1433 1.31.2.2 phil */ 1434 1.31.2.2 phil n = m_getcl(how, m->m_type, m->m_flags & M_COPYFLAGS); 1435 1.31.2.2 phil if (n == NULL) { 1436 1.31.2.2 phil m_freem(m0); 1437 1.31.2.2 phil return (NULL); 1438 1.31.2.2 phil } 1439 1.31.2.2 phil if (m->m_flags & M_PKTHDR) { 1440 1.31.2.2 phil FBSDKASSERT(mprev == NULL, ("%s: m0 %p, m %p has M_PKTHDR", 1441 1.31.2.2 phil __func__, m0, m)); 1442 1.31.2.2 phil m_move_pkthdr(n, m); 1443 1.31.2.2 phil } 1444 1.31.2.2 phil len = m->m_len; 1445 1.31.2.2 phil off = 0; 1446 1.31.2.2 phil mfirst = n; 1447 1.31.2.2 phil mlast = NULL; 1448 1.31.2.2 phil for (;;) { 1449 1.31.2.2 phil int cc = min(len, MCLBYTES); 1450 1.31.2.3 phil memcpy(mtod(n, __uint8_t *), mtod(m, __uint8_t *) + off, cc); 1451 1.31.2.2 phil n->m_len = cc; 1452 1.31.2.2 phil if (mlast != NULL) 1453 1.31.2.2 phil mlast->m_next = n; 1454 1.31.2.2 phil mlast = n; 1455 1.31.2.2 phil #if 0 1456 1.31.2.2 phil newipsecstat.ips_clcopied++; 1457 1.31.2.2 phil #endif 1458 1.31.2.2 phil 1459 1.31.2.2 phil len -= cc; 1460 1.31.2.2 phil if (len <= 0) 1461 1.31.2.2 phil break; 1462 1.31.2.2 phil off += cc; 1463 1.31.2.2 phil 1464 1.31.2.2 phil n = m_getcl(how, m->m_type, m->m_flags & M_COPYFLAGS); 1465 1.31.2.2 phil if (n == NULL) { 1466 1.31.2.2 phil m_freem(mfirst); 1467 1.31.2.2 phil m_freem(m0); 1468 1.31.2.2 phil return (NULL); 1469 1.31.2.2 phil } 1470 1.31.2.2 phil } 1471 1.31.2.2 phil n->m_next = m->m_next; 1472 1.31.2.2 phil if (mprev == NULL) 1473 1.31.2.2 phil m0 = mfirst; /* new head of chain */ 1474 1.31.2.2 phil else 1475 1.31.2.2 phil mprev->m_next = mfirst; /* replace old mbuf */ 1476 1.31.2.2 phil m_free(m); /* release old mbuf */ 1477 1.31.2.2 phil mprev = mfirst; 1478 1.31.2.2 phil } 1479 1.31.2.2 phil return (m0); 1480 1.31.2.2 phil } 1481
Indexes created Fri Sep 26 20:09:58 GMT 2025