Skip site navigation (1)Skip section navigation (2)
Date:      Wed, 11 Jan 2012 17:41:14 +0000 (UTC)
From:      Adrian Chadd <adrian@FreeBSD.org>
To:        src-committers@freebsd.org, svn-src-all@freebsd.org, svn-src-head@freebsd.org
Subject:   svn commit: r229970 - in head/sys: dev/wtap dev/wtap/plugins dev/wtap/wtap_hal modules/wtap
Message-ID:  <201201111741.q0BHfEEl069717@svn.freebsd.org>

next in thread | raw e-mail | index | archive | help
Author: adrian
Date: Wed Jan 11 17:41:14 2012
New Revision: 229970
URL: http://svn.freebsd.org/changeset/base/229970

Log:
  Introduce wtap, the beginnings of a net80211 wlan simulator.
  
  This introduces:
  
  * a basic wtap interface
  * a HAL, which implements an abstraction layer for implementing
    different device behavious;
  * A visibility plugin, which allows for control over which nodes
    see other nodes (useful for mesh work.)
  
  It doesn't yet implement sta/adhoc/hostap modes but these are quite
  feasible to implement.
  
  Monthadar uses it to do 802.11s mesh verification.
  
  The userland tools will be committed in a follow-up commit.
  
  Submitted by:	Monthadar Al Jaberi <monthadar@gmail.com>

Added:
  head/sys/dev/wtap/
  head/sys/dev/wtap/if_medium.c   (contents, props changed)
  head/sys/dev/wtap/if_medium.h   (contents, props changed)
  head/sys/dev/wtap/if_wtap.c   (contents, props changed)
  head/sys/dev/wtap/if_wtap_module.c   (contents, props changed)
  head/sys/dev/wtap/if_wtapioctl.h   (contents, props changed)
  head/sys/dev/wtap/if_wtapvar.h   (contents, props changed)
  head/sys/dev/wtap/plugins/
  head/sys/dev/wtap/plugins/visibility.c   (contents, props changed)
  head/sys/dev/wtap/plugins/visibility.h   (contents, props changed)
  head/sys/dev/wtap/plugins/visibility_ioctl.h   (contents, props changed)
  head/sys/dev/wtap/plugins/wtap_plugin.h   (contents, props changed)
  head/sys/dev/wtap/wtap_hal/
  head/sys/dev/wtap/wtap_hal/hal.c   (contents, props changed)
  head/sys/dev/wtap/wtap_hal/hal.h   (contents, props changed)
  head/sys/dev/wtap/wtap_hal/handler.h   (contents, props changed)
  head/sys/modules/wtap/
  head/sys/modules/wtap/Makefile   (contents, props changed)

Added: head/sys/dev/wtap/if_medium.c
==============================================================================
--- /dev/null	00:00:00 1970	(empty, because file is newly added)
+++ head/sys/dev/wtap/if_medium.c	Wed Jan 11 17:41:14 2012	(r229970)
@@ -0,0 +1,120 @@
+/*-
+ * Copyright (c) 2010-2011 Monthadar Al Jaberi, TerraNet AB
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer,
+ *    without modification.
+ * 2. Redistributions in binary form must reproduce at minimum a disclaimer
+ *    similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
+ *    redistribution must be conditioned upon including a substantially
+ *    similar Disclaimer requirement for further binary redistribution.
+ *
+ * NO WARRANTY
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
+ * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
+ * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
+ * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+ * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
+ * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
+ * THE POSSIBILITY OF SUCH DAMAGES.
+ *
+ * $FreeBSD$
+ */
+#include "if_wtapvar.h"
+#include "if_medium.h"
+
+void
+init_medium(struct wtap_medium *md)
+{
+
+	DWTAP_PRINTF("%s\n", __func__);
+	STAILQ_INIT(&md->md_pktbuf);
+	mtx_init(&md->md_mtx, "wtap_medium mtx", NULL, MTX_DEF | MTX_RECURSE);
+
+	/* Event handler for sending packets between wtaps */
+	struct eventhandler *eh = (struct eventhandler *)
+	    malloc(sizeof(struct eventhandler), M_WTAP, M_NOWAIT | M_ZERO);
+	eh->tq = taskqueue_create("wtap_tx_taskq",  M_NOWAIT | M_ZERO,
+	    taskqueue_thread_enqueue, &eh->tq);
+	taskqueue_start_threads(&eh->tq, 1, PI_NET, "%s taskq", "wtap_medium");
+	md->tx_handler = eh;
+	/* Mark medium closed by default */
+	md->open = 0;
+}
+
+void
+deinit_medium(struct wtap_medium *md)
+{
+
+	DWTAP_PRINTF("%s\n", __func__);
+	taskqueue_free(md->tx_handler->tq);
+	free(md->tx_handler, M_WTAP);
+}
+
+int
+medium_transmit(struct wtap_medium *md, int id, struct mbuf*m)
+{
+
+	mtx_lock(&md->md_mtx);
+	if (md->open == 0){
+		DWTAP_PRINTF("[%d] dropping m=%p\n", id, m);
+		m_free(m);
+		mtx_unlock(&md->md_mtx);
+		return 0;
+	}
+
+	DWTAP_PRINTF("[%d] transmiting m=%p\n", id, m);
+	struct packet *p = (struct packet *)malloc(sizeof(struct packet),
+	    M_WTAP_PACKET, M_ZERO | M_NOWAIT);
+	p->id = id;
+	p->m = m;
+
+	STAILQ_INSERT_TAIL(&md->md_pktbuf, p, pf_list);
+	taskqueue_enqueue(md->tx_handler->tq, &md->tx_handler->proc);
+	mtx_unlock(&md->md_mtx);
+
+      return 0;
+}
+
+struct packet *
+medium_get_next_packet(struct wtap_medium *md)
+{
+	struct packet *p;
+
+	mtx_lock(&md->md_mtx);
+	p = STAILQ_FIRST(&md->md_pktbuf);
+	if (p == NULL){
+		mtx_unlock(&md->md_mtx);
+		return NULL;
+	}
+
+	STAILQ_REMOVE_HEAD(&md->md_pktbuf, pf_list);
+	mtx_unlock(&md->md_mtx);
+	return p;
+}
+
+void
+medium_open(struct wtap_medium *md)
+{
+
+	mtx_lock(&md->md_mtx);
+	md->open = 1;
+	mtx_unlock(&md->md_mtx);
+}
+
+void
+medium_close(struct wtap_medium *md)
+{
+
+	mtx_lock(&md->md_mtx);
+	md->open = 0;
+	mtx_unlock(&md->md_mtx);
+}

Added: head/sys/dev/wtap/if_medium.h
==============================================================================
--- /dev/null	00:00:00 1970	(empty, because file is newly added)
+++ head/sys/dev/wtap/if_medium.h	Wed Jan 11 17:41:14 2012	(r229970)
@@ -0,0 +1,72 @@
+/*-
+ * Copyright (c) 2010-2011 Monthadar Al Jaberi, TerraNet AB
+ * All rights reserved.
+ *
+ * Copyright (c) 2002-2009 Sam Leffler, Errno Consulting
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer,
+ *    without modification.
+ * 2. Redistributions in binary form must reproduce at minimum a disclaimer
+ *    similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
+ *    redistribution must be conditioned upon including a substantially
+ *    similar Disclaimer requirement for further binary redistribution.
+ *
+ * NO WARRANTY
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
+ * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
+ * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
+ * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+ * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
+ * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
+ * THE POSSIBILITY OF SUCH DAMAGES.
+ *
+ * $FreeBSD$
+ */
+
+#ifndef	__DEV_WTAP_MEDIUM_H__
+#define	__DEV_WTAP_MEDIUM_H__
+
+#include "if_wtapvar.h"
+#include "wtap_hal/handler.h"
+
+struct packet {
+	STAILQ_ENTRY(packet)	pf_list;
+	struct mbuf *		m;
+	int			id;
+};
+typedef STAILQ_HEAD(, packet) md_pkthead;
+
+struct wtap_medium {
+	struct mtx 			md_mtx;
+#if 0
+	int				visibility[MAX_NBR_WTAP];
+	struct stailhead 		*headp;
+	packet_head			pktbuf;
+	STAILQ_HEAD(stailhead, packet) pktbuf;
+	STAILQ_HEAD(stailhead, packet) pktbuf;
+	/* = STAILQ_HEAD_INITIALIZER(head); */
+#endif
+	/* 0 means we drop packets, 1 we queue them */
+	int				open;
+	md_pkthead			md_pktbuf;	/* master queue */
+	struct eventhandler		*tx_handler;
+	struct timehandler		*bc_handler;
+};
+
+extern	void init_medium(struct wtap_medium *);
+extern	void deinit_medium(struct wtap_medium *);
+extern	void medium_open(struct wtap_medium *);
+extern	void medium_close(struct wtap_medium *);
+extern	int medium_transmit(struct wtap_medium *, int id, struct mbuf*);
+extern	struct packet *medium_get_next_packet(struct wtap_medium *);
+
+#endif	/* __DEV_WTAP_MEDIUM_H__ */

Added: head/sys/dev/wtap/if_wtap.c
==============================================================================
--- /dev/null	00:00:00 1970	(empty, because file is newly added)
+++ head/sys/dev/wtap/if_wtap.c	Wed Jan 11 17:41:14 2012	(r229970)
@@ -0,0 +1,904 @@
+/*-
+ * Copyright (c) 2010-2011 Monthadar Al Jaberi, TerraNet AB
+ * All rights reserved.
+ *
+ * Copyright (c) 2002-2009 Sam Leffler, Errno Consulting
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer,
+ *    without modification.
+ * 2. Redistributions in binary form must reproduce at minimum a disclaimer
+ *    similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
+ *    redistribution must be conditioned upon including a substantially
+ *    similar Disclaimer requirement for further binary redistribution.
+ *
+ * NO WARRANTY
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
+ * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
+ * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
+ * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+ * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
+ * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
+ * THE POSSIBILITY OF SUCH DAMAGES.
+ *
+ * $FreeBSD$
+ */
+#include "if_wtapvar.h"
+#include <sys/uio.h>    /* uio struct */
+#include <sys/jail.h>
+#include <net/if_var.h>
+#include <net/vnet.h>
+
+#include <net80211/ieee80211_ratectl.h>
+#include "if_medium.h"
+
+/* device for IOCTL and read/write for debuggin purposes */
+/* Function prototypes */
+static	d_open_t	wtap_node_open;
+static	d_close_t	wtap_node_close;
+static	d_write_t	wtap_node_write;
+static	d_ioctl_t	wtap_node_ioctl;
+
+static struct cdevsw wtap_cdevsw = {
+	.d_version =	D_VERSION,
+	.d_flags =	0,
+	.d_open = 	wtap_node_open,
+	.d_close = 	wtap_node_close,
+	.d_write = 	wtap_node_write,
+	.d_ioctl =	wtap_node_ioctl,
+	.d_name =	"wtapnode",
+};
+
+static int
+wtap_node_open(struct cdev *dev, int oflags, int devtype, struct thread *p)
+{
+
+	int err = 0;
+	uprintf("Opened device \"echo\" successfully.\n");
+	return(err);
+}
+
+static int
+wtap_node_close(struct cdev *dev, int fflag, int devtype, struct thread *p)
+{
+
+	uprintf("Closing device \"echo.\"\n");
+	return(0);
+}
+
+static int
+wtap_node_write(struct cdev *dev, struct uio *uio, int ioflag)
+{
+	int err = 0;
+	struct mbuf *m;
+	struct ifnet *ifp;
+	struct wtap_softc *sc;
+	uint8_t buf[1024];
+	int buf_len;
+
+	uprintf("write device %s \"echo.\"\n", dev->si_name);
+	buf_len = MIN(uio->uio_iov->iov_len, 1024);
+	err = copyin(uio->uio_iov->iov_base, buf, buf_len);
+
+	if (err != 0) {
+		uprintf("Write failed: bad address!\n");
+		return (err);
+	}
+
+	MGETHDR(m, M_DONTWAIT, MT_DATA);
+	m_copyback(m, 0, buf_len, buf);
+
+	CURVNET_SET(TD_TO_VNET(curthread));
+	IFNET_RLOCK_NOSLEEP();
+
+	TAILQ_FOREACH(ifp, &V_ifnet, if_link) {
+		printf("ifp->if_xname = %s\n", ifp->if_xname);
+		if(strcmp(dev->si_name, ifp->if_xname) == 0){
+			printf("found match, correspoding wtap = %s\n",
+			    ifp->if_xname);
+			sc = (struct wtap_softc *)ifp->if_softc;
+			printf("wtap id = %d\n", sc->id);
+			wtap_inject(sc, m);
+		}
+	}
+
+	IFNET_RUNLOCK_NOSLEEP();
+	CURVNET_RESTORE();
+
+	return(err);
+}
+
+int
+wtap_node_ioctl(struct cdev *dev, u_long cmd, caddr_t data,
+    int fflag, struct thread *td)
+{
+	int error = 0;
+
+	switch(cmd) {
+	default:
+		DWTAP_PRINTF("Unkown WTAP IOCTL\n");
+		error = EINVAL;
+	}
+	return error;
+}
+
+static int wtap_raw_xmit(struct ieee80211_node *ni, struct mbuf *m,
+	const struct ieee80211_bpf_params *params);
+
+static int
+wtap_medium_enqueue(struct wtap_vap *avp, struct mbuf *m)
+{
+
+	return medium_transmit(avp->av_md, avp->id, m);
+}
+
+static int
+wtap_media_change(struct ifnet *ifp)
+{
+
+	DWTAP_PRINTF("%s\n", __func__);
+	int error = ieee80211_media_change(ifp);
+	/* NB: only the fixed rate can change and that doesn't need a reset */
+	return (error == ENETRESET ? 0 : error);
+}
+
+/*
+ * Intercept management frames to collect beacon rssi data
+ * and to do ibss merges.
+ */
+static void
+wtap_recv_mgmt(struct ieee80211_node *ni, struct mbuf *m,
+    int subtype, int rssi, int nf)
+{
+	struct ieee80211vap *vap = ni->ni_vap;
+#if 0
+	DWTAP_PRINTF("[%d] %s\n", myath_id(ni), __func__);
+#endif
+	WTAP_VAP(vap)->av_recv_mgmt(ni, m, subtype, rssi, nf);
+}
+
+static int
+wtap_reset_vap(struct ieee80211vap *vap, u_long cmd)
+{
+
+	DWTAP_PRINTF("%s\n", __func__);
+	return 0;
+}
+
+static void
+wtap_beacon_update(struct ieee80211vap *vap, int item)
+{
+	struct ieee80211_beacon_offsets *bo = &WTAP_VAP(vap)->av_boff;
+
+	DWTAP_PRINTF("%s\n", __func__);
+	setbit(bo->bo_flags, item);
+}
+
+/*
+ * Allocate and setup an initial beacon frame.
+ */
+static int
+wtap_beacon_alloc(struct wtap_softc *sc, struct ieee80211_node *ni)
+{
+	struct ieee80211vap *vap = ni->ni_vap;
+	struct wtap_vap *avp = WTAP_VAP(vap);
+
+	DWTAP_PRINTF("[%s] %s\n", ether_sprintf(ni->ni_macaddr), __func__);
+
+	/*
+	 * NB: the beacon data buffer must be 32-bit aligned;
+	 * we assume the mbuf routines will return us something
+	 * with this alignment (perhaps should assert).
+	 */
+	avp->beacon = ieee80211_beacon_alloc(ni, &avp->av_boff);
+	if (avp->beacon == NULL) {
+		printf("%s: cannot get mbuf\n", __func__);
+		return ENOMEM;
+	}
+	callout_init(&avp->av_swba, 0);
+	avp->bf_node = ieee80211_ref_node(ni);
+
+	return 0;
+}
+
+static void
+wtap_beacon_config(struct wtap_softc *sc, struct ieee80211vap *vap)
+{
+
+	DWTAP_PRINTF("%s\n", __func__);
+}
+
+static void
+wtap_beacon_intrp(void *arg)
+{
+	struct wtap_vap *avp = arg;
+	struct ieee80211vap *vap = arg;
+	struct mbuf *m;
+
+	KASSERT(vap->iv_state >= IEEE80211_S_RUN,
+	    ("not running, state %d", vap->iv_state));
+	DWTAP_PRINTF("[%d] beacon intrp\n", avp->id);	//burst mode
+	/*
+	 * Update dynamic beacon contents.  If this returns
+	 * non-zero then we need to remap the memory because
+	 * the beacon frame changed size (probably because
+	 * of the TIM bitmap).
+	 */
+	m = m_dup(avp->beacon, M_DONTWAIT);
+	if (ieee80211_beacon_update(avp->bf_node, &avp->av_boff, m, 0)) {
+		printf("%s, need to remap the memory because the beacon frame"
+		    " changed size.\n",__func__);
+	}
+
+	if (ieee80211_radiotap_active_vap(vap))
+	    ieee80211_radiotap_tx(vap, m);
+
+#if 0
+	medium_transmit(avp->av_md, avp->id, m);
+#endif
+	wtap_medium_enqueue(avp, m);
+	callout_schedule(&avp->av_swba, avp->av_bcinterval);
+}
+
+static int
+wtap_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg)
+{
+	struct ieee80211com *ic = vap->iv_ic;
+	struct wtap_softc *sc = ic->ic_ifp->if_softc;
+	struct wtap_vap *avp = WTAP_VAP(vap);
+	struct ieee80211_node *ni = NULL;
+	int error;
+
+	DWTAP_PRINTF("%s\n", __func__);
+
+	ni = vap->iv_bss;
+	/*
+	 * Invoke the parent method to do net80211 work.
+	 */
+	error = avp->av_newstate(vap, nstate, arg);
+	if (error != 0)
+		goto bad;
+
+	if (nstate == IEEE80211_S_RUN) {
+		/* NB: collect bss node again, it may have changed */
+		ni = vap->iv_bss;
+		switch (vap->iv_opmode) {
+		case IEEE80211_M_MBSS:
+			error = wtap_beacon_alloc(sc, ni);
+			if (error != 0)
+				goto bad;
+			wtap_beacon_config(sc, vap);
+			callout_reset(&avp->av_swba, avp->av_bcinterval,
+			    wtap_beacon_intrp, vap);
+			break;
+		default:
+			goto bad;
+		}
+	}
+	return 0;
+bad:
+	printf("%s: bad\n", __func__);
+	return error;
+}
+
+static void
+wtap_bmiss(struct ieee80211vap *vap)
+{
+	struct wtap_vap *avp = (struct wtap_vap *)vap;
+
+	DWTAP_PRINTF("%s\n", __func__);
+	avp->av_bmiss(vap);
+}
+
+static struct ieee80211vap *
+wtap_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ],
+    int unit, enum ieee80211_opmode opmode, int flags,
+    const uint8_t bssid[IEEE80211_ADDR_LEN],
+    const uint8_t mac[IEEE80211_ADDR_LEN])
+{
+	 struct wtap_softc *sc = ic->ic_ifp->if_softc;
+	 struct ieee80211vap *vap;
+	 struct wtap_vap *avp;
+	 int error;
+
+	 DWTAP_PRINTF("%s\n", __func__);
+
+	avp = (struct wtap_vap *) malloc(sizeof(struct wtap_vap),
+	    M_80211_VAP, M_NOWAIT | M_ZERO);
+	avp->id = sc->id;
+	avp->av_md = sc->sc_md;
+	avp->av_bcinterval = BEACON_INTRERVAL + 100*sc->id;
+	vap = (struct ieee80211vap *) avp;
+	error = ieee80211_vap_setup(ic, vap, name, unit, IEEE80211_M_MBSS,
+	    flags | IEEE80211_CLONE_NOBEACONS, bssid, mac);
+
+	/* override various methods */
+	avp->av_recv_mgmt = vap->iv_recv_mgmt;
+	vap->iv_recv_mgmt = wtap_recv_mgmt;
+	vap->iv_reset = wtap_reset_vap;
+	vap->iv_update_beacon = wtap_beacon_update;
+	avp->av_newstate = vap->iv_newstate;
+	vap->iv_newstate = wtap_newstate;
+	avp->av_bmiss = vap->iv_bmiss;
+	vap->iv_bmiss = wtap_bmiss;
+
+	/* complete setup */
+	ieee80211_vap_attach(vap, wtap_media_change, ieee80211_media_status);
+	avp->av_dev = make_dev(&wtap_cdevsw, 0, UID_ROOT, GID_WHEEL, 0600,
+	    (const char *)ic->ic_ifp->if_xname);
+
+	/* TODO this is a hack to force it to choose the rate we want */
+	vap->iv_bss->ni_txrate = 130;
+	return vap;
+}
+
+static void
+wtap_vap_delete(struct ieee80211vap *vap)
+{
+	struct wtap_vap *avp = WTAP_VAP(vap);
+
+	DWTAP_PRINTF("%s\n", __func__);
+	destroy_dev(avp->av_dev);
+	callout_stop(&avp->av_swba);
+	ieee80211_vap_detach(vap);
+	free((struct wtap_vap*) vap, M_80211_VAP);
+}
+
+/* NB: This function is not used.
+ * I had the problem of the queue
+ * being empty all the time.
+ * Maybe I am setting the queue wrong?
+ */
+static void
+wtap_start(struct ifnet *ifp)
+{
+	struct ieee80211com *ic = ifp->if_l2com;
+	struct ifnet *icifp = ic->ic_ifp;
+	struct wtap_softc *sc = icifp->if_softc;
+	struct ieee80211_node *ni;
+	struct mbuf *m;
+
+	DWTAP_PRINTF("my_start, with id=%u\n", sc->id);
+
+	if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0 || sc->up == 0)
+		return;
+	for (;;) {
+		if(IFQ_IS_EMPTY(&ifp->if_snd)){
+		    printf("queue empty, just trying to see "
+		        "if the other queue is empty\n");
+#if 0
+		    printf("queue for id=1, %u\n",
+		        IFQ_IS_EMPTY(&global_mscs[1]->ifp->if_snd));
+		    printf("queue for id=0, %u\n",
+		        IFQ_IS_EMPTY(&global_mscs[0]->ifp->if_snd));
+#endif
+		    break;
+		}
+		IFQ_DEQUEUE(&ifp->if_snd, m);
+		if (m == NULL) {
+			printf("error dequeueing from ifp->snd\n");
+			break;
+		}
+		ni = (struct ieee80211_node *) m->m_pkthdr.rcvif;
+		/*
+		 * Check for fragmentation.  If this frame
+		 * has been broken up verify we have enough
+		 * buffers to send all the fragments so all
+		 * go out or none...
+		 */
+#if 0
+		STAILQ_INIT(&frags);
+#endif
+		if ((m->m_flags & M_FRAG)){
+			printf("dont support frags\n");
+			ifp->if_oerrors++;
+			return;
+		}
+		ifp->if_opackets++;
+		if(wtap_raw_xmit(ni, m, NULL) < 0){
+			printf("error raw_xmiting\n");
+			ifp->if_oerrors++;
+			return;
+		}
+	}
+}
+
+static int
+wtap_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
+{
+#if 0
+	DWTAP_PRINTF("%s\n", __func__);
+	uprintf("%s, command %lu\n", __func__, cmd);
+#endif
+#define	IS_RUNNING(ifp) \
+	((ifp->if_flags & IFF_UP) && (ifp->if_drv_flags & IFF_DRV_RUNNING))
+	struct ieee80211com *ic = ifp->if_l2com;
+	struct wtap_softc *sc = ifp->if_softc;
+	struct ifreq *ifr = (struct ifreq *)data;
+	int error = 0;
+
+	switch (cmd) {
+	case SIOCSIFFLAGS:
+		//printf("%s: %s\n", __func__, "SIOCSIFFLAGS");
+		if (IS_RUNNING(ifp)) {
+			DWTAP_PRINTF("running\n");
+#if 0
+			/*
+			 * To avoid rescanning another access point,
+			 * do not call ath_init() here.  Instead,
+			 * only reflect promisc mode settings.
+			 */
+			//ath_mode_init(sc);
+#endif
+			} else if (ifp->if_flags & IFF_UP) {
+			DWTAP_PRINTF("up\n");
+			sc->up = 1;
+#if 0
+			/*
+			 * Beware of being called during attach/detach
+			 * to reset promiscuous mode.  In that case we
+			 * will still be marked UP but not RUNNING.
+			 * However trying to re-init the interface
+			 * is the wrong thing to do as we've already
+			 * torn down much of our state.  There's
+			 * probably a better way to deal with this.
+			 */
+			//if (!sc->sc_invalid)
+			//	ath_init(sc);	/* XXX lose error */
+#endif
+			ifp->if_drv_flags |= IFF_DRV_RUNNING;
+			ieee80211_start_all(ic);
+		} else {
+			DWTAP_PRINTF("stoping\n");
+#if 0
+			ath_stop_locked(ifp);
+#ifdef notyet
+			/* XXX must wakeup in places like ath_vap_delete */
+			if (!sc->sc_invalid)
+				ath_hal_setpower(sc->sc_ah, HAL_PM_FULL_SLEEP);
+#endif
+#endif
+		}
+		break;
+	case SIOCGIFMEDIA:
+	case SIOCSIFMEDIA:
+#if 0
+		DWTAP_PRINTF("%s: %s\n", __func__, "SIOCGIFMEDIA|SIOCSIFMEDIA");
+#endif
+		error = ifmedia_ioctl(ifp, ifr, &ic->ic_media, cmd);
+		break;
+	case SIOCGIFADDR:
+#if 0
+		DWTAP_PRINTF("%s: %s\n", __func__, "SIOCGIFADDR");
+#endif
+		error = ether_ioctl(ifp, cmd, data);
+		break;
+	default:
+		DWTAP_PRINTF("%s: %s [%lu]\n", __func__, "EINVAL", cmd);
+		error = EINVAL;
+		break;
+	}
+	return error;
+#undef IS_RUNNING
+}
+
+static void
+wtap_init(void *arg){
+
+	DWTAP_PRINTF("%s\n", __func__);
+}
+
+static void
+wtap_scan_start(struct ieee80211com *ic)
+{
+
+#if 0
+	DWTAP_PRINTF("%s\n", __func__);
+#endif
+}
+
+static void
+wtap_scan_end(struct ieee80211com *ic)
+{
+
+#if 0
+	DWTAP_PRINTF("%s\n", __func__);
+#endif
+}
+
+static void
+wtap_set_channel(struct ieee80211com *ic)
+{
+
+#if 0
+	DWTAP_PRINTF("%s\n", __func__);
+#endif
+}
+
+static int
+wtap_raw_xmit(struct ieee80211_node *ni, struct mbuf *m,
+	const struct ieee80211_bpf_params *params)
+{
+#if 0
+	DWTAP_PRINTF("%s, %p\n", __func__, m);
+#endif
+	struct ieee80211vap	*vap = ni->ni_vap;
+	struct wtap_vap 	*avp = WTAP_VAP(vap);
+
+	if (ieee80211_radiotap_active_vap(vap)) {
+		ieee80211_radiotap_tx(vap, m);
+	}
+	if (m->m_flags & M_TXCB)
+		ieee80211_process_callback(ni, m, 0);
+	ieee80211_free_node(ni);
+	return wtap_medium_enqueue(avp, m);
+}
+
+void
+wtap_inject(struct wtap_softc *sc, struct mbuf *m)
+{
+      struct wtap_buf *bf = (struct wtap_buf *)malloc(sizeof(struct wtap_buf),
+          M_WTAP_RXBUF, M_NOWAIT | M_ZERO);
+      KASSERT(bf != NULL, ("could not allocated a new wtap_buf\n"));
+      bf->m = m;
+
+      mtx_lock(&sc->sc_mtx);
+      STAILQ_INSERT_TAIL(&sc->sc_rxbuf, bf, bf_list);
+      taskqueue_enqueue(sc->sc_tq, &sc->sc_rxtask);
+      mtx_unlock(&sc->sc_mtx);
+}
+
+void
+wtap_rx_deliver(struct wtap_softc *sc, struct mbuf *m)
+{
+	struct ifnet *ifp = sc->sc_ifp;
+	struct ieee80211com *ic = ifp->if_l2com;
+	struct ieee80211_node *ni;
+	int type;
+#if 0
+	DWTAP_PRINTF("%s\n", __func__);
+#endif
+
+	DWTAP_PRINTF("[%d] receiving m=%p\n", sc->id, m);
+	if (m == NULL) {		/* NB: shouldn't happen */
+		if_printf(ifp, "%s: no mbuf!\n", __func__);
+	}
+
+	ifp->if_ipackets++;
+
+	ieee80211_dump_pkt(ic, mtod(m, caddr_t), 0,0,0);
+
+	/*
+	  * Locate the node for sender, track state, and then
+	  * pass the (referenced) node up to the 802.11 layer
+	  * for its use.
+	  */
+	ni = ieee80211_find_rxnode_withkey(ic,
+	    mtod(m, const struct ieee80211_frame_min *),IEEE80211_KEYIX_NONE);
+	if (ni != NULL) {
+		/*
+		 * Sending station is known, dispatch directly.
+		 */
+		type = ieee80211_input(ni, m, 1<<7, 10);
+		ieee80211_free_node(ni);
+	} else {
+		type = ieee80211_input_all(ic, m, 1<<7, 10);
+	}
+}
+
+static void
+wtap_rx_proc(void *arg, int npending)
+{
+	struct wtap_softc *sc = (struct wtap_softc *)arg;
+	struct ifnet *ifp = sc->sc_ifp;
+	struct ieee80211com *ic = ifp->if_l2com;
+	struct mbuf *m;
+	struct ieee80211_node *ni;
+	int type;
+	struct wtap_buf *bf;
+
+#if 0
+	DWTAP_PRINTF("%s\n", __func__);
+#endif
+
+	for(;;) {
+		mtx_lock(&sc->sc_mtx);
+		bf = STAILQ_FIRST(&sc->sc_rxbuf);
+		if (bf == NULL) {
+			mtx_unlock(&sc->sc_mtx);
+			return;
+		}
+		STAILQ_REMOVE_HEAD(&sc->sc_rxbuf, bf_list);
+		mtx_unlock(&sc->sc_mtx);
+		KASSERT(bf != NULL, ("wtap_buf is NULL\n"));
+		m = bf->m;
+		DWTAP_PRINTF("[%d] receiving m=%p\n", sc->id, bf->m);
+		if (m == NULL) {		/* NB: shouldn't happen */
+			if_printf(ifp, "%s: no mbuf!\n", __func__);
+			free(bf, M_WTAP_RXBUF);
+			return;
+		}
+
+		ifp->if_ipackets++;
+#if 0
+		ieee80211_dump_pkt(ic, mtod(m, caddr_t), 0,0,0);
+#endif
+
+		/*
+		 * Locate the node for sender, track state, and then
+		 * pass the (referenced) node up to the 802.11 layer
+		 * for its use.
+		 */
+		ni = ieee80211_find_rxnode_withkey(ic,
+		    mtod(m, const struct ieee80211_frame_min *),
+		    IEEE80211_KEYIX_NONE);
+		if (ni != NULL) {
+			/*
+			 * Sending station is known, dispatch directly.
+			 */
+#if 0
+			ieee80211_radiotap_rx(ni->ni_vap, m);
+#endif
+			type = ieee80211_input(ni, m, 1<<7, 10);
+			ieee80211_free_node(ni);
+		} else {
+#if 0
+			ieee80211_radiotap_rx_all(ic, m);
+#endif
+			type = ieee80211_input_all(ic, m, 1<<7, 10);
+		}
+		
+		/* The mbufs are freed by the Net80211 stack */
+		free(bf, M_WTAP_RXBUF);
+	}
+}
+
+static void
+wtap_newassoc(struct ieee80211_node *ni, int isnew)
+{
+
+	DWTAP_PRINTF("%s\n", __func__);
+}
+
+/*
+ * Callback from the 802.11 layer to update WME parameters.
+ */
+static int
+wtap_wme_update(struct ieee80211com *ic)
+{
+
+	DWTAP_PRINTF("%s\n", __func__);
+	return 0;
+}
+
+static void
+wtap_update_mcast(struct ifnet *ifp)
+{
+
+	DWTAP_PRINTF("%s\n", __func__);
+}
+
+static void
+wtap_update_promisc(struct ifnet *ifp)
+{
+
+	DWTAP_PRINTF("%s\n", __func__);
+}
+
+static int
+wtap_if_transmit(struct ifnet *ifp, struct mbuf *m)
+{
+	struct ieee80211_node *ni =
+	    (struct ieee80211_node *) m->m_pkthdr.rcvif;
+	struct ieee80211vap *vap = ni->ni_vap;
+	struct wtap_vap *avp = WTAP_VAP(vap);
+
+	if(ni == NULL){
+		printf("m->m_pkthdr.rcvif is NULL we cant radiotap_tx\n");
+	}else{
+		if (ieee80211_radiotap_active_vap(vap))
+			ieee80211_radiotap_tx(vap, m);
+	}
+	if (m->m_flags & M_TXCB)
+		ieee80211_process_callback(ni, m, 0);
+	ieee80211_free_node(ni);
+	return wtap_medium_enqueue(avp, m);
+}
+
+static struct ieee80211_node *
+wtap_node_alloc(struct ieee80211vap *vap, const uint8_t mac[IEEE80211_ADDR_LEN])
+{
+	struct ieee80211_node *ni;
+
+	DWTAP_PRINTF("%s\n", __func__);
+
+	ni = malloc(sizeof(struct ieee80211_node), M_80211_NODE,
+	    M_NOWAIT|M_ZERO);
+
+	ni->ni_txrate = 130;
+	return ni;
+}
+
+static void
+wtap_node_free(struct ieee80211_node *ni)
+{
+	struct ieee80211com *ic = ni->ni_ic;
+	struct wtap_softc *sc = ic->ic_ifp->if_softc;
+
+	DWTAP_PRINTF("%s\n", __func__);
+	sc->sc_node_free(ni);
+}
+
+int32_t
+wtap_attach(struct wtap_softc *sc, const uint8_t *macaddr)
+{
+	struct ifnet *ifp;
+	struct ieee80211com *ic;
+	char wtap_name[] = {'w','T','a','p',sc->id,
+	    '_','t','a','s','k','q','\0'};
+
+	DWTAP_PRINTF("%s\n", __func__);
+
+	ifp = if_alloc(IFT_IEEE80211);
+	if (ifp == NULL) {
+		printf("can not if_alloc()\n");
+		return -1;
+	}
+	ic = ifp->if_l2com;
+	if_initname(ifp, "wtap", sc->id);
+
+	sc->sc_ifp = ifp;
+	sc->up = 0;
+
+	STAILQ_INIT(&sc->sc_rxbuf);
+	sc->sc_tq = taskqueue_create(wtap_name, M_NOWAIT | M_ZERO,
+	    taskqueue_thread_enqueue, &sc->sc_tq);
+	taskqueue_start_threads(&sc->sc_tq, 1, PI_SOFT, "%s taskQ",
+	    ifp->if_xname);
+	TASK_INIT(&sc->sc_rxtask, 0, wtap_rx_proc, sc);
+
+	ifp->if_softc = sc;
+	ifp->if_flags = IFF_SIMPLEX | IFF_BROADCAST | IFF_MULTICAST;
+	ifp->if_start = wtap_start;
+	ifp->if_ioctl = wtap_ioctl;
+	ifp->if_init = wtap_init;
+	IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen);
+	ifp->if_snd.ifq_drv_maxlen = ifqmaxlen;
+	IFQ_SET_READY(&ifp->if_snd);
+
+	ic->ic_ifp = ifp;
+	ic->ic_phytype = IEEE80211_T_DS;
+	ic->ic_opmode = IEEE80211_M_MBSS;
+	ic->ic_caps = IEEE80211_C_MBSS;
+
+	ic->ic_max_keyix = 128; /* A value read from Atheros ATH_KEYMAX */
+
+	ic->ic_regdomain.regdomain = SKU_ETSI;
+	ic->ic_regdomain.country = CTRY_SWEDEN;
+	ic->ic_regdomain.location = 1; /* Indoors */
+	ic->ic_regdomain.isocc[0] = 'S';
+	ic->ic_regdomain.isocc[1] = 'E';
+	/*
+	 * Indicate we need the 802.11 header padded to a
+	 * 32-bit boundary for 4-address and QoS frames.
+	 */
+	ic->ic_flags |= IEEE80211_F_DATAPAD;
+	ic->ic_nchans = 1;
+	ic->ic_channels[0].ic_flags = IEEE80211_CHAN_B;
+	ic->ic_channels[0].ic_freq = 2412;
+
+	ieee80211_ifattach(ic, macaddr);
+

*** DIFF OUTPUT TRUNCATED AT 1000 LINES ***



Want to link to this message? Use this URL: <https://mail-archive.FreeBSD.org/cgi/mid.cgi?201201111741.q0BHfEEl069717>