if_uath.c revision 293339
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 293339 2016-01-07 18:41:03Z avos $"); 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> 89257176Sglebius#include <net/if_var.h> 90190688Sweongyo#include <net/if_arp.h> 91190688Sweongyo#include <net/ethernet.h> 92190688Sweongyo#include <net/if_dl.h> 93190688Sweongyo#include <net/if_media.h> 94190688Sweongyo#include <net/if_types.h> 95190688Sweongyo 96190688Sweongyo#ifdef INET 97190688Sweongyo#include <netinet/in.h> 98190688Sweongyo#include <netinet/in_systm.h> 99190688Sweongyo#include <netinet/in_var.h> 100190688Sweongyo#include <netinet/if_ether.h> 101190688Sweongyo#include <netinet/ip.h> 102190688Sweongyo#endif 103190688Sweongyo 104190688Sweongyo#include <net80211/ieee80211_var.h> 105288088Sadrian#include <net80211/ieee80211_input.h> 106190688Sweongyo#include <net80211/ieee80211_regdomain.h> 107190688Sweongyo#include <net80211/ieee80211_radiotap.h> 108190688Sweongyo 109190688Sweongyo#include <dev/usb/usb.h> 110194677Sthompsa#include <dev/usb/usbdi.h> 111190688Sweongyo#include "usbdevs.h" 112190688Sweongyo 113190688Sweongyo#include <dev/usb/wlan/if_uathreg.h> 114190688Sweongyo#include <dev/usb/wlan/if_uathvar.h> 115190688Sweongyo 116227309Sedstatic SYSCTL_NODE(_hw_usb, OID_AUTO, uath, CTLFLAG_RW, 0, "USB Atheros"); 117190688Sweongyo 118190688Sweongyostatic int uath_countrycode = CTRY_DEFAULT; /* country code */ 119267992ShselaskySYSCTL_INT(_hw_usb_uath, OID_AUTO, countrycode, CTLFLAG_RWTUN, &uath_countrycode, 120190688Sweongyo 0, "country code"); 121190688Sweongyostatic int uath_regdomain = 0; /* regulatory domain */ 122192502SthompsaSYSCTL_INT(_hw_usb_uath, OID_AUTO, regdomain, CTLFLAG_RD, &uath_regdomain, 123190688Sweongyo 0, "regulatory domain"); 124190688Sweongyo 125190688Sweongyo#ifdef UATH_DEBUG 126190688Sweongyoint uath_debug = 0; 127267992ShselaskySYSCTL_INT(_hw_usb_uath, OID_AUTO, debug, CTLFLAG_RWTUN, &uath_debug, 0, 128190688Sweongyo "uath debug level"); 129190688Sweongyoenum { 130190688Sweongyo UATH_DEBUG_XMIT = 0x00000001, /* basic xmit operation */ 131190688Sweongyo UATH_DEBUG_XMIT_DUMP = 0x00000002, /* xmit dump */ 132190688Sweongyo UATH_DEBUG_RECV = 0x00000004, /* basic recv operation */ 133190688Sweongyo UATH_DEBUG_TX_PROC = 0x00000008, /* tx ISR proc */ 134190688Sweongyo UATH_DEBUG_RX_PROC = 0x00000010, /* rx ISR proc */ 135190688Sweongyo UATH_DEBUG_RECV_ALL = 0x00000020, /* trace all frames (beacons) */ 136190688Sweongyo UATH_DEBUG_INIT = 0x00000040, /* initialization of dev */ 137190688Sweongyo UATH_DEBUG_DEVCAP = 0x00000080, /* dev caps */ 138190688Sweongyo UATH_DEBUG_CMDS = 0x00000100, /* commands */ 139190688Sweongyo UATH_DEBUG_CMDS_DUMP = 0x00000200, /* command buffer dump */ 140190688Sweongyo UATH_DEBUG_RESET = 0x00000400, /* reset processing */ 141190688Sweongyo UATH_DEBUG_STATE = 0x00000800, /* 802.11 state transitions */ 142190688Sweongyo UATH_DEBUG_MULTICAST = 0x00001000, /* multicast */ 143190688Sweongyo UATH_DEBUG_WME = 0x00002000, /* WME */ 144190688Sweongyo UATH_DEBUG_CHANNEL = 0x00004000, /* channel */ 145190688Sweongyo UATH_DEBUG_RATES = 0x00008000, /* rates */ 146190688Sweongyo UATH_DEBUG_CRYPTO = 0x00010000, /* crypto */ 147190688Sweongyo UATH_DEBUG_LED = 0x00020000, /* LED */ 148190688Sweongyo UATH_DEBUG_ANY = 0xffffffff 149190688Sweongyo}; 150190688Sweongyo#define DPRINTF(sc, m, fmt, ...) do { \ 151190688Sweongyo if (sc->sc_debug & (m)) \ 152190688Sweongyo printf(fmt, __VA_ARGS__); \ 153190688Sweongyo} while (0) 154190688Sweongyo#else 155190688Sweongyo#define DPRINTF(sc, m, fmt, ...) do { \ 156190688Sweongyo (void) sc; \ 157190688Sweongyo} while (0) 158190688Sweongyo#endif 159190688Sweongyo 160190688Sweongyo/* recognized device vendors/products */ 161223486Shselaskystatic const STRUCT_USB_HOST_ID uath_devs[] = { 162190688Sweongyo#define UATH_DEV(v,p) { USB_VP(USB_VENDOR_##v, USB_PRODUCT_##v##_##p) } 163193029Sweongyo UATH_DEV(ACCTON, SMCWUSBTG2), 164190688Sweongyo UATH_DEV(ATHEROS, AR5523), 165190688Sweongyo UATH_DEV(ATHEROS2, AR5523_1), 166190688Sweongyo UATH_DEV(ATHEROS2, AR5523_2), 167190688Sweongyo UATH_DEV(ATHEROS2, AR5523_3), 168190688Sweongyo UATH_DEV(CONCEPTRONIC, AR5523_1), 169190688Sweongyo UATH_DEV(CONCEPTRONIC, AR5523_2), 170190688Sweongyo UATH_DEV(DLINK, DWLAG122), 171190688Sweongyo UATH_DEV(DLINK, DWLAG132), 172190688Sweongyo UATH_DEV(DLINK, DWLG132), 173195916Sweongyo UATH_DEV(DLINK2, DWA120), 174190688Sweongyo UATH_DEV(GIGASET, AR5523), 175190688Sweongyo UATH_DEV(GIGASET, SMCWUSBTG), 176190688Sweongyo UATH_DEV(GLOBALSUN, AR5523_1), 177190688Sweongyo UATH_DEV(GLOBALSUN, AR5523_2), 178190688Sweongyo UATH_DEV(NETGEAR, WG111U), 179190688Sweongyo UATH_DEV(NETGEAR3, WG111T), 180190688Sweongyo UATH_DEV(NETGEAR3, WPN111), 181203143Sthompsa UATH_DEV(NETGEAR3, WPN111_2), 182190688Sweongyo UATH_DEV(UMEDIA, TEW444UBEU), 183190688Sweongyo UATH_DEV(UMEDIA, AR5523_2), 184190688Sweongyo UATH_DEV(WISTRONNEWEB, AR5523_1), 185190688Sweongyo UATH_DEV(WISTRONNEWEB, AR5523_2), 186190688Sweongyo UATH_DEV(ZCOM, AR5523) 187190688Sweongyo#undef UATH_DEV 188190688Sweongyo}; 189190688Sweongyo 190193045Sthompsastatic usb_callback_t uath_intr_rx_callback; 191193045Sthompsastatic usb_callback_t uath_intr_tx_callback; 192193045Sthompsastatic usb_callback_t uath_bulk_rx_callback; 193193045Sthompsastatic usb_callback_t uath_bulk_tx_callback; 194190688Sweongyo 195192984Sthompsastatic const struct usb_config uath_usbconfig[UATH_N_XFERS] = { 196190688Sweongyo [UATH_INTR_RX] = { 197190688Sweongyo .type = UE_BULK, 198190688Sweongyo .endpoint = 0x1, 199190688Sweongyo .direction = UE_DIR_IN, 200190744Sthompsa .bufsize = UATH_MAX_CMDSZ, 201190744Sthompsa .flags = { 202190688Sweongyo .pipe_bof = 1, 203190688Sweongyo .short_xfer_ok = 1 204190688Sweongyo }, 205190744Sthompsa .callback = uath_intr_rx_callback 206190688Sweongyo }, 207190688Sweongyo [UATH_INTR_TX] = { 208190688Sweongyo .type = UE_BULK, 209190688Sweongyo .endpoint = 0x1, 210190688Sweongyo .direction = UE_DIR_OUT, 211244503Shselasky .bufsize = UATH_MAX_CMDSZ * UATH_CMD_LIST_COUNT, 212190744Sthompsa .flags = { 213190688Sweongyo .force_short_xfer = 1, 214190688Sweongyo .pipe_bof = 1, 215190688Sweongyo }, 216190744Sthompsa .callback = uath_intr_tx_callback, 217190744Sthompsa .timeout = UATH_CMD_TIMEOUT 218190688Sweongyo }, 219190688Sweongyo [UATH_BULK_RX] = { 220190688Sweongyo .type = UE_BULK, 221190688Sweongyo .endpoint = 0x2, 222190688Sweongyo .direction = UE_DIR_IN, 223190744Sthompsa .bufsize = MCLBYTES, 224190744Sthompsa .flags = { 225190688Sweongyo .ext_buffer = 1, 226190688Sweongyo .pipe_bof = 1, 227190688Sweongyo .short_xfer_ok = 1 228190688Sweongyo }, 229190744Sthompsa .callback = uath_bulk_rx_callback 230190688Sweongyo }, 231190688Sweongyo [UATH_BULK_TX] = { 232190688Sweongyo .type = UE_BULK, 233190688Sweongyo .endpoint = 0x2, 234190688Sweongyo .direction = UE_DIR_OUT, 235244503Shselasky .bufsize = UATH_MAX_TXBUFSZ * UATH_TX_DATA_LIST_COUNT, 236190744Sthompsa .flags = { 237190688Sweongyo .force_short_xfer = 1, 238190688Sweongyo .pipe_bof = 1 239190688Sweongyo }, 240190744Sthompsa .callback = uath_bulk_tx_callback, 241190744Sthompsa .timeout = UATH_DATA_TIMEOUT 242190688Sweongyo } 243190688Sweongyo}; 244190688Sweongyo 245190688Sweongyostatic struct ieee80211vap *uath_vap_create(struct ieee80211com *, 246228621Sbschmidt const char [IFNAMSIZ], int, enum ieee80211_opmode, int, 247228621Sbschmidt const uint8_t [IEEE80211_ADDR_LEN], 248228621Sbschmidt const uint8_t [IEEE80211_ADDR_LEN]); 249190688Sweongyostatic void uath_vap_delete(struct ieee80211vap *); 250244503Shselaskystatic int uath_alloc_cmd_list(struct uath_softc *, struct uath_cmd []); 251244503Shselaskystatic void uath_free_cmd_list(struct uath_softc *, struct uath_cmd []); 252190688Sweongyostatic int uath_host_available(struct uath_softc *); 253190688Sweongyostatic int uath_get_capability(struct uath_softc *, uint32_t, uint32_t *); 254190688Sweongyostatic int uath_get_devcap(struct uath_softc *); 255190688Sweongyostatic struct uath_cmd * 256190688Sweongyo uath_get_cmdbuf(struct uath_softc *); 257190688Sweongyostatic int uath_cmd_read(struct uath_softc *, uint32_t, const void *, 258190688Sweongyo int, void *, int, int); 259190688Sweongyostatic int uath_cmd_write(struct uath_softc *, uint32_t, const void *, 260190688Sweongyo int, int); 261190688Sweongyostatic void uath_stat(void *); 262190688Sweongyo#ifdef UATH_DEBUG 263190688Sweongyostatic void uath_dump_cmd(const uint8_t *, int, char); 264190688Sweongyostatic const char * 265190688Sweongyo uath_codename(int); 266190688Sweongyo#endif 267190688Sweongyostatic int uath_get_devstatus(struct uath_softc *, 268190688Sweongyo uint8_t macaddr[IEEE80211_ADDR_LEN]); 269190688Sweongyostatic int uath_get_status(struct uath_softc *, uint32_t, void *, int); 270190688Sweongyostatic int uath_alloc_rx_data_list(struct uath_softc *); 271190688Sweongyostatic int uath_alloc_tx_data_list(struct uath_softc *); 272190688Sweongyostatic void uath_free_rx_data_list(struct uath_softc *); 273190688Sweongyostatic void uath_free_tx_data_list(struct uath_softc *); 274287197Sglebiusstatic int uath_init(struct uath_softc *); 275287197Sglebiusstatic void uath_stop(struct uath_softc *); 276287197Sglebiusstatic void uath_parent(struct ieee80211com *); 277287197Sglebiusstatic int uath_transmit(struct ieee80211com *, struct mbuf *); 278287197Sglebiusstatic void uath_start(struct uath_softc *); 279190688Sweongyostatic int uath_raw_xmit(struct ieee80211_node *, struct mbuf *, 280190688Sweongyo const struct ieee80211_bpf_params *); 281190688Sweongyostatic void uath_scan_start(struct ieee80211com *); 282190688Sweongyostatic void uath_scan_end(struct ieee80211com *); 283190688Sweongyostatic void uath_set_channel(struct ieee80211com *); 284283540Sglebiusstatic void uath_update_mcast(struct ieee80211com *); 285283540Sglebiusstatic void uath_update_promisc(struct ieee80211com *); 286190688Sweongyostatic int uath_config(struct uath_softc *, uint32_t, uint32_t); 287190688Sweongyostatic int uath_config_multi(struct uath_softc *, uint32_t, const void *, 288190688Sweongyo int); 289190688Sweongyostatic int uath_switch_channel(struct uath_softc *, 290190688Sweongyo struct ieee80211_channel *); 291190688Sweongyostatic int uath_set_rxfilter(struct uath_softc *, uint32_t, uint32_t); 292190688Sweongyostatic void uath_watchdog(void *); 293190688Sweongyostatic void uath_abort_xfers(struct uath_softc *); 294190688Sweongyostatic int uath_dataflush(struct uath_softc *); 295190688Sweongyostatic int uath_cmdflush(struct uath_softc *); 296190688Sweongyostatic int uath_flush(struct uath_softc *); 297190688Sweongyostatic int uath_set_ledstate(struct uath_softc *, int); 298190688Sweongyostatic int uath_set_chan(struct uath_softc *, struct ieee80211_channel *); 299190688Sweongyostatic int uath_reset_tx_queues(struct uath_softc *); 300190688Sweongyostatic int uath_wme_init(struct uath_softc *); 301190688Sweongyostatic struct uath_data * 302190688Sweongyo uath_getbuf(struct uath_softc *); 303190688Sweongyostatic int uath_newstate(struct ieee80211vap *, enum ieee80211_state, 304190688Sweongyo int); 305190688Sweongyostatic int uath_set_key(struct uath_softc *, 306190688Sweongyo const struct ieee80211_key *, int); 307190688Sweongyostatic int uath_set_keys(struct uath_softc *, struct ieee80211vap *); 308190688Sweongyostatic void uath_sysctl_node(struct uath_softc *); 309190688Sweongyo 310190688Sweongyostatic int 311190688Sweongyouath_match(device_t dev) 312190688Sweongyo{ 313192984Sthompsa struct usb_attach_arg *uaa = device_get_ivars(dev); 314190688Sweongyo 315192499Sthompsa if (uaa->usb_mode != USB_MODE_HOST) 316190688Sweongyo return (ENXIO); 317190688Sweongyo if (uaa->info.bConfigIndex != UATH_CONFIG_INDEX) 318190688Sweongyo return (ENXIO); 319190688Sweongyo if (uaa->info.bIfaceIndex != UATH_IFACE_INDEX) 320190688Sweongyo return (ENXIO); 321190688Sweongyo 322194228Sthompsa return (usbd_lookup_id_by_uaa(uath_devs, sizeof(uath_devs), uaa)); 323190688Sweongyo} 324190688Sweongyo 325190688Sweongyostatic int 326190688Sweongyouath_attach(device_t dev) 327190688Sweongyo{ 328190688Sweongyo struct uath_softc *sc = device_get_softc(dev); 329192984Sthompsa struct usb_attach_arg *uaa = device_get_ivars(dev); 330287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 331293339Savos uint8_t bands[howmany(IEEE80211_MODE_MAX, 8)]; 332293339Savos uint8_t iface_index = UATH_IFACE_INDEX; /* XXX */ 333193045Sthompsa usb_error_t error; 334190688Sweongyo 335190688Sweongyo sc->sc_dev = dev; 336190688Sweongyo sc->sc_udev = uaa->device; 337190688Sweongyo#ifdef UATH_DEBUG 338190688Sweongyo sc->sc_debug = uath_debug; 339190688Sweongyo#endif 340194228Sthompsa device_set_usb_desc(dev); 341190688Sweongyo 342190688Sweongyo /* 343190688Sweongyo * Only post-firmware devices here. 344190688Sweongyo */ 345190688Sweongyo mtx_init(&sc->sc_mtx, device_get_nameunit(sc->sc_dev), MTX_NETWORK_LOCK, 346190688Sweongyo MTX_DEF); 347190688Sweongyo callout_init(&sc->stat_ch, 0); 348190688Sweongyo callout_init_mtx(&sc->watchdog_ch, &sc->sc_mtx, 0); 349287197Sglebius mbufq_init(&sc->sc_snd, ifqmaxlen); 350190688Sweongyo 351194228Sthompsa error = usbd_transfer_setup(uaa->device, &iface_index, sc->sc_xfer, 352190688Sweongyo uath_usbconfig, UATH_N_XFERS, sc, &sc->sc_mtx); 353190688Sweongyo if (error) { 354190688Sweongyo device_printf(dev, "could not allocate USB transfers, " 355194228Sthompsa "err=%s\n", usbd_errstr(error)); 356246565Shselasky goto fail; 357190688Sweongyo } 358190688Sweongyo 359244503Shselasky sc->sc_cmd_dma_buf = 360244503Shselasky usbd_xfer_get_frame_buffer(sc->sc_xfer[UATH_INTR_TX], 0); 361244503Shselasky sc->sc_tx_dma_buf = 362244503Shselasky usbd_xfer_get_frame_buffer(sc->sc_xfer[UATH_BULK_TX], 0); 363244503Shselasky 364190688Sweongyo /* 365246565Shselasky * Setup buffers for firmware commands. 366246565Shselasky */ 367246565Shselasky error = uath_alloc_cmd_list(sc, sc->sc_cmd); 368246565Shselasky if (error != 0) { 369246565Shselasky device_printf(sc->sc_dev, 370246565Shselasky "could not allocate Tx command list\n"); 371246565Shselasky goto fail1; 372246565Shselasky } 373246565Shselasky 374246565Shselasky /* 375190688Sweongyo * We're now ready to send+receive firmware commands. 376190688Sweongyo */ 377190688Sweongyo UATH_LOCK(sc); 378190688Sweongyo error = uath_host_available(sc); 379190688Sweongyo if (error != 0) { 380190688Sweongyo device_printf(sc->sc_dev, "could not initialize adapter\n"); 381287197Sglebius goto fail2; 382190688Sweongyo } 383190688Sweongyo error = uath_get_devcap(sc); 384190688Sweongyo if (error != 0) { 385190688Sweongyo device_printf(sc->sc_dev, 386190688Sweongyo "could not get device capabilities\n"); 387287197Sglebius goto fail2; 388190688Sweongyo } 389190688Sweongyo UATH_UNLOCK(sc); 390190688Sweongyo 391190688Sweongyo /* Create device sysctl node. */ 392190688Sweongyo uath_sysctl_node(sc); 393190688Sweongyo 394190688Sweongyo UATH_LOCK(sc); 395287197Sglebius error = uath_get_devstatus(sc, ic->ic_macaddr); 396190688Sweongyo if (error != 0) { 397190688Sweongyo device_printf(sc->sc_dev, "could not get device status\n"); 398287197Sglebius goto fail2; 399190688Sweongyo } 400190688Sweongyo 401190688Sweongyo /* 402190688Sweongyo * Allocate xfers for Rx/Tx data pipes. 403190688Sweongyo */ 404190688Sweongyo error = uath_alloc_rx_data_list(sc); 405190688Sweongyo if (error != 0) { 406190688Sweongyo device_printf(sc->sc_dev, "could not allocate Rx data list\n"); 407287197Sglebius goto fail2; 408190688Sweongyo } 409190688Sweongyo error = uath_alloc_tx_data_list(sc); 410190688Sweongyo if (error != 0) { 411190688Sweongyo device_printf(sc->sc_dev, "could not allocate Tx data list\n"); 412287197Sglebius goto fail2; 413190688Sweongyo } 414190688Sweongyo UATH_UNLOCK(sc); 415190688Sweongyo 416283537Sglebius ic->ic_softc = sc; 417283527Sglebius ic->ic_name = device_get_nameunit(dev); 418190688Sweongyo ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ 419190688Sweongyo ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */ 420190688Sweongyo 421190688Sweongyo /* set device capabilities */ 422190688Sweongyo ic->ic_caps = 423190688Sweongyo IEEE80211_C_STA | /* station mode */ 424190688Sweongyo IEEE80211_C_MONITOR | /* monitor mode supported */ 425190688Sweongyo IEEE80211_C_TXPMGT | /* tx power management */ 426190688Sweongyo IEEE80211_C_SHPREAMBLE | /* short preamble supported */ 427190688Sweongyo IEEE80211_C_SHSLOT | /* short slot time supported */ 428190688Sweongyo IEEE80211_C_WPA | /* 802.11i */ 429190688Sweongyo IEEE80211_C_BGSCAN | /* capable of bg scanning */ 430190688Sweongyo IEEE80211_C_TXFRAG; /* handle tx frags */ 431190688Sweongyo 432190688Sweongyo /* put a regulatory domain to reveal informations. */ 433190688Sweongyo uath_regdomain = sc->sc_devcap.regDomain; 434190688Sweongyo 435293339Savos memset(bands, 0, sizeof(bands)); 436293339Savos setbit(bands, IEEE80211_MODE_11B); 437293339Savos setbit(bands, IEEE80211_MODE_11G); 438190688Sweongyo if ((sc->sc_devcap.analog5GhzRevision & 0xf0) == 0x30) 439293339Savos setbit(bands, IEEE80211_MODE_11A); 440190688Sweongyo /* XXX turbo */ 441293339Savos ieee80211_init_channels(ic, NULL, bands); 442190688Sweongyo 443287197Sglebius ieee80211_ifattach(ic); 444190688Sweongyo ic->ic_raw_xmit = uath_raw_xmit; 445190688Sweongyo ic->ic_scan_start = uath_scan_start; 446190688Sweongyo ic->ic_scan_end = uath_scan_end; 447190688Sweongyo ic->ic_set_channel = uath_set_channel; 448190688Sweongyo ic->ic_vap_create = uath_vap_create; 449190688Sweongyo ic->ic_vap_delete = uath_vap_delete; 450190688Sweongyo ic->ic_update_mcast = uath_update_mcast; 451190688Sweongyo ic->ic_update_promisc = uath_update_promisc; 452287197Sglebius ic->ic_transmit = uath_transmit; 453287197Sglebius ic->ic_parent = uath_parent; 454190688Sweongyo 455192468Ssam ieee80211_radiotap_attach(ic, 456192468Ssam &sc->sc_txtap.wt_ihdr, sizeof(sc->sc_txtap), 457192468Ssam UATH_TX_RADIOTAP_PRESENT, 458192468Ssam &sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap), 459192468Ssam UATH_RX_RADIOTAP_PRESENT); 460190688Sweongyo 461190688Sweongyo if (bootverbose) 462190688Sweongyo ieee80211_announce(ic); 463190688Sweongyo 464190688Sweongyo return (0); 465190688Sweongyo 466287197Sglebiusfail2: UATH_UNLOCK(sc); 467287197Sglebius uath_free_cmd_list(sc, sc->sc_cmd); 468246565Shselaskyfail1: usbd_transfer_unsetup(sc->sc_xfer, UATH_N_XFERS); 469190688Sweongyofail: 470190688Sweongyo return (error); 471190688Sweongyo} 472190688Sweongyo 473190688Sweongyostatic int 474190688Sweongyouath_detach(device_t dev) 475190688Sweongyo{ 476190688Sweongyo struct uath_softc *sc = device_get_softc(dev); 477287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 478246614Shselasky unsigned int x; 479190688Sweongyo 480246614Shselasky /* 481246614Shselasky * Prevent further allocations from RX/TX/CMD 482246614Shselasky * data lists and ioctls 483246614Shselasky */ 484194329Sweongyo UATH_LOCK(sc); 485190688Sweongyo sc->sc_flags |= UATH_FLAG_INVALID; 486246614Shselasky 487246614Shselasky STAILQ_INIT(&sc->sc_rx_active); 488246614Shselasky STAILQ_INIT(&sc->sc_rx_inactive); 489246614Shselasky 490246614Shselasky STAILQ_INIT(&sc->sc_tx_active); 491246614Shselasky STAILQ_INIT(&sc->sc_tx_inactive); 492246614Shselasky STAILQ_INIT(&sc->sc_tx_pending); 493246614Shselasky 494246614Shselasky STAILQ_INIT(&sc->sc_cmd_active); 495246614Shselasky STAILQ_INIT(&sc->sc_cmd_pending); 496246614Shselasky STAILQ_INIT(&sc->sc_cmd_waiting); 497246614Shselasky STAILQ_INIT(&sc->sc_cmd_inactive); 498287197Sglebius 499287197Sglebius uath_stop(sc); 500194329Sweongyo UATH_UNLOCK(sc); 501194329Sweongyo 502190688Sweongyo callout_drain(&sc->stat_ch); 503190688Sweongyo callout_drain(&sc->watchdog_ch); 504190688Sweongyo 505246614Shselasky /* drain USB transfers */ 506246614Shselasky for (x = 0; x != UATH_N_XFERS; x++) 507246614Shselasky usbd_transfer_drain(sc->sc_xfer[x]); 508190688Sweongyo 509246614Shselasky /* free data buffers */ 510190688Sweongyo UATH_LOCK(sc); 511190688Sweongyo uath_free_rx_data_list(sc); 512190688Sweongyo uath_free_tx_data_list(sc); 513244503Shselasky uath_free_cmd_list(sc, sc->sc_cmd); 514190688Sweongyo UATH_UNLOCK(sc); 515190688Sweongyo 516246614Shselasky /* free USB transfers and some data buffers */ 517246614Shselasky usbd_transfer_unsetup(sc->sc_xfer, UATH_N_XFERS); 518246614Shselasky 519246614Shselasky ieee80211_ifdetach(ic); 520287197Sglebius mbufq_drain(&sc->sc_snd); 521190688Sweongyo mtx_destroy(&sc->sc_mtx); 522190688Sweongyo return (0); 523190688Sweongyo} 524190688Sweongyo 525190688Sweongyostatic void 526244503Shselaskyuath_free_cmd_list(struct uath_softc *sc, struct uath_cmd cmds[]) 527190688Sweongyo{ 528190688Sweongyo int i; 529190688Sweongyo 530244503Shselasky for (i = 0; i != UATH_CMD_LIST_COUNT; i++) 531244503Shselasky cmds[i].buf = NULL; 532190688Sweongyo} 533190688Sweongyo 534190688Sweongyostatic int 535244503Shselaskyuath_alloc_cmd_list(struct uath_softc *sc, struct uath_cmd cmds[]) 536190688Sweongyo{ 537244503Shselasky int i; 538190688Sweongyo 539190688Sweongyo STAILQ_INIT(&sc->sc_cmd_active); 540190688Sweongyo STAILQ_INIT(&sc->sc_cmd_pending); 541190688Sweongyo STAILQ_INIT(&sc->sc_cmd_waiting); 542190688Sweongyo STAILQ_INIT(&sc->sc_cmd_inactive); 543190688Sweongyo 544244503Shselasky for (i = 0; i != UATH_CMD_LIST_COUNT; i++) { 545190688Sweongyo struct uath_cmd *cmd = &cmds[i]; 546190688Sweongyo 547190688Sweongyo cmd->sc = sc; /* backpointer for callbacks */ 548190688Sweongyo cmd->msgid = i; 549244503Shselasky cmd->buf = ((uint8_t *)sc->sc_cmd_dma_buf) + 550244503Shselasky (i * UATH_MAX_CMDSZ); 551190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_cmd_inactive, cmd, next); 552190688Sweongyo UATH_STAT_INC(sc, st_cmd_inactive); 553190688Sweongyo } 554190688Sweongyo return (0); 555190688Sweongyo} 556190688Sweongyo 557190688Sweongyostatic int 558190688Sweongyouath_host_available(struct uath_softc *sc) 559190688Sweongyo{ 560190688Sweongyo struct uath_cmd_host_available setup; 561190688Sweongyo 562190688Sweongyo UATH_ASSERT_LOCKED(sc); 563190688Sweongyo 564190688Sweongyo /* inform target the host is available */ 565190688Sweongyo setup.sw_ver_major = htobe32(ATH_SW_VER_MAJOR); 566190688Sweongyo setup.sw_ver_minor = htobe32(ATH_SW_VER_MINOR); 567190688Sweongyo setup.sw_ver_patch = htobe32(ATH_SW_VER_PATCH); 568190688Sweongyo setup.sw_ver_build = htobe32(ATH_SW_VER_BUILD); 569190688Sweongyo return uath_cmd_read(sc, WDCMSG_HOST_AVAILABLE, 570190688Sweongyo &setup, sizeof setup, NULL, 0, 0); 571190688Sweongyo} 572190688Sweongyo 573190688Sweongyo#ifdef UATH_DEBUG 574190688Sweongyostatic void 575190688Sweongyouath_dump_cmd(const uint8_t *buf, int len, char prefix) 576190688Sweongyo{ 577190688Sweongyo const char *sep = ""; 578190688Sweongyo int i; 579190688Sweongyo 580190688Sweongyo for (i = 0; i < len; i++) { 581190688Sweongyo if ((i % 16) == 0) { 582190688Sweongyo printf("%s%c ", sep, prefix); 583190688Sweongyo sep = "\n"; 584190688Sweongyo } 585190688Sweongyo else if ((i % 4) == 0) 586190688Sweongyo printf(" "); 587190688Sweongyo printf("%02x", buf[i]); 588190688Sweongyo } 589190688Sweongyo printf("\n"); 590190688Sweongyo} 591190688Sweongyo 592190688Sweongyostatic const char * 593190688Sweongyouath_codename(int code) 594190688Sweongyo{ 595190688Sweongyo static const char *names[] = { 596190688Sweongyo "0x00", 597190688Sweongyo "HOST_AVAILABLE", 598190688Sweongyo "BIND", 599190688Sweongyo "TARGET_RESET", 600190688Sweongyo "TARGET_GET_CAPABILITY", 601190688Sweongyo "TARGET_SET_CONFIG", 602190688Sweongyo "TARGET_GET_STATUS", 603190688Sweongyo "TARGET_GET_STATS", 604190688Sweongyo "TARGET_START", 605190688Sweongyo "TARGET_STOP", 606190688Sweongyo "TARGET_ENABLE", 607190688Sweongyo "TARGET_DISABLE", 608190688Sweongyo "CREATE_CONNECTION", 609190688Sweongyo "UPDATE_CONNECT_ATTR", 610190688Sweongyo "DELETE_CONNECT", 611190688Sweongyo "SEND", 612190688Sweongyo "FLUSH", 613190688Sweongyo "STATS_UPDATE", 614190688Sweongyo "BMISS", 615190688Sweongyo "DEVICE_AVAIL", 616190688Sweongyo "SEND_COMPLETE", 617190688Sweongyo "DATA_AVAIL", 618190688Sweongyo "SET_PWR_MODE", 619190688Sweongyo "BMISS_ACK", 620190688Sweongyo "SET_LED_STEADY", 621190688Sweongyo "SET_LED_BLINK", 622190688Sweongyo "SETUP_BEACON_DESC", 623190688Sweongyo "BEACON_INIT", 624190688Sweongyo "RESET_KEY_CACHE", 625190688Sweongyo "RESET_KEY_CACHE_ENTRY", 626190688Sweongyo "SET_KEY_CACHE_ENTRY", 627190688Sweongyo "SET_DECOMP_MASK", 628190688Sweongyo "SET_REGULATORY_DOMAIN", 629190688Sweongyo "SET_LED_STATE", 630190688Sweongyo "WRITE_ASSOCID", 631190688Sweongyo "SET_STA_BEACON_TIMERS", 632190688Sweongyo "GET_TSF", 633190688Sweongyo "RESET_TSF", 634190688Sweongyo "SET_ADHOC_MODE", 635190688Sweongyo "SET_BASIC_RATE", 636190688Sweongyo "MIB_CONTROL", 637190688Sweongyo "GET_CHANNEL_DATA", 638190688Sweongyo "GET_CUR_RSSI", 639190688Sweongyo "SET_ANTENNA_SWITCH", 640190688Sweongyo "0x2c", "0x2d", "0x2e", 641190688Sweongyo "USE_SHORT_SLOT_TIME", 642190688Sweongyo "SET_POWER_MODE", 643190688Sweongyo "SETUP_PSPOLL_DESC", 644190688Sweongyo "SET_RX_MULTICAST_FILTER", 645190688Sweongyo "RX_FILTER", 646190688Sweongyo "PER_CALIBRATION", 647190688Sweongyo "RESET", 648190688Sweongyo "DISABLE", 649190688Sweongyo "PHY_DISABLE", 650190688Sweongyo "SET_TX_POWER_LIMIT", 651190688Sweongyo "SET_TX_QUEUE_PARAMS", 652190688Sweongyo "SETUP_TX_QUEUE", 653190688Sweongyo "RELEASE_TX_QUEUE", 654190688Sweongyo }; 655190688Sweongyo static char buf[8]; 656190688Sweongyo 657288088Sadrian if (code < nitems(names)) 658190688Sweongyo return names[code]; 659190688Sweongyo if (code == WDCMSG_SET_DEFAULT_KEY) 660190688Sweongyo return "SET_DEFAULT_KEY"; 661190688Sweongyo snprintf(buf, sizeof(buf), "0x%02x", code); 662190688Sweongyo return buf; 663190688Sweongyo} 664190688Sweongyo#endif 665190688Sweongyo 666190688Sweongyo/* 667190688Sweongyo * Low-level function to send read or write commands to the firmware. 668190688Sweongyo */ 669190688Sweongyostatic int 670190688Sweongyouath_cmdsend(struct uath_softc *sc, uint32_t code, const void *idata, int ilen, 671190688Sweongyo void *odata, int olen, int flags) 672190688Sweongyo{ 673190688Sweongyo struct uath_cmd_hdr *hdr; 674190688Sweongyo struct uath_cmd *cmd; 675190688Sweongyo int error; 676190688Sweongyo 677190688Sweongyo UATH_ASSERT_LOCKED(sc); 678190688Sweongyo 679190688Sweongyo /* grab a xfer */ 680190688Sweongyo cmd = uath_get_cmdbuf(sc); 681190688Sweongyo if (cmd == NULL) { 682190688Sweongyo device_printf(sc->sc_dev, "%s: empty inactive queue\n", 683190688Sweongyo __func__); 684190688Sweongyo return (ENOBUFS); 685190688Sweongyo } 686190688Sweongyo cmd->flags = flags; 687190688Sweongyo /* always bulk-out a multiple of 4 bytes */ 688190688Sweongyo cmd->buflen = roundup2(sizeof(struct uath_cmd_hdr) + ilen, 4); 689190688Sweongyo 690190688Sweongyo hdr = (struct uath_cmd_hdr *)cmd->buf; 691227461Shselasky memset(hdr, 0, sizeof(struct uath_cmd_hdr)); 692190688Sweongyo hdr->len = htobe32(cmd->buflen); 693190688Sweongyo hdr->code = htobe32(code); 694190688Sweongyo hdr->msgid = cmd->msgid; /* don't care about endianness */ 695190688Sweongyo hdr->magic = htobe32((cmd->flags & UATH_CMD_FLAG_MAGIC) ? 1 << 24 : 0); 696227461Shselasky memcpy((uint8_t *)(hdr + 1), idata, ilen); 697190688Sweongyo 698190688Sweongyo#ifdef UATH_DEBUG 699190688Sweongyo if (sc->sc_debug & UATH_DEBUG_CMDS) { 700190688Sweongyo printf("%s: send %s [flags 0x%x] olen %d\n", 701190688Sweongyo __func__, uath_codename(code), cmd->flags, olen); 702190688Sweongyo if (sc->sc_debug & UATH_DEBUG_CMDS_DUMP) 703190688Sweongyo uath_dump_cmd(cmd->buf, cmd->buflen, '+'); 704190688Sweongyo } 705190688Sweongyo#endif 706190688Sweongyo cmd->odata = odata; 707190688Sweongyo KASSERT(odata == NULL || 708190688Sweongyo olen < UATH_MAX_CMDSZ - sizeof(*hdr) + sizeof(uint32_t), 709190688Sweongyo ("odata %p olen %u", odata, olen)); 710190688Sweongyo cmd->olen = olen; 711190688Sweongyo 712190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_cmd_pending, cmd, next); 713190688Sweongyo UATH_STAT_INC(sc, st_cmd_pending); 714194228Sthompsa usbd_transfer_start(sc->sc_xfer[UATH_INTR_TX]); 715190688Sweongyo 716190688Sweongyo if (cmd->flags & UATH_CMD_FLAG_READ) { 717194228Sthompsa usbd_transfer_start(sc->sc_xfer[UATH_INTR_RX]); 718190688Sweongyo 719190688Sweongyo /* wait at most two seconds for command reply */ 720190688Sweongyo error = mtx_sleep(cmd, &sc->sc_mtx, 0, "uathcmd", 2 * hz); 721190688Sweongyo cmd->odata = NULL; /* in case reply comes too late */ 722190688Sweongyo if (error != 0) { 723190688Sweongyo device_printf(sc->sc_dev, "timeout waiting for reply " 724190688Sweongyo "to cmd 0x%x (%u)\n", code, code); 725190688Sweongyo } else if (cmd->olen != olen) { 726190688Sweongyo device_printf(sc->sc_dev, "unexpected reply data count " 727190688Sweongyo "to cmd 0x%x (%u), got %u, expected %u\n", 728190688Sweongyo code, code, cmd->olen, olen); 729190688Sweongyo error = EINVAL; 730190688Sweongyo } 731190688Sweongyo return (error); 732190688Sweongyo } 733190688Sweongyo return (0); 734190688Sweongyo} 735190688Sweongyo 736190688Sweongyostatic int 737190688Sweongyouath_cmd_read(struct uath_softc *sc, uint32_t code, const void *idata, 738190688Sweongyo int ilen, void *odata, int olen, int flags) 739190688Sweongyo{ 740190688Sweongyo 741190688Sweongyo flags |= UATH_CMD_FLAG_READ; 742190688Sweongyo return uath_cmdsend(sc, code, idata, ilen, odata, olen, flags); 743190688Sweongyo} 744190688Sweongyo 745190688Sweongyostatic int 746190688Sweongyouath_cmd_write(struct uath_softc *sc, uint32_t code, const void *data, int len, 747190688Sweongyo int flags) 748190688Sweongyo{ 749190688Sweongyo 750190688Sweongyo flags &= ~UATH_CMD_FLAG_READ; 751190688Sweongyo return uath_cmdsend(sc, code, data, len, NULL, 0, flags); 752190688Sweongyo} 753190688Sweongyo 754190688Sweongyostatic struct uath_cmd * 755190688Sweongyouath_get_cmdbuf(struct uath_softc *sc) 756190688Sweongyo{ 757190688Sweongyo struct uath_cmd *uc; 758190688Sweongyo 759190688Sweongyo UATH_ASSERT_LOCKED(sc); 760190688Sweongyo 761190688Sweongyo uc = STAILQ_FIRST(&sc->sc_cmd_inactive); 762190688Sweongyo if (uc != NULL) { 763190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_cmd_inactive, next); 764190688Sweongyo UATH_STAT_DEC(sc, st_cmd_inactive); 765190688Sweongyo } else 766190688Sweongyo uc = NULL; 767190688Sweongyo if (uc == NULL) 768190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, "%s: %s\n", __func__, 769190688Sweongyo "out of command xmit buffers"); 770190688Sweongyo return (uc); 771190688Sweongyo} 772190688Sweongyo 773190688Sweongyo/* 774190688Sweongyo * This function is called periodically (every second) when associated to 775190688Sweongyo * query device statistics. 776190688Sweongyo */ 777190688Sweongyostatic void 778190688Sweongyouath_stat(void *arg) 779190688Sweongyo{ 780190688Sweongyo struct uath_softc *sc = arg; 781190688Sweongyo int error; 782190688Sweongyo 783190688Sweongyo UATH_LOCK(sc); 784190688Sweongyo /* 785190688Sweongyo * Send request for statistics asynchronously. The timer will be 786190688Sweongyo * restarted when we'll get the stats notification. 787190688Sweongyo */ 788190688Sweongyo error = uath_cmd_write(sc, WDCMSG_TARGET_GET_STATS, NULL, 0, 789190688Sweongyo UATH_CMD_FLAG_ASYNC); 790190688Sweongyo if (error != 0) { 791190688Sweongyo device_printf(sc->sc_dev, 792190688Sweongyo "could not query stats, error %d\n", error); 793190688Sweongyo } 794190688Sweongyo UATH_UNLOCK(sc); 795190688Sweongyo} 796190688Sweongyo 797190688Sweongyostatic int 798190688Sweongyouath_get_capability(struct uath_softc *sc, uint32_t cap, uint32_t *val) 799190688Sweongyo{ 800190688Sweongyo int error; 801190688Sweongyo 802190688Sweongyo cap = htobe32(cap); 803190688Sweongyo error = uath_cmd_read(sc, WDCMSG_TARGET_GET_CAPABILITY, 804190688Sweongyo &cap, sizeof cap, val, sizeof(uint32_t), UATH_CMD_FLAG_MAGIC); 805190688Sweongyo if (error != 0) { 806190688Sweongyo device_printf(sc->sc_dev, "could not read capability %u\n", 807190688Sweongyo be32toh(cap)); 808190688Sweongyo return (error); 809190688Sweongyo } 810190688Sweongyo *val = be32toh(*val); 811190688Sweongyo return (error); 812190688Sweongyo} 813190688Sweongyo 814190688Sweongyostatic int 815190688Sweongyouath_get_devcap(struct uath_softc *sc) 816190688Sweongyo{ 817190688Sweongyo#define GETCAP(x, v) do { \ 818190688Sweongyo error = uath_get_capability(sc, x, &v); \ 819190688Sweongyo if (error != 0) \ 820190688Sweongyo return (error); \ 821190688Sweongyo DPRINTF(sc, UATH_DEBUG_DEVCAP, \ 822190688Sweongyo "%s: %s=0x%08x\n", __func__, #x, v); \ 823190688Sweongyo} while (0) 824190688Sweongyo struct uath_devcap *cap = &sc->sc_devcap; 825190688Sweongyo int error; 826190688Sweongyo 827190688Sweongyo /* collect device capabilities */ 828190688Sweongyo GETCAP(CAP_TARGET_VERSION, cap->targetVersion); 829190688Sweongyo GETCAP(CAP_TARGET_REVISION, cap->targetRevision); 830190688Sweongyo GETCAP(CAP_MAC_VERSION, cap->macVersion); 831190688Sweongyo GETCAP(CAP_MAC_REVISION, cap->macRevision); 832190688Sweongyo GETCAP(CAP_PHY_REVISION, cap->phyRevision); 833190688Sweongyo GETCAP(CAP_ANALOG_5GHz_REVISION, cap->analog5GhzRevision); 834190688Sweongyo GETCAP(CAP_ANALOG_2GHz_REVISION, cap->analog2GhzRevision); 835190688Sweongyo 836190688Sweongyo GETCAP(CAP_REG_DOMAIN, cap->regDomain); 837190688Sweongyo GETCAP(CAP_REG_CAP_BITS, cap->regCapBits); 838190688Sweongyo#if 0 839190688Sweongyo /* NB: not supported in rev 1.5 */ 840190688Sweongyo GETCAP(CAP_COUNTRY_CODE, cap->countryCode); 841190688Sweongyo#endif 842190688Sweongyo GETCAP(CAP_WIRELESS_MODES, cap->wirelessModes); 843190688Sweongyo GETCAP(CAP_CHAN_SPREAD_SUPPORT, cap->chanSpreadSupport); 844190688Sweongyo GETCAP(CAP_COMPRESS_SUPPORT, cap->compressSupport); 845190688Sweongyo GETCAP(CAP_BURST_SUPPORT, cap->burstSupport); 846190688Sweongyo GETCAP(CAP_FAST_FRAMES_SUPPORT, cap->fastFramesSupport); 847190688Sweongyo GETCAP(CAP_CHAP_TUNING_SUPPORT, cap->chapTuningSupport); 848190688Sweongyo GETCAP(CAP_TURBOG_SUPPORT, cap->turboGSupport); 849190688Sweongyo GETCAP(CAP_TURBO_PRIME_SUPPORT, cap->turboPrimeSupport); 850190688Sweongyo GETCAP(CAP_DEVICE_TYPE, cap->deviceType); 851190688Sweongyo GETCAP(CAP_WME_SUPPORT, cap->wmeSupport); 852190688Sweongyo GETCAP(CAP_TOTAL_QUEUES, cap->numTxQueues); 853190688Sweongyo GETCAP(CAP_CONNECTION_ID_MAX, cap->connectionIdMax); 854190688Sweongyo 855190688Sweongyo GETCAP(CAP_LOW_5GHZ_CHAN, cap->low5GhzChan); 856190688Sweongyo GETCAP(CAP_HIGH_5GHZ_CHAN, cap->high5GhzChan); 857190688Sweongyo GETCAP(CAP_LOW_2GHZ_CHAN, cap->low2GhzChan); 858190688Sweongyo GETCAP(CAP_HIGH_2GHZ_CHAN, cap->high2GhzChan); 859190688Sweongyo GETCAP(CAP_TWICE_ANTENNAGAIN_5G, cap->twiceAntennaGain5G); 860190688Sweongyo GETCAP(CAP_TWICE_ANTENNAGAIN_2G, cap->twiceAntennaGain2G); 861190688Sweongyo 862190688Sweongyo GETCAP(CAP_CIPHER_AES_CCM, cap->supportCipherAES_CCM); 863190688Sweongyo GETCAP(CAP_CIPHER_TKIP, cap->supportCipherTKIP); 864190688Sweongyo GETCAP(CAP_MIC_TKIP, cap->supportMicTKIP); 865190688Sweongyo 866190688Sweongyo cap->supportCipherWEP = 1; /* NB: always available */ 867190688Sweongyo 868190688Sweongyo return (0); 869190688Sweongyo} 870190688Sweongyo 871190688Sweongyostatic int 872190688Sweongyouath_get_devstatus(struct uath_softc *sc, uint8_t macaddr[IEEE80211_ADDR_LEN]) 873190688Sweongyo{ 874190688Sweongyo int error; 875190688Sweongyo 876190688Sweongyo /* retrieve MAC address */ 877190688Sweongyo error = uath_get_status(sc, ST_MAC_ADDR, macaddr, IEEE80211_ADDR_LEN); 878190688Sweongyo if (error != 0) { 879190688Sweongyo device_printf(sc->sc_dev, "could not read MAC address\n"); 880190688Sweongyo return (error); 881190688Sweongyo } 882190688Sweongyo 883190688Sweongyo error = uath_get_status(sc, ST_SERIAL_NUMBER, 884190688Sweongyo &sc->sc_serial[0], sizeof(sc->sc_serial)); 885190688Sweongyo if (error != 0) { 886190688Sweongyo device_printf(sc->sc_dev, 887190688Sweongyo "could not read device serial number\n"); 888190688Sweongyo return (error); 889190688Sweongyo } 890190688Sweongyo return (0); 891190688Sweongyo} 892190688Sweongyo 893190688Sweongyostatic int 894190688Sweongyouath_get_status(struct uath_softc *sc, uint32_t which, void *odata, int olen) 895190688Sweongyo{ 896190688Sweongyo int error; 897190688Sweongyo 898190688Sweongyo which = htobe32(which); 899190688Sweongyo error = uath_cmd_read(sc, WDCMSG_TARGET_GET_STATUS, 900190688Sweongyo &which, sizeof(which), odata, olen, UATH_CMD_FLAG_MAGIC); 901190688Sweongyo if (error != 0) 902190688Sweongyo device_printf(sc->sc_dev, 903190688Sweongyo "could not read EEPROM offset 0x%02x\n", be32toh(which)); 904190688Sweongyo return (error); 905190688Sweongyo} 906190688Sweongyo 907190688Sweongyostatic void 908190688Sweongyouath_free_data_list(struct uath_softc *sc, struct uath_data data[], int ndata, 909190688Sweongyo int fillmbuf) 910190688Sweongyo{ 911190688Sweongyo int i; 912190688Sweongyo 913190688Sweongyo for (i = 0; i < ndata; i++) { 914190688Sweongyo struct uath_data *dp = &data[i]; 915190688Sweongyo 916190688Sweongyo if (fillmbuf == 1) { 917190688Sweongyo if (dp->m != NULL) { 918190688Sweongyo m_freem(dp->m); 919190688Sweongyo dp->m = NULL; 920190688Sweongyo dp->buf = NULL; 921190688Sweongyo } 922190688Sweongyo } else { 923244503Shselasky dp->buf = NULL; 924190688Sweongyo } 925246614Shselasky if (dp->ni != NULL) { 926246614Shselasky ieee80211_free_node(dp->ni); 927246614Shselasky dp->ni = NULL; 928246614Shselasky } 929190688Sweongyo } 930190688Sweongyo} 931190688Sweongyo 932190688Sweongyostatic int 933190688Sweongyouath_alloc_data_list(struct uath_softc *sc, struct uath_data data[], 934244503Shselasky int ndata, int maxsz, void *dma_buf) 935190688Sweongyo{ 936190688Sweongyo int i, error; 937190688Sweongyo 938190688Sweongyo for (i = 0; i < ndata; i++) { 939190688Sweongyo struct uath_data *dp = &data[i]; 940190688Sweongyo 941190688Sweongyo dp->sc = sc; 942244503Shselasky if (dma_buf == NULL) { 943190688Sweongyo /* XXX check maxsz */ 944243857Sglebius dp->m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 945190688Sweongyo if (dp->m == NULL) { 946190688Sweongyo device_printf(sc->sc_dev, 947190688Sweongyo "could not allocate rx mbuf\n"); 948190688Sweongyo error = ENOMEM; 949190688Sweongyo goto fail; 950190688Sweongyo } 951190688Sweongyo dp->buf = mtod(dp->m, uint8_t *); 952190688Sweongyo } else { 953190688Sweongyo dp->m = NULL; 954244503Shselasky dp->buf = ((uint8_t *)dma_buf) + (i * maxsz); 955190688Sweongyo } 956190688Sweongyo dp->ni = NULL; 957190688Sweongyo } 958190688Sweongyo 959190688Sweongyo return (0); 960190688Sweongyo 961244503Shselaskyfail: uath_free_data_list(sc, data, ndata, 1 /* free mbufs */); 962190688Sweongyo return (error); 963190688Sweongyo} 964190688Sweongyo 965190688Sweongyostatic int 966190688Sweongyouath_alloc_rx_data_list(struct uath_softc *sc) 967190688Sweongyo{ 968190688Sweongyo int error, i; 969190688Sweongyo 970190688Sweongyo /* XXX is it enough to store the RX packet with MCLBYTES bytes? */ 971190688Sweongyo error = uath_alloc_data_list(sc, 972190688Sweongyo sc->sc_rx, UATH_RX_DATA_LIST_COUNT, MCLBYTES, 973244503Shselasky NULL /* setup mbufs */); 974190688Sweongyo if (error != 0) 975190688Sweongyo return (error); 976190688Sweongyo 977190688Sweongyo STAILQ_INIT(&sc->sc_rx_active); 978190688Sweongyo STAILQ_INIT(&sc->sc_rx_inactive); 979190688Sweongyo 980190688Sweongyo for (i = 0; i < UATH_RX_DATA_LIST_COUNT; i++) { 981190688Sweongyo STAILQ_INSERT_HEAD(&sc->sc_rx_inactive, &sc->sc_rx[i], 982190688Sweongyo next); 983190688Sweongyo UATH_STAT_INC(sc, st_rx_inactive); 984190688Sweongyo } 985190688Sweongyo 986190688Sweongyo return (0); 987190688Sweongyo} 988190688Sweongyo 989190688Sweongyostatic int 990190688Sweongyouath_alloc_tx_data_list(struct uath_softc *sc) 991190688Sweongyo{ 992190688Sweongyo int error, i; 993190688Sweongyo 994190688Sweongyo error = uath_alloc_data_list(sc, 995190688Sweongyo sc->sc_tx, UATH_TX_DATA_LIST_COUNT, UATH_MAX_TXBUFSZ, 996244503Shselasky sc->sc_tx_dma_buf); 997190688Sweongyo if (error != 0) 998190688Sweongyo return (error); 999190688Sweongyo 1000190688Sweongyo STAILQ_INIT(&sc->sc_tx_active); 1001190688Sweongyo STAILQ_INIT(&sc->sc_tx_inactive); 1002190688Sweongyo STAILQ_INIT(&sc->sc_tx_pending); 1003190688Sweongyo 1004190688Sweongyo for (i = 0; i < UATH_TX_DATA_LIST_COUNT; i++) { 1005190688Sweongyo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, &sc->sc_tx[i], 1006190688Sweongyo next); 1007190688Sweongyo UATH_STAT_INC(sc, st_tx_inactive); 1008190688Sweongyo } 1009190688Sweongyo 1010190688Sweongyo return (0); 1011190688Sweongyo} 1012190688Sweongyo 1013190688Sweongyostatic void 1014190688Sweongyouath_free_rx_data_list(struct uath_softc *sc) 1015190688Sweongyo{ 1016190688Sweongyo uath_free_data_list(sc, sc->sc_rx, UATH_RX_DATA_LIST_COUNT, 1017190688Sweongyo 1 /* free mbufs */); 1018190688Sweongyo} 1019190688Sweongyo 1020190688Sweongyostatic void 1021190688Sweongyouath_free_tx_data_list(struct uath_softc *sc) 1022190688Sweongyo{ 1023190688Sweongyo uath_free_data_list(sc, sc->sc_tx, UATH_TX_DATA_LIST_COUNT, 1024190688Sweongyo 0 /* no mbufs */); 1025190688Sweongyo} 1026190688Sweongyo 1027190688Sweongyostatic struct ieee80211vap * 1028228621Sbschmidtuath_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit, 1029228621Sbschmidt enum ieee80211_opmode opmode, int flags, 1030228621Sbschmidt const uint8_t bssid[IEEE80211_ADDR_LEN], 1031228621Sbschmidt const uint8_t mac[IEEE80211_ADDR_LEN]) 1032190688Sweongyo{ 1033190688Sweongyo struct uath_vap *uvp; 1034190688Sweongyo struct ieee80211vap *vap; 1035190688Sweongyo 1036190688Sweongyo if (!TAILQ_EMPTY(&ic->ic_vaps)) /* only one at a time */ 1037190688Sweongyo return (NULL); 1038287197Sglebius uvp = malloc(sizeof(struct uath_vap), M_80211_VAP, M_WAITOK | M_ZERO); 1039190688Sweongyo vap = &uvp->vap; 1040190688Sweongyo /* enable s/w bmiss handling for sta mode */ 1041190688Sweongyo 1042257743Shselasky if (ieee80211_vap_setup(ic, vap, name, unit, opmode, 1043287197Sglebius flags | IEEE80211_CLONE_NOBEACONS, bssid) != 0) { 1044257743Shselasky /* out of memory */ 1045257743Shselasky free(uvp, M_80211_VAP); 1046257743Shselasky return (NULL); 1047257743Shselasky } 1048257743Shselasky 1049190688Sweongyo /* override state transition machine */ 1050190688Sweongyo uvp->newstate = vap->iv_newstate; 1051190688Sweongyo vap->iv_newstate = uath_newstate; 1052190688Sweongyo 1053190688Sweongyo /* complete setup */ 1054190688Sweongyo ieee80211_vap_attach(vap, ieee80211_media_change, 1055287197Sglebius ieee80211_media_status, mac); 1056190688Sweongyo ic->ic_opmode = opmode; 1057190688Sweongyo return (vap); 1058190688Sweongyo} 1059190688Sweongyo 1060190688Sweongyostatic void 1061190688Sweongyouath_vap_delete(struct ieee80211vap *vap) 1062190688Sweongyo{ 1063190688Sweongyo struct uath_vap *uvp = UATH_VAP(vap); 1064190688Sweongyo 1065190688Sweongyo ieee80211_vap_detach(vap); 1066190688Sweongyo free(uvp, M_80211_VAP); 1067190688Sweongyo} 1068190688Sweongyo 1069190688Sweongyostatic int 1070287197Sglebiusuath_init(struct uath_softc *sc) 1071190688Sweongyo{ 1072287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 1073287197Sglebius struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 1074190688Sweongyo uint32_t val; 1075190688Sweongyo int error; 1076190688Sweongyo 1077190688Sweongyo UATH_ASSERT_LOCKED(sc); 1078190688Sweongyo 1079287197Sglebius if (sc->sc_flags & UATH_FLAG_INITDONE) 1080287197Sglebius uath_stop(sc); 1081190688Sweongyo 1082190688Sweongyo /* reset variables */ 1083190688Sweongyo sc->sc_intrx_nextnum = sc->sc_msgid = 0; 1084190688Sweongyo 1085190688Sweongyo val = htobe32(0); 1086190688Sweongyo uath_cmd_write(sc, WDCMSG_BIND, &val, sizeof val, 0); 1087190688Sweongyo 1088190688Sweongyo /* set MAC address */ 1089287197Sglebius uath_config_multi(sc, CFG_MAC_ADDR, 1090287197Sglebius vap ? vap->iv_myaddr : ic->ic_macaddr, IEEE80211_ADDR_LEN); 1091190688Sweongyo 1092190688Sweongyo /* XXX honor net80211 state */ 1093190688Sweongyo uath_config(sc, CFG_RATE_CONTROL_ENABLE, 0x00000001); 1094190688Sweongyo uath_config(sc, CFG_DIVERSITY_CTL, 0x00000001); 1095190688Sweongyo uath_config(sc, CFG_ABOLT, 0x0000003f); 1096190688Sweongyo uath_config(sc, CFG_WME_ENABLED, 0x00000001); 1097190688Sweongyo 1098190688Sweongyo uath_config(sc, CFG_SERVICE_TYPE, 1); 1099190688Sweongyo uath_config(sc, CFG_TP_SCALE, 0x00000000); 1100190688Sweongyo uath_config(sc, CFG_TPC_HALF_DBM5, 0x0000003c); 1101190688Sweongyo uath_config(sc, CFG_TPC_HALF_DBM2, 0x0000003c); 1102190688Sweongyo uath_config(sc, CFG_OVERRD_TX_POWER, 0x00000000); 1103190688Sweongyo uath_config(sc, CFG_GMODE_PROTECTION, 0x00000000); 1104190688Sweongyo uath_config(sc, CFG_GMODE_PROTECT_RATE_INDEX, 0x00000003); 1105190688Sweongyo uath_config(sc, CFG_PROTECTION_TYPE, 0x00000000); 1106190688Sweongyo uath_config(sc, CFG_MODE_CTS, 0x00000002); 1107190688Sweongyo 1108190688Sweongyo error = uath_cmd_read(sc, WDCMSG_TARGET_START, NULL, 0, 1109190688Sweongyo &val, sizeof(val), UATH_CMD_FLAG_MAGIC); 1110190688Sweongyo if (error) { 1111190688Sweongyo device_printf(sc->sc_dev, 1112190688Sweongyo "could not start target, error %d\n", error); 1113190688Sweongyo goto fail; 1114190688Sweongyo } 1115190688Sweongyo DPRINTF(sc, UATH_DEBUG_INIT, "%s returns handle: 0x%x\n", 1116190688Sweongyo uath_codename(WDCMSG_TARGET_START), be32toh(val)); 1117190688Sweongyo 1118190688Sweongyo /* set default channel */ 1119190688Sweongyo error = uath_switch_channel(sc, ic->ic_curchan); 1120190688Sweongyo if (error) { 1121190688Sweongyo device_printf(sc->sc_dev, 1122190688Sweongyo "could not switch channel, error %d\n", error); 1123190688Sweongyo goto fail; 1124190688Sweongyo } 1125190688Sweongyo 1126190688Sweongyo val = htobe32(TARGET_DEVICE_AWAKE); 1127190688Sweongyo uath_cmd_write(sc, WDCMSG_SET_PWR_MODE, &val, sizeof val, 0); 1128190688Sweongyo /* XXX? check */ 1129190688Sweongyo uath_cmd_write(sc, WDCMSG_RESET_KEY_CACHE, NULL, 0, 0); 1130190688Sweongyo 1131194228Sthompsa usbd_transfer_start(sc->sc_xfer[UATH_BULK_RX]); 1132190688Sweongyo /* enable Rx */ 1133190688Sweongyo uath_set_rxfilter(sc, 0x0, UATH_FILTER_OP_INIT); 1134190688Sweongyo uath_set_rxfilter(sc, 1135190688Sweongyo UATH_FILTER_RX_UCAST | UATH_FILTER_RX_MCAST | 1136190688Sweongyo UATH_FILTER_RX_BCAST | UATH_FILTER_RX_BEACON, 1137190688Sweongyo UATH_FILTER_OP_SET); 1138190688Sweongyo 1139190688Sweongyo sc->sc_flags |= UATH_FLAG_INITDONE; 1140190688Sweongyo 1141190688Sweongyo callout_reset(&sc->watchdog_ch, hz, uath_watchdog, sc); 1142190688Sweongyo 1143190688Sweongyo return (0); 1144190688Sweongyo 1145190688Sweongyofail: 1146287197Sglebius uath_stop(sc); 1147190688Sweongyo return (error); 1148190688Sweongyo} 1149190688Sweongyo 1150190688Sweongyostatic void 1151287197Sglebiusuath_stop(struct uath_softc *sc) 1152190688Sweongyo{ 1153190688Sweongyo 1154190688Sweongyo UATH_ASSERT_LOCKED(sc); 1155190688Sweongyo 1156190688Sweongyo sc->sc_flags &= ~UATH_FLAG_INITDONE; 1157190688Sweongyo 1158190688Sweongyo callout_stop(&sc->stat_ch); 1159190688Sweongyo callout_stop(&sc->watchdog_ch); 1160190688Sweongyo sc->sc_tx_timer = 0; 1161190688Sweongyo /* abort pending transmits */ 1162190688Sweongyo uath_abort_xfers(sc); 1163190688Sweongyo /* flush data & control requests into the target */ 1164190688Sweongyo (void)uath_flush(sc); 1165190688Sweongyo /* set a LED status to the disconnected. */ 1166190688Sweongyo uath_set_ledstate(sc, 0); 1167190688Sweongyo /* stop the target */ 1168190688Sweongyo uath_cmd_write(sc, WDCMSG_TARGET_STOP, NULL, 0, 0); 1169190688Sweongyo} 1170190688Sweongyo 1171190688Sweongyostatic int 1172190688Sweongyouath_config(struct uath_softc *sc, uint32_t reg, uint32_t val) 1173190688Sweongyo{ 1174190688Sweongyo struct uath_write_mac write; 1175190688Sweongyo int error; 1176190688Sweongyo 1177190688Sweongyo write.reg = htobe32(reg); 1178190688Sweongyo write.len = htobe32(0); /* 0 = single write */ 1179190688Sweongyo *(uint32_t *)write.data = htobe32(val); 1180190688Sweongyo 1181190688Sweongyo error = uath_cmd_write(sc, WDCMSG_TARGET_SET_CONFIG, &write, 1182190688Sweongyo 3 * sizeof (uint32_t), 0); 1183190688Sweongyo if (error != 0) { 1184190688Sweongyo device_printf(sc->sc_dev, "could not write register 0x%02x\n", 1185190688Sweongyo reg); 1186190688Sweongyo } 1187190688Sweongyo return (error); 1188190688Sweongyo} 1189190688Sweongyo 1190190688Sweongyostatic int 1191190688Sweongyouath_config_multi(struct uath_softc *sc, uint32_t reg, const void *data, 1192190688Sweongyo int len) 1193190688Sweongyo{ 1194190688Sweongyo struct uath_write_mac write; 1195190688Sweongyo int error; 1196190688Sweongyo 1197190688Sweongyo write.reg = htobe32(reg); 1198190688Sweongyo write.len = htobe32(len); 1199190688Sweongyo bcopy(data, write.data, len); 1200190688Sweongyo 1201190688Sweongyo /* properly handle the case where len is zero (reset) */ 1202190688Sweongyo error = uath_cmd_write(sc, WDCMSG_TARGET_SET_CONFIG, &write, 1203190688Sweongyo (len == 0) ? sizeof (uint32_t) : 2 * sizeof (uint32_t) + len, 0); 1204190688Sweongyo if (error != 0) { 1205190688Sweongyo device_printf(sc->sc_dev, 1206190688Sweongyo "could not write %d bytes to register 0x%02x\n", len, reg); 1207190688Sweongyo } 1208190688Sweongyo return (error); 1209190688Sweongyo} 1210190688Sweongyo 1211190688Sweongyostatic int 1212190688Sweongyouath_switch_channel(struct uath_softc *sc, struct ieee80211_channel *c) 1213190688Sweongyo{ 1214190688Sweongyo int error; 1215190688Sweongyo 1216190688Sweongyo UATH_ASSERT_LOCKED(sc); 1217190688Sweongyo 1218190688Sweongyo /* set radio frequency */ 1219190688Sweongyo error = uath_set_chan(sc, c); 1220190688Sweongyo if (error) { 1221190688Sweongyo device_printf(sc->sc_dev, 1222190688Sweongyo "could not set channel, error %d\n", error); 1223190688Sweongyo goto failed; 1224190688Sweongyo } 1225190688Sweongyo /* reset Tx rings */ 1226190688Sweongyo error = uath_reset_tx_queues(sc); 1227190688Sweongyo if (error) { 1228190688Sweongyo device_printf(sc->sc_dev, 1229190688Sweongyo "could not reset Tx queues, error %d\n", error); 1230190688Sweongyo goto failed; 1231190688Sweongyo } 1232190688Sweongyo /* set Tx rings WME properties */ 1233190688Sweongyo error = uath_wme_init(sc); 1234190688Sweongyo if (error) { 1235190688Sweongyo device_printf(sc->sc_dev, 1236190688Sweongyo "could not init Tx queues, error %d\n", error); 1237190688Sweongyo goto failed; 1238190688Sweongyo } 1239190688Sweongyo error = uath_set_ledstate(sc, 0); 1240190688Sweongyo if (error) { 1241190688Sweongyo device_printf(sc->sc_dev, 1242190688Sweongyo "could not set led state, error %d\n", error); 1243190688Sweongyo goto failed; 1244190688Sweongyo } 1245190688Sweongyo error = uath_flush(sc); 1246190688Sweongyo if (error) { 1247190688Sweongyo device_printf(sc->sc_dev, 1248190688Sweongyo "could not flush pipes, error %d\n", error); 1249190688Sweongyo goto failed; 1250190688Sweongyo } 1251190688Sweongyofailed: 1252190688Sweongyo return (error); 1253190688Sweongyo} 1254190688Sweongyo 1255190688Sweongyostatic int 1256190688Sweongyouath_set_rxfilter(struct uath_softc *sc, uint32_t bits, uint32_t op) 1257190688Sweongyo{ 1258190688Sweongyo struct uath_cmd_rx_filter rxfilter; 1259190688Sweongyo 1260190688Sweongyo rxfilter.bits = htobe32(bits); 1261190688Sweongyo rxfilter.op = htobe32(op); 1262190688Sweongyo 1263190688Sweongyo DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL, 1264190688Sweongyo "setting Rx filter=0x%x flags=0x%x\n", bits, op); 1265190688Sweongyo return uath_cmd_write(sc, WDCMSG_RX_FILTER, &rxfilter, 1266190688Sweongyo sizeof rxfilter, 0); 1267190688Sweongyo} 1268190688Sweongyo 1269190688Sweongyostatic void 1270190688Sweongyouath_watchdog(void *arg) 1271190688Sweongyo{ 1272190688Sweongyo struct uath_softc *sc = arg; 1273287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 1274190688Sweongyo 1275190688Sweongyo if (sc->sc_tx_timer > 0) { 1276190688Sweongyo if (--sc->sc_tx_timer == 0) { 1277190688Sweongyo device_printf(sc->sc_dev, "device timeout\n"); 1278287197Sglebius /*uath_init(sc); XXX needs a process context! */ 1279287197Sglebius counter_u64_add(ic->ic_oerrors, 1); 1280190688Sweongyo return; 1281190688Sweongyo } 1282190688Sweongyo callout_reset(&sc->watchdog_ch, hz, uath_watchdog, sc); 1283190688Sweongyo } 1284190688Sweongyo} 1285190688Sweongyo 1286190688Sweongyostatic void 1287190688Sweongyouath_abort_xfers(struct uath_softc *sc) 1288190688Sweongyo{ 1289190688Sweongyo int i; 1290190688Sweongyo 1291190688Sweongyo UATH_ASSERT_LOCKED(sc); 1292190688Sweongyo /* abort any pending transfers */ 1293190688Sweongyo for (i = 0; i < UATH_N_XFERS; i++) 1294194228Sthompsa usbd_transfer_stop(sc->sc_xfer[i]); 1295190688Sweongyo} 1296190688Sweongyo 1297190688Sweongyostatic int 1298190688Sweongyouath_flush(struct uath_softc *sc) 1299190688Sweongyo{ 1300190688Sweongyo int error; 1301190688Sweongyo 1302190688Sweongyo error = uath_dataflush(sc); 1303190688Sweongyo if (error != 0) 1304190688Sweongyo goto failed; 1305190688Sweongyo 1306190688Sweongyo error = uath_cmdflush(sc); 1307190688Sweongyo if (error != 0) 1308190688Sweongyo goto failed; 1309190688Sweongyo 1310190688Sweongyofailed: 1311190688Sweongyo return (error); 1312190688Sweongyo} 1313190688Sweongyo 1314190688Sweongyostatic int 1315190688Sweongyouath_cmdflush(struct uath_softc *sc) 1316190688Sweongyo{ 1317190688Sweongyo 1318190688Sweongyo return uath_cmd_write(sc, WDCMSG_FLUSH, NULL, 0, 0); 1319190688Sweongyo} 1320190688Sweongyo 1321190688Sweongyostatic int 1322190688Sweongyouath_dataflush(struct uath_softc *sc) 1323190688Sweongyo{ 1324190688Sweongyo struct uath_data *data; 1325190688Sweongyo struct uath_chunk *chunk; 1326190688Sweongyo struct uath_tx_desc *desc; 1327190688Sweongyo 1328190688Sweongyo UATH_ASSERT_LOCKED(sc); 1329190688Sweongyo 1330190688Sweongyo data = uath_getbuf(sc); 1331190688Sweongyo if (data == NULL) 1332190688Sweongyo return (ENOBUFS); 1333190688Sweongyo data->buflen = sizeof(struct uath_chunk) + sizeof(struct uath_tx_desc); 1334190688Sweongyo data->m = NULL; 1335190688Sweongyo data->ni = NULL; 1336190688Sweongyo chunk = (struct uath_chunk *)data->buf; 1337190688Sweongyo desc = (struct uath_tx_desc *)(chunk + 1); 1338190688Sweongyo 1339190688Sweongyo /* one chunk only */ 1340190688Sweongyo chunk->seqnum = 0; 1341190688Sweongyo chunk->flags = UATH_CFLAGS_FINAL; 1342190688Sweongyo chunk->length = htobe16(sizeof (struct uath_tx_desc)); 1343190688Sweongyo 1344227461Shselasky memset(desc, 0, sizeof(struct uath_tx_desc)); 1345190688Sweongyo desc->msglen = htobe32(sizeof(struct uath_tx_desc)); 1346190688Sweongyo desc->msgid = (sc->sc_msgid++) + 1; /* don't care about endianness */ 1347190688Sweongyo desc->type = htobe32(WDCMSG_FLUSH); 1348190688Sweongyo desc->txqid = htobe32(0); 1349190688Sweongyo desc->connid = htobe32(0); 1350190688Sweongyo desc->flags = htobe32(0); 1351190688Sweongyo 1352190688Sweongyo#ifdef UATH_DEBUG 1353190688Sweongyo if (sc->sc_debug & UATH_DEBUG_CMDS) { 1354190688Sweongyo DPRINTF(sc, UATH_DEBUG_RESET, "send flush ix %d\n", 1355190688Sweongyo desc->msgid); 1356190688Sweongyo if (sc->sc_debug & UATH_DEBUG_CMDS_DUMP) 1357190688Sweongyo uath_dump_cmd(data->buf, data->buflen, '+'); 1358190688Sweongyo } 1359190688Sweongyo#endif 1360190688Sweongyo 1361190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next); 1362190688Sweongyo UATH_STAT_INC(sc, st_tx_pending); 1363190688Sweongyo sc->sc_tx_timer = 5; 1364194228Sthompsa usbd_transfer_start(sc->sc_xfer[UATH_BULK_TX]); 1365190688Sweongyo 1366190688Sweongyo return (0); 1367190688Sweongyo} 1368190688Sweongyo 1369190688Sweongyostatic struct uath_data * 1370190688Sweongyo_uath_getbuf(struct uath_softc *sc) 1371190688Sweongyo{ 1372190688Sweongyo struct uath_data *bf; 1373190688Sweongyo 1374190688Sweongyo bf = STAILQ_FIRST(&sc->sc_tx_inactive); 1375190688Sweongyo if (bf != NULL) { 1376190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_tx_inactive, next); 1377190688Sweongyo UATH_STAT_DEC(sc, st_tx_inactive); 1378190688Sweongyo } else 1379190688Sweongyo bf = NULL; 1380190688Sweongyo if (bf == NULL) 1381190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, "%s: %s\n", __func__, 1382190688Sweongyo "out of xmit buffers"); 1383190688Sweongyo return (bf); 1384190688Sweongyo} 1385190688Sweongyo 1386190688Sweongyostatic struct uath_data * 1387190688Sweongyouath_getbuf(struct uath_softc *sc) 1388190688Sweongyo{ 1389190688Sweongyo struct uath_data *bf; 1390190688Sweongyo 1391190688Sweongyo UATH_ASSERT_LOCKED(sc); 1392190688Sweongyo 1393190688Sweongyo bf = _uath_getbuf(sc); 1394287197Sglebius if (bf == NULL) 1395190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, "%s: stop queue\n", __func__); 1396190688Sweongyo return (bf); 1397190688Sweongyo} 1398190688Sweongyo 1399190688Sweongyostatic int 1400190688Sweongyouath_set_ledstate(struct uath_softc *sc, int connected) 1401190688Sweongyo{ 1402190688Sweongyo 1403190688Sweongyo DPRINTF(sc, UATH_DEBUG_LED, 1404190688Sweongyo "set led state %sconnected\n", connected ? "" : "!"); 1405190688Sweongyo connected = htobe32(connected); 1406190688Sweongyo return uath_cmd_write(sc, WDCMSG_SET_LED_STATE, 1407190688Sweongyo &connected, sizeof connected, 0); 1408190688Sweongyo} 1409190688Sweongyo 1410190688Sweongyostatic int 1411190688Sweongyouath_set_chan(struct uath_softc *sc, struct ieee80211_channel *c) 1412190688Sweongyo{ 1413190688Sweongyo#ifdef UATH_DEBUG 1414287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 1415190688Sweongyo#endif 1416190688Sweongyo struct uath_cmd_reset reset; 1417190688Sweongyo 1418227461Shselasky memset(&reset, 0, sizeof(reset)); 1419190688Sweongyo if (IEEE80211_IS_CHAN_2GHZ(c)) 1420190688Sweongyo reset.flags |= htobe32(UATH_CHAN_2GHZ); 1421190688Sweongyo if (IEEE80211_IS_CHAN_5GHZ(c)) 1422190688Sweongyo reset.flags |= htobe32(UATH_CHAN_5GHZ); 1423190688Sweongyo /* NB: 11g =>'s 11b so don't specify both OFDM and CCK */ 1424192257Ssam if (IEEE80211_IS_CHAN_OFDM(c)) 1425190688Sweongyo reset.flags |= htobe32(UATH_CHAN_OFDM); 1426192257Ssam else if (IEEE80211_IS_CHAN_CCK(c)) 1427190688Sweongyo reset.flags |= htobe32(UATH_CHAN_CCK); 1428190688Sweongyo /* turbo can be used in either 2GHz or 5GHz */ 1429190688Sweongyo if (c->ic_flags & IEEE80211_CHAN_TURBO) 1430190688Sweongyo reset.flags |= htobe32(UATH_CHAN_TURBO); 1431190688Sweongyo reset.freq = htobe32(c->ic_freq); 1432190688Sweongyo reset.maxrdpower = htobe32(50); /* XXX */ 1433190688Sweongyo reset.channelchange = htobe32(1); 1434190688Sweongyo reset.keeprccontent = htobe32(0); 1435190688Sweongyo 1436190688Sweongyo DPRINTF(sc, UATH_DEBUG_CHANNEL, "set channel %d, flags 0x%x freq %u\n", 1437190688Sweongyo ieee80211_chan2ieee(ic, c), 1438190688Sweongyo be32toh(reset.flags), be32toh(reset.freq)); 1439190688Sweongyo return uath_cmd_write(sc, WDCMSG_RESET, &reset, sizeof reset, 0); 1440190688Sweongyo} 1441190688Sweongyo 1442190688Sweongyostatic int 1443190688Sweongyouath_reset_tx_queues(struct uath_softc *sc) 1444190688Sweongyo{ 1445190688Sweongyo int ac, error; 1446190688Sweongyo 1447190688Sweongyo DPRINTF(sc, UATH_DEBUG_RESET, "%s: reset Tx queues\n", __func__); 1448190688Sweongyo for (ac = 0; ac < 4; ac++) { 1449190688Sweongyo const uint32_t qid = htobe32(ac); 1450190688Sweongyo 1451190688Sweongyo error = uath_cmd_write(sc, WDCMSG_RELEASE_TX_QUEUE, &qid, 1452190688Sweongyo sizeof qid, 0); 1453190688Sweongyo if (error != 0) 1454190688Sweongyo break; 1455190688Sweongyo } 1456190688Sweongyo return (error); 1457190688Sweongyo} 1458190688Sweongyo 1459190688Sweongyostatic int 1460190688Sweongyouath_wme_init(struct uath_softc *sc) 1461190688Sweongyo{ 1462190688Sweongyo /* XXX get from net80211 */ 1463190688Sweongyo static const struct uath_wme_settings uath_wme_11g[4] = { 1464190688Sweongyo { 7, 4, 10, 0, 0 }, /* Background */ 1465190688Sweongyo { 3, 4, 10, 0, 0 }, /* Best-Effort */ 1466190688Sweongyo { 3, 3, 4, 26, 0 }, /* Video */ 1467190688Sweongyo { 2, 2, 3, 47, 0 } /* Voice */ 1468190688Sweongyo }; 1469190688Sweongyo struct uath_cmd_txq_setup qinfo; 1470190688Sweongyo int ac, error; 1471190688Sweongyo 1472190688Sweongyo DPRINTF(sc, UATH_DEBUG_WME, "%s: setup Tx queues\n", __func__); 1473190688Sweongyo for (ac = 0; ac < 4; ac++) { 1474190688Sweongyo qinfo.qid = htobe32(ac); 1475190688Sweongyo qinfo.len = htobe32(sizeof(qinfo.attr)); 1476190688Sweongyo qinfo.attr.priority = htobe32(ac); /* XXX */ 1477190688Sweongyo qinfo.attr.aifs = htobe32(uath_wme_11g[ac].aifsn); 1478190688Sweongyo qinfo.attr.logcwmin = htobe32(uath_wme_11g[ac].logcwmin); 1479190688Sweongyo qinfo.attr.logcwmax = htobe32(uath_wme_11g[ac].logcwmax); 1480288088Sadrian qinfo.attr.bursttime = htobe32(IEEE80211_TXOP_TO_US( 1481190688Sweongyo uath_wme_11g[ac].txop)); 1482190688Sweongyo qinfo.attr.mode = htobe32(uath_wme_11g[ac].acm);/*XXX? */ 1483190688Sweongyo qinfo.attr.qflags = htobe32(1); /* XXX? */ 1484190688Sweongyo 1485190688Sweongyo error = uath_cmd_write(sc, WDCMSG_SETUP_TX_QUEUE, &qinfo, 1486190688Sweongyo sizeof qinfo, 0); 1487190688Sweongyo if (error != 0) 1488190688Sweongyo break; 1489190688Sweongyo } 1490190688Sweongyo return (error); 1491190688Sweongyo} 1492190688Sweongyo 1493287197Sglebiusstatic void 1494287197Sglebiusuath_parent(struct ieee80211com *ic) 1495190688Sweongyo{ 1496286950Sadrian struct uath_softc *sc = ic->ic_softc; 1497246614Shselasky int startall = 0; 1498190688Sweongyo 1499246614Shselasky UATH_LOCK(sc); 1500287197Sglebius if (sc->sc_flags & UATH_FLAG_INVALID) { 1501287197Sglebius UATH_UNLOCK(sc); 1502287197Sglebius return; 1503287197Sglebius } 1504286437Sadrian 1505287197Sglebius if (ic->ic_nrunning > 0) { 1506287197Sglebius if (!(sc->sc_flags & UATH_FLAG_INITDONE)) { 1507287197Sglebius uath_init(sc); 1508287197Sglebius startall = 1; 1509286437Sadrian } 1510287197Sglebius } else if (sc->sc_flags & UATH_FLAG_INITDONE) 1511287197Sglebius uath_stop(sc); 1512287197Sglebius UATH_UNLOCK(sc); 1513287197Sglebius if (startall) 1514287197Sglebius ieee80211_start_all(ic); 1515190688Sweongyo} 1516190688Sweongyo 1517190688Sweongyostatic int 1518190688Sweongyouath_tx_start(struct uath_softc *sc, struct mbuf *m0, struct ieee80211_node *ni, 1519190688Sweongyo struct uath_data *data) 1520190688Sweongyo{ 1521191746Sthompsa struct ieee80211vap *vap = ni->ni_vap; 1522190688Sweongyo struct uath_chunk *chunk; 1523190688Sweongyo struct uath_tx_desc *desc; 1524190688Sweongyo const struct ieee80211_frame *wh; 1525190688Sweongyo struct ieee80211_key *k; 1526190688Sweongyo int framelen, msglen; 1527190688Sweongyo 1528190688Sweongyo UATH_ASSERT_LOCKED(sc); 1529190688Sweongyo 1530190688Sweongyo data->ni = ni; 1531190688Sweongyo data->m = m0; 1532190688Sweongyo chunk = (struct uath_chunk *)data->buf; 1533190688Sweongyo desc = (struct uath_tx_desc *)(chunk + 1); 1534190688Sweongyo 1535192468Ssam if (ieee80211_radiotap_active_vap(vap)) { 1536190688Sweongyo struct uath_tx_radiotap_header *tap = &sc->sc_txtap; 1537190688Sweongyo 1538190688Sweongyo tap->wt_flags = 0; 1539190688Sweongyo if (m0->m_flags & M_FRAG) 1540190688Sweongyo tap->wt_flags |= IEEE80211_RADIOTAP_F_FRAG; 1541190688Sweongyo 1542192468Ssam ieee80211_radiotap_tx(vap, m0); 1543190688Sweongyo } 1544190688Sweongyo 1545190688Sweongyo wh = mtod(m0, struct ieee80211_frame *); 1546260444Skevlo if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 1547190688Sweongyo k = ieee80211_crypto_encap(ni, m0); 1548190688Sweongyo if (k == NULL) { 1549190688Sweongyo m_freem(m0); 1550190688Sweongyo return (ENOBUFS); 1551190688Sweongyo } 1552190688Sweongyo 1553190688Sweongyo /* packet header may have moved, reset our local pointer */ 1554190688Sweongyo wh = mtod(m0, struct ieee80211_frame *); 1555190688Sweongyo } 1556190688Sweongyo m_copydata(m0, 0, m0->m_pkthdr.len, (uint8_t *)(desc + 1)); 1557190688Sweongyo 1558190688Sweongyo framelen = m0->m_pkthdr.len + IEEE80211_CRC_LEN; 1559190688Sweongyo msglen = framelen + sizeof (struct uath_tx_desc); 1560190688Sweongyo data->buflen = msglen + sizeof (struct uath_chunk); 1561190688Sweongyo 1562190688Sweongyo /* one chunk only for now */ 1563190688Sweongyo chunk->seqnum = sc->sc_seqnum++; 1564190688Sweongyo chunk->flags = (m0->m_flags & M_FRAG) ? 0 : UATH_CFLAGS_FINAL; 1565190688Sweongyo if (m0->m_flags & M_LASTFRAG) 1566190688Sweongyo chunk->flags |= UATH_CFLAGS_FINAL; 1567190688Sweongyo chunk->flags = UATH_CFLAGS_FINAL; 1568190688Sweongyo chunk->length = htobe16(msglen); 1569190688Sweongyo 1570190688Sweongyo /* fill Tx descriptor */ 1571190688Sweongyo desc->msglen = htobe32(msglen); 1572190688Sweongyo /* NB: to get UATH_TX_NOTIFY reply, `msgid' must be larger than 0 */ 1573190688Sweongyo desc->msgid = (sc->sc_msgid++) + 1; /* don't care about endianness */ 1574190688Sweongyo desc->type = htobe32(WDCMSG_SEND); 1575190688Sweongyo switch (wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) { 1576190688Sweongyo case IEEE80211_FC0_TYPE_CTL: 1577190688Sweongyo case IEEE80211_FC0_TYPE_MGT: 1578190688Sweongyo /* NB: force all management frames to highest queue */ 1579190688Sweongyo if (ni->ni_flags & IEEE80211_NODE_QOS) { 1580190688Sweongyo /* NB: force all management frames to highest queue */ 1581190688Sweongyo desc->txqid = htobe32(WME_AC_VO | UATH_TXQID_MINRATE); 1582190688Sweongyo } else 1583190688Sweongyo desc->txqid = htobe32(WME_AC_BE | UATH_TXQID_MINRATE); 1584190688Sweongyo break; 1585190688Sweongyo case IEEE80211_FC0_TYPE_DATA: 1586190688Sweongyo /* XXX multicast frames should honor mcastrate */ 1587190688Sweongyo desc->txqid = htobe32(M_WME_GETAC(m0)); 1588190688Sweongyo break; 1589190688Sweongyo default: 1590190688Sweongyo device_printf(sc->sc_dev, "bogus frame type 0x%x (%s)\n", 1591190688Sweongyo wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK, __func__); 1592190688Sweongyo m_freem(m0); 1593190688Sweongyo return (EIO); 1594190688Sweongyo } 1595191746Sthompsa if (vap->iv_state == IEEE80211_S_AUTH || 1596191746Sthompsa vap->iv_state == IEEE80211_S_ASSOC || 1597191746Sthompsa vap->iv_state == IEEE80211_S_RUN) 1598190688Sweongyo desc->connid = htobe32(UATH_ID_BSS); 1599190688Sweongyo else 1600190688Sweongyo desc->connid = htobe32(UATH_ID_INVALID); 1601190688Sweongyo desc->flags = htobe32(0 /* no UATH_TX_NOTIFY */); 1602190688Sweongyo desc->buflen = htobe32(m0->m_pkthdr.len); 1603190688Sweongyo 1604190688Sweongyo#ifdef UATH_DEBUG 1605190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, 1606190688Sweongyo "send frame ix %u framelen %d msglen %d connid 0x%x txqid 0x%x\n", 1607190688Sweongyo desc->msgid, framelen, msglen, be32toh(desc->connid), 1608190688Sweongyo be32toh(desc->txqid)); 1609190688Sweongyo if (sc->sc_debug & UATH_DEBUG_XMIT_DUMP) 1610190688Sweongyo uath_dump_cmd(data->buf, data->buflen, '+'); 1611190688Sweongyo#endif 1612190688Sweongyo 1613190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next); 1614190688Sweongyo UATH_STAT_INC(sc, st_tx_pending); 1615194228Sthompsa usbd_transfer_start(sc->sc_xfer[UATH_BULK_TX]); 1616190688Sweongyo 1617190688Sweongyo return (0); 1618190688Sweongyo} 1619190688Sweongyo 1620190688Sweongyo/* 1621190688Sweongyo * Cleanup driver resources when we run out of buffers while processing 1622190688Sweongyo * fragments; return the tx buffers allocated and drop node references. 1623190688Sweongyo */ 1624190688Sweongyostatic void 1625190688Sweongyouath_txfrag_cleanup(struct uath_softc *sc, 1626190688Sweongyo uath_datahead *frags, struct ieee80211_node *ni) 1627190688Sweongyo{ 1628190688Sweongyo struct uath_data *bf, *next; 1629190688Sweongyo 1630190688Sweongyo UATH_ASSERT_LOCKED(sc); 1631190688Sweongyo 1632190688Sweongyo STAILQ_FOREACH_SAFE(bf, frags, next, next) { 1633190688Sweongyo /* NB: bf assumed clean */ 1634190688Sweongyo STAILQ_REMOVE_HEAD(frags, next); 1635190688Sweongyo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 1636190688Sweongyo UATH_STAT_INC(sc, st_tx_inactive); 1637190688Sweongyo ieee80211_node_decref(ni); 1638190688Sweongyo } 1639190688Sweongyo} 1640190688Sweongyo 1641190688Sweongyo/* 1642190688Sweongyo * Setup xmit of a fragmented frame. Allocate a buffer for each frag and bump 1643190688Sweongyo * the node reference count to reflect the held reference to be setup by 1644190688Sweongyo * uath_tx_start. 1645190688Sweongyo */ 1646190688Sweongyostatic int 1647190688Sweongyouath_txfrag_setup(struct uath_softc *sc, uath_datahead *frags, 1648190688Sweongyo struct mbuf *m0, struct ieee80211_node *ni) 1649190688Sweongyo{ 1650190688Sweongyo struct mbuf *m; 1651190688Sweongyo struct uath_data *bf; 1652190688Sweongyo 1653190688Sweongyo UATH_ASSERT_LOCKED(sc); 1654190688Sweongyo for (m = m0->m_nextpkt; m != NULL; m = m->m_nextpkt) { 1655190688Sweongyo bf = uath_getbuf(sc); 1656190688Sweongyo if (bf == NULL) { /* out of buffers, cleanup */ 1657190688Sweongyo uath_txfrag_cleanup(sc, frags, ni); 1658190688Sweongyo break; 1659190688Sweongyo } 1660190688Sweongyo ieee80211_node_incref(ni); 1661190688Sweongyo STAILQ_INSERT_TAIL(frags, bf, next); 1662190688Sweongyo } 1663190688Sweongyo 1664190688Sweongyo return !STAILQ_EMPTY(frags); 1665190688Sweongyo} 1666190688Sweongyo 1667287197Sglebiusstatic int 1668287197Sglebiusuath_transmit(struct ieee80211com *ic, struct mbuf *m) 1669287197Sglebius{ 1670287197Sglebius struct uath_softc *sc = ic->ic_softc; 1671287197Sglebius int error; 1672287197Sglebius 1673287197Sglebius UATH_LOCK(sc); 1674287197Sglebius if ((sc->sc_flags & UATH_FLAG_INITDONE) == 0) { 1675287197Sglebius UATH_UNLOCK(sc); 1676287197Sglebius return (ENXIO); 1677287197Sglebius } 1678287197Sglebius error = mbufq_enqueue(&sc->sc_snd, m); 1679287197Sglebius if (error) { 1680287197Sglebius UATH_UNLOCK(sc); 1681287197Sglebius return (error); 1682287197Sglebius } 1683287197Sglebius uath_start(sc); 1684287197Sglebius UATH_UNLOCK(sc); 1685287197Sglebius 1686287197Sglebius return (0); 1687287197Sglebius} 1688287197Sglebius 1689190688Sweongyostatic void 1690287197Sglebiusuath_start(struct uath_softc *sc) 1691190688Sweongyo{ 1692190688Sweongyo struct uath_data *bf; 1693190688Sweongyo struct ieee80211_node *ni; 1694190688Sweongyo struct mbuf *m, *next; 1695190688Sweongyo uath_datahead frags; 1696190688Sweongyo 1697287197Sglebius UATH_ASSERT_LOCKED(sc); 1698287197Sglebius 1699287197Sglebius if ((sc->sc_flags & UATH_FLAG_INITDONE) == 0 || 1700190688Sweongyo (sc->sc_flags & UATH_FLAG_INVALID)) 1701190688Sweongyo return; 1702190688Sweongyo 1703287197Sglebius while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) { 1704190688Sweongyo bf = uath_getbuf(sc); 1705287197Sglebius if (bf == NULL) { 1706287197Sglebius mbufq_prepend(&sc->sc_snd, m); 1707190688Sweongyo break; 1708287197Sglebius } 1709286437Sadrian 1710190688Sweongyo ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 1711190688Sweongyo m->m_pkthdr.rcvif = NULL; 1712190688Sweongyo 1713190688Sweongyo /* 1714190688Sweongyo * Check for fragmentation. If this frame has been broken up 1715190688Sweongyo * verify we have enough buffers to send all the fragments 1716190688Sweongyo * so all go out or none... 1717190688Sweongyo */ 1718190688Sweongyo STAILQ_INIT(&frags); 1719190688Sweongyo if ((m->m_flags & M_FRAG) && 1720190688Sweongyo !uath_txfrag_setup(sc, &frags, m, ni)) { 1721190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, 1722190688Sweongyo "%s: out of txfrag buffers\n", __func__); 1723289162Sadrian ieee80211_free_mbuf(m); 1724190688Sweongyo goto bad; 1725190688Sweongyo } 1726190688Sweongyo sc->sc_seqnum = 0; 1727190688Sweongyo nextfrag: 1728190688Sweongyo /* 1729190688Sweongyo * Pass the frame to the h/w for transmission. 1730190688Sweongyo * Fragmented frames have each frag chained together 1731190688Sweongyo * with m_nextpkt. We know there are sufficient uath_data's 1732190688Sweongyo * to send all the frags because of work done by 1733190688Sweongyo * uath_txfrag_setup. 1734190688Sweongyo */ 1735190688Sweongyo next = m->m_nextpkt; 1736190688Sweongyo if (uath_tx_start(sc, m, ni, bf) != 0) { 1737190688Sweongyo bad: 1738287197Sglebius if_inc_counter(ni->ni_vap->iv_ifp, 1739287197Sglebius IFCOUNTER_OERRORS, 1); 1740190688Sweongyo reclaim: 1741190688Sweongyo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 1742190688Sweongyo UATH_STAT_INC(sc, st_tx_inactive); 1743190688Sweongyo uath_txfrag_cleanup(sc, &frags, ni); 1744190688Sweongyo ieee80211_free_node(ni); 1745190688Sweongyo continue; 1746190688Sweongyo } 1747190688Sweongyo 1748190688Sweongyo if (next != NULL) { 1749190688Sweongyo /* 1750190688Sweongyo * Beware of state changing between frags. 1751190688Sweongyo XXX check sta power-save state? 1752190688Sweongyo */ 1753190688Sweongyo if (ni->ni_vap->iv_state != IEEE80211_S_RUN) { 1754190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, 1755190688Sweongyo "%s: flush fragmented packet, state %s\n", 1756190688Sweongyo __func__, 1757190688Sweongyo ieee80211_state_name[ni->ni_vap->iv_state]); 1758289162Sadrian ieee80211_free_mbuf(next); 1759190688Sweongyo goto reclaim; 1760190688Sweongyo } 1761190688Sweongyo m = next; 1762190688Sweongyo bf = STAILQ_FIRST(&frags); 1763190688Sweongyo KASSERT(bf != NULL, ("no buf for txfrag")); 1764190688Sweongyo STAILQ_REMOVE_HEAD(&frags, next); 1765190688Sweongyo goto nextfrag; 1766190688Sweongyo } 1767190688Sweongyo 1768190688Sweongyo sc->sc_tx_timer = 5; 1769190688Sweongyo } 1770190688Sweongyo} 1771190688Sweongyo 1772190688Sweongyostatic int 1773190688Sweongyouath_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 1774190688Sweongyo const struct ieee80211_bpf_params *params) 1775190688Sweongyo{ 1776190688Sweongyo struct ieee80211com *ic = ni->ni_ic; 1777190688Sweongyo struct uath_data *bf; 1778286950Sadrian struct uath_softc *sc = ic->ic_softc; 1779190688Sweongyo 1780287197Sglebius UATH_LOCK(sc); 1781190688Sweongyo /* prevent management frames from being sent if we're not ready */ 1782194329Sweongyo if ((sc->sc_flags & UATH_FLAG_INVALID) || 1783287197Sglebius !(sc->sc_flags & UATH_FLAG_INITDONE)) { 1784190688Sweongyo m_freem(m); 1785287197Sglebius UATH_UNLOCK(sc); 1786190688Sweongyo return (ENETDOWN); 1787190688Sweongyo } 1788190688Sweongyo 1789190688Sweongyo /* grab a TX buffer */ 1790190688Sweongyo bf = uath_getbuf(sc); 1791190688Sweongyo if (bf == NULL) { 1792190688Sweongyo m_freem(m); 1793190688Sweongyo UATH_UNLOCK(sc); 1794190688Sweongyo return (ENOBUFS); 1795190688Sweongyo } 1796190688Sweongyo 1797190688Sweongyo sc->sc_seqnum = 0; 1798190688Sweongyo if (uath_tx_start(sc, m, ni, bf) != 0) { 1799190688Sweongyo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 1800190688Sweongyo UATH_STAT_INC(sc, st_tx_inactive); 1801190688Sweongyo UATH_UNLOCK(sc); 1802190688Sweongyo return (EIO); 1803190688Sweongyo } 1804190688Sweongyo UATH_UNLOCK(sc); 1805190688Sweongyo 1806190688Sweongyo sc->sc_tx_timer = 5; 1807190688Sweongyo return (0); 1808190688Sweongyo} 1809190688Sweongyo 1810190688Sweongyostatic void 1811190688Sweongyouath_scan_start(struct ieee80211com *ic) 1812190688Sweongyo{ 1813190688Sweongyo /* do nothing */ 1814190688Sweongyo} 1815190688Sweongyo 1816190688Sweongyostatic void 1817190688Sweongyouath_scan_end(struct ieee80211com *ic) 1818190688Sweongyo{ 1819190688Sweongyo /* do nothing */ 1820190688Sweongyo} 1821190688Sweongyo 1822190688Sweongyostatic void 1823190688Sweongyouath_set_channel(struct ieee80211com *ic) 1824190688Sweongyo{ 1825286950Sadrian struct uath_softc *sc = ic->ic_softc; 1826190688Sweongyo 1827190688Sweongyo UATH_LOCK(sc); 1828194329Sweongyo if ((sc->sc_flags & UATH_FLAG_INVALID) || 1829287197Sglebius (sc->sc_flags & UATH_FLAG_INITDONE) == 0) { 1830194329Sweongyo UATH_UNLOCK(sc); 1831194329Sweongyo return; 1832194329Sweongyo } 1833190688Sweongyo (void)uath_switch_channel(sc, ic->ic_curchan); 1834190688Sweongyo UATH_UNLOCK(sc); 1835190688Sweongyo} 1836190688Sweongyo 1837190688Sweongyostatic int 1838190688Sweongyouath_set_rxmulti_filter(struct uath_softc *sc) 1839190688Sweongyo{ 1840192468Ssam /* XXX broken */ 1841190688Sweongyo return (0); 1842190688Sweongyo} 1843190688Sweongyostatic void 1844283540Sglebiusuath_update_mcast(struct ieee80211com *ic) 1845190688Sweongyo{ 1846283540Sglebius struct uath_softc *sc = ic->ic_softc; 1847190688Sweongyo 1848192468Ssam UATH_LOCK(sc); 1849194329Sweongyo if ((sc->sc_flags & UATH_FLAG_INVALID) || 1850287197Sglebius (sc->sc_flags & UATH_FLAG_INITDONE) == 0) { 1851194329Sweongyo UATH_UNLOCK(sc); 1852194329Sweongyo return; 1853194329Sweongyo } 1854190688Sweongyo /* 1855190688Sweongyo * this is for avoiding the race condition when we're try to 1856190688Sweongyo * connect to the AP with WPA. 1857190688Sweongyo */ 1858192468Ssam if (sc->sc_flags & UATH_FLAG_INITDONE) 1859192468Ssam (void)uath_set_rxmulti_filter(sc); 1860192468Ssam UATH_UNLOCK(sc); 1861190688Sweongyo} 1862190688Sweongyo 1863190688Sweongyostatic void 1864283540Sglebiusuath_update_promisc(struct ieee80211com *ic) 1865190688Sweongyo{ 1866283540Sglebius struct uath_softc *sc = ic->ic_softc; 1867190688Sweongyo 1868192468Ssam UATH_LOCK(sc); 1869194329Sweongyo if ((sc->sc_flags & UATH_FLAG_INVALID) || 1870287197Sglebius (sc->sc_flags & UATH_FLAG_INITDONE) == 0) { 1871194329Sweongyo UATH_UNLOCK(sc); 1872194329Sweongyo return; 1873194329Sweongyo } 1874192468Ssam if (sc->sc_flags & UATH_FLAG_INITDONE) { 1875192468Ssam uath_set_rxfilter(sc, 1876192468Ssam UATH_FILTER_RX_UCAST | UATH_FILTER_RX_MCAST | 1877192468Ssam UATH_FILTER_RX_BCAST | UATH_FILTER_RX_BEACON | 1878192468Ssam UATH_FILTER_RX_PROM, UATH_FILTER_OP_SET); 1879192468Ssam } 1880192468Ssam UATH_UNLOCK(sc); 1881190688Sweongyo} 1882190688Sweongyo 1883190688Sweongyostatic int 1884190688Sweongyouath_create_connection(struct uath_softc *sc, uint32_t connid) 1885190688Sweongyo{ 1886190688Sweongyo const struct ieee80211_rateset *rs; 1887287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 1888190688Sweongyo struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 1889212127Sthompsa struct ieee80211_node *ni; 1890190688Sweongyo struct uath_cmd_create_connection create; 1891190688Sweongyo 1892212127Sthompsa ni = ieee80211_ref_node(vap->iv_bss); 1893227461Shselasky memset(&create, 0, sizeof(create)); 1894190688Sweongyo create.connid = htobe32(connid); 1895190688Sweongyo create.bssid = htobe32(0); 1896190688Sweongyo /* XXX packed or not? */ 1897190688Sweongyo create.size = htobe32(sizeof(struct uath_cmd_rateset)); 1898190688Sweongyo 1899190688Sweongyo rs = &ni->ni_rates; 1900190688Sweongyo create.connattr.rateset.length = rs->rs_nrates; 1901190688Sweongyo bcopy(rs->rs_rates, &create.connattr.rateset.set[0], 1902190688Sweongyo rs->rs_nrates); 1903190688Sweongyo 1904190688Sweongyo /* XXX turbo */ 1905190688Sweongyo if (IEEE80211_IS_CHAN_A(ni->ni_chan)) 1906190688Sweongyo create.connattr.wlanmode = htobe32(WLAN_MODE_11a); 1907190688Sweongyo else if (IEEE80211_IS_CHAN_ANYG(ni->ni_chan)) 1908190688Sweongyo create.connattr.wlanmode = htobe32(WLAN_MODE_11g); 1909190688Sweongyo else 1910190688Sweongyo create.connattr.wlanmode = htobe32(WLAN_MODE_11b); 1911212127Sthompsa ieee80211_free_node(ni); 1912190688Sweongyo 1913190688Sweongyo return uath_cmd_write(sc, WDCMSG_CREATE_CONNECTION, &create, 1914190688Sweongyo sizeof create, 0); 1915190688Sweongyo} 1916190688Sweongyo 1917190688Sweongyostatic int 1918190688Sweongyouath_set_rates(struct uath_softc *sc, const struct ieee80211_rateset *rs) 1919190688Sweongyo{ 1920190688Sweongyo struct uath_cmd_rates rates; 1921190688Sweongyo 1922227461Shselasky memset(&rates, 0, sizeof(rates)); 1923190688Sweongyo rates.connid = htobe32(UATH_ID_BSS); /* XXX */ 1924190688Sweongyo rates.size = htobe32(sizeof(struct uath_cmd_rateset)); 1925190688Sweongyo /* XXX bounds check rs->rs_nrates */ 1926190688Sweongyo rates.rateset.length = rs->rs_nrates; 1927190688Sweongyo bcopy(rs->rs_rates, &rates.rateset.set[0], rs->rs_nrates); 1928190688Sweongyo 1929190688Sweongyo DPRINTF(sc, UATH_DEBUG_RATES, 1930190688Sweongyo "setting supported rates nrates=%d\n", rs->rs_nrates); 1931190688Sweongyo return uath_cmd_write(sc, WDCMSG_SET_BASIC_RATE, 1932190688Sweongyo &rates, sizeof rates, 0); 1933190688Sweongyo} 1934190688Sweongyo 1935190688Sweongyostatic int 1936190688Sweongyouath_write_associd(struct uath_softc *sc) 1937190688Sweongyo{ 1938287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 1939190688Sweongyo struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 1940212127Sthompsa struct ieee80211_node *ni; 1941190688Sweongyo struct uath_cmd_set_associd associd; 1942190688Sweongyo 1943212127Sthompsa ni = ieee80211_ref_node(vap->iv_bss); 1944227461Shselasky memset(&associd, 0, sizeof(associd)); 1945190688Sweongyo associd.defaultrateix = htobe32(1); /* XXX */ 1946190688Sweongyo associd.associd = htobe32(ni->ni_associd); 1947190688Sweongyo associd.timoffset = htobe32(0x3b); /* XXX */ 1948190688Sweongyo IEEE80211_ADDR_COPY(associd.bssid, ni->ni_bssid); 1949212127Sthompsa ieee80211_free_node(ni); 1950190688Sweongyo return uath_cmd_write(sc, WDCMSG_WRITE_ASSOCID, &associd, 1951190688Sweongyo sizeof associd, 0); 1952190688Sweongyo} 1953190688Sweongyo 1954190688Sweongyostatic int 1955190688Sweongyouath_set_ledsteady(struct uath_softc *sc, int lednum, int ledmode) 1956190688Sweongyo{ 1957190688Sweongyo struct uath_cmd_ledsteady led; 1958190688Sweongyo 1959190688Sweongyo led.lednum = htobe32(lednum); 1960190688Sweongyo led.ledmode = htobe32(ledmode); 1961190688Sweongyo 1962190688Sweongyo DPRINTF(sc, UATH_DEBUG_LED, "set %s led %s (steady)\n", 1963190688Sweongyo (lednum == UATH_LED_LINK) ? "link" : "activity", 1964190688Sweongyo ledmode ? "on" : "off"); 1965190688Sweongyo return uath_cmd_write(sc, WDCMSG_SET_LED_STEADY, &led, sizeof led, 0); 1966190688Sweongyo} 1967190688Sweongyo 1968190688Sweongyostatic int 1969190688Sweongyouath_set_ledblink(struct uath_softc *sc, int lednum, int ledmode, 1970190688Sweongyo int blinkrate, int slowmode) 1971190688Sweongyo{ 1972190688Sweongyo struct uath_cmd_ledblink led; 1973190688Sweongyo 1974190688Sweongyo led.lednum = htobe32(lednum); 1975190688Sweongyo led.ledmode = htobe32(ledmode); 1976190688Sweongyo led.blinkrate = htobe32(blinkrate); 1977190688Sweongyo led.slowmode = htobe32(slowmode); 1978190688Sweongyo 1979190688Sweongyo DPRINTF(sc, UATH_DEBUG_LED, "set %s led %s (blink)\n", 1980190688Sweongyo (lednum == UATH_LED_LINK) ? "link" : "activity", 1981190688Sweongyo ledmode ? "on" : "off"); 1982190688Sweongyo return uath_cmd_write(sc, WDCMSG_SET_LED_BLINK, &led, sizeof led, 0); 1983190688Sweongyo} 1984190688Sweongyo 1985190688Sweongyostatic int 1986190688Sweongyouath_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 1987190688Sweongyo{ 1988190688Sweongyo enum ieee80211_state ostate = vap->iv_state; 1989190688Sweongyo int error; 1990212127Sthompsa struct ieee80211_node *ni; 1991190688Sweongyo struct ieee80211com *ic = vap->iv_ic; 1992286950Sadrian struct uath_softc *sc = ic->ic_softc; 1993190688Sweongyo struct uath_vap *uvp = UATH_VAP(vap); 1994190688Sweongyo 1995190688Sweongyo DPRINTF(sc, UATH_DEBUG_STATE, 1996190688Sweongyo "%s: %s -> %s\n", __func__, ieee80211_state_name[vap->iv_state], 1997190688Sweongyo ieee80211_state_name[nstate]); 1998190688Sweongyo 1999191746Sthompsa IEEE80211_UNLOCK(ic); 2000190688Sweongyo UATH_LOCK(sc); 2001190688Sweongyo callout_stop(&sc->stat_ch); 2002190688Sweongyo callout_stop(&sc->watchdog_ch); 2003212127Sthompsa ni = ieee80211_ref_node(vap->iv_bss); 2004190688Sweongyo 2005190688Sweongyo switch (nstate) { 2006190688Sweongyo case IEEE80211_S_INIT: 2007190688Sweongyo if (ostate == IEEE80211_S_RUN) { 2008190688Sweongyo /* turn link and activity LEDs off */ 2009190688Sweongyo uath_set_ledstate(sc, 0); 2010190688Sweongyo } 2011190688Sweongyo break; 2012190688Sweongyo 2013190688Sweongyo case IEEE80211_S_SCAN: 2014190688Sweongyo break; 2015190688Sweongyo 2016190688Sweongyo case IEEE80211_S_AUTH: 2017190688Sweongyo /* XXX good place? set RTS threshold */ 2018190688Sweongyo uath_config(sc, CFG_USER_RTS_THRESHOLD, vap->iv_rtsthreshold); 2019190688Sweongyo /* XXX bad place */ 2020190688Sweongyo error = uath_set_keys(sc, vap); 2021190688Sweongyo if (error != 0) { 2022190688Sweongyo device_printf(sc->sc_dev, 2023190688Sweongyo "could not set crypto keys, error %d\n", error); 2024190688Sweongyo break; 2025190688Sweongyo } 2026190688Sweongyo if (uath_switch_channel(sc, ni->ni_chan) != 0) { 2027190688Sweongyo device_printf(sc->sc_dev, "could not switch channel\n"); 2028190688Sweongyo break; 2029190688Sweongyo } 2030190688Sweongyo if (uath_create_connection(sc, UATH_ID_BSS) != 0) { 2031190688Sweongyo device_printf(sc->sc_dev, 2032190688Sweongyo "could not create connection\n"); 2033190688Sweongyo break; 2034190688Sweongyo } 2035190688Sweongyo break; 2036190688Sweongyo 2037190688Sweongyo case IEEE80211_S_ASSOC: 2038190688Sweongyo if (uath_set_rates(sc, &ni->ni_rates) != 0) { 2039190688Sweongyo device_printf(sc->sc_dev, 2040190688Sweongyo "could not set negotiated rate set\n"); 2041190688Sweongyo break; 2042190688Sweongyo } 2043190688Sweongyo break; 2044190688Sweongyo 2045190688Sweongyo case IEEE80211_S_RUN: 2046190688Sweongyo /* XXX monitor mode doesn't be tested */ 2047190688Sweongyo if (ic->ic_opmode == IEEE80211_M_MONITOR) { 2048190688Sweongyo uath_set_ledstate(sc, 1); 2049190688Sweongyo break; 2050190688Sweongyo } 2051190688Sweongyo 2052190688Sweongyo /* 2053190688Sweongyo * Tx rate is controlled by firmware, report the maximum 2054190688Sweongyo * negotiated rate in ifconfig output. 2055190688Sweongyo */ 2056190688Sweongyo ni->ni_txrate = ni->ni_rates.rs_rates[ni->ni_rates.rs_nrates-1]; 2057190688Sweongyo 2058190688Sweongyo if (uath_write_associd(sc) != 0) { 2059190688Sweongyo device_printf(sc->sc_dev, 2060190688Sweongyo "could not write association id\n"); 2061190688Sweongyo break; 2062190688Sweongyo } 2063190688Sweongyo /* turn link LED on */ 2064190688Sweongyo uath_set_ledsteady(sc, UATH_LED_LINK, UATH_LED_ON); 2065190688Sweongyo /* make activity LED blink */ 2066190688Sweongyo uath_set_ledblink(sc, UATH_LED_ACTIVITY, UATH_LED_ON, 1, 2); 2067190688Sweongyo /* set state to associated */ 2068190688Sweongyo uath_set_ledstate(sc, 1); 2069190688Sweongyo 2070190688Sweongyo /* start statistics timer */ 2071190688Sweongyo callout_reset(&sc->stat_ch, hz, uath_stat, sc); 2072190688Sweongyo break; 2073190688Sweongyo default: 2074190688Sweongyo break; 2075190688Sweongyo } 2076212127Sthompsa ieee80211_free_node(ni); 2077190688Sweongyo UATH_UNLOCK(sc); 2078190688Sweongyo IEEE80211_LOCK(ic); 2079191746Sthompsa return (uvp->newstate(vap, nstate, arg)); 2080190688Sweongyo} 2081190688Sweongyo 2082190688Sweongyostatic int 2083190688Sweongyouath_set_key(struct uath_softc *sc, const struct ieee80211_key *wk, 2084190688Sweongyo int index) 2085190688Sweongyo{ 2086190688Sweongyo#if 0 2087190688Sweongyo struct uath_cmd_crypto crypto; 2088190688Sweongyo int i; 2089190688Sweongyo 2090227461Shselasky memset(&crypto, 0, sizeof(crypto)); 2091190688Sweongyo crypto.keyidx = htobe32(index); 2092190688Sweongyo crypto.magic1 = htobe32(1); 2093190688Sweongyo crypto.size = htobe32(368); 2094190688Sweongyo crypto.mask = htobe32(0xffff); 2095190688Sweongyo crypto.flags = htobe32(0x80000068); 2096190688Sweongyo if (index != UATH_DEFAULT_KEY) 2097190688Sweongyo crypto.flags |= htobe32(index << 16); 2098227461Shselasky memset(crypto.magic2, 0xff, sizeof(crypto.magic2)); 2099190688Sweongyo 2100190688Sweongyo /* 2101190688Sweongyo * Each byte of the key must be XOR'ed with 10101010 before being 2102190688Sweongyo * transmitted to the firmware. 2103190688Sweongyo */ 2104190688Sweongyo for (i = 0; i < wk->wk_keylen; i++) 2105190688Sweongyo crypto.key[i] = wk->wk_key[i] ^ 0xaa; 2106190688Sweongyo 2107190688Sweongyo DPRINTF(sc, UATH_DEBUG_CRYPTO, 2108190688Sweongyo "setting crypto key index=%d len=%d\n", index, wk->wk_keylen); 2109190688Sweongyo return uath_cmd_write(sc, WDCMSG_SET_KEY_CACHE_ENTRY, &crypto, 2110190688Sweongyo sizeof crypto, 0); 2111190688Sweongyo#else 2112190688Sweongyo /* XXX support H/W cryto */ 2113190688Sweongyo return (0); 2114190688Sweongyo#endif 2115190688Sweongyo} 2116190688Sweongyo 2117190688Sweongyostatic int 2118190688Sweongyouath_set_keys(struct uath_softc *sc, struct ieee80211vap *vap) 2119190688Sweongyo{ 2120190688Sweongyo int i, error; 2121190688Sweongyo 2122190688Sweongyo error = 0; 2123190688Sweongyo for (i = 0; i < IEEE80211_WEP_NKID; i++) { 2124190688Sweongyo const struct ieee80211_key *wk = &vap->iv_nw_keys[i]; 2125190688Sweongyo 2126190688Sweongyo if (wk->wk_flags & (IEEE80211_KEY_XMIT|IEEE80211_KEY_RECV)) { 2127190688Sweongyo error = uath_set_key(sc, wk, i); 2128190688Sweongyo if (error) 2129190688Sweongyo return (error); 2130190688Sweongyo } 2131190688Sweongyo } 2132190688Sweongyo if (vap->iv_def_txkey != IEEE80211_KEYIX_NONE) { 2133190688Sweongyo error = uath_set_key(sc, &vap->iv_nw_keys[vap->iv_def_txkey], 2134190688Sweongyo UATH_DEFAULT_KEY); 2135190688Sweongyo } 2136190688Sweongyo return (error); 2137190688Sweongyo} 2138190688Sweongyo 2139190688Sweongyo#define UATH_SYSCTL_STAT_ADD32(c, h, n, p, d) \ 2140190688Sweongyo SYSCTL_ADD_UINT(c, h, OID_AUTO, n, CTLFLAG_RD, p, 0, d) 2141190688Sweongyo 2142190688Sweongyostatic void 2143190688Sweongyouath_sysctl_node(struct uath_softc *sc) 2144190688Sweongyo{ 2145190688Sweongyo struct sysctl_ctx_list *ctx; 2146190688Sweongyo struct sysctl_oid_list *child; 2147190688Sweongyo struct sysctl_oid *tree; 2148190688Sweongyo struct uath_stat *stats; 2149190688Sweongyo 2150190688Sweongyo stats = &sc->sc_stat; 2151190688Sweongyo ctx = device_get_sysctl_ctx(sc->sc_dev); 2152190688Sweongyo child = SYSCTL_CHILDREN(device_get_sysctl_tree(sc->sc_dev)); 2153190688Sweongyo 2154190688Sweongyo tree = SYSCTL_ADD_NODE(ctx, child, OID_AUTO, "stats", CTLFLAG_RD, 2155190688Sweongyo NULL, "UATH statistics"); 2156190688Sweongyo child = SYSCTL_CHILDREN(tree); 2157190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "badchunkseqnum", 2158190688Sweongyo &stats->st_badchunkseqnum, "Bad chunk sequence numbers"); 2159190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "invalidlen", &stats->st_invalidlen, 2160190688Sweongyo "Invalid length"); 2161190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "multichunk", &stats->st_multichunk, 2162190688Sweongyo "Multi chunks"); 2163190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "toobigrxpkt", 2164190688Sweongyo &stats->st_toobigrxpkt, "Too big rx packets"); 2165190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "stopinprogress", 2166190688Sweongyo &stats->st_stopinprogress, "Stop in progress"); 2167190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "crcerrs", &stats->st_crcerr, 2168190688Sweongyo "CRC errors"); 2169190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "phyerr", &stats->st_phyerr, 2170190688Sweongyo "PHY errors"); 2171190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "decrypt_crcerr", 2172190688Sweongyo &stats->st_decrypt_crcerr, "Decryption CRC errors"); 2173190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "decrypt_micerr", 2174190688Sweongyo &stats->st_decrypt_micerr, "Decryption Misc errors"); 2175190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "decomperr", &stats->st_decomperr, 2176190688Sweongyo "Decomp errors"); 2177190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "keyerr", &stats->st_keyerr, 2178190688Sweongyo "Key errors"); 2179190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "err", &stats->st_err, 2180190688Sweongyo "Unknown errors"); 2181190688Sweongyo 2182190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "cmd_active", 2183190688Sweongyo &stats->st_cmd_active, "Active numbers in Command queue"); 2184190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "cmd_inactive", 2185190688Sweongyo &stats->st_cmd_inactive, "Inactive numbers in Command queue"); 2186190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "cmd_pending", 2187190688Sweongyo &stats->st_cmd_pending, "Pending numbers in Command queue"); 2188190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "cmd_waiting", 2189190688Sweongyo &stats->st_cmd_waiting, "Waiting numbers in Command queue"); 2190190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "rx_active", 2191190688Sweongyo &stats->st_rx_active, "Active numbers in RX queue"); 2192190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "rx_inactive", 2193190688Sweongyo &stats->st_rx_inactive, "Inactive numbers in RX queue"); 2194190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "tx_active", 2195190688Sweongyo &stats->st_tx_active, "Active numbers in TX queue"); 2196190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "tx_inactive", 2197190688Sweongyo &stats->st_tx_inactive, "Inactive numbers in TX queue"); 2198190688Sweongyo UATH_SYSCTL_STAT_ADD32(ctx, child, "tx_pending", 2199190688Sweongyo &stats->st_tx_pending, "Pending numbers in TX queue"); 2200190688Sweongyo} 2201190688Sweongyo 2202190688Sweongyo#undef UATH_SYSCTL_STAT_ADD32 2203190688Sweongyo 2204190688Sweongyostatic void 2205190688Sweongyouath_cmdeof(struct uath_softc *sc, struct uath_cmd *cmd) 2206190688Sweongyo{ 2207190688Sweongyo struct uath_cmd_hdr *hdr; 2208190688Sweongyo int dlen; 2209190688Sweongyo 2210190688Sweongyo hdr = (struct uath_cmd_hdr *)cmd->buf; 2211190688Sweongyo /* NB: msgid is passed thru w/o byte swapping */ 2212190688Sweongyo#ifdef UATH_DEBUG 2213190688Sweongyo if (sc->sc_debug & UATH_DEBUG_CMDS) { 2214190688Sweongyo int len = be32toh(hdr->len); 2215190688Sweongyo printf("%s: %s [ix %u] len %u status %u\n", 2216190688Sweongyo __func__, uath_codename(be32toh(hdr->code)), 2217190688Sweongyo hdr->msgid, len, be32toh(hdr->magic)); 2218190688Sweongyo if (sc->sc_debug & UATH_DEBUG_CMDS_DUMP) 2219190688Sweongyo uath_dump_cmd(cmd->buf, 2220190688Sweongyo len > UATH_MAX_CMDSZ ? sizeof(*hdr) : len, '-'); 2221190688Sweongyo } 2222190688Sweongyo#endif 2223190688Sweongyo hdr->code = be32toh(hdr->code); 2224190688Sweongyo hdr->len = be32toh(hdr->len); 2225190688Sweongyo hdr->magic = be32toh(hdr->magic); /* target status on return */ 2226190688Sweongyo 2227190688Sweongyo switch (hdr->code & 0xff) { 2228190688Sweongyo /* reply to a read command */ 2229190688Sweongyo default: 2230190688Sweongyo dlen = hdr->len - sizeof(*hdr); 2231233774Shselasky if (dlen < 0) { 2232233774Shselasky device_printf(sc->sc_dev, 2233233774Shselasky "Invalid header length %d\n", dlen); 2234233774Shselasky return; 2235233774Shselasky } 2236190688Sweongyo DPRINTF(sc, UATH_DEBUG_RX_PROC | UATH_DEBUG_RECV_ALL, 2237190688Sweongyo "%s: code %d data len %u\n", 2238190688Sweongyo __func__, hdr->code & 0xff, dlen); 2239190688Sweongyo /* 2240190688Sweongyo * The first response from the target after the 2241190688Sweongyo * HOST_AVAILABLE has an invalid msgid so we must 2242190688Sweongyo * treat it specially. 2243190688Sweongyo */ 2244190688Sweongyo if (hdr->msgid < UATH_CMD_LIST_COUNT) { 2245190688Sweongyo uint32_t *rp = (uint32_t *)(hdr+1); 2246190688Sweongyo u_int olen; 2247190688Sweongyo 2248190688Sweongyo if (!(sizeof(*hdr) <= hdr->len && 2249190688Sweongyo hdr->len < UATH_MAX_CMDSZ)) { 2250190688Sweongyo device_printf(sc->sc_dev, 2251190688Sweongyo "%s: invalid WDC msg length %u; " 2252190688Sweongyo "msg ignored\n", __func__, hdr->len); 2253190688Sweongyo return; 2254190688Sweongyo } 2255190688Sweongyo /* 2256190688Sweongyo * Calculate return/receive payload size; the 2257190688Sweongyo * first word, if present, always gives the 2258190688Sweongyo * number of bytes--unless it's 0 in which 2259190688Sweongyo * case a single 32-bit word should be present. 2260190688Sweongyo */ 2261233774Shselasky if (dlen >= (int)sizeof(uint32_t)) { 2262190688Sweongyo olen = be32toh(rp[0]); 2263190688Sweongyo dlen -= sizeof(uint32_t); 2264190688Sweongyo if (olen == 0) { 2265190688Sweongyo /* convention is 0 =>'s one word */ 2266190688Sweongyo olen = sizeof(uint32_t); 2267190688Sweongyo /* XXX KASSERT(olen == dlen ) */ 2268190688Sweongyo } 2269190688Sweongyo } else 2270190688Sweongyo olen = 0; 2271190688Sweongyo if (cmd->odata != NULL) { 2272190688Sweongyo /* NB: cmd->olen validated in uath_cmd */ 2273233774Shselasky if (olen > (u_int)cmd->olen) { 2274190688Sweongyo /* XXX complain? */ 2275190688Sweongyo device_printf(sc->sc_dev, 2276190688Sweongyo "%s: cmd 0x%x olen %u cmd olen %u\n", 2277190688Sweongyo __func__, hdr->code, olen, 2278190688Sweongyo cmd->olen); 2279190688Sweongyo olen = cmd->olen; 2280190688Sweongyo } 2281233774Shselasky if (olen > (u_int)dlen) { 2282190688Sweongyo /* XXX complain, shouldn't happen */ 2283190688Sweongyo device_printf(sc->sc_dev, 2284190688Sweongyo "%s: cmd 0x%x olen %u dlen %u\n", 2285190688Sweongyo __func__, hdr->code, olen, dlen); 2286190688Sweongyo olen = dlen; 2287190688Sweongyo } 2288190688Sweongyo /* XXX have submitter do this */ 2289190688Sweongyo /* copy answer into caller's supplied buffer */ 2290190688Sweongyo bcopy(&rp[1], cmd->odata, olen); 2291190688Sweongyo cmd->olen = olen; 2292190688Sweongyo } 2293190688Sweongyo } 2294190688Sweongyo wakeup_one(cmd); /* wake up caller */ 2295190688Sweongyo break; 2296190688Sweongyo 2297190688Sweongyo case WDCMSG_TARGET_START: 2298190688Sweongyo if (hdr->msgid >= UATH_CMD_LIST_COUNT) { 2299190688Sweongyo /* XXX */ 2300190688Sweongyo return; 2301190688Sweongyo } 2302190688Sweongyo dlen = hdr->len - sizeof(*hdr); 2303233774Shselasky if (dlen != (int)sizeof(uint32_t)) { 2304190688Sweongyo /* XXX something wrong */ 2305190688Sweongyo return; 2306190688Sweongyo } 2307190688Sweongyo /* XXX have submitter do this */ 2308190688Sweongyo /* copy answer into caller's supplied buffer */ 2309190688Sweongyo bcopy(hdr+1, cmd->odata, sizeof(uint32_t)); 2310190688Sweongyo cmd->olen = sizeof(uint32_t); 2311190688Sweongyo wakeup_one(cmd); /* wake up caller */ 2312190688Sweongyo break; 2313190688Sweongyo 2314190688Sweongyo case WDCMSG_SEND_COMPLETE: 2315190688Sweongyo /* this notification is sent when UATH_TX_NOTIFY is set */ 2316190688Sweongyo DPRINTF(sc, UATH_DEBUG_RX_PROC | UATH_DEBUG_RECV_ALL, 2317190688Sweongyo "%s: received Tx notification\n", __func__); 2318190688Sweongyo break; 2319190688Sweongyo 2320190688Sweongyo case WDCMSG_TARGET_GET_STATS: 2321190688Sweongyo DPRINTF(sc, UATH_DEBUG_RX_PROC | UATH_DEBUG_RECV_ALL, 2322190688Sweongyo "%s: received device statistics\n", __func__); 2323190688Sweongyo callout_reset(&sc->stat_ch, hz, uath_stat, sc); 2324190688Sweongyo break; 2325190688Sweongyo } 2326190688Sweongyo} 2327190688Sweongyo 2328190688Sweongyostatic void 2329194677Sthompsauath_intr_rx_callback(struct usb_xfer *xfer, usb_error_t error) 2330190688Sweongyo{ 2331194677Sthompsa struct uath_softc *sc = usbd_xfer_softc(xfer); 2332190688Sweongyo struct uath_cmd *cmd; 2333194677Sthompsa struct usb_page_cache *pc; 2334194677Sthompsa int actlen; 2335190688Sweongyo 2336194677Sthompsa usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL); 2337194677Sthompsa 2338190688Sweongyo UATH_ASSERT_LOCKED(sc); 2339190688Sweongyo 2340190688Sweongyo switch (USB_GET_STATE(xfer)) { 2341190688Sweongyo case USB_ST_TRANSFERRED: 2342190688Sweongyo cmd = STAILQ_FIRST(&sc->sc_cmd_waiting); 2343190688Sweongyo if (cmd == NULL) 2344190688Sweongyo goto setup; 2345190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_cmd_waiting, next); 2346190688Sweongyo UATH_STAT_DEC(sc, st_cmd_waiting); 2347190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_cmd_inactive, cmd, next); 2348190688Sweongyo UATH_STAT_INC(sc, st_cmd_inactive); 2349190688Sweongyo 2350233774Shselasky KASSERT(actlen >= (int)sizeof(struct uath_cmd_hdr), 2351190688Sweongyo ("short xfer error")); 2352194677Sthompsa pc = usbd_xfer_get_frame(xfer, 0); 2353194677Sthompsa usbd_copy_out(pc, 0, cmd->buf, actlen); 2354190688Sweongyo uath_cmdeof(sc, cmd); 2355190688Sweongyo case USB_ST_SETUP: 2356190688Sweongyosetup: 2357194677Sthompsa usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer)); 2358194228Sthompsa usbd_transfer_submit(xfer); 2359190688Sweongyo break; 2360190688Sweongyo default: 2361194677Sthompsa if (error != USB_ERR_CANCELLED) { 2362194677Sthompsa usbd_xfer_set_stall(xfer); 2363190688Sweongyo goto setup; 2364190688Sweongyo } 2365190688Sweongyo break; 2366190688Sweongyo } 2367190688Sweongyo} 2368190688Sweongyo 2369190688Sweongyostatic void 2370194677Sthompsauath_intr_tx_callback(struct usb_xfer *xfer, usb_error_t error) 2371190688Sweongyo{ 2372194677Sthompsa struct uath_softc *sc = usbd_xfer_softc(xfer); 2373190688Sweongyo struct uath_cmd *cmd; 2374190688Sweongyo 2375190688Sweongyo UATH_ASSERT_LOCKED(sc); 2376190688Sweongyo 2377246570Shselasky cmd = STAILQ_FIRST(&sc->sc_cmd_active); 2378246570Shselasky if (cmd != NULL && USB_GET_STATE(xfer) != USB_ST_SETUP) { 2379190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_cmd_active, next); 2380190688Sweongyo UATH_STAT_DEC(sc, st_cmd_active); 2381190688Sweongyo STAILQ_INSERT_TAIL((cmd->flags & UATH_CMD_FLAG_READ) ? 2382190688Sweongyo &sc->sc_cmd_waiting : &sc->sc_cmd_inactive, cmd, next); 2383190688Sweongyo if (cmd->flags & UATH_CMD_FLAG_READ) 2384190688Sweongyo UATH_STAT_INC(sc, st_cmd_waiting); 2385190688Sweongyo else 2386190688Sweongyo UATH_STAT_INC(sc, st_cmd_inactive); 2387246570Shselasky } 2388246570Shselasky 2389246570Shselasky switch (USB_GET_STATE(xfer)) { 2390246570Shselasky case USB_ST_TRANSFERRED: 2391190688Sweongyo case USB_ST_SETUP: 2392190688Sweongyosetup: 2393190688Sweongyo cmd = STAILQ_FIRST(&sc->sc_cmd_pending); 2394190688Sweongyo if (cmd == NULL) { 2395190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, "%s: empty pending queue\n", 2396190688Sweongyo __func__); 2397190688Sweongyo return; 2398190688Sweongyo } 2399190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_cmd_pending, next); 2400190688Sweongyo UATH_STAT_DEC(sc, st_cmd_pending); 2401190688Sweongyo STAILQ_INSERT_TAIL((cmd->flags & UATH_CMD_FLAG_ASYNC) ? 2402190688Sweongyo &sc->sc_cmd_inactive : &sc->sc_cmd_active, cmd, next); 2403190688Sweongyo if (cmd->flags & UATH_CMD_FLAG_ASYNC) 2404190688Sweongyo UATH_STAT_INC(sc, st_cmd_inactive); 2405190688Sweongyo else 2406190688Sweongyo UATH_STAT_INC(sc, st_cmd_active); 2407190688Sweongyo 2408194677Sthompsa usbd_xfer_set_frame_data(xfer, 0, cmd->buf, cmd->buflen); 2409194228Sthompsa usbd_transfer_submit(xfer); 2410190688Sweongyo break; 2411190688Sweongyo default: 2412194677Sthompsa if (error != USB_ERR_CANCELLED) { 2413194677Sthompsa usbd_xfer_set_stall(xfer); 2414190688Sweongyo goto setup; 2415190688Sweongyo } 2416190688Sweongyo break; 2417190688Sweongyo } 2418190688Sweongyo} 2419190688Sweongyo 2420190688Sweongyostatic void 2421190688Sweongyouath_update_rxstat(struct uath_softc *sc, uint32_t status) 2422190688Sweongyo{ 2423190688Sweongyo 2424190688Sweongyo switch (status) { 2425190688Sweongyo case UATH_STATUS_STOP_IN_PROGRESS: 2426190688Sweongyo UATH_STAT_INC(sc, st_stopinprogress); 2427190688Sweongyo break; 2428190688Sweongyo case UATH_STATUS_CRC_ERR: 2429190688Sweongyo UATH_STAT_INC(sc, st_crcerr); 2430190688Sweongyo break; 2431190688Sweongyo case UATH_STATUS_PHY_ERR: 2432190688Sweongyo UATH_STAT_INC(sc, st_phyerr); 2433190688Sweongyo break; 2434190688Sweongyo case UATH_STATUS_DECRYPT_CRC_ERR: 2435190688Sweongyo UATH_STAT_INC(sc, st_decrypt_crcerr); 2436190688Sweongyo break; 2437190688Sweongyo case UATH_STATUS_DECRYPT_MIC_ERR: 2438190688Sweongyo UATH_STAT_INC(sc, st_decrypt_micerr); 2439190688Sweongyo break; 2440190688Sweongyo case UATH_STATUS_DECOMP_ERR: 2441190688Sweongyo UATH_STAT_INC(sc, st_decomperr); 2442190688Sweongyo break; 2443190688Sweongyo case UATH_STATUS_KEY_ERR: 2444190688Sweongyo UATH_STAT_INC(sc, st_keyerr); 2445190688Sweongyo break; 2446190688Sweongyo case UATH_STATUS_ERR: 2447190688Sweongyo UATH_STAT_INC(sc, st_err); 2448190688Sweongyo break; 2449190688Sweongyo default: 2450190688Sweongyo break; 2451190688Sweongyo } 2452190688Sweongyo} 2453190688Sweongyo 2454190688Sweongyostatic struct mbuf * 2455192984Sthompsauath_data_rxeof(struct usb_xfer *xfer, struct uath_data *data, 2456190688Sweongyo struct uath_rx_desc **pdesc) 2457190688Sweongyo{ 2458194677Sthompsa struct uath_softc *sc = usbd_xfer_softc(xfer); 2459287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 2460190688Sweongyo struct uath_chunk *chunk; 2461190688Sweongyo struct uath_rx_desc *desc; 2462190688Sweongyo struct mbuf *m = data->m, *mnew, *mp; 2463190688Sweongyo uint16_t chunklen; 2464194677Sthompsa int actlen; 2465190688Sweongyo 2466194677Sthompsa usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL); 2467194677Sthompsa 2468233774Shselasky if (actlen < (int)UATH_MIN_RXBUFSZ) { 2469190688Sweongyo DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL, 2470194677Sthompsa "%s: wrong xfer size (len=%d)\n", __func__, actlen); 2471287197Sglebius counter_u64_add(ic->ic_ierrors, 1); 2472190688Sweongyo return (NULL); 2473190688Sweongyo } 2474190688Sweongyo 2475190688Sweongyo chunk = (struct uath_chunk *)data->buf; 2476190688Sweongyo if (chunk->seqnum == 0 && chunk->flags == 0 && chunk->length == 0) { 2477190688Sweongyo device_printf(sc->sc_dev, "%s: strange response\n", __func__); 2478287197Sglebius counter_u64_add(ic->ic_ierrors, 1); 2479190688Sweongyo UATH_RESET_INTRX(sc); 2480190688Sweongyo return (NULL); 2481190688Sweongyo } 2482190688Sweongyo 2483190688Sweongyo if (chunk->seqnum != sc->sc_intrx_nextnum) { 2484190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, "invalid seqnum %d, expected %d\n", 2485190688Sweongyo chunk->seqnum, sc->sc_intrx_nextnum); 2486190688Sweongyo UATH_STAT_INC(sc, st_badchunkseqnum); 2487190688Sweongyo if (sc->sc_intrx_head != NULL) 2488190688Sweongyo m_freem(sc->sc_intrx_head); 2489190688Sweongyo UATH_RESET_INTRX(sc); 2490190688Sweongyo return (NULL); 2491190688Sweongyo } 2492190688Sweongyo 2493190688Sweongyo /* check multi-chunk frames */ 2494190688Sweongyo if ((chunk->seqnum == 0 && !(chunk->flags & UATH_CFLAGS_FINAL)) || 2495190688Sweongyo (chunk->seqnum != 0 && (chunk->flags & UATH_CFLAGS_FINAL)) || 2496190688Sweongyo chunk->flags & UATH_CFLAGS_RXMSG) 2497190688Sweongyo UATH_STAT_INC(sc, st_multichunk); 2498190688Sweongyo 2499190688Sweongyo chunklen = be16toh(chunk->length); 2500190688Sweongyo if (chunk->flags & UATH_CFLAGS_FINAL) 2501190688Sweongyo chunklen -= sizeof(struct uath_rx_desc); 2502190688Sweongyo 2503190688Sweongyo if (chunklen > 0 && 2504190688Sweongyo (!(chunk->flags & UATH_CFLAGS_FINAL) || !(chunk->seqnum == 0))) { 2505190688Sweongyo /* we should use intermediate RX buffer */ 2506190688Sweongyo if (chunk->seqnum == 0) 2507190688Sweongyo UATH_RESET_INTRX(sc); 2508190688Sweongyo if ((sc->sc_intrx_len + sizeof(struct uath_rx_desc) + 2509190688Sweongyo chunklen) > UATH_MAX_INTRX_SIZE) { 2510190688Sweongyo UATH_STAT_INC(sc, st_invalidlen); 2511287197Sglebius counter_u64_add(ic->ic_ierrors, 1); 2512190688Sweongyo if (sc->sc_intrx_head != NULL) 2513190688Sweongyo m_freem(sc->sc_intrx_head); 2514190688Sweongyo UATH_RESET_INTRX(sc); 2515190688Sweongyo return (NULL); 2516190688Sweongyo } 2517190688Sweongyo 2518190688Sweongyo m->m_len = chunklen; 2519190688Sweongyo m->m_data += sizeof(struct uath_chunk); 2520190688Sweongyo 2521190688Sweongyo if (sc->sc_intrx_head == NULL) { 2522190688Sweongyo sc->sc_intrx_head = m; 2523190688Sweongyo sc->sc_intrx_tail = m; 2524190688Sweongyo } else { 2525190688Sweongyo m->m_flags &= ~M_PKTHDR; 2526190688Sweongyo sc->sc_intrx_tail->m_next = m; 2527190688Sweongyo sc->sc_intrx_tail = m; 2528190688Sweongyo } 2529190688Sweongyo } 2530190688Sweongyo sc->sc_intrx_len += chunklen; 2531190688Sweongyo 2532243857Sglebius mnew = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 2533190688Sweongyo if (mnew == NULL) { 2534190688Sweongyo DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL, 2535190688Sweongyo "%s: can't get new mbuf, drop frame\n", __func__); 2536287197Sglebius counter_u64_add(ic->ic_ierrors, 1); 2537190688Sweongyo if (sc->sc_intrx_head != NULL) 2538190688Sweongyo m_freem(sc->sc_intrx_head); 2539190688Sweongyo UATH_RESET_INTRX(sc); 2540190688Sweongyo return (NULL); 2541190688Sweongyo } 2542190688Sweongyo 2543190688Sweongyo data->m = mnew; 2544190688Sweongyo data->buf = mtod(mnew, uint8_t *); 2545190688Sweongyo 2546190688Sweongyo /* if the frame is not final continue the transfer */ 2547190688Sweongyo if (!(chunk->flags & UATH_CFLAGS_FINAL)) { 2548190688Sweongyo sc->sc_intrx_nextnum++; 2549190688Sweongyo UATH_RESET_INTRX(sc); 2550190688Sweongyo return (NULL); 2551190688Sweongyo } 2552190688Sweongyo 2553190688Sweongyo /* 2554190688Sweongyo * if the frame is not set UATH_CFLAGS_RXMSG, then rx descriptor is 2555190688Sweongyo * located at the end, 32-bit aligned 2556190688Sweongyo */ 2557190688Sweongyo desc = (chunk->flags & UATH_CFLAGS_RXMSG) ? 2558190688Sweongyo (struct uath_rx_desc *)(chunk + 1) : 2559190688Sweongyo (struct uath_rx_desc *)(((uint8_t *)chunk) + 2560190688Sweongyo sizeof(struct uath_chunk) + be16toh(chunk->length) - 2561190688Sweongyo sizeof(struct uath_rx_desc)); 2562190688Sweongyo *pdesc = desc; 2563190688Sweongyo 2564190688Sweongyo DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL, 2565190688Sweongyo "%s: frame len %u code %u status %u rate %u antenna %u " 2566190688Sweongyo "rssi %d channel %u phyerror %u connix %u decrypterror %u " 2567190688Sweongyo "keycachemiss %u\n", __func__, be32toh(desc->framelen) 2568190688Sweongyo , be32toh(desc->code), be32toh(desc->status), be32toh(desc->rate) 2569190688Sweongyo , be32toh(desc->antenna), be32toh(desc->rssi), be32toh(desc->channel) 2570190688Sweongyo , be32toh(desc->phyerror), be32toh(desc->connix) 2571190688Sweongyo , be32toh(desc->decrypterror), be32toh(desc->keycachemiss)); 2572190688Sweongyo 2573190688Sweongyo if (be32toh(desc->len) > MCLBYTES) { 2574190688Sweongyo DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL, 2575190688Sweongyo "%s: bad descriptor (len=%d)\n", __func__, 2576190688Sweongyo be32toh(desc->len)); 2577287197Sglebius counter_u64_add(ic->ic_ierrors, 1); 2578190688Sweongyo UATH_STAT_INC(sc, st_toobigrxpkt); 2579190688Sweongyo if (sc->sc_intrx_head != NULL) 2580190688Sweongyo m_freem(sc->sc_intrx_head); 2581190688Sweongyo UATH_RESET_INTRX(sc); 2582190688Sweongyo return (NULL); 2583190688Sweongyo } 2584190688Sweongyo 2585190688Sweongyo uath_update_rxstat(sc, be32toh(desc->status)); 2586190688Sweongyo 2587190688Sweongyo /* finalize mbuf */ 2588190688Sweongyo if (sc->sc_intrx_head == NULL) { 2589190688Sweongyo m->m_pkthdr.len = m->m_len = 2590190688Sweongyo be32toh(desc->framelen) - UATH_RX_DUMMYSIZE; 2591190688Sweongyo m->m_data += sizeof(struct uath_chunk); 2592190688Sweongyo } else { 2593190688Sweongyo mp = sc->sc_intrx_head; 2594190688Sweongyo mp->m_flags |= M_PKTHDR; 2595190688Sweongyo mp->m_pkthdr.len = sc->sc_intrx_len; 2596190688Sweongyo m = mp; 2597190688Sweongyo } 2598190688Sweongyo 2599190688Sweongyo /* there are a lot more fields in the RX descriptor */ 2600194329Sweongyo if ((sc->sc_flags & UATH_FLAG_INVALID) == 0 && 2601194329Sweongyo ieee80211_radiotap_active(ic)) { 2602190688Sweongyo struct uath_rx_radiotap_header *tap = &sc->sc_rxtap; 2603192468Ssam uint32_t tsf_hi = be32toh(desc->tstamp_high); 2604192468Ssam uint32_t tsf_lo = be32toh(desc->tstamp_low); 2605190688Sweongyo 2606192468Ssam /* XXX only get low order 24bits of tsf from h/w */ 2607192468Ssam tap->wr_tsf = htole64(((uint64_t)tsf_hi << 32) | tsf_lo); 2608192468Ssam tap->wr_flags = 0; 2609192468Ssam if (be32toh(desc->status) == UATH_STATUS_CRC_ERR) 2610192468Ssam tap->wr_flags |= IEEE80211_RADIOTAP_F_BADFCS; 2611192468Ssam /* XXX map other status to BADFCS? */ 2612192468Ssam /* XXX ath h/w rate code, need to map */ 2613192468Ssam tap->wr_rate = be32toh(desc->rate); 2614192468Ssam tap->wr_antenna = be32toh(desc->antenna); 2615192468Ssam tap->wr_antsignal = -95 + be32toh(desc->rssi); 2616192468Ssam tap->wr_antnoise = -95; 2617190688Sweongyo } 2618190688Sweongyo 2619190688Sweongyo UATH_RESET_INTRX(sc); 2620190688Sweongyo 2621190688Sweongyo return (m); 2622190688Sweongyo} 2623190688Sweongyo 2624190688Sweongyostatic void 2625194677Sthompsauath_bulk_rx_callback(struct usb_xfer *xfer, usb_error_t error) 2626190688Sweongyo{ 2627194677Sthompsa struct uath_softc *sc = usbd_xfer_softc(xfer); 2628287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 2629190688Sweongyo struct ieee80211_frame *wh; 2630190688Sweongyo struct ieee80211_node *ni; 2631190688Sweongyo struct mbuf *m = NULL; 2632190688Sweongyo struct uath_data *data; 2633190688Sweongyo struct uath_rx_desc *desc = NULL; 2634190688Sweongyo int8_t nf; 2635190688Sweongyo 2636190688Sweongyo UATH_ASSERT_LOCKED(sc); 2637190688Sweongyo 2638190688Sweongyo switch (USB_GET_STATE(xfer)) { 2639190688Sweongyo case USB_ST_TRANSFERRED: 2640190688Sweongyo data = STAILQ_FIRST(&sc->sc_rx_active); 2641190688Sweongyo if (data == NULL) 2642190688Sweongyo goto setup; 2643190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 2644190688Sweongyo UATH_STAT_DEC(sc, st_rx_active); 2645190688Sweongyo m = uath_data_rxeof(xfer, data, &desc); 2646190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 2647190688Sweongyo UATH_STAT_INC(sc, st_rx_inactive); 2648190688Sweongyo /* FALLTHROUGH */ 2649190688Sweongyo case USB_ST_SETUP: 2650190688Sweongyosetup: 2651190688Sweongyo data = STAILQ_FIRST(&sc->sc_rx_inactive); 2652190688Sweongyo if (data == NULL) 2653190688Sweongyo return; 2654190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_rx_inactive, next); 2655190688Sweongyo UATH_STAT_DEC(sc, st_rx_inactive); 2656190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_rx_active, data, next); 2657190688Sweongyo UATH_STAT_INC(sc, st_rx_active); 2658244503Shselasky usbd_xfer_set_frame_data(xfer, 0, data->buf, MCLBYTES); 2659194228Sthompsa usbd_transfer_submit(xfer); 2660190688Sweongyo 2661190688Sweongyo /* 2662190688Sweongyo * To avoid LOR we should unlock our private mutex here to call 2663190688Sweongyo * ieee80211_input() because here is at the end of a USB 2664190688Sweongyo * callback and safe to unlock. 2665190688Sweongyo */ 2666194329Sweongyo if (sc->sc_flags & UATH_FLAG_INVALID) { 2667194329Sweongyo if (m != NULL) 2668194329Sweongyo m_freem(m); 2669194329Sweongyo return; 2670194329Sweongyo } 2671190688Sweongyo UATH_UNLOCK(sc); 2672190688Sweongyo if (m != NULL && desc != NULL) { 2673190688Sweongyo wh = mtod(m, struct ieee80211_frame *); 2674190688Sweongyo ni = ieee80211_find_rxnode(ic, 2675190688Sweongyo (struct ieee80211_frame_min *)wh); 2676190688Sweongyo nf = -95; /* XXX */ 2677190688Sweongyo if (ni != NULL) { 2678190688Sweongyo (void) ieee80211_input(ni, m, 2679192468Ssam (int)be32toh(desc->rssi), nf); 2680190688Sweongyo /* node is no longer needed */ 2681190688Sweongyo ieee80211_free_node(ni); 2682190688Sweongyo } else 2683190688Sweongyo (void) ieee80211_input_all(ic, m, 2684192468Ssam (int)be32toh(desc->rssi), nf); 2685190688Sweongyo m = NULL; 2686190688Sweongyo desc = NULL; 2687190688Sweongyo } 2688190688Sweongyo UATH_LOCK(sc); 2689287197Sglebius uath_start(sc); 2690190688Sweongyo break; 2691190688Sweongyo default: 2692190688Sweongyo /* needs it to the inactive queue due to a error. */ 2693190688Sweongyo data = STAILQ_FIRST(&sc->sc_rx_active); 2694190688Sweongyo if (data != NULL) { 2695190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 2696190688Sweongyo UATH_STAT_DEC(sc, st_rx_active); 2697190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 2698190688Sweongyo UATH_STAT_INC(sc, st_rx_inactive); 2699190688Sweongyo } 2700194677Sthompsa if (error != USB_ERR_CANCELLED) { 2701194677Sthompsa usbd_xfer_set_stall(xfer); 2702287197Sglebius counter_u64_add(ic->ic_ierrors, 1); 2703190688Sweongyo goto setup; 2704190688Sweongyo } 2705190688Sweongyo break; 2706190688Sweongyo } 2707190688Sweongyo} 2708190688Sweongyo 2709190688Sweongyostatic void 2710192984Sthompsauath_data_txeof(struct usb_xfer *xfer, struct uath_data *data) 2711190688Sweongyo{ 2712194677Sthompsa struct uath_softc *sc = usbd_xfer_softc(xfer); 2713190688Sweongyo 2714190688Sweongyo UATH_ASSERT_LOCKED(sc); 2715190688Sweongyo 2716190688Sweongyo if (data->m) { 2717287197Sglebius /* XXX status? */ 2718287197Sglebius ieee80211_tx_complete(data->ni, data->m, 0); 2719190688Sweongyo data->m = NULL; 2720190688Sweongyo data->ni = NULL; 2721190688Sweongyo } 2722190688Sweongyo sc->sc_tx_timer = 0; 2723190688Sweongyo} 2724190688Sweongyo 2725190688Sweongyostatic void 2726194677Sthompsauath_bulk_tx_callback(struct usb_xfer *xfer, usb_error_t error) 2727190688Sweongyo{ 2728194677Sthompsa struct uath_softc *sc = usbd_xfer_softc(xfer); 2729190688Sweongyo struct uath_data *data; 2730190688Sweongyo 2731190688Sweongyo UATH_ASSERT_LOCKED(sc); 2732190688Sweongyo 2733190688Sweongyo switch (USB_GET_STATE(xfer)) { 2734190688Sweongyo case USB_ST_TRANSFERRED: 2735190688Sweongyo data = STAILQ_FIRST(&sc->sc_tx_active); 2736190688Sweongyo if (data == NULL) 2737190688Sweongyo goto setup; 2738190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next); 2739190688Sweongyo UATH_STAT_DEC(sc, st_tx_active); 2740190688Sweongyo uath_data_txeof(xfer, data); 2741190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data, next); 2742190688Sweongyo UATH_STAT_INC(sc, st_tx_inactive); 2743190688Sweongyo /* FALLTHROUGH */ 2744190688Sweongyo case USB_ST_SETUP: 2745190688Sweongyosetup: 2746190688Sweongyo data = STAILQ_FIRST(&sc->sc_tx_pending); 2747190688Sweongyo if (data == NULL) { 2748190688Sweongyo DPRINTF(sc, UATH_DEBUG_XMIT, "%s: empty pending queue\n", 2749190688Sweongyo __func__); 2750190688Sweongyo return; 2751190688Sweongyo } 2752190688Sweongyo STAILQ_REMOVE_HEAD(&sc->sc_tx_pending, next); 2753190688Sweongyo UATH_STAT_DEC(sc, st_tx_pending); 2754190688Sweongyo STAILQ_INSERT_TAIL(&sc->sc_tx_active, data, next); 2755190688Sweongyo UATH_STAT_INC(sc, st_tx_active); 2756190688Sweongyo 2757194677Sthompsa usbd_xfer_set_frame_data(xfer, 0, data->buf, data->buflen); 2758194228Sthompsa usbd_transfer_submit(xfer); 2759190688Sweongyo 2760287197Sglebius uath_start(sc); 2761190688Sweongyo break; 2762190688Sweongyo default: 2763190688Sweongyo data = STAILQ_FIRST(&sc->sc_tx_active); 2764190688Sweongyo if (data == NULL) 2765190688Sweongyo goto setup; 2766190688Sweongyo if (data->ni != NULL) { 2767287197Sglebius if_inc_counter(data->ni->ni_vap->iv_ifp, 2768287197Sglebius IFCOUNTER_OERRORS, 1); 2769194329Sweongyo if ((sc->sc_flags & UATH_FLAG_INVALID) == 0) 2770194329Sweongyo ieee80211_free_node(data->ni); 2771190688Sweongyo data->ni = NULL; 2772190688Sweongyo } 2773194677Sthompsa if (error != USB_ERR_CANCELLED) { 2774194677Sthompsa usbd_xfer_set_stall(xfer); 2775190688Sweongyo goto setup; 2776190688Sweongyo } 2777190688Sweongyo break; 2778190688Sweongyo } 2779190688Sweongyo} 2780190688Sweongyo 2781190688Sweongyostatic device_method_t uath_methods[] = { 2782190688Sweongyo DEVMETHOD(device_probe, uath_match), 2783190688Sweongyo DEVMETHOD(device_attach, uath_attach), 2784190688Sweongyo DEVMETHOD(device_detach, uath_detach), 2785244503Shselasky DEVMETHOD_END 2786190688Sweongyo}; 2787190688Sweongyostatic driver_t uath_driver = { 2788233774Shselasky .name = "uath", 2789233774Shselasky .methods = uath_methods, 2790233774Shselasky .size = sizeof(struct uath_softc) 2791190688Sweongyo}; 2792190688Sweongyostatic devclass_t uath_devclass; 2793190688Sweongyo 2794190688SweongyoDRIVER_MODULE(uath, uhub, uath_driver, uath_devclass, NULL, 0); 2795190688SweongyoMODULE_DEPEND(uath, wlan, 1, 1, 1); 2796190688SweongyoMODULE_DEPEND(uath, usb, 1, 1, 1); 2797212122SthompsaMODULE_VERSION(uath, 1); 2798292080SimpUSB_PNP_HOST_INFO(uath_devs); 2799