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