if_urtwn.c revision 295907
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> 5264912Skevlo * Copyright (c) 2014 Kevin Lo <kevlo@FreeBSD.org> 6292176Savos * Copyright (c) 2015 Andriy Voskoboinyk <avos@FreeBSD.org> 7251538Srpaulo * 8251538Srpaulo * Permission to use, copy, modify, and distribute this software for any 9251538Srpaulo * purpose with or without fee is hereby granted, provided that the above 10251538Srpaulo * copyright notice and this permission notice appear in all copies. 11251538Srpaulo * 12251538Srpaulo * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 13251538Srpaulo * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 14251538Srpaulo * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 15251538Srpaulo * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 16251538Srpaulo * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 17251538Srpaulo * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 18251538Srpaulo * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 19251538Srpaulo */ 20251538Srpaulo 21251538Srpaulo#include <sys/cdefs.h> 22251538Srpaulo__FBSDID("$FreeBSD: head/sys/dev/usb/wlan/if_urtwn.c 295907 2016-02-23 01:56:58Z kevlo $"); 23251538Srpaulo 24251538Srpaulo/* 25264912Skevlo * Driver for Realtek RTL8188CE-VAU/RTL8188CUS/RTL8188EU/RTL8188RU/RTL8192CU. 26251538Srpaulo */ 27251538Srpaulo 28288353Sadrian#include "opt_wlan.h" 29295871Savos#include "opt_urtwn.h" 30288353Sadrian 31251538Srpaulo#include <sys/param.h> 32251538Srpaulo#include <sys/sockio.h> 33251538Srpaulo#include <sys/sysctl.h> 34251538Srpaulo#include <sys/lock.h> 35251538Srpaulo#include <sys/mutex.h> 36291902Skevlo#include <sys/condvar.h> 37251538Srpaulo#include <sys/mbuf.h> 38251538Srpaulo#include <sys/kernel.h> 39251538Srpaulo#include <sys/socket.h> 40251538Srpaulo#include <sys/systm.h> 41251538Srpaulo#include <sys/malloc.h> 42251538Srpaulo#include <sys/module.h> 43251538Srpaulo#include <sys/bus.h> 44251538Srpaulo#include <sys/endian.h> 45251538Srpaulo#include <sys/linker.h> 46251538Srpaulo#include <sys/firmware.h> 47251538Srpaulo#include <sys/kdb.h> 48251538Srpaulo 49251538Srpaulo#include <machine/bus.h> 50251538Srpaulo#include <machine/resource.h> 51251538Srpaulo#include <sys/rman.h> 52251538Srpaulo 53251538Srpaulo#include <net/bpf.h> 54251538Srpaulo#include <net/if.h> 55257176Sglebius#include <net/if_var.h> 56251538Srpaulo#include <net/if_arp.h> 57251538Srpaulo#include <net/ethernet.h> 58251538Srpaulo#include <net/if_dl.h> 59251538Srpaulo#include <net/if_media.h> 60251538Srpaulo#include <net/if_types.h> 61251538Srpaulo 62251538Srpaulo#include <netinet/in.h> 63251538Srpaulo#include <netinet/in_systm.h> 64251538Srpaulo#include <netinet/in_var.h> 65251538Srpaulo#include <netinet/if_ether.h> 66251538Srpaulo#include <netinet/ip.h> 67251538Srpaulo 68251538Srpaulo#include <net80211/ieee80211_var.h> 69288088Sadrian#include <net80211/ieee80211_input.h> 70251538Srpaulo#include <net80211/ieee80211_regdomain.h> 71251538Srpaulo#include <net80211/ieee80211_radiotap.h> 72251538Srpaulo#include <net80211/ieee80211_ratectl.h> 73251538Srpaulo 74251538Srpaulo#include <dev/usb/usb.h> 75251538Srpaulo#include <dev/usb/usbdi.h> 76291902Skevlo#include <dev/usb/usb_device.h> 77251538Srpaulo#include "usbdevs.h" 78251538Srpaulo 79251538Srpaulo#include <dev/usb/usb_debug.h> 80251538Srpaulo 81251538Srpaulo#include <dev/usb/wlan/if_urtwnreg.h> 82289167Sadrian#include <dev/usb/wlan/if_urtwnvar.h> 83251538Srpaulo 84251538Srpaulo#ifdef USB_DEBUG 85294471Savosenum { 86294471Savos URTWN_DEBUG_XMIT = 0x00000001, /* basic xmit operation */ 87294471Savos URTWN_DEBUG_RECV = 0x00000002, /* basic recv operation */ 88294471Savos URTWN_DEBUG_STATE = 0x00000004, /* 802.11 state transitions */ 89294471Savos URTWN_DEBUG_RA = 0x00000008, /* f/w rate adaptation setup */ 90294471Savos URTWN_DEBUG_USB = 0x00000010, /* usb requests */ 91294471Savos URTWN_DEBUG_FIRMWARE = 0x00000020, /* firmware(9) loading debug */ 92294471Savos URTWN_DEBUG_BEACON = 0x00000040, /* beacon handling */ 93294471Savos URTWN_DEBUG_INTR = 0x00000080, /* ISR */ 94294471Savos URTWN_DEBUG_TEMP = 0x00000100, /* temperature calibration */ 95294471Savos URTWN_DEBUG_ROM = 0x00000200, /* various ROM info */ 96294471Savos URTWN_DEBUG_KEY = 0x00000400, /* crypto keys management */ 97294471Savos URTWN_DEBUG_TXPWR = 0x00000800, /* dump Tx power values */ 98294471Savos URTWN_DEBUG_ANY = 0xffffffff 99294471Savos}; 100251538Srpaulo 101294471Savos#define URTWN_DPRINTF(_sc, _m, ...) do { \ 102294471Savos if ((_sc)->sc_debug & (_m)) \ 103294471Savos device_printf((_sc)->sc_dev, __VA_ARGS__); \ 104294471Savos} while(0) 105294471Savos 106294471Savos#else 107294471Savos#define URTWN_DPRINTF(_sc, _m, ...) do { (void) sc; } while (0) 108251538Srpaulo#endif 109251538Srpaulo 110288088Sadrian#define IEEE80211_HAS_ADDR4(wh) IEEE80211_IS_DSTODS(wh) 111251538Srpaulo 112251538Srpaulo/* various supported device vendors/products */ 113251596Srpaulostatic const STRUCT_USB_HOST_ID urtwn_devs[] = { 114251538Srpaulo#define URTWN_DEV(v,p) { USB_VP(USB_VENDOR_##v, USB_PRODUCT_##v##_##p) } 115264912Skevlo#define URTWN_RTL8188E_DEV(v,p) \ 116264912Skevlo { USB_VPI(USB_VENDOR_##v, USB_PRODUCT_##v##_##p, URTWN_RTL8188E) } 117264912Skevlo#define URTWN_RTL8188E 1 118251538Srpaulo URTWN_DEV(ABOCOM, RTL8188CU_1), 119251538Srpaulo URTWN_DEV(ABOCOM, RTL8188CU_2), 120251538Srpaulo URTWN_DEV(ABOCOM, RTL8192CU), 121251538Srpaulo URTWN_DEV(ASUS, RTL8192CU), 122266721Skevlo URTWN_DEV(ASUS, USBN10NANO), 123251538Srpaulo URTWN_DEV(AZUREWAVE, RTL8188CE_1), 124251538Srpaulo URTWN_DEV(AZUREWAVE, RTL8188CE_2), 125251538Srpaulo URTWN_DEV(AZUREWAVE, RTL8188CU), 126251538Srpaulo URTWN_DEV(BELKIN, F7D2102), 127251538Srpaulo URTWN_DEV(BELKIN, RTL8188CU), 128251538Srpaulo URTWN_DEV(BELKIN, RTL8192CU), 129251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_1), 130251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_2), 131251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_3), 132251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_4), 133251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_5), 134251538Srpaulo URTWN_DEV(COREGA, RTL8192CU), 135251538Srpaulo URTWN_DEV(DLINK, RTL8188CU), 136251538Srpaulo URTWN_DEV(DLINK, RTL8192CU_1), 137251538Srpaulo URTWN_DEV(DLINK, RTL8192CU_2), 138251538Srpaulo URTWN_DEV(DLINK, RTL8192CU_3), 139252196Skevlo URTWN_DEV(DLINK, DWA131B), 140251538Srpaulo URTWN_DEV(EDIMAX, EW7811UN), 141251538Srpaulo URTWN_DEV(EDIMAX, RTL8192CU), 142251538Srpaulo URTWN_DEV(FEIXUN, RTL8188CU), 143251538Srpaulo URTWN_DEV(FEIXUN, RTL8192CU), 144251538Srpaulo URTWN_DEV(GUILLEMOT, HWNUP150), 145251538Srpaulo URTWN_DEV(HAWKING, RTL8192CU), 146251538Srpaulo URTWN_DEV(HP3, RTL8188CU), 147251538Srpaulo URTWN_DEV(NETGEAR, WNA1000M), 148251538Srpaulo URTWN_DEV(NETGEAR, RTL8192CU), 149251538Srpaulo URTWN_DEV(NETGEAR4, RTL8188CU), 150251538Srpaulo URTWN_DEV(NOVATECH, RTL8188CU), 151251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CU_1), 152251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CU_2), 153251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CU_3), 154251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CU_4), 155251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CUS), 156251538Srpaulo URTWN_DEV(PLANEX2, RTL8192CU), 157251538Srpaulo URTWN_DEV(REALTEK, RTL8188CE_0), 158251538Srpaulo URTWN_DEV(REALTEK, RTL8188CE_1), 159251538Srpaulo URTWN_DEV(REALTEK, RTL8188CTV), 160251538Srpaulo URTWN_DEV(REALTEK, RTL8188CU_0), 161251538Srpaulo URTWN_DEV(REALTEK, RTL8188CU_1), 162251538Srpaulo URTWN_DEV(REALTEK, RTL8188CU_2), 163282119Skevlo URTWN_DEV(REALTEK, RTL8188CU_3), 164251538Srpaulo URTWN_DEV(REALTEK, RTL8188CU_COMBO), 165251538Srpaulo URTWN_DEV(REALTEK, RTL8188CUS), 166251538Srpaulo URTWN_DEV(REALTEK, RTL8188RU_1), 167251538Srpaulo URTWN_DEV(REALTEK, RTL8188RU_2), 168272410Shselasky URTWN_DEV(REALTEK, RTL8188RU_3), 169251538Srpaulo URTWN_DEV(REALTEK, RTL8191CU), 170251538Srpaulo URTWN_DEV(REALTEK, RTL8192CE), 171251538Srpaulo URTWN_DEV(REALTEK, RTL8192CU), 172251538Srpaulo URTWN_DEV(SITECOMEU, RTL8188CU_1), 173251538Srpaulo URTWN_DEV(SITECOMEU, RTL8188CU_2), 174251538Srpaulo URTWN_DEV(SITECOMEU, RTL8192CU), 175251538Srpaulo URTWN_DEV(TRENDNET, RTL8188CU), 176251538Srpaulo URTWN_DEV(TRENDNET, RTL8192CU), 177251538Srpaulo URTWN_DEV(ZYXEL, RTL8192CU), 178264912Skevlo /* URTWN_RTL8188E */ 179295907Skevlo URTWN_RTL8188E_DEV(ABOCOM, RTL8188EU), 180273589Skevlo URTWN_RTL8188E_DEV(DLINK, DWA123D1), 181270191Skevlo URTWN_RTL8188E_DEV(DLINK, DWA125D1), 182273589Skevlo URTWN_RTL8188E_DEV(ELECOM, WDC150SU2M), 183264912Skevlo URTWN_RTL8188E_DEV(REALTEK, RTL8188ETV), 184264912Skevlo URTWN_RTL8188E_DEV(REALTEK, RTL8188EU), 185264912Skevlo#undef URTWN_RTL8188E_DEV 186251538Srpaulo#undef URTWN_DEV 187251538Srpaulo}; 188251538Srpaulo 189251538Srpaulostatic device_probe_t urtwn_match; 190251538Srpaulostatic device_attach_t urtwn_attach; 191251538Srpaulostatic device_detach_t urtwn_detach; 192251538Srpaulo 193251538Srpaulostatic usb_callback_t urtwn_bulk_tx_callback; 194251538Srpaulostatic usb_callback_t urtwn_bulk_rx_callback; 195251538Srpaulo 196294471Savosstatic void urtwn_sysctlattach(struct urtwn_softc *); 197294471Savosstatic void urtwn_drain_mbufq(struct urtwn_softc *); 198287197Sglebiusstatic usb_error_t urtwn_do_request(struct urtwn_softc *, 199287197Sglebius struct usb_device_request *, void *); 200251538Srpaulostatic struct ieee80211vap *urtwn_vap_create(struct ieee80211com *, 201251538Srpaulo const char [IFNAMSIZ], int, enum ieee80211_opmode, int, 202251538Srpaulo const uint8_t [IEEE80211_ADDR_LEN], 203251538Srpaulo const uint8_t [IEEE80211_ADDR_LEN]); 204251538Srpaulostatic void urtwn_vap_delete(struct ieee80211vap *); 205292207Savosstatic struct mbuf * urtwn_rx_copy_to_mbuf(struct urtwn_softc *, 206292207Savos struct r92c_rx_stat *, int); 207292207Savosstatic struct mbuf * urtwn_report_intr(struct usb_xfer *, 208292207Savos struct urtwn_data *); 209292207Savosstatic struct mbuf * urtwn_rxeof(struct urtwn_softc *, uint8_t *, int); 210292167Savosstatic void urtwn_r88e_ratectl_tx_complete(struct urtwn_softc *, 211292167Savos void *); 212292207Savosstatic struct ieee80211_node *urtwn_rx_frame(struct urtwn_softc *, 213292207Savos struct mbuf *, int8_t *); 214289891Savosstatic void urtwn_txeof(struct urtwn_softc *, struct urtwn_data *, 215289891Savos int); 216281069Srpaulostatic int urtwn_alloc_list(struct urtwn_softc *, 217251538Srpaulo struct urtwn_data[], int, int); 218251538Srpaulostatic int urtwn_alloc_rx_list(struct urtwn_softc *); 219251538Srpaulostatic int urtwn_alloc_tx_list(struct urtwn_softc *); 220251538Srpaulostatic void urtwn_free_list(struct urtwn_softc *, 221251538Srpaulo struct urtwn_data data[], int); 222289066Skevlostatic void urtwn_free_rx_list(struct urtwn_softc *); 223289066Skevlostatic void urtwn_free_tx_list(struct urtwn_softc *); 224251538Srpaulostatic struct urtwn_data * _urtwn_getbuf(struct urtwn_softc *); 225251538Srpaulostatic struct urtwn_data * urtwn_getbuf(struct urtwn_softc *); 226291698Savosstatic usb_error_t urtwn_write_region_1(struct urtwn_softc *, uint16_t, 227251538Srpaulo uint8_t *, int); 228291698Savosstatic usb_error_t urtwn_write_1(struct urtwn_softc *, uint16_t, uint8_t); 229291698Savosstatic usb_error_t urtwn_write_2(struct urtwn_softc *, uint16_t, uint16_t); 230291698Savosstatic usb_error_t urtwn_write_4(struct urtwn_softc *, uint16_t, uint32_t); 231291698Savosstatic usb_error_t urtwn_read_region_1(struct urtwn_softc *, uint16_t, 232251538Srpaulo uint8_t *, int); 233251538Srpaulostatic uint8_t urtwn_read_1(struct urtwn_softc *, uint16_t); 234251538Srpaulostatic uint16_t urtwn_read_2(struct urtwn_softc *, uint16_t); 235251538Srpaulostatic uint32_t urtwn_read_4(struct urtwn_softc *, uint16_t); 236281069Srpaulostatic int urtwn_fw_cmd(struct urtwn_softc *, uint8_t, 237251538Srpaulo const void *, int); 238292174Savosstatic void urtwn_cmdq_cb(void *, int); 239292174Savosstatic int urtwn_cmd_sleepable(struct urtwn_softc *, const void *, 240292174Savos size_t, CMD_FUNC_PROTO); 241264912Skevlostatic void urtwn_r92c_rf_write(struct urtwn_softc *, int, 242264912Skevlo uint8_t, uint32_t); 243281069Srpaulostatic void urtwn_r88e_rf_write(struct urtwn_softc *, int, 244264912Skevlo uint8_t, uint32_t); 245251538Srpaulostatic uint32_t urtwn_rf_read(struct urtwn_softc *, int, uint8_t); 246281069Srpaulostatic int urtwn_llt_write(struct urtwn_softc *, uint32_t, 247251538Srpaulo uint32_t); 248291264Savosstatic int urtwn_efuse_read_next(struct urtwn_softc *, uint8_t *); 249291264Savosstatic int urtwn_efuse_read_data(struct urtwn_softc *, uint8_t *, 250291264Savos uint8_t, uint8_t); 251294471Savos#ifdef USB_DEBUG 252291264Savosstatic void urtwn_dump_rom_contents(struct urtwn_softc *, 253291264Savos uint8_t *, uint16_t); 254291264Savos#endif 255291264Savosstatic int urtwn_efuse_read(struct urtwn_softc *, uint8_t *, 256291264Savos uint16_t); 257291698Savosstatic int urtwn_efuse_switch_power(struct urtwn_softc *); 258251538Srpaulostatic int urtwn_read_chipid(struct urtwn_softc *); 259291264Savosstatic int urtwn_read_rom(struct urtwn_softc *); 260291264Savosstatic int urtwn_r88e_read_rom(struct urtwn_softc *); 261251538Srpaulostatic int urtwn_ra_init(struct urtwn_softc *); 262290631Savosstatic void urtwn_init_beacon(struct urtwn_softc *, 263290631Savos struct urtwn_vap *); 264290631Savosstatic int urtwn_setup_beacon(struct urtwn_softc *, 265290631Savos struct ieee80211_node *); 266290631Savosstatic void urtwn_update_beacon(struct ieee80211vap *, int); 267290631Savosstatic int urtwn_tx_beacon(struct urtwn_softc *sc, 268290631Savos struct urtwn_vap *); 269292175Savosstatic int urtwn_key_alloc(struct ieee80211vap *, 270292175Savos struct ieee80211_key *, ieee80211_keyix *, 271292175Savos ieee80211_keyix *); 272292175Savosstatic void urtwn_key_set_cb(struct urtwn_softc *, 273292175Savos union sec_param *); 274292175Savosstatic void urtwn_key_del_cb(struct urtwn_softc *, 275292175Savos union sec_param *); 276292175Savosstatic int urtwn_key_set(struct ieee80211vap *, 277292175Savos const struct ieee80211_key *); 278292175Savosstatic int urtwn_key_delete(struct ieee80211vap *, 279292175Savos const struct ieee80211_key *); 280290651Savosstatic void urtwn_tsf_task_adhoc(void *, int); 281290631Savosstatic void urtwn_tsf_sync_enable(struct urtwn_softc *, 282290631Savos struct ieee80211vap *); 283292203Savosstatic void urtwn_get_tsf(struct urtwn_softc *, uint64_t *); 284251538Srpaulostatic void urtwn_set_led(struct urtwn_softc *, int, int); 285289811Savosstatic void urtwn_set_mode(struct urtwn_softc *, uint8_t); 286290651Savosstatic void urtwn_ibss_recv_mgmt(struct ieee80211_node *, 287290651Savos struct mbuf *, int, 288290651Savos const struct ieee80211_rx_stats *, int, int); 289281069Srpaulostatic int urtwn_newstate(struct ieee80211vap *, 290251538Srpaulo enum ieee80211_state, int); 291294473Savosstatic void urtwn_calib_to(void *); 292294473Savosstatic void urtwn_calib_cb(struct urtwn_softc *, 293294473Savos union sec_param *); 294251538Srpaulostatic void urtwn_watchdog(void *); 295251538Srpaulostatic void urtwn_update_avgrssi(struct urtwn_softc *, int, int8_t); 296251538Srpaulostatic int8_t urtwn_get_rssi(struct urtwn_softc *, int, void *); 297264912Skevlostatic int8_t urtwn_r88e_get_rssi(struct urtwn_softc *, int, void *); 298290630Savosstatic int urtwn_tx_data(struct urtwn_softc *, 299251538Srpaulo struct ieee80211_node *, struct mbuf *, 300251538Srpaulo struct urtwn_data *); 301292221Savosstatic int urtwn_tx_raw(struct urtwn_softc *, 302292221Savos struct ieee80211_node *, struct mbuf *, 303292221Savos struct urtwn_data *, 304292221Savos const struct ieee80211_bpf_params *); 305290630Savosstatic void urtwn_tx_start(struct urtwn_softc *, struct mbuf *, 306290630Savos uint8_t, struct urtwn_data *); 307287197Sglebiusstatic int urtwn_transmit(struct ieee80211com *, struct mbuf *); 308287197Sglebiusstatic void urtwn_start(struct urtwn_softc *); 309287197Sglebiusstatic void urtwn_parent(struct ieee80211com *); 310264912Skevlostatic int urtwn_r92c_power_on(struct urtwn_softc *); 311264912Skevlostatic int urtwn_r88e_power_on(struct urtwn_softc *); 312295874Savosstatic void urtwn_r92c_power_off(struct urtwn_softc *); 313295874Savosstatic void urtwn_r88e_power_off(struct urtwn_softc *); 314251538Srpaulostatic int urtwn_llt_init(struct urtwn_softc *); 315295871Savos#ifndef URTWN_WITHOUT_UCODE 316251538Srpaulostatic void urtwn_fw_reset(struct urtwn_softc *); 317264912Skevlostatic void urtwn_r88e_fw_reset(struct urtwn_softc *); 318281069Srpaulostatic int urtwn_fw_loadpage(struct urtwn_softc *, int, 319251538Srpaulo const uint8_t *, int); 320251538Srpaulostatic int urtwn_load_firmware(struct urtwn_softc *); 321295871Savos#endif 322291902Skevlostatic int urtwn_dma_init(struct urtwn_softc *); 323291698Savosstatic int urtwn_mac_init(struct urtwn_softc *); 324251538Srpaulostatic void urtwn_bb_init(struct urtwn_softc *); 325251538Srpaulostatic void urtwn_rf_init(struct urtwn_softc *); 326251538Srpaulostatic void urtwn_cam_init(struct urtwn_softc *); 327292175Savosstatic int urtwn_cam_write(struct urtwn_softc *, uint32_t, 328292175Savos uint32_t); 329251538Srpaulostatic void urtwn_pa_bias_init(struct urtwn_softc *); 330251538Srpaulostatic void urtwn_rxfilter_init(struct urtwn_softc *); 331251538Srpaulostatic void urtwn_edca_init(struct urtwn_softc *); 332281069Srpaulostatic void urtwn_write_txpower(struct urtwn_softc *, int, 333251538Srpaulo uint16_t[]); 334251538Srpaulostatic void urtwn_get_txpower(struct urtwn_softc *, int, 335281069Srpaulo struct ieee80211_channel *, 336251538Srpaulo struct ieee80211_channel *, uint16_t[]); 337264912Skevlostatic void urtwn_r88e_get_txpower(struct urtwn_softc *, int, 338281069Srpaulo struct ieee80211_channel *, 339264912Skevlo struct ieee80211_channel *, uint16_t[]); 340251538Srpaulostatic void urtwn_set_txpower(struct urtwn_softc *, 341281069Srpaulo struct ieee80211_channel *, 342251538Srpaulo struct ieee80211_channel *); 343290048Savosstatic void urtwn_set_rx_bssid_all(struct urtwn_softc *, int); 344290048Savosstatic void urtwn_set_gain(struct urtwn_softc *, uint8_t); 345251538Srpaulostatic void urtwn_scan_start(struct ieee80211com *); 346251538Srpaulostatic void urtwn_scan_end(struct ieee80211com *); 347251538Srpaulostatic void urtwn_set_channel(struct ieee80211com *); 348292014Savosstatic int urtwn_wme_update(struct ieee80211com *); 349294465Savosstatic void urtwn_update_slot(struct ieee80211com *); 350294465Savosstatic void urtwn_update_slot_cb(struct urtwn_softc *, 351294465Savos union sec_param *); 352294465Savosstatic void urtwn_update_aifs(struct urtwn_softc *, uint8_t); 353290564Savosstatic void urtwn_set_promisc(struct urtwn_softc *); 354290564Savosstatic void urtwn_update_promisc(struct ieee80211com *); 355289066Skevlostatic void urtwn_update_mcast(struct ieee80211com *); 356292167Savosstatic struct ieee80211_node *urtwn_r88e_node_alloc(struct ieee80211vap *, 357292167Savos const uint8_t mac[IEEE80211_ADDR_LEN]); 358292167Savosstatic void urtwn_r88e_newassoc(struct ieee80211_node *, int); 359292167Savosstatic void urtwn_r88e_node_free(struct ieee80211_node *); 360251538Srpaulostatic void urtwn_set_chan(struct urtwn_softc *, 361281069Srpaulo struct ieee80211_channel *, 362251538Srpaulo struct ieee80211_channel *); 363251538Srpaulostatic void urtwn_iq_calib(struct urtwn_softc *); 364251538Srpaulostatic void urtwn_lc_calib(struct urtwn_softc *); 365294473Savosstatic void urtwn_temp_calib(struct urtwn_softc *); 366291698Savosstatic int urtwn_init(struct urtwn_softc *); 367287197Sglebiusstatic void urtwn_stop(struct urtwn_softc *); 368251538Srpaulostatic void urtwn_abort_xfers(struct urtwn_softc *); 369251538Srpaulostatic int urtwn_raw_xmit(struct ieee80211_node *, struct mbuf *, 370251538Srpaulo const struct ieee80211_bpf_params *); 371266472Shselaskystatic void urtwn_ms_delay(struct urtwn_softc *); 372251538Srpaulo 373251538Srpaulo/* Aliases. */ 374251538Srpaulo#define urtwn_bb_write urtwn_write_4 375251538Srpaulo#define urtwn_bb_read urtwn_read_4 376251538Srpaulo 377251538Srpaulostatic const struct usb_config urtwn_config[URTWN_N_TRANSFER] = { 378251538Srpaulo [URTWN_BULK_RX] = { 379251538Srpaulo .type = UE_BULK, 380251538Srpaulo .endpoint = UE_ADDR_ANY, 381251538Srpaulo .direction = UE_DIR_IN, 382251538Srpaulo .bufsize = URTWN_RXBUFSZ, 383251538Srpaulo .flags = { 384251538Srpaulo .pipe_bof = 1, 385251538Srpaulo .short_xfer_ok = 1 386251538Srpaulo }, 387251538Srpaulo .callback = urtwn_bulk_rx_callback, 388251538Srpaulo }, 389251538Srpaulo [URTWN_BULK_TX_BE] = { 390251538Srpaulo .type = UE_BULK, 391251538Srpaulo .endpoint = 0x03, 392251538Srpaulo .direction = UE_DIR_OUT, 393251538Srpaulo .bufsize = URTWN_TXBUFSZ, 394251538Srpaulo .flags = { 395251538Srpaulo .ext_buffer = 1, 396251538Srpaulo .pipe_bof = 1, 397251538Srpaulo .force_short_xfer = 1 398251538Srpaulo }, 399251538Srpaulo .callback = urtwn_bulk_tx_callback, 400251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 401251538Srpaulo }, 402251538Srpaulo [URTWN_BULK_TX_BK] = { 403251538Srpaulo .type = UE_BULK, 404251538Srpaulo .endpoint = 0x03, 405251538Srpaulo .direction = UE_DIR_OUT, 406251538Srpaulo .bufsize = URTWN_TXBUFSZ, 407251538Srpaulo .flags = { 408251538Srpaulo .ext_buffer = 1, 409251538Srpaulo .pipe_bof = 1, 410251538Srpaulo .force_short_xfer = 1, 411251538Srpaulo }, 412251538Srpaulo .callback = urtwn_bulk_tx_callback, 413251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 414251538Srpaulo }, 415251538Srpaulo [URTWN_BULK_TX_VI] = { 416251538Srpaulo .type = UE_BULK, 417251538Srpaulo .endpoint = 0x02, 418251538Srpaulo .direction = UE_DIR_OUT, 419251538Srpaulo .bufsize = URTWN_TXBUFSZ, 420251538Srpaulo .flags = { 421251538Srpaulo .ext_buffer = 1, 422251538Srpaulo .pipe_bof = 1, 423251538Srpaulo .force_short_xfer = 1 424251538Srpaulo }, 425251538Srpaulo .callback = urtwn_bulk_tx_callback, 426251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 427251538Srpaulo }, 428251538Srpaulo [URTWN_BULK_TX_VO] = { 429251538Srpaulo .type = UE_BULK, 430251538Srpaulo .endpoint = 0x02, 431251538Srpaulo .direction = UE_DIR_OUT, 432251538Srpaulo .bufsize = URTWN_TXBUFSZ, 433251538Srpaulo .flags = { 434251538Srpaulo .ext_buffer = 1, 435251538Srpaulo .pipe_bof = 1, 436251538Srpaulo .force_short_xfer = 1 437251538Srpaulo }, 438251538Srpaulo .callback = urtwn_bulk_tx_callback, 439251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 440251538Srpaulo }, 441251538Srpaulo}; 442251538Srpaulo 443292014Savosstatic const struct wme_to_queue { 444292014Savos uint16_t reg; 445292014Savos uint8_t qid; 446292014Savos} wme2queue[WME_NUM_AC] = { 447292014Savos { R92C_EDCA_BE_PARAM, URTWN_BULK_TX_BE}, 448292014Savos { R92C_EDCA_BK_PARAM, URTWN_BULK_TX_BK}, 449292014Savos { R92C_EDCA_VI_PARAM, URTWN_BULK_TX_VI}, 450292014Savos { R92C_EDCA_VO_PARAM, URTWN_BULK_TX_VO} 451292014Savos}; 452292014Savos 453251538Srpaulostatic int 454251538Srpaulourtwn_match(device_t self) 455251538Srpaulo{ 456251538Srpaulo struct usb_attach_arg *uaa = device_get_ivars(self); 457251538Srpaulo 458251538Srpaulo if (uaa->usb_mode != USB_MODE_HOST) 459251538Srpaulo return (ENXIO); 460251538Srpaulo if (uaa->info.bConfigIndex != URTWN_CONFIG_INDEX) 461251538Srpaulo return (ENXIO); 462251538Srpaulo if (uaa->info.bIfaceIndex != URTWN_IFACE_INDEX) 463251538Srpaulo return (ENXIO); 464251538Srpaulo 465251538Srpaulo return (usbd_lookup_id_by_uaa(urtwn_devs, sizeof(urtwn_devs), uaa)); 466251538Srpaulo} 467251538Srpaulo 468251538Srpaulostatic int 469251538Srpaulourtwn_attach(device_t self) 470251538Srpaulo{ 471251538Srpaulo struct usb_attach_arg *uaa = device_get_ivars(self); 472251538Srpaulo struct urtwn_softc *sc = device_get_softc(self); 473287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 474293339Savos uint8_t bands[howmany(IEEE80211_MODE_MAX, 8)]; 475251538Srpaulo int error; 476251538Srpaulo 477251538Srpaulo device_set_usb_desc(self); 478251538Srpaulo sc->sc_udev = uaa->device; 479251538Srpaulo sc->sc_dev = self; 480264912Skevlo if (USB_GET_DRIVER_INFO(uaa) == URTWN_RTL8188E) 481264912Skevlo sc->chip |= URTWN_CHIP_88E; 482251538Srpaulo 483294471Savos#ifdef USB_DEBUG 484294471Savos int debug; 485294471Savos if (resource_int_value(device_get_name(sc->sc_dev), 486294471Savos device_get_unit(sc->sc_dev), "debug", &debug) == 0) 487294471Savos sc->sc_debug = debug; 488294471Savos#endif 489294471Savos 490251538Srpaulo mtx_init(&sc->sc_mtx, device_get_nameunit(self), 491251538Srpaulo MTX_NETWORK_LOCK, MTX_DEF); 492292174Savos URTWN_CMDQ_LOCK_INIT(sc); 493292167Savos URTWN_NT_LOCK_INIT(sc); 494294473Savos callout_init(&sc->sc_calib_to, 0); 495251538Srpaulo callout_init(&sc->sc_watchdog_ch, 0); 496287197Sglebius mbufq_init(&sc->sc_snd, ifqmaxlen); 497251538Srpaulo 498291902Skevlo sc->sc_iface_index = URTWN_IFACE_INDEX; 499291902Skevlo error = usbd_transfer_setup(uaa->device, &sc->sc_iface_index, 500291902Skevlo sc->sc_xfer, urtwn_config, URTWN_N_TRANSFER, sc, &sc->sc_mtx); 501251538Srpaulo if (error) { 502251538Srpaulo device_printf(self, "could not allocate USB transfers, " 503251538Srpaulo "err=%s\n", usbd_errstr(error)); 504251538Srpaulo goto detach; 505251538Srpaulo } 506251538Srpaulo 507251538Srpaulo URTWN_LOCK(sc); 508251538Srpaulo 509251538Srpaulo error = urtwn_read_chipid(sc); 510251538Srpaulo if (error) { 511251538Srpaulo device_printf(sc->sc_dev, "unsupported test chip\n"); 512251538Srpaulo URTWN_UNLOCK(sc); 513251538Srpaulo goto detach; 514251538Srpaulo } 515251538Srpaulo 516251538Srpaulo /* Determine number of Tx/Rx chains. */ 517251538Srpaulo if (sc->chip & URTWN_CHIP_92C) { 518251538Srpaulo sc->ntxchains = (sc->chip & URTWN_CHIP_92C_1T2R) ? 1 : 2; 519251538Srpaulo sc->nrxchains = 2; 520251538Srpaulo } else { 521251538Srpaulo sc->ntxchains = 1; 522251538Srpaulo sc->nrxchains = 1; 523251538Srpaulo } 524251538Srpaulo 525264912Skevlo if (sc->chip & URTWN_CHIP_88E) 526291264Savos error = urtwn_r88e_read_rom(sc); 527264912Skevlo else 528291264Savos error = urtwn_read_rom(sc); 529291264Savos if (error != 0) { 530291264Savos device_printf(sc->sc_dev, "%s: cannot read rom, error %d\n", 531291264Savos __func__, error); 532291264Savos URTWN_UNLOCK(sc); 533291264Savos goto detach; 534291264Savos } 535264912Skevlo 536251538Srpaulo device_printf(sc->sc_dev, "MAC/BB RTL%s, RF 6052 %dT%dR\n", 537251538Srpaulo (sc->chip & URTWN_CHIP_92C) ? "8192CU" : 538264912Skevlo (sc->chip & URTWN_CHIP_88E) ? "8188EU" : 539251538Srpaulo (sc->board_type == R92C_BOARD_TYPE_HIGHPA) ? "8188RU" : 540251538Srpaulo (sc->board_type == R92C_BOARD_TYPE_MINICARD) ? "8188CE-VAU" : 541251538Srpaulo "8188CUS", sc->ntxchains, sc->nrxchains); 542251538Srpaulo 543251538Srpaulo URTWN_UNLOCK(sc); 544251538Srpaulo 545283537Sglebius ic->ic_softc = sc; 546283527Sglebius ic->ic_name = device_get_nameunit(self); 547251538Srpaulo ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ 548251538Srpaulo ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */ 549251538Srpaulo 550251538Srpaulo /* set device capabilities */ 551251538Srpaulo ic->ic_caps = 552251538Srpaulo IEEE80211_C_STA /* station mode */ 553251538Srpaulo | IEEE80211_C_MONITOR /* monitor mode */ 554290651Savos | IEEE80211_C_IBSS /* adhoc mode */ 555290631Savos | IEEE80211_C_HOSTAP /* hostap mode */ 556251538Srpaulo | IEEE80211_C_SHPREAMBLE /* short preamble supported */ 557251538Srpaulo | IEEE80211_C_SHSLOT /* short slot time supported */ 558251538Srpaulo | IEEE80211_C_BGSCAN /* capable of bg scanning */ 559251538Srpaulo | IEEE80211_C_WPA /* 802.11i */ 560292014Savos | IEEE80211_C_WME /* 802.11e */ 561251538Srpaulo ; 562251538Srpaulo 563292175Savos ic->ic_cryptocaps = 564292175Savos IEEE80211_CRYPTO_WEP | 565292175Savos IEEE80211_CRYPTO_TKIP | 566292175Savos IEEE80211_CRYPTO_AES_CCM; 567292175Savos 568293339Savos memset(bands, 0, sizeof(bands)); 569293339Savos setbit(bands, IEEE80211_MODE_11B); 570293339Savos setbit(bands, IEEE80211_MODE_11G); 571293339Savos ieee80211_init_channels(ic, NULL, bands); 572251538Srpaulo 573287197Sglebius ieee80211_ifattach(ic); 574251538Srpaulo ic->ic_raw_xmit = urtwn_raw_xmit; 575251538Srpaulo ic->ic_scan_start = urtwn_scan_start; 576251538Srpaulo ic->ic_scan_end = urtwn_scan_end; 577251538Srpaulo ic->ic_set_channel = urtwn_set_channel; 578287197Sglebius ic->ic_transmit = urtwn_transmit; 579287197Sglebius ic->ic_parent = urtwn_parent; 580251538Srpaulo ic->ic_vap_create = urtwn_vap_create; 581251538Srpaulo ic->ic_vap_delete = urtwn_vap_delete; 582292014Savos ic->ic_wme.wme_update = urtwn_wme_update; 583294465Savos ic->ic_updateslot = urtwn_update_slot; 584290564Savos ic->ic_update_promisc = urtwn_update_promisc; 585251538Srpaulo ic->ic_update_mcast = urtwn_update_mcast; 586292167Savos if (sc->chip & URTWN_CHIP_88E) { 587292167Savos ic->ic_node_alloc = urtwn_r88e_node_alloc; 588292167Savos ic->ic_newassoc = urtwn_r88e_newassoc; 589292167Savos sc->sc_node_free = ic->ic_node_free; 590292167Savos ic->ic_node_free = urtwn_r88e_node_free; 591292167Savos } 592251538Srpaulo 593281069Srpaulo ieee80211_radiotap_attach(ic, &sc->sc_txtap.wt_ihdr, 594251538Srpaulo sizeof(sc->sc_txtap), URTWN_TX_RADIOTAP_PRESENT, 595251538Srpaulo &sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap), 596251538Srpaulo URTWN_RX_RADIOTAP_PRESENT); 597251538Srpaulo 598292174Savos TASK_INIT(&sc->cmdq_task, 0, urtwn_cmdq_cb, sc); 599292174Savos 600294471Savos urtwn_sysctlattach(sc); 601294471Savos 602251538Srpaulo if (bootverbose) 603251538Srpaulo ieee80211_announce(ic); 604251538Srpaulo 605251538Srpaulo return (0); 606251538Srpaulo 607251538Srpaulodetach: 608251538Srpaulo urtwn_detach(self); 609251538Srpaulo return (ENXIO); /* failure */ 610251538Srpaulo} 611251538Srpaulo 612294471Savosstatic void 613294471Savosurtwn_sysctlattach(struct urtwn_softc *sc) 614294471Savos{ 615294471Savos#ifdef USB_DEBUG 616294471Savos struct sysctl_ctx_list *ctx = device_get_sysctl_ctx(sc->sc_dev); 617294471Savos struct sysctl_oid *tree = device_get_sysctl_tree(sc->sc_dev); 618294471Savos 619294471Savos SYSCTL_ADD_U32(ctx, SYSCTL_CHILDREN(tree), OID_AUTO, 620294471Savos "debug", CTLFLAG_RW, &sc->sc_debug, sc->sc_debug, 621294471Savos "control debugging printfs"); 622294471Savos#endif 623294471Savos} 624294471Savos 625251538Srpaulostatic int 626251538Srpaulourtwn_detach(device_t self) 627251538Srpaulo{ 628251538Srpaulo struct urtwn_softc *sc = device_get_softc(self); 629287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 630263153Skevlo unsigned int x; 631281069Srpaulo 632263153Skevlo /* Prevent further ioctls. */ 633263153Skevlo URTWN_LOCK(sc); 634263153Skevlo sc->sc_flags |= URTWN_DETACHED; 635263153Skevlo URTWN_UNLOCK(sc); 636251538Srpaulo 637291698Savos urtwn_stop(sc); 638291698Savos 639251538Srpaulo callout_drain(&sc->sc_watchdog_ch); 640294473Savos callout_drain(&sc->sc_calib_to); 641251538Srpaulo 642288353Sadrian /* stop all USB transfers */ 643288353Sadrian usbd_transfer_unsetup(sc->sc_xfer, URTWN_N_TRANSFER); 644288353Sadrian 645263153Skevlo /* Prevent further allocations from RX/TX data lists. */ 646263153Skevlo URTWN_LOCK(sc); 647263153Skevlo STAILQ_INIT(&sc->sc_tx_active); 648263153Skevlo STAILQ_INIT(&sc->sc_tx_inactive); 649263153Skevlo STAILQ_INIT(&sc->sc_tx_pending); 650263153Skevlo 651263153Skevlo STAILQ_INIT(&sc->sc_rx_active); 652263153Skevlo STAILQ_INIT(&sc->sc_rx_inactive); 653263153Skevlo URTWN_UNLOCK(sc); 654263153Skevlo 655263153Skevlo /* drain USB transfers */ 656263153Skevlo for (x = 0; x != URTWN_N_TRANSFER; x++) 657263153Skevlo usbd_transfer_drain(sc->sc_xfer[x]); 658263153Skevlo 659263153Skevlo /* Free data buffers. */ 660263153Skevlo URTWN_LOCK(sc); 661263153Skevlo urtwn_free_tx_list(sc); 662263153Skevlo urtwn_free_rx_list(sc); 663263153Skevlo URTWN_UNLOCK(sc); 664263153Skevlo 665292174Savos if (ic->ic_softc == sc) { 666292174Savos ieee80211_draintask(ic, &sc->cmdq_task); 667292174Savos ieee80211_ifdetach(ic); 668292174Savos } 669292174Savos 670292167Savos URTWN_NT_LOCK_DESTROY(sc); 671292174Savos URTWN_CMDQ_LOCK_DESTROY(sc); 672251538Srpaulo mtx_destroy(&sc->sc_mtx); 673251538Srpaulo 674251538Srpaulo return (0); 675251538Srpaulo} 676251538Srpaulo 677251538Srpaulostatic void 678289066Skevlourtwn_drain_mbufq(struct urtwn_softc *sc) 679251538Srpaulo{ 680289066Skevlo struct mbuf *m; 681289066Skevlo struct ieee80211_node *ni; 682289066Skevlo URTWN_ASSERT_LOCKED(sc); 683289066Skevlo while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) { 684289066Skevlo ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 685289066Skevlo m->m_pkthdr.rcvif = NULL; 686289066Skevlo ieee80211_free_node(ni); 687289066Skevlo m_freem(m); 688251538Srpaulo } 689251538Srpaulo} 690251538Srpaulo 691251538Srpaulostatic usb_error_t 692251538Srpaulourtwn_do_request(struct urtwn_softc *sc, struct usb_device_request *req, 693251538Srpaulo void *data) 694251538Srpaulo{ 695251538Srpaulo usb_error_t err; 696251538Srpaulo int ntries = 10; 697251538Srpaulo 698251538Srpaulo URTWN_ASSERT_LOCKED(sc); 699251538Srpaulo 700251538Srpaulo while (ntries--) { 701251538Srpaulo err = usbd_do_request_flags(sc->sc_udev, &sc->sc_mtx, 702251538Srpaulo req, data, 0, NULL, 250 /* ms */); 703251538Srpaulo if (err == 0) 704251538Srpaulo break; 705251538Srpaulo 706294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_USB, 707294471Savos "%s: control request failed, %s (retries left: %d)\n", 708294471Savos __func__, usbd_errstr(err), ntries); 709251538Srpaulo usb_pause_mtx(&sc->sc_mtx, hz / 100); 710251538Srpaulo } 711251538Srpaulo return (err); 712251538Srpaulo} 713251538Srpaulo 714251538Srpaulostatic struct ieee80211vap * 715251538Srpaulourtwn_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit, 716251538Srpaulo enum ieee80211_opmode opmode, int flags, 717251538Srpaulo const uint8_t bssid[IEEE80211_ADDR_LEN], 718251538Srpaulo const uint8_t mac[IEEE80211_ADDR_LEN]) 719251538Srpaulo{ 720290631Savos struct urtwn_softc *sc = ic->ic_softc; 721251538Srpaulo struct urtwn_vap *uvp; 722251538Srpaulo struct ieee80211vap *vap; 723251538Srpaulo 724251538Srpaulo if (!TAILQ_EMPTY(&ic->ic_vaps)) /* only one at a time */ 725251538Srpaulo return (NULL); 726251538Srpaulo 727287197Sglebius uvp = malloc(sizeof(struct urtwn_vap), M_80211_VAP, M_WAITOK | M_ZERO); 728251538Srpaulo vap = &uvp->vap; 729251538Srpaulo /* enable s/w bmiss handling for sta mode */ 730251538Srpaulo 731281069Srpaulo if (ieee80211_vap_setup(ic, vap, name, unit, opmode, 732287197Sglebius flags | IEEE80211_CLONE_NOBEACONS, bssid) != 0) { 733257743Shselasky /* out of memory */ 734257743Shselasky free(uvp, M_80211_VAP); 735257743Shselasky return (NULL); 736257743Shselasky } 737257743Shselasky 738290651Savos if (opmode == IEEE80211_M_HOSTAP || opmode == IEEE80211_M_IBSS) 739290631Savos urtwn_init_beacon(sc, uvp); 740290631Savos 741251538Srpaulo /* override state transition machine */ 742251538Srpaulo uvp->newstate = vap->iv_newstate; 743251538Srpaulo vap->iv_newstate = urtwn_newstate; 744290631Savos vap->iv_update_beacon = urtwn_update_beacon; 745292175Savos vap->iv_key_alloc = urtwn_key_alloc; 746292175Savos vap->iv_key_set = urtwn_key_set; 747292175Savos vap->iv_key_delete = urtwn_key_delete; 748290651Savos if (opmode == IEEE80211_M_IBSS) { 749290651Savos uvp->recv_mgmt = vap->iv_recv_mgmt; 750290651Savos vap->iv_recv_mgmt = urtwn_ibss_recv_mgmt; 751290651Savos TASK_INIT(&uvp->tsf_task_adhoc, 0, urtwn_tsf_task_adhoc, vap); 752290651Savos } 753251538Srpaulo 754292167Savos if (URTWN_CHIP_HAS_RATECTL(sc)) 755292167Savos ieee80211_ratectl_init(vap); 756251538Srpaulo /* complete setup */ 757251538Srpaulo ieee80211_vap_attach(vap, ieee80211_media_change, 758287197Sglebius ieee80211_media_status, mac); 759251538Srpaulo ic->ic_opmode = opmode; 760251538Srpaulo return (vap); 761251538Srpaulo} 762251538Srpaulo 763251538Srpaulostatic void 764251538Srpaulourtwn_vap_delete(struct ieee80211vap *vap) 765251538Srpaulo{ 766290651Savos struct ieee80211com *ic = vap->iv_ic; 767292167Savos struct urtwn_softc *sc = ic->ic_softc; 768251538Srpaulo struct urtwn_vap *uvp = URTWN_VAP(vap); 769251538Srpaulo 770290651Savos if (uvp->bcn_mbuf != NULL) 771290651Savos m_freem(uvp->bcn_mbuf); 772290651Savos if (vap->iv_opmode == IEEE80211_M_IBSS) 773290651Savos ieee80211_draintask(ic, &uvp->tsf_task_adhoc); 774292167Savos if (URTWN_CHIP_HAS_RATECTL(sc)) 775292167Savos ieee80211_ratectl_deinit(vap); 776251538Srpaulo ieee80211_vap_detach(vap); 777251538Srpaulo free(uvp, M_80211_VAP); 778251538Srpaulo} 779251538Srpaulo 780251538Srpaulostatic struct mbuf * 781292207Savosurtwn_rx_copy_to_mbuf(struct urtwn_softc *sc, struct r92c_rx_stat *stat, 782292207Savos int totlen) 783251538Srpaulo{ 784287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 785251538Srpaulo struct mbuf *m; 786292207Savos uint32_t rxdw0; 787292207Savos int pktlen; 788251538Srpaulo 789251538Srpaulo /* 790251538Srpaulo * don't pass packets to the ieee80211 framework if the driver isn't 791251538Srpaulo * RUNNING. 792251538Srpaulo */ 793287197Sglebius if (!(sc->sc_flags & URTWN_RUNNING)) 794251538Srpaulo return (NULL); 795251538Srpaulo 796251538Srpaulo rxdw0 = le32toh(stat->rxdw0); 797251538Srpaulo if (rxdw0 & (R92C_RXDW0_CRCERR | R92C_RXDW0_ICVERR)) { 798251538Srpaulo /* 799251538Srpaulo * This should not happen since we setup our Rx filter 800251538Srpaulo * to not receive these frames. 801251538Srpaulo */ 802294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_RECV, 803294471Savos "%s: RX flags error (%s)\n", __func__, 804292207Savos rxdw0 & R92C_RXDW0_CRCERR ? "CRC" : "ICV"); 805292207Savos goto fail; 806251538Srpaulo } 807292207Savos 808292207Savos pktlen = MS(rxdw0, R92C_RXDW0_PKTLEN); 809292207Savos if (pktlen < sizeof(struct ieee80211_frame_ack)) { 810294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_RECV, 811294471Savos "%s: frame is too short: %d\n", __func__, pktlen); 812292207Savos goto fail; 813271303Skevlo } 814251538Srpaulo 815292207Savos if (__predict_false(totlen > MCLBYTES)) { 816292207Savos /* convert to m_getjcl if this happens */ 817292207Savos device_printf(sc->sc_dev, "%s: frame too long: %d (%d)\n", 818292207Savos __func__, pktlen, totlen); 819292207Savos goto fail; 820251538Srpaulo } 821251538Srpaulo 822260463Skevlo m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 823292207Savos if (__predict_false(m == NULL)) { 824292207Savos device_printf(sc->sc_dev, "%s: could not allocate RX mbuf\n", 825292207Savos __func__); 826292207Savos goto fail; 827251538Srpaulo } 828251538Srpaulo 829251538Srpaulo /* Finalize mbuf. */ 830292207Savos memcpy(mtod(m, uint8_t *), (uint8_t *)stat, totlen); 831292207Savos m->m_pkthdr.len = m->m_len = totlen; 832292207Savos 833251538Srpaulo return (m); 834292207Savosfail: 835292207Savos counter_u64_add(ic->ic_ierrors, 1); 836292207Savos return (NULL); 837251538Srpaulo} 838251538Srpaulo 839251538Srpaulostatic struct mbuf * 840292207Savosurtwn_report_intr(struct usb_xfer *xfer, struct urtwn_data *data) 841251538Srpaulo{ 842251538Srpaulo struct urtwn_softc *sc = data->sc; 843287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 844251538Srpaulo struct r92c_rx_stat *stat; 845251538Srpaulo uint8_t *buf; 846292167Savos int len; 847251538Srpaulo 848251538Srpaulo usbd_xfer_status(xfer, &len, NULL, NULL, NULL); 849251538Srpaulo 850251538Srpaulo if (len < sizeof(*stat)) { 851287197Sglebius counter_u64_add(ic->ic_ierrors, 1); 852251538Srpaulo return (NULL); 853251538Srpaulo } 854251538Srpaulo 855251538Srpaulo buf = data->buf; 856292167Savos stat = (struct r92c_rx_stat *)buf; 857292167Savos 858292167Savos if (sc->chip & URTWN_CHIP_88E) { 859292167Savos int report_sel = MS(le32toh(stat->rxdw3), R88E_RXDW3_RPT); 860292167Savos 861292167Savos switch (report_sel) { 862292167Savos case R88E_RXDW3_RPT_RX: 863292207Savos return (urtwn_rxeof(sc, buf, len)); 864292167Savos case R88E_RXDW3_RPT_TX1: 865292167Savos urtwn_r88e_ratectl_tx_complete(sc, &stat[1]); 866292167Savos break; 867292167Savos default: 868294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_INTR, 869294471Savos "%s: case %d was not handled\n", __func__, 870294471Savos report_sel); 871292167Savos break; 872292167Savos } 873292167Savos } else 874292207Savos return (urtwn_rxeof(sc, buf, len)); 875292167Savos 876292167Savos return (NULL); 877292167Savos} 878292167Savos 879292167Savosstatic struct mbuf * 880292207Savosurtwn_rxeof(struct urtwn_softc *sc, uint8_t *buf, int len) 881292167Savos{ 882292167Savos struct r92c_rx_stat *stat; 883292167Savos struct mbuf *m, *m0 = NULL, *prevm = NULL; 884292167Savos uint32_t rxdw0; 885292167Savos int totlen, pktlen, infosz, npkts; 886292167Savos 887251538Srpaulo /* Get the number of encapsulated frames. */ 888251538Srpaulo stat = (struct r92c_rx_stat *)buf; 889251538Srpaulo npkts = MS(le32toh(stat->rxdw2), R92C_RXDW2_PKTCNT); 890294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_RECV, 891294471Savos "%s: Rx %d frames in one chunk\n", __func__, npkts); 892251538Srpaulo 893251538Srpaulo /* Process all of them. */ 894251538Srpaulo while (npkts-- > 0) { 895251538Srpaulo if (len < sizeof(*stat)) 896251538Srpaulo break; 897251538Srpaulo stat = (struct r92c_rx_stat *)buf; 898251538Srpaulo rxdw0 = le32toh(stat->rxdw0); 899251538Srpaulo 900251538Srpaulo pktlen = MS(rxdw0, R92C_RXDW0_PKTLEN); 901251538Srpaulo if (pktlen == 0) 902251538Srpaulo break; 903251538Srpaulo 904251538Srpaulo infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8; 905251538Srpaulo 906251538Srpaulo /* Make sure everything fits in xfer. */ 907251538Srpaulo totlen = sizeof(*stat) + infosz + pktlen; 908251538Srpaulo if (totlen > len) 909251538Srpaulo break; 910251538Srpaulo 911292207Savos m = urtwn_rx_copy_to_mbuf(sc, stat, totlen); 912251538Srpaulo if (m0 == NULL) 913251538Srpaulo m0 = m; 914251538Srpaulo if (prevm == NULL) 915251538Srpaulo prevm = m; 916251538Srpaulo else { 917251538Srpaulo prevm->m_next = m; 918251538Srpaulo prevm = m; 919251538Srpaulo } 920251538Srpaulo 921251538Srpaulo /* Next chunk is 128-byte aligned. */ 922251538Srpaulo totlen = (totlen + 127) & ~127; 923251538Srpaulo buf += totlen; 924251538Srpaulo len -= totlen; 925251538Srpaulo } 926251538Srpaulo 927251538Srpaulo return (m0); 928251538Srpaulo} 929251538Srpaulo 930251538Srpaulostatic void 931292167Savosurtwn_r88e_ratectl_tx_complete(struct urtwn_softc *sc, void *arg) 932292167Savos{ 933292167Savos struct r88e_tx_rpt_ccx *rpt = arg; 934292167Savos struct ieee80211vap *vap; 935292167Savos struct ieee80211_node *ni; 936292167Savos uint8_t macid; 937292167Savos int ntries; 938292167Savos 939292167Savos macid = MS(rpt->rptb1, R88E_RPTB1_MACID); 940292167Savos ntries = MS(rpt->rptb2, R88E_RPTB2_RETRY_CNT); 941292167Savos 942292167Savos URTWN_NT_LOCK(sc); 943292167Savos ni = sc->node_list[macid]; 944292167Savos if (ni != NULL) { 945292167Savos vap = ni->ni_vap; 946294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_INTR, "%s: frame for macid %d was" 947294471Savos "%s sent (%d retries)\n", __func__, macid, 948294471Savos (rpt->rptb1 & R88E_RPTB1_PKT_OK) ? "" : " not", 949294471Savos ntries); 950292167Savos 951292167Savos if (rpt->rptb1 & R88E_RPTB1_PKT_OK) { 952292167Savos ieee80211_ratectl_tx_complete(vap, ni, 953292167Savos IEEE80211_RATECTL_TX_SUCCESS, &ntries, NULL); 954292167Savos } else { 955292167Savos ieee80211_ratectl_tx_complete(vap, ni, 956292167Savos IEEE80211_RATECTL_TX_FAILURE, &ntries, NULL); 957292167Savos } 958294471Savos } else { 959294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_INTR, "%s: macid %d, ni is NULL\n", 960294471Savos __func__, macid); 961294471Savos } 962292167Savos URTWN_NT_UNLOCK(sc); 963292167Savos} 964292167Savos 965292207Savosstatic struct ieee80211_node * 966292207Savosurtwn_rx_frame(struct urtwn_softc *sc, struct mbuf *m, int8_t *rssi_p) 967292207Savos{ 968292207Savos struct ieee80211com *ic = &sc->sc_ic; 969292207Savos struct ieee80211_frame_min *wh; 970292207Savos struct r92c_rx_stat *stat; 971292207Savos uint32_t rxdw0, rxdw3; 972292207Savos uint8_t rate, cipher; 973292207Savos int8_t rssi = URTWN_NOISE_FLOOR + 1; 974292207Savos int infosz; 975292207Savos 976292207Savos stat = mtod(m, struct r92c_rx_stat *); 977292207Savos rxdw0 = le32toh(stat->rxdw0); 978292207Savos rxdw3 = le32toh(stat->rxdw3); 979292207Savos 980292207Savos rate = MS(rxdw3, R92C_RXDW3_RATE); 981292207Savos cipher = MS(rxdw0, R92C_RXDW0_CIPHER); 982292207Savos infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8; 983292207Savos 984292207Savos /* Get RSSI from PHY status descriptor if present. */ 985292207Savos if (infosz != 0 && (rxdw0 & R92C_RXDW0_PHYST)) { 986292207Savos if (sc->chip & URTWN_CHIP_88E) 987292207Savos rssi = urtwn_r88e_get_rssi(sc, rate, &stat[1]); 988292207Savos else 989292207Savos rssi = urtwn_get_rssi(sc, rate, &stat[1]); 990292207Savos /* Update our average RSSI. */ 991292207Savos urtwn_update_avgrssi(sc, rate, rssi); 992292207Savos } 993292207Savos 994292207Savos if (ieee80211_radiotap_active(ic)) { 995292207Savos struct urtwn_rx_radiotap_header *tap = &sc->sc_rxtap; 996292207Savos 997292207Savos tap->wr_flags = 0; 998292207Savos 999292207Savos urtwn_get_tsf(sc, &tap->wr_tsft); 1000292207Savos if (__predict_false(le32toh((uint32_t)tap->wr_tsft) < 1001292207Savos le32toh(stat->rxdw5))) { 1002292207Savos tap->wr_tsft = le32toh(tap->wr_tsft >> 32) - 1; 1003292207Savos tap->wr_tsft = (uint64_t)htole32(tap->wr_tsft) << 32; 1004292207Savos } else 1005292207Savos tap->wr_tsft &= 0xffffffff00000000; 1006292207Savos tap->wr_tsft += stat->rxdw5; 1007292207Savos 1008292207Savos /* Map HW rate index to 802.11 rate. */ 1009292207Savos if (!(rxdw3 & R92C_RXDW3_HT)) { 1010292207Savos tap->wr_rate = ridx2rate[rate]; 1011292207Savos } else if (rate >= 12) { /* MCS0~15. */ 1012292207Savos /* Bit 7 set means HT MCS instead of rate. */ 1013292207Savos tap->wr_rate = 0x80 | (rate - 12); 1014292207Savos } 1015292207Savos tap->wr_dbm_antsignal = rssi; 1016292207Savos tap->wr_dbm_antnoise = URTWN_NOISE_FLOOR; 1017292207Savos } 1018292207Savos 1019292207Savos *rssi_p = rssi; 1020292207Savos 1021292207Savos /* Drop descriptor. */ 1022292207Savos m_adj(m, sizeof(*stat) + infosz); 1023292207Savos wh = mtod(m, struct ieee80211_frame_min *); 1024292207Savos 1025292207Savos if ((wh->i_fc[1] & IEEE80211_FC1_PROTECTED) && 1026292207Savos cipher != R92C_CAM_ALGO_NONE) { 1027292207Savos m->m_flags |= M_WEP; 1028292207Savos } 1029292207Savos 1030292207Savos if (m->m_len >= sizeof(*wh)) 1031292207Savos return (ieee80211_find_rxnode(ic, wh)); 1032292207Savos 1033292207Savos return (NULL); 1034292207Savos} 1035292207Savos 1036292167Savosstatic void 1037251538Srpaulourtwn_bulk_rx_callback(struct usb_xfer *xfer, usb_error_t error) 1038251538Srpaulo{ 1039251538Srpaulo struct urtwn_softc *sc = usbd_xfer_softc(xfer); 1040287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 1041251538Srpaulo struct ieee80211_node *ni; 1042251538Srpaulo struct mbuf *m = NULL, *next; 1043251538Srpaulo struct urtwn_data *data; 1044292207Savos int8_t nf, rssi; 1045251538Srpaulo 1046251538Srpaulo URTWN_ASSERT_LOCKED(sc); 1047251538Srpaulo 1048251538Srpaulo switch (USB_GET_STATE(xfer)) { 1049251538Srpaulo case USB_ST_TRANSFERRED: 1050251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_active); 1051251538Srpaulo if (data == NULL) 1052251538Srpaulo goto tr_setup; 1053251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 1054292207Savos m = urtwn_report_intr(xfer, data); 1055251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 1056251538Srpaulo /* FALLTHROUGH */ 1057251538Srpaulo case USB_ST_SETUP: 1058251538Srpaulotr_setup: 1059251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_inactive); 1060251538Srpaulo if (data == NULL) { 1061251538Srpaulo KASSERT(m == NULL, ("mbuf isn't NULL")); 1062251538Srpaulo return; 1063251538Srpaulo } 1064251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_inactive, next); 1065251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_active, data, next); 1066251538Srpaulo usbd_xfer_set_frame_data(xfer, 0, data->buf, 1067251538Srpaulo usbd_xfer_max_len(xfer)); 1068251538Srpaulo usbd_transfer_submit(xfer); 1069251538Srpaulo 1070251538Srpaulo /* 1071251538Srpaulo * To avoid LOR we should unlock our private mutex here to call 1072251538Srpaulo * ieee80211_input() because here is at the end of a USB 1073251538Srpaulo * callback and safe to unlock. 1074251538Srpaulo */ 1075251538Srpaulo while (m != NULL) { 1076251538Srpaulo next = m->m_next; 1077251538Srpaulo m->m_next = NULL; 1078292207Savos 1079292207Savos ni = urtwn_rx_frame(sc, m, &rssi); 1080292207Savos URTWN_UNLOCK(sc); 1081292207Savos 1082251538Srpaulo nf = URTWN_NOISE_FLOOR; 1083251538Srpaulo if (ni != NULL) { 1084289799Savos (void)ieee80211_input(ni, m, rssi - nf, nf); 1085251538Srpaulo ieee80211_free_node(ni); 1086289799Savos } else { 1087289799Savos (void)ieee80211_input_all(ic, m, rssi - nf, 1088289799Savos nf); 1089289799Savos } 1090292207Savos 1091292207Savos URTWN_LOCK(sc); 1092251538Srpaulo m = next; 1093251538Srpaulo } 1094251538Srpaulo break; 1095251538Srpaulo default: 1096251538Srpaulo /* needs it to the inactive queue due to a error. */ 1097251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_active); 1098251538Srpaulo if (data != NULL) { 1099251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 1100251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 1101251538Srpaulo } 1102251538Srpaulo if (error != USB_ERR_CANCELLED) { 1103251538Srpaulo usbd_xfer_set_stall(xfer); 1104287197Sglebius counter_u64_add(ic->ic_ierrors, 1); 1105251538Srpaulo goto tr_setup; 1106251538Srpaulo } 1107251538Srpaulo break; 1108251538Srpaulo } 1109251538Srpaulo} 1110251538Srpaulo 1111251538Srpaulostatic void 1112289891Savosurtwn_txeof(struct urtwn_softc *sc, struct urtwn_data *data, int status) 1113251538Srpaulo{ 1114251538Srpaulo 1115251538Srpaulo URTWN_ASSERT_LOCKED(sc); 1116289891Savos 1117290631Savos if (data->ni != NULL) /* not a beacon frame */ 1118290631Savos ieee80211_tx_complete(data->ni, data->m, status); 1119289891Savos 1120287197Sglebius data->ni = NULL; 1121287197Sglebius data->m = NULL; 1122289891Savos 1123251538Srpaulo sc->sc_txtimer = 0; 1124289891Savos 1125289891Savos STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data, next); 1126251538Srpaulo} 1127251538Srpaulo 1128289066Skevlostatic int 1129289066Skevlourtwn_alloc_list(struct urtwn_softc *sc, struct urtwn_data data[], 1130289066Skevlo int ndata, int maxsz) 1131289066Skevlo{ 1132289066Skevlo int i, error; 1133289066Skevlo 1134289066Skevlo for (i = 0; i < ndata; i++) { 1135289066Skevlo struct urtwn_data *dp = &data[i]; 1136289066Skevlo dp->sc = sc; 1137289066Skevlo dp->m = NULL; 1138289066Skevlo dp->buf = malloc(maxsz, M_USBDEV, M_NOWAIT); 1139289066Skevlo if (dp->buf == NULL) { 1140289066Skevlo device_printf(sc->sc_dev, 1141289066Skevlo "could not allocate buffer\n"); 1142289066Skevlo error = ENOMEM; 1143289066Skevlo goto fail; 1144289066Skevlo } 1145289066Skevlo dp->ni = NULL; 1146289066Skevlo } 1147289066Skevlo 1148289066Skevlo return (0); 1149289066Skevlofail: 1150289066Skevlo urtwn_free_list(sc, data, ndata); 1151289066Skevlo return (error); 1152289066Skevlo} 1153289066Skevlo 1154289066Skevlostatic int 1155289066Skevlourtwn_alloc_rx_list(struct urtwn_softc *sc) 1156289066Skevlo{ 1157289066Skevlo int error, i; 1158289066Skevlo 1159289066Skevlo error = urtwn_alloc_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT, 1160289066Skevlo URTWN_RXBUFSZ); 1161289066Skevlo if (error != 0) 1162289066Skevlo return (error); 1163289066Skevlo 1164289066Skevlo STAILQ_INIT(&sc->sc_rx_active); 1165289066Skevlo STAILQ_INIT(&sc->sc_rx_inactive); 1166289066Skevlo 1167289066Skevlo for (i = 0; i < URTWN_RX_LIST_COUNT; i++) 1168289066Skevlo STAILQ_INSERT_HEAD(&sc->sc_rx_inactive, &sc->sc_rx[i], next); 1169289066Skevlo 1170289066Skevlo return (0); 1171289066Skevlo} 1172289066Skevlo 1173289066Skevlostatic int 1174289066Skevlourtwn_alloc_tx_list(struct urtwn_softc *sc) 1175289066Skevlo{ 1176289066Skevlo int error, i; 1177289066Skevlo 1178289066Skevlo error = urtwn_alloc_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT, 1179289066Skevlo URTWN_TXBUFSZ); 1180289066Skevlo if (error != 0) 1181289066Skevlo return (error); 1182289066Skevlo 1183289066Skevlo STAILQ_INIT(&sc->sc_tx_active); 1184289066Skevlo STAILQ_INIT(&sc->sc_tx_inactive); 1185289066Skevlo STAILQ_INIT(&sc->sc_tx_pending); 1186289066Skevlo 1187289066Skevlo for (i = 0; i < URTWN_TX_LIST_COUNT; i++) 1188289066Skevlo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, &sc->sc_tx[i], next); 1189289066Skevlo 1190289066Skevlo return (0); 1191289066Skevlo} 1192289066Skevlo 1193251538Srpaulostatic void 1194289066Skevlourtwn_free_list(struct urtwn_softc *sc, struct urtwn_data data[], int ndata) 1195289066Skevlo{ 1196289066Skevlo int i; 1197289066Skevlo 1198289066Skevlo for (i = 0; i < ndata; i++) { 1199289066Skevlo struct urtwn_data *dp = &data[i]; 1200289066Skevlo 1201289066Skevlo if (dp->buf != NULL) { 1202289066Skevlo free(dp->buf, M_USBDEV); 1203289066Skevlo dp->buf = NULL; 1204289066Skevlo } 1205289066Skevlo if (dp->ni != NULL) { 1206289066Skevlo ieee80211_free_node(dp->ni); 1207289066Skevlo dp->ni = NULL; 1208289066Skevlo } 1209289066Skevlo } 1210289066Skevlo} 1211289066Skevlo 1212289066Skevlostatic void 1213289066Skevlourtwn_free_rx_list(struct urtwn_softc *sc) 1214289066Skevlo{ 1215289066Skevlo urtwn_free_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT); 1216289066Skevlo} 1217289066Skevlo 1218289066Skevlostatic void 1219289066Skevlourtwn_free_tx_list(struct urtwn_softc *sc) 1220289066Skevlo{ 1221289066Skevlo urtwn_free_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT); 1222289066Skevlo} 1223289066Skevlo 1224289066Skevlostatic void 1225251538Srpaulourtwn_bulk_tx_callback(struct usb_xfer *xfer, usb_error_t error) 1226251538Srpaulo{ 1227251538Srpaulo struct urtwn_softc *sc = usbd_xfer_softc(xfer); 1228251538Srpaulo struct urtwn_data *data; 1229251538Srpaulo 1230251538Srpaulo URTWN_ASSERT_LOCKED(sc); 1231251538Srpaulo 1232251538Srpaulo switch (USB_GET_STATE(xfer)){ 1233251538Srpaulo case USB_ST_TRANSFERRED: 1234251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_active); 1235251538Srpaulo if (data == NULL) 1236251538Srpaulo goto tr_setup; 1237251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next); 1238289891Savos urtwn_txeof(sc, data, 0); 1239251538Srpaulo /* FALLTHROUGH */ 1240251538Srpaulo case USB_ST_SETUP: 1241251538Srpaulotr_setup: 1242251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_pending); 1243251538Srpaulo if (data == NULL) { 1244294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT, 1245294471Savos "%s: empty pending queue\n", __func__); 1246288353Sadrian goto finish; 1247251538Srpaulo } 1248251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_pending, next); 1249251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_tx_active, data, next); 1250251538Srpaulo usbd_xfer_set_frame_data(xfer, 0, data->buf, data->buflen); 1251251538Srpaulo usbd_transfer_submit(xfer); 1252251538Srpaulo break; 1253251538Srpaulo default: 1254251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_active); 1255251538Srpaulo if (data == NULL) 1256251538Srpaulo goto tr_setup; 1257289891Savos STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next); 1258289891Savos urtwn_txeof(sc, data, 1); 1259251538Srpaulo if (error != USB_ERR_CANCELLED) { 1260251538Srpaulo usbd_xfer_set_stall(xfer); 1261251538Srpaulo goto tr_setup; 1262251538Srpaulo } 1263251538Srpaulo break; 1264251538Srpaulo } 1265288353Sadrianfinish: 1266288353Sadrian /* Kick-start more transmit */ 1267288353Sadrian urtwn_start(sc); 1268251538Srpaulo} 1269251538Srpaulo 1270251538Srpaulostatic struct urtwn_data * 1271251538Srpaulo_urtwn_getbuf(struct urtwn_softc *sc) 1272251538Srpaulo{ 1273251538Srpaulo struct urtwn_data *bf; 1274251538Srpaulo 1275251538Srpaulo bf = STAILQ_FIRST(&sc->sc_tx_inactive); 1276251538Srpaulo if (bf != NULL) 1277251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_inactive, next); 1278294471Savos else { 1279294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT, 1280294471Savos "%s: out of xmit buffers\n", __func__); 1281294471Savos } 1282251538Srpaulo return (bf); 1283251538Srpaulo} 1284251538Srpaulo 1285251538Srpaulostatic struct urtwn_data * 1286251538Srpaulourtwn_getbuf(struct urtwn_softc *sc) 1287251538Srpaulo{ 1288251538Srpaulo struct urtwn_data *bf; 1289251538Srpaulo 1290251538Srpaulo URTWN_ASSERT_LOCKED(sc); 1291251538Srpaulo 1292251538Srpaulo bf = _urtwn_getbuf(sc); 1293294471Savos if (bf == NULL) { 1294294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT, "%s: stop queue\n", 1295294471Savos __func__); 1296294471Savos } 1297251538Srpaulo return (bf); 1298251538Srpaulo} 1299251538Srpaulo 1300291698Savosstatic usb_error_t 1301251538Srpaulourtwn_write_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf, 1302251538Srpaulo int len) 1303251538Srpaulo{ 1304251538Srpaulo usb_device_request_t req; 1305251538Srpaulo 1306251538Srpaulo req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 1307251538Srpaulo req.bRequest = R92C_REQ_REGS; 1308251538Srpaulo USETW(req.wValue, addr); 1309251538Srpaulo USETW(req.wIndex, 0); 1310251538Srpaulo USETW(req.wLength, len); 1311251538Srpaulo return (urtwn_do_request(sc, &req, buf)); 1312251538Srpaulo} 1313251538Srpaulo 1314291698Savosstatic usb_error_t 1315251538Srpaulourtwn_write_1(struct urtwn_softc *sc, uint16_t addr, uint8_t val) 1316251538Srpaulo{ 1317291698Savos return (urtwn_write_region_1(sc, addr, &val, sizeof(val))); 1318251538Srpaulo} 1319251538Srpaulo 1320291698Savosstatic usb_error_t 1321251538Srpaulourtwn_write_2(struct urtwn_softc *sc, uint16_t addr, uint16_t val) 1322251538Srpaulo{ 1323251538Srpaulo val = htole16(val); 1324291698Savos return (urtwn_write_region_1(sc, addr, (uint8_t *)&val, sizeof(val))); 1325251538Srpaulo} 1326251538Srpaulo 1327291698Savosstatic usb_error_t 1328251538Srpaulourtwn_write_4(struct urtwn_softc *sc, uint16_t addr, uint32_t val) 1329251538Srpaulo{ 1330251538Srpaulo val = htole32(val); 1331291698Savos return (urtwn_write_region_1(sc, addr, (uint8_t *)&val, sizeof(val))); 1332251538Srpaulo} 1333251538Srpaulo 1334291698Savosstatic usb_error_t 1335251538Srpaulourtwn_read_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf, 1336251538Srpaulo int len) 1337251538Srpaulo{ 1338251538Srpaulo usb_device_request_t req; 1339251538Srpaulo 1340251538Srpaulo req.bmRequestType = UT_READ_VENDOR_DEVICE; 1341251538Srpaulo req.bRequest = R92C_REQ_REGS; 1342251538Srpaulo USETW(req.wValue, addr); 1343251538Srpaulo USETW(req.wIndex, 0); 1344251538Srpaulo USETW(req.wLength, len); 1345251538Srpaulo return (urtwn_do_request(sc, &req, buf)); 1346251538Srpaulo} 1347251538Srpaulo 1348251538Srpaulostatic uint8_t 1349251538Srpaulourtwn_read_1(struct urtwn_softc *sc, uint16_t addr) 1350251538Srpaulo{ 1351251538Srpaulo uint8_t val; 1352251538Srpaulo 1353251538Srpaulo if (urtwn_read_region_1(sc, addr, &val, 1) != 0) 1354251538Srpaulo return (0xff); 1355251538Srpaulo return (val); 1356251538Srpaulo} 1357251538Srpaulo 1358251538Srpaulostatic uint16_t 1359251538Srpaulourtwn_read_2(struct urtwn_softc *sc, uint16_t addr) 1360251538Srpaulo{ 1361251538Srpaulo uint16_t val; 1362251538Srpaulo 1363251538Srpaulo if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 2) != 0) 1364251538Srpaulo return (0xffff); 1365251538Srpaulo return (le16toh(val)); 1366251538Srpaulo} 1367251538Srpaulo 1368251538Srpaulostatic uint32_t 1369251538Srpaulourtwn_read_4(struct urtwn_softc *sc, uint16_t addr) 1370251538Srpaulo{ 1371251538Srpaulo uint32_t val; 1372251538Srpaulo 1373251538Srpaulo if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 4) != 0) 1374251538Srpaulo return (0xffffffff); 1375251538Srpaulo return (le32toh(val)); 1376251538Srpaulo} 1377251538Srpaulo 1378251538Srpaulostatic int 1379251538Srpaulourtwn_fw_cmd(struct urtwn_softc *sc, uint8_t id, const void *buf, int len) 1380251538Srpaulo{ 1381251538Srpaulo struct r92c_fw_cmd cmd; 1382291698Savos usb_error_t error; 1383251538Srpaulo int ntries; 1384251538Srpaulo 1385295871Savos if (!(sc->sc_flags & URTWN_FW_LOADED)) { 1386295871Savos URTWN_DPRINTF(sc, URTWN_DEBUG_FIRMWARE, "%s: firmware " 1387295871Savos "was not loaded; command (id %d) will be discarded\n", 1388295871Savos __func__, id); 1389295871Savos return (0); 1390295871Savos } 1391295871Savos 1392251538Srpaulo /* Wait for current FW box to be empty. */ 1393251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 1394251538Srpaulo if (!(urtwn_read_1(sc, R92C_HMETFR) & (1 << sc->fwcur))) 1395251538Srpaulo break; 1396266472Shselasky urtwn_ms_delay(sc); 1397251538Srpaulo } 1398251538Srpaulo if (ntries == 100) { 1399251538Srpaulo device_printf(sc->sc_dev, 1400251538Srpaulo "could not send firmware command\n"); 1401251538Srpaulo return (ETIMEDOUT); 1402251538Srpaulo } 1403251538Srpaulo memset(&cmd, 0, sizeof(cmd)); 1404251538Srpaulo cmd.id = id; 1405251538Srpaulo if (len > 3) 1406251538Srpaulo cmd.id |= R92C_CMD_FLAG_EXT; 1407251538Srpaulo KASSERT(len <= sizeof(cmd.msg), ("urtwn_fw_cmd\n")); 1408251538Srpaulo memcpy(cmd.msg, buf, len); 1409251538Srpaulo 1410251538Srpaulo /* Write the first word last since that will trigger the FW. */ 1411291698Savos error = urtwn_write_region_1(sc, R92C_HMEBOX_EXT(sc->fwcur), 1412251538Srpaulo (uint8_t *)&cmd + 4, 2); 1413291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1414291698Savos return (EIO); 1415291698Savos error = urtwn_write_region_1(sc, R92C_HMEBOX(sc->fwcur), 1416251538Srpaulo (uint8_t *)&cmd + 0, 4); 1417291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1418291698Savos return (EIO); 1419251538Srpaulo 1420251538Srpaulo sc->fwcur = (sc->fwcur + 1) % R92C_H2C_NBOX; 1421251538Srpaulo return (0); 1422251538Srpaulo} 1423251538Srpaulo 1424292174Savosstatic void 1425292174Savosurtwn_cmdq_cb(void *arg, int pending) 1426292174Savos{ 1427292174Savos struct urtwn_softc *sc = arg; 1428292174Savos struct urtwn_cmdq *item; 1429292174Savos 1430292174Savos /* 1431292174Savos * Device must be powered on (via urtwn_power_on()) 1432292174Savos * before any command may be sent. 1433292174Savos */ 1434292174Savos URTWN_LOCK(sc); 1435292174Savos if (!(sc->sc_flags & URTWN_RUNNING)) { 1436292174Savos URTWN_UNLOCK(sc); 1437292174Savos return; 1438292174Savos } 1439292174Savos 1440292174Savos URTWN_CMDQ_LOCK(sc); 1441292174Savos while (sc->cmdq[sc->cmdq_first].func != NULL) { 1442292174Savos item = &sc->cmdq[sc->cmdq_first]; 1443292174Savos sc->cmdq_first = (sc->cmdq_first + 1) % URTWN_CMDQ_SIZE; 1444292174Savos URTWN_CMDQ_UNLOCK(sc); 1445292174Savos 1446292174Savos item->func(sc, &item->data); 1447292174Savos 1448292174Savos URTWN_CMDQ_LOCK(sc); 1449292174Savos memset(item, 0, sizeof (*item)); 1450292174Savos } 1451292174Savos URTWN_CMDQ_UNLOCK(sc); 1452292174Savos URTWN_UNLOCK(sc); 1453292174Savos} 1454292174Savos 1455292174Savosstatic int 1456292174Savosurtwn_cmd_sleepable(struct urtwn_softc *sc, const void *ptr, size_t len, 1457292174Savos CMD_FUNC_PROTO) 1458292174Savos{ 1459292174Savos struct ieee80211com *ic = &sc->sc_ic; 1460292174Savos 1461292174Savos KASSERT(len <= sizeof(union sec_param), ("buffer overflow")); 1462292174Savos 1463292174Savos URTWN_CMDQ_LOCK(sc); 1464292174Savos if (sc->cmdq[sc->cmdq_last].func != NULL) { 1465292174Savos device_printf(sc->sc_dev, "%s: cmdq overflow\n", __func__); 1466292174Savos URTWN_CMDQ_UNLOCK(sc); 1467292174Savos 1468292174Savos return (EAGAIN); 1469292174Savos } 1470292174Savos 1471292174Savos if (ptr != NULL) 1472292174Savos memcpy(&sc->cmdq[sc->cmdq_last].data, ptr, len); 1473292174Savos sc->cmdq[sc->cmdq_last].func = func; 1474292174Savos sc->cmdq_last = (sc->cmdq_last + 1) % URTWN_CMDQ_SIZE; 1475292174Savos URTWN_CMDQ_UNLOCK(sc); 1476292174Savos 1477292174Savos ieee80211_runtask(ic, &sc->cmdq_task); 1478292174Savos 1479292174Savos return (0); 1480292174Savos} 1481292174Savos 1482264912Skevlostatic __inline void 1483251538Srpaulourtwn_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, uint32_t val) 1484251538Srpaulo{ 1485264912Skevlo 1486264912Skevlo sc->sc_rf_write(sc, chain, addr, val); 1487264912Skevlo} 1488264912Skevlo 1489264912Skevlostatic void 1490264912Skevlourtwn_r92c_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, 1491264912Skevlo uint32_t val) 1492264912Skevlo{ 1493251538Srpaulo urtwn_bb_write(sc, R92C_LSSI_PARAM(chain), 1494251538Srpaulo SM(R92C_LSSI_PARAM_ADDR, addr) | 1495251538Srpaulo SM(R92C_LSSI_PARAM_DATA, val)); 1496251538Srpaulo} 1497251538Srpaulo 1498264912Skevlostatic void 1499264912Skevlourtwn_r88e_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, 1500264912Skevlouint32_t val) 1501264912Skevlo{ 1502264912Skevlo urtwn_bb_write(sc, R92C_LSSI_PARAM(chain), 1503264912Skevlo SM(R88E_LSSI_PARAM_ADDR, addr) | 1504264912Skevlo SM(R92C_LSSI_PARAM_DATA, val)); 1505264912Skevlo} 1506264912Skevlo 1507251538Srpaulostatic uint32_t 1508251538Srpaulourtwn_rf_read(struct urtwn_softc *sc, int chain, uint8_t addr) 1509251538Srpaulo{ 1510251538Srpaulo uint32_t reg[R92C_MAX_CHAINS], val; 1511251538Srpaulo 1512251538Srpaulo reg[0] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)); 1513251538Srpaulo if (chain != 0) 1514251538Srpaulo reg[chain] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(chain)); 1515251538Srpaulo 1516251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(0), 1517251538Srpaulo reg[0] & ~R92C_HSSI_PARAM2_READ_EDGE); 1518266472Shselasky urtwn_ms_delay(sc); 1519251538Srpaulo 1520251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(chain), 1521251538Srpaulo RW(reg[chain], R92C_HSSI_PARAM2_READ_ADDR, addr) | 1522251538Srpaulo R92C_HSSI_PARAM2_READ_EDGE); 1523266472Shselasky urtwn_ms_delay(sc); 1524251538Srpaulo 1525251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(0), 1526251538Srpaulo reg[0] | R92C_HSSI_PARAM2_READ_EDGE); 1527266472Shselasky urtwn_ms_delay(sc); 1528251538Srpaulo 1529251538Srpaulo if (urtwn_bb_read(sc, R92C_HSSI_PARAM1(chain)) & R92C_HSSI_PARAM1_PI) 1530251538Srpaulo val = urtwn_bb_read(sc, R92C_HSPI_READBACK(chain)); 1531251538Srpaulo else 1532251538Srpaulo val = urtwn_bb_read(sc, R92C_LSSI_READBACK(chain)); 1533251538Srpaulo return (MS(val, R92C_LSSI_READBACK_DATA)); 1534251538Srpaulo} 1535251538Srpaulo 1536251538Srpaulostatic int 1537251538Srpaulourtwn_llt_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data) 1538251538Srpaulo{ 1539291698Savos usb_error_t error; 1540251538Srpaulo int ntries; 1541251538Srpaulo 1542291698Savos error = urtwn_write_4(sc, R92C_LLT_INIT, 1543251538Srpaulo SM(R92C_LLT_INIT_OP, R92C_LLT_INIT_OP_WRITE) | 1544251538Srpaulo SM(R92C_LLT_INIT_ADDR, addr) | 1545251538Srpaulo SM(R92C_LLT_INIT_DATA, data)); 1546291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1547291698Savos return (EIO); 1548251538Srpaulo /* Wait for write operation to complete. */ 1549251538Srpaulo for (ntries = 0; ntries < 20; ntries++) { 1550251538Srpaulo if (MS(urtwn_read_4(sc, R92C_LLT_INIT), R92C_LLT_INIT_OP) == 1551251538Srpaulo R92C_LLT_INIT_OP_NO_ACTIVE) 1552251538Srpaulo return (0); 1553266472Shselasky urtwn_ms_delay(sc); 1554251538Srpaulo } 1555251538Srpaulo return (ETIMEDOUT); 1556251538Srpaulo} 1557251538Srpaulo 1558291264Savosstatic int 1559291264Savosurtwn_efuse_read_next(struct urtwn_softc *sc, uint8_t *val) 1560251538Srpaulo{ 1561251538Srpaulo uint32_t reg; 1562291698Savos usb_error_t error; 1563251538Srpaulo int ntries; 1564251538Srpaulo 1565291264Savos if (sc->last_rom_addr >= URTWN_EFUSE_MAX_LEN) 1566291264Savos return (EFAULT); 1567291264Savos 1568251538Srpaulo reg = urtwn_read_4(sc, R92C_EFUSE_CTRL); 1569291264Savos reg = RW(reg, R92C_EFUSE_CTRL_ADDR, sc->last_rom_addr); 1570251538Srpaulo reg &= ~R92C_EFUSE_CTRL_VALID; 1571291264Savos 1572291698Savos error = urtwn_write_4(sc, R92C_EFUSE_CTRL, reg); 1573291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1574291698Savos return (EIO); 1575251538Srpaulo /* Wait for read operation to complete. */ 1576251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 1577251538Srpaulo reg = urtwn_read_4(sc, R92C_EFUSE_CTRL); 1578251538Srpaulo if (reg & R92C_EFUSE_CTRL_VALID) 1579291264Savos break; 1580266472Shselasky urtwn_ms_delay(sc); 1581251538Srpaulo } 1582291264Savos if (ntries == 100) { 1583291264Savos device_printf(sc->sc_dev, 1584291264Savos "could not read efuse byte at address 0x%x\n", 1585291264Savos sc->last_rom_addr); 1586291264Savos return (ETIMEDOUT); 1587291264Savos } 1588291264Savos 1589291264Savos *val = MS(reg, R92C_EFUSE_CTRL_DATA); 1590291264Savos sc->last_rom_addr++; 1591291264Savos 1592291264Savos return (0); 1593251538Srpaulo} 1594251538Srpaulo 1595291264Savosstatic int 1596291264Savosurtwn_efuse_read_data(struct urtwn_softc *sc, uint8_t *rom, uint8_t off, 1597291264Savos uint8_t msk) 1598291264Savos{ 1599291264Savos uint8_t reg; 1600291264Savos int i, error; 1601291264Savos 1602291264Savos for (i = 0; i < 4; i++) { 1603291264Savos if (msk & (1 << i)) 1604291264Savos continue; 1605291264Savos error = urtwn_efuse_read_next(sc, ®); 1606291264Savos if (error != 0) 1607291264Savos return (error); 1608294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "rom[0x%03X] == 0x%02X\n", 1609294471Savos off * 8 + i * 2, reg); 1610291264Savos rom[off * 8 + i * 2 + 0] = reg; 1611291264Savos 1612291264Savos error = urtwn_efuse_read_next(sc, ®); 1613291264Savos if (error != 0) 1614291264Savos return (error); 1615294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "rom[0x%03X] == 0x%02X\n", 1616294471Savos off * 8 + i * 2 + 1, reg); 1617291264Savos rom[off * 8 + i * 2 + 1] = reg; 1618291264Savos } 1619291264Savos 1620291264Savos return (0); 1621291264Savos} 1622291264Savos 1623294471Savos#ifdef USB_DEBUG 1624251538Srpaulostatic void 1625291264Savosurtwn_dump_rom_contents(struct urtwn_softc *sc, uint8_t *rom, uint16_t size) 1626251538Srpaulo{ 1627251538Srpaulo int i; 1628251538Srpaulo 1629291264Savos /* Dump ROM contents. */ 1630291264Savos device_printf(sc->sc_dev, "%s:", __func__); 1631291264Savos for (i = 0; i < size; i++) { 1632291264Savos if (i % 32 == 0) 1633291264Savos printf("\n%03X: ", i); 1634291264Savos else if (i % 4 == 0) 1635291264Savos printf(" "); 1636291264Savos 1637291264Savos printf("%02X", rom[i]); 1638291264Savos } 1639291264Savos printf("\n"); 1640291264Savos} 1641291264Savos#endif 1642291264Savos 1643291264Savosstatic int 1644291264Savosurtwn_efuse_read(struct urtwn_softc *sc, uint8_t *rom, uint16_t size) 1645291264Savos{ 1646291264Savos#define URTWN_CHK(res) do { \ 1647291264Savos if ((error = res) != 0) \ 1648291264Savos goto end; \ 1649291264Savos} while(0) 1650291264Savos uint8_t msk, off, reg; 1651291264Savos int error; 1652291264Savos 1653291698Savos URTWN_CHK(urtwn_efuse_switch_power(sc)); 1654264912Skevlo 1655291264Savos /* Read full ROM image. */ 1656291264Savos sc->last_rom_addr = 0; 1657291264Savos memset(rom, 0xff, size); 1658291264Savos 1659291264Savos URTWN_CHK(urtwn_efuse_read_next(sc, ®)); 1660291264Savos while (reg != 0xff) { 1661291264Savos /* check for extended header */ 1662291264Savos if ((sc->chip & URTWN_CHIP_88E) && (reg & 0x1f) == 0x0f) { 1663291264Savos off = reg >> 5; 1664291264Savos URTWN_CHK(urtwn_efuse_read_next(sc, ®)); 1665291264Savos 1666291264Savos if ((reg & 0x0f) != 0x0f) 1667291264Savos off = ((reg & 0xf0) >> 1) | off; 1668291264Savos else 1669291264Savos continue; 1670291264Savos } else 1671291264Savos off = reg >> 4; 1672251538Srpaulo msk = reg & 0xf; 1673291264Savos 1674291264Savos URTWN_CHK(urtwn_efuse_read_data(sc, rom, off, msk)); 1675291264Savos URTWN_CHK(urtwn_efuse_read_next(sc, ®)); 1676251538Srpaulo } 1677291264Savos 1678291264Savosend: 1679291264Savos 1680294471Savos#ifdef USB_DEBUG 1681294471Savos if (sc->sc_debug & URTWN_DEBUG_ROM) 1682291264Savos urtwn_dump_rom_contents(sc, rom, size); 1683251538Srpaulo#endif 1684291264Savos 1685282623Skevlo urtwn_write_1(sc, R92C_EFUSE_ACCESS, R92C_EFUSE_ACCESS_OFF); 1686291264Savos 1687291264Savos if (error != 0) { 1688291264Savos device_printf(sc->sc_dev, "%s: error while reading ROM\n", 1689291264Savos __func__); 1690291264Savos } 1691291264Savos 1692291264Savos return (error); 1693291264Savos#undef URTWN_CHK 1694282623Skevlo} 1695281592Skevlo 1696291698Savosstatic int 1697264912Skevlourtwn_efuse_switch_power(struct urtwn_softc *sc) 1698264912Skevlo{ 1699291698Savos usb_error_t error; 1700264912Skevlo uint32_t reg; 1701251538Srpaulo 1702291698Savos error = urtwn_write_1(sc, R92C_EFUSE_ACCESS, R92C_EFUSE_ACCESS_ON); 1703291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1704291698Savos return (EIO); 1705281918Skevlo 1706264912Skevlo reg = urtwn_read_2(sc, R92C_SYS_ISO_CTRL); 1707264912Skevlo if (!(reg & R92C_SYS_ISO_CTRL_PWC_EV12V)) { 1708291698Savos error = urtwn_write_2(sc, R92C_SYS_ISO_CTRL, 1709264912Skevlo reg | R92C_SYS_ISO_CTRL_PWC_EV12V); 1710291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1711291698Savos return (EIO); 1712264912Skevlo } 1713264912Skevlo reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN); 1714264912Skevlo if (!(reg & R92C_SYS_FUNC_EN_ELDR)) { 1715291698Savos error = urtwn_write_2(sc, R92C_SYS_FUNC_EN, 1716264912Skevlo reg | R92C_SYS_FUNC_EN_ELDR); 1717291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1718291698Savos return (EIO); 1719264912Skevlo } 1720264912Skevlo reg = urtwn_read_2(sc, R92C_SYS_CLKR); 1721264912Skevlo if ((reg & (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) != 1722264912Skevlo (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) { 1723291698Savos error = urtwn_write_2(sc, R92C_SYS_CLKR, 1724264912Skevlo reg | R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M); 1725291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1726291698Savos return (EIO); 1727264912Skevlo } 1728291698Savos 1729291698Savos return (0); 1730264912Skevlo} 1731264912Skevlo 1732251538Srpaulostatic int 1733251538Srpaulourtwn_read_chipid(struct urtwn_softc *sc) 1734251538Srpaulo{ 1735251538Srpaulo uint32_t reg; 1736251538Srpaulo 1737264912Skevlo if (sc->chip & URTWN_CHIP_88E) 1738264912Skevlo return (0); 1739264912Skevlo 1740251538Srpaulo reg = urtwn_read_4(sc, R92C_SYS_CFG); 1741251538Srpaulo if (reg & R92C_SYS_CFG_TRP_VAUX_EN) 1742251538Srpaulo return (EIO); 1743251538Srpaulo 1744251538Srpaulo if (reg & R92C_SYS_CFG_TYPE_92C) { 1745251538Srpaulo sc->chip |= URTWN_CHIP_92C; 1746251538Srpaulo /* Check if it is a castrated 8192C. */ 1747251538Srpaulo if (MS(urtwn_read_4(sc, R92C_HPON_FSM), 1748251538Srpaulo R92C_HPON_FSM_CHIP_BONDING_ID) == 1749251538Srpaulo R92C_HPON_FSM_CHIP_BONDING_ID_92C_1T2R) 1750251538Srpaulo sc->chip |= URTWN_CHIP_92C_1T2R; 1751251538Srpaulo } 1752251538Srpaulo if (reg & R92C_SYS_CFG_VENDOR_UMC) { 1753251538Srpaulo sc->chip |= URTWN_CHIP_UMC; 1754251538Srpaulo if (MS(reg, R92C_SYS_CFG_CHIP_VER_RTL) == 0) 1755251538Srpaulo sc->chip |= URTWN_CHIP_UMC_A_CUT; 1756251538Srpaulo } 1757251538Srpaulo return (0); 1758251538Srpaulo} 1759251538Srpaulo 1760291264Savosstatic int 1761251538Srpaulourtwn_read_rom(struct urtwn_softc *sc) 1762251538Srpaulo{ 1763291264Savos struct r92c_rom *rom = &sc->rom.r92c_rom; 1764291264Savos int error; 1765251538Srpaulo 1766251538Srpaulo /* Read full ROM image. */ 1767291264Savos error = urtwn_efuse_read(sc, (uint8_t *)rom, sizeof(*rom)); 1768291264Savos if (error != 0) 1769291264Savos return (error); 1770251538Srpaulo 1771251538Srpaulo /* XXX Weird but this is what the vendor driver does. */ 1772291264Savos sc->last_rom_addr = 0x1fa; 1773291264Savos error = urtwn_efuse_read_next(sc, &sc->pa_setting); 1774291264Savos if (error != 0) 1775291264Savos return (error); 1776294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "%s: PA setting=0x%x\n", __func__, 1777294471Savos sc->pa_setting); 1778251538Srpaulo 1779251538Srpaulo sc->board_type = MS(rom->rf_opt1, R92C_ROM_RF1_BOARD_TYPE); 1780251538Srpaulo 1781251538Srpaulo sc->regulatory = MS(rom->rf_opt1, R92C_ROM_RF1_REGULATORY); 1782294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "%s: regulatory type=%d\n", 1783294471Savos __func__, sc->regulatory); 1784287197Sglebius IEEE80211_ADDR_COPY(sc->sc_ic.ic_macaddr, rom->macaddr); 1785251538Srpaulo 1786264912Skevlo sc->sc_rf_write = urtwn_r92c_rf_write; 1787264912Skevlo sc->sc_power_on = urtwn_r92c_power_on; 1788295874Savos sc->sc_power_off = urtwn_r92c_power_off; 1789291264Savos 1790291264Savos return (0); 1791251538Srpaulo} 1792251538Srpaulo 1793291264Savosstatic int 1794264912Skevlourtwn_r88e_read_rom(struct urtwn_softc *sc) 1795264912Skevlo{ 1796294198Savos struct r88e_rom *rom = &sc->rom.r88e_rom; 1797294198Savos int error; 1798264912Skevlo 1799294198Savos error = urtwn_efuse_read(sc, (uint8_t *)rom, sizeof(sc->rom.r88e_rom)); 1800291264Savos if (error != 0) 1801291264Savos return (error); 1802264912Skevlo 1803294198Savos sc->bw20_tx_pwr_diff = (rom->tx_pwr_diff >> 4); 1804264912Skevlo if (sc->bw20_tx_pwr_diff & 0x08) 1805264912Skevlo sc->bw20_tx_pwr_diff |= 0xf0; 1806294198Savos sc->ofdm_tx_pwr_diff = (rom->tx_pwr_diff & 0xf); 1807264912Skevlo if (sc->ofdm_tx_pwr_diff & 0x08) 1808264912Skevlo sc->ofdm_tx_pwr_diff |= 0xf0; 1809294198Savos sc->regulatory = MS(rom->rf_board_opt, R92C_ROM_RF1_REGULATORY); 1810294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "%s: regulatory type %d\n", 1811294471Savos __func__,sc->regulatory); 1812294198Savos IEEE80211_ADDR_COPY(sc->sc_ic.ic_macaddr, rom->macaddr); 1813264912Skevlo 1814264912Skevlo sc->sc_rf_write = urtwn_r88e_rf_write; 1815264912Skevlo sc->sc_power_on = urtwn_r88e_power_on; 1816295874Savos sc->sc_power_off = urtwn_r88e_power_off; 1817291264Savos 1818291264Savos return (0); 1819264912Skevlo} 1820264912Skevlo 1821251538Srpaulo/* 1822251538Srpaulo * Initialize rate adaptation in firmware. 1823251538Srpaulo */ 1824251538Srpaulostatic int 1825251538Srpaulourtwn_ra_init(struct urtwn_softc *sc) 1826251538Srpaulo{ 1827287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 1828251538Srpaulo struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 1829251538Srpaulo struct ieee80211_node *ni; 1830251538Srpaulo struct ieee80211_rateset *rs; 1831251538Srpaulo struct r92c_fw_cmd_macid_cfg cmd; 1832251538Srpaulo uint32_t rates, basicrates; 1833251538Srpaulo uint8_t mode; 1834251538Srpaulo int maxrate, maxbasicrate, error, i, j; 1835251538Srpaulo 1836251538Srpaulo ni = ieee80211_ref_node(vap->iv_bss); 1837251538Srpaulo rs = &ni->ni_rates; 1838251538Srpaulo 1839251538Srpaulo /* Get normal and basic rates mask. */ 1840251538Srpaulo rates = basicrates = 0; 1841251538Srpaulo maxrate = maxbasicrate = 0; 1842251538Srpaulo for (i = 0; i < rs->rs_nrates; i++) { 1843251538Srpaulo /* Convert 802.11 rate to HW rate index. */ 1844289758Savos for (j = 0; j < nitems(ridx2rate); j++) 1845289758Savos if ((rs->rs_rates[i] & IEEE80211_RATE_VAL) == 1846289758Savos ridx2rate[j]) 1847251538Srpaulo break; 1848289758Savos if (j == nitems(ridx2rate)) /* Unknown rate, skip. */ 1849251538Srpaulo continue; 1850251538Srpaulo rates |= 1 << j; 1851251538Srpaulo if (j > maxrate) 1852251538Srpaulo maxrate = j; 1853251538Srpaulo if (rs->rs_rates[i] & IEEE80211_RATE_BASIC) { 1854251538Srpaulo basicrates |= 1 << j; 1855251538Srpaulo if (j > maxbasicrate) 1856251538Srpaulo maxbasicrate = j; 1857251538Srpaulo } 1858251538Srpaulo } 1859251538Srpaulo if (ic->ic_curmode == IEEE80211_MODE_11B) 1860251538Srpaulo mode = R92C_RAID_11B; 1861251538Srpaulo else 1862251538Srpaulo mode = R92C_RAID_11BG; 1863294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_RA, 1864294471Savos "%s: mode 0x%x, rates 0x%08x, basicrates 0x%08x\n", __func__, 1865251538Srpaulo mode, rates, basicrates); 1866251538Srpaulo 1867251538Srpaulo /* Set rates mask for group addressed frames. */ 1868251538Srpaulo cmd.macid = URTWN_MACID_BC | URTWN_MACID_VALID; 1869251538Srpaulo cmd.mask = htole32(mode << 28 | basicrates); 1870251538Srpaulo error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd)); 1871251538Srpaulo if (error != 0) { 1872252401Srpaulo ieee80211_free_node(ni); 1873251538Srpaulo device_printf(sc->sc_dev, 1874251538Srpaulo "could not add broadcast station\n"); 1875251538Srpaulo return (error); 1876251538Srpaulo } 1877251538Srpaulo /* Set initial MRR rate. */ 1878294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_RA, "%s: maxbasicrate %d\n", __func__, 1879294471Savos maxbasicrate); 1880251538Srpaulo urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BC), 1881251538Srpaulo maxbasicrate); 1882251538Srpaulo 1883251538Srpaulo /* Set rates mask for unicast frames. */ 1884251538Srpaulo cmd.macid = URTWN_MACID_BSS | URTWN_MACID_VALID; 1885251538Srpaulo cmd.mask = htole32(mode << 28 | rates); 1886251538Srpaulo error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd)); 1887251538Srpaulo if (error != 0) { 1888252401Srpaulo ieee80211_free_node(ni); 1889251538Srpaulo device_printf(sc->sc_dev, "could not add BSS station\n"); 1890251538Srpaulo return (error); 1891251538Srpaulo } 1892251538Srpaulo /* Set initial MRR rate. */ 1893294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_RA, "%s: maxrate %d\n", __func__, 1894294471Savos maxrate); 1895251538Srpaulo urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BSS), 1896251538Srpaulo maxrate); 1897251538Srpaulo 1898251538Srpaulo /* Indicate highest supported rate. */ 1899252403Srpaulo ni->ni_txrate = rs->rs_rates[rs->rs_nrates - 1]; 1900252401Srpaulo ieee80211_free_node(ni); 1901252401Srpaulo 1902251538Srpaulo return (0); 1903251538Srpaulo} 1904251538Srpaulo 1905290439Savosstatic void 1906290631Savosurtwn_init_beacon(struct urtwn_softc *sc, struct urtwn_vap *uvp) 1907251538Srpaulo{ 1908290631Savos struct r92c_tx_desc *txd = &uvp->bcn_desc; 1909290631Savos 1910290631Savos txd->txdw0 = htole32( 1911290631Savos SM(R92C_TXDW0_OFFSET, sizeof(*txd)) | R92C_TXDW0_BMCAST | 1912290631Savos R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG); 1913290631Savos txd->txdw1 = htole32( 1914290631Savos SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_BEACON) | 1915290631Savos SM(R92C_TXDW1_RAID, R92C_RAID_11B)); 1916290631Savos 1917291858Savos if (sc->chip & URTWN_CHIP_88E) { 1918290631Savos txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, URTWN_MACID_BC)); 1919291858Savos txd->txdseq |= htole16(R88E_TXDSEQ_HWSEQ_EN); 1920291858Savos } else { 1921290631Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, URTWN_MACID_BC)); 1922291858Savos txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN); 1923291858Savos } 1924290631Savos 1925290631Savos txd->txdw4 = htole32(R92C_TXDW4_DRVRATE); 1926290631Savos txd->txdw5 = htole32(SM(R92C_TXDW5_DATARATE, URTWN_RIDX_CCK1)); 1927251538Srpaulo} 1928251538Srpaulo 1929290631Savosstatic int 1930290631Savosurtwn_setup_beacon(struct urtwn_softc *sc, struct ieee80211_node *ni) 1931290631Savos{ 1932290631Savos struct ieee80211vap *vap = ni->ni_vap; 1933290631Savos struct urtwn_vap *uvp = URTWN_VAP(vap); 1934290631Savos struct mbuf *m; 1935290631Savos int error; 1936290631Savos 1937290631Savos URTWN_ASSERT_LOCKED(sc); 1938290631Savos 1939290631Savos if (ni->ni_chan == IEEE80211_CHAN_ANYC) 1940290631Savos return (EINVAL); 1941290631Savos 1942290631Savos m = ieee80211_beacon_alloc(ni); 1943290631Savos if (m == NULL) { 1944290631Savos device_printf(sc->sc_dev, 1945290631Savos "%s: could not allocate beacon frame\n", __func__); 1946290631Savos return (ENOMEM); 1947290631Savos } 1948290631Savos 1949290631Savos if (uvp->bcn_mbuf != NULL) 1950290631Savos m_freem(uvp->bcn_mbuf); 1951290631Savos 1952290631Savos uvp->bcn_mbuf = m; 1953290631Savos 1954290631Savos if ((error = urtwn_tx_beacon(sc, uvp)) != 0) 1955290631Savos return (error); 1956290631Savos 1957290631Savos /* XXX bcnq stuck workaround */ 1958290631Savos if ((error = urtwn_tx_beacon(sc, uvp)) != 0) 1959290631Savos return (error); 1960290631Savos 1961294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_BEACON, "%s: beacon was %srecognized\n", 1962294471Savos __func__, urtwn_read_1(sc, R92C_TDECTRL + 2) & 1963294471Savos (R92C_TDECTRL_BCN_VALID >> 16) ? "" : "not "); 1964294471Savos 1965290631Savos return (0); 1966290631Savos} 1967290631Savos 1968251538Srpaulostatic void 1969290631Savosurtwn_update_beacon(struct ieee80211vap *vap, int item) 1970290631Savos{ 1971290631Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 1972290631Savos struct urtwn_vap *uvp = URTWN_VAP(vap); 1973290631Savos struct ieee80211_beacon_offsets *bo = &vap->iv_bcn_off; 1974290631Savos struct ieee80211_node *ni = vap->iv_bss; 1975290631Savos int mcast = 0; 1976290631Savos 1977290631Savos URTWN_LOCK(sc); 1978290631Savos if (uvp->bcn_mbuf == NULL) { 1979290631Savos uvp->bcn_mbuf = ieee80211_beacon_alloc(ni); 1980290631Savos if (uvp->bcn_mbuf == NULL) { 1981290631Savos device_printf(sc->sc_dev, 1982290631Savos "%s: could not allocate beacon frame\n", __func__); 1983290631Savos URTWN_UNLOCK(sc); 1984290631Savos return; 1985290631Savos } 1986290631Savos } 1987290631Savos URTWN_UNLOCK(sc); 1988290631Savos 1989290631Savos if (item == IEEE80211_BEACON_TIM) 1990290631Savos mcast = 1; /* XXX */ 1991290631Savos 1992290631Savos setbit(bo->bo_flags, item); 1993290631Savos ieee80211_beacon_update(ni, uvp->bcn_mbuf, mcast); 1994290631Savos 1995290631Savos URTWN_LOCK(sc); 1996290631Savos urtwn_tx_beacon(sc, uvp); 1997290631Savos URTWN_UNLOCK(sc); 1998290631Savos} 1999290631Savos 2000290631Savos/* 2001290631Savos * Push a beacon frame into the chip. Beacon will 2002290631Savos * be repeated by the chip every R92C_BCN_INTERVAL. 2003290631Savos */ 2004290631Savosstatic int 2005290631Savosurtwn_tx_beacon(struct urtwn_softc *sc, struct urtwn_vap *uvp) 2006290631Savos{ 2007290631Savos struct r92c_tx_desc *desc = &uvp->bcn_desc; 2008290631Savos struct urtwn_data *bf; 2009290631Savos 2010290631Savos URTWN_ASSERT_LOCKED(sc); 2011290631Savos 2012290631Savos bf = urtwn_getbuf(sc); 2013290631Savos if (bf == NULL) 2014290631Savos return (ENOMEM); 2015290631Savos 2016290631Savos memcpy(bf->buf, desc, sizeof(*desc)); 2017290631Savos urtwn_tx_start(sc, uvp->bcn_mbuf, IEEE80211_FC0_TYPE_MGT, bf); 2018290631Savos 2019290631Savos sc->sc_txtimer = 5; 2020290631Savos callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 2021290631Savos 2022290631Savos return (0); 2023290631Savos} 2024290631Savos 2025292175Savosstatic int 2026292175Savosurtwn_key_alloc(struct ieee80211vap *vap, struct ieee80211_key *k, 2027292175Savos ieee80211_keyix *keyix, ieee80211_keyix *rxkeyix) 2028292175Savos{ 2029292175Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2030292175Savos uint8_t i; 2031292175Savos 2032292175Savos if (!(&vap->iv_nw_keys[0] <= k && 2033292175Savos k < &vap->iv_nw_keys[IEEE80211_WEP_NKID])) { 2034292175Savos if (!(k->wk_flags & IEEE80211_KEY_SWCRYPT)) { 2035292175Savos URTWN_LOCK(sc); 2036292175Savos /* 2037292175Savos * First 4 slots for group keys, 2038292175Savos * what is left - for pairwise. 2039292175Savos * XXX incompatible with IBSS RSN. 2040292175Savos */ 2041292175Savos for (i = IEEE80211_WEP_NKID; 2042292175Savos i < R92C_CAM_ENTRY_COUNT; i++) { 2043292175Savos if ((sc->keys_bmap & (1 << i)) == 0) { 2044292175Savos sc->keys_bmap |= 1 << i; 2045292175Savos *keyix = i; 2046292175Savos break; 2047292175Savos } 2048292175Savos } 2049292175Savos URTWN_UNLOCK(sc); 2050292175Savos if (i == R92C_CAM_ENTRY_COUNT) { 2051292175Savos device_printf(sc->sc_dev, 2052292175Savos "%s: no free space in the key table\n", 2053292175Savos __func__); 2054292175Savos return 0; 2055292175Savos } 2056292175Savos } else 2057292175Savos *keyix = 0; 2058292175Savos } else { 2059292175Savos *keyix = k - vap->iv_nw_keys; 2060292175Savos } 2061292175Savos *rxkeyix = *keyix; 2062292175Savos return 1; 2063292175Savos} 2064292175Savos 2065290631Savosstatic void 2066292175Savosurtwn_key_set_cb(struct urtwn_softc *sc, union sec_param *data) 2067292175Savos{ 2068292175Savos struct ieee80211_key *k = &data->key; 2069292175Savos uint8_t algo, keyid; 2070292175Savos int i, error; 2071292175Savos 2072292175Savos if (k->wk_keyix < IEEE80211_WEP_NKID) 2073292175Savos keyid = k->wk_keyix; 2074292175Savos else 2075292175Savos keyid = 0; 2076292175Savos 2077292175Savos /* Map net80211 cipher to HW crypto algorithm. */ 2078292175Savos switch (k->wk_cipher->ic_cipher) { 2079292175Savos case IEEE80211_CIPHER_WEP: 2080292175Savos if (k->wk_keylen < 8) 2081292175Savos algo = R92C_CAM_ALGO_WEP40; 2082292175Savos else 2083292175Savos algo = R92C_CAM_ALGO_WEP104; 2084292175Savos break; 2085292175Savos case IEEE80211_CIPHER_TKIP: 2086292175Savos algo = R92C_CAM_ALGO_TKIP; 2087292175Savos break; 2088292175Savos case IEEE80211_CIPHER_AES_CCM: 2089292175Savos algo = R92C_CAM_ALGO_AES; 2090292175Savos break; 2091292175Savos default: 2092292175Savos device_printf(sc->sc_dev, "%s: undefined cipher %d\n", 2093292175Savos __func__, k->wk_cipher->ic_cipher); 2094292175Savos return; 2095292175Savos } 2096292175Savos 2097294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_KEY, 2098294471Savos "%s: keyix %d, keyid %d, algo %d/%d, flags %04X, len %d, " 2099294471Savos "macaddr %s\n", __func__, k->wk_keyix, keyid, 2100294471Savos k->wk_cipher->ic_cipher, algo, k->wk_flags, k->wk_keylen, 2101294471Savos ether_sprintf(k->wk_macaddr)); 2102292175Savos 2103292175Savos /* Write key. */ 2104292175Savos for (i = 0; i < 4; i++) { 2105292175Savos error = urtwn_cam_write(sc, R92C_CAM_KEY(k->wk_keyix, i), 2106292175Savos LE_READ_4(&k->wk_key[i * 4])); 2107292175Savos if (error != 0) 2108292175Savos goto fail; 2109292175Savos } 2110292175Savos 2111292175Savos /* Write CTL0 last since that will validate the CAM entry. */ 2112292175Savos error = urtwn_cam_write(sc, R92C_CAM_CTL1(k->wk_keyix), 2113292175Savos LE_READ_4(&k->wk_macaddr[2])); 2114292175Savos if (error != 0) 2115292175Savos goto fail; 2116292175Savos error = urtwn_cam_write(sc, R92C_CAM_CTL0(k->wk_keyix), 2117292175Savos SM(R92C_CAM_ALGO, algo) | 2118292175Savos SM(R92C_CAM_KEYID, keyid) | 2119292175Savos SM(R92C_CAM_MACLO, LE_READ_2(&k->wk_macaddr[0])) | 2120292175Savos R92C_CAM_VALID); 2121292175Savos if (error != 0) 2122292175Savos goto fail; 2123292175Savos 2124292175Savos return; 2125292175Savos 2126292175Savosfail: 2127292175Savos device_printf(sc->sc_dev, "%s fails, error %d\n", __func__, error); 2128292175Savos} 2129292175Savos 2130292175Savosstatic void 2131292175Savosurtwn_key_del_cb(struct urtwn_softc *sc, union sec_param *data) 2132292175Savos{ 2133292175Savos struct ieee80211_key *k = &data->key; 2134292175Savos int i; 2135292175Savos 2136294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_KEY, 2137294471Savos "%s: keyix %d, flags %04X, macaddr %s\n", __func__, 2138292175Savos k->wk_keyix, k->wk_flags, ether_sprintf(k->wk_macaddr)); 2139292175Savos 2140292175Savos urtwn_cam_write(sc, R92C_CAM_CTL0(k->wk_keyix), 0); 2141292175Savos urtwn_cam_write(sc, R92C_CAM_CTL1(k->wk_keyix), 0); 2142292175Savos 2143292175Savos /* Clear key. */ 2144292175Savos for (i = 0; i < 4; i++) 2145292175Savos urtwn_cam_write(sc, R92C_CAM_KEY(k->wk_keyix, i), 0); 2146292175Savos sc->keys_bmap &= ~(1 << k->wk_keyix); 2147292175Savos} 2148292175Savos 2149292175Savosstatic int 2150292175Savosurtwn_key_set(struct ieee80211vap *vap, const struct ieee80211_key *k) 2151292175Savos{ 2152292175Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2153292175Savos 2154292175Savos if (k->wk_flags & IEEE80211_KEY_SWCRYPT) { 2155292175Savos /* Not for us. */ 2156292175Savos return (1); 2157292175Savos } 2158292175Savos 2159292175Savos return (!urtwn_cmd_sleepable(sc, k, sizeof(*k), urtwn_key_set_cb)); 2160292175Savos} 2161292175Savos 2162292175Savosstatic int 2163292175Savosurtwn_key_delete(struct ieee80211vap *vap, const struct ieee80211_key *k) 2164292175Savos{ 2165292175Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2166292175Savos 2167292175Savos if (k->wk_flags & IEEE80211_KEY_SWCRYPT) { 2168292175Savos /* Not for us. */ 2169292175Savos return (1); 2170292175Savos } 2171292175Savos 2172292175Savos return (!urtwn_cmd_sleepable(sc, k, sizeof(*k), urtwn_key_del_cb)); 2173292175Savos} 2174292175Savos 2175292175Savosstatic void 2176290651Savosurtwn_tsf_task_adhoc(void *arg, int pending) 2177290651Savos{ 2178290651Savos struct ieee80211vap *vap = arg; 2179290651Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2180290651Savos struct ieee80211_node *ni; 2181290651Savos uint32_t reg; 2182290651Savos 2183290651Savos URTWN_LOCK(sc); 2184290651Savos ni = ieee80211_ref_node(vap->iv_bss); 2185290651Savos reg = urtwn_read_1(sc, R92C_BCN_CTRL); 2186290651Savos 2187290651Savos /* Accept beacons with the same BSSID. */ 2188290651Savos urtwn_set_rx_bssid_all(sc, 0); 2189290651Savos 2190290651Savos /* Enable synchronization. */ 2191290651Savos reg &= ~R92C_BCN_CTRL_DIS_TSF_UDT0; 2192290651Savos urtwn_write_1(sc, R92C_BCN_CTRL, reg); 2193290651Savos 2194290651Savos /* Synchronize. */ 2195290651Savos usb_pause_mtx(&sc->sc_mtx, hz * ni->ni_intval * 5 / 1000); 2196290651Savos 2197290651Savos /* Disable synchronization. */ 2198290651Savos reg |= R92C_BCN_CTRL_DIS_TSF_UDT0; 2199290651Savos urtwn_write_1(sc, R92C_BCN_CTRL, reg); 2200290651Savos 2201290651Savos /* Remove beacon filter. */ 2202290651Savos urtwn_set_rx_bssid_all(sc, 1); 2203290651Savos 2204290651Savos /* Enable beaconing. */ 2205290651Savos urtwn_write_1(sc, R92C_MBID_NUM, 2206290651Savos urtwn_read_1(sc, R92C_MBID_NUM) | R92C_MBID_TXBCN_RPT0); 2207290651Savos reg |= R92C_BCN_CTRL_EN_BCN; 2208290651Savos 2209290651Savos urtwn_write_1(sc, R92C_BCN_CTRL, reg); 2210290651Savos ieee80211_free_node(ni); 2211290651Savos URTWN_UNLOCK(sc); 2212290651Savos} 2213290651Savos 2214290651Savosstatic void 2215290631Savosurtwn_tsf_sync_enable(struct urtwn_softc *sc, struct ieee80211vap *vap) 2216290631Savos{ 2217290651Savos struct ieee80211com *ic = &sc->sc_ic; 2218290651Savos struct urtwn_vap *uvp = URTWN_VAP(vap); 2219290651Savos 2220290631Savos /* Reset TSF. */ 2221290631Savos urtwn_write_1(sc, R92C_DUAL_TSF_RST, R92C_DUAL_TSF_RST0); 2222290631Savos 2223290631Savos switch (vap->iv_opmode) { 2224290631Savos case IEEE80211_M_STA: 2225290631Savos /* Enable TSF synchronization. */ 2226290631Savos urtwn_write_1(sc, R92C_BCN_CTRL, 2227290631Savos urtwn_read_1(sc, R92C_BCN_CTRL) & 2228290631Savos ~R92C_BCN_CTRL_DIS_TSF_UDT0); 2229290631Savos break; 2230290651Savos case IEEE80211_M_IBSS: 2231290651Savos ieee80211_runtask(ic, &uvp->tsf_task_adhoc); 2232290651Savos break; 2233290631Savos case IEEE80211_M_HOSTAP: 2234290631Savos /* Enable beaconing. */ 2235290631Savos urtwn_write_1(sc, R92C_MBID_NUM, 2236290631Savos urtwn_read_1(sc, R92C_MBID_NUM) | R92C_MBID_TXBCN_RPT0); 2237290631Savos urtwn_write_1(sc, R92C_BCN_CTRL, 2238290631Savos urtwn_read_1(sc, R92C_BCN_CTRL) | R92C_BCN_CTRL_EN_BCN); 2239290631Savos break; 2240290631Savos default: 2241290631Savos device_printf(sc->sc_dev, "undefined opmode %d\n", 2242290631Savos vap->iv_opmode); 2243290631Savos return; 2244290631Savos } 2245290631Savos} 2246290631Savos 2247290631Savosstatic void 2248292203Savosurtwn_get_tsf(struct urtwn_softc *sc, uint64_t *buf) 2249292203Savos{ 2250292203Savos urtwn_read_region_1(sc, R92C_TSFTR, (uint8_t *)buf, sizeof(*buf)); 2251292203Savos} 2252292203Savos 2253292203Savosstatic void 2254251538Srpaulourtwn_set_led(struct urtwn_softc *sc, int led, int on) 2255251538Srpaulo{ 2256251538Srpaulo uint8_t reg; 2257281069Srpaulo 2258251538Srpaulo if (led == URTWN_LED_LINK) { 2259264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 2260264912Skevlo reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0xf0; 2261264912Skevlo urtwn_write_1(sc, R92C_LEDCFG2, reg | 0x60); 2262264912Skevlo if (!on) { 2263264912Skevlo reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0x90; 2264264912Skevlo urtwn_write_1(sc, R92C_LEDCFG2, 2265264912Skevlo reg | R92C_LEDCFG0_DIS); 2266264912Skevlo urtwn_write_1(sc, R92C_MAC_PINMUX_CFG, 2267264912Skevlo urtwn_read_1(sc, R92C_MAC_PINMUX_CFG) & 2268264912Skevlo 0xfe); 2269264912Skevlo } 2270264912Skevlo } else { 2271264912Skevlo reg = urtwn_read_1(sc, R92C_LEDCFG0) & 0x70; 2272264912Skevlo if (!on) 2273264912Skevlo reg |= R92C_LEDCFG0_DIS; 2274264912Skevlo urtwn_write_1(sc, R92C_LEDCFG0, reg); 2275264912Skevlo } 2276264912Skevlo sc->ledlink = on; /* Save LED state. */ 2277251538Srpaulo } 2278251538Srpaulo} 2279251538Srpaulo 2280289811Savosstatic void 2281289811Savosurtwn_set_mode(struct urtwn_softc *sc, uint8_t mode) 2282289811Savos{ 2283289811Savos uint8_t reg; 2284289811Savos 2285289811Savos reg = urtwn_read_1(sc, R92C_MSR); 2286289811Savos reg = (reg & ~R92C_MSR_MASK) | mode; 2287289811Savos urtwn_write_1(sc, R92C_MSR, reg); 2288289811Savos} 2289289811Savos 2290290651Savosstatic void 2291290651Savosurtwn_ibss_recv_mgmt(struct ieee80211_node *ni, struct mbuf *m, int subtype, 2292290651Savos const struct ieee80211_rx_stats *rxs, 2293290651Savos int rssi, int nf) 2294290651Savos{ 2295290651Savos struct ieee80211vap *vap = ni->ni_vap; 2296290651Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2297290651Savos struct urtwn_vap *uvp = URTWN_VAP(vap); 2298290651Savos uint64_t ni_tstamp, curr_tstamp; 2299290651Savos 2300290651Savos uvp->recv_mgmt(ni, m, subtype, rxs, rssi, nf); 2301290651Savos 2302290651Savos if (vap->iv_state == IEEE80211_S_RUN && 2303290651Savos (subtype == IEEE80211_FC0_SUBTYPE_BEACON || 2304290651Savos subtype == IEEE80211_FC0_SUBTYPE_PROBE_RESP)) { 2305290651Savos ni_tstamp = le64toh(ni->ni_tstamp.tsf); 2306290651Savos URTWN_LOCK(sc); 2307290651Savos urtwn_get_tsf(sc, &curr_tstamp); 2308290651Savos URTWN_UNLOCK(sc); 2309290651Savos curr_tstamp = le64toh(curr_tstamp); 2310290651Savos 2311290651Savos if (ni_tstamp >= curr_tstamp) 2312290651Savos (void) ieee80211_ibss_merge(ni); 2313290651Savos } 2314290651Savos} 2315290651Savos 2316251538Srpaulostatic int 2317251538Srpaulourtwn_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 2318251538Srpaulo{ 2319251538Srpaulo struct urtwn_vap *uvp = URTWN_VAP(vap); 2320251538Srpaulo struct ieee80211com *ic = vap->iv_ic; 2321286949Sadrian struct urtwn_softc *sc = ic->ic_softc; 2322251538Srpaulo struct ieee80211_node *ni; 2323251538Srpaulo enum ieee80211_state ostate; 2324290631Savos uint32_t reg; 2325290631Savos uint8_t mode; 2326290631Savos int error = 0; 2327251538Srpaulo 2328251538Srpaulo ostate = vap->iv_state; 2329294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_STATE, "%s -> %s\n", 2330294471Savos ieee80211_state_name[ostate], ieee80211_state_name[nstate]); 2331251538Srpaulo 2332251538Srpaulo IEEE80211_UNLOCK(ic); 2333251538Srpaulo URTWN_LOCK(sc); 2334251538Srpaulo callout_stop(&sc->sc_watchdog_ch); 2335251538Srpaulo 2336251538Srpaulo if (ostate == IEEE80211_S_RUN) { 2337294473Savos /* Stop calibration. */ 2338294473Savos callout_stop(&sc->sc_calib_to); 2339294473Savos 2340251538Srpaulo /* Turn link LED off. */ 2341251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 0); 2342251538Srpaulo 2343251538Srpaulo /* Set media status to 'No Link'. */ 2344289811Savos urtwn_set_mode(sc, R92C_MSR_NOLINK); 2345251538Srpaulo 2346251538Srpaulo /* Stop Rx of data frames. */ 2347251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP2, 0); 2348251538Srpaulo 2349251538Srpaulo /* Disable TSF synchronization. */ 2350251538Srpaulo urtwn_write_1(sc, R92C_BCN_CTRL, 2351290631Savos (urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_EN_BCN) | 2352251538Srpaulo R92C_BCN_CTRL_DIS_TSF_UDT0); 2353251538Srpaulo 2354290631Savos /* Disable beaconing. */ 2355290631Savos urtwn_write_1(sc, R92C_MBID_NUM, 2356290631Savos urtwn_read_1(sc, R92C_MBID_NUM) & ~R92C_MBID_TXBCN_RPT0); 2357290631Savos 2358290631Savos /* Reset TSF. */ 2359290631Savos urtwn_write_1(sc, R92C_DUAL_TSF_RST, R92C_DUAL_TSF_RST0); 2360290631Savos 2361251538Srpaulo /* Reset EDCA parameters. */ 2362251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002f3217); 2363251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005e4317); 2364251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x00105320); 2365251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a444); 2366251538Srpaulo } 2367251538Srpaulo 2368251538Srpaulo switch (nstate) { 2369251538Srpaulo case IEEE80211_S_INIT: 2370251538Srpaulo /* Turn link LED off. */ 2371251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 0); 2372251538Srpaulo break; 2373251538Srpaulo case IEEE80211_S_SCAN: 2374251538Srpaulo /* Pause AC Tx queues. */ 2375251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 2376293180Savos urtwn_read_1(sc, R92C_TXPAUSE) | R92C_TX_QUEUE_AC); 2377251538Srpaulo break; 2378251538Srpaulo case IEEE80211_S_AUTH: 2379251538Srpaulo urtwn_set_chan(sc, ic->ic_curchan, NULL); 2380251538Srpaulo break; 2381251538Srpaulo case IEEE80211_S_RUN: 2382251538Srpaulo if (vap->iv_opmode == IEEE80211_M_MONITOR) { 2383251538Srpaulo /* Turn link LED on. */ 2384251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 1); 2385251538Srpaulo break; 2386251538Srpaulo } 2387251538Srpaulo 2388251538Srpaulo ni = ieee80211_ref_node(vap->iv_bss); 2389290631Savos 2390290631Savos if (ic->ic_bsschan == IEEE80211_CHAN_ANYC || 2391290631Savos ni->ni_chan == IEEE80211_CHAN_ANYC) { 2392290631Savos device_printf(sc->sc_dev, 2393290631Savos "%s: could not move to RUN state\n", __func__); 2394290631Savos error = EINVAL; 2395290631Savos goto end_run; 2396290631Savos } 2397290631Savos 2398290631Savos switch (vap->iv_opmode) { 2399290631Savos case IEEE80211_M_STA: 2400290631Savos mode = R92C_MSR_INFRA; 2401290631Savos break; 2402290651Savos case IEEE80211_M_IBSS: 2403290651Savos mode = R92C_MSR_ADHOC; 2404290651Savos break; 2405290631Savos case IEEE80211_M_HOSTAP: 2406290631Savos mode = R92C_MSR_AP; 2407290631Savos break; 2408290631Savos default: 2409290631Savos device_printf(sc->sc_dev, "undefined opmode %d\n", 2410290631Savos vap->iv_opmode); 2411290631Savos error = EINVAL; 2412290631Savos goto end_run; 2413290631Savos } 2414290631Savos 2415251538Srpaulo /* Set media status to 'Associated'. */ 2416290631Savos urtwn_set_mode(sc, mode); 2417251538Srpaulo 2418251538Srpaulo /* Set BSSID. */ 2419251538Srpaulo urtwn_write_4(sc, R92C_BSSID + 0, LE_READ_4(&ni->ni_bssid[0])); 2420251538Srpaulo urtwn_write_4(sc, R92C_BSSID + 4, LE_READ_2(&ni->ni_bssid[4])); 2421251538Srpaulo 2422251538Srpaulo if (ic->ic_curmode == IEEE80211_MODE_11B) 2423251538Srpaulo urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 0); 2424251538Srpaulo else /* 802.11b/g */ 2425251538Srpaulo urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 3); 2426251538Srpaulo 2427251538Srpaulo /* Enable Rx of data frames. */ 2428251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff); 2429251538Srpaulo 2430251538Srpaulo /* Flush all AC queues. */ 2431251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 0); 2432251538Srpaulo 2433251538Srpaulo /* Set beacon interval. */ 2434251538Srpaulo urtwn_write_2(sc, R92C_BCN_INTERVAL, ni->ni_intval); 2435251538Srpaulo 2436251538Srpaulo /* Allow Rx from our BSSID only. */ 2437290564Savos if (ic->ic_promisc == 0) { 2438290631Savos reg = urtwn_read_4(sc, R92C_RCR); 2439290631Savos 2440290631Savos if (vap->iv_opmode != IEEE80211_M_HOSTAP) 2441290631Savos reg |= R92C_RCR_CBSSID_DATA; 2442290651Savos if (vap->iv_opmode != IEEE80211_M_IBSS) 2443290651Savos reg |= R92C_RCR_CBSSID_BCN; 2444290631Savos 2445290631Savos urtwn_write_4(sc, R92C_RCR, reg); 2446290564Savos } 2447251538Srpaulo 2448290651Savos if (vap->iv_opmode == IEEE80211_M_HOSTAP || 2449290651Savos vap->iv_opmode == IEEE80211_M_IBSS) { 2450290631Savos error = urtwn_setup_beacon(sc, ni); 2451290631Savos if (error != 0) { 2452290631Savos device_printf(sc->sc_dev, 2453290631Savos "unable to push beacon into the chip, " 2454290631Savos "error %d\n", error); 2455290631Savos goto end_run; 2456290631Savos } 2457290631Savos } 2458290631Savos 2459251538Srpaulo /* Enable TSF synchronization. */ 2460290631Savos urtwn_tsf_sync_enable(sc, vap); 2461251538Srpaulo 2462251538Srpaulo urtwn_write_1(sc, R92C_SIFS_CCK + 1, 10); 2463251538Srpaulo urtwn_write_1(sc, R92C_SIFS_OFDM + 1, 10); 2464251538Srpaulo urtwn_write_1(sc, R92C_SPEC_SIFS + 1, 10); 2465251538Srpaulo urtwn_write_1(sc, R92C_MAC_SPEC_SIFS + 1, 10); 2466251538Srpaulo urtwn_write_1(sc, R92C_R2T_SIFS + 1, 10); 2467251538Srpaulo urtwn_write_1(sc, R92C_T2T_SIFS + 1, 10); 2468251538Srpaulo 2469251538Srpaulo /* Intialize rate adaptation. */ 2470292167Savos if (!(sc->chip & URTWN_CHIP_88E)) 2471264912Skevlo urtwn_ra_init(sc); 2472251538Srpaulo /* Turn link LED on. */ 2473251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 1); 2474251538Srpaulo 2475251538Srpaulo sc->avg_pwdb = -1; /* Reset average RSSI. */ 2476251538Srpaulo /* Reset temperature calibration state machine. */ 2477294473Savos sc->sc_flags &= ~URTWN_TEMP_MEASURED; 2478251538Srpaulo sc->thcal_lctemp = 0; 2479294473Savos /* Start periodic calibration. */ 2480294473Savos callout_reset(&sc->sc_calib_to, 2*hz, urtwn_calib_to, sc); 2481290631Savos 2482290631Savosend_run: 2483251538Srpaulo ieee80211_free_node(ni); 2484251538Srpaulo break; 2485251538Srpaulo default: 2486251538Srpaulo break; 2487251538Srpaulo } 2488290631Savos 2489251538Srpaulo URTWN_UNLOCK(sc); 2490251538Srpaulo IEEE80211_LOCK(ic); 2491290631Savos return (error != 0 ? error : uvp->newstate(vap, nstate, arg)); 2492251538Srpaulo} 2493251538Srpaulo 2494251538Srpaulostatic void 2495294473Savosurtwn_calib_to(void *arg) 2496294473Savos{ 2497294473Savos struct urtwn_softc *sc = arg; 2498294473Savos 2499294473Savos /* Do it in a process context. */ 2500294473Savos urtwn_cmd_sleepable(sc, NULL, 0, urtwn_calib_cb); 2501294473Savos} 2502294473Savos 2503294473Savosstatic void 2504294473Savosurtwn_calib_cb(struct urtwn_softc *sc, union sec_param *data) 2505294473Savos{ 2506294473Savos /* Do temperature compensation. */ 2507294473Savos urtwn_temp_calib(sc); 2508294473Savos 2509294473Savos if ((urtwn_read_1(sc, R92C_MSR) & R92C_MSR_MASK) != R92C_MSR_NOLINK) 2510294473Savos callout_reset(&sc->sc_calib_to, 2*hz, urtwn_calib_to, sc); 2511294473Savos} 2512294473Savos 2513294473Savosstatic void 2514251538Srpaulourtwn_watchdog(void *arg) 2515251538Srpaulo{ 2516251538Srpaulo struct urtwn_softc *sc = arg; 2517251538Srpaulo 2518251538Srpaulo if (sc->sc_txtimer > 0) { 2519251538Srpaulo if (--sc->sc_txtimer == 0) { 2520251538Srpaulo device_printf(sc->sc_dev, "device timeout\n"); 2521287197Sglebius counter_u64_add(sc->sc_ic.ic_oerrors, 1); 2522251538Srpaulo return; 2523251538Srpaulo } 2524251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 2525251538Srpaulo } 2526251538Srpaulo} 2527251538Srpaulo 2528251538Srpaulostatic void 2529251538Srpaulourtwn_update_avgrssi(struct urtwn_softc *sc, int rate, int8_t rssi) 2530251538Srpaulo{ 2531251538Srpaulo int pwdb; 2532251538Srpaulo 2533251538Srpaulo /* Convert antenna signal to percentage. */ 2534251538Srpaulo if (rssi <= -100 || rssi >= 20) 2535251538Srpaulo pwdb = 0; 2536251538Srpaulo else if (rssi >= 0) 2537251538Srpaulo pwdb = 100; 2538251538Srpaulo else 2539251538Srpaulo pwdb = 100 + rssi; 2540264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 2541289758Savos if (rate <= URTWN_RIDX_CCK11) { 2542264912Skevlo /* CCK gain is smaller than OFDM/MCS gain. */ 2543264912Skevlo pwdb += 6; 2544264912Skevlo if (pwdb > 100) 2545264912Skevlo pwdb = 100; 2546264912Skevlo if (pwdb <= 14) 2547264912Skevlo pwdb -= 4; 2548264912Skevlo else if (pwdb <= 26) 2549264912Skevlo pwdb -= 8; 2550264912Skevlo else if (pwdb <= 34) 2551264912Skevlo pwdb -= 6; 2552264912Skevlo else if (pwdb <= 42) 2553264912Skevlo pwdb -= 2; 2554264912Skevlo } 2555251538Srpaulo } 2556251538Srpaulo if (sc->avg_pwdb == -1) /* Init. */ 2557251538Srpaulo sc->avg_pwdb = pwdb; 2558251538Srpaulo else if (sc->avg_pwdb < pwdb) 2559251538Srpaulo sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20) + 1; 2560251538Srpaulo else 2561251538Srpaulo sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20); 2562294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_RA, "%s: PWDB %d, EMA %d\n", __func__, 2563294471Savos pwdb, sc->avg_pwdb); 2564251538Srpaulo} 2565251538Srpaulo 2566251538Srpaulostatic int8_t 2567251538Srpaulourtwn_get_rssi(struct urtwn_softc *sc, int rate, void *physt) 2568251538Srpaulo{ 2569251538Srpaulo static const int8_t cckoff[] = { 16, -12, -26, -46 }; 2570251538Srpaulo struct r92c_rx_phystat *phy; 2571251538Srpaulo struct r92c_rx_cck *cck; 2572251538Srpaulo uint8_t rpt; 2573251538Srpaulo int8_t rssi; 2574251538Srpaulo 2575289758Savos if (rate <= URTWN_RIDX_CCK11) { 2576251538Srpaulo cck = (struct r92c_rx_cck *)physt; 2577251538Srpaulo if (sc->sc_flags & URTWN_FLAG_CCK_HIPWR) { 2578251538Srpaulo rpt = (cck->agc_rpt >> 5) & 0x3; 2579251538Srpaulo rssi = (cck->agc_rpt & 0x1f) << 1; 2580251538Srpaulo } else { 2581251538Srpaulo rpt = (cck->agc_rpt >> 6) & 0x3; 2582251538Srpaulo rssi = cck->agc_rpt & 0x3e; 2583251538Srpaulo } 2584251538Srpaulo rssi = cckoff[rpt] - rssi; 2585251538Srpaulo } else { /* OFDM/HT. */ 2586251538Srpaulo phy = (struct r92c_rx_phystat *)physt; 2587251538Srpaulo rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110; 2588251538Srpaulo } 2589251538Srpaulo return (rssi); 2590251538Srpaulo} 2591251538Srpaulo 2592264912Skevlostatic int8_t 2593264912Skevlourtwn_r88e_get_rssi(struct urtwn_softc *sc, int rate, void *physt) 2594264912Skevlo{ 2595264912Skevlo struct r92c_rx_phystat *phy; 2596264912Skevlo struct r88e_rx_cck *cck; 2597264912Skevlo uint8_t cck_agc_rpt, lna_idx, vga_idx; 2598264912Skevlo int8_t rssi; 2599264912Skevlo 2600264972Skevlo rssi = 0; 2601289758Savos if (rate <= URTWN_RIDX_CCK11) { 2602264912Skevlo cck = (struct r88e_rx_cck *)physt; 2603264912Skevlo cck_agc_rpt = cck->agc_rpt; 2604264912Skevlo lna_idx = (cck_agc_rpt & 0xe0) >> 5; 2605281069Srpaulo vga_idx = cck_agc_rpt & 0x1f; 2606264912Skevlo switch (lna_idx) { 2607264912Skevlo case 7: 2608264912Skevlo if (vga_idx <= 27) 2609264912Skevlo rssi = -100 + 2* (27 - vga_idx); 2610264912Skevlo else 2611264912Skevlo rssi = -100; 2612264912Skevlo break; 2613264912Skevlo case 6: 2614264912Skevlo rssi = -48 + 2 * (2 - vga_idx); 2615264912Skevlo break; 2616264912Skevlo case 5: 2617264912Skevlo rssi = -42 + 2 * (7 - vga_idx); 2618264912Skevlo break; 2619264912Skevlo case 4: 2620264912Skevlo rssi = -36 + 2 * (7 - vga_idx); 2621264912Skevlo break; 2622264912Skevlo case 3: 2623264912Skevlo rssi = -24 + 2 * (7 - vga_idx); 2624264912Skevlo break; 2625264912Skevlo case 2: 2626264912Skevlo rssi = -12 + 2 * (5 - vga_idx); 2627264912Skevlo break; 2628264912Skevlo case 1: 2629264912Skevlo rssi = 8 - (2 * vga_idx); 2630264912Skevlo break; 2631264912Skevlo case 0: 2632264912Skevlo rssi = 14 - (2 * vga_idx); 2633264912Skevlo break; 2634264912Skevlo } 2635264912Skevlo rssi += 6; 2636264912Skevlo } else { /* OFDM/HT. */ 2637264912Skevlo phy = (struct r92c_rx_phystat *)physt; 2638264912Skevlo rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110; 2639264912Skevlo } 2640264912Skevlo return (rssi); 2641264912Skevlo} 2642264912Skevlo 2643292167Savosstatic __inline uint8_t 2644292167Savosrate2ridx(uint8_t rate) 2645292167Savos{ 2646292167Savos switch (rate) { 2647292167Savos case 12: return 4; 2648292167Savos case 18: return 5; 2649292167Savos case 24: return 6; 2650292167Savos case 36: return 7; 2651292167Savos case 48: return 8; 2652292167Savos case 72: return 9; 2653292167Savos case 96: return 10; 2654292167Savos case 108: return 11; 2655292167Savos case 2: return 0; 2656292167Savos case 4: return 1; 2657292167Savos case 11: return 2; 2658292167Savos case 22: return 3; 2659292167Savos default: return 0; 2660292167Savos } 2661292167Savos} 2662292167Savos 2663251538Srpaulostatic int 2664290630Savosurtwn_tx_data(struct urtwn_softc *sc, struct ieee80211_node *ni, 2665290630Savos struct mbuf *m, struct urtwn_data *data) 2666251538Srpaulo{ 2667292167Savos const struct ieee80211_txparam *tp; 2668287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 2669251538Srpaulo struct ieee80211vap *vap = ni->ni_vap; 2670292167Savos struct ieee80211_key *k = NULL; 2671292167Savos struct ieee80211_channel *chan; 2672292167Savos struct ieee80211_frame *wh; 2673251538Srpaulo struct r92c_tx_desc *txd; 2674292167Savos uint8_t macid, raid, rate, ridx, subtype, type, tid, qsel; 2675292014Savos int hasqos, ismcast; 2676251538Srpaulo 2677251538Srpaulo URTWN_ASSERT_LOCKED(sc); 2678251538Srpaulo 2679251538Srpaulo /* 2680251538Srpaulo * Software crypto. 2681251538Srpaulo */ 2682290630Savos wh = mtod(m, struct ieee80211_frame *); 2683264912Skevlo type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK; 2684290630Savos subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK; 2685292014Savos hasqos = IEEE80211_QOS_HAS_SEQ(wh); 2686290630Savos ismcast = IEEE80211_IS_MULTICAST(wh->i_addr1); 2687264912Skevlo 2688292014Savos /* Select TX ring for this frame. */ 2689292014Savos if (hasqos) { 2690292014Savos tid = ((const struct ieee80211_qosframe *)wh)->i_qos[0]; 2691292014Savos tid &= IEEE80211_QOS_TID; 2692292014Savos } else 2693292014Savos tid = 0; 2694292014Savos 2695292167Savos chan = (ni->ni_chan != IEEE80211_CHAN_ANYC) ? 2696292167Savos ni->ni_chan : ic->ic_curchan; 2697292167Savos tp = &vap->iv_txparms[ieee80211_chan2mode(chan)]; 2698292167Savos 2699292167Savos /* Choose a TX rate index. */ 2700292167Savos if (type == IEEE80211_FC0_TYPE_MGT) 2701292167Savos rate = tp->mgmtrate; 2702292167Savos else if (ismcast) 2703292167Savos rate = tp->mcastrate; 2704292167Savos else if (tp->ucastrate != IEEE80211_FIXED_RATE_NONE) 2705292167Savos rate = tp->ucastrate; 2706292167Savos else if (m->m_flags & M_EAPOL) 2707292167Savos rate = tp->mgmtrate; 2708292167Savos else { 2709292167Savos if (URTWN_CHIP_HAS_RATECTL(sc)) { 2710292167Savos /* XXX pass pktlen */ 2711292167Savos (void) ieee80211_ratectl_rate(ni, NULL, 0); 2712292167Savos rate = ni->ni_txrate; 2713292167Savos } else { 2714292167Savos if (ic->ic_curmode != IEEE80211_MODE_11B) 2715292167Savos rate = 108; 2716292167Savos else 2717292167Savos rate = 22; 2718292167Savos } 2719292167Savos } 2720292167Savos 2721292167Savos ridx = rate2ridx(rate); 2722292167Savos if (ic->ic_curmode != IEEE80211_MODE_11B) 2723292167Savos raid = R92C_RAID_11BG; 2724292167Savos else 2725292167Savos raid = R92C_RAID_11B; 2726292167Savos 2727260444Skevlo if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 2728290630Savos k = ieee80211_crypto_encap(ni, m); 2729251538Srpaulo if (k == NULL) { 2730251538Srpaulo device_printf(sc->sc_dev, 2731251538Srpaulo "ieee80211_crypto_encap returns NULL.\n"); 2732251538Srpaulo return (ENOBUFS); 2733251538Srpaulo } 2734251538Srpaulo 2735251538Srpaulo /* in case packet header moved, reset pointer */ 2736290630Savos wh = mtod(m, struct ieee80211_frame *); 2737251538Srpaulo } 2738281069Srpaulo 2739251538Srpaulo /* Fill Tx descriptor. */ 2740251538Srpaulo txd = (struct r92c_tx_desc *)data->buf; 2741251538Srpaulo memset(txd, 0, sizeof(*txd)); 2742251538Srpaulo 2743251538Srpaulo txd->txdw0 |= htole32( 2744251538Srpaulo SM(R92C_TXDW0_OFFSET, sizeof(*txd)) | 2745251538Srpaulo R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG); 2746290630Savos if (ismcast) 2747251538Srpaulo txd->txdw0 |= htole32(R92C_TXDW0_BMCAST); 2748290630Savos 2749290630Savos if (!ismcast) { 2750292167Savos if (sc->chip & URTWN_CHIP_88E) { 2751292167Savos struct urtwn_node *un = URTWN_NODE(ni); 2752292167Savos macid = un->id; 2753292167Savos } else 2754292167Savos macid = URTWN_MACID_BSS; 2755290630Savos 2756290630Savos if (type == IEEE80211_FC0_TYPE_DATA) { 2757292014Savos qsel = tid % URTWN_MAX_TID; 2758290630Savos 2759292167Savos if (sc->chip & URTWN_CHIP_88E) { 2760292167Savos txd->txdw2 |= htole32( 2761292167Savos R88E_TXDW2_AGGBK | 2762292167Savos R88E_TXDW2_CCX_RPT); 2763292167Savos } else 2764290630Savos txd->txdw1 |= htole32(R92C_TXDW1_AGGBK); 2765290630Savos 2766290630Savos if (ic->ic_flags & IEEE80211_F_USEPROT) { 2767290630Savos switch (ic->ic_protmode) { 2768290630Savos case IEEE80211_PROT_CTSONLY: 2769290630Savos txd->txdw4 |= htole32( 2770290630Savos R92C_TXDW4_CTS2SELF | 2771290630Savos R92C_TXDW4_HWRTSEN); 2772290630Savos break; 2773290630Savos case IEEE80211_PROT_RTSCTS: 2774290630Savos txd->txdw4 |= htole32( 2775290630Savos R92C_TXDW4_RTSEN | 2776290630Savos R92C_TXDW4_HWRTSEN); 2777290630Savos break; 2778290630Savos default: 2779290630Savos break; 2780290630Savos } 2781290630Savos } 2782290630Savos txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE, 2783290630Savos URTWN_RIDX_OFDM24)); 2784290630Savos txd->txdw5 |= htole32(0x0001ff00); 2785290630Savos } else /* IEEE80211_FC0_TYPE_MGT */ 2786290630Savos qsel = R92C_TXDW1_QSEL_MGNT; 2787251538Srpaulo } else { 2788290630Savos macid = URTWN_MACID_BC; 2789290630Savos qsel = R92C_TXDW1_QSEL_MGNT; 2790290630Savos } 2791251538Srpaulo 2792290630Savos txd->txdw1 |= htole32( 2793290630Savos SM(R92C_TXDW1_QSEL, qsel) | 2794290630Savos SM(R92C_TXDW1_RAID, raid)); 2795290630Savos 2796290630Savos if (sc->chip & URTWN_CHIP_88E) 2797290630Savos txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, macid)); 2798290630Savos else 2799290630Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, macid)); 2800290630Savos 2801290630Savos txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, ridx)); 2802291858Savos /* Force this rate if needed. */ 2803292167Savos if (URTWN_CHIP_HAS_RATECTL(sc) || ismcast || 2804292167Savos (m->m_flags & M_EAPOL) || type != IEEE80211_FC0_TYPE_DATA) 2805251538Srpaulo txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE); 2806251538Srpaulo 2807292014Savos if (!hasqos) { 2808251538Srpaulo /* Use HW sequence numbering for non-QoS frames. */ 2809291858Savos if (sc->chip & URTWN_CHIP_88E) 2810291858Savos txd->txdseq = htole16(R88E_TXDSEQ_HWSEQ_EN); 2811291858Savos else 2812291858Savos txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN); 2813290630Savos } else { 2814290630Savos /* Set sequence number. */ 2815290630Savos txd->txdseq = htole16(M_SEQNO_GET(m) % IEEE80211_SEQ_RANGE); 2816290630Savos } 2817251538Srpaulo 2818292175Savos if (k != NULL && !(k->wk_flags & IEEE80211_KEY_SWCRYPT)) { 2819292175Savos uint8_t cipher; 2820292175Savos 2821292175Savos switch (k->wk_cipher->ic_cipher) { 2822292175Savos case IEEE80211_CIPHER_WEP: 2823292175Savos case IEEE80211_CIPHER_TKIP: 2824292175Savos cipher = R92C_TXDW1_CIPHER_RC4; 2825292175Savos break; 2826292175Savos case IEEE80211_CIPHER_AES_CCM: 2827292175Savos cipher = R92C_TXDW1_CIPHER_AES; 2828292175Savos break; 2829292175Savos default: 2830292175Savos device_printf(sc->sc_dev, "%s: unknown cipher %d\n", 2831292175Savos __func__, k->wk_cipher->ic_cipher); 2832292175Savos return (EINVAL); 2833292175Savos } 2834292175Savos 2835292175Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_CIPHER, cipher)); 2836292175Savos } 2837292175Savos 2838251538Srpaulo if (ieee80211_radiotap_active_vap(vap)) { 2839251538Srpaulo struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap; 2840251538Srpaulo 2841251538Srpaulo tap->wt_flags = 0; 2842290630Savos if (k != NULL) 2843290630Savos tap->wt_flags |= IEEE80211_RADIOTAP_F_WEP; 2844290630Savos ieee80211_radiotap_tx(vap, m); 2845251538Srpaulo } 2846251538Srpaulo 2847290630Savos data->ni = ni; 2848251538Srpaulo 2849290630Savos urtwn_tx_start(sc, m, type, data); 2850290630Savos 2851290630Savos return (0); 2852290630Savos} 2853290630Savos 2854292221Savosstatic int 2855292221Savosurtwn_tx_raw(struct urtwn_softc *sc, struct ieee80211_node *ni, 2856292221Savos struct mbuf *m, struct urtwn_data *data, 2857292221Savos const struct ieee80211_bpf_params *params) 2858292221Savos{ 2859292221Savos struct ieee80211vap *vap = ni->ni_vap; 2860292221Savos struct ieee80211_key *k = NULL; 2861292221Savos struct ieee80211_frame *wh; 2862292221Savos struct r92c_tx_desc *txd; 2863292221Savos uint8_t cipher, ridx, type; 2864292221Savos 2865292221Savos /* Encrypt the frame if need be. */ 2866292221Savos cipher = R92C_TXDW1_CIPHER_NONE; 2867292221Savos if (params->ibp_flags & IEEE80211_BPF_CRYPTO) { 2868292221Savos /* Retrieve key for TX. */ 2869292221Savos k = ieee80211_crypto_encap(ni, m); 2870292221Savos if (k == NULL) 2871292221Savos return (ENOBUFS); 2872292221Savos 2873292221Savos if (!(k->wk_flags & IEEE80211_KEY_SWCRYPT)) { 2874292221Savos switch (k->wk_cipher->ic_cipher) { 2875292221Savos case IEEE80211_CIPHER_WEP: 2876292221Savos case IEEE80211_CIPHER_TKIP: 2877292221Savos cipher = R92C_TXDW1_CIPHER_RC4; 2878292221Savos break; 2879292221Savos case IEEE80211_CIPHER_AES_CCM: 2880292221Savos cipher = R92C_TXDW1_CIPHER_AES; 2881292221Savos break; 2882292221Savos default: 2883292221Savos device_printf(sc->sc_dev, 2884292221Savos "%s: unknown cipher %d\n", 2885292221Savos __func__, k->wk_cipher->ic_cipher); 2886292221Savos return (EINVAL); 2887292221Savos } 2888292221Savos } 2889292221Savos } 2890292221Savos 2891292221Savos wh = mtod(m, struct ieee80211_frame *); 2892292221Savos type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK; 2893292221Savos 2894292221Savos /* Fill Tx descriptor. */ 2895292221Savos txd = (struct r92c_tx_desc *)data->buf; 2896292221Savos memset(txd, 0, sizeof(*txd)); 2897292221Savos 2898292221Savos txd->txdw0 |= htole32( 2899292221Savos SM(R92C_TXDW0_OFFSET, sizeof(*txd)) | 2900292221Savos R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG); 2901292221Savos if (IEEE80211_IS_MULTICAST(wh->i_addr1)) 2902292221Savos txd->txdw0 |= htole32(R92C_TXDW0_BMCAST); 2903292221Savos 2904292221Savos if (params->ibp_flags & IEEE80211_BPF_RTS) 2905292221Savos txd->txdw4 |= htole32(R92C_TXDW4_RTSEN); 2906292221Savos if (params->ibp_flags & IEEE80211_BPF_CTS) 2907292221Savos txd->txdw4 |= htole32(R92C_TXDW4_CTS2SELF); 2908292221Savos if (txd->txdw4 & htole32(R92C_TXDW4_RTSEN | R92C_TXDW4_CTS2SELF)) { 2909292221Savos txd->txdw4 |= htole32(R92C_TXDW4_HWRTSEN); 2910292221Savos txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE, 2911292221Savos URTWN_RIDX_OFDM24)); 2912292221Savos } 2913292221Savos 2914292221Savos if (sc->chip & URTWN_CHIP_88E) 2915292221Savos txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, URTWN_MACID_BC)); 2916292221Savos else 2917292221Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, URTWN_MACID_BC)); 2918292221Savos 2919292221Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_MGNT)); 2920292221Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_CIPHER, cipher)); 2921292221Savos 2922292221Savos /* Choose a TX rate index. */ 2923292221Savos ridx = rate2ridx(params->ibp_rate0); 2924292221Savos txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, ridx)); 2925292221Savos txd->txdw5 |= htole32(0x0001ff00); 2926292221Savos txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE); 2927292221Savos 2928292221Savos if (!IEEE80211_QOS_HAS_SEQ(wh)) { 2929292221Savos /* Use HW sequence numbering for non-QoS frames. */ 2930292221Savos if (sc->chip & URTWN_CHIP_88E) 2931292221Savos txd->txdseq = htole16(R88E_TXDSEQ_HWSEQ_EN); 2932292221Savos else 2933292221Savos txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN); 2934292221Savos } else { 2935292221Savos /* Set sequence number. */ 2936292221Savos txd->txdseq = htole16(M_SEQNO_GET(m) % IEEE80211_SEQ_RANGE); 2937292221Savos } 2938292221Savos 2939292221Savos if (ieee80211_radiotap_active_vap(vap)) { 2940292221Savos struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap; 2941292221Savos 2942292221Savos tap->wt_flags = 0; 2943292221Savos if (k != NULL) 2944292221Savos tap->wt_flags |= IEEE80211_RADIOTAP_F_WEP; 2945292221Savos ieee80211_radiotap_tx(vap, m); 2946292221Savos } 2947292221Savos 2948292221Savos data->ni = ni; 2949292221Savos 2950292221Savos urtwn_tx_start(sc, m, type, data); 2951292221Savos 2952292221Savos return (0); 2953292221Savos} 2954292221Savos 2955290630Savosstatic void 2956290630Savosurtwn_tx_start(struct urtwn_softc *sc, struct mbuf *m, uint8_t type, 2957290630Savos struct urtwn_data *data) 2958290630Savos{ 2959290630Savos struct usb_xfer *xfer; 2960290630Savos struct r92c_tx_desc *txd; 2961290630Savos uint16_t ac, sum; 2962290630Savos int i, xferlen; 2963290630Savos 2964290630Savos URTWN_ASSERT_LOCKED(sc); 2965290630Savos 2966290630Savos ac = M_WME_GETAC(m); 2967290630Savos 2968290630Savos switch (type) { 2969290630Savos case IEEE80211_FC0_TYPE_CTL: 2970290630Savos case IEEE80211_FC0_TYPE_MGT: 2971290630Savos xfer = sc->sc_xfer[URTWN_BULK_TX_VO]; 2972290630Savos break; 2973290630Savos default: 2974292014Savos xfer = sc->sc_xfer[wme2queue[ac].qid]; 2975290630Savos break; 2976290630Savos } 2977290630Savos 2978290630Savos txd = (struct r92c_tx_desc *)data->buf; 2979290630Savos txd->txdw0 |= htole32(SM(R92C_TXDW0_PKTLEN, m->m_pkthdr.len)); 2980290630Savos 2981290630Savos /* Compute Tx descriptor checksum. */ 2982290630Savos sum = 0; 2983290630Savos for (i = 0; i < sizeof(*txd) / 2; i++) 2984290630Savos sum ^= ((uint16_t *)txd)[i]; 2985290630Savos txd->txdsum = sum; /* NB: already little endian. */ 2986290630Savos 2987290630Savos xferlen = sizeof(*txd) + m->m_pkthdr.len; 2988290630Savos m_copydata(m, 0, m->m_pkthdr.len, (caddr_t)&txd[1]); 2989290630Savos 2990251538Srpaulo data->buflen = xferlen; 2991290630Savos data->m = m; 2992251538Srpaulo 2993251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next); 2994251538Srpaulo usbd_transfer_start(xfer); 2995251538Srpaulo} 2996251538Srpaulo 2997287197Sglebiusstatic int 2998287197Sglebiusurtwn_transmit(struct ieee80211com *ic, struct mbuf *m) 2999251538Srpaulo{ 3000287197Sglebius struct urtwn_softc *sc = ic->ic_softc; 3001287197Sglebius int error; 3002261863Srpaulo 3003261863Srpaulo URTWN_LOCK(sc); 3004287197Sglebius if ((sc->sc_flags & URTWN_RUNNING) == 0) { 3005287197Sglebius URTWN_UNLOCK(sc); 3006287197Sglebius return (ENXIO); 3007287197Sglebius } 3008287197Sglebius error = mbufq_enqueue(&sc->sc_snd, m); 3009287197Sglebius if (error) { 3010287197Sglebius URTWN_UNLOCK(sc); 3011287197Sglebius return (error); 3012287197Sglebius } 3013287197Sglebius urtwn_start(sc); 3014261863Srpaulo URTWN_UNLOCK(sc); 3015287197Sglebius 3016287197Sglebius return (0); 3017261863Srpaulo} 3018261863Srpaulo 3019261863Srpaulostatic void 3020287197Sglebiusurtwn_start(struct urtwn_softc *sc) 3021261863Srpaulo{ 3022251538Srpaulo struct ieee80211_node *ni; 3023251538Srpaulo struct mbuf *m; 3024251538Srpaulo struct urtwn_data *bf; 3025251538Srpaulo 3026261863Srpaulo URTWN_ASSERT_LOCKED(sc); 3027287197Sglebius while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) { 3028251538Srpaulo bf = urtwn_getbuf(sc); 3029251538Srpaulo if (bf == NULL) { 3030287197Sglebius mbufq_prepend(&sc->sc_snd, m); 3031251538Srpaulo break; 3032251538Srpaulo } 3033251538Srpaulo ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 3034251538Srpaulo m->m_pkthdr.rcvif = NULL; 3035290630Savos if (urtwn_tx_data(sc, ni, m, bf) != 0) { 3036287197Sglebius if_inc_counter(ni->ni_vap->iv_ifp, 3037287197Sglebius IFCOUNTER_OERRORS, 1); 3038251538Srpaulo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 3039288353Sadrian m_freem(m); 3040251538Srpaulo ieee80211_free_node(ni); 3041251538Srpaulo break; 3042251538Srpaulo } 3043251538Srpaulo sc->sc_txtimer = 5; 3044251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 3045251538Srpaulo } 3046251538Srpaulo} 3047251538Srpaulo 3048287197Sglebiusstatic void 3049287197Sglebiusurtwn_parent(struct ieee80211com *ic) 3050251538Srpaulo{ 3051286949Sadrian struct urtwn_softc *sc = ic->ic_softc; 3052251538Srpaulo 3053263153Skevlo URTWN_LOCK(sc); 3054287197Sglebius if (sc->sc_flags & URTWN_DETACHED) { 3055287197Sglebius URTWN_UNLOCK(sc); 3056287197Sglebius return; 3057287197Sglebius } 3058291698Savos URTWN_UNLOCK(sc); 3059291698Savos 3060287197Sglebius if (ic->ic_nrunning > 0) { 3061291698Savos if (urtwn_init(sc) != 0) { 3062291698Savos struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 3063291698Savos if (vap != NULL) 3064291698Savos ieee80211_stop(vap); 3065291698Savos } else 3066291698Savos ieee80211_start_all(ic); 3067291698Savos } else 3068287197Sglebius urtwn_stop(sc); 3069251538Srpaulo} 3070251538Srpaulo 3071264912Skevlostatic __inline int 3072251538Srpaulourtwn_power_on(struct urtwn_softc *sc) 3073251538Srpaulo{ 3074264912Skevlo 3075264912Skevlo return sc->sc_power_on(sc); 3076264912Skevlo} 3077264912Skevlo 3078264912Skevlostatic int 3079264912Skevlourtwn_r92c_power_on(struct urtwn_softc *sc) 3080264912Skevlo{ 3081251538Srpaulo uint32_t reg; 3082291698Savos usb_error_t error; 3083251538Srpaulo int ntries; 3084251538Srpaulo 3085251538Srpaulo /* Wait for autoload done bit. */ 3086251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 3087251538Srpaulo if (urtwn_read_1(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_PFM_ALDN) 3088251538Srpaulo break; 3089266472Shselasky urtwn_ms_delay(sc); 3090251538Srpaulo } 3091251538Srpaulo if (ntries == 1000) { 3092251538Srpaulo device_printf(sc->sc_dev, 3093251538Srpaulo "timeout waiting for chip autoload\n"); 3094251538Srpaulo return (ETIMEDOUT); 3095251538Srpaulo } 3096251538Srpaulo 3097251538Srpaulo /* Unlock ISO/CLK/Power control register. */ 3098291698Savos error = urtwn_write_1(sc, R92C_RSV_CTRL, 0); 3099291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3100291698Savos return (EIO); 3101251538Srpaulo /* Move SPS into PWM mode. */ 3102291698Savos error = urtwn_write_1(sc, R92C_SPS0_CTRL, 0x2b); 3103291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3104291698Savos return (EIO); 3105266472Shselasky urtwn_ms_delay(sc); 3106251538Srpaulo 3107251538Srpaulo reg = urtwn_read_1(sc, R92C_LDOV12D_CTRL); 3108251538Srpaulo if (!(reg & R92C_LDOV12D_CTRL_LDV12_EN)) { 3109291698Savos error = urtwn_write_1(sc, R92C_LDOV12D_CTRL, 3110251538Srpaulo reg | R92C_LDOV12D_CTRL_LDV12_EN); 3111291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3112291698Savos return (EIO); 3113266472Shselasky urtwn_ms_delay(sc); 3114291698Savos error = urtwn_write_1(sc, R92C_SYS_ISO_CTRL, 3115251538Srpaulo urtwn_read_1(sc, R92C_SYS_ISO_CTRL) & 3116251538Srpaulo ~R92C_SYS_ISO_CTRL_MD2PP); 3117291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3118291698Savos return (EIO); 3119251538Srpaulo } 3120251538Srpaulo 3121251538Srpaulo /* Auto enable WLAN. */ 3122291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 3123251538Srpaulo urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC); 3124291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3125291698Savos return (EIO); 3126251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 3127262822Skevlo if (!(urtwn_read_2(sc, R92C_APS_FSMCO) & 3128262822Skevlo R92C_APS_FSMCO_APFM_ONMAC)) 3129251538Srpaulo break; 3130266472Shselasky urtwn_ms_delay(sc); 3131251538Srpaulo } 3132251538Srpaulo if (ntries == 1000) { 3133251538Srpaulo device_printf(sc->sc_dev, 3134251538Srpaulo "timeout waiting for MAC auto ON\n"); 3135251538Srpaulo return (ETIMEDOUT); 3136251538Srpaulo } 3137251538Srpaulo 3138251538Srpaulo /* Enable radio, GPIO and LED functions. */ 3139291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 3140251538Srpaulo R92C_APS_FSMCO_AFSM_HSUS | 3141251538Srpaulo R92C_APS_FSMCO_PDN_EN | 3142251538Srpaulo R92C_APS_FSMCO_PFM_ALDN); 3143291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3144291698Savos return (EIO); 3145251538Srpaulo /* Release RF digital isolation. */ 3146291698Savos error = urtwn_write_2(sc, R92C_SYS_ISO_CTRL, 3147251538Srpaulo urtwn_read_2(sc, R92C_SYS_ISO_CTRL) & ~R92C_SYS_ISO_CTRL_DIOR); 3148291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3149291698Savos return (EIO); 3150251538Srpaulo 3151251538Srpaulo /* Initialize MAC. */ 3152291698Savos error = urtwn_write_1(sc, R92C_APSD_CTRL, 3153251538Srpaulo urtwn_read_1(sc, R92C_APSD_CTRL) & ~R92C_APSD_CTRL_OFF); 3154291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3155291698Savos return (EIO); 3156251538Srpaulo for (ntries = 0; ntries < 200; ntries++) { 3157251538Srpaulo if (!(urtwn_read_1(sc, R92C_APSD_CTRL) & 3158251538Srpaulo R92C_APSD_CTRL_OFF_STATUS)) 3159251538Srpaulo break; 3160266472Shselasky urtwn_ms_delay(sc); 3161251538Srpaulo } 3162251538Srpaulo if (ntries == 200) { 3163251538Srpaulo device_printf(sc->sc_dev, 3164251538Srpaulo "timeout waiting for MAC initialization\n"); 3165251538Srpaulo return (ETIMEDOUT); 3166251538Srpaulo } 3167251538Srpaulo 3168251538Srpaulo /* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */ 3169251538Srpaulo reg = urtwn_read_2(sc, R92C_CR); 3170251538Srpaulo reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN | 3171251538Srpaulo R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN | 3172251538Srpaulo R92C_CR_SCHEDULE_EN | R92C_CR_MACTXEN | R92C_CR_MACRXEN | 3173251538Srpaulo R92C_CR_ENSEC; 3174291698Savos error = urtwn_write_2(sc, R92C_CR, reg); 3175291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3176291698Savos return (EIO); 3177251538Srpaulo 3178291698Savos error = urtwn_write_1(sc, 0xfe10, 0x19); 3179291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3180291698Savos return (EIO); 3181251538Srpaulo return (0); 3182251538Srpaulo} 3183251538Srpaulo 3184251538Srpaulostatic int 3185264912Skevlourtwn_r88e_power_on(struct urtwn_softc *sc) 3186264912Skevlo{ 3187264912Skevlo uint32_t reg; 3188291698Savos usb_error_t error; 3189264912Skevlo int ntries; 3190264912Skevlo 3191264912Skevlo /* Wait for power ready bit. */ 3192264912Skevlo for (ntries = 0; ntries < 5000; ntries++) { 3193281918Skevlo if (urtwn_read_4(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_SUS_HOST) 3194264912Skevlo break; 3195266472Shselasky urtwn_ms_delay(sc); 3196264912Skevlo } 3197264912Skevlo if (ntries == 5000) { 3198264912Skevlo device_printf(sc->sc_dev, 3199264912Skevlo "timeout waiting for chip power up\n"); 3200264912Skevlo return (ETIMEDOUT); 3201264912Skevlo } 3202264912Skevlo 3203264912Skevlo /* Reset BB. */ 3204291698Savos error = urtwn_write_1(sc, R92C_SYS_FUNC_EN, 3205264912Skevlo urtwn_read_1(sc, R92C_SYS_FUNC_EN) & ~(R92C_SYS_FUNC_EN_BBRSTB | 3206264912Skevlo R92C_SYS_FUNC_EN_BB_GLB_RST)); 3207291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3208291698Savos return (EIO); 3209264912Skevlo 3210291698Savos error = urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 2, 3211281918Skevlo urtwn_read_1(sc, R92C_AFE_XTAL_CTRL + 2) | 0x80); 3212291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3213291698Savos return (EIO); 3214264912Skevlo 3215264912Skevlo /* Disable HWPDN. */ 3216291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 3217281918Skevlo urtwn_read_2(sc, R92C_APS_FSMCO) & ~R92C_APS_FSMCO_APDM_HPDN); 3218291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3219291698Savos return (EIO); 3220264912Skevlo 3221264912Skevlo /* Disable WL suspend. */ 3222291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 3223281918Skevlo urtwn_read_2(sc, R92C_APS_FSMCO) & 3224281918Skevlo ~(R92C_APS_FSMCO_AFSM_HSUS | R92C_APS_FSMCO_AFSM_PCIE)); 3225291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3226291698Savos return (EIO); 3227264912Skevlo 3228291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 3229281918Skevlo urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC); 3230291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3231291698Savos return (EIO); 3232264912Skevlo for (ntries = 0; ntries < 5000; ntries++) { 3233281918Skevlo if (!(urtwn_read_2(sc, R92C_APS_FSMCO) & 3234281918Skevlo R92C_APS_FSMCO_APFM_ONMAC)) 3235264912Skevlo break; 3236266472Shselasky urtwn_ms_delay(sc); 3237264912Skevlo } 3238264912Skevlo if (ntries == 5000) 3239264912Skevlo return (ETIMEDOUT); 3240264912Skevlo 3241264912Skevlo /* Enable LDO normal mode. */ 3242291698Savos error = urtwn_write_1(sc, R92C_LPLDO_CTRL, 3243295874Savos urtwn_read_1(sc, R92C_LPLDO_CTRL) & ~R92C_LPLDO_CTRL_SLEEP); 3244291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3245291698Savos return (EIO); 3246264912Skevlo 3247264912Skevlo /* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */ 3248291698Savos error = urtwn_write_2(sc, R92C_CR, 0); 3249291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3250291698Savos return (EIO); 3251264912Skevlo reg = urtwn_read_2(sc, R92C_CR); 3252264912Skevlo reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN | 3253264912Skevlo R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN | 3254264912Skevlo R92C_CR_SCHEDULE_EN | R92C_CR_ENSEC | R92C_CR_CALTMR_EN; 3255291698Savos error = urtwn_write_2(sc, R92C_CR, reg); 3256291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3257291698Savos return (EIO); 3258264912Skevlo 3259264912Skevlo return (0); 3260264912Skevlo} 3261264912Skevlo 3262295874Savosstatic __inline void 3263295874Savosurtwn_power_off(struct urtwn_softc *sc) 3264295874Savos{ 3265295874Savos 3266295874Savos return sc->sc_power_off(sc); 3267295874Savos} 3268295874Savos 3269295874Savosstatic void 3270295874Savosurtwn_r92c_power_off(struct urtwn_softc *sc) 3271295874Savos{ 3272295874Savos uint32_t reg; 3273295874Savos 3274295874Savos /* Block all Tx queues. */ 3275295874Savos urtwn_write_1(sc, R92C_TXPAUSE, R92C_TX_QUEUE_ALL); 3276295874Savos 3277295874Savos /* Disable RF */ 3278295874Savos urtwn_rf_write(sc, 0, 0, 0); 3279295874Savos 3280295874Savos urtwn_write_1(sc, R92C_APSD_CTRL, R92C_APSD_CTRL_OFF); 3281295874Savos 3282295874Savos /* Reset BB state machine */ 3283295874Savos urtwn_write_1(sc, R92C_SYS_FUNC_EN, 3284295874Savos R92C_SYS_FUNC_EN_USBD | R92C_SYS_FUNC_EN_USBA | 3285295874Savos R92C_SYS_FUNC_EN_BB_GLB_RST); 3286295874Savos urtwn_write_1(sc, R92C_SYS_FUNC_EN, 3287295874Savos R92C_SYS_FUNC_EN_USBD | R92C_SYS_FUNC_EN_USBA); 3288295874Savos 3289295874Savos /* 3290295874Savos * Reset digital sequence 3291295874Savos */ 3292295874Savos#ifndef URTWN_WITHOUT_UCODE 3293295874Savos if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RDY) { 3294295874Savos /* Reset MCU ready status */ 3295295874Savos urtwn_write_1(sc, R92C_MCUFWDL, 0); 3296295874Savos 3297295874Savos /* If firmware in ram code, do reset */ 3298295874Savos urtwn_fw_reset(sc); 3299295874Savos } 3300295874Savos#endif 3301295874Savos 3302295874Savos /* Reset MAC and Enable 8051 */ 3303295874Savos urtwn_write_1(sc, R92C_SYS_FUNC_EN + 1, 3304295874Savos (R92C_SYS_FUNC_EN_CPUEN | 3305295874Savos R92C_SYS_FUNC_EN_ELDR | 3306295874Savos R92C_SYS_FUNC_EN_HWPDN) >> 8); 3307295874Savos 3308295874Savos /* Reset MCU ready status */ 3309295874Savos urtwn_write_1(sc, R92C_MCUFWDL, 0); 3310295874Savos 3311295874Savos /* Disable MAC clock */ 3312295874Savos urtwn_write_2(sc, R92C_SYS_CLKR, 3313295874Savos R92C_SYS_CLKR_ANAD16V_EN | 3314295874Savos R92C_SYS_CLKR_ANA8M | 3315295874Savos R92C_SYS_CLKR_LOADER_EN | 3316295874Savos R92C_SYS_CLKR_80M_SSC_DIS | 3317295874Savos R92C_SYS_CLKR_SYS_EN | 3318295874Savos R92C_SYS_CLKR_RING_EN | 3319295874Savos 0x4000); 3320295874Savos 3321295874Savos /* Disable AFE PLL */ 3322295874Savos urtwn_write_1(sc, R92C_AFE_PLL_CTRL, 0x80); 3323295874Savos 3324295874Savos /* Gated AFE DIG_CLOCK */ 3325295874Savos urtwn_write_2(sc, R92C_AFE_XTAL_CTRL, 0x880F); 3326295874Savos 3327295874Savos /* Isolated digital to PON */ 3328295874Savos urtwn_write_1(sc, R92C_SYS_ISO_CTRL, 3329295874Savos R92C_SYS_ISO_CTRL_MD2PP | 3330295874Savos R92C_SYS_ISO_CTRL_PA2PCIE | 3331295874Savos R92C_SYS_ISO_CTRL_PD2CORE | 3332295874Savos R92C_SYS_ISO_CTRL_IP2MAC | 3333295874Savos R92C_SYS_ISO_CTRL_DIOP | 3334295874Savos R92C_SYS_ISO_CTRL_DIOE); 3335295874Savos 3336295874Savos /* 3337295874Savos * Pull GPIO PIN to balance level and LED control 3338295874Savos */ 3339295874Savos /* 1. Disable GPIO[7:0] */ 3340295874Savos urtwn_write_2(sc, R92C_GPIO_IOSEL, 0x0000); 3341295874Savos 3342295874Savos reg = urtwn_read_4(sc, R92C_GPIO_PIN_CTRL) & ~0x0000ff00; 3343295874Savos reg |= ((reg << 8) & 0x0000ff00) | 0x00ff0000; 3344295874Savos urtwn_write_4(sc, R92C_GPIO_PIN_CTRL, reg); 3345295874Savos 3346295874Savos /* Disable GPIO[10:8] */ 3347295874Savos urtwn_write_1(sc, R92C_MAC_PINMUX_CFG, 0x00); 3348295874Savos 3349295874Savos reg = urtwn_read_2(sc, R92C_GPIO_IO_SEL) & ~0x00f0; 3350295874Savos reg |= (((reg & 0x000f) << 4) | 0x0780); 3351295874Savos urtwn_write_2(sc, R92C_GPIO_IO_SEL, reg); 3352295874Savos 3353295874Savos /* Disable LED0 & 1 */ 3354295874Savos urtwn_write_2(sc, R92C_LEDCFG0, 0x8080); 3355295874Savos 3356295874Savos /* 3357295874Savos * Reset digital sequence 3358295874Savos */ 3359295874Savos /* Disable ELDR clock */ 3360295874Savos urtwn_write_2(sc, R92C_SYS_CLKR, 3361295874Savos R92C_SYS_CLKR_ANAD16V_EN | 3362295874Savos R92C_SYS_CLKR_ANA8M | 3363295874Savos R92C_SYS_CLKR_LOADER_EN | 3364295874Savos R92C_SYS_CLKR_80M_SSC_DIS | 3365295874Savos R92C_SYS_CLKR_SYS_EN | 3366295874Savos R92C_SYS_CLKR_RING_EN | 3367295874Savos 0x4000); 3368295874Savos 3369295874Savos /* Isolated ELDR to PON */ 3370295874Savos urtwn_write_1(sc, R92C_SYS_ISO_CTRL + 1, 3371295874Savos (R92C_SYS_ISO_CTRL_DIOR | 3372295874Savos R92C_SYS_ISO_CTRL_PWC_EV12V) >> 8); 3373295874Savos 3374295874Savos /* 3375295874Savos * Disable analog sequence 3376295874Savos */ 3377295874Savos /* Disable A15 power */ 3378295874Savos urtwn_write_1(sc, R92C_LDOA15_CTRL, R92C_LDOA15_CTRL_OBUF); 3379295874Savos /* Disable digital core power */ 3380295874Savos urtwn_write_1(sc, R92C_LDOV12D_CTRL, 3381295874Savos urtwn_read_1(sc, R92C_LDOV12D_CTRL) & 3382295874Savos ~R92C_LDOV12D_CTRL_LDV12_EN); 3383295874Savos 3384295874Savos /* Enter PFM mode */ 3385295874Savos urtwn_write_1(sc, R92C_SPS0_CTRL, 0x23); 3386295874Savos 3387295874Savos /* Set USB suspend */ 3388295874Savos urtwn_write_2(sc, R92C_APS_FSMCO, 3389295874Savos R92C_APS_FSMCO_APDM_HOST | 3390295874Savos R92C_APS_FSMCO_AFSM_HSUS | 3391295874Savos R92C_APS_FSMCO_PFM_ALDN); 3392295874Savos 3393295874Savos /* Lock ISO/CLK/Power control register. */ 3394295874Savos urtwn_write_1(sc, R92C_RSV_CTRL, 0x0E); 3395295874Savos} 3396295874Savos 3397295874Savosstatic void 3398295874Savosurtwn_r88e_power_off(struct urtwn_softc *sc) 3399295874Savos{ 3400295874Savos uint8_t reg; 3401295874Savos int ntries; 3402295874Savos 3403295874Savos /* Disable any kind of TX reports. */ 3404295874Savos urtwn_write_1(sc, R88E_TX_RPT_CTRL, 3405295874Savos urtwn_read_1(sc, R88E_TX_RPT_CTRL) & 3406295874Savos ~(R88E_TX_RPT1_ENA | R88E_TX_RPT2_ENA)); 3407295874Savos 3408295874Savos /* Stop Rx. */ 3409295874Savos urtwn_write_1(sc, R92C_CR, 0); 3410295874Savos 3411295874Savos /* Move card to Low Power State. */ 3412295874Savos /* Block all Tx queues. */ 3413295874Savos urtwn_write_1(sc, R92C_TXPAUSE, R92C_TX_QUEUE_ALL); 3414295874Savos 3415295874Savos for (ntries = 0; ntries < 20; ntries++) { 3416295874Savos /* Should be zero if no packet is transmitting. */ 3417295874Savos if (urtwn_read_4(sc, R88E_SCH_TXCMD) == 0) 3418295874Savos break; 3419295874Savos 3420295874Savos urtwn_ms_delay(sc); 3421295874Savos } 3422295874Savos if (ntries == 20) { 3423295874Savos device_printf(sc->sc_dev, "%s: failed to block Tx queues\n", 3424295874Savos __func__); 3425295874Savos return; 3426295874Savos } 3427295874Savos 3428295874Savos /* CCK and OFDM are disabled, and clock are gated. */ 3429295874Savos urtwn_write_1(sc, R92C_SYS_FUNC_EN, 3430295874Savos urtwn_read_1(sc, R92C_SYS_FUNC_EN) & ~R92C_SYS_FUNC_EN_BBRSTB); 3431295874Savos 3432295874Savos urtwn_ms_delay(sc); 3433295874Savos 3434295874Savos /* Reset MAC TRX */ 3435295874Savos urtwn_write_1(sc, R92C_CR, 3436295874Savos R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN | 3437295874Savos R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | 3438295874Savos R92C_CR_PROTOCOL_EN | R92C_CR_SCHEDULE_EN); 3439295874Savos 3440295874Savos /* check if removed later */ 3441295874Savos urtwn_write_1(sc, R92C_CR + 1, 3442295874Savos urtwn_read_1(sc, R92C_CR + 1) & ~(R92C_CR_ENSEC >> 8)); 3443295874Savos 3444295874Savos /* Respond TxOK to scheduler */ 3445295874Savos urtwn_write_1(sc, R92C_DUAL_TSF_RST, 3446295874Savos urtwn_read_1(sc, R92C_DUAL_TSF_RST) | 0x20); 3447295874Savos 3448295874Savos /* If firmware in ram code, do reset. */ 3449295874Savos#ifndef URTWN_WITHOUT_UCODE 3450295874Savos if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RDY) 3451295874Savos urtwn_r88e_fw_reset(sc); 3452295874Savos#endif 3453295874Savos 3454295874Savos /* Reset MCU ready status. */ 3455295874Savos urtwn_write_1(sc, R92C_MCUFWDL, 0x00); 3456295874Savos 3457295874Savos /* Disable 32k. */ 3458295874Savos urtwn_write_1(sc, R88E_32K_CTRL, 3459295874Savos urtwn_read_1(sc, R88E_32K_CTRL) & ~0x01); 3460295874Savos 3461295874Savos /* Move card to Disabled state. */ 3462295874Savos /* Turn off RF. */ 3463295874Savos urtwn_write_1(sc, R92C_RF_CTRL, 0); 3464295874Savos 3465295874Savos /* LDO Sleep mode. */ 3466295874Savos urtwn_write_1(sc, R92C_LPLDO_CTRL, 3467295874Savos urtwn_read_1(sc, R92C_LPLDO_CTRL) | R92C_LPLDO_CTRL_SLEEP); 3468295874Savos 3469295874Savos /* Turn off MAC by HW state machine */ 3470295874Savos urtwn_write_1(sc, R92C_APS_FSMCO + 1, 3471295874Savos urtwn_read_1(sc, R92C_APS_FSMCO + 1) | 3472295874Savos (R92C_APS_FSMCO_APFM_OFF >> 8)); 3473295874Savos 3474295874Savos for (ntries = 0; ntries < 20; ntries++) { 3475295874Savos /* Wait until it will be disabled. */ 3476295874Savos if ((urtwn_read_1(sc, R92C_APS_FSMCO + 1) & 3477295874Savos (R92C_APS_FSMCO_APFM_OFF >> 8)) == 0) 3478295874Savos break; 3479295874Savos 3480295874Savos urtwn_ms_delay(sc); 3481295874Savos } 3482295874Savos if (ntries == 20) { 3483295874Savos device_printf(sc->sc_dev, "%s: could not turn off MAC\n", 3484295874Savos __func__); 3485295874Savos return; 3486295874Savos } 3487295874Savos 3488295874Savos /* schmit trigger */ 3489295874Savos urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 2, 3490295874Savos urtwn_read_1(sc, R92C_AFE_XTAL_CTRL + 2) | 0x80); 3491295874Savos 3492295874Savos /* Enable WL suspend. */ 3493295874Savos urtwn_write_1(sc, R92C_APS_FSMCO + 1, 3494295874Savos (urtwn_read_1(sc, R92C_APS_FSMCO + 1) & ~0x10) | 0x08); 3495295874Savos 3496295874Savos /* Enable bandgap mbias in suspend. */ 3497295874Savos urtwn_write_1(sc, R92C_APS_FSMCO + 3, 0); 3498295874Savos 3499295874Savos /* Clear SIC_EN register. */ 3500295874Savos urtwn_write_1(sc, R92C_GPIO_MUXCFG + 1, 3501295874Savos urtwn_read_1(sc, R92C_GPIO_MUXCFG + 1) & ~0x10); 3502295874Savos 3503295874Savos /* Set USB suspend enable local register */ 3504295874Savos urtwn_write_1(sc, R92C_USB_SUSPEND, 3505295874Savos urtwn_read_1(sc, R92C_USB_SUSPEND) | 0x10); 3506295874Savos 3507295874Savos /* Reset MCU IO Wrapper. */ 3508295874Savos reg = urtwn_read_1(sc, R92C_RSV_CTRL + 1); 3509295874Savos urtwn_write_1(sc, R92C_RSV_CTRL + 1, reg & ~0x08); 3510295874Savos urtwn_write_1(sc, R92C_RSV_CTRL + 1, reg | 0x08); 3511295874Savos 3512295874Savos /* marked as 'For Power Consumption' code. */ 3513295874Savos urtwn_write_1(sc, R92C_GPIO_OUT, urtwn_read_1(sc, R92C_GPIO_IN)); 3514295874Savos urtwn_write_1(sc, R92C_GPIO_IOSEL, 0xff); 3515295874Savos 3516295874Savos urtwn_write_1(sc, R92C_GPIO_IO_SEL, 3517295874Savos urtwn_read_1(sc, R92C_GPIO_IO_SEL) << 4); 3518295874Savos urtwn_write_1(sc, R92C_GPIO_MOD, 3519295874Savos urtwn_read_1(sc, R92C_GPIO_MOD) | 0x0f); 3520295874Savos 3521295874Savos /* Set LNA, TRSW, EX_PA Pin to output mode. */ 3522295874Savos urtwn_write_4(sc, R88E_BB_PAD_CTRL, 0x00080808); 3523295874Savos} 3524295874Savos 3525264912Skevlostatic int 3526251538Srpaulourtwn_llt_init(struct urtwn_softc *sc) 3527251538Srpaulo{ 3528264912Skevlo int i, error, page_count, pktbuf_count; 3529251538Srpaulo 3530264912Skevlo page_count = (sc->chip & URTWN_CHIP_88E) ? 3531264912Skevlo R88E_TX_PAGE_COUNT : R92C_TX_PAGE_COUNT; 3532264912Skevlo pktbuf_count = (sc->chip & URTWN_CHIP_88E) ? 3533264912Skevlo R88E_TXPKTBUF_COUNT : R92C_TXPKTBUF_COUNT; 3534264912Skevlo 3535264912Skevlo /* Reserve pages [0; page_count]. */ 3536264912Skevlo for (i = 0; i < page_count; i++) { 3537251538Srpaulo if ((error = urtwn_llt_write(sc, i, i + 1)) != 0) 3538251538Srpaulo return (error); 3539251538Srpaulo } 3540251538Srpaulo /* NB: 0xff indicates end-of-list. */ 3541251538Srpaulo if ((error = urtwn_llt_write(sc, i, 0xff)) != 0) 3542251538Srpaulo return (error); 3543251538Srpaulo /* 3544264912Skevlo * Use pages [page_count + 1; pktbuf_count - 1] 3545251538Srpaulo * as ring buffer. 3546251538Srpaulo */ 3547264912Skevlo for (++i; i < pktbuf_count - 1; i++) { 3548251538Srpaulo if ((error = urtwn_llt_write(sc, i, i + 1)) != 0) 3549251538Srpaulo return (error); 3550251538Srpaulo } 3551251538Srpaulo /* Make the last page point to the beginning of the ring buffer. */ 3552264912Skevlo error = urtwn_llt_write(sc, i, page_count + 1); 3553251538Srpaulo return (error); 3554251538Srpaulo} 3555251538Srpaulo 3556295871Savos#ifndef URTWN_WITHOUT_UCODE 3557251538Srpaulostatic void 3558251538Srpaulourtwn_fw_reset(struct urtwn_softc *sc) 3559251538Srpaulo{ 3560251538Srpaulo uint16_t reg; 3561251538Srpaulo int ntries; 3562251538Srpaulo 3563251538Srpaulo /* Tell 8051 to reset itself. */ 3564251538Srpaulo urtwn_write_1(sc, R92C_HMETFR + 3, 0x20); 3565251538Srpaulo 3566251538Srpaulo /* Wait until 8051 resets by itself. */ 3567251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 3568251538Srpaulo reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN); 3569251538Srpaulo if (!(reg & R92C_SYS_FUNC_EN_CPUEN)) 3570251538Srpaulo return; 3571266472Shselasky urtwn_ms_delay(sc); 3572251538Srpaulo } 3573251538Srpaulo /* Force 8051 reset. */ 3574251538Srpaulo urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN); 3575251538Srpaulo} 3576251538Srpaulo 3577264912Skevlostatic void 3578264912Skevlourtwn_r88e_fw_reset(struct urtwn_softc *sc) 3579264912Skevlo{ 3580264912Skevlo uint16_t reg; 3581264912Skevlo 3582264912Skevlo reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN); 3583264912Skevlo urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN); 3584264912Skevlo urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg | R92C_SYS_FUNC_EN_CPUEN); 3585264912Skevlo} 3586264912Skevlo 3587251538Srpaulostatic int 3588251538Srpaulourtwn_fw_loadpage(struct urtwn_softc *sc, int page, const uint8_t *buf, int len) 3589251538Srpaulo{ 3590251538Srpaulo uint32_t reg; 3591291698Savos usb_error_t error = USB_ERR_NORMAL_COMPLETION; 3592291698Savos int off, mlen; 3593251538Srpaulo 3594251538Srpaulo reg = urtwn_read_4(sc, R92C_MCUFWDL); 3595251538Srpaulo reg = RW(reg, R92C_MCUFWDL_PAGE, page); 3596251538Srpaulo urtwn_write_4(sc, R92C_MCUFWDL, reg); 3597251538Srpaulo 3598251538Srpaulo off = R92C_FW_START_ADDR; 3599251538Srpaulo while (len > 0) { 3600251538Srpaulo if (len > 196) 3601251538Srpaulo mlen = 196; 3602251538Srpaulo else if (len > 4) 3603251538Srpaulo mlen = 4; 3604251538Srpaulo else 3605251538Srpaulo mlen = 1; 3606251538Srpaulo /* XXX fix this deconst */ 3607281069Srpaulo error = urtwn_write_region_1(sc, off, 3608251538Srpaulo __DECONST(uint8_t *, buf), mlen); 3609291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3610251538Srpaulo break; 3611251538Srpaulo off += mlen; 3612251538Srpaulo buf += mlen; 3613251538Srpaulo len -= mlen; 3614251538Srpaulo } 3615251538Srpaulo return (error); 3616251538Srpaulo} 3617251538Srpaulo 3618251538Srpaulostatic int 3619251538Srpaulourtwn_load_firmware(struct urtwn_softc *sc) 3620251538Srpaulo{ 3621251538Srpaulo const struct firmware *fw; 3622251538Srpaulo const struct r92c_fw_hdr *hdr; 3623251538Srpaulo const char *imagename; 3624251538Srpaulo const u_char *ptr; 3625251538Srpaulo size_t len; 3626251538Srpaulo uint32_t reg; 3627251538Srpaulo int mlen, ntries, page, error; 3628251538Srpaulo 3629264864Skevlo URTWN_UNLOCK(sc); 3630251538Srpaulo /* Read firmware image from the filesystem. */ 3631264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3632264912Skevlo imagename = "urtwn-rtl8188eufw"; 3633264912Skevlo else if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) == 3634264912Skevlo URTWN_CHIP_UMC_A_CUT) 3635251538Srpaulo imagename = "urtwn-rtl8192cfwU"; 3636251538Srpaulo else 3637251538Srpaulo imagename = "urtwn-rtl8192cfwT"; 3638251538Srpaulo 3639251538Srpaulo fw = firmware_get(imagename); 3640264864Skevlo URTWN_LOCK(sc); 3641251538Srpaulo if (fw == NULL) { 3642251538Srpaulo device_printf(sc->sc_dev, 3643251538Srpaulo "failed loadfirmware of file %s\n", imagename); 3644251538Srpaulo return (ENOENT); 3645251538Srpaulo } 3646251538Srpaulo 3647251538Srpaulo len = fw->datasize; 3648251538Srpaulo 3649251538Srpaulo if (len < sizeof(*hdr)) { 3650251538Srpaulo device_printf(sc->sc_dev, "firmware too short\n"); 3651251538Srpaulo error = EINVAL; 3652251538Srpaulo goto fail; 3653251538Srpaulo } 3654251538Srpaulo ptr = fw->data; 3655251538Srpaulo hdr = (const struct r92c_fw_hdr *)ptr; 3656251538Srpaulo /* Check if there is a valid FW header and skip it. */ 3657251538Srpaulo if ((le16toh(hdr->signature) >> 4) == 0x88c || 3658264912Skevlo (le16toh(hdr->signature) >> 4) == 0x88e || 3659251538Srpaulo (le16toh(hdr->signature) >> 4) == 0x92c) { 3660294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_FIRMWARE, 3661294471Savos "FW V%d.%d %02d-%02d %02d:%02d\n", 3662251538Srpaulo le16toh(hdr->version), le16toh(hdr->subversion), 3663251538Srpaulo hdr->month, hdr->date, hdr->hour, hdr->minute); 3664251538Srpaulo ptr += sizeof(*hdr); 3665251538Srpaulo len -= sizeof(*hdr); 3666251538Srpaulo } 3667251538Srpaulo 3668264912Skevlo if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RAM_DL_SEL) { 3669264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3670264912Skevlo urtwn_r88e_fw_reset(sc); 3671264912Skevlo else 3672264912Skevlo urtwn_fw_reset(sc); 3673251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 0); 3674251538Srpaulo } 3675264912Skevlo 3676268487Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 3677268487Skevlo urtwn_write_2(sc, R92C_SYS_FUNC_EN, 3678268487Skevlo urtwn_read_2(sc, R92C_SYS_FUNC_EN) | 3679268487Skevlo R92C_SYS_FUNC_EN_CPUEN); 3680268487Skevlo } 3681251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 3682251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_EN); 3683251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL + 2, 3684251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL + 2) & ~0x08); 3685251538Srpaulo 3686263154Skevlo /* Reset the FWDL checksum. */ 3687263154Skevlo urtwn_write_1(sc, R92C_MCUFWDL, 3688263154Skevlo urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_CHKSUM_RPT); 3689263154Skevlo 3690251538Srpaulo for (page = 0; len > 0; page++) { 3691251538Srpaulo mlen = min(len, R92C_FW_PAGE_SIZE); 3692251538Srpaulo error = urtwn_fw_loadpage(sc, page, ptr, mlen); 3693251538Srpaulo if (error != 0) { 3694251538Srpaulo device_printf(sc->sc_dev, 3695251538Srpaulo "could not load firmware page\n"); 3696251538Srpaulo goto fail; 3697251538Srpaulo } 3698251538Srpaulo ptr += mlen; 3699251538Srpaulo len -= mlen; 3700251538Srpaulo } 3701251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 3702251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL) & ~R92C_MCUFWDL_EN); 3703251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL + 1, 0); 3704251538Srpaulo 3705251538Srpaulo /* Wait for checksum report. */ 3706251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 3707251538Srpaulo if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_CHKSUM_RPT) 3708251538Srpaulo break; 3709266472Shselasky urtwn_ms_delay(sc); 3710251538Srpaulo } 3711251538Srpaulo if (ntries == 1000) { 3712251538Srpaulo device_printf(sc->sc_dev, 3713251538Srpaulo "timeout waiting for checksum report\n"); 3714251538Srpaulo error = ETIMEDOUT; 3715251538Srpaulo goto fail; 3716251538Srpaulo } 3717251538Srpaulo 3718251538Srpaulo reg = urtwn_read_4(sc, R92C_MCUFWDL); 3719251538Srpaulo reg = (reg & ~R92C_MCUFWDL_WINTINI_RDY) | R92C_MCUFWDL_RDY; 3720251538Srpaulo urtwn_write_4(sc, R92C_MCUFWDL, reg); 3721264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3722264912Skevlo urtwn_r88e_fw_reset(sc); 3723251538Srpaulo /* Wait for firmware readiness. */ 3724251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 3725251538Srpaulo if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_WINTINI_RDY) 3726251538Srpaulo break; 3727266472Shselasky urtwn_ms_delay(sc); 3728251538Srpaulo } 3729251538Srpaulo if (ntries == 1000) { 3730251538Srpaulo device_printf(sc->sc_dev, 3731251538Srpaulo "timeout waiting for firmware readiness\n"); 3732251538Srpaulo error = ETIMEDOUT; 3733251538Srpaulo goto fail; 3734251538Srpaulo } 3735251538Srpaulofail: 3736251538Srpaulo firmware_put(fw, FIRMWARE_UNLOAD); 3737251538Srpaulo return (error); 3738251538Srpaulo} 3739295871Savos#endif 3740251538Srpaulo 3741291902Skevlostatic int 3742251538Srpaulourtwn_dma_init(struct urtwn_softc *sc) 3743251538Srpaulo{ 3744291902Skevlo struct usb_endpoint *ep, *ep_end; 3745291698Savos usb_error_t usb_err; 3746291902Skevlo uint32_t reg; 3747291902Skevlo int hashq, hasnq, haslq, nqueues, ntx; 3748291902Skevlo int error, pagecount, npubqpages, nqpages, nrempages, tx_boundary; 3749281069Srpaulo 3750291695Savos /* Initialize LLT table. */ 3751291695Savos error = urtwn_llt_init(sc); 3752291695Savos if (error != 0) 3753291695Savos return (error); 3754291695Savos 3755291902Skevlo /* Determine the number of bulk-out pipes. */ 3756291902Skevlo ntx = 0; 3757291902Skevlo ep = sc->sc_udev->endpoints; 3758291902Skevlo ep_end = sc->sc_udev->endpoints + sc->sc_udev->endpoints_max; 3759291902Skevlo for (; ep != ep_end; ep++) { 3760291902Skevlo if ((ep->edesc == NULL) || 3761291902Skevlo (ep->iface_index != sc->sc_iface_index)) 3762291902Skevlo continue; 3763291902Skevlo if (UE_GET_DIR(ep->edesc->bEndpointAddress) == UE_DIR_OUT) 3764291902Skevlo ntx++; 3765291902Skevlo } 3766291902Skevlo if (ntx == 0) { 3767291902Skevlo device_printf(sc->sc_dev, 3768291902Skevlo "%d: invalid number of Tx bulk pipes\n", ntx); 3769291698Savos return (EIO); 3770291902Skevlo } 3771291695Savos 3772251538Srpaulo /* Get Tx queues to USB endpoints mapping. */ 3773291902Skevlo hashq = hasnq = haslq = nqueues = 0; 3774291902Skevlo switch (ntx) { 3775291902Skevlo case 1: hashq = 1; break; 3776291902Skevlo case 2: hashq = hasnq = 1; break; 3777291902Skevlo case 3: case 4: hashq = hasnq = haslq = 1; break; 3778291902Skevlo } 3779251538Srpaulo nqueues = hashq + hasnq + haslq; 3780251538Srpaulo if (nqueues == 0) 3781251538Srpaulo return (EIO); 3782251538Srpaulo 3783291902Skevlo npubqpages = nqpages = nrempages = pagecount = 0; 3784291902Skevlo if (sc->chip & URTWN_CHIP_88E) 3785291902Skevlo tx_boundary = R88E_TX_PAGE_BOUNDARY; 3786291902Skevlo else { 3787291902Skevlo pagecount = R92C_TX_PAGE_COUNT; 3788291902Skevlo npubqpages = R92C_PUBQ_NPAGES; 3789291902Skevlo tx_boundary = R92C_TX_PAGE_BOUNDARY; 3790291902Skevlo } 3791291902Skevlo 3792251538Srpaulo /* Set number of pages for normal priority queue. */ 3793291902Skevlo if (sc->chip & URTWN_CHIP_88E) { 3794291902Skevlo usb_err = urtwn_write_2(sc, R92C_RQPN_NPQ, 0xd); 3795291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3796291902Skevlo return (EIO); 3797291902Skevlo usb_err = urtwn_write_4(sc, R92C_RQPN, 0x808e000d); 3798291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3799291902Skevlo return (EIO); 3800291902Skevlo } else { 3801291902Skevlo /* Get the number of pages for each queue. */ 3802291902Skevlo nqpages = (pagecount - npubqpages) / nqueues; 3803291902Skevlo /* 3804291902Skevlo * The remaining pages are assigned to the high priority 3805291902Skevlo * queue. 3806291902Skevlo */ 3807291902Skevlo nrempages = (pagecount - npubqpages) % nqueues; 3808291902Skevlo usb_err = urtwn_write_1(sc, R92C_RQPN_NPQ, hasnq ? nqpages : 0); 3809291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3810291902Skevlo return (EIO); 3811291902Skevlo usb_err = urtwn_write_4(sc, R92C_RQPN, 3812291902Skevlo /* Set number of pages for public queue. */ 3813291902Skevlo SM(R92C_RQPN_PUBQ, npubqpages) | 3814291902Skevlo /* Set number of pages for high priority queue. */ 3815291902Skevlo SM(R92C_RQPN_HPQ, hashq ? nqpages + nrempages : 0) | 3816291902Skevlo /* Set number of pages for low priority queue. */ 3817291902Skevlo SM(R92C_RQPN_LPQ, haslq ? nqpages : 0) | 3818291902Skevlo /* Load values. */ 3819291902Skevlo R92C_RQPN_LD); 3820291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3821291902Skevlo return (EIO); 3822291902Skevlo } 3823251538Srpaulo 3824291902Skevlo usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_BCNQ_BDNY, tx_boundary); 3825291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3826291698Savos return (EIO); 3827291902Skevlo usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_MGQ_BDNY, tx_boundary); 3828291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3829291698Savos return (EIO); 3830291902Skevlo usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_WMAC_LBK_BF_HD, tx_boundary); 3831291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3832291698Savos return (EIO); 3833291902Skevlo usb_err = urtwn_write_1(sc, R92C_TRXFF_BNDY, tx_boundary); 3834291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3835291698Savos return (EIO); 3836291902Skevlo usb_err = urtwn_write_1(sc, R92C_TDECTRL + 1, tx_boundary); 3837291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3838291698Savos return (EIO); 3839251538Srpaulo 3840251538Srpaulo /* Set queue to USB pipe mapping. */ 3841251538Srpaulo reg = urtwn_read_2(sc, R92C_TRXDMA_CTRL); 3842251538Srpaulo reg &= ~R92C_TRXDMA_CTRL_QMAP_M; 3843251538Srpaulo if (nqueues == 1) { 3844251538Srpaulo if (hashq) 3845251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_HQ; 3846251538Srpaulo else if (hasnq) 3847251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_NQ; 3848251538Srpaulo else 3849251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_LQ; 3850251538Srpaulo } else if (nqueues == 2) { 3851292056Skevlo /* 3852292056Skevlo * All 2-endpoints configs have high and normal 3853292056Skevlo * priority queues. 3854292056Skevlo */ 3855292056Skevlo reg |= R92C_TRXDMA_CTRL_QMAP_HQ_NQ; 3856251538Srpaulo } else 3857251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_3EP; 3858291902Skevlo usb_err = urtwn_write_2(sc, R92C_TRXDMA_CTRL, reg); 3859291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3860291698Savos return (EIO); 3861251538Srpaulo 3862251538Srpaulo /* Set Tx/Rx transfer page boundary. */ 3863291902Skevlo usb_err = urtwn_write_2(sc, R92C_TRXFF_BNDY + 2, 3864291902Skevlo (sc->chip & URTWN_CHIP_88E) ? 0x23ff : 0x27ff); 3865291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3866291698Savos return (EIO); 3867251538Srpaulo 3868291902Skevlo /* Set Tx/Rx transfer page size. */ 3869291902Skevlo usb_err = urtwn_write_1(sc, R92C_PBP, 3870291902Skevlo SM(R92C_PBP_PSRX, R92C_PBP_128) | 3871291902Skevlo SM(R92C_PBP_PSTX, R92C_PBP_128)); 3872291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3873264912Skevlo return (EIO); 3874264912Skevlo 3875264912Skevlo return (0); 3876264912Skevlo} 3877264912Skevlo 3878291698Savosstatic int 3879251538Srpaulourtwn_mac_init(struct urtwn_softc *sc) 3880251538Srpaulo{ 3881291698Savos usb_error_t error; 3882251538Srpaulo int i; 3883251538Srpaulo 3884251538Srpaulo /* Write MAC initialization values. */ 3885264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 3886264912Skevlo for (i = 0; i < nitems(rtl8188eu_mac); i++) { 3887291698Savos error = urtwn_write_1(sc, rtl8188eu_mac[i].reg, 3888264912Skevlo rtl8188eu_mac[i].val); 3889291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3890291698Savos return (EIO); 3891264912Skevlo } 3892264912Skevlo urtwn_write_1(sc, R92C_MAX_AGGR_NUM, 0x07); 3893264912Skevlo } else { 3894264912Skevlo for (i = 0; i < nitems(rtl8192cu_mac); i++) 3895291698Savos error = urtwn_write_1(sc, rtl8192cu_mac[i].reg, 3896264912Skevlo rtl8192cu_mac[i].val); 3897291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3898291698Savos return (EIO); 3899264912Skevlo } 3900291698Savos 3901291698Savos return (0); 3902251538Srpaulo} 3903251538Srpaulo 3904251538Srpaulostatic void 3905251538Srpaulourtwn_bb_init(struct urtwn_softc *sc) 3906251538Srpaulo{ 3907251538Srpaulo const struct urtwn_bb_prog *prog; 3908251538Srpaulo uint32_t reg; 3909264912Skevlo uint8_t crystalcap; 3910251538Srpaulo int i; 3911251538Srpaulo 3912251538Srpaulo /* Enable BB and RF. */ 3913251538Srpaulo urtwn_write_2(sc, R92C_SYS_FUNC_EN, 3914251538Srpaulo urtwn_read_2(sc, R92C_SYS_FUNC_EN) | 3915251538Srpaulo R92C_SYS_FUNC_EN_BBRSTB | R92C_SYS_FUNC_EN_BB_GLB_RST | 3916251538Srpaulo R92C_SYS_FUNC_EN_DIO_RF); 3917251538Srpaulo 3918264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) 3919264912Skevlo urtwn_write_2(sc, R92C_AFE_PLL_CTRL, 0xdb83); 3920251538Srpaulo 3921251538Srpaulo urtwn_write_1(sc, R92C_RF_CTRL, 3922251538Srpaulo R92C_RF_CTRL_EN | R92C_RF_CTRL_RSTB | R92C_RF_CTRL_SDMRSTB); 3923251538Srpaulo urtwn_write_1(sc, R92C_SYS_FUNC_EN, 3924251538Srpaulo R92C_SYS_FUNC_EN_USBA | R92C_SYS_FUNC_EN_USBD | 3925251538Srpaulo R92C_SYS_FUNC_EN_BB_GLB_RST | R92C_SYS_FUNC_EN_BBRSTB); 3926251538Srpaulo 3927264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 3928264912Skevlo urtwn_write_1(sc, R92C_LDOHCI12_CTRL, 0x0f); 3929264912Skevlo urtwn_write_1(sc, 0x15, 0xe9); 3930264912Skevlo urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 1, 0x80); 3931264912Skevlo } 3932251538Srpaulo 3933251538Srpaulo /* Select BB programming based on board type. */ 3934264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3935264912Skevlo prog = &rtl8188eu_bb_prog; 3936264912Skevlo else if (!(sc->chip & URTWN_CHIP_92C)) { 3937251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 3938251538Srpaulo prog = &rtl8188ce_bb_prog; 3939251538Srpaulo else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 3940251538Srpaulo prog = &rtl8188ru_bb_prog; 3941251538Srpaulo else 3942251538Srpaulo prog = &rtl8188cu_bb_prog; 3943251538Srpaulo } else { 3944251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 3945251538Srpaulo prog = &rtl8192ce_bb_prog; 3946251538Srpaulo else 3947251538Srpaulo prog = &rtl8192cu_bb_prog; 3948251538Srpaulo } 3949251538Srpaulo /* Write BB initialization values. */ 3950251538Srpaulo for (i = 0; i < prog->count; i++) { 3951251538Srpaulo urtwn_bb_write(sc, prog->regs[i], prog->vals[i]); 3952266472Shselasky urtwn_ms_delay(sc); 3953251538Srpaulo } 3954251538Srpaulo 3955251538Srpaulo if (sc->chip & URTWN_CHIP_92C_1T2R) { 3956251538Srpaulo /* 8192C 1T only configuration. */ 3957251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_TXINFO); 3958251538Srpaulo reg = (reg & ~0x00000003) | 0x2; 3959251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_TXINFO, reg); 3960251538Srpaulo 3961251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA1_TXINFO); 3962251538Srpaulo reg = (reg & ~0x00300033) | 0x00200022; 3963251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_TXINFO, reg); 3964251538Srpaulo 3965251538Srpaulo reg = urtwn_bb_read(sc, R92C_CCK0_AFESETTING); 3966251538Srpaulo reg = (reg & ~0xff000000) | 0x45 << 24; 3967251538Srpaulo urtwn_bb_write(sc, R92C_CCK0_AFESETTING, reg); 3968251538Srpaulo 3969251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_TRXPATHENA); 3970251538Srpaulo reg = (reg & ~0x000000ff) | 0x23; 3971251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_TRXPATHENA, reg); 3972251538Srpaulo 3973251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_AGCPARAM1); 3974251538Srpaulo reg = (reg & ~0x00000030) | 1 << 4; 3975251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCPARAM1, reg); 3976251538Srpaulo 3977251538Srpaulo reg = urtwn_bb_read(sc, 0xe74); 3978251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 3979251538Srpaulo urtwn_bb_write(sc, 0xe74, reg); 3980251538Srpaulo reg = urtwn_bb_read(sc, 0xe78); 3981251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 3982251538Srpaulo urtwn_bb_write(sc, 0xe78, reg); 3983251538Srpaulo reg = urtwn_bb_read(sc, 0xe7c); 3984251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 3985251538Srpaulo urtwn_bb_write(sc, 0xe7c, reg); 3986251538Srpaulo reg = urtwn_bb_read(sc, 0xe80); 3987251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 3988251538Srpaulo urtwn_bb_write(sc, 0xe80, reg); 3989251538Srpaulo reg = urtwn_bb_read(sc, 0xe88); 3990251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 3991251538Srpaulo urtwn_bb_write(sc, 0xe88, reg); 3992251538Srpaulo } 3993251538Srpaulo 3994251538Srpaulo /* Write AGC values. */ 3995251538Srpaulo for (i = 0; i < prog->agccount; i++) { 3996251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCRSSITABLE, 3997251538Srpaulo prog->agcvals[i]); 3998266472Shselasky urtwn_ms_delay(sc); 3999251538Srpaulo } 4000251538Srpaulo 4001264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 4002264912Skevlo urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553422); 4003266472Shselasky urtwn_ms_delay(sc); 4004264912Skevlo urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553420); 4005266472Shselasky urtwn_ms_delay(sc); 4006264912Skevlo 4007294198Savos crystalcap = sc->rom.r88e_rom.crystalcap; 4008264912Skevlo if (crystalcap == 0xff) 4009264912Skevlo crystalcap = 0x20; 4010264912Skevlo crystalcap &= 0x3f; 4011264912Skevlo reg = urtwn_bb_read(sc, R92C_AFE_XTAL_CTRL); 4012264912Skevlo urtwn_bb_write(sc, R92C_AFE_XTAL_CTRL, 4013264912Skevlo RW(reg, R92C_AFE_XTAL_CTRL_ADDR, 4014264912Skevlo crystalcap | crystalcap << 6)); 4015264912Skevlo } else { 4016264912Skevlo if (urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)) & 4017264912Skevlo R92C_HSSI_PARAM2_CCK_HIPWR) 4018264912Skevlo sc->sc_flags |= URTWN_FLAG_CCK_HIPWR; 4019264912Skevlo } 4020251538Srpaulo} 4021251538Srpaulo 4022289066Skevlostatic void 4023251538Srpaulourtwn_rf_init(struct urtwn_softc *sc) 4024251538Srpaulo{ 4025251538Srpaulo const struct urtwn_rf_prog *prog; 4026251538Srpaulo uint32_t reg, type; 4027251538Srpaulo int i, j, idx, off; 4028251538Srpaulo 4029251538Srpaulo /* Select RF programming based on board type. */ 4030264912Skevlo if (sc->chip & URTWN_CHIP_88E) 4031264912Skevlo prog = rtl8188eu_rf_prog; 4032264912Skevlo else if (!(sc->chip & URTWN_CHIP_92C)) { 4033251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 4034251538Srpaulo prog = rtl8188ce_rf_prog; 4035251538Srpaulo else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 4036251538Srpaulo prog = rtl8188ru_rf_prog; 4037251538Srpaulo else 4038251538Srpaulo prog = rtl8188cu_rf_prog; 4039251538Srpaulo } else 4040251538Srpaulo prog = rtl8192ce_rf_prog; 4041251538Srpaulo 4042251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 4043251538Srpaulo /* Save RF_ENV control type. */ 4044251538Srpaulo idx = i / 2; 4045251538Srpaulo off = (i % 2) * 16; 4046251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx)); 4047251538Srpaulo type = (reg >> off) & 0x10; 4048251538Srpaulo 4049251538Srpaulo /* Set RF_ENV enable. */ 4050251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i)); 4051251538Srpaulo reg |= 0x100000; 4052251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg); 4053266472Shselasky urtwn_ms_delay(sc); 4054251538Srpaulo /* Set RF_ENV output high. */ 4055251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i)); 4056251538Srpaulo reg |= 0x10; 4057251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg); 4058266472Shselasky urtwn_ms_delay(sc); 4059251538Srpaulo /* Set address and data lengths of RF registers. */ 4060251538Srpaulo reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i)); 4061251538Srpaulo reg &= ~R92C_HSSI_PARAM2_ADDR_LENGTH; 4062251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg); 4063266472Shselasky urtwn_ms_delay(sc); 4064251538Srpaulo reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i)); 4065251538Srpaulo reg &= ~R92C_HSSI_PARAM2_DATA_LENGTH; 4066251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg); 4067266472Shselasky urtwn_ms_delay(sc); 4068251538Srpaulo 4069251538Srpaulo /* Write RF initialization values for this chain. */ 4070251538Srpaulo for (j = 0; j < prog[i].count; j++) { 4071251538Srpaulo if (prog[i].regs[j] >= 0xf9 && 4072251538Srpaulo prog[i].regs[j] <= 0xfe) { 4073251538Srpaulo /* 4074251538Srpaulo * These are fake RF registers offsets that 4075251538Srpaulo * indicate a delay is required. 4076251538Srpaulo */ 4077266472Shselasky usb_pause_mtx(&sc->sc_mtx, hz / 20); /* 50ms */ 4078251538Srpaulo continue; 4079251538Srpaulo } 4080251538Srpaulo urtwn_rf_write(sc, i, prog[i].regs[j], 4081251538Srpaulo prog[i].vals[j]); 4082266472Shselasky urtwn_ms_delay(sc); 4083251538Srpaulo } 4084251538Srpaulo 4085251538Srpaulo /* Restore RF_ENV control type. */ 4086251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx)); 4087251538Srpaulo reg &= ~(0x10 << off) | (type << off); 4088251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACESW(idx), reg); 4089251538Srpaulo 4090251538Srpaulo /* Cache RF register CHNLBW. */ 4091251538Srpaulo sc->rf_chnlbw[i] = urtwn_rf_read(sc, i, R92C_RF_CHNLBW); 4092251538Srpaulo } 4093251538Srpaulo 4094251538Srpaulo if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) == 4095251538Srpaulo URTWN_CHIP_UMC_A_CUT) { 4096251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_RX_G1, 0x30255); 4097251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_RX_G2, 0x50a00); 4098251538Srpaulo } 4099251538Srpaulo} 4100251538Srpaulo 4101251538Srpaulostatic void 4102251538Srpaulourtwn_cam_init(struct urtwn_softc *sc) 4103251538Srpaulo{ 4104251538Srpaulo /* Invalidate all CAM entries. */ 4105251538Srpaulo urtwn_write_4(sc, R92C_CAMCMD, 4106251538Srpaulo R92C_CAMCMD_POLLING | R92C_CAMCMD_CLR); 4107251538Srpaulo} 4108251538Srpaulo 4109292175Savosstatic int 4110292175Savosurtwn_cam_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data) 4111292175Savos{ 4112292175Savos usb_error_t error; 4113292175Savos 4114292175Savos error = urtwn_write_4(sc, R92C_CAMWRITE, data); 4115292175Savos if (error != USB_ERR_NORMAL_COMPLETION) 4116292175Savos return (EIO); 4117292175Savos error = urtwn_write_4(sc, R92C_CAMCMD, 4118292175Savos R92C_CAMCMD_POLLING | R92C_CAMCMD_WRITE | 4119292175Savos SM(R92C_CAMCMD_ADDR, addr)); 4120292175Savos if (error != USB_ERR_NORMAL_COMPLETION) 4121292175Savos return (EIO); 4122292175Savos 4123292175Savos return (0); 4124292175Savos} 4125292175Savos 4126251538Srpaulostatic void 4127251538Srpaulourtwn_pa_bias_init(struct urtwn_softc *sc) 4128251538Srpaulo{ 4129251538Srpaulo uint8_t reg; 4130251538Srpaulo int i; 4131251538Srpaulo 4132251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 4133251538Srpaulo if (sc->pa_setting & (1 << i)) 4134251538Srpaulo continue; 4135251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x0f406); 4136251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x4f406); 4137251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x8f406); 4138251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0xcf406); 4139251538Srpaulo } 4140251538Srpaulo if (!(sc->pa_setting & 0x10)) { 4141251538Srpaulo reg = urtwn_read_1(sc, 0x16); 4142251538Srpaulo reg = (reg & ~0xf0) | 0x90; 4143251538Srpaulo urtwn_write_1(sc, 0x16, reg); 4144251538Srpaulo } 4145251538Srpaulo} 4146251538Srpaulo 4147251538Srpaulostatic void 4148251538Srpaulourtwn_rxfilter_init(struct urtwn_softc *sc) 4149251538Srpaulo{ 4150290564Savos struct ieee80211com *ic = &sc->sc_ic; 4151290564Savos struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 4152290564Savos uint32_t rcr; 4153290564Savos uint16_t filter; 4154290564Savos 4155290564Savos URTWN_ASSERT_LOCKED(sc); 4156290564Savos 4157251538Srpaulo /* Accept all multicast frames. */ 4158251538Srpaulo urtwn_write_4(sc, R92C_MAR + 0, 0xffffffff); 4159251538Srpaulo urtwn_write_4(sc, R92C_MAR + 4, 0xffffffff); 4160290564Savos 4161290564Savos /* Filter for management frames. */ 4162290564Savos filter = 0x7f3f; 4163290631Savos switch (vap->iv_opmode) { 4164290631Savos case IEEE80211_M_STA: 4165290564Savos filter &= ~( 4166290564Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_ASSOC_REQ) | 4167290564Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_REASSOC_REQ) | 4168290564Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_PROBE_REQ)); 4169290631Savos break; 4170290631Savos case IEEE80211_M_HOSTAP: 4171290631Savos filter &= ~( 4172290631Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_ASSOC_RESP) | 4173290631Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_REASSOC_RESP) | 4174290631Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_BEACON)); 4175290631Savos break; 4176290631Savos case IEEE80211_M_MONITOR: 4177290651Savos case IEEE80211_M_IBSS: 4178290631Savos break; 4179290631Savos default: 4180290631Savos device_printf(sc->sc_dev, "%s: undefined opmode %d\n", 4181290631Savos __func__, vap->iv_opmode); 4182290631Savos break; 4183290564Savos } 4184290564Savos urtwn_write_2(sc, R92C_RXFLTMAP0, filter); 4185290564Savos 4186251538Srpaulo /* Reject all control frames. */ 4187251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP1, 0x0000); 4188290564Savos 4189290564Savos /* Reject all data frames. */ 4190290564Savos urtwn_write_2(sc, R92C_RXFLTMAP2, 0x0000); 4191290564Savos 4192290564Savos rcr = R92C_RCR_AM | R92C_RCR_AB | R92C_RCR_APM | 4193290564Savos R92C_RCR_HTC_LOC_CTRL | R92C_RCR_APP_PHYSTS | 4194290564Savos R92C_RCR_APP_ICV | R92C_RCR_APP_MIC; 4195290564Savos 4196290564Savos if (vap->iv_opmode == IEEE80211_M_MONITOR) { 4197290564Savos /* Accept all frames. */ 4198290564Savos rcr |= R92C_RCR_ACF | R92C_RCR_ADF | R92C_RCR_AMF | 4199290564Savos R92C_RCR_AAP; 4200290564Savos } 4201290564Savos 4202290564Savos /* Set Rx filter. */ 4203290564Savos urtwn_write_4(sc, R92C_RCR, rcr); 4204290564Savos 4205290564Savos if (ic->ic_promisc != 0) { 4206290564Savos /* Update Rx filter. */ 4207290564Savos urtwn_set_promisc(sc); 4208290564Savos } 4209251538Srpaulo} 4210251538Srpaulo 4211251538Srpaulostatic void 4212251538Srpaulourtwn_edca_init(struct urtwn_softc *sc) 4213251538Srpaulo{ 4214251538Srpaulo urtwn_write_2(sc, R92C_SPEC_SIFS, 0x100a); 4215251538Srpaulo urtwn_write_2(sc, R92C_MAC_SPEC_SIFS, 0x100a); 4216251538Srpaulo urtwn_write_2(sc, R92C_SIFS_CCK, 0x100a); 4217251538Srpaulo urtwn_write_2(sc, R92C_SIFS_OFDM, 0x100a); 4218251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x005ea42b); 4219251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a44f); 4220251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005ea324); 4221251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002fa226); 4222251538Srpaulo} 4223251538Srpaulo 4224289066Skevlostatic void 4225251538Srpaulourtwn_write_txpower(struct urtwn_softc *sc, int chain, 4226251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]) 4227251538Srpaulo{ 4228251538Srpaulo uint32_t reg; 4229251538Srpaulo 4230251538Srpaulo /* Write per-CCK rate Tx power. */ 4231251538Srpaulo if (chain == 0) { 4232251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_A_CCK1_MCS32); 4233251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK1, power[0]); 4234251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_A_CCK1_MCS32, reg); 4235251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11); 4236251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK2, power[1]); 4237251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK55, power[2]); 4238251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK11, power[3]); 4239251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg); 4240251538Srpaulo } else { 4241251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK1_55_MCS32); 4242251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK1, power[0]); 4243251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK2, power[1]); 4244251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK55, power[2]); 4245251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK1_55_MCS32, reg); 4246251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11); 4247251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK11, power[3]); 4248251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg); 4249251538Srpaulo } 4250251538Srpaulo /* Write per-OFDM rate Tx power. */ 4251251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_RATE18_06(chain), 4252251538Srpaulo SM(R92C_TXAGC_RATE06, power[ 4]) | 4253251538Srpaulo SM(R92C_TXAGC_RATE09, power[ 5]) | 4254251538Srpaulo SM(R92C_TXAGC_RATE12, power[ 6]) | 4255251538Srpaulo SM(R92C_TXAGC_RATE18, power[ 7])); 4256251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_RATE54_24(chain), 4257251538Srpaulo SM(R92C_TXAGC_RATE24, power[ 8]) | 4258251538Srpaulo SM(R92C_TXAGC_RATE36, power[ 9]) | 4259251538Srpaulo SM(R92C_TXAGC_RATE48, power[10]) | 4260251538Srpaulo SM(R92C_TXAGC_RATE54, power[11])); 4261251538Srpaulo /* Write per-MCS Tx power. */ 4262251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS03_MCS00(chain), 4263251538Srpaulo SM(R92C_TXAGC_MCS00, power[12]) | 4264251538Srpaulo SM(R92C_TXAGC_MCS01, power[13]) | 4265251538Srpaulo SM(R92C_TXAGC_MCS02, power[14]) | 4266251538Srpaulo SM(R92C_TXAGC_MCS03, power[15])); 4267251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS07_MCS04(chain), 4268251538Srpaulo SM(R92C_TXAGC_MCS04, power[16]) | 4269251538Srpaulo SM(R92C_TXAGC_MCS05, power[17]) | 4270251538Srpaulo SM(R92C_TXAGC_MCS06, power[18]) | 4271251538Srpaulo SM(R92C_TXAGC_MCS07, power[19])); 4272251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS11_MCS08(chain), 4273251538Srpaulo SM(R92C_TXAGC_MCS08, power[20]) | 4274261506Skevlo SM(R92C_TXAGC_MCS09, power[21]) | 4275251538Srpaulo SM(R92C_TXAGC_MCS10, power[22]) | 4276251538Srpaulo SM(R92C_TXAGC_MCS11, power[23])); 4277251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS15_MCS12(chain), 4278251538Srpaulo SM(R92C_TXAGC_MCS12, power[24]) | 4279251538Srpaulo SM(R92C_TXAGC_MCS13, power[25]) | 4280251538Srpaulo SM(R92C_TXAGC_MCS14, power[26]) | 4281251538Srpaulo SM(R92C_TXAGC_MCS15, power[27])); 4282251538Srpaulo} 4283251538Srpaulo 4284289066Skevlostatic void 4285251538Srpaulourtwn_get_txpower(struct urtwn_softc *sc, int chain, 4286251538Srpaulo struct ieee80211_channel *c, struct ieee80211_channel *extc, 4287251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]) 4288251538Srpaulo{ 4289287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 4290291264Savos struct r92c_rom *rom = &sc->rom.r92c_rom; 4291251538Srpaulo uint16_t cckpow, ofdmpow, htpow, diff, max; 4292251538Srpaulo const struct urtwn_txpwr *base; 4293251538Srpaulo int ridx, chan, group; 4294251538Srpaulo 4295251538Srpaulo /* Determine channel group. */ 4296251538Srpaulo chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */ 4297251538Srpaulo if (chan <= 3) 4298251538Srpaulo group = 0; 4299251538Srpaulo else if (chan <= 9) 4300251538Srpaulo group = 1; 4301251538Srpaulo else 4302251538Srpaulo group = 2; 4303251538Srpaulo 4304251538Srpaulo /* Get original Tx power based on board type and RF chain. */ 4305251538Srpaulo if (!(sc->chip & URTWN_CHIP_92C)) { 4306251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 4307251538Srpaulo base = &rtl8188ru_txagc[chain]; 4308251538Srpaulo else 4309251538Srpaulo base = &rtl8192cu_txagc[chain]; 4310251538Srpaulo } else 4311251538Srpaulo base = &rtl8192cu_txagc[chain]; 4312251538Srpaulo 4313251538Srpaulo memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0])); 4314251538Srpaulo if (sc->regulatory == 0) { 4315289758Savos for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) 4316251538Srpaulo power[ridx] = base->pwr[0][ridx]; 4317251538Srpaulo } 4318289758Savos for (ridx = URTWN_RIDX_OFDM6; ridx < URTWN_RIDX_COUNT; ridx++) { 4319251538Srpaulo if (sc->regulatory == 3) { 4320251538Srpaulo power[ridx] = base->pwr[0][ridx]; 4321251538Srpaulo /* Apply vendor limits. */ 4322251538Srpaulo if (extc != NULL) 4323251538Srpaulo max = rom->ht40_max_pwr[group]; 4324251538Srpaulo else 4325251538Srpaulo max = rom->ht20_max_pwr[group]; 4326251538Srpaulo max = (max >> (chain * 4)) & 0xf; 4327251538Srpaulo if (power[ridx] > max) 4328251538Srpaulo power[ridx] = max; 4329251538Srpaulo } else if (sc->regulatory == 1) { 4330251538Srpaulo if (extc == NULL) 4331251538Srpaulo power[ridx] = base->pwr[group][ridx]; 4332251538Srpaulo } else if (sc->regulatory != 2) 4333251538Srpaulo power[ridx] = base->pwr[0][ridx]; 4334251538Srpaulo } 4335251538Srpaulo 4336251538Srpaulo /* Compute per-CCK rate Tx power. */ 4337251538Srpaulo cckpow = rom->cck_tx_pwr[chain][group]; 4338289758Savos for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) { 4339251538Srpaulo power[ridx] += cckpow; 4340251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 4341251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 4342251538Srpaulo } 4343251538Srpaulo 4344251538Srpaulo htpow = rom->ht40_1s_tx_pwr[chain][group]; 4345251538Srpaulo if (sc->ntxchains > 1) { 4346251538Srpaulo /* Apply reduction for 2 spatial streams. */ 4347251538Srpaulo diff = rom->ht40_2s_tx_pwr_diff[group]; 4348251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 4349251538Srpaulo htpow = (htpow > diff) ? htpow - diff : 0; 4350251538Srpaulo } 4351251538Srpaulo 4352251538Srpaulo /* Compute per-OFDM rate Tx power. */ 4353251538Srpaulo diff = rom->ofdm_tx_pwr_diff[group]; 4354251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 4355251538Srpaulo ofdmpow = htpow + diff; /* HT->OFDM correction. */ 4356289758Savos for (ridx = URTWN_RIDX_OFDM6; ridx <= URTWN_RIDX_OFDM54; ridx++) { 4357251538Srpaulo power[ridx] += ofdmpow; 4358251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 4359251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 4360251538Srpaulo } 4361251538Srpaulo 4362251538Srpaulo /* Compute per-MCS Tx power. */ 4363251538Srpaulo if (extc == NULL) { 4364251538Srpaulo diff = rom->ht20_tx_pwr_diff[group]; 4365251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 4366251538Srpaulo htpow += diff; /* HT40->HT20 correction. */ 4367251538Srpaulo } 4368251538Srpaulo for (ridx = 12; ridx <= 27; ridx++) { 4369251538Srpaulo power[ridx] += htpow; 4370251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 4371251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 4372251538Srpaulo } 4373294471Savos#ifdef USB_DEBUG 4374294471Savos if (sc->sc_debug & URTWN_DEBUG_TXPWR) { 4375251538Srpaulo /* Dump per-rate Tx power values. */ 4376251538Srpaulo printf("Tx power for chain %d:\n", chain); 4377289758Savos for (ridx = URTWN_RIDX_CCK1; ridx < URTWN_RIDX_COUNT; ridx++) 4378251538Srpaulo printf("Rate %d = %u\n", ridx, power[ridx]); 4379251538Srpaulo } 4380251538Srpaulo#endif 4381251538Srpaulo} 4382251538Srpaulo 4383289066Skevlostatic void 4384264912Skevlourtwn_r88e_get_txpower(struct urtwn_softc *sc, int chain, 4385264912Skevlo struct ieee80211_channel *c, struct ieee80211_channel *extc, 4386264912Skevlo uint16_t power[URTWN_RIDX_COUNT]) 4387264912Skevlo{ 4388287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 4389294198Savos struct r88e_rom *rom = &sc->rom.r88e_rom; 4390264912Skevlo uint16_t cckpow, ofdmpow, bw20pow, htpow; 4391264912Skevlo const struct urtwn_r88e_txpwr *base; 4392264912Skevlo int ridx, chan, group; 4393264912Skevlo 4394264912Skevlo /* Determine channel group. */ 4395264912Skevlo chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */ 4396264912Skevlo if (chan <= 2) 4397264912Skevlo group = 0; 4398264912Skevlo else if (chan <= 5) 4399264912Skevlo group = 1; 4400264912Skevlo else if (chan <= 8) 4401264912Skevlo group = 2; 4402264912Skevlo else if (chan <= 11) 4403264912Skevlo group = 3; 4404264912Skevlo else if (chan <= 13) 4405264912Skevlo group = 4; 4406264912Skevlo else 4407264912Skevlo group = 5; 4408264912Skevlo 4409264912Skevlo /* Get original Tx power based on board type and RF chain. */ 4410264912Skevlo base = &rtl8188eu_txagc[chain]; 4411264912Skevlo 4412264912Skevlo memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0])); 4413264912Skevlo if (sc->regulatory == 0) { 4414289758Savos for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) 4415264912Skevlo power[ridx] = base->pwr[0][ridx]; 4416264912Skevlo } 4417289758Savos for (ridx = URTWN_RIDX_OFDM6; ridx < URTWN_RIDX_COUNT; ridx++) { 4418264912Skevlo if (sc->regulatory == 3) 4419264912Skevlo power[ridx] = base->pwr[0][ridx]; 4420264912Skevlo else if (sc->regulatory == 1) { 4421264912Skevlo if (extc == NULL) 4422264912Skevlo power[ridx] = base->pwr[group][ridx]; 4423264912Skevlo } else if (sc->regulatory != 2) 4424264912Skevlo power[ridx] = base->pwr[0][ridx]; 4425264912Skevlo } 4426264912Skevlo 4427264912Skevlo /* Compute per-CCK rate Tx power. */ 4428294198Savos cckpow = rom->cck_tx_pwr[group]; 4429289758Savos for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) { 4430264912Skevlo power[ridx] += cckpow; 4431264912Skevlo if (power[ridx] > R92C_MAX_TX_PWR) 4432264912Skevlo power[ridx] = R92C_MAX_TX_PWR; 4433264912Skevlo } 4434264912Skevlo 4435294198Savos htpow = rom->ht40_tx_pwr[group]; 4436264912Skevlo 4437264912Skevlo /* Compute per-OFDM rate Tx power. */ 4438264912Skevlo ofdmpow = htpow + sc->ofdm_tx_pwr_diff; 4439289758Savos for (ridx = URTWN_RIDX_OFDM6; ridx <= URTWN_RIDX_OFDM54; ridx++) { 4440264912Skevlo power[ridx] += ofdmpow; 4441264912Skevlo if (power[ridx] > R92C_MAX_TX_PWR) 4442264912Skevlo power[ridx] = R92C_MAX_TX_PWR; 4443264912Skevlo } 4444264912Skevlo 4445264912Skevlo bw20pow = htpow + sc->bw20_tx_pwr_diff; 4446264912Skevlo for (ridx = 12; ridx <= 27; ridx++) { 4447264912Skevlo power[ridx] += bw20pow; 4448264912Skevlo if (power[ridx] > R92C_MAX_TX_PWR) 4449264912Skevlo power[ridx] = R92C_MAX_TX_PWR; 4450264912Skevlo } 4451264912Skevlo} 4452264912Skevlo 4453289066Skevlostatic void 4454251538Srpaulourtwn_set_txpower(struct urtwn_softc *sc, struct ieee80211_channel *c, 4455251538Srpaulo struct ieee80211_channel *extc) 4456251538Srpaulo{ 4457251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]; 4458251538Srpaulo int i; 4459251538Srpaulo 4460251538Srpaulo for (i = 0; i < sc->ntxchains; i++) { 4461251538Srpaulo /* Compute per-rate Tx power values. */ 4462264912Skevlo if (sc->chip & URTWN_CHIP_88E) 4463264912Skevlo urtwn_r88e_get_txpower(sc, i, c, extc, power); 4464264912Skevlo else 4465264912Skevlo urtwn_get_txpower(sc, i, c, extc, power); 4466251538Srpaulo /* Write per-rate Tx power values to hardware. */ 4467251538Srpaulo urtwn_write_txpower(sc, i, power); 4468251538Srpaulo } 4469251538Srpaulo} 4470251538Srpaulo 4471251538Srpaulostatic void 4472290048Savosurtwn_set_rx_bssid_all(struct urtwn_softc *sc, int enable) 4473290048Savos{ 4474290048Savos uint32_t reg; 4475290048Savos 4476290048Savos reg = urtwn_read_4(sc, R92C_RCR); 4477290048Savos if (enable) 4478290048Savos reg &= ~R92C_RCR_CBSSID_BCN; 4479290048Savos else 4480290048Savos reg |= R92C_RCR_CBSSID_BCN; 4481290048Savos urtwn_write_4(sc, R92C_RCR, reg); 4482290048Savos} 4483290048Savos 4484290048Savosstatic void 4485290048Savosurtwn_set_gain(struct urtwn_softc *sc, uint8_t gain) 4486290048Savos{ 4487290048Savos uint32_t reg; 4488290048Savos 4489290048Savos reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0)); 4490290048Savos reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, gain); 4491290048Savos urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg); 4492290048Savos 4493290048Savos if (!(sc->chip & URTWN_CHIP_88E)) { 4494290048Savos reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1)); 4495290048Savos reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, gain); 4496290048Savos urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg); 4497290048Savos } 4498290048Savos} 4499290048Savos 4500290048Savosstatic void 4501251538Srpaulourtwn_scan_start(struct ieee80211com *ic) 4502251538Srpaulo{ 4503290048Savos struct urtwn_softc *sc = ic->ic_softc; 4504290048Savos 4505290048Savos URTWN_LOCK(sc); 4506290048Savos /* Receive beacons / probe responses from any BSSID. */ 4507290651Savos if (ic->ic_opmode != IEEE80211_M_IBSS) 4508290651Savos urtwn_set_rx_bssid_all(sc, 1); 4509290651Savos 4510290048Savos /* Set gain for scanning. */ 4511290048Savos urtwn_set_gain(sc, 0x20); 4512290048Savos URTWN_UNLOCK(sc); 4513251538Srpaulo} 4514251538Srpaulo 4515251538Srpaulostatic void 4516251538Srpaulourtwn_scan_end(struct ieee80211com *ic) 4517251538Srpaulo{ 4518290048Savos struct urtwn_softc *sc = ic->ic_softc; 4519290048Savos 4520290048Savos URTWN_LOCK(sc); 4521290048Savos /* Restore limitations. */ 4522290651Savos if (ic->ic_promisc == 0 && ic->ic_opmode != IEEE80211_M_IBSS) 4523290564Savos urtwn_set_rx_bssid_all(sc, 0); 4524290651Savos 4525290048Savos /* Set gain under link. */ 4526290048Savos urtwn_set_gain(sc, 0x32); 4527290048Savos URTWN_UNLOCK(sc); 4528251538Srpaulo} 4529251538Srpaulo 4530251538Srpaulostatic void 4531251538Srpaulourtwn_set_channel(struct ieee80211com *ic) 4532251538Srpaulo{ 4533286949Sadrian struct urtwn_softc *sc = ic->ic_softc; 4534292173Savos struct ieee80211_channel *c = ic->ic_curchan; 4535281070Srpaulo struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 4536251538Srpaulo 4537251538Srpaulo URTWN_LOCK(sc); 4538281070Srpaulo if (vap->iv_state == IEEE80211_S_SCAN) { 4539281070Srpaulo /* Make link LED blink during scan. */ 4540281070Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, !sc->ledlink); 4541281070Srpaulo } 4542292173Savos urtwn_set_chan(sc, c, NULL); 4543292173Savos sc->sc_rxtap.wr_chan_freq = htole16(c->ic_freq); 4544292173Savos sc->sc_rxtap.wr_chan_flags = htole16(c->ic_flags); 4545292173Savos sc->sc_txtap.wt_chan_freq = htole16(c->ic_freq); 4546292173Savos sc->sc_txtap.wt_chan_flags = htole16(c->ic_flags); 4547251538Srpaulo URTWN_UNLOCK(sc); 4548251538Srpaulo} 4549251538Srpaulo 4550292014Savosstatic int 4551292014Savosurtwn_wme_update(struct ieee80211com *ic) 4552292014Savos{ 4553292014Savos const struct wmeParams *wmep = 4554292014Savos ic->ic_wme.wme_chanParams.cap_wmeParams; 4555292014Savos struct urtwn_softc *sc = ic->ic_softc; 4556292014Savos uint8_t aifs, acm, slottime; 4557292014Savos int ac; 4558292014Savos 4559292014Savos acm = 0; 4560292165Savos slottime = IEEE80211_GET_SLOTTIME(ic); 4561292014Savos 4562292014Savos URTWN_LOCK(sc); 4563292014Savos for (ac = WME_AC_BE; ac < WME_NUM_AC; ac++) { 4564292014Savos /* AIFS[AC] = AIFSN[AC] * aSlotTime + aSIFSTime. */ 4565292014Savos aifs = wmep[ac].wmep_aifsn * slottime + IEEE80211_DUR_SIFS; 4566292014Savos urtwn_write_4(sc, wme2queue[ac].reg, 4567292014Savos SM(R92C_EDCA_PARAM_TXOP, wmep[ac].wmep_txopLimit) | 4568292014Savos SM(R92C_EDCA_PARAM_ECWMIN, wmep[ac].wmep_logcwmin) | 4569292014Savos SM(R92C_EDCA_PARAM_ECWMAX, wmep[ac].wmep_logcwmax) | 4570292014Savos SM(R92C_EDCA_PARAM_AIFS, aifs)); 4571292014Savos if (ac != WME_AC_BE) 4572292014Savos acm |= wmep[ac].wmep_acm << ac; 4573292014Savos } 4574292014Savos 4575292014Savos if (acm != 0) 4576292014Savos acm |= R92C_ACMHWCTRL_EN; 4577292014Savos urtwn_write_1(sc, R92C_ACMHWCTRL, 4578292014Savos (urtwn_read_1(sc, R92C_ACMHWCTRL) & ~R92C_ACMHWCTRL_ACM_MASK) | 4579292014Savos acm); 4580292014Savos 4581292014Savos URTWN_UNLOCK(sc); 4582292014Savos 4583292014Savos return 0; 4584292014Savos} 4585292014Savos 4586251538Srpaulostatic void 4587294465Savosurtwn_update_slot(struct ieee80211com *ic) 4588294465Savos{ 4589294465Savos urtwn_cmd_sleepable(ic->ic_softc, NULL, 0, urtwn_update_slot_cb); 4590294465Savos} 4591294465Savos 4592294465Savosstatic void 4593294465Savosurtwn_update_slot_cb(struct urtwn_softc *sc, union sec_param *data) 4594294465Savos{ 4595294465Savos struct ieee80211com *ic = &sc->sc_ic; 4596294465Savos uint8_t slottime; 4597294465Savos 4598294465Savos slottime = IEEE80211_GET_SLOTTIME(ic); 4599294465Savos 4600294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_ANY, "%s: setting slot time to %uus\n", 4601294471Savos __func__, slottime); 4602294465Savos 4603294465Savos urtwn_write_1(sc, R92C_SLOT, slottime); 4604294465Savos urtwn_update_aifs(sc, slottime); 4605294465Savos} 4606294465Savos 4607294465Savosstatic void 4608294465Savosurtwn_update_aifs(struct urtwn_softc *sc, uint8_t slottime) 4609294465Savos{ 4610294465Savos const struct wmeParams *wmep = 4611294465Savos sc->sc_ic.ic_wme.wme_chanParams.cap_wmeParams; 4612294465Savos uint8_t aifs, ac; 4613294465Savos 4614294465Savos for (ac = WME_AC_BE; ac < WME_NUM_AC; ac++) { 4615294465Savos /* AIFS[AC] = AIFSN[AC] * aSlotTime + aSIFSTime. */ 4616294465Savos aifs = wmep[ac].wmep_aifsn * slottime + IEEE80211_DUR_SIFS; 4617294465Savos urtwn_write_1(sc, wme2queue[ac].reg, aifs); 4618294465Savos } 4619294465Savos} 4620294465Savos 4621294465Savosstatic void 4622290564Savosurtwn_set_promisc(struct urtwn_softc *sc) 4623290564Savos{ 4624290564Savos struct ieee80211com *ic = &sc->sc_ic; 4625290564Savos struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 4626290564Savos uint32_t rcr, mask1, mask2; 4627290564Savos 4628290564Savos URTWN_ASSERT_LOCKED(sc); 4629290564Savos 4630290564Savos if (vap->iv_opmode == IEEE80211_M_MONITOR) 4631290564Savos return; 4632290564Savos 4633290564Savos mask1 = R92C_RCR_ACF | R92C_RCR_ADF | R92C_RCR_AMF | R92C_RCR_AAP; 4634290564Savos mask2 = R92C_RCR_APM; 4635290564Savos 4636290564Savos if (vap->iv_state == IEEE80211_S_RUN) { 4637290564Savos switch (vap->iv_opmode) { 4638290564Savos case IEEE80211_M_STA: 4639290631Savos mask2 |= R92C_RCR_CBSSID_DATA; 4640290631Savos /* FALLTHROUGH */ 4641290631Savos case IEEE80211_M_HOSTAP: 4642290631Savos mask2 |= R92C_RCR_CBSSID_BCN; 4643290564Savos break; 4644290651Savos case IEEE80211_M_IBSS: 4645290651Savos mask2 |= R92C_RCR_CBSSID_DATA; 4646290651Savos break; 4647290564Savos default: 4648290564Savos device_printf(sc->sc_dev, "%s: undefined opmode %d\n", 4649290564Savos __func__, vap->iv_opmode); 4650290564Savos return; 4651290564Savos } 4652290564Savos } 4653290564Savos 4654290564Savos rcr = urtwn_read_4(sc, R92C_RCR); 4655290564Savos if (ic->ic_promisc == 0) 4656290564Savos rcr = (rcr & ~mask1) | mask2; 4657290564Savos else 4658290564Savos rcr = (rcr & ~mask2) | mask1; 4659290564Savos urtwn_write_4(sc, R92C_RCR, rcr); 4660290564Savos} 4661290564Savos 4662290564Savosstatic void 4663290564Savosurtwn_update_promisc(struct ieee80211com *ic) 4664290564Savos{ 4665290564Savos struct urtwn_softc *sc = ic->ic_softc; 4666290564Savos 4667290564Savos URTWN_LOCK(sc); 4668290564Savos if (sc->sc_flags & URTWN_RUNNING) 4669290564Savos urtwn_set_promisc(sc); 4670290564Savos URTWN_UNLOCK(sc); 4671290564Savos} 4672290564Savos 4673290564Savosstatic void 4674283540Sglebiusurtwn_update_mcast(struct ieee80211com *ic) 4675251538Srpaulo{ 4676251538Srpaulo /* XXX do nothing? */ 4677251538Srpaulo} 4678251538Srpaulo 4679292167Savosstatic struct ieee80211_node * 4680292167Savosurtwn_r88e_node_alloc(struct ieee80211vap *vap, 4681292167Savos const uint8_t mac[IEEE80211_ADDR_LEN]) 4682292167Savos{ 4683292167Savos struct urtwn_node *un; 4684292167Savos 4685292167Savos un = malloc(sizeof (struct urtwn_node), M_80211_NODE, 4686292167Savos M_NOWAIT | M_ZERO); 4687292167Savos 4688292167Savos if (un == NULL) 4689292167Savos return NULL; 4690292167Savos 4691292167Savos un->id = URTWN_MACID_UNDEFINED; 4692292167Savos 4693292167Savos return &un->ni; 4694292167Savos} 4695292167Savos 4696251538Srpaulostatic void 4697292167Savosurtwn_r88e_newassoc(struct ieee80211_node *ni, int isnew) 4698292167Savos{ 4699292167Savos struct urtwn_softc *sc = ni->ni_ic->ic_softc; 4700292167Savos struct urtwn_node *un = URTWN_NODE(ni); 4701292167Savos uint8_t id; 4702292167Savos 4703292167Savos if (!isnew) 4704292167Savos return; 4705292167Savos 4706292167Savos URTWN_NT_LOCK(sc); 4707292167Savos for (id = 0; id <= URTWN_MACID_MAX(sc); id++) { 4708292167Savos if (id != URTWN_MACID_BC && sc->node_list[id] == NULL) { 4709292167Savos un->id = id; 4710292167Savos sc->node_list[id] = ni; 4711292167Savos break; 4712292167Savos } 4713292167Savos } 4714292167Savos URTWN_NT_UNLOCK(sc); 4715292167Savos 4716292167Savos if (id > URTWN_MACID_MAX(sc)) { 4717292167Savos device_printf(sc->sc_dev, "%s: node table is full\n", 4718292167Savos __func__); 4719292167Savos } 4720292167Savos} 4721292167Savos 4722292167Savosstatic void 4723292167Savosurtwn_r88e_node_free(struct ieee80211_node *ni) 4724292167Savos{ 4725292167Savos struct urtwn_softc *sc = ni->ni_ic->ic_softc; 4726292167Savos struct urtwn_node *un = URTWN_NODE(ni); 4727292167Savos 4728292167Savos URTWN_NT_LOCK(sc); 4729292167Savos if (un->id != URTWN_MACID_UNDEFINED) 4730292167Savos sc->node_list[un->id] = NULL; 4731292167Savos URTWN_NT_UNLOCK(sc); 4732292167Savos 4733292167Savos sc->sc_node_free(ni); 4734292167Savos} 4735292167Savos 4736292167Savosstatic void 4737251538Srpaulourtwn_set_chan(struct urtwn_softc *sc, struct ieee80211_channel *c, 4738251538Srpaulo struct ieee80211_channel *extc) 4739251538Srpaulo{ 4740287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 4741251538Srpaulo uint32_t reg; 4742251538Srpaulo u_int chan; 4743251538Srpaulo int i; 4744251538Srpaulo 4745251538Srpaulo chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */ 4746251538Srpaulo if (chan == 0 || chan == IEEE80211_CHAN_ANY) { 4747251538Srpaulo device_printf(sc->sc_dev, 4748251538Srpaulo "%s: invalid channel %x\n", __func__, chan); 4749251538Srpaulo return; 4750251538Srpaulo } 4751251538Srpaulo 4752251538Srpaulo /* Set Tx power for this new channel. */ 4753251538Srpaulo urtwn_set_txpower(sc, c, extc); 4754251538Srpaulo 4755251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 4756251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_CHNLBW, 4757251538Srpaulo RW(sc->rf_chnlbw[i], R92C_RF_CHNLBW_CHNL, chan)); 4758251538Srpaulo } 4759251538Srpaulo#ifndef IEEE80211_NO_HT 4760251538Srpaulo if (extc != NULL) { 4761251538Srpaulo /* Is secondary channel below or above primary? */ 4762251538Srpaulo int prichlo = c->ic_freq < extc->ic_freq; 4763251538Srpaulo 4764251538Srpaulo urtwn_write_1(sc, R92C_BWOPMODE, 4765251538Srpaulo urtwn_read_1(sc, R92C_BWOPMODE) & ~R92C_BWOPMODE_20MHZ); 4766251538Srpaulo 4767251538Srpaulo reg = urtwn_read_1(sc, R92C_RRSR + 2); 4768251538Srpaulo reg = (reg & ~0x6f) | (prichlo ? 1 : 2) << 5; 4769251538Srpaulo urtwn_write_1(sc, R92C_RRSR + 2, reg); 4770251538Srpaulo 4771251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFMOD, 4772251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_RFMOD) | R92C_RFMOD_40MHZ); 4773251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_RFMOD, 4774251538Srpaulo urtwn_bb_read(sc, R92C_FPGA1_RFMOD) | R92C_RFMOD_40MHZ); 4775251538Srpaulo 4776251538Srpaulo /* Set CCK side band. */ 4777251538Srpaulo reg = urtwn_bb_read(sc, R92C_CCK0_SYSTEM); 4778251538Srpaulo reg = (reg & ~0x00000010) | (prichlo ? 0 : 1) << 4; 4779251538Srpaulo urtwn_bb_write(sc, R92C_CCK0_SYSTEM, reg); 4780251538Srpaulo 4781251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM1_LSTF); 4782251538Srpaulo reg = (reg & ~0x00000c00) | (prichlo ? 1 : 2) << 10; 4783251538Srpaulo urtwn_bb_write(sc, R92C_OFDM1_LSTF, reg); 4784251538Srpaulo 4785251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2, 4786251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) & 4787251538Srpaulo ~R92C_FPGA0_ANAPARAM2_CBW20); 4788251538Srpaulo 4789251538Srpaulo reg = urtwn_bb_read(sc, 0x818); 4790251538Srpaulo reg = (reg & ~0x0c000000) | (prichlo ? 2 : 1) << 26; 4791251538Srpaulo urtwn_bb_write(sc, 0x818, reg); 4792251538Srpaulo 4793251538Srpaulo /* Select 40MHz bandwidth. */ 4794251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 4795251538Srpaulo (sc->rf_chnlbw[0] & ~0xfff) | chan); 4796251538Srpaulo } else 4797251538Srpaulo#endif 4798251538Srpaulo { 4799251538Srpaulo urtwn_write_1(sc, R92C_BWOPMODE, 4800251538Srpaulo urtwn_read_1(sc, R92C_BWOPMODE) | R92C_BWOPMODE_20MHZ); 4801251538Srpaulo 4802251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFMOD, 4803251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_RFMOD) & ~R92C_RFMOD_40MHZ); 4804251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_RFMOD, 4805251538Srpaulo urtwn_bb_read(sc, R92C_FPGA1_RFMOD) & ~R92C_RFMOD_40MHZ); 4806251538Srpaulo 4807264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 4808264912Skevlo urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2, 4809264912Skevlo urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) | 4810264912Skevlo R92C_FPGA0_ANAPARAM2_CBW20); 4811264912Skevlo } 4812281069Srpaulo 4813251538Srpaulo /* Select 20MHz bandwidth. */ 4814251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 4815281069Srpaulo (sc->rf_chnlbw[0] & ~0xfff) | chan | 4816264912Skevlo ((sc->chip & URTWN_CHIP_88E) ? R88E_RF_CHNLBW_BW20 : 4817264912Skevlo R92C_RF_CHNLBW_BW20)); 4818251538Srpaulo } 4819251538Srpaulo} 4820251538Srpaulo 4821251538Srpaulostatic void 4822251538Srpaulourtwn_iq_calib(struct urtwn_softc *sc) 4823251538Srpaulo{ 4824251538Srpaulo /* TODO */ 4825251538Srpaulo} 4826251538Srpaulo 4827251538Srpaulostatic void 4828251538Srpaulourtwn_lc_calib(struct urtwn_softc *sc) 4829251538Srpaulo{ 4830251538Srpaulo uint32_t rf_ac[2]; 4831251538Srpaulo uint8_t txmode; 4832251538Srpaulo int i; 4833251538Srpaulo 4834251538Srpaulo txmode = urtwn_read_1(sc, R92C_OFDM1_LSTF + 3); 4835251538Srpaulo if ((txmode & 0x70) != 0) { 4836251538Srpaulo /* Disable all continuous Tx. */ 4837251538Srpaulo urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode & ~0x70); 4838251538Srpaulo 4839251538Srpaulo /* Set RF mode to standby mode. */ 4840251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 4841251538Srpaulo rf_ac[i] = urtwn_rf_read(sc, i, R92C_RF_AC); 4842251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_AC, 4843251538Srpaulo RW(rf_ac[i], R92C_RF_AC_MODE, 4844251538Srpaulo R92C_RF_AC_MODE_STANDBY)); 4845251538Srpaulo } 4846251538Srpaulo } else { 4847251538Srpaulo /* Block all Tx queues. */ 4848293180Savos urtwn_write_1(sc, R92C_TXPAUSE, R92C_TX_QUEUE_ALL); 4849251538Srpaulo } 4850251538Srpaulo /* Start calibration. */ 4851251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 4852251538Srpaulo urtwn_rf_read(sc, 0, R92C_RF_CHNLBW) | R92C_RF_CHNLBW_LCSTART); 4853251538Srpaulo 4854251538Srpaulo /* Give calibration the time to complete. */ 4855266472Shselasky usb_pause_mtx(&sc->sc_mtx, hz / 10); /* 100ms */ 4856251538Srpaulo 4857251538Srpaulo /* Restore configuration. */ 4858251538Srpaulo if ((txmode & 0x70) != 0) { 4859251538Srpaulo /* Restore Tx mode. */ 4860251538Srpaulo urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode); 4861251538Srpaulo /* Restore RF mode. */ 4862251538Srpaulo for (i = 0; i < sc->nrxchains; i++) 4863251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_AC, rf_ac[i]); 4864251538Srpaulo } else { 4865251538Srpaulo /* Unblock all Tx queues. */ 4866251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 0x00); 4867251538Srpaulo } 4868251538Srpaulo} 4869251538Srpaulo 4870294473Savosstatic void 4871294473Savosurtwn_temp_calib(struct urtwn_softc *sc) 4872294473Savos{ 4873294473Savos uint8_t temp; 4874294473Savos 4875294473Savos URTWN_ASSERT_LOCKED(sc); 4876294473Savos 4877294473Savos if (!(sc->sc_flags & URTWN_TEMP_MEASURED)) { 4878294473Savos /* Start measuring temperature. */ 4879294473Savos URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP, 4880294473Savos "%s: start measuring temperature\n", __func__); 4881294473Savos if (sc->chip & URTWN_CHIP_88E) { 4882294473Savos urtwn_rf_write(sc, 0, R88E_RF_T_METER, 4883294473Savos R88E_RF_T_METER_START); 4884294473Savos } else { 4885294473Savos urtwn_rf_write(sc, 0, R92C_RF_T_METER, 4886294473Savos R92C_RF_T_METER_START); 4887294473Savos } 4888294473Savos sc->sc_flags |= URTWN_TEMP_MEASURED; 4889294473Savos return; 4890294473Savos } 4891294473Savos sc->sc_flags &= ~URTWN_TEMP_MEASURED; 4892294473Savos 4893294473Savos /* Read measured temperature. */ 4894294473Savos if (sc->chip & URTWN_CHIP_88E) { 4895294473Savos temp = MS(urtwn_rf_read(sc, 0, R88E_RF_T_METER), 4896294473Savos R88E_RF_T_METER_VAL); 4897294473Savos } else { 4898294473Savos temp = MS(urtwn_rf_read(sc, 0, R92C_RF_T_METER), 4899294473Savos R92C_RF_T_METER_VAL); 4900294473Savos } 4901294473Savos if (temp == 0) { /* Read failed, skip. */ 4902294473Savos URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP, 4903294473Savos "%s: temperature read failed, skipping\n", __func__); 4904294473Savos return; 4905294473Savos } 4906294473Savos 4907294473Savos URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP, 4908294473Savos "%s: temperature: previous %u, current %u\n", 4909294473Savos __func__, sc->thcal_lctemp, temp); 4910294473Savos 4911294473Savos /* 4912294473Savos * Redo LC calibration if temperature changed significantly since 4913294473Savos * last calibration. 4914294473Savos */ 4915294473Savos if (sc->thcal_lctemp == 0) { 4916294473Savos /* First LC calibration is performed in urtwn_init(). */ 4917294473Savos sc->thcal_lctemp = temp; 4918294473Savos } else if (abs(temp - sc->thcal_lctemp) > 1) { 4919294473Savos URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP, 4920294473Savos "%s: LC calib triggered by temp: %u -> %u\n", 4921294473Savos __func__, sc->thcal_lctemp, temp); 4922294473Savos urtwn_lc_calib(sc); 4923294473Savos /* Record temperature of last LC calibration. */ 4924294473Savos sc->thcal_lctemp = temp; 4925294473Savos } 4926294473Savos} 4927294473Savos 4928291698Savosstatic int 4929287197Sglebiusurtwn_init(struct urtwn_softc *sc) 4930251538Srpaulo{ 4931287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 4932287197Sglebius struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 4933287197Sglebius uint8_t macaddr[IEEE80211_ADDR_LEN]; 4934251538Srpaulo uint32_t reg; 4935291698Savos usb_error_t usb_err = USB_ERR_NORMAL_COMPLETION; 4936251538Srpaulo int error; 4937251538Srpaulo 4938291698Savos URTWN_LOCK(sc); 4939291698Savos if (sc->sc_flags & URTWN_RUNNING) { 4940291698Savos URTWN_UNLOCK(sc); 4941291698Savos return (0); 4942291698Savos } 4943264864Skevlo 4944251538Srpaulo /* Init firmware commands ring. */ 4945251538Srpaulo sc->fwcur = 0; 4946251538Srpaulo 4947251538Srpaulo /* Allocate Tx/Rx buffers. */ 4948251538Srpaulo error = urtwn_alloc_rx_list(sc); 4949251538Srpaulo if (error != 0) 4950251538Srpaulo goto fail; 4951281069Srpaulo 4952251538Srpaulo error = urtwn_alloc_tx_list(sc); 4953251538Srpaulo if (error != 0) 4954251538Srpaulo goto fail; 4955251538Srpaulo 4956251538Srpaulo /* Power on adapter. */ 4957251538Srpaulo error = urtwn_power_on(sc); 4958251538Srpaulo if (error != 0) 4959251538Srpaulo goto fail; 4960251538Srpaulo 4961251538Srpaulo /* Initialize DMA. */ 4962251538Srpaulo error = urtwn_dma_init(sc); 4963251538Srpaulo if (error != 0) 4964251538Srpaulo goto fail; 4965251538Srpaulo 4966251538Srpaulo /* Set info size in Rx descriptors (in 64-bit words). */ 4967251538Srpaulo urtwn_write_1(sc, R92C_RX_DRVINFO_SZ, 4); 4968251538Srpaulo 4969251538Srpaulo /* Init interrupts. */ 4970264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 4971291698Savos usb_err = urtwn_write_4(sc, R88E_HISR, 0xffffffff); 4972291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4973291698Savos goto fail; 4974291698Savos usb_err = urtwn_write_4(sc, R88E_HIMR, R88E_HIMR_CPWM | R88E_HIMR_CPWM2 | 4975264912Skevlo R88E_HIMR_TBDER | R88E_HIMR_PSTIMEOUT); 4976291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4977291698Savos goto fail; 4978291698Savos usb_err = urtwn_write_4(sc, R88E_HIMRE, R88E_HIMRE_RXFOVW | 4979264912Skevlo R88E_HIMRE_TXFOVW | R88E_HIMRE_RXERR | R88E_HIMRE_TXERR); 4980291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4981291698Savos goto fail; 4982291698Savos usb_err = urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION, 4983264912Skevlo urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) | 4984264912Skevlo R92C_USB_SPECIAL_OPTION_INT_BULK_SEL); 4985291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4986291698Savos goto fail; 4987264912Skevlo } else { 4988291698Savos usb_err = urtwn_write_4(sc, R92C_HISR, 0xffffffff); 4989291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4990291698Savos goto fail; 4991291698Savos usb_err = urtwn_write_4(sc, R92C_HIMR, 0xffffffff); 4992291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4993291698Savos goto fail; 4994264912Skevlo } 4995251538Srpaulo 4996251538Srpaulo /* Set MAC address. */ 4997287197Sglebius IEEE80211_ADDR_COPY(macaddr, vap ? vap->iv_myaddr : ic->ic_macaddr); 4998291698Savos usb_err = urtwn_write_region_1(sc, R92C_MACID, macaddr, IEEE80211_ADDR_LEN); 4999291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 5000291698Savos goto fail; 5001251538Srpaulo 5002251538Srpaulo /* Set initial network type. */ 5003289811Savos urtwn_set_mode(sc, R92C_MSR_INFRA); 5004251538Srpaulo 5005290564Savos /* Initialize Rx filter. */ 5006251538Srpaulo urtwn_rxfilter_init(sc); 5007251538Srpaulo 5008282623Skevlo /* Set response rate. */ 5009251538Srpaulo reg = urtwn_read_4(sc, R92C_RRSR); 5010251538Srpaulo reg = RW(reg, R92C_RRSR_RATE_BITMAP, R92C_RRSR_RATE_CCK_ONLY_1M); 5011251538Srpaulo urtwn_write_4(sc, R92C_RRSR, reg); 5012251538Srpaulo 5013251538Srpaulo /* Set short/long retry limits. */ 5014251538Srpaulo urtwn_write_2(sc, R92C_RL, 5015251538Srpaulo SM(R92C_RL_SRL, 0x30) | SM(R92C_RL_LRL, 0x30)); 5016251538Srpaulo 5017251538Srpaulo /* Initialize EDCA parameters. */ 5018251538Srpaulo urtwn_edca_init(sc); 5019251538Srpaulo 5020251538Srpaulo /* Setup rate fallback. */ 5021264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 5022264912Skevlo urtwn_write_4(sc, R92C_DARFRC + 0, 0x00000000); 5023264912Skevlo urtwn_write_4(sc, R92C_DARFRC + 4, 0x10080404); 5024264912Skevlo urtwn_write_4(sc, R92C_RARFRC + 0, 0x04030201); 5025264912Skevlo urtwn_write_4(sc, R92C_RARFRC + 4, 0x08070605); 5026264912Skevlo } 5027251538Srpaulo 5028251538Srpaulo urtwn_write_1(sc, R92C_FWHW_TXQ_CTRL, 5029251538Srpaulo urtwn_read_1(sc, R92C_FWHW_TXQ_CTRL) | 5030251538Srpaulo R92C_FWHW_TXQ_CTRL_AMPDU_RTY_NEW); 5031251538Srpaulo /* Set ACK timeout. */ 5032251538Srpaulo urtwn_write_1(sc, R92C_ACKTO, 0x40); 5033251538Srpaulo 5034251538Srpaulo /* Setup USB aggregation. */ 5035251538Srpaulo reg = urtwn_read_4(sc, R92C_TDECTRL); 5036251538Srpaulo reg = RW(reg, R92C_TDECTRL_BLK_DESC_NUM, 6); 5037251538Srpaulo urtwn_write_4(sc, R92C_TDECTRL, reg); 5038251538Srpaulo urtwn_write_1(sc, R92C_TRXDMA_CTRL, 5039251538Srpaulo urtwn_read_1(sc, R92C_TRXDMA_CTRL) | 5040251538Srpaulo R92C_TRXDMA_CTRL_RXDMA_AGG_EN); 5041251538Srpaulo urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH, 48); 5042264912Skevlo if (sc->chip & URTWN_CHIP_88E) 5043264912Skevlo urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH + 1, 4); 5044282266Skevlo else { 5045264912Skevlo urtwn_write_1(sc, R92C_USB_DMA_AGG_TO, 4); 5046282266Skevlo urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION, 5047282266Skevlo urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) | 5048282266Skevlo R92C_USB_SPECIAL_OPTION_AGG_EN); 5049282266Skevlo urtwn_write_1(sc, R92C_USB_AGG_TH, 8); 5050282266Skevlo urtwn_write_1(sc, R92C_USB_AGG_TO, 6); 5051282266Skevlo } 5052251538Srpaulo 5053251538Srpaulo /* Initialize beacon parameters. */ 5054264912Skevlo urtwn_write_2(sc, R92C_BCN_CTRL, 0x1010); 5055251538Srpaulo urtwn_write_2(sc, R92C_TBTT_PROHIBIT, 0x6404); 5056251538Srpaulo urtwn_write_1(sc, R92C_DRVERLYINT, 0x05); 5057251538Srpaulo urtwn_write_1(sc, R92C_BCNDMATIM, 0x02); 5058251538Srpaulo urtwn_write_2(sc, R92C_BCNTCFG, 0x660f); 5059251538Srpaulo 5060264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 5061264912Skevlo /* Setup AMPDU aggregation. */ 5062264912Skevlo urtwn_write_4(sc, R92C_AGGLEN_LMT, 0x99997631); /* MCS7~0 */ 5063264912Skevlo urtwn_write_1(sc, R92C_AGGR_BREAK_TIME, 0x16); 5064264912Skevlo urtwn_write_2(sc, R92C_MAX_AGGR_NUM, 0x0708); 5065251538Srpaulo 5066264912Skevlo urtwn_write_1(sc, R92C_BCN_MAX_ERR, 0xff); 5067264912Skevlo } 5068251538Srpaulo 5069295871Savos#ifndef URTWN_WITHOUT_UCODE 5070251538Srpaulo /* Load 8051 microcode. */ 5071251538Srpaulo error = urtwn_load_firmware(sc); 5072295871Savos if (error == 0) 5073295871Savos sc->sc_flags |= URTWN_FW_LOADED; 5074295871Savos#endif 5075251538Srpaulo 5076251538Srpaulo /* Initialize MAC/BB/RF blocks. */ 5077291698Savos error = urtwn_mac_init(sc); 5078291698Savos if (error != 0) { 5079291698Savos device_printf(sc->sc_dev, 5080291698Savos "%s: error while initializing MAC block\n", __func__); 5081291698Savos goto fail; 5082291698Savos } 5083251538Srpaulo urtwn_bb_init(sc); 5084251538Srpaulo urtwn_rf_init(sc); 5085251538Srpaulo 5086290564Savos /* Reinitialize Rx filter (D3845 is not committed yet). */ 5087290564Savos urtwn_rxfilter_init(sc); 5088290564Savos 5089264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 5090264912Skevlo urtwn_write_2(sc, R92C_CR, 5091264912Skevlo urtwn_read_2(sc, R92C_CR) | R92C_CR_MACTXEN | 5092264912Skevlo R92C_CR_MACRXEN); 5093264912Skevlo } 5094264912Skevlo 5095251538Srpaulo /* Turn CCK and OFDM blocks on. */ 5096251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD); 5097251538Srpaulo reg |= R92C_RFMOD_CCK_EN; 5098291698Savos usb_err = urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg); 5099291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 5100291698Savos goto fail; 5101251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD); 5102251538Srpaulo reg |= R92C_RFMOD_OFDM_EN; 5103291698Savos usb_err = urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg); 5104291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 5105291698Savos goto fail; 5106251538Srpaulo 5107251538Srpaulo /* Clear per-station keys table. */ 5108251538Srpaulo urtwn_cam_init(sc); 5109251538Srpaulo 5110292175Savos /* Enable decryption / encryption. */ 5111292175Savos urtwn_write_2(sc, R92C_SECCFG, 5112292175Savos R92C_SECCFG_TXUCKEY_DEF | R92C_SECCFG_RXUCKEY_DEF | 5113292175Savos R92C_SECCFG_TXENC_ENA | R92C_SECCFG_RXDEC_ENA | 5114292175Savos R92C_SECCFG_TXBCKEY_DEF | R92C_SECCFG_RXBCKEY_DEF); 5115292175Savos 5116292175Savos /* 5117292175Savos * Install static keys (if any). 5118292175Savos * Must be called after urtwn_cam_init(). 5119292175Savos */ 5120292175Savos ieee80211_runtask(ic, &sc->cmdq_task); 5121292175Savos 5122251538Srpaulo /* Enable hardware sequence numbering. */ 5123293180Savos urtwn_write_1(sc, R92C_HWSEQ_CTRL, R92C_TX_QUEUE_ALL); 5124251538Srpaulo 5125292167Savos /* Enable per-packet TX report. */ 5126292167Savos if (sc->chip & URTWN_CHIP_88E) { 5127292167Savos urtwn_write_1(sc, R88E_TX_RPT_CTRL, 5128292167Savos urtwn_read_1(sc, R88E_TX_RPT_CTRL) | R88E_TX_RPT1_ENA); 5129292167Savos } 5130292167Savos 5131251538Srpaulo /* Perform LO and IQ calibrations. */ 5132251538Srpaulo urtwn_iq_calib(sc); 5133251538Srpaulo /* Perform LC calibration. */ 5134251538Srpaulo urtwn_lc_calib(sc); 5135251538Srpaulo 5136251538Srpaulo /* Fix USB interference issue. */ 5137264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 5138264912Skevlo urtwn_write_1(sc, 0xfe40, 0xe0); 5139264912Skevlo urtwn_write_1(sc, 0xfe41, 0x8d); 5140264912Skevlo urtwn_write_1(sc, 0xfe42, 0x80); 5141251538Srpaulo 5142264912Skevlo urtwn_pa_bias_init(sc); 5143264912Skevlo } 5144251538Srpaulo 5145251538Srpaulo /* Initialize GPIO setting. */ 5146251538Srpaulo urtwn_write_1(sc, R92C_GPIO_MUXCFG, 5147251538Srpaulo urtwn_read_1(sc, R92C_GPIO_MUXCFG) & ~R92C_GPIO_MUXCFG_ENBT); 5148251538Srpaulo 5149251538Srpaulo /* Fix for lower temperature. */ 5150264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) 5151264912Skevlo urtwn_write_1(sc, 0x15, 0xe9); 5152251538Srpaulo 5153251538Srpaulo usbd_transfer_start(sc->sc_xfer[URTWN_BULK_RX]); 5154251538Srpaulo 5155287197Sglebius sc->sc_flags |= URTWN_RUNNING; 5156251538Srpaulo 5157251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 5158251538Srpaulofail: 5159291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 5160291698Savos error = EIO; 5161291698Savos 5162291698Savos URTWN_UNLOCK(sc); 5163291698Savos 5164291698Savos return (error); 5165251538Srpaulo} 5166251538Srpaulo 5167251538Srpaulostatic void 5168287197Sglebiusurtwn_stop(struct urtwn_softc *sc) 5169251538Srpaulo{ 5170251538Srpaulo 5171291698Savos URTWN_LOCK(sc); 5172291698Savos if (!(sc->sc_flags & URTWN_RUNNING)) { 5173291698Savos URTWN_UNLOCK(sc); 5174291698Savos return; 5175291698Savos } 5176291698Savos 5177295871Savos sc->sc_flags &= ~(URTWN_RUNNING | URTWN_FW_LOADED | 5178295871Savos URTWN_TEMP_MEASURED); 5179294473Savos sc->thcal_lctemp = 0; 5180251538Srpaulo callout_stop(&sc->sc_watchdog_ch); 5181295874Savos 5182251538Srpaulo urtwn_abort_xfers(sc); 5183288353Sadrian urtwn_drain_mbufq(sc); 5184295874Savos urtwn_power_off(sc); 5185291698Savos URTWN_UNLOCK(sc); 5186251538Srpaulo} 5187251538Srpaulo 5188251538Srpaulostatic void 5189251538Srpaulourtwn_abort_xfers(struct urtwn_softc *sc) 5190251538Srpaulo{ 5191251538Srpaulo int i; 5192251538Srpaulo 5193251538Srpaulo URTWN_ASSERT_LOCKED(sc); 5194251538Srpaulo 5195251538Srpaulo /* abort any pending transfers */ 5196251538Srpaulo for (i = 0; i < URTWN_N_TRANSFER; i++) 5197251538Srpaulo usbd_transfer_stop(sc->sc_xfer[i]); 5198251538Srpaulo} 5199251538Srpaulo 5200251538Srpaulostatic int 5201251538Srpaulourtwn_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 5202251538Srpaulo const struct ieee80211_bpf_params *params) 5203251538Srpaulo{ 5204251538Srpaulo struct ieee80211com *ic = ni->ni_ic; 5205286949Sadrian struct urtwn_softc *sc = ic->ic_softc; 5206251538Srpaulo struct urtwn_data *bf; 5207290630Savos int error; 5208251538Srpaulo 5209251538Srpaulo /* prevent management frames from being sent if we're not ready */ 5210290630Savos URTWN_LOCK(sc); 5211287197Sglebius if (!(sc->sc_flags & URTWN_RUNNING)) { 5212290630Savos error = ENETDOWN; 5213290630Savos goto end; 5214251538Srpaulo } 5215290630Savos 5216251538Srpaulo bf = urtwn_getbuf(sc); 5217251538Srpaulo if (bf == NULL) { 5218290630Savos error = ENOBUFS; 5219290630Savos goto end; 5220251538Srpaulo } 5221251538Srpaulo 5222292221Savos if (params == NULL) { 5223292221Savos /* 5224292221Savos * Legacy path; interpret frame contents to decide 5225292221Savos * precisely how to send the frame. 5226292221Savos */ 5227292221Savos error = urtwn_tx_data(sc, ni, m, bf); 5228292221Savos } else { 5229292221Savos /* 5230292221Savos * Caller supplied explicit parameters to use in 5231292221Savos * sending the frame. 5232292221Savos */ 5233292221Savos error = urtwn_tx_raw(sc, ni, m, bf, params); 5234292221Savos } 5235292221Savos if (error != 0) { 5236251538Srpaulo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 5237290630Savos goto end; 5238251538Srpaulo } 5239290630Savos 5240288353Sadrian sc->sc_txtimer = 5; 5241290630Savos callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 5242290630Savos 5243290630Savosend: 5244290630Savos if (error != 0) 5245290630Savos m_freem(m); 5246290630Savos 5247251538Srpaulo URTWN_UNLOCK(sc); 5248251538Srpaulo 5249290630Savos return (error); 5250251538Srpaulo} 5251251538Srpaulo 5252266472Shselaskystatic void 5253266472Shselaskyurtwn_ms_delay(struct urtwn_softc *sc) 5254266472Shselasky{ 5255266472Shselasky usb_pause_mtx(&sc->sc_mtx, hz / 1000); 5256266472Shselasky} 5257266472Shselasky 5258251538Srpaulostatic device_method_t urtwn_methods[] = { 5259251538Srpaulo /* Device interface */ 5260251538Srpaulo DEVMETHOD(device_probe, urtwn_match), 5261251538Srpaulo DEVMETHOD(device_attach, urtwn_attach), 5262251538Srpaulo DEVMETHOD(device_detach, urtwn_detach), 5263251538Srpaulo 5264264912Skevlo DEVMETHOD_END 5265251538Srpaulo}; 5266251538Srpaulo 5267251538Srpaulostatic driver_t urtwn_driver = { 5268251538Srpaulo "urtwn", 5269251538Srpaulo urtwn_methods, 5270251538Srpaulo sizeof(struct urtwn_softc) 5271251538Srpaulo}; 5272251538Srpaulo 5273251538Srpaulostatic devclass_t urtwn_devclass; 5274251538Srpaulo 5275251538SrpauloDRIVER_MODULE(urtwn, uhub, urtwn_driver, urtwn_devclass, NULL, NULL); 5276251538SrpauloMODULE_DEPEND(urtwn, usb, 1, 1, 1); 5277251538SrpauloMODULE_DEPEND(urtwn, wlan, 1, 1, 1); 5278295871Savos#ifndef URTWN_WITHOUT_UCODE 5279251538SrpauloMODULE_DEPEND(urtwn, firmware, 1, 1, 1); 5280295871Savos#endif 5281251538SrpauloMODULE_VERSION(urtwn, 1); 5282292080SimpUSB_PNP_HOST_INFO(urtwn_devs); 5283