if_uath.c revision 192499
1190688Sweongyo/*- 2190688Sweongyo * Copyright (c) 2006 Sam Leffler, Errno Consulting 3190688Sweongyo * Copyright (c) 2008-2009 Weongyo Jeong <weongyo@freebsd.org> 4190688Sweongyo * All rights reserved. 5190688Sweongyo * 6190688Sweongyo * Redistribution and use in source and binary forms, with or without 7190688Sweongyo * modification, are permitted provided that the following conditions 8190688Sweongyo * are met: 9190688Sweongyo * 1. Redistributions of source code must retain the above copyright 10190688Sweongyo * notice, this list of conditions and the following disclaimer, 11190688Sweongyo * without modification. 12190688Sweongyo * 2. Redistributions in binary form must reproduce at minimum a disclaimer 13190688Sweongyo * similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any 14190688Sweongyo * redistribution must be conditioned upon including a substantially 15190688Sweongyo * similar Disclaimer requirement for further binary redistribution. 16190688Sweongyo * 17190688Sweongyo * NO WARRANTY 18190688Sweongyo * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 19190688Sweongyo * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 20190688Sweongyo * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY 21190688Sweongyo * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL 22190688Sweongyo * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, 23190688Sweongyo * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 24190688Sweongyo * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 25190688Sweongyo * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER 26190688Sweongyo * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 27190688Sweongyo * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF 28190688Sweongyo * THE POSSIBILITY OF SUCH DAMAGES. 29190688Sweongyo */ 30190688Sweongyo 31190688Sweongyo/* 32190688Sweongyo * This driver is distantly derived from a driver of the same name 33190688Sweongyo * by Damien Bergamini. The original copyright is included below: 34190688Sweongyo * 35190688Sweongyo * Copyright (c) 2006 36190688Sweongyo * Damien Bergamini <damien.bergamini@free.fr> 37190688Sweongyo * 38190688Sweongyo * Permission to use, copy, modify, and distribute this software for any 39190688Sweongyo * purpose with or without fee is hereby granted, provided that the above 40190688Sweongyo * copyright notice and this permission notice appear in all copies. 41190688Sweongyo * 42190688Sweongyo * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 43190688Sweongyo * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 44190688Sweongyo * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 45190688Sweongyo * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 46190688Sweongyo * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 47190688Sweongyo * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 48190688Sweongyo * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 49190688Sweongyo */ 50190688Sweongyo 51190688Sweongyo#include <sys/cdefs.h> 52190688Sweongyo__FBSDID("$FreeBSD: head/sys/dev/usb/wlan/if_uath.c 192499 2009-05-21 00:04:17Z thompsa $"); 53190688Sweongyo 54190688Sweongyo/*- 55190688Sweongyo * Driver for Atheros AR5523 USB parts. 56190688Sweongyo * 57190688Sweongyo * The driver requires firmware to be loaded into the device. This 58190688Sweongyo * is done on device discovery from a user application (uathload) 59190688Sweongyo * that is launched by devd when a device with suitable product ID 60190688Sweongyo * is recognized. Once firmware has been loaded the device will 61190688Sweongyo * reset the USB port and re-attach with the original product ID+1 62190688Sweongyo * and this driver will be attached. The firmware is licensed for 63190688Sweongyo * general use (royalty free) and may be incorporated in products. 64190688Sweongyo * Note that the firmware normally packaged with the NDIS drivers 65190688Sweongyo * for these devices does not work in this way and so does not work 66190688Sweongyo * with this driver. 67190688Sweongyo */ 68190688Sweongyo#include <sys/param.h> 69190688Sweongyo#include <sys/sockio.h> 70190688Sweongyo#include <sys/sysctl.h> 71190688Sweongyo#include <sys/lock.h> 72190688Sweongyo#include <sys/mutex.h> 73190688Sweongyo#include <sys/mbuf.h> 74190688Sweongyo#include <sys/kernel.h> 75190688Sweongyo#include <sys/socket.h> 76190688Sweongyo#include <sys/systm.h> 77190688Sweongyo#include <sys/malloc.h> 78190688Sweongyo#include <sys/module.h> 79190688Sweongyo#include <sys/bus.h> 80190688Sweongyo#include <sys/endian.h> 81190688Sweongyo#include <sys/kdb.h> 82190688Sweongyo 83190688Sweongyo#include <machine/bus.h> 84190688Sweongyo#include <machine/resource.h> 85190688Sweongyo#include <sys/rman.h> 86190688Sweongyo 87190688Sweongyo#include <net/bpf.h> 88190688Sweongyo#include <net/if.h> 89190688Sweongyo#include <net/if_arp.h> 90190688Sweongyo#include <net/ethernet.h> 91190688Sweongyo#include <net/if_dl.h> 92190688Sweongyo#include <net/if_media.h> 93190688Sweongyo#include <net/if_types.h> 94190688Sweongyo 95190688Sweongyo#ifdef INET 96190688Sweongyo#include <netinet/in.h> 97190688Sweongyo#include <netinet/in_systm.h> 98190688Sweongyo#include <netinet/in_var.h> 99190688Sweongyo#include <netinet/if_ether.h> 100190688Sweongyo#include <netinet/ip.h> 101190688Sweongyo#endif 102190688Sweongyo 103190688Sweongyo#include <net80211/ieee80211_var.h> 104190688Sweongyo#include <net80211/ieee80211_regdomain.h> 105190688Sweongyo#include <net80211/ieee80211_radiotap.h> 106190688Sweongyo 107190688Sweongyo#include <dev/usb/usb.h> 108190688Sweongyo#include <dev/usb/usb_core.h> 109190688Sweongyo#include <dev/usb/usb_busdma.h> 110190688Sweongyo#include <dev/usb/usb_debug.h> 111190688Sweongyo#include <dev/usb/usb_error.h> 112190688Sweongyo#include <dev/usb/usb_lookup.h> 113190688Sweongyo#include <dev/usb/usb_util.h> 114190688Sweongyo#include "usbdevs.h" 115190688Sweongyo 116190688Sweongyo#include <dev/usb/wlan/if_uathreg.h> 117190688Sweongyo#include <dev/usb/wlan/if_uathvar.h> 118190688Sweongyo 119190688SweongyoSYSCTL_NODE(_hw_usb2, OID_AUTO, uath, CTLFLAG_RW, 0, "USB Atheros"); 120190688Sweongyo 121190688Sweongyostatic int uath_countrycode = CTRY_DEFAULT; /* country code */ 122190688SweongyoSYSCTL_INT(_hw_usb2_uath, OID_AUTO, countrycode, CTLFLAG_RW, &uath_countrycode, 123190688Sweongyo 0, "country code"); 124190688SweongyoTUNABLE_INT("hw.usb2.uath.countrycode", &uath_countrycode); 125190688Sweongyostatic int uath_regdomain = 0; /* regulatory domain */ 126190688SweongyoSYSCTL_INT(_hw_usb2_uath, OID_AUTO, regdomain, CTLFLAG_RD, &uath_regdomain, 127190688Sweongyo 0, "regulatory domain"); 128190688Sweongyo 129190688Sweongyo#ifdef UATH_DEBUG 130190688Sweongyoint uath_debug = 0; 131190688SweongyoSYSCTL_INT(_hw_usb2_uath, OID_AUTO, debug, CTLFLAG_RW, &uath_debug, 0, 132190688Sweongyo "uath debug level"); 133190688SweongyoTUNABLE_INT("hw.usb.uath.debug", &uath_debug); 134190688Sweongyoenum { 135190688Sweongyo UATH_DEBUG_XMIT = 0x00000001, /* basic xmit operation */ 136190688Sweongyo UATH_DEBUG_XMIT_DUMP = 0x00000002, /* xmit dump */ 137190688Sweongyo UATH_DEBUG_RECV = 0x00000004, /* basic recv operation */ 138190688Sweongyo UATH_DEBUG_TX_PROC = 0x00000008, /* tx ISR proc */ 139190688Sweongyo UATH_DEBUG_RX_PROC = 0x00000010, /* rx ISR proc */ 140190688Sweongyo UATH_DEBUG_RECV_ALL = 0x00000020, /* trace all frames (beacons) */ 141190688Sweongyo UATH_DEBUG_INIT = 0x00000040, /* initialization of dev */ 142190688Sweongyo UATH_DEBUG_DEVCAP = 0x00000080, /* dev caps */ 143190688Sweongyo UATH_DEBUG_CMDS = 0x00000100, /* commands */ 144190688Sweongyo UATH_DEBUG_CMDS_DUMP = 0x00000200, /* command buffer dump */ 145190688Sweongyo UATH_DEBUG_RESET = 0x00000400, /* reset processing */ 146190688Sweongyo UATH_DEBUG_STATE = 0x00000800, /* 802.11 state transitions */ 147190688Sweongyo UATH_DEBUG_MULTICAST = 0x00001000, /* multicast */ 148190688Sweongyo UATH_DEBUG_WME = 0x00002000, /* WME */ 149190688Sweongyo UATH_DEBUG_CHANNEL = 0x00004000, /* channel */ 150190688Sweongyo UATH_DEBUG_RATES = 0x00008000, /* rates */ 151190688Sweongyo UATH_DEBUG_CRYPTO = 0x00010000, /* crypto */ 152190688Sweongyo UATH_DEBUG_LED = 0x00020000, /* LED */ 153190688Sweongyo UATH_DEBUG_ANY = 0xffffffff 154190688Sweongyo}; 155190688Sweongyo#define DPRINTF(sc, m, fmt, ...) do { \ 156190688Sweongyo if (sc->sc_debug & (m)) \ 157190688Sweongyo printf(fmt, __VA_ARGS__); \ 158190688Sweongyo} while (0) 159190688Sweongyo#else 160190688Sweongyo#define DPRINTF(sc, m, fmt, ...) do { \ 161190688Sweongyo (void) sc; \ 162190688Sweongyo} while (0) 163190688Sweongyo#endif 164190688Sweongyo 165190688Sweongyo/* unaligned little endian access */ 166190688Sweongyo#define LE_READ_2(p) \ 167190688Sweongyo ((u_int16_t) \ 168190688Sweongyo ((((u_int8_t *)(p))[0] ) | (((u_int8_t *)(p))[1] << 8))) 169190688Sweongyo#define LE_READ_4(p) \ 170190688Sweongyo ((u_int32_t) \ 171190688Sweongyo ((((u_int8_t *)(p))[0] ) | (((u_int8_t *)(p))[1] << 8) | \ 172190688Sweongyo (((u_int8_t *)(p))[2] << 16) | (((u_int8_t *)(p))[3] << 24))) 173190688Sweongyo 174190688Sweongyo/* recognized device vendors/products */ 175190688Sweongyostatic const struct usb2_device_id uath_devs[] = { 176190688Sweongyo#define UATH_DEV(v,p) { USB_VP(USB_VENDOR_##v, USB_PRODUCT_##v##_##p) } 177190688Sweongyo UATH_DEV(ATHEROS, AR5523), 178190688Sweongyo UATH_DEV(ATHEROS2, AR5523_1), 179190688Sweongyo UATH_DEV(ATHEROS2, AR5523_2), 180190688Sweongyo UATH_DEV(ATHEROS2, AR5523_3), 181190688Sweongyo UATH_DEV(CONCEPTRONIC, AR5523_1), 182190688Sweongyo UATH_DEV(CONCEPTRONIC, AR5523_2), 183190688Sweongyo UATH_DEV(DLINK, DWLAG122), 184190688Sweongyo UATH_DEV(DLINK, DWLAG132), 185190688Sweongyo UATH_DEV(DLINK, DWLG132), 186190688Sweongyo UATH_DEV(GIGASET, AR5523), 187190688Sweongyo UATH_DEV(GIGASET, SMCWUSBTG), 188190688Sweongyo UATH_DEV(GLOBALSUN, AR5523_1), 189190688Sweongyo UATH_DEV(GLOBALSUN, AR5523_2), 190190688Sweongyo UATH_DEV(NETGEAR, WG111U), 191190688Sweongyo UATH_DEV(NETGEAR3, WG111T), 192190688Sweongyo UATH_DEV(NETGEAR3, WPN111), 193190688Sweongyo UATH_DEV(UMEDIA, TEW444UBEU), 194190688Sweongyo UATH_DEV(UMEDIA, AR5523_2), 195192258Ssam UATH_DEV(UMEDIA, AR5523_3), 196190688Sweongyo UATH_DEV(WISTRONNEWEB, AR5523_1), 197190688Sweongyo UATH_DEV(WISTRONNEWEB, AR5523_2), 198190688Sweongyo UATH_DEV(ZCOM, AR5523) 199190688Sweongyo#undef UATH_DEV 200190688Sweongyo}; 201190688Sweongyo 202190688Sweongyostatic usb2_callback_t uath_intr_rx_callback; 203190688Sweongyostatic usb2_callback_t uath_intr_tx_callback; 204190688Sweongyostatic usb2_callback_t uath_bulk_rx_callback; 205190688Sweongyostatic usb2_callback_t uath_bulk_tx_callback; 206190688Sweongyo 207190688Sweongyostatic const struct usb2_config uath_usbconfig[UATH_N_XFERS] = { 208190688Sweongyo [UATH_INTR_RX] = { 209190688Sweongyo .type = UE_BULK, 210190688Sweongyo .endpoint = 0x1, 211190688Sweongyo .direction = UE_DIR_IN, 212190744Sthompsa .bufsize = UATH_MAX_CMDSZ, 213190744Sthompsa .flags = { 214190688Sweongyo .pipe_bof = 1, 215190688Sweongyo .short_xfer_ok = 1 216190688Sweongyo }, 217190744Sthompsa .callback = uath_intr_rx_callback 218190688Sweongyo }, 219190688Sweongyo [UATH_INTR_TX] = { 220190688Sweongyo .type = UE_BULK, 221190688Sweongyo .endpoint = 0x1, 222190688Sweongyo .direction = UE_DIR_OUT, 223190744Sthompsa .bufsize = UATH_MAX_CMDSZ, 224190744Sthompsa .flags = { 225190688Sweongyo .ext_buffer = 1, 226190688Sweongyo .force_short_xfer = 1, 227190688Sweongyo .pipe_bof = 1, 228190688Sweongyo }, 229190744Sthompsa .callback = uath_intr_tx_callback, 230190744Sthompsa .timeout = UATH_CMD_TIMEOUT 231190688Sweongyo }, 232190688Sweongyo [UATH_BULK_RX] = { 233190688Sweongyo .type = UE_BULK, 234190688Sweongyo .endpoint = 0x2, 235190688Sweongyo .direction = UE_DIR_IN, 236190744Sthompsa .bufsize = MCLBYTES, 237190744Sthompsa .flags = { 238190688Sweongyo .ext_buffer = 1, 239190688Sweongyo .pipe_bof = 1, 240190688Sweongyo .short_xfer_ok = 1 241190688Sweongyo }, 242190744Sthompsa .callback = uath_bulk_rx_callback 243190688Sweongyo }, 244190688Sweongyo [UATH_BULK_TX] = { 245190688Sweongyo .type = UE_BULK, 246190688Sweongyo .endpoint = 0x2, 247190688Sweongyo .direction = UE_DIR_OUT, 248190744Sthompsa .bufsize = UATH_MAX_TXBUFSZ, 249190744Sthompsa .flags = { 250190688Sweongyo .ext_buffer = 1, 251190688Sweongyo .force_short_xfer = 1, 252190688Sweongyo .pipe_bof = 1 253190688Sweongyo }, 254190744Sthompsa .callback = uath_bulk_tx_callback, 255190744Sthompsa .timeout = UATH_DATA_TIMEOUT 256190688Sweongyo } 257190688Sweongyo}; 258190688Sweongyo 259190688Sweongyostatic struct ieee80211vap *uath_vap_create(struct ieee80211com *, 260190688Sweongyo const char name[IFNAMSIZ], int unit, int opmode, 261190688Sweongyo int flags, const uint8_t bssid[IEEE80211_ADDR_LEN], 262190688Sweongyo const uint8_t mac[IEEE80211_ADDR_LEN]); 263190688Sweongyostatic void uath_vap_delete(struct ieee80211vap *); 264190688Sweongyostatic int uath_alloc_cmd_list(struct uath_softc *, struct uath_cmd [], 265190688Sweongyo int, int); 266190688Sweongyostatic void uath_free_cmd_list(struct uath_softc *, struct uath_cmd [], 267190688Sweongyo int); 268190688Sweongyostatic int uath_host_available(struct uath_softc *); 269190688Sweongyostatic int uath_get_capability(struct uath_softc *, uint32_t, uint32_t *); 270190688Sweongyostatic int uath_get_devcap(struct uath_softc *); 271190688Sweongyostatic struct uath_cmd * 272190688Sweongyo uath_get_cmdbuf(struct uath_softc *); 273190688Sweongyostatic int uath_cmd_read(struct uath_softc *, uint32_t, const void *, 274190688Sweongyo int, void *, int, int); 275190688Sweongyostatic int uath_cmd_write(struct uath_softc *, uint32_t, const void *, 276190688Sweongyo int, int); 277190688Sweongyostatic void uath_stat(void *); 278190688Sweongyo#ifdef UATH_DEBUG 279190688Sweongyostatic void uath_dump_cmd(const uint8_t *, int, char); 280190688Sweongyostatic const char * 281190688Sweongyo uath_codename(int); 282190688Sweongyo#endif 283190688Sweongyostatic int uath_get_devstatus(struct uath_softc *, 284190688Sweongyo uint8_t macaddr[IEEE80211_ADDR_LEN]); 285190688Sweongyostatic int uath_get_status(struct uath_softc *, uint32_t, void *, int); 286190688Sweongyostatic int uath_alloc_rx_data_list(struct uath_softc *); 287190688Sweongyostatic int uath_alloc_tx_data_list(struct uath_softc *); 288190688Sweongyostatic void uath_free_rx_data_list(struct uath_softc *); 289190688Sweongyostatic void uath_free_tx_data_list(struct uath_softc *); 290190688Sweongyostatic int uath_init_locked(void *); 291190688Sweongyostatic void uath_init(void *); 292190688Sweongyostatic void uath_stop_locked(struct ifnet *); 293190688Sweongyostatic void uath_stop(struct ifnet *); 294190688Sweongyostatic int uath_ioctl(struct ifnet *, u_long, caddr_t); 295190688Sweongyostatic void uath_start(struct ifnet *); 296190688Sweongyostatic int uath_raw_xmit(struct ieee80211_node *, struct mbuf *, 297190688Sweongyo const struct ieee80211_bpf_params *); 298190688Sweongyostatic void uath_scan_start(struct ieee80211com *); 299190688Sweongyostatic void uath_scan_end(struct ieee80211com *); 300190688Sweongyostatic void uath_set_channel(struct ieee80211com *); 301190688Sweongyostatic void uath_update_mcast(struct ifnet *); 302190688Sweongyostatic void uath_update_promisc(struct ifnet *); 303190688Sweongyostatic int uath_config(struct uath_softc *, uint32_t, uint32_t); 304190688Sweongyostatic int uath_config_multi(struct uath_softc *, uint32_t, const void *, 305190688Sweongyo int); 306190688Sweongyostatic int uath_switch_channel(struct uath_softc *, 307190688Sweongyo struct ieee80211_channel *); 308190688Sweongyostatic int uath_set_rxfilter(struct uath_softc *, uint32_t, uint32_t); 309190688Sweongyostatic void uath_watchdog(void *); 310190688Sweongyostatic void uath_abort_xfers(struct uath_softc *); 311190688Sweongyostatic int uath_dataflush(struct uath_softc *); 312190688Sweongyostatic int uath_cmdflush(struct uath_softc *); 313190688Sweongyostatic int uath_flush(struct uath_softc *); 314190688Sweongyostatic int uath_set_ledstate(struct uath_softc *, int); 315190688Sweongyostatic int uath_set_chan(struct uath_softc *, struct ieee80211_channel *); 316190688Sweongyostatic int uath_reset_tx_queues(struct uath_softc *); 317190688Sweongyostatic int uath_wme_init(struct uath_softc *); 318190688Sweongyostatic struct uath_data * 319190688Sweongyo uath_getbuf(struct uath_softc *); 320190688Sweongyostatic int uath_newstate(struct ieee80211vap *, enum ieee80211_state, 321190688Sweongyo int); 322190688Sweongyostatic int uath_set_key(struct uath_softc *, 323190688Sweongyo const struct ieee80211_key *, int); 324190688Sweongyostatic int uath_set_keys(struct uath_softc *, struct ieee80211vap *); 325190688Sweongyostatic void uath_sysctl_node(struct uath_softc *); 326190688Sweongyo 327190688Sweongyostatic int 328190688Sweongyouath_match(device_t dev) 329190688Sweongyo{ 330190688Sweongyo struct usb2_attach_arg *uaa = device_get_ivars(dev); 331190688Sweongyo 332192499Sthompsa if (uaa->usb_mode != USB_MODE_HOST) 333190688Sweongyo return (ENXIO); 334190688Sweongyo if (uaa->info.bConfigIndex != UATH_CONFIG_INDEX) 335190688Sweongyo return (ENXIO); 336190688Sweongyo if (uaa->info.bIfaceIndex != UATH_IFACE_INDEX) 337190688Sweongyo return (ENXIO); 338190688Sweongyo 339190688Sweongyo return (usb2_lookup_id_by_uaa(uath_devs, sizeof(uath_devs), uaa)); 340190688Sweongyo} 341190688Sweongyo 342190688Sweongyostatic int 343190688Sweongyouath_attach(device_t dev) 344190688Sweongyo{ 345190688Sweongyo struct uath_softc *sc = device_get_softc(dev); 346190688Sweongyo struct usb2_attach_arg *uaa = device_get_ivars(dev); 347190688Sweongyo struct ieee80211com *ic; 348190688Sweongyo struct ifnet *ifp; 349190688Sweongyo uint8_t bands, iface_index = UATH_IFACE_INDEX; /* XXX */ 350190688Sweongyo usb2_error_t error; 351190688Sweongyo uint8_t macaddr[IEEE80211_ADDR_LEN]; 352190688Sweongyo 353190688Sweongyo sc->sc_dev = dev; 354190688Sweongyo sc->sc_udev = uaa->device; 355190688Sweongyo#ifdef UATH_DEBUG 356190688Sweongyo sc->sc_debug = uath_debug; 357190688Sweongyo#endif 358190688Sweongyo 359190688Sweongyo /* 360190688Sweongyo * Only post-firmware devices here. 361190688Sweongyo */ 362190688Sweongyo mtx_init(&sc->sc_mtx, device_get_nameunit(sc->sc_dev), MTX_NETWORK_LOCK, 363190688Sweongyo MTX_DEF); 364190688Sweongyo callout_init(&sc->stat_ch, 0); 365190688Sweongyo callout_init_mtx(&sc->watchdog_ch, &sc->sc_mtx, 0); 366190688Sweongyo 367190688Sweongyo /* 368190688Sweongyo * Allocate xfers for firmware commands. 369190688Sweongyo */ 370190688Sweongyo error = uath_alloc_cmd_list(sc, sc->sc_cmd, UATH_CMD_LIST_COUNT, 371190688Sweongyo UATH_MAX_CMDSZ); 372190688Sweongyo if (error != 0) { 373190688Sweongyo device_printf(sc->sc_dev, 374190688Sweongyo "could not allocate Tx command list\n"); 375190688Sweongyo goto fail; 376190688Sweongyo } 377190688Sweongyo 378190688Sweongyo error = usb2_transfer_setup(uaa->device, &iface_index, sc->sc_xfer, 379190688Sweongyo uath_usbconfig, UATH_N_XFERS, sc, &sc->sc_mtx); 380190688Sweongyo if (error) { 381190688Sweongyo device_printf(dev, "could not allocate USB transfers, " 382190688Sweongyo "err=%s\n", usb2_errstr(error)); 383190688Sweongyo goto fail1; 384190688Sweongyo } 385190688Sweongyo 386190688Sweongyo /* 387190688Sweongyo * We're now ready to send+receive firmware commands. 388190688Sweongyo */ 389190688Sweongyo UATH_LOCK(sc); 390190688Sweongyo error = uath_host_available(sc); 391190688Sweongyo if (error != 0) { 392190688Sweongyo device_printf(sc->sc_dev, "could not initialize adapter\n"); 393190688Sweongyo goto fail3; 394190688Sweongyo } 395190688Sweongyo error = uath_get_devcap(sc); 396190688Sweongyo if (error != 0) { 397190688Sweongyo device_printf(sc->sc_dev, 398190688Sweongyo "could not get device capabilities\n"); 399190688Sweongyo goto fail3; 400190688Sweongyo } 401190688Sweongyo UATH_UNLOCK(sc); 402190688Sweongyo 403190688Sweongyo /* Create device sysctl node. */ 404190688Sweongyo uath_sysctl_node(sc); 405190688Sweongyo 406190688Sweongyo ifp = sc->sc_ifp = if_alloc(IFT_IEEE80211); 407190688Sweongyo if (ifp == NULL) { 408190688Sweongyo device_printf(sc->sc_dev, "can not allocate ifnet\n"); 409190688Sweongyo error = ENXIO; 410190688Sweongyo goto fail2; 411190688Sweongyo } 412190688Sweongyo 413190688Sweongyo UATH_LOCK(sc); 414190688Sweongyo error = uath_get_devstatus(sc, macaddr); 415190688Sweongyo if (error != 0) { 416190688Sweongyo device_printf(sc->sc_dev, "could not get device status\n"); 417190688Sweongyo goto fail4; 418190688Sweongyo } 419190688Sweongyo 420190688Sweongyo /* 421190688Sweongyo * Allocate xfers for Rx/Tx data pipes. 422190688Sweongyo */ 423190688Sweongyo error = uath_alloc_rx_data_list(sc); 424190688Sweongyo if (error != 0) { 425190688Sweongyo device_printf(sc->sc_dev, "could not allocate Rx data list\n"); 426190688Sweongyo goto fail4; 427190688Sweongyo } 428190688Sweongyo error = uath_alloc_tx_data_list(sc); 429190688Sweongyo if (error != 0) { 430190688Sweongyo device_printf(sc->sc_dev, "could not allocate Tx data list\n"); 431190688Sweongyo goto fail4; 432190688Sweongyo } 433190688Sweongyo UATH_UNLOCK(sc); 434190688Sweongyo 435190688Sweongyo ifp->if_softc = sc; 436190688Sweongyo if_initname(ifp, "uath", device_get_unit(sc->sc_dev)); 437190688Sweongyo ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 438190688Sweongyo ifp->if_init = uath_init; 439190688Sweongyo ifp->if_ioctl = uath_ioctl; 440190688Sweongyo ifp->if_start = uath_start; 441190688Sweongyo /* XXX UATH_TX_DATA_LIST_COUNT */ 442190688Sweongyo IFQ_SET_MAXLEN(&ifp->if_snd, IFQ_MAXLEN); 443190688Sweongyo ifp->if_snd.ifq_drv_maxlen = IFQ_MAXLEN; 444190688Sweongyo IFQ_SET_READY(&ifp->if_snd); 445190688Sweongyo 446190688Sweongyo ic = ifp->if_l2com; 447190688Sweongyo ic->ic_ifp = ifp; 448190688Sweongyo ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ 449190688Sweongyo ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */ 450190688Sweongyo 451190688Sweongyo /* set device capabilities */ 452190688Sweongyo ic->ic_caps = 453190688Sweongyo IEEE80211_C_STA | /* station mode */ 454190688Sweongyo IEEE80211_C_MONITOR | /* monitor mode supported */ 455190688Sweongyo IEEE80211_C_TXPMGT | /* tx power management */ 456190688Sweongyo IEEE80211_C_SHPREAMBLE | /* short preamble supported */ 457190688Sweongyo IEEE80211_C_SHSLOT | /* short slot time supported */ 458190688Sweongyo IEEE80211_C_WPA | /* 802.11i */ 459190688Sweongyo IEEE80211_C_BGSCAN | /* capable of bg scanning */ 460190688Sweongyo IEEE80211_C_TXFRAG; /* handle tx frags */ 461190688Sweongyo 462190688Sweongyo /* put a regulatory domain to reveal informations. */ 463190688Sweongyo uath_regdomain = sc->sc_devcap.regDomain; 464190688Sweongyo 465190688Sweongyo bands = 0; 466190688Sweongyo setbit(&bands, IEEE80211_MODE_11B); 467190688Sweongyo setbit(&bands, IEEE80211_MODE_11G); 468190688Sweongyo if ((sc->sc_devcap.analog5GhzRevision & 0xf0) == 0x30) 469190688Sweongyo setbit(&bands, IEEE80211_MODE_11A); 470190688Sweongyo /* XXX turbo */ 471190688Sweongyo ieee80211_init_channels(ic, NULL, &bands); 472190688Sweongyo 473190688Sweongyo ieee80211_ifattach(ic, macaddr); 474190688Sweongyo ic->ic_raw_xmit = uath_raw_xmit; 475190688Sweongyo ic->ic_scan_start = uath_scan_start; 476190688Sweongyo ic->ic_scan_end = uath_scan_end; 477190688Sweongyo ic->ic_set_channel = uath_set_channel; 478190688Sweongyo 479190688Sweongyo ic->ic_vap_create = uath_vap_create; 480190688Sweongyo ic->ic_vap_delete = uath_vap_delete; 481190688Sweongyo ic->ic_update_mcast = uath_update_mcast; 482190688Sweongyo ic->ic_update_promisc = uath_update_promisc; 483190688Sweongyo 484192468Ssam ieee80211_radiotap_attach(ic, 485192468Ssam &sc->sc_txtap.wt_ihdr, sizeof(sc->sc_txtap), 486192468Ssam UATH_TX_RADIOTAP_PRESENT, 487192468Ssam &sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap), 488192468Ssam UATH_RX_RADIOTAP_PRESENT); 489190688Sweongyo 490190688Sweongyo if (bootverbose) 491190688Sweongyo ieee80211_announce(ic); 492190688Sweongyo 493190688Sweongyo return (0); 494190688Sweongyo 495190688Sweongyofail4: if_free(ifp); 496190688Sweongyofail3: UATH_UNLOCK(sc); 497190688Sweongyofail2: usb2_transfer_unsetup(sc->sc_xfer, UATH_N_XFERS); 498190688Sweongyofail1: uath_free_cmd_list(sc, sc->sc_cmd, UATH_CMD_LIST_COUNT); 499190688Sweongyofail: 500190688Sweongyo return (error); 501190688Sweongyo} 502190688Sweongyo 503190688Sweongyostatic int 504190688Sweongyouath_detach(device_t dev) 505190688Sweongyo{ 506190688Sweongyo struct uath_softc *sc = device_get_softc(dev); 507190688Sweongyo struct ifnet *ifp = sc->sc_ifp; 508190688Sweongyo struct ieee80211com *ic = ifp->if_l2com; 509190688Sweongyo 510190688Sweongyo if (!device_is_attached(dev)) 511190688Sweongyo return (0); 512190688Sweongyo 513190688Sweongyo sc->sc_flags |= UATH_FLAG_INVALID; 514190688Sweongyo uath_stop(ifp); 515190688Sweongyo 516190688Sweongyo callout_drain(&sc->stat_ch); 517190688Sweongyo callout_drain(&sc->watchdog_ch); 518190688Sweongyo 519190688Sweongyo usb2_transfer_unsetup(sc->sc_xfer, UATH_N_XFERS); 520192419Sweongyo ieee80211_ifdetach(ic); 521190688Sweongyo 522190688Sweongyo /* free buffers */ 523190688Sweongyo UATH_LOCK(sc); 524190688Sweongyo uath_free_rx_data_list(sc); 525190688Sweongyo uath_free_tx_data_list(sc); 526190688Sweongyo uath_free_cmd_list(sc, sc->sc_cmd, UATH_CMD_LIST_COUNT); 527190688Sweongyo UATH_UNLOCK(sc); 528190688Sweongyo 529190688Sweongyo if_free(ifp); 530190688Sweongyo mtx_destroy(&sc->sc_mtx); 531190688Sweongyo return (0); 532190688Sweongyo} 533190688Sweongyo 534190688Sweongyostatic void 535190688Sweongyouath_free_cmd_list(struct uath_softc *sc, struct uath_cmd cmds[], int ncmd) 536190688Sweongyo{ 537190688Sweongyo int i; 538190688Sweongyo 539190688Sweongyo for (i = 0; i < ncmd; i++) 540190688Sweongyo if (cmds[i].buf != NULL) 541190688Sweongyo free(cmds[i].buf, M_USBDEV); 542190688Sweongyo} 543190688Sweongyo 544190688Sweongyostatic int 545190688Sweongyouath_alloc_cmd_list(struct uath_softc *sc, struct uath_cmd cmds[], 546190688Sweongyo int ncmd, int maxsz) 547190688Sweongyo{ 548190688Sweongyo int i, error; 549190688Sweongyo 550190688Sweongyo STAILQ_INIT(&sc->sc_cmd_active); 551190688Sweongyo STAILQ_INIT(&sc->sc_cmd_pending); 552190688Sweongyo STAILQ_INIT(&sc->sc_cmd_waiting); 553190688Sweongyo STAILQ_INIT(&sc->sc_cmd_inactive); 554190688Sweongyo 555190688Sweongyo for (i = 0; i < ncmd; i++) { 556190688Sweongyo struct uath_cmd *cmd = &cmds[i]; 557190688Sweongyo 558190688Sweongyo cmd->sc = sc; /* backpointer for callbacks */ 559190688Sweongyo cmd->msgid = i; 560190688Sweongyo cmd->buf = malloc(maxsz, M_USBDEV, M_NOWAIT); 561190688Sweongyo if (cmd->buf == NULL) { 562190688Sweongyo device_printf(sc->sc_dev, 563190688Sweongyo "could not allocate xfer buffer\n"); 564190688Sweongyo error = ENOMEM; 565190688Sweongyo goto fail; 566190688Sweongyo } 567190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_cmd_inactive, cmd, next); 568190688Sweongyo UATH_STAT_INC(sc, st_cmd_inactive); 569190688Sweongyo } 570190688Sweongyo return (0); 571190688Sweongyo 572190688Sweongyofail: uath_free_cmd_list(sc, cmds, ncmd); 573190688Sweongyo return (error); 574190688Sweongyo} 575190688Sweongyo 576190688Sweongyostatic int 577190688Sweongyouath_host_available(struct uath_softc *sc) 578190688Sweongyo{ 579190688Sweongyo struct uath_cmd_host_available setup; 580190688Sweongyo 581190688Sweongyo UATH_ASSERT_LOCKED(sc); 582190688Sweongyo 583190688Sweongyo /* inform target the host is available */ 584190688Sweongyo setup.sw_ver_major = htobe32(ATH_SW_VER_MAJOR); 585190688Sweongyo setup.sw_ver_minor = htobe32(ATH_SW_VER_MINOR); 586190688Sweongyo setup.sw_ver_patch = htobe32(ATH_SW_VER_PATCH); 587190688Sweongyo setup.sw_ver_build = htobe32(ATH_SW_VER_BUILD); 588190688Sweongyo return uath_cmd_read(sc, WDCMSG_HOST_AVAILABLE, 589190688Sweongyo &setup, sizeof setup, NULL, 0, 0); 590190688Sweongyo} 591190688Sweongyo 592190688Sweongyo#ifdef UATH_DEBUG 593190688Sweongyostatic void 594190688Sweongyouath_dump_cmd(const uint8_t *buf, int len, char prefix) 595190688Sweongyo{ 596190688Sweongyo const char *sep = ""; 597190688Sweongyo int i; 598190688Sweongyo 599190688Sweongyo for (i = 0; i < len; i++) { 600190688Sweongyo if ((i % 16) == 0) { 601190688Sweongyo printf("%s%c ", sep, prefix); 602190688Sweongyo sep = "\n"; 603190688Sweongyo } 604190688Sweongyo else if ((i % 4) == 0) 605190688Sweongyo printf(" "); 606190688Sweongyo printf("%02x", buf[i]); 607190688Sweongyo } 608190688Sweongyo printf("\n"); 609190688Sweongyo} 610190688Sweongyo 611190688Sweongyostatic const char * 612190688Sweongyouath_codename(int code) 613190688Sweongyo{ 614190688Sweongyo#define N(a) (sizeof(a)/sizeof(a[0])) 615190688Sweongyo static const char *names[] = { 616190688Sweongyo "0x00", 617190688Sweongyo "HOST_AVAILABLE", 618190688Sweongyo "BIND", 619190688Sweongyo "TARGET_RESET", 620190688Sweongyo "TARGET_GET_CAPABILITY", 621190688Sweongyo "TARGET_SET_CONFIG", 622190688Sweongyo "TARGET_GET_STATUS", 623190688Sweongyo "TARGET_GET_STATS", 624190688Sweongyo "TARGET_START", 625190688Sweongyo "TARGET_STOP", 626190688Sweongyo "TARGET_ENABLE", 627190688Sweongyo "TARGET_DISABLE", 628190688Sweongyo "CREATE_CONNECTION", 629190688Sweongyo "UPDATE_CONNECT_ATTR", 630190688Sweongyo "DELETE_CONNECT", 631190688Sweongyo "SEND", 632190688Sweongyo "FLUSH", 633190688Sweongyo "STATS_UPDATE", 634190688Sweongyo "BMISS", 635190688Sweongyo "DEVICE_AVAIL", 636190688Sweongyo "SEND_COMPLETE", 637190688Sweongyo "DATA_AVAIL", 638190688Sweongyo "SET_PWR_MODE", 639190688Sweongyo "BMISS_ACK", 640190688Sweongyo "SET_LED_STEADY", 641190688Sweongyo "SET_LED_BLINK", 642190688Sweongyo "SETUP_BEACON_DESC", 643190688Sweongyo "BEACON_INIT", 644190688Sweongyo "RESET_KEY_CACHE", 645190688Sweongyo "RESET_KEY_CACHE_ENTRY", 646190688Sweongyo "SET_KEY_CACHE_ENTRY", 647190688Sweongyo "SET_DECOMP_MASK", 648190688Sweongyo "SET_REGULATORY_DOMAIN", 649190688Sweongyo "SET_LED_STATE", 650190688Sweongyo "WRITE_ASSOCID", 651190688Sweongyo "SET_STA_BEACON_TIMERS", 652190688Sweongyo "GET_TSF", 653190688Sweongyo "RESET_TSF", 654190688Sweongyo "SET_ADHOC_MODE", 655190688Sweongyo "SET_BASIC_RATE", 656190688Sweongyo "MIB_CONTROL", 657190688Sweongyo "GET_CHANNEL_DATA", 658190688Sweongyo "GET_CUR_RSSI", 659190688Sweongyo "SET_ANTENNA_SWITCH", 660190688Sweongyo "0x2c", "0x2d", "0x2e", 661190688Sweongyo "USE_SHORT_SLOT_TIME", 662190688Sweongyo "SET_POWER_MODE", 663190688Sweongyo "SETUP_PSPOLL_DESC", 664190688Sweongyo "SET_RX_MULTICAST_FILTER", 665190688Sweongyo "RX_FILTER", 666190688Sweongyo "PER_CALIBRATION", 667190688Sweongyo "RESET", 668190688Sweongyo "DISABLE", 669190688Sweongyo "PHY_DISABLE", 670190688Sweongyo "SET_TX_POWER_LIMIT", 671190688Sweongyo "SET_TX_QUEUE_PARAMS", 672190688Sweongyo "SETUP_TX_QUEUE", 673190688Sweongyo "RELEASE_TX_QUEUE", 674190688Sweongyo }; 675190688Sweongyo static char buf[8]; 676190688Sweongyo 677190688Sweongyo if (code < N(names)) 678190688Sweongyo return names[code]; 679190688Sweongyo if (code == WDCMSG_SET_DEFAULT_KEY) 680190688Sweongyo return "SET_DEFAULT_KEY"; 681190688Sweongyo snprintf(buf, sizeof(buf), "0x%02x", code); 682190688Sweongyo return buf; 683190688Sweongyo#undef N 684190688Sweongyo} 685190688Sweongyo#endif 686190688Sweongyo 687190688Sweongyo/* 688190688Sweongyo * Low-level function to send read or write commands to the firmware. 689190688Sweongyo */ 690190688Sweongyostatic int 691190688Sweongyouath_cmdsend(struct uath_softc *sc, uint32_t code, const void *idata, int ilen, 692190688Sweongyo void *odata, int olen, int flags) 693190688Sweongyo{ 694190688Sweongyo struct uath_cmd_hdr *hdr; 695190688Sweongyo struct uath_cmd *cmd; 696190688Sweongyo int error; 697190688Sweongyo 698190688Sweongyo UATH_ASSERT_LOCKED(sc); 699190688Sweongyo 700190688Sweongyo /* grab a xfer */ 701190688Sweongyo cmd = uath_get_cmdbuf(sc); 702190688Sweongyo if (cmd == NULL) { 703190688Sweongyo device_printf(sc->sc_dev, "%s: empty inactive queue\n", 704190688Sweongyo __func__); 705190688Sweongyo return (ENOBUFS); 706190688Sweongyo } 707190688Sweongyo cmd->flags = flags; 708190688Sweongyo /* always bulk-out a multiple of 4 bytes */ 709190688Sweongyo cmd->buflen = roundup2(sizeof(struct uath_cmd_hdr) + ilen, 4); 710190688Sweongyo 711190688Sweongyo hdr = (struct uath_cmd_hdr *)cmd->buf; 712190688Sweongyo bzero(hdr, sizeof (struct uath_cmd_hdr)); /* XXX not needed */ 713190688Sweongyo hdr->len = htobe32(cmd->buflen); 714190688Sweongyo hdr->code = htobe32(code); 715190688Sweongyo hdr->msgid = cmd->msgid; /* don't care about endianness */ 716190688Sweongyo hdr->magic = htobe32((cmd->flags & UATH_CMD_FLAG_MAGIC) ? 1 << 24 : 0); 717190688Sweongyo bcopy(idata, (uint8_t *)(hdr + 1), ilen); 718190688Sweongyo 719190688Sweongyo#ifdef UATH_DEBUG 720190688Sweongyo if (sc->sc_debug & UATH_DEBUG_CMDS) { 721190688Sweongyo printf("%s: send %s [flags 0x%x] olen %d\n", 722190688Sweongyo __func__, uath_codename(code), cmd->flags, olen); 723190688Sweongyo if (sc->sc_debug & UATH_DEBUG_CMDS_DUMP) 724190688Sweongyo uath_dump_cmd(cmd->buf, cmd->buflen, '+'); 725190688Sweongyo } 726190688Sweongyo#endif 727190688Sweongyo cmd->odata = odata; 728190688Sweongyo KASSERT(odata == NULL || 729190688Sweongyo olen < UATH_MAX_CMDSZ - sizeof(*hdr) + sizeof(uint32_t), 730190688Sweongyo ("odata %p olen %u", odata, olen)); 731190688Sweongyo cmd->olen = olen; 732190688Sweongyo 733190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_cmd_pending, cmd, next); 734190688Sweongyo UATH_STAT_INC(sc, st_cmd_pending); 735190688Sweongyo usb2_transfer_start(sc->sc_xfer[UATH_INTR_TX]); 736190688Sweongyo 737190688Sweongyo if (cmd->flags & UATH_CMD_FLAG_READ) { 738190688Sweongyo usb2_transfer_start(sc->sc_xfer[UATH_INTR_RX]); 739190688Sweongyo 740190688Sweongyo /* wait at most two seconds for command reply */ 741190688Sweongyo error = mtx_sleep(cmd, &sc->sc_mtx, 0, "uathcmd", 2 * hz); 742190688Sweongyo cmd->odata = NULL; /* in case reply comes too late */ 743190688Sweongyo if (error != 0) { 744190688Sweongyo device_printf(sc->sc_dev, "timeout waiting for reply " 745190688Sweongyo "to cmd 0x%x (%u)\n", code, code); 746190688Sweongyo } else if (cmd->olen != olen) { 747190688Sweongyo device_printf(sc->sc_dev, "unexpected reply data count " 748190688Sweongyo "to cmd 0x%x (%u), got %u, expected %u\n", 749190688Sweongyo code, code, cmd->olen, olen); 750190688Sweongyo error = EINVAL; 751190688Sweongyo } 752190688Sweongyo return (error); 753190688Sweongyo } 754190688Sweongyo return (0); 755190688Sweongyo} 756190688Sweongyo 757190688Sweongyostatic int 758190688Sweongyouath_cmd_read(struct uath_softc *sc, uint32_t code, const void *idata, 759190688Sweongyo int ilen, void *odata, int olen, int flags) 760190688Sweongyo{ 761190688Sweongyo 762190688Sweongyo flags |= UATH_CMD_FLAG_READ; 763190688Sweongyo return uath_cmdsend(sc, code, idata, ilen, odata, olen, flags); 764190688Sweongyo} 765190688Sweongyo 766190688Sweongyostatic int 767190688Sweongyouath_cmd_write(struct uath_softc *sc, uint32_t code, const void *data, int len, 768190688Sweongyo int flags) 769190688Sweongyo{ 770190688Sweongyo 771190688Sweongyo flags &= ~UATH_CMD_FLAG_READ; 772190688Sweongyo return uath_cmdsend(sc, code, data, len, NULL, 0, flags); 773190688Sweongyo} 774190688Sweongyo 775190688Sweongyostatic struct uath_cmd * 776190688Sweongyouath_get_cmdbuf(struct uath_softc *sc) 777190688Sweongyo{ 778190688Sweongyo struct uath_cmd *uc; 779190688Sweongyo 780190688Sweongyo UATH_ASSERT_LOCKED(sc); 781190688Sweongyo 782190688Sweongyo uc = STAILQ_FIRST(&sc->sc_cmd_inactive); 783190688Sweongyo if (uc != NULL) { 784190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_cmd_inactive, next); 785190688Sweongyo UATH_STAT_DEC(sc, st_cmd_inactive); 786190688Sweongyo } else 787190688Sweongyo uc = NULL; 788190688Sweongyo if (uc == NULL) 789190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, "%s: %s\n", __func__, 790190688Sweongyo "out of command xmit buffers"); 791190688Sweongyo return (uc); 792190688Sweongyo} 793190688Sweongyo 794190688Sweongyo/* 795190688Sweongyo * This function is called periodically (every second) when associated to 796190688Sweongyo * query device statistics. 797190688Sweongyo */ 798190688Sweongyostatic void 799190688Sweongyouath_stat(void *arg) 800190688Sweongyo{ 801190688Sweongyo struct uath_softc *sc = arg; 802190688Sweongyo int error; 803190688Sweongyo 804190688Sweongyo UATH_LOCK(sc); 805190688Sweongyo /* 806190688Sweongyo * Send request for statistics asynchronously. The timer will be 807190688Sweongyo * restarted when we'll get the stats notification. 808190688Sweongyo */ 809190688Sweongyo error = uath_cmd_write(sc, WDCMSG_TARGET_GET_STATS, NULL, 0, 810190688Sweongyo UATH_CMD_FLAG_ASYNC); 811190688Sweongyo if (error != 0) { 812190688Sweongyo device_printf(sc->sc_dev, 813190688Sweongyo "could not query stats, error %d\n", error); 814190688Sweongyo } 815190688Sweongyo UATH_UNLOCK(sc); 816190688Sweongyo} 817190688Sweongyo 818190688Sweongyostatic int 819190688Sweongyouath_get_capability(struct uath_softc *sc, uint32_t cap, uint32_t *val) 820190688Sweongyo{ 821190688Sweongyo int error; 822190688Sweongyo 823190688Sweongyo cap = htobe32(cap); 824190688Sweongyo error = uath_cmd_read(sc, WDCMSG_TARGET_GET_CAPABILITY, 825190688Sweongyo &cap, sizeof cap, val, sizeof(uint32_t), UATH_CMD_FLAG_MAGIC); 826190688Sweongyo if (error != 0) { 827190688Sweongyo device_printf(sc->sc_dev, "could not read capability %u\n", 828190688Sweongyo be32toh(cap)); 829190688Sweongyo return (error); 830190688Sweongyo } 831190688Sweongyo *val = be32toh(*val); 832190688Sweongyo return (error); 833190688Sweongyo} 834190688Sweongyo 835190688Sweongyostatic int 836190688Sweongyouath_get_devcap(struct uath_softc *sc) 837190688Sweongyo{ 838190688Sweongyo#define GETCAP(x, v) do { \ 839190688Sweongyo error = uath_get_capability(sc, x, &v); \ 840190688Sweongyo if (error != 0) \ 841190688Sweongyo return (error); \ 842190688Sweongyo DPRINTF(sc, UATH_DEBUG_DEVCAP, \ 843190688Sweongyo "%s: %s=0x%08x\n", __func__, #x, v); \ 844190688Sweongyo} while (0) 845190688Sweongyo struct uath_devcap *cap = &sc->sc_devcap; 846190688Sweongyo int error; 847190688Sweongyo 848190688Sweongyo /* collect device capabilities */ 849190688Sweongyo GETCAP(CAP_TARGET_VERSION, cap->targetVersion); 850190688Sweongyo GETCAP(CAP_TARGET_REVISION, cap->targetRevision); 851190688Sweongyo GETCAP(CAP_MAC_VERSION, cap->macVersion); 852190688Sweongyo GETCAP(CAP_MAC_REVISION, cap->macRevision); 853190688Sweongyo GETCAP(CAP_PHY_REVISION, cap->phyRevision); 854190688Sweongyo GETCAP(CAP_ANALOG_5GHz_REVISION, cap->analog5GhzRevision); 855190688Sweongyo GETCAP(CAP_ANALOG_2GHz_REVISION, cap->analog2GhzRevision); 856190688Sweongyo 857190688Sweongyo GETCAP(CAP_REG_DOMAIN, cap->regDomain); 858190688Sweongyo GETCAP(CAP_REG_CAP_BITS, cap->regCapBits); 859190688Sweongyo#if 0 860190688Sweongyo /* NB: not supported in rev 1.5 */ 861190688Sweongyo GETCAP(CAP_COUNTRY_CODE, cap->countryCode); 862190688Sweongyo#endif 863190688Sweongyo GETCAP(CAP_WIRELESS_MODES, cap->wirelessModes); 864190688Sweongyo GETCAP(CAP_CHAN_SPREAD_SUPPORT, cap->chanSpreadSupport); 865190688Sweongyo GETCAP(CAP_COMPRESS_SUPPORT, cap->compressSupport); 866190688Sweongyo GETCAP(CAP_BURST_SUPPORT, cap->burstSupport); 867190688Sweongyo GETCAP(CAP_FAST_FRAMES_SUPPORT, cap->fastFramesSupport); 868190688Sweongyo GETCAP(CAP_CHAP_TUNING_SUPPORT, cap->chapTuningSupport); 869190688Sweongyo GETCAP(CAP_TURBOG_SUPPORT, cap->turboGSupport); 870190688Sweongyo GETCAP(CAP_TURBO_PRIME_SUPPORT, cap->turboPrimeSupport); 871190688Sweongyo GETCAP(CAP_DEVICE_TYPE, cap->deviceType); 872190688Sweongyo GETCAP(CAP_WME_SUPPORT, cap->wmeSupport); 873190688Sweongyo GETCAP(CAP_TOTAL_QUEUES, cap->numTxQueues); 874190688Sweongyo GETCAP(CAP_CONNECTION_ID_MAX, cap->connectionIdMax); 875190688Sweongyo 876190688Sweongyo GETCAP(CAP_LOW_5GHZ_CHAN, cap->low5GhzChan); 877190688Sweongyo GETCAP(CAP_HIGH_5GHZ_CHAN, cap->high5GhzChan); 878190688Sweongyo GETCAP(CAP_LOW_2GHZ_CHAN, cap->low2GhzChan); 879190688Sweongyo GETCAP(CAP_HIGH_2GHZ_CHAN, cap->high2GhzChan); 880190688Sweongyo GETCAP(CAP_TWICE_ANTENNAGAIN_5G, cap->twiceAntennaGain5G); 881190688Sweongyo GETCAP(CAP_TWICE_ANTENNAGAIN_2G, cap->twiceAntennaGain2G); 882190688Sweongyo 883190688Sweongyo GETCAP(CAP_CIPHER_AES_CCM, cap->supportCipherAES_CCM); 884190688Sweongyo GETCAP(CAP_CIPHER_TKIP, cap->supportCipherTKIP); 885190688Sweongyo GETCAP(CAP_MIC_TKIP, cap->supportMicTKIP); 886190688Sweongyo 887190688Sweongyo cap->supportCipherWEP = 1; /* NB: always available */ 888190688Sweongyo 889190688Sweongyo return (0); 890190688Sweongyo} 891190688Sweongyo 892190688Sweongyostatic int 893190688Sweongyouath_get_devstatus(struct uath_softc *sc, uint8_t macaddr[IEEE80211_ADDR_LEN]) 894190688Sweongyo{ 895190688Sweongyo int error; 896190688Sweongyo 897190688Sweongyo /* retrieve MAC address */ 898190688Sweongyo error = uath_get_status(sc, ST_MAC_ADDR, macaddr, IEEE80211_ADDR_LEN); 899190688Sweongyo if (error != 0) { 900190688Sweongyo device_printf(sc->sc_dev, "could not read MAC address\n"); 901190688Sweongyo return (error); 902190688Sweongyo } 903190688Sweongyo 904190688Sweongyo error = uath_get_status(sc, ST_SERIAL_NUMBER, 905190688Sweongyo &sc->sc_serial[0], sizeof(sc->sc_serial)); 906190688Sweongyo if (error != 0) { 907190688Sweongyo device_printf(sc->sc_dev, 908190688Sweongyo "could not read device serial number\n"); 909190688Sweongyo return (error); 910190688Sweongyo } 911190688Sweongyo return (0); 912190688Sweongyo} 913190688Sweongyo 914190688Sweongyostatic int 915190688Sweongyouath_get_status(struct uath_softc *sc, uint32_t which, void *odata, int olen) 916190688Sweongyo{ 917190688Sweongyo int error; 918190688Sweongyo 919190688Sweongyo which = htobe32(which); 920190688Sweongyo error = uath_cmd_read(sc, WDCMSG_TARGET_GET_STATUS, 921190688Sweongyo &which, sizeof(which), odata, olen, UATH_CMD_FLAG_MAGIC); 922190688Sweongyo if (error != 0) 923190688Sweongyo device_printf(sc->sc_dev, 924190688Sweongyo "could not read EEPROM offset 0x%02x\n", be32toh(which)); 925190688Sweongyo return (error); 926190688Sweongyo} 927190688Sweongyo 928190688Sweongyostatic void 929190688Sweongyouath_free_data_list(struct uath_softc *sc, struct uath_data data[], int ndata, 930190688Sweongyo int fillmbuf) 931190688Sweongyo{ 932190688Sweongyo int i; 933190688Sweongyo 934190688Sweongyo for (i = 0; i < ndata; i++) { 935190688Sweongyo struct uath_data *dp = &data[i]; 936190688Sweongyo 937190688Sweongyo if (fillmbuf == 1) { 938190688Sweongyo if (dp->m != NULL) { 939190688Sweongyo m_freem(dp->m); 940190688Sweongyo dp->m = NULL; 941190688Sweongyo dp->buf = NULL; 942190688Sweongyo } 943190688Sweongyo } else { 944190688Sweongyo if (dp->buf != NULL) { 945190688Sweongyo free(dp->buf, M_USBDEV); 946190688Sweongyo dp->buf = NULL; 947190688Sweongyo } 948190688Sweongyo } 949190688Sweongyo#ifdef UATH_DEBUG 950190688Sweongyo if (dp->ni != NULL) 951190688Sweongyo device_printf(sc->sc_dev, "Node isn't NULL\n"); 952190688Sweongyo#endif 953190688Sweongyo } 954190688Sweongyo} 955190688Sweongyo 956190688Sweongyostatic int 957190688Sweongyouath_alloc_data_list(struct uath_softc *sc, struct uath_data data[], 958190688Sweongyo int ndata, int maxsz, int fillmbuf) 959190688Sweongyo{ 960190688Sweongyo int i, error; 961190688Sweongyo 962190688Sweongyo for (i = 0; i < ndata; i++) { 963190688Sweongyo struct uath_data *dp = &data[i]; 964190688Sweongyo 965190688Sweongyo dp->sc = sc; 966190688Sweongyo if (fillmbuf) { 967190688Sweongyo /* XXX check maxsz */ 968190688Sweongyo dp->m = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR); 969190688Sweongyo if (dp->m == NULL) { 970190688Sweongyo device_printf(sc->sc_dev, 971190688Sweongyo "could not allocate rx mbuf\n"); 972190688Sweongyo error = ENOMEM; 973190688Sweongyo goto fail; 974190688Sweongyo } 975190688Sweongyo dp->buf = mtod(dp->m, uint8_t *); 976190688Sweongyo } else { 977190688Sweongyo dp->m = NULL; 978190688Sweongyo dp->buf = malloc(maxsz, M_USBDEV, M_NOWAIT); 979190688Sweongyo if (dp->buf == NULL) { 980190688Sweongyo device_printf(sc->sc_dev, 981190688Sweongyo "could not allocate buffer\n"); 982190688Sweongyo error = ENOMEM; 983190688Sweongyo goto fail; 984190688Sweongyo } 985190688Sweongyo } 986190688Sweongyo dp->ni = NULL; 987190688Sweongyo } 988190688Sweongyo 989190688Sweongyo return (0); 990190688Sweongyo 991190688Sweongyofail: uath_free_data_list(sc, data, ndata, fillmbuf); 992190688Sweongyo return (error); 993190688Sweongyo} 994190688Sweongyo 995190688Sweongyostatic int 996190688Sweongyouath_alloc_rx_data_list(struct uath_softc *sc) 997190688Sweongyo{ 998190688Sweongyo int error, i; 999190688Sweongyo 1000190688Sweongyo /* XXX is it enough to store the RX packet with MCLBYTES bytes? */ 1001190688Sweongyo error = uath_alloc_data_list(sc, 1002190688Sweongyo sc->sc_rx, UATH_RX_DATA_LIST_COUNT, MCLBYTES, 1003190688Sweongyo 1 /* setup mbufs */); 1004190688Sweongyo if (error != 0) 1005190688Sweongyo return (error); 1006190688Sweongyo 1007190688Sweongyo STAILQ_INIT(&sc->sc_rx_active); 1008190688Sweongyo STAILQ_INIT(&sc->sc_rx_inactive); 1009190688Sweongyo 1010190688Sweongyo for (i = 0; i < UATH_RX_DATA_LIST_COUNT; i++) { 1011190688Sweongyo STAILQ_INSERT_HEAD(&sc->sc_rx_inactive, &sc->sc_rx[i], 1012190688Sweongyo next); 1013190688Sweongyo UATH_STAT_INC(sc, st_rx_inactive); 1014190688Sweongyo } 1015190688Sweongyo 1016190688Sweongyo return (0); 1017190688Sweongyo} 1018190688Sweongyo 1019190688Sweongyostatic int 1020190688Sweongyouath_alloc_tx_data_list(struct uath_softc *sc) 1021190688Sweongyo{ 1022190688Sweongyo int error, i; 1023190688Sweongyo 1024190688Sweongyo error = uath_alloc_data_list(sc, 1025190688Sweongyo sc->sc_tx, UATH_TX_DATA_LIST_COUNT, UATH_MAX_TXBUFSZ, 1026190688Sweongyo 0 /* no mbufs */); 1027190688Sweongyo if (error != 0) 1028190688Sweongyo return (error); 1029190688Sweongyo 1030190688Sweongyo STAILQ_INIT(&sc->sc_tx_active); 1031190688Sweongyo STAILQ_INIT(&sc->sc_tx_inactive); 1032190688Sweongyo STAILQ_INIT(&sc->sc_tx_pending); 1033190688Sweongyo 1034190688Sweongyo for (i = 0; i < UATH_TX_DATA_LIST_COUNT; i++) { 1035190688Sweongyo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, &sc->sc_tx[i], 1036190688Sweongyo next); 1037190688Sweongyo UATH_STAT_INC(sc, st_tx_inactive); 1038190688Sweongyo } 1039190688Sweongyo 1040190688Sweongyo return (0); 1041190688Sweongyo} 1042190688Sweongyo 1043190688Sweongyostatic void 1044190688Sweongyouath_free_rx_data_list(struct uath_softc *sc) 1045190688Sweongyo{ 1046190688Sweongyo 1047190688Sweongyo STAILQ_INIT(&sc->sc_rx_active); 1048190688Sweongyo STAILQ_INIT(&sc->sc_rx_inactive); 1049190688Sweongyo 1050190688Sweongyo uath_free_data_list(sc, sc->sc_rx, UATH_RX_DATA_LIST_COUNT, 1051190688Sweongyo 1 /* free mbufs */); 1052190688Sweongyo} 1053190688Sweongyo 1054190688Sweongyostatic void 1055190688Sweongyouath_free_tx_data_list(struct uath_softc *sc) 1056190688Sweongyo{ 1057190688Sweongyo 1058190688Sweongyo STAILQ_INIT(&sc->sc_tx_active); 1059190688Sweongyo STAILQ_INIT(&sc->sc_tx_inactive); 1060190688Sweongyo STAILQ_INIT(&sc->sc_tx_pending); 1061190688Sweongyo 1062190688Sweongyo uath_free_data_list(sc, sc->sc_tx, UATH_TX_DATA_LIST_COUNT, 1063190688Sweongyo 0 /* no mbufs */); 1064190688Sweongyo} 1065190688Sweongyo 1066190688Sweongyostatic struct ieee80211vap * 1067190688Sweongyouath_vap_create(struct ieee80211com *ic, 1068190688Sweongyo const char name[IFNAMSIZ], int unit, int opmode, int flags, 1069190688Sweongyo const uint8_t bssid[IEEE80211_ADDR_LEN], 1070190688Sweongyo const uint8_t mac[IEEE80211_ADDR_LEN]) 1071190688Sweongyo{ 1072190688Sweongyo struct uath_vap *uvp; 1073190688Sweongyo struct ieee80211vap *vap; 1074190688Sweongyo 1075190688Sweongyo if (!TAILQ_EMPTY(&ic->ic_vaps)) /* only one at a time */ 1076190688Sweongyo return (NULL); 1077190688Sweongyo uvp = (struct uath_vap *) malloc(sizeof(struct uath_vap), 1078190688Sweongyo M_80211_VAP, M_NOWAIT | M_ZERO); 1079190688Sweongyo if (uvp == NULL) 1080190688Sweongyo return (NULL); 1081190688Sweongyo vap = &uvp->vap; 1082190688Sweongyo /* enable s/w bmiss handling for sta mode */ 1083190688Sweongyo ieee80211_vap_setup(ic, vap, name, unit, opmode, 1084190688Sweongyo flags | IEEE80211_CLONE_NOBEACONS, bssid, mac); 1085190688Sweongyo 1086190688Sweongyo /* override state transition machine */ 1087190688Sweongyo uvp->newstate = vap->iv_newstate; 1088190688Sweongyo vap->iv_newstate = uath_newstate; 1089190688Sweongyo 1090190688Sweongyo /* complete setup */ 1091190688Sweongyo ieee80211_vap_attach(vap, ieee80211_media_change, 1092190688Sweongyo ieee80211_media_status); 1093190688Sweongyo ic->ic_opmode = opmode; 1094190688Sweongyo return (vap); 1095190688Sweongyo} 1096190688Sweongyo 1097190688Sweongyostatic void 1098190688Sweongyouath_vap_delete(struct ieee80211vap *vap) 1099190688Sweongyo{ 1100190688Sweongyo struct uath_vap *uvp = UATH_VAP(vap); 1101190688Sweongyo 1102190688Sweongyo ieee80211_vap_detach(vap); 1103190688Sweongyo free(uvp, M_80211_VAP); 1104190688Sweongyo} 1105190688Sweongyo 1106190688Sweongyostatic int 1107190688Sweongyouath_init_locked(void *arg) 1108190688Sweongyo{ 1109190688Sweongyo struct uath_softc *sc = arg; 1110190688Sweongyo struct ifnet *ifp = sc->sc_ifp; 1111190688Sweongyo struct ieee80211com *ic = ifp->if_l2com; 1112190688Sweongyo uint32_t val; 1113190688Sweongyo int error; 1114190688Sweongyo 1115190688Sweongyo UATH_ASSERT_LOCKED(sc); 1116190688Sweongyo 1117190688Sweongyo if (ifp->if_drv_flags & IFF_DRV_RUNNING) 1118190688Sweongyo uath_stop_locked(ifp); 1119190688Sweongyo 1120190688Sweongyo /* reset variables */ 1121190688Sweongyo sc->sc_intrx_nextnum = sc->sc_msgid = 0; 1122190688Sweongyo 1123190688Sweongyo val = htobe32(0); 1124190688Sweongyo uath_cmd_write(sc, WDCMSG_BIND, &val, sizeof val, 0); 1125190688Sweongyo 1126190688Sweongyo /* set MAC address */ 1127190688Sweongyo uath_config_multi(sc, CFG_MAC_ADDR, IF_LLADDR(ifp), IEEE80211_ADDR_LEN); 1128190688Sweongyo 1129190688Sweongyo /* XXX honor net80211 state */ 1130190688Sweongyo uath_config(sc, CFG_RATE_CONTROL_ENABLE, 0x00000001); 1131190688Sweongyo uath_config(sc, CFG_DIVERSITY_CTL, 0x00000001); 1132190688Sweongyo uath_config(sc, CFG_ABOLT, 0x0000003f); 1133190688Sweongyo uath_config(sc, CFG_WME_ENABLED, 0x00000001); 1134190688Sweongyo 1135190688Sweongyo uath_config(sc, CFG_SERVICE_TYPE, 1); 1136190688Sweongyo uath_config(sc, CFG_TP_SCALE, 0x00000000); 1137190688Sweongyo uath_config(sc, CFG_TPC_HALF_DBM5, 0x0000003c); 1138190688Sweongyo uath_config(sc, CFG_TPC_HALF_DBM2, 0x0000003c); 1139190688Sweongyo uath_config(sc, CFG_OVERRD_TX_POWER, 0x00000000); 1140190688Sweongyo uath_config(sc, CFG_GMODE_PROTECTION, 0x00000000); 1141190688Sweongyo uath_config(sc, CFG_GMODE_PROTECT_RATE_INDEX, 0x00000003); 1142190688Sweongyo uath_config(sc, CFG_PROTECTION_TYPE, 0x00000000); 1143190688Sweongyo uath_config(sc, CFG_MODE_CTS, 0x00000002); 1144190688Sweongyo 1145190688Sweongyo error = uath_cmd_read(sc, WDCMSG_TARGET_START, NULL, 0, 1146190688Sweongyo &val, sizeof(val), UATH_CMD_FLAG_MAGIC); 1147190688Sweongyo if (error) { 1148190688Sweongyo device_printf(sc->sc_dev, 1149190688Sweongyo "could not start target, error %d\n", error); 1150190688Sweongyo goto fail; 1151190688Sweongyo } 1152190688Sweongyo DPRINTF(sc, UATH_DEBUG_INIT, "%s returns handle: 0x%x\n", 1153190688Sweongyo uath_codename(WDCMSG_TARGET_START), be32toh(val)); 1154190688Sweongyo 1155190688Sweongyo /* set default channel */ 1156190688Sweongyo error = uath_switch_channel(sc, ic->ic_curchan); 1157190688Sweongyo if (error) { 1158190688Sweongyo device_printf(sc->sc_dev, 1159190688Sweongyo "could not switch channel, error %d\n", error); 1160190688Sweongyo goto fail; 1161190688Sweongyo } 1162190688Sweongyo 1163190688Sweongyo val = htobe32(TARGET_DEVICE_AWAKE); 1164190688Sweongyo uath_cmd_write(sc, WDCMSG_SET_PWR_MODE, &val, sizeof val, 0); 1165190688Sweongyo /* XXX? check */ 1166190688Sweongyo uath_cmd_write(sc, WDCMSG_RESET_KEY_CACHE, NULL, 0, 0); 1167190688Sweongyo 1168190688Sweongyo usb2_transfer_start(sc->sc_xfer[UATH_BULK_RX]); 1169190688Sweongyo /* enable Rx */ 1170190688Sweongyo uath_set_rxfilter(sc, 0x0, UATH_FILTER_OP_INIT); 1171190688Sweongyo uath_set_rxfilter(sc, 1172190688Sweongyo UATH_FILTER_RX_UCAST | UATH_FILTER_RX_MCAST | 1173190688Sweongyo UATH_FILTER_RX_BCAST | UATH_FILTER_RX_BEACON, 1174190688Sweongyo UATH_FILTER_OP_SET); 1175190688Sweongyo 1176190688Sweongyo ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 1177190688Sweongyo ifp->if_drv_flags |= IFF_DRV_RUNNING; 1178190688Sweongyo sc->sc_flags |= UATH_FLAG_INITDONE; 1179190688Sweongyo 1180190688Sweongyo callout_reset(&sc->watchdog_ch, hz, uath_watchdog, sc); 1181190688Sweongyo 1182190688Sweongyo return (0); 1183190688Sweongyo 1184190688Sweongyofail: 1185190688Sweongyo uath_stop_locked(ifp); 1186190688Sweongyo return (error); 1187190688Sweongyo} 1188190688Sweongyo 1189190688Sweongyostatic void 1190190688Sweongyouath_init(void *arg) 1191190688Sweongyo{ 1192190688Sweongyo struct uath_softc *sc = arg; 1193190688Sweongyo 1194190688Sweongyo UATH_LOCK(sc); 1195190688Sweongyo (void)uath_init_locked(sc); 1196190688Sweongyo UATH_UNLOCK(sc); 1197190688Sweongyo} 1198190688Sweongyo 1199190688Sweongyostatic void 1200190688Sweongyouath_stop_locked(struct ifnet *ifp) 1201190688Sweongyo{ 1202190688Sweongyo struct uath_softc *sc = ifp->if_softc; 1203190688Sweongyo 1204190688Sweongyo UATH_ASSERT_LOCKED(sc); 1205190688Sweongyo 1206190688Sweongyo ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 1207190688Sweongyo sc->sc_flags &= ~UATH_FLAG_INITDONE; 1208190688Sweongyo 1209190688Sweongyo callout_stop(&sc->stat_ch); 1210190688Sweongyo callout_stop(&sc->watchdog_ch); 1211190688Sweongyo sc->sc_tx_timer = 0; 1212190688Sweongyo /* abort pending transmits */ 1213190688Sweongyo uath_abort_xfers(sc); 1214190688Sweongyo /* flush data & control requests into the target */ 1215190688Sweongyo (void)uath_flush(sc); 1216190688Sweongyo /* set a LED status to the disconnected. */ 1217190688Sweongyo uath_set_ledstate(sc, 0); 1218190688Sweongyo /* stop the target */ 1219190688Sweongyo uath_cmd_write(sc, WDCMSG_TARGET_STOP, NULL, 0, 0); 1220190688Sweongyo} 1221190688Sweongyo 1222190688Sweongyostatic void 1223190688Sweongyouath_stop(struct ifnet *ifp) 1224190688Sweongyo{ 1225190688Sweongyo struct uath_softc *sc = ifp->if_softc; 1226190688Sweongyo 1227190688Sweongyo UATH_LOCK(sc); 1228190688Sweongyo uath_stop_locked(ifp); 1229190688Sweongyo UATH_UNLOCK(sc); 1230190688Sweongyo} 1231190688Sweongyo 1232190688Sweongyostatic int 1233190688Sweongyouath_config(struct uath_softc *sc, uint32_t reg, uint32_t val) 1234190688Sweongyo{ 1235190688Sweongyo struct uath_write_mac write; 1236190688Sweongyo int error; 1237190688Sweongyo 1238190688Sweongyo write.reg = htobe32(reg); 1239190688Sweongyo write.len = htobe32(0); /* 0 = single write */ 1240190688Sweongyo *(uint32_t *)write.data = htobe32(val); 1241190688Sweongyo 1242190688Sweongyo error = uath_cmd_write(sc, WDCMSG_TARGET_SET_CONFIG, &write, 1243190688Sweongyo 3 * sizeof (uint32_t), 0); 1244190688Sweongyo if (error != 0) { 1245190688Sweongyo device_printf(sc->sc_dev, "could not write register 0x%02x\n", 1246190688Sweongyo reg); 1247190688Sweongyo } 1248190688Sweongyo return (error); 1249190688Sweongyo} 1250190688Sweongyo 1251190688Sweongyostatic int 1252190688Sweongyouath_config_multi(struct uath_softc *sc, uint32_t reg, const void *data, 1253190688Sweongyo int len) 1254190688Sweongyo{ 1255190688Sweongyo struct uath_write_mac write; 1256190688Sweongyo int error; 1257190688Sweongyo 1258190688Sweongyo write.reg = htobe32(reg); 1259190688Sweongyo write.len = htobe32(len); 1260190688Sweongyo bcopy(data, write.data, len); 1261190688Sweongyo 1262190688Sweongyo /* properly handle the case where len is zero (reset) */ 1263190688Sweongyo error = uath_cmd_write(sc, WDCMSG_TARGET_SET_CONFIG, &write, 1264190688Sweongyo (len == 0) ? sizeof (uint32_t) : 2 * sizeof (uint32_t) + len, 0); 1265190688Sweongyo if (error != 0) { 1266190688Sweongyo device_printf(sc->sc_dev, 1267190688Sweongyo "could not write %d bytes to register 0x%02x\n", len, reg); 1268190688Sweongyo } 1269190688Sweongyo return (error); 1270190688Sweongyo} 1271190688Sweongyo 1272190688Sweongyostatic int 1273190688Sweongyouath_switch_channel(struct uath_softc *sc, struct ieee80211_channel *c) 1274190688Sweongyo{ 1275190688Sweongyo int error; 1276190688Sweongyo 1277190688Sweongyo UATH_ASSERT_LOCKED(sc); 1278190688Sweongyo 1279190688Sweongyo /* set radio frequency */ 1280190688Sweongyo error = uath_set_chan(sc, c); 1281190688Sweongyo if (error) { 1282190688Sweongyo device_printf(sc->sc_dev, 1283190688Sweongyo "could not set channel, error %d\n", error); 1284190688Sweongyo goto failed; 1285190688Sweongyo } 1286190688Sweongyo /* reset Tx rings */ 1287190688Sweongyo error = uath_reset_tx_queues(sc); 1288190688Sweongyo if (error) { 1289190688Sweongyo device_printf(sc->sc_dev, 1290190688Sweongyo "could not reset Tx queues, error %d\n", error); 1291190688Sweongyo goto failed; 1292190688Sweongyo } 1293190688Sweongyo /* set Tx rings WME properties */ 1294190688Sweongyo error = uath_wme_init(sc); 1295190688Sweongyo if (error) { 1296190688Sweongyo device_printf(sc->sc_dev, 1297190688Sweongyo "could not init Tx queues, error %d\n", error); 1298190688Sweongyo goto failed; 1299190688Sweongyo } 1300190688Sweongyo error = uath_set_ledstate(sc, 0); 1301190688Sweongyo if (error) { 1302190688Sweongyo device_printf(sc->sc_dev, 1303190688Sweongyo "could not set led state, error %d\n", error); 1304190688Sweongyo goto failed; 1305190688Sweongyo } 1306190688Sweongyo error = uath_flush(sc); 1307190688Sweongyo if (error) { 1308190688Sweongyo device_printf(sc->sc_dev, 1309190688Sweongyo "could not flush pipes, error %d\n", error); 1310190688Sweongyo goto failed; 1311190688Sweongyo } 1312190688Sweongyofailed: 1313190688Sweongyo return (error); 1314190688Sweongyo} 1315190688Sweongyo 1316190688Sweongyostatic int 1317190688Sweongyouath_set_rxfilter(struct uath_softc *sc, uint32_t bits, uint32_t op) 1318190688Sweongyo{ 1319190688Sweongyo struct uath_cmd_rx_filter rxfilter; 1320190688Sweongyo 1321190688Sweongyo rxfilter.bits = htobe32(bits); 1322190688Sweongyo rxfilter.op = htobe32(op); 1323190688Sweongyo 1324190688Sweongyo DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL, 1325190688Sweongyo "setting Rx filter=0x%x flags=0x%x\n", bits, op); 1326190688Sweongyo return uath_cmd_write(sc, WDCMSG_RX_FILTER, &rxfilter, 1327190688Sweongyo sizeof rxfilter, 0); 1328190688Sweongyo} 1329190688Sweongyo 1330190688Sweongyostatic void 1331190688Sweongyouath_watchdog(void *arg) 1332190688Sweongyo{ 1333190688Sweongyo struct uath_softc *sc = arg; 1334190688Sweongyo struct ifnet *ifp = sc->sc_ifp; 1335190688Sweongyo 1336190688Sweongyo if (sc->sc_tx_timer > 0) { 1337190688Sweongyo if (--sc->sc_tx_timer == 0) { 1338190688Sweongyo device_printf(sc->sc_dev, "device timeout\n"); 1339190688Sweongyo /*uath_init(ifp); XXX needs a process context! */ 1340190688Sweongyo ifp->if_oerrors++; 1341190688Sweongyo return; 1342190688Sweongyo } 1343190688Sweongyo callout_reset(&sc->watchdog_ch, hz, uath_watchdog, sc); 1344190688Sweongyo } 1345190688Sweongyo} 1346190688Sweongyo 1347190688Sweongyostatic void 1348190688Sweongyouath_abort_xfers(struct uath_softc *sc) 1349190688Sweongyo{ 1350190688Sweongyo int i; 1351190688Sweongyo 1352190688Sweongyo UATH_ASSERT_LOCKED(sc); 1353190688Sweongyo /* abort any pending transfers */ 1354190688Sweongyo for (i = 0; i < UATH_N_XFERS; i++) 1355190688Sweongyo usb2_transfer_stop(sc->sc_xfer[i]); 1356190688Sweongyo} 1357190688Sweongyo 1358190688Sweongyostatic int 1359190688Sweongyouath_flush(struct uath_softc *sc) 1360190688Sweongyo{ 1361190688Sweongyo int error; 1362190688Sweongyo 1363190688Sweongyo error = uath_dataflush(sc); 1364190688Sweongyo if (error != 0) 1365190688Sweongyo goto failed; 1366190688Sweongyo 1367190688Sweongyo error = uath_cmdflush(sc); 1368190688Sweongyo if (error != 0) 1369190688Sweongyo goto failed; 1370190688Sweongyo 1371190688Sweongyofailed: 1372190688Sweongyo return (error); 1373190688Sweongyo} 1374190688Sweongyo 1375190688Sweongyostatic int 1376190688Sweongyouath_cmdflush(struct uath_softc *sc) 1377190688Sweongyo{ 1378190688Sweongyo 1379190688Sweongyo return uath_cmd_write(sc, WDCMSG_FLUSH, NULL, 0, 0); 1380190688Sweongyo} 1381190688Sweongyo 1382190688Sweongyostatic int 1383190688Sweongyouath_dataflush(struct uath_softc *sc) 1384190688Sweongyo{ 1385190688Sweongyo struct uath_data *data; 1386190688Sweongyo struct uath_chunk *chunk; 1387190688Sweongyo struct uath_tx_desc *desc; 1388190688Sweongyo 1389190688Sweongyo UATH_ASSERT_LOCKED(sc); 1390190688Sweongyo 1391190688Sweongyo data = uath_getbuf(sc); 1392190688Sweongyo if (data == NULL) 1393190688Sweongyo return (ENOBUFS); 1394190688Sweongyo data->buflen = sizeof(struct uath_chunk) + sizeof(struct uath_tx_desc); 1395190688Sweongyo data->m = NULL; 1396190688Sweongyo data->ni = NULL; 1397190688Sweongyo chunk = (struct uath_chunk *)data->buf; 1398190688Sweongyo desc = (struct uath_tx_desc *)(chunk + 1); 1399190688Sweongyo 1400190688Sweongyo /* one chunk only */ 1401190688Sweongyo chunk->seqnum = 0; 1402190688Sweongyo chunk->flags = UATH_CFLAGS_FINAL; 1403190688Sweongyo chunk->length = htobe16(sizeof (struct uath_tx_desc)); 1404190688Sweongyo 1405190688Sweongyo bzero(desc, sizeof(struct uath_tx_desc)); 1406190688Sweongyo desc->msglen = htobe32(sizeof(struct uath_tx_desc)); 1407190688Sweongyo desc->msgid = (sc->sc_msgid++) + 1; /* don't care about endianness */ 1408190688Sweongyo desc->type = htobe32(WDCMSG_FLUSH); 1409190688Sweongyo desc->txqid = htobe32(0); 1410190688Sweongyo desc->connid = htobe32(0); 1411190688Sweongyo desc->flags = htobe32(0); 1412190688Sweongyo 1413190688Sweongyo#ifdef UATH_DEBUG 1414190688Sweongyo if (sc->sc_debug & UATH_DEBUG_CMDS) { 1415190688Sweongyo DPRINTF(sc, UATH_DEBUG_RESET, "send flush ix %d\n", 1416190688Sweongyo desc->msgid); 1417190688Sweongyo if (sc->sc_debug & UATH_DEBUG_CMDS_DUMP) 1418190688Sweongyo uath_dump_cmd(data->buf, data->buflen, '+'); 1419190688Sweongyo } 1420190688Sweongyo#endif 1421190688Sweongyo 1422190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next); 1423190688Sweongyo UATH_STAT_INC(sc, st_tx_pending); 1424190688Sweongyo sc->sc_tx_timer = 5; 1425190688Sweongyo usb2_transfer_start(sc->sc_xfer[UATH_BULK_TX]); 1426190688Sweongyo 1427190688Sweongyo return (0); 1428190688Sweongyo} 1429190688Sweongyo 1430190688Sweongyostatic struct uath_data * 1431190688Sweongyo_uath_getbuf(struct uath_softc *sc) 1432190688Sweongyo{ 1433190688Sweongyo struct uath_data *bf; 1434190688Sweongyo 1435190688Sweongyo bf = STAILQ_FIRST(&sc->sc_tx_inactive); 1436190688Sweongyo if (bf != NULL) { 1437190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_tx_inactive, next); 1438190688Sweongyo UATH_STAT_DEC(sc, st_tx_inactive); 1439190688Sweongyo } else 1440190688Sweongyo bf = NULL; 1441190688Sweongyo if (bf == NULL) 1442190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, "%s: %s\n", __func__, 1443190688Sweongyo "out of xmit buffers"); 1444190688Sweongyo return (bf); 1445190688Sweongyo} 1446190688Sweongyo 1447190688Sweongyostatic struct uath_data * 1448190688Sweongyouath_getbuf(struct uath_softc *sc) 1449190688Sweongyo{ 1450190688Sweongyo struct uath_data *bf; 1451190688Sweongyo 1452190688Sweongyo UATH_ASSERT_LOCKED(sc); 1453190688Sweongyo 1454190688Sweongyo bf = _uath_getbuf(sc); 1455190688Sweongyo if (bf == NULL) { 1456190688Sweongyo struct ifnet *ifp = sc->sc_ifp; 1457190688Sweongyo 1458190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, "%s: stop queue\n", __func__); 1459190688Sweongyo ifp->if_drv_flags |= IFF_DRV_OACTIVE; 1460190688Sweongyo } 1461190688Sweongyo return (bf); 1462190688Sweongyo} 1463190688Sweongyo 1464190688Sweongyostatic int 1465190688Sweongyouath_set_ledstate(struct uath_softc *sc, int connected) 1466190688Sweongyo{ 1467190688Sweongyo 1468190688Sweongyo DPRINTF(sc, UATH_DEBUG_LED, 1469190688Sweongyo "set led state %sconnected\n", connected ? "" : "!"); 1470190688Sweongyo connected = htobe32(connected); 1471190688Sweongyo return uath_cmd_write(sc, WDCMSG_SET_LED_STATE, 1472190688Sweongyo &connected, sizeof connected, 0); 1473190688Sweongyo} 1474190688Sweongyo 1475190688Sweongyostatic int 1476190688Sweongyouath_set_chan(struct uath_softc *sc, struct ieee80211_channel *c) 1477190688Sweongyo{ 1478190688Sweongyo#ifdef UATH_DEBUG 1479190688Sweongyo struct ifnet *ifp = sc->sc_ifp; 1480190688Sweongyo struct ieee80211com *ic = ifp->if_l2com; 1481190688Sweongyo#endif 1482190688Sweongyo struct uath_cmd_reset reset; 1483190688Sweongyo 1484190688Sweongyo bzero(&reset, sizeof reset); 1485190688Sweongyo if (IEEE80211_IS_CHAN_2GHZ(c)) 1486190688Sweongyo reset.flags |= htobe32(UATH_CHAN_2GHZ); 1487190688Sweongyo if (IEEE80211_IS_CHAN_5GHZ(c)) 1488190688Sweongyo reset.flags |= htobe32(UATH_CHAN_5GHZ); 1489190688Sweongyo /* NB: 11g =>'s 11b so don't specify both OFDM and CCK */ 1490192257Ssam if (IEEE80211_IS_CHAN_OFDM(c)) 1491190688Sweongyo reset.flags |= htobe32(UATH_CHAN_OFDM); 1492192257Ssam else if (IEEE80211_IS_CHAN_CCK(c)) 1493190688Sweongyo reset.flags |= htobe32(UATH_CHAN_CCK); 1494190688Sweongyo /* turbo can be used in either 2GHz or 5GHz */ 1495190688Sweongyo if (c->ic_flags & IEEE80211_CHAN_TURBO) 1496190688Sweongyo reset.flags |= htobe32(UATH_CHAN_TURBO); 1497190688Sweongyo reset.freq = htobe32(c->ic_freq); 1498190688Sweongyo reset.maxrdpower = htobe32(50); /* XXX */ 1499190688Sweongyo reset.channelchange = htobe32(1); 1500190688Sweongyo reset.keeprccontent = htobe32(0); 1501190688Sweongyo 1502190688Sweongyo DPRINTF(sc, UATH_DEBUG_CHANNEL, "set channel %d, flags 0x%x freq %u\n", 1503190688Sweongyo ieee80211_chan2ieee(ic, c), 1504190688Sweongyo be32toh(reset.flags), be32toh(reset.freq)); 1505190688Sweongyo return uath_cmd_write(sc, WDCMSG_RESET, &reset, sizeof reset, 0); 1506190688Sweongyo} 1507190688Sweongyo 1508190688Sweongyostatic int 1509190688Sweongyouath_reset_tx_queues(struct uath_softc *sc) 1510190688Sweongyo{ 1511190688Sweongyo int ac, error; 1512190688Sweongyo 1513190688Sweongyo DPRINTF(sc, UATH_DEBUG_RESET, "%s: reset Tx queues\n", __func__); 1514190688Sweongyo for (ac = 0; ac < 4; ac++) { 1515190688Sweongyo const uint32_t qid = htobe32(ac); 1516190688Sweongyo 1517190688Sweongyo error = uath_cmd_write(sc, WDCMSG_RELEASE_TX_QUEUE, &qid, 1518190688Sweongyo sizeof qid, 0); 1519190688Sweongyo if (error != 0) 1520190688Sweongyo break; 1521190688Sweongyo } 1522190688Sweongyo return (error); 1523190688Sweongyo} 1524190688Sweongyo 1525190688Sweongyostatic int 1526190688Sweongyouath_wme_init(struct uath_softc *sc) 1527190688Sweongyo{ 1528190688Sweongyo /* XXX get from net80211 */ 1529190688Sweongyo static const struct uath_wme_settings uath_wme_11g[4] = { 1530190688Sweongyo { 7, 4, 10, 0, 0 }, /* Background */ 1531190688Sweongyo { 3, 4, 10, 0, 0 }, /* Best-Effort */ 1532190688Sweongyo { 3, 3, 4, 26, 0 }, /* Video */ 1533190688Sweongyo { 2, 2, 3, 47, 0 } /* Voice */ 1534190688Sweongyo }; 1535190688Sweongyo struct uath_cmd_txq_setup qinfo; 1536190688Sweongyo int ac, error; 1537190688Sweongyo 1538190688Sweongyo DPRINTF(sc, UATH_DEBUG_WME, "%s: setup Tx queues\n", __func__); 1539190688Sweongyo for (ac = 0; ac < 4; ac++) { 1540190688Sweongyo qinfo.qid = htobe32(ac); 1541190688Sweongyo qinfo.len = htobe32(sizeof(qinfo.attr)); 1542190688Sweongyo qinfo.attr.priority = htobe32(ac); /* XXX */ 1543190688Sweongyo qinfo.attr.aifs = htobe32(uath_wme_11g[ac].aifsn); 1544190688Sweongyo qinfo.attr.logcwmin = htobe32(uath_wme_11g[ac].logcwmin); 1545190688Sweongyo qinfo.attr.logcwmax = htobe32(uath_wme_11g[ac].logcwmax); 1546190688Sweongyo qinfo.attr.bursttime = htobe32(UATH_TXOP_TO_US( 1547190688Sweongyo uath_wme_11g[ac].txop)); 1548190688Sweongyo qinfo.attr.mode = htobe32(uath_wme_11g[ac].acm);/*XXX? */ 1549190688Sweongyo qinfo.attr.qflags = htobe32(1); /* XXX? */ 1550190688Sweongyo 1551190688Sweongyo error = uath_cmd_write(sc, WDCMSG_SETUP_TX_QUEUE, &qinfo, 1552190688Sweongyo sizeof qinfo, 0); 1553190688Sweongyo if (error != 0) 1554190688Sweongyo break; 1555190688Sweongyo } 1556190688Sweongyo return (error); 1557190688Sweongyo} 1558190688Sweongyo 1559190688Sweongyostatic int 1560190688Sweongyouath_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 1561190688Sweongyo{ 1562190688Sweongyo struct ieee80211com *ic = ifp->if_l2com; 1563190688Sweongyo struct ifreq *ifr = (struct ifreq *) data; 1564190688Sweongyo int error = 0, startall = 0; 1565190688Sweongyo 1566190688Sweongyo switch (cmd) { 1567190688Sweongyo case SIOCSIFFLAGS: 1568190688Sweongyo if (ifp->if_flags & IFF_UP) { 1569190688Sweongyo if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) { 1570190688Sweongyo uath_init(ifp->if_softc); 1571190688Sweongyo startall = 1; 1572190688Sweongyo } 1573190688Sweongyo } else { 1574190688Sweongyo if (ifp->if_drv_flags & IFF_DRV_RUNNING) 1575190688Sweongyo uath_stop(ifp); 1576190688Sweongyo } 1577190688Sweongyo if (startall) 1578190688Sweongyo ieee80211_start_all(ic); 1579190688Sweongyo break; 1580190688Sweongyo case SIOCGIFMEDIA: 1581190688Sweongyo error = ifmedia_ioctl(ifp, ifr, &ic->ic_media, cmd); 1582190688Sweongyo break; 1583190688Sweongyo case SIOCGIFADDR: 1584190688Sweongyo error = ether_ioctl(ifp, cmd, data); 1585190688Sweongyo break; 1586190688Sweongyo default: 1587190688Sweongyo error = EINVAL; 1588190688Sweongyo break; 1589190688Sweongyo } 1590190688Sweongyo 1591190688Sweongyo return (error); 1592190688Sweongyo} 1593190688Sweongyo 1594190688Sweongyostatic int 1595190688Sweongyouath_tx_start(struct uath_softc *sc, struct mbuf *m0, struct ieee80211_node *ni, 1596190688Sweongyo struct uath_data *data) 1597190688Sweongyo{ 1598191746Sthompsa struct ieee80211vap *vap = ni->ni_vap; 1599190688Sweongyo struct uath_chunk *chunk; 1600190688Sweongyo struct uath_tx_desc *desc; 1601190688Sweongyo const struct ieee80211_frame *wh; 1602190688Sweongyo struct ieee80211_key *k; 1603190688Sweongyo int framelen, msglen; 1604190688Sweongyo 1605190688Sweongyo UATH_ASSERT_LOCKED(sc); 1606190688Sweongyo 1607190688Sweongyo data->ni = ni; 1608190688Sweongyo data->m = m0; 1609190688Sweongyo chunk = (struct uath_chunk *)data->buf; 1610190688Sweongyo desc = (struct uath_tx_desc *)(chunk + 1); 1611190688Sweongyo 1612192468Ssam if (ieee80211_radiotap_active_vap(vap)) { 1613190688Sweongyo struct uath_tx_radiotap_header *tap = &sc->sc_txtap; 1614190688Sweongyo 1615190688Sweongyo tap->wt_flags = 0; 1616190688Sweongyo if (m0->m_flags & M_FRAG) 1617190688Sweongyo tap->wt_flags |= IEEE80211_RADIOTAP_F_FRAG; 1618190688Sweongyo 1619192468Ssam ieee80211_radiotap_tx(vap, m0); 1620190688Sweongyo } 1621190688Sweongyo 1622190688Sweongyo wh = mtod(m0, struct ieee80211_frame *); 1623190688Sweongyo if (wh->i_fc[1] & IEEE80211_FC1_WEP) { 1624190688Sweongyo k = ieee80211_crypto_encap(ni, m0); 1625190688Sweongyo if (k == NULL) { 1626190688Sweongyo m_freem(m0); 1627190688Sweongyo return (ENOBUFS); 1628190688Sweongyo } 1629190688Sweongyo 1630190688Sweongyo /* packet header may have moved, reset our local pointer */ 1631190688Sweongyo wh = mtod(m0, struct ieee80211_frame *); 1632190688Sweongyo } 1633190688Sweongyo m_copydata(m0, 0, m0->m_pkthdr.len, (uint8_t *)(desc + 1)); 1634190688Sweongyo 1635190688Sweongyo framelen = m0->m_pkthdr.len + IEEE80211_CRC_LEN; 1636190688Sweongyo msglen = framelen + sizeof (struct uath_tx_desc); 1637190688Sweongyo data->buflen = msglen + sizeof (struct uath_chunk); 1638190688Sweongyo 1639190688Sweongyo /* one chunk only for now */ 1640190688Sweongyo chunk->seqnum = sc->sc_seqnum++; 1641190688Sweongyo chunk->flags = (m0->m_flags & M_FRAG) ? 0 : UATH_CFLAGS_FINAL; 1642190688Sweongyo if (m0->m_flags & M_LASTFRAG) 1643190688Sweongyo chunk->flags |= UATH_CFLAGS_FINAL; 1644190688Sweongyo chunk->flags = UATH_CFLAGS_FINAL; 1645190688Sweongyo chunk->length = htobe16(msglen); 1646190688Sweongyo 1647190688Sweongyo /* fill Tx descriptor */ 1648190688Sweongyo desc->msglen = htobe32(msglen); 1649190688Sweongyo /* NB: to get UATH_TX_NOTIFY reply, `msgid' must be larger than 0 */ 1650190688Sweongyo desc->msgid = (sc->sc_msgid++) + 1; /* don't care about endianness */ 1651190688Sweongyo desc->type = htobe32(WDCMSG_SEND); 1652190688Sweongyo switch (wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) { 1653190688Sweongyo case IEEE80211_FC0_TYPE_CTL: 1654190688Sweongyo case IEEE80211_FC0_TYPE_MGT: 1655190688Sweongyo /* NB: force all management frames to highest queue */ 1656190688Sweongyo if (ni->ni_flags & IEEE80211_NODE_QOS) { 1657190688Sweongyo /* NB: force all management frames to highest queue */ 1658190688Sweongyo desc->txqid = htobe32(WME_AC_VO | UATH_TXQID_MINRATE); 1659190688Sweongyo } else 1660190688Sweongyo desc->txqid = htobe32(WME_AC_BE | UATH_TXQID_MINRATE); 1661190688Sweongyo break; 1662190688Sweongyo case IEEE80211_FC0_TYPE_DATA: 1663190688Sweongyo /* XXX multicast frames should honor mcastrate */ 1664190688Sweongyo desc->txqid = htobe32(M_WME_GETAC(m0)); 1665190688Sweongyo break; 1666190688Sweongyo default: 1667190688Sweongyo device_printf(sc->sc_dev, "bogus frame type 0x%x (%s)\n", 1668190688Sweongyo wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK, __func__); 1669190688Sweongyo m_freem(m0); 1670190688Sweongyo return (EIO); 1671190688Sweongyo } 1672191746Sthompsa if (vap->iv_state == IEEE80211_S_AUTH || 1673191746Sthompsa vap->iv_state == IEEE80211_S_ASSOC || 1674191746Sthompsa vap->iv_state == IEEE80211_S_RUN) 1675190688Sweongyo desc->connid = htobe32(UATH_ID_BSS); 1676190688Sweongyo else 1677190688Sweongyo desc->connid = htobe32(UATH_ID_INVALID); 1678190688Sweongyo desc->flags = htobe32(0 /* no UATH_TX_NOTIFY */); 1679190688Sweongyo desc->buflen = htobe32(m0->m_pkthdr.len); 1680190688Sweongyo 1681190688Sweongyo#ifdef UATH_DEBUG 1682190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, 1683190688Sweongyo "send frame ix %u framelen %d msglen %d connid 0x%x txqid 0x%x\n", 1684190688Sweongyo desc->msgid, framelen, msglen, be32toh(desc->connid), 1685190688Sweongyo be32toh(desc->txqid)); 1686190688Sweongyo if (sc->sc_debug & UATH_DEBUG_XMIT_DUMP) 1687190688Sweongyo uath_dump_cmd(data->buf, data->buflen, '+'); 1688190688Sweongyo#endif 1689190688Sweongyo 1690190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next); 1691190688Sweongyo UATH_STAT_INC(sc, st_tx_pending); 1692190688Sweongyo usb2_transfer_start(sc->sc_xfer[UATH_BULK_TX]); 1693190688Sweongyo 1694190688Sweongyo return (0); 1695190688Sweongyo} 1696190688Sweongyo 1697190688Sweongyo/* 1698190688Sweongyo * Cleanup driver resources when we run out of buffers while processing 1699190688Sweongyo * fragments; return the tx buffers allocated and drop node references. 1700190688Sweongyo */ 1701190688Sweongyostatic void 1702190688Sweongyouath_txfrag_cleanup(struct uath_softc *sc, 1703190688Sweongyo uath_datahead *frags, struct ieee80211_node *ni) 1704190688Sweongyo{ 1705190688Sweongyo struct uath_data *bf, *next; 1706190688Sweongyo 1707190688Sweongyo UATH_ASSERT_LOCKED(sc); 1708190688Sweongyo 1709190688Sweongyo STAILQ_FOREACH_SAFE(bf, frags, next, next) { 1710190688Sweongyo /* NB: bf assumed clean */ 1711190688Sweongyo STAILQ_REMOVE_HEAD(frags, next); 1712190688Sweongyo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 1713190688Sweongyo UATH_STAT_INC(sc, st_tx_inactive); 1714190688Sweongyo ieee80211_node_decref(ni); 1715190688Sweongyo } 1716190688Sweongyo} 1717190688Sweongyo 1718190688Sweongyo/* 1719190688Sweongyo * Setup xmit of a fragmented frame. Allocate a buffer for each frag and bump 1720190688Sweongyo * the node reference count to reflect the held reference to be setup by 1721190688Sweongyo * uath_tx_start. 1722190688Sweongyo */ 1723190688Sweongyostatic int 1724190688Sweongyouath_txfrag_setup(struct uath_softc *sc, uath_datahead *frags, 1725190688Sweongyo struct mbuf *m0, struct ieee80211_node *ni) 1726190688Sweongyo{ 1727190688Sweongyo struct mbuf *m; 1728190688Sweongyo struct uath_data *bf; 1729190688Sweongyo 1730190688Sweongyo UATH_ASSERT_LOCKED(sc); 1731190688Sweongyo for (m = m0->m_nextpkt; m != NULL; m = m->m_nextpkt) { 1732190688Sweongyo bf = uath_getbuf(sc); 1733190688Sweongyo if (bf == NULL) { /* out of buffers, cleanup */ 1734190688Sweongyo uath_txfrag_cleanup(sc, frags, ni); 1735190688Sweongyo break; 1736190688Sweongyo } 1737190688Sweongyo ieee80211_node_incref(ni); 1738190688Sweongyo STAILQ_INSERT_TAIL(frags, bf, next); 1739190688Sweongyo } 1740190688Sweongyo 1741190688Sweongyo return !STAILQ_EMPTY(frags); 1742190688Sweongyo} 1743190688Sweongyo 1744190688Sweongyo/* 1745190688Sweongyo * Reclaim mbuf resources. For fragmented frames we need to claim each frag 1746190688Sweongyo * chained with m_nextpkt. 1747190688Sweongyo */ 1748190688Sweongyostatic void 1749190688Sweongyouath_freetx(struct mbuf *m) 1750190688Sweongyo{ 1751190688Sweongyo struct mbuf *next; 1752190688Sweongyo 1753190688Sweongyo do { 1754190688Sweongyo next = m->m_nextpkt; 1755190688Sweongyo m->m_nextpkt = NULL; 1756190688Sweongyo m_freem(m); 1757190688Sweongyo } while ((m = next) != NULL); 1758190688Sweongyo} 1759190688Sweongyo 1760190688Sweongyostatic void 1761190688Sweongyouath_start(struct ifnet *ifp) 1762190688Sweongyo{ 1763190688Sweongyo struct uath_data *bf; 1764190688Sweongyo struct uath_softc *sc = ifp->if_softc; 1765190688Sweongyo struct ieee80211_node *ni; 1766190688Sweongyo struct mbuf *m, *next; 1767190688Sweongyo uath_datahead frags; 1768190688Sweongyo 1769190688Sweongyo if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0 || 1770190688Sweongyo (sc->sc_flags & UATH_FLAG_INVALID)) 1771190688Sweongyo return; 1772190688Sweongyo 1773190688Sweongyo UATH_LOCK(sc); 1774190688Sweongyo for (;;) { 1775190688Sweongyo bf = uath_getbuf(sc); 1776190688Sweongyo if (bf == NULL) 1777190688Sweongyo break; 1778190688Sweongyo 1779190688Sweongyo IFQ_DRV_DEQUEUE(&ifp->if_snd, m); 1780190688Sweongyo if (m == NULL) { 1781190688Sweongyo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 1782190688Sweongyo UATH_STAT_INC(sc, st_tx_inactive); 1783190688Sweongyo break; 1784190688Sweongyo } 1785190688Sweongyo ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 1786190688Sweongyo m->m_pkthdr.rcvif = NULL; 1787190688Sweongyo 1788190688Sweongyo /* 1789190688Sweongyo * Check for fragmentation. If this frame has been broken up 1790190688Sweongyo * verify we have enough buffers to send all the fragments 1791190688Sweongyo * so all go out or none... 1792190688Sweongyo */ 1793190688Sweongyo STAILQ_INIT(&frags); 1794190688Sweongyo if ((m->m_flags & M_FRAG) && 1795190688Sweongyo !uath_txfrag_setup(sc, &frags, m, ni)) { 1796190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, 1797190688Sweongyo "%s: out of txfrag buffers\n", __func__); 1798190688Sweongyo uath_freetx(m); 1799190688Sweongyo goto bad; 1800190688Sweongyo } 1801190688Sweongyo sc->sc_seqnum = 0; 1802190688Sweongyo nextfrag: 1803190688Sweongyo /* 1804190688Sweongyo * Pass the frame to the h/w for transmission. 1805190688Sweongyo * Fragmented frames have each frag chained together 1806190688Sweongyo * with m_nextpkt. We know there are sufficient uath_data's 1807190688Sweongyo * to send all the frags because of work done by 1808190688Sweongyo * uath_txfrag_setup. 1809190688Sweongyo */ 1810190688Sweongyo next = m->m_nextpkt; 1811190688Sweongyo if (uath_tx_start(sc, m, ni, bf) != 0) { 1812190688Sweongyo bad: 1813190688Sweongyo ifp->if_oerrors++; 1814190688Sweongyo reclaim: 1815190688Sweongyo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 1816190688Sweongyo UATH_STAT_INC(sc, st_tx_inactive); 1817190688Sweongyo uath_txfrag_cleanup(sc, &frags, ni); 1818190688Sweongyo ieee80211_free_node(ni); 1819190688Sweongyo continue; 1820190688Sweongyo } 1821190688Sweongyo 1822190688Sweongyo if (next != NULL) { 1823190688Sweongyo /* 1824190688Sweongyo * Beware of state changing between frags. 1825190688Sweongyo XXX check sta power-save state? 1826190688Sweongyo */ 1827190688Sweongyo if (ni->ni_vap->iv_state != IEEE80211_S_RUN) { 1828190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, 1829190688Sweongyo "%s: flush fragmented packet, state %s\n", 1830190688Sweongyo __func__, 1831190688Sweongyo ieee80211_state_name[ni->ni_vap->iv_state]); 1832190688Sweongyo uath_freetx(next); 1833190688Sweongyo goto reclaim; 1834190688Sweongyo } 1835190688Sweongyo m = next; 1836190688Sweongyo bf = STAILQ_FIRST(&frags); 1837190688Sweongyo KASSERT(bf != NULL, ("no buf for txfrag")); 1838190688Sweongyo STAILQ_REMOVE_HEAD(&frags, next); 1839190688Sweongyo goto nextfrag; 1840190688Sweongyo } 1841190688Sweongyo 1842190688Sweongyo sc->sc_tx_timer = 5; 1843190688Sweongyo } 1844190688Sweongyo UATH_UNLOCK(sc); 1845190688Sweongyo} 1846190688Sweongyo 1847190688Sweongyostatic int 1848190688Sweongyouath_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 1849190688Sweongyo const struct ieee80211_bpf_params *params) 1850190688Sweongyo{ 1851190688Sweongyo struct ieee80211com *ic = ni->ni_ic; 1852190688Sweongyo struct ifnet *ifp = ic->ic_ifp; 1853190688Sweongyo struct uath_data *bf; 1854190688Sweongyo struct uath_softc *sc = ifp->if_softc; 1855190688Sweongyo 1856190688Sweongyo /* prevent management frames from being sent if we're not ready */ 1857190688Sweongyo if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) { 1858190688Sweongyo m_freem(m); 1859190688Sweongyo ieee80211_free_node(ni); 1860190688Sweongyo return (ENETDOWN); 1861190688Sweongyo } 1862190688Sweongyo 1863190688Sweongyo UATH_LOCK(sc); 1864190688Sweongyo /* grab a TX buffer */ 1865190688Sweongyo bf = uath_getbuf(sc); 1866190688Sweongyo if (bf == NULL) { 1867190688Sweongyo ieee80211_free_node(ni); 1868190688Sweongyo m_freem(m); 1869190688Sweongyo UATH_UNLOCK(sc); 1870190688Sweongyo return (ENOBUFS); 1871190688Sweongyo } 1872190688Sweongyo 1873190688Sweongyo sc->sc_seqnum = 0; 1874190688Sweongyo if (uath_tx_start(sc, m, ni, bf) != 0) { 1875190688Sweongyo ieee80211_free_node(ni); 1876190688Sweongyo ifp->if_oerrors++; 1877190688Sweongyo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 1878190688Sweongyo UATH_STAT_INC(sc, st_tx_inactive); 1879190688Sweongyo UATH_UNLOCK(sc); 1880190688Sweongyo return (EIO); 1881190688Sweongyo } 1882190688Sweongyo UATH_UNLOCK(sc); 1883190688Sweongyo 1884190688Sweongyo sc->sc_tx_timer = 5; 1885190688Sweongyo return (0); 1886190688Sweongyo} 1887190688Sweongyo 1888190688Sweongyostatic void 1889190688Sweongyouath_scan_start(struct ieee80211com *ic) 1890190688Sweongyo{ 1891190688Sweongyo /* do nothing */ 1892190688Sweongyo} 1893190688Sweongyo 1894190688Sweongyostatic void 1895190688Sweongyouath_scan_end(struct ieee80211com *ic) 1896190688Sweongyo{ 1897190688Sweongyo /* do nothing */ 1898190688Sweongyo} 1899190688Sweongyo 1900190688Sweongyostatic void 1901190688Sweongyouath_set_channel(struct ieee80211com *ic) 1902190688Sweongyo{ 1903190688Sweongyo struct ifnet *ifp = ic->ic_ifp; 1904190688Sweongyo struct uath_softc *sc = ifp->if_softc; 1905190688Sweongyo 1906190688Sweongyo UATH_LOCK(sc); 1907190688Sweongyo (void)uath_switch_channel(sc, ic->ic_curchan); 1908190688Sweongyo UATH_UNLOCK(sc); 1909190688Sweongyo} 1910190688Sweongyo 1911190688Sweongyostatic int 1912190688Sweongyouath_set_rxmulti_filter(struct uath_softc *sc) 1913190688Sweongyo{ 1914192468Ssam /* XXX broken */ 1915190688Sweongyo return (0); 1916190688Sweongyo} 1917190688Sweongyostatic void 1918190688Sweongyouath_update_mcast(struct ifnet *ifp) 1919190688Sweongyo{ 1920190688Sweongyo struct uath_softc *sc = ifp->if_softc; 1921190688Sweongyo 1922192468Ssam UATH_LOCK(sc); 1923190688Sweongyo /* 1924190688Sweongyo * this is for avoiding the race condition when we're try to 1925190688Sweongyo * connect to the AP with WPA. 1926190688Sweongyo */ 1927192468Ssam if (sc->sc_flags & UATH_FLAG_INITDONE) 1928192468Ssam (void)uath_set_rxmulti_filter(sc); 1929192468Ssam UATH_UNLOCK(sc); 1930190688Sweongyo} 1931190688Sweongyo 1932190688Sweongyostatic void 1933190688Sweongyouath_update_promisc(struct ifnet *ifp) 1934190688Sweongyo{ 1935190688Sweongyo struct uath_softc *sc = ifp->if_softc; 1936190688Sweongyo 1937192468Ssam UATH_LOCK(sc); 1938192468Ssam if (sc->sc_flags & UATH_FLAG_INITDONE) { 1939192468Ssam uath_set_rxfilter(sc, 1940192468Ssam UATH_FILTER_RX_UCAST | UATH_FILTER_RX_MCAST | 1941192468Ssam UATH_FILTER_RX_BCAST | UATH_FILTER_RX_BEACON | 1942192468Ssam UATH_FILTER_RX_PROM, UATH_FILTER_OP_SET); 1943192468Ssam } 1944192468Ssam UATH_UNLOCK(sc); 1945190688Sweongyo} 1946190688Sweongyo 1947190688Sweongyostatic int 1948190688Sweongyouath_create_connection(struct uath_softc *sc, uint32_t connid) 1949190688Sweongyo{ 1950190688Sweongyo const struct ieee80211_rateset *rs; 1951190688Sweongyo struct ieee80211com *ic = sc->sc_ifp->if_l2com; 1952190688Sweongyo struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 1953190688Sweongyo struct ieee80211_node *ni = vap->iv_bss; 1954190688Sweongyo struct uath_cmd_create_connection create; 1955190688Sweongyo 1956190688Sweongyo bzero(&create, sizeof create); 1957190688Sweongyo create.connid = htobe32(connid); 1958190688Sweongyo create.bssid = htobe32(0); 1959190688Sweongyo /* XXX packed or not? */ 1960190688Sweongyo create.size = htobe32(sizeof(struct uath_cmd_rateset)); 1961190688Sweongyo 1962190688Sweongyo rs = &ni->ni_rates; 1963190688Sweongyo create.connattr.rateset.length = rs->rs_nrates; 1964190688Sweongyo bcopy(rs->rs_rates, &create.connattr.rateset.set[0], 1965190688Sweongyo rs->rs_nrates); 1966190688Sweongyo 1967190688Sweongyo /* XXX turbo */ 1968190688Sweongyo if (IEEE80211_IS_CHAN_A(ni->ni_chan)) 1969190688Sweongyo create.connattr.wlanmode = htobe32(WLAN_MODE_11a); 1970190688Sweongyo else if (IEEE80211_IS_CHAN_ANYG(ni->ni_chan)) 1971190688Sweongyo create.connattr.wlanmode = htobe32(WLAN_MODE_11g); 1972190688Sweongyo else 1973190688Sweongyo create.connattr.wlanmode = htobe32(WLAN_MODE_11b); 1974190688Sweongyo 1975190688Sweongyo return uath_cmd_write(sc, WDCMSG_CREATE_CONNECTION, &create, 1976190688Sweongyo sizeof create, 0); 1977190688Sweongyo} 1978190688Sweongyo 1979190688Sweongyostatic int 1980190688Sweongyouath_set_rates(struct uath_softc *sc, const struct ieee80211_rateset *rs) 1981190688Sweongyo{ 1982190688Sweongyo struct uath_cmd_rates rates; 1983190688Sweongyo 1984190688Sweongyo bzero(&rates, sizeof rates); 1985190688Sweongyo rates.connid = htobe32(UATH_ID_BSS); /* XXX */ 1986190688Sweongyo rates.size = htobe32(sizeof(struct uath_cmd_rateset)); 1987190688Sweongyo /* XXX bounds check rs->rs_nrates */ 1988190688Sweongyo rates.rateset.length = rs->rs_nrates; 1989190688Sweongyo bcopy(rs->rs_rates, &rates.rateset.set[0], rs->rs_nrates); 1990190688Sweongyo 1991190688Sweongyo DPRINTF(sc, UATH_DEBUG_RATES, 1992190688Sweongyo "setting supported rates nrates=%d\n", rs->rs_nrates); 1993190688Sweongyo return uath_cmd_write(sc, WDCMSG_SET_BASIC_RATE, 1994190688Sweongyo &rates, sizeof rates, 0); 1995190688Sweongyo} 1996190688Sweongyo 1997190688Sweongyostatic int 1998190688Sweongyouath_write_associd(struct uath_softc *sc) 1999190688Sweongyo{ 2000190688Sweongyo struct ieee80211com *ic = sc->sc_ifp->if_l2com; 2001190688Sweongyo struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 2002190688Sweongyo struct ieee80211_node *ni = vap->iv_bss; 2003190688Sweongyo struct uath_cmd_set_associd associd; 2004190688Sweongyo 2005190688Sweongyo bzero(&associd, sizeof associd); 2006190688Sweongyo associd.defaultrateix = htobe32(1); /* XXX */ 2007190688Sweongyo associd.associd = htobe32(ni->ni_associd); 2008190688Sweongyo associd.timoffset = htobe32(0x3b); /* XXX */ 2009190688Sweongyo IEEE80211_ADDR_COPY(associd.bssid, ni->ni_bssid); 2010190688Sweongyo return uath_cmd_write(sc, WDCMSG_WRITE_ASSOCID, &associd, 2011190688Sweongyo sizeof associd, 0); 2012190688Sweongyo} 2013190688Sweongyo 2014190688Sweongyostatic int 2015190688Sweongyouath_set_ledsteady(struct uath_softc *sc, int lednum, int ledmode) 2016190688Sweongyo{ 2017190688Sweongyo struct uath_cmd_ledsteady led; 2018190688Sweongyo 2019190688Sweongyo led.lednum = htobe32(lednum); 2020190688Sweongyo led.ledmode = htobe32(ledmode); 2021190688Sweongyo 2022190688Sweongyo DPRINTF(sc, UATH_DEBUG_LED, "set %s led %s (steady)\n", 2023190688Sweongyo (lednum == UATH_LED_LINK) ? "link" : "activity", 2024190688Sweongyo ledmode ? "on" : "off"); 2025190688Sweongyo return uath_cmd_write(sc, WDCMSG_SET_LED_STEADY, &led, sizeof led, 0); 2026190688Sweongyo} 2027190688Sweongyo 2028190688Sweongyostatic int 2029190688Sweongyouath_set_ledblink(struct uath_softc *sc, int lednum, int ledmode, 2030190688Sweongyo int blinkrate, int slowmode) 2031190688Sweongyo{ 2032190688Sweongyo struct uath_cmd_ledblink led; 2033190688Sweongyo 2034190688Sweongyo led.lednum = htobe32(lednum); 2035190688Sweongyo led.ledmode = htobe32(ledmode); 2036190688Sweongyo led.blinkrate = htobe32(blinkrate); 2037190688Sweongyo led.slowmode = htobe32(slowmode); 2038190688Sweongyo 2039190688Sweongyo DPRINTF(sc, UATH_DEBUG_LED, "set %s led %s (blink)\n", 2040190688Sweongyo (lednum == UATH_LED_LINK) ? "link" : "activity", 2041190688Sweongyo ledmode ? "on" : "off"); 2042190688Sweongyo return uath_cmd_write(sc, WDCMSG_SET_LED_BLINK, &led, sizeof led, 0); 2043190688Sweongyo} 2044190688Sweongyo 2045190688Sweongyostatic int 2046190688Sweongyouath_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 2047190688Sweongyo{ 2048190688Sweongyo enum ieee80211_state ostate = vap->iv_state; 2049190688Sweongyo int error; 2050190688Sweongyo struct ieee80211_node *ni = vap->iv_bss; 2051190688Sweongyo struct ieee80211com *ic = vap->iv_ic; 2052190688Sweongyo struct uath_softc *sc = ic->ic_ifp->if_softc; 2053190688Sweongyo struct uath_vap *uvp = UATH_VAP(vap); 2054190688Sweongyo 2055190688Sweongyo DPRINTF(sc, UATH_DEBUG_STATE, 2056190688Sweongyo "%s: %s -> %s\n", __func__, ieee80211_state_name[vap->iv_state], 2057190688Sweongyo ieee80211_state_name[nstate]); 2058190688Sweongyo 2059191746Sthompsa IEEE80211_UNLOCK(ic); 2060190688Sweongyo UATH_LOCK(sc); 2061190688Sweongyo callout_stop(&sc->stat_ch); 2062190688Sweongyo callout_stop(&sc->watchdog_ch); 2063190688Sweongyo 2064190688Sweongyo switch (nstate) { 2065190688Sweongyo case IEEE80211_S_INIT: 2066190688Sweongyo if (ostate == IEEE80211_S_RUN) { 2067190688Sweongyo /* turn link and activity LEDs off */ 2068190688Sweongyo uath_set_ledstate(sc, 0); 2069190688Sweongyo } 2070190688Sweongyo break; 2071190688Sweongyo 2072190688Sweongyo case IEEE80211_S_SCAN: 2073190688Sweongyo break; 2074190688Sweongyo 2075190688Sweongyo case IEEE80211_S_AUTH: 2076190688Sweongyo /* XXX good place? set RTS threshold */ 2077190688Sweongyo uath_config(sc, CFG_USER_RTS_THRESHOLD, vap->iv_rtsthreshold); 2078190688Sweongyo /* XXX bad place */ 2079190688Sweongyo error = uath_set_keys(sc, vap); 2080190688Sweongyo if (error != 0) { 2081190688Sweongyo device_printf(sc->sc_dev, 2082190688Sweongyo "could not set crypto keys, error %d\n", error); 2083190688Sweongyo break; 2084190688Sweongyo } 2085190688Sweongyo if (uath_switch_channel(sc, ni->ni_chan) != 0) { 2086190688Sweongyo device_printf(sc->sc_dev, "could not switch channel\n"); 2087190688Sweongyo break; 2088190688Sweongyo } 2089190688Sweongyo if (uath_create_connection(sc, UATH_ID_BSS) != 0) { 2090190688Sweongyo device_printf(sc->sc_dev, 2091190688Sweongyo "could not create connection\n"); 2092190688Sweongyo break; 2093190688Sweongyo } 2094190688Sweongyo break; 2095190688Sweongyo 2096190688Sweongyo case IEEE80211_S_ASSOC: 2097190688Sweongyo if (uath_set_rates(sc, &ni->ni_rates) != 0) { 2098190688Sweongyo device_printf(sc->sc_dev, 2099190688Sweongyo "could not set negotiated rate set\n"); 2100190688Sweongyo break; 2101190688Sweongyo } 2102190688Sweongyo break; 2103190688Sweongyo 2104190688Sweongyo case IEEE80211_S_RUN: 2105190688Sweongyo /* XXX monitor mode doesn't be tested */ 2106190688Sweongyo if (ic->ic_opmode == IEEE80211_M_MONITOR) { 2107190688Sweongyo uath_set_ledstate(sc, 1); 2108190688Sweongyo break; 2109190688Sweongyo } 2110190688Sweongyo 2111190688Sweongyo /* 2112190688Sweongyo * Tx rate is controlled by firmware, report the maximum 2113190688Sweongyo * negotiated rate in ifconfig output. 2114190688Sweongyo */ 2115190688Sweongyo ni->ni_txrate = ni->ni_rates.rs_rates[ni->ni_rates.rs_nrates-1]; 2116190688Sweongyo 2117190688Sweongyo if (uath_write_associd(sc) != 0) { 2118190688Sweongyo device_printf(sc->sc_dev, 2119190688Sweongyo "could not write association id\n"); 2120190688Sweongyo break; 2121190688Sweongyo } 2122190688Sweongyo /* turn link LED on */ 2123190688Sweongyo uath_set_ledsteady(sc, UATH_LED_LINK, UATH_LED_ON); 2124190688Sweongyo /* make activity LED blink */ 2125190688Sweongyo uath_set_ledblink(sc, UATH_LED_ACTIVITY, UATH_LED_ON, 1, 2); 2126190688Sweongyo /* set state to associated */ 2127190688Sweongyo uath_set_ledstate(sc, 1); 2128190688Sweongyo 2129190688Sweongyo /* start statistics timer */ 2130190688Sweongyo callout_reset(&sc->stat_ch, hz, uath_stat, sc); 2131190688Sweongyo break; 2132190688Sweongyo default: 2133190688Sweongyo break; 2134190688Sweongyo } 2135190688Sweongyo UATH_UNLOCK(sc); 2136190688Sweongyo IEEE80211_LOCK(ic); 2137191746Sthompsa return (uvp->newstate(vap, nstate, arg)); 2138190688Sweongyo} 2139190688Sweongyo 2140190688Sweongyostatic int 2141190688Sweongyouath_set_key(struct uath_softc *sc, const struct ieee80211_key *wk, 2142190688Sweongyo int index) 2143190688Sweongyo{ 2144190688Sweongyo#if 0 2145190688Sweongyo struct uath_cmd_crypto crypto; 2146190688Sweongyo int i; 2147190688Sweongyo 2148190688Sweongyo bzero(&crypto, sizeof crypto); 2149190688Sweongyo crypto.keyidx = htobe32(index); 2150190688Sweongyo crypto.magic1 = htobe32(1); 2151190688Sweongyo crypto.size = htobe32(368); 2152190688Sweongyo crypto.mask = htobe32(0xffff); 2153190688Sweongyo crypto.flags = htobe32(0x80000068); 2154190688Sweongyo if (index != UATH_DEFAULT_KEY) 2155190688Sweongyo crypto.flags |= htobe32(index << 16); 2156190688Sweongyo memset(crypto.magic2, 0xff, sizeof crypto.magic2); 2157190688Sweongyo 2158190688Sweongyo /* 2159190688Sweongyo * Each byte of the key must be XOR'ed with 10101010 before being 2160190688Sweongyo * transmitted to the firmware. 2161190688Sweongyo */ 2162190688Sweongyo for (i = 0; i < wk->wk_keylen; i++) 2163190688Sweongyo crypto.key[i] = wk->wk_key[i] ^ 0xaa; 2164190688Sweongyo 2165190688Sweongyo DPRINTF(sc, UATH_DEBUG_CRYPTO, 2166190688Sweongyo "setting crypto key index=%d len=%d\n", index, wk->wk_keylen); 2167190688Sweongyo return uath_cmd_write(sc, WDCMSG_SET_KEY_CACHE_ENTRY, &crypto, 2168190688Sweongyo sizeof crypto, 0); 2169190688Sweongyo#else 2170190688Sweongyo /* XXX support H/W cryto */ 2171190688Sweongyo return (0); 2172190688Sweongyo#endif 2173190688Sweongyo} 2174190688Sweongyo 2175190688Sweongyostatic int 2176190688Sweongyouath_set_keys(struct uath_softc *sc, struct ieee80211vap *vap) 2177190688Sweongyo{ 2178190688Sweongyo int i, error; 2179190688Sweongyo 2180190688Sweongyo error = 0; 2181190688Sweongyo for (i = 0; i < IEEE80211_WEP_NKID; i++) { 2182190688Sweongyo const struct ieee80211_key *wk = &vap->iv_nw_keys[i]; 2183190688Sweongyo 2184190688Sweongyo if (wk->wk_flags & (IEEE80211_KEY_XMIT|IEEE80211_KEY_RECV)) { 2185190688Sweongyo error = uath_set_key(sc, wk, i); 2186190688Sweongyo if (error) 2187190688Sweongyo return (error); 2188190688Sweongyo } 2189190688Sweongyo } 2190190688Sweongyo if (vap->iv_def_txkey != IEEE80211_KEYIX_NONE) { 2191190688Sweongyo error = uath_set_key(sc, &vap->iv_nw_keys[vap->iv_def_txkey], 2192190688Sweongyo UATH_DEFAULT_KEY); 2193190688Sweongyo } 2194190688Sweongyo return (error); 2195190688Sweongyo} 2196190688Sweongyo 2197190688Sweongyo#define UATH_SYSCTL_STAT_ADD32(c, h, n, p, d) \ 2198190688Sweongyo SYSCTL_ADD_UINT(c, h, OID_AUTO, n, CTLFLAG_RD, p, 0, d) 2199190688Sweongyo 2200190688Sweongyostatic void 2201190688Sweongyouath_sysctl_node(struct uath_softc *sc) 2202190688Sweongyo{ 2203190688Sweongyo struct sysctl_ctx_list *ctx; 2204190688Sweongyo struct sysctl_oid_list *child; 2205190688Sweongyo struct sysctl_oid *tree; 2206190688Sweongyo struct uath_stat *stats; 2207190688Sweongyo 2208190688Sweongyo stats = &sc->sc_stat; 2209190688Sweongyo ctx = device_get_sysctl_ctx(sc->sc_dev); 2210190688Sweongyo child = SYSCTL_CHILDREN(device_get_sysctl_tree(sc->sc_dev)); 2211190688Sweongyo 2212190688Sweongyo tree = SYSCTL_ADD_NODE(ctx, child, OID_AUTO, "stats", CTLFLAG_RD, 2213190688Sweongyo NULL, "UATH statistics"); 2214190688Sweongyo child = SYSCTL_CHILDREN(tree); 2215190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "badchunkseqnum", 2216190688Sweongyo &stats->st_badchunkseqnum, "Bad chunk sequence numbers"); 2217190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "invalidlen", &stats->st_invalidlen, 2218190688Sweongyo "Invalid length"); 2219190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "multichunk", &stats->st_multichunk, 2220190688Sweongyo "Multi chunks"); 2221190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "toobigrxpkt", 2222190688Sweongyo &stats->st_toobigrxpkt, "Too big rx packets"); 2223190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "stopinprogress", 2224190688Sweongyo &stats->st_stopinprogress, "Stop in progress"); 2225190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "crcerrs", &stats->st_crcerr, 2226190688Sweongyo "CRC errors"); 2227190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "phyerr", &stats->st_phyerr, 2228190688Sweongyo "PHY errors"); 2229190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "decrypt_crcerr", 2230190688Sweongyo &stats->st_decrypt_crcerr, "Decryption CRC errors"); 2231190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "decrypt_micerr", 2232190688Sweongyo &stats->st_decrypt_micerr, "Decryption Misc errors"); 2233190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "decomperr", &stats->st_decomperr, 2234190688Sweongyo "Decomp errors"); 2235190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "keyerr", &stats->st_keyerr, 2236190688Sweongyo "Key errors"); 2237190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "err", &stats->st_err, 2238190688Sweongyo "Unknown errors"); 2239190688Sweongyo 2240190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "cmd_active", 2241190688Sweongyo &stats->st_cmd_active, "Active numbers in Command queue"); 2242190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "cmd_inactive", 2243190688Sweongyo &stats->st_cmd_inactive, "Inactive numbers in Command queue"); 2244190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "cmd_pending", 2245190688Sweongyo &stats->st_cmd_pending, "Pending numbers in Command queue"); 2246190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "cmd_waiting", 2247190688Sweongyo &stats->st_cmd_waiting, "Waiting numbers in Command queue"); 2248190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "rx_active", 2249190688Sweongyo &stats->st_rx_active, "Active numbers in RX queue"); 2250190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "rx_inactive", 2251190688Sweongyo &stats->st_rx_inactive, "Inactive numbers in RX queue"); 2252190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "tx_active", 2253190688Sweongyo &stats->st_tx_active, "Active numbers in TX queue"); 2254190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "tx_inactive", 2255190688Sweongyo &stats->st_tx_inactive, "Inactive numbers in TX queue"); 2256190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "tx_pending", 2257190688Sweongyo &stats->st_tx_pending, "Pending numbers in TX queue"); 2258190688Sweongyo} 2259190688Sweongyo 2260190688Sweongyo#undef UATH_SYSCTL_STAT_ADD32 2261190688Sweongyo 2262190688Sweongyostatic void 2263190688Sweongyouath_cmdeof(struct uath_softc *sc, struct uath_cmd *cmd) 2264190688Sweongyo{ 2265190688Sweongyo struct uath_cmd_hdr *hdr; 2266190688Sweongyo int dlen; 2267190688Sweongyo 2268190688Sweongyo hdr = (struct uath_cmd_hdr *)cmd->buf; 2269190688Sweongyo /* NB: msgid is passed thru w/o byte swapping */ 2270190688Sweongyo#ifdef UATH_DEBUG 2271190688Sweongyo if (sc->sc_debug & UATH_DEBUG_CMDS) { 2272190688Sweongyo int len = be32toh(hdr->len); 2273190688Sweongyo printf("%s: %s [ix %u] len %u status %u\n", 2274190688Sweongyo __func__, uath_codename(be32toh(hdr->code)), 2275190688Sweongyo hdr->msgid, len, be32toh(hdr->magic)); 2276190688Sweongyo if (sc->sc_debug & UATH_DEBUG_CMDS_DUMP) 2277190688Sweongyo uath_dump_cmd(cmd->buf, 2278190688Sweongyo len > UATH_MAX_CMDSZ ? sizeof(*hdr) : len, '-'); 2279190688Sweongyo } 2280190688Sweongyo#endif 2281190688Sweongyo hdr->code = be32toh(hdr->code); 2282190688Sweongyo hdr->len = be32toh(hdr->len); 2283190688Sweongyo hdr->magic = be32toh(hdr->magic); /* target status on return */ 2284190688Sweongyo 2285190688Sweongyo switch (hdr->code & 0xff) { 2286190688Sweongyo /* reply to a read command */ 2287190688Sweongyo default: 2288190688Sweongyo dlen = hdr->len - sizeof(*hdr); 2289190688Sweongyo DPRINTF(sc, UATH_DEBUG_RX_PROC | UATH_DEBUG_RECV_ALL, 2290190688Sweongyo "%s: code %d data len %u\n", 2291190688Sweongyo __func__, hdr->code & 0xff, dlen); 2292190688Sweongyo /* 2293190688Sweongyo * The first response from the target after the 2294190688Sweongyo * HOST_AVAILABLE has an invalid msgid so we must 2295190688Sweongyo * treat it specially. 2296190688Sweongyo */ 2297190688Sweongyo if (hdr->msgid < UATH_CMD_LIST_COUNT) { 2298190688Sweongyo uint32_t *rp = (uint32_t *)(hdr+1); 2299190688Sweongyo u_int olen; 2300190688Sweongyo 2301190688Sweongyo if (!(sizeof(*hdr) <= hdr->len && 2302190688Sweongyo hdr->len < UATH_MAX_CMDSZ)) { 2303190688Sweongyo device_printf(sc->sc_dev, 2304190688Sweongyo "%s: invalid WDC msg length %u; " 2305190688Sweongyo "msg ignored\n", __func__, hdr->len); 2306190688Sweongyo return; 2307190688Sweongyo } 2308190688Sweongyo /* 2309190688Sweongyo * Calculate return/receive payload size; the 2310190688Sweongyo * first word, if present, always gives the 2311190688Sweongyo * number of bytes--unless it's 0 in which 2312190688Sweongyo * case a single 32-bit word should be present. 2313190688Sweongyo */ 2314190688Sweongyo if (dlen >= sizeof(uint32_t)) { 2315190688Sweongyo olen = be32toh(rp[0]); 2316190688Sweongyo dlen -= sizeof(uint32_t); 2317190688Sweongyo if (olen == 0) { 2318190688Sweongyo /* convention is 0 =>'s one word */ 2319190688Sweongyo olen = sizeof(uint32_t); 2320190688Sweongyo /* XXX KASSERT(olen == dlen ) */ 2321190688Sweongyo } 2322190688Sweongyo } else 2323190688Sweongyo olen = 0; 2324190688Sweongyo if (cmd->odata != NULL) { 2325190688Sweongyo /* NB: cmd->olen validated in uath_cmd */ 2326190688Sweongyo if (olen > cmd->olen) { 2327190688Sweongyo /* XXX complain? */ 2328190688Sweongyo device_printf(sc->sc_dev, 2329190688Sweongyo "%s: cmd 0x%x olen %u cmd olen %u\n", 2330190688Sweongyo __func__, hdr->code, olen, 2331190688Sweongyo cmd->olen); 2332190688Sweongyo olen = cmd->olen; 2333190688Sweongyo } 2334190688Sweongyo if (olen > dlen) { 2335190688Sweongyo /* XXX complain, shouldn't happen */ 2336190688Sweongyo device_printf(sc->sc_dev, 2337190688Sweongyo "%s: cmd 0x%x olen %u dlen %u\n", 2338190688Sweongyo __func__, hdr->code, olen, dlen); 2339190688Sweongyo olen = dlen; 2340190688Sweongyo } 2341190688Sweongyo /* XXX have submitter do this */ 2342190688Sweongyo /* copy answer into caller's supplied buffer */ 2343190688Sweongyo bcopy(&rp[1], cmd->odata, olen); 2344190688Sweongyo cmd->olen = olen; 2345190688Sweongyo } 2346190688Sweongyo } 2347190688Sweongyo wakeup_one(cmd); /* wake up caller */ 2348190688Sweongyo break; 2349190688Sweongyo 2350190688Sweongyo case WDCMSG_TARGET_START: 2351190688Sweongyo if (hdr->msgid >= UATH_CMD_LIST_COUNT) { 2352190688Sweongyo /* XXX */ 2353190688Sweongyo return; 2354190688Sweongyo } 2355190688Sweongyo dlen = hdr->len - sizeof(*hdr); 2356190688Sweongyo if (dlen != sizeof(uint32_t)) { 2357190688Sweongyo /* XXX something wrong */ 2358190688Sweongyo return; 2359190688Sweongyo } 2360190688Sweongyo /* XXX have submitter do this */ 2361190688Sweongyo /* copy answer into caller's supplied buffer */ 2362190688Sweongyo bcopy(hdr+1, cmd->odata, sizeof(uint32_t)); 2363190688Sweongyo cmd->olen = sizeof(uint32_t); 2364190688Sweongyo wakeup_one(cmd); /* wake up caller */ 2365190688Sweongyo break; 2366190688Sweongyo 2367190688Sweongyo case WDCMSG_SEND_COMPLETE: 2368190688Sweongyo /* this notification is sent when UATH_TX_NOTIFY is set */ 2369190688Sweongyo DPRINTF(sc, UATH_DEBUG_RX_PROC | UATH_DEBUG_RECV_ALL, 2370190688Sweongyo "%s: received Tx notification\n", __func__); 2371190688Sweongyo break; 2372190688Sweongyo 2373190688Sweongyo case WDCMSG_TARGET_GET_STATS: 2374190688Sweongyo DPRINTF(sc, UATH_DEBUG_RX_PROC | UATH_DEBUG_RECV_ALL, 2375190688Sweongyo "%s: received device statistics\n", __func__); 2376190688Sweongyo callout_reset(&sc->stat_ch, hz, uath_stat, sc); 2377190688Sweongyo break; 2378190688Sweongyo } 2379190688Sweongyo} 2380190688Sweongyo 2381190688Sweongyostatic void 2382190688Sweongyouath_intr_rx_callback(struct usb2_xfer *xfer) 2383190688Sweongyo{ 2384190688Sweongyo struct uath_softc *sc = xfer->priv_sc; 2385190688Sweongyo struct uath_cmd *cmd; 2386190688Sweongyo 2387190688Sweongyo UATH_ASSERT_LOCKED(sc); 2388190688Sweongyo 2389190688Sweongyo switch (USB_GET_STATE(xfer)) { 2390190688Sweongyo case USB_ST_TRANSFERRED: 2391190688Sweongyo cmd = STAILQ_FIRST(&sc->sc_cmd_waiting); 2392190688Sweongyo if (cmd == NULL) 2393190688Sweongyo goto setup; 2394190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_cmd_waiting, next); 2395190688Sweongyo UATH_STAT_DEC(sc, st_cmd_waiting); 2396190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_cmd_inactive, cmd, next); 2397190688Sweongyo UATH_STAT_INC(sc, st_cmd_inactive); 2398190688Sweongyo 2399190688Sweongyo KASSERT(xfer->actlen >= sizeof(struct uath_cmd_hdr), 2400190688Sweongyo ("short xfer error")); 2401190688Sweongyo usb2_copy_out(xfer->frbuffers, 0, cmd->buf, xfer->actlen); 2402190688Sweongyo uath_cmdeof(sc, cmd); 2403190688Sweongyo case USB_ST_SETUP: 2404190688Sweongyosetup: 2405190688Sweongyo xfer->frlengths[0] = xfer->max_data_length; 2406190688Sweongyo usb2_start_hardware(xfer); 2407190688Sweongyo break; 2408190688Sweongyo default: 2409190688Sweongyo if (xfer->error != USB_ERR_CANCELLED) { 2410190688Sweongyo xfer->flags.stall_pipe = 1; 2411190688Sweongyo goto setup; 2412190688Sweongyo } 2413190688Sweongyo break; 2414190688Sweongyo } 2415190688Sweongyo} 2416190688Sweongyo 2417190688Sweongyostatic void 2418190688Sweongyouath_intr_tx_callback(struct usb2_xfer *xfer) 2419190688Sweongyo{ 2420190688Sweongyo struct uath_softc *sc = xfer->priv_sc; 2421190688Sweongyo struct uath_cmd *cmd; 2422190688Sweongyo 2423190688Sweongyo UATH_ASSERT_LOCKED(sc); 2424190688Sweongyo 2425190688Sweongyo switch (USB_GET_STATE(xfer)) { 2426190688Sweongyo case USB_ST_TRANSFERRED: 2427190688Sweongyo cmd = STAILQ_FIRST(&sc->sc_cmd_active); 2428190688Sweongyo if (cmd == NULL) 2429190688Sweongyo goto setup; 2430190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_cmd_active, next); 2431190688Sweongyo UATH_STAT_DEC(sc, st_cmd_active); 2432190688Sweongyo STAILQ_INSERT_TAIL((cmd->flags & UATH_CMD_FLAG_READ) ? 2433190688Sweongyo &sc->sc_cmd_waiting : &sc->sc_cmd_inactive, cmd, next); 2434190688Sweongyo if (cmd->flags & UATH_CMD_FLAG_READ) 2435190688Sweongyo UATH_STAT_INC(sc, st_cmd_waiting); 2436190688Sweongyo else 2437190688Sweongyo UATH_STAT_INC(sc, st_cmd_inactive); 2438190688Sweongyo /* FALLTHROUGH */ 2439190688Sweongyo case USB_ST_SETUP: 2440190688Sweongyosetup: 2441190688Sweongyo cmd = STAILQ_FIRST(&sc->sc_cmd_pending); 2442190688Sweongyo if (cmd == NULL) { 2443190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, "%s: empty pending queue\n", 2444190688Sweongyo __func__); 2445190688Sweongyo return; 2446190688Sweongyo } 2447190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_cmd_pending, next); 2448190688Sweongyo UATH_STAT_DEC(sc, st_cmd_pending); 2449190688Sweongyo STAILQ_INSERT_TAIL((cmd->flags & UATH_CMD_FLAG_ASYNC) ? 2450190688Sweongyo &sc->sc_cmd_inactive : &sc->sc_cmd_active, cmd, next); 2451190688Sweongyo if (cmd->flags & UATH_CMD_FLAG_ASYNC) 2452190688Sweongyo UATH_STAT_INC(sc, st_cmd_inactive); 2453190688Sweongyo else 2454190688Sweongyo UATH_STAT_INC(sc, st_cmd_active); 2455190688Sweongyo 2456190688Sweongyo usb2_set_frame_data(xfer, cmd->buf, 0); 2457190688Sweongyo xfer->frlengths[0] = cmd->buflen; 2458190688Sweongyo usb2_start_hardware(xfer); 2459190688Sweongyo break; 2460190688Sweongyo default: 2461190688Sweongyo if (xfer->error != USB_ERR_CANCELLED) { 2462190688Sweongyo xfer->flags.stall_pipe = 1; 2463190688Sweongyo goto setup; 2464190688Sweongyo } 2465190688Sweongyo break; 2466190688Sweongyo } 2467190688Sweongyo} 2468190688Sweongyo 2469190688Sweongyostatic void 2470190688Sweongyouath_update_rxstat(struct uath_softc *sc, uint32_t status) 2471190688Sweongyo{ 2472190688Sweongyo 2473190688Sweongyo switch (status) { 2474190688Sweongyo case UATH_STATUS_STOP_IN_PROGRESS: 2475190688Sweongyo UATH_STAT_INC(sc, st_stopinprogress); 2476190688Sweongyo break; 2477190688Sweongyo case UATH_STATUS_CRC_ERR: 2478190688Sweongyo UATH_STAT_INC(sc, st_crcerr); 2479190688Sweongyo break; 2480190688Sweongyo case UATH_STATUS_PHY_ERR: 2481190688Sweongyo UATH_STAT_INC(sc, st_phyerr); 2482190688Sweongyo break; 2483190688Sweongyo case UATH_STATUS_DECRYPT_CRC_ERR: 2484190688Sweongyo UATH_STAT_INC(sc, st_decrypt_crcerr); 2485190688Sweongyo break; 2486190688Sweongyo case UATH_STATUS_DECRYPT_MIC_ERR: 2487190688Sweongyo UATH_STAT_INC(sc, st_decrypt_micerr); 2488190688Sweongyo break; 2489190688Sweongyo case UATH_STATUS_DECOMP_ERR: 2490190688Sweongyo UATH_STAT_INC(sc, st_decomperr); 2491190688Sweongyo break; 2492190688Sweongyo case UATH_STATUS_KEY_ERR: 2493190688Sweongyo UATH_STAT_INC(sc, st_keyerr); 2494190688Sweongyo break; 2495190688Sweongyo case UATH_STATUS_ERR: 2496190688Sweongyo UATH_STAT_INC(sc, st_err); 2497190688Sweongyo break; 2498190688Sweongyo default: 2499190688Sweongyo break; 2500190688Sweongyo } 2501190688Sweongyo} 2502190688Sweongyo 2503190688Sweongyostatic struct mbuf * 2504190688Sweongyouath_data_rxeof(struct usb2_xfer *xfer, struct uath_data *data, 2505190688Sweongyo struct uath_rx_desc **pdesc) 2506190688Sweongyo{ 2507190688Sweongyo struct uath_softc *sc = xfer->priv_sc; 2508190688Sweongyo struct ifnet *ifp = sc->sc_ifp; 2509190688Sweongyo struct ieee80211com *ic = ifp->if_l2com; 2510190688Sweongyo struct uath_chunk *chunk; 2511190688Sweongyo struct uath_rx_desc *desc; 2512190688Sweongyo struct mbuf *m = data->m, *mnew, *mp; 2513190688Sweongyo uint16_t chunklen; 2514190688Sweongyo 2515190688Sweongyo if (xfer->actlen < UATH_MIN_RXBUFSZ) { 2516190688Sweongyo DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL, 2517190688Sweongyo "%s: wrong xfer size (len=%d)\n", __func__, xfer->actlen); 2518190688Sweongyo ifp->if_ierrors++; 2519190688Sweongyo return (NULL); 2520190688Sweongyo } 2521190688Sweongyo 2522190688Sweongyo chunk = (struct uath_chunk *)data->buf; 2523190688Sweongyo if (chunk->seqnum == 0 && chunk->flags == 0 && chunk->length == 0) { 2524190688Sweongyo device_printf(sc->sc_dev, "%s: strange response\n", __func__); 2525190688Sweongyo ifp->if_ierrors++; 2526190688Sweongyo UATH_RESET_INTRX(sc); 2527190688Sweongyo return (NULL); 2528190688Sweongyo } 2529190688Sweongyo 2530190688Sweongyo if (chunk->seqnum != sc->sc_intrx_nextnum) { 2531190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, "invalid seqnum %d, expected %d\n", 2532190688Sweongyo chunk->seqnum, sc->sc_intrx_nextnum); 2533190688Sweongyo UATH_STAT_INC(sc, st_badchunkseqnum); 2534190688Sweongyo if (sc->sc_intrx_head != NULL) 2535190688Sweongyo m_freem(sc->sc_intrx_head); 2536190688Sweongyo UATH_RESET_INTRX(sc); 2537190688Sweongyo return (NULL); 2538190688Sweongyo } 2539190688Sweongyo 2540190688Sweongyo /* check multi-chunk frames */ 2541190688Sweongyo if ((chunk->seqnum == 0 && !(chunk->flags & UATH_CFLAGS_FINAL)) || 2542190688Sweongyo (chunk->seqnum != 0 && (chunk->flags & UATH_CFLAGS_FINAL)) || 2543190688Sweongyo chunk->flags & UATH_CFLAGS_RXMSG) 2544190688Sweongyo UATH_STAT_INC(sc, st_multichunk); 2545190688Sweongyo 2546190688Sweongyo chunklen = be16toh(chunk->length); 2547190688Sweongyo if (chunk->flags & UATH_CFLAGS_FINAL) 2548190688Sweongyo chunklen -= sizeof(struct uath_rx_desc); 2549190688Sweongyo 2550190688Sweongyo if (chunklen > 0 && 2551190688Sweongyo (!(chunk->flags & UATH_CFLAGS_FINAL) || !(chunk->seqnum == 0))) { 2552190688Sweongyo /* we should use intermediate RX buffer */ 2553190688Sweongyo if (chunk->seqnum == 0) 2554190688Sweongyo UATH_RESET_INTRX(sc); 2555190688Sweongyo if ((sc->sc_intrx_len + sizeof(struct uath_rx_desc) + 2556190688Sweongyo chunklen) > UATH_MAX_INTRX_SIZE) { 2557190688Sweongyo UATH_STAT_INC(sc, st_invalidlen); 2558190688Sweongyo ifp->if_iqdrops++; 2559190688Sweongyo if (sc->sc_intrx_head != NULL) 2560190688Sweongyo m_freem(sc->sc_intrx_head); 2561190688Sweongyo UATH_RESET_INTRX(sc); 2562190688Sweongyo return (NULL); 2563190688Sweongyo } 2564190688Sweongyo 2565190688Sweongyo m->m_len = chunklen; 2566190688Sweongyo m->m_data += sizeof(struct uath_chunk); 2567190688Sweongyo 2568190688Sweongyo if (sc->sc_intrx_head == NULL) { 2569190688Sweongyo sc->sc_intrx_head = m; 2570190688Sweongyo sc->sc_intrx_tail = m; 2571190688Sweongyo } else { 2572190688Sweongyo m->m_flags &= ~M_PKTHDR; 2573190688Sweongyo sc->sc_intrx_tail->m_next = m; 2574190688Sweongyo sc->sc_intrx_tail = m; 2575190688Sweongyo } 2576190688Sweongyo } 2577190688Sweongyo sc->sc_intrx_len += chunklen; 2578190688Sweongyo 2579190688Sweongyo mnew = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR); 2580190688Sweongyo if (mnew == NULL) { 2581190688Sweongyo DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL, 2582190688Sweongyo "%s: can't get new mbuf, drop frame\n", __func__); 2583190688Sweongyo ifp->if_ierrors++; 2584190688Sweongyo if (sc->sc_intrx_head != NULL) 2585190688Sweongyo m_freem(sc->sc_intrx_head); 2586190688Sweongyo UATH_RESET_INTRX(sc); 2587190688Sweongyo return (NULL); 2588190688Sweongyo } 2589190688Sweongyo 2590190688Sweongyo data->m = mnew; 2591190688Sweongyo data->buf = mtod(mnew, uint8_t *); 2592190688Sweongyo 2593190688Sweongyo /* if the frame is not final continue the transfer */ 2594190688Sweongyo if (!(chunk->flags & UATH_CFLAGS_FINAL)) { 2595190688Sweongyo sc->sc_intrx_nextnum++; 2596190688Sweongyo UATH_RESET_INTRX(sc); 2597190688Sweongyo return (NULL); 2598190688Sweongyo } 2599190688Sweongyo 2600190688Sweongyo /* 2601190688Sweongyo * if the frame is not set UATH_CFLAGS_RXMSG, then rx descriptor is 2602190688Sweongyo * located at the end, 32-bit aligned 2603190688Sweongyo */ 2604190688Sweongyo desc = (chunk->flags & UATH_CFLAGS_RXMSG) ? 2605190688Sweongyo (struct uath_rx_desc *)(chunk + 1) : 2606190688Sweongyo (struct uath_rx_desc *)(((uint8_t *)chunk) + 2607190688Sweongyo sizeof(struct uath_chunk) + be16toh(chunk->length) - 2608190688Sweongyo sizeof(struct uath_rx_desc)); 2609190688Sweongyo *pdesc = desc; 2610190688Sweongyo 2611190688Sweongyo DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL, 2612190688Sweongyo "%s: frame len %u code %u status %u rate %u antenna %u " 2613190688Sweongyo "rssi %d channel %u phyerror %u connix %u decrypterror %u " 2614190688Sweongyo "keycachemiss %u\n", __func__, be32toh(desc->framelen) 2615190688Sweongyo , be32toh(desc->code), be32toh(desc->status), be32toh(desc->rate) 2616190688Sweongyo , be32toh(desc->antenna), be32toh(desc->rssi), be32toh(desc->channel) 2617190688Sweongyo , be32toh(desc->phyerror), be32toh(desc->connix) 2618190688Sweongyo , be32toh(desc->decrypterror), be32toh(desc->keycachemiss)); 2619190688Sweongyo 2620190688Sweongyo if (be32toh(desc->len) > MCLBYTES) { 2621190688Sweongyo DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL, 2622190688Sweongyo "%s: bad descriptor (len=%d)\n", __func__, 2623190688Sweongyo be32toh(desc->len)); 2624190688Sweongyo ifp->if_iqdrops++; 2625190688Sweongyo UATH_STAT_INC(sc, st_toobigrxpkt); 2626190688Sweongyo if (sc->sc_intrx_head != NULL) 2627190688Sweongyo m_freem(sc->sc_intrx_head); 2628190688Sweongyo UATH_RESET_INTRX(sc); 2629190688Sweongyo return (NULL); 2630190688Sweongyo } 2631190688Sweongyo 2632190688Sweongyo uath_update_rxstat(sc, be32toh(desc->status)); 2633190688Sweongyo 2634190688Sweongyo /* finalize mbuf */ 2635190688Sweongyo if (sc->sc_intrx_head == NULL) { 2636190688Sweongyo m->m_pkthdr.rcvif = ifp; 2637190688Sweongyo m->m_pkthdr.len = m->m_len = 2638190688Sweongyo be32toh(desc->framelen) - UATH_RX_DUMMYSIZE; 2639190688Sweongyo m->m_data += sizeof(struct uath_chunk); 2640190688Sweongyo } else { 2641190688Sweongyo mp = sc->sc_intrx_head; 2642190688Sweongyo mp->m_pkthdr.rcvif = ifp; 2643190688Sweongyo mp->m_flags |= M_PKTHDR; 2644190688Sweongyo mp->m_pkthdr.len = sc->sc_intrx_len; 2645190688Sweongyo m = mp; 2646190688Sweongyo } 2647190688Sweongyo 2648190688Sweongyo /* there are a lot more fields in the RX descriptor */ 2649192468Ssam if (ieee80211_radiotap_active(ic)) { 2650190688Sweongyo struct uath_rx_radiotap_header *tap = &sc->sc_rxtap; 2651192468Ssam uint32_t tsf_hi = be32toh(desc->tstamp_high); 2652192468Ssam uint32_t tsf_lo = be32toh(desc->tstamp_low); 2653190688Sweongyo 2654192468Ssam /* XXX only get low order 24bits of tsf from h/w */ 2655192468Ssam tap->wr_tsf = htole64(((uint64_t)tsf_hi << 32) | tsf_lo); 2656192468Ssam tap->wr_flags = 0; 2657192468Ssam if (be32toh(desc->status) == UATH_STATUS_CRC_ERR) 2658192468Ssam tap->wr_flags |= IEEE80211_RADIOTAP_F_BADFCS; 2659192468Ssam /* XXX map other status to BADFCS? */ 2660192468Ssam /* XXX ath h/w rate code, need to map */ 2661192468Ssam tap->wr_rate = be32toh(desc->rate); 2662192468Ssam tap->wr_antenna = be32toh(desc->antenna); 2663192468Ssam tap->wr_antsignal = -95 + be32toh(desc->rssi); 2664192468Ssam tap->wr_antnoise = -95; 2665190688Sweongyo } 2666190688Sweongyo 2667190688Sweongyo ifp->if_ipackets++; 2668190688Sweongyo UATH_RESET_INTRX(sc); 2669190688Sweongyo 2670190688Sweongyo return (m); 2671190688Sweongyo} 2672190688Sweongyo 2673190688Sweongyostatic void 2674190688Sweongyouath_bulk_rx_callback(struct usb2_xfer *xfer) 2675190688Sweongyo{ 2676190688Sweongyo struct uath_softc *sc = xfer->priv_sc; 2677190688Sweongyo struct ifnet *ifp = sc->sc_ifp; 2678190688Sweongyo struct ieee80211com *ic = ifp->if_l2com; 2679190688Sweongyo struct ieee80211_frame *wh; 2680190688Sweongyo struct ieee80211_node *ni; 2681190688Sweongyo struct mbuf *m = NULL; 2682190688Sweongyo struct uath_data *data; 2683190688Sweongyo struct uath_rx_desc *desc = NULL; 2684190688Sweongyo int8_t nf; 2685190688Sweongyo 2686190688Sweongyo UATH_ASSERT_LOCKED(sc); 2687190688Sweongyo 2688190688Sweongyo switch (USB_GET_STATE(xfer)) { 2689190688Sweongyo case USB_ST_TRANSFERRED: 2690190688Sweongyo data = STAILQ_FIRST(&sc->sc_rx_active); 2691190688Sweongyo if (data == NULL) 2692190688Sweongyo goto setup; 2693190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 2694190688Sweongyo UATH_STAT_DEC(sc, st_rx_active); 2695190688Sweongyo m = uath_data_rxeof(xfer, data, &desc); 2696190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 2697190688Sweongyo UATH_STAT_INC(sc, st_rx_inactive); 2698190688Sweongyo /* FALLTHROUGH */ 2699190688Sweongyo case USB_ST_SETUP: 2700190688Sweongyosetup: 2701190688Sweongyo data = STAILQ_FIRST(&sc->sc_rx_inactive); 2702190688Sweongyo if (data == NULL) 2703190688Sweongyo return; 2704190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_rx_inactive, next); 2705190688Sweongyo UATH_STAT_DEC(sc, st_rx_inactive); 2706190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_rx_active, data, next); 2707190688Sweongyo UATH_STAT_INC(sc, st_rx_active); 2708190688Sweongyo usb2_set_frame_data(xfer, data->buf, 0); 2709190688Sweongyo xfer->frlengths[0] = xfer->max_data_length; 2710190688Sweongyo usb2_start_hardware(xfer); 2711190688Sweongyo 2712190688Sweongyo /* 2713190688Sweongyo * To avoid LOR we should unlock our private mutex here to call 2714190688Sweongyo * ieee80211_input() because here is at the end of a USB 2715190688Sweongyo * callback and safe to unlock. 2716190688Sweongyo */ 2717190688Sweongyo UATH_UNLOCK(sc); 2718190688Sweongyo if (m != NULL && desc != NULL) { 2719190688Sweongyo wh = mtod(m, struct ieee80211_frame *); 2720190688Sweongyo ni = ieee80211_find_rxnode(ic, 2721190688Sweongyo (struct ieee80211_frame_min *)wh); 2722190688Sweongyo nf = -95; /* XXX */ 2723190688Sweongyo if (ni != NULL) { 2724190688Sweongyo (void) ieee80211_input(ni, m, 2725192468Ssam (int)be32toh(desc->rssi), nf); 2726190688Sweongyo /* node is no longer needed */ 2727190688Sweongyo ieee80211_free_node(ni); 2728190688Sweongyo } else 2729190688Sweongyo (void) ieee80211_input_all(ic, m, 2730192468Ssam (int)be32toh(desc->rssi), nf); 2731190688Sweongyo m = NULL; 2732190688Sweongyo desc = NULL; 2733190688Sweongyo } 2734190688Sweongyo UATH_LOCK(sc); 2735190688Sweongyo break; 2736190688Sweongyo default: 2737190688Sweongyo /* needs it to the inactive queue due to a error. */ 2738190688Sweongyo data = STAILQ_FIRST(&sc->sc_rx_active); 2739190688Sweongyo if (data != NULL) { 2740190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 2741190688Sweongyo UATH_STAT_DEC(sc, st_rx_active); 2742190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 2743190688Sweongyo UATH_STAT_INC(sc, st_rx_inactive); 2744190688Sweongyo } 2745190688Sweongyo if (xfer->error != USB_ERR_CANCELLED) { 2746190688Sweongyo xfer->flags.stall_pipe = 1; 2747190688Sweongyo ifp->if_ierrors++; 2748190688Sweongyo goto setup; 2749190688Sweongyo } 2750190688Sweongyo break; 2751190688Sweongyo } 2752190688Sweongyo} 2753190688Sweongyo 2754190688Sweongyostatic void 2755190688Sweongyouath_data_txeof(struct usb2_xfer *xfer, struct uath_data *data) 2756190688Sweongyo{ 2757190688Sweongyo struct uath_softc *sc = xfer->priv_sc; 2758190688Sweongyo struct ifnet *ifp = sc->sc_ifp; 2759190688Sweongyo struct mbuf *m; 2760190688Sweongyo 2761190688Sweongyo UATH_ASSERT_LOCKED(sc); 2762190688Sweongyo 2763190688Sweongyo /* 2764190688Sweongyo * Do any tx complete callback. Note this must be done before releasing 2765190688Sweongyo * the node reference. 2766190688Sweongyo */ 2767190688Sweongyo if (data->m) { 2768190688Sweongyo m = data->m; 2769190688Sweongyo if (m->m_flags & M_TXCB) { 2770190688Sweongyo /* XXX status? */ 2771190688Sweongyo ieee80211_process_callback(data->ni, m, 0); 2772190688Sweongyo } 2773190688Sweongyo m_freem(m); 2774190688Sweongyo data->m = NULL; 2775190688Sweongyo } 2776190688Sweongyo if (data->ni) { 2777190688Sweongyo ieee80211_free_node(data->ni); 2778190688Sweongyo data->ni = NULL; 2779190688Sweongyo } 2780190688Sweongyo sc->sc_tx_timer = 0; 2781190688Sweongyo ifp->if_opackets++; 2782190688Sweongyo ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 2783190688Sweongyo} 2784190688Sweongyo 2785190688Sweongyostatic void 2786190688Sweongyouath_bulk_tx_callback(struct usb2_xfer *xfer) 2787190688Sweongyo{ 2788190688Sweongyo struct uath_softc *sc = xfer->priv_sc; 2789190688Sweongyo struct ifnet *ifp = sc->sc_ifp; 2790190688Sweongyo struct uath_data *data; 2791190688Sweongyo 2792190688Sweongyo UATH_ASSERT_LOCKED(sc); 2793190688Sweongyo 2794190688Sweongyo switch (USB_GET_STATE(xfer)) { 2795190688Sweongyo case USB_ST_TRANSFERRED: 2796190688Sweongyo data = STAILQ_FIRST(&sc->sc_tx_active); 2797190688Sweongyo if (data == NULL) 2798190688Sweongyo goto setup; 2799190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next); 2800190688Sweongyo UATH_STAT_DEC(sc, st_tx_active); 2801190688Sweongyo uath_data_txeof(xfer, data); 2802190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data, next); 2803190688Sweongyo UATH_STAT_INC(sc, st_tx_inactive); 2804190688Sweongyo /* FALLTHROUGH */ 2805190688Sweongyo case USB_ST_SETUP: 2806190688Sweongyosetup: 2807190688Sweongyo data = STAILQ_FIRST(&sc->sc_tx_pending); 2808190688Sweongyo if (data == NULL) { 2809190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, "%s: empty pending queue\n", 2810190688Sweongyo __func__); 2811190688Sweongyo return; 2812190688Sweongyo } 2813190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_tx_pending, next); 2814190688Sweongyo UATH_STAT_DEC(sc, st_tx_pending); 2815190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_tx_active, data, next); 2816190688Sweongyo UATH_STAT_INC(sc, st_tx_active); 2817190688Sweongyo 2818190688Sweongyo usb2_set_frame_data(xfer, data->buf, 0); 2819190688Sweongyo xfer->frlengths[0] = data->buflen; 2820190688Sweongyo usb2_start_hardware(xfer); 2821190688Sweongyo 2822190688Sweongyo UATH_UNLOCK(sc); 2823190688Sweongyo uath_start(ifp); 2824190688Sweongyo UATH_LOCK(sc); 2825190688Sweongyo break; 2826190688Sweongyo default: 2827190688Sweongyo data = STAILQ_FIRST(&sc->sc_tx_active); 2828190688Sweongyo if (data == NULL) 2829190688Sweongyo goto setup; 2830190688Sweongyo if (data->ni != NULL) { 2831190688Sweongyo ieee80211_free_node(data->ni); 2832190688Sweongyo data->ni = NULL; 2833190688Sweongyo ifp->if_oerrors++; 2834190688Sweongyo } 2835190688Sweongyo if (xfer->error != USB_ERR_CANCELLED) { 2836190688Sweongyo xfer->flags.stall_pipe = 1; 2837190688Sweongyo goto setup; 2838190688Sweongyo } 2839190688Sweongyo break; 2840190688Sweongyo } 2841190688Sweongyo} 2842190688Sweongyo 2843190688Sweongyostatic device_method_t uath_methods[] = { 2844190688Sweongyo DEVMETHOD(device_probe, uath_match), 2845190688Sweongyo DEVMETHOD(device_attach, uath_attach), 2846190688Sweongyo DEVMETHOD(device_detach, uath_detach), 2847190688Sweongyo { 0, 0 } 2848190688Sweongyo}; 2849190688Sweongyostatic driver_t uath_driver = { 2850190688Sweongyo "uath", 2851190688Sweongyo uath_methods, 2852190688Sweongyo sizeof(struct uath_softc) 2853190688Sweongyo}; 2854190688Sweongyostatic devclass_t uath_devclass; 2855190688Sweongyo 2856190688SweongyoDRIVER_MODULE(uath, uhub, uath_driver, uath_devclass, NULL, 0); 2857190688SweongyoMODULE_DEPEND(uath, wlan, 1, 1, 1); 2858190688SweongyoMODULE_DEPEND(uath, usb, 1, 1, 1); 2859