if_urtwn.c revision 262822
1251538Srpaulo/* $OpenBSD: if_urtwn.c,v 1.16 2011/02/10 17:26:40 jakemsr Exp $ */ 2251538Srpaulo 3251538Srpaulo/*- 4251538Srpaulo * Copyright (c) 2010 Damien Bergamini <damien.bergamini@free.fr> 5251538Srpaulo * 6251538Srpaulo * Permission to use, copy, modify, and distribute this software for any 7251538Srpaulo * purpose with or without fee is hereby granted, provided that the above 8251538Srpaulo * copyright notice and this permission notice appear in all copies. 9251538Srpaulo * 10251538Srpaulo * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 11251538Srpaulo * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 12251538Srpaulo * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 13251538Srpaulo * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 14251538Srpaulo * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 15251538Srpaulo * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 16251538Srpaulo * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 17251538Srpaulo */ 18251538Srpaulo 19251538Srpaulo#include <sys/cdefs.h> 20251538Srpaulo__FBSDID("$FreeBSD: head/sys/dev/usb/wlan/if_urtwn.c 262822 2014-03-06 06:39:55Z kevlo $"); 21251538Srpaulo 22251538Srpaulo/* 23251538Srpaulo * Driver for Realtek RTL8188CE-VAU/RTL8188CUS/RTL8188RU/RTL8192CU. 24251538Srpaulo */ 25251538Srpaulo 26251538Srpaulo#include <sys/param.h> 27251538Srpaulo#include <sys/sockio.h> 28251538Srpaulo#include <sys/sysctl.h> 29251538Srpaulo#include <sys/lock.h> 30251538Srpaulo#include <sys/mutex.h> 31251538Srpaulo#include <sys/mbuf.h> 32251538Srpaulo#include <sys/kernel.h> 33251538Srpaulo#include <sys/socket.h> 34251538Srpaulo#include <sys/systm.h> 35251538Srpaulo#include <sys/malloc.h> 36251538Srpaulo#include <sys/module.h> 37251538Srpaulo#include <sys/bus.h> 38251538Srpaulo#include <sys/endian.h> 39251538Srpaulo#include <sys/linker.h> 40251538Srpaulo#include <sys/firmware.h> 41251538Srpaulo#include <sys/kdb.h> 42251538Srpaulo 43251538Srpaulo#include <machine/bus.h> 44251538Srpaulo#include <machine/resource.h> 45251538Srpaulo#include <sys/rman.h> 46251538Srpaulo 47251538Srpaulo#include <net/bpf.h> 48251538Srpaulo#include <net/if.h> 49257176Sglebius#include <net/if_var.h> 50251538Srpaulo#include <net/if_arp.h> 51251538Srpaulo#include <net/ethernet.h> 52251538Srpaulo#include <net/if_dl.h> 53251538Srpaulo#include <net/if_media.h> 54251538Srpaulo#include <net/if_types.h> 55251538Srpaulo 56251538Srpaulo#include <netinet/in.h> 57251538Srpaulo#include <netinet/in_systm.h> 58251538Srpaulo#include <netinet/in_var.h> 59251538Srpaulo#include <netinet/if_ether.h> 60251538Srpaulo#include <netinet/ip.h> 61251538Srpaulo 62251538Srpaulo#include <net80211/ieee80211_var.h> 63251538Srpaulo#include <net80211/ieee80211_regdomain.h> 64251538Srpaulo#include <net80211/ieee80211_radiotap.h> 65251538Srpaulo#include <net80211/ieee80211_ratectl.h> 66251538Srpaulo 67251538Srpaulo#include <dev/usb/usb.h> 68251538Srpaulo#include <dev/usb/usbdi.h> 69251538Srpaulo#include "usbdevs.h" 70251538Srpaulo 71251538Srpaulo#define USB_DEBUG_VAR urtwn_debug 72251538Srpaulo#include <dev/usb/usb_debug.h> 73251538Srpaulo 74251538Srpaulo#include <dev/usb/wlan/if_urtwnreg.h> 75251538Srpaulo 76251538Srpaulo#ifdef USB_DEBUG 77251538Srpaulostatic int urtwn_debug = 0; 78251538Srpaulo 79251538SrpauloSYSCTL_NODE(_hw_usb, OID_AUTO, urtwn, CTLFLAG_RW, 0, "USB urtwn"); 80251538SrpauloSYSCTL_INT(_hw_usb_urtwn, OID_AUTO, debug, CTLFLAG_RW, &urtwn_debug, 0, 81251538Srpaulo "Debug level"); 82251538Srpaulo#endif 83251538Srpaulo 84252406Srpaulo#define URTWN_RSSI(r) (r) - 110 85251538Srpaulo#define IEEE80211_HAS_ADDR4(wh) \ 86251538Srpaulo (((wh)->i_fc[1] & IEEE80211_FC1_DIR_MASK) == IEEE80211_FC1_DIR_DSTODS) 87251538Srpaulo 88251538Srpaulo/* various supported device vendors/products */ 89251596Srpaulostatic const STRUCT_USB_HOST_ID urtwn_devs[] = { 90251538Srpaulo#define URTWN_DEV(v,p) { USB_VP(USB_VENDOR_##v, USB_PRODUCT_##v##_##p) } 91251538Srpaulo URTWN_DEV(ABOCOM, RTL8188CU_1), 92251538Srpaulo URTWN_DEV(ABOCOM, RTL8188CU_2), 93251538Srpaulo URTWN_DEV(ABOCOM, RTL8192CU), 94251538Srpaulo URTWN_DEV(ASUS, RTL8192CU), 95251538Srpaulo URTWN_DEV(AZUREWAVE, RTL8188CE_1), 96251538Srpaulo URTWN_DEV(AZUREWAVE, RTL8188CE_2), 97251538Srpaulo URTWN_DEV(AZUREWAVE, RTL8188CU), 98251538Srpaulo URTWN_DEV(BELKIN, F7D2102), 99251538Srpaulo URTWN_DEV(BELKIN, RTL8188CU), 100251538Srpaulo URTWN_DEV(BELKIN, RTL8192CU), 101251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_1), 102251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_2), 103251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_3), 104251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_4), 105251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_5), 106251538Srpaulo URTWN_DEV(COREGA, RTL8192CU), 107251538Srpaulo URTWN_DEV(DLINK, RTL8188CU), 108251538Srpaulo URTWN_DEV(DLINK, RTL8192CU_1), 109251538Srpaulo URTWN_DEV(DLINK, RTL8192CU_2), 110251538Srpaulo URTWN_DEV(DLINK, RTL8192CU_3), 111252196Skevlo URTWN_DEV(DLINK, DWA131B), 112251538Srpaulo URTWN_DEV(EDIMAX, EW7811UN), 113251538Srpaulo URTWN_DEV(EDIMAX, RTL8192CU), 114251538Srpaulo URTWN_DEV(FEIXUN, RTL8188CU), 115251538Srpaulo URTWN_DEV(FEIXUN, RTL8192CU), 116251538Srpaulo URTWN_DEV(GUILLEMOT, HWNUP150), 117251538Srpaulo URTWN_DEV(HAWKING, RTL8192CU), 118251538Srpaulo URTWN_DEV(HP3, RTL8188CU), 119251538Srpaulo URTWN_DEV(NETGEAR, WNA1000M), 120251538Srpaulo URTWN_DEV(NETGEAR, RTL8192CU), 121251538Srpaulo URTWN_DEV(NETGEAR4, RTL8188CU), 122251538Srpaulo URTWN_DEV(NOVATECH, RTL8188CU), 123251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CU_1), 124251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CU_2), 125251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CU_3), 126251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CU_4), 127251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CUS), 128251538Srpaulo URTWN_DEV(PLANEX2, RTL8192CU), 129251538Srpaulo URTWN_DEV(REALTEK, RTL8188CE_0), 130251538Srpaulo URTWN_DEV(REALTEK, RTL8188CE_1), 131251538Srpaulo URTWN_DEV(REALTEK, RTL8188CTV), 132251538Srpaulo URTWN_DEV(REALTEK, RTL8188CU_0), 133251538Srpaulo URTWN_DEV(REALTEK, RTL8188CU_1), 134251538Srpaulo URTWN_DEV(REALTEK, RTL8188CU_2), 135251538Srpaulo URTWN_DEV(REALTEK, RTL8188CU_COMBO), 136251538Srpaulo URTWN_DEV(REALTEK, RTL8188CUS), 137251538Srpaulo URTWN_DEV(REALTEK, RTL8188RU_1), 138251538Srpaulo URTWN_DEV(REALTEK, RTL8188RU_2), 139251538Srpaulo URTWN_DEV(REALTEK, RTL8191CU), 140251538Srpaulo URTWN_DEV(REALTEK, RTL8192CE), 141251538Srpaulo URTWN_DEV(REALTEK, RTL8192CU), 142257543Salfred URTWN_DEV(REALTEK, RTL8188CU_0), 143251538Srpaulo URTWN_DEV(SITECOMEU, RTL8188CU_1), 144251538Srpaulo URTWN_DEV(SITECOMEU, RTL8188CU_2), 145251538Srpaulo URTWN_DEV(SITECOMEU, RTL8192CU), 146251538Srpaulo URTWN_DEV(TRENDNET, RTL8188CU), 147251538Srpaulo URTWN_DEV(TRENDNET, RTL8192CU), 148251538Srpaulo URTWN_DEV(ZYXEL, RTL8192CU), 149251538Srpaulo#undef URTWN_DEV 150251538Srpaulo}; 151251538Srpaulo 152251538Srpaulostatic device_probe_t urtwn_match; 153251538Srpaulostatic device_attach_t urtwn_attach; 154251538Srpaulostatic device_detach_t urtwn_detach; 155251538Srpaulo 156251538Srpaulostatic usb_callback_t urtwn_bulk_tx_callback; 157251538Srpaulostatic usb_callback_t urtwn_bulk_rx_callback; 158251538Srpaulo 159251538Srpaulostatic usb_error_t urtwn_do_request(struct urtwn_softc *sc, 160251538Srpaulo struct usb_device_request *req, void *data); 161251538Srpaulostatic struct ieee80211vap *urtwn_vap_create(struct ieee80211com *, 162251538Srpaulo const char [IFNAMSIZ], int, enum ieee80211_opmode, int, 163251538Srpaulo const uint8_t [IEEE80211_ADDR_LEN], 164251538Srpaulo const uint8_t [IEEE80211_ADDR_LEN]); 165251538Srpaulostatic void urtwn_vap_delete(struct ieee80211vap *); 166251538Srpaulostatic struct mbuf * urtwn_rx_frame(struct urtwn_softc *, uint8_t *, int, 167251538Srpaulo int *); 168251538Srpaulostatic struct mbuf * urtwn_rxeof(struct usb_xfer *, struct urtwn_data *, 169251538Srpaulo int *, int8_t *); 170251538Srpaulostatic void urtwn_txeof(struct usb_xfer *, struct urtwn_data *); 171251538Srpaulostatic int urtwn_alloc_list(struct urtwn_softc *, 172251538Srpaulo struct urtwn_data[], int, int); 173251538Srpaulostatic int urtwn_alloc_rx_list(struct urtwn_softc *); 174251538Srpaulostatic int urtwn_alloc_tx_list(struct urtwn_softc *); 175251538Srpaulostatic void urtwn_free_tx_list(struct urtwn_softc *); 176251538Srpaulostatic void urtwn_free_rx_list(struct urtwn_softc *); 177251538Srpaulostatic void urtwn_free_list(struct urtwn_softc *, 178251538Srpaulo struct urtwn_data data[], int); 179251538Srpaulostatic struct urtwn_data * _urtwn_getbuf(struct urtwn_softc *); 180251538Srpaulostatic struct urtwn_data * urtwn_getbuf(struct urtwn_softc *); 181251538Srpaulostatic int urtwn_write_region_1(struct urtwn_softc *, uint16_t, 182251538Srpaulo uint8_t *, int); 183251538Srpaulostatic void urtwn_write_1(struct urtwn_softc *, uint16_t, uint8_t); 184251538Srpaulostatic void urtwn_write_2(struct urtwn_softc *, uint16_t, uint16_t); 185251538Srpaulostatic void urtwn_write_4(struct urtwn_softc *, uint16_t, uint32_t); 186251538Srpaulostatic int urtwn_read_region_1(struct urtwn_softc *, uint16_t, 187251538Srpaulo uint8_t *, int); 188251538Srpaulostatic uint8_t urtwn_read_1(struct urtwn_softc *, uint16_t); 189251538Srpaulostatic uint16_t urtwn_read_2(struct urtwn_softc *, uint16_t); 190251538Srpaulostatic uint32_t urtwn_read_4(struct urtwn_softc *, uint16_t); 191251538Srpaulostatic int urtwn_fw_cmd(struct urtwn_softc *, uint8_t, 192251538Srpaulo const void *, int); 193251538Srpaulostatic void urtwn_rf_write(struct urtwn_softc *, int, uint8_t, 194251538Srpaulo uint32_t); 195251538Srpaulostatic uint32_t urtwn_rf_read(struct urtwn_softc *, int, uint8_t); 196251538Srpaulostatic int urtwn_llt_write(struct urtwn_softc *, uint32_t, 197251538Srpaulo uint32_t); 198251538Srpaulostatic uint8_t urtwn_efuse_read_1(struct urtwn_softc *, uint16_t); 199251538Srpaulostatic void urtwn_efuse_read(struct urtwn_softc *); 200251538Srpaulostatic int urtwn_read_chipid(struct urtwn_softc *); 201251538Srpaulostatic void urtwn_read_rom(struct urtwn_softc *); 202251538Srpaulostatic int urtwn_ra_init(struct urtwn_softc *); 203251538Srpaulostatic void urtwn_tsf_sync_enable(struct urtwn_softc *); 204251538Srpaulostatic void urtwn_set_led(struct urtwn_softc *, int, int); 205251538Srpaulostatic int urtwn_newstate(struct ieee80211vap *, 206251538Srpaulo enum ieee80211_state, int); 207251538Srpaulostatic void urtwn_watchdog(void *); 208251538Srpaulostatic void urtwn_update_avgrssi(struct urtwn_softc *, int, int8_t); 209251538Srpaulostatic int8_t urtwn_get_rssi(struct urtwn_softc *, int, void *); 210251538Srpaulostatic int urtwn_tx_start(struct urtwn_softc *, 211251538Srpaulo struct ieee80211_node *, struct mbuf *, 212251538Srpaulo struct urtwn_data *); 213251538Srpaulostatic void urtwn_start(struct ifnet *); 214261863Srpaulostatic void urtwn_start_locked(struct ifnet *, 215261863Srpaulo struct urtwn_softc *); 216251538Srpaulostatic int urtwn_ioctl(struct ifnet *, u_long, caddr_t); 217251538Srpaulostatic int urtwn_power_on(struct urtwn_softc *); 218251538Srpaulostatic int urtwn_llt_init(struct urtwn_softc *); 219251538Srpaulostatic void urtwn_fw_reset(struct urtwn_softc *); 220251538Srpaulostatic int urtwn_fw_loadpage(struct urtwn_softc *, int, 221251538Srpaulo const uint8_t *, int); 222251538Srpaulostatic int urtwn_load_firmware(struct urtwn_softc *); 223251538Srpaulostatic int urtwn_dma_init(struct urtwn_softc *); 224251538Srpaulostatic void urtwn_mac_init(struct urtwn_softc *); 225251538Srpaulostatic void urtwn_bb_init(struct urtwn_softc *); 226251538Srpaulostatic void urtwn_rf_init(struct urtwn_softc *); 227251538Srpaulostatic void urtwn_cam_init(struct urtwn_softc *); 228251538Srpaulostatic void urtwn_pa_bias_init(struct urtwn_softc *); 229251538Srpaulostatic void urtwn_rxfilter_init(struct urtwn_softc *); 230251538Srpaulostatic void urtwn_edca_init(struct urtwn_softc *); 231251538Srpaulostatic void urtwn_write_txpower(struct urtwn_softc *, int, 232251538Srpaulo uint16_t[]); 233251538Srpaulostatic void urtwn_get_txpower(struct urtwn_softc *, int, 234251538Srpaulo struct ieee80211_channel *, 235251538Srpaulo struct ieee80211_channel *, uint16_t[]); 236251538Srpaulostatic void urtwn_set_txpower(struct urtwn_softc *, 237251538Srpaulo struct ieee80211_channel *, 238251538Srpaulo struct ieee80211_channel *); 239251538Srpaulostatic void urtwn_scan_start(struct ieee80211com *); 240251538Srpaulostatic void urtwn_scan_end(struct ieee80211com *); 241251538Srpaulostatic void urtwn_set_channel(struct ieee80211com *); 242251538Srpaulostatic void urtwn_set_chan(struct urtwn_softc *, 243251538Srpaulo struct ieee80211_channel *, 244251538Srpaulo struct ieee80211_channel *); 245251538Srpaulostatic void urtwn_update_mcast(struct ifnet *); 246251538Srpaulostatic void urtwn_iq_calib(struct urtwn_softc *); 247251538Srpaulostatic void urtwn_lc_calib(struct urtwn_softc *); 248251538Srpaulostatic void urtwn_init(void *); 249251538Srpaulostatic void urtwn_init_locked(void *); 250251538Srpaulostatic void urtwn_stop(struct ifnet *, int); 251251538Srpaulostatic void urtwn_stop_locked(struct ifnet *, int); 252251538Srpaulostatic void urtwn_abort_xfers(struct urtwn_softc *); 253251538Srpaulostatic int urtwn_raw_xmit(struct ieee80211_node *, struct mbuf *, 254251538Srpaulo const struct ieee80211_bpf_params *); 255251538Srpaulo 256251538Srpaulo/* Aliases. */ 257251538Srpaulo#define urtwn_bb_write urtwn_write_4 258251538Srpaulo#define urtwn_bb_read urtwn_read_4 259251538Srpaulo 260251538Srpaulostatic const struct usb_config urtwn_config[URTWN_N_TRANSFER] = { 261251538Srpaulo [URTWN_BULK_RX] = { 262251538Srpaulo .type = UE_BULK, 263251538Srpaulo .endpoint = UE_ADDR_ANY, 264251538Srpaulo .direction = UE_DIR_IN, 265251538Srpaulo .bufsize = URTWN_RXBUFSZ, 266251538Srpaulo .flags = { 267251538Srpaulo .pipe_bof = 1, 268251538Srpaulo .short_xfer_ok = 1 269251538Srpaulo }, 270251538Srpaulo .callback = urtwn_bulk_rx_callback, 271251538Srpaulo }, 272251538Srpaulo [URTWN_BULK_TX_BE] = { 273251538Srpaulo .type = UE_BULK, 274251538Srpaulo .endpoint = 0x03, 275251538Srpaulo .direction = UE_DIR_OUT, 276251538Srpaulo .bufsize = URTWN_TXBUFSZ, 277251538Srpaulo .flags = { 278251538Srpaulo .ext_buffer = 1, 279251538Srpaulo .pipe_bof = 1, 280251538Srpaulo .force_short_xfer = 1 281251538Srpaulo }, 282251538Srpaulo .callback = urtwn_bulk_tx_callback, 283251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 284251538Srpaulo }, 285251538Srpaulo [URTWN_BULK_TX_BK] = { 286251538Srpaulo .type = UE_BULK, 287251538Srpaulo .endpoint = 0x03, 288251538Srpaulo .direction = UE_DIR_OUT, 289251538Srpaulo .bufsize = URTWN_TXBUFSZ, 290251538Srpaulo .flags = { 291251538Srpaulo .ext_buffer = 1, 292251538Srpaulo .pipe_bof = 1, 293251538Srpaulo .force_short_xfer = 1, 294251538Srpaulo }, 295251538Srpaulo .callback = urtwn_bulk_tx_callback, 296251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 297251538Srpaulo }, 298251538Srpaulo [URTWN_BULK_TX_VI] = { 299251538Srpaulo .type = UE_BULK, 300251538Srpaulo .endpoint = 0x02, 301251538Srpaulo .direction = UE_DIR_OUT, 302251538Srpaulo .bufsize = URTWN_TXBUFSZ, 303251538Srpaulo .flags = { 304251538Srpaulo .ext_buffer = 1, 305251538Srpaulo .pipe_bof = 1, 306251538Srpaulo .force_short_xfer = 1 307251538Srpaulo }, 308251538Srpaulo .callback = urtwn_bulk_tx_callback, 309251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 310251538Srpaulo }, 311251538Srpaulo [URTWN_BULK_TX_VO] = { 312251538Srpaulo .type = UE_BULK, 313251538Srpaulo .endpoint = 0x02, 314251538Srpaulo .direction = UE_DIR_OUT, 315251538Srpaulo .bufsize = URTWN_TXBUFSZ, 316251538Srpaulo .flags = { 317251538Srpaulo .ext_buffer = 1, 318251538Srpaulo .pipe_bof = 1, 319251538Srpaulo .force_short_xfer = 1 320251538Srpaulo }, 321251538Srpaulo .callback = urtwn_bulk_tx_callback, 322251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 323251538Srpaulo }, 324251538Srpaulo}; 325251538Srpaulo 326251538Srpaulostatic int 327251538Srpaulourtwn_match(device_t self) 328251538Srpaulo{ 329251538Srpaulo struct usb_attach_arg *uaa = device_get_ivars(self); 330251538Srpaulo 331251538Srpaulo if (uaa->usb_mode != USB_MODE_HOST) 332251538Srpaulo return (ENXIO); 333251538Srpaulo if (uaa->info.bConfigIndex != URTWN_CONFIG_INDEX) 334251538Srpaulo return (ENXIO); 335251538Srpaulo if (uaa->info.bIfaceIndex != URTWN_IFACE_INDEX) 336251538Srpaulo return (ENXIO); 337251538Srpaulo 338251538Srpaulo return (usbd_lookup_id_by_uaa(urtwn_devs, sizeof(urtwn_devs), uaa)); 339251538Srpaulo} 340251538Srpaulo 341251538Srpaulostatic int 342251538Srpaulourtwn_attach(device_t self) 343251538Srpaulo{ 344251538Srpaulo struct usb_attach_arg *uaa = device_get_ivars(self); 345251538Srpaulo struct urtwn_softc *sc = device_get_softc(self); 346251538Srpaulo struct ifnet *ifp; 347251538Srpaulo struct ieee80211com *ic; 348251538Srpaulo uint8_t iface_index, bands; 349251538Srpaulo int error; 350251538Srpaulo 351251538Srpaulo device_set_usb_desc(self); 352251538Srpaulo sc->sc_udev = uaa->device; 353251538Srpaulo sc->sc_dev = self; 354251538Srpaulo 355251538Srpaulo mtx_init(&sc->sc_mtx, device_get_nameunit(self), 356251538Srpaulo MTX_NETWORK_LOCK, MTX_DEF); 357251538Srpaulo callout_init(&sc->sc_watchdog_ch, 0); 358251538Srpaulo 359251538Srpaulo iface_index = URTWN_IFACE_INDEX; 360251538Srpaulo error = usbd_transfer_setup(uaa->device, &iface_index, sc->sc_xfer, 361251538Srpaulo urtwn_config, URTWN_N_TRANSFER, sc, &sc->sc_mtx); 362251538Srpaulo if (error) { 363251538Srpaulo device_printf(self, "could not allocate USB transfers, " 364251538Srpaulo "err=%s\n", usbd_errstr(error)); 365251538Srpaulo goto detach; 366251538Srpaulo } 367251538Srpaulo 368251538Srpaulo URTWN_LOCK(sc); 369251538Srpaulo 370251538Srpaulo error = urtwn_read_chipid(sc); 371251538Srpaulo if (error) { 372251538Srpaulo device_printf(sc->sc_dev, "unsupported test chip\n"); 373251538Srpaulo URTWN_UNLOCK(sc); 374251538Srpaulo goto detach; 375251538Srpaulo } 376251538Srpaulo 377251538Srpaulo /* Determine number of Tx/Rx chains. */ 378251538Srpaulo if (sc->chip & URTWN_CHIP_92C) { 379251538Srpaulo sc->ntxchains = (sc->chip & URTWN_CHIP_92C_1T2R) ? 1 : 2; 380251538Srpaulo sc->nrxchains = 2; 381251538Srpaulo } else { 382251538Srpaulo sc->ntxchains = 1; 383251538Srpaulo sc->nrxchains = 1; 384251538Srpaulo } 385251538Srpaulo urtwn_read_rom(sc); 386251538Srpaulo 387251538Srpaulo device_printf(sc->sc_dev, "MAC/BB RTL%s, RF 6052 %dT%dR\n", 388251538Srpaulo (sc->chip & URTWN_CHIP_92C) ? "8192CU" : 389251538Srpaulo (sc->board_type == R92C_BOARD_TYPE_HIGHPA) ? "8188RU" : 390251538Srpaulo (sc->board_type == R92C_BOARD_TYPE_MINICARD) ? "8188CE-VAU" : 391251538Srpaulo "8188CUS", sc->ntxchains, sc->nrxchains); 392251538Srpaulo 393251538Srpaulo URTWN_UNLOCK(sc); 394251538Srpaulo 395251538Srpaulo ifp = sc->sc_ifp = if_alloc(IFT_IEEE80211); 396251538Srpaulo if (ifp == NULL) { 397251538Srpaulo device_printf(sc->sc_dev, "can not if_alloc()\n"); 398251538Srpaulo goto detach; 399251538Srpaulo } 400251538Srpaulo ic = ifp->if_l2com; 401251538Srpaulo 402251538Srpaulo ifp->if_softc = sc; 403251538Srpaulo if_initname(ifp, "urtwn", device_get_unit(sc->sc_dev)); 404251538Srpaulo ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 405251538Srpaulo ifp->if_init = urtwn_init; 406251538Srpaulo ifp->if_ioctl = urtwn_ioctl; 407251538Srpaulo ifp->if_start = urtwn_start; 408251538Srpaulo IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen); 409251538Srpaulo ifp->if_snd.ifq_drv_maxlen = ifqmaxlen; 410251538Srpaulo IFQ_SET_READY(&ifp->if_snd); 411251538Srpaulo 412251538Srpaulo ic->ic_ifp = ifp; 413251538Srpaulo ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ 414251538Srpaulo ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */ 415251538Srpaulo 416251538Srpaulo /* set device capabilities */ 417251538Srpaulo ic->ic_caps = 418251538Srpaulo IEEE80211_C_STA /* station mode */ 419251538Srpaulo | IEEE80211_C_MONITOR /* monitor mode */ 420251538Srpaulo | IEEE80211_C_SHPREAMBLE /* short preamble supported */ 421251538Srpaulo | IEEE80211_C_SHSLOT /* short slot time supported */ 422251538Srpaulo | IEEE80211_C_BGSCAN /* capable of bg scanning */ 423251538Srpaulo | IEEE80211_C_WPA /* 802.11i */ 424251538Srpaulo ; 425251538Srpaulo 426251538Srpaulo bands = 0; 427251538Srpaulo setbit(&bands, IEEE80211_MODE_11B); 428251538Srpaulo setbit(&bands, IEEE80211_MODE_11G); 429251538Srpaulo ieee80211_init_channels(ic, NULL, &bands); 430251538Srpaulo 431251538Srpaulo ieee80211_ifattach(ic, sc->sc_bssid); 432251538Srpaulo ic->ic_raw_xmit = urtwn_raw_xmit; 433251538Srpaulo ic->ic_scan_start = urtwn_scan_start; 434251538Srpaulo ic->ic_scan_end = urtwn_scan_end; 435251538Srpaulo ic->ic_set_channel = urtwn_set_channel; 436251538Srpaulo 437251538Srpaulo ic->ic_vap_create = urtwn_vap_create; 438251538Srpaulo ic->ic_vap_delete = urtwn_vap_delete; 439251538Srpaulo ic->ic_update_mcast = urtwn_update_mcast; 440251538Srpaulo 441251538Srpaulo ieee80211_radiotap_attach(ic, &sc->sc_txtap.wt_ihdr, 442251538Srpaulo sizeof(sc->sc_txtap), URTWN_TX_RADIOTAP_PRESENT, 443251538Srpaulo &sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap), 444251538Srpaulo URTWN_RX_RADIOTAP_PRESENT); 445251538Srpaulo 446251538Srpaulo if (bootverbose) 447251538Srpaulo ieee80211_announce(ic); 448251538Srpaulo 449251538Srpaulo return (0); 450251538Srpaulo 451251538Srpaulodetach: 452251538Srpaulo urtwn_detach(self); 453251538Srpaulo return (ENXIO); /* failure */ 454251538Srpaulo} 455251538Srpaulo 456251538Srpaulostatic int 457251538Srpaulourtwn_detach(device_t self) 458251538Srpaulo{ 459251538Srpaulo struct urtwn_softc *sc = device_get_softc(self); 460251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 461251538Srpaulo struct ieee80211com *ic = ifp->if_l2com; 462251538Srpaulo 463251538Srpaulo if (!device_is_attached(self)) 464251538Srpaulo return (0); 465251538Srpaulo 466251538Srpaulo urtwn_stop(ifp, 1); 467251538Srpaulo 468251538Srpaulo callout_drain(&sc->sc_watchdog_ch); 469251538Srpaulo 470251538Srpaulo /* stop all USB transfers */ 471251538Srpaulo usbd_transfer_unsetup(sc->sc_xfer, URTWN_N_TRANSFER); 472251538Srpaulo ieee80211_ifdetach(ic); 473251538Srpaulo 474251538Srpaulo urtwn_free_tx_list(sc); 475251538Srpaulo urtwn_free_rx_list(sc); 476251538Srpaulo 477251538Srpaulo if_free(ifp); 478251538Srpaulo mtx_destroy(&sc->sc_mtx); 479251538Srpaulo 480251538Srpaulo return (0); 481251538Srpaulo} 482251538Srpaulo 483251538Srpaulostatic void 484251538Srpaulourtwn_free_tx_list(struct urtwn_softc *sc) 485251538Srpaulo{ 486251538Srpaulo urtwn_free_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT); 487251538Srpaulo} 488251538Srpaulo 489251538Srpaulostatic void 490251538Srpaulourtwn_free_rx_list(struct urtwn_softc *sc) 491251538Srpaulo{ 492251538Srpaulo urtwn_free_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT); 493251538Srpaulo} 494251538Srpaulo 495251538Srpaulostatic void 496251538Srpaulourtwn_free_list(struct urtwn_softc *sc, struct urtwn_data data[], int ndata) 497251538Srpaulo{ 498251538Srpaulo int i; 499251538Srpaulo 500251538Srpaulo for (i = 0; i < ndata; i++) { 501251538Srpaulo struct urtwn_data *dp = &data[i]; 502251538Srpaulo 503251538Srpaulo if (dp->buf != NULL) { 504251538Srpaulo free(dp->buf, M_USBDEV); 505251538Srpaulo dp->buf = NULL; 506251538Srpaulo } 507251538Srpaulo if (dp->ni != NULL) { 508251538Srpaulo ieee80211_free_node(dp->ni); 509251538Srpaulo dp->ni = NULL; 510251538Srpaulo } 511251538Srpaulo } 512251538Srpaulo} 513251538Srpaulo 514251538Srpaulostatic usb_error_t 515251538Srpaulourtwn_do_request(struct urtwn_softc *sc, struct usb_device_request *req, 516251538Srpaulo void *data) 517251538Srpaulo{ 518251538Srpaulo usb_error_t err; 519251538Srpaulo int ntries = 10; 520251538Srpaulo 521251538Srpaulo URTWN_ASSERT_LOCKED(sc); 522251538Srpaulo 523251538Srpaulo while (ntries--) { 524251538Srpaulo err = usbd_do_request_flags(sc->sc_udev, &sc->sc_mtx, 525251538Srpaulo req, data, 0, NULL, 250 /* ms */); 526251538Srpaulo if (err == 0) 527251538Srpaulo break; 528251538Srpaulo 529251538Srpaulo DPRINTFN(1, "Control request failed, %s (retrying)\n", 530251538Srpaulo usbd_errstr(err)); 531251538Srpaulo usb_pause_mtx(&sc->sc_mtx, hz / 100); 532251538Srpaulo } 533251538Srpaulo return (err); 534251538Srpaulo} 535251538Srpaulo 536251538Srpaulostatic struct ieee80211vap * 537251538Srpaulourtwn_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit, 538251538Srpaulo enum ieee80211_opmode opmode, int flags, 539251538Srpaulo const uint8_t bssid[IEEE80211_ADDR_LEN], 540251538Srpaulo const uint8_t mac[IEEE80211_ADDR_LEN]) 541251538Srpaulo{ 542251538Srpaulo struct urtwn_vap *uvp; 543251538Srpaulo struct ieee80211vap *vap; 544251538Srpaulo 545251538Srpaulo if (!TAILQ_EMPTY(&ic->ic_vaps)) /* only one at a time */ 546251538Srpaulo return (NULL); 547251538Srpaulo 548251538Srpaulo uvp = (struct urtwn_vap *) malloc(sizeof(struct urtwn_vap), 549251538Srpaulo M_80211_VAP, M_NOWAIT | M_ZERO); 550251538Srpaulo if (uvp == NULL) 551251538Srpaulo return (NULL); 552251538Srpaulo vap = &uvp->vap; 553251538Srpaulo /* enable s/w bmiss handling for sta mode */ 554251538Srpaulo 555257743Shselasky if (ieee80211_vap_setup(ic, vap, name, unit, opmode, 556257743Shselasky flags | IEEE80211_CLONE_NOBEACONS, bssid, mac) != 0) { 557257743Shselasky /* out of memory */ 558257743Shselasky free(uvp, M_80211_VAP); 559257743Shselasky return (NULL); 560257743Shselasky } 561257743Shselasky 562251538Srpaulo /* override state transition machine */ 563251538Srpaulo uvp->newstate = vap->iv_newstate; 564251538Srpaulo vap->iv_newstate = urtwn_newstate; 565251538Srpaulo 566251538Srpaulo /* complete setup */ 567251538Srpaulo ieee80211_vap_attach(vap, ieee80211_media_change, 568251538Srpaulo ieee80211_media_status); 569251538Srpaulo ic->ic_opmode = opmode; 570251538Srpaulo return (vap); 571251538Srpaulo} 572251538Srpaulo 573251538Srpaulostatic void 574251538Srpaulourtwn_vap_delete(struct ieee80211vap *vap) 575251538Srpaulo{ 576251538Srpaulo struct urtwn_vap *uvp = URTWN_VAP(vap); 577251538Srpaulo 578251538Srpaulo ieee80211_vap_detach(vap); 579251538Srpaulo free(uvp, M_80211_VAP); 580251538Srpaulo} 581251538Srpaulo 582251538Srpaulostatic struct mbuf * 583251538Srpaulourtwn_rx_frame(struct urtwn_softc *sc, uint8_t *buf, int pktlen, int *rssi_p) 584251538Srpaulo{ 585251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 586251538Srpaulo struct ieee80211com *ic = ifp->if_l2com; 587251538Srpaulo struct ieee80211_frame *wh; 588251538Srpaulo struct mbuf *m; 589251538Srpaulo struct r92c_rx_stat *stat; 590251538Srpaulo uint32_t rxdw0, rxdw3; 591251538Srpaulo uint8_t rate; 592251538Srpaulo int8_t rssi = 0; 593251538Srpaulo int infosz; 594251538Srpaulo 595251538Srpaulo /* 596251538Srpaulo * don't pass packets to the ieee80211 framework if the driver isn't 597251538Srpaulo * RUNNING. 598251538Srpaulo */ 599251538Srpaulo if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) 600251538Srpaulo return (NULL); 601251538Srpaulo 602251538Srpaulo stat = (struct r92c_rx_stat *)buf; 603251538Srpaulo rxdw0 = le32toh(stat->rxdw0); 604251538Srpaulo rxdw3 = le32toh(stat->rxdw3); 605251538Srpaulo 606251538Srpaulo if (rxdw0 & (R92C_RXDW0_CRCERR | R92C_RXDW0_ICVERR)) { 607251538Srpaulo /* 608251538Srpaulo * This should not happen since we setup our Rx filter 609251538Srpaulo * to not receive these frames. 610251538Srpaulo */ 611251538Srpaulo ifp->if_ierrors++; 612251538Srpaulo return (NULL); 613251538Srpaulo } 614251538Srpaulo 615251538Srpaulo rate = MS(rxdw3, R92C_RXDW3_RATE); 616251538Srpaulo infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8; 617251538Srpaulo 618251538Srpaulo /* Get RSSI from PHY status descriptor if present. */ 619251538Srpaulo if (infosz != 0 && (rxdw0 & R92C_RXDW0_PHYST)) { 620251538Srpaulo rssi = urtwn_get_rssi(sc, rate, &stat[1]); 621251538Srpaulo /* Update our average RSSI. */ 622251538Srpaulo urtwn_update_avgrssi(sc, rate, rssi); 623252405Srpaulo /* 624252405Srpaulo * Convert the RSSI to a range that will be accepted 625252405Srpaulo * by net80211. 626252405Srpaulo */ 627252405Srpaulo rssi = URTWN_RSSI(rssi); 628251538Srpaulo } 629251538Srpaulo 630260463Skevlo m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 631251538Srpaulo if (m == NULL) { 632251538Srpaulo device_printf(sc->sc_dev, "could not create RX mbuf\n"); 633251538Srpaulo return (NULL); 634251538Srpaulo } 635251538Srpaulo 636251538Srpaulo /* Finalize mbuf. */ 637251538Srpaulo m->m_pkthdr.rcvif = ifp; 638251538Srpaulo wh = (struct ieee80211_frame *)((uint8_t *)&stat[1] + infosz); 639251538Srpaulo memcpy(mtod(m, uint8_t *), wh, pktlen); 640251538Srpaulo m->m_pkthdr.len = m->m_len = pktlen; 641251538Srpaulo 642251538Srpaulo if (ieee80211_radiotap_active(ic)) { 643251538Srpaulo struct urtwn_rx_radiotap_header *tap = &sc->sc_rxtap; 644251538Srpaulo 645251538Srpaulo tap->wr_flags = 0; 646251538Srpaulo /* Map HW rate index to 802.11 rate. */ 647251538Srpaulo if (!(rxdw3 & R92C_RXDW3_HT)) { 648251538Srpaulo switch (rate) { 649251538Srpaulo /* CCK. */ 650251538Srpaulo case 0: tap->wr_rate = 2; break; 651251538Srpaulo case 1: tap->wr_rate = 4; break; 652251538Srpaulo case 2: tap->wr_rate = 11; break; 653251538Srpaulo case 3: tap->wr_rate = 22; break; 654251538Srpaulo /* OFDM. */ 655251538Srpaulo case 4: tap->wr_rate = 12; break; 656251538Srpaulo case 5: tap->wr_rate = 18; break; 657251538Srpaulo case 6: tap->wr_rate = 24; break; 658251538Srpaulo case 7: tap->wr_rate = 36; break; 659251538Srpaulo case 8: tap->wr_rate = 48; break; 660251538Srpaulo case 9: tap->wr_rate = 72; break; 661251538Srpaulo case 10: tap->wr_rate = 96; break; 662251538Srpaulo case 11: tap->wr_rate = 108; break; 663251538Srpaulo } 664251538Srpaulo } else if (rate >= 12) { /* MCS0~15. */ 665251538Srpaulo /* Bit 7 set means HT MCS instead of rate. */ 666251538Srpaulo tap->wr_rate = 0x80 | (rate - 12); 667251538Srpaulo } 668251538Srpaulo tap->wr_dbm_antsignal = rssi; 669251538Srpaulo tap->wr_chan_freq = htole16(ic->ic_curchan->ic_freq); 670251538Srpaulo tap->wr_chan_flags = htole16(ic->ic_curchan->ic_flags); 671251538Srpaulo } 672251538Srpaulo 673251538Srpaulo *rssi_p = rssi; 674251538Srpaulo 675251538Srpaulo return (m); 676251538Srpaulo} 677251538Srpaulo 678251538Srpaulostatic struct mbuf * 679251538Srpaulourtwn_rxeof(struct usb_xfer *xfer, struct urtwn_data *data, int *rssi, 680251538Srpaulo int8_t *nf) 681251538Srpaulo{ 682251538Srpaulo struct urtwn_softc *sc = data->sc; 683251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 684251538Srpaulo struct r92c_rx_stat *stat; 685251538Srpaulo struct mbuf *m, *m0 = NULL, *prevm = NULL; 686251538Srpaulo uint32_t rxdw0; 687251538Srpaulo uint8_t *buf; 688251538Srpaulo int len, totlen, pktlen, infosz, npkts; 689251538Srpaulo 690251538Srpaulo usbd_xfer_status(xfer, &len, NULL, NULL, NULL); 691251538Srpaulo 692251538Srpaulo if (len < sizeof(*stat)) { 693251538Srpaulo ifp->if_ierrors++; 694251538Srpaulo return (NULL); 695251538Srpaulo } 696251538Srpaulo 697251538Srpaulo buf = data->buf; 698251538Srpaulo /* Get the number of encapsulated frames. */ 699251538Srpaulo stat = (struct r92c_rx_stat *)buf; 700251538Srpaulo npkts = MS(le32toh(stat->rxdw2), R92C_RXDW2_PKTCNT); 701251538Srpaulo DPRINTFN(6, "Rx %d frames in one chunk\n", npkts); 702251538Srpaulo 703251538Srpaulo /* Process all of them. */ 704251538Srpaulo while (npkts-- > 0) { 705251538Srpaulo if (len < sizeof(*stat)) 706251538Srpaulo break; 707251538Srpaulo stat = (struct r92c_rx_stat *)buf; 708251538Srpaulo rxdw0 = le32toh(stat->rxdw0); 709251538Srpaulo 710251538Srpaulo pktlen = MS(rxdw0, R92C_RXDW0_PKTLEN); 711251538Srpaulo if (pktlen == 0) 712251538Srpaulo break; 713251538Srpaulo 714251538Srpaulo infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8; 715251538Srpaulo 716251538Srpaulo /* Make sure everything fits in xfer. */ 717251538Srpaulo totlen = sizeof(*stat) + infosz + pktlen; 718251538Srpaulo if (totlen > len) 719251538Srpaulo break; 720251538Srpaulo 721251538Srpaulo m = urtwn_rx_frame(sc, buf, pktlen, rssi); 722251538Srpaulo if (m0 == NULL) 723251538Srpaulo m0 = m; 724251538Srpaulo if (prevm == NULL) 725251538Srpaulo prevm = m; 726251538Srpaulo else { 727251538Srpaulo prevm->m_next = m; 728251538Srpaulo prevm = m; 729251538Srpaulo } 730251538Srpaulo 731251538Srpaulo /* Next chunk is 128-byte aligned. */ 732251538Srpaulo totlen = (totlen + 127) & ~127; 733251538Srpaulo buf += totlen; 734251538Srpaulo len -= totlen; 735251538Srpaulo } 736251538Srpaulo 737251538Srpaulo return (m0); 738251538Srpaulo} 739251538Srpaulo 740251538Srpaulostatic void 741251538Srpaulourtwn_bulk_rx_callback(struct usb_xfer *xfer, usb_error_t error) 742251538Srpaulo{ 743251538Srpaulo struct urtwn_softc *sc = usbd_xfer_softc(xfer); 744251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 745251538Srpaulo struct ieee80211com *ic = ifp->if_l2com; 746251538Srpaulo struct ieee80211_frame *wh; 747251538Srpaulo struct ieee80211_node *ni; 748251538Srpaulo struct mbuf *m = NULL, *next; 749251538Srpaulo struct urtwn_data *data; 750251538Srpaulo int8_t nf; 751251538Srpaulo int rssi = 1; 752251538Srpaulo 753251538Srpaulo URTWN_ASSERT_LOCKED(sc); 754251538Srpaulo 755251538Srpaulo switch (USB_GET_STATE(xfer)) { 756251538Srpaulo case USB_ST_TRANSFERRED: 757251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_active); 758251538Srpaulo if (data == NULL) 759251538Srpaulo goto tr_setup; 760251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 761251538Srpaulo m = urtwn_rxeof(xfer, data, &rssi, &nf); 762251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 763251538Srpaulo /* FALLTHROUGH */ 764251538Srpaulo case USB_ST_SETUP: 765251538Srpaulotr_setup: 766251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_inactive); 767251538Srpaulo if (data == NULL) { 768251538Srpaulo KASSERT(m == NULL, ("mbuf isn't NULL")); 769251538Srpaulo return; 770251538Srpaulo } 771251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_inactive, next); 772251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_active, data, next); 773251538Srpaulo usbd_xfer_set_frame_data(xfer, 0, data->buf, 774251538Srpaulo usbd_xfer_max_len(xfer)); 775251538Srpaulo usbd_transfer_submit(xfer); 776251538Srpaulo 777251538Srpaulo /* 778251538Srpaulo * To avoid LOR we should unlock our private mutex here to call 779251538Srpaulo * ieee80211_input() because here is at the end of a USB 780251538Srpaulo * callback and safe to unlock. 781251538Srpaulo */ 782251538Srpaulo URTWN_UNLOCK(sc); 783251538Srpaulo while (m != NULL) { 784251538Srpaulo next = m->m_next; 785251538Srpaulo m->m_next = NULL; 786251538Srpaulo wh = mtod(m, struct ieee80211_frame *); 787251538Srpaulo ni = ieee80211_find_rxnode(ic, 788251538Srpaulo (struct ieee80211_frame_min *)wh); 789251538Srpaulo nf = URTWN_NOISE_FLOOR; 790251538Srpaulo if (ni != NULL) { 791251538Srpaulo (void)ieee80211_input(ni, m, rssi, nf); 792251538Srpaulo ieee80211_free_node(ni); 793251538Srpaulo } else 794251538Srpaulo (void)ieee80211_input_all(ic, m, rssi, nf); 795251538Srpaulo m = next; 796251538Srpaulo } 797251538Srpaulo URTWN_LOCK(sc); 798251538Srpaulo break; 799251538Srpaulo default: 800251538Srpaulo /* needs it to the inactive queue due to a error. */ 801251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_active); 802251538Srpaulo if (data != NULL) { 803251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 804251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 805251538Srpaulo } 806251538Srpaulo if (error != USB_ERR_CANCELLED) { 807251538Srpaulo usbd_xfer_set_stall(xfer); 808251538Srpaulo ifp->if_ierrors++; 809251538Srpaulo goto tr_setup; 810251538Srpaulo } 811251538Srpaulo break; 812251538Srpaulo } 813251538Srpaulo} 814251538Srpaulo 815251538Srpaulostatic void 816251538Srpaulourtwn_txeof(struct usb_xfer *xfer, struct urtwn_data *data) 817251538Srpaulo{ 818251538Srpaulo struct urtwn_softc *sc = usbd_xfer_softc(xfer); 819251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 820251538Srpaulo struct mbuf *m; 821251538Srpaulo 822251538Srpaulo URTWN_ASSERT_LOCKED(sc); 823251538Srpaulo 824251538Srpaulo /* 825251538Srpaulo * Do any tx complete callback. Note this must be done before releasing 826251538Srpaulo * the node reference. 827251538Srpaulo */ 828251538Srpaulo if (data->m) { 829251538Srpaulo m = data->m; 830251538Srpaulo if (m->m_flags & M_TXCB) { 831251538Srpaulo /* XXX status? */ 832251538Srpaulo ieee80211_process_callback(data->ni, m, 0); 833251538Srpaulo } 834251538Srpaulo m_freem(m); 835251538Srpaulo data->m = NULL; 836251538Srpaulo } 837251538Srpaulo if (data->ni) { 838251538Srpaulo ieee80211_free_node(data->ni); 839251538Srpaulo data->ni = NULL; 840251538Srpaulo } 841251538Srpaulo sc->sc_txtimer = 0; 842251538Srpaulo ifp->if_opackets++; 843251538Srpaulo ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 844251538Srpaulo} 845251538Srpaulo 846251538Srpaulostatic void 847251538Srpaulourtwn_bulk_tx_callback(struct usb_xfer *xfer, usb_error_t error) 848251538Srpaulo{ 849251538Srpaulo struct urtwn_softc *sc = usbd_xfer_softc(xfer); 850251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 851251538Srpaulo struct urtwn_data *data; 852251538Srpaulo 853251538Srpaulo URTWN_ASSERT_LOCKED(sc); 854251538Srpaulo 855251538Srpaulo switch (USB_GET_STATE(xfer)){ 856251538Srpaulo case USB_ST_TRANSFERRED: 857251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_active); 858251538Srpaulo if (data == NULL) 859251538Srpaulo goto tr_setup; 860251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next); 861251538Srpaulo urtwn_txeof(xfer, data); 862251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data, next); 863251538Srpaulo /* FALLTHROUGH */ 864251538Srpaulo case USB_ST_SETUP: 865251538Srpaulotr_setup: 866251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_pending); 867251538Srpaulo if (data == NULL) { 868251538Srpaulo DPRINTF("%s: empty pending queue\n", __func__); 869251538Srpaulo return; 870251538Srpaulo } 871251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_pending, next); 872251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_tx_active, data, next); 873251538Srpaulo usbd_xfer_set_frame_data(xfer, 0, data->buf, data->buflen); 874251538Srpaulo usbd_transfer_submit(xfer); 875261863Srpaulo urtwn_start_locked(ifp, sc); 876251538Srpaulo break; 877251538Srpaulo default: 878251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_active); 879251538Srpaulo if (data == NULL) 880251538Srpaulo goto tr_setup; 881251538Srpaulo if (data->ni != NULL) { 882251538Srpaulo ieee80211_free_node(data->ni); 883251538Srpaulo data->ni = NULL; 884251538Srpaulo ifp->if_oerrors++; 885251538Srpaulo } 886251538Srpaulo if (error != USB_ERR_CANCELLED) { 887251538Srpaulo usbd_xfer_set_stall(xfer); 888251538Srpaulo goto tr_setup; 889251538Srpaulo } 890251538Srpaulo break; 891251538Srpaulo } 892251538Srpaulo} 893251538Srpaulo 894251538Srpaulostatic struct urtwn_data * 895251538Srpaulo_urtwn_getbuf(struct urtwn_softc *sc) 896251538Srpaulo{ 897251538Srpaulo struct urtwn_data *bf; 898251538Srpaulo 899251538Srpaulo bf = STAILQ_FIRST(&sc->sc_tx_inactive); 900251538Srpaulo if (bf != NULL) 901251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_inactive, next); 902251538Srpaulo else 903251538Srpaulo bf = NULL; 904251538Srpaulo if (bf == NULL) 905251538Srpaulo DPRINTF("%s: %s\n", __func__, "out of xmit buffers"); 906251538Srpaulo return (bf); 907251538Srpaulo} 908251538Srpaulo 909251538Srpaulostatic struct urtwn_data * 910251538Srpaulourtwn_getbuf(struct urtwn_softc *sc) 911251538Srpaulo{ 912251538Srpaulo struct urtwn_data *bf; 913251538Srpaulo 914251538Srpaulo URTWN_ASSERT_LOCKED(sc); 915251538Srpaulo 916251538Srpaulo bf = _urtwn_getbuf(sc); 917251538Srpaulo if (bf == NULL) { 918251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 919251538Srpaulo DPRINTF("%s: stop queue\n", __func__); 920251538Srpaulo ifp->if_drv_flags |= IFF_DRV_OACTIVE; 921251538Srpaulo } 922251538Srpaulo return (bf); 923251538Srpaulo} 924251538Srpaulo 925251538Srpaulostatic int 926251538Srpaulourtwn_write_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf, 927251538Srpaulo int len) 928251538Srpaulo{ 929251538Srpaulo usb_device_request_t req; 930251538Srpaulo 931251538Srpaulo req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 932251538Srpaulo req.bRequest = R92C_REQ_REGS; 933251538Srpaulo USETW(req.wValue, addr); 934251538Srpaulo USETW(req.wIndex, 0); 935251538Srpaulo USETW(req.wLength, len); 936251538Srpaulo return (urtwn_do_request(sc, &req, buf)); 937251538Srpaulo} 938251538Srpaulo 939251538Srpaulostatic void 940251538Srpaulourtwn_write_1(struct urtwn_softc *sc, uint16_t addr, uint8_t val) 941251538Srpaulo{ 942251538Srpaulo urtwn_write_region_1(sc, addr, &val, 1); 943251538Srpaulo} 944251538Srpaulo 945251538Srpaulo 946251538Srpaulostatic void 947251538Srpaulourtwn_write_2(struct urtwn_softc *sc, uint16_t addr, uint16_t val) 948251538Srpaulo{ 949251538Srpaulo val = htole16(val); 950251538Srpaulo urtwn_write_region_1(sc, addr, (uint8_t *)&val, 2); 951251538Srpaulo} 952251538Srpaulo 953251538Srpaulostatic void 954251538Srpaulourtwn_write_4(struct urtwn_softc *sc, uint16_t addr, uint32_t val) 955251538Srpaulo{ 956251538Srpaulo val = htole32(val); 957251538Srpaulo urtwn_write_region_1(sc, addr, (uint8_t *)&val, 4); 958251538Srpaulo} 959251538Srpaulo 960251538Srpaulostatic int 961251538Srpaulourtwn_read_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf, 962251538Srpaulo int len) 963251538Srpaulo{ 964251538Srpaulo usb_device_request_t req; 965251538Srpaulo 966251538Srpaulo req.bmRequestType = UT_READ_VENDOR_DEVICE; 967251538Srpaulo req.bRequest = R92C_REQ_REGS; 968251538Srpaulo USETW(req.wValue, addr); 969251538Srpaulo USETW(req.wIndex, 0); 970251538Srpaulo USETW(req.wLength, len); 971251538Srpaulo return (urtwn_do_request(sc, &req, buf)); 972251538Srpaulo} 973251538Srpaulo 974251538Srpaulostatic uint8_t 975251538Srpaulourtwn_read_1(struct urtwn_softc *sc, uint16_t addr) 976251538Srpaulo{ 977251538Srpaulo uint8_t val; 978251538Srpaulo 979251538Srpaulo if (urtwn_read_region_1(sc, addr, &val, 1) != 0) 980251538Srpaulo return (0xff); 981251538Srpaulo return (val); 982251538Srpaulo} 983251538Srpaulo 984251538Srpaulostatic uint16_t 985251538Srpaulourtwn_read_2(struct urtwn_softc *sc, uint16_t addr) 986251538Srpaulo{ 987251538Srpaulo uint16_t val; 988251538Srpaulo 989251538Srpaulo if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 2) != 0) 990251538Srpaulo return (0xffff); 991251538Srpaulo return (le16toh(val)); 992251538Srpaulo} 993251538Srpaulo 994251538Srpaulostatic uint32_t 995251538Srpaulourtwn_read_4(struct urtwn_softc *sc, uint16_t addr) 996251538Srpaulo{ 997251538Srpaulo uint32_t val; 998251538Srpaulo 999251538Srpaulo if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 4) != 0) 1000251538Srpaulo return (0xffffffff); 1001251538Srpaulo return (le32toh(val)); 1002251538Srpaulo} 1003251538Srpaulo 1004251538Srpaulostatic int 1005251538Srpaulourtwn_fw_cmd(struct urtwn_softc *sc, uint8_t id, const void *buf, int len) 1006251538Srpaulo{ 1007251538Srpaulo struct r92c_fw_cmd cmd; 1008251538Srpaulo int ntries; 1009251538Srpaulo 1010251538Srpaulo /* Wait for current FW box to be empty. */ 1011251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 1012251538Srpaulo if (!(urtwn_read_1(sc, R92C_HMETFR) & (1 << sc->fwcur))) 1013251538Srpaulo break; 1014251538Srpaulo DELAY(1); 1015251538Srpaulo } 1016251538Srpaulo if (ntries == 100) { 1017251538Srpaulo device_printf(sc->sc_dev, 1018251538Srpaulo "could not send firmware command\n"); 1019251538Srpaulo return (ETIMEDOUT); 1020251538Srpaulo } 1021251538Srpaulo memset(&cmd, 0, sizeof(cmd)); 1022251538Srpaulo cmd.id = id; 1023251538Srpaulo if (len > 3) 1024251538Srpaulo cmd.id |= R92C_CMD_FLAG_EXT; 1025251538Srpaulo KASSERT(len <= sizeof(cmd.msg), ("urtwn_fw_cmd\n")); 1026251538Srpaulo memcpy(cmd.msg, buf, len); 1027251538Srpaulo 1028251538Srpaulo /* Write the first word last since that will trigger the FW. */ 1029251538Srpaulo urtwn_write_region_1(sc, R92C_HMEBOX_EXT(sc->fwcur), 1030251538Srpaulo (uint8_t *)&cmd + 4, 2); 1031251538Srpaulo urtwn_write_region_1(sc, R92C_HMEBOX(sc->fwcur), 1032251538Srpaulo (uint8_t *)&cmd + 0, 4); 1033251538Srpaulo 1034251538Srpaulo sc->fwcur = (sc->fwcur + 1) % R92C_H2C_NBOX; 1035251538Srpaulo return (0); 1036251538Srpaulo} 1037251538Srpaulo 1038251538Srpaulostatic void 1039251538Srpaulourtwn_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, uint32_t val) 1040251538Srpaulo{ 1041251538Srpaulo urtwn_bb_write(sc, R92C_LSSI_PARAM(chain), 1042251538Srpaulo SM(R92C_LSSI_PARAM_ADDR, addr) | 1043251538Srpaulo SM(R92C_LSSI_PARAM_DATA, val)); 1044251538Srpaulo} 1045251538Srpaulo 1046251538Srpaulostatic uint32_t 1047251538Srpaulourtwn_rf_read(struct urtwn_softc *sc, int chain, uint8_t addr) 1048251538Srpaulo{ 1049251538Srpaulo uint32_t reg[R92C_MAX_CHAINS], val; 1050251538Srpaulo 1051251538Srpaulo reg[0] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)); 1052251538Srpaulo if (chain != 0) 1053251538Srpaulo reg[chain] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(chain)); 1054251538Srpaulo 1055251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(0), 1056251538Srpaulo reg[0] & ~R92C_HSSI_PARAM2_READ_EDGE); 1057251538Srpaulo DELAY(1000); 1058251538Srpaulo 1059251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(chain), 1060251538Srpaulo RW(reg[chain], R92C_HSSI_PARAM2_READ_ADDR, addr) | 1061251538Srpaulo R92C_HSSI_PARAM2_READ_EDGE); 1062251538Srpaulo DELAY(1000); 1063251538Srpaulo 1064251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(0), 1065251538Srpaulo reg[0] | R92C_HSSI_PARAM2_READ_EDGE); 1066251538Srpaulo DELAY(1000); 1067251538Srpaulo 1068251538Srpaulo if (urtwn_bb_read(sc, R92C_HSSI_PARAM1(chain)) & R92C_HSSI_PARAM1_PI) 1069251538Srpaulo val = urtwn_bb_read(sc, R92C_HSPI_READBACK(chain)); 1070251538Srpaulo else 1071251538Srpaulo val = urtwn_bb_read(sc, R92C_LSSI_READBACK(chain)); 1072251538Srpaulo return (MS(val, R92C_LSSI_READBACK_DATA)); 1073251538Srpaulo} 1074251538Srpaulo 1075251538Srpaulostatic int 1076251538Srpaulourtwn_llt_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data) 1077251538Srpaulo{ 1078251538Srpaulo int ntries; 1079251538Srpaulo 1080251538Srpaulo urtwn_write_4(sc, R92C_LLT_INIT, 1081251538Srpaulo SM(R92C_LLT_INIT_OP, R92C_LLT_INIT_OP_WRITE) | 1082251538Srpaulo SM(R92C_LLT_INIT_ADDR, addr) | 1083251538Srpaulo SM(R92C_LLT_INIT_DATA, data)); 1084251538Srpaulo /* Wait for write operation to complete. */ 1085251538Srpaulo for (ntries = 0; ntries < 20; ntries++) { 1086251538Srpaulo if (MS(urtwn_read_4(sc, R92C_LLT_INIT), R92C_LLT_INIT_OP) == 1087251538Srpaulo R92C_LLT_INIT_OP_NO_ACTIVE) 1088251538Srpaulo return (0); 1089251538Srpaulo DELAY(5); 1090251538Srpaulo } 1091251538Srpaulo return (ETIMEDOUT); 1092251538Srpaulo} 1093251538Srpaulo 1094251538Srpaulostatic uint8_t 1095251538Srpaulourtwn_efuse_read_1(struct urtwn_softc *sc, uint16_t addr) 1096251538Srpaulo{ 1097251538Srpaulo uint32_t reg; 1098251538Srpaulo int ntries; 1099251538Srpaulo 1100251538Srpaulo reg = urtwn_read_4(sc, R92C_EFUSE_CTRL); 1101251538Srpaulo reg = RW(reg, R92C_EFUSE_CTRL_ADDR, addr); 1102251538Srpaulo reg &= ~R92C_EFUSE_CTRL_VALID; 1103251538Srpaulo urtwn_write_4(sc, R92C_EFUSE_CTRL, reg); 1104251538Srpaulo /* Wait for read operation to complete. */ 1105251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 1106251538Srpaulo reg = urtwn_read_4(sc, R92C_EFUSE_CTRL); 1107251538Srpaulo if (reg & R92C_EFUSE_CTRL_VALID) 1108251538Srpaulo return (MS(reg, R92C_EFUSE_CTRL_DATA)); 1109251538Srpaulo DELAY(5); 1110251538Srpaulo } 1111251538Srpaulo device_printf(sc->sc_dev, 1112251538Srpaulo "could not read efuse byte at address 0x%x\n", addr); 1113251538Srpaulo return (0xff); 1114251538Srpaulo} 1115251538Srpaulo 1116251538Srpaulostatic void 1117251538Srpaulourtwn_efuse_read(struct urtwn_softc *sc) 1118251538Srpaulo{ 1119251538Srpaulo uint8_t *rom = (uint8_t *)&sc->rom; 1120251538Srpaulo uint16_t addr = 0; 1121251538Srpaulo uint32_t reg; 1122251538Srpaulo uint8_t off, msk; 1123251538Srpaulo int i; 1124251538Srpaulo 1125251538Srpaulo reg = urtwn_read_2(sc, R92C_SYS_ISO_CTRL); 1126251538Srpaulo if (!(reg & R92C_SYS_ISO_CTRL_PWC_EV12V)) { 1127251538Srpaulo urtwn_write_2(sc, R92C_SYS_ISO_CTRL, 1128251538Srpaulo reg | R92C_SYS_ISO_CTRL_PWC_EV12V); 1129251538Srpaulo } 1130251538Srpaulo reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN); 1131251538Srpaulo if (!(reg & R92C_SYS_FUNC_EN_ELDR)) { 1132251538Srpaulo urtwn_write_2(sc, R92C_SYS_FUNC_EN, 1133251538Srpaulo reg | R92C_SYS_FUNC_EN_ELDR); 1134251538Srpaulo } 1135251538Srpaulo reg = urtwn_read_2(sc, R92C_SYS_CLKR); 1136251538Srpaulo if ((reg & (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) != 1137251538Srpaulo (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) { 1138251538Srpaulo urtwn_write_2(sc, R92C_SYS_CLKR, 1139251538Srpaulo reg | R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M); 1140251538Srpaulo } 1141251538Srpaulo memset(&sc->rom, 0xff, sizeof(sc->rom)); 1142251538Srpaulo while (addr < 512) { 1143251538Srpaulo reg = urtwn_efuse_read_1(sc, addr); 1144251538Srpaulo if (reg == 0xff) 1145251538Srpaulo break; 1146251538Srpaulo addr++; 1147251538Srpaulo off = reg >> 4; 1148251538Srpaulo msk = reg & 0xf; 1149251538Srpaulo for (i = 0; i < 4; i++) { 1150251538Srpaulo if (msk & (1 << i)) 1151251538Srpaulo continue; 1152251538Srpaulo rom[off * 8 + i * 2 + 0] = 1153251538Srpaulo urtwn_efuse_read_1(sc, addr); 1154251538Srpaulo addr++; 1155251538Srpaulo rom[off * 8 + i * 2 + 1] = 1156251538Srpaulo urtwn_efuse_read_1(sc, addr); 1157251538Srpaulo addr++; 1158251538Srpaulo } 1159251538Srpaulo } 1160251538Srpaulo#ifdef URTWN_DEBUG 1161251538Srpaulo if (urtwn_debug >= 2) { 1162251538Srpaulo /* Dump ROM content. */ 1163251538Srpaulo printf("\n"); 1164251538Srpaulo for (i = 0; i < sizeof(sc->rom); i++) 1165251538Srpaulo printf("%02x:", rom[i]); 1166251538Srpaulo printf("\n"); 1167251538Srpaulo } 1168251538Srpaulo#endif 1169251538Srpaulo} 1170251538Srpaulo 1171251538Srpaulostatic int 1172251538Srpaulourtwn_read_chipid(struct urtwn_softc *sc) 1173251538Srpaulo{ 1174251538Srpaulo uint32_t reg; 1175251538Srpaulo 1176251538Srpaulo reg = urtwn_read_4(sc, R92C_SYS_CFG); 1177251538Srpaulo if (reg & R92C_SYS_CFG_TRP_VAUX_EN) 1178251538Srpaulo return (EIO); 1179251538Srpaulo 1180251538Srpaulo if (reg & R92C_SYS_CFG_TYPE_92C) { 1181251538Srpaulo sc->chip |= URTWN_CHIP_92C; 1182251538Srpaulo /* Check if it is a castrated 8192C. */ 1183251538Srpaulo if (MS(urtwn_read_4(sc, R92C_HPON_FSM), 1184251538Srpaulo R92C_HPON_FSM_CHIP_BONDING_ID) == 1185251538Srpaulo R92C_HPON_FSM_CHIP_BONDING_ID_92C_1T2R) 1186251538Srpaulo sc->chip |= URTWN_CHIP_92C_1T2R; 1187251538Srpaulo } 1188251538Srpaulo if (reg & R92C_SYS_CFG_VENDOR_UMC) { 1189251538Srpaulo sc->chip |= URTWN_CHIP_UMC; 1190251538Srpaulo if (MS(reg, R92C_SYS_CFG_CHIP_VER_RTL) == 0) 1191251538Srpaulo sc->chip |= URTWN_CHIP_UMC_A_CUT; 1192251538Srpaulo } 1193251538Srpaulo return (0); 1194251538Srpaulo} 1195251538Srpaulo 1196251538Srpaulostatic void 1197251538Srpaulourtwn_read_rom(struct urtwn_softc *sc) 1198251538Srpaulo{ 1199251538Srpaulo struct r92c_rom *rom = &sc->rom; 1200251538Srpaulo 1201251538Srpaulo /* Read full ROM image. */ 1202251538Srpaulo urtwn_efuse_read(sc); 1203251538Srpaulo 1204251538Srpaulo /* XXX Weird but this is what the vendor driver does. */ 1205251538Srpaulo sc->pa_setting = urtwn_efuse_read_1(sc, 0x1fa); 1206251538Srpaulo DPRINTF("PA setting=0x%x\n", sc->pa_setting); 1207251538Srpaulo 1208251538Srpaulo sc->board_type = MS(rom->rf_opt1, R92C_ROM_RF1_BOARD_TYPE); 1209251538Srpaulo 1210251538Srpaulo sc->regulatory = MS(rom->rf_opt1, R92C_ROM_RF1_REGULATORY); 1211251538Srpaulo DPRINTF("regulatory type=%d\n", sc->regulatory); 1212251538Srpaulo 1213251538Srpaulo IEEE80211_ADDR_COPY(sc->sc_bssid, rom->macaddr); 1214251538Srpaulo} 1215251538Srpaulo 1216251538Srpaulo/* 1217251538Srpaulo * Initialize rate adaptation in firmware. 1218251538Srpaulo */ 1219251538Srpaulostatic int 1220251538Srpaulourtwn_ra_init(struct urtwn_softc *sc) 1221251538Srpaulo{ 1222251538Srpaulo static const uint8_t map[] = 1223251538Srpaulo { 2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108 }; 1224251538Srpaulo struct ieee80211com *ic = sc->sc_ifp->if_l2com; 1225251538Srpaulo struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 1226251538Srpaulo struct ieee80211_node *ni; 1227251538Srpaulo struct ieee80211_rateset *rs; 1228251538Srpaulo struct r92c_fw_cmd_macid_cfg cmd; 1229251538Srpaulo uint32_t rates, basicrates; 1230251538Srpaulo uint8_t mode; 1231251538Srpaulo int maxrate, maxbasicrate, error, i, j; 1232251538Srpaulo 1233251538Srpaulo ni = ieee80211_ref_node(vap->iv_bss); 1234251538Srpaulo rs = &ni->ni_rates; 1235251538Srpaulo 1236251538Srpaulo /* Get normal and basic rates mask. */ 1237251538Srpaulo rates = basicrates = 0; 1238251538Srpaulo maxrate = maxbasicrate = 0; 1239251538Srpaulo for (i = 0; i < rs->rs_nrates; i++) { 1240251538Srpaulo /* Convert 802.11 rate to HW rate index. */ 1241251538Srpaulo for (j = 0; j < nitems(map); j++) 1242251538Srpaulo if ((rs->rs_rates[i] & IEEE80211_RATE_VAL) == map[j]) 1243251538Srpaulo break; 1244251538Srpaulo if (j == nitems(map)) /* Unknown rate, skip. */ 1245251538Srpaulo continue; 1246251538Srpaulo rates |= 1 << j; 1247251538Srpaulo if (j > maxrate) 1248251538Srpaulo maxrate = j; 1249251538Srpaulo if (rs->rs_rates[i] & IEEE80211_RATE_BASIC) { 1250251538Srpaulo basicrates |= 1 << j; 1251251538Srpaulo if (j > maxbasicrate) 1252251538Srpaulo maxbasicrate = j; 1253251538Srpaulo } 1254251538Srpaulo } 1255251538Srpaulo if (ic->ic_curmode == IEEE80211_MODE_11B) 1256251538Srpaulo mode = R92C_RAID_11B; 1257251538Srpaulo else 1258251538Srpaulo mode = R92C_RAID_11BG; 1259251538Srpaulo DPRINTF("mode=0x%x rates=0x%08x, basicrates=0x%08x\n", 1260251538Srpaulo mode, rates, basicrates); 1261251538Srpaulo 1262251538Srpaulo /* Set rates mask for group addressed frames. */ 1263251538Srpaulo cmd.macid = URTWN_MACID_BC | URTWN_MACID_VALID; 1264251538Srpaulo cmd.mask = htole32(mode << 28 | basicrates); 1265251538Srpaulo error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd)); 1266251538Srpaulo if (error != 0) { 1267252401Srpaulo ieee80211_free_node(ni); 1268251538Srpaulo device_printf(sc->sc_dev, 1269251538Srpaulo "could not add broadcast station\n"); 1270251538Srpaulo return (error); 1271251538Srpaulo } 1272251538Srpaulo /* Set initial MRR rate. */ 1273251538Srpaulo DPRINTF("maxbasicrate=%d\n", maxbasicrate); 1274251538Srpaulo urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BC), 1275251538Srpaulo maxbasicrate); 1276251538Srpaulo 1277251538Srpaulo /* Set rates mask for unicast frames. */ 1278251538Srpaulo cmd.macid = URTWN_MACID_BSS | URTWN_MACID_VALID; 1279251538Srpaulo cmd.mask = htole32(mode << 28 | rates); 1280251538Srpaulo error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd)); 1281251538Srpaulo if (error != 0) { 1282252401Srpaulo ieee80211_free_node(ni); 1283251538Srpaulo device_printf(sc->sc_dev, "could not add BSS station\n"); 1284251538Srpaulo return (error); 1285251538Srpaulo } 1286251538Srpaulo /* Set initial MRR rate. */ 1287251538Srpaulo DPRINTF("maxrate=%d\n", maxrate); 1288251538Srpaulo urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BSS), 1289251538Srpaulo maxrate); 1290251538Srpaulo 1291251538Srpaulo /* Indicate highest supported rate. */ 1292252403Srpaulo ni->ni_txrate = rs->rs_rates[rs->rs_nrates - 1]; 1293252401Srpaulo ieee80211_free_node(ni); 1294252401Srpaulo 1295251538Srpaulo return (0); 1296251538Srpaulo} 1297251538Srpaulo 1298251538Srpaulovoid 1299251538Srpaulourtwn_tsf_sync_enable(struct urtwn_softc *sc) 1300251538Srpaulo{ 1301251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 1302251538Srpaulo struct ieee80211com *ic = ifp->if_l2com; 1303251538Srpaulo struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 1304251538Srpaulo struct ieee80211_node *ni = vap->iv_bss; 1305251538Srpaulo 1306251538Srpaulo uint64_t tsf; 1307251538Srpaulo 1308251538Srpaulo /* Enable TSF synchronization. */ 1309251538Srpaulo urtwn_write_1(sc, R92C_BCN_CTRL, 1310251538Srpaulo urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_DIS_TSF_UDT0); 1311251538Srpaulo 1312251538Srpaulo urtwn_write_1(sc, R92C_BCN_CTRL, 1313251538Srpaulo urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_EN_BCN); 1314251538Srpaulo 1315251538Srpaulo /* Set initial TSF. */ 1316251538Srpaulo memcpy(&tsf, ni->ni_tstamp.data, 8); 1317251538Srpaulo tsf = le64toh(tsf); 1318251538Srpaulo tsf = tsf - (tsf % (vap->iv_bss->ni_intval * IEEE80211_DUR_TU)); 1319251538Srpaulo tsf -= IEEE80211_DUR_TU; 1320251538Srpaulo urtwn_write_4(sc, R92C_TSFTR + 0, tsf); 1321251538Srpaulo urtwn_write_4(sc, R92C_TSFTR + 4, tsf >> 32); 1322251538Srpaulo 1323251538Srpaulo urtwn_write_1(sc, R92C_BCN_CTRL, 1324251538Srpaulo urtwn_read_1(sc, R92C_BCN_CTRL) | R92C_BCN_CTRL_EN_BCN); 1325251538Srpaulo} 1326251538Srpaulo 1327251538Srpaulostatic void 1328251538Srpaulourtwn_set_led(struct urtwn_softc *sc, int led, int on) 1329251538Srpaulo{ 1330251538Srpaulo uint8_t reg; 1331251538Srpaulo 1332251538Srpaulo if (led == URTWN_LED_LINK) { 1333251538Srpaulo reg = urtwn_read_1(sc, R92C_LEDCFG0) & 0x70; 1334251538Srpaulo if (!on) 1335251538Srpaulo reg |= R92C_LEDCFG0_DIS; 1336251538Srpaulo urtwn_write_1(sc, R92C_LEDCFG0, reg); 1337251538Srpaulo sc->ledlink = on; /* Save LED state. */ 1338251538Srpaulo } 1339251538Srpaulo} 1340251538Srpaulo 1341251538Srpaulostatic int 1342251538Srpaulourtwn_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 1343251538Srpaulo{ 1344251538Srpaulo struct urtwn_vap *uvp = URTWN_VAP(vap); 1345251538Srpaulo struct ieee80211com *ic = vap->iv_ic; 1346251538Srpaulo struct urtwn_softc *sc = ic->ic_ifp->if_softc; 1347251538Srpaulo struct ieee80211_node *ni; 1348251538Srpaulo enum ieee80211_state ostate; 1349251538Srpaulo uint32_t reg; 1350251538Srpaulo 1351251538Srpaulo ostate = vap->iv_state; 1352251538Srpaulo DPRINTF("%s -> %s\n", ieee80211_state_name[ostate], 1353251538Srpaulo ieee80211_state_name[nstate]); 1354251538Srpaulo 1355251538Srpaulo IEEE80211_UNLOCK(ic); 1356251538Srpaulo URTWN_LOCK(sc); 1357251538Srpaulo callout_stop(&sc->sc_watchdog_ch); 1358251538Srpaulo 1359251538Srpaulo if (ostate == IEEE80211_S_RUN) { 1360251538Srpaulo /* Turn link LED off. */ 1361251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 0); 1362251538Srpaulo 1363251538Srpaulo /* Set media status to 'No Link'. */ 1364251538Srpaulo reg = urtwn_read_4(sc, R92C_CR); 1365251538Srpaulo reg = RW(reg, R92C_CR_NETTYPE, R92C_CR_NETTYPE_NOLINK); 1366251538Srpaulo urtwn_write_4(sc, R92C_CR, reg); 1367251538Srpaulo 1368251538Srpaulo /* Stop Rx of data frames. */ 1369251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP2, 0); 1370251538Srpaulo 1371251538Srpaulo /* Rest TSF. */ 1372251538Srpaulo urtwn_write_1(sc, R92C_DUAL_TSF_RST, 0x03); 1373251538Srpaulo 1374251538Srpaulo /* Disable TSF synchronization. */ 1375251538Srpaulo urtwn_write_1(sc, R92C_BCN_CTRL, 1376251538Srpaulo urtwn_read_1(sc, R92C_BCN_CTRL) | 1377251538Srpaulo R92C_BCN_CTRL_DIS_TSF_UDT0); 1378251538Srpaulo 1379251538Srpaulo /* Reset EDCA parameters. */ 1380251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002f3217); 1381251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005e4317); 1382251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x00105320); 1383251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a444); 1384251538Srpaulo } 1385251538Srpaulo 1386251538Srpaulo switch (nstate) { 1387251538Srpaulo case IEEE80211_S_INIT: 1388251538Srpaulo /* Turn link LED off. */ 1389251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 0); 1390251538Srpaulo break; 1391251538Srpaulo case IEEE80211_S_SCAN: 1392251538Srpaulo if (ostate != IEEE80211_S_SCAN) { 1393251538Srpaulo /* Allow Rx from any BSSID. */ 1394251538Srpaulo urtwn_write_4(sc, R92C_RCR, 1395251538Srpaulo urtwn_read_4(sc, R92C_RCR) & 1396251538Srpaulo ~(R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN)); 1397251538Srpaulo 1398251538Srpaulo /* Set gain for scanning. */ 1399251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0)); 1400251538Srpaulo reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x20); 1401251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg); 1402251538Srpaulo 1403251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1)); 1404251538Srpaulo reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x20); 1405251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg); 1406251538Srpaulo } 1407251538Srpaulo 1408251538Srpaulo /* Make link LED blink during scan. */ 1409251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, !sc->ledlink); 1410251538Srpaulo 1411251538Srpaulo /* Pause AC Tx queues. */ 1412251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 1413251538Srpaulo urtwn_read_1(sc, R92C_TXPAUSE) | 0x0f); 1414251538Srpaulo 1415251538Srpaulo urtwn_set_chan(sc, ic->ic_curchan, NULL); 1416251538Srpaulo break; 1417251538Srpaulo case IEEE80211_S_AUTH: 1418251538Srpaulo /* Set initial gain under link. */ 1419251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0)); 1420251538Srpaulo reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x32); 1421251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg); 1422251538Srpaulo 1423251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1)); 1424251538Srpaulo reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x32); 1425251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg); 1426251538Srpaulo 1427251538Srpaulo urtwn_set_chan(sc, ic->ic_curchan, NULL); 1428251538Srpaulo break; 1429251538Srpaulo case IEEE80211_S_RUN: 1430251538Srpaulo if (vap->iv_opmode == IEEE80211_M_MONITOR) { 1431251538Srpaulo /* Enable Rx of data frames. */ 1432251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff); 1433251538Srpaulo 1434251538Srpaulo /* Turn link LED on. */ 1435251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 1); 1436251538Srpaulo break; 1437251538Srpaulo } 1438251538Srpaulo 1439251538Srpaulo ni = ieee80211_ref_node(vap->iv_bss); 1440251538Srpaulo /* Set media status to 'Associated'. */ 1441251538Srpaulo reg = urtwn_read_4(sc, R92C_CR); 1442251538Srpaulo reg = RW(reg, R92C_CR_NETTYPE, R92C_CR_NETTYPE_INFRA); 1443251538Srpaulo urtwn_write_4(sc, R92C_CR, reg); 1444251538Srpaulo 1445251538Srpaulo /* Set BSSID. */ 1446251538Srpaulo urtwn_write_4(sc, R92C_BSSID + 0, LE_READ_4(&ni->ni_bssid[0])); 1447251538Srpaulo urtwn_write_4(sc, R92C_BSSID + 4, LE_READ_2(&ni->ni_bssid[4])); 1448251538Srpaulo 1449251538Srpaulo if (ic->ic_curmode == IEEE80211_MODE_11B) 1450251538Srpaulo urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 0); 1451251538Srpaulo else /* 802.11b/g */ 1452251538Srpaulo urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 3); 1453251538Srpaulo 1454251538Srpaulo /* Enable Rx of data frames. */ 1455251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff); 1456251538Srpaulo 1457251538Srpaulo /* Flush all AC queues. */ 1458251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 0); 1459251538Srpaulo 1460251538Srpaulo /* Set beacon interval. */ 1461251538Srpaulo urtwn_write_2(sc, R92C_BCN_INTERVAL, ni->ni_intval); 1462251538Srpaulo 1463251538Srpaulo /* Allow Rx from our BSSID only. */ 1464251538Srpaulo urtwn_write_4(sc, R92C_RCR, 1465251538Srpaulo urtwn_read_4(sc, R92C_RCR) | 1466251538Srpaulo R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN); 1467251538Srpaulo 1468251538Srpaulo /* Enable TSF synchronization. */ 1469251538Srpaulo urtwn_tsf_sync_enable(sc); 1470251538Srpaulo 1471251538Srpaulo urtwn_write_1(sc, R92C_SIFS_CCK + 1, 10); 1472251538Srpaulo urtwn_write_1(sc, R92C_SIFS_OFDM + 1, 10); 1473251538Srpaulo urtwn_write_1(sc, R92C_SPEC_SIFS + 1, 10); 1474251538Srpaulo urtwn_write_1(sc, R92C_MAC_SPEC_SIFS + 1, 10); 1475251538Srpaulo urtwn_write_1(sc, R92C_R2T_SIFS + 1, 10); 1476251538Srpaulo urtwn_write_1(sc, R92C_T2T_SIFS + 1, 10); 1477251538Srpaulo 1478251538Srpaulo /* Intialize rate adaptation. */ 1479251538Srpaulo urtwn_ra_init(sc); 1480251538Srpaulo /* Turn link LED on. */ 1481251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 1); 1482251538Srpaulo 1483251538Srpaulo sc->avg_pwdb = -1; /* Reset average RSSI. */ 1484251538Srpaulo /* Reset temperature calibration state machine. */ 1485251538Srpaulo sc->thcal_state = 0; 1486251538Srpaulo sc->thcal_lctemp = 0; 1487251538Srpaulo ieee80211_free_node(ni); 1488251538Srpaulo break; 1489251538Srpaulo default: 1490251538Srpaulo break; 1491251538Srpaulo } 1492251538Srpaulo URTWN_UNLOCK(sc); 1493251538Srpaulo IEEE80211_LOCK(ic); 1494251538Srpaulo return(uvp->newstate(vap, nstate, arg)); 1495251538Srpaulo} 1496251538Srpaulo 1497251538Srpaulostatic void 1498251538Srpaulourtwn_watchdog(void *arg) 1499251538Srpaulo{ 1500251538Srpaulo struct urtwn_softc *sc = arg; 1501251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 1502251538Srpaulo 1503251538Srpaulo if (sc->sc_txtimer > 0) { 1504251538Srpaulo if (--sc->sc_txtimer == 0) { 1505251538Srpaulo device_printf(sc->sc_dev, "device timeout\n"); 1506251538Srpaulo ifp->if_oerrors++; 1507251538Srpaulo return; 1508251538Srpaulo } 1509251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 1510251538Srpaulo } 1511251538Srpaulo} 1512251538Srpaulo 1513251538Srpaulostatic void 1514251538Srpaulourtwn_update_avgrssi(struct urtwn_softc *sc, int rate, int8_t rssi) 1515251538Srpaulo{ 1516251538Srpaulo int pwdb; 1517251538Srpaulo 1518251538Srpaulo /* Convert antenna signal to percentage. */ 1519251538Srpaulo if (rssi <= -100 || rssi >= 20) 1520251538Srpaulo pwdb = 0; 1521251538Srpaulo else if (rssi >= 0) 1522251538Srpaulo pwdb = 100; 1523251538Srpaulo else 1524251538Srpaulo pwdb = 100 + rssi; 1525251538Srpaulo if (rate <= 3) { 1526251538Srpaulo /* CCK gain is smaller than OFDM/MCS gain. */ 1527251538Srpaulo pwdb += 6; 1528251538Srpaulo if (pwdb > 100) 1529251538Srpaulo pwdb = 100; 1530251538Srpaulo if (pwdb <= 14) 1531251538Srpaulo pwdb -= 4; 1532251538Srpaulo else if (pwdb <= 26) 1533251538Srpaulo pwdb -= 8; 1534251538Srpaulo else if (pwdb <= 34) 1535251538Srpaulo pwdb -= 6; 1536251538Srpaulo else if (pwdb <= 42) 1537251538Srpaulo pwdb -= 2; 1538251538Srpaulo } 1539251538Srpaulo if (sc->avg_pwdb == -1) /* Init. */ 1540251538Srpaulo sc->avg_pwdb = pwdb; 1541251538Srpaulo else if (sc->avg_pwdb < pwdb) 1542251538Srpaulo sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20) + 1; 1543251538Srpaulo else 1544251538Srpaulo sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20); 1545251538Srpaulo DPRINTFN(4, "PWDB=%d EMA=%d\n", pwdb, sc->avg_pwdb); 1546251538Srpaulo} 1547251538Srpaulo 1548251538Srpaulostatic int8_t 1549251538Srpaulourtwn_get_rssi(struct urtwn_softc *sc, int rate, void *physt) 1550251538Srpaulo{ 1551251538Srpaulo static const int8_t cckoff[] = { 16, -12, -26, -46 }; 1552251538Srpaulo struct r92c_rx_phystat *phy; 1553251538Srpaulo struct r92c_rx_cck *cck; 1554251538Srpaulo uint8_t rpt; 1555251538Srpaulo int8_t rssi; 1556251538Srpaulo 1557251538Srpaulo if (rate <= 3) { 1558251538Srpaulo cck = (struct r92c_rx_cck *)physt; 1559251538Srpaulo if (sc->sc_flags & URTWN_FLAG_CCK_HIPWR) { 1560251538Srpaulo rpt = (cck->agc_rpt >> 5) & 0x3; 1561251538Srpaulo rssi = (cck->agc_rpt & 0x1f) << 1; 1562251538Srpaulo } else { 1563251538Srpaulo rpt = (cck->agc_rpt >> 6) & 0x3; 1564251538Srpaulo rssi = cck->agc_rpt & 0x3e; 1565251538Srpaulo } 1566251538Srpaulo rssi = cckoff[rpt] - rssi; 1567251538Srpaulo } else { /* OFDM/HT. */ 1568251538Srpaulo phy = (struct r92c_rx_phystat *)physt; 1569251538Srpaulo rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110; 1570251538Srpaulo } 1571251538Srpaulo return (rssi); 1572251538Srpaulo} 1573251538Srpaulo 1574251538Srpaulostatic int 1575251538Srpaulourtwn_tx_start(struct urtwn_softc *sc, struct ieee80211_node *ni, 1576251538Srpaulo struct mbuf *m0, struct urtwn_data *data) 1577251538Srpaulo{ 1578251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 1579251538Srpaulo struct ieee80211_frame *wh; 1580251538Srpaulo struct ieee80211_key *k; 1581251538Srpaulo struct ieee80211com *ic = ifp->if_l2com; 1582251538Srpaulo struct ieee80211vap *vap = ni->ni_vap; 1583251538Srpaulo struct usb_xfer *xfer; 1584251538Srpaulo struct r92c_tx_desc *txd; 1585251538Srpaulo uint8_t raid, type; 1586251538Srpaulo uint16_t sum; 1587251538Srpaulo int i, hasqos, xferlen; 1588251538Srpaulo struct usb_xfer *urtwn_pipes[4] = { 1589251538Srpaulo sc->sc_xfer[URTWN_BULK_TX_BE], 1590251538Srpaulo sc->sc_xfer[URTWN_BULK_TX_BK], 1591251538Srpaulo sc->sc_xfer[URTWN_BULK_TX_VI], 1592251538Srpaulo sc->sc_xfer[URTWN_BULK_TX_VO] 1593251538Srpaulo }; 1594251538Srpaulo 1595251538Srpaulo URTWN_ASSERT_LOCKED(sc); 1596251538Srpaulo 1597251538Srpaulo /* 1598251538Srpaulo * Software crypto. 1599251538Srpaulo */ 1600251538Srpaulo wh = mtod(m0, struct ieee80211_frame *); 1601260444Skevlo if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 1602251538Srpaulo k = ieee80211_crypto_encap(ni, m0); 1603251538Srpaulo if (k == NULL) { 1604251538Srpaulo device_printf(sc->sc_dev, 1605251538Srpaulo "ieee80211_crypto_encap returns NULL.\n"); 1606251538Srpaulo /* XXX we don't expect the fragmented frames */ 1607251538Srpaulo m_freem(m0); 1608251538Srpaulo return (ENOBUFS); 1609251538Srpaulo } 1610251538Srpaulo 1611251538Srpaulo /* in case packet header moved, reset pointer */ 1612251538Srpaulo wh = mtod(m0, struct ieee80211_frame *); 1613251538Srpaulo } 1614251538Srpaulo 1615251538Srpaulo switch (wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) { 1616251538Srpaulo case IEEE80211_FC0_TYPE_CTL: 1617251538Srpaulo case IEEE80211_FC0_TYPE_MGT: 1618251538Srpaulo xfer = sc->sc_xfer[URTWN_BULK_TX_VO]; 1619251538Srpaulo break; 1620251538Srpaulo default: 1621251538Srpaulo KASSERT(M_WME_GETAC(m0) < 4, 1622251538Srpaulo ("unsupported WME pipe %d", M_WME_GETAC(m0))); 1623251538Srpaulo xfer = urtwn_pipes[M_WME_GETAC(m0)]; 1624251538Srpaulo break; 1625251538Srpaulo } 1626251538Srpaulo 1627251538Srpaulo hasqos = 0; 1628251538Srpaulo 1629251538Srpaulo /* Fill Tx descriptor. */ 1630251538Srpaulo txd = (struct r92c_tx_desc *)data->buf; 1631251538Srpaulo memset(txd, 0, sizeof(*txd)); 1632251538Srpaulo 1633251538Srpaulo txd->txdw0 |= htole32( 1634251538Srpaulo SM(R92C_TXDW0_PKTLEN, m0->m_pkthdr.len) | 1635251538Srpaulo SM(R92C_TXDW0_OFFSET, sizeof(*txd)) | 1636251538Srpaulo R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG); 1637251538Srpaulo if (IEEE80211_IS_MULTICAST(wh->i_addr1)) 1638251538Srpaulo txd->txdw0 |= htole32(R92C_TXDW0_BMCAST); 1639251538Srpaulo 1640251538Srpaulo type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK; 1641251538Srpaulo if (!IEEE80211_IS_MULTICAST(wh->i_addr1) && 1642251538Srpaulo type == IEEE80211_FC0_TYPE_DATA) { 1643251538Srpaulo if (ic->ic_curmode == IEEE80211_MODE_11B) 1644251538Srpaulo raid = R92C_RAID_11B; 1645251538Srpaulo else 1646251538Srpaulo raid = R92C_RAID_11BG; 1647251538Srpaulo txd->txdw1 |= htole32( 1648251538Srpaulo SM(R92C_TXDW1_MACID, URTWN_MACID_BSS) | 1649251538Srpaulo SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_BE) | 1650251538Srpaulo SM(R92C_TXDW1_RAID, raid) | 1651251538Srpaulo R92C_TXDW1_AGGBK); 1652251538Srpaulo 1653251538Srpaulo if (ic->ic_flags & IEEE80211_F_USEPROT) { 1654251538Srpaulo if (ic->ic_protmode == IEEE80211_PROT_CTSONLY) { 1655251538Srpaulo txd->txdw4 |= htole32(R92C_TXDW4_CTS2SELF | 1656251538Srpaulo R92C_TXDW4_HWRTSEN); 1657251538Srpaulo } else if (ic->ic_protmode == IEEE80211_PROT_RTSCTS) { 1658251538Srpaulo txd->txdw4 |= htole32(R92C_TXDW4_RTSEN | 1659251538Srpaulo R92C_TXDW4_HWRTSEN); 1660251538Srpaulo } 1661251538Srpaulo } 1662251538Srpaulo /* Send RTS at OFDM24. */ 1663251538Srpaulo txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE, 8)); 1664251538Srpaulo txd->txdw5 |= htole32(0x0001ff00); 1665251538Srpaulo /* Send data at OFDM54. */ 1666251538Srpaulo txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, 11)); 1667251538Srpaulo } else { 1668251538Srpaulo txd->txdw1 |= htole32( 1669251538Srpaulo SM(R92C_TXDW1_MACID, 0) | 1670251538Srpaulo SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_MGNT) | 1671251538Srpaulo SM(R92C_TXDW1_RAID, R92C_RAID_11B)); 1672251538Srpaulo 1673251538Srpaulo /* Force CCK1. */ 1674251538Srpaulo txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE); 1675251538Srpaulo txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, 0)); 1676251538Srpaulo } 1677251538Srpaulo /* Set sequence number (already little endian). */ 1678251538Srpaulo txd->txdseq |= *(uint16_t *)wh->i_seq; 1679251538Srpaulo 1680251538Srpaulo if (!hasqos) { 1681251538Srpaulo /* Use HW sequence numbering for non-QoS frames. */ 1682251538Srpaulo txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ); 1683251538Srpaulo txd->txdseq |= htole16(0x8000); 1684251538Srpaulo } else 1685251538Srpaulo txd->txdw4 |= htole32(R92C_TXDW4_QOS); 1686251538Srpaulo 1687251538Srpaulo /* Compute Tx descriptor checksum. */ 1688251538Srpaulo sum = 0; 1689251538Srpaulo for (i = 0; i < sizeof(*txd) / 2; i++) 1690251538Srpaulo sum ^= ((uint16_t *)txd)[i]; 1691251538Srpaulo txd->txdsum = sum; /* NB: already little endian. */ 1692251538Srpaulo 1693251538Srpaulo if (ieee80211_radiotap_active_vap(vap)) { 1694251538Srpaulo struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap; 1695251538Srpaulo 1696251538Srpaulo tap->wt_flags = 0; 1697251538Srpaulo tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq); 1698251538Srpaulo tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags); 1699251538Srpaulo ieee80211_radiotap_tx(vap, m0); 1700251538Srpaulo } 1701251538Srpaulo 1702251538Srpaulo xferlen = sizeof(*txd) + m0->m_pkthdr.len; 1703251538Srpaulo m_copydata(m0, 0, m0->m_pkthdr.len, (caddr_t)&txd[1]); 1704251538Srpaulo 1705251538Srpaulo data->buflen = xferlen; 1706251538Srpaulo data->ni = ni; 1707251538Srpaulo data->m = m0; 1708251538Srpaulo 1709251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next); 1710251538Srpaulo usbd_transfer_start(xfer); 1711251538Srpaulo return (0); 1712251538Srpaulo} 1713251538Srpaulo 1714251538Srpaulostatic void 1715251538Srpaulourtwn_start(struct ifnet *ifp) 1716251538Srpaulo{ 1717251538Srpaulo struct urtwn_softc *sc = ifp->if_softc; 1718261863Srpaulo 1719261863Srpaulo if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0) 1720261863Srpaulo return; 1721261863Srpaulo URTWN_LOCK(sc); 1722261863Srpaulo urtwn_start_locked(ifp, sc); 1723261863Srpaulo URTWN_UNLOCK(sc); 1724261863Srpaulo} 1725261863Srpaulo 1726261863Srpaulostatic void 1727261863Srpaulourtwn_start_locked(struct ifnet *ifp, struct urtwn_softc *sc) 1728261863Srpaulo{ 1729251538Srpaulo struct ieee80211_node *ni; 1730251538Srpaulo struct mbuf *m; 1731251538Srpaulo struct urtwn_data *bf; 1732251538Srpaulo 1733261863Srpaulo URTWN_ASSERT_LOCKED(sc); 1734251538Srpaulo for (;;) { 1735251538Srpaulo IFQ_DRV_DEQUEUE(&ifp->if_snd, m); 1736251538Srpaulo if (m == NULL) 1737251538Srpaulo break; 1738251538Srpaulo bf = urtwn_getbuf(sc); 1739251538Srpaulo if (bf == NULL) { 1740251538Srpaulo IFQ_DRV_PREPEND(&ifp->if_snd, m); 1741251538Srpaulo break; 1742251538Srpaulo } 1743251538Srpaulo ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 1744251538Srpaulo m->m_pkthdr.rcvif = NULL; 1745251538Srpaulo 1746251538Srpaulo if (urtwn_tx_start(sc, ni, m, bf) != 0) { 1747251538Srpaulo ifp->if_oerrors++; 1748251538Srpaulo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 1749251538Srpaulo ieee80211_free_node(ni); 1750251538Srpaulo break; 1751251538Srpaulo } 1752251538Srpaulo 1753251538Srpaulo sc->sc_txtimer = 5; 1754251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 1755251538Srpaulo } 1756251538Srpaulo} 1757251538Srpaulo 1758251538Srpaulostatic int 1759251538Srpaulourtwn_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 1760251538Srpaulo{ 1761251538Srpaulo struct ieee80211com *ic = ifp->if_l2com; 1762251538Srpaulo struct ifreq *ifr = (struct ifreq *) data; 1763251538Srpaulo int error = 0, startall = 0; 1764251538Srpaulo 1765251538Srpaulo switch (cmd) { 1766251538Srpaulo case SIOCSIFFLAGS: 1767251538Srpaulo if (ifp->if_flags & IFF_UP) { 1768251538Srpaulo if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0) { 1769251538Srpaulo urtwn_init(ifp->if_softc); 1770251538Srpaulo startall = 1; 1771251538Srpaulo } 1772251538Srpaulo } else { 1773251538Srpaulo if (ifp->if_drv_flags & IFF_DRV_RUNNING) 1774251538Srpaulo urtwn_stop(ifp, 1); 1775251538Srpaulo } 1776251538Srpaulo if (startall) 1777251538Srpaulo ieee80211_start_all(ic); 1778251538Srpaulo break; 1779251538Srpaulo case SIOCGIFMEDIA: 1780251538Srpaulo error = ifmedia_ioctl(ifp, ifr, &ic->ic_media, cmd); 1781251538Srpaulo break; 1782251538Srpaulo case SIOCGIFADDR: 1783251538Srpaulo error = ether_ioctl(ifp, cmd, data); 1784251538Srpaulo break; 1785251538Srpaulo default: 1786251538Srpaulo error = EINVAL; 1787251538Srpaulo break; 1788251538Srpaulo } 1789251538Srpaulo return (error); 1790251538Srpaulo} 1791251538Srpaulo 1792251538Srpaulostatic int 1793251538Srpaulourtwn_alloc_list(struct urtwn_softc *sc, struct urtwn_data data[], 1794251538Srpaulo int ndata, int maxsz) 1795251538Srpaulo{ 1796251538Srpaulo int i, error; 1797251538Srpaulo 1798251538Srpaulo for (i = 0; i < ndata; i++) { 1799251538Srpaulo struct urtwn_data *dp = &data[i]; 1800251538Srpaulo dp->sc = sc; 1801251538Srpaulo dp->m = NULL; 1802251538Srpaulo dp->buf = malloc(maxsz, M_USBDEV, M_NOWAIT); 1803251538Srpaulo if (dp->buf == NULL) { 1804251538Srpaulo device_printf(sc->sc_dev, 1805251538Srpaulo "could not allocate buffer\n"); 1806251538Srpaulo error = ENOMEM; 1807251538Srpaulo goto fail; 1808251538Srpaulo } 1809251538Srpaulo dp->ni = NULL; 1810251538Srpaulo } 1811251538Srpaulo 1812251538Srpaulo return (0); 1813251538Srpaulofail: 1814251538Srpaulo urtwn_free_list(sc, data, ndata); 1815251538Srpaulo return (error); 1816251538Srpaulo} 1817251538Srpaulo 1818251538Srpaulostatic int 1819251538Srpaulourtwn_alloc_rx_list(struct urtwn_softc *sc) 1820251538Srpaulo{ 1821251538Srpaulo int error, i; 1822251538Srpaulo 1823251538Srpaulo error = urtwn_alloc_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT, 1824251538Srpaulo URTWN_RXBUFSZ); 1825251538Srpaulo if (error != 0) 1826251538Srpaulo return (error); 1827251538Srpaulo 1828251538Srpaulo STAILQ_INIT(&sc->sc_rx_active); 1829251538Srpaulo STAILQ_INIT(&sc->sc_rx_inactive); 1830251538Srpaulo 1831251538Srpaulo for (i = 0; i < URTWN_RX_LIST_COUNT; i++) 1832251538Srpaulo STAILQ_INSERT_HEAD(&sc->sc_rx_inactive, &sc->sc_rx[i], next); 1833251538Srpaulo 1834251538Srpaulo return (0); 1835251538Srpaulo} 1836251538Srpaulo 1837251538Srpaulostatic int 1838251538Srpaulourtwn_alloc_tx_list(struct urtwn_softc *sc) 1839251538Srpaulo{ 1840251538Srpaulo int error, i; 1841251538Srpaulo 1842251538Srpaulo error = urtwn_alloc_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT, 1843251538Srpaulo URTWN_TXBUFSZ); 1844251538Srpaulo if (error != 0) 1845251538Srpaulo return (error); 1846251538Srpaulo 1847251538Srpaulo STAILQ_INIT(&sc->sc_tx_active); 1848251538Srpaulo STAILQ_INIT(&sc->sc_tx_inactive); 1849251538Srpaulo STAILQ_INIT(&sc->sc_tx_pending); 1850251538Srpaulo 1851251538Srpaulo for (i = 0; i < URTWN_TX_LIST_COUNT; i++) 1852251538Srpaulo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, &sc->sc_tx[i], next); 1853251538Srpaulo 1854251538Srpaulo return (0); 1855251538Srpaulo} 1856251538Srpaulo 1857251538Srpaulostatic int 1858251538Srpaulourtwn_power_on(struct urtwn_softc *sc) 1859251538Srpaulo{ 1860251538Srpaulo uint32_t reg; 1861251538Srpaulo int ntries; 1862251538Srpaulo 1863251538Srpaulo /* Wait for autoload done bit. */ 1864251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 1865251538Srpaulo if (urtwn_read_1(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_PFM_ALDN) 1866251538Srpaulo break; 1867251538Srpaulo DELAY(5); 1868251538Srpaulo } 1869251538Srpaulo if (ntries == 1000) { 1870251538Srpaulo device_printf(sc->sc_dev, 1871251538Srpaulo "timeout waiting for chip autoload\n"); 1872251538Srpaulo return (ETIMEDOUT); 1873251538Srpaulo } 1874251538Srpaulo 1875251538Srpaulo /* Unlock ISO/CLK/Power control register. */ 1876251538Srpaulo urtwn_write_1(sc, R92C_RSV_CTRL, 0); 1877251538Srpaulo /* Move SPS into PWM mode. */ 1878251538Srpaulo urtwn_write_1(sc, R92C_SPS0_CTRL, 0x2b); 1879251538Srpaulo DELAY(100); 1880251538Srpaulo 1881251538Srpaulo reg = urtwn_read_1(sc, R92C_LDOV12D_CTRL); 1882251538Srpaulo if (!(reg & R92C_LDOV12D_CTRL_LDV12_EN)) { 1883251538Srpaulo urtwn_write_1(sc, R92C_LDOV12D_CTRL, 1884251538Srpaulo reg | R92C_LDOV12D_CTRL_LDV12_EN); 1885251538Srpaulo DELAY(100); 1886251538Srpaulo urtwn_write_1(sc, R92C_SYS_ISO_CTRL, 1887251538Srpaulo urtwn_read_1(sc, R92C_SYS_ISO_CTRL) & 1888251538Srpaulo ~R92C_SYS_ISO_CTRL_MD2PP); 1889251538Srpaulo } 1890251538Srpaulo 1891251538Srpaulo /* Auto enable WLAN. */ 1892251538Srpaulo urtwn_write_2(sc, R92C_APS_FSMCO, 1893251538Srpaulo urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC); 1894251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 1895262822Skevlo if (!(urtwn_read_2(sc, R92C_APS_FSMCO) & 1896262822Skevlo R92C_APS_FSMCO_APFM_ONMAC)) 1897251538Srpaulo break; 1898251538Srpaulo DELAY(5); 1899251538Srpaulo } 1900251538Srpaulo if (ntries == 1000) { 1901251538Srpaulo device_printf(sc->sc_dev, 1902251538Srpaulo "timeout waiting for MAC auto ON\n"); 1903251538Srpaulo return (ETIMEDOUT); 1904251538Srpaulo } 1905251538Srpaulo 1906251538Srpaulo /* Enable radio, GPIO and LED functions. */ 1907251538Srpaulo urtwn_write_2(sc, R92C_APS_FSMCO, 1908251538Srpaulo R92C_APS_FSMCO_AFSM_HSUS | 1909251538Srpaulo R92C_APS_FSMCO_PDN_EN | 1910251538Srpaulo R92C_APS_FSMCO_PFM_ALDN); 1911251538Srpaulo /* Release RF digital isolation. */ 1912251538Srpaulo urtwn_write_2(sc, R92C_SYS_ISO_CTRL, 1913251538Srpaulo urtwn_read_2(sc, R92C_SYS_ISO_CTRL) & ~R92C_SYS_ISO_CTRL_DIOR); 1914251538Srpaulo 1915251538Srpaulo /* Initialize MAC. */ 1916251538Srpaulo urtwn_write_1(sc, R92C_APSD_CTRL, 1917251538Srpaulo urtwn_read_1(sc, R92C_APSD_CTRL) & ~R92C_APSD_CTRL_OFF); 1918251538Srpaulo for (ntries = 0; ntries < 200; ntries++) { 1919251538Srpaulo if (!(urtwn_read_1(sc, R92C_APSD_CTRL) & 1920251538Srpaulo R92C_APSD_CTRL_OFF_STATUS)) 1921251538Srpaulo break; 1922251538Srpaulo DELAY(5); 1923251538Srpaulo } 1924251538Srpaulo if (ntries == 200) { 1925251538Srpaulo device_printf(sc->sc_dev, 1926251538Srpaulo "timeout waiting for MAC initialization\n"); 1927251538Srpaulo return (ETIMEDOUT); 1928251538Srpaulo } 1929251538Srpaulo 1930251538Srpaulo /* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */ 1931251538Srpaulo reg = urtwn_read_2(sc, R92C_CR); 1932251538Srpaulo reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN | 1933251538Srpaulo R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN | 1934251538Srpaulo R92C_CR_SCHEDULE_EN | R92C_CR_MACTXEN | R92C_CR_MACRXEN | 1935251538Srpaulo R92C_CR_ENSEC; 1936251538Srpaulo urtwn_write_2(sc, R92C_CR, reg); 1937251538Srpaulo 1938251538Srpaulo urtwn_write_1(sc, 0xfe10, 0x19); 1939251538Srpaulo return (0); 1940251538Srpaulo} 1941251538Srpaulo 1942251538Srpaulostatic int 1943251538Srpaulourtwn_llt_init(struct urtwn_softc *sc) 1944251538Srpaulo{ 1945251538Srpaulo int i, error; 1946251538Srpaulo 1947251538Srpaulo /* Reserve pages [0; R92C_TX_PAGE_COUNT]. */ 1948251538Srpaulo for (i = 0; i < R92C_TX_PAGE_COUNT; i++) { 1949251538Srpaulo if ((error = urtwn_llt_write(sc, i, i + 1)) != 0) 1950251538Srpaulo return (error); 1951251538Srpaulo } 1952251538Srpaulo /* NB: 0xff indicates end-of-list. */ 1953251538Srpaulo if ((error = urtwn_llt_write(sc, i, 0xff)) != 0) 1954251538Srpaulo return (error); 1955251538Srpaulo /* 1956251538Srpaulo * Use pages [R92C_TX_PAGE_COUNT + 1; R92C_TXPKTBUF_COUNT - 1] 1957251538Srpaulo * as ring buffer. 1958251538Srpaulo */ 1959251538Srpaulo for (++i; i < R92C_TXPKTBUF_COUNT - 1; i++) { 1960251538Srpaulo if ((error = urtwn_llt_write(sc, i, i + 1)) != 0) 1961251538Srpaulo return (error); 1962251538Srpaulo } 1963251538Srpaulo /* Make the last page point to the beginning of the ring buffer. */ 1964251538Srpaulo error = urtwn_llt_write(sc, i, R92C_TX_PAGE_COUNT + 1); 1965251538Srpaulo return (error); 1966251538Srpaulo} 1967251538Srpaulo 1968251538Srpaulostatic void 1969251538Srpaulourtwn_fw_reset(struct urtwn_softc *sc) 1970251538Srpaulo{ 1971251538Srpaulo uint16_t reg; 1972251538Srpaulo int ntries; 1973251538Srpaulo 1974251538Srpaulo /* Tell 8051 to reset itself. */ 1975251538Srpaulo urtwn_write_1(sc, R92C_HMETFR + 3, 0x20); 1976251538Srpaulo 1977251538Srpaulo /* Wait until 8051 resets by itself. */ 1978251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 1979251538Srpaulo reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN); 1980251538Srpaulo if (!(reg & R92C_SYS_FUNC_EN_CPUEN)) 1981251538Srpaulo return; 1982251538Srpaulo DELAY(50); 1983251538Srpaulo } 1984251538Srpaulo /* Force 8051 reset. */ 1985251538Srpaulo urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN); 1986251538Srpaulo} 1987251538Srpaulo 1988251538Srpaulostatic int 1989251538Srpaulourtwn_fw_loadpage(struct urtwn_softc *sc, int page, const uint8_t *buf, int len) 1990251538Srpaulo{ 1991251538Srpaulo uint32_t reg; 1992251538Srpaulo int off, mlen, error = 0; 1993251538Srpaulo 1994251538Srpaulo reg = urtwn_read_4(sc, R92C_MCUFWDL); 1995251538Srpaulo reg = RW(reg, R92C_MCUFWDL_PAGE, page); 1996251538Srpaulo urtwn_write_4(sc, R92C_MCUFWDL, reg); 1997251538Srpaulo 1998251538Srpaulo off = R92C_FW_START_ADDR; 1999251538Srpaulo while (len > 0) { 2000251538Srpaulo if (len > 196) 2001251538Srpaulo mlen = 196; 2002251538Srpaulo else if (len > 4) 2003251538Srpaulo mlen = 4; 2004251538Srpaulo else 2005251538Srpaulo mlen = 1; 2006251538Srpaulo /* XXX fix this deconst */ 2007251538Srpaulo error = urtwn_write_region_1(sc, off, 2008251538Srpaulo __DECONST(uint8_t *, buf), mlen); 2009251538Srpaulo if (error != 0) 2010251538Srpaulo break; 2011251538Srpaulo off += mlen; 2012251538Srpaulo buf += mlen; 2013251538Srpaulo len -= mlen; 2014251538Srpaulo } 2015251538Srpaulo return (error); 2016251538Srpaulo} 2017251538Srpaulo 2018251538Srpaulostatic int 2019251538Srpaulourtwn_load_firmware(struct urtwn_softc *sc) 2020251538Srpaulo{ 2021251538Srpaulo const struct firmware *fw; 2022251538Srpaulo const struct r92c_fw_hdr *hdr; 2023251538Srpaulo const char *imagename; 2024251538Srpaulo const u_char *ptr; 2025251538Srpaulo size_t len; 2026251538Srpaulo uint32_t reg; 2027251538Srpaulo int mlen, ntries, page, error; 2028251538Srpaulo 2029251538Srpaulo /* Read firmware image from the filesystem. */ 2030251538Srpaulo if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) == 2031251538Srpaulo URTWN_CHIP_UMC_A_CUT) 2032251538Srpaulo imagename = "urtwn-rtl8192cfwU"; 2033251538Srpaulo else 2034251538Srpaulo imagename = "urtwn-rtl8192cfwT"; 2035251538Srpaulo 2036251538Srpaulo fw = firmware_get(imagename); 2037251538Srpaulo if (fw == NULL) { 2038251538Srpaulo device_printf(sc->sc_dev, 2039251538Srpaulo "failed loadfirmware of file %s\n", imagename); 2040251538Srpaulo return (ENOENT); 2041251538Srpaulo } 2042251538Srpaulo 2043251538Srpaulo len = fw->datasize; 2044251538Srpaulo 2045251538Srpaulo if (len < sizeof(*hdr)) { 2046251538Srpaulo device_printf(sc->sc_dev, "firmware too short\n"); 2047251538Srpaulo error = EINVAL; 2048251538Srpaulo goto fail; 2049251538Srpaulo } 2050251538Srpaulo ptr = fw->data; 2051251538Srpaulo hdr = (const struct r92c_fw_hdr *)ptr; 2052251538Srpaulo /* Check if there is a valid FW header and skip it. */ 2053251538Srpaulo if ((le16toh(hdr->signature) >> 4) == 0x88c || 2054251538Srpaulo (le16toh(hdr->signature) >> 4) == 0x92c) { 2055251538Srpaulo DPRINTF("FW V%d.%d %02d-%02d %02d:%02d\n", 2056251538Srpaulo le16toh(hdr->version), le16toh(hdr->subversion), 2057251538Srpaulo hdr->month, hdr->date, hdr->hour, hdr->minute); 2058251538Srpaulo ptr += sizeof(*hdr); 2059251538Srpaulo len -= sizeof(*hdr); 2060251538Srpaulo } 2061251538Srpaulo 2062251538Srpaulo if (urtwn_read_1(sc, R92C_MCUFWDL) & 0x80) { 2063251538Srpaulo urtwn_fw_reset(sc); 2064251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 0); 2065251538Srpaulo } 2066251538Srpaulo urtwn_write_2(sc, R92C_SYS_FUNC_EN, 2067251538Srpaulo urtwn_read_2(sc, R92C_SYS_FUNC_EN) | 2068251538Srpaulo R92C_SYS_FUNC_EN_CPUEN); 2069251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 2070251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_EN); 2071251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL + 2, 2072251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL + 2) & ~0x08); 2073251538Srpaulo 2074251538Srpaulo for (page = 0; len > 0; page++) { 2075251538Srpaulo mlen = min(len, R92C_FW_PAGE_SIZE); 2076251538Srpaulo error = urtwn_fw_loadpage(sc, page, ptr, mlen); 2077251538Srpaulo if (error != 0) { 2078251538Srpaulo device_printf(sc->sc_dev, 2079251538Srpaulo "could not load firmware page\n"); 2080251538Srpaulo goto fail; 2081251538Srpaulo } 2082251538Srpaulo ptr += mlen; 2083251538Srpaulo len -= mlen; 2084251538Srpaulo } 2085251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 2086251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL) & ~R92C_MCUFWDL_EN); 2087251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL + 1, 0); 2088251538Srpaulo 2089251538Srpaulo /* Wait for checksum report. */ 2090251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 2091251538Srpaulo if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_CHKSUM_RPT) 2092251538Srpaulo break; 2093251538Srpaulo DELAY(5); 2094251538Srpaulo } 2095251538Srpaulo if (ntries == 1000) { 2096251538Srpaulo device_printf(sc->sc_dev, 2097251538Srpaulo "timeout waiting for checksum report\n"); 2098251538Srpaulo error = ETIMEDOUT; 2099251538Srpaulo goto fail; 2100251538Srpaulo } 2101251538Srpaulo 2102251538Srpaulo reg = urtwn_read_4(sc, R92C_MCUFWDL); 2103251538Srpaulo reg = (reg & ~R92C_MCUFWDL_WINTINI_RDY) | R92C_MCUFWDL_RDY; 2104251538Srpaulo urtwn_write_4(sc, R92C_MCUFWDL, reg); 2105251538Srpaulo /* Wait for firmware readiness. */ 2106251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 2107251538Srpaulo if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_WINTINI_RDY) 2108251538Srpaulo break; 2109251538Srpaulo DELAY(5); 2110251538Srpaulo } 2111251538Srpaulo if (ntries == 1000) { 2112251538Srpaulo device_printf(sc->sc_dev, 2113251538Srpaulo "timeout waiting for firmware readiness\n"); 2114251538Srpaulo error = ETIMEDOUT; 2115251538Srpaulo goto fail; 2116251538Srpaulo } 2117251538Srpaulofail: 2118251538Srpaulo firmware_put(fw, FIRMWARE_UNLOAD); 2119251538Srpaulo return (error); 2120251538Srpaulo} 2121251538Srpaulo 2122251538Srpaulostatic int 2123251538Srpaulourtwn_dma_init(struct urtwn_softc *sc) 2124251538Srpaulo{ 2125251538Srpaulo int hashq, hasnq, haslq, nqueues, nqpages, nrempages; 2126251538Srpaulo uint32_t reg; 2127251538Srpaulo int error; 2128251538Srpaulo 2129251538Srpaulo /* Initialize LLT table. */ 2130251538Srpaulo error = urtwn_llt_init(sc); 2131251538Srpaulo if (error != 0) 2132251538Srpaulo return (error); 2133251538Srpaulo 2134251538Srpaulo /* Get Tx queues to USB endpoints mapping. */ 2135251538Srpaulo hashq = hasnq = haslq = 0; 2136251538Srpaulo reg = urtwn_read_2(sc, R92C_USB_EP + 1); 2137251538Srpaulo DPRINTFN(2, "USB endpoints mapping 0x%x\n", reg); 2138251538Srpaulo if (MS(reg, R92C_USB_EP_HQ) != 0) 2139251538Srpaulo hashq = 1; 2140251538Srpaulo if (MS(reg, R92C_USB_EP_NQ) != 0) 2141251538Srpaulo hasnq = 1; 2142251538Srpaulo if (MS(reg, R92C_USB_EP_LQ) != 0) 2143251538Srpaulo haslq = 1; 2144251538Srpaulo nqueues = hashq + hasnq + haslq; 2145251538Srpaulo if (nqueues == 0) 2146251538Srpaulo return (EIO); 2147251538Srpaulo /* Get the number of pages for each queue. */ 2148251538Srpaulo nqpages = (R92C_TX_PAGE_COUNT - R92C_PUBQ_NPAGES) / nqueues; 2149251538Srpaulo /* The remaining pages are assigned to the high priority queue. */ 2150251538Srpaulo nrempages = (R92C_TX_PAGE_COUNT - R92C_PUBQ_NPAGES) % nqueues; 2151251538Srpaulo 2152251538Srpaulo /* Set number of pages for normal priority queue. */ 2153251538Srpaulo urtwn_write_1(sc, R92C_RQPN_NPQ, hasnq ? nqpages : 0); 2154251538Srpaulo urtwn_write_4(sc, R92C_RQPN, 2155251538Srpaulo /* Set number of pages for public queue. */ 2156251538Srpaulo SM(R92C_RQPN_PUBQ, R92C_PUBQ_NPAGES) | 2157251538Srpaulo /* Set number of pages for high priority queue. */ 2158251538Srpaulo SM(R92C_RQPN_HPQ, hashq ? nqpages + nrempages : 0) | 2159251538Srpaulo /* Set number of pages for low priority queue. */ 2160251538Srpaulo SM(R92C_RQPN_LPQ, haslq ? nqpages : 0) | 2161251538Srpaulo /* Load values. */ 2162251538Srpaulo R92C_RQPN_LD); 2163251538Srpaulo 2164251538Srpaulo urtwn_write_1(sc, R92C_TXPKTBUF_BCNQ_BDNY, R92C_TX_PAGE_BOUNDARY); 2165251538Srpaulo urtwn_write_1(sc, R92C_TXPKTBUF_MGQ_BDNY, R92C_TX_PAGE_BOUNDARY); 2166251538Srpaulo urtwn_write_1(sc, R92C_TXPKTBUF_WMAC_LBK_BF_HD, R92C_TX_PAGE_BOUNDARY); 2167251538Srpaulo urtwn_write_1(sc, R92C_TRXFF_BNDY, R92C_TX_PAGE_BOUNDARY); 2168251538Srpaulo urtwn_write_1(sc, R92C_TDECTRL + 1, R92C_TX_PAGE_BOUNDARY); 2169251538Srpaulo 2170251538Srpaulo /* Set queue to USB pipe mapping. */ 2171251538Srpaulo reg = urtwn_read_2(sc, R92C_TRXDMA_CTRL); 2172251538Srpaulo reg &= ~R92C_TRXDMA_CTRL_QMAP_M; 2173251538Srpaulo if (nqueues == 1) { 2174251538Srpaulo if (hashq) 2175251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_HQ; 2176251538Srpaulo else if (hasnq) 2177251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_NQ; 2178251538Srpaulo else 2179251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_LQ; 2180251538Srpaulo } else if (nqueues == 2) { 2181251538Srpaulo /* All 2-endpoints configs have a high priority queue. */ 2182251538Srpaulo if (!hashq) 2183251538Srpaulo return (EIO); 2184251538Srpaulo if (hasnq) 2185251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_HQ_NQ; 2186251538Srpaulo else 2187251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_HQ_LQ; 2188251538Srpaulo } else 2189251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_3EP; 2190251538Srpaulo urtwn_write_2(sc, R92C_TRXDMA_CTRL, reg); 2191251538Srpaulo 2192251538Srpaulo /* Set Tx/Rx transfer page boundary. */ 2193251538Srpaulo urtwn_write_2(sc, R92C_TRXFF_BNDY + 2, 0x27ff); 2194251538Srpaulo 2195251538Srpaulo /* Set Tx/Rx transfer page size. */ 2196251538Srpaulo urtwn_write_1(sc, R92C_PBP, 2197251538Srpaulo SM(R92C_PBP_PSRX, R92C_PBP_128) | 2198251538Srpaulo SM(R92C_PBP_PSTX, R92C_PBP_128)); 2199251538Srpaulo return (0); 2200251538Srpaulo} 2201251538Srpaulo 2202251538Srpaulostatic void 2203251538Srpaulourtwn_mac_init(struct urtwn_softc *sc) 2204251538Srpaulo{ 2205251538Srpaulo int i; 2206251538Srpaulo 2207251538Srpaulo /* Write MAC initialization values. */ 2208251538Srpaulo for (i = 0; i < nitems(rtl8192cu_mac); i++) 2209251538Srpaulo urtwn_write_1(sc, rtl8192cu_mac[i].reg, rtl8192cu_mac[i].val); 2210251538Srpaulo} 2211251538Srpaulo 2212251538Srpaulostatic void 2213251538Srpaulourtwn_bb_init(struct urtwn_softc *sc) 2214251538Srpaulo{ 2215251538Srpaulo const struct urtwn_bb_prog *prog; 2216251538Srpaulo uint32_t reg; 2217251538Srpaulo int i; 2218251538Srpaulo 2219251538Srpaulo /* Enable BB and RF. */ 2220251538Srpaulo urtwn_write_2(sc, R92C_SYS_FUNC_EN, 2221251538Srpaulo urtwn_read_2(sc, R92C_SYS_FUNC_EN) | 2222251538Srpaulo R92C_SYS_FUNC_EN_BBRSTB | R92C_SYS_FUNC_EN_BB_GLB_RST | 2223251538Srpaulo R92C_SYS_FUNC_EN_DIO_RF); 2224251538Srpaulo 2225251538Srpaulo urtwn_write_2(sc, R92C_AFE_PLL_CTRL, 0xdb83); 2226251538Srpaulo 2227251538Srpaulo urtwn_write_1(sc, R92C_RF_CTRL, 2228251538Srpaulo R92C_RF_CTRL_EN | R92C_RF_CTRL_RSTB | R92C_RF_CTRL_SDMRSTB); 2229251538Srpaulo urtwn_write_1(sc, R92C_SYS_FUNC_EN, 2230251538Srpaulo R92C_SYS_FUNC_EN_USBA | R92C_SYS_FUNC_EN_USBD | 2231251538Srpaulo R92C_SYS_FUNC_EN_BB_GLB_RST | R92C_SYS_FUNC_EN_BBRSTB); 2232251538Srpaulo 2233251538Srpaulo urtwn_write_1(sc, R92C_LDOHCI12_CTRL, 0x0f); 2234251538Srpaulo urtwn_write_1(sc, 0x15, 0xe9); 2235251538Srpaulo urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 1, 0x80); 2236251538Srpaulo 2237251538Srpaulo /* Select BB programming based on board type. */ 2238251538Srpaulo if (!(sc->chip & URTWN_CHIP_92C)) { 2239251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 2240251538Srpaulo prog = &rtl8188ce_bb_prog; 2241251538Srpaulo else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 2242251538Srpaulo prog = &rtl8188ru_bb_prog; 2243251538Srpaulo else 2244251538Srpaulo prog = &rtl8188cu_bb_prog; 2245251538Srpaulo } else { 2246251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 2247251538Srpaulo prog = &rtl8192ce_bb_prog; 2248251538Srpaulo else 2249251538Srpaulo prog = &rtl8192cu_bb_prog; 2250251538Srpaulo } 2251251538Srpaulo /* Write BB initialization values. */ 2252251538Srpaulo for (i = 0; i < prog->count; i++) { 2253251538Srpaulo urtwn_bb_write(sc, prog->regs[i], prog->vals[i]); 2254251538Srpaulo DELAY(1); 2255251538Srpaulo } 2256251538Srpaulo 2257251538Srpaulo if (sc->chip & URTWN_CHIP_92C_1T2R) { 2258251538Srpaulo /* 8192C 1T only configuration. */ 2259251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_TXINFO); 2260251538Srpaulo reg = (reg & ~0x00000003) | 0x2; 2261251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_TXINFO, reg); 2262251538Srpaulo 2263251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA1_TXINFO); 2264251538Srpaulo reg = (reg & ~0x00300033) | 0x00200022; 2265251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_TXINFO, reg); 2266251538Srpaulo 2267251538Srpaulo reg = urtwn_bb_read(sc, R92C_CCK0_AFESETTING); 2268251538Srpaulo reg = (reg & ~0xff000000) | 0x45 << 24; 2269251538Srpaulo urtwn_bb_write(sc, R92C_CCK0_AFESETTING, reg); 2270251538Srpaulo 2271251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_TRXPATHENA); 2272251538Srpaulo reg = (reg & ~0x000000ff) | 0x23; 2273251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_TRXPATHENA, reg); 2274251538Srpaulo 2275251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_AGCPARAM1); 2276251538Srpaulo reg = (reg & ~0x00000030) | 1 << 4; 2277251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCPARAM1, reg); 2278251538Srpaulo 2279251538Srpaulo reg = urtwn_bb_read(sc, 0xe74); 2280251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 2281251538Srpaulo urtwn_bb_write(sc, 0xe74, reg); 2282251538Srpaulo reg = urtwn_bb_read(sc, 0xe78); 2283251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 2284251538Srpaulo urtwn_bb_write(sc, 0xe78, reg); 2285251538Srpaulo reg = urtwn_bb_read(sc, 0xe7c); 2286251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 2287251538Srpaulo urtwn_bb_write(sc, 0xe7c, reg); 2288251538Srpaulo reg = urtwn_bb_read(sc, 0xe80); 2289251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 2290251538Srpaulo urtwn_bb_write(sc, 0xe80, reg); 2291251538Srpaulo reg = urtwn_bb_read(sc, 0xe88); 2292251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 2293251538Srpaulo urtwn_bb_write(sc, 0xe88, reg); 2294251538Srpaulo } 2295251538Srpaulo 2296251538Srpaulo /* Write AGC values. */ 2297251538Srpaulo for (i = 0; i < prog->agccount; i++) { 2298251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCRSSITABLE, 2299251538Srpaulo prog->agcvals[i]); 2300251538Srpaulo DELAY(1); 2301251538Srpaulo } 2302251538Srpaulo 2303251538Srpaulo if (urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)) & 2304251538Srpaulo R92C_HSSI_PARAM2_CCK_HIPWR) 2305251538Srpaulo sc->sc_flags |= URTWN_FLAG_CCK_HIPWR; 2306251538Srpaulo} 2307251538Srpaulo 2308251538Srpaulovoid 2309251538Srpaulourtwn_rf_init(struct urtwn_softc *sc) 2310251538Srpaulo{ 2311251538Srpaulo const struct urtwn_rf_prog *prog; 2312251538Srpaulo uint32_t reg, type; 2313251538Srpaulo int i, j, idx, off; 2314251538Srpaulo 2315251538Srpaulo /* Select RF programming based on board type. */ 2316251538Srpaulo if (!(sc->chip & URTWN_CHIP_92C)) { 2317251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 2318251538Srpaulo prog = rtl8188ce_rf_prog; 2319251538Srpaulo else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 2320251538Srpaulo prog = rtl8188ru_rf_prog; 2321251538Srpaulo else 2322251538Srpaulo prog = rtl8188cu_rf_prog; 2323251538Srpaulo } else 2324251538Srpaulo prog = rtl8192ce_rf_prog; 2325251538Srpaulo 2326251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 2327251538Srpaulo /* Save RF_ENV control type. */ 2328251538Srpaulo idx = i / 2; 2329251538Srpaulo off = (i % 2) * 16; 2330251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx)); 2331251538Srpaulo type = (reg >> off) & 0x10; 2332251538Srpaulo 2333251538Srpaulo /* Set RF_ENV enable. */ 2334251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i)); 2335251538Srpaulo reg |= 0x100000; 2336251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg); 2337251538Srpaulo DELAY(1); 2338251538Srpaulo /* Set RF_ENV output high. */ 2339251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i)); 2340251538Srpaulo reg |= 0x10; 2341251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg); 2342251538Srpaulo DELAY(1); 2343251538Srpaulo /* Set address and data lengths of RF registers. */ 2344251538Srpaulo reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i)); 2345251538Srpaulo reg &= ~R92C_HSSI_PARAM2_ADDR_LENGTH; 2346251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg); 2347251538Srpaulo DELAY(1); 2348251538Srpaulo reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i)); 2349251538Srpaulo reg &= ~R92C_HSSI_PARAM2_DATA_LENGTH; 2350251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg); 2351251538Srpaulo DELAY(1); 2352251538Srpaulo 2353251538Srpaulo /* Write RF initialization values for this chain. */ 2354251538Srpaulo for (j = 0; j < prog[i].count; j++) { 2355251538Srpaulo if (prog[i].regs[j] >= 0xf9 && 2356251538Srpaulo prog[i].regs[j] <= 0xfe) { 2357251538Srpaulo /* 2358251538Srpaulo * These are fake RF registers offsets that 2359251538Srpaulo * indicate a delay is required. 2360251538Srpaulo */ 2361251538Srpaulo usb_pause_mtx(&sc->sc_mtx, 50); 2362251538Srpaulo continue; 2363251538Srpaulo } 2364251538Srpaulo urtwn_rf_write(sc, i, prog[i].regs[j], 2365251538Srpaulo prog[i].vals[j]); 2366251538Srpaulo DELAY(1); 2367251538Srpaulo } 2368251538Srpaulo 2369251538Srpaulo /* Restore RF_ENV control type. */ 2370251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx)); 2371251538Srpaulo reg &= ~(0x10 << off) | (type << off); 2372251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACESW(idx), reg); 2373251538Srpaulo 2374251538Srpaulo /* Cache RF register CHNLBW. */ 2375251538Srpaulo sc->rf_chnlbw[i] = urtwn_rf_read(sc, i, R92C_RF_CHNLBW); 2376251538Srpaulo } 2377251538Srpaulo 2378251538Srpaulo if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) == 2379251538Srpaulo URTWN_CHIP_UMC_A_CUT) { 2380251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_RX_G1, 0x30255); 2381251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_RX_G2, 0x50a00); 2382251538Srpaulo } 2383251538Srpaulo} 2384251538Srpaulo 2385251538Srpaulostatic void 2386251538Srpaulourtwn_cam_init(struct urtwn_softc *sc) 2387251538Srpaulo{ 2388251538Srpaulo /* Invalidate all CAM entries. */ 2389251538Srpaulo urtwn_write_4(sc, R92C_CAMCMD, 2390251538Srpaulo R92C_CAMCMD_POLLING | R92C_CAMCMD_CLR); 2391251538Srpaulo} 2392251538Srpaulo 2393251538Srpaulostatic void 2394251538Srpaulourtwn_pa_bias_init(struct urtwn_softc *sc) 2395251538Srpaulo{ 2396251538Srpaulo uint8_t reg; 2397251538Srpaulo int i; 2398251538Srpaulo 2399251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 2400251538Srpaulo if (sc->pa_setting & (1 << i)) 2401251538Srpaulo continue; 2402251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x0f406); 2403251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x4f406); 2404251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x8f406); 2405251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0xcf406); 2406251538Srpaulo } 2407251538Srpaulo if (!(sc->pa_setting & 0x10)) { 2408251538Srpaulo reg = urtwn_read_1(sc, 0x16); 2409251538Srpaulo reg = (reg & ~0xf0) | 0x90; 2410251538Srpaulo urtwn_write_1(sc, 0x16, reg); 2411251538Srpaulo } 2412251538Srpaulo} 2413251538Srpaulo 2414251538Srpaulostatic void 2415251538Srpaulourtwn_rxfilter_init(struct urtwn_softc *sc) 2416251538Srpaulo{ 2417251538Srpaulo /* Initialize Rx filter. */ 2418251538Srpaulo /* TODO: use better filter for monitor mode. */ 2419251538Srpaulo urtwn_write_4(sc, R92C_RCR, 2420251538Srpaulo R92C_RCR_AAP | R92C_RCR_APM | R92C_RCR_AM | R92C_RCR_AB | 2421251538Srpaulo R92C_RCR_APP_ICV | R92C_RCR_AMF | R92C_RCR_HTC_LOC_CTRL | 2422251538Srpaulo R92C_RCR_APP_MIC | R92C_RCR_APP_PHYSTS); 2423251538Srpaulo /* Accept all multicast frames. */ 2424251538Srpaulo urtwn_write_4(sc, R92C_MAR + 0, 0xffffffff); 2425251538Srpaulo urtwn_write_4(sc, R92C_MAR + 4, 0xffffffff); 2426251538Srpaulo /* Accept all management frames. */ 2427251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP0, 0xffff); 2428251538Srpaulo /* Reject all control frames. */ 2429251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP1, 0x0000); 2430251538Srpaulo /* Accept all data frames. */ 2431251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff); 2432251538Srpaulo} 2433251538Srpaulo 2434251538Srpaulostatic void 2435251538Srpaulourtwn_edca_init(struct urtwn_softc *sc) 2436251538Srpaulo{ 2437251538Srpaulo urtwn_write_2(sc, R92C_SPEC_SIFS, 0x100a); 2438251538Srpaulo urtwn_write_2(sc, R92C_MAC_SPEC_SIFS, 0x100a); 2439251538Srpaulo urtwn_write_2(sc, R92C_SIFS_CCK, 0x100a); 2440251538Srpaulo urtwn_write_2(sc, R92C_SIFS_OFDM, 0x100a); 2441251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x005ea42b); 2442251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a44f); 2443251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005ea324); 2444251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002fa226); 2445251538Srpaulo} 2446251538Srpaulo 2447251538Srpaulovoid 2448251538Srpaulourtwn_write_txpower(struct urtwn_softc *sc, int chain, 2449251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]) 2450251538Srpaulo{ 2451251538Srpaulo uint32_t reg; 2452251538Srpaulo 2453251538Srpaulo /* Write per-CCK rate Tx power. */ 2454251538Srpaulo if (chain == 0) { 2455251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_A_CCK1_MCS32); 2456251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK1, power[0]); 2457251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_A_CCK1_MCS32, reg); 2458251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11); 2459251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK2, power[1]); 2460251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK55, power[2]); 2461251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK11, power[3]); 2462251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg); 2463251538Srpaulo } else { 2464251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK1_55_MCS32); 2465251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK1, power[0]); 2466251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK2, power[1]); 2467251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK55, power[2]); 2468251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK1_55_MCS32, reg); 2469251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11); 2470251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK11, power[3]); 2471251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg); 2472251538Srpaulo } 2473251538Srpaulo /* Write per-OFDM rate Tx power. */ 2474251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_RATE18_06(chain), 2475251538Srpaulo SM(R92C_TXAGC_RATE06, power[ 4]) | 2476251538Srpaulo SM(R92C_TXAGC_RATE09, power[ 5]) | 2477251538Srpaulo SM(R92C_TXAGC_RATE12, power[ 6]) | 2478251538Srpaulo SM(R92C_TXAGC_RATE18, power[ 7])); 2479251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_RATE54_24(chain), 2480251538Srpaulo SM(R92C_TXAGC_RATE24, power[ 8]) | 2481251538Srpaulo SM(R92C_TXAGC_RATE36, power[ 9]) | 2482251538Srpaulo SM(R92C_TXAGC_RATE48, power[10]) | 2483251538Srpaulo SM(R92C_TXAGC_RATE54, power[11])); 2484251538Srpaulo /* Write per-MCS Tx power. */ 2485251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS03_MCS00(chain), 2486251538Srpaulo SM(R92C_TXAGC_MCS00, power[12]) | 2487251538Srpaulo SM(R92C_TXAGC_MCS01, power[13]) | 2488251538Srpaulo SM(R92C_TXAGC_MCS02, power[14]) | 2489251538Srpaulo SM(R92C_TXAGC_MCS03, power[15])); 2490251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS07_MCS04(chain), 2491251538Srpaulo SM(R92C_TXAGC_MCS04, power[16]) | 2492251538Srpaulo SM(R92C_TXAGC_MCS05, power[17]) | 2493251538Srpaulo SM(R92C_TXAGC_MCS06, power[18]) | 2494251538Srpaulo SM(R92C_TXAGC_MCS07, power[19])); 2495251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS11_MCS08(chain), 2496251538Srpaulo SM(R92C_TXAGC_MCS08, power[20]) | 2497261506Skevlo SM(R92C_TXAGC_MCS09, power[21]) | 2498251538Srpaulo SM(R92C_TXAGC_MCS10, power[22]) | 2499251538Srpaulo SM(R92C_TXAGC_MCS11, power[23])); 2500251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS15_MCS12(chain), 2501251538Srpaulo SM(R92C_TXAGC_MCS12, power[24]) | 2502251538Srpaulo SM(R92C_TXAGC_MCS13, power[25]) | 2503251538Srpaulo SM(R92C_TXAGC_MCS14, power[26]) | 2504251538Srpaulo SM(R92C_TXAGC_MCS15, power[27])); 2505251538Srpaulo} 2506251538Srpaulo 2507251538Srpaulovoid 2508251538Srpaulourtwn_get_txpower(struct urtwn_softc *sc, int chain, 2509251538Srpaulo struct ieee80211_channel *c, struct ieee80211_channel *extc, 2510251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]) 2511251538Srpaulo{ 2512251538Srpaulo struct ieee80211com *ic = sc->sc_ifp->if_l2com; 2513251538Srpaulo struct r92c_rom *rom = &sc->rom; 2514251538Srpaulo uint16_t cckpow, ofdmpow, htpow, diff, max; 2515251538Srpaulo const struct urtwn_txpwr *base; 2516251538Srpaulo int ridx, chan, group; 2517251538Srpaulo 2518251538Srpaulo /* Determine channel group. */ 2519251538Srpaulo chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */ 2520251538Srpaulo if (chan <= 3) 2521251538Srpaulo group = 0; 2522251538Srpaulo else if (chan <= 9) 2523251538Srpaulo group = 1; 2524251538Srpaulo else 2525251538Srpaulo group = 2; 2526251538Srpaulo 2527251538Srpaulo /* Get original Tx power based on board type and RF chain. */ 2528251538Srpaulo if (!(sc->chip & URTWN_CHIP_92C)) { 2529251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 2530251538Srpaulo base = &rtl8188ru_txagc[chain]; 2531251538Srpaulo else 2532251538Srpaulo base = &rtl8192cu_txagc[chain]; 2533251538Srpaulo } else 2534251538Srpaulo base = &rtl8192cu_txagc[chain]; 2535251538Srpaulo 2536251538Srpaulo memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0])); 2537251538Srpaulo if (sc->regulatory == 0) { 2538251538Srpaulo for (ridx = 0; ridx <= 3; ridx++) 2539251538Srpaulo power[ridx] = base->pwr[0][ridx]; 2540251538Srpaulo } 2541251538Srpaulo for (ridx = 4; ridx < URTWN_RIDX_COUNT; ridx++) { 2542251538Srpaulo if (sc->regulatory == 3) { 2543251538Srpaulo power[ridx] = base->pwr[0][ridx]; 2544251538Srpaulo /* Apply vendor limits. */ 2545251538Srpaulo if (extc != NULL) 2546251538Srpaulo max = rom->ht40_max_pwr[group]; 2547251538Srpaulo else 2548251538Srpaulo max = rom->ht20_max_pwr[group]; 2549251538Srpaulo max = (max >> (chain * 4)) & 0xf; 2550251538Srpaulo if (power[ridx] > max) 2551251538Srpaulo power[ridx] = max; 2552251538Srpaulo } else if (sc->regulatory == 1) { 2553251538Srpaulo if (extc == NULL) 2554251538Srpaulo power[ridx] = base->pwr[group][ridx]; 2555251538Srpaulo } else if (sc->regulatory != 2) 2556251538Srpaulo power[ridx] = base->pwr[0][ridx]; 2557251538Srpaulo } 2558251538Srpaulo 2559251538Srpaulo /* Compute per-CCK rate Tx power. */ 2560251538Srpaulo cckpow = rom->cck_tx_pwr[chain][group]; 2561251538Srpaulo for (ridx = 0; ridx <= 3; ridx++) { 2562251538Srpaulo power[ridx] += cckpow; 2563251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 2564251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 2565251538Srpaulo } 2566251538Srpaulo 2567251538Srpaulo htpow = rom->ht40_1s_tx_pwr[chain][group]; 2568251538Srpaulo if (sc->ntxchains > 1) { 2569251538Srpaulo /* Apply reduction for 2 spatial streams. */ 2570251538Srpaulo diff = rom->ht40_2s_tx_pwr_diff[group]; 2571251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 2572251538Srpaulo htpow = (htpow > diff) ? htpow - diff : 0; 2573251538Srpaulo } 2574251538Srpaulo 2575251538Srpaulo /* Compute per-OFDM rate Tx power. */ 2576251538Srpaulo diff = rom->ofdm_tx_pwr_diff[group]; 2577251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 2578251538Srpaulo ofdmpow = htpow + diff; /* HT->OFDM correction. */ 2579251538Srpaulo for (ridx = 4; ridx <= 11; ridx++) { 2580251538Srpaulo power[ridx] += ofdmpow; 2581251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 2582251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 2583251538Srpaulo } 2584251538Srpaulo 2585251538Srpaulo /* Compute per-MCS Tx power. */ 2586251538Srpaulo if (extc == NULL) { 2587251538Srpaulo diff = rom->ht20_tx_pwr_diff[group]; 2588251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 2589251538Srpaulo htpow += diff; /* HT40->HT20 correction. */ 2590251538Srpaulo } 2591251538Srpaulo for (ridx = 12; ridx <= 27; ridx++) { 2592251538Srpaulo power[ridx] += htpow; 2593251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 2594251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 2595251538Srpaulo } 2596251538Srpaulo#ifdef URTWN_DEBUG 2597251538Srpaulo if (urtwn_debug >= 4) { 2598251538Srpaulo /* Dump per-rate Tx power values. */ 2599251538Srpaulo printf("Tx power for chain %d:\n", chain); 2600251538Srpaulo for (ridx = 0; ridx < URTWN_RIDX_COUNT; ridx++) 2601251538Srpaulo printf("Rate %d = %u\n", ridx, power[ridx]); 2602251538Srpaulo } 2603251538Srpaulo#endif 2604251538Srpaulo} 2605251538Srpaulo 2606251538Srpaulovoid 2607251538Srpaulourtwn_set_txpower(struct urtwn_softc *sc, struct ieee80211_channel *c, 2608251538Srpaulo struct ieee80211_channel *extc) 2609251538Srpaulo{ 2610251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]; 2611251538Srpaulo int i; 2612251538Srpaulo 2613251538Srpaulo for (i = 0; i < sc->ntxchains; i++) { 2614251538Srpaulo /* Compute per-rate Tx power values. */ 2615251538Srpaulo urtwn_get_txpower(sc, i, c, extc, power); 2616251538Srpaulo /* Write per-rate Tx power values to hardware. */ 2617251538Srpaulo urtwn_write_txpower(sc, i, power); 2618251538Srpaulo } 2619251538Srpaulo} 2620251538Srpaulo 2621251538Srpaulostatic void 2622251538Srpaulourtwn_scan_start(struct ieee80211com *ic) 2623251538Srpaulo{ 2624251538Srpaulo /* XXX do nothing? */ 2625251538Srpaulo} 2626251538Srpaulo 2627251538Srpaulostatic void 2628251538Srpaulourtwn_scan_end(struct ieee80211com *ic) 2629251538Srpaulo{ 2630251538Srpaulo /* XXX do nothing? */ 2631251538Srpaulo} 2632251538Srpaulo 2633251538Srpaulostatic void 2634251538Srpaulourtwn_set_channel(struct ieee80211com *ic) 2635251538Srpaulo{ 2636251538Srpaulo struct urtwn_softc *sc = ic->ic_ifp->if_softc; 2637251538Srpaulo 2638251538Srpaulo URTWN_LOCK(sc); 2639251538Srpaulo urtwn_set_chan(sc, ic->ic_curchan, NULL); 2640251538Srpaulo URTWN_UNLOCK(sc); 2641251538Srpaulo} 2642251538Srpaulo 2643251538Srpaulostatic void 2644251538Srpaulourtwn_update_mcast(struct ifnet *ifp) 2645251538Srpaulo{ 2646251538Srpaulo /* XXX do nothing? */ 2647251538Srpaulo} 2648251538Srpaulo 2649251538Srpaulostatic void 2650251538Srpaulourtwn_set_chan(struct urtwn_softc *sc, struct ieee80211_channel *c, 2651251538Srpaulo struct ieee80211_channel *extc) 2652251538Srpaulo{ 2653251538Srpaulo struct ieee80211com *ic = sc->sc_ifp->if_l2com; 2654251538Srpaulo uint32_t reg; 2655251538Srpaulo u_int chan; 2656251538Srpaulo int i; 2657251538Srpaulo 2658251538Srpaulo chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */ 2659251538Srpaulo if (chan == 0 || chan == IEEE80211_CHAN_ANY) { 2660251538Srpaulo device_printf(sc->sc_dev, 2661251538Srpaulo "%s: invalid channel %x\n", __func__, chan); 2662251538Srpaulo return; 2663251538Srpaulo } 2664251538Srpaulo 2665251538Srpaulo /* Set Tx power for this new channel. */ 2666251538Srpaulo urtwn_set_txpower(sc, c, extc); 2667251538Srpaulo 2668251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 2669251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_CHNLBW, 2670251538Srpaulo RW(sc->rf_chnlbw[i], R92C_RF_CHNLBW_CHNL, chan)); 2671251538Srpaulo } 2672251538Srpaulo#ifndef IEEE80211_NO_HT 2673251538Srpaulo if (extc != NULL) { 2674251538Srpaulo /* Is secondary channel below or above primary? */ 2675251538Srpaulo int prichlo = c->ic_freq < extc->ic_freq; 2676251538Srpaulo 2677251538Srpaulo urtwn_write_1(sc, R92C_BWOPMODE, 2678251538Srpaulo urtwn_read_1(sc, R92C_BWOPMODE) & ~R92C_BWOPMODE_20MHZ); 2679251538Srpaulo 2680251538Srpaulo reg = urtwn_read_1(sc, R92C_RRSR + 2); 2681251538Srpaulo reg = (reg & ~0x6f) | (prichlo ? 1 : 2) << 5; 2682251538Srpaulo urtwn_write_1(sc, R92C_RRSR + 2, reg); 2683251538Srpaulo 2684251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFMOD, 2685251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_RFMOD) | R92C_RFMOD_40MHZ); 2686251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_RFMOD, 2687251538Srpaulo urtwn_bb_read(sc, R92C_FPGA1_RFMOD) | R92C_RFMOD_40MHZ); 2688251538Srpaulo 2689251538Srpaulo /* Set CCK side band. */ 2690251538Srpaulo reg = urtwn_bb_read(sc, R92C_CCK0_SYSTEM); 2691251538Srpaulo reg = (reg & ~0x00000010) | (prichlo ? 0 : 1) << 4; 2692251538Srpaulo urtwn_bb_write(sc, R92C_CCK0_SYSTEM, reg); 2693251538Srpaulo 2694251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM1_LSTF); 2695251538Srpaulo reg = (reg & ~0x00000c00) | (prichlo ? 1 : 2) << 10; 2696251538Srpaulo urtwn_bb_write(sc, R92C_OFDM1_LSTF, reg); 2697251538Srpaulo 2698251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2, 2699251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) & 2700251538Srpaulo ~R92C_FPGA0_ANAPARAM2_CBW20); 2701251538Srpaulo 2702251538Srpaulo reg = urtwn_bb_read(sc, 0x818); 2703251538Srpaulo reg = (reg & ~0x0c000000) | (prichlo ? 2 : 1) << 26; 2704251538Srpaulo urtwn_bb_write(sc, 0x818, reg); 2705251538Srpaulo 2706251538Srpaulo /* Select 40MHz bandwidth. */ 2707251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 2708251538Srpaulo (sc->rf_chnlbw[0] & ~0xfff) | chan); 2709251538Srpaulo } else 2710251538Srpaulo#endif 2711251538Srpaulo { 2712251538Srpaulo urtwn_write_1(sc, R92C_BWOPMODE, 2713251538Srpaulo urtwn_read_1(sc, R92C_BWOPMODE) | R92C_BWOPMODE_20MHZ); 2714251538Srpaulo 2715251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFMOD, 2716251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_RFMOD) & ~R92C_RFMOD_40MHZ); 2717251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_RFMOD, 2718251538Srpaulo urtwn_bb_read(sc, R92C_FPGA1_RFMOD) & ~R92C_RFMOD_40MHZ); 2719251538Srpaulo 2720251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2, 2721251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) | 2722251538Srpaulo R92C_FPGA0_ANAPARAM2_CBW20); 2723251538Srpaulo 2724251538Srpaulo /* Select 20MHz bandwidth. */ 2725251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 2726251538Srpaulo (sc->rf_chnlbw[0] & ~0xfff) | R92C_RF_CHNLBW_BW20 | chan); 2727251538Srpaulo } 2728251538Srpaulo} 2729251538Srpaulo 2730251538Srpaulostatic void 2731251538Srpaulourtwn_iq_calib(struct urtwn_softc *sc) 2732251538Srpaulo{ 2733251538Srpaulo /* TODO */ 2734251538Srpaulo} 2735251538Srpaulo 2736251538Srpaulostatic void 2737251538Srpaulourtwn_lc_calib(struct urtwn_softc *sc) 2738251538Srpaulo{ 2739251538Srpaulo uint32_t rf_ac[2]; 2740251538Srpaulo uint8_t txmode; 2741251538Srpaulo int i; 2742251538Srpaulo 2743251538Srpaulo txmode = urtwn_read_1(sc, R92C_OFDM1_LSTF + 3); 2744251538Srpaulo if ((txmode & 0x70) != 0) { 2745251538Srpaulo /* Disable all continuous Tx. */ 2746251538Srpaulo urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode & ~0x70); 2747251538Srpaulo 2748251538Srpaulo /* Set RF mode to standby mode. */ 2749251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 2750251538Srpaulo rf_ac[i] = urtwn_rf_read(sc, i, R92C_RF_AC); 2751251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_AC, 2752251538Srpaulo RW(rf_ac[i], R92C_RF_AC_MODE, 2753251538Srpaulo R92C_RF_AC_MODE_STANDBY)); 2754251538Srpaulo } 2755251538Srpaulo } else { 2756251538Srpaulo /* Block all Tx queues. */ 2757251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 0xff); 2758251538Srpaulo } 2759251538Srpaulo /* Start calibration. */ 2760251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 2761251538Srpaulo urtwn_rf_read(sc, 0, R92C_RF_CHNLBW) | R92C_RF_CHNLBW_LCSTART); 2762251538Srpaulo 2763251538Srpaulo /* Give calibration the time to complete. */ 2764251538Srpaulo usb_pause_mtx(&sc->sc_mtx, 100); 2765251538Srpaulo 2766251538Srpaulo /* Restore configuration. */ 2767251538Srpaulo if ((txmode & 0x70) != 0) { 2768251538Srpaulo /* Restore Tx mode. */ 2769251538Srpaulo urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode); 2770251538Srpaulo /* Restore RF mode. */ 2771251538Srpaulo for (i = 0; i < sc->nrxchains; i++) 2772251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_AC, rf_ac[i]); 2773251538Srpaulo } else { 2774251538Srpaulo /* Unblock all Tx queues. */ 2775251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 0x00); 2776251538Srpaulo } 2777251538Srpaulo} 2778251538Srpaulo 2779251538Srpaulostatic void 2780251538Srpaulourtwn_init_locked(void *arg) 2781251538Srpaulo{ 2782251538Srpaulo struct urtwn_softc *sc = arg; 2783251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 2784251538Srpaulo uint32_t reg; 2785251538Srpaulo int error; 2786251538Srpaulo 2787251538Srpaulo if (ifp->if_drv_flags & IFF_DRV_RUNNING) 2788251538Srpaulo urtwn_stop_locked(ifp, 0); 2789251538Srpaulo 2790251538Srpaulo /* Init firmware commands ring. */ 2791251538Srpaulo sc->fwcur = 0; 2792251538Srpaulo 2793251538Srpaulo /* Allocate Tx/Rx buffers. */ 2794251538Srpaulo error = urtwn_alloc_rx_list(sc); 2795251538Srpaulo if (error != 0) 2796251538Srpaulo goto fail; 2797251538Srpaulo 2798251538Srpaulo error = urtwn_alloc_tx_list(sc); 2799251538Srpaulo if (error != 0) 2800251538Srpaulo goto fail; 2801251538Srpaulo 2802251538Srpaulo /* Power on adapter. */ 2803251538Srpaulo error = urtwn_power_on(sc); 2804251538Srpaulo if (error != 0) 2805251538Srpaulo goto fail; 2806251538Srpaulo 2807251538Srpaulo /* Initialize DMA. */ 2808251538Srpaulo error = urtwn_dma_init(sc); 2809251538Srpaulo if (error != 0) 2810251538Srpaulo goto fail; 2811251538Srpaulo 2812251538Srpaulo /* Set info size in Rx descriptors (in 64-bit words). */ 2813251538Srpaulo urtwn_write_1(sc, R92C_RX_DRVINFO_SZ, 4); 2814251538Srpaulo 2815251538Srpaulo /* Init interrupts. */ 2816251538Srpaulo urtwn_write_4(sc, R92C_HISR, 0xffffffff); 2817251538Srpaulo urtwn_write_4(sc, R92C_HIMR, 0xffffffff); 2818251538Srpaulo 2819251538Srpaulo /* Set MAC address. */ 2820251538Srpaulo urtwn_write_region_1(sc, R92C_MACID, IF_LLADDR(ifp), 2821251538Srpaulo IEEE80211_ADDR_LEN); 2822251538Srpaulo 2823251538Srpaulo /* Set initial network type. */ 2824251538Srpaulo reg = urtwn_read_4(sc, R92C_CR); 2825251538Srpaulo reg = RW(reg, R92C_CR_NETTYPE, R92C_CR_NETTYPE_INFRA); 2826251538Srpaulo urtwn_write_4(sc, R92C_CR, reg); 2827251538Srpaulo 2828251538Srpaulo urtwn_rxfilter_init(sc); 2829251538Srpaulo 2830251538Srpaulo reg = urtwn_read_4(sc, R92C_RRSR); 2831251538Srpaulo reg = RW(reg, R92C_RRSR_RATE_BITMAP, R92C_RRSR_RATE_CCK_ONLY_1M); 2832251538Srpaulo urtwn_write_4(sc, R92C_RRSR, reg); 2833251538Srpaulo 2834251538Srpaulo /* Set short/long retry limits. */ 2835251538Srpaulo urtwn_write_2(sc, R92C_RL, 2836251538Srpaulo SM(R92C_RL_SRL, 0x30) | SM(R92C_RL_LRL, 0x30)); 2837251538Srpaulo 2838251538Srpaulo /* Initialize EDCA parameters. */ 2839251538Srpaulo urtwn_edca_init(sc); 2840251538Srpaulo 2841251538Srpaulo /* Setup rate fallback. */ 2842251538Srpaulo urtwn_write_4(sc, R92C_DARFRC + 0, 0x00000000); 2843251538Srpaulo urtwn_write_4(sc, R92C_DARFRC + 4, 0x10080404); 2844251538Srpaulo urtwn_write_4(sc, R92C_RARFRC + 0, 0x04030201); 2845251538Srpaulo urtwn_write_4(sc, R92C_RARFRC + 4, 0x08070605); 2846251538Srpaulo 2847251538Srpaulo urtwn_write_1(sc, R92C_FWHW_TXQ_CTRL, 2848251538Srpaulo urtwn_read_1(sc, R92C_FWHW_TXQ_CTRL) | 2849251538Srpaulo R92C_FWHW_TXQ_CTRL_AMPDU_RTY_NEW); 2850251538Srpaulo /* Set ACK timeout. */ 2851251538Srpaulo urtwn_write_1(sc, R92C_ACKTO, 0x40); 2852251538Srpaulo 2853251538Srpaulo /* Setup USB aggregation. */ 2854251538Srpaulo reg = urtwn_read_4(sc, R92C_TDECTRL); 2855251538Srpaulo reg = RW(reg, R92C_TDECTRL_BLK_DESC_NUM, 6); 2856251538Srpaulo urtwn_write_4(sc, R92C_TDECTRL, reg); 2857251538Srpaulo urtwn_write_1(sc, R92C_TRXDMA_CTRL, 2858251538Srpaulo urtwn_read_1(sc, R92C_TRXDMA_CTRL) | 2859251538Srpaulo R92C_TRXDMA_CTRL_RXDMA_AGG_EN); 2860251538Srpaulo urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION, 2861251538Srpaulo urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) | 2862251538Srpaulo R92C_USB_SPECIAL_OPTION_AGG_EN); 2863251538Srpaulo urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH, 48); 2864251538Srpaulo urtwn_write_1(sc, R92C_USB_DMA_AGG_TO, 4); 2865251538Srpaulo urtwn_write_1(sc, R92C_USB_AGG_TH, 8); 2866251538Srpaulo urtwn_write_1(sc, R92C_USB_AGG_TO, 6); 2867251538Srpaulo 2868251538Srpaulo /* Initialize beacon parameters. */ 2869251538Srpaulo urtwn_write_2(sc, R92C_TBTT_PROHIBIT, 0x6404); 2870251538Srpaulo urtwn_write_1(sc, R92C_DRVERLYINT, 0x05); 2871251538Srpaulo urtwn_write_1(sc, R92C_BCNDMATIM, 0x02); 2872251538Srpaulo urtwn_write_2(sc, R92C_BCNTCFG, 0x660f); 2873251538Srpaulo 2874251538Srpaulo /* Setup AMPDU aggregation. */ 2875251538Srpaulo urtwn_write_4(sc, R92C_AGGLEN_LMT, 0x99997631); /* MCS7~0 */ 2876251538Srpaulo urtwn_write_1(sc, R92C_AGGR_BREAK_TIME, 0x16); 2877251538Srpaulo urtwn_write_2(sc, 0x4ca, 0x0708); 2878251538Srpaulo 2879251538Srpaulo urtwn_write_1(sc, R92C_BCN_MAX_ERR, 0xff); 2880251538Srpaulo urtwn_write_1(sc, R92C_BCN_CTRL, R92C_BCN_CTRL_DIS_TSF_UDT0); 2881251538Srpaulo 2882251538Srpaulo /* Load 8051 microcode. */ 2883251538Srpaulo error = urtwn_load_firmware(sc); 2884251538Srpaulo if (error != 0) 2885251538Srpaulo goto fail; 2886251538Srpaulo 2887251538Srpaulo /* Initialize MAC/BB/RF blocks. */ 2888251538Srpaulo urtwn_mac_init(sc); 2889251538Srpaulo urtwn_bb_init(sc); 2890251538Srpaulo urtwn_rf_init(sc); 2891251538Srpaulo 2892251538Srpaulo /* Turn CCK and OFDM blocks on. */ 2893251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD); 2894251538Srpaulo reg |= R92C_RFMOD_CCK_EN; 2895251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg); 2896251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD); 2897251538Srpaulo reg |= R92C_RFMOD_OFDM_EN; 2898251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg); 2899251538Srpaulo 2900251538Srpaulo /* Clear per-station keys table. */ 2901251538Srpaulo urtwn_cam_init(sc); 2902251538Srpaulo 2903251538Srpaulo /* Enable hardware sequence numbering. */ 2904251538Srpaulo urtwn_write_1(sc, R92C_HWSEQ_CTRL, 0xff); 2905251538Srpaulo 2906251538Srpaulo /* Perform LO and IQ calibrations. */ 2907251538Srpaulo urtwn_iq_calib(sc); 2908251538Srpaulo /* Perform LC calibration. */ 2909251538Srpaulo urtwn_lc_calib(sc); 2910251538Srpaulo 2911251538Srpaulo /* Fix USB interference issue. */ 2912251538Srpaulo urtwn_write_1(sc, 0xfe40, 0xe0); 2913251538Srpaulo urtwn_write_1(sc, 0xfe41, 0x8d); 2914251538Srpaulo urtwn_write_1(sc, 0xfe42, 0x80); 2915251538Srpaulo 2916251538Srpaulo urtwn_pa_bias_init(sc); 2917251538Srpaulo 2918251538Srpaulo /* Initialize GPIO setting. */ 2919251538Srpaulo urtwn_write_1(sc, R92C_GPIO_MUXCFG, 2920251538Srpaulo urtwn_read_1(sc, R92C_GPIO_MUXCFG) & ~R92C_GPIO_MUXCFG_ENBT); 2921251538Srpaulo 2922251538Srpaulo /* Fix for lower temperature. */ 2923251538Srpaulo urtwn_write_1(sc, 0x15, 0xe9); 2924251538Srpaulo 2925251538Srpaulo usbd_transfer_start(sc->sc_xfer[URTWN_BULK_RX]); 2926251538Srpaulo 2927251538Srpaulo ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 2928251538Srpaulo ifp->if_drv_flags |= IFF_DRV_RUNNING; 2929251538Srpaulo 2930251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 2931251538Srpaulofail: 2932251538Srpaulo return; 2933251538Srpaulo} 2934251538Srpaulo 2935251538Srpaulostatic void 2936251538Srpaulourtwn_init(void *arg) 2937251538Srpaulo{ 2938251538Srpaulo struct urtwn_softc *sc = arg; 2939251538Srpaulo 2940251538Srpaulo URTWN_LOCK(sc); 2941251538Srpaulo urtwn_init_locked(arg); 2942251538Srpaulo URTWN_UNLOCK(sc); 2943251538Srpaulo} 2944251538Srpaulo 2945251538Srpaulostatic void 2946251538Srpaulourtwn_stop_locked(struct ifnet *ifp, int disable) 2947251538Srpaulo{ 2948251538Srpaulo struct urtwn_softc *sc = ifp->if_softc; 2949251538Srpaulo 2950251538Srpaulo (void)disable; 2951251538Srpaulo ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 2952251538Srpaulo 2953251538Srpaulo callout_stop(&sc->sc_watchdog_ch); 2954251538Srpaulo urtwn_abort_xfers(sc); 2955251538Srpaulo} 2956251538Srpaulo 2957251538Srpaulostatic void 2958251538Srpaulourtwn_stop(struct ifnet *ifp, int disable) 2959251538Srpaulo{ 2960251538Srpaulo struct urtwn_softc *sc = ifp->if_softc; 2961251538Srpaulo 2962251538Srpaulo URTWN_LOCK(sc); 2963251538Srpaulo urtwn_stop_locked(ifp, disable); 2964251538Srpaulo URTWN_UNLOCK(sc); 2965251538Srpaulo} 2966251538Srpaulo 2967251538Srpaulostatic void 2968251538Srpaulourtwn_abort_xfers(struct urtwn_softc *sc) 2969251538Srpaulo{ 2970251538Srpaulo int i; 2971251538Srpaulo 2972251538Srpaulo URTWN_ASSERT_LOCKED(sc); 2973251538Srpaulo 2974251538Srpaulo /* abort any pending transfers */ 2975251538Srpaulo for (i = 0; i < URTWN_N_TRANSFER; i++) 2976251538Srpaulo usbd_transfer_stop(sc->sc_xfer[i]); 2977251538Srpaulo} 2978251538Srpaulo 2979251538Srpaulostatic int 2980251538Srpaulourtwn_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 2981251538Srpaulo const struct ieee80211_bpf_params *params) 2982251538Srpaulo{ 2983251538Srpaulo struct ieee80211com *ic = ni->ni_ic; 2984251538Srpaulo struct ifnet *ifp = ic->ic_ifp; 2985251538Srpaulo struct urtwn_softc *sc = ifp->if_softc; 2986251538Srpaulo struct urtwn_data *bf; 2987251538Srpaulo 2988251538Srpaulo /* prevent management frames from being sent if we're not ready */ 2989251538Srpaulo if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) { 2990251538Srpaulo m_freem(m); 2991251538Srpaulo ieee80211_free_node(ni); 2992251538Srpaulo return (ENETDOWN); 2993251538Srpaulo } 2994251538Srpaulo URTWN_LOCK(sc); 2995251538Srpaulo bf = urtwn_getbuf(sc); 2996251538Srpaulo if (bf == NULL) { 2997251538Srpaulo ieee80211_free_node(ni); 2998251538Srpaulo m_freem(m); 2999251538Srpaulo URTWN_UNLOCK(sc); 3000251538Srpaulo return (ENOBUFS); 3001251538Srpaulo } 3002251538Srpaulo 3003251538Srpaulo ifp->if_opackets++; 3004251538Srpaulo if (urtwn_tx_start(sc, ni, m, bf) != 0) { 3005251538Srpaulo ieee80211_free_node(ni); 3006251538Srpaulo ifp->if_oerrors++; 3007251538Srpaulo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 3008251538Srpaulo URTWN_UNLOCK(sc); 3009251538Srpaulo return (EIO); 3010251538Srpaulo } 3011251538Srpaulo URTWN_UNLOCK(sc); 3012251538Srpaulo 3013251538Srpaulo sc->sc_txtimer = 5; 3014251538Srpaulo return (0); 3015251538Srpaulo} 3016251538Srpaulo 3017251538Srpaulostatic device_method_t urtwn_methods[] = { 3018251538Srpaulo /* Device interface */ 3019251538Srpaulo DEVMETHOD(device_probe, urtwn_match), 3020251538Srpaulo DEVMETHOD(device_attach, urtwn_attach), 3021251538Srpaulo DEVMETHOD(device_detach, urtwn_detach), 3022251538Srpaulo 3023251538Srpaulo { 0, 0 } 3024251538Srpaulo}; 3025251538Srpaulo 3026251538Srpaulostatic driver_t urtwn_driver = { 3027251538Srpaulo "urtwn", 3028251538Srpaulo urtwn_methods, 3029251538Srpaulo sizeof(struct urtwn_softc) 3030251538Srpaulo}; 3031251538Srpaulo 3032251538Srpaulostatic devclass_t urtwn_devclass; 3033251538Srpaulo 3034251538SrpauloDRIVER_MODULE(urtwn, uhub, urtwn_driver, urtwn_devclass, NULL, NULL); 3035251538SrpauloMODULE_DEPEND(urtwn, usb, 1, 1, 1); 3036251538SrpauloMODULE_DEPEND(urtwn, wlan, 1, 1, 1); 3037251538SrpauloMODULE_DEPEND(urtwn, firmware, 1, 1, 1); 3038251538SrpauloMODULE_VERSION(urtwn, 1); 3039