1dc60165bSWeongyo Jeong /*- 2dc60165bSWeongyo Jeong * Copyright (c) 2006 Sam Leffler, Errno Consulting 3dc60165bSWeongyo Jeong * Copyright (c) 2008-2009 Weongyo Jeong <weongyo@freebsd.org> 4dc60165bSWeongyo Jeong * All rights reserved. 5dc60165bSWeongyo Jeong * 6dc60165bSWeongyo Jeong * Redistribution and use in source and binary forms, with or without 7dc60165bSWeongyo Jeong * modification, are permitted provided that the following conditions 8dc60165bSWeongyo Jeong * are met: 9dc60165bSWeongyo Jeong * 1. Redistributions of source code must retain the above copyright 10dc60165bSWeongyo Jeong * notice, this list of conditions and the following disclaimer, 11dc60165bSWeongyo Jeong * without modification. 12dc60165bSWeongyo Jeong * 2. Redistributions in binary form must reproduce at minimum a disclaimer 13dc60165bSWeongyo Jeong * similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any 14dc60165bSWeongyo Jeong * redistribution must be conditioned upon including a substantially 15dc60165bSWeongyo Jeong * similar Disclaimer requirement for further binary redistribution. 16dc60165bSWeongyo Jeong * 17dc60165bSWeongyo Jeong * NO WARRANTY 18dc60165bSWeongyo Jeong * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 19dc60165bSWeongyo Jeong * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 20dc60165bSWeongyo Jeong * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY 21dc60165bSWeongyo Jeong * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL 22dc60165bSWeongyo Jeong * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, 23dc60165bSWeongyo Jeong * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 24dc60165bSWeongyo Jeong * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 25dc60165bSWeongyo Jeong * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER 26dc60165bSWeongyo Jeong * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 27dc60165bSWeongyo Jeong * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF 28dc60165bSWeongyo Jeong * THE POSSIBILITY OF SUCH DAMAGES. 29dc60165bSWeongyo Jeong */ 30dc60165bSWeongyo Jeong 31dc60165bSWeongyo Jeong /* 32dc60165bSWeongyo Jeong * This driver is distantly derived from a driver of the same name 33dc60165bSWeongyo Jeong * by Damien Bergamini. The original copyright is included below: 34dc60165bSWeongyo Jeong * 35dc60165bSWeongyo Jeong * Copyright (c) 2006 36dc60165bSWeongyo Jeong * Damien Bergamini <damien.bergamini@free.fr> 37dc60165bSWeongyo Jeong * 38dc60165bSWeongyo Jeong * Permission to use, copy, modify, and distribute this software for any 39dc60165bSWeongyo Jeong * purpose with or without fee is hereby granted, provided that the above 40dc60165bSWeongyo Jeong * copyright notice and this permission notice appear in all copies. 41dc60165bSWeongyo Jeong * 42dc60165bSWeongyo Jeong * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 43dc60165bSWeongyo Jeong * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 44dc60165bSWeongyo Jeong * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 45dc60165bSWeongyo Jeong * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 46dc60165bSWeongyo Jeong * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 47dc60165bSWeongyo Jeong * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 48dc60165bSWeongyo Jeong * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 49dc60165bSWeongyo Jeong */ 50dc60165bSWeongyo Jeong 51dc60165bSWeongyo Jeong #include <sys/cdefs.h> 52dc60165bSWeongyo Jeong __FBSDID("$FreeBSD$"); 53dc60165bSWeongyo Jeong 54dc60165bSWeongyo Jeong /*- 55dc60165bSWeongyo Jeong * Driver for Atheros AR5523 USB parts. 56dc60165bSWeongyo Jeong * 57dc60165bSWeongyo Jeong * The driver requires firmware to be loaded into the device. This 58dc60165bSWeongyo Jeong * is done on device discovery from a user application (uathload) 59dc60165bSWeongyo Jeong * that is launched by devd when a device with suitable product ID 60dc60165bSWeongyo Jeong * is recognized. Once firmware has been loaded the device will 61dc60165bSWeongyo Jeong * reset the USB port and re-attach with the original product ID+1 62dc60165bSWeongyo Jeong * and this driver will be attached. The firmware is licensed for 63dc60165bSWeongyo Jeong * general use (royalty free) and may be incorporated in products. 64dc60165bSWeongyo Jeong * Note that the firmware normally packaged with the NDIS drivers 65dc60165bSWeongyo Jeong * for these devices does not work in this way and so does not work 66dc60165bSWeongyo Jeong * with this driver. 67dc60165bSWeongyo Jeong */ 68dc60165bSWeongyo Jeong #include <sys/param.h> 69dc60165bSWeongyo Jeong #include <sys/sockio.h> 70dc60165bSWeongyo Jeong #include <sys/sysctl.h> 71dc60165bSWeongyo Jeong #include <sys/lock.h> 72dc60165bSWeongyo Jeong #include <sys/mutex.h> 73dc60165bSWeongyo Jeong #include <sys/mbuf.h> 74dc60165bSWeongyo Jeong #include <sys/kernel.h> 75dc60165bSWeongyo Jeong #include <sys/socket.h> 76dc60165bSWeongyo Jeong #include <sys/systm.h> 77dc60165bSWeongyo Jeong #include <sys/malloc.h> 78dc60165bSWeongyo Jeong #include <sys/module.h> 79dc60165bSWeongyo Jeong #include <sys/bus.h> 80dc60165bSWeongyo Jeong #include <sys/endian.h> 81dc60165bSWeongyo Jeong #include <sys/kdb.h> 82dc60165bSWeongyo Jeong 83dc60165bSWeongyo Jeong #include <machine/bus.h> 84dc60165bSWeongyo Jeong #include <machine/resource.h> 85dc60165bSWeongyo Jeong #include <sys/rman.h> 86dc60165bSWeongyo Jeong 87dc60165bSWeongyo Jeong #include <net/bpf.h> 88dc60165bSWeongyo Jeong #include <net/if.h> 8976039bc8SGleb Smirnoff #include <net/if_var.h> 90dc60165bSWeongyo Jeong #include <net/if_arp.h> 91dc60165bSWeongyo Jeong #include <net/ethernet.h> 92dc60165bSWeongyo Jeong #include <net/if_dl.h> 93dc60165bSWeongyo Jeong #include <net/if_media.h> 94dc60165bSWeongyo Jeong #include <net/if_types.h> 95dc60165bSWeongyo Jeong 96dc60165bSWeongyo Jeong #ifdef INET 97dc60165bSWeongyo Jeong #include <netinet/in.h> 98dc60165bSWeongyo Jeong #include <netinet/in_systm.h> 99dc60165bSWeongyo Jeong #include <netinet/in_var.h> 100dc60165bSWeongyo Jeong #include <netinet/if_ether.h> 101dc60165bSWeongyo Jeong #include <netinet/ip.h> 102dc60165bSWeongyo Jeong #endif 103dc60165bSWeongyo Jeong 104dc60165bSWeongyo Jeong #include <net80211/ieee80211_var.h> 105dc60165bSWeongyo Jeong #include <net80211/ieee80211_regdomain.h> 106dc60165bSWeongyo Jeong #include <net80211/ieee80211_radiotap.h> 107dc60165bSWeongyo Jeong 108dc60165bSWeongyo Jeong #include <dev/usb/usb.h> 109ed6d949aSAndrew Thompson #include <dev/usb/usbdi.h> 110dc60165bSWeongyo Jeong #include "usbdevs.h" 111dc60165bSWeongyo Jeong 112dc60165bSWeongyo Jeong #include <dev/usb/wlan/if_uathreg.h> 113dc60165bSWeongyo Jeong #include <dev/usb/wlan/if_uathvar.h> 114dc60165bSWeongyo Jeong 1156472ac3dSEd Schouten static SYSCTL_NODE(_hw_usb, OID_AUTO, uath, CTLFLAG_RW, 0, "USB Atheros"); 116dc60165bSWeongyo Jeong 117dc60165bSWeongyo Jeong static int uath_countrycode = CTRY_DEFAULT; /* country code */ 118af3b2549SHans Petter Selasky SYSCTL_INT(_hw_usb_uath, OID_AUTO, countrycode, CTLFLAG_RWTUN, &uath_countrycode, 119dc60165bSWeongyo Jeong 0, "country code"); 120dc60165bSWeongyo Jeong static int uath_regdomain = 0; /* regulatory domain */ 1219360ae40SAndrew Thompson SYSCTL_INT(_hw_usb_uath, OID_AUTO, regdomain, CTLFLAG_RD, &uath_regdomain, 122dc60165bSWeongyo Jeong 0, "regulatory domain"); 123dc60165bSWeongyo Jeong 124dc60165bSWeongyo Jeong #ifdef UATH_DEBUG 125dc60165bSWeongyo Jeong int uath_debug = 0; 126af3b2549SHans Petter Selasky SYSCTL_INT(_hw_usb_uath, OID_AUTO, debug, CTLFLAG_RWTUN, &uath_debug, 0, 127dc60165bSWeongyo Jeong "uath debug level"); 128dc60165bSWeongyo Jeong enum { 129dc60165bSWeongyo Jeong UATH_DEBUG_XMIT = 0x00000001, /* basic xmit operation */ 130dc60165bSWeongyo Jeong UATH_DEBUG_XMIT_DUMP = 0x00000002, /* xmit dump */ 131dc60165bSWeongyo Jeong UATH_DEBUG_RECV = 0x00000004, /* basic recv operation */ 132dc60165bSWeongyo Jeong UATH_DEBUG_TX_PROC = 0x00000008, /* tx ISR proc */ 133dc60165bSWeongyo Jeong UATH_DEBUG_RX_PROC = 0x00000010, /* rx ISR proc */ 134dc60165bSWeongyo Jeong UATH_DEBUG_RECV_ALL = 0x00000020, /* trace all frames (beacons) */ 135dc60165bSWeongyo Jeong UATH_DEBUG_INIT = 0x00000040, /* initialization of dev */ 136dc60165bSWeongyo Jeong UATH_DEBUG_DEVCAP = 0x00000080, /* dev caps */ 137dc60165bSWeongyo Jeong UATH_DEBUG_CMDS = 0x00000100, /* commands */ 138dc60165bSWeongyo Jeong UATH_DEBUG_CMDS_DUMP = 0x00000200, /* command buffer dump */ 139dc60165bSWeongyo Jeong UATH_DEBUG_RESET = 0x00000400, /* reset processing */ 140dc60165bSWeongyo Jeong UATH_DEBUG_STATE = 0x00000800, /* 802.11 state transitions */ 141dc60165bSWeongyo Jeong UATH_DEBUG_MULTICAST = 0x00001000, /* multicast */ 142dc60165bSWeongyo Jeong UATH_DEBUG_WME = 0x00002000, /* WME */ 143dc60165bSWeongyo Jeong UATH_DEBUG_CHANNEL = 0x00004000, /* channel */ 144dc60165bSWeongyo Jeong UATH_DEBUG_RATES = 0x00008000, /* rates */ 145dc60165bSWeongyo Jeong UATH_DEBUG_CRYPTO = 0x00010000, /* crypto */ 146dc60165bSWeongyo Jeong UATH_DEBUG_LED = 0x00020000, /* LED */ 147dc60165bSWeongyo Jeong UATH_DEBUG_ANY = 0xffffffff 148dc60165bSWeongyo Jeong }; 149dc60165bSWeongyo Jeong #define DPRINTF(sc, m, fmt, ...) do { \ 150dc60165bSWeongyo Jeong if (sc->sc_debug & (m)) \ 151dc60165bSWeongyo Jeong printf(fmt, __VA_ARGS__); \ 152dc60165bSWeongyo Jeong } while (0) 153dc60165bSWeongyo Jeong #else 154dc60165bSWeongyo Jeong #define DPRINTF(sc, m, fmt, ...) do { \ 155dc60165bSWeongyo Jeong (void) sc; \ 156dc60165bSWeongyo Jeong } while (0) 157dc60165bSWeongyo Jeong #endif 158dc60165bSWeongyo Jeong 159dc60165bSWeongyo Jeong /* unaligned little endian access */ 160dc60165bSWeongyo Jeong #define LE_READ_2(p) \ 161dc60165bSWeongyo Jeong ((u_int16_t) \ 162dc60165bSWeongyo Jeong ((((u_int8_t *)(p))[0] ) | (((u_int8_t *)(p))[1] << 8))) 163dc60165bSWeongyo Jeong #define LE_READ_4(p) \ 164dc60165bSWeongyo Jeong ((u_int32_t) \ 165dc60165bSWeongyo Jeong ((((u_int8_t *)(p))[0] ) | (((u_int8_t *)(p))[1] << 8) | \ 166dc60165bSWeongyo Jeong (((u_int8_t *)(p))[2] << 16) | (((u_int8_t *)(p))[3] << 24))) 167dc60165bSWeongyo Jeong 168dc60165bSWeongyo Jeong /* recognized device vendors/products */ 169f1a16106SHans Petter Selasky static const STRUCT_USB_HOST_ID uath_devs[] = { 170dc60165bSWeongyo Jeong #define UATH_DEV(v,p) { USB_VP(USB_VENDOR_##v, USB_PRODUCT_##v##_##p) } 171e257fff4SWeongyo Jeong UATH_DEV(ACCTON, SMCWUSBTG2), 172dc60165bSWeongyo Jeong UATH_DEV(ATHEROS, AR5523), 173dc60165bSWeongyo Jeong UATH_DEV(ATHEROS2, AR5523_1), 174dc60165bSWeongyo Jeong UATH_DEV(ATHEROS2, AR5523_2), 175dc60165bSWeongyo Jeong UATH_DEV(ATHEROS2, AR5523_3), 176dc60165bSWeongyo Jeong UATH_DEV(CONCEPTRONIC, AR5523_1), 177dc60165bSWeongyo Jeong UATH_DEV(CONCEPTRONIC, AR5523_2), 178dc60165bSWeongyo Jeong UATH_DEV(DLINK, DWLAG122), 179dc60165bSWeongyo Jeong UATH_DEV(DLINK, DWLAG132), 180dc60165bSWeongyo Jeong UATH_DEV(DLINK, DWLG132), 18162dcd865SWeongyo Jeong UATH_DEV(DLINK2, DWA120), 182dc60165bSWeongyo Jeong UATH_DEV(GIGASET, AR5523), 183dc60165bSWeongyo Jeong UATH_DEV(GIGASET, SMCWUSBTG), 184dc60165bSWeongyo Jeong UATH_DEV(GLOBALSUN, AR5523_1), 185dc60165bSWeongyo Jeong UATH_DEV(GLOBALSUN, AR5523_2), 186dc60165bSWeongyo Jeong UATH_DEV(NETGEAR, WG111U), 187dc60165bSWeongyo Jeong UATH_DEV(NETGEAR3, WG111T), 188dc60165bSWeongyo Jeong UATH_DEV(NETGEAR3, WPN111), 189dae1952fSAndrew Thompson UATH_DEV(NETGEAR3, WPN111_2), 190dc60165bSWeongyo Jeong UATH_DEV(UMEDIA, TEW444UBEU), 191dc60165bSWeongyo Jeong UATH_DEV(UMEDIA, AR5523_2), 192dc60165bSWeongyo Jeong UATH_DEV(WISTRONNEWEB, AR5523_1), 193dc60165bSWeongyo Jeong UATH_DEV(WISTRONNEWEB, AR5523_2), 194dc60165bSWeongyo Jeong UATH_DEV(ZCOM, AR5523) 195dc60165bSWeongyo Jeong #undef UATH_DEV 196dc60165bSWeongyo Jeong }; 197dc60165bSWeongyo Jeong 198e0a69b51SAndrew Thompson static usb_callback_t uath_intr_rx_callback; 199e0a69b51SAndrew Thompson static usb_callback_t uath_intr_tx_callback; 200e0a69b51SAndrew Thompson static usb_callback_t uath_bulk_rx_callback; 201e0a69b51SAndrew Thompson static usb_callback_t uath_bulk_tx_callback; 202dc60165bSWeongyo Jeong 203760bc48eSAndrew Thompson static const struct usb_config uath_usbconfig[UATH_N_XFERS] = { 204dc60165bSWeongyo Jeong [UATH_INTR_RX] = { 205dc60165bSWeongyo Jeong .type = UE_BULK, 206dc60165bSWeongyo Jeong .endpoint = 0x1, 207dc60165bSWeongyo Jeong .direction = UE_DIR_IN, 2085cbbd666SAndrew Thompson .bufsize = UATH_MAX_CMDSZ, 2095cbbd666SAndrew Thompson .flags = { 210dc60165bSWeongyo Jeong .pipe_bof = 1, 211dc60165bSWeongyo Jeong .short_xfer_ok = 1 212dc60165bSWeongyo Jeong }, 2135cbbd666SAndrew Thompson .callback = uath_intr_rx_callback 214dc60165bSWeongyo Jeong }, 215dc60165bSWeongyo Jeong [UATH_INTR_TX] = { 216dc60165bSWeongyo Jeong .type = UE_BULK, 217dc60165bSWeongyo Jeong .endpoint = 0x1, 218dc60165bSWeongyo Jeong .direction = UE_DIR_OUT, 219c180b398SHans Petter Selasky .bufsize = UATH_MAX_CMDSZ * UATH_CMD_LIST_COUNT, 2205cbbd666SAndrew Thompson .flags = { 221dc60165bSWeongyo Jeong .force_short_xfer = 1, 222dc60165bSWeongyo Jeong .pipe_bof = 1, 223dc60165bSWeongyo Jeong }, 2245cbbd666SAndrew Thompson .callback = uath_intr_tx_callback, 2255cbbd666SAndrew Thompson .timeout = UATH_CMD_TIMEOUT 226dc60165bSWeongyo Jeong }, 227dc60165bSWeongyo Jeong [UATH_BULK_RX] = { 228dc60165bSWeongyo Jeong .type = UE_BULK, 229dc60165bSWeongyo Jeong .endpoint = 0x2, 230dc60165bSWeongyo Jeong .direction = UE_DIR_IN, 2315cbbd666SAndrew Thompson .bufsize = MCLBYTES, 2325cbbd666SAndrew Thompson .flags = { 233dc60165bSWeongyo Jeong .ext_buffer = 1, 234dc60165bSWeongyo Jeong .pipe_bof = 1, 235dc60165bSWeongyo Jeong .short_xfer_ok = 1 236dc60165bSWeongyo Jeong }, 2375cbbd666SAndrew Thompson .callback = uath_bulk_rx_callback 238dc60165bSWeongyo Jeong }, 239dc60165bSWeongyo Jeong [UATH_BULK_TX] = { 240dc60165bSWeongyo Jeong .type = UE_BULK, 241dc60165bSWeongyo Jeong .endpoint = 0x2, 242dc60165bSWeongyo Jeong .direction = UE_DIR_OUT, 243c180b398SHans Petter Selasky .bufsize = UATH_MAX_TXBUFSZ * UATH_TX_DATA_LIST_COUNT, 2445cbbd666SAndrew Thompson .flags = { 245dc60165bSWeongyo Jeong .force_short_xfer = 1, 246dc60165bSWeongyo Jeong .pipe_bof = 1 247dc60165bSWeongyo Jeong }, 2485cbbd666SAndrew Thompson .callback = uath_bulk_tx_callback, 2495cbbd666SAndrew Thompson .timeout = UATH_DATA_TIMEOUT 250dc60165bSWeongyo Jeong } 251dc60165bSWeongyo Jeong }; 252dc60165bSWeongyo Jeong 253dc60165bSWeongyo Jeong static struct ieee80211vap *uath_vap_create(struct ieee80211com *, 254fcd9500fSBernhard Schmidt const char [IFNAMSIZ], int, enum ieee80211_opmode, int, 255fcd9500fSBernhard Schmidt const uint8_t [IEEE80211_ADDR_LEN], 256fcd9500fSBernhard Schmidt const uint8_t [IEEE80211_ADDR_LEN]); 257dc60165bSWeongyo Jeong static void uath_vap_delete(struct ieee80211vap *); 258c180b398SHans Petter Selasky static int uath_alloc_cmd_list(struct uath_softc *, struct uath_cmd []); 259c180b398SHans Petter Selasky static void uath_free_cmd_list(struct uath_softc *, struct uath_cmd []); 260dc60165bSWeongyo Jeong static int uath_host_available(struct uath_softc *); 261dc60165bSWeongyo Jeong static int uath_get_capability(struct uath_softc *, uint32_t, uint32_t *); 262dc60165bSWeongyo Jeong static int uath_get_devcap(struct uath_softc *); 263dc60165bSWeongyo Jeong static struct uath_cmd * 264dc60165bSWeongyo Jeong uath_get_cmdbuf(struct uath_softc *); 265dc60165bSWeongyo Jeong static int uath_cmd_read(struct uath_softc *, uint32_t, const void *, 266dc60165bSWeongyo Jeong int, void *, int, int); 267dc60165bSWeongyo Jeong static int uath_cmd_write(struct uath_softc *, uint32_t, const void *, 268dc60165bSWeongyo Jeong int, int); 269dc60165bSWeongyo Jeong static void uath_stat(void *); 270dc60165bSWeongyo Jeong #ifdef UATH_DEBUG 271dc60165bSWeongyo Jeong static void uath_dump_cmd(const uint8_t *, int, char); 272dc60165bSWeongyo Jeong static const char * 273dc60165bSWeongyo Jeong uath_codename(int); 274dc60165bSWeongyo Jeong #endif 275dc60165bSWeongyo Jeong static int uath_get_devstatus(struct uath_softc *, 276dc60165bSWeongyo Jeong uint8_t macaddr[IEEE80211_ADDR_LEN]); 277dc60165bSWeongyo Jeong static int uath_get_status(struct uath_softc *, uint32_t, void *, int); 278dc60165bSWeongyo Jeong static int uath_alloc_rx_data_list(struct uath_softc *); 279dc60165bSWeongyo Jeong static int uath_alloc_tx_data_list(struct uath_softc *); 280dc60165bSWeongyo Jeong static void uath_free_rx_data_list(struct uath_softc *); 281dc60165bSWeongyo Jeong static void uath_free_tx_data_list(struct uath_softc *); 282*7a79cebfSGleb Smirnoff static int uath_init(struct uath_softc *); 283*7a79cebfSGleb Smirnoff static void uath_stop(struct uath_softc *); 284*7a79cebfSGleb Smirnoff static void uath_parent(struct ieee80211com *); 285*7a79cebfSGleb Smirnoff static int uath_transmit(struct ieee80211com *, struct mbuf *); 286*7a79cebfSGleb Smirnoff static void uath_start(struct uath_softc *); 287dc60165bSWeongyo Jeong static int uath_raw_xmit(struct ieee80211_node *, struct mbuf *, 288dc60165bSWeongyo Jeong const struct ieee80211_bpf_params *); 289dc60165bSWeongyo Jeong static void uath_scan_start(struct ieee80211com *); 290dc60165bSWeongyo Jeong static void uath_scan_end(struct ieee80211com *); 291dc60165bSWeongyo Jeong static void uath_set_channel(struct ieee80211com *); 292272f6adeSGleb Smirnoff static void uath_update_mcast(struct ieee80211com *); 293272f6adeSGleb Smirnoff static void uath_update_promisc(struct ieee80211com *); 294dc60165bSWeongyo Jeong static int uath_config(struct uath_softc *, uint32_t, uint32_t); 295dc60165bSWeongyo Jeong static int uath_config_multi(struct uath_softc *, uint32_t, const void *, 296dc60165bSWeongyo Jeong int); 297dc60165bSWeongyo Jeong static int uath_switch_channel(struct uath_softc *, 298dc60165bSWeongyo Jeong struct ieee80211_channel *); 299dc60165bSWeongyo Jeong static int uath_set_rxfilter(struct uath_softc *, uint32_t, uint32_t); 300dc60165bSWeongyo Jeong static void uath_watchdog(void *); 301dc60165bSWeongyo Jeong static void uath_abort_xfers(struct uath_softc *); 302dc60165bSWeongyo Jeong static int uath_dataflush(struct uath_softc *); 303dc60165bSWeongyo Jeong static int uath_cmdflush(struct uath_softc *); 304dc60165bSWeongyo Jeong static int uath_flush(struct uath_softc *); 305dc60165bSWeongyo Jeong static int uath_set_ledstate(struct uath_softc *, int); 306dc60165bSWeongyo Jeong static int uath_set_chan(struct uath_softc *, struct ieee80211_channel *); 307dc60165bSWeongyo Jeong static int uath_reset_tx_queues(struct uath_softc *); 308dc60165bSWeongyo Jeong static int uath_wme_init(struct uath_softc *); 309dc60165bSWeongyo Jeong static struct uath_data * 310dc60165bSWeongyo Jeong uath_getbuf(struct uath_softc *); 311dc60165bSWeongyo Jeong static int uath_newstate(struct ieee80211vap *, enum ieee80211_state, 312dc60165bSWeongyo Jeong int); 313dc60165bSWeongyo Jeong static int uath_set_key(struct uath_softc *, 314dc60165bSWeongyo Jeong const struct ieee80211_key *, int); 315dc60165bSWeongyo Jeong static int uath_set_keys(struct uath_softc *, struct ieee80211vap *); 316dc60165bSWeongyo Jeong static void uath_sysctl_node(struct uath_softc *); 317dc60165bSWeongyo Jeong 318dc60165bSWeongyo Jeong static int 319dc60165bSWeongyo Jeong uath_match(device_t dev) 320dc60165bSWeongyo Jeong { 321760bc48eSAndrew Thompson struct usb_attach_arg *uaa = device_get_ivars(dev); 322dc60165bSWeongyo Jeong 323f29a0724SAndrew Thompson if (uaa->usb_mode != USB_MODE_HOST) 324dc60165bSWeongyo Jeong return (ENXIO); 325dc60165bSWeongyo Jeong if (uaa->info.bConfigIndex != UATH_CONFIG_INDEX) 326dc60165bSWeongyo Jeong return (ENXIO); 327dc60165bSWeongyo Jeong if (uaa->info.bIfaceIndex != UATH_IFACE_INDEX) 328dc60165bSWeongyo Jeong return (ENXIO); 329dc60165bSWeongyo Jeong 330a593f6b8SAndrew Thompson return (usbd_lookup_id_by_uaa(uath_devs, sizeof(uath_devs), uaa)); 331dc60165bSWeongyo Jeong } 332dc60165bSWeongyo Jeong 333dc60165bSWeongyo Jeong static int 334dc60165bSWeongyo Jeong uath_attach(device_t dev) 335dc60165bSWeongyo Jeong { 336dc60165bSWeongyo Jeong struct uath_softc *sc = device_get_softc(dev); 337760bc48eSAndrew Thompson struct usb_attach_arg *uaa = device_get_ivars(dev); 338*7a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 339dc60165bSWeongyo Jeong uint8_t bands, iface_index = UATH_IFACE_INDEX; /* XXX */ 340e0a69b51SAndrew Thompson usb_error_t error; 341dc60165bSWeongyo Jeong 342dc60165bSWeongyo Jeong sc->sc_dev = dev; 343dc60165bSWeongyo Jeong sc->sc_udev = uaa->device; 344dc60165bSWeongyo Jeong #ifdef UATH_DEBUG 345dc60165bSWeongyo Jeong sc->sc_debug = uath_debug; 346dc60165bSWeongyo Jeong #endif 347a593f6b8SAndrew Thompson device_set_usb_desc(dev); 348dc60165bSWeongyo Jeong 349dc60165bSWeongyo Jeong /* 350dc60165bSWeongyo Jeong * Only post-firmware devices here. 351dc60165bSWeongyo Jeong */ 352dc60165bSWeongyo Jeong mtx_init(&sc->sc_mtx, device_get_nameunit(sc->sc_dev), MTX_NETWORK_LOCK, 353dc60165bSWeongyo Jeong MTX_DEF); 354dc60165bSWeongyo Jeong callout_init(&sc->stat_ch, 0); 355dc60165bSWeongyo Jeong callout_init_mtx(&sc->watchdog_ch, &sc->sc_mtx, 0); 356*7a79cebfSGleb Smirnoff mbufq_init(&sc->sc_snd, ifqmaxlen); 357dc60165bSWeongyo Jeong 358a593f6b8SAndrew Thompson error = usbd_transfer_setup(uaa->device, &iface_index, sc->sc_xfer, 359dc60165bSWeongyo Jeong uath_usbconfig, UATH_N_XFERS, sc, &sc->sc_mtx); 360dc60165bSWeongyo Jeong if (error) { 361dc60165bSWeongyo Jeong device_printf(dev, "could not allocate USB transfers, " 362a593f6b8SAndrew Thompson "err=%s\n", usbd_errstr(error)); 3632d8a425bSHans Petter Selasky goto fail; 364dc60165bSWeongyo Jeong } 365dc60165bSWeongyo Jeong 366c180b398SHans Petter Selasky sc->sc_cmd_dma_buf = 367c180b398SHans Petter Selasky usbd_xfer_get_frame_buffer(sc->sc_xfer[UATH_INTR_TX], 0); 368c180b398SHans Petter Selasky sc->sc_tx_dma_buf = 369c180b398SHans Petter Selasky usbd_xfer_get_frame_buffer(sc->sc_xfer[UATH_BULK_TX], 0); 370c180b398SHans Petter Selasky 371dc60165bSWeongyo Jeong /* 3722d8a425bSHans Petter Selasky * Setup buffers for firmware commands. 3732d8a425bSHans Petter Selasky */ 3742d8a425bSHans Petter Selasky error = uath_alloc_cmd_list(sc, sc->sc_cmd); 3752d8a425bSHans Petter Selasky if (error != 0) { 3762d8a425bSHans Petter Selasky device_printf(sc->sc_dev, 3772d8a425bSHans Petter Selasky "could not allocate Tx command list\n"); 3782d8a425bSHans Petter Selasky goto fail1; 3792d8a425bSHans Petter Selasky } 3802d8a425bSHans Petter Selasky 3812d8a425bSHans Petter Selasky /* 382dc60165bSWeongyo Jeong * We're now ready to send+receive firmware commands. 383dc60165bSWeongyo Jeong */ 384dc60165bSWeongyo Jeong UATH_LOCK(sc); 385dc60165bSWeongyo Jeong error = uath_host_available(sc); 386dc60165bSWeongyo Jeong if (error != 0) { 387dc60165bSWeongyo Jeong device_printf(sc->sc_dev, "could not initialize adapter\n"); 388*7a79cebfSGleb Smirnoff goto fail2; 389dc60165bSWeongyo Jeong } 390dc60165bSWeongyo Jeong error = uath_get_devcap(sc); 391dc60165bSWeongyo Jeong if (error != 0) { 392dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 393dc60165bSWeongyo Jeong "could not get device capabilities\n"); 394*7a79cebfSGleb Smirnoff goto fail2; 395dc60165bSWeongyo Jeong } 396dc60165bSWeongyo Jeong UATH_UNLOCK(sc); 397dc60165bSWeongyo Jeong 398dc60165bSWeongyo Jeong /* Create device sysctl node. */ 399dc60165bSWeongyo Jeong uath_sysctl_node(sc); 400dc60165bSWeongyo Jeong 401dc60165bSWeongyo Jeong UATH_LOCK(sc); 402*7a79cebfSGleb Smirnoff error = uath_get_devstatus(sc, ic->ic_macaddr); 403dc60165bSWeongyo Jeong if (error != 0) { 404dc60165bSWeongyo Jeong device_printf(sc->sc_dev, "could not get device status\n"); 405*7a79cebfSGleb Smirnoff goto fail2; 406dc60165bSWeongyo Jeong } 407dc60165bSWeongyo Jeong 408dc60165bSWeongyo Jeong /* 409dc60165bSWeongyo Jeong * Allocate xfers for Rx/Tx data pipes. 410dc60165bSWeongyo Jeong */ 411dc60165bSWeongyo Jeong error = uath_alloc_rx_data_list(sc); 412dc60165bSWeongyo Jeong if (error != 0) { 413dc60165bSWeongyo Jeong device_printf(sc->sc_dev, "could not allocate Rx data list\n"); 414*7a79cebfSGleb Smirnoff goto fail2; 415dc60165bSWeongyo Jeong } 416dc60165bSWeongyo Jeong error = uath_alloc_tx_data_list(sc); 417dc60165bSWeongyo Jeong if (error != 0) { 418dc60165bSWeongyo Jeong device_printf(sc->sc_dev, "could not allocate Tx data list\n"); 419*7a79cebfSGleb Smirnoff goto fail2; 420dc60165bSWeongyo Jeong } 421dc60165bSWeongyo Jeong UATH_UNLOCK(sc); 422dc60165bSWeongyo Jeong 42359686fe9SGleb Smirnoff ic->ic_softc = sc; 424c8550c02SGleb Smirnoff ic->ic_name = device_get_nameunit(dev); 425dc60165bSWeongyo Jeong ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ 426dc60165bSWeongyo Jeong ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */ 427dc60165bSWeongyo Jeong 428dc60165bSWeongyo Jeong /* set device capabilities */ 429dc60165bSWeongyo Jeong ic->ic_caps = 430dc60165bSWeongyo Jeong IEEE80211_C_STA | /* station mode */ 431dc60165bSWeongyo Jeong IEEE80211_C_MONITOR | /* monitor mode supported */ 432dc60165bSWeongyo Jeong IEEE80211_C_TXPMGT | /* tx power management */ 433dc60165bSWeongyo Jeong IEEE80211_C_SHPREAMBLE | /* short preamble supported */ 434dc60165bSWeongyo Jeong IEEE80211_C_SHSLOT | /* short slot time supported */ 435dc60165bSWeongyo Jeong IEEE80211_C_WPA | /* 802.11i */ 436dc60165bSWeongyo Jeong IEEE80211_C_BGSCAN | /* capable of bg scanning */ 437dc60165bSWeongyo Jeong IEEE80211_C_TXFRAG; /* handle tx frags */ 438dc60165bSWeongyo Jeong 439dc60165bSWeongyo Jeong /* put a regulatory domain to reveal informations. */ 440dc60165bSWeongyo Jeong uath_regdomain = sc->sc_devcap.regDomain; 441dc60165bSWeongyo Jeong 442dc60165bSWeongyo Jeong bands = 0; 443dc60165bSWeongyo Jeong setbit(&bands, IEEE80211_MODE_11B); 444dc60165bSWeongyo Jeong setbit(&bands, IEEE80211_MODE_11G); 445dc60165bSWeongyo Jeong if ((sc->sc_devcap.analog5GhzRevision & 0xf0) == 0x30) 446dc60165bSWeongyo Jeong setbit(&bands, IEEE80211_MODE_11A); 447dc60165bSWeongyo Jeong /* XXX turbo */ 448dc60165bSWeongyo Jeong ieee80211_init_channels(ic, NULL, &bands); 449dc60165bSWeongyo Jeong 450*7a79cebfSGleb Smirnoff ieee80211_ifattach(ic); 451dc60165bSWeongyo Jeong ic->ic_raw_xmit = uath_raw_xmit; 452dc60165bSWeongyo Jeong ic->ic_scan_start = uath_scan_start; 453dc60165bSWeongyo Jeong ic->ic_scan_end = uath_scan_end; 454dc60165bSWeongyo Jeong ic->ic_set_channel = uath_set_channel; 455dc60165bSWeongyo Jeong ic->ic_vap_create = uath_vap_create; 456dc60165bSWeongyo Jeong ic->ic_vap_delete = uath_vap_delete; 457dc60165bSWeongyo Jeong ic->ic_update_mcast = uath_update_mcast; 458dc60165bSWeongyo Jeong ic->ic_update_promisc = uath_update_promisc; 459*7a79cebfSGleb Smirnoff ic->ic_transmit = uath_transmit; 460*7a79cebfSGleb Smirnoff ic->ic_parent = uath_parent; 461dc60165bSWeongyo Jeong 4625463c4a4SSam Leffler ieee80211_radiotap_attach(ic, 4635463c4a4SSam Leffler &sc->sc_txtap.wt_ihdr, sizeof(sc->sc_txtap), 4645463c4a4SSam Leffler UATH_TX_RADIOTAP_PRESENT, 4655463c4a4SSam Leffler &sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap), 4665463c4a4SSam Leffler UATH_RX_RADIOTAP_PRESENT); 467dc60165bSWeongyo Jeong 468dc60165bSWeongyo Jeong if (bootverbose) 469dc60165bSWeongyo Jeong ieee80211_announce(ic); 470dc60165bSWeongyo Jeong 471dc60165bSWeongyo Jeong return (0); 472dc60165bSWeongyo Jeong 473*7a79cebfSGleb Smirnoff fail2: UATH_UNLOCK(sc); 474*7a79cebfSGleb Smirnoff uath_free_cmd_list(sc, sc->sc_cmd); 4752d8a425bSHans Petter Selasky fail1: usbd_transfer_unsetup(sc->sc_xfer, UATH_N_XFERS); 476dc60165bSWeongyo Jeong fail: 477dc60165bSWeongyo Jeong return (error); 478dc60165bSWeongyo Jeong } 479dc60165bSWeongyo Jeong 480dc60165bSWeongyo Jeong static int 481dc60165bSWeongyo Jeong uath_detach(device_t dev) 482dc60165bSWeongyo Jeong { 483dc60165bSWeongyo Jeong struct uath_softc *sc = device_get_softc(dev); 484*7a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 485645e4d17SHans Petter Selasky unsigned int x; 486dc60165bSWeongyo Jeong 487645e4d17SHans Petter Selasky /* 488645e4d17SHans Petter Selasky * Prevent further allocations from RX/TX/CMD 489645e4d17SHans Petter Selasky * data lists and ioctls 490645e4d17SHans Petter Selasky */ 491c39515adSWeongyo Jeong UATH_LOCK(sc); 492dc60165bSWeongyo Jeong sc->sc_flags |= UATH_FLAG_INVALID; 493645e4d17SHans Petter Selasky 494645e4d17SHans Petter Selasky STAILQ_INIT(&sc->sc_rx_active); 495645e4d17SHans Petter Selasky STAILQ_INIT(&sc->sc_rx_inactive); 496645e4d17SHans Petter Selasky 497645e4d17SHans Petter Selasky STAILQ_INIT(&sc->sc_tx_active); 498645e4d17SHans Petter Selasky STAILQ_INIT(&sc->sc_tx_inactive); 499645e4d17SHans Petter Selasky STAILQ_INIT(&sc->sc_tx_pending); 500645e4d17SHans Petter Selasky 501645e4d17SHans Petter Selasky STAILQ_INIT(&sc->sc_cmd_active); 502645e4d17SHans Petter Selasky STAILQ_INIT(&sc->sc_cmd_pending); 503645e4d17SHans Petter Selasky STAILQ_INIT(&sc->sc_cmd_waiting); 504645e4d17SHans Petter Selasky STAILQ_INIT(&sc->sc_cmd_inactive); 505dc60165bSWeongyo Jeong 506*7a79cebfSGleb Smirnoff uath_stop(sc); 507*7a79cebfSGleb Smirnoff UATH_UNLOCK(sc); 508ba2c1fbcSAdrian Chadd 509dc60165bSWeongyo Jeong callout_drain(&sc->stat_ch); 510dc60165bSWeongyo Jeong callout_drain(&sc->watchdog_ch); 511dc60165bSWeongyo Jeong 512645e4d17SHans Petter Selasky /* drain USB transfers */ 513645e4d17SHans Petter Selasky for (x = 0; x != UATH_N_XFERS; x++) 514645e4d17SHans Petter Selasky usbd_transfer_drain(sc->sc_xfer[x]); 515dc60165bSWeongyo Jeong 516645e4d17SHans Petter Selasky /* free data buffers */ 517dc60165bSWeongyo Jeong UATH_LOCK(sc); 518dc60165bSWeongyo Jeong uath_free_rx_data_list(sc); 519dc60165bSWeongyo Jeong uath_free_tx_data_list(sc); 520c180b398SHans Petter Selasky uath_free_cmd_list(sc, sc->sc_cmd); 521dc60165bSWeongyo Jeong UATH_UNLOCK(sc); 522dc60165bSWeongyo Jeong 523645e4d17SHans Petter Selasky /* free USB transfers and some data buffers */ 524645e4d17SHans Petter Selasky usbd_transfer_unsetup(sc->sc_xfer, UATH_N_XFERS); 525645e4d17SHans Petter Selasky 526645e4d17SHans Petter Selasky ieee80211_ifdetach(ic); 527*7a79cebfSGleb Smirnoff mbufq_drain(&sc->sc_snd); 528dc60165bSWeongyo Jeong mtx_destroy(&sc->sc_mtx); 529dc60165bSWeongyo Jeong return (0); 530dc60165bSWeongyo Jeong } 531dc60165bSWeongyo Jeong 532dc60165bSWeongyo Jeong static void 533c180b398SHans Petter Selasky uath_free_cmd_list(struct uath_softc *sc, struct uath_cmd cmds[]) 534dc60165bSWeongyo Jeong { 535dc60165bSWeongyo Jeong int i; 536dc60165bSWeongyo Jeong 537c180b398SHans Petter Selasky for (i = 0; i != UATH_CMD_LIST_COUNT; i++) 538c180b398SHans Petter Selasky cmds[i].buf = NULL; 539dc60165bSWeongyo Jeong } 540dc60165bSWeongyo Jeong 541dc60165bSWeongyo Jeong static int 542c180b398SHans Petter Selasky uath_alloc_cmd_list(struct uath_softc *sc, struct uath_cmd cmds[]) 543dc60165bSWeongyo Jeong { 544c180b398SHans Petter Selasky int i; 545dc60165bSWeongyo Jeong 546dc60165bSWeongyo Jeong STAILQ_INIT(&sc->sc_cmd_active); 547dc60165bSWeongyo Jeong STAILQ_INIT(&sc->sc_cmd_pending); 548dc60165bSWeongyo Jeong STAILQ_INIT(&sc->sc_cmd_waiting); 549dc60165bSWeongyo Jeong STAILQ_INIT(&sc->sc_cmd_inactive); 550dc60165bSWeongyo Jeong 551c180b398SHans Petter Selasky for (i = 0; i != UATH_CMD_LIST_COUNT; i++) { 552dc60165bSWeongyo Jeong struct uath_cmd *cmd = &cmds[i]; 553dc60165bSWeongyo Jeong 554dc60165bSWeongyo Jeong cmd->sc = sc; /* backpointer for callbacks */ 555dc60165bSWeongyo Jeong cmd->msgid = i; 556c180b398SHans Petter Selasky cmd->buf = ((uint8_t *)sc->sc_cmd_dma_buf) + 557c180b398SHans Petter Selasky (i * UATH_MAX_CMDSZ); 558dc60165bSWeongyo Jeong STAILQ_INSERT_TAIL(&sc->sc_cmd_inactive, cmd, next); 559dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_cmd_inactive); 560dc60165bSWeongyo Jeong } 561dc60165bSWeongyo Jeong return (0); 562dc60165bSWeongyo Jeong } 563dc60165bSWeongyo Jeong 564dc60165bSWeongyo Jeong static int 565dc60165bSWeongyo Jeong uath_host_available(struct uath_softc *sc) 566dc60165bSWeongyo Jeong { 567dc60165bSWeongyo Jeong struct uath_cmd_host_available setup; 568dc60165bSWeongyo Jeong 569dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 570dc60165bSWeongyo Jeong 571dc60165bSWeongyo Jeong /* inform target the host is available */ 572dc60165bSWeongyo Jeong setup.sw_ver_major = htobe32(ATH_SW_VER_MAJOR); 573dc60165bSWeongyo Jeong setup.sw_ver_minor = htobe32(ATH_SW_VER_MINOR); 574dc60165bSWeongyo Jeong setup.sw_ver_patch = htobe32(ATH_SW_VER_PATCH); 575dc60165bSWeongyo Jeong setup.sw_ver_build = htobe32(ATH_SW_VER_BUILD); 576dc60165bSWeongyo Jeong return uath_cmd_read(sc, WDCMSG_HOST_AVAILABLE, 577dc60165bSWeongyo Jeong &setup, sizeof setup, NULL, 0, 0); 578dc60165bSWeongyo Jeong } 579dc60165bSWeongyo Jeong 580dc60165bSWeongyo Jeong #ifdef UATH_DEBUG 581dc60165bSWeongyo Jeong static void 582dc60165bSWeongyo Jeong uath_dump_cmd(const uint8_t *buf, int len, char prefix) 583dc60165bSWeongyo Jeong { 584dc60165bSWeongyo Jeong const char *sep = ""; 585dc60165bSWeongyo Jeong int i; 586dc60165bSWeongyo Jeong 587dc60165bSWeongyo Jeong for (i = 0; i < len; i++) { 588dc60165bSWeongyo Jeong if ((i % 16) == 0) { 589dc60165bSWeongyo Jeong printf("%s%c ", sep, prefix); 590dc60165bSWeongyo Jeong sep = "\n"; 591dc60165bSWeongyo Jeong } 592dc60165bSWeongyo Jeong else if ((i % 4) == 0) 593dc60165bSWeongyo Jeong printf(" "); 594dc60165bSWeongyo Jeong printf("%02x", buf[i]); 595dc60165bSWeongyo Jeong } 596dc60165bSWeongyo Jeong printf("\n"); 597dc60165bSWeongyo Jeong } 598dc60165bSWeongyo Jeong 599dc60165bSWeongyo Jeong static const char * 600dc60165bSWeongyo Jeong uath_codename(int code) 601dc60165bSWeongyo Jeong { 602dc60165bSWeongyo Jeong #define N(a) (sizeof(a)/sizeof(a[0])) 603dc60165bSWeongyo Jeong static const char *names[] = { 604dc60165bSWeongyo Jeong "0x00", 605dc60165bSWeongyo Jeong "HOST_AVAILABLE", 606dc60165bSWeongyo Jeong "BIND", 607dc60165bSWeongyo Jeong "TARGET_RESET", 608dc60165bSWeongyo Jeong "TARGET_GET_CAPABILITY", 609dc60165bSWeongyo Jeong "TARGET_SET_CONFIG", 610dc60165bSWeongyo Jeong "TARGET_GET_STATUS", 611dc60165bSWeongyo Jeong "TARGET_GET_STATS", 612dc60165bSWeongyo Jeong "TARGET_START", 613dc60165bSWeongyo Jeong "TARGET_STOP", 614dc60165bSWeongyo Jeong "TARGET_ENABLE", 615dc60165bSWeongyo Jeong "TARGET_DISABLE", 616dc60165bSWeongyo Jeong "CREATE_CONNECTION", 617dc60165bSWeongyo Jeong "UPDATE_CONNECT_ATTR", 618dc60165bSWeongyo Jeong "DELETE_CONNECT", 619dc60165bSWeongyo Jeong "SEND", 620dc60165bSWeongyo Jeong "FLUSH", 621dc60165bSWeongyo Jeong "STATS_UPDATE", 622dc60165bSWeongyo Jeong "BMISS", 623dc60165bSWeongyo Jeong "DEVICE_AVAIL", 624dc60165bSWeongyo Jeong "SEND_COMPLETE", 625dc60165bSWeongyo Jeong "DATA_AVAIL", 626dc60165bSWeongyo Jeong "SET_PWR_MODE", 627dc60165bSWeongyo Jeong "BMISS_ACK", 628dc60165bSWeongyo Jeong "SET_LED_STEADY", 629dc60165bSWeongyo Jeong "SET_LED_BLINK", 630dc60165bSWeongyo Jeong "SETUP_BEACON_DESC", 631dc60165bSWeongyo Jeong "BEACON_INIT", 632dc60165bSWeongyo Jeong "RESET_KEY_CACHE", 633dc60165bSWeongyo Jeong "RESET_KEY_CACHE_ENTRY", 634dc60165bSWeongyo Jeong "SET_KEY_CACHE_ENTRY", 635dc60165bSWeongyo Jeong "SET_DECOMP_MASK", 636dc60165bSWeongyo Jeong "SET_REGULATORY_DOMAIN", 637dc60165bSWeongyo Jeong "SET_LED_STATE", 638dc60165bSWeongyo Jeong "WRITE_ASSOCID", 639dc60165bSWeongyo Jeong "SET_STA_BEACON_TIMERS", 640dc60165bSWeongyo Jeong "GET_TSF", 641dc60165bSWeongyo Jeong "RESET_TSF", 642dc60165bSWeongyo Jeong "SET_ADHOC_MODE", 643dc60165bSWeongyo Jeong "SET_BASIC_RATE", 644dc60165bSWeongyo Jeong "MIB_CONTROL", 645dc60165bSWeongyo Jeong "GET_CHANNEL_DATA", 646dc60165bSWeongyo Jeong "GET_CUR_RSSI", 647dc60165bSWeongyo Jeong "SET_ANTENNA_SWITCH", 648dc60165bSWeongyo Jeong "0x2c", "0x2d", "0x2e", 649dc60165bSWeongyo Jeong "USE_SHORT_SLOT_TIME", 650dc60165bSWeongyo Jeong "SET_POWER_MODE", 651dc60165bSWeongyo Jeong "SETUP_PSPOLL_DESC", 652dc60165bSWeongyo Jeong "SET_RX_MULTICAST_FILTER", 653dc60165bSWeongyo Jeong "RX_FILTER", 654dc60165bSWeongyo Jeong "PER_CALIBRATION", 655dc60165bSWeongyo Jeong "RESET", 656dc60165bSWeongyo Jeong "DISABLE", 657dc60165bSWeongyo Jeong "PHY_DISABLE", 658dc60165bSWeongyo Jeong "SET_TX_POWER_LIMIT", 659dc60165bSWeongyo Jeong "SET_TX_QUEUE_PARAMS", 660dc60165bSWeongyo Jeong "SETUP_TX_QUEUE", 661dc60165bSWeongyo Jeong "RELEASE_TX_QUEUE", 662dc60165bSWeongyo Jeong }; 663dc60165bSWeongyo Jeong static char buf[8]; 664dc60165bSWeongyo Jeong 665dc60165bSWeongyo Jeong if (code < N(names)) 666dc60165bSWeongyo Jeong return names[code]; 667dc60165bSWeongyo Jeong if (code == WDCMSG_SET_DEFAULT_KEY) 668dc60165bSWeongyo Jeong return "SET_DEFAULT_KEY"; 669dc60165bSWeongyo Jeong snprintf(buf, sizeof(buf), "0x%02x", code); 670dc60165bSWeongyo Jeong return buf; 671dc60165bSWeongyo Jeong #undef N 672dc60165bSWeongyo Jeong } 673dc60165bSWeongyo Jeong #endif 674dc60165bSWeongyo Jeong 675dc60165bSWeongyo Jeong /* 676dc60165bSWeongyo Jeong * Low-level function to send read or write commands to the firmware. 677dc60165bSWeongyo Jeong */ 678dc60165bSWeongyo Jeong static int 679dc60165bSWeongyo Jeong uath_cmdsend(struct uath_softc *sc, uint32_t code, const void *idata, int ilen, 680dc60165bSWeongyo Jeong void *odata, int olen, int flags) 681dc60165bSWeongyo Jeong { 682dc60165bSWeongyo Jeong struct uath_cmd_hdr *hdr; 683dc60165bSWeongyo Jeong struct uath_cmd *cmd; 684dc60165bSWeongyo Jeong int error; 685dc60165bSWeongyo Jeong 686dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 687dc60165bSWeongyo Jeong 688dc60165bSWeongyo Jeong /* grab a xfer */ 689dc60165bSWeongyo Jeong cmd = uath_get_cmdbuf(sc); 690dc60165bSWeongyo Jeong if (cmd == NULL) { 691dc60165bSWeongyo Jeong device_printf(sc->sc_dev, "%s: empty inactive queue\n", 692dc60165bSWeongyo Jeong __func__); 693dc60165bSWeongyo Jeong return (ENOBUFS); 694dc60165bSWeongyo Jeong } 695dc60165bSWeongyo Jeong cmd->flags = flags; 696dc60165bSWeongyo Jeong /* always bulk-out a multiple of 4 bytes */ 697dc60165bSWeongyo Jeong cmd->buflen = roundup2(sizeof(struct uath_cmd_hdr) + ilen, 4); 698dc60165bSWeongyo Jeong 699dc60165bSWeongyo Jeong hdr = (struct uath_cmd_hdr *)cmd->buf; 700271ae033SHans Petter Selasky memset(hdr, 0, sizeof(struct uath_cmd_hdr)); 701dc60165bSWeongyo Jeong hdr->len = htobe32(cmd->buflen); 702dc60165bSWeongyo Jeong hdr->code = htobe32(code); 703dc60165bSWeongyo Jeong hdr->msgid = cmd->msgid; /* don't care about endianness */ 704dc60165bSWeongyo Jeong hdr->magic = htobe32((cmd->flags & UATH_CMD_FLAG_MAGIC) ? 1 << 24 : 0); 705271ae033SHans Petter Selasky memcpy((uint8_t *)(hdr + 1), idata, ilen); 706dc60165bSWeongyo Jeong 707dc60165bSWeongyo Jeong #ifdef UATH_DEBUG 708dc60165bSWeongyo Jeong if (sc->sc_debug & UATH_DEBUG_CMDS) { 709dc60165bSWeongyo Jeong printf("%s: send %s [flags 0x%x] olen %d\n", 710dc60165bSWeongyo Jeong __func__, uath_codename(code), cmd->flags, olen); 711dc60165bSWeongyo Jeong if (sc->sc_debug & UATH_DEBUG_CMDS_DUMP) 712dc60165bSWeongyo Jeong uath_dump_cmd(cmd->buf, cmd->buflen, '+'); 713dc60165bSWeongyo Jeong } 714dc60165bSWeongyo Jeong #endif 715dc60165bSWeongyo Jeong cmd->odata = odata; 716dc60165bSWeongyo Jeong KASSERT(odata == NULL || 717dc60165bSWeongyo Jeong olen < UATH_MAX_CMDSZ - sizeof(*hdr) + sizeof(uint32_t), 718dc60165bSWeongyo Jeong ("odata %p olen %u", odata, olen)); 719dc60165bSWeongyo Jeong cmd->olen = olen; 720dc60165bSWeongyo Jeong 721dc60165bSWeongyo Jeong STAILQ_INSERT_TAIL(&sc->sc_cmd_pending, cmd, next); 722dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_cmd_pending); 723a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[UATH_INTR_TX]); 724dc60165bSWeongyo Jeong 725dc60165bSWeongyo Jeong if (cmd->flags & UATH_CMD_FLAG_READ) { 726a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[UATH_INTR_RX]); 727dc60165bSWeongyo Jeong 728dc60165bSWeongyo Jeong /* wait at most two seconds for command reply */ 729dc60165bSWeongyo Jeong error = mtx_sleep(cmd, &sc->sc_mtx, 0, "uathcmd", 2 * hz); 730dc60165bSWeongyo Jeong cmd->odata = NULL; /* in case reply comes too late */ 731dc60165bSWeongyo Jeong if (error != 0) { 732dc60165bSWeongyo Jeong device_printf(sc->sc_dev, "timeout waiting for reply " 733dc60165bSWeongyo Jeong "to cmd 0x%x (%u)\n", code, code); 734dc60165bSWeongyo Jeong } else if (cmd->olen != olen) { 735dc60165bSWeongyo Jeong device_printf(sc->sc_dev, "unexpected reply data count " 736dc60165bSWeongyo Jeong "to cmd 0x%x (%u), got %u, expected %u\n", 737dc60165bSWeongyo Jeong code, code, cmd->olen, olen); 738dc60165bSWeongyo Jeong error = EINVAL; 739dc60165bSWeongyo Jeong } 740dc60165bSWeongyo Jeong return (error); 741dc60165bSWeongyo Jeong } 742dc60165bSWeongyo Jeong return (0); 743dc60165bSWeongyo Jeong } 744dc60165bSWeongyo Jeong 745dc60165bSWeongyo Jeong static int 746dc60165bSWeongyo Jeong uath_cmd_read(struct uath_softc *sc, uint32_t code, const void *idata, 747dc60165bSWeongyo Jeong int ilen, void *odata, int olen, int flags) 748dc60165bSWeongyo Jeong { 749dc60165bSWeongyo Jeong 750dc60165bSWeongyo Jeong flags |= UATH_CMD_FLAG_READ; 751dc60165bSWeongyo Jeong return uath_cmdsend(sc, code, idata, ilen, odata, olen, flags); 752dc60165bSWeongyo Jeong } 753dc60165bSWeongyo Jeong 754dc60165bSWeongyo Jeong static int 755dc60165bSWeongyo Jeong uath_cmd_write(struct uath_softc *sc, uint32_t code, const void *data, int len, 756dc60165bSWeongyo Jeong int flags) 757dc60165bSWeongyo Jeong { 758dc60165bSWeongyo Jeong 759dc60165bSWeongyo Jeong flags &= ~UATH_CMD_FLAG_READ; 760dc60165bSWeongyo Jeong return uath_cmdsend(sc, code, data, len, NULL, 0, flags); 761dc60165bSWeongyo Jeong } 762dc60165bSWeongyo Jeong 763dc60165bSWeongyo Jeong static struct uath_cmd * 764dc60165bSWeongyo Jeong uath_get_cmdbuf(struct uath_softc *sc) 765dc60165bSWeongyo Jeong { 766dc60165bSWeongyo Jeong struct uath_cmd *uc; 767dc60165bSWeongyo Jeong 768dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 769dc60165bSWeongyo Jeong 770dc60165bSWeongyo Jeong uc = STAILQ_FIRST(&sc->sc_cmd_inactive); 771dc60165bSWeongyo Jeong if (uc != NULL) { 772dc60165bSWeongyo Jeong STAILQ_REMOVE_HEAD(&sc->sc_cmd_inactive, next); 773dc60165bSWeongyo Jeong UATH_STAT_DEC(sc, st_cmd_inactive); 774dc60165bSWeongyo Jeong } else 775dc60165bSWeongyo Jeong uc = NULL; 776dc60165bSWeongyo Jeong if (uc == NULL) 777dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_XMIT, "%s: %s\n", __func__, 778dc60165bSWeongyo Jeong "out of command xmit buffers"); 779dc60165bSWeongyo Jeong return (uc); 780dc60165bSWeongyo Jeong } 781dc60165bSWeongyo Jeong 782dc60165bSWeongyo Jeong /* 783dc60165bSWeongyo Jeong * This function is called periodically (every second) when associated to 784dc60165bSWeongyo Jeong * query device statistics. 785dc60165bSWeongyo Jeong */ 786dc60165bSWeongyo Jeong static void 787dc60165bSWeongyo Jeong uath_stat(void *arg) 788dc60165bSWeongyo Jeong { 789dc60165bSWeongyo Jeong struct uath_softc *sc = arg; 790dc60165bSWeongyo Jeong int error; 791dc60165bSWeongyo Jeong 792dc60165bSWeongyo Jeong UATH_LOCK(sc); 793dc60165bSWeongyo Jeong /* 794dc60165bSWeongyo Jeong * Send request for statistics asynchronously. The timer will be 795dc60165bSWeongyo Jeong * restarted when we'll get the stats notification. 796dc60165bSWeongyo Jeong */ 797dc60165bSWeongyo Jeong error = uath_cmd_write(sc, WDCMSG_TARGET_GET_STATS, NULL, 0, 798dc60165bSWeongyo Jeong UATH_CMD_FLAG_ASYNC); 799dc60165bSWeongyo Jeong if (error != 0) { 800dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 801dc60165bSWeongyo Jeong "could not query stats, error %d\n", error); 802dc60165bSWeongyo Jeong } 803dc60165bSWeongyo Jeong UATH_UNLOCK(sc); 804dc60165bSWeongyo Jeong } 805dc60165bSWeongyo Jeong 806dc60165bSWeongyo Jeong static int 807dc60165bSWeongyo Jeong uath_get_capability(struct uath_softc *sc, uint32_t cap, uint32_t *val) 808dc60165bSWeongyo Jeong { 809dc60165bSWeongyo Jeong int error; 810dc60165bSWeongyo Jeong 811dc60165bSWeongyo Jeong cap = htobe32(cap); 812dc60165bSWeongyo Jeong error = uath_cmd_read(sc, WDCMSG_TARGET_GET_CAPABILITY, 813dc60165bSWeongyo Jeong &cap, sizeof cap, val, sizeof(uint32_t), UATH_CMD_FLAG_MAGIC); 814dc60165bSWeongyo Jeong if (error != 0) { 815dc60165bSWeongyo Jeong device_printf(sc->sc_dev, "could not read capability %u\n", 816dc60165bSWeongyo Jeong be32toh(cap)); 817dc60165bSWeongyo Jeong return (error); 818dc60165bSWeongyo Jeong } 819dc60165bSWeongyo Jeong *val = be32toh(*val); 820dc60165bSWeongyo Jeong return (error); 821dc60165bSWeongyo Jeong } 822dc60165bSWeongyo Jeong 823dc60165bSWeongyo Jeong static int 824dc60165bSWeongyo Jeong uath_get_devcap(struct uath_softc *sc) 825dc60165bSWeongyo Jeong { 826dc60165bSWeongyo Jeong #define GETCAP(x, v) do { \ 827dc60165bSWeongyo Jeong error = uath_get_capability(sc, x, &v); \ 828dc60165bSWeongyo Jeong if (error != 0) \ 829dc60165bSWeongyo Jeong return (error); \ 830dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_DEVCAP, \ 831dc60165bSWeongyo Jeong "%s: %s=0x%08x\n", __func__, #x, v); \ 832dc60165bSWeongyo Jeong } while (0) 833dc60165bSWeongyo Jeong struct uath_devcap *cap = &sc->sc_devcap; 834dc60165bSWeongyo Jeong int error; 835dc60165bSWeongyo Jeong 836dc60165bSWeongyo Jeong /* collect device capabilities */ 837dc60165bSWeongyo Jeong GETCAP(CAP_TARGET_VERSION, cap->targetVersion); 838dc60165bSWeongyo Jeong GETCAP(CAP_TARGET_REVISION, cap->targetRevision); 839dc60165bSWeongyo Jeong GETCAP(CAP_MAC_VERSION, cap->macVersion); 840dc60165bSWeongyo Jeong GETCAP(CAP_MAC_REVISION, cap->macRevision); 841dc60165bSWeongyo Jeong GETCAP(CAP_PHY_REVISION, cap->phyRevision); 842dc60165bSWeongyo Jeong GETCAP(CAP_ANALOG_5GHz_REVISION, cap->analog5GhzRevision); 843dc60165bSWeongyo Jeong GETCAP(CAP_ANALOG_2GHz_REVISION, cap->analog2GhzRevision); 844dc60165bSWeongyo Jeong 845dc60165bSWeongyo Jeong GETCAP(CAP_REG_DOMAIN, cap->regDomain); 846dc60165bSWeongyo Jeong GETCAP(CAP_REG_CAP_BITS, cap->regCapBits); 847dc60165bSWeongyo Jeong #if 0 848dc60165bSWeongyo Jeong /* NB: not supported in rev 1.5 */ 849dc60165bSWeongyo Jeong GETCAP(CAP_COUNTRY_CODE, cap->countryCode); 850dc60165bSWeongyo Jeong #endif 851dc60165bSWeongyo Jeong GETCAP(CAP_WIRELESS_MODES, cap->wirelessModes); 852dc60165bSWeongyo Jeong GETCAP(CAP_CHAN_SPREAD_SUPPORT, cap->chanSpreadSupport); 853dc60165bSWeongyo Jeong GETCAP(CAP_COMPRESS_SUPPORT, cap->compressSupport); 854dc60165bSWeongyo Jeong GETCAP(CAP_BURST_SUPPORT, cap->burstSupport); 855dc60165bSWeongyo Jeong GETCAP(CAP_FAST_FRAMES_SUPPORT, cap->fastFramesSupport); 856dc60165bSWeongyo Jeong GETCAP(CAP_CHAP_TUNING_SUPPORT, cap->chapTuningSupport); 857dc60165bSWeongyo Jeong GETCAP(CAP_TURBOG_SUPPORT, cap->turboGSupport); 858dc60165bSWeongyo Jeong GETCAP(CAP_TURBO_PRIME_SUPPORT, cap->turboPrimeSupport); 859dc60165bSWeongyo Jeong GETCAP(CAP_DEVICE_TYPE, cap->deviceType); 860dc60165bSWeongyo Jeong GETCAP(CAP_WME_SUPPORT, cap->wmeSupport); 861dc60165bSWeongyo Jeong GETCAP(CAP_TOTAL_QUEUES, cap->numTxQueues); 862dc60165bSWeongyo Jeong GETCAP(CAP_CONNECTION_ID_MAX, cap->connectionIdMax); 863dc60165bSWeongyo Jeong 864dc60165bSWeongyo Jeong GETCAP(CAP_LOW_5GHZ_CHAN, cap->low5GhzChan); 865dc60165bSWeongyo Jeong GETCAP(CAP_HIGH_5GHZ_CHAN, cap->high5GhzChan); 866dc60165bSWeongyo Jeong GETCAP(CAP_LOW_2GHZ_CHAN, cap->low2GhzChan); 867dc60165bSWeongyo Jeong GETCAP(CAP_HIGH_2GHZ_CHAN, cap->high2GhzChan); 868dc60165bSWeongyo Jeong GETCAP(CAP_TWICE_ANTENNAGAIN_5G, cap->twiceAntennaGain5G); 869dc60165bSWeongyo Jeong GETCAP(CAP_TWICE_ANTENNAGAIN_2G, cap->twiceAntennaGain2G); 870dc60165bSWeongyo Jeong 871dc60165bSWeongyo Jeong GETCAP(CAP_CIPHER_AES_CCM, cap->supportCipherAES_CCM); 872dc60165bSWeongyo Jeong GETCAP(CAP_CIPHER_TKIP, cap->supportCipherTKIP); 873dc60165bSWeongyo Jeong GETCAP(CAP_MIC_TKIP, cap->supportMicTKIP); 874dc60165bSWeongyo Jeong 875dc60165bSWeongyo Jeong cap->supportCipherWEP = 1; /* NB: always available */ 876dc60165bSWeongyo Jeong 877dc60165bSWeongyo Jeong return (0); 878dc60165bSWeongyo Jeong } 879dc60165bSWeongyo Jeong 880dc60165bSWeongyo Jeong static int 881dc60165bSWeongyo Jeong uath_get_devstatus(struct uath_softc *sc, uint8_t macaddr[IEEE80211_ADDR_LEN]) 882dc60165bSWeongyo Jeong { 883dc60165bSWeongyo Jeong int error; 884dc60165bSWeongyo Jeong 885dc60165bSWeongyo Jeong /* retrieve MAC address */ 886dc60165bSWeongyo Jeong error = uath_get_status(sc, ST_MAC_ADDR, macaddr, IEEE80211_ADDR_LEN); 887dc60165bSWeongyo Jeong if (error != 0) { 888dc60165bSWeongyo Jeong device_printf(sc->sc_dev, "could not read MAC address\n"); 889dc60165bSWeongyo Jeong return (error); 890dc60165bSWeongyo Jeong } 891dc60165bSWeongyo Jeong 892dc60165bSWeongyo Jeong error = uath_get_status(sc, ST_SERIAL_NUMBER, 893dc60165bSWeongyo Jeong &sc->sc_serial[0], sizeof(sc->sc_serial)); 894dc60165bSWeongyo Jeong if (error != 0) { 895dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 896dc60165bSWeongyo Jeong "could not read device serial number\n"); 897dc60165bSWeongyo Jeong return (error); 898dc60165bSWeongyo Jeong } 899dc60165bSWeongyo Jeong return (0); 900dc60165bSWeongyo Jeong } 901dc60165bSWeongyo Jeong 902dc60165bSWeongyo Jeong static int 903dc60165bSWeongyo Jeong uath_get_status(struct uath_softc *sc, uint32_t which, void *odata, int olen) 904dc60165bSWeongyo Jeong { 905dc60165bSWeongyo Jeong int error; 906dc60165bSWeongyo Jeong 907dc60165bSWeongyo Jeong which = htobe32(which); 908dc60165bSWeongyo Jeong error = uath_cmd_read(sc, WDCMSG_TARGET_GET_STATUS, 909dc60165bSWeongyo Jeong &which, sizeof(which), odata, olen, UATH_CMD_FLAG_MAGIC); 910dc60165bSWeongyo Jeong if (error != 0) 911dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 912dc60165bSWeongyo Jeong "could not read EEPROM offset 0x%02x\n", be32toh(which)); 913dc60165bSWeongyo Jeong return (error); 914dc60165bSWeongyo Jeong } 915dc60165bSWeongyo Jeong 916dc60165bSWeongyo Jeong static void 917dc60165bSWeongyo Jeong uath_free_data_list(struct uath_softc *sc, struct uath_data data[], int ndata, 918dc60165bSWeongyo Jeong int fillmbuf) 919dc60165bSWeongyo Jeong { 920dc60165bSWeongyo Jeong int i; 921dc60165bSWeongyo Jeong 922dc60165bSWeongyo Jeong for (i = 0; i < ndata; i++) { 923dc60165bSWeongyo Jeong struct uath_data *dp = &data[i]; 924dc60165bSWeongyo Jeong 925dc60165bSWeongyo Jeong if (fillmbuf == 1) { 926dc60165bSWeongyo Jeong if (dp->m != NULL) { 927dc60165bSWeongyo Jeong m_freem(dp->m); 928dc60165bSWeongyo Jeong dp->m = NULL; 929dc60165bSWeongyo Jeong dp->buf = NULL; 930dc60165bSWeongyo Jeong } 931dc60165bSWeongyo Jeong } else { 932dc60165bSWeongyo Jeong dp->buf = NULL; 933dc60165bSWeongyo Jeong } 934645e4d17SHans Petter Selasky if (dp->ni != NULL) { 935645e4d17SHans Petter Selasky ieee80211_free_node(dp->ni); 936645e4d17SHans Petter Selasky dp->ni = NULL; 937645e4d17SHans Petter Selasky } 938dc60165bSWeongyo Jeong } 939dc60165bSWeongyo Jeong } 940dc60165bSWeongyo Jeong 941dc60165bSWeongyo Jeong static int 942dc60165bSWeongyo Jeong uath_alloc_data_list(struct uath_softc *sc, struct uath_data data[], 943c180b398SHans Petter Selasky int ndata, int maxsz, void *dma_buf) 944dc60165bSWeongyo Jeong { 945dc60165bSWeongyo Jeong int i, error; 946dc60165bSWeongyo Jeong 947dc60165bSWeongyo Jeong for (i = 0; i < ndata; i++) { 948dc60165bSWeongyo Jeong struct uath_data *dp = &data[i]; 949dc60165bSWeongyo Jeong 950dc60165bSWeongyo Jeong dp->sc = sc; 951c180b398SHans Petter Selasky if (dma_buf == NULL) { 952dc60165bSWeongyo Jeong /* XXX check maxsz */ 953c6499eccSGleb Smirnoff dp->m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 954dc60165bSWeongyo Jeong if (dp->m == NULL) { 955dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 956dc60165bSWeongyo Jeong "could not allocate rx mbuf\n"); 957dc60165bSWeongyo Jeong error = ENOMEM; 958dc60165bSWeongyo Jeong goto fail; 959dc60165bSWeongyo Jeong } 960dc60165bSWeongyo Jeong dp->buf = mtod(dp->m, uint8_t *); 961dc60165bSWeongyo Jeong } else { 962dc60165bSWeongyo Jeong dp->m = NULL; 963c180b398SHans Petter Selasky dp->buf = ((uint8_t *)dma_buf) + (i * maxsz); 964dc60165bSWeongyo Jeong } 965dc60165bSWeongyo Jeong dp->ni = NULL; 966dc60165bSWeongyo Jeong } 967dc60165bSWeongyo Jeong 968dc60165bSWeongyo Jeong return (0); 969dc60165bSWeongyo Jeong 970c180b398SHans Petter Selasky fail: uath_free_data_list(sc, data, ndata, 1 /* free mbufs */); 971dc60165bSWeongyo Jeong return (error); 972dc60165bSWeongyo Jeong } 973dc60165bSWeongyo Jeong 974dc60165bSWeongyo Jeong static int 975dc60165bSWeongyo Jeong uath_alloc_rx_data_list(struct uath_softc *sc) 976dc60165bSWeongyo Jeong { 977dc60165bSWeongyo Jeong int error, i; 978dc60165bSWeongyo Jeong 979dc60165bSWeongyo Jeong /* XXX is it enough to store the RX packet with MCLBYTES bytes? */ 980dc60165bSWeongyo Jeong error = uath_alloc_data_list(sc, 981dc60165bSWeongyo Jeong sc->sc_rx, UATH_RX_DATA_LIST_COUNT, MCLBYTES, 982c180b398SHans Petter Selasky NULL /* setup mbufs */); 983dc60165bSWeongyo Jeong if (error != 0) 984dc60165bSWeongyo Jeong return (error); 985dc60165bSWeongyo Jeong 986dc60165bSWeongyo Jeong STAILQ_INIT(&sc->sc_rx_active); 987dc60165bSWeongyo Jeong STAILQ_INIT(&sc->sc_rx_inactive); 988dc60165bSWeongyo Jeong 989dc60165bSWeongyo Jeong for (i = 0; i < UATH_RX_DATA_LIST_COUNT; i++) { 990dc60165bSWeongyo Jeong STAILQ_INSERT_HEAD(&sc->sc_rx_inactive, &sc->sc_rx[i], 991dc60165bSWeongyo Jeong next); 992dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_rx_inactive); 993dc60165bSWeongyo Jeong } 994dc60165bSWeongyo Jeong 995dc60165bSWeongyo Jeong return (0); 996dc60165bSWeongyo Jeong } 997dc60165bSWeongyo Jeong 998dc60165bSWeongyo Jeong static int 999dc60165bSWeongyo Jeong uath_alloc_tx_data_list(struct uath_softc *sc) 1000dc60165bSWeongyo Jeong { 1001dc60165bSWeongyo Jeong int error, i; 1002dc60165bSWeongyo Jeong 1003dc60165bSWeongyo Jeong error = uath_alloc_data_list(sc, 1004dc60165bSWeongyo Jeong sc->sc_tx, UATH_TX_DATA_LIST_COUNT, UATH_MAX_TXBUFSZ, 1005c180b398SHans Petter Selasky sc->sc_tx_dma_buf); 1006dc60165bSWeongyo Jeong if (error != 0) 1007dc60165bSWeongyo Jeong return (error); 1008dc60165bSWeongyo Jeong 1009dc60165bSWeongyo Jeong STAILQ_INIT(&sc->sc_tx_active); 1010dc60165bSWeongyo Jeong STAILQ_INIT(&sc->sc_tx_inactive); 1011dc60165bSWeongyo Jeong STAILQ_INIT(&sc->sc_tx_pending); 1012dc60165bSWeongyo Jeong 1013dc60165bSWeongyo Jeong for (i = 0; i < UATH_TX_DATA_LIST_COUNT; i++) { 1014dc60165bSWeongyo Jeong STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, &sc->sc_tx[i], 1015dc60165bSWeongyo Jeong next); 1016dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_tx_inactive); 1017dc60165bSWeongyo Jeong } 1018dc60165bSWeongyo Jeong 1019dc60165bSWeongyo Jeong return (0); 1020dc60165bSWeongyo Jeong } 1021dc60165bSWeongyo Jeong 1022dc60165bSWeongyo Jeong static void 1023dc60165bSWeongyo Jeong uath_free_rx_data_list(struct uath_softc *sc) 1024dc60165bSWeongyo Jeong { 1025dc60165bSWeongyo Jeong uath_free_data_list(sc, sc->sc_rx, UATH_RX_DATA_LIST_COUNT, 1026dc60165bSWeongyo Jeong 1 /* free mbufs */); 1027dc60165bSWeongyo Jeong } 1028dc60165bSWeongyo Jeong 1029dc60165bSWeongyo Jeong static void 1030dc60165bSWeongyo Jeong uath_free_tx_data_list(struct uath_softc *sc) 1031dc60165bSWeongyo Jeong { 1032dc60165bSWeongyo Jeong uath_free_data_list(sc, sc->sc_tx, UATH_TX_DATA_LIST_COUNT, 1033dc60165bSWeongyo Jeong 0 /* no mbufs */); 1034dc60165bSWeongyo Jeong } 1035dc60165bSWeongyo Jeong 1036dc60165bSWeongyo Jeong static struct ieee80211vap * 1037fcd9500fSBernhard Schmidt uath_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit, 1038fcd9500fSBernhard Schmidt enum ieee80211_opmode opmode, int flags, 1039dc60165bSWeongyo Jeong const uint8_t bssid[IEEE80211_ADDR_LEN], 1040dc60165bSWeongyo Jeong const uint8_t mac[IEEE80211_ADDR_LEN]) 1041dc60165bSWeongyo Jeong { 1042dc60165bSWeongyo Jeong struct uath_vap *uvp; 1043dc60165bSWeongyo Jeong struct ieee80211vap *vap; 1044dc60165bSWeongyo Jeong 1045dc60165bSWeongyo Jeong if (!TAILQ_EMPTY(&ic->ic_vaps)) /* only one at a time */ 1046dc60165bSWeongyo Jeong return (NULL); 1047*7a79cebfSGleb Smirnoff uvp = malloc(sizeof(struct uath_vap), M_80211_VAP, M_WAITOK | M_ZERO); 1048dc60165bSWeongyo Jeong vap = &uvp->vap; 1049dc60165bSWeongyo Jeong /* enable s/w bmiss handling for sta mode */ 1050bb2f69e8SHans Petter Selasky 1051bb2f69e8SHans Petter Selasky if (ieee80211_vap_setup(ic, vap, name, unit, opmode, 1052*7a79cebfSGleb Smirnoff flags | IEEE80211_CLONE_NOBEACONS, bssid) != 0) { 1053bb2f69e8SHans Petter Selasky /* out of memory */ 1054bb2f69e8SHans Petter Selasky free(uvp, M_80211_VAP); 1055bb2f69e8SHans Petter Selasky return (NULL); 1056bb2f69e8SHans Petter Selasky } 1057dc60165bSWeongyo Jeong 1058dc60165bSWeongyo Jeong /* override state transition machine */ 1059dc60165bSWeongyo Jeong uvp->newstate = vap->iv_newstate; 1060dc60165bSWeongyo Jeong vap->iv_newstate = uath_newstate; 1061dc60165bSWeongyo Jeong 1062dc60165bSWeongyo Jeong /* complete setup */ 1063dc60165bSWeongyo Jeong ieee80211_vap_attach(vap, ieee80211_media_change, 1064*7a79cebfSGleb Smirnoff ieee80211_media_status, mac); 1065dc60165bSWeongyo Jeong ic->ic_opmode = opmode; 1066dc60165bSWeongyo Jeong return (vap); 1067dc60165bSWeongyo Jeong } 1068dc60165bSWeongyo Jeong 1069dc60165bSWeongyo Jeong static void 1070dc60165bSWeongyo Jeong uath_vap_delete(struct ieee80211vap *vap) 1071dc60165bSWeongyo Jeong { 1072dc60165bSWeongyo Jeong struct uath_vap *uvp = UATH_VAP(vap); 1073dc60165bSWeongyo Jeong 1074dc60165bSWeongyo Jeong ieee80211_vap_detach(vap); 1075dc60165bSWeongyo Jeong free(uvp, M_80211_VAP); 1076dc60165bSWeongyo Jeong } 1077dc60165bSWeongyo Jeong 1078dc60165bSWeongyo Jeong static int 1079*7a79cebfSGleb Smirnoff uath_init(struct uath_softc *sc) 1080dc60165bSWeongyo Jeong { 1081*7a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 1082*7a79cebfSGleb Smirnoff struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 1083dc60165bSWeongyo Jeong uint32_t val; 1084dc60165bSWeongyo Jeong int error; 1085dc60165bSWeongyo Jeong 1086dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 1087dc60165bSWeongyo Jeong 1088*7a79cebfSGleb Smirnoff if (sc->sc_flags & UATH_FLAG_INITDONE) 1089*7a79cebfSGleb Smirnoff uath_stop(sc); 1090dc60165bSWeongyo Jeong 1091dc60165bSWeongyo Jeong /* reset variables */ 1092dc60165bSWeongyo Jeong sc->sc_intrx_nextnum = sc->sc_msgid = 0; 1093dc60165bSWeongyo Jeong 1094dc60165bSWeongyo Jeong val = htobe32(0); 1095dc60165bSWeongyo Jeong uath_cmd_write(sc, WDCMSG_BIND, &val, sizeof val, 0); 1096dc60165bSWeongyo Jeong 1097dc60165bSWeongyo Jeong /* set MAC address */ 1098*7a79cebfSGleb Smirnoff uath_config_multi(sc, CFG_MAC_ADDR, 1099*7a79cebfSGleb Smirnoff vap ? vap->iv_myaddr : ic->ic_macaddr, IEEE80211_ADDR_LEN); 1100dc60165bSWeongyo Jeong 1101dc60165bSWeongyo Jeong /* XXX honor net80211 state */ 1102dc60165bSWeongyo Jeong uath_config(sc, CFG_RATE_CONTROL_ENABLE, 0x00000001); 1103dc60165bSWeongyo Jeong uath_config(sc, CFG_DIVERSITY_CTL, 0x00000001); 1104dc60165bSWeongyo Jeong uath_config(sc, CFG_ABOLT, 0x0000003f); 1105dc60165bSWeongyo Jeong uath_config(sc, CFG_WME_ENABLED, 0x00000001); 1106dc60165bSWeongyo Jeong 1107dc60165bSWeongyo Jeong uath_config(sc, CFG_SERVICE_TYPE, 1); 1108dc60165bSWeongyo Jeong uath_config(sc, CFG_TP_SCALE, 0x00000000); 1109dc60165bSWeongyo Jeong uath_config(sc, CFG_TPC_HALF_DBM5, 0x0000003c); 1110dc60165bSWeongyo Jeong uath_config(sc, CFG_TPC_HALF_DBM2, 0x0000003c); 1111dc60165bSWeongyo Jeong uath_config(sc, CFG_OVERRD_TX_POWER, 0x00000000); 1112dc60165bSWeongyo Jeong uath_config(sc, CFG_GMODE_PROTECTION, 0x00000000); 1113dc60165bSWeongyo Jeong uath_config(sc, CFG_GMODE_PROTECT_RATE_INDEX, 0x00000003); 1114dc60165bSWeongyo Jeong uath_config(sc, CFG_PROTECTION_TYPE, 0x00000000); 1115dc60165bSWeongyo Jeong uath_config(sc, CFG_MODE_CTS, 0x00000002); 1116dc60165bSWeongyo Jeong 1117dc60165bSWeongyo Jeong error = uath_cmd_read(sc, WDCMSG_TARGET_START, NULL, 0, 1118dc60165bSWeongyo Jeong &val, sizeof(val), UATH_CMD_FLAG_MAGIC); 1119dc60165bSWeongyo Jeong if (error) { 1120dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 1121dc60165bSWeongyo Jeong "could not start target, error %d\n", error); 1122dc60165bSWeongyo Jeong goto fail; 1123dc60165bSWeongyo Jeong } 1124dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_INIT, "%s returns handle: 0x%x\n", 1125dc60165bSWeongyo Jeong uath_codename(WDCMSG_TARGET_START), be32toh(val)); 1126dc60165bSWeongyo Jeong 1127dc60165bSWeongyo Jeong /* set default channel */ 1128dc60165bSWeongyo Jeong error = uath_switch_channel(sc, ic->ic_curchan); 1129dc60165bSWeongyo Jeong if (error) { 1130dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 1131dc60165bSWeongyo Jeong "could not switch channel, error %d\n", error); 1132dc60165bSWeongyo Jeong goto fail; 1133dc60165bSWeongyo Jeong } 1134dc60165bSWeongyo Jeong 1135dc60165bSWeongyo Jeong val = htobe32(TARGET_DEVICE_AWAKE); 1136dc60165bSWeongyo Jeong uath_cmd_write(sc, WDCMSG_SET_PWR_MODE, &val, sizeof val, 0); 1137dc60165bSWeongyo Jeong /* XXX? check */ 1138dc60165bSWeongyo Jeong uath_cmd_write(sc, WDCMSG_RESET_KEY_CACHE, NULL, 0, 0); 1139dc60165bSWeongyo Jeong 1140a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[UATH_BULK_RX]); 1141dc60165bSWeongyo Jeong /* enable Rx */ 1142dc60165bSWeongyo Jeong uath_set_rxfilter(sc, 0x0, UATH_FILTER_OP_INIT); 1143dc60165bSWeongyo Jeong uath_set_rxfilter(sc, 1144dc60165bSWeongyo Jeong UATH_FILTER_RX_UCAST | UATH_FILTER_RX_MCAST | 1145dc60165bSWeongyo Jeong UATH_FILTER_RX_BCAST | UATH_FILTER_RX_BEACON, 1146dc60165bSWeongyo Jeong UATH_FILTER_OP_SET); 1147dc60165bSWeongyo Jeong 1148dc60165bSWeongyo Jeong sc->sc_flags |= UATH_FLAG_INITDONE; 1149dc60165bSWeongyo Jeong 1150dc60165bSWeongyo Jeong callout_reset(&sc->watchdog_ch, hz, uath_watchdog, sc); 1151dc60165bSWeongyo Jeong 1152dc60165bSWeongyo Jeong return (0); 1153dc60165bSWeongyo Jeong 1154dc60165bSWeongyo Jeong fail: 1155*7a79cebfSGleb Smirnoff uath_stop(sc); 1156dc60165bSWeongyo Jeong return (error); 1157dc60165bSWeongyo Jeong } 1158dc60165bSWeongyo Jeong 1159dc60165bSWeongyo Jeong static void 1160*7a79cebfSGleb Smirnoff uath_stop(struct uath_softc *sc) 1161dc60165bSWeongyo Jeong { 1162dc60165bSWeongyo Jeong 1163dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 1164dc60165bSWeongyo Jeong 1165dc60165bSWeongyo Jeong sc->sc_flags &= ~UATH_FLAG_INITDONE; 1166dc60165bSWeongyo Jeong 1167dc60165bSWeongyo Jeong callout_stop(&sc->stat_ch); 1168dc60165bSWeongyo Jeong callout_stop(&sc->watchdog_ch); 1169dc60165bSWeongyo Jeong sc->sc_tx_timer = 0; 1170dc60165bSWeongyo Jeong /* abort pending transmits */ 1171dc60165bSWeongyo Jeong uath_abort_xfers(sc); 1172dc60165bSWeongyo Jeong /* flush data & control requests into the target */ 1173dc60165bSWeongyo Jeong (void)uath_flush(sc); 1174dc60165bSWeongyo Jeong /* set a LED status to the disconnected. */ 1175dc60165bSWeongyo Jeong uath_set_ledstate(sc, 0); 1176dc60165bSWeongyo Jeong /* stop the target */ 1177dc60165bSWeongyo Jeong uath_cmd_write(sc, WDCMSG_TARGET_STOP, NULL, 0, 0); 1178dc60165bSWeongyo Jeong } 1179dc60165bSWeongyo Jeong 1180dc60165bSWeongyo Jeong static int 1181dc60165bSWeongyo Jeong uath_config(struct uath_softc *sc, uint32_t reg, uint32_t val) 1182dc60165bSWeongyo Jeong { 1183dc60165bSWeongyo Jeong struct uath_write_mac write; 1184dc60165bSWeongyo Jeong int error; 1185dc60165bSWeongyo Jeong 1186dc60165bSWeongyo Jeong write.reg = htobe32(reg); 1187dc60165bSWeongyo Jeong write.len = htobe32(0); /* 0 = single write */ 1188dc60165bSWeongyo Jeong *(uint32_t *)write.data = htobe32(val); 1189dc60165bSWeongyo Jeong 1190dc60165bSWeongyo Jeong error = uath_cmd_write(sc, WDCMSG_TARGET_SET_CONFIG, &write, 1191dc60165bSWeongyo Jeong 3 * sizeof (uint32_t), 0); 1192dc60165bSWeongyo Jeong if (error != 0) { 1193dc60165bSWeongyo Jeong device_printf(sc->sc_dev, "could not write register 0x%02x\n", 1194dc60165bSWeongyo Jeong reg); 1195dc60165bSWeongyo Jeong } 1196dc60165bSWeongyo Jeong return (error); 1197dc60165bSWeongyo Jeong } 1198dc60165bSWeongyo Jeong 1199dc60165bSWeongyo Jeong static int 1200dc60165bSWeongyo Jeong uath_config_multi(struct uath_softc *sc, uint32_t reg, const void *data, 1201dc60165bSWeongyo Jeong int len) 1202dc60165bSWeongyo Jeong { 1203dc60165bSWeongyo Jeong struct uath_write_mac write; 1204dc60165bSWeongyo Jeong int error; 1205dc60165bSWeongyo Jeong 1206dc60165bSWeongyo Jeong write.reg = htobe32(reg); 1207dc60165bSWeongyo Jeong write.len = htobe32(len); 1208dc60165bSWeongyo Jeong bcopy(data, write.data, len); 1209dc60165bSWeongyo Jeong 1210dc60165bSWeongyo Jeong /* properly handle the case where len is zero (reset) */ 1211dc60165bSWeongyo Jeong error = uath_cmd_write(sc, WDCMSG_TARGET_SET_CONFIG, &write, 1212dc60165bSWeongyo Jeong (len == 0) ? sizeof (uint32_t) : 2 * sizeof (uint32_t) + len, 0); 1213dc60165bSWeongyo Jeong if (error != 0) { 1214dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 1215dc60165bSWeongyo Jeong "could not write %d bytes to register 0x%02x\n", len, reg); 1216dc60165bSWeongyo Jeong } 1217dc60165bSWeongyo Jeong return (error); 1218dc60165bSWeongyo Jeong } 1219dc60165bSWeongyo Jeong 1220dc60165bSWeongyo Jeong static int 1221dc60165bSWeongyo Jeong uath_switch_channel(struct uath_softc *sc, struct ieee80211_channel *c) 1222dc60165bSWeongyo Jeong { 1223dc60165bSWeongyo Jeong int error; 1224dc60165bSWeongyo Jeong 1225dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 1226dc60165bSWeongyo Jeong 1227dc60165bSWeongyo Jeong /* set radio frequency */ 1228dc60165bSWeongyo Jeong error = uath_set_chan(sc, c); 1229dc60165bSWeongyo Jeong if (error) { 1230dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 1231dc60165bSWeongyo Jeong "could not set channel, error %d\n", error); 1232dc60165bSWeongyo Jeong goto failed; 1233dc60165bSWeongyo Jeong } 1234dc60165bSWeongyo Jeong /* reset Tx rings */ 1235dc60165bSWeongyo Jeong error = uath_reset_tx_queues(sc); 1236dc60165bSWeongyo Jeong if (error) { 1237dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 1238dc60165bSWeongyo Jeong "could not reset Tx queues, error %d\n", error); 1239dc60165bSWeongyo Jeong goto failed; 1240dc60165bSWeongyo Jeong } 1241dc60165bSWeongyo Jeong /* set Tx rings WME properties */ 1242dc60165bSWeongyo Jeong error = uath_wme_init(sc); 1243dc60165bSWeongyo Jeong if (error) { 1244dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 1245dc60165bSWeongyo Jeong "could not init Tx queues, error %d\n", error); 1246dc60165bSWeongyo Jeong goto failed; 1247dc60165bSWeongyo Jeong } 1248dc60165bSWeongyo Jeong error = uath_set_ledstate(sc, 0); 1249dc60165bSWeongyo Jeong if (error) { 1250dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 1251dc60165bSWeongyo Jeong "could not set led state, error %d\n", error); 1252dc60165bSWeongyo Jeong goto failed; 1253dc60165bSWeongyo Jeong } 1254dc60165bSWeongyo Jeong error = uath_flush(sc); 1255dc60165bSWeongyo Jeong if (error) { 1256dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 1257dc60165bSWeongyo Jeong "could not flush pipes, error %d\n", error); 1258dc60165bSWeongyo Jeong goto failed; 1259dc60165bSWeongyo Jeong } 1260dc60165bSWeongyo Jeong failed: 1261dc60165bSWeongyo Jeong return (error); 1262dc60165bSWeongyo Jeong } 1263dc60165bSWeongyo Jeong 1264dc60165bSWeongyo Jeong static int 1265dc60165bSWeongyo Jeong uath_set_rxfilter(struct uath_softc *sc, uint32_t bits, uint32_t op) 1266dc60165bSWeongyo Jeong { 1267dc60165bSWeongyo Jeong struct uath_cmd_rx_filter rxfilter; 1268dc60165bSWeongyo Jeong 1269dc60165bSWeongyo Jeong rxfilter.bits = htobe32(bits); 1270dc60165bSWeongyo Jeong rxfilter.op = htobe32(op); 1271dc60165bSWeongyo Jeong 1272dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL, 1273dc60165bSWeongyo Jeong "setting Rx filter=0x%x flags=0x%x\n", bits, op); 1274dc60165bSWeongyo Jeong return uath_cmd_write(sc, WDCMSG_RX_FILTER, &rxfilter, 1275dc60165bSWeongyo Jeong sizeof rxfilter, 0); 1276dc60165bSWeongyo Jeong } 1277dc60165bSWeongyo Jeong 1278dc60165bSWeongyo Jeong static void 1279dc60165bSWeongyo Jeong uath_watchdog(void *arg) 1280dc60165bSWeongyo Jeong { 1281dc60165bSWeongyo Jeong struct uath_softc *sc = arg; 1282*7a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 1283dc60165bSWeongyo Jeong 1284dc60165bSWeongyo Jeong if (sc->sc_tx_timer > 0) { 1285dc60165bSWeongyo Jeong if (--sc->sc_tx_timer == 0) { 1286dc60165bSWeongyo Jeong device_printf(sc->sc_dev, "device timeout\n"); 1287*7a79cebfSGleb Smirnoff /*uath_init(sc); XXX needs a process context! */ 1288*7a79cebfSGleb Smirnoff counter_u64_add(ic->ic_oerrors, 1); 1289dc60165bSWeongyo Jeong return; 1290dc60165bSWeongyo Jeong } 1291dc60165bSWeongyo Jeong callout_reset(&sc->watchdog_ch, hz, uath_watchdog, sc); 1292dc60165bSWeongyo Jeong } 1293dc60165bSWeongyo Jeong } 1294dc60165bSWeongyo Jeong 1295dc60165bSWeongyo Jeong static void 1296dc60165bSWeongyo Jeong uath_abort_xfers(struct uath_softc *sc) 1297dc60165bSWeongyo Jeong { 1298dc60165bSWeongyo Jeong int i; 1299dc60165bSWeongyo Jeong 1300dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 1301dc60165bSWeongyo Jeong /* abort any pending transfers */ 1302dc60165bSWeongyo Jeong for (i = 0; i < UATH_N_XFERS; i++) 1303a593f6b8SAndrew Thompson usbd_transfer_stop(sc->sc_xfer[i]); 1304dc60165bSWeongyo Jeong } 1305dc60165bSWeongyo Jeong 1306dc60165bSWeongyo Jeong static int 1307dc60165bSWeongyo Jeong uath_flush(struct uath_softc *sc) 1308dc60165bSWeongyo Jeong { 1309dc60165bSWeongyo Jeong int error; 1310dc60165bSWeongyo Jeong 1311dc60165bSWeongyo Jeong error = uath_dataflush(sc); 1312dc60165bSWeongyo Jeong if (error != 0) 1313dc60165bSWeongyo Jeong goto failed; 1314dc60165bSWeongyo Jeong 1315dc60165bSWeongyo Jeong error = uath_cmdflush(sc); 1316dc60165bSWeongyo Jeong if (error != 0) 1317dc60165bSWeongyo Jeong goto failed; 1318dc60165bSWeongyo Jeong 1319dc60165bSWeongyo Jeong failed: 1320dc60165bSWeongyo Jeong return (error); 1321dc60165bSWeongyo Jeong } 1322dc60165bSWeongyo Jeong 1323dc60165bSWeongyo Jeong static int 1324dc60165bSWeongyo Jeong uath_cmdflush(struct uath_softc *sc) 1325dc60165bSWeongyo Jeong { 1326dc60165bSWeongyo Jeong 1327dc60165bSWeongyo Jeong return uath_cmd_write(sc, WDCMSG_FLUSH, NULL, 0, 0); 1328dc60165bSWeongyo Jeong } 1329dc60165bSWeongyo Jeong 1330dc60165bSWeongyo Jeong static int 1331dc60165bSWeongyo Jeong uath_dataflush(struct uath_softc *sc) 1332dc60165bSWeongyo Jeong { 1333dc60165bSWeongyo Jeong struct uath_data *data; 1334dc60165bSWeongyo Jeong struct uath_chunk *chunk; 1335dc60165bSWeongyo Jeong struct uath_tx_desc *desc; 1336dc60165bSWeongyo Jeong 1337dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 1338dc60165bSWeongyo Jeong 1339dc60165bSWeongyo Jeong data = uath_getbuf(sc); 1340dc60165bSWeongyo Jeong if (data == NULL) 1341dc60165bSWeongyo Jeong return (ENOBUFS); 1342dc60165bSWeongyo Jeong data->buflen = sizeof(struct uath_chunk) + sizeof(struct uath_tx_desc); 1343dc60165bSWeongyo Jeong data->m = NULL; 1344dc60165bSWeongyo Jeong data->ni = NULL; 1345dc60165bSWeongyo Jeong chunk = (struct uath_chunk *)data->buf; 1346dc60165bSWeongyo Jeong desc = (struct uath_tx_desc *)(chunk + 1); 1347dc60165bSWeongyo Jeong 1348dc60165bSWeongyo Jeong /* one chunk only */ 1349dc60165bSWeongyo Jeong chunk->seqnum = 0; 1350dc60165bSWeongyo Jeong chunk->flags = UATH_CFLAGS_FINAL; 1351dc60165bSWeongyo Jeong chunk->length = htobe16(sizeof (struct uath_tx_desc)); 1352dc60165bSWeongyo Jeong 1353271ae033SHans Petter Selasky memset(desc, 0, sizeof(struct uath_tx_desc)); 1354dc60165bSWeongyo Jeong desc->msglen = htobe32(sizeof(struct uath_tx_desc)); 1355dc60165bSWeongyo Jeong desc->msgid = (sc->sc_msgid++) + 1; /* don't care about endianness */ 1356dc60165bSWeongyo Jeong desc->type = htobe32(WDCMSG_FLUSH); 1357dc60165bSWeongyo Jeong desc->txqid = htobe32(0); 1358dc60165bSWeongyo Jeong desc->connid = htobe32(0); 1359dc60165bSWeongyo Jeong desc->flags = htobe32(0); 1360dc60165bSWeongyo Jeong 1361dc60165bSWeongyo Jeong #ifdef UATH_DEBUG 1362dc60165bSWeongyo Jeong if (sc->sc_debug & UATH_DEBUG_CMDS) { 1363dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_RESET, "send flush ix %d\n", 1364dc60165bSWeongyo Jeong desc->msgid); 1365dc60165bSWeongyo Jeong if (sc->sc_debug & UATH_DEBUG_CMDS_DUMP) 1366dc60165bSWeongyo Jeong uath_dump_cmd(data->buf, data->buflen, '+'); 1367dc60165bSWeongyo Jeong } 1368dc60165bSWeongyo Jeong #endif 1369dc60165bSWeongyo Jeong 1370dc60165bSWeongyo Jeong STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next); 1371dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_tx_pending); 1372dc60165bSWeongyo Jeong sc->sc_tx_timer = 5; 1373a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[UATH_BULK_TX]); 1374dc60165bSWeongyo Jeong 1375dc60165bSWeongyo Jeong return (0); 1376dc60165bSWeongyo Jeong } 1377dc60165bSWeongyo Jeong 1378dc60165bSWeongyo Jeong static struct uath_data * 1379dc60165bSWeongyo Jeong _uath_getbuf(struct uath_softc *sc) 1380dc60165bSWeongyo Jeong { 1381dc60165bSWeongyo Jeong struct uath_data *bf; 1382dc60165bSWeongyo Jeong 1383dc60165bSWeongyo Jeong bf = STAILQ_FIRST(&sc->sc_tx_inactive); 1384dc60165bSWeongyo Jeong if (bf != NULL) { 1385dc60165bSWeongyo Jeong STAILQ_REMOVE_HEAD(&sc->sc_tx_inactive, next); 1386dc60165bSWeongyo Jeong UATH_STAT_DEC(sc, st_tx_inactive); 1387dc60165bSWeongyo Jeong } else 1388dc60165bSWeongyo Jeong bf = NULL; 1389dc60165bSWeongyo Jeong if (bf == NULL) 1390dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_XMIT, "%s: %s\n", __func__, 1391dc60165bSWeongyo Jeong "out of xmit buffers"); 1392dc60165bSWeongyo Jeong return (bf); 1393dc60165bSWeongyo Jeong } 1394dc60165bSWeongyo Jeong 1395dc60165bSWeongyo Jeong static struct uath_data * 1396dc60165bSWeongyo Jeong uath_getbuf(struct uath_softc *sc) 1397dc60165bSWeongyo Jeong { 1398dc60165bSWeongyo Jeong struct uath_data *bf; 1399dc60165bSWeongyo Jeong 1400dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 1401dc60165bSWeongyo Jeong 1402dc60165bSWeongyo Jeong bf = _uath_getbuf(sc); 1403*7a79cebfSGleb Smirnoff if (bf == NULL) 1404dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_XMIT, "%s: stop queue\n", __func__); 1405dc60165bSWeongyo Jeong return (bf); 1406dc60165bSWeongyo Jeong } 1407dc60165bSWeongyo Jeong 1408dc60165bSWeongyo Jeong static int 1409dc60165bSWeongyo Jeong uath_set_ledstate(struct uath_softc *sc, int connected) 1410dc60165bSWeongyo Jeong { 1411dc60165bSWeongyo Jeong 1412dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_LED, 1413dc60165bSWeongyo Jeong "set led state %sconnected\n", connected ? "" : "!"); 1414dc60165bSWeongyo Jeong connected = htobe32(connected); 1415dc60165bSWeongyo Jeong return uath_cmd_write(sc, WDCMSG_SET_LED_STATE, 1416dc60165bSWeongyo Jeong &connected, sizeof connected, 0); 1417dc60165bSWeongyo Jeong } 1418dc60165bSWeongyo Jeong 1419dc60165bSWeongyo Jeong static int 1420dc60165bSWeongyo Jeong uath_set_chan(struct uath_softc *sc, struct ieee80211_channel *c) 1421dc60165bSWeongyo Jeong { 1422dc60165bSWeongyo Jeong #ifdef UATH_DEBUG 1423*7a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 1424dc60165bSWeongyo Jeong #endif 1425dc60165bSWeongyo Jeong struct uath_cmd_reset reset; 1426dc60165bSWeongyo Jeong 1427271ae033SHans Petter Selasky memset(&reset, 0, sizeof(reset)); 1428dc60165bSWeongyo Jeong if (IEEE80211_IS_CHAN_2GHZ(c)) 1429dc60165bSWeongyo Jeong reset.flags |= htobe32(UATH_CHAN_2GHZ); 1430dc60165bSWeongyo Jeong if (IEEE80211_IS_CHAN_5GHZ(c)) 1431dc60165bSWeongyo Jeong reset.flags |= htobe32(UATH_CHAN_5GHZ); 1432dc60165bSWeongyo Jeong /* NB: 11g =>'s 11b so don't specify both OFDM and CCK */ 1433f61336e4SSam Leffler if (IEEE80211_IS_CHAN_OFDM(c)) 1434dc60165bSWeongyo Jeong reset.flags |= htobe32(UATH_CHAN_OFDM); 1435f61336e4SSam Leffler else if (IEEE80211_IS_CHAN_CCK(c)) 1436dc60165bSWeongyo Jeong reset.flags |= htobe32(UATH_CHAN_CCK); 1437dc60165bSWeongyo Jeong /* turbo can be used in either 2GHz or 5GHz */ 1438dc60165bSWeongyo Jeong if (c->ic_flags & IEEE80211_CHAN_TURBO) 1439dc60165bSWeongyo Jeong reset.flags |= htobe32(UATH_CHAN_TURBO); 1440dc60165bSWeongyo Jeong reset.freq = htobe32(c->ic_freq); 1441dc60165bSWeongyo Jeong reset.maxrdpower = htobe32(50); /* XXX */ 1442dc60165bSWeongyo Jeong reset.channelchange = htobe32(1); 1443dc60165bSWeongyo Jeong reset.keeprccontent = htobe32(0); 1444dc60165bSWeongyo Jeong 1445dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_CHANNEL, "set channel %d, flags 0x%x freq %u\n", 1446dc60165bSWeongyo Jeong ieee80211_chan2ieee(ic, c), 1447dc60165bSWeongyo Jeong be32toh(reset.flags), be32toh(reset.freq)); 1448dc60165bSWeongyo Jeong return uath_cmd_write(sc, WDCMSG_RESET, &reset, sizeof reset, 0); 1449dc60165bSWeongyo Jeong } 1450dc60165bSWeongyo Jeong 1451dc60165bSWeongyo Jeong static int 1452dc60165bSWeongyo Jeong uath_reset_tx_queues(struct uath_softc *sc) 1453dc60165bSWeongyo Jeong { 1454dc60165bSWeongyo Jeong int ac, error; 1455dc60165bSWeongyo Jeong 1456dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_RESET, "%s: reset Tx queues\n", __func__); 1457dc60165bSWeongyo Jeong for (ac = 0; ac < 4; ac++) { 1458dc60165bSWeongyo Jeong const uint32_t qid = htobe32(ac); 1459dc60165bSWeongyo Jeong 1460dc60165bSWeongyo Jeong error = uath_cmd_write(sc, WDCMSG_RELEASE_TX_QUEUE, &qid, 1461dc60165bSWeongyo Jeong sizeof qid, 0); 1462dc60165bSWeongyo Jeong if (error != 0) 1463dc60165bSWeongyo Jeong break; 1464dc60165bSWeongyo Jeong } 1465dc60165bSWeongyo Jeong return (error); 1466dc60165bSWeongyo Jeong } 1467dc60165bSWeongyo Jeong 1468dc60165bSWeongyo Jeong static int 1469dc60165bSWeongyo Jeong uath_wme_init(struct uath_softc *sc) 1470dc60165bSWeongyo Jeong { 1471dc60165bSWeongyo Jeong /* XXX get from net80211 */ 1472dc60165bSWeongyo Jeong static const struct uath_wme_settings uath_wme_11g[4] = { 1473dc60165bSWeongyo Jeong { 7, 4, 10, 0, 0 }, /* Background */ 1474dc60165bSWeongyo Jeong { 3, 4, 10, 0, 0 }, /* Best-Effort */ 1475dc60165bSWeongyo Jeong { 3, 3, 4, 26, 0 }, /* Video */ 1476dc60165bSWeongyo Jeong { 2, 2, 3, 47, 0 } /* Voice */ 1477dc60165bSWeongyo Jeong }; 1478dc60165bSWeongyo Jeong struct uath_cmd_txq_setup qinfo; 1479dc60165bSWeongyo Jeong int ac, error; 1480dc60165bSWeongyo Jeong 1481dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_WME, "%s: setup Tx queues\n", __func__); 1482dc60165bSWeongyo Jeong for (ac = 0; ac < 4; ac++) { 1483dc60165bSWeongyo Jeong qinfo.qid = htobe32(ac); 1484dc60165bSWeongyo Jeong qinfo.len = htobe32(sizeof(qinfo.attr)); 1485dc60165bSWeongyo Jeong qinfo.attr.priority = htobe32(ac); /* XXX */ 1486dc60165bSWeongyo Jeong qinfo.attr.aifs = htobe32(uath_wme_11g[ac].aifsn); 1487dc60165bSWeongyo Jeong qinfo.attr.logcwmin = htobe32(uath_wme_11g[ac].logcwmin); 1488dc60165bSWeongyo Jeong qinfo.attr.logcwmax = htobe32(uath_wme_11g[ac].logcwmax); 1489dc60165bSWeongyo Jeong qinfo.attr.bursttime = htobe32(UATH_TXOP_TO_US( 1490dc60165bSWeongyo Jeong uath_wme_11g[ac].txop)); 1491dc60165bSWeongyo Jeong qinfo.attr.mode = htobe32(uath_wme_11g[ac].acm);/*XXX? */ 1492dc60165bSWeongyo Jeong qinfo.attr.qflags = htobe32(1); /* XXX? */ 1493dc60165bSWeongyo Jeong 1494dc60165bSWeongyo Jeong error = uath_cmd_write(sc, WDCMSG_SETUP_TX_QUEUE, &qinfo, 1495dc60165bSWeongyo Jeong sizeof qinfo, 0); 1496dc60165bSWeongyo Jeong if (error != 0) 1497dc60165bSWeongyo Jeong break; 1498dc60165bSWeongyo Jeong } 1499dc60165bSWeongyo Jeong return (error); 1500dc60165bSWeongyo Jeong } 1501dc60165bSWeongyo Jeong 1502*7a79cebfSGleb Smirnoff static void 1503*7a79cebfSGleb Smirnoff uath_parent(struct ieee80211com *ic) 1504dc60165bSWeongyo Jeong { 1505d3fdd08cSAdrian Chadd struct uath_softc *sc = ic->ic_softc; 1506645e4d17SHans Petter Selasky int startall = 0; 1507645e4d17SHans Petter Selasky 1508645e4d17SHans Petter Selasky UATH_LOCK(sc); 1509*7a79cebfSGleb Smirnoff if (sc->sc_flags & UATH_FLAG_INVALID) { 1510645e4d17SHans Petter Selasky UATH_UNLOCK(sc); 1511*7a79cebfSGleb Smirnoff return; 1512*7a79cebfSGleb Smirnoff } 1513dc60165bSWeongyo Jeong 1514*7a79cebfSGleb Smirnoff if (ic->ic_nrunning > 0) { 1515*7a79cebfSGleb Smirnoff if (!(sc->sc_flags & UATH_FLAG_INITDONE)) { 1516d3fdd08cSAdrian Chadd uath_init(sc); 1517dc60165bSWeongyo Jeong startall = 1; 1518dc60165bSWeongyo Jeong } 1519*7a79cebfSGleb Smirnoff } else if (sc->sc_flags & UATH_FLAG_INITDONE) 1520*7a79cebfSGleb Smirnoff uath_stop(sc); 1521*7a79cebfSGleb Smirnoff UATH_UNLOCK(sc); 1522dc60165bSWeongyo Jeong if (startall) 1523dc60165bSWeongyo Jeong ieee80211_start_all(ic); 1524dc60165bSWeongyo Jeong } 1525dc60165bSWeongyo Jeong 1526dc60165bSWeongyo Jeong static int 1527dc60165bSWeongyo Jeong uath_tx_start(struct uath_softc *sc, struct mbuf *m0, struct ieee80211_node *ni, 1528dc60165bSWeongyo Jeong struct uath_data *data) 1529dc60165bSWeongyo Jeong { 15305efea30fSAndrew Thompson struct ieee80211vap *vap = ni->ni_vap; 1531dc60165bSWeongyo Jeong struct uath_chunk *chunk; 1532dc60165bSWeongyo Jeong struct uath_tx_desc *desc; 1533dc60165bSWeongyo Jeong const struct ieee80211_frame *wh; 1534dc60165bSWeongyo Jeong struct ieee80211_key *k; 1535dc60165bSWeongyo Jeong int framelen, msglen; 1536dc60165bSWeongyo Jeong 1537dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 1538dc60165bSWeongyo Jeong 1539dc60165bSWeongyo Jeong data->ni = ni; 1540dc60165bSWeongyo Jeong data->m = m0; 1541dc60165bSWeongyo Jeong chunk = (struct uath_chunk *)data->buf; 1542dc60165bSWeongyo Jeong desc = (struct uath_tx_desc *)(chunk + 1); 1543dc60165bSWeongyo Jeong 15445463c4a4SSam Leffler if (ieee80211_radiotap_active_vap(vap)) { 1545dc60165bSWeongyo Jeong struct uath_tx_radiotap_header *tap = &sc->sc_txtap; 1546dc60165bSWeongyo Jeong 1547dc60165bSWeongyo Jeong tap->wt_flags = 0; 1548dc60165bSWeongyo Jeong if (m0->m_flags & M_FRAG) 1549dc60165bSWeongyo Jeong tap->wt_flags |= IEEE80211_RADIOTAP_F_FRAG; 1550dc60165bSWeongyo Jeong 15515463c4a4SSam Leffler ieee80211_radiotap_tx(vap, m0); 1552dc60165bSWeongyo Jeong } 1553dc60165bSWeongyo Jeong 1554dc60165bSWeongyo Jeong wh = mtod(m0, struct ieee80211_frame *); 15555945b5f5SKevin Lo if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 1556dc60165bSWeongyo Jeong k = ieee80211_crypto_encap(ni, m0); 1557dc60165bSWeongyo Jeong if (k == NULL) { 1558dc60165bSWeongyo Jeong m_freem(m0); 1559dc60165bSWeongyo Jeong return (ENOBUFS); 1560dc60165bSWeongyo Jeong } 1561dc60165bSWeongyo Jeong 1562dc60165bSWeongyo Jeong /* packet header may have moved, reset our local pointer */ 1563dc60165bSWeongyo Jeong wh = mtod(m0, struct ieee80211_frame *); 1564dc60165bSWeongyo Jeong } 1565dc60165bSWeongyo Jeong m_copydata(m0, 0, m0->m_pkthdr.len, (uint8_t *)(desc + 1)); 1566dc60165bSWeongyo Jeong 1567dc60165bSWeongyo Jeong framelen = m0->m_pkthdr.len + IEEE80211_CRC_LEN; 1568dc60165bSWeongyo Jeong msglen = framelen + sizeof (struct uath_tx_desc); 1569dc60165bSWeongyo Jeong data->buflen = msglen + sizeof (struct uath_chunk); 1570dc60165bSWeongyo Jeong 1571dc60165bSWeongyo Jeong /* one chunk only for now */ 1572dc60165bSWeongyo Jeong chunk->seqnum = sc->sc_seqnum++; 1573dc60165bSWeongyo Jeong chunk->flags = (m0->m_flags & M_FRAG) ? 0 : UATH_CFLAGS_FINAL; 1574dc60165bSWeongyo Jeong if (m0->m_flags & M_LASTFRAG) 1575dc60165bSWeongyo Jeong chunk->flags |= UATH_CFLAGS_FINAL; 1576dc60165bSWeongyo Jeong chunk->flags = UATH_CFLAGS_FINAL; 1577dc60165bSWeongyo Jeong chunk->length = htobe16(msglen); 1578dc60165bSWeongyo Jeong 1579dc60165bSWeongyo Jeong /* fill Tx descriptor */ 1580dc60165bSWeongyo Jeong desc->msglen = htobe32(msglen); 1581dc60165bSWeongyo Jeong /* NB: to get UATH_TX_NOTIFY reply, `msgid' must be larger than 0 */ 1582dc60165bSWeongyo Jeong desc->msgid = (sc->sc_msgid++) + 1; /* don't care about endianness */ 1583dc60165bSWeongyo Jeong desc->type = htobe32(WDCMSG_SEND); 1584dc60165bSWeongyo Jeong switch (wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) { 1585dc60165bSWeongyo Jeong case IEEE80211_FC0_TYPE_CTL: 1586dc60165bSWeongyo Jeong case IEEE80211_FC0_TYPE_MGT: 1587dc60165bSWeongyo Jeong /* NB: force all management frames to highest queue */ 1588dc60165bSWeongyo Jeong if (ni->ni_flags & IEEE80211_NODE_QOS) { 1589dc60165bSWeongyo Jeong /* NB: force all management frames to highest queue */ 1590dc60165bSWeongyo Jeong desc->txqid = htobe32(WME_AC_VO | UATH_TXQID_MINRATE); 1591dc60165bSWeongyo Jeong } else 1592dc60165bSWeongyo Jeong desc->txqid = htobe32(WME_AC_BE | UATH_TXQID_MINRATE); 1593dc60165bSWeongyo Jeong break; 1594dc60165bSWeongyo Jeong case IEEE80211_FC0_TYPE_DATA: 1595dc60165bSWeongyo Jeong /* XXX multicast frames should honor mcastrate */ 1596dc60165bSWeongyo Jeong desc->txqid = htobe32(M_WME_GETAC(m0)); 1597dc60165bSWeongyo Jeong break; 1598dc60165bSWeongyo Jeong default: 1599dc60165bSWeongyo Jeong device_printf(sc->sc_dev, "bogus frame type 0x%x (%s)\n", 1600dc60165bSWeongyo Jeong wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK, __func__); 1601dc60165bSWeongyo Jeong m_freem(m0); 1602dc60165bSWeongyo Jeong return (EIO); 1603dc60165bSWeongyo Jeong } 16045efea30fSAndrew Thompson if (vap->iv_state == IEEE80211_S_AUTH || 16055efea30fSAndrew Thompson vap->iv_state == IEEE80211_S_ASSOC || 16065efea30fSAndrew Thompson vap->iv_state == IEEE80211_S_RUN) 1607dc60165bSWeongyo Jeong desc->connid = htobe32(UATH_ID_BSS); 1608dc60165bSWeongyo Jeong else 1609dc60165bSWeongyo Jeong desc->connid = htobe32(UATH_ID_INVALID); 1610dc60165bSWeongyo Jeong desc->flags = htobe32(0 /* no UATH_TX_NOTIFY */); 1611dc60165bSWeongyo Jeong desc->buflen = htobe32(m0->m_pkthdr.len); 1612dc60165bSWeongyo Jeong 1613dc60165bSWeongyo Jeong #ifdef UATH_DEBUG 1614dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_XMIT, 1615dc60165bSWeongyo Jeong "send frame ix %u framelen %d msglen %d connid 0x%x txqid 0x%x\n", 1616dc60165bSWeongyo Jeong desc->msgid, framelen, msglen, be32toh(desc->connid), 1617dc60165bSWeongyo Jeong be32toh(desc->txqid)); 1618dc60165bSWeongyo Jeong if (sc->sc_debug & UATH_DEBUG_XMIT_DUMP) 1619dc60165bSWeongyo Jeong uath_dump_cmd(data->buf, data->buflen, '+'); 1620dc60165bSWeongyo Jeong #endif 1621dc60165bSWeongyo Jeong 1622dc60165bSWeongyo Jeong STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next); 1623dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_tx_pending); 1624a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[UATH_BULK_TX]); 1625dc60165bSWeongyo Jeong 1626dc60165bSWeongyo Jeong return (0); 1627dc60165bSWeongyo Jeong } 1628dc60165bSWeongyo Jeong 1629dc60165bSWeongyo Jeong /* 1630dc60165bSWeongyo Jeong * Cleanup driver resources when we run out of buffers while processing 1631dc60165bSWeongyo Jeong * fragments; return the tx buffers allocated and drop node references. 1632dc60165bSWeongyo Jeong */ 1633dc60165bSWeongyo Jeong static void 1634dc60165bSWeongyo Jeong uath_txfrag_cleanup(struct uath_softc *sc, 1635dc60165bSWeongyo Jeong uath_datahead *frags, struct ieee80211_node *ni) 1636dc60165bSWeongyo Jeong { 1637dc60165bSWeongyo Jeong struct uath_data *bf, *next; 1638dc60165bSWeongyo Jeong 1639dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 1640dc60165bSWeongyo Jeong 1641dc60165bSWeongyo Jeong STAILQ_FOREACH_SAFE(bf, frags, next, next) { 1642dc60165bSWeongyo Jeong /* NB: bf assumed clean */ 1643dc60165bSWeongyo Jeong STAILQ_REMOVE_HEAD(frags, next); 1644dc60165bSWeongyo Jeong STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 1645dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_tx_inactive); 1646dc60165bSWeongyo Jeong ieee80211_node_decref(ni); 1647dc60165bSWeongyo Jeong } 1648dc60165bSWeongyo Jeong } 1649dc60165bSWeongyo Jeong 1650dc60165bSWeongyo Jeong /* 1651dc60165bSWeongyo Jeong * Setup xmit of a fragmented frame. Allocate a buffer for each frag and bump 1652dc60165bSWeongyo Jeong * the node reference count to reflect the held reference to be setup by 1653dc60165bSWeongyo Jeong * uath_tx_start. 1654dc60165bSWeongyo Jeong */ 1655dc60165bSWeongyo Jeong static int 1656dc60165bSWeongyo Jeong uath_txfrag_setup(struct uath_softc *sc, uath_datahead *frags, 1657dc60165bSWeongyo Jeong struct mbuf *m0, struct ieee80211_node *ni) 1658dc60165bSWeongyo Jeong { 1659dc60165bSWeongyo Jeong struct mbuf *m; 1660dc60165bSWeongyo Jeong struct uath_data *bf; 1661dc60165bSWeongyo Jeong 1662dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 1663dc60165bSWeongyo Jeong for (m = m0->m_nextpkt; m != NULL; m = m->m_nextpkt) { 1664dc60165bSWeongyo Jeong bf = uath_getbuf(sc); 1665dc60165bSWeongyo Jeong if (bf == NULL) { /* out of buffers, cleanup */ 1666dc60165bSWeongyo Jeong uath_txfrag_cleanup(sc, frags, ni); 1667dc60165bSWeongyo Jeong break; 1668dc60165bSWeongyo Jeong } 1669dc60165bSWeongyo Jeong ieee80211_node_incref(ni); 1670dc60165bSWeongyo Jeong STAILQ_INSERT_TAIL(frags, bf, next); 1671dc60165bSWeongyo Jeong } 1672dc60165bSWeongyo Jeong 1673dc60165bSWeongyo Jeong return !STAILQ_EMPTY(frags); 1674dc60165bSWeongyo Jeong } 1675dc60165bSWeongyo Jeong 1676dc60165bSWeongyo Jeong /* 1677dc60165bSWeongyo Jeong * Reclaim mbuf resources. For fragmented frames we need to claim each frag 1678dc60165bSWeongyo Jeong * chained with m_nextpkt. 1679dc60165bSWeongyo Jeong */ 1680dc60165bSWeongyo Jeong static void 1681dc60165bSWeongyo Jeong uath_freetx(struct mbuf *m) 1682dc60165bSWeongyo Jeong { 1683dc60165bSWeongyo Jeong struct mbuf *next; 1684dc60165bSWeongyo Jeong 1685dc60165bSWeongyo Jeong do { 1686dc60165bSWeongyo Jeong next = m->m_nextpkt; 1687dc60165bSWeongyo Jeong m->m_nextpkt = NULL; 1688dc60165bSWeongyo Jeong m_freem(m); 1689dc60165bSWeongyo Jeong } while ((m = next) != NULL); 1690dc60165bSWeongyo Jeong } 1691dc60165bSWeongyo Jeong 1692*7a79cebfSGleb Smirnoff static int 1693*7a79cebfSGleb Smirnoff uath_transmit(struct ieee80211com *ic, struct mbuf *m) 1694*7a79cebfSGleb Smirnoff { 1695*7a79cebfSGleb Smirnoff struct uath_softc *sc = ic->ic_softc; 1696*7a79cebfSGleb Smirnoff int error; 1697*7a79cebfSGleb Smirnoff 1698*7a79cebfSGleb Smirnoff UATH_LOCK(sc); 1699*7a79cebfSGleb Smirnoff if ((sc->sc_flags & UATH_FLAG_INITDONE) == 0) { 1700*7a79cebfSGleb Smirnoff UATH_UNLOCK(sc); 1701*7a79cebfSGleb Smirnoff return (ENXIO); 1702*7a79cebfSGleb Smirnoff } 1703*7a79cebfSGleb Smirnoff error = mbufq_enqueue(&sc->sc_snd, m); 1704*7a79cebfSGleb Smirnoff if (error) { 1705*7a79cebfSGleb Smirnoff UATH_UNLOCK(sc); 1706*7a79cebfSGleb Smirnoff return (error); 1707*7a79cebfSGleb Smirnoff } 1708*7a79cebfSGleb Smirnoff uath_start(sc); 1709*7a79cebfSGleb Smirnoff UATH_UNLOCK(sc); 1710*7a79cebfSGleb Smirnoff 1711*7a79cebfSGleb Smirnoff return (0); 1712*7a79cebfSGleb Smirnoff } 1713*7a79cebfSGleb Smirnoff 1714dc60165bSWeongyo Jeong static void 1715*7a79cebfSGleb Smirnoff uath_start(struct uath_softc *sc) 1716dc60165bSWeongyo Jeong { 1717dc60165bSWeongyo Jeong struct uath_data *bf; 1718dc60165bSWeongyo Jeong struct ieee80211_node *ni; 1719dc60165bSWeongyo Jeong struct mbuf *m, *next; 1720dc60165bSWeongyo Jeong uath_datahead frags; 1721dc60165bSWeongyo Jeong 1722*7a79cebfSGleb Smirnoff UATH_ASSERT_LOCKED(sc); 1723*7a79cebfSGleb Smirnoff 1724*7a79cebfSGleb Smirnoff if ((sc->sc_flags & UATH_FLAG_INITDONE) == 0 || 1725dc60165bSWeongyo Jeong (sc->sc_flags & UATH_FLAG_INVALID)) 1726dc60165bSWeongyo Jeong return; 1727dc60165bSWeongyo Jeong 1728*7a79cebfSGleb Smirnoff while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) { 1729dc60165bSWeongyo Jeong bf = uath_getbuf(sc); 1730*7a79cebfSGleb Smirnoff if (bf == NULL) { 1731*7a79cebfSGleb Smirnoff mbufq_prepend(&sc->sc_snd, m); 1732dc60165bSWeongyo Jeong break; 1733dc60165bSWeongyo Jeong } 1734*7a79cebfSGleb Smirnoff 1735dc60165bSWeongyo Jeong ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 1736dc60165bSWeongyo Jeong m->m_pkthdr.rcvif = NULL; 1737dc60165bSWeongyo Jeong 1738dc60165bSWeongyo Jeong /* 1739dc60165bSWeongyo Jeong * Check for fragmentation. If this frame has been broken up 1740dc60165bSWeongyo Jeong * verify we have enough buffers to send all the fragments 1741dc60165bSWeongyo Jeong * so all go out or none... 1742dc60165bSWeongyo Jeong */ 1743dc60165bSWeongyo Jeong STAILQ_INIT(&frags); 1744dc60165bSWeongyo Jeong if ((m->m_flags & M_FRAG) && 1745dc60165bSWeongyo Jeong !uath_txfrag_setup(sc, &frags, m, ni)) { 1746dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_XMIT, 1747dc60165bSWeongyo Jeong "%s: out of txfrag buffers\n", __func__); 1748dc60165bSWeongyo Jeong uath_freetx(m); 1749dc60165bSWeongyo Jeong goto bad; 1750dc60165bSWeongyo Jeong } 1751dc60165bSWeongyo Jeong sc->sc_seqnum = 0; 1752dc60165bSWeongyo Jeong nextfrag: 1753dc60165bSWeongyo Jeong /* 1754dc60165bSWeongyo Jeong * Pass the frame to the h/w for transmission. 1755dc60165bSWeongyo Jeong * Fragmented frames have each frag chained together 1756dc60165bSWeongyo Jeong * with m_nextpkt. We know there are sufficient uath_data's 1757dc60165bSWeongyo Jeong * to send all the frags because of work done by 1758dc60165bSWeongyo Jeong * uath_txfrag_setup. 1759dc60165bSWeongyo Jeong */ 1760dc60165bSWeongyo Jeong next = m->m_nextpkt; 1761dc60165bSWeongyo Jeong if (uath_tx_start(sc, m, ni, bf) != 0) { 1762dc60165bSWeongyo Jeong bad: 1763*7a79cebfSGleb Smirnoff if_inc_counter(ni->ni_vap->iv_ifp, 1764*7a79cebfSGleb Smirnoff IFCOUNTER_OERRORS, 1); 1765dc60165bSWeongyo Jeong reclaim: 1766dc60165bSWeongyo Jeong STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 1767dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_tx_inactive); 1768dc60165bSWeongyo Jeong uath_txfrag_cleanup(sc, &frags, ni); 1769dc60165bSWeongyo Jeong ieee80211_free_node(ni); 1770dc60165bSWeongyo Jeong continue; 1771dc60165bSWeongyo Jeong } 1772dc60165bSWeongyo Jeong 1773dc60165bSWeongyo Jeong if (next != NULL) { 1774dc60165bSWeongyo Jeong /* 1775dc60165bSWeongyo Jeong * Beware of state changing between frags. 1776dc60165bSWeongyo Jeong XXX check sta power-save state? 1777dc60165bSWeongyo Jeong */ 1778dc60165bSWeongyo Jeong if (ni->ni_vap->iv_state != IEEE80211_S_RUN) { 1779dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_XMIT, 1780dc60165bSWeongyo Jeong "%s: flush fragmented packet, state %s\n", 1781dc60165bSWeongyo Jeong __func__, 1782dc60165bSWeongyo Jeong ieee80211_state_name[ni->ni_vap->iv_state]); 1783dc60165bSWeongyo Jeong uath_freetx(next); 1784dc60165bSWeongyo Jeong goto reclaim; 1785dc60165bSWeongyo Jeong } 1786dc60165bSWeongyo Jeong m = next; 1787dc60165bSWeongyo Jeong bf = STAILQ_FIRST(&frags); 1788dc60165bSWeongyo Jeong KASSERT(bf != NULL, ("no buf for txfrag")); 1789dc60165bSWeongyo Jeong STAILQ_REMOVE_HEAD(&frags, next); 1790dc60165bSWeongyo Jeong goto nextfrag; 1791dc60165bSWeongyo Jeong } 1792dc60165bSWeongyo Jeong 1793dc60165bSWeongyo Jeong sc->sc_tx_timer = 5; 1794dc60165bSWeongyo Jeong } 1795dc60165bSWeongyo Jeong } 1796dc60165bSWeongyo Jeong 1797dc60165bSWeongyo Jeong static int 1798dc60165bSWeongyo Jeong uath_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 1799dc60165bSWeongyo Jeong const struct ieee80211_bpf_params *params) 1800dc60165bSWeongyo Jeong { 1801dc60165bSWeongyo Jeong struct ieee80211com *ic = ni->ni_ic; 1802dc60165bSWeongyo Jeong struct uath_data *bf; 1803d3fdd08cSAdrian Chadd struct uath_softc *sc = ic->ic_softc; 1804dc60165bSWeongyo Jeong 1805*7a79cebfSGleb Smirnoff UATH_LOCK(sc); 1806dc60165bSWeongyo Jeong /* prevent management frames from being sent if we're not ready */ 1807c39515adSWeongyo Jeong if ((sc->sc_flags & UATH_FLAG_INVALID) || 1808*7a79cebfSGleb Smirnoff !(sc->sc_flags & UATH_FLAG_INITDONE)) { 1809dc60165bSWeongyo Jeong m_freem(m); 1810dc60165bSWeongyo Jeong ieee80211_free_node(ni); 1811*7a79cebfSGleb Smirnoff UATH_UNLOCK(sc); 1812dc60165bSWeongyo Jeong return (ENETDOWN); 1813dc60165bSWeongyo Jeong } 1814dc60165bSWeongyo Jeong 1815dc60165bSWeongyo Jeong /* grab a TX buffer */ 1816dc60165bSWeongyo Jeong bf = uath_getbuf(sc); 1817dc60165bSWeongyo Jeong if (bf == NULL) { 1818dc60165bSWeongyo Jeong ieee80211_free_node(ni); 1819dc60165bSWeongyo Jeong m_freem(m); 1820dc60165bSWeongyo Jeong UATH_UNLOCK(sc); 1821dc60165bSWeongyo Jeong return (ENOBUFS); 1822dc60165bSWeongyo Jeong } 1823dc60165bSWeongyo Jeong 1824dc60165bSWeongyo Jeong sc->sc_seqnum = 0; 1825dc60165bSWeongyo Jeong if (uath_tx_start(sc, m, ni, bf) != 0) { 1826dc60165bSWeongyo Jeong ieee80211_free_node(ni); 1827dc60165bSWeongyo Jeong STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 1828dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_tx_inactive); 1829dc60165bSWeongyo Jeong UATH_UNLOCK(sc); 1830dc60165bSWeongyo Jeong return (EIO); 1831dc60165bSWeongyo Jeong } 1832dc60165bSWeongyo Jeong UATH_UNLOCK(sc); 1833dc60165bSWeongyo Jeong 1834dc60165bSWeongyo Jeong sc->sc_tx_timer = 5; 1835dc60165bSWeongyo Jeong return (0); 1836dc60165bSWeongyo Jeong } 1837dc60165bSWeongyo Jeong 1838dc60165bSWeongyo Jeong static void 1839dc60165bSWeongyo Jeong uath_scan_start(struct ieee80211com *ic) 1840dc60165bSWeongyo Jeong { 1841dc60165bSWeongyo Jeong /* do nothing */ 1842dc60165bSWeongyo Jeong } 1843dc60165bSWeongyo Jeong 1844dc60165bSWeongyo Jeong static void 1845dc60165bSWeongyo Jeong uath_scan_end(struct ieee80211com *ic) 1846dc60165bSWeongyo Jeong { 1847dc60165bSWeongyo Jeong /* do nothing */ 1848dc60165bSWeongyo Jeong } 1849dc60165bSWeongyo Jeong 1850dc60165bSWeongyo Jeong static void 1851dc60165bSWeongyo Jeong uath_set_channel(struct ieee80211com *ic) 1852dc60165bSWeongyo Jeong { 1853d3fdd08cSAdrian Chadd struct uath_softc *sc = ic->ic_softc; 1854dc60165bSWeongyo Jeong 1855dc60165bSWeongyo Jeong UATH_LOCK(sc); 1856c39515adSWeongyo Jeong if ((sc->sc_flags & UATH_FLAG_INVALID) || 1857*7a79cebfSGleb Smirnoff (sc->sc_flags & UATH_FLAG_INITDONE) == 0) { 1858c39515adSWeongyo Jeong UATH_UNLOCK(sc); 1859c39515adSWeongyo Jeong return; 1860c39515adSWeongyo Jeong } 1861dc60165bSWeongyo Jeong (void)uath_switch_channel(sc, ic->ic_curchan); 1862dc60165bSWeongyo Jeong UATH_UNLOCK(sc); 1863dc60165bSWeongyo Jeong } 1864dc60165bSWeongyo Jeong 1865dc60165bSWeongyo Jeong static int 1866dc60165bSWeongyo Jeong uath_set_rxmulti_filter(struct uath_softc *sc) 1867dc60165bSWeongyo Jeong { 18685463c4a4SSam Leffler /* XXX broken */ 1869dc60165bSWeongyo Jeong return (0); 1870dc60165bSWeongyo Jeong } 1871dc60165bSWeongyo Jeong static void 1872272f6adeSGleb Smirnoff uath_update_mcast(struct ieee80211com *ic) 1873dc60165bSWeongyo Jeong { 1874272f6adeSGleb Smirnoff struct uath_softc *sc = ic->ic_softc; 1875dc60165bSWeongyo Jeong 18765463c4a4SSam Leffler UATH_LOCK(sc); 1877c39515adSWeongyo Jeong if ((sc->sc_flags & UATH_FLAG_INVALID) || 1878*7a79cebfSGleb Smirnoff (sc->sc_flags & UATH_FLAG_INITDONE) == 0) { 1879c39515adSWeongyo Jeong UATH_UNLOCK(sc); 1880c39515adSWeongyo Jeong return; 1881c39515adSWeongyo Jeong } 1882dc60165bSWeongyo Jeong /* 1883dc60165bSWeongyo Jeong * this is for avoiding the race condition when we're try to 1884dc60165bSWeongyo Jeong * connect to the AP with WPA. 1885dc60165bSWeongyo Jeong */ 18865463c4a4SSam Leffler if (sc->sc_flags & UATH_FLAG_INITDONE) 1887dc60165bSWeongyo Jeong (void)uath_set_rxmulti_filter(sc); 18885463c4a4SSam Leffler UATH_UNLOCK(sc); 1889dc60165bSWeongyo Jeong } 1890dc60165bSWeongyo Jeong 1891dc60165bSWeongyo Jeong static void 1892272f6adeSGleb Smirnoff uath_update_promisc(struct ieee80211com *ic) 1893dc60165bSWeongyo Jeong { 1894272f6adeSGleb Smirnoff struct uath_softc *sc = ic->ic_softc; 1895dc60165bSWeongyo Jeong 18965463c4a4SSam Leffler UATH_LOCK(sc); 1897c39515adSWeongyo Jeong if ((sc->sc_flags & UATH_FLAG_INVALID) || 1898*7a79cebfSGleb Smirnoff (sc->sc_flags & UATH_FLAG_INITDONE) == 0) { 1899c39515adSWeongyo Jeong UATH_UNLOCK(sc); 1900c39515adSWeongyo Jeong return; 1901c39515adSWeongyo Jeong } 19025463c4a4SSam Leffler if (sc->sc_flags & UATH_FLAG_INITDONE) { 1903dc60165bSWeongyo Jeong uath_set_rxfilter(sc, 1904dc60165bSWeongyo Jeong UATH_FILTER_RX_UCAST | UATH_FILTER_RX_MCAST | 1905dc60165bSWeongyo Jeong UATH_FILTER_RX_BCAST | UATH_FILTER_RX_BEACON | 1906dc60165bSWeongyo Jeong UATH_FILTER_RX_PROM, UATH_FILTER_OP_SET); 1907dc60165bSWeongyo Jeong } 19085463c4a4SSam Leffler UATH_UNLOCK(sc); 19095463c4a4SSam Leffler } 1910dc60165bSWeongyo Jeong 1911dc60165bSWeongyo Jeong static int 1912dc60165bSWeongyo Jeong uath_create_connection(struct uath_softc *sc, uint32_t connid) 1913dc60165bSWeongyo Jeong { 1914dc60165bSWeongyo Jeong const struct ieee80211_rateset *rs; 1915*7a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 1916dc60165bSWeongyo Jeong struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 19178d8bdb01SAndrew Thompson struct ieee80211_node *ni; 1918dc60165bSWeongyo Jeong struct uath_cmd_create_connection create; 1919dc60165bSWeongyo Jeong 19208d8bdb01SAndrew Thompson ni = ieee80211_ref_node(vap->iv_bss); 1921271ae033SHans Petter Selasky memset(&create, 0, sizeof(create)); 1922dc60165bSWeongyo Jeong create.connid = htobe32(connid); 1923dc60165bSWeongyo Jeong create.bssid = htobe32(0); 1924dc60165bSWeongyo Jeong /* XXX packed or not? */ 1925dc60165bSWeongyo Jeong create.size = htobe32(sizeof(struct uath_cmd_rateset)); 1926dc60165bSWeongyo Jeong 1927dc60165bSWeongyo Jeong rs = &ni->ni_rates; 1928dc60165bSWeongyo Jeong create.connattr.rateset.length = rs->rs_nrates; 1929dc60165bSWeongyo Jeong bcopy(rs->rs_rates, &create.connattr.rateset.set[0], 1930dc60165bSWeongyo Jeong rs->rs_nrates); 1931dc60165bSWeongyo Jeong 1932dc60165bSWeongyo Jeong /* XXX turbo */ 1933dc60165bSWeongyo Jeong if (IEEE80211_IS_CHAN_A(ni->ni_chan)) 1934dc60165bSWeongyo Jeong create.connattr.wlanmode = htobe32(WLAN_MODE_11a); 1935dc60165bSWeongyo Jeong else if (IEEE80211_IS_CHAN_ANYG(ni->ni_chan)) 1936dc60165bSWeongyo Jeong create.connattr.wlanmode = htobe32(WLAN_MODE_11g); 1937dc60165bSWeongyo Jeong else 1938dc60165bSWeongyo Jeong create.connattr.wlanmode = htobe32(WLAN_MODE_11b); 19398d8bdb01SAndrew Thompson ieee80211_free_node(ni); 1940dc60165bSWeongyo Jeong 1941dc60165bSWeongyo Jeong return uath_cmd_write(sc, WDCMSG_CREATE_CONNECTION, &create, 1942dc60165bSWeongyo Jeong sizeof create, 0); 1943dc60165bSWeongyo Jeong } 1944dc60165bSWeongyo Jeong 1945dc60165bSWeongyo Jeong static int 1946dc60165bSWeongyo Jeong uath_set_rates(struct uath_softc *sc, const struct ieee80211_rateset *rs) 1947dc60165bSWeongyo Jeong { 1948dc60165bSWeongyo Jeong struct uath_cmd_rates rates; 1949dc60165bSWeongyo Jeong 1950271ae033SHans Petter Selasky memset(&rates, 0, sizeof(rates)); 1951dc60165bSWeongyo Jeong rates.connid = htobe32(UATH_ID_BSS); /* XXX */ 1952dc60165bSWeongyo Jeong rates.size = htobe32(sizeof(struct uath_cmd_rateset)); 1953dc60165bSWeongyo Jeong /* XXX bounds check rs->rs_nrates */ 1954dc60165bSWeongyo Jeong rates.rateset.length = rs->rs_nrates; 1955dc60165bSWeongyo Jeong bcopy(rs->rs_rates, &rates.rateset.set[0], rs->rs_nrates); 1956dc60165bSWeongyo Jeong 1957dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_RATES, 1958dc60165bSWeongyo Jeong "setting supported rates nrates=%d\n", rs->rs_nrates); 1959dc60165bSWeongyo Jeong return uath_cmd_write(sc, WDCMSG_SET_BASIC_RATE, 1960dc60165bSWeongyo Jeong &rates, sizeof rates, 0); 1961dc60165bSWeongyo Jeong } 1962dc60165bSWeongyo Jeong 1963dc60165bSWeongyo Jeong static int 1964dc60165bSWeongyo Jeong uath_write_associd(struct uath_softc *sc) 1965dc60165bSWeongyo Jeong { 1966*7a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 1967dc60165bSWeongyo Jeong struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 19688d8bdb01SAndrew Thompson struct ieee80211_node *ni; 1969dc60165bSWeongyo Jeong struct uath_cmd_set_associd associd; 1970dc60165bSWeongyo Jeong 19718d8bdb01SAndrew Thompson ni = ieee80211_ref_node(vap->iv_bss); 1972271ae033SHans Petter Selasky memset(&associd, 0, sizeof(associd)); 1973dc60165bSWeongyo Jeong associd.defaultrateix = htobe32(1); /* XXX */ 1974dc60165bSWeongyo Jeong associd.associd = htobe32(ni->ni_associd); 1975dc60165bSWeongyo Jeong associd.timoffset = htobe32(0x3b); /* XXX */ 1976dc60165bSWeongyo Jeong IEEE80211_ADDR_COPY(associd.bssid, ni->ni_bssid); 19778d8bdb01SAndrew Thompson ieee80211_free_node(ni); 1978dc60165bSWeongyo Jeong return uath_cmd_write(sc, WDCMSG_WRITE_ASSOCID, &associd, 1979dc60165bSWeongyo Jeong sizeof associd, 0); 1980dc60165bSWeongyo Jeong } 1981dc60165bSWeongyo Jeong 1982dc60165bSWeongyo Jeong static int 1983dc60165bSWeongyo Jeong uath_set_ledsteady(struct uath_softc *sc, int lednum, int ledmode) 1984dc60165bSWeongyo Jeong { 1985dc60165bSWeongyo Jeong struct uath_cmd_ledsteady led; 1986dc60165bSWeongyo Jeong 1987dc60165bSWeongyo Jeong led.lednum = htobe32(lednum); 1988dc60165bSWeongyo Jeong led.ledmode = htobe32(ledmode); 1989dc60165bSWeongyo Jeong 1990dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_LED, "set %s led %s (steady)\n", 1991dc60165bSWeongyo Jeong (lednum == UATH_LED_LINK) ? "link" : "activity", 1992dc60165bSWeongyo Jeong ledmode ? "on" : "off"); 1993dc60165bSWeongyo Jeong return uath_cmd_write(sc, WDCMSG_SET_LED_STEADY, &led, sizeof led, 0); 1994dc60165bSWeongyo Jeong } 1995dc60165bSWeongyo Jeong 1996dc60165bSWeongyo Jeong static int 1997dc60165bSWeongyo Jeong uath_set_ledblink(struct uath_softc *sc, int lednum, int ledmode, 1998dc60165bSWeongyo Jeong int blinkrate, int slowmode) 1999dc60165bSWeongyo Jeong { 2000dc60165bSWeongyo Jeong struct uath_cmd_ledblink led; 2001dc60165bSWeongyo Jeong 2002dc60165bSWeongyo Jeong led.lednum = htobe32(lednum); 2003dc60165bSWeongyo Jeong led.ledmode = htobe32(ledmode); 2004dc60165bSWeongyo Jeong led.blinkrate = htobe32(blinkrate); 2005dc60165bSWeongyo Jeong led.slowmode = htobe32(slowmode); 2006dc60165bSWeongyo Jeong 2007dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_LED, "set %s led %s (blink)\n", 2008dc60165bSWeongyo Jeong (lednum == UATH_LED_LINK) ? "link" : "activity", 2009dc60165bSWeongyo Jeong ledmode ? "on" : "off"); 2010dc60165bSWeongyo Jeong return uath_cmd_write(sc, WDCMSG_SET_LED_BLINK, &led, sizeof led, 0); 2011dc60165bSWeongyo Jeong } 2012dc60165bSWeongyo Jeong 2013dc60165bSWeongyo Jeong static int 2014dc60165bSWeongyo Jeong uath_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 2015dc60165bSWeongyo Jeong { 2016dc60165bSWeongyo Jeong enum ieee80211_state ostate = vap->iv_state; 2017dc60165bSWeongyo Jeong int error; 20188d8bdb01SAndrew Thompson struct ieee80211_node *ni; 2019dc60165bSWeongyo Jeong struct ieee80211com *ic = vap->iv_ic; 2020d3fdd08cSAdrian Chadd struct uath_softc *sc = ic->ic_softc; 2021dc60165bSWeongyo Jeong struct uath_vap *uvp = UATH_VAP(vap); 2022dc60165bSWeongyo Jeong 2023dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_STATE, 2024dc60165bSWeongyo Jeong "%s: %s -> %s\n", __func__, ieee80211_state_name[vap->iv_state], 2025dc60165bSWeongyo Jeong ieee80211_state_name[nstate]); 2026dc60165bSWeongyo Jeong 20275efea30fSAndrew Thompson IEEE80211_UNLOCK(ic); 2028dc60165bSWeongyo Jeong UATH_LOCK(sc); 2029dc60165bSWeongyo Jeong callout_stop(&sc->stat_ch); 2030dc60165bSWeongyo Jeong callout_stop(&sc->watchdog_ch); 20318d8bdb01SAndrew Thompson ni = ieee80211_ref_node(vap->iv_bss); 2032dc60165bSWeongyo Jeong 2033dc60165bSWeongyo Jeong switch (nstate) { 2034dc60165bSWeongyo Jeong case IEEE80211_S_INIT: 2035dc60165bSWeongyo Jeong if (ostate == IEEE80211_S_RUN) { 2036dc60165bSWeongyo Jeong /* turn link and activity LEDs off */ 2037dc60165bSWeongyo Jeong uath_set_ledstate(sc, 0); 2038dc60165bSWeongyo Jeong } 2039dc60165bSWeongyo Jeong break; 2040dc60165bSWeongyo Jeong 2041dc60165bSWeongyo Jeong case IEEE80211_S_SCAN: 2042dc60165bSWeongyo Jeong break; 2043dc60165bSWeongyo Jeong 2044dc60165bSWeongyo Jeong case IEEE80211_S_AUTH: 2045dc60165bSWeongyo Jeong /* XXX good place? set RTS threshold */ 2046dc60165bSWeongyo Jeong uath_config(sc, CFG_USER_RTS_THRESHOLD, vap->iv_rtsthreshold); 2047dc60165bSWeongyo Jeong /* XXX bad place */ 2048dc60165bSWeongyo Jeong error = uath_set_keys(sc, vap); 2049dc60165bSWeongyo Jeong if (error != 0) { 2050dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 2051dc60165bSWeongyo Jeong "could not set crypto keys, error %d\n", error); 2052dc60165bSWeongyo Jeong break; 2053dc60165bSWeongyo Jeong } 2054dc60165bSWeongyo Jeong if (uath_switch_channel(sc, ni->ni_chan) != 0) { 2055dc60165bSWeongyo Jeong device_printf(sc->sc_dev, "could not switch channel\n"); 2056dc60165bSWeongyo Jeong break; 2057dc60165bSWeongyo Jeong } 2058dc60165bSWeongyo Jeong if (uath_create_connection(sc, UATH_ID_BSS) != 0) { 2059dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 2060dc60165bSWeongyo Jeong "could not create connection\n"); 2061dc60165bSWeongyo Jeong break; 2062dc60165bSWeongyo Jeong } 2063dc60165bSWeongyo Jeong break; 2064dc60165bSWeongyo Jeong 2065dc60165bSWeongyo Jeong case IEEE80211_S_ASSOC: 2066dc60165bSWeongyo Jeong if (uath_set_rates(sc, &ni->ni_rates) != 0) { 2067dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 2068dc60165bSWeongyo Jeong "could not set negotiated rate set\n"); 2069dc60165bSWeongyo Jeong break; 2070dc60165bSWeongyo Jeong } 2071dc60165bSWeongyo Jeong break; 2072dc60165bSWeongyo Jeong 2073dc60165bSWeongyo Jeong case IEEE80211_S_RUN: 2074dc60165bSWeongyo Jeong /* XXX monitor mode doesn't be tested */ 2075dc60165bSWeongyo Jeong if (ic->ic_opmode == IEEE80211_M_MONITOR) { 2076dc60165bSWeongyo Jeong uath_set_ledstate(sc, 1); 2077dc60165bSWeongyo Jeong break; 2078dc60165bSWeongyo Jeong } 2079dc60165bSWeongyo Jeong 2080dc60165bSWeongyo Jeong /* 2081dc60165bSWeongyo Jeong * Tx rate is controlled by firmware, report the maximum 2082dc60165bSWeongyo Jeong * negotiated rate in ifconfig output. 2083dc60165bSWeongyo Jeong */ 2084dc60165bSWeongyo Jeong ni->ni_txrate = ni->ni_rates.rs_rates[ni->ni_rates.rs_nrates-1]; 2085dc60165bSWeongyo Jeong 2086dc60165bSWeongyo Jeong if (uath_write_associd(sc) != 0) { 2087dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 2088dc60165bSWeongyo Jeong "could not write association id\n"); 2089dc60165bSWeongyo Jeong break; 2090dc60165bSWeongyo Jeong } 2091dc60165bSWeongyo Jeong /* turn link LED on */ 2092dc60165bSWeongyo Jeong uath_set_ledsteady(sc, UATH_LED_LINK, UATH_LED_ON); 2093dc60165bSWeongyo Jeong /* make activity LED blink */ 2094dc60165bSWeongyo Jeong uath_set_ledblink(sc, UATH_LED_ACTIVITY, UATH_LED_ON, 1, 2); 2095dc60165bSWeongyo Jeong /* set state to associated */ 2096dc60165bSWeongyo Jeong uath_set_ledstate(sc, 1); 2097dc60165bSWeongyo Jeong 2098dc60165bSWeongyo Jeong /* start statistics timer */ 2099dc60165bSWeongyo Jeong callout_reset(&sc->stat_ch, hz, uath_stat, sc); 2100dc60165bSWeongyo Jeong break; 2101dc60165bSWeongyo Jeong default: 2102dc60165bSWeongyo Jeong break; 2103dc60165bSWeongyo Jeong } 21048d8bdb01SAndrew Thompson ieee80211_free_node(ni); 2105dc60165bSWeongyo Jeong UATH_UNLOCK(sc); 2106dc60165bSWeongyo Jeong IEEE80211_LOCK(ic); 21075efea30fSAndrew Thompson return (uvp->newstate(vap, nstate, arg)); 2108dc60165bSWeongyo Jeong } 2109dc60165bSWeongyo Jeong 2110dc60165bSWeongyo Jeong static int 2111dc60165bSWeongyo Jeong uath_set_key(struct uath_softc *sc, const struct ieee80211_key *wk, 2112dc60165bSWeongyo Jeong int index) 2113dc60165bSWeongyo Jeong { 2114dc60165bSWeongyo Jeong #if 0 2115dc60165bSWeongyo Jeong struct uath_cmd_crypto crypto; 2116dc60165bSWeongyo Jeong int i; 2117dc60165bSWeongyo Jeong 2118271ae033SHans Petter Selasky memset(&crypto, 0, sizeof(crypto)); 2119dc60165bSWeongyo Jeong crypto.keyidx = htobe32(index); 2120dc60165bSWeongyo Jeong crypto.magic1 = htobe32(1); 2121dc60165bSWeongyo Jeong crypto.size = htobe32(368); 2122dc60165bSWeongyo Jeong crypto.mask = htobe32(0xffff); 2123dc60165bSWeongyo Jeong crypto.flags = htobe32(0x80000068); 2124dc60165bSWeongyo Jeong if (index != UATH_DEFAULT_KEY) 2125dc60165bSWeongyo Jeong crypto.flags |= htobe32(index << 16); 2126271ae033SHans Petter Selasky memset(crypto.magic2, 0xff, sizeof(crypto.magic2)); 2127dc60165bSWeongyo Jeong 2128dc60165bSWeongyo Jeong /* 2129dc60165bSWeongyo Jeong * Each byte of the key must be XOR'ed with 10101010 before being 2130dc60165bSWeongyo Jeong * transmitted to the firmware. 2131dc60165bSWeongyo Jeong */ 2132dc60165bSWeongyo Jeong for (i = 0; i < wk->wk_keylen; i++) 2133dc60165bSWeongyo Jeong crypto.key[i] = wk->wk_key[i] ^ 0xaa; 2134dc60165bSWeongyo Jeong 2135dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_CRYPTO, 2136dc60165bSWeongyo Jeong "setting crypto key index=%d len=%d\n", index, wk->wk_keylen); 2137dc60165bSWeongyo Jeong return uath_cmd_write(sc, WDCMSG_SET_KEY_CACHE_ENTRY, &crypto, 2138dc60165bSWeongyo Jeong sizeof crypto, 0); 2139dc60165bSWeongyo Jeong #else 2140dc60165bSWeongyo Jeong /* XXX support H/W cryto */ 2141dc60165bSWeongyo Jeong return (0); 2142dc60165bSWeongyo Jeong #endif 2143dc60165bSWeongyo Jeong } 2144dc60165bSWeongyo Jeong 2145dc60165bSWeongyo Jeong static int 2146dc60165bSWeongyo Jeong uath_set_keys(struct uath_softc *sc, struct ieee80211vap *vap) 2147dc60165bSWeongyo Jeong { 2148dc60165bSWeongyo Jeong int i, error; 2149dc60165bSWeongyo Jeong 2150dc60165bSWeongyo Jeong error = 0; 2151dc60165bSWeongyo Jeong for (i = 0; i < IEEE80211_WEP_NKID; i++) { 2152dc60165bSWeongyo Jeong const struct ieee80211_key *wk = &vap->iv_nw_keys[i]; 2153dc60165bSWeongyo Jeong 2154dc60165bSWeongyo Jeong if (wk->wk_flags & (IEEE80211_KEY_XMIT|IEEE80211_KEY_RECV)) { 2155dc60165bSWeongyo Jeong error = uath_set_key(sc, wk, i); 2156dc60165bSWeongyo Jeong if (error) 2157dc60165bSWeongyo Jeong return (error); 2158dc60165bSWeongyo Jeong } 2159dc60165bSWeongyo Jeong } 2160dc60165bSWeongyo Jeong if (vap->iv_def_txkey != IEEE80211_KEYIX_NONE) { 2161dc60165bSWeongyo Jeong error = uath_set_key(sc, &vap->iv_nw_keys[vap->iv_def_txkey], 2162dc60165bSWeongyo Jeong UATH_DEFAULT_KEY); 2163dc60165bSWeongyo Jeong } 2164dc60165bSWeongyo Jeong return (error); 2165dc60165bSWeongyo Jeong } 2166dc60165bSWeongyo Jeong 2167dc60165bSWeongyo Jeong #define UATH_SYSCTL_STAT_ADD32(c, h, n, p, d) \ 2168dc60165bSWeongyo Jeong SYSCTL_ADD_UINT(c, h, OID_AUTO, n, CTLFLAG_RD, p, 0, d) 2169dc60165bSWeongyo Jeong 2170dc60165bSWeongyo Jeong static void 2171dc60165bSWeongyo Jeong uath_sysctl_node(struct uath_softc *sc) 2172dc60165bSWeongyo Jeong { 2173dc60165bSWeongyo Jeong struct sysctl_ctx_list *ctx; 2174dc60165bSWeongyo Jeong struct sysctl_oid_list *child; 2175dc60165bSWeongyo Jeong struct sysctl_oid *tree; 2176dc60165bSWeongyo Jeong struct uath_stat *stats; 2177dc60165bSWeongyo Jeong 2178dc60165bSWeongyo Jeong stats = &sc->sc_stat; 2179dc60165bSWeongyo Jeong ctx = device_get_sysctl_ctx(sc->sc_dev); 2180dc60165bSWeongyo Jeong child = SYSCTL_CHILDREN(device_get_sysctl_tree(sc->sc_dev)); 2181dc60165bSWeongyo Jeong 2182dc60165bSWeongyo Jeong tree = SYSCTL_ADD_NODE(ctx, child, OID_AUTO, "stats", CTLFLAG_RD, 2183dc60165bSWeongyo Jeong NULL, "UATH statistics"); 2184dc60165bSWeongyo Jeong child = SYSCTL_CHILDREN(tree); 2185dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "badchunkseqnum", 2186dc60165bSWeongyo Jeong &stats->st_badchunkseqnum, "Bad chunk sequence numbers"); 2187dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "invalidlen", &stats->st_invalidlen, 2188dc60165bSWeongyo Jeong "Invalid length"); 2189dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "multichunk", &stats->st_multichunk, 2190dc60165bSWeongyo Jeong "Multi chunks"); 2191dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "toobigrxpkt", 2192dc60165bSWeongyo Jeong &stats->st_toobigrxpkt, "Too big rx packets"); 2193dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "stopinprogress", 2194dc60165bSWeongyo Jeong &stats->st_stopinprogress, "Stop in progress"); 2195dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "crcerrs", &stats->st_crcerr, 2196dc60165bSWeongyo Jeong "CRC errors"); 2197dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "phyerr", &stats->st_phyerr, 2198dc60165bSWeongyo Jeong "PHY errors"); 2199dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "decrypt_crcerr", 2200dc60165bSWeongyo Jeong &stats->st_decrypt_crcerr, "Decryption CRC errors"); 2201dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "decrypt_micerr", 2202dc60165bSWeongyo Jeong &stats->st_decrypt_micerr, "Decryption Misc errors"); 2203dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "decomperr", &stats->st_decomperr, 2204dc60165bSWeongyo Jeong "Decomp errors"); 2205dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "keyerr", &stats->st_keyerr, 2206dc60165bSWeongyo Jeong "Key errors"); 2207dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "err", &stats->st_err, 2208dc60165bSWeongyo Jeong "Unknown errors"); 2209dc60165bSWeongyo Jeong 2210dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "cmd_active", 2211dc60165bSWeongyo Jeong &stats->st_cmd_active, "Active numbers in Command queue"); 2212dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "cmd_inactive", 2213dc60165bSWeongyo Jeong &stats->st_cmd_inactive, "Inactive numbers in Command queue"); 2214dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "cmd_pending", 2215dc60165bSWeongyo Jeong &stats->st_cmd_pending, "Pending numbers in Command queue"); 2216dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "cmd_waiting", 2217dc60165bSWeongyo Jeong &stats->st_cmd_waiting, "Waiting numbers in Command queue"); 2218dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "rx_active", 2219dc60165bSWeongyo Jeong &stats->st_rx_active, "Active numbers in RX queue"); 2220dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "rx_inactive", 2221dc60165bSWeongyo Jeong &stats->st_rx_inactive, "Inactive numbers in RX queue"); 2222dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "tx_active", 2223dc60165bSWeongyo Jeong &stats->st_tx_active, "Active numbers in TX queue"); 2224dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "tx_inactive", 2225dc60165bSWeongyo Jeong &stats->st_tx_inactive, "Inactive numbers in TX queue"); 2226dc60165bSWeongyo Jeong UATH_SYSCTL_STAT_ADD32(ctx, child, "tx_pending", 2227dc60165bSWeongyo Jeong &stats->st_tx_pending, "Pending numbers in TX queue"); 2228dc60165bSWeongyo Jeong } 2229dc60165bSWeongyo Jeong 2230dc60165bSWeongyo Jeong #undef UATH_SYSCTL_STAT_ADD32 2231dc60165bSWeongyo Jeong 2232dc60165bSWeongyo Jeong static void 2233dc60165bSWeongyo Jeong uath_cmdeof(struct uath_softc *sc, struct uath_cmd *cmd) 2234dc60165bSWeongyo Jeong { 2235dc60165bSWeongyo Jeong struct uath_cmd_hdr *hdr; 2236dc60165bSWeongyo Jeong int dlen; 2237dc60165bSWeongyo Jeong 2238dc60165bSWeongyo Jeong hdr = (struct uath_cmd_hdr *)cmd->buf; 2239dc60165bSWeongyo Jeong /* NB: msgid is passed thru w/o byte swapping */ 2240dc60165bSWeongyo Jeong #ifdef UATH_DEBUG 2241dc60165bSWeongyo Jeong if (sc->sc_debug & UATH_DEBUG_CMDS) { 2242dc60165bSWeongyo Jeong int len = be32toh(hdr->len); 2243dc60165bSWeongyo Jeong printf("%s: %s [ix %u] len %u status %u\n", 2244dc60165bSWeongyo Jeong __func__, uath_codename(be32toh(hdr->code)), 2245dc60165bSWeongyo Jeong hdr->msgid, len, be32toh(hdr->magic)); 2246dc60165bSWeongyo Jeong if (sc->sc_debug & UATH_DEBUG_CMDS_DUMP) 2247dc60165bSWeongyo Jeong uath_dump_cmd(cmd->buf, 2248dc60165bSWeongyo Jeong len > UATH_MAX_CMDSZ ? sizeof(*hdr) : len, '-'); 2249dc60165bSWeongyo Jeong } 2250dc60165bSWeongyo Jeong #endif 2251dc60165bSWeongyo Jeong hdr->code = be32toh(hdr->code); 2252dc60165bSWeongyo Jeong hdr->len = be32toh(hdr->len); 2253dc60165bSWeongyo Jeong hdr->magic = be32toh(hdr->magic); /* target status on return */ 2254dc60165bSWeongyo Jeong 2255dc60165bSWeongyo Jeong switch (hdr->code & 0xff) { 2256dc60165bSWeongyo Jeong /* reply to a read command */ 2257dc60165bSWeongyo Jeong default: 2258dc60165bSWeongyo Jeong dlen = hdr->len - sizeof(*hdr); 22596d917491SHans Petter Selasky if (dlen < 0) { 22606d917491SHans Petter Selasky device_printf(sc->sc_dev, 22616d917491SHans Petter Selasky "Invalid header length %d\n", dlen); 22626d917491SHans Petter Selasky return; 22636d917491SHans Petter Selasky } 2264dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_RX_PROC | UATH_DEBUG_RECV_ALL, 2265dc60165bSWeongyo Jeong "%s: code %d data len %u\n", 2266dc60165bSWeongyo Jeong __func__, hdr->code & 0xff, dlen); 2267dc60165bSWeongyo Jeong /* 2268dc60165bSWeongyo Jeong * The first response from the target after the 2269dc60165bSWeongyo Jeong * HOST_AVAILABLE has an invalid msgid so we must 2270dc60165bSWeongyo Jeong * treat it specially. 2271dc60165bSWeongyo Jeong */ 2272dc60165bSWeongyo Jeong if (hdr->msgid < UATH_CMD_LIST_COUNT) { 2273dc60165bSWeongyo Jeong uint32_t *rp = (uint32_t *)(hdr+1); 2274dc60165bSWeongyo Jeong u_int olen; 2275dc60165bSWeongyo Jeong 2276dc60165bSWeongyo Jeong if (!(sizeof(*hdr) <= hdr->len && 2277dc60165bSWeongyo Jeong hdr->len < UATH_MAX_CMDSZ)) { 2278dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 2279dc60165bSWeongyo Jeong "%s: invalid WDC msg length %u; " 2280dc60165bSWeongyo Jeong "msg ignored\n", __func__, hdr->len); 2281dc60165bSWeongyo Jeong return; 2282dc60165bSWeongyo Jeong } 2283dc60165bSWeongyo Jeong /* 2284dc60165bSWeongyo Jeong * Calculate return/receive payload size; the 2285dc60165bSWeongyo Jeong * first word, if present, always gives the 2286dc60165bSWeongyo Jeong * number of bytes--unless it's 0 in which 2287dc60165bSWeongyo Jeong * case a single 32-bit word should be present. 2288dc60165bSWeongyo Jeong */ 22896d917491SHans Petter Selasky if (dlen >= (int)sizeof(uint32_t)) { 2290dc60165bSWeongyo Jeong olen = be32toh(rp[0]); 2291dc60165bSWeongyo Jeong dlen -= sizeof(uint32_t); 2292dc60165bSWeongyo Jeong if (olen == 0) { 2293dc60165bSWeongyo Jeong /* convention is 0 =>'s one word */ 2294dc60165bSWeongyo Jeong olen = sizeof(uint32_t); 2295dc60165bSWeongyo Jeong /* XXX KASSERT(olen == dlen ) */ 2296dc60165bSWeongyo Jeong } 2297dc60165bSWeongyo Jeong } else 2298dc60165bSWeongyo Jeong olen = 0; 2299dc60165bSWeongyo Jeong if (cmd->odata != NULL) { 2300dc60165bSWeongyo Jeong /* NB: cmd->olen validated in uath_cmd */ 23016d917491SHans Petter Selasky if (olen > (u_int)cmd->olen) { 2302dc60165bSWeongyo Jeong /* XXX complain? */ 2303dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 2304dc60165bSWeongyo Jeong "%s: cmd 0x%x olen %u cmd olen %u\n", 2305dc60165bSWeongyo Jeong __func__, hdr->code, olen, 2306dc60165bSWeongyo Jeong cmd->olen); 2307dc60165bSWeongyo Jeong olen = cmd->olen; 2308dc60165bSWeongyo Jeong } 23096d917491SHans Petter Selasky if (olen > (u_int)dlen) { 2310dc60165bSWeongyo Jeong /* XXX complain, shouldn't happen */ 2311dc60165bSWeongyo Jeong device_printf(sc->sc_dev, 2312dc60165bSWeongyo Jeong "%s: cmd 0x%x olen %u dlen %u\n", 2313dc60165bSWeongyo Jeong __func__, hdr->code, olen, dlen); 2314dc60165bSWeongyo Jeong olen = dlen; 2315dc60165bSWeongyo Jeong } 2316dc60165bSWeongyo Jeong /* XXX have submitter do this */ 2317dc60165bSWeongyo Jeong /* copy answer into caller's supplied buffer */ 2318dc60165bSWeongyo Jeong bcopy(&rp[1], cmd->odata, olen); 2319dc60165bSWeongyo Jeong cmd->olen = olen; 2320dc60165bSWeongyo Jeong } 2321dc60165bSWeongyo Jeong } 2322dc60165bSWeongyo Jeong wakeup_one(cmd); /* wake up caller */ 2323dc60165bSWeongyo Jeong break; 2324dc60165bSWeongyo Jeong 2325dc60165bSWeongyo Jeong case WDCMSG_TARGET_START: 2326dc60165bSWeongyo Jeong if (hdr->msgid >= UATH_CMD_LIST_COUNT) { 2327dc60165bSWeongyo Jeong /* XXX */ 2328dc60165bSWeongyo Jeong return; 2329dc60165bSWeongyo Jeong } 2330dc60165bSWeongyo Jeong dlen = hdr->len - sizeof(*hdr); 23316d917491SHans Petter Selasky if (dlen != (int)sizeof(uint32_t)) { 2332dc60165bSWeongyo Jeong /* XXX something wrong */ 2333dc60165bSWeongyo Jeong return; 2334dc60165bSWeongyo Jeong } 2335dc60165bSWeongyo Jeong /* XXX have submitter do this */ 2336dc60165bSWeongyo Jeong /* copy answer into caller's supplied buffer */ 2337dc60165bSWeongyo Jeong bcopy(hdr+1, cmd->odata, sizeof(uint32_t)); 2338dc60165bSWeongyo Jeong cmd->olen = sizeof(uint32_t); 2339dc60165bSWeongyo Jeong wakeup_one(cmd); /* wake up caller */ 2340dc60165bSWeongyo Jeong break; 2341dc60165bSWeongyo Jeong 2342dc60165bSWeongyo Jeong case WDCMSG_SEND_COMPLETE: 2343dc60165bSWeongyo Jeong /* this notification is sent when UATH_TX_NOTIFY is set */ 2344dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_RX_PROC | UATH_DEBUG_RECV_ALL, 2345dc60165bSWeongyo Jeong "%s: received Tx notification\n", __func__); 2346dc60165bSWeongyo Jeong break; 2347dc60165bSWeongyo Jeong 2348dc60165bSWeongyo Jeong case WDCMSG_TARGET_GET_STATS: 2349dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_RX_PROC | UATH_DEBUG_RECV_ALL, 2350dc60165bSWeongyo Jeong "%s: received device statistics\n", __func__); 2351dc60165bSWeongyo Jeong callout_reset(&sc->stat_ch, hz, uath_stat, sc); 2352dc60165bSWeongyo Jeong break; 2353dc60165bSWeongyo Jeong } 2354dc60165bSWeongyo Jeong } 2355dc60165bSWeongyo Jeong 2356dc60165bSWeongyo Jeong static void 2357ed6d949aSAndrew Thompson uath_intr_rx_callback(struct usb_xfer *xfer, usb_error_t error) 2358dc60165bSWeongyo Jeong { 2359ed6d949aSAndrew Thompson struct uath_softc *sc = usbd_xfer_softc(xfer); 2360dc60165bSWeongyo Jeong struct uath_cmd *cmd; 2361ed6d949aSAndrew Thompson struct usb_page_cache *pc; 2362ed6d949aSAndrew Thompson int actlen; 2363ed6d949aSAndrew Thompson 2364ed6d949aSAndrew Thompson usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL); 2365dc60165bSWeongyo Jeong 2366dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 2367dc60165bSWeongyo Jeong 2368dc60165bSWeongyo Jeong switch (USB_GET_STATE(xfer)) { 2369dc60165bSWeongyo Jeong case USB_ST_TRANSFERRED: 2370dc60165bSWeongyo Jeong cmd = STAILQ_FIRST(&sc->sc_cmd_waiting); 2371dc60165bSWeongyo Jeong if (cmd == NULL) 2372dc60165bSWeongyo Jeong goto setup; 2373dc60165bSWeongyo Jeong STAILQ_REMOVE_HEAD(&sc->sc_cmd_waiting, next); 2374dc60165bSWeongyo Jeong UATH_STAT_DEC(sc, st_cmd_waiting); 2375dc60165bSWeongyo Jeong STAILQ_INSERT_TAIL(&sc->sc_cmd_inactive, cmd, next); 2376dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_cmd_inactive); 2377dc60165bSWeongyo Jeong 23786d917491SHans Petter Selasky KASSERT(actlen >= (int)sizeof(struct uath_cmd_hdr), 2379dc60165bSWeongyo Jeong ("short xfer error")); 2380ed6d949aSAndrew Thompson pc = usbd_xfer_get_frame(xfer, 0); 2381ed6d949aSAndrew Thompson usbd_copy_out(pc, 0, cmd->buf, actlen); 2382dc60165bSWeongyo Jeong uath_cmdeof(sc, cmd); 2383dc60165bSWeongyo Jeong case USB_ST_SETUP: 2384dc60165bSWeongyo Jeong setup: 2385ed6d949aSAndrew Thompson usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer)); 2386a593f6b8SAndrew Thompson usbd_transfer_submit(xfer); 2387dc60165bSWeongyo Jeong break; 2388dc60165bSWeongyo Jeong default: 2389ed6d949aSAndrew Thompson if (error != USB_ERR_CANCELLED) { 2390ed6d949aSAndrew Thompson usbd_xfer_set_stall(xfer); 2391dc60165bSWeongyo Jeong goto setup; 2392dc60165bSWeongyo Jeong } 2393dc60165bSWeongyo Jeong break; 2394dc60165bSWeongyo Jeong } 2395dc60165bSWeongyo Jeong } 2396dc60165bSWeongyo Jeong 2397dc60165bSWeongyo Jeong static void 2398ed6d949aSAndrew Thompson uath_intr_tx_callback(struct usb_xfer *xfer, usb_error_t error) 2399dc60165bSWeongyo Jeong { 2400ed6d949aSAndrew Thompson struct uath_softc *sc = usbd_xfer_softc(xfer); 2401dc60165bSWeongyo Jeong struct uath_cmd *cmd; 2402dc60165bSWeongyo Jeong 2403dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 2404dc60165bSWeongyo Jeong 2405dc60165bSWeongyo Jeong cmd = STAILQ_FIRST(&sc->sc_cmd_active); 2406056e0b5dSHans Petter Selasky if (cmd != NULL && USB_GET_STATE(xfer) != USB_ST_SETUP) { 2407dc60165bSWeongyo Jeong STAILQ_REMOVE_HEAD(&sc->sc_cmd_active, next); 2408dc60165bSWeongyo Jeong UATH_STAT_DEC(sc, st_cmd_active); 2409dc60165bSWeongyo Jeong STAILQ_INSERT_TAIL((cmd->flags & UATH_CMD_FLAG_READ) ? 2410dc60165bSWeongyo Jeong &sc->sc_cmd_waiting : &sc->sc_cmd_inactive, cmd, next); 2411dc60165bSWeongyo Jeong if (cmd->flags & UATH_CMD_FLAG_READ) 2412dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_cmd_waiting); 2413dc60165bSWeongyo Jeong else 2414dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_cmd_inactive); 2415056e0b5dSHans Petter Selasky } 2416056e0b5dSHans Petter Selasky 2417056e0b5dSHans Petter Selasky switch (USB_GET_STATE(xfer)) { 2418056e0b5dSHans Petter Selasky case USB_ST_TRANSFERRED: 2419dc60165bSWeongyo Jeong case USB_ST_SETUP: 2420dc60165bSWeongyo Jeong setup: 2421dc60165bSWeongyo Jeong cmd = STAILQ_FIRST(&sc->sc_cmd_pending); 2422dc60165bSWeongyo Jeong if (cmd == NULL) { 2423dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_XMIT, "%s: empty pending queue\n", 2424dc60165bSWeongyo Jeong __func__); 2425dc60165bSWeongyo Jeong return; 2426dc60165bSWeongyo Jeong } 2427dc60165bSWeongyo Jeong STAILQ_REMOVE_HEAD(&sc->sc_cmd_pending, next); 2428dc60165bSWeongyo Jeong UATH_STAT_DEC(sc, st_cmd_pending); 2429dc60165bSWeongyo Jeong STAILQ_INSERT_TAIL((cmd->flags & UATH_CMD_FLAG_ASYNC) ? 2430dc60165bSWeongyo Jeong &sc->sc_cmd_inactive : &sc->sc_cmd_active, cmd, next); 2431dc60165bSWeongyo Jeong if (cmd->flags & UATH_CMD_FLAG_ASYNC) 2432dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_cmd_inactive); 2433dc60165bSWeongyo Jeong else 2434dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_cmd_active); 2435dc60165bSWeongyo Jeong 2436ed6d949aSAndrew Thompson usbd_xfer_set_frame_data(xfer, 0, cmd->buf, cmd->buflen); 2437a593f6b8SAndrew Thompson usbd_transfer_submit(xfer); 2438dc60165bSWeongyo Jeong break; 2439dc60165bSWeongyo Jeong default: 2440ed6d949aSAndrew Thompson if (error != USB_ERR_CANCELLED) { 2441ed6d949aSAndrew Thompson usbd_xfer_set_stall(xfer); 2442dc60165bSWeongyo Jeong goto setup; 2443dc60165bSWeongyo Jeong } 2444dc60165bSWeongyo Jeong break; 2445dc60165bSWeongyo Jeong } 2446dc60165bSWeongyo Jeong } 2447dc60165bSWeongyo Jeong 2448dc60165bSWeongyo Jeong static void 2449dc60165bSWeongyo Jeong uath_update_rxstat(struct uath_softc *sc, uint32_t status) 2450dc60165bSWeongyo Jeong { 2451dc60165bSWeongyo Jeong 2452dc60165bSWeongyo Jeong switch (status) { 2453dc60165bSWeongyo Jeong case UATH_STATUS_STOP_IN_PROGRESS: 2454dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_stopinprogress); 2455dc60165bSWeongyo Jeong break; 2456dc60165bSWeongyo Jeong case UATH_STATUS_CRC_ERR: 2457dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_crcerr); 2458dc60165bSWeongyo Jeong break; 2459dc60165bSWeongyo Jeong case UATH_STATUS_PHY_ERR: 2460dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_phyerr); 2461dc60165bSWeongyo Jeong break; 2462dc60165bSWeongyo Jeong case UATH_STATUS_DECRYPT_CRC_ERR: 2463dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_decrypt_crcerr); 2464dc60165bSWeongyo Jeong break; 2465dc60165bSWeongyo Jeong case UATH_STATUS_DECRYPT_MIC_ERR: 2466dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_decrypt_micerr); 2467dc60165bSWeongyo Jeong break; 2468dc60165bSWeongyo Jeong case UATH_STATUS_DECOMP_ERR: 2469dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_decomperr); 2470dc60165bSWeongyo Jeong break; 2471dc60165bSWeongyo Jeong case UATH_STATUS_KEY_ERR: 2472dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_keyerr); 2473dc60165bSWeongyo Jeong break; 2474dc60165bSWeongyo Jeong case UATH_STATUS_ERR: 2475dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_err); 2476dc60165bSWeongyo Jeong break; 2477dc60165bSWeongyo Jeong default: 2478dc60165bSWeongyo Jeong break; 2479dc60165bSWeongyo Jeong } 2480dc60165bSWeongyo Jeong } 2481dc60165bSWeongyo Jeong 2482dc60165bSWeongyo Jeong static struct mbuf * 2483760bc48eSAndrew Thompson uath_data_rxeof(struct usb_xfer *xfer, struct uath_data *data, 2484dc60165bSWeongyo Jeong struct uath_rx_desc **pdesc) 2485dc60165bSWeongyo Jeong { 2486ed6d949aSAndrew Thompson struct uath_softc *sc = usbd_xfer_softc(xfer); 2487*7a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 2488dc60165bSWeongyo Jeong struct uath_chunk *chunk; 2489dc60165bSWeongyo Jeong struct uath_rx_desc *desc; 2490dc60165bSWeongyo Jeong struct mbuf *m = data->m, *mnew, *mp; 2491dc60165bSWeongyo Jeong uint16_t chunklen; 2492ed6d949aSAndrew Thompson int actlen; 2493dc60165bSWeongyo Jeong 2494ed6d949aSAndrew Thompson usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL); 2495ed6d949aSAndrew Thompson 24966d917491SHans Petter Selasky if (actlen < (int)UATH_MIN_RXBUFSZ) { 2497dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL, 2498ed6d949aSAndrew Thompson "%s: wrong xfer size (len=%d)\n", __func__, actlen); 2499*7a79cebfSGleb Smirnoff counter_u64_add(ic->ic_ierrors, 1); 2500dc60165bSWeongyo Jeong return (NULL); 2501dc60165bSWeongyo Jeong } 2502dc60165bSWeongyo Jeong 2503dc60165bSWeongyo Jeong chunk = (struct uath_chunk *)data->buf; 2504dc60165bSWeongyo Jeong if (chunk->seqnum == 0 && chunk->flags == 0 && chunk->length == 0) { 2505dc60165bSWeongyo Jeong device_printf(sc->sc_dev, "%s: strange response\n", __func__); 2506*7a79cebfSGleb Smirnoff counter_u64_add(ic->ic_ierrors, 1); 2507dc60165bSWeongyo Jeong UATH_RESET_INTRX(sc); 2508dc60165bSWeongyo Jeong return (NULL); 2509dc60165bSWeongyo Jeong } 2510dc60165bSWeongyo Jeong 2511dc60165bSWeongyo Jeong if (chunk->seqnum != sc->sc_intrx_nextnum) { 2512dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_XMIT, "invalid seqnum %d, expected %d\n", 2513dc60165bSWeongyo Jeong chunk->seqnum, sc->sc_intrx_nextnum); 2514dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_badchunkseqnum); 2515dc60165bSWeongyo Jeong if (sc->sc_intrx_head != NULL) 2516dc60165bSWeongyo Jeong m_freem(sc->sc_intrx_head); 2517dc60165bSWeongyo Jeong UATH_RESET_INTRX(sc); 2518dc60165bSWeongyo Jeong return (NULL); 2519dc60165bSWeongyo Jeong } 2520dc60165bSWeongyo Jeong 2521dc60165bSWeongyo Jeong /* check multi-chunk frames */ 2522dc60165bSWeongyo Jeong if ((chunk->seqnum == 0 && !(chunk->flags & UATH_CFLAGS_FINAL)) || 2523dc60165bSWeongyo Jeong (chunk->seqnum != 0 && (chunk->flags & UATH_CFLAGS_FINAL)) || 2524dc60165bSWeongyo Jeong chunk->flags & UATH_CFLAGS_RXMSG) 2525dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_multichunk); 2526dc60165bSWeongyo Jeong 2527dc60165bSWeongyo Jeong chunklen = be16toh(chunk->length); 2528dc60165bSWeongyo Jeong if (chunk->flags & UATH_CFLAGS_FINAL) 2529dc60165bSWeongyo Jeong chunklen -= sizeof(struct uath_rx_desc); 2530dc60165bSWeongyo Jeong 2531dc60165bSWeongyo Jeong if (chunklen > 0 && 2532dc60165bSWeongyo Jeong (!(chunk->flags & UATH_CFLAGS_FINAL) || !(chunk->seqnum == 0))) { 2533dc60165bSWeongyo Jeong /* we should use intermediate RX buffer */ 2534dc60165bSWeongyo Jeong if (chunk->seqnum == 0) 2535dc60165bSWeongyo Jeong UATH_RESET_INTRX(sc); 2536dc60165bSWeongyo Jeong if ((sc->sc_intrx_len + sizeof(struct uath_rx_desc) + 2537dc60165bSWeongyo Jeong chunklen) > UATH_MAX_INTRX_SIZE) { 2538dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_invalidlen); 2539*7a79cebfSGleb Smirnoff counter_u64_add(ic->ic_ierrors, 1); 2540dc60165bSWeongyo Jeong if (sc->sc_intrx_head != NULL) 2541dc60165bSWeongyo Jeong m_freem(sc->sc_intrx_head); 2542dc60165bSWeongyo Jeong UATH_RESET_INTRX(sc); 2543dc60165bSWeongyo Jeong return (NULL); 2544dc60165bSWeongyo Jeong } 2545dc60165bSWeongyo Jeong 2546dc60165bSWeongyo Jeong m->m_len = chunklen; 2547dc60165bSWeongyo Jeong m->m_data += sizeof(struct uath_chunk); 2548dc60165bSWeongyo Jeong 2549dc60165bSWeongyo Jeong if (sc->sc_intrx_head == NULL) { 2550dc60165bSWeongyo Jeong sc->sc_intrx_head = m; 2551dc60165bSWeongyo Jeong sc->sc_intrx_tail = m; 2552dc60165bSWeongyo Jeong } else { 2553dc60165bSWeongyo Jeong m->m_flags &= ~M_PKTHDR; 2554dc60165bSWeongyo Jeong sc->sc_intrx_tail->m_next = m; 2555dc60165bSWeongyo Jeong sc->sc_intrx_tail = m; 2556dc60165bSWeongyo Jeong } 2557dc60165bSWeongyo Jeong } 2558dc60165bSWeongyo Jeong sc->sc_intrx_len += chunklen; 2559dc60165bSWeongyo Jeong 2560c6499eccSGleb Smirnoff mnew = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 2561dc60165bSWeongyo Jeong if (mnew == NULL) { 2562dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL, 2563dc60165bSWeongyo Jeong "%s: can't get new mbuf, drop frame\n", __func__); 2564*7a79cebfSGleb Smirnoff counter_u64_add(ic->ic_ierrors, 1); 2565dc60165bSWeongyo Jeong if (sc->sc_intrx_head != NULL) 2566dc60165bSWeongyo Jeong m_freem(sc->sc_intrx_head); 2567dc60165bSWeongyo Jeong UATH_RESET_INTRX(sc); 2568dc60165bSWeongyo Jeong return (NULL); 2569dc60165bSWeongyo Jeong } 2570dc60165bSWeongyo Jeong 2571dc60165bSWeongyo Jeong data->m = mnew; 2572dc60165bSWeongyo Jeong data->buf = mtod(mnew, uint8_t *); 2573dc60165bSWeongyo Jeong 2574dc60165bSWeongyo Jeong /* if the frame is not final continue the transfer */ 2575dc60165bSWeongyo Jeong if (!(chunk->flags & UATH_CFLAGS_FINAL)) { 2576dc60165bSWeongyo Jeong sc->sc_intrx_nextnum++; 2577dc60165bSWeongyo Jeong UATH_RESET_INTRX(sc); 2578dc60165bSWeongyo Jeong return (NULL); 2579dc60165bSWeongyo Jeong } 2580dc60165bSWeongyo Jeong 2581dc60165bSWeongyo Jeong /* 2582dc60165bSWeongyo Jeong * if the frame is not set UATH_CFLAGS_RXMSG, then rx descriptor is 2583dc60165bSWeongyo Jeong * located at the end, 32-bit aligned 2584dc60165bSWeongyo Jeong */ 2585dc60165bSWeongyo Jeong desc = (chunk->flags & UATH_CFLAGS_RXMSG) ? 2586dc60165bSWeongyo Jeong (struct uath_rx_desc *)(chunk + 1) : 2587dc60165bSWeongyo Jeong (struct uath_rx_desc *)(((uint8_t *)chunk) + 2588dc60165bSWeongyo Jeong sizeof(struct uath_chunk) + be16toh(chunk->length) - 2589dc60165bSWeongyo Jeong sizeof(struct uath_rx_desc)); 2590dc60165bSWeongyo Jeong *pdesc = desc; 2591dc60165bSWeongyo Jeong 2592dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL, 2593dc60165bSWeongyo Jeong "%s: frame len %u code %u status %u rate %u antenna %u " 2594dc60165bSWeongyo Jeong "rssi %d channel %u phyerror %u connix %u decrypterror %u " 2595dc60165bSWeongyo Jeong "keycachemiss %u\n", __func__, be32toh(desc->framelen) 2596dc60165bSWeongyo Jeong , be32toh(desc->code), be32toh(desc->status), be32toh(desc->rate) 2597dc60165bSWeongyo Jeong , be32toh(desc->antenna), be32toh(desc->rssi), be32toh(desc->channel) 2598dc60165bSWeongyo Jeong , be32toh(desc->phyerror), be32toh(desc->connix) 2599dc60165bSWeongyo Jeong , be32toh(desc->decrypterror), be32toh(desc->keycachemiss)); 2600dc60165bSWeongyo Jeong 2601dc60165bSWeongyo Jeong if (be32toh(desc->len) > MCLBYTES) { 2602dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL, 2603dc60165bSWeongyo Jeong "%s: bad descriptor (len=%d)\n", __func__, 2604dc60165bSWeongyo Jeong be32toh(desc->len)); 2605*7a79cebfSGleb Smirnoff counter_u64_add(ic->ic_ierrors, 1); 2606dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_toobigrxpkt); 2607dc60165bSWeongyo Jeong if (sc->sc_intrx_head != NULL) 2608dc60165bSWeongyo Jeong m_freem(sc->sc_intrx_head); 2609dc60165bSWeongyo Jeong UATH_RESET_INTRX(sc); 2610dc60165bSWeongyo Jeong return (NULL); 2611dc60165bSWeongyo Jeong } 2612dc60165bSWeongyo Jeong 2613dc60165bSWeongyo Jeong uath_update_rxstat(sc, be32toh(desc->status)); 2614dc60165bSWeongyo Jeong 2615dc60165bSWeongyo Jeong /* finalize mbuf */ 2616dc60165bSWeongyo Jeong if (sc->sc_intrx_head == NULL) { 2617dc60165bSWeongyo Jeong m->m_pkthdr.len = m->m_len = 2618dc60165bSWeongyo Jeong be32toh(desc->framelen) - UATH_RX_DUMMYSIZE; 2619dc60165bSWeongyo Jeong m->m_data += sizeof(struct uath_chunk); 2620dc60165bSWeongyo Jeong } else { 2621dc60165bSWeongyo Jeong mp = sc->sc_intrx_head; 2622dc60165bSWeongyo Jeong mp->m_flags |= M_PKTHDR; 2623dc60165bSWeongyo Jeong mp->m_pkthdr.len = sc->sc_intrx_len; 2624dc60165bSWeongyo Jeong m = mp; 2625dc60165bSWeongyo Jeong } 2626dc60165bSWeongyo Jeong 2627dc60165bSWeongyo Jeong /* there are a lot more fields in the RX descriptor */ 2628c39515adSWeongyo Jeong if ((sc->sc_flags & UATH_FLAG_INVALID) == 0 && 2629c39515adSWeongyo Jeong ieee80211_radiotap_active(ic)) { 2630dc60165bSWeongyo Jeong struct uath_rx_radiotap_header *tap = &sc->sc_rxtap; 26315463c4a4SSam Leffler uint32_t tsf_hi = be32toh(desc->tstamp_high); 26325463c4a4SSam Leffler uint32_t tsf_lo = be32toh(desc->tstamp_low); 2633dc60165bSWeongyo Jeong 26345463c4a4SSam Leffler /* XXX only get low order 24bits of tsf from h/w */ 26355463c4a4SSam Leffler tap->wr_tsf = htole64(((uint64_t)tsf_hi << 32) | tsf_lo); 26365463c4a4SSam Leffler tap->wr_flags = 0; 26375463c4a4SSam Leffler if (be32toh(desc->status) == UATH_STATUS_CRC_ERR) 26385463c4a4SSam Leffler tap->wr_flags |= IEEE80211_RADIOTAP_F_BADFCS; 26395463c4a4SSam Leffler /* XXX map other status to BADFCS? */ 26405463c4a4SSam Leffler /* XXX ath h/w rate code, need to map */ 26415463c4a4SSam Leffler tap->wr_rate = be32toh(desc->rate); 26425463c4a4SSam Leffler tap->wr_antenna = be32toh(desc->antenna); 26435463c4a4SSam Leffler tap->wr_antsignal = -95 + be32toh(desc->rssi); 26445463c4a4SSam Leffler tap->wr_antnoise = -95; 2645dc60165bSWeongyo Jeong } 2646dc60165bSWeongyo Jeong 2647dc60165bSWeongyo Jeong UATH_RESET_INTRX(sc); 2648dc60165bSWeongyo Jeong 2649dc60165bSWeongyo Jeong return (m); 2650dc60165bSWeongyo Jeong } 2651dc60165bSWeongyo Jeong 2652dc60165bSWeongyo Jeong static void 2653ed6d949aSAndrew Thompson uath_bulk_rx_callback(struct usb_xfer *xfer, usb_error_t error) 2654dc60165bSWeongyo Jeong { 2655ed6d949aSAndrew Thompson struct uath_softc *sc = usbd_xfer_softc(xfer); 2656*7a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 2657dc60165bSWeongyo Jeong struct ieee80211_frame *wh; 2658dc60165bSWeongyo Jeong struct ieee80211_node *ni; 2659dc60165bSWeongyo Jeong struct mbuf *m = NULL; 2660dc60165bSWeongyo Jeong struct uath_data *data; 2661dc60165bSWeongyo Jeong struct uath_rx_desc *desc = NULL; 2662dc60165bSWeongyo Jeong int8_t nf; 2663dc60165bSWeongyo Jeong 2664dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 2665dc60165bSWeongyo Jeong 2666dc60165bSWeongyo Jeong switch (USB_GET_STATE(xfer)) { 2667dc60165bSWeongyo Jeong case USB_ST_TRANSFERRED: 2668dc60165bSWeongyo Jeong data = STAILQ_FIRST(&sc->sc_rx_active); 2669dc60165bSWeongyo Jeong if (data == NULL) 2670dc60165bSWeongyo Jeong goto setup; 2671dc60165bSWeongyo Jeong STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 2672dc60165bSWeongyo Jeong UATH_STAT_DEC(sc, st_rx_active); 2673dc60165bSWeongyo Jeong m = uath_data_rxeof(xfer, data, &desc); 2674dc60165bSWeongyo Jeong STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 2675dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_rx_inactive); 2676dc60165bSWeongyo Jeong /* FALLTHROUGH */ 2677dc60165bSWeongyo Jeong case USB_ST_SETUP: 2678dc60165bSWeongyo Jeong setup: 2679dc60165bSWeongyo Jeong data = STAILQ_FIRST(&sc->sc_rx_inactive); 2680dc60165bSWeongyo Jeong if (data == NULL) 2681dc60165bSWeongyo Jeong return; 2682dc60165bSWeongyo Jeong STAILQ_REMOVE_HEAD(&sc->sc_rx_inactive, next); 2683dc60165bSWeongyo Jeong UATH_STAT_DEC(sc, st_rx_inactive); 2684dc60165bSWeongyo Jeong STAILQ_INSERT_TAIL(&sc->sc_rx_active, data, next); 2685dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_rx_active); 2686c180b398SHans Petter Selasky usbd_xfer_set_frame_data(xfer, 0, data->buf, MCLBYTES); 2687a593f6b8SAndrew Thompson usbd_transfer_submit(xfer); 2688dc60165bSWeongyo Jeong 2689dc60165bSWeongyo Jeong /* 2690dc60165bSWeongyo Jeong * To avoid LOR we should unlock our private mutex here to call 2691dc60165bSWeongyo Jeong * ieee80211_input() because here is at the end of a USB 2692dc60165bSWeongyo Jeong * callback and safe to unlock. 2693dc60165bSWeongyo Jeong */ 2694c39515adSWeongyo Jeong if (sc->sc_flags & UATH_FLAG_INVALID) { 2695c39515adSWeongyo Jeong if (m != NULL) 2696c39515adSWeongyo Jeong m_freem(m); 2697c39515adSWeongyo Jeong return; 2698c39515adSWeongyo Jeong } 2699dc60165bSWeongyo Jeong UATH_UNLOCK(sc); 2700dc60165bSWeongyo Jeong if (m != NULL && desc != NULL) { 2701dc60165bSWeongyo Jeong wh = mtod(m, struct ieee80211_frame *); 2702dc60165bSWeongyo Jeong ni = ieee80211_find_rxnode(ic, 2703dc60165bSWeongyo Jeong (struct ieee80211_frame_min *)wh); 2704dc60165bSWeongyo Jeong nf = -95; /* XXX */ 2705dc60165bSWeongyo Jeong if (ni != NULL) { 2706dc60165bSWeongyo Jeong (void) ieee80211_input(ni, m, 27075463c4a4SSam Leffler (int)be32toh(desc->rssi), nf); 2708dc60165bSWeongyo Jeong /* node is no longer needed */ 2709dc60165bSWeongyo Jeong ieee80211_free_node(ni); 2710dc60165bSWeongyo Jeong } else 2711dc60165bSWeongyo Jeong (void) ieee80211_input_all(ic, m, 27125463c4a4SSam Leffler (int)be32toh(desc->rssi), nf); 2713dc60165bSWeongyo Jeong m = NULL; 2714dc60165bSWeongyo Jeong desc = NULL; 2715dc60165bSWeongyo Jeong } 2716dc60165bSWeongyo Jeong UATH_LOCK(sc); 2717*7a79cebfSGleb Smirnoff uath_start(sc); 2718dc60165bSWeongyo Jeong break; 2719dc60165bSWeongyo Jeong default: 2720dc60165bSWeongyo Jeong /* needs it to the inactive queue due to a error. */ 2721dc60165bSWeongyo Jeong data = STAILQ_FIRST(&sc->sc_rx_active); 2722dc60165bSWeongyo Jeong if (data != NULL) { 2723dc60165bSWeongyo Jeong STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 2724dc60165bSWeongyo Jeong UATH_STAT_DEC(sc, st_rx_active); 2725dc60165bSWeongyo Jeong STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 2726dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_rx_inactive); 2727dc60165bSWeongyo Jeong } 2728ed6d949aSAndrew Thompson if (error != USB_ERR_CANCELLED) { 2729ed6d949aSAndrew Thompson usbd_xfer_set_stall(xfer); 2730*7a79cebfSGleb Smirnoff counter_u64_add(ic->ic_ierrors, 1); 2731dc60165bSWeongyo Jeong goto setup; 2732dc60165bSWeongyo Jeong } 2733dc60165bSWeongyo Jeong break; 2734dc60165bSWeongyo Jeong } 2735dc60165bSWeongyo Jeong } 2736dc60165bSWeongyo Jeong 2737dc60165bSWeongyo Jeong static void 2738760bc48eSAndrew Thompson uath_data_txeof(struct usb_xfer *xfer, struct uath_data *data) 2739dc60165bSWeongyo Jeong { 2740ed6d949aSAndrew Thompson struct uath_softc *sc = usbd_xfer_softc(xfer); 2741dc60165bSWeongyo Jeong 2742dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 2743dc60165bSWeongyo Jeong 2744dc60165bSWeongyo Jeong if (data->m) { 2745dc60165bSWeongyo Jeong /* XXX status? */ 2746*7a79cebfSGleb Smirnoff ieee80211_tx_complete(data->ni, data->m, 0); 2747dc60165bSWeongyo Jeong data->m = NULL; 2748dc60165bSWeongyo Jeong data->ni = NULL; 2749dc60165bSWeongyo Jeong } 2750dc60165bSWeongyo Jeong sc->sc_tx_timer = 0; 2751dc60165bSWeongyo Jeong } 2752dc60165bSWeongyo Jeong 2753dc60165bSWeongyo Jeong static void 2754ed6d949aSAndrew Thompson uath_bulk_tx_callback(struct usb_xfer *xfer, usb_error_t error) 2755dc60165bSWeongyo Jeong { 2756ed6d949aSAndrew Thompson struct uath_softc *sc = usbd_xfer_softc(xfer); 2757dc60165bSWeongyo Jeong struct uath_data *data; 2758dc60165bSWeongyo Jeong 2759dc60165bSWeongyo Jeong UATH_ASSERT_LOCKED(sc); 2760dc60165bSWeongyo Jeong 2761dc60165bSWeongyo Jeong switch (USB_GET_STATE(xfer)) { 2762dc60165bSWeongyo Jeong case USB_ST_TRANSFERRED: 2763dc60165bSWeongyo Jeong data = STAILQ_FIRST(&sc->sc_tx_active); 2764dc60165bSWeongyo Jeong if (data == NULL) 2765dc60165bSWeongyo Jeong goto setup; 2766dc60165bSWeongyo Jeong STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next); 2767dc60165bSWeongyo Jeong UATH_STAT_DEC(sc, st_tx_active); 2768dc60165bSWeongyo Jeong uath_data_txeof(xfer, data); 2769dc60165bSWeongyo Jeong STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data, next); 2770dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_tx_inactive); 2771dc60165bSWeongyo Jeong /* FALLTHROUGH */ 2772dc60165bSWeongyo Jeong case USB_ST_SETUP: 2773dc60165bSWeongyo Jeong setup: 2774dc60165bSWeongyo Jeong data = STAILQ_FIRST(&sc->sc_tx_pending); 2775dc60165bSWeongyo Jeong if (data == NULL) { 2776dc60165bSWeongyo Jeong DPRINTF(sc, UATH_DEBUG_XMIT, "%s: empty pending queue\n", 2777dc60165bSWeongyo Jeong __func__); 2778dc60165bSWeongyo Jeong return; 2779dc60165bSWeongyo Jeong } 2780dc60165bSWeongyo Jeong STAILQ_REMOVE_HEAD(&sc->sc_tx_pending, next); 2781dc60165bSWeongyo Jeong UATH_STAT_DEC(sc, st_tx_pending); 2782dc60165bSWeongyo Jeong STAILQ_INSERT_TAIL(&sc->sc_tx_active, data, next); 2783dc60165bSWeongyo Jeong UATH_STAT_INC(sc, st_tx_active); 2784dc60165bSWeongyo Jeong 2785ed6d949aSAndrew Thompson usbd_xfer_set_frame_data(xfer, 0, data->buf, data->buflen); 2786a593f6b8SAndrew Thompson usbd_transfer_submit(xfer); 2787dc60165bSWeongyo Jeong 2788*7a79cebfSGleb Smirnoff uath_start(sc); 2789dc60165bSWeongyo Jeong break; 2790dc60165bSWeongyo Jeong default: 2791dc60165bSWeongyo Jeong data = STAILQ_FIRST(&sc->sc_tx_active); 2792dc60165bSWeongyo Jeong if (data == NULL) 2793dc60165bSWeongyo Jeong goto setup; 2794dc60165bSWeongyo Jeong if (data->ni != NULL) { 2795*7a79cebfSGleb Smirnoff if_inc_counter(data->ni->ni_vap->iv_ifp, 2796*7a79cebfSGleb Smirnoff IFCOUNTER_OERRORS, 1); 2797c39515adSWeongyo Jeong if ((sc->sc_flags & UATH_FLAG_INVALID) == 0) 2798dc60165bSWeongyo Jeong ieee80211_free_node(data->ni); 2799dc60165bSWeongyo Jeong data->ni = NULL; 2800dc60165bSWeongyo Jeong } 2801ed6d949aSAndrew Thompson if (error != USB_ERR_CANCELLED) { 2802ed6d949aSAndrew Thompson usbd_xfer_set_stall(xfer); 2803dc60165bSWeongyo Jeong goto setup; 2804dc60165bSWeongyo Jeong } 2805dc60165bSWeongyo Jeong break; 2806dc60165bSWeongyo Jeong } 2807dc60165bSWeongyo Jeong } 2808dc60165bSWeongyo Jeong 2809dc60165bSWeongyo Jeong static device_method_t uath_methods[] = { 2810dc60165bSWeongyo Jeong DEVMETHOD(device_probe, uath_match), 2811dc60165bSWeongyo Jeong DEVMETHOD(device_attach, uath_attach), 2812dc60165bSWeongyo Jeong DEVMETHOD(device_detach, uath_detach), 2813c180b398SHans Petter Selasky DEVMETHOD_END 2814dc60165bSWeongyo Jeong }; 2815dc60165bSWeongyo Jeong static driver_t uath_driver = { 28166d917491SHans Petter Selasky .name = "uath", 28176d917491SHans Petter Selasky .methods = uath_methods, 28186d917491SHans Petter Selasky .size = sizeof(struct uath_softc) 2819dc60165bSWeongyo Jeong }; 2820dc60165bSWeongyo Jeong static devclass_t uath_devclass; 2821dc60165bSWeongyo Jeong 2822dc60165bSWeongyo Jeong DRIVER_MODULE(uath, uhub, uath_driver, uath_devclass, NULL, 0); 2823dc60165bSWeongyo Jeong MODULE_DEPEND(uath, wlan, 1, 1, 1); 2824dc60165bSWeongyo Jeong MODULE_DEPEND(uath, usb, 1, 1, 1); 2825910cb8feSAndrew Thompson MODULE_VERSION(uath, 1); 2826