if_urtwn.c revision 263153
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 263153 2014-03-14 06:37:08Z 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 *); 250263153Skevlostatic void urtwn_stop(struct ifnet *); 251263153Skevlostatic void urtwn_stop_locked(struct ifnet *); 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; 462263153Skevlo unsigned int x; 463251538Srpaulo 464263153Skevlo /* Prevent further ioctls. */ 465263153Skevlo URTWN_LOCK(sc); 466263153Skevlo sc->sc_flags |= URTWN_DETACHED; 467263153Skevlo URTWN_UNLOCK(sc); 468251538Srpaulo 469263153Skevlo urtwn_stop(ifp); 470251538Srpaulo 471251538Srpaulo callout_drain(&sc->sc_watchdog_ch); 472251538Srpaulo 473263153Skevlo /* Prevent further allocations from RX/TX data lists. */ 474263153Skevlo URTWN_LOCK(sc); 475263153Skevlo STAILQ_INIT(&sc->sc_tx_active); 476263153Skevlo STAILQ_INIT(&sc->sc_tx_inactive); 477263153Skevlo STAILQ_INIT(&sc->sc_tx_pending); 478263153Skevlo 479263153Skevlo STAILQ_INIT(&sc->sc_rx_active); 480263153Skevlo STAILQ_INIT(&sc->sc_rx_inactive); 481263153Skevlo URTWN_UNLOCK(sc); 482263153Skevlo 483263153Skevlo /* drain USB transfers */ 484263153Skevlo for (x = 0; x != URTWN_N_TRANSFER; x++) 485263153Skevlo usbd_transfer_drain(sc->sc_xfer[x]); 486263153Skevlo 487263153Skevlo /* Free data buffers. */ 488263153Skevlo URTWN_LOCK(sc); 489263153Skevlo urtwn_free_tx_list(sc); 490263153Skevlo urtwn_free_rx_list(sc); 491263153Skevlo URTWN_UNLOCK(sc); 492263153Skevlo 493251538Srpaulo /* stop all USB transfers */ 494251538Srpaulo usbd_transfer_unsetup(sc->sc_xfer, URTWN_N_TRANSFER); 495251538Srpaulo ieee80211_ifdetach(ic); 496251538Srpaulo 497251538Srpaulo if_free(ifp); 498251538Srpaulo mtx_destroy(&sc->sc_mtx); 499251538Srpaulo 500251538Srpaulo return (0); 501251538Srpaulo} 502251538Srpaulo 503251538Srpaulostatic void 504251538Srpaulourtwn_free_tx_list(struct urtwn_softc *sc) 505251538Srpaulo{ 506251538Srpaulo urtwn_free_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT); 507251538Srpaulo} 508251538Srpaulo 509251538Srpaulostatic void 510251538Srpaulourtwn_free_rx_list(struct urtwn_softc *sc) 511251538Srpaulo{ 512251538Srpaulo urtwn_free_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT); 513251538Srpaulo} 514251538Srpaulo 515251538Srpaulostatic void 516251538Srpaulourtwn_free_list(struct urtwn_softc *sc, struct urtwn_data data[], int ndata) 517251538Srpaulo{ 518251538Srpaulo int i; 519251538Srpaulo 520251538Srpaulo for (i = 0; i < ndata; i++) { 521251538Srpaulo struct urtwn_data *dp = &data[i]; 522251538Srpaulo 523251538Srpaulo if (dp->buf != NULL) { 524251538Srpaulo free(dp->buf, M_USBDEV); 525251538Srpaulo dp->buf = NULL; 526251538Srpaulo } 527251538Srpaulo if (dp->ni != NULL) { 528251538Srpaulo ieee80211_free_node(dp->ni); 529251538Srpaulo dp->ni = NULL; 530251538Srpaulo } 531251538Srpaulo } 532251538Srpaulo} 533251538Srpaulo 534251538Srpaulostatic usb_error_t 535251538Srpaulourtwn_do_request(struct urtwn_softc *sc, struct usb_device_request *req, 536251538Srpaulo void *data) 537251538Srpaulo{ 538251538Srpaulo usb_error_t err; 539251538Srpaulo int ntries = 10; 540251538Srpaulo 541251538Srpaulo URTWN_ASSERT_LOCKED(sc); 542251538Srpaulo 543251538Srpaulo while (ntries--) { 544251538Srpaulo err = usbd_do_request_flags(sc->sc_udev, &sc->sc_mtx, 545251538Srpaulo req, data, 0, NULL, 250 /* ms */); 546251538Srpaulo if (err == 0) 547251538Srpaulo break; 548251538Srpaulo 549251538Srpaulo DPRINTFN(1, "Control request failed, %s (retrying)\n", 550251538Srpaulo usbd_errstr(err)); 551251538Srpaulo usb_pause_mtx(&sc->sc_mtx, hz / 100); 552251538Srpaulo } 553251538Srpaulo return (err); 554251538Srpaulo} 555251538Srpaulo 556251538Srpaulostatic struct ieee80211vap * 557251538Srpaulourtwn_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit, 558251538Srpaulo enum ieee80211_opmode opmode, int flags, 559251538Srpaulo const uint8_t bssid[IEEE80211_ADDR_LEN], 560251538Srpaulo const uint8_t mac[IEEE80211_ADDR_LEN]) 561251538Srpaulo{ 562251538Srpaulo struct urtwn_vap *uvp; 563251538Srpaulo struct ieee80211vap *vap; 564251538Srpaulo 565251538Srpaulo if (!TAILQ_EMPTY(&ic->ic_vaps)) /* only one at a time */ 566251538Srpaulo return (NULL); 567251538Srpaulo 568251538Srpaulo uvp = (struct urtwn_vap *) malloc(sizeof(struct urtwn_vap), 569251538Srpaulo M_80211_VAP, M_NOWAIT | M_ZERO); 570251538Srpaulo if (uvp == NULL) 571251538Srpaulo return (NULL); 572251538Srpaulo vap = &uvp->vap; 573251538Srpaulo /* enable s/w bmiss handling for sta mode */ 574251538Srpaulo 575257743Shselasky if (ieee80211_vap_setup(ic, vap, name, unit, opmode, 576257743Shselasky flags | IEEE80211_CLONE_NOBEACONS, bssid, mac) != 0) { 577257743Shselasky /* out of memory */ 578257743Shselasky free(uvp, M_80211_VAP); 579257743Shselasky return (NULL); 580257743Shselasky } 581257743Shselasky 582251538Srpaulo /* override state transition machine */ 583251538Srpaulo uvp->newstate = vap->iv_newstate; 584251538Srpaulo vap->iv_newstate = urtwn_newstate; 585251538Srpaulo 586251538Srpaulo /* complete setup */ 587251538Srpaulo ieee80211_vap_attach(vap, ieee80211_media_change, 588251538Srpaulo ieee80211_media_status); 589251538Srpaulo ic->ic_opmode = opmode; 590251538Srpaulo return (vap); 591251538Srpaulo} 592251538Srpaulo 593251538Srpaulostatic void 594251538Srpaulourtwn_vap_delete(struct ieee80211vap *vap) 595251538Srpaulo{ 596251538Srpaulo struct urtwn_vap *uvp = URTWN_VAP(vap); 597251538Srpaulo 598251538Srpaulo ieee80211_vap_detach(vap); 599251538Srpaulo free(uvp, M_80211_VAP); 600251538Srpaulo} 601251538Srpaulo 602251538Srpaulostatic struct mbuf * 603251538Srpaulourtwn_rx_frame(struct urtwn_softc *sc, uint8_t *buf, int pktlen, int *rssi_p) 604251538Srpaulo{ 605251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 606251538Srpaulo struct ieee80211com *ic = ifp->if_l2com; 607251538Srpaulo struct ieee80211_frame *wh; 608251538Srpaulo struct mbuf *m; 609251538Srpaulo struct r92c_rx_stat *stat; 610251538Srpaulo uint32_t rxdw0, rxdw3; 611251538Srpaulo uint8_t rate; 612251538Srpaulo int8_t rssi = 0; 613251538Srpaulo int infosz; 614251538Srpaulo 615251538Srpaulo /* 616251538Srpaulo * don't pass packets to the ieee80211 framework if the driver isn't 617251538Srpaulo * RUNNING. 618251538Srpaulo */ 619251538Srpaulo if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) 620251538Srpaulo return (NULL); 621251538Srpaulo 622251538Srpaulo stat = (struct r92c_rx_stat *)buf; 623251538Srpaulo rxdw0 = le32toh(stat->rxdw0); 624251538Srpaulo rxdw3 = le32toh(stat->rxdw3); 625251538Srpaulo 626251538Srpaulo if (rxdw0 & (R92C_RXDW0_CRCERR | R92C_RXDW0_ICVERR)) { 627251538Srpaulo /* 628251538Srpaulo * This should not happen since we setup our Rx filter 629251538Srpaulo * to not receive these frames. 630251538Srpaulo */ 631251538Srpaulo ifp->if_ierrors++; 632251538Srpaulo return (NULL); 633251538Srpaulo } 634251538Srpaulo 635251538Srpaulo rate = MS(rxdw3, R92C_RXDW3_RATE); 636251538Srpaulo infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8; 637251538Srpaulo 638251538Srpaulo /* Get RSSI from PHY status descriptor if present. */ 639251538Srpaulo if (infosz != 0 && (rxdw0 & R92C_RXDW0_PHYST)) { 640251538Srpaulo rssi = urtwn_get_rssi(sc, rate, &stat[1]); 641251538Srpaulo /* Update our average RSSI. */ 642251538Srpaulo urtwn_update_avgrssi(sc, rate, rssi); 643252405Srpaulo /* 644252405Srpaulo * Convert the RSSI to a range that will be accepted 645252405Srpaulo * by net80211. 646252405Srpaulo */ 647252405Srpaulo rssi = URTWN_RSSI(rssi); 648251538Srpaulo } 649251538Srpaulo 650260463Skevlo m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 651251538Srpaulo if (m == NULL) { 652251538Srpaulo device_printf(sc->sc_dev, "could not create RX mbuf\n"); 653251538Srpaulo return (NULL); 654251538Srpaulo } 655251538Srpaulo 656251538Srpaulo /* Finalize mbuf. */ 657251538Srpaulo m->m_pkthdr.rcvif = ifp; 658251538Srpaulo wh = (struct ieee80211_frame *)((uint8_t *)&stat[1] + infosz); 659251538Srpaulo memcpy(mtod(m, uint8_t *), wh, pktlen); 660251538Srpaulo m->m_pkthdr.len = m->m_len = pktlen; 661251538Srpaulo 662251538Srpaulo if (ieee80211_radiotap_active(ic)) { 663251538Srpaulo struct urtwn_rx_radiotap_header *tap = &sc->sc_rxtap; 664251538Srpaulo 665251538Srpaulo tap->wr_flags = 0; 666251538Srpaulo /* Map HW rate index to 802.11 rate. */ 667251538Srpaulo if (!(rxdw3 & R92C_RXDW3_HT)) { 668251538Srpaulo switch (rate) { 669251538Srpaulo /* CCK. */ 670251538Srpaulo case 0: tap->wr_rate = 2; break; 671251538Srpaulo case 1: tap->wr_rate = 4; break; 672251538Srpaulo case 2: tap->wr_rate = 11; break; 673251538Srpaulo case 3: tap->wr_rate = 22; break; 674251538Srpaulo /* OFDM. */ 675251538Srpaulo case 4: tap->wr_rate = 12; break; 676251538Srpaulo case 5: tap->wr_rate = 18; break; 677251538Srpaulo case 6: tap->wr_rate = 24; break; 678251538Srpaulo case 7: tap->wr_rate = 36; break; 679251538Srpaulo case 8: tap->wr_rate = 48; break; 680251538Srpaulo case 9: tap->wr_rate = 72; break; 681251538Srpaulo case 10: tap->wr_rate = 96; break; 682251538Srpaulo case 11: tap->wr_rate = 108; break; 683251538Srpaulo } 684251538Srpaulo } else if (rate >= 12) { /* MCS0~15. */ 685251538Srpaulo /* Bit 7 set means HT MCS instead of rate. */ 686251538Srpaulo tap->wr_rate = 0x80 | (rate - 12); 687251538Srpaulo } 688251538Srpaulo tap->wr_dbm_antsignal = rssi; 689251538Srpaulo tap->wr_chan_freq = htole16(ic->ic_curchan->ic_freq); 690251538Srpaulo tap->wr_chan_flags = htole16(ic->ic_curchan->ic_flags); 691251538Srpaulo } 692251538Srpaulo 693251538Srpaulo *rssi_p = rssi; 694251538Srpaulo 695251538Srpaulo return (m); 696251538Srpaulo} 697251538Srpaulo 698251538Srpaulostatic struct mbuf * 699251538Srpaulourtwn_rxeof(struct usb_xfer *xfer, struct urtwn_data *data, int *rssi, 700251538Srpaulo int8_t *nf) 701251538Srpaulo{ 702251538Srpaulo struct urtwn_softc *sc = data->sc; 703251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 704251538Srpaulo struct r92c_rx_stat *stat; 705251538Srpaulo struct mbuf *m, *m0 = NULL, *prevm = NULL; 706251538Srpaulo uint32_t rxdw0; 707251538Srpaulo uint8_t *buf; 708251538Srpaulo int len, totlen, pktlen, infosz, npkts; 709251538Srpaulo 710251538Srpaulo usbd_xfer_status(xfer, &len, NULL, NULL, NULL); 711251538Srpaulo 712251538Srpaulo if (len < sizeof(*stat)) { 713251538Srpaulo ifp->if_ierrors++; 714251538Srpaulo return (NULL); 715251538Srpaulo } 716251538Srpaulo 717251538Srpaulo buf = data->buf; 718251538Srpaulo /* Get the number of encapsulated frames. */ 719251538Srpaulo stat = (struct r92c_rx_stat *)buf; 720251538Srpaulo npkts = MS(le32toh(stat->rxdw2), R92C_RXDW2_PKTCNT); 721251538Srpaulo DPRINTFN(6, "Rx %d frames in one chunk\n", npkts); 722251538Srpaulo 723251538Srpaulo /* Process all of them. */ 724251538Srpaulo while (npkts-- > 0) { 725251538Srpaulo if (len < sizeof(*stat)) 726251538Srpaulo break; 727251538Srpaulo stat = (struct r92c_rx_stat *)buf; 728251538Srpaulo rxdw0 = le32toh(stat->rxdw0); 729251538Srpaulo 730251538Srpaulo pktlen = MS(rxdw0, R92C_RXDW0_PKTLEN); 731251538Srpaulo if (pktlen == 0) 732251538Srpaulo break; 733251538Srpaulo 734251538Srpaulo infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8; 735251538Srpaulo 736251538Srpaulo /* Make sure everything fits in xfer. */ 737251538Srpaulo totlen = sizeof(*stat) + infosz + pktlen; 738251538Srpaulo if (totlen > len) 739251538Srpaulo break; 740251538Srpaulo 741251538Srpaulo m = urtwn_rx_frame(sc, buf, pktlen, rssi); 742251538Srpaulo if (m0 == NULL) 743251538Srpaulo m0 = m; 744251538Srpaulo if (prevm == NULL) 745251538Srpaulo prevm = m; 746251538Srpaulo else { 747251538Srpaulo prevm->m_next = m; 748251538Srpaulo prevm = m; 749251538Srpaulo } 750251538Srpaulo 751251538Srpaulo /* Next chunk is 128-byte aligned. */ 752251538Srpaulo totlen = (totlen + 127) & ~127; 753251538Srpaulo buf += totlen; 754251538Srpaulo len -= totlen; 755251538Srpaulo } 756251538Srpaulo 757251538Srpaulo return (m0); 758251538Srpaulo} 759251538Srpaulo 760251538Srpaulostatic void 761251538Srpaulourtwn_bulk_rx_callback(struct usb_xfer *xfer, usb_error_t error) 762251538Srpaulo{ 763251538Srpaulo struct urtwn_softc *sc = usbd_xfer_softc(xfer); 764251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 765251538Srpaulo struct ieee80211com *ic = ifp->if_l2com; 766251538Srpaulo struct ieee80211_frame *wh; 767251538Srpaulo struct ieee80211_node *ni; 768251538Srpaulo struct mbuf *m = NULL, *next; 769251538Srpaulo struct urtwn_data *data; 770251538Srpaulo int8_t nf; 771251538Srpaulo int rssi = 1; 772251538Srpaulo 773251538Srpaulo URTWN_ASSERT_LOCKED(sc); 774251538Srpaulo 775251538Srpaulo switch (USB_GET_STATE(xfer)) { 776251538Srpaulo case USB_ST_TRANSFERRED: 777251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_active); 778251538Srpaulo if (data == NULL) 779251538Srpaulo goto tr_setup; 780251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 781251538Srpaulo m = urtwn_rxeof(xfer, data, &rssi, &nf); 782251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 783251538Srpaulo /* FALLTHROUGH */ 784251538Srpaulo case USB_ST_SETUP: 785251538Srpaulotr_setup: 786251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_inactive); 787251538Srpaulo if (data == NULL) { 788251538Srpaulo KASSERT(m == NULL, ("mbuf isn't NULL")); 789251538Srpaulo return; 790251538Srpaulo } 791251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_inactive, next); 792251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_active, data, next); 793251538Srpaulo usbd_xfer_set_frame_data(xfer, 0, data->buf, 794251538Srpaulo usbd_xfer_max_len(xfer)); 795251538Srpaulo usbd_transfer_submit(xfer); 796251538Srpaulo 797251538Srpaulo /* 798251538Srpaulo * To avoid LOR we should unlock our private mutex here to call 799251538Srpaulo * ieee80211_input() because here is at the end of a USB 800251538Srpaulo * callback and safe to unlock. 801251538Srpaulo */ 802251538Srpaulo URTWN_UNLOCK(sc); 803251538Srpaulo while (m != NULL) { 804251538Srpaulo next = m->m_next; 805251538Srpaulo m->m_next = NULL; 806251538Srpaulo wh = mtod(m, struct ieee80211_frame *); 807251538Srpaulo ni = ieee80211_find_rxnode(ic, 808251538Srpaulo (struct ieee80211_frame_min *)wh); 809251538Srpaulo nf = URTWN_NOISE_FLOOR; 810251538Srpaulo if (ni != NULL) { 811251538Srpaulo (void)ieee80211_input(ni, m, rssi, nf); 812251538Srpaulo ieee80211_free_node(ni); 813251538Srpaulo } else 814251538Srpaulo (void)ieee80211_input_all(ic, m, rssi, nf); 815251538Srpaulo m = next; 816251538Srpaulo } 817251538Srpaulo URTWN_LOCK(sc); 818251538Srpaulo break; 819251538Srpaulo default: 820251538Srpaulo /* needs it to the inactive queue due to a error. */ 821251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_active); 822251538Srpaulo if (data != NULL) { 823251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 824251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 825251538Srpaulo } 826251538Srpaulo if (error != USB_ERR_CANCELLED) { 827251538Srpaulo usbd_xfer_set_stall(xfer); 828251538Srpaulo ifp->if_ierrors++; 829251538Srpaulo goto tr_setup; 830251538Srpaulo } 831251538Srpaulo break; 832251538Srpaulo } 833251538Srpaulo} 834251538Srpaulo 835251538Srpaulostatic void 836251538Srpaulourtwn_txeof(struct usb_xfer *xfer, struct urtwn_data *data) 837251538Srpaulo{ 838251538Srpaulo struct urtwn_softc *sc = usbd_xfer_softc(xfer); 839251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 840251538Srpaulo struct mbuf *m; 841251538Srpaulo 842251538Srpaulo URTWN_ASSERT_LOCKED(sc); 843251538Srpaulo 844251538Srpaulo /* 845251538Srpaulo * Do any tx complete callback. Note this must be done before releasing 846251538Srpaulo * the node reference. 847251538Srpaulo */ 848251538Srpaulo if (data->m) { 849251538Srpaulo m = data->m; 850251538Srpaulo if (m->m_flags & M_TXCB) { 851251538Srpaulo /* XXX status? */ 852251538Srpaulo ieee80211_process_callback(data->ni, m, 0); 853251538Srpaulo } 854251538Srpaulo m_freem(m); 855251538Srpaulo data->m = NULL; 856251538Srpaulo } 857251538Srpaulo if (data->ni) { 858251538Srpaulo ieee80211_free_node(data->ni); 859251538Srpaulo data->ni = NULL; 860251538Srpaulo } 861251538Srpaulo sc->sc_txtimer = 0; 862251538Srpaulo ifp->if_opackets++; 863251538Srpaulo ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 864251538Srpaulo} 865251538Srpaulo 866251538Srpaulostatic void 867251538Srpaulourtwn_bulk_tx_callback(struct usb_xfer *xfer, usb_error_t error) 868251538Srpaulo{ 869251538Srpaulo struct urtwn_softc *sc = usbd_xfer_softc(xfer); 870251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 871251538Srpaulo struct urtwn_data *data; 872251538Srpaulo 873251538Srpaulo URTWN_ASSERT_LOCKED(sc); 874251538Srpaulo 875251538Srpaulo switch (USB_GET_STATE(xfer)){ 876251538Srpaulo case USB_ST_TRANSFERRED: 877251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_active); 878251538Srpaulo if (data == NULL) 879251538Srpaulo goto tr_setup; 880251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next); 881251538Srpaulo urtwn_txeof(xfer, data); 882251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data, next); 883251538Srpaulo /* FALLTHROUGH */ 884251538Srpaulo case USB_ST_SETUP: 885251538Srpaulotr_setup: 886251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_pending); 887251538Srpaulo if (data == NULL) { 888251538Srpaulo DPRINTF("%s: empty pending queue\n", __func__); 889251538Srpaulo return; 890251538Srpaulo } 891251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_pending, next); 892251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_tx_active, data, next); 893251538Srpaulo usbd_xfer_set_frame_data(xfer, 0, data->buf, data->buflen); 894251538Srpaulo usbd_transfer_submit(xfer); 895261863Srpaulo urtwn_start_locked(ifp, sc); 896251538Srpaulo break; 897251538Srpaulo default: 898251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_active); 899251538Srpaulo if (data == NULL) 900251538Srpaulo goto tr_setup; 901251538Srpaulo if (data->ni != NULL) { 902251538Srpaulo ieee80211_free_node(data->ni); 903251538Srpaulo data->ni = NULL; 904251538Srpaulo ifp->if_oerrors++; 905251538Srpaulo } 906251538Srpaulo if (error != USB_ERR_CANCELLED) { 907251538Srpaulo usbd_xfer_set_stall(xfer); 908251538Srpaulo goto tr_setup; 909251538Srpaulo } 910251538Srpaulo break; 911251538Srpaulo } 912251538Srpaulo} 913251538Srpaulo 914251538Srpaulostatic struct urtwn_data * 915251538Srpaulo_urtwn_getbuf(struct urtwn_softc *sc) 916251538Srpaulo{ 917251538Srpaulo struct urtwn_data *bf; 918251538Srpaulo 919251538Srpaulo bf = STAILQ_FIRST(&sc->sc_tx_inactive); 920251538Srpaulo if (bf != NULL) 921251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_inactive, next); 922251538Srpaulo else 923251538Srpaulo bf = NULL; 924251538Srpaulo if (bf == NULL) 925251538Srpaulo DPRINTF("%s: %s\n", __func__, "out of xmit buffers"); 926251538Srpaulo return (bf); 927251538Srpaulo} 928251538Srpaulo 929251538Srpaulostatic struct urtwn_data * 930251538Srpaulourtwn_getbuf(struct urtwn_softc *sc) 931251538Srpaulo{ 932251538Srpaulo struct urtwn_data *bf; 933251538Srpaulo 934251538Srpaulo URTWN_ASSERT_LOCKED(sc); 935251538Srpaulo 936251538Srpaulo bf = _urtwn_getbuf(sc); 937251538Srpaulo if (bf == NULL) { 938251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 939251538Srpaulo DPRINTF("%s: stop queue\n", __func__); 940251538Srpaulo ifp->if_drv_flags |= IFF_DRV_OACTIVE; 941251538Srpaulo } 942251538Srpaulo return (bf); 943251538Srpaulo} 944251538Srpaulo 945251538Srpaulostatic int 946251538Srpaulourtwn_write_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf, 947251538Srpaulo int len) 948251538Srpaulo{ 949251538Srpaulo usb_device_request_t req; 950251538Srpaulo 951251538Srpaulo req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 952251538Srpaulo req.bRequest = R92C_REQ_REGS; 953251538Srpaulo USETW(req.wValue, addr); 954251538Srpaulo USETW(req.wIndex, 0); 955251538Srpaulo USETW(req.wLength, len); 956251538Srpaulo return (urtwn_do_request(sc, &req, buf)); 957251538Srpaulo} 958251538Srpaulo 959251538Srpaulostatic void 960251538Srpaulourtwn_write_1(struct urtwn_softc *sc, uint16_t addr, uint8_t val) 961251538Srpaulo{ 962251538Srpaulo urtwn_write_region_1(sc, addr, &val, 1); 963251538Srpaulo} 964251538Srpaulo 965251538Srpaulo 966251538Srpaulostatic void 967251538Srpaulourtwn_write_2(struct urtwn_softc *sc, uint16_t addr, uint16_t val) 968251538Srpaulo{ 969251538Srpaulo val = htole16(val); 970251538Srpaulo urtwn_write_region_1(sc, addr, (uint8_t *)&val, 2); 971251538Srpaulo} 972251538Srpaulo 973251538Srpaulostatic void 974251538Srpaulourtwn_write_4(struct urtwn_softc *sc, uint16_t addr, uint32_t val) 975251538Srpaulo{ 976251538Srpaulo val = htole32(val); 977251538Srpaulo urtwn_write_region_1(sc, addr, (uint8_t *)&val, 4); 978251538Srpaulo} 979251538Srpaulo 980251538Srpaulostatic int 981251538Srpaulourtwn_read_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf, 982251538Srpaulo int len) 983251538Srpaulo{ 984251538Srpaulo usb_device_request_t req; 985251538Srpaulo 986251538Srpaulo req.bmRequestType = UT_READ_VENDOR_DEVICE; 987251538Srpaulo req.bRequest = R92C_REQ_REGS; 988251538Srpaulo USETW(req.wValue, addr); 989251538Srpaulo USETW(req.wIndex, 0); 990251538Srpaulo USETW(req.wLength, len); 991251538Srpaulo return (urtwn_do_request(sc, &req, buf)); 992251538Srpaulo} 993251538Srpaulo 994251538Srpaulostatic uint8_t 995251538Srpaulourtwn_read_1(struct urtwn_softc *sc, uint16_t addr) 996251538Srpaulo{ 997251538Srpaulo uint8_t val; 998251538Srpaulo 999251538Srpaulo if (urtwn_read_region_1(sc, addr, &val, 1) != 0) 1000251538Srpaulo return (0xff); 1001251538Srpaulo return (val); 1002251538Srpaulo} 1003251538Srpaulo 1004251538Srpaulostatic uint16_t 1005251538Srpaulourtwn_read_2(struct urtwn_softc *sc, uint16_t addr) 1006251538Srpaulo{ 1007251538Srpaulo uint16_t val; 1008251538Srpaulo 1009251538Srpaulo if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 2) != 0) 1010251538Srpaulo return (0xffff); 1011251538Srpaulo return (le16toh(val)); 1012251538Srpaulo} 1013251538Srpaulo 1014251538Srpaulostatic uint32_t 1015251538Srpaulourtwn_read_4(struct urtwn_softc *sc, uint16_t addr) 1016251538Srpaulo{ 1017251538Srpaulo uint32_t val; 1018251538Srpaulo 1019251538Srpaulo if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 4) != 0) 1020251538Srpaulo return (0xffffffff); 1021251538Srpaulo return (le32toh(val)); 1022251538Srpaulo} 1023251538Srpaulo 1024251538Srpaulostatic int 1025251538Srpaulourtwn_fw_cmd(struct urtwn_softc *sc, uint8_t id, const void *buf, int len) 1026251538Srpaulo{ 1027251538Srpaulo struct r92c_fw_cmd cmd; 1028251538Srpaulo int ntries; 1029251538Srpaulo 1030251538Srpaulo /* Wait for current FW box to be empty. */ 1031251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 1032251538Srpaulo if (!(urtwn_read_1(sc, R92C_HMETFR) & (1 << sc->fwcur))) 1033251538Srpaulo break; 1034251538Srpaulo DELAY(1); 1035251538Srpaulo } 1036251538Srpaulo if (ntries == 100) { 1037251538Srpaulo device_printf(sc->sc_dev, 1038251538Srpaulo "could not send firmware command\n"); 1039251538Srpaulo return (ETIMEDOUT); 1040251538Srpaulo } 1041251538Srpaulo memset(&cmd, 0, sizeof(cmd)); 1042251538Srpaulo cmd.id = id; 1043251538Srpaulo if (len > 3) 1044251538Srpaulo cmd.id |= R92C_CMD_FLAG_EXT; 1045251538Srpaulo KASSERT(len <= sizeof(cmd.msg), ("urtwn_fw_cmd\n")); 1046251538Srpaulo memcpy(cmd.msg, buf, len); 1047251538Srpaulo 1048251538Srpaulo /* Write the first word last since that will trigger the FW. */ 1049251538Srpaulo urtwn_write_region_1(sc, R92C_HMEBOX_EXT(sc->fwcur), 1050251538Srpaulo (uint8_t *)&cmd + 4, 2); 1051251538Srpaulo urtwn_write_region_1(sc, R92C_HMEBOX(sc->fwcur), 1052251538Srpaulo (uint8_t *)&cmd + 0, 4); 1053251538Srpaulo 1054251538Srpaulo sc->fwcur = (sc->fwcur + 1) % R92C_H2C_NBOX; 1055251538Srpaulo return (0); 1056251538Srpaulo} 1057251538Srpaulo 1058251538Srpaulostatic void 1059251538Srpaulourtwn_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, uint32_t val) 1060251538Srpaulo{ 1061251538Srpaulo urtwn_bb_write(sc, R92C_LSSI_PARAM(chain), 1062251538Srpaulo SM(R92C_LSSI_PARAM_ADDR, addr) | 1063251538Srpaulo SM(R92C_LSSI_PARAM_DATA, val)); 1064251538Srpaulo} 1065251538Srpaulo 1066251538Srpaulostatic uint32_t 1067251538Srpaulourtwn_rf_read(struct urtwn_softc *sc, int chain, uint8_t addr) 1068251538Srpaulo{ 1069251538Srpaulo uint32_t reg[R92C_MAX_CHAINS], val; 1070251538Srpaulo 1071251538Srpaulo reg[0] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)); 1072251538Srpaulo if (chain != 0) 1073251538Srpaulo reg[chain] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(chain)); 1074251538Srpaulo 1075251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(0), 1076251538Srpaulo reg[0] & ~R92C_HSSI_PARAM2_READ_EDGE); 1077251538Srpaulo DELAY(1000); 1078251538Srpaulo 1079251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(chain), 1080251538Srpaulo RW(reg[chain], R92C_HSSI_PARAM2_READ_ADDR, addr) | 1081251538Srpaulo R92C_HSSI_PARAM2_READ_EDGE); 1082251538Srpaulo DELAY(1000); 1083251538Srpaulo 1084251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(0), 1085251538Srpaulo reg[0] | R92C_HSSI_PARAM2_READ_EDGE); 1086251538Srpaulo DELAY(1000); 1087251538Srpaulo 1088251538Srpaulo if (urtwn_bb_read(sc, R92C_HSSI_PARAM1(chain)) & R92C_HSSI_PARAM1_PI) 1089251538Srpaulo val = urtwn_bb_read(sc, R92C_HSPI_READBACK(chain)); 1090251538Srpaulo else 1091251538Srpaulo val = urtwn_bb_read(sc, R92C_LSSI_READBACK(chain)); 1092251538Srpaulo return (MS(val, R92C_LSSI_READBACK_DATA)); 1093251538Srpaulo} 1094251538Srpaulo 1095251538Srpaulostatic int 1096251538Srpaulourtwn_llt_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data) 1097251538Srpaulo{ 1098251538Srpaulo int ntries; 1099251538Srpaulo 1100251538Srpaulo urtwn_write_4(sc, R92C_LLT_INIT, 1101251538Srpaulo SM(R92C_LLT_INIT_OP, R92C_LLT_INIT_OP_WRITE) | 1102251538Srpaulo SM(R92C_LLT_INIT_ADDR, addr) | 1103251538Srpaulo SM(R92C_LLT_INIT_DATA, data)); 1104251538Srpaulo /* Wait for write operation to complete. */ 1105251538Srpaulo for (ntries = 0; ntries < 20; ntries++) { 1106251538Srpaulo if (MS(urtwn_read_4(sc, R92C_LLT_INIT), R92C_LLT_INIT_OP) == 1107251538Srpaulo R92C_LLT_INIT_OP_NO_ACTIVE) 1108251538Srpaulo return (0); 1109251538Srpaulo DELAY(5); 1110251538Srpaulo } 1111251538Srpaulo return (ETIMEDOUT); 1112251538Srpaulo} 1113251538Srpaulo 1114251538Srpaulostatic uint8_t 1115251538Srpaulourtwn_efuse_read_1(struct urtwn_softc *sc, uint16_t addr) 1116251538Srpaulo{ 1117251538Srpaulo uint32_t reg; 1118251538Srpaulo int ntries; 1119251538Srpaulo 1120251538Srpaulo reg = urtwn_read_4(sc, R92C_EFUSE_CTRL); 1121251538Srpaulo reg = RW(reg, R92C_EFUSE_CTRL_ADDR, addr); 1122251538Srpaulo reg &= ~R92C_EFUSE_CTRL_VALID; 1123251538Srpaulo urtwn_write_4(sc, R92C_EFUSE_CTRL, reg); 1124251538Srpaulo /* Wait for read operation to complete. */ 1125251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 1126251538Srpaulo reg = urtwn_read_4(sc, R92C_EFUSE_CTRL); 1127251538Srpaulo if (reg & R92C_EFUSE_CTRL_VALID) 1128251538Srpaulo return (MS(reg, R92C_EFUSE_CTRL_DATA)); 1129251538Srpaulo DELAY(5); 1130251538Srpaulo } 1131251538Srpaulo device_printf(sc->sc_dev, 1132251538Srpaulo "could not read efuse byte at address 0x%x\n", addr); 1133251538Srpaulo return (0xff); 1134251538Srpaulo} 1135251538Srpaulo 1136251538Srpaulostatic void 1137251538Srpaulourtwn_efuse_read(struct urtwn_softc *sc) 1138251538Srpaulo{ 1139251538Srpaulo uint8_t *rom = (uint8_t *)&sc->rom; 1140251538Srpaulo uint16_t addr = 0; 1141251538Srpaulo uint32_t reg; 1142251538Srpaulo uint8_t off, msk; 1143251538Srpaulo int i; 1144251538Srpaulo 1145251538Srpaulo reg = urtwn_read_2(sc, R92C_SYS_ISO_CTRL); 1146251538Srpaulo if (!(reg & R92C_SYS_ISO_CTRL_PWC_EV12V)) { 1147251538Srpaulo urtwn_write_2(sc, R92C_SYS_ISO_CTRL, 1148251538Srpaulo reg | R92C_SYS_ISO_CTRL_PWC_EV12V); 1149251538Srpaulo } 1150251538Srpaulo reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN); 1151251538Srpaulo if (!(reg & R92C_SYS_FUNC_EN_ELDR)) { 1152251538Srpaulo urtwn_write_2(sc, R92C_SYS_FUNC_EN, 1153251538Srpaulo reg | R92C_SYS_FUNC_EN_ELDR); 1154251538Srpaulo } 1155251538Srpaulo reg = urtwn_read_2(sc, R92C_SYS_CLKR); 1156251538Srpaulo if ((reg & (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) != 1157251538Srpaulo (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) { 1158251538Srpaulo urtwn_write_2(sc, R92C_SYS_CLKR, 1159251538Srpaulo reg | R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M); 1160251538Srpaulo } 1161251538Srpaulo memset(&sc->rom, 0xff, sizeof(sc->rom)); 1162251538Srpaulo while (addr < 512) { 1163251538Srpaulo reg = urtwn_efuse_read_1(sc, addr); 1164251538Srpaulo if (reg == 0xff) 1165251538Srpaulo break; 1166251538Srpaulo addr++; 1167251538Srpaulo off = reg >> 4; 1168251538Srpaulo msk = reg & 0xf; 1169251538Srpaulo for (i = 0; i < 4; i++) { 1170251538Srpaulo if (msk & (1 << i)) 1171251538Srpaulo continue; 1172251538Srpaulo rom[off * 8 + i * 2 + 0] = 1173251538Srpaulo urtwn_efuse_read_1(sc, addr); 1174251538Srpaulo addr++; 1175251538Srpaulo rom[off * 8 + i * 2 + 1] = 1176251538Srpaulo urtwn_efuse_read_1(sc, addr); 1177251538Srpaulo addr++; 1178251538Srpaulo } 1179251538Srpaulo } 1180251538Srpaulo#ifdef URTWN_DEBUG 1181251538Srpaulo if (urtwn_debug >= 2) { 1182251538Srpaulo /* Dump ROM content. */ 1183251538Srpaulo printf("\n"); 1184251538Srpaulo for (i = 0; i < sizeof(sc->rom); i++) 1185251538Srpaulo printf("%02x:", rom[i]); 1186251538Srpaulo printf("\n"); 1187251538Srpaulo } 1188251538Srpaulo#endif 1189251538Srpaulo} 1190251538Srpaulo 1191251538Srpaulostatic int 1192251538Srpaulourtwn_read_chipid(struct urtwn_softc *sc) 1193251538Srpaulo{ 1194251538Srpaulo uint32_t reg; 1195251538Srpaulo 1196251538Srpaulo reg = urtwn_read_4(sc, R92C_SYS_CFG); 1197251538Srpaulo if (reg & R92C_SYS_CFG_TRP_VAUX_EN) 1198251538Srpaulo return (EIO); 1199251538Srpaulo 1200251538Srpaulo if (reg & R92C_SYS_CFG_TYPE_92C) { 1201251538Srpaulo sc->chip |= URTWN_CHIP_92C; 1202251538Srpaulo /* Check if it is a castrated 8192C. */ 1203251538Srpaulo if (MS(urtwn_read_4(sc, R92C_HPON_FSM), 1204251538Srpaulo R92C_HPON_FSM_CHIP_BONDING_ID) == 1205251538Srpaulo R92C_HPON_FSM_CHIP_BONDING_ID_92C_1T2R) 1206251538Srpaulo sc->chip |= URTWN_CHIP_92C_1T2R; 1207251538Srpaulo } 1208251538Srpaulo if (reg & R92C_SYS_CFG_VENDOR_UMC) { 1209251538Srpaulo sc->chip |= URTWN_CHIP_UMC; 1210251538Srpaulo if (MS(reg, R92C_SYS_CFG_CHIP_VER_RTL) == 0) 1211251538Srpaulo sc->chip |= URTWN_CHIP_UMC_A_CUT; 1212251538Srpaulo } 1213251538Srpaulo return (0); 1214251538Srpaulo} 1215251538Srpaulo 1216251538Srpaulostatic void 1217251538Srpaulourtwn_read_rom(struct urtwn_softc *sc) 1218251538Srpaulo{ 1219251538Srpaulo struct r92c_rom *rom = &sc->rom; 1220251538Srpaulo 1221251538Srpaulo /* Read full ROM image. */ 1222251538Srpaulo urtwn_efuse_read(sc); 1223251538Srpaulo 1224251538Srpaulo /* XXX Weird but this is what the vendor driver does. */ 1225251538Srpaulo sc->pa_setting = urtwn_efuse_read_1(sc, 0x1fa); 1226251538Srpaulo DPRINTF("PA setting=0x%x\n", sc->pa_setting); 1227251538Srpaulo 1228251538Srpaulo sc->board_type = MS(rom->rf_opt1, R92C_ROM_RF1_BOARD_TYPE); 1229251538Srpaulo 1230251538Srpaulo sc->regulatory = MS(rom->rf_opt1, R92C_ROM_RF1_REGULATORY); 1231251538Srpaulo DPRINTF("regulatory type=%d\n", sc->regulatory); 1232251538Srpaulo 1233251538Srpaulo IEEE80211_ADDR_COPY(sc->sc_bssid, rom->macaddr); 1234251538Srpaulo} 1235251538Srpaulo 1236251538Srpaulo/* 1237251538Srpaulo * Initialize rate adaptation in firmware. 1238251538Srpaulo */ 1239251538Srpaulostatic int 1240251538Srpaulourtwn_ra_init(struct urtwn_softc *sc) 1241251538Srpaulo{ 1242251538Srpaulo static const uint8_t map[] = 1243251538Srpaulo { 2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108 }; 1244251538Srpaulo struct ieee80211com *ic = sc->sc_ifp->if_l2com; 1245251538Srpaulo struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 1246251538Srpaulo struct ieee80211_node *ni; 1247251538Srpaulo struct ieee80211_rateset *rs; 1248251538Srpaulo struct r92c_fw_cmd_macid_cfg cmd; 1249251538Srpaulo uint32_t rates, basicrates; 1250251538Srpaulo uint8_t mode; 1251251538Srpaulo int maxrate, maxbasicrate, error, i, j; 1252251538Srpaulo 1253251538Srpaulo ni = ieee80211_ref_node(vap->iv_bss); 1254251538Srpaulo rs = &ni->ni_rates; 1255251538Srpaulo 1256251538Srpaulo /* Get normal and basic rates mask. */ 1257251538Srpaulo rates = basicrates = 0; 1258251538Srpaulo maxrate = maxbasicrate = 0; 1259251538Srpaulo for (i = 0; i < rs->rs_nrates; i++) { 1260251538Srpaulo /* Convert 802.11 rate to HW rate index. */ 1261251538Srpaulo for (j = 0; j < nitems(map); j++) 1262251538Srpaulo if ((rs->rs_rates[i] & IEEE80211_RATE_VAL) == map[j]) 1263251538Srpaulo break; 1264251538Srpaulo if (j == nitems(map)) /* Unknown rate, skip. */ 1265251538Srpaulo continue; 1266251538Srpaulo rates |= 1 << j; 1267251538Srpaulo if (j > maxrate) 1268251538Srpaulo maxrate = j; 1269251538Srpaulo if (rs->rs_rates[i] & IEEE80211_RATE_BASIC) { 1270251538Srpaulo basicrates |= 1 << j; 1271251538Srpaulo if (j > maxbasicrate) 1272251538Srpaulo maxbasicrate = j; 1273251538Srpaulo } 1274251538Srpaulo } 1275251538Srpaulo if (ic->ic_curmode == IEEE80211_MODE_11B) 1276251538Srpaulo mode = R92C_RAID_11B; 1277251538Srpaulo else 1278251538Srpaulo mode = R92C_RAID_11BG; 1279251538Srpaulo DPRINTF("mode=0x%x rates=0x%08x, basicrates=0x%08x\n", 1280251538Srpaulo mode, rates, basicrates); 1281251538Srpaulo 1282251538Srpaulo /* Set rates mask for group addressed frames. */ 1283251538Srpaulo cmd.macid = URTWN_MACID_BC | URTWN_MACID_VALID; 1284251538Srpaulo cmd.mask = htole32(mode << 28 | basicrates); 1285251538Srpaulo error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd)); 1286251538Srpaulo if (error != 0) { 1287252401Srpaulo ieee80211_free_node(ni); 1288251538Srpaulo device_printf(sc->sc_dev, 1289251538Srpaulo "could not add broadcast station\n"); 1290251538Srpaulo return (error); 1291251538Srpaulo } 1292251538Srpaulo /* Set initial MRR rate. */ 1293251538Srpaulo DPRINTF("maxbasicrate=%d\n", maxbasicrate); 1294251538Srpaulo urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BC), 1295251538Srpaulo maxbasicrate); 1296251538Srpaulo 1297251538Srpaulo /* Set rates mask for unicast frames. */ 1298251538Srpaulo cmd.macid = URTWN_MACID_BSS | URTWN_MACID_VALID; 1299251538Srpaulo cmd.mask = htole32(mode << 28 | rates); 1300251538Srpaulo error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd)); 1301251538Srpaulo if (error != 0) { 1302252401Srpaulo ieee80211_free_node(ni); 1303251538Srpaulo device_printf(sc->sc_dev, "could not add BSS station\n"); 1304251538Srpaulo return (error); 1305251538Srpaulo } 1306251538Srpaulo /* Set initial MRR rate. */ 1307251538Srpaulo DPRINTF("maxrate=%d\n", maxrate); 1308251538Srpaulo urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BSS), 1309251538Srpaulo maxrate); 1310251538Srpaulo 1311251538Srpaulo /* Indicate highest supported rate. */ 1312252403Srpaulo ni->ni_txrate = rs->rs_rates[rs->rs_nrates - 1]; 1313252401Srpaulo ieee80211_free_node(ni); 1314252401Srpaulo 1315251538Srpaulo return (0); 1316251538Srpaulo} 1317251538Srpaulo 1318251538Srpaulovoid 1319251538Srpaulourtwn_tsf_sync_enable(struct urtwn_softc *sc) 1320251538Srpaulo{ 1321251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 1322251538Srpaulo struct ieee80211com *ic = ifp->if_l2com; 1323251538Srpaulo struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 1324251538Srpaulo struct ieee80211_node *ni = vap->iv_bss; 1325251538Srpaulo 1326251538Srpaulo uint64_t tsf; 1327251538Srpaulo 1328251538Srpaulo /* Enable TSF synchronization. */ 1329251538Srpaulo urtwn_write_1(sc, R92C_BCN_CTRL, 1330251538Srpaulo urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_DIS_TSF_UDT0); 1331251538Srpaulo 1332251538Srpaulo urtwn_write_1(sc, R92C_BCN_CTRL, 1333251538Srpaulo urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_EN_BCN); 1334251538Srpaulo 1335251538Srpaulo /* Set initial TSF. */ 1336251538Srpaulo memcpy(&tsf, ni->ni_tstamp.data, 8); 1337251538Srpaulo tsf = le64toh(tsf); 1338251538Srpaulo tsf = tsf - (tsf % (vap->iv_bss->ni_intval * IEEE80211_DUR_TU)); 1339251538Srpaulo tsf -= IEEE80211_DUR_TU; 1340251538Srpaulo urtwn_write_4(sc, R92C_TSFTR + 0, tsf); 1341251538Srpaulo urtwn_write_4(sc, R92C_TSFTR + 4, tsf >> 32); 1342251538Srpaulo 1343251538Srpaulo urtwn_write_1(sc, R92C_BCN_CTRL, 1344251538Srpaulo urtwn_read_1(sc, R92C_BCN_CTRL) | R92C_BCN_CTRL_EN_BCN); 1345251538Srpaulo} 1346251538Srpaulo 1347251538Srpaulostatic void 1348251538Srpaulourtwn_set_led(struct urtwn_softc *sc, int led, int on) 1349251538Srpaulo{ 1350251538Srpaulo uint8_t reg; 1351251538Srpaulo 1352251538Srpaulo if (led == URTWN_LED_LINK) { 1353251538Srpaulo reg = urtwn_read_1(sc, R92C_LEDCFG0) & 0x70; 1354251538Srpaulo if (!on) 1355251538Srpaulo reg |= R92C_LEDCFG0_DIS; 1356251538Srpaulo urtwn_write_1(sc, R92C_LEDCFG0, reg); 1357251538Srpaulo sc->ledlink = on; /* Save LED state. */ 1358251538Srpaulo } 1359251538Srpaulo} 1360251538Srpaulo 1361251538Srpaulostatic int 1362251538Srpaulourtwn_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 1363251538Srpaulo{ 1364251538Srpaulo struct urtwn_vap *uvp = URTWN_VAP(vap); 1365251538Srpaulo struct ieee80211com *ic = vap->iv_ic; 1366251538Srpaulo struct urtwn_softc *sc = ic->ic_ifp->if_softc; 1367251538Srpaulo struct ieee80211_node *ni; 1368251538Srpaulo enum ieee80211_state ostate; 1369251538Srpaulo uint32_t reg; 1370251538Srpaulo 1371251538Srpaulo ostate = vap->iv_state; 1372251538Srpaulo DPRINTF("%s -> %s\n", ieee80211_state_name[ostate], 1373251538Srpaulo ieee80211_state_name[nstate]); 1374251538Srpaulo 1375251538Srpaulo IEEE80211_UNLOCK(ic); 1376251538Srpaulo URTWN_LOCK(sc); 1377251538Srpaulo callout_stop(&sc->sc_watchdog_ch); 1378251538Srpaulo 1379251538Srpaulo if (ostate == IEEE80211_S_RUN) { 1380251538Srpaulo /* Turn link LED off. */ 1381251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 0); 1382251538Srpaulo 1383251538Srpaulo /* Set media status to 'No Link'. */ 1384251538Srpaulo reg = urtwn_read_4(sc, R92C_CR); 1385251538Srpaulo reg = RW(reg, R92C_CR_NETTYPE, R92C_CR_NETTYPE_NOLINK); 1386251538Srpaulo urtwn_write_4(sc, R92C_CR, reg); 1387251538Srpaulo 1388251538Srpaulo /* Stop Rx of data frames. */ 1389251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP2, 0); 1390251538Srpaulo 1391251538Srpaulo /* Rest TSF. */ 1392251538Srpaulo urtwn_write_1(sc, R92C_DUAL_TSF_RST, 0x03); 1393251538Srpaulo 1394251538Srpaulo /* Disable TSF synchronization. */ 1395251538Srpaulo urtwn_write_1(sc, R92C_BCN_CTRL, 1396251538Srpaulo urtwn_read_1(sc, R92C_BCN_CTRL) | 1397251538Srpaulo R92C_BCN_CTRL_DIS_TSF_UDT0); 1398251538Srpaulo 1399251538Srpaulo /* Reset EDCA parameters. */ 1400251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002f3217); 1401251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005e4317); 1402251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x00105320); 1403251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a444); 1404251538Srpaulo } 1405251538Srpaulo 1406251538Srpaulo switch (nstate) { 1407251538Srpaulo case IEEE80211_S_INIT: 1408251538Srpaulo /* Turn link LED off. */ 1409251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 0); 1410251538Srpaulo break; 1411251538Srpaulo case IEEE80211_S_SCAN: 1412251538Srpaulo if (ostate != IEEE80211_S_SCAN) { 1413251538Srpaulo /* Allow Rx from any BSSID. */ 1414251538Srpaulo urtwn_write_4(sc, R92C_RCR, 1415251538Srpaulo urtwn_read_4(sc, R92C_RCR) & 1416251538Srpaulo ~(R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN)); 1417251538Srpaulo 1418251538Srpaulo /* Set gain for scanning. */ 1419251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0)); 1420251538Srpaulo reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x20); 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, 0x20); 1425251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg); 1426251538Srpaulo } 1427251538Srpaulo 1428251538Srpaulo /* Make link LED blink during scan. */ 1429251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, !sc->ledlink); 1430251538Srpaulo 1431251538Srpaulo /* Pause AC Tx queues. */ 1432251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 1433251538Srpaulo urtwn_read_1(sc, R92C_TXPAUSE) | 0x0f); 1434251538Srpaulo 1435251538Srpaulo urtwn_set_chan(sc, ic->ic_curchan, NULL); 1436251538Srpaulo break; 1437251538Srpaulo case IEEE80211_S_AUTH: 1438251538Srpaulo /* Set initial gain under link. */ 1439251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0)); 1440251538Srpaulo reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x32); 1441251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg); 1442251538Srpaulo 1443251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1)); 1444251538Srpaulo reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x32); 1445251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg); 1446251538Srpaulo 1447251538Srpaulo urtwn_set_chan(sc, ic->ic_curchan, NULL); 1448251538Srpaulo break; 1449251538Srpaulo case IEEE80211_S_RUN: 1450251538Srpaulo if (vap->iv_opmode == IEEE80211_M_MONITOR) { 1451251538Srpaulo /* Enable Rx of data frames. */ 1452251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff); 1453251538Srpaulo 1454251538Srpaulo /* Turn link LED on. */ 1455251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 1); 1456251538Srpaulo break; 1457251538Srpaulo } 1458251538Srpaulo 1459251538Srpaulo ni = ieee80211_ref_node(vap->iv_bss); 1460251538Srpaulo /* Set media status to 'Associated'. */ 1461251538Srpaulo reg = urtwn_read_4(sc, R92C_CR); 1462251538Srpaulo reg = RW(reg, R92C_CR_NETTYPE, R92C_CR_NETTYPE_INFRA); 1463251538Srpaulo urtwn_write_4(sc, R92C_CR, reg); 1464251538Srpaulo 1465251538Srpaulo /* Set BSSID. */ 1466251538Srpaulo urtwn_write_4(sc, R92C_BSSID + 0, LE_READ_4(&ni->ni_bssid[0])); 1467251538Srpaulo urtwn_write_4(sc, R92C_BSSID + 4, LE_READ_2(&ni->ni_bssid[4])); 1468251538Srpaulo 1469251538Srpaulo if (ic->ic_curmode == IEEE80211_MODE_11B) 1470251538Srpaulo urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 0); 1471251538Srpaulo else /* 802.11b/g */ 1472251538Srpaulo urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 3); 1473251538Srpaulo 1474251538Srpaulo /* Enable Rx of data frames. */ 1475251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff); 1476251538Srpaulo 1477251538Srpaulo /* Flush all AC queues. */ 1478251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 0); 1479251538Srpaulo 1480251538Srpaulo /* Set beacon interval. */ 1481251538Srpaulo urtwn_write_2(sc, R92C_BCN_INTERVAL, ni->ni_intval); 1482251538Srpaulo 1483251538Srpaulo /* Allow Rx from our BSSID only. */ 1484251538Srpaulo urtwn_write_4(sc, R92C_RCR, 1485251538Srpaulo urtwn_read_4(sc, R92C_RCR) | 1486251538Srpaulo R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN); 1487251538Srpaulo 1488251538Srpaulo /* Enable TSF synchronization. */ 1489251538Srpaulo urtwn_tsf_sync_enable(sc); 1490251538Srpaulo 1491251538Srpaulo urtwn_write_1(sc, R92C_SIFS_CCK + 1, 10); 1492251538Srpaulo urtwn_write_1(sc, R92C_SIFS_OFDM + 1, 10); 1493251538Srpaulo urtwn_write_1(sc, R92C_SPEC_SIFS + 1, 10); 1494251538Srpaulo urtwn_write_1(sc, R92C_MAC_SPEC_SIFS + 1, 10); 1495251538Srpaulo urtwn_write_1(sc, R92C_R2T_SIFS + 1, 10); 1496251538Srpaulo urtwn_write_1(sc, R92C_T2T_SIFS + 1, 10); 1497251538Srpaulo 1498251538Srpaulo /* Intialize rate adaptation. */ 1499251538Srpaulo urtwn_ra_init(sc); 1500251538Srpaulo /* Turn link LED on. */ 1501251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 1); 1502251538Srpaulo 1503251538Srpaulo sc->avg_pwdb = -1; /* Reset average RSSI. */ 1504251538Srpaulo /* Reset temperature calibration state machine. */ 1505251538Srpaulo sc->thcal_state = 0; 1506251538Srpaulo sc->thcal_lctemp = 0; 1507251538Srpaulo ieee80211_free_node(ni); 1508251538Srpaulo break; 1509251538Srpaulo default: 1510251538Srpaulo break; 1511251538Srpaulo } 1512251538Srpaulo URTWN_UNLOCK(sc); 1513251538Srpaulo IEEE80211_LOCK(ic); 1514251538Srpaulo return(uvp->newstate(vap, nstate, arg)); 1515251538Srpaulo} 1516251538Srpaulo 1517251538Srpaulostatic void 1518251538Srpaulourtwn_watchdog(void *arg) 1519251538Srpaulo{ 1520251538Srpaulo struct urtwn_softc *sc = arg; 1521251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 1522251538Srpaulo 1523251538Srpaulo if (sc->sc_txtimer > 0) { 1524251538Srpaulo if (--sc->sc_txtimer == 0) { 1525251538Srpaulo device_printf(sc->sc_dev, "device timeout\n"); 1526251538Srpaulo ifp->if_oerrors++; 1527251538Srpaulo return; 1528251538Srpaulo } 1529251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 1530251538Srpaulo } 1531251538Srpaulo} 1532251538Srpaulo 1533251538Srpaulostatic void 1534251538Srpaulourtwn_update_avgrssi(struct urtwn_softc *sc, int rate, int8_t rssi) 1535251538Srpaulo{ 1536251538Srpaulo int pwdb; 1537251538Srpaulo 1538251538Srpaulo /* Convert antenna signal to percentage. */ 1539251538Srpaulo if (rssi <= -100 || rssi >= 20) 1540251538Srpaulo pwdb = 0; 1541251538Srpaulo else if (rssi >= 0) 1542251538Srpaulo pwdb = 100; 1543251538Srpaulo else 1544251538Srpaulo pwdb = 100 + rssi; 1545251538Srpaulo if (rate <= 3) { 1546251538Srpaulo /* CCK gain is smaller than OFDM/MCS gain. */ 1547251538Srpaulo pwdb += 6; 1548251538Srpaulo if (pwdb > 100) 1549251538Srpaulo pwdb = 100; 1550251538Srpaulo if (pwdb <= 14) 1551251538Srpaulo pwdb -= 4; 1552251538Srpaulo else if (pwdb <= 26) 1553251538Srpaulo pwdb -= 8; 1554251538Srpaulo else if (pwdb <= 34) 1555251538Srpaulo pwdb -= 6; 1556251538Srpaulo else if (pwdb <= 42) 1557251538Srpaulo pwdb -= 2; 1558251538Srpaulo } 1559251538Srpaulo if (sc->avg_pwdb == -1) /* Init. */ 1560251538Srpaulo sc->avg_pwdb = pwdb; 1561251538Srpaulo else if (sc->avg_pwdb < pwdb) 1562251538Srpaulo sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20) + 1; 1563251538Srpaulo else 1564251538Srpaulo sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20); 1565251538Srpaulo DPRINTFN(4, "PWDB=%d EMA=%d\n", pwdb, sc->avg_pwdb); 1566251538Srpaulo} 1567251538Srpaulo 1568251538Srpaulostatic int8_t 1569251538Srpaulourtwn_get_rssi(struct urtwn_softc *sc, int rate, void *physt) 1570251538Srpaulo{ 1571251538Srpaulo static const int8_t cckoff[] = { 16, -12, -26, -46 }; 1572251538Srpaulo struct r92c_rx_phystat *phy; 1573251538Srpaulo struct r92c_rx_cck *cck; 1574251538Srpaulo uint8_t rpt; 1575251538Srpaulo int8_t rssi; 1576251538Srpaulo 1577251538Srpaulo if (rate <= 3) { 1578251538Srpaulo cck = (struct r92c_rx_cck *)physt; 1579251538Srpaulo if (sc->sc_flags & URTWN_FLAG_CCK_HIPWR) { 1580251538Srpaulo rpt = (cck->agc_rpt >> 5) & 0x3; 1581251538Srpaulo rssi = (cck->agc_rpt & 0x1f) << 1; 1582251538Srpaulo } else { 1583251538Srpaulo rpt = (cck->agc_rpt >> 6) & 0x3; 1584251538Srpaulo rssi = cck->agc_rpt & 0x3e; 1585251538Srpaulo } 1586251538Srpaulo rssi = cckoff[rpt] - rssi; 1587251538Srpaulo } else { /* OFDM/HT. */ 1588251538Srpaulo phy = (struct r92c_rx_phystat *)physt; 1589251538Srpaulo rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110; 1590251538Srpaulo } 1591251538Srpaulo return (rssi); 1592251538Srpaulo} 1593251538Srpaulo 1594251538Srpaulostatic int 1595251538Srpaulourtwn_tx_start(struct urtwn_softc *sc, struct ieee80211_node *ni, 1596251538Srpaulo struct mbuf *m0, struct urtwn_data *data) 1597251538Srpaulo{ 1598251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 1599251538Srpaulo struct ieee80211_frame *wh; 1600251538Srpaulo struct ieee80211_key *k; 1601251538Srpaulo struct ieee80211com *ic = ifp->if_l2com; 1602251538Srpaulo struct ieee80211vap *vap = ni->ni_vap; 1603251538Srpaulo struct usb_xfer *xfer; 1604251538Srpaulo struct r92c_tx_desc *txd; 1605251538Srpaulo uint8_t raid, type; 1606251538Srpaulo uint16_t sum; 1607251538Srpaulo int i, hasqos, xferlen; 1608251538Srpaulo struct usb_xfer *urtwn_pipes[4] = { 1609251538Srpaulo sc->sc_xfer[URTWN_BULK_TX_BE], 1610251538Srpaulo sc->sc_xfer[URTWN_BULK_TX_BK], 1611251538Srpaulo sc->sc_xfer[URTWN_BULK_TX_VI], 1612251538Srpaulo sc->sc_xfer[URTWN_BULK_TX_VO] 1613251538Srpaulo }; 1614251538Srpaulo 1615251538Srpaulo URTWN_ASSERT_LOCKED(sc); 1616251538Srpaulo 1617251538Srpaulo /* 1618251538Srpaulo * Software crypto. 1619251538Srpaulo */ 1620251538Srpaulo wh = mtod(m0, struct ieee80211_frame *); 1621260444Skevlo if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 1622251538Srpaulo k = ieee80211_crypto_encap(ni, m0); 1623251538Srpaulo if (k == NULL) { 1624251538Srpaulo device_printf(sc->sc_dev, 1625251538Srpaulo "ieee80211_crypto_encap returns NULL.\n"); 1626251538Srpaulo /* XXX we don't expect the fragmented frames */ 1627251538Srpaulo m_freem(m0); 1628251538Srpaulo return (ENOBUFS); 1629251538Srpaulo } 1630251538Srpaulo 1631251538Srpaulo /* in case packet header moved, reset pointer */ 1632251538Srpaulo wh = mtod(m0, struct ieee80211_frame *); 1633251538Srpaulo } 1634251538Srpaulo 1635251538Srpaulo switch (wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) { 1636251538Srpaulo case IEEE80211_FC0_TYPE_CTL: 1637251538Srpaulo case IEEE80211_FC0_TYPE_MGT: 1638251538Srpaulo xfer = sc->sc_xfer[URTWN_BULK_TX_VO]; 1639251538Srpaulo break; 1640251538Srpaulo default: 1641251538Srpaulo KASSERT(M_WME_GETAC(m0) < 4, 1642251538Srpaulo ("unsupported WME pipe %d", M_WME_GETAC(m0))); 1643251538Srpaulo xfer = urtwn_pipes[M_WME_GETAC(m0)]; 1644251538Srpaulo break; 1645251538Srpaulo } 1646251538Srpaulo 1647251538Srpaulo hasqos = 0; 1648251538Srpaulo 1649251538Srpaulo /* Fill Tx descriptor. */ 1650251538Srpaulo txd = (struct r92c_tx_desc *)data->buf; 1651251538Srpaulo memset(txd, 0, sizeof(*txd)); 1652251538Srpaulo 1653251538Srpaulo txd->txdw0 |= htole32( 1654251538Srpaulo SM(R92C_TXDW0_PKTLEN, m0->m_pkthdr.len) | 1655251538Srpaulo SM(R92C_TXDW0_OFFSET, sizeof(*txd)) | 1656251538Srpaulo R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG); 1657251538Srpaulo if (IEEE80211_IS_MULTICAST(wh->i_addr1)) 1658251538Srpaulo txd->txdw0 |= htole32(R92C_TXDW0_BMCAST); 1659251538Srpaulo 1660251538Srpaulo type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK; 1661251538Srpaulo if (!IEEE80211_IS_MULTICAST(wh->i_addr1) && 1662251538Srpaulo type == IEEE80211_FC0_TYPE_DATA) { 1663251538Srpaulo if (ic->ic_curmode == IEEE80211_MODE_11B) 1664251538Srpaulo raid = R92C_RAID_11B; 1665251538Srpaulo else 1666251538Srpaulo raid = R92C_RAID_11BG; 1667251538Srpaulo txd->txdw1 |= htole32( 1668251538Srpaulo SM(R92C_TXDW1_MACID, URTWN_MACID_BSS) | 1669251538Srpaulo SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_BE) | 1670251538Srpaulo SM(R92C_TXDW1_RAID, raid) | 1671251538Srpaulo R92C_TXDW1_AGGBK); 1672251538Srpaulo 1673251538Srpaulo if (ic->ic_flags & IEEE80211_F_USEPROT) { 1674251538Srpaulo if (ic->ic_protmode == IEEE80211_PROT_CTSONLY) { 1675251538Srpaulo txd->txdw4 |= htole32(R92C_TXDW4_CTS2SELF | 1676251538Srpaulo R92C_TXDW4_HWRTSEN); 1677251538Srpaulo } else if (ic->ic_protmode == IEEE80211_PROT_RTSCTS) { 1678251538Srpaulo txd->txdw4 |= htole32(R92C_TXDW4_RTSEN | 1679251538Srpaulo R92C_TXDW4_HWRTSEN); 1680251538Srpaulo } 1681251538Srpaulo } 1682251538Srpaulo /* Send RTS at OFDM24. */ 1683251538Srpaulo txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE, 8)); 1684251538Srpaulo txd->txdw5 |= htole32(0x0001ff00); 1685251538Srpaulo /* Send data at OFDM54. */ 1686251538Srpaulo txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, 11)); 1687251538Srpaulo } else { 1688251538Srpaulo txd->txdw1 |= htole32( 1689251538Srpaulo SM(R92C_TXDW1_MACID, 0) | 1690251538Srpaulo SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_MGNT) | 1691251538Srpaulo SM(R92C_TXDW1_RAID, R92C_RAID_11B)); 1692251538Srpaulo 1693251538Srpaulo /* Force CCK1. */ 1694251538Srpaulo txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE); 1695251538Srpaulo txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, 0)); 1696251538Srpaulo } 1697251538Srpaulo /* Set sequence number (already little endian). */ 1698251538Srpaulo txd->txdseq |= *(uint16_t *)wh->i_seq; 1699251538Srpaulo 1700251538Srpaulo if (!hasqos) { 1701251538Srpaulo /* Use HW sequence numbering for non-QoS frames. */ 1702251538Srpaulo txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ); 1703251538Srpaulo txd->txdseq |= htole16(0x8000); 1704251538Srpaulo } else 1705251538Srpaulo txd->txdw4 |= htole32(R92C_TXDW4_QOS); 1706251538Srpaulo 1707251538Srpaulo /* Compute Tx descriptor checksum. */ 1708251538Srpaulo sum = 0; 1709251538Srpaulo for (i = 0; i < sizeof(*txd) / 2; i++) 1710251538Srpaulo sum ^= ((uint16_t *)txd)[i]; 1711251538Srpaulo txd->txdsum = sum; /* NB: already little endian. */ 1712251538Srpaulo 1713251538Srpaulo if (ieee80211_radiotap_active_vap(vap)) { 1714251538Srpaulo struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap; 1715251538Srpaulo 1716251538Srpaulo tap->wt_flags = 0; 1717251538Srpaulo tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq); 1718251538Srpaulo tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags); 1719251538Srpaulo ieee80211_radiotap_tx(vap, m0); 1720251538Srpaulo } 1721251538Srpaulo 1722251538Srpaulo xferlen = sizeof(*txd) + m0->m_pkthdr.len; 1723251538Srpaulo m_copydata(m0, 0, m0->m_pkthdr.len, (caddr_t)&txd[1]); 1724251538Srpaulo 1725251538Srpaulo data->buflen = xferlen; 1726251538Srpaulo data->ni = ni; 1727251538Srpaulo data->m = m0; 1728251538Srpaulo 1729251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next); 1730251538Srpaulo usbd_transfer_start(xfer); 1731251538Srpaulo return (0); 1732251538Srpaulo} 1733251538Srpaulo 1734251538Srpaulostatic void 1735251538Srpaulourtwn_start(struct ifnet *ifp) 1736251538Srpaulo{ 1737251538Srpaulo struct urtwn_softc *sc = ifp->if_softc; 1738261863Srpaulo 1739261863Srpaulo if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0) 1740261863Srpaulo return; 1741261863Srpaulo URTWN_LOCK(sc); 1742261863Srpaulo urtwn_start_locked(ifp, sc); 1743261863Srpaulo URTWN_UNLOCK(sc); 1744261863Srpaulo} 1745261863Srpaulo 1746261863Srpaulostatic void 1747261863Srpaulourtwn_start_locked(struct ifnet *ifp, struct urtwn_softc *sc) 1748261863Srpaulo{ 1749251538Srpaulo struct ieee80211_node *ni; 1750251538Srpaulo struct mbuf *m; 1751251538Srpaulo struct urtwn_data *bf; 1752251538Srpaulo 1753261863Srpaulo URTWN_ASSERT_LOCKED(sc); 1754251538Srpaulo for (;;) { 1755251538Srpaulo IFQ_DRV_DEQUEUE(&ifp->if_snd, m); 1756251538Srpaulo if (m == NULL) 1757251538Srpaulo break; 1758251538Srpaulo bf = urtwn_getbuf(sc); 1759251538Srpaulo if (bf == NULL) { 1760251538Srpaulo IFQ_DRV_PREPEND(&ifp->if_snd, m); 1761251538Srpaulo break; 1762251538Srpaulo } 1763251538Srpaulo ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 1764251538Srpaulo m->m_pkthdr.rcvif = NULL; 1765251538Srpaulo 1766251538Srpaulo if (urtwn_tx_start(sc, ni, m, bf) != 0) { 1767251538Srpaulo ifp->if_oerrors++; 1768251538Srpaulo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 1769251538Srpaulo ieee80211_free_node(ni); 1770251538Srpaulo break; 1771251538Srpaulo } 1772251538Srpaulo 1773251538Srpaulo sc->sc_txtimer = 5; 1774251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 1775251538Srpaulo } 1776251538Srpaulo} 1777251538Srpaulo 1778251538Srpaulostatic int 1779251538Srpaulourtwn_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 1780251538Srpaulo{ 1781263153Skevlo struct urtwn_softc *sc = ifp->if_softc; 1782251538Srpaulo struct ieee80211com *ic = ifp->if_l2com; 1783251538Srpaulo struct ifreq *ifr = (struct ifreq *) data; 1784251538Srpaulo int error = 0, startall = 0; 1785251538Srpaulo 1786263153Skevlo URTWN_LOCK(sc); 1787263153Skevlo error = (sc->sc_flags & URTWN_DETACHED) ? ENXIO : 0; 1788263153Skevlo URTWN_UNLOCK(sc); 1789263153Skevlo if (error != 0) 1790263153Skevlo return (error); 1791263153Skevlo 1792251538Srpaulo switch (cmd) { 1793251538Srpaulo case SIOCSIFFLAGS: 1794251538Srpaulo if (ifp->if_flags & IFF_UP) { 1795251538Srpaulo if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0) { 1796251538Srpaulo urtwn_init(ifp->if_softc); 1797251538Srpaulo startall = 1; 1798251538Srpaulo } 1799251538Srpaulo } else { 1800251538Srpaulo if (ifp->if_drv_flags & IFF_DRV_RUNNING) 1801263153Skevlo urtwn_stop(ifp); 1802251538Srpaulo } 1803251538Srpaulo if (startall) 1804251538Srpaulo ieee80211_start_all(ic); 1805251538Srpaulo break; 1806251538Srpaulo case SIOCGIFMEDIA: 1807251538Srpaulo error = ifmedia_ioctl(ifp, ifr, &ic->ic_media, cmd); 1808251538Srpaulo break; 1809251538Srpaulo case SIOCGIFADDR: 1810251538Srpaulo error = ether_ioctl(ifp, cmd, data); 1811251538Srpaulo break; 1812251538Srpaulo default: 1813251538Srpaulo error = EINVAL; 1814251538Srpaulo break; 1815251538Srpaulo } 1816251538Srpaulo return (error); 1817251538Srpaulo} 1818251538Srpaulo 1819251538Srpaulostatic int 1820251538Srpaulourtwn_alloc_list(struct urtwn_softc *sc, struct urtwn_data data[], 1821251538Srpaulo int ndata, int maxsz) 1822251538Srpaulo{ 1823251538Srpaulo int i, error; 1824251538Srpaulo 1825251538Srpaulo for (i = 0; i < ndata; i++) { 1826251538Srpaulo struct urtwn_data *dp = &data[i]; 1827251538Srpaulo dp->sc = sc; 1828251538Srpaulo dp->m = NULL; 1829251538Srpaulo dp->buf = malloc(maxsz, M_USBDEV, M_NOWAIT); 1830251538Srpaulo if (dp->buf == NULL) { 1831251538Srpaulo device_printf(sc->sc_dev, 1832251538Srpaulo "could not allocate buffer\n"); 1833251538Srpaulo error = ENOMEM; 1834251538Srpaulo goto fail; 1835251538Srpaulo } 1836251538Srpaulo dp->ni = NULL; 1837251538Srpaulo } 1838251538Srpaulo 1839251538Srpaulo return (0); 1840251538Srpaulofail: 1841251538Srpaulo urtwn_free_list(sc, data, ndata); 1842251538Srpaulo return (error); 1843251538Srpaulo} 1844251538Srpaulo 1845251538Srpaulostatic int 1846251538Srpaulourtwn_alloc_rx_list(struct urtwn_softc *sc) 1847251538Srpaulo{ 1848251538Srpaulo int error, i; 1849251538Srpaulo 1850251538Srpaulo error = urtwn_alloc_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT, 1851251538Srpaulo URTWN_RXBUFSZ); 1852251538Srpaulo if (error != 0) 1853251538Srpaulo return (error); 1854251538Srpaulo 1855251538Srpaulo STAILQ_INIT(&sc->sc_rx_active); 1856251538Srpaulo STAILQ_INIT(&sc->sc_rx_inactive); 1857251538Srpaulo 1858251538Srpaulo for (i = 0; i < URTWN_RX_LIST_COUNT; i++) 1859251538Srpaulo STAILQ_INSERT_HEAD(&sc->sc_rx_inactive, &sc->sc_rx[i], next); 1860251538Srpaulo 1861251538Srpaulo return (0); 1862251538Srpaulo} 1863251538Srpaulo 1864251538Srpaulostatic int 1865251538Srpaulourtwn_alloc_tx_list(struct urtwn_softc *sc) 1866251538Srpaulo{ 1867251538Srpaulo int error, i; 1868251538Srpaulo 1869251538Srpaulo error = urtwn_alloc_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT, 1870251538Srpaulo URTWN_TXBUFSZ); 1871251538Srpaulo if (error != 0) 1872251538Srpaulo return (error); 1873251538Srpaulo 1874251538Srpaulo STAILQ_INIT(&sc->sc_tx_active); 1875251538Srpaulo STAILQ_INIT(&sc->sc_tx_inactive); 1876251538Srpaulo STAILQ_INIT(&sc->sc_tx_pending); 1877251538Srpaulo 1878251538Srpaulo for (i = 0; i < URTWN_TX_LIST_COUNT; i++) 1879251538Srpaulo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, &sc->sc_tx[i], next); 1880251538Srpaulo 1881251538Srpaulo return (0); 1882251538Srpaulo} 1883251538Srpaulo 1884251538Srpaulostatic int 1885251538Srpaulourtwn_power_on(struct urtwn_softc *sc) 1886251538Srpaulo{ 1887251538Srpaulo uint32_t reg; 1888251538Srpaulo int ntries; 1889251538Srpaulo 1890251538Srpaulo /* Wait for autoload done bit. */ 1891251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 1892251538Srpaulo if (urtwn_read_1(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_PFM_ALDN) 1893251538Srpaulo break; 1894251538Srpaulo DELAY(5); 1895251538Srpaulo } 1896251538Srpaulo if (ntries == 1000) { 1897251538Srpaulo device_printf(sc->sc_dev, 1898251538Srpaulo "timeout waiting for chip autoload\n"); 1899251538Srpaulo return (ETIMEDOUT); 1900251538Srpaulo } 1901251538Srpaulo 1902251538Srpaulo /* Unlock ISO/CLK/Power control register. */ 1903251538Srpaulo urtwn_write_1(sc, R92C_RSV_CTRL, 0); 1904251538Srpaulo /* Move SPS into PWM mode. */ 1905251538Srpaulo urtwn_write_1(sc, R92C_SPS0_CTRL, 0x2b); 1906251538Srpaulo DELAY(100); 1907251538Srpaulo 1908251538Srpaulo reg = urtwn_read_1(sc, R92C_LDOV12D_CTRL); 1909251538Srpaulo if (!(reg & R92C_LDOV12D_CTRL_LDV12_EN)) { 1910251538Srpaulo urtwn_write_1(sc, R92C_LDOV12D_CTRL, 1911251538Srpaulo reg | R92C_LDOV12D_CTRL_LDV12_EN); 1912251538Srpaulo DELAY(100); 1913251538Srpaulo urtwn_write_1(sc, R92C_SYS_ISO_CTRL, 1914251538Srpaulo urtwn_read_1(sc, R92C_SYS_ISO_CTRL) & 1915251538Srpaulo ~R92C_SYS_ISO_CTRL_MD2PP); 1916251538Srpaulo } 1917251538Srpaulo 1918251538Srpaulo /* Auto enable WLAN. */ 1919251538Srpaulo urtwn_write_2(sc, R92C_APS_FSMCO, 1920251538Srpaulo urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC); 1921251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 1922262822Skevlo if (!(urtwn_read_2(sc, R92C_APS_FSMCO) & 1923262822Skevlo R92C_APS_FSMCO_APFM_ONMAC)) 1924251538Srpaulo break; 1925251538Srpaulo DELAY(5); 1926251538Srpaulo } 1927251538Srpaulo if (ntries == 1000) { 1928251538Srpaulo device_printf(sc->sc_dev, 1929251538Srpaulo "timeout waiting for MAC auto ON\n"); 1930251538Srpaulo return (ETIMEDOUT); 1931251538Srpaulo } 1932251538Srpaulo 1933251538Srpaulo /* Enable radio, GPIO and LED functions. */ 1934251538Srpaulo urtwn_write_2(sc, R92C_APS_FSMCO, 1935251538Srpaulo R92C_APS_FSMCO_AFSM_HSUS | 1936251538Srpaulo R92C_APS_FSMCO_PDN_EN | 1937251538Srpaulo R92C_APS_FSMCO_PFM_ALDN); 1938251538Srpaulo /* Release RF digital isolation. */ 1939251538Srpaulo urtwn_write_2(sc, R92C_SYS_ISO_CTRL, 1940251538Srpaulo urtwn_read_2(sc, R92C_SYS_ISO_CTRL) & ~R92C_SYS_ISO_CTRL_DIOR); 1941251538Srpaulo 1942251538Srpaulo /* Initialize MAC. */ 1943251538Srpaulo urtwn_write_1(sc, R92C_APSD_CTRL, 1944251538Srpaulo urtwn_read_1(sc, R92C_APSD_CTRL) & ~R92C_APSD_CTRL_OFF); 1945251538Srpaulo for (ntries = 0; ntries < 200; ntries++) { 1946251538Srpaulo if (!(urtwn_read_1(sc, R92C_APSD_CTRL) & 1947251538Srpaulo R92C_APSD_CTRL_OFF_STATUS)) 1948251538Srpaulo break; 1949251538Srpaulo DELAY(5); 1950251538Srpaulo } 1951251538Srpaulo if (ntries == 200) { 1952251538Srpaulo device_printf(sc->sc_dev, 1953251538Srpaulo "timeout waiting for MAC initialization\n"); 1954251538Srpaulo return (ETIMEDOUT); 1955251538Srpaulo } 1956251538Srpaulo 1957251538Srpaulo /* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */ 1958251538Srpaulo reg = urtwn_read_2(sc, R92C_CR); 1959251538Srpaulo reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN | 1960251538Srpaulo R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN | 1961251538Srpaulo R92C_CR_SCHEDULE_EN | R92C_CR_MACTXEN | R92C_CR_MACRXEN | 1962251538Srpaulo R92C_CR_ENSEC; 1963251538Srpaulo urtwn_write_2(sc, R92C_CR, reg); 1964251538Srpaulo 1965251538Srpaulo urtwn_write_1(sc, 0xfe10, 0x19); 1966251538Srpaulo return (0); 1967251538Srpaulo} 1968251538Srpaulo 1969251538Srpaulostatic int 1970251538Srpaulourtwn_llt_init(struct urtwn_softc *sc) 1971251538Srpaulo{ 1972251538Srpaulo int i, error; 1973251538Srpaulo 1974251538Srpaulo /* Reserve pages [0; R92C_TX_PAGE_COUNT]. */ 1975251538Srpaulo for (i = 0; i < R92C_TX_PAGE_COUNT; i++) { 1976251538Srpaulo if ((error = urtwn_llt_write(sc, i, i + 1)) != 0) 1977251538Srpaulo return (error); 1978251538Srpaulo } 1979251538Srpaulo /* NB: 0xff indicates end-of-list. */ 1980251538Srpaulo if ((error = urtwn_llt_write(sc, i, 0xff)) != 0) 1981251538Srpaulo return (error); 1982251538Srpaulo /* 1983251538Srpaulo * Use pages [R92C_TX_PAGE_COUNT + 1; R92C_TXPKTBUF_COUNT - 1] 1984251538Srpaulo * as ring buffer. 1985251538Srpaulo */ 1986251538Srpaulo for (++i; i < R92C_TXPKTBUF_COUNT - 1; i++) { 1987251538Srpaulo if ((error = urtwn_llt_write(sc, i, i + 1)) != 0) 1988251538Srpaulo return (error); 1989251538Srpaulo } 1990251538Srpaulo /* Make the last page point to the beginning of the ring buffer. */ 1991251538Srpaulo error = urtwn_llt_write(sc, i, R92C_TX_PAGE_COUNT + 1); 1992251538Srpaulo return (error); 1993251538Srpaulo} 1994251538Srpaulo 1995251538Srpaulostatic void 1996251538Srpaulourtwn_fw_reset(struct urtwn_softc *sc) 1997251538Srpaulo{ 1998251538Srpaulo uint16_t reg; 1999251538Srpaulo int ntries; 2000251538Srpaulo 2001251538Srpaulo /* Tell 8051 to reset itself. */ 2002251538Srpaulo urtwn_write_1(sc, R92C_HMETFR + 3, 0x20); 2003251538Srpaulo 2004251538Srpaulo /* Wait until 8051 resets by itself. */ 2005251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 2006251538Srpaulo reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN); 2007251538Srpaulo if (!(reg & R92C_SYS_FUNC_EN_CPUEN)) 2008251538Srpaulo return; 2009251538Srpaulo DELAY(50); 2010251538Srpaulo } 2011251538Srpaulo /* Force 8051 reset. */ 2012251538Srpaulo urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN); 2013251538Srpaulo} 2014251538Srpaulo 2015251538Srpaulostatic int 2016251538Srpaulourtwn_fw_loadpage(struct urtwn_softc *sc, int page, const uint8_t *buf, int len) 2017251538Srpaulo{ 2018251538Srpaulo uint32_t reg; 2019251538Srpaulo int off, mlen, error = 0; 2020251538Srpaulo 2021251538Srpaulo reg = urtwn_read_4(sc, R92C_MCUFWDL); 2022251538Srpaulo reg = RW(reg, R92C_MCUFWDL_PAGE, page); 2023251538Srpaulo urtwn_write_4(sc, R92C_MCUFWDL, reg); 2024251538Srpaulo 2025251538Srpaulo off = R92C_FW_START_ADDR; 2026251538Srpaulo while (len > 0) { 2027251538Srpaulo if (len > 196) 2028251538Srpaulo mlen = 196; 2029251538Srpaulo else if (len > 4) 2030251538Srpaulo mlen = 4; 2031251538Srpaulo else 2032251538Srpaulo mlen = 1; 2033251538Srpaulo /* XXX fix this deconst */ 2034251538Srpaulo error = urtwn_write_region_1(sc, off, 2035251538Srpaulo __DECONST(uint8_t *, buf), mlen); 2036251538Srpaulo if (error != 0) 2037251538Srpaulo break; 2038251538Srpaulo off += mlen; 2039251538Srpaulo buf += mlen; 2040251538Srpaulo len -= mlen; 2041251538Srpaulo } 2042251538Srpaulo return (error); 2043251538Srpaulo} 2044251538Srpaulo 2045251538Srpaulostatic int 2046251538Srpaulourtwn_load_firmware(struct urtwn_softc *sc) 2047251538Srpaulo{ 2048251538Srpaulo const struct firmware *fw; 2049251538Srpaulo const struct r92c_fw_hdr *hdr; 2050251538Srpaulo const char *imagename; 2051251538Srpaulo const u_char *ptr; 2052251538Srpaulo size_t len; 2053251538Srpaulo uint32_t reg; 2054251538Srpaulo int mlen, ntries, page, error; 2055251538Srpaulo 2056251538Srpaulo /* Read firmware image from the filesystem. */ 2057251538Srpaulo if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) == 2058251538Srpaulo URTWN_CHIP_UMC_A_CUT) 2059251538Srpaulo imagename = "urtwn-rtl8192cfwU"; 2060251538Srpaulo else 2061251538Srpaulo imagename = "urtwn-rtl8192cfwT"; 2062251538Srpaulo 2063251538Srpaulo fw = firmware_get(imagename); 2064251538Srpaulo if (fw == NULL) { 2065251538Srpaulo device_printf(sc->sc_dev, 2066251538Srpaulo "failed loadfirmware of file %s\n", imagename); 2067251538Srpaulo return (ENOENT); 2068251538Srpaulo } 2069251538Srpaulo 2070251538Srpaulo len = fw->datasize; 2071251538Srpaulo 2072251538Srpaulo if (len < sizeof(*hdr)) { 2073251538Srpaulo device_printf(sc->sc_dev, "firmware too short\n"); 2074251538Srpaulo error = EINVAL; 2075251538Srpaulo goto fail; 2076251538Srpaulo } 2077251538Srpaulo ptr = fw->data; 2078251538Srpaulo hdr = (const struct r92c_fw_hdr *)ptr; 2079251538Srpaulo /* Check if there is a valid FW header and skip it. */ 2080251538Srpaulo if ((le16toh(hdr->signature) >> 4) == 0x88c || 2081251538Srpaulo (le16toh(hdr->signature) >> 4) == 0x92c) { 2082251538Srpaulo DPRINTF("FW V%d.%d %02d-%02d %02d:%02d\n", 2083251538Srpaulo le16toh(hdr->version), le16toh(hdr->subversion), 2084251538Srpaulo hdr->month, hdr->date, hdr->hour, hdr->minute); 2085251538Srpaulo ptr += sizeof(*hdr); 2086251538Srpaulo len -= sizeof(*hdr); 2087251538Srpaulo } 2088251538Srpaulo 2089251538Srpaulo if (urtwn_read_1(sc, R92C_MCUFWDL) & 0x80) { 2090251538Srpaulo urtwn_fw_reset(sc); 2091251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 0); 2092251538Srpaulo } 2093251538Srpaulo urtwn_write_2(sc, R92C_SYS_FUNC_EN, 2094251538Srpaulo urtwn_read_2(sc, R92C_SYS_FUNC_EN) | 2095251538Srpaulo R92C_SYS_FUNC_EN_CPUEN); 2096251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 2097251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_EN); 2098251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL + 2, 2099251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL + 2) & ~0x08); 2100251538Srpaulo 2101251538Srpaulo for (page = 0; len > 0; page++) { 2102251538Srpaulo mlen = min(len, R92C_FW_PAGE_SIZE); 2103251538Srpaulo error = urtwn_fw_loadpage(sc, page, ptr, mlen); 2104251538Srpaulo if (error != 0) { 2105251538Srpaulo device_printf(sc->sc_dev, 2106251538Srpaulo "could not load firmware page\n"); 2107251538Srpaulo goto fail; 2108251538Srpaulo } 2109251538Srpaulo ptr += mlen; 2110251538Srpaulo len -= mlen; 2111251538Srpaulo } 2112251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 2113251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL) & ~R92C_MCUFWDL_EN); 2114251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL + 1, 0); 2115251538Srpaulo 2116251538Srpaulo /* Wait for checksum report. */ 2117251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 2118251538Srpaulo if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_CHKSUM_RPT) 2119251538Srpaulo break; 2120251538Srpaulo DELAY(5); 2121251538Srpaulo } 2122251538Srpaulo if (ntries == 1000) { 2123251538Srpaulo device_printf(sc->sc_dev, 2124251538Srpaulo "timeout waiting for checksum report\n"); 2125251538Srpaulo error = ETIMEDOUT; 2126251538Srpaulo goto fail; 2127251538Srpaulo } 2128251538Srpaulo 2129251538Srpaulo reg = urtwn_read_4(sc, R92C_MCUFWDL); 2130251538Srpaulo reg = (reg & ~R92C_MCUFWDL_WINTINI_RDY) | R92C_MCUFWDL_RDY; 2131251538Srpaulo urtwn_write_4(sc, R92C_MCUFWDL, reg); 2132251538Srpaulo /* Wait for firmware readiness. */ 2133251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 2134251538Srpaulo if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_WINTINI_RDY) 2135251538Srpaulo break; 2136251538Srpaulo DELAY(5); 2137251538Srpaulo } 2138251538Srpaulo if (ntries == 1000) { 2139251538Srpaulo device_printf(sc->sc_dev, 2140251538Srpaulo "timeout waiting for firmware readiness\n"); 2141251538Srpaulo error = ETIMEDOUT; 2142251538Srpaulo goto fail; 2143251538Srpaulo } 2144251538Srpaulofail: 2145251538Srpaulo firmware_put(fw, FIRMWARE_UNLOAD); 2146251538Srpaulo return (error); 2147251538Srpaulo} 2148251538Srpaulo 2149251538Srpaulostatic int 2150251538Srpaulourtwn_dma_init(struct urtwn_softc *sc) 2151251538Srpaulo{ 2152251538Srpaulo int hashq, hasnq, haslq, nqueues, nqpages, nrempages; 2153251538Srpaulo uint32_t reg; 2154251538Srpaulo int error; 2155251538Srpaulo 2156251538Srpaulo /* Initialize LLT table. */ 2157251538Srpaulo error = urtwn_llt_init(sc); 2158251538Srpaulo if (error != 0) 2159251538Srpaulo return (error); 2160251538Srpaulo 2161251538Srpaulo /* Get Tx queues to USB endpoints mapping. */ 2162251538Srpaulo hashq = hasnq = haslq = 0; 2163251538Srpaulo reg = urtwn_read_2(sc, R92C_USB_EP + 1); 2164251538Srpaulo DPRINTFN(2, "USB endpoints mapping 0x%x\n", reg); 2165251538Srpaulo if (MS(reg, R92C_USB_EP_HQ) != 0) 2166251538Srpaulo hashq = 1; 2167251538Srpaulo if (MS(reg, R92C_USB_EP_NQ) != 0) 2168251538Srpaulo hasnq = 1; 2169251538Srpaulo if (MS(reg, R92C_USB_EP_LQ) != 0) 2170251538Srpaulo haslq = 1; 2171251538Srpaulo nqueues = hashq + hasnq + haslq; 2172251538Srpaulo if (nqueues == 0) 2173251538Srpaulo return (EIO); 2174251538Srpaulo /* Get the number of pages for each queue. */ 2175251538Srpaulo nqpages = (R92C_TX_PAGE_COUNT - R92C_PUBQ_NPAGES) / nqueues; 2176251538Srpaulo /* The remaining pages are assigned to the high priority queue. */ 2177251538Srpaulo nrempages = (R92C_TX_PAGE_COUNT - R92C_PUBQ_NPAGES) % nqueues; 2178251538Srpaulo 2179251538Srpaulo /* Set number of pages for normal priority queue. */ 2180251538Srpaulo urtwn_write_1(sc, R92C_RQPN_NPQ, hasnq ? nqpages : 0); 2181251538Srpaulo urtwn_write_4(sc, R92C_RQPN, 2182251538Srpaulo /* Set number of pages for public queue. */ 2183251538Srpaulo SM(R92C_RQPN_PUBQ, R92C_PUBQ_NPAGES) | 2184251538Srpaulo /* Set number of pages for high priority queue. */ 2185251538Srpaulo SM(R92C_RQPN_HPQ, hashq ? nqpages + nrempages : 0) | 2186251538Srpaulo /* Set number of pages for low priority queue. */ 2187251538Srpaulo SM(R92C_RQPN_LPQ, haslq ? nqpages : 0) | 2188251538Srpaulo /* Load values. */ 2189251538Srpaulo R92C_RQPN_LD); 2190251538Srpaulo 2191251538Srpaulo urtwn_write_1(sc, R92C_TXPKTBUF_BCNQ_BDNY, R92C_TX_PAGE_BOUNDARY); 2192251538Srpaulo urtwn_write_1(sc, R92C_TXPKTBUF_MGQ_BDNY, R92C_TX_PAGE_BOUNDARY); 2193251538Srpaulo urtwn_write_1(sc, R92C_TXPKTBUF_WMAC_LBK_BF_HD, R92C_TX_PAGE_BOUNDARY); 2194251538Srpaulo urtwn_write_1(sc, R92C_TRXFF_BNDY, R92C_TX_PAGE_BOUNDARY); 2195251538Srpaulo urtwn_write_1(sc, R92C_TDECTRL + 1, R92C_TX_PAGE_BOUNDARY); 2196251538Srpaulo 2197251538Srpaulo /* Set queue to USB pipe mapping. */ 2198251538Srpaulo reg = urtwn_read_2(sc, R92C_TRXDMA_CTRL); 2199251538Srpaulo reg &= ~R92C_TRXDMA_CTRL_QMAP_M; 2200251538Srpaulo if (nqueues == 1) { 2201251538Srpaulo if (hashq) 2202251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_HQ; 2203251538Srpaulo else if (hasnq) 2204251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_NQ; 2205251538Srpaulo else 2206251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_LQ; 2207251538Srpaulo } else if (nqueues == 2) { 2208251538Srpaulo /* All 2-endpoints configs have a high priority queue. */ 2209251538Srpaulo if (!hashq) 2210251538Srpaulo return (EIO); 2211251538Srpaulo if (hasnq) 2212251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_HQ_NQ; 2213251538Srpaulo else 2214251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_HQ_LQ; 2215251538Srpaulo } else 2216251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_3EP; 2217251538Srpaulo urtwn_write_2(sc, R92C_TRXDMA_CTRL, reg); 2218251538Srpaulo 2219251538Srpaulo /* Set Tx/Rx transfer page boundary. */ 2220251538Srpaulo urtwn_write_2(sc, R92C_TRXFF_BNDY + 2, 0x27ff); 2221251538Srpaulo 2222251538Srpaulo /* Set Tx/Rx transfer page size. */ 2223251538Srpaulo urtwn_write_1(sc, R92C_PBP, 2224251538Srpaulo SM(R92C_PBP_PSRX, R92C_PBP_128) | 2225251538Srpaulo SM(R92C_PBP_PSTX, R92C_PBP_128)); 2226251538Srpaulo return (0); 2227251538Srpaulo} 2228251538Srpaulo 2229251538Srpaulostatic void 2230251538Srpaulourtwn_mac_init(struct urtwn_softc *sc) 2231251538Srpaulo{ 2232251538Srpaulo int i; 2233251538Srpaulo 2234251538Srpaulo /* Write MAC initialization values. */ 2235251538Srpaulo for (i = 0; i < nitems(rtl8192cu_mac); i++) 2236251538Srpaulo urtwn_write_1(sc, rtl8192cu_mac[i].reg, rtl8192cu_mac[i].val); 2237251538Srpaulo} 2238251538Srpaulo 2239251538Srpaulostatic void 2240251538Srpaulourtwn_bb_init(struct urtwn_softc *sc) 2241251538Srpaulo{ 2242251538Srpaulo const struct urtwn_bb_prog *prog; 2243251538Srpaulo uint32_t reg; 2244251538Srpaulo int i; 2245251538Srpaulo 2246251538Srpaulo /* Enable BB and RF. */ 2247251538Srpaulo urtwn_write_2(sc, R92C_SYS_FUNC_EN, 2248251538Srpaulo urtwn_read_2(sc, R92C_SYS_FUNC_EN) | 2249251538Srpaulo R92C_SYS_FUNC_EN_BBRSTB | R92C_SYS_FUNC_EN_BB_GLB_RST | 2250251538Srpaulo R92C_SYS_FUNC_EN_DIO_RF); 2251251538Srpaulo 2252251538Srpaulo urtwn_write_2(sc, R92C_AFE_PLL_CTRL, 0xdb83); 2253251538Srpaulo 2254251538Srpaulo urtwn_write_1(sc, R92C_RF_CTRL, 2255251538Srpaulo R92C_RF_CTRL_EN | R92C_RF_CTRL_RSTB | R92C_RF_CTRL_SDMRSTB); 2256251538Srpaulo urtwn_write_1(sc, R92C_SYS_FUNC_EN, 2257251538Srpaulo R92C_SYS_FUNC_EN_USBA | R92C_SYS_FUNC_EN_USBD | 2258251538Srpaulo R92C_SYS_FUNC_EN_BB_GLB_RST | R92C_SYS_FUNC_EN_BBRSTB); 2259251538Srpaulo 2260251538Srpaulo urtwn_write_1(sc, R92C_LDOHCI12_CTRL, 0x0f); 2261251538Srpaulo urtwn_write_1(sc, 0x15, 0xe9); 2262251538Srpaulo urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 1, 0x80); 2263251538Srpaulo 2264251538Srpaulo /* Select BB programming based on board type. */ 2265251538Srpaulo if (!(sc->chip & URTWN_CHIP_92C)) { 2266251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 2267251538Srpaulo prog = &rtl8188ce_bb_prog; 2268251538Srpaulo else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 2269251538Srpaulo prog = &rtl8188ru_bb_prog; 2270251538Srpaulo else 2271251538Srpaulo prog = &rtl8188cu_bb_prog; 2272251538Srpaulo } else { 2273251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 2274251538Srpaulo prog = &rtl8192ce_bb_prog; 2275251538Srpaulo else 2276251538Srpaulo prog = &rtl8192cu_bb_prog; 2277251538Srpaulo } 2278251538Srpaulo /* Write BB initialization values. */ 2279251538Srpaulo for (i = 0; i < prog->count; i++) { 2280251538Srpaulo urtwn_bb_write(sc, prog->regs[i], prog->vals[i]); 2281251538Srpaulo DELAY(1); 2282251538Srpaulo } 2283251538Srpaulo 2284251538Srpaulo if (sc->chip & URTWN_CHIP_92C_1T2R) { 2285251538Srpaulo /* 8192C 1T only configuration. */ 2286251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_TXINFO); 2287251538Srpaulo reg = (reg & ~0x00000003) | 0x2; 2288251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_TXINFO, reg); 2289251538Srpaulo 2290251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA1_TXINFO); 2291251538Srpaulo reg = (reg & ~0x00300033) | 0x00200022; 2292251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_TXINFO, reg); 2293251538Srpaulo 2294251538Srpaulo reg = urtwn_bb_read(sc, R92C_CCK0_AFESETTING); 2295251538Srpaulo reg = (reg & ~0xff000000) | 0x45 << 24; 2296251538Srpaulo urtwn_bb_write(sc, R92C_CCK0_AFESETTING, reg); 2297251538Srpaulo 2298251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_TRXPATHENA); 2299251538Srpaulo reg = (reg & ~0x000000ff) | 0x23; 2300251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_TRXPATHENA, reg); 2301251538Srpaulo 2302251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_AGCPARAM1); 2303251538Srpaulo reg = (reg & ~0x00000030) | 1 << 4; 2304251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCPARAM1, reg); 2305251538Srpaulo 2306251538Srpaulo reg = urtwn_bb_read(sc, 0xe74); 2307251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 2308251538Srpaulo urtwn_bb_write(sc, 0xe74, reg); 2309251538Srpaulo reg = urtwn_bb_read(sc, 0xe78); 2310251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 2311251538Srpaulo urtwn_bb_write(sc, 0xe78, reg); 2312251538Srpaulo reg = urtwn_bb_read(sc, 0xe7c); 2313251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 2314251538Srpaulo urtwn_bb_write(sc, 0xe7c, reg); 2315251538Srpaulo reg = urtwn_bb_read(sc, 0xe80); 2316251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 2317251538Srpaulo urtwn_bb_write(sc, 0xe80, reg); 2318251538Srpaulo reg = urtwn_bb_read(sc, 0xe88); 2319251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 2320251538Srpaulo urtwn_bb_write(sc, 0xe88, reg); 2321251538Srpaulo } 2322251538Srpaulo 2323251538Srpaulo /* Write AGC values. */ 2324251538Srpaulo for (i = 0; i < prog->agccount; i++) { 2325251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCRSSITABLE, 2326251538Srpaulo prog->agcvals[i]); 2327251538Srpaulo DELAY(1); 2328251538Srpaulo } 2329251538Srpaulo 2330251538Srpaulo if (urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)) & 2331251538Srpaulo R92C_HSSI_PARAM2_CCK_HIPWR) 2332251538Srpaulo sc->sc_flags |= URTWN_FLAG_CCK_HIPWR; 2333251538Srpaulo} 2334251538Srpaulo 2335251538Srpaulovoid 2336251538Srpaulourtwn_rf_init(struct urtwn_softc *sc) 2337251538Srpaulo{ 2338251538Srpaulo const struct urtwn_rf_prog *prog; 2339251538Srpaulo uint32_t reg, type; 2340251538Srpaulo int i, j, idx, off; 2341251538Srpaulo 2342251538Srpaulo /* Select RF programming based on board type. */ 2343251538Srpaulo if (!(sc->chip & URTWN_CHIP_92C)) { 2344251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 2345251538Srpaulo prog = rtl8188ce_rf_prog; 2346251538Srpaulo else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 2347251538Srpaulo prog = rtl8188ru_rf_prog; 2348251538Srpaulo else 2349251538Srpaulo prog = rtl8188cu_rf_prog; 2350251538Srpaulo } else 2351251538Srpaulo prog = rtl8192ce_rf_prog; 2352251538Srpaulo 2353251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 2354251538Srpaulo /* Save RF_ENV control type. */ 2355251538Srpaulo idx = i / 2; 2356251538Srpaulo off = (i % 2) * 16; 2357251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx)); 2358251538Srpaulo type = (reg >> off) & 0x10; 2359251538Srpaulo 2360251538Srpaulo /* Set RF_ENV enable. */ 2361251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i)); 2362251538Srpaulo reg |= 0x100000; 2363251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg); 2364251538Srpaulo DELAY(1); 2365251538Srpaulo /* Set RF_ENV output high. */ 2366251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i)); 2367251538Srpaulo reg |= 0x10; 2368251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg); 2369251538Srpaulo DELAY(1); 2370251538Srpaulo /* Set address and data lengths of RF registers. */ 2371251538Srpaulo reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i)); 2372251538Srpaulo reg &= ~R92C_HSSI_PARAM2_ADDR_LENGTH; 2373251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg); 2374251538Srpaulo DELAY(1); 2375251538Srpaulo reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i)); 2376251538Srpaulo reg &= ~R92C_HSSI_PARAM2_DATA_LENGTH; 2377251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg); 2378251538Srpaulo DELAY(1); 2379251538Srpaulo 2380251538Srpaulo /* Write RF initialization values for this chain. */ 2381251538Srpaulo for (j = 0; j < prog[i].count; j++) { 2382251538Srpaulo if (prog[i].regs[j] >= 0xf9 && 2383251538Srpaulo prog[i].regs[j] <= 0xfe) { 2384251538Srpaulo /* 2385251538Srpaulo * These are fake RF registers offsets that 2386251538Srpaulo * indicate a delay is required. 2387251538Srpaulo */ 2388251538Srpaulo usb_pause_mtx(&sc->sc_mtx, 50); 2389251538Srpaulo continue; 2390251538Srpaulo } 2391251538Srpaulo urtwn_rf_write(sc, i, prog[i].regs[j], 2392251538Srpaulo prog[i].vals[j]); 2393251538Srpaulo DELAY(1); 2394251538Srpaulo } 2395251538Srpaulo 2396251538Srpaulo /* Restore RF_ENV control type. */ 2397251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx)); 2398251538Srpaulo reg &= ~(0x10 << off) | (type << off); 2399251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACESW(idx), reg); 2400251538Srpaulo 2401251538Srpaulo /* Cache RF register CHNLBW. */ 2402251538Srpaulo sc->rf_chnlbw[i] = urtwn_rf_read(sc, i, R92C_RF_CHNLBW); 2403251538Srpaulo } 2404251538Srpaulo 2405251538Srpaulo if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) == 2406251538Srpaulo URTWN_CHIP_UMC_A_CUT) { 2407251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_RX_G1, 0x30255); 2408251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_RX_G2, 0x50a00); 2409251538Srpaulo } 2410251538Srpaulo} 2411251538Srpaulo 2412251538Srpaulostatic void 2413251538Srpaulourtwn_cam_init(struct urtwn_softc *sc) 2414251538Srpaulo{ 2415251538Srpaulo /* Invalidate all CAM entries. */ 2416251538Srpaulo urtwn_write_4(sc, R92C_CAMCMD, 2417251538Srpaulo R92C_CAMCMD_POLLING | R92C_CAMCMD_CLR); 2418251538Srpaulo} 2419251538Srpaulo 2420251538Srpaulostatic void 2421251538Srpaulourtwn_pa_bias_init(struct urtwn_softc *sc) 2422251538Srpaulo{ 2423251538Srpaulo uint8_t reg; 2424251538Srpaulo int i; 2425251538Srpaulo 2426251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 2427251538Srpaulo if (sc->pa_setting & (1 << i)) 2428251538Srpaulo continue; 2429251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x0f406); 2430251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x4f406); 2431251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x8f406); 2432251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0xcf406); 2433251538Srpaulo } 2434251538Srpaulo if (!(sc->pa_setting & 0x10)) { 2435251538Srpaulo reg = urtwn_read_1(sc, 0x16); 2436251538Srpaulo reg = (reg & ~0xf0) | 0x90; 2437251538Srpaulo urtwn_write_1(sc, 0x16, reg); 2438251538Srpaulo } 2439251538Srpaulo} 2440251538Srpaulo 2441251538Srpaulostatic void 2442251538Srpaulourtwn_rxfilter_init(struct urtwn_softc *sc) 2443251538Srpaulo{ 2444251538Srpaulo /* Initialize Rx filter. */ 2445251538Srpaulo /* TODO: use better filter for monitor mode. */ 2446251538Srpaulo urtwn_write_4(sc, R92C_RCR, 2447251538Srpaulo R92C_RCR_AAP | R92C_RCR_APM | R92C_RCR_AM | R92C_RCR_AB | 2448251538Srpaulo R92C_RCR_APP_ICV | R92C_RCR_AMF | R92C_RCR_HTC_LOC_CTRL | 2449251538Srpaulo R92C_RCR_APP_MIC | R92C_RCR_APP_PHYSTS); 2450251538Srpaulo /* Accept all multicast frames. */ 2451251538Srpaulo urtwn_write_4(sc, R92C_MAR + 0, 0xffffffff); 2452251538Srpaulo urtwn_write_4(sc, R92C_MAR + 4, 0xffffffff); 2453251538Srpaulo /* Accept all management frames. */ 2454251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP0, 0xffff); 2455251538Srpaulo /* Reject all control frames. */ 2456251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP1, 0x0000); 2457251538Srpaulo /* Accept all data frames. */ 2458251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff); 2459251538Srpaulo} 2460251538Srpaulo 2461251538Srpaulostatic void 2462251538Srpaulourtwn_edca_init(struct urtwn_softc *sc) 2463251538Srpaulo{ 2464251538Srpaulo urtwn_write_2(sc, R92C_SPEC_SIFS, 0x100a); 2465251538Srpaulo urtwn_write_2(sc, R92C_MAC_SPEC_SIFS, 0x100a); 2466251538Srpaulo urtwn_write_2(sc, R92C_SIFS_CCK, 0x100a); 2467251538Srpaulo urtwn_write_2(sc, R92C_SIFS_OFDM, 0x100a); 2468251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x005ea42b); 2469251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a44f); 2470251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005ea324); 2471251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002fa226); 2472251538Srpaulo} 2473251538Srpaulo 2474251538Srpaulovoid 2475251538Srpaulourtwn_write_txpower(struct urtwn_softc *sc, int chain, 2476251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]) 2477251538Srpaulo{ 2478251538Srpaulo uint32_t reg; 2479251538Srpaulo 2480251538Srpaulo /* Write per-CCK rate Tx power. */ 2481251538Srpaulo if (chain == 0) { 2482251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_A_CCK1_MCS32); 2483251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK1, power[0]); 2484251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_A_CCK1_MCS32, reg); 2485251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11); 2486251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK2, power[1]); 2487251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK55, power[2]); 2488251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK11, power[3]); 2489251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg); 2490251538Srpaulo } else { 2491251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK1_55_MCS32); 2492251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK1, power[0]); 2493251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK2, power[1]); 2494251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK55, power[2]); 2495251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK1_55_MCS32, reg); 2496251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11); 2497251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK11, power[3]); 2498251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg); 2499251538Srpaulo } 2500251538Srpaulo /* Write per-OFDM rate Tx power. */ 2501251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_RATE18_06(chain), 2502251538Srpaulo SM(R92C_TXAGC_RATE06, power[ 4]) | 2503251538Srpaulo SM(R92C_TXAGC_RATE09, power[ 5]) | 2504251538Srpaulo SM(R92C_TXAGC_RATE12, power[ 6]) | 2505251538Srpaulo SM(R92C_TXAGC_RATE18, power[ 7])); 2506251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_RATE54_24(chain), 2507251538Srpaulo SM(R92C_TXAGC_RATE24, power[ 8]) | 2508251538Srpaulo SM(R92C_TXAGC_RATE36, power[ 9]) | 2509251538Srpaulo SM(R92C_TXAGC_RATE48, power[10]) | 2510251538Srpaulo SM(R92C_TXAGC_RATE54, power[11])); 2511251538Srpaulo /* Write per-MCS Tx power. */ 2512251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS03_MCS00(chain), 2513251538Srpaulo SM(R92C_TXAGC_MCS00, power[12]) | 2514251538Srpaulo SM(R92C_TXAGC_MCS01, power[13]) | 2515251538Srpaulo SM(R92C_TXAGC_MCS02, power[14]) | 2516251538Srpaulo SM(R92C_TXAGC_MCS03, power[15])); 2517251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS07_MCS04(chain), 2518251538Srpaulo SM(R92C_TXAGC_MCS04, power[16]) | 2519251538Srpaulo SM(R92C_TXAGC_MCS05, power[17]) | 2520251538Srpaulo SM(R92C_TXAGC_MCS06, power[18]) | 2521251538Srpaulo SM(R92C_TXAGC_MCS07, power[19])); 2522251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS11_MCS08(chain), 2523251538Srpaulo SM(R92C_TXAGC_MCS08, power[20]) | 2524261506Skevlo SM(R92C_TXAGC_MCS09, power[21]) | 2525251538Srpaulo SM(R92C_TXAGC_MCS10, power[22]) | 2526251538Srpaulo SM(R92C_TXAGC_MCS11, power[23])); 2527251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS15_MCS12(chain), 2528251538Srpaulo SM(R92C_TXAGC_MCS12, power[24]) | 2529251538Srpaulo SM(R92C_TXAGC_MCS13, power[25]) | 2530251538Srpaulo SM(R92C_TXAGC_MCS14, power[26]) | 2531251538Srpaulo SM(R92C_TXAGC_MCS15, power[27])); 2532251538Srpaulo} 2533251538Srpaulo 2534251538Srpaulovoid 2535251538Srpaulourtwn_get_txpower(struct urtwn_softc *sc, int chain, 2536251538Srpaulo struct ieee80211_channel *c, struct ieee80211_channel *extc, 2537251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]) 2538251538Srpaulo{ 2539251538Srpaulo struct ieee80211com *ic = sc->sc_ifp->if_l2com; 2540251538Srpaulo struct r92c_rom *rom = &sc->rom; 2541251538Srpaulo uint16_t cckpow, ofdmpow, htpow, diff, max; 2542251538Srpaulo const struct urtwn_txpwr *base; 2543251538Srpaulo int ridx, chan, group; 2544251538Srpaulo 2545251538Srpaulo /* Determine channel group. */ 2546251538Srpaulo chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */ 2547251538Srpaulo if (chan <= 3) 2548251538Srpaulo group = 0; 2549251538Srpaulo else if (chan <= 9) 2550251538Srpaulo group = 1; 2551251538Srpaulo else 2552251538Srpaulo group = 2; 2553251538Srpaulo 2554251538Srpaulo /* Get original Tx power based on board type and RF chain. */ 2555251538Srpaulo if (!(sc->chip & URTWN_CHIP_92C)) { 2556251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 2557251538Srpaulo base = &rtl8188ru_txagc[chain]; 2558251538Srpaulo else 2559251538Srpaulo base = &rtl8192cu_txagc[chain]; 2560251538Srpaulo } else 2561251538Srpaulo base = &rtl8192cu_txagc[chain]; 2562251538Srpaulo 2563251538Srpaulo memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0])); 2564251538Srpaulo if (sc->regulatory == 0) { 2565251538Srpaulo for (ridx = 0; ridx <= 3; ridx++) 2566251538Srpaulo power[ridx] = base->pwr[0][ridx]; 2567251538Srpaulo } 2568251538Srpaulo for (ridx = 4; ridx < URTWN_RIDX_COUNT; ridx++) { 2569251538Srpaulo if (sc->regulatory == 3) { 2570251538Srpaulo power[ridx] = base->pwr[0][ridx]; 2571251538Srpaulo /* Apply vendor limits. */ 2572251538Srpaulo if (extc != NULL) 2573251538Srpaulo max = rom->ht40_max_pwr[group]; 2574251538Srpaulo else 2575251538Srpaulo max = rom->ht20_max_pwr[group]; 2576251538Srpaulo max = (max >> (chain * 4)) & 0xf; 2577251538Srpaulo if (power[ridx] > max) 2578251538Srpaulo power[ridx] = max; 2579251538Srpaulo } else if (sc->regulatory == 1) { 2580251538Srpaulo if (extc == NULL) 2581251538Srpaulo power[ridx] = base->pwr[group][ridx]; 2582251538Srpaulo } else if (sc->regulatory != 2) 2583251538Srpaulo power[ridx] = base->pwr[0][ridx]; 2584251538Srpaulo } 2585251538Srpaulo 2586251538Srpaulo /* Compute per-CCK rate Tx power. */ 2587251538Srpaulo cckpow = rom->cck_tx_pwr[chain][group]; 2588251538Srpaulo for (ridx = 0; ridx <= 3; ridx++) { 2589251538Srpaulo power[ridx] += cckpow; 2590251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 2591251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 2592251538Srpaulo } 2593251538Srpaulo 2594251538Srpaulo htpow = rom->ht40_1s_tx_pwr[chain][group]; 2595251538Srpaulo if (sc->ntxchains > 1) { 2596251538Srpaulo /* Apply reduction for 2 spatial streams. */ 2597251538Srpaulo diff = rom->ht40_2s_tx_pwr_diff[group]; 2598251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 2599251538Srpaulo htpow = (htpow > diff) ? htpow - diff : 0; 2600251538Srpaulo } 2601251538Srpaulo 2602251538Srpaulo /* Compute per-OFDM rate Tx power. */ 2603251538Srpaulo diff = rom->ofdm_tx_pwr_diff[group]; 2604251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 2605251538Srpaulo ofdmpow = htpow + diff; /* HT->OFDM correction. */ 2606251538Srpaulo for (ridx = 4; ridx <= 11; ridx++) { 2607251538Srpaulo power[ridx] += ofdmpow; 2608251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 2609251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 2610251538Srpaulo } 2611251538Srpaulo 2612251538Srpaulo /* Compute per-MCS Tx power. */ 2613251538Srpaulo if (extc == NULL) { 2614251538Srpaulo diff = rom->ht20_tx_pwr_diff[group]; 2615251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 2616251538Srpaulo htpow += diff; /* HT40->HT20 correction. */ 2617251538Srpaulo } 2618251538Srpaulo for (ridx = 12; ridx <= 27; ridx++) { 2619251538Srpaulo power[ridx] += htpow; 2620251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 2621251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 2622251538Srpaulo } 2623251538Srpaulo#ifdef URTWN_DEBUG 2624251538Srpaulo if (urtwn_debug >= 4) { 2625251538Srpaulo /* Dump per-rate Tx power values. */ 2626251538Srpaulo printf("Tx power for chain %d:\n", chain); 2627251538Srpaulo for (ridx = 0; ridx < URTWN_RIDX_COUNT; ridx++) 2628251538Srpaulo printf("Rate %d = %u\n", ridx, power[ridx]); 2629251538Srpaulo } 2630251538Srpaulo#endif 2631251538Srpaulo} 2632251538Srpaulo 2633251538Srpaulovoid 2634251538Srpaulourtwn_set_txpower(struct urtwn_softc *sc, struct ieee80211_channel *c, 2635251538Srpaulo struct ieee80211_channel *extc) 2636251538Srpaulo{ 2637251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]; 2638251538Srpaulo int i; 2639251538Srpaulo 2640251538Srpaulo for (i = 0; i < sc->ntxchains; i++) { 2641251538Srpaulo /* Compute per-rate Tx power values. */ 2642251538Srpaulo urtwn_get_txpower(sc, i, c, extc, power); 2643251538Srpaulo /* Write per-rate Tx power values to hardware. */ 2644251538Srpaulo urtwn_write_txpower(sc, i, power); 2645251538Srpaulo } 2646251538Srpaulo} 2647251538Srpaulo 2648251538Srpaulostatic void 2649251538Srpaulourtwn_scan_start(struct ieee80211com *ic) 2650251538Srpaulo{ 2651251538Srpaulo /* XXX do nothing? */ 2652251538Srpaulo} 2653251538Srpaulo 2654251538Srpaulostatic void 2655251538Srpaulourtwn_scan_end(struct ieee80211com *ic) 2656251538Srpaulo{ 2657251538Srpaulo /* XXX do nothing? */ 2658251538Srpaulo} 2659251538Srpaulo 2660251538Srpaulostatic void 2661251538Srpaulourtwn_set_channel(struct ieee80211com *ic) 2662251538Srpaulo{ 2663251538Srpaulo struct urtwn_softc *sc = ic->ic_ifp->if_softc; 2664251538Srpaulo 2665251538Srpaulo URTWN_LOCK(sc); 2666251538Srpaulo urtwn_set_chan(sc, ic->ic_curchan, NULL); 2667251538Srpaulo URTWN_UNLOCK(sc); 2668251538Srpaulo} 2669251538Srpaulo 2670251538Srpaulostatic void 2671251538Srpaulourtwn_update_mcast(struct ifnet *ifp) 2672251538Srpaulo{ 2673251538Srpaulo /* XXX do nothing? */ 2674251538Srpaulo} 2675251538Srpaulo 2676251538Srpaulostatic void 2677251538Srpaulourtwn_set_chan(struct urtwn_softc *sc, struct ieee80211_channel *c, 2678251538Srpaulo struct ieee80211_channel *extc) 2679251538Srpaulo{ 2680251538Srpaulo struct ieee80211com *ic = sc->sc_ifp->if_l2com; 2681251538Srpaulo uint32_t reg; 2682251538Srpaulo u_int chan; 2683251538Srpaulo int i; 2684251538Srpaulo 2685251538Srpaulo chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */ 2686251538Srpaulo if (chan == 0 || chan == IEEE80211_CHAN_ANY) { 2687251538Srpaulo device_printf(sc->sc_dev, 2688251538Srpaulo "%s: invalid channel %x\n", __func__, chan); 2689251538Srpaulo return; 2690251538Srpaulo } 2691251538Srpaulo 2692251538Srpaulo /* Set Tx power for this new channel. */ 2693251538Srpaulo urtwn_set_txpower(sc, c, extc); 2694251538Srpaulo 2695251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 2696251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_CHNLBW, 2697251538Srpaulo RW(sc->rf_chnlbw[i], R92C_RF_CHNLBW_CHNL, chan)); 2698251538Srpaulo } 2699251538Srpaulo#ifndef IEEE80211_NO_HT 2700251538Srpaulo if (extc != NULL) { 2701251538Srpaulo /* Is secondary channel below or above primary? */ 2702251538Srpaulo int prichlo = c->ic_freq < extc->ic_freq; 2703251538Srpaulo 2704251538Srpaulo urtwn_write_1(sc, R92C_BWOPMODE, 2705251538Srpaulo urtwn_read_1(sc, R92C_BWOPMODE) & ~R92C_BWOPMODE_20MHZ); 2706251538Srpaulo 2707251538Srpaulo reg = urtwn_read_1(sc, R92C_RRSR + 2); 2708251538Srpaulo reg = (reg & ~0x6f) | (prichlo ? 1 : 2) << 5; 2709251538Srpaulo urtwn_write_1(sc, R92C_RRSR + 2, reg); 2710251538Srpaulo 2711251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFMOD, 2712251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_RFMOD) | R92C_RFMOD_40MHZ); 2713251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_RFMOD, 2714251538Srpaulo urtwn_bb_read(sc, R92C_FPGA1_RFMOD) | R92C_RFMOD_40MHZ); 2715251538Srpaulo 2716251538Srpaulo /* Set CCK side band. */ 2717251538Srpaulo reg = urtwn_bb_read(sc, R92C_CCK0_SYSTEM); 2718251538Srpaulo reg = (reg & ~0x00000010) | (prichlo ? 0 : 1) << 4; 2719251538Srpaulo urtwn_bb_write(sc, R92C_CCK0_SYSTEM, reg); 2720251538Srpaulo 2721251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM1_LSTF); 2722251538Srpaulo reg = (reg & ~0x00000c00) | (prichlo ? 1 : 2) << 10; 2723251538Srpaulo urtwn_bb_write(sc, R92C_OFDM1_LSTF, reg); 2724251538Srpaulo 2725251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2, 2726251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) & 2727251538Srpaulo ~R92C_FPGA0_ANAPARAM2_CBW20); 2728251538Srpaulo 2729251538Srpaulo reg = urtwn_bb_read(sc, 0x818); 2730251538Srpaulo reg = (reg & ~0x0c000000) | (prichlo ? 2 : 1) << 26; 2731251538Srpaulo urtwn_bb_write(sc, 0x818, reg); 2732251538Srpaulo 2733251538Srpaulo /* Select 40MHz bandwidth. */ 2734251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 2735251538Srpaulo (sc->rf_chnlbw[0] & ~0xfff) | chan); 2736251538Srpaulo } else 2737251538Srpaulo#endif 2738251538Srpaulo { 2739251538Srpaulo urtwn_write_1(sc, R92C_BWOPMODE, 2740251538Srpaulo urtwn_read_1(sc, R92C_BWOPMODE) | R92C_BWOPMODE_20MHZ); 2741251538Srpaulo 2742251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFMOD, 2743251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_RFMOD) & ~R92C_RFMOD_40MHZ); 2744251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_RFMOD, 2745251538Srpaulo urtwn_bb_read(sc, R92C_FPGA1_RFMOD) & ~R92C_RFMOD_40MHZ); 2746251538Srpaulo 2747251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2, 2748251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) | 2749251538Srpaulo R92C_FPGA0_ANAPARAM2_CBW20); 2750251538Srpaulo 2751251538Srpaulo /* Select 20MHz bandwidth. */ 2752251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 2753251538Srpaulo (sc->rf_chnlbw[0] & ~0xfff) | R92C_RF_CHNLBW_BW20 | chan); 2754251538Srpaulo } 2755251538Srpaulo} 2756251538Srpaulo 2757251538Srpaulostatic void 2758251538Srpaulourtwn_iq_calib(struct urtwn_softc *sc) 2759251538Srpaulo{ 2760251538Srpaulo /* TODO */ 2761251538Srpaulo} 2762251538Srpaulo 2763251538Srpaulostatic void 2764251538Srpaulourtwn_lc_calib(struct urtwn_softc *sc) 2765251538Srpaulo{ 2766251538Srpaulo uint32_t rf_ac[2]; 2767251538Srpaulo uint8_t txmode; 2768251538Srpaulo int i; 2769251538Srpaulo 2770251538Srpaulo txmode = urtwn_read_1(sc, R92C_OFDM1_LSTF + 3); 2771251538Srpaulo if ((txmode & 0x70) != 0) { 2772251538Srpaulo /* Disable all continuous Tx. */ 2773251538Srpaulo urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode & ~0x70); 2774251538Srpaulo 2775251538Srpaulo /* Set RF mode to standby mode. */ 2776251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 2777251538Srpaulo rf_ac[i] = urtwn_rf_read(sc, i, R92C_RF_AC); 2778251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_AC, 2779251538Srpaulo RW(rf_ac[i], R92C_RF_AC_MODE, 2780251538Srpaulo R92C_RF_AC_MODE_STANDBY)); 2781251538Srpaulo } 2782251538Srpaulo } else { 2783251538Srpaulo /* Block all Tx queues. */ 2784251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 0xff); 2785251538Srpaulo } 2786251538Srpaulo /* Start calibration. */ 2787251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 2788251538Srpaulo urtwn_rf_read(sc, 0, R92C_RF_CHNLBW) | R92C_RF_CHNLBW_LCSTART); 2789251538Srpaulo 2790251538Srpaulo /* Give calibration the time to complete. */ 2791251538Srpaulo usb_pause_mtx(&sc->sc_mtx, 100); 2792251538Srpaulo 2793251538Srpaulo /* Restore configuration. */ 2794251538Srpaulo if ((txmode & 0x70) != 0) { 2795251538Srpaulo /* Restore Tx mode. */ 2796251538Srpaulo urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode); 2797251538Srpaulo /* Restore RF mode. */ 2798251538Srpaulo for (i = 0; i < sc->nrxchains; i++) 2799251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_AC, rf_ac[i]); 2800251538Srpaulo } else { 2801251538Srpaulo /* Unblock all Tx queues. */ 2802251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 0x00); 2803251538Srpaulo } 2804251538Srpaulo} 2805251538Srpaulo 2806251538Srpaulostatic void 2807251538Srpaulourtwn_init_locked(void *arg) 2808251538Srpaulo{ 2809251538Srpaulo struct urtwn_softc *sc = arg; 2810251538Srpaulo struct ifnet *ifp = sc->sc_ifp; 2811251538Srpaulo uint32_t reg; 2812251538Srpaulo int error; 2813251538Srpaulo 2814251538Srpaulo if (ifp->if_drv_flags & IFF_DRV_RUNNING) 2815263153Skevlo urtwn_stop_locked(ifp); 2816251538Srpaulo 2817251538Srpaulo /* Init firmware commands ring. */ 2818251538Srpaulo sc->fwcur = 0; 2819251538Srpaulo 2820251538Srpaulo /* Allocate Tx/Rx buffers. */ 2821251538Srpaulo error = urtwn_alloc_rx_list(sc); 2822251538Srpaulo if (error != 0) 2823251538Srpaulo goto fail; 2824251538Srpaulo 2825251538Srpaulo error = urtwn_alloc_tx_list(sc); 2826251538Srpaulo if (error != 0) 2827251538Srpaulo goto fail; 2828251538Srpaulo 2829251538Srpaulo /* Power on adapter. */ 2830251538Srpaulo error = urtwn_power_on(sc); 2831251538Srpaulo if (error != 0) 2832251538Srpaulo goto fail; 2833251538Srpaulo 2834251538Srpaulo /* Initialize DMA. */ 2835251538Srpaulo error = urtwn_dma_init(sc); 2836251538Srpaulo if (error != 0) 2837251538Srpaulo goto fail; 2838251538Srpaulo 2839251538Srpaulo /* Set info size in Rx descriptors (in 64-bit words). */ 2840251538Srpaulo urtwn_write_1(sc, R92C_RX_DRVINFO_SZ, 4); 2841251538Srpaulo 2842251538Srpaulo /* Init interrupts. */ 2843251538Srpaulo urtwn_write_4(sc, R92C_HISR, 0xffffffff); 2844251538Srpaulo urtwn_write_4(sc, R92C_HIMR, 0xffffffff); 2845251538Srpaulo 2846251538Srpaulo /* Set MAC address. */ 2847251538Srpaulo urtwn_write_region_1(sc, R92C_MACID, IF_LLADDR(ifp), 2848251538Srpaulo IEEE80211_ADDR_LEN); 2849251538Srpaulo 2850251538Srpaulo /* Set initial network type. */ 2851251538Srpaulo reg = urtwn_read_4(sc, R92C_CR); 2852251538Srpaulo reg = RW(reg, R92C_CR_NETTYPE, R92C_CR_NETTYPE_INFRA); 2853251538Srpaulo urtwn_write_4(sc, R92C_CR, reg); 2854251538Srpaulo 2855251538Srpaulo urtwn_rxfilter_init(sc); 2856251538Srpaulo 2857251538Srpaulo reg = urtwn_read_4(sc, R92C_RRSR); 2858251538Srpaulo reg = RW(reg, R92C_RRSR_RATE_BITMAP, R92C_RRSR_RATE_CCK_ONLY_1M); 2859251538Srpaulo urtwn_write_4(sc, R92C_RRSR, reg); 2860251538Srpaulo 2861251538Srpaulo /* Set short/long retry limits. */ 2862251538Srpaulo urtwn_write_2(sc, R92C_RL, 2863251538Srpaulo SM(R92C_RL_SRL, 0x30) | SM(R92C_RL_LRL, 0x30)); 2864251538Srpaulo 2865251538Srpaulo /* Initialize EDCA parameters. */ 2866251538Srpaulo urtwn_edca_init(sc); 2867251538Srpaulo 2868251538Srpaulo /* Setup rate fallback. */ 2869251538Srpaulo urtwn_write_4(sc, R92C_DARFRC + 0, 0x00000000); 2870251538Srpaulo urtwn_write_4(sc, R92C_DARFRC + 4, 0x10080404); 2871251538Srpaulo urtwn_write_4(sc, R92C_RARFRC + 0, 0x04030201); 2872251538Srpaulo urtwn_write_4(sc, R92C_RARFRC + 4, 0x08070605); 2873251538Srpaulo 2874251538Srpaulo urtwn_write_1(sc, R92C_FWHW_TXQ_CTRL, 2875251538Srpaulo urtwn_read_1(sc, R92C_FWHW_TXQ_CTRL) | 2876251538Srpaulo R92C_FWHW_TXQ_CTRL_AMPDU_RTY_NEW); 2877251538Srpaulo /* Set ACK timeout. */ 2878251538Srpaulo urtwn_write_1(sc, R92C_ACKTO, 0x40); 2879251538Srpaulo 2880251538Srpaulo /* Setup USB aggregation. */ 2881251538Srpaulo reg = urtwn_read_4(sc, R92C_TDECTRL); 2882251538Srpaulo reg = RW(reg, R92C_TDECTRL_BLK_DESC_NUM, 6); 2883251538Srpaulo urtwn_write_4(sc, R92C_TDECTRL, reg); 2884251538Srpaulo urtwn_write_1(sc, R92C_TRXDMA_CTRL, 2885251538Srpaulo urtwn_read_1(sc, R92C_TRXDMA_CTRL) | 2886251538Srpaulo R92C_TRXDMA_CTRL_RXDMA_AGG_EN); 2887251538Srpaulo urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION, 2888251538Srpaulo urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) | 2889251538Srpaulo R92C_USB_SPECIAL_OPTION_AGG_EN); 2890251538Srpaulo urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH, 48); 2891251538Srpaulo urtwn_write_1(sc, R92C_USB_DMA_AGG_TO, 4); 2892251538Srpaulo urtwn_write_1(sc, R92C_USB_AGG_TH, 8); 2893251538Srpaulo urtwn_write_1(sc, R92C_USB_AGG_TO, 6); 2894251538Srpaulo 2895251538Srpaulo /* Initialize beacon parameters. */ 2896251538Srpaulo urtwn_write_2(sc, R92C_TBTT_PROHIBIT, 0x6404); 2897251538Srpaulo urtwn_write_1(sc, R92C_DRVERLYINT, 0x05); 2898251538Srpaulo urtwn_write_1(sc, R92C_BCNDMATIM, 0x02); 2899251538Srpaulo urtwn_write_2(sc, R92C_BCNTCFG, 0x660f); 2900251538Srpaulo 2901251538Srpaulo /* Setup AMPDU aggregation. */ 2902251538Srpaulo urtwn_write_4(sc, R92C_AGGLEN_LMT, 0x99997631); /* MCS7~0 */ 2903251538Srpaulo urtwn_write_1(sc, R92C_AGGR_BREAK_TIME, 0x16); 2904251538Srpaulo urtwn_write_2(sc, 0x4ca, 0x0708); 2905251538Srpaulo 2906251538Srpaulo urtwn_write_1(sc, R92C_BCN_MAX_ERR, 0xff); 2907251538Srpaulo urtwn_write_1(sc, R92C_BCN_CTRL, R92C_BCN_CTRL_DIS_TSF_UDT0); 2908251538Srpaulo 2909251538Srpaulo /* Load 8051 microcode. */ 2910251538Srpaulo error = urtwn_load_firmware(sc); 2911251538Srpaulo if (error != 0) 2912251538Srpaulo goto fail; 2913251538Srpaulo 2914251538Srpaulo /* Initialize MAC/BB/RF blocks. */ 2915251538Srpaulo urtwn_mac_init(sc); 2916251538Srpaulo urtwn_bb_init(sc); 2917251538Srpaulo urtwn_rf_init(sc); 2918251538Srpaulo 2919251538Srpaulo /* Turn CCK and OFDM blocks on. */ 2920251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD); 2921251538Srpaulo reg |= R92C_RFMOD_CCK_EN; 2922251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg); 2923251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD); 2924251538Srpaulo reg |= R92C_RFMOD_OFDM_EN; 2925251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg); 2926251538Srpaulo 2927251538Srpaulo /* Clear per-station keys table. */ 2928251538Srpaulo urtwn_cam_init(sc); 2929251538Srpaulo 2930251538Srpaulo /* Enable hardware sequence numbering. */ 2931251538Srpaulo urtwn_write_1(sc, R92C_HWSEQ_CTRL, 0xff); 2932251538Srpaulo 2933251538Srpaulo /* Perform LO and IQ calibrations. */ 2934251538Srpaulo urtwn_iq_calib(sc); 2935251538Srpaulo /* Perform LC calibration. */ 2936251538Srpaulo urtwn_lc_calib(sc); 2937251538Srpaulo 2938251538Srpaulo /* Fix USB interference issue. */ 2939251538Srpaulo urtwn_write_1(sc, 0xfe40, 0xe0); 2940251538Srpaulo urtwn_write_1(sc, 0xfe41, 0x8d); 2941251538Srpaulo urtwn_write_1(sc, 0xfe42, 0x80); 2942251538Srpaulo 2943251538Srpaulo urtwn_pa_bias_init(sc); 2944251538Srpaulo 2945251538Srpaulo /* Initialize GPIO setting. */ 2946251538Srpaulo urtwn_write_1(sc, R92C_GPIO_MUXCFG, 2947251538Srpaulo urtwn_read_1(sc, R92C_GPIO_MUXCFG) & ~R92C_GPIO_MUXCFG_ENBT); 2948251538Srpaulo 2949251538Srpaulo /* Fix for lower temperature. */ 2950251538Srpaulo urtwn_write_1(sc, 0x15, 0xe9); 2951251538Srpaulo 2952251538Srpaulo usbd_transfer_start(sc->sc_xfer[URTWN_BULK_RX]); 2953251538Srpaulo 2954251538Srpaulo ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 2955251538Srpaulo ifp->if_drv_flags |= IFF_DRV_RUNNING; 2956251538Srpaulo 2957251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 2958251538Srpaulofail: 2959251538Srpaulo return; 2960251538Srpaulo} 2961251538Srpaulo 2962251538Srpaulostatic void 2963251538Srpaulourtwn_init(void *arg) 2964251538Srpaulo{ 2965251538Srpaulo struct urtwn_softc *sc = arg; 2966251538Srpaulo 2967251538Srpaulo URTWN_LOCK(sc); 2968251538Srpaulo urtwn_init_locked(arg); 2969251538Srpaulo URTWN_UNLOCK(sc); 2970251538Srpaulo} 2971251538Srpaulo 2972251538Srpaulostatic void 2973263153Skevlourtwn_stop_locked(struct ifnet *ifp) 2974251538Srpaulo{ 2975251538Srpaulo struct urtwn_softc *sc = ifp->if_softc; 2976251538Srpaulo 2977251538Srpaulo ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 2978251538Srpaulo 2979251538Srpaulo callout_stop(&sc->sc_watchdog_ch); 2980251538Srpaulo urtwn_abort_xfers(sc); 2981251538Srpaulo} 2982251538Srpaulo 2983251538Srpaulostatic void 2984263153Skevlourtwn_stop(struct ifnet *ifp) 2985251538Srpaulo{ 2986251538Srpaulo struct urtwn_softc *sc = ifp->if_softc; 2987251538Srpaulo 2988251538Srpaulo URTWN_LOCK(sc); 2989263153Skevlo urtwn_stop_locked(ifp); 2990251538Srpaulo URTWN_UNLOCK(sc); 2991251538Srpaulo} 2992251538Srpaulo 2993251538Srpaulostatic void 2994251538Srpaulourtwn_abort_xfers(struct urtwn_softc *sc) 2995251538Srpaulo{ 2996251538Srpaulo int i; 2997251538Srpaulo 2998251538Srpaulo URTWN_ASSERT_LOCKED(sc); 2999251538Srpaulo 3000251538Srpaulo /* abort any pending transfers */ 3001251538Srpaulo for (i = 0; i < URTWN_N_TRANSFER; i++) 3002251538Srpaulo usbd_transfer_stop(sc->sc_xfer[i]); 3003251538Srpaulo} 3004251538Srpaulo 3005251538Srpaulostatic int 3006251538Srpaulourtwn_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 3007251538Srpaulo const struct ieee80211_bpf_params *params) 3008251538Srpaulo{ 3009251538Srpaulo struct ieee80211com *ic = ni->ni_ic; 3010251538Srpaulo struct ifnet *ifp = ic->ic_ifp; 3011251538Srpaulo struct urtwn_softc *sc = ifp->if_softc; 3012251538Srpaulo struct urtwn_data *bf; 3013251538Srpaulo 3014251538Srpaulo /* prevent management frames from being sent if we're not ready */ 3015251538Srpaulo if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) { 3016251538Srpaulo m_freem(m); 3017251538Srpaulo ieee80211_free_node(ni); 3018251538Srpaulo return (ENETDOWN); 3019251538Srpaulo } 3020251538Srpaulo URTWN_LOCK(sc); 3021251538Srpaulo bf = urtwn_getbuf(sc); 3022251538Srpaulo if (bf == NULL) { 3023251538Srpaulo ieee80211_free_node(ni); 3024251538Srpaulo m_freem(m); 3025251538Srpaulo URTWN_UNLOCK(sc); 3026251538Srpaulo return (ENOBUFS); 3027251538Srpaulo } 3028251538Srpaulo 3029251538Srpaulo ifp->if_opackets++; 3030251538Srpaulo if (urtwn_tx_start(sc, ni, m, bf) != 0) { 3031251538Srpaulo ieee80211_free_node(ni); 3032251538Srpaulo ifp->if_oerrors++; 3033251538Srpaulo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 3034251538Srpaulo URTWN_UNLOCK(sc); 3035251538Srpaulo return (EIO); 3036251538Srpaulo } 3037251538Srpaulo URTWN_UNLOCK(sc); 3038251538Srpaulo 3039251538Srpaulo sc->sc_txtimer = 5; 3040251538Srpaulo return (0); 3041251538Srpaulo} 3042251538Srpaulo 3043251538Srpaulostatic device_method_t urtwn_methods[] = { 3044251538Srpaulo /* Device interface */ 3045251538Srpaulo DEVMETHOD(device_probe, urtwn_match), 3046251538Srpaulo DEVMETHOD(device_attach, urtwn_attach), 3047251538Srpaulo DEVMETHOD(device_detach, urtwn_detach), 3048251538Srpaulo 3049251538Srpaulo { 0, 0 } 3050251538Srpaulo}; 3051251538Srpaulo 3052251538Srpaulostatic driver_t urtwn_driver = { 3053251538Srpaulo "urtwn", 3054251538Srpaulo urtwn_methods, 3055251538Srpaulo sizeof(struct urtwn_softc) 3056251538Srpaulo}; 3057251538Srpaulo 3058251538Srpaulostatic devclass_t urtwn_devclass; 3059251538Srpaulo 3060251538SrpauloDRIVER_MODULE(urtwn, uhub, urtwn_driver, urtwn_devclass, NULL, NULL); 3061251538SrpauloMODULE_DEPEND(urtwn, usb, 1, 1, 1); 3062251538SrpauloMODULE_DEPEND(urtwn, wlan, 1, 1, 1); 3063251538SrpauloMODULE_DEPEND(urtwn, firmware, 1, 1, 1); 3064251538SrpauloMODULE_VERSION(urtwn, 1); 3065