if_urtwn.c revision 294465
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 294465 2016-01-20 23:01:33Z avos $"); 23251538Srpaulo 24251538Srpaulo/* 25264912Skevlo * Driver for Realtek RTL8188CE-VAU/RTL8188CUS/RTL8188EU/RTL8188RU/RTL8192CU. 26251538Srpaulo */ 27251538Srpaulo 28288353Sadrian#include "opt_wlan.h" 29288353Sadrian 30251538Srpaulo#include <sys/param.h> 31251538Srpaulo#include <sys/sockio.h> 32251538Srpaulo#include <sys/sysctl.h> 33251538Srpaulo#include <sys/lock.h> 34251538Srpaulo#include <sys/mutex.h> 35291902Skevlo#include <sys/condvar.h> 36251538Srpaulo#include <sys/mbuf.h> 37251538Srpaulo#include <sys/kernel.h> 38251538Srpaulo#include <sys/socket.h> 39251538Srpaulo#include <sys/systm.h> 40251538Srpaulo#include <sys/malloc.h> 41251538Srpaulo#include <sys/module.h> 42251538Srpaulo#include <sys/bus.h> 43251538Srpaulo#include <sys/endian.h> 44251538Srpaulo#include <sys/linker.h> 45251538Srpaulo#include <sys/firmware.h> 46251538Srpaulo#include <sys/kdb.h> 47251538Srpaulo 48251538Srpaulo#include <machine/bus.h> 49251538Srpaulo#include <machine/resource.h> 50251538Srpaulo#include <sys/rman.h> 51251538Srpaulo 52251538Srpaulo#include <net/bpf.h> 53251538Srpaulo#include <net/if.h> 54257176Sglebius#include <net/if_var.h> 55251538Srpaulo#include <net/if_arp.h> 56251538Srpaulo#include <net/ethernet.h> 57251538Srpaulo#include <net/if_dl.h> 58251538Srpaulo#include <net/if_media.h> 59251538Srpaulo#include <net/if_types.h> 60251538Srpaulo 61251538Srpaulo#include <netinet/in.h> 62251538Srpaulo#include <netinet/in_systm.h> 63251538Srpaulo#include <netinet/in_var.h> 64251538Srpaulo#include <netinet/if_ether.h> 65251538Srpaulo#include <netinet/ip.h> 66251538Srpaulo 67251538Srpaulo#include <net80211/ieee80211_var.h> 68288088Sadrian#include <net80211/ieee80211_input.h> 69251538Srpaulo#include <net80211/ieee80211_regdomain.h> 70251538Srpaulo#include <net80211/ieee80211_radiotap.h> 71251538Srpaulo#include <net80211/ieee80211_ratectl.h> 72251538Srpaulo 73251538Srpaulo#include <dev/usb/usb.h> 74251538Srpaulo#include <dev/usb/usbdi.h> 75291902Skevlo#include <dev/usb/usb_device.h> 76251538Srpaulo#include "usbdevs.h" 77251538Srpaulo 78251538Srpaulo#define USB_DEBUG_VAR urtwn_debug 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 85251538Srpaulostatic int urtwn_debug = 0; 86251538Srpaulo 87251538SrpauloSYSCTL_NODE(_hw_usb, OID_AUTO, urtwn, CTLFLAG_RW, 0, "USB urtwn"); 88276701ShselaskySYSCTL_INT(_hw_usb_urtwn, OID_AUTO, debug, CTLFLAG_RWTUN, &urtwn_debug, 0, 89251538Srpaulo "Debug level"); 90251538Srpaulo#endif 91251538Srpaulo 92288088Sadrian#define IEEE80211_HAS_ADDR4(wh) IEEE80211_IS_DSTODS(wh) 93251538Srpaulo 94251538Srpaulo/* various supported device vendors/products */ 95251596Srpaulostatic const STRUCT_USB_HOST_ID urtwn_devs[] = { 96251538Srpaulo#define URTWN_DEV(v,p) { USB_VP(USB_VENDOR_##v, USB_PRODUCT_##v##_##p) } 97264912Skevlo#define URTWN_RTL8188E_DEV(v,p) \ 98264912Skevlo { USB_VPI(USB_VENDOR_##v, USB_PRODUCT_##v##_##p, URTWN_RTL8188E) } 99264912Skevlo#define URTWN_RTL8188E 1 100251538Srpaulo URTWN_DEV(ABOCOM, RTL8188CU_1), 101251538Srpaulo URTWN_DEV(ABOCOM, RTL8188CU_2), 102251538Srpaulo URTWN_DEV(ABOCOM, RTL8192CU), 103251538Srpaulo URTWN_DEV(ASUS, RTL8192CU), 104266721Skevlo URTWN_DEV(ASUS, USBN10NANO), 105251538Srpaulo URTWN_DEV(AZUREWAVE, RTL8188CE_1), 106251538Srpaulo URTWN_DEV(AZUREWAVE, RTL8188CE_2), 107251538Srpaulo URTWN_DEV(AZUREWAVE, RTL8188CU), 108251538Srpaulo URTWN_DEV(BELKIN, F7D2102), 109251538Srpaulo URTWN_DEV(BELKIN, RTL8188CU), 110251538Srpaulo URTWN_DEV(BELKIN, RTL8192CU), 111251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_1), 112251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_2), 113251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_3), 114251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_4), 115251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_5), 116251538Srpaulo URTWN_DEV(COREGA, RTL8192CU), 117251538Srpaulo URTWN_DEV(DLINK, RTL8188CU), 118251538Srpaulo URTWN_DEV(DLINK, RTL8192CU_1), 119251538Srpaulo URTWN_DEV(DLINK, RTL8192CU_2), 120251538Srpaulo URTWN_DEV(DLINK, RTL8192CU_3), 121252196Skevlo URTWN_DEV(DLINK, DWA131B), 122251538Srpaulo URTWN_DEV(EDIMAX, EW7811UN), 123251538Srpaulo URTWN_DEV(EDIMAX, RTL8192CU), 124251538Srpaulo URTWN_DEV(FEIXUN, RTL8188CU), 125251538Srpaulo URTWN_DEV(FEIXUN, RTL8192CU), 126251538Srpaulo URTWN_DEV(GUILLEMOT, HWNUP150), 127251538Srpaulo URTWN_DEV(HAWKING, RTL8192CU), 128251538Srpaulo URTWN_DEV(HP3, RTL8188CU), 129251538Srpaulo URTWN_DEV(NETGEAR, WNA1000M), 130251538Srpaulo URTWN_DEV(NETGEAR, RTL8192CU), 131251538Srpaulo URTWN_DEV(NETGEAR4, RTL8188CU), 132251538Srpaulo URTWN_DEV(NOVATECH, RTL8188CU), 133251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CU_1), 134251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CU_2), 135251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CU_3), 136251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CU_4), 137251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CUS), 138251538Srpaulo URTWN_DEV(PLANEX2, RTL8192CU), 139251538Srpaulo URTWN_DEV(REALTEK, RTL8188CE_0), 140251538Srpaulo URTWN_DEV(REALTEK, RTL8188CE_1), 141251538Srpaulo URTWN_DEV(REALTEK, RTL8188CTV), 142251538Srpaulo URTWN_DEV(REALTEK, RTL8188CU_0), 143251538Srpaulo URTWN_DEV(REALTEK, RTL8188CU_1), 144251538Srpaulo URTWN_DEV(REALTEK, RTL8188CU_2), 145282119Skevlo URTWN_DEV(REALTEK, RTL8188CU_3), 146251538Srpaulo URTWN_DEV(REALTEK, RTL8188CU_COMBO), 147251538Srpaulo URTWN_DEV(REALTEK, RTL8188CUS), 148251538Srpaulo URTWN_DEV(REALTEK, RTL8188RU_1), 149251538Srpaulo URTWN_DEV(REALTEK, RTL8188RU_2), 150272410Shselasky URTWN_DEV(REALTEK, RTL8188RU_3), 151251538Srpaulo URTWN_DEV(REALTEK, RTL8191CU), 152251538Srpaulo URTWN_DEV(REALTEK, RTL8192CE), 153251538Srpaulo URTWN_DEV(REALTEK, RTL8192CU), 154251538Srpaulo URTWN_DEV(SITECOMEU, RTL8188CU_1), 155251538Srpaulo URTWN_DEV(SITECOMEU, RTL8188CU_2), 156251538Srpaulo URTWN_DEV(SITECOMEU, RTL8192CU), 157251538Srpaulo URTWN_DEV(TRENDNET, RTL8188CU), 158251538Srpaulo URTWN_DEV(TRENDNET, RTL8192CU), 159251538Srpaulo URTWN_DEV(ZYXEL, RTL8192CU), 160264912Skevlo /* URTWN_RTL8188E */ 161273589Skevlo URTWN_RTL8188E_DEV(DLINK, DWA123D1), 162270191Skevlo URTWN_RTL8188E_DEV(DLINK, DWA125D1), 163273589Skevlo URTWN_RTL8188E_DEV(ELECOM, WDC150SU2M), 164264912Skevlo URTWN_RTL8188E_DEV(REALTEK, RTL8188ETV), 165264912Skevlo URTWN_RTL8188E_DEV(REALTEK, RTL8188EU), 166264912Skevlo#undef URTWN_RTL8188E_DEV 167251538Srpaulo#undef URTWN_DEV 168251538Srpaulo}; 169251538Srpaulo 170251538Srpaulostatic device_probe_t urtwn_match; 171251538Srpaulostatic device_attach_t urtwn_attach; 172251538Srpaulostatic device_detach_t urtwn_detach; 173251538Srpaulo 174251538Srpaulostatic usb_callback_t urtwn_bulk_tx_callback; 175251538Srpaulostatic usb_callback_t urtwn_bulk_rx_callback; 176251538Srpaulo 177288353Sadrianstatic void urtwn_drain_mbufq(struct urtwn_softc *sc); 178287197Sglebiusstatic usb_error_t urtwn_do_request(struct urtwn_softc *, 179287197Sglebius struct usb_device_request *, void *); 180251538Srpaulostatic struct ieee80211vap *urtwn_vap_create(struct ieee80211com *, 181251538Srpaulo const char [IFNAMSIZ], int, enum ieee80211_opmode, int, 182251538Srpaulo const uint8_t [IEEE80211_ADDR_LEN], 183251538Srpaulo const uint8_t [IEEE80211_ADDR_LEN]); 184251538Srpaulostatic void urtwn_vap_delete(struct ieee80211vap *); 185292207Savosstatic struct mbuf * urtwn_rx_copy_to_mbuf(struct urtwn_softc *, 186292207Savos struct r92c_rx_stat *, int); 187292207Savosstatic struct mbuf * urtwn_report_intr(struct usb_xfer *, 188292207Savos struct urtwn_data *); 189292207Savosstatic struct mbuf * urtwn_rxeof(struct urtwn_softc *, uint8_t *, int); 190292167Savosstatic void urtwn_r88e_ratectl_tx_complete(struct urtwn_softc *, 191292167Savos void *); 192292207Savosstatic struct ieee80211_node *urtwn_rx_frame(struct urtwn_softc *, 193292207Savos struct mbuf *, int8_t *); 194289891Savosstatic void urtwn_txeof(struct urtwn_softc *, struct urtwn_data *, 195289891Savos int); 196281069Srpaulostatic int urtwn_alloc_list(struct urtwn_softc *, 197251538Srpaulo struct urtwn_data[], int, int); 198251538Srpaulostatic int urtwn_alloc_rx_list(struct urtwn_softc *); 199251538Srpaulostatic int urtwn_alloc_tx_list(struct urtwn_softc *); 200251538Srpaulostatic void urtwn_free_list(struct urtwn_softc *, 201251538Srpaulo struct urtwn_data data[], int); 202289066Skevlostatic void urtwn_free_rx_list(struct urtwn_softc *); 203289066Skevlostatic void urtwn_free_tx_list(struct urtwn_softc *); 204251538Srpaulostatic struct urtwn_data * _urtwn_getbuf(struct urtwn_softc *); 205251538Srpaulostatic struct urtwn_data * urtwn_getbuf(struct urtwn_softc *); 206291698Savosstatic usb_error_t urtwn_write_region_1(struct urtwn_softc *, uint16_t, 207251538Srpaulo uint8_t *, int); 208291698Savosstatic usb_error_t urtwn_write_1(struct urtwn_softc *, uint16_t, uint8_t); 209291698Savosstatic usb_error_t urtwn_write_2(struct urtwn_softc *, uint16_t, uint16_t); 210291698Savosstatic usb_error_t urtwn_write_4(struct urtwn_softc *, uint16_t, uint32_t); 211291698Savosstatic usb_error_t urtwn_read_region_1(struct urtwn_softc *, uint16_t, 212251538Srpaulo uint8_t *, int); 213251538Srpaulostatic uint8_t urtwn_read_1(struct urtwn_softc *, uint16_t); 214251538Srpaulostatic uint16_t urtwn_read_2(struct urtwn_softc *, uint16_t); 215251538Srpaulostatic uint32_t urtwn_read_4(struct urtwn_softc *, uint16_t); 216281069Srpaulostatic int urtwn_fw_cmd(struct urtwn_softc *, uint8_t, 217251538Srpaulo const void *, int); 218292174Savosstatic void urtwn_cmdq_cb(void *, int); 219292174Savosstatic int urtwn_cmd_sleepable(struct urtwn_softc *, const void *, 220292174Savos size_t, CMD_FUNC_PROTO); 221264912Skevlostatic void urtwn_r92c_rf_write(struct urtwn_softc *, int, 222264912Skevlo uint8_t, uint32_t); 223281069Srpaulostatic void urtwn_r88e_rf_write(struct urtwn_softc *, int, 224264912Skevlo uint8_t, uint32_t); 225251538Srpaulostatic uint32_t urtwn_rf_read(struct urtwn_softc *, int, uint8_t); 226281069Srpaulostatic int urtwn_llt_write(struct urtwn_softc *, uint32_t, 227251538Srpaulo uint32_t); 228291264Savosstatic int urtwn_efuse_read_next(struct urtwn_softc *, uint8_t *); 229291264Savosstatic int urtwn_efuse_read_data(struct urtwn_softc *, uint8_t *, 230291264Savos uint8_t, uint8_t); 231291264Savos#ifdef URTWN_DEBUG 232291264Savosstatic void urtwn_dump_rom_contents(struct urtwn_softc *, 233291264Savos uint8_t *, uint16_t); 234291264Savos#endif 235291264Savosstatic int urtwn_efuse_read(struct urtwn_softc *, uint8_t *, 236291264Savos uint16_t); 237291698Savosstatic int urtwn_efuse_switch_power(struct urtwn_softc *); 238251538Srpaulostatic int urtwn_read_chipid(struct urtwn_softc *); 239291264Savosstatic int urtwn_read_rom(struct urtwn_softc *); 240291264Savosstatic int urtwn_r88e_read_rom(struct urtwn_softc *); 241251538Srpaulostatic int urtwn_ra_init(struct urtwn_softc *); 242290631Savosstatic void urtwn_init_beacon(struct urtwn_softc *, 243290631Savos struct urtwn_vap *); 244290631Savosstatic int urtwn_setup_beacon(struct urtwn_softc *, 245290631Savos struct ieee80211_node *); 246290631Savosstatic void urtwn_update_beacon(struct ieee80211vap *, int); 247290631Savosstatic int urtwn_tx_beacon(struct urtwn_softc *sc, 248290631Savos struct urtwn_vap *); 249292175Savosstatic int urtwn_key_alloc(struct ieee80211vap *, 250292175Savos struct ieee80211_key *, ieee80211_keyix *, 251292175Savos ieee80211_keyix *); 252292175Savosstatic void urtwn_key_set_cb(struct urtwn_softc *, 253292175Savos union sec_param *); 254292175Savosstatic void urtwn_key_del_cb(struct urtwn_softc *, 255292175Savos union sec_param *); 256292175Savosstatic int urtwn_key_set(struct ieee80211vap *, 257292175Savos const struct ieee80211_key *); 258292175Savosstatic int urtwn_key_delete(struct ieee80211vap *, 259292175Savos const struct ieee80211_key *); 260290651Savosstatic void urtwn_tsf_task_adhoc(void *, int); 261290631Savosstatic void urtwn_tsf_sync_enable(struct urtwn_softc *, 262290631Savos struct ieee80211vap *); 263292203Savosstatic void urtwn_get_tsf(struct urtwn_softc *, uint64_t *); 264251538Srpaulostatic void urtwn_set_led(struct urtwn_softc *, int, int); 265289811Savosstatic void urtwn_set_mode(struct urtwn_softc *, uint8_t); 266290651Savosstatic void urtwn_ibss_recv_mgmt(struct ieee80211_node *, 267290651Savos struct mbuf *, int, 268290651Savos const struct ieee80211_rx_stats *, int, int); 269281069Srpaulostatic int urtwn_newstate(struct ieee80211vap *, 270251538Srpaulo enum ieee80211_state, int); 271251538Srpaulostatic void urtwn_watchdog(void *); 272251538Srpaulostatic void urtwn_update_avgrssi(struct urtwn_softc *, int, int8_t); 273251538Srpaulostatic int8_t urtwn_get_rssi(struct urtwn_softc *, int, void *); 274264912Skevlostatic int8_t urtwn_r88e_get_rssi(struct urtwn_softc *, int, void *); 275290630Savosstatic int urtwn_tx_data(struct urtwn_softc *, 276251538Srpaulo struct ieee80211_node *, struct mbuf *, 277251538Srpaulo struct urtwn_data *); 278292221Savosstatic int urtwn_tx_raw(struct urtwn_softc *, 279292221Savos struct ieee80211_node *, struct mbuf *, 280292221Savos struct urtwn_data *, 281292221Savos const struct ieee80211_bpf_params *); 282290630Savosstatic void urtwn_tx_start(struct urtwn_softc *, struct mbuf *, 283290630Savos uint8_t, struct urtwn_data *); 284287197Sglebiusstatic int urtwn_transmit(struct ieee80211com *, struct mbuf *); 285287197Sglebiusstatic void urtwn_start(struct urtwn_softc *); 286287197Sglebiusstatic void urtwn_parent(struct ieee80211com *); 287264912Skevlostatic int urtwn_r92c_power_on(struct urtwn_softc *); 288264912Skevlostatic int urtwn_r88e_power_on(struct urtwn_softc *); 289251538Srpaulostatic int urtwn_llt_init(struct urtwn_softc *); 290251538Srpaulostatic void urtwn_fw_reset(struct urtwn_softc *); 291264912Skevlostatic void urtwn_r88e_fw_reset(struct urtwn_softc *); 292281069Srpaulostatic int urtwn_fw_loadpage(struct urtwn_softc *, int, 293251538Srpaulo const uint8_t *, int); 294251538Srpaulostatic int urtwn_load_firmware(struct urtwn_softc *); 295291902Skevlostatic int urtwn_dma_init(struct urtwn_softc *); 296291698Savosstatic int urtwn_mac_init(struct urtwn_softc *); 297251538Srpaulostatic void urtwn_bb_init(struct urtwn_softc *); 298251538Srpaulostatic void urtwn_rf_init(struct urtwn_softc *); 299251538Srpaulostatic void urtwn_cam_init(struct urtwn_softc *); 300292175Savosstatic int urtwn_cam_write(struct urtwn_softc *, uint32_t, 301292175Savos uint32_t); 302251538Srpaulostatic void urtwn_pa_bias_init(struct urtwn_softc *); 303251538Srpaulostatic void urtwn_rxfilter_init(struct urtwn_softc *); 304251538Srpaulostatic void urtwn_edca_init(struct urtwn_softc *); 305281069Srpaulostatic void urtwn_write_txpower(struct urtwn_softc *, int, 306251538Srpaulo uint16_t[]); 307251538Srpaulostatic void urtwn_get_txpower(struct urtwn_softc *, int, 308281069Srpaulo struct ieee80211_channel *, 309251538Srpaulo struct ieee80211_channel *, uint16_t[]); 310264912Skevlostatic void urtwn_r88e_get_txpower(struct urtwn_softc *, int, 311281069Srpaulo struct ieee80211_channel *, 312264912Skevlo struct ieee80211_channel *, uint16_t[]); 313251538Srpaulostatic void urtwn_set_txpower(struct urtwn_softc *, 314281069Srpaulo struct ieee80211_channel *, 315251538Srpaulo struct ieee80211_channel *); 316290048Savosstatic void urtwn_set_rx_bssid_all(struct urtwn_softc *, int); 317290048Savosstatic void urtwn_set_gain(struct urtwn_softc *, uint8_t); 318251538Srpaulostatic void urtwn_scan_start(struct ieee80211com *); 319251538Srpaulostatic void urtwn_scan_end(struct ieee80211com *); 320251538Srpaulostatic void urtwn_set_channel(struct ieee80211com *); 321292014Savosstatic int urtwn_wme_update(struct ieee80211com *); 322294465Savosstatic void urtwn_update_slot(struct ieee80211com *); 323294465Savosstatic void urtwn_update_slot_cb(struct urtwn_softc *, 324294465Savos union sec_param *); 325294465Savosstatic void urtwn_update_aifs(struct urtwn_softc *, uint8_t); 326290564Savosstatic void urtwn_set_promisc(struct urtwn_softc *); 327290564Savosstatic void urtwn_update_promisc(struct ieee80211com *); 328289066Skevlostatic void urtwn_update_mcast(struct ieee80211com *); 329292167Savosstatic struct ieee80211_node *urtwn_r88e_node_alloc(struct ieee80211vap *, 330292167Savos const uint8_t mac[IEEE80211_ADDR_LEN]); 331292167Savosstatic void urtwn_r88e_newassoc(struct ieee80211_node *, int); 332292167Savosstatic void urtwn_r88e_node_free(struct ieee80211_node *); 333251538Srpaulostatic void urtwn_set_chan(struct urtwn_softc *, 334281069Srpaulo struct ieee80211_channel *, 335251538Srpaulo struct ieee80211_channel *); 336251538Srpaulostatic void urtwn_iq_calib(struct urtwn_softc *); 337251538Srpaulostatic void urtwn_lc_calib(struct urtwn_softc *); 338291698Savosstatic int urtwn_init(struct urtwn_softc *); 339287197Sglebiusstatic void urtwn_stop(struct urtwn_softc *); 340251538Srpaulostatic void urtwn_abort_xfers(struct urtwn_softc *); 341251538Srpaulostatic int urtwn_raw_xmit(struct ieee80211_node *, struct mbuf *, 342251538Srpaulo const struct ieee80211_bpf_params *); 343266472Shselaskystatic void urtwn_ms_delay(struct urtwn_softc *); 344251538Srpaulo 345251538Srpaulo/* Aliases. */ 346251538Srpaulo#define urtwn_bb_write urtwn_write_4 347251538Srpaulo#define urtwn_bb_read urtwn_read_4 348251538Srpaulo 349251538Srpaulostatic const struct usb_config urtwn_config[URTWN_N_TRANSFER] = { 350251538Srpaulo [URTWN_BULK_RX] = { 351251538Srpaulo .type = UE_BULK, 352251538Srpaulo .endpoint = UE_ADDR_ANY, 353251538Srpaulo .direction = UE_DIR_IN, 354251538Srpaulo .bufsize = URTWN_RXBUFSZ, 355251538Srpaulo .flags = { 356251538Srpaulo .pipe_bof = 1, 357251538Srpaulo .short_xfer_ok = 1 358251538Srpaulo }, 359251538Srpaulo .callback = urtwn_bulk_rx_callback, 360251538Srpaulo }, 361251538Srpaulo [URTWN_BULK_TX_BE] = { 362251538Srpaulo .type = UE_BULK, 363251538Srpaulo .endpoint = 0x03, 364251538Srpaulo .direction = UE_DIR_OUT, 365251538Srpaulo .bufsize = URTWN_TXBUFSZ, 366251538Srpaulo .flags = { 367251538Srpaulo .ext_buffer = 1, 368251538Srpaulo .pipe_bof = 1, 369251538Srpaulo .force_short_xfer = 1 370251538Srpaulo }, 371251538Srpaulo .callback = urtwn_bulk_tx_callback, 372251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 373251538Srpaulo }, 374251538Srpaulo [URTWN_BULK_TX_BK] = { 375251538Srpaulo .type = UE_BULK, 376251538Srpaulo .endpoint = 0x03, 377251538Srpaulo .direction = UE_DIR_OUT, 378251538Srpaulo .bufsize = URTWN_TXBUFSZ, 379251538Srpaulo .flags = { 380251538Srpaulo .ext_buffer = 1, 381251538Srpaulo .pipe_bof = 1, 382251538Srpaulo .force_short_xfer = 1, 383251538Srpaulo }, 384251538Srpaulo .callback = urtwn_bulk_tx_callback, 385251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 386251538Srpaulo }, 387251538Srpaulo [URTWN_BULK_TX_VI] = { 388251538Srpaulo .type = UE_BULK, 389251538Srpaulo .endpoint = 0x02, 390251538Srpaulo .direction = UE_DIR_OUT, 391251538Srpaulo .bufsize = URTWN_TXBUFSZ, 392251538Srpaulo .flags = { 393251538Srpaulo .ext_buffer = 1, 394251538Srpaulo .pipe_bof = 1, 395251538Srpaulo .force_short_xfer = 1 396251538Srpaulo }, 397251538Srpaulo .callback = urtwn_bulk_tx_callback, 398251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 399251538Srpaulo }, 400251538Srpaulo [URTWN_BULK_TX_VO] = { 401251538Srpaulo .type = UE_BULK, 402251538Srpaulo .endpoint = 0x02, 403251538Srpaulo .direction = UE_DIR_OUT, 404251538Srpaulo .bufsize = URTWN_TXBUFSZ, 405251538Srpaulo .flags = { 406251538Srpaulo .ext_buffer = 1, 407251538Srpaulo .pipe_bof = 1, 408251538Srpaulo .force_short_xfer = 1 409251538Srpaulo }, 410251538Srpaulo .callback = urtwn_bulk_tx_callback, 411251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 412251538Srpaulo }, 413251538Srpaulo}; 414251538Srpaulo 415292014Savosstatic const struct wme_to_queue { 416292014Savos uint16_t reg; 417292014Savos uint8_t qid; 418292014Savos} wme2queue[WME_NUM_AC] = { 419292014Savos { R92C_EDCA_BE_PARAM, URTWN_BULK_TX_BE}, 420292014Savos { R92C_EDCA_BK_PARAM, URTWN_BULK_TX_BK}, 421292014Savos { R92C_EDCA_VI_PARAM, URTWN_BULK_TX_VI}, 422292014Savos { R92C_EDCA_VO_PARAM, URTWN_BULK_TX_VO} 423292014Savos}; 424292014Savos 425251538Srpaulostatic int 426251538Srpaulourtwn_match(device_t self) 427251538Srpaulo{ 428251538Srpaulo struct usb_attach_arg *uaa = device_get_ivars(self); 429251538Srpaulo 430251538Srpaulo if (uaa->usb_mode != USB_MODE_HOST) 431251538Srpaulo return (ENXIO); 432251538Srpaulo if (uaa->info.bConfigIndex != URTWN_CONFIG_INDEX) 433251538Srpaulo return (ENXIO); 434251538Srpaulo if (uaa->info.bIfaceIndex != URTWN_IFACE_INDEX) 435251538Srpaulo return (ENXIO); 436251538Srpaulo 437251538Srpaulo return (usbd_lookup_id_by_uaa(urtwn_devs, sizeof(urtwn_devs), uaa)); 438251538Srpaulo} 439251538Srpaulo 440251538Srpaulostatic int 441251538Srpaulourtwn_attach(device_t self) 442251538Srpaulo{ 443251538Srpaulo struct usb_attach_arg *uaa = device_get_ivars(self); 444251538Srpaulo struct urtwn_softc *sc = device_get_softc(self); 445287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 446293339Savos uint8_t bands[howmany(IEEE80211_MODE_MAX, 8)]; 447251538Srpaulo int error; 448251538Srpaulo 449251538Srpaulo device_set_usb_desc(self); 450251538Srpaulo sc->sc_udev = uaa->device; 451251538Srpaulo sc->sc_dev = self; 452264912Skevlo if (USB_GET_DRIVER_INFO(uaa) == URTWN_RTL8188E) 453264912Skevlo sc->chip |= URTWN_CHIP_88E; 454251538Srpaulo 455251538Srpaulo mtx_init(&sc->sc_mtx, device_get_nameunit(self), 456251538Srpaulo MTX_NETWORK_LOCK, MTX_DEF); 457292174Savos URTWN_CMDQ_LOCK_INIT(sc); 458292167Savos URTWN_NT_LOCK_INIT(sc); 459251538Srpaulo callout_init(&sc->sc_watchdog_ch, 0); 460287197Sglebius mbufq_init(&sc->sc_snd, ifqmaxlen); 461251538Srpaulo 462291902Skevlo sc->sc_iface_index = URTWN_IFACE_INDEX; 463291902Skevlo error = usbd_transfer_setup(uaa->device, &sc->sc_iface_index, 464291902Skevlo sc->sc_xfer, urtwn_config, URTWN_N_TRANSFER, sc, &sc->sc_mtx); 465251538Srpaulo if (error) { 466251538Srpaulo device_printf(self, "could not allocate USB transfers, " 467251538Srpaulo "err=%s\n", usbd_errstr(error)); 468251538Srpaulo goto detach; 469251538Srpaulo } 470251538Srpaulo 471251538Srpaulo URTWN_LOCK(sc); 472251538Srpaulo 473251538Srpaulo error = urtwn_read_chipid(sc); 474251538Srpaulo if (error) { 475251538Srpaulo device_printf(sc->sc_dev, "unsupported test chip\n"); 476251538Srpaulo URTWN_UNLOCK(sc); 477251538Srpaulo goto detach; 478251538Srpaulo } 479251538Srpaulo 480251538Srpaulo /* Determine number of Tx/Rx chains. */ 481251538Srpaulo if (sc->chip & URTWN_CHIP_92C) { 482251538Srpaulo sc->ntxchains = (sc->chip & URTWN_CHIP_92C_1T2R) ? 1 : 2; 483251538Srpaulo sc->nrxchains = 2; 484251538Srpaulo } else { 485251538Srpaulo sc->ntxchains = 1; 486251538Srpaulo sc->nrxchains = 1; 487251538Srpaulo } 488251538Srpaulo 489264912Skevlo if (sc->chip & URTWN_CHIP_88E) 490291264Savos error = urtwn_r88e_read_rom(sc); 491264912Skevlo else 492291264Savos error = urtwn_read_rom(sc); 493291264Savos if (error != 0) { 494291264Savos device_printf(sc->sc_dev, "%s: cannot read rom, error %d\n", 495291264Savos __func__, error); 496291264Savos URTWN_UNLOCK(sc); 497291264Savos goto detach; 498291264Savos } 499264912Skevlo 500251538Srpaulo device_printf(sc->sc_dev, "MAC/BB RTL%s, RF 6052 %dT%dR\n", 501251538Srpaulo (sc->chip & URTWN_CHIP_92C) ? "8192CU" : 502264912Skevlo (sc->chip & URTWN_CHIP_88E) ? "8188EU" : 503251538Srpaulo (sc->board_type == R92C_BOARD_TYPE_HIGHPA) ? "8188RU" : 504251538Srpaulo (sc->board_type == R92C_BOARD_TYPE_MINICARD) ? "8188CE-VAU" : 505251538Srpaulo "8188CUS", sc->ntxchains, sc->nrxchains); 506251538Srpaulo 507251538Srpaulo URTWN_UNLOCK(sc); 508251538Srpaulo 509283537Sglebius ic->ic_softc = sc; 510283527Sglebius ic->ic_name = device_get_nameunit(self); 511251538Srpaulo ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ 512251538Srpaulo ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */ 513251538Srpaulo 514251538Srpaulo /* set device capabilities */ 515251538Srpaulo ic->ic_caps = 516251538Srpaulo IEEE80211_C_STA /* station mode */ 517251538Srpaulo | IEEE80211_C_MONITOR /* monitor mode */ 518290651Savos | IEEE80211_C_IBSS /* adhoc mode */ 519290631Savos | IEEE80211_C_HOSTAP /* hostap mode */ 520251538Srpaulo | IEEE80211_C_SHPREAMBLE /* short preamble supported */ 521251538Srpaulo | IEEE80211_C_SHSLOT /* short slot time supported */ 522251538Srpaulo | IEEE80211_C_BGSCAN /* capable of bg scanning */ 523251538Srpaulo | IEEE80211_C_WPA /* 802.11i */ 524292014Savos | IEEE80211_C_WME /* 802.11e */ 525251538Srpaulo ; 526251538Srpaulo 527292175Savos ic->ic_cryptocaps = 528292175Savos IEEE80211_CRYPTO_WEP | 529292175Savos IEEE80211_CRYPTO_TKIP | 530292175Savos IEEE80211_CRYPTO_AES_CCM; 531292175Savos 532293339Savos memset(bands, 0, sizeof(bands)); 533293339Savos setbit(bands, IEEE80211_MODE_11B); 534293339Savos setbit(bands, IEEE80211_MODE_11G); 535293339Savos ieee80211_init_channels(ic, NULL, bands); 536251538Srpaulo 537287197Sglebius ieee80211_ifattach(ic); 538251538Srpaulo ic->ic_raw_xmit = urtwn_raw_xmit; 539251538Srpaulo ic->ic_scan_start = urtwn_scan_start; 540251538Srpaulo ic->ic_scan_end = urtwn_scan_end; 541251538Srpaulo ic->ic_set_channel = urtwn_set_channel; 542287197Sglebius ic->ic_transmit = urtwn_transmit; 543287197Sglebius ic->ic_parent = urtwn_parent; 544251538Srpaulo ic->ic_vap_create = urtwn_vap_create; 545251538Srpaulo ic->ic_vap_delete = urtwn_vap_delete; 546292014Savos ic->ic_wme.wme_update = urtwn_wme_update; 547294465Savos ic->ic_updateslot = urtwn_update_slot; 548290564Savos ic->ic_update_promisc = urtwn_update_promisc; 549251538Srpaulo ic->ic_update_mcast = urtwn_update_mcast; 550292167Savos if (sc->chip & URTWN_CHIP_88E) { 551292167Savos ic->ic_node_alloc = urtwn_r88e_node_alloc; 552292167Savos ic->ic_newassoc = urtwn_r88e_newassoc; 553292167Savos sc->sc_node_free = ic->ic_node_free; 554292167Savos ic->ic_node_free = urtwn_r88e_node_free; 555292167Savos } 556251538Srpaulo 557281069Srpaulo ieee80211_radiotap_attach(ic, &sc->sc_txtap.wt_ihdr, 558251538Srpaulo sizeof(sc->sc_txtap), URTWN_TX_RADIOTAP_PRESENT, 559251538Srpaulo &sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap), 560251538Srpaulo URTWN_RX_RADIOTAP_PRESENT); 561251538Srpaulo 562292174Savos TASK_INIT(&sc->cmdq_task, 0, urtwn_cmdq_cb, sc); 563292174Savos 564251538Srpaulo if (bootverbose) 565251538Srpaulo ieee80211_announce(ic); 566251538Srpaulo 567251538Srpaulo return (0); 568251538Srpaulo 569251538Srpaulodetach: 570251538Srpaulo urtwn_detach(self); 571251538Srpaulo return (ENXIO); /* failure */ 572251538Srpaulo} 573251538Srpaulo 574251538Srpaulostatic int 575251538Srpaulourtwn_detach(device_t self) 576251538Srpaulo{ 577251538Srpaulo struct urtwn_softc *sc = device_get_softc(self); 578287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 579263153Skevlo unsigned int x; 580281069Srpaulo 581263153Skevlo /* Prevent further ioctls. */ 582263153Skevlo URTWN_LOCK(sc); 583263153Skevlo sc->sc_flags |= URTWN_DETACHED; 584263153Skevlo URTWN_UNLOCK(sc); 585251538Srpaulo 586291698Savos urtwn_stop(sc); 587291698Savos 588251538Srpaulo callout_drain(&sc->sc_watchdog_ch); 589251538Srpaulo 590288353Sadrian /* stop all USB transfers */ 591288353Sadrian usbd_transfer_unsetup(sc->sc_xfer, URTWN_N_TRANSFER); 592288353Sadrian 593263153Skevlo /* Prevent further allocations from RX/TX data lists. */ 594263153Skevlo URTWN_LOCK(sc); 595263153Skevlo STAILQ_INIT(&sc->sc_tx_active); 596263153Skevlo STAILQ_INIT(&sc->sc_tx_inactive); 597263153Skevlo STAILQ_INIT(&sc->sc_tx_pending); 598263153Skevlo 599263153Skevlo STAILQ_INIT(&sc->sc_rx_active); 600263153Skevlo STAILQ_INIT(&sc->sc_rx_inactive); 601263153Skevlo URTWN_UNLOCK(sc); 602263153Skevlo 603263153Skevlo /* drain USB transfers */ 604263153Skevlo for (x = 0; x != URTWN_N_TRANSFER; x++) 605263153Skevlo usbd_transfer_drain(sc->sc_xfer[x]); 606263153Skevlo 607263153Skevlo /* Free data buffers. */ 608263153Skevlo URTWN_LOCK(sc); 609263153Skevlo urtwn_free_tx_list(sc); 610263153Skevlo urtwn_free_rx_list(sc); 611263153Skevlo URTWN_UNLOCK(sc); 612263153Skevlo 613292174Savos if (ic->ic_softc == sc) { 614292174Savos ieee80211_draintask(ic, &sc->cmdq_task); 615292174Savos ieee80211_ifdetach(ic); 616292174Savos } 617292174Savos 618292167Savos URTWN_NT_LOCK_DESTROY(sc); 619292174Savos URTWN_CMDQ_LOCK_DESTROY(sc); 620251538Srpaulo mtx_destroy(&sc->sc_mtx); 621251538Srpaulo 622251538Srpaulo return (0); 623251538Srpaulo} 624251538Srpaulo 625251538Srpaulostatic void 626289066Skevlourtwn_drain_mbufq(struct urtwn_softc *sc) 627251538Srpaulo{ 628289066Skevlo struct mbuf *m; 629289066Skevlo struct ieee80211_node *ni; 630289066Skevlo URTWN_ASSERT_LOCKED(sc); 631289066Skevlo while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) { 632289066Skevlo ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 633289066Skevlo m->m_pkthdr.rcvif = NULL; 634289066Skevlo ieee80211_free_node(ni); 635289066Skevlo m_freem(m); 636251538Srpaulo } 637251538Srpaulo} 638251538Srpaulo 639251538Srpaulostatic usb_error_t 640251538Srpaulourtwn_do_request(struct urtwn_softc *sc, struct usb_device_request *req, 641251538Srpaulo void *data) 642251538Srpaulo{ 643251538Srpaulo usb_error_t err; 644251538Srpaulo int ntries = 10; 645251538Srpaulo 646251538Srpaulo URTWN_ASSERT_LOCKED(sc); 647251538Srpaulo 648251538Srpaulo while (ntries--) { 649251538Srpaulo err = usbd_do_request_flags(sc->sc_udev, &sc->sc_mtx, 650251538Srpaulo req, data, 0, NULL, 250 /* ms */); 651251538Srpaulo if (err == 0) 652251538Srpaulo break; 653251538Srpaulo 654251538Srpaulo DPRINTFN(1, "Control request failed, %s (retrying)\n", 655251538Srpaulo usbd_errstr(err)); 656251538Srpaulo usb_pause_mtx(&sc->sc_mtx, hz / 100); 657251538Srpaulo } 658251538Srpaulo return (err); 659251538Srpaulo} 660251538Srpaulo 661251538Srpaulostatic struct ieee80211vap * 662251538Srpaulourtwn_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit, 663251538Srpaulo enum ieee80211_opmode opmode, int flags, 664251538Srpaulo const uint8_t bssid[IEEE80211_ADDR_LEN], 665251538Srpaulo const uint8_t mac[IEEE80211_ADDR_LEN]) 666251538Srpaulo{ 667290631Savos struct urtwn_softc *sc = ic->ic_softc; 668251538Srpaulo struct urtwn_vap *uvp; 669251538Srpaulo struct ieee80211vap *vap; 670251538Srpaulo 671251538Srpaulo if (!TAILQ_EMPTY(&ic->ic_vaps)) /* only one at a time */ 672251538Srpaulo return (NULL); 673251538Srpaulo 674287197Sglebius uvp = malloc(sizeof(struct urtwn_vap), M_80211_VAP, M_WAITOK | M_ZERO); 675251538Srpaulo vap = &uvp->vap; 676251538Srpaulo /* enable s/w bmiss handling for sta mode */ 677251538Srpaulo 678281069Srpaulo if (ieee80211_vap_setup(ic, vap, name, unit, opmode, 679287197Sglebius flags | IEEE80211_CLONE_NOBEACONS, bssid) != 0) { 680257743Shselasky /* out of memory */ 681257743Shselasky free(uvp, M_80211_VAP); 682257743Shselasky return (NULL); 683257743Shselasky } 684257743Shselasky 685290651Savos if (opmode == IEEE80211_M_HOSTAP || opmode == IEEE80211_M_IBSS) 686290631Savos urtwn_init_beacon(sc, uvp); 687290631Savos 688251538Srpaulo /* override state transition machine */ 689251538Srpaulo uvp->newstate = vap->iv_newstate; 690251538Srpaulo vap->iv_newstate = urtwn_newstate; 691290631Savos vap->iv_update_beacon = urtwn_update_beacon; 692292175Savos vap->iv_key_alloc = urtwn_key_alloc; 693292175Savos vap->iv_key_set = urtwn_key_set; 694292175Savos vap->iv_key_delete = urtwn_key_delete; 695290651Savos if (opmode == IEEE80211_M_IBSS) { 696290651Savos uvp->recv_mgmt = vap->iv_recv_mgmt; 697290651Savos vap->iv_recv_mgmt = urtwn_ibss_recv_mgmt; 698290651Savos TASK_INIT(&uvp->tsf_task_adhoc, 0, urtwn_tsf_task_adhoc, vap); 699290651Savos } 700251538Srpaulo 701292167Savos if (URTWN_CHIP_HAS_RATECTL(sc)) 702292167Savos ieee80211_ratectl_init(vap); 703251538Srpaulo /* complete setup */ 704251538Srpaulo ieee80211_vap_attach(vap, ieee80211_media_change, 705287197Sglebius ieee80211_media_status, mac); 706251538Srpaulo ic->ic_opmode = opmode; 707251538Srpaulo return (vap); 708251538Srpaulo} 709251538Srpaulo 710251538Srpaulostatic void 711251538Srpaulourtwn_vap_delete(struct ieee80211vap *vap) 712251538Srpaulo{ 713290651Savos struct ieee80211com *ic = vap->iv_ic; 714292167Savos struct urtwn_softc *sc = ic->ic_softc; 715251538Srpaulo struct urtwn_vap *uvp = URTWN_VAP(vap); 716251538Srpaulo 717290651Savos if (uvp->bcn_mbuf != NULL) 718290651Savos m_freem(uvp->bcn_mbuf); 719290651Savos if (vap->iv_opmode == IEEE80211_M_IBSS) 720290651Savos ieee80211_draintask(ic, &uvp->tsf_task_adhoc); 721292167Savos if (URTWN_CHIP_HAS_RATECTL(sc)) 722292167Savos ieee80211_ratectl_deinit(vap); 723251538Srpaulo ieee80211_vap_detach(vap); 724251538Srpaulo free(uvp, M_80211_VAP); 725251538Srpaulo} 726251538Srpaulo 727251538Srpaulostatic struct mbuf * 728292207Savosurtwn_rx_copy_to_mbuf(struct urtwn_softc *sc, struct r92c_rx_stat *stat, 729292207Savos int totlen) 730251538Srpaulo{ 731287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 732251538Srpaulo struct mbuf *m; 733292207Savos uint32_t rxdw0; 734292207Savos int pktlen; 735251538Srpaulo 736251538Srpaulo /* 737251538Srpaulo * don't pass packets to the ieee80211 framework if the driver isn't 738251538Srpaulo * RUNNING. 739251538Srpaulo */ 740287197Sglebius if (!(sc->sc_flags & URTWN_RUNNING)) 741251538Srpaulo return (NULL); 742251538Srpaulo 743251538Srpaulo rxdw0 = le32toh(stat->rxdw0); 744251538Srpaulo if (rxdw0 & (R92C_RXDW0_CRCERR | R92C_RXDW0_ICVERR)) { 745251538Srpaulo /* 746251538Srpaulo * This should not happen since we setup our Rx filter 747251538Srpaulo * to not receive these frames. 748251538Srpaulo */ 749292207Savos DPRINTFN(6, "RX flags error (%s)\n", 750292207Savos rxdw0 & R92C_RXDW0_CRCERR ? "CRC" : "ICV"); 751292207Savos goto fail; 752251538Srpaulo } 753292207Savos 754292207Savos pktlen = MS(rxdw0, R92C_RXDW0_PKTLEN); 755292207Savos if (pktlen < sizeof(struct ieee80211_frame_ack)) { 756292207Savos DPRINTFN(6, "frame too short: %d\n", pktlen); 757292207Savos goto fail; 758271303Skevlo } 759251538Srpaulo 760292207Savos if (__predict_false(totlen > MCLBYTES)) { 761292207Savos /* convert to m_getjcl if this happens */ 762292207Savos device_printf(sc->sc_dev, "%s: frame too long: %d (%d)\n", 763292207Savos __func__, pktlen, totlen); 764292207Savos goto fail; 765251538Srpaulo } 766251538Srpaulo 767260463Skevlo m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 768292207Savos if (__predict_false(m == NULL)) { 769292207Savos device_printf(sc->sc_dev, "%s: could not allocate RX mbuf\n", 770292207Savos __func__); 771292207Savos goto fail; 772251538Srpaulo } 773251538Srpaulo 774251538Srpaulo /* Finalize mbuf. */ 775292207Savos memcpy(mtod(m, uint8_t *), (uint8_t *)stat, totlen); 776292207Savos m->m_pkthdr.len = m->m_len = totlen; 777292207Savos 778251538Srpaulo return (m); 779292207Savosfail: 780292207Savos counter_u64_add(ic->ic_ierrors, 1); 781292207Savos return (NULL); 782251538Srpaulo} 783251538Srpaulo 784251538Srpaulostatic struct mbuf * 785292207Savosurtwn_report_intr(struct usb_xfer *xfer, struct urtwn_data *data) 786251538Srpaulo{ 787251538Srpaulo struct urtwn_softc *sc = data->sc; 788287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 789251538Srpaulo struct r92c_rx_stat *stat; 790251538Srpaulo uint8_t *buf; 791292167Savos int len; 792251538Srpaulo 793251538Srpaulo usbd_xfer_status(xfer, &len, NULL, NULL, NULL); 794251538Srpaulo 795251538Srpaulo if (len < sizeof(*stat)) { 796287197Sglebius counter_u64_add(ic->ic_ierrors, 1); 797251538Srpaulo return (NULL); 798251538Srpaulo } 799251538Srpaulo 800251538Srpaulo buf = data->buf; 801292167Savos stat = (struct r92c_rx_stat *)buf; 802292167Savos 803292167Savos if (sc->chip & URTWN_CHIP_88E) { 804292167Savos int report_sel = MS(le32toh(stat->rxdw3), R88E_RXDW3_RPT); 805292167Savos 806292167Savos switch (report_sel) { 807292167Savos case R88E_RXDW3_RPT_RX: 808292207Savos return (urtwn_rxeof(sc, buf, len)); 809292167Savos case R88E_RXDW3_RPT_TX1: 810292167Savos urtwn_r88e_ratectl_tx_complete(sc, &stat[1]); 811292167Savos break; 812292167Savos default: 813292167Savos DPRINTFN(7, "case %d was not handled\n", report_sel); 814292167Savos break; 815292167Savos } 816292167Savos } else 817292207Savos return (urtwn_rxeof(sc, buf, len)); 818292167Savos 819292167Savos return (NULL); 820292167Savos} 821292167Savos 822292167Savosstatic struct mbuf * 823292207Savosurtwn_rxeof(struct urtwn_softc *sc, uint8_t *buf, int len) 824292167Savos{ 825292167Savos struct r92c_rx_stat *stat; 826292167Savos struct mbuf *m, *m0 = NULL, *prevm = NULL; 827292167Savos uint32_t rxdw0; 828292167Savos int totlen, pktlen, infosz, npkts; 829292167Savos 830251538Srpaulo /* Get the number of encapsulated frames. */ 831251538Srpaulo stat = (struct r92c_rx_stat *)buf; 832251538Srpaulo npkts = MS(le32toh(stat->rxdw2), R92C_RXDW2_PKTCNT); 833251538Srpaulo DPRINTFN(6, "Rx %d frames in one chunk\n", npkts); 834251538Srpaulo 835251538Srpaulo /* Process all of them. */ 836251538Srpaulo while (npkts-- > 0) { 837251538Srpaulo if (len < sizeof(*stat)) 838251538Srpaulo break; 839251538Srpaulo stat = (struct r92c_rx_stat *)buf; 840251538Srpaulo rxdw0 = le32toh(stat->rxdw0); 841251538Srpaulo 842251538Srpaulo pktlen = MS(rxdw0, R92C_RXDW0_PKTLEN); 843251538Srpaulo if (pktlen == 0) 844251538Srpaulo break; 845251538Srpaulo 846251538Srpaulo infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8; 847251538Srpaulo 848251538Srpaulo /* Make sure everything fits in xfer. */ 849251538Srpaulo totlen = sizeof(*stat) + infosz + pktlen; 850251538Srpaulo if (totlen > len) 851251538Srpaulo break; 852251538Srpaulo 853292207Savos m = urtwn_rx_copy_to_mbuf(sc, stat, totlen); 854251538Srpaulo if (m0 == NULL) 855251538Srpaulo m0 = m; 856251538Srpaulo if (prevm == NULL) 857251538Srpaulo prevm = m; 858251538Srpaulo else { 859251538Srpaulo prevm->m_next = m; 860251538Srpaulo prevm = m; 861251538Srpaulo } 862251538Srpaulo 863251538Srpaulo /* Next chunk is 128-byte aligned. */ 864251538Srpaulo totlen = (totlen + 127) & ~127; 865251538Srpaulo buf += totlen; 866251538Srpaulo len -= totlen; 867251538Srpaulo } 868251538Srpaulo 869251538Srpaulo return (m0); 870251538Srpaulo} 871251538Srpaulo 872251538Srpaulostatic void 873292167Savosurtwn_r88e_ratectl_tx_complete(struct urtwn_softc *sc, void *arg) 874292167Savos{ 875292167Savos struct r88e_tx_rpt_ccx *rpt = arg; 876292167Savos struct ieee80211vap *vap; 877292167Savos struct ieee80211_node *ni; 878292167Savos uint8_t macid; 879292167Savos int ntries; 880292167Savos 881292167Savos macid = MS(rpt->rptb1, R88E_RPTB1_MACID); 882292167Savos ntries = MS(rpt->rptb2, R88E_RPTB2_RETRY_CNT); 883292167Savos 884292167Savos URTWN_NT_LOCK(sc); 885292167Savos ni = sc->node_list[macid]; 886292167Savos if (ni != NULL) { 887292167Savos vap = ni->ni_vap; 888292167Savos 889292167Savos if (rpt->rptb1 & R88E_RPTB1_PKT_OK) { 890292167Savos ieee80211_ratectl_tx_complete(vap, ni, 891292167Savos IEEE80211_RATECTL_TX_SUCCESS, &ntries, NULL); 892292167Savos } else { 893292167Savos ieee80211_ratectl_tx_complete(vap, ni, 894292167Savos IEEE80211_RATECTL_TX_FAILURE, &ntries, NULL); 895292167Savos } 896292167Savos } else 897292167Savos DPRINTFN(8, "macid %d, ni is NULL\n", macid); 898292167Savos URTWN_NT_UNLOCK(sc); 899292167Savos} 900292167Savos 901292207Savosstatic struct ieee80211_node * 902292207Savosurtwn_rx_frame(struct urtwn_softc *sc, struct mbuf *m, int8_t *rssi_p) 903292207Savos{ 904292207Savos struct ieee80211com *ic = &sc->sc_ic; 905292207Savos struct ieee80211_frame_min *wh; 906292207Savos struct r92c_rx_stat *stat; 907292207Savos uint32_t rxdw0, rxdw3; 908292207Savos uint8_t rate, cipher; 909292207Savos int8_t rssi = URTWN_NOISE_FLOOR + 1; 910292207Savos int infosz; 911292207Savos 912292207Savos stat = mtod(m, struct r92c_rx_stat *); 913292207Savos rxdw0 = le32toh(stat->rxdw0); 914292207Savos rxdw3 = le32toh(stat->rxdw3); 915292207Savos 916292207Savos rate = MS(rxdw3, R92C_RXDW3_RATE); 917292207Savos cipher = MS(rxdw0, R92C_RXDW0_CIPHER); 918292207Savos infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8; 919292207Savos 920292207Savos /* Get RSSI from PHY status descriptor if present. */ 921292207Savos if (infosz != 0 && (rxdw0 & R92C_RXDW0_PHYST)) { 922292207Savos if (sc->chip & URTWN_CHIP_88E) 923292207Savos rssi = urtwn_r88e_get_rssi(sc, rate, &stat[1]); 924292207Savos else 925292207Savos rssi = urtwn_get_rssi(sc, rate, &stat[1]); 926292207Savos /* Update our average RSSI. */ 927292207Savos urtwn_update_avgrssi(sc, rate, rssi); 928292207Savos } 929292207Savos 930292207Savos if (ieee80211_radiotap_active(ic)) { 931292207Savos struct urtwn_rx_radiotap_header *tap = &sc->sc_rxtap; 932292207Savos 933292207Savos tap->wr_flags = 0; 934292207Savos 935292207Savos urtwn_get_tsf(sc, &tap->wr_tsft); 936292207Savos if (__predict_false(le32toh((uint32_t)tap->wr_tsft) < 937292207Savos le32toh(stat->rxdw5))) { 938292207Savos tap->wr_tsft = le32toh(tap->wr_tsft >> 32) - 1; 939292207Savos tap->wr_tsft = (uint64_t)htole32(tap->wr_tsft) << 32; 940292207Savos } else 941292207Savos tap->wr_tsft &= 0xffffffff00000000; 942292207Savos tap->wr_tsft += stat->rxdw5; 943292207Savos 944292207Savos /* Map HW rate index to 802.11 rate. */ 945292207Savos if (!(rxdw3 & R92C_RXDW3_HT)) { 946292207Savos tap->wr_rate = ridx2rate[rate]; 947292207Savos } else if (rate >= 12) { /* MCS0~15. */ 948292207Savos /* Bit 7 set means HT MCS instead of rate. */ 949292207Savos tap->wr_rate = 0x80 | (rate - 12); 950292207Savos } 951292207Savos tap->wr_dbm_antsignal = rssi; 952292207Savos tap->wr_dbm_antnoise = URTWN_NOISE_FLOOR; 953292207Savos } 954292207Savos 955292207Savos *rssi_p = rssi; 956292207Savos 957292207Savos /* Drop descriptor. */ 958292207Savos m_adj(m, sizeof(*stat) + infosz); 959292207Savos wh = mtod(m, struct ieee80211_frame_min *); 960292207Savos 961292207Savos if ((wh->i_fc[1] & IEEE80211_FC1_PROTECTED) && 962292207Savos cipher != R92C_CAM_ALGO_NONE) { 963292207Savos m->m_flags |= M_WEP; 964292207Savos } 965292207Savos 966292207Savos if (m->m_len >= sizeof(*wh)) 967292207Savos return (ieee80211_find_rxnode(ic, wh)); 968292207Savos 969292207Savos return (NULL); 970292207Savos} 971292207Savos 972292167Savosstatic void 973251538Srpaulourtwn_bulk_rx_callback(struct usb_xfer *xfer, usb_error_t error) 974251538Srpaulo{ 975251538Srpaulo struct urtwn_softc *sc = usbd_xfer_softc(xfer); 976287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 977251538Srpaulo struct ieee80211_node *ni; 978251538Srpaulo struct mbuf *m = NULL, *next; 979251538Srpaulo struct urtwn_data *data; 980292207Savos int8_t nf, rssi; 981251538Srpaulo 982251538Srpaulo URTWN_ASSERT_LOCKED(sc); 983251538Srpaulo 984251538Srpaulo switch (USB_GET_STATE(xfer)) { 985251538Srpaulo case USB_ST_TRANSFERRED: 986251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_active); 987251538Srpaulo if (data == NULL) 988251538Srpaulo goto tr_setup; 989251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 990292207Savos m = urtwn_report_intr(xfer, data); 991251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 992251538Srpaulo /* FALLTHROUGH */ 993251538Srpaulo case USB_ST_SETUP: 994251538Srpaulotr_setup: 995251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_inactive); 996251538Srpaulo if (data == NULL) { 997251538Srpaulo KASSERT(m == NULL, ("mbuf isn't NULL")); 998251538Srpaulo return; 999251538Srpaulo } 1000251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_inactive, next); 1001251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_active, data, next); 1002251538Srpaulo usbd_xfer_set_frame_data(xfer, 0, data->buf, 1003251538Srpaulo usbd_xfer_max_len(xfer)); 1004251538Srpaulo usbd_transfer_submit(xfer); 1005251538Srpaulo 1006251538Srpaulo /* 1007251538Srpaulo * To avoid LOR we should unlock our private mutex here to call 1008251538Srpaulo * ieee80211_input() because here is at the end of a USB 1009251538Srpaulo * callback and safe to unlock. 1010251538Srpaulo */ 1011251538Srpaulo while (m != NULL) { 1012251538Srpaulo next = m->m_next; 1013251538Srpaulo m->m_next = NULL; 1014292207Savos 1015292207Savos ni = urtwn_rx_frame(sc, m, &rssi); 1016292207Savos URTWN_UNLOCK(sc); 1017292207Savos 1018251538Srpaulo nf = URTWN_NOISE_FLOOR; 1019251538Srpaulo if (ni != NULL) { 1020289799Savos (void)ieee80211_input(ni, m, rssi - nf, nf); 1021251538Srpaulo ieee80211_free_node(ni); 1022289799Savos } else { 1023289799Savos (void)ieee80211_input_all(ic, m, rssi - nf, 1024289799Savos nf); 1025289799Savos } 1026292207Savos 1027292207Savos URTWN_LOCK(sc); 1028251538Srpaulo m = next; 1029251538Srpaulo } 1030251538Srpaulo break; 1031251538Srpaulo default: 1032251538Srpaulo /* needs it to the inactive queue due to a error. */ 1033251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_active); 1034251538Srpaulo if (data != NULL) { 1035251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 1036251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 1037251538Srpaulo } 1038251538Srpaulo if (error != USB_ERR_CANCELLED) { 1039251538Srpaulo usbd_xfer_set_stall(xfer); 1040287197Sglebius counter_u64_add(ic->ic_ierrors, 1); 1041251538Srpaulo goto tr_setup; 1042251538Srpaulo } 1043251538Srpaulo break; 1044251538Srpaulo } 1045251538Srpaulo} 1046251538Srpaulo 1047251538Srpaulostatic void 1048289891Savosurtwn_txeof(struct urtwn_softc *sc, struct urtwn_data *data, int status) 1049251538Srpaulo{ 1050251538Srpaulo 1051251538Srpaulo URTWN_ASSERT_LOCKED(sc); 1052289891Savos 1053290631Savos if (data->ni != NULL) /* not a beacon frame */ 1054290631Savos ieee80211_tx_complete(data->ni, data->m, status); 1055289891Savos 1056287197Sglebius data->ni = NULL; 1057287197Sglebius data->m = NULL; 1058289891Savos 1059251538Srpaulo sc->sc_txtimer = 0; 1060289891Savos 1061289891Savos STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data, next); 1062251538Srpaulo} 1063251538Srpaulo 1064289066Skevlostatic int 1065289066Skevlourtwn_alloc_list(struct urtwn_softc *sc, struct urtwn_data data[], 1066289066Skevlo int ndata, int maxsz) 1067289066Skevlo{ 1068289066Skevlo int i, error; 1069289066Skevlo 1070289066Skevlo for (i = 0; i < ndata; i++) { 1071289066Skevlo struct urtwn_data *dp = &data[i]; 1072289066Skevlo dp->sc = sc; 1073289066Skevlo dp->m = NULL; 1074289066Skevlo dp->buf = malloc(maxsz, M_USBDEV, M_NOWAIT); 1075289066Skevlo if (dp->buf == NULL) { 1076289066Skevlo device_printf(sc->sc_dev, 1077289066Skevlo "could not allocate buffer\n"); 1078289066Skevlo error = ENOMEM; 1079289066Skevlo goto fail; 1080289066Skevlo } 1081289066Skevlo dp->ni = NULL; 1082289066Skevlo } 1083289066Skevlo 1084289066Skevlo return (0); 1085289066Skevlofail: 1086289066Skevlo urtwn_free_list(sc, data, ndata); 1087289066Skevlo return (error); 1088289066Skevlo} 1089289066Skevlo 1090289066Skevlostatic int 1091289066Skevlourtwn_alloc_rx_list(struct urtwn_softc *sc) 1092289066Skevlo{ 1093289066Skevlo int error, i; 1094289066Skevlo 1095289066Skevlo error = urtwn_alloc_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT, 1096289066Skevlo URTWN_RXBUFSZ); 1097289066Skevlo if (error != 0) 1098289066Skevlo return (error); 1099289066Skevlo 1100289066Skevlo STAILQ_INIT(&sc->sc_rx_active); 1101289066Skevlo STAILQ_INIT(&sc->sc_rx_inactive); 1102289066Skevlo 1103289066Skevlo for (i = 0; i < URTWN_RX_LIST_COUNT; i++) 1104289066Skevlo STAILQ_INSERT_HEAD(&sc->sc_rx_inactive, &sc->sc_rx[i], next); 1105289066Skevlo 1106289066Skevlo return (0); 1107289066Skevlo} 1108289066Skevlo 1109289066Skevlostatic int 1110289066Skevlourtwn_alloc_tx_list(struct urtwn_softc *sc) 1111289066Skevlo{ 1112289066Skevlo int error, i; 1113289066Skevlo 1114289066Skevlo error = urtwn_alloc_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT, 1115289066Skevlo URTWN_TXBUFSZ); 1116289066Skevlo if (error != 0) 1117289066Skevlo return (error); 1118289066Skevlo 1119289066Skevlo STAILQ_INIT(&sc->sc_tx_active); 1120289066Skevlo STAILQ_INIT(&sc->sc_tx_inactive); 1121289066Skevlo STAILQ_INIT(&sc->sc_tx_pending); 1122289066Skevlo 1123289066Skevlo for (i = 0; i < URTWN_TX_LIST_COUNT; i++) 1124289066Skevlo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, &sc->sc_tx[i], next); 1125289066Skevlo 1126289066Skevlo return (0); 1127289066Skevlo} 1128289066Skevlo 1129251538Srpaulostatic void 1130289066Skevlourtwn_free_list(struct urtwn_softc *sc, struct urtwn_data data[], int ndata) 1131289066Skevlo{ 1132289066Skevlo int i; 1133289066Skevlo 1134289066Skevlo for (i = 0; i < ndata; i++) { 1135289066Skevlo struct urtwn_data *dp = &data[i]; 1136289066Skevlo 1137289066Skevlo if (dp->buf != NULL) { 1138289066Skevlo free(dp->buf, M_USBDEV); 1139289066Skevlo dp->buf = NULL; 1140289066Skevlo } 1141289066Skevlo if (dp->ni != NULL) { 1142289066Skevlo ieee80211_free_node(dp->ni); 1143289066Skevlo dp->ni = NULL; 1144289066Skevlo } 1145289066Skevlo } 1146289066Skevlo} 1147289066Skevlo 1148289066Skevlostatic void 1149289066Skevlourtwn_free_rx_list(struct urtwn_softc *sc) 1150289066Skevlo{ 1151289066Skevlo urtwn_free_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT); 1152289066Skevlo} 1153289066Skevlo 1154289066Skevlostatic void 1155289066Skevlourtwn_free_tx_list(struct urtwn_softc *sc) 1156289066Skevlo{ 1157289066Skevlo urtwn_free_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT); 1158289066Skevlo} 1159289066Skevlo 1160289066Skevlostatic void 1161251538Srpaulourtwn_bulk_tx_callback(struct usb_xfer *xfer, usb_error_t error) 1162251538Srpaulo{ 1163251538Srpaulo struct urtwn_softc *sc = usbd_xfer_softc(xfer); 1164251538Srpaulo struct urtwn_data *data; 1165251538Srpaulo 1166251538Srpaulo URTWN_ASSERT_LOCKED(sc); 1167251538Srpaulo 1168251538Srpaulo switch (USB_GET_STATE(xfer)){ 1169251538Srpaulo case USB_ST_TRANSFERRED: 1170251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_active); 1171251538Srpaulo if (data == NULL) 1172251538Srpaulo goto tr_setup; 1173251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next); 1174289891Savos urtwn_txeof(sc, data, 0); 1175251538Srpaulo /* FALLTHROUGH */ 1176251538Srpaulo case USB_ST_SETUP: 1177251538Srpaulotr_setup: 1178251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_pending); 1179251538Srpaulo if (data == NULL) { 1180251538Srpaulo DPRINTF("%s: empty pending queue\n", __func__); 1181288353Sadrian goto finish; 1182251538Srpaulo } 1183251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_pending, next); 1184251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_tx_active, data, next); 1185251538Srpaulo usbd_xfer_set_frame_data(xfer, 0, data->buf, data->buflen); 1186251538Srpaulo usbd_transfer_submit(xfer); 1187251538Srpaulo break; 1188251538Srpaulo default: 1189251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_active); 1190251538Srpaulo if (data == NULL) 1191251538Srpaulo goto tr_setup; 1192289891Savos STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next); 1193289891Savos urtwn_txeof(sc, data, 1); 1194251538Srpaulo if (error != USB_ERR_CANCELLED) { 1195251538Srpaulo usbd_xfer_set_stall(xfer); 1196251538Srpaulo goto tr_setup; 1197251538Srpaulo } 1198251538Srpaulo break; 1199251538Srpaulo } 1200288353Sadrianfinish: 1201288353Sadrian /* Kick-start more transmit */ 1202288353Sadrian urtwn_start(sc); 1203251538Srpaulo} 1204251538Srpaulo 1205251538Srpaulostatic struct urtwn_data * 1206251538Srpaulo_urtwn_getbuf(struct urtwn_softc *sc) 1207251538Srpaulo{ 1208251538Srpaulo struct urtwn_data *bf; 1209251538Srpaulo 1210251538Srpaulo bf = STAILQ_FIRST(&sc->sc_tx_inactive); 1211251538Srpaulo if (bf != NULL) 1212251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_inactive, next); 1213251538Srpaulo else 1214251538Srpaulo DPRINTF("%s: %s\n", __func__, "out of xmit buffers"); 1215251538Srpaulo return (bf); 1216251538Srpaulo} 1217251538Srpaulo 1218251538Srpaulostatic struct urtwn_data * 1219251538Srpaulourtwn_getbuf(struct urtwn_softc *sc) 1220251538Srpaulo{ 1221251538Srpaulo struct urtwn_data *bf; 1222251538Srpaulo 1223251538Srpaulo URTWN_ASSERT_LOCKED(sc); 1224251538Srpaulo 1225251538Srpaulo bf = _urtwn_getbuf(sc); 1226287197Sglebius if (bf == NULL) 1227251538Srpaulo DPRINTF("%s: stop queue\n", __func__); 1228251538Srpaulo return (bf); 1229251538Srpaulo} 1230251538Srpaulo 1231291698Savosstatic usb_error_t 1232251538Srpaulourtwn_write_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf, 1233251538Srpaulo int len) 1234251538Srpaulo{ 1235251538Srpaulo usb_device_request_t req; 1236251538Srpaulo 1237251538Srpaulo req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 1238251538Srpaulo req.bRequest = R92C_REQ_REGS; 1239251538Srpaulo USETW(req.wValue, addr); 1240251538Srpaulo USETW(req.wIndex, 0); 1241251538Srpaulo USETW(req.wLength, len); 1242251538Srpaulo return (urtwn_do_request(sc, &req, buf)); 1243251538Srpaulo} 1244251538Srpaulo 1245291698Savosstatic usb_error_t 1246251538Srpaulourtwn_write_1(struct urtwn_softc *sc, uint16_t addr, uint8_t val) 1247251538Srpaulo{ 1248291698Savos return (urtwn_write_region_1(sc, addr, &val, sizeof(val))); 1249251538Srpaulo} 1250251538Srpaulo 1251291698Savosstatic usb_error_t 1252251538Srpaulourtwn_write_2(struct urtwn_softc *sc, uint16_t addr, uint16_t val) 1253251538Srpaulo{ 1254251538Srpaulo val = htole16(val); 1255291698Savos return (urtwn_write_region_1(sc, addr, (uint8_t *)&val, sizeof(val))); 1256251538Srpaulo} 1257251538Srpaulo 1258291698Savosstatic usb_error_t 1259251538Srpaulourtwn_write_4(struct urtwn_softc *sc, uint16_t addr, uint32_t val) 1260251538Srpaulo{ 1261251538Srpaulo val = htole32(val); 1262291698Savos return (urtwn_write_region_1(sc, addr, (uint8_t *)&val, sizeof(val))); 1263251538Srpaulo} 1264251538Srpaulo 1265291698Savosstatic usb_error_t 1266251538Srpaulourtwn_read_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf, 1267251538Srpaulo int len) 1268251538Srpaulo{ 1269251538Srpaulo usb_device_request_t req; 1270251538Srpaulo 1271251538Srpaulo req.bmRequestType = UT_READ_VENDOR_DEVICE; 1272251538Srpaulo req.bRequest = R92C_REQ_REGS; 1273251538Srpaulo USETW(req.wValue, addr); 1274251538Srpaulo USETW(req.wIndex, 0); 1275251538Srpaulo USETW(req.wLength, len); 1276251538Srpaulo return (urtwn_do_request(sc, &req, buf)); 1277251538Srpaulo} 1278251538Srpaulo 1279251538Srpaulostatic uint8_t 1280251538Srpaulourtwn_read_1(struct urtwn_softc *sc, uint16_t addr) 1281251538Srpaulo{ 1282251538Srpaulo uint8_t val; 1283251538Srpaulo 1284251538Srpaulo if (urtwn_read_region_1(sc, addr, &val, 1) != 0) 1285251538Srpaulo return (0xff); 1286251538Srpaulo return (val); 1287251538Srpaulo} 1288251538Srpaulo 1289251538Srpaulostatic uint16_t 1290251538Srpaulourtwn_read_2(struct urtwn_softc *sc, uint16_t addr) 1291251538Srpaulo{ 1292251538Srpaulo uint16_t val; 1293251538Srpaulo 1294251538Srpaulo if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 2) != 0) 1295251538Srpaulo return (0xffff); 1296251538Srpaulo return (le16toh(val)); 1297251538Srpaulo} 1298251538Srpaulo 1299251538Srpaulostatic uint32_t 1300251538Srpaulourtwn_read_4(struct urtwn_softc *sc, uint16_t addr) 1301251538Srpaulo{ 1302251538Srpaulo uint32_t val; 1303251538Srpaulo 1304251538Srpaulo if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 4) != 0) 1305251538Srpaulo return (0xffffffff); 1306251538Srpaulo return (le32toh(val)); 1307251538Srpaulo} 1308251538Srpaulo 1309251538Srpaulostatic int 1310251538Srpaulourtwn_fw_cmd(struct urtwn_softc *sc, uint8_t id, const void *buf, int len) 1311251538Srpaulo{ 1312251538Srpaulo struct r92c_fw_cmd cmd; 1313291698Savos usb_error_t error; 1314251538Srpaulo int ntries; 1315251538Srpaulo 1316251538Srpaulo /* Wait for current FW box to be empty. */ 1317251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 1318251538Srpaulo if (!(urtwn_read_1(sc, R92C_HMETFR) & (1 << sc->fwcur))) 1319251538Srpaulo break; 1320266472Shselasky urtwn_ms_delay(sc); 1321251538Srpaulo } 1322251538Srpaulo if (ntries == 100) { 1323251538Srpaulo device_printf(sc->sc_dev, 1324251538Srpaulo "could not send firmware command\n"); 1325251538Srpaulo return (ETIMEDOUT); 1326251538Srpaulo } 1327251538Srpaulo memset(&cmd, 0, sizeof(cmd)); 1328251538Srpaulo cmd.id = id; 1329251538Srpaulo if (len > 3) 1330251538Srpaulo cmd.id |= R92C_CMD_FLAG_EXT; 1331251538Srpaulo KASSERT(len <= sizeof(cmd.msg), ("urtwn_fw_cmd\n")); 1332251538Srpaulo memcpy(cmd.msg, buf, len); 1333251538Srpaulo 1334251538Srpaulo /* Write the first word last since that will trigger the FW. */ 1335291698Savos error = urtwn_write_region_1(sc, R92C_HMEBOX_EXT(sc->fwcur), 1336251538Srpaulo (uint8_t *)&cmd + 4, 2); 1337291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1338291698Savos return (EIO); 1339291698Savos error = urtwn_write_region_1(sc, R92C_HMEBOX(sc->fwcur), 1340251538Srpaulo (uint8_t *)&cmd + 0, 4); 1341291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1342291698Savos return (EIO); 1343251538Srpaulo 1344251538Srpaulo sc->fwcur = (sc->fwcur + 1) % R92C_H2C_NBOX; 1345251538Srpaulo return (0); 1346251538Srpaulo} 1347251538Srpaulo 1348292174Savosstatic void 1349292174Savosurtwn_cmdq_cb(void *arg, int pending) 1350292174Savos{ 1351292174Savos struct urtwn_softc *sc = arg; 1352292174Savos struct urtwn_cmdq *item; 1353292174Savos 1354292174Savos /* 1355292174Savos * Device must be powered on (via urtwn_power_on()) 1356292174Savos * before any command may be sent. 1357292174Savos */ 1358292174Savos URTWN_LOCK(sc); 1359292174Savos if (!(sc->sc_flags & URTWN_RUNNING)) { 1360292174Savos URTWN_UNLOCK(sc); 1361292174Savos return; 1362292174Savos } 1363292174Savos 1364292174Savos URTWN_CMDQ_LOCK(sc); 1365292174Savos while (sc->cmdq[sc->cmdq_first].func != NULL) { 1366292174Savos item = &sc->cmdq[sc->cmdq_first]; 1367292174Savos sc->cmdq_first = (sc->cmdq_first + 1) % URTWN_CMDQ_SIZE; 1368292174Savos URTWN_CMDQ_UNLOCK(sc); 1369292174Savos 1370292174Savos item->func(sc, &item->data); 1371292174Savos 1372292174Savos URTWN_CMDQ_LOCK(sc); 1373292174Savos memset(item, 0, sizeof (*item)); 1374292174Savos } 1375292174Savos URTWN_CMDQ_UNLOCK(sc); 1376292174Savos URTWN_UNLOCK(sc); 1377292174Savos} 1378292174Savos 1379292174Savosstatic int 1380292174Savosurtwn_cmd_sleepable(struct urtwn_softc *sc, const void *ptr, size_t len, 1381292174Savos CMD_FUNC_PROTO) 1382292174Savos{ 1383292174Savos struct ieee80211com *ic = &sc->sc_ic; 1384292174Savos 1385292174Savos KASSERT(len <= sizeof(union sec_param), ("buffer overflow")); 1386292174Savos 1387292174Savos URTWN_CMDQ_LOCK(sc); 1388292174Savos if (sc->cmdq[sc->cmdq_last].func != NULL) { 1389292174Savos device_printf(sc->sc_dev, "%s: cmdq overflow\n", __func__); 1390292174Savos URTWN_CMDQ_UNLOCK(sc); 1391292174Savos 1392292174Savos return (EAGAIN); 1393292174Savos } 1394292174Savos 1395292174Savos if (ptr != NULL) 1396292174Savos memcpy(&sc->cmdq[sc->cmdq_last].data, ptr, len); 1397292174Savos sc->cmdq[sc->cmdq_last].func = func; 1398292174Savos sc->cmdq_last = (sc->cmdq_last + 1) % URTWN_CMDQ_SIZE; 1399292174Savos URTWN_CMDQ_UNLOCK(sc); 1400292174Savos 1401292174Savos ieee80211_runtask(ic, &sc->cmdq_task); 1402292174Savos 1403292174Savos return (0); 1404292174Savos} 1405292174Savos 1406264912Skevlostatic __inline void 1407251538Srpaulourtwn_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, uint32_t val) 1408251538Srpaulo{ 1409264912Skevlo 1410264912Skevlo sc->sc_rf_write(sc, chain, addr, val); 1411264912Skevlo} 1412264912Skevlo 1413264912Skevlostatic void 1414264912Skevlourtwn_r92c_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, 1415264912Skevlo uint32_t val) 1416264912Skevlo{ 1417251538Srpaulo urtwn_bb_write(sc, R92C_LSSI_PARAM(chain), 1418251538Srpaulo SM(R92C_LSSI_PARAM_ADDR, addr) | 1419251538Srpaulo SM(R92C_LSSI_PARAM_DATA, val)); 1420251538Srpaulo} 1421251538Srpaulo 1422264912Skevlostatic void 1423264912Skevlourtwn_r88e_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, 1424264912Skevlouint32_t val) 1425264912Skevlo{ 1426264912Skevlo urtwn_bb_write(sc, R92C_LSSI_PARAM(chain), 1427264912Skevlo SM(R88E_LSSI_PARAM_ADDR, addr) | 1428264912Skevlo SM(R92C_LSSI_PARAM_DATA, val)); 1429264912Skevlo} 1430264912Skevlo 1431251538Srpaulostatic uint32_t 1432251538Srpaulourtwn_rf_read(struct urtwn_softc *sc, int chain, uint8_t addr) 1433251538Srpaulo{ 1434251538Srpaulo uint32_t reg[R92C_MAX_CHAINS], val; 1435251538Srpaulo 1436251538Srpaulo reg[0] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)); 1437251538Srpaulo if (chain != 0) 1438251538Srpaulo reg[chain] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(chain)); 1439251538Srpaulo 1440251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(0), 1441251538Srpaulo reg[0] & ~R92C_HSSI_PARAM2_READ_EDGE); 1442266472Shselasky urtwn_ms_delay(sc); 1443251538Srpaulo 1444251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(chain), 1445251538Srpaulo RW(reg[chain], R92C_HSSI_PARAM2_READ_ADDR, addr) | 1446251538Srpaulo R92C_HSSI_PARAM2_READ_EDGE); 1447266472Shselasky urtwn_ms_delay(sc); 1448251538Srpaulo 1449251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(0), 1450251538Srpaulo reg[0] | R92C_HSSI_PARAM2_READ_EDGE); 1451266472Shselasky urtwn_ms_delay(sc); 1452251538Srpaulo 1453251538Srpaulo if (urtwn_bb_read(sc, R92C_HSSI_PARAM1(chain)) & R92C_HSSI_PARAM1_PI) 1454251538Srpaulo val = urtwn_bb_read(sc, R92C_HSPI_READBACK(chain)); 1455251538Srpaulo else 1456251538Srpaulo val = urtwn_bb_read(sc, R92C_LSSI_READBACK(chain)); 1457251538Srpaulo return (MS(val, R92C_LSSI_READBACK_DATA)); 1458251538Srpaulo} 1459251538Srpaulo 1460251538Srpaulostatic int 1461251538Srpaulourtwn_llt_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data) 1462251538Srpaulo{ 1463291698Savos usb_error_t error; 1464251538Srpaulo int ntries; 1465251538Srpaulo 1466291698Savos error = urtwn_write_4(sc, R92C_LLT_INIT, 1467251538Srpaulo SM(R92C_LLT_INIT_OP, R92C_LLT_INIT_OP_WRITE) | 1468251538Srpaulo SM(R92C_LLT_INIT_ADDR, addr) | 1469251538Srpaulo SM(R92C_LLT_INIT_DATA, data)); 1470291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1471291698Savos return (EIO); 1472251538Srpaulo /* Wait for write operation to complete. */ 1473251538Srpaulo for (ntries = 0; ntries < 20; ntries++) { 1474251538Srpaulo if (MS(urtwn_read_4(sc, R92C_LLT_INIT), R92C_LLT_INIT_OP) == 1475251538Srpaulo R92C_LLT_INIT_OP_NO_ACTIVE) 1476251538Srpaulo return (0); 1477266472Shselasky urtwn_ms_delay(sc); 1478251538Srpaulo } 1479251538Srpaulo return (ETIMEDOUT); 1480251538Srpaulo} 1481251538Srpaulo 1482291264Savosstatic int 1483291264Savosurtwn_efuse_read_next(struct urtwn_softc *sc, uint8_t *val) 1484251538Srpaulo{ 1485251538Srpaulo uint32_t reg; 1486291698Savos usb_error_t error; 1487251538Srpaulo int ntries; 1488251538Srpaulo 1489291264Savos if (sc->last_rom_addr >= URTWN_EFUSE_MAX_LEN) 1490291264Savos return (EFAULT); 1491291264Savos 1492251538Srpaulo reg = urtwn_read_4(sc, R92C_EFUSE_CTRL); 1493291264Savos reg = RW(reg, R92C_EFUSE_CTRL_ADDR, sc->last_rom_addr); 1494251538Srpaulo reg &= ~R92C_EFUSE_CTRL_VALID; 1495291264Savos 1496291698Savos error = urtwn_write_4(sc, R92C_EFUSE_CTRL, reg); 1497291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1498291698Savos return (EIO); 1499251538Srpaulo /* Wait for read operation to complete. */ 1500251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 1501251538Srpaulo reg = urtwn_read_4(sc, R92C_EFUSE_CTRL); 1502251538Srpaulo if (reg & R92C_EFUSE_CTRL_VALID) 1503291264Savos break; 1504266472Shselasky urtwn_ms_delay(sc); 1505251538Srpaulo } 1506291264Savos if (ntries == 100) { 1507291264Savos device_printf(sc->sc_dev, 1508291264Savos "could not read efuse byte at address 0x%x\n", 1509291264Savos sc->last_rom_addr); 1510291264Savos return (ETIMEDOUT); 1511291264Savos } 1512291264Savos 1513291264Savos *val = MS(reg, R92C_EFUSE_CTRL_DATA); 1514291264Savos sc->last_rom_addr++; 1515291264Savos 1516291264Savos return (0); 1517251538Srpaulo} 1518251538Srpaulo 1519291264Savosstatic int 1520291264Savosurtwn_efuse_read_data(struct urtwn_softc *sc, uint8_t *rom, uint8_t off, 1521291264Savos uint8_t msk) 1522291264Savos{ 1523291264Savos uint8_t reg; 1524291264Savos int i, error; 1525291264Savos 1526291264Savos for (i = 0; i < 4; i++) { 1527291264Savos if (msk & (1 << i)) 1528291264Savos continue; 1529291264Savos error = urtwn_efuse_read_next(sc, ®); 1530291264Savos if (error != 0) 1531291264Savos return (error); 1532291264Savos DPRINTF("rom[0x%03X] == 0x%02X\n", off * 8 + i * 2, reg); 1533291264Savos rom[off * 8 + i * 2 + 0] = reg; 1534291264Savos 1535291264Savos error = urtwn_efuse_read_next(sc, ®); 1536291264Savos if (error != 0) 1537291264Savos return (error); 1538291264Savos DPRINTF("rom[0x%03X] == 0x%02X\n", off * 8 + i * 2 + 1, reg); 1539291264Savos rom[off * 8 + i * 2 + 1] = reg; 1540291264Savos } 1541291264Savos 1542291264Savos return (0); 1543291264Savos} 1544291264Savos 1545291264Savos#ifdef URTWN_DEBUG 1546251538Srpaulostatic void 1547291264Savosurtwn_dump_rom_contents(struct urtwn_softc *sc, uint8_t *rom, uint16_t size) 1548251538Srpaulo{ 1549251538Srpaulo int i; 1550251538Srpaulo 1551291264Savos /* Dump ROM contents. */ 1552291264Savos device_printf(sc->sc_dev, "%s:", __func__); 1553291264Savos for (i = 0; i < size; i++) { 1554291264Savos if (i % 32 == 0) 1555291264Savos printf("\n%03X: ", i); 1556291264Savos else if (i % 4 == 0) 1557291264Savos printf(" "); 1558291264Savos 1559291264Savos printf("%02X", rom[i]); 1560291264Savos } 1561291264Savos printf("\n"); 1562291264Savos} 1563291264Savos#endif 1564291264Savos 1565291264Savosstatic int 1566291264Savosurtwn_efuse_read(struct urtwn_softc *sc, uint8_t *rom, uint16_t size) 1567291264Savos{ 1568291264Savos#define URTWN_CHK(res) do { \ 1569291264Savos if ((error = res) != 0) \ 1570291264Savos goto end; \ 1571291264Savos} while(0) 1572291264Savos uint8_t msk, off, reg; 1573291264Savos int error; 1574291264Savos 1575291698Savos URTWN_CHK(urtwn_efuse_switch_power(sc)); 1576264912Skevlo 1577291264Savos /* Read full ROM image. */ 1578291264Savos sc->last_rom_addr = 0; 1579291264Savos memset(rom, 0xff, size); 1580291264Savos 1581291264Savos URTWN_CHK(urtwn_efuse_read_next(sc, ®)); 1582291264Savos while (reg != 0xff) { 1583291264Savos /* check for extended header */ 1584291264Savos if ((sc->chip & URTWN_CHIP_88E) && (reg & 0x1f) == 0x0f) { 1585291264Savos off = reg >> 5; 1586291264Savos URTWN_CHK(urtwn_efuse_read_next(sc, ®)); 1587291264Savos 1588291264Savos if ((reg & 0x0f) != 0x0f) 1589291264Savos off = ((reg & 0xf0) >> 1) | off; 1590291264Savos else 1591291264Savos continue; 1592291264Savos } else 1593291264Savos off = reg >> 4; 1594251538Srpaulo msk = reg & 0xf; 1595291264Savos 1596291264Savos URTWN_CHK(urtwn_efuse_read_data(sc, rom, off, msk)); 1597291264Savos URTWN_CHK(urtwn_efuse_read_next(sc, ®)); 1598251538Srpaulo } 1599291264Savos 1600291264Savosend: 1601291264Savos 1602251538Srpaulo#ifdef URTWN_DEBUG 1603291264Savos if (urtwn_debug >= 2) 1604291264Savos urtwn_dump_rom_contents(sc, rom, size); 1605251538Srpaulo#endif 1606291264Savos 1607282623Skevlo urtwn_write_1(sc, R92C_EFUSE_ACCESS, R92C_EFUSE_ACCESS_OFF); 1608291264Savos 1609291264Savos if (error != 0) { 1610291264Savos device_printf(sc->sc_dev, "%s: error while reading ROM\n", 1611291264Savos __func__); 1612291264Savos } 1613291264Savos 1614291264Savos return (error); 1615291264Savos#undef URTWN_CHK 1616282623Skevlo} 1617281592Skevlo 1618291698Savosstatic int 1619264912Skevlourtwn_efuse_switch_power(struct urtwn_softc *sc) 1620264912Skevlo{ 1621291698Savos usb_error_t error; 1622264912Skevlo uint32_t reg; 1623251538Srpaulo 1624291698Savos error = urtwn_write_1(sc, R92C_EFUSE_ACCESS, R92C_EFUSE_ACCESS_ON); 1625291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1626291698Savos return (EIO); 1627281918Skevlo 1628264912Skevlo reg = urtwn_read_2(sc, R92C_SYS_ISO_CTRL); 1629264912Skevlo if (!(reg & R92C_SYS_ISO_CTRL_PWC_EV12V)) { 1630291698Savos error = urtwn_write_2(sc, R92C_SYS_ISO_CTRL, 1631264912Skevlo reg | R92C_SYS_ISO_CTRL_PWC_EV12V); 1632291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1633291698Savos return (EIO); 1634264912Skevlo } 1635264912Skevlo reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN); 1636264912Skevlo if (!(reg & R92C_SYS_FUNC_EN_ELDR)) { 1637291698Savos error = urtwn_write_2(sc, R92C_SYS_FUNC_EN, 1638264912Skevlo reg | R92C_SYS_FUNC_EN_ELDR); 1639291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1640291698Savos return (EIO); 1641264912Skevlo } 1642264912Skevlo reg = urtwn_read_2(sc, R92C_SYS_CLKR); 1643264912Skevlo if ((reg & (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) != 1644264912Skevlo (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) { 1645291698Savos error = urtwn_write_2(sc, R92C_SYS_CLKR, 1646264912Skevlo reg | R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M); 1647291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1648291698Savos return (EIO); 1649264912Skevlo } 1650291698Savos 1651291698Savos return (0); 1652264912Skevlo} 1653264912Skevlo 1654251538Srpaulostatic int 1655251538Srpaulourtwn_read_chipid(struct urtwn_softc *sc) 1656251538Srpaulo{ 1657251538Srpaulo uint32_t reg; 1658251538Srpaulo 1659264912Skevlo if (sc->chip & URTWN_CHIP_88E) 1660264912Skevlo return (0); 1661264912Skevlo 1662251538Srpaulo reg = urtwn_read_4(sc, R92C_SYS_CFG); 1663251538Srpaulo if (reg & R92C_SYS_CFG_TRP_VAUX_EN) 1664251538Srpaulo return (EIO); 1665251538Srpaulo 1666251538Srpaulo if (reg & R92C_SYS_CFG_TYPE_92C) { 1667251538Srpaulo sc->chip |= URTWN_CHIP_92C; 1668251538Srpaulo /* Check if it is a castrated 8192C. */ 1669251538Srpaulo if (MS(urtwn_read_4(sc, R92C_HPON_FSM), 1670251538Srpaulo R92C_HPON_FSM_CHIP_BONDING_ID) == 1671251538Srpaulo R92C_HPON_FSM_CHIP_BONDING_ID_92C_1T2R) 1672251538Srpaulo sc->chip |= URTWN_CHIP_92C_1T2R; 1673251538Srpaulo } 1674251538Srpaulo if (reg & R92C_SYS_CFG_VENDOR_UMC) { 1675251538Srpaulo sc->chip |= URTWN_CHIP_UMC; 1676251538Srpaulo if (MS(reg, R92C_SYS_CFG_CHIP_VER_RTL) == 0) 1677251538Srpaulo sc->chip |= URTWN_CHIP_UMC_A_CUT; 1678251538Srpaulo } 1679251538Srpaulo return (0); 1680251538Srpaulo} 1681251538Srpaulo 1682291264Savosstatic int 1683251538Srpaulourtwn_read_rom(struct urtwn_softc *sc) 1684251538Srpaulo{ 1685291264Savos struct r92c_rom *rom = &sc->rom.r92c_rom; 1686291264Savos int error; 1687251538Srpaulo 1688251538Srpaulo /* Read full ROM image. */ 1689291264Savos error = urtwn_efuse_read(sc, (uint8_t *)rom, sizeof(*rom)); 1690291264Savos if (error != 0) 1691291264Savos return (error); 1692251538Srpaulo 1693251538Srpaulo /* XXX Weird but this is what the vendor driver does. */ 1694291264Savos sc->last_rom_addr = 0x1fa; 1695291264Savos error = urtwn_efuse_read_next(sc, &sc->pa_setting); 1696291264Savos if (error != 0) 1697291264Savos return (error); 1698251538Srpaulo DPRINTF("PA setting=0x%x\n", sc->pa_setting); 1699251538Srpaulo 1700251538Srpaulo sc->board_type = MS(rom->rf_opt1, R92C_ROM_RF1_BOARD_TYPE); 1701251538Srpaulo 1702251538Srpaulo sc->regulatory = MS(rom->rf_opt1, R92C_ROM_RF1_REGULATORY); 1703251538Srpaulo DPRINTF("regulatory type=%d\n", sc->regulatory); 1704287197Sglebius IEEE80211_ADDR_COPY(sc->sc_ic.ic_macaddr, rom->macaddr); 1705251538Srpaulo 1706264912Skevlo sc->sc_rf_write = urtwn_r92c_rf_write; 1707264912Skevlo sc->sc_power_on = urtwn_r92c_power_on; 1708291264Savos 1709291264Savos return (0); 1710251538Srpaulo} 1711251538Srpaulo 1712291264Savosstatic int 1713264912Skevlourtwn_r88e_read_rom(struct urtwn_softc *sc) 1714264912Skevlo{ 1715294198Savos struct r88e_rom *rom = &sc->rom.r88e_rom; 1716294198Savos int error; 1717264912Skevlo 1718294198Savos error = urtwn_efuse_read(sc, (uint8_t *)rom, sizeof(sc->rom.r88e_rom)); 1719291264Savos if (error != 0) 1720291264Savos return (error); 1721264912Skevlo 1722294198Savos sc->bw20_tx_pwr_diff = (rom->tx_pwr_diff >> 4); 1723264912Skevlo if (sc->bw20_tx_pwr_diff & 0x08) 1724264912Skevlo sc->bw20_tx_pwr_diff |= 0xf0; 1725294198Savos sc->ofdm_tx_pwr_diff = (rom->tx_pwr_diff & 0xf); 1726264912Skevlo if (sc->ofdm_tx_pwr_diff & 0x08) 1727264912Skevlo sc->ofdm_tx_pwr_diff |= 0xf0; 1728294198Savos sc->regulatory = MS(rom->rf_board_opt, R92C_ROM_RF1_REGULATORY); 1729294198Savos DPRINTF("regulatory type=%d\n", sc->regulatory); 1730294198Savos IEEE80211_ADDR_COPY(sc->sc_ic.ic_macaddr, rom->macaddr); 1731264912Skevlo 1732264912Skevlo sc->sc_rf_write = urtwn_r88e_rf_write; 1733264912Skevlo sc->sc_power_on = urtwn_r88e_power_on; 1734291264Savos 1735291264Savos return (0); 1736264912Skevlo} 1737264912Skevlo 1738251538Srpaulo/* 1739251538Srpaulo * Initialize rate adaptation in firmware. 1740251538Srpaulo */ 1741251538Srpaulostatic int 1742251538Srpaulourtwn_ra_init(struct urtwn_softc *sc) 1743251538Srpaulo{ 1744287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 1745251538Srpaulo struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 1746251538Srpaulo struct ieee80211_node *ni; 1747251538Srpaulo struct ieee80211_rateset *rs; 1748251538Srpaulo struct r92c_fw_cmd_macid_cfg cmd; 1749251538Srpaulo uint32_t rates, basicrates; 1750251538Srpaulo uint8_t mode; 1751251538Srpaulo int maxrate, maxbasicrate, error, i, j; 1752251538Srpaulo 1753251538Srpaulo ni = ieee80211_ref_node(vap->iv_bss); 1754251538Srpaulo rs = &ni->ni_rates; 1755251538Srpaulo 1756251538Srpaulo /* Get normal and basic rates mask. */ 1757251538Srpaulo rates = basicrates = 0; 1758251538Srpaulo maxrate = maxbasicrate = 0; 1759251538Srpaulo for (i = 0; i < rs->rs_nrates; i++) { 1760251538Srpaulo /* Convert 802.11 rate to HW rate index. */ 1761289758Savos for (j = 0; j < nitems(ridx2rate); j++) 1762289758Savos if ((rs->rs_rates[i] & IEEE80211_RATE_VAL) == 1763289758Savos ridx2rate[j]) 1764251538Srpaulo break; 1765289758Savos if (j == nitems(ridx2rate)) /* Unknown rate, skip. */ 1766251538Srpaulo continue; 1767251538Srpaulo rates |= 1 << j; 1768251538Srpaulo if (j > maxrate) 1769251538Srpaulo maxrate = j; 1770251538Srpaulo if (rs->rs_rates[i] & IEEE80211_RATE_BASIC) { 1771251538Srpaulo basicrates |= 1 << j; 1772251538Srpaulo if (j > maxbasicrate) 1773251538Srpaulo maxbasicrate = j; 1774251538Srpaulo } 1775251538Srpaulo } 1776251538Srpaulo if (ic->ic_curmode == IEEE80211_MODE_11B) 1777251538Srpaulo mode = R92C_RAID_11B; 1778251538Srpaulo else 1779251538Srpaulo mode = R92C_RAID_11BG; 1780251538Srpaulo DPRINTF("mode=0x%x rates=0x%08x, basicrates=0x%08x\n", 1781251538Srpaulo mode, rates, basicrates); 1782251538Srpaulo 1783251538Srpaulo /* Set rates mask for group addressed frames. */ 1784251538Srpaulo cmd.macid = URTWN_MACID_BC | URTWN_MACID_VALID; 1785251538Srpaulo cmd.mask = htole32(mode << 28 | basicrates); 1786251538Srpaulo error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd)); 1787251538Srpaulo if (error != 0) { 1788252401Srpaulo ieee80211_free_node(ni); 1789251538Srpaulo device_printf(sc->sc_dev, 1790251538Srpaulo "could not add broadcast station\n"); 1791251538Srpaulo return (error); 1792251538Srpaulo } 1793251538Srpaulo /* Set initial MRR rate. */ 1794251538Srpaulo DPRINTF("maxbasicrate=%d\n", maxbasicrate); 1795251538Srpaulo urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BC), 1796251538Srpaulo maxbasicrate); 1797251538Srpaulo 1798251538Srpaulo /* Set rates mask for unicast frames. */ 1799251538Srpaulo cmd.macid = URTWN_MACID_BSS | URTWN_MACID_VALID; 1800251538Srpaulo cmd.mask = htole32(mode << 28 | rates); 1801251538Srpaulo error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd)); 1802251538Srpaulo if (error != 0) { 1803252401Srpaulo ieee80211_free_node(ni); 1804251538Srpaulo device_printf(sc->sc_dev, "could not add BSS station\n"); 1805251538Srpaulo return (error); 1806251538Srpaulo } 1807251538Srpaulo /* Set initial MRR rate. */ 1808251538Srpaulo DPRINTF("maxrate=%d\n", maxrate); 1809251538Srpaulo urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BSS), 1810251538Srpaulo maxrate); 1811251538Srpaulo 1812251538Srpaulo /* Indicate highest supported rate. */ 1813252403Srpaulo ni->ni_txrate = rs->rs_rates[rs->rs_nrates - 1]; 1814252401Srpaulo ieee80211_free_node(ni); 1815252401Srpaulo 1816251538Srpaulo return (0); 1817251538Srpaulo} 1818251538Srpaulo 1819290439Savosstatic void 1820290631Savosurtwn_init_beacon(struct urtwn_softc *sc, struct urtwn_vap *uvp) 1821251538Srpaulo{ 1822290631Savos struct r92c_tx_desc *txd = &uvp->bcn_desc; 1823290631Savos 1824290631Savos txd->txdw0 = htole32( 1825290631Savos SM(R92C_TXDW0_OFFSET, sizeof(*txd)) | R92C_TXDW0_BMCAST | 1826290631Savos R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG); 1827290631Savos txd->txdw1 = htole32( 1828290631Savos SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_BEACON) | 1829290631Savos SM(R92C_TXDW1_RAID, R92C_RAID_11B)); 1830290631Savos 1831291858Savos if (sc->chip & URTWN_CHIP_88E) { 1832290631Savos txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, URTWN_MACID_BC)); 1833291858Savos txd->txdseq |= htole16(R88E_TXDSEQ_HWSEQ_EN); 1834291858Savos } else { 1835290631Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, URTWN_MACID_BC)); 1836291858Savos txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN); 1837291858Savos } 1838290631Savos 1839290631Savos txd->txdw4 = htole32(R92C_TXDW4_DRVRATE); 1840290631Savos txd->txdw5 = htole32(SM(R92C_TXDW5_DATARATE, URTWN_RIDX_CCK1)); 1841251538Srpaulo} 1842251538Srpaulo 1843290631Savosstatic int 1844290631Savosurtwn_setup_beacon(struct urtwn_softc *sc, struct ieee80211_node *ni) 1845290631Savos{ 1846290631Savos struct ieee80211vap *vap = ni->ni_vap; 1847290631Savos struct urtwn_vap *uvp = URTWN_VAP(vap); 1848290631Savos struct mbuf *m; 1849290631Savos int error; 1850290631Savos 1851290631Savos URTWN_ASSERT_LOCKED(sc); 1852290631Savos 1853290631Savos if (ni->ni_chan == IEEE80211_CHAN_ANYC) 1854290631Savos return (EINVAL); 1855290631Savos 1856290631Savos m = ieee80211_beacon_alloc(ni); 1857290631Savos if (m == NULL) { 1858290631Savos device_printf(sc->sc_dev, 1859290631Savos "%s: could not allocate beacon frame\n", __func__); 1860290631Savos return (ENOMEM); 1861290631Savos } 1862290631Savos 1863290631Savos if (uvp->bcn_mbuf != NULL) 1864290631Savos m_freem(uvp->bcn_mbuf); 1865290631Savos 1866290631Savos uvp->bcn_mbuf = m; 1867290631Savos 1868290631Savos if ((error = urtwn_tx_beacon(sc, uvp)) != 0) 1869290631Savos return (error); 1870290631Savos 1871290631Savos /* XXX bcnq stuck workaround */ 1872290631Savos if ((error = urtwn_tx_beacon(sc, uvp)) != 0) 1873290631Savos return (error); 1874290631Savos 1875290631Savos return (0); 1876290631Savos} 1877290631Savos 1878251538Srpaulostatic void 1879290631Savosurtwn_update_beacon(struct ieee80211vap *vap, int item) 1880290631Savos{ 1881290631Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 1882290631Savos struct urtwn_vap *uvp = URTWN_VAP(vap); 1883290631Savos struct ieee80211_beacon_offsets *bo = &vap->iv_bcn_off; 1884290631Savos struct ieee80211_node *ni = vap->iv_bss; 1885290631Savos int mcast = 0; 1886290631Savos 1887290631Savos URTWN_LOCK(sc); 1888290631Savos if (uvp->bcn_mbuf == NULL) { 1889290631Savos uvp->bcn_mbuf = ieee80211_beacon_alloc(ni); 1890290631Savos if (uvp->bcn_mbuf == NULL) { 1891290631Savos device_printf(sc->sc_dev, 1892290631Savos "%s: could not allocate beacon frame\n", __func__); 1893290631Savos URTWN_UNLOCK(sc); 1894290631Savos return; 1895290631Savos } 1896290631Savos } 1897290631Savos URTWN_UNLOCK(sc); 1898290631Savos 1899290631Savos if (item == IEEE80211_BEACON_TIM) 1900290631Savos mcast = 1; /* XXX */ 1901290631Savos 1902290631Savos setbit(bo->bo_flags, item); 1903290631Savos ieee80211_beacon_update(ni, uvp->bcn_mbuf, mcast); 1904290631Savos 1905290631Savos URTWN_LOCK(sc); 1906290631Savos urtwn_tx_beacon(sc, uvp); 1907290631Savos URTWN_UNLOCK(sc); 1908290631Savos} 1909290631Savos 1910290631Savos/* 1911290631Savos * Push a beacon frame into the chip. Beacon will 1912290631Savos * be repeated by the chip every R92C_BCN_INTERVAL. 1913290631Savos */ 1914290631Savosstatic int 1915290631Savosurtwn_tx_beacon(struct urtwn_softc *sc, struct urtwn_vap *uvp) 1916290631Savos{ 1917290631Savos struct r92c_tx_desc *desc = &uvp->bcn_desc; 1918290631Savos struct urtwn_data *bf; 1919290631Savos 1920290631Savos URTWN_ASSERT_LOCKED(sc); 1921290631Savos 1922290631Savos bf = urtwn_getbuf(sc); 1923290631Savos if (bf == NULL) 1924290631Savos return (ENOMEM); 1925290631Savos 1926290631Savos memcpy(bf->buf, desc, sizeof(*desc)); 1927290631Savos urtwn_tx_start(sc, uvp->bcn_mbuf, IEEE80211_FC0_TYPE_MGT, bf); 1928290631Savos 1929290631Savos sc->sc_txtimer = 5; 1930290631Savos callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 1931290631Savos 1932290631Savos return (0); 1933290631Savos} 1934290631Savos 1935292175Savosstatic int 1936292175Savosurtwn_key_alloc(struct ieee80211vap *vap, struct ieee80211_key *k, 1937292175Savos ieee80211_keyix *keyix, ieee80211_keyix *rxkeyix) 1938292175Savos{ 1939292175Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 1940292175Savos uint8_t i; 1941292175Savos 1942292175Savos if (!(&vap->iv_nw_keys[0] <= k && 1943292175Savos k < &vap->iv_nw_keys[IEEE80211_WEP_NKID])) { 1944292175Savos if (!(k->wk_flags & IEEE80211_KEY_SWCRYPT)) { 1945292175Savos URTWN_LOCK(sc); 1946292175Savos /* 1947292175Savos * First 4 slots for group keys, 1948292175Savos * what is left - for pairwise. 1949292175Savos * XXX incompatible with IBSS RSN. 1950292175Savos */ 1951292175Savos for (i = IEEE80211_WEP_NKID; 1952292175Savos i < R92C_CAM_ENTRY_COUNT; i++) { 1953292175Savos if ((sc->keys_bmap & (1 << i)) == 0) { 1954292175Savos sc->keys_bmap |= 1 << i; 1955292175Savos *keyix = i; 1956292175Savos break; 1957292175Savos } 1958292175Savos } 1959292175Savos URTWN_UNLOCK(sc); 1960292175Savos if (i == R92C_CAM_ENTRY_COUNT) { 1961292175Savos device_printf(sc->sc_dev, 1962292175Savos "%s: no free space in the key table\n", 1963292175Savos __func__); 1964292175Savos return 0; 1965292175Savos } 1966292175Savos } else 1967292175Savos *keyix = 0; 1968292175Savos } else { 1969292175Savos *keyix = k - vap->iv_nw_keys; 1970292175Savos } 1971292175Savos *rxkeyix = *keyix; 1972292175Savos return 1; 1973292175Savos} 1974292175Savos 1975290631Savosstatic void 1976292175Savosurtwn_key_set_cb(struct urtwn_softc *sc, union sec_param *data) 1977292175Savos{ 1978292175Savos struct ieee80211_key *k = &data->key; 1979292175Savos uint8_t algo, keyid; 1980292175Savos int i, error; 1981292175Savos 1982292175Savos if (k->wk_keyix < IEEE80211_WEP_NKID) 1983292175Savos keyid = k->wk_keyix; 1984292175Savos else 1985292175Savos keyid = 0; 1986292175Savos 1987292175Savos /* Map net80211 cipher to HW crypto algorithm. */ 1988292175Savos switch (k->wk_cipher->ic_cipher) { 1989292175Savos case IEEE80211_CIPHER_WEP: 1990292175Savos if (k->wk_keylen < 8) 1991292175Savos algo = R92C_CAM_ALGO_WEP40; 1992292175Savos else 1993292175Savos algo = R92C_CAM_ALGO_WEP104; 1994292175Savos break; 1995292175Savos case IEEE80211_CIPHER_TKIP: 1996292175Savos algo = R92C_CAM_ALGO_TKIP; 1997292175Savos break; 1998292175Savos case IEEE80211_CIPHER_AES_CCM: 1999292175Savos algo = R92C_CAM_ALGO_AES; 2000292175Savos break; 2001292175Savos default: 2002292175Savos device_printf(sc->sc_dev, "%s: undefined cipher %d\n", 2003292175Savos __func__, k->wk_cipher->ic_cipher); 2004292175Savos return; 2005292175Savos } 2006292175Savos 2007292175Savos DPRINTFN(9, "keyix %d, keyid %d, algo %d/%d, flags %04X, len %d, " 2008292175Savos "macaddr %s\n", k->wk_keyix, keyid, k->wk_cipher->ic_cipher, algo, 2009292175Savos k->wk_flags, k->wk_keylen, ether_sprintf(k->wk_macaddr)); 2010292175Savos 2011292175Savos /* Write key. */ 2012292175Savos for (i = 0; i < 4; i++) { 2013292175Savos error = urtwn_cam_write(sc, R92C_CAM_KEY(k->wk_keyix, i), 2014292175Savos LE_READ_4(&k->wk_key[i * 4])); 2015292175Savos if (error != 0) 2016292175Savos goto fail; 2017292175Savos } 2018292175Savos 2019292175Savos /* Write CTL0 last since that will validate the CAM entry. */ 2020292175Savos error = urtwn_cam_write(sc, R92C_CAM_CTL1(k->wk_keyix), 2021292175Savos LE_READ_4(&k->wk_macaddr[2])); 2022292175Savos if (error != 0) 2023292175Savos goto fail; 2024292175Savos error = urtwn_cam_write(sc, R92C_CAM_CTL0(k->wk_keyix), 2025292175Savos SM(R92C_CAM_ALGO, algo) | 2026292175Savos SM(R92C_CAM_KEYID, keyid) | 2027292175Savos SM(R92C_CAM_MACLO, LE_READ_2(&k->wk_macaddr[0])) | 2028292175Savos R92C_CAM_VALID); 2029292175Savos if (error != 0) 2030292175Savos goto fail; 2031292175Savos 2032292175Savos return; 2033292175Savos 2034292175Savosfail: 2035292175Savos device_printf(sc->sc_dev, "%s fails, error %d\n", __func__, error); 2036292175Savos} 2037292175Savos 2038292175Savosstatic void 2039292175Savosurtwn_key_del_cb(struct urtwn_softc *sc, union sec_param *data) 2040292175Savos{ 2041292175Savos struct ieee80211_key *k = &data->key; 2042292175Savos int i; 2043292175Savos 2044292175Savos DPRINTFN(9, "keyix %d, flags %04X, macaddr %s\n", 2045292175Savos k->wk_keyix, k->wk_flags, ether_sprintf(k->wk_macaddr)); 2046292175Savos 2047292175Savos urtwn_cam_write(sc, R92C_CAM_CTL0(k->wk_keyix), 0); 2048292175Savos urtwn_cam_write(sc, R92C_CAM_CTL1(k->wk_keyix), 0); 2049292175Savos 2050292175Savos /* Clear key. */ 2051292175Savos for (i = 0; i < 4; i++) 2052292175Savos urtwn_cam_write(sc, R92C_CAM_KEY(k->wk_keyix, i), 0); 2053292175Savos sc->keys_bmap &= ~(1 << k->wk_keyix); 2054292175Savos} 2055292175Savos 2056292175Savosstatic int 2057292175Savosurtwn_key_set(struct ieee80211vap *vap, const struct ieee80211_key *k) 2058292175Savos{ 2059292175Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2060292175Savos 2061292175Savos if (k->wk_flags & IEEE80211_KEY_SWCRYPT) { 2062292175Savos /* Not for us. */ 2063292175Savos return (1); 2064292175Savos } 2065292175Savos 2066292175Savos return (!urtwn_cmd_sleepable(sc, k, sizeof(*k), urtwn_key_set_cb)); 2067292175Savos} 2068292175Savos 2069292175Savosstatic int 2070292175Savosurtwn_key_delete(struct ieee80211vap *vap, const struct ieee80211_key *k) 2071292175Savos{ 2072292175Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2073292175Savos 2074292175Savos if (k->wk_flags & IEEE80211_KEY_SWCRYPT) { 2075292175Savos /* Not for us. */ 2076292175Savos return (1); 2077292175Savos } 2078292175Savos 2079292175Savos return (!urtwn_cmd_sleepable(sc, k, sizeof(*k), urtwn_key_del_cb)); 2080292175Savos} 2081292175Savos 2082292175Savosstatic void 2083290651Savosurtwn_tsf_task_adhoc(void *arg, int pending) 2084290651Savos{ 2085290651Savos struct ieee80211vap *vap = arg; 2086290651Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2087290651Savos struct ieee80211_node *ni; 2088290651Savos uint32_t reg; 2089290651Savos 2090290651Savos URTWN_LOCK(sc); 2091290651Savos ni = ieee80211_ref_node(vap->iv_bss); 2092290651Savos reg = urtwn_read_1(sc, R92C_BCN_CTRL); 2093290651Savos 2094290651Savos /* Accept beacons with the same BSSID. */ 2095290651Savos urtwn_set_rx_bssid_all(sc, 0); 2096290651Savos 2097290651Savos /* Enable synchronization. */ 2098290651Savos reg &= ~R92C_BCN_CTRL_DIS_TSF_UDT0; 2099290651Savos urtwn_write_1(sc, R92C_BCN_CTRL, reg); 2100290651Savos 2101290651Savos /* Synchronize. */ 2102290651Savos usb_pause_mtx(&sc->sc_mtx, hz * ni->ni_intval * 5 / 1000); 2103290651Savos 2104290651Savos /* Disable synchronization. */ 2105290651Savos reg |= R92C_BCN_CTRL_DIS_TSF_UDT0; 2106290651Savos urtwn_write_1(sc, R92C_BCN_CTRL, reg); 2107290651Savos 2108290651Savos /* Remove beacon filter. */ 2109290651Savos urtwn_set_rx_bssid_all(sc, 1); 2110290651Savos 2111290651Savos /* Enable beaconing. */ 2112290651Savos urtwn_write_1(sc, R92C_MBID_NUM, 2113290651Savos urtwn_read_1(sc, R92C_MBID_NUM) | R92C_MBID_TXBCN_RPT0); 2114290651Savos reg |= R92C_BCN_CTRL_EN_BCN; 2115290651Savos 2116290651Savos urtwn_write_1(sc, R92C_BCN_CTRL, reg); 2117290651Savos ieee80211_free_node(ni); 2118290651Savos URTWN_UNLOCK(sc); 2119290651Savos} 2120290651Savos 2121290651Savosstatic void 2122290631Savosurtwn_tsf_sync_enable(struct urtwn_softc *sc, struct ieee80211vap *vap) 2123290631Savos{ 2124290651Savos struct ieee80211com *ic = &sc->sc_ic; 2125290651Savos struct urtwn_vap *uvp = URTWN_VAP(vap); 2126290651Savos 2127290631Savos /* Reset TSF. */ 2128290631Savos urtwn_write_1(sc, R92C_DUAL_TSF_RST, R92C_DUAL_TSF_RST0); 2129290631Savos 2130290631Savos switch (vap->iv_opmode) { 2131290631Savos case IEEE80211_M_STA: 2132290631Savos /* Enable TSF synchronization. */ 2133290631Savos urtwn_write_1(sc, R92C_BCN_CTRL, 2134290631Savos urtwn_read_1(sc, R92C_BCN_CTRL) & 2135290631Savos ~R92C_BCN_CTRL_DIS_TSF_UDT0); 2136290631Savos break; 2137290651Savos case IEEE80211_M_IBSS: 2138290651Savos ieee80211_runtask(ic, &uvp->tsf_task_adhoc); 2139290651Savos break; 2140290631Savos case IEEE80211_M_HOSTAP: 2141290631Savos /* Enable beaconing. */ 2142290631Savos urtwn_write_1(sc, R92C_MBID_NUM, 2143290631Savos urtwn_read_1(sc, R92C_MBID_NUM) | R92C_MBID_TXBCN_RPT0); 2144290631Savos urtwn_write_1(sc, R92C_BCN_CTRL, 2145290631Savos urtwn_read_1(sc, R92C_BCN_CTRL) | R92C_BCN_CTRL_EN_BCN); 2146290631Savos break; 2147290631Savos default: 2148290631Savos device_printf(sc->sc_dev, "undefined opmode %d\n", 2149290631Savos vap->iv_opmode); 2150290631Savos return; 2151290631Savos } 2152290631Savos} 2153290631Savos 2154290631Savosstatic void 2155292203Savosurtwn_get_tsf(struct urtwn_softc *sc, uint64_t *buf) 2156292203Savos{ 2157292203Savos urtwn_read_region_1(sc, R92C_TSFTR, (uint8_t *)buf, sizeof(*buf)); 2158292203Savos} 2159292203Savos 2160292203Savosstatic void 2161251538Srpaulourtwn_set_led(struct urtwn_softc *sc, int led, int on) 2162251538Srpaulo{ 2163251538Srpaulo uint8_t reg; 2164281069Srpaulo 2165251538Srpaulo if (led == URTWN_LED_LINK) { 2166264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 2167264912Skevlo reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0xf0; 2168264912Skevlo urtwn_write_1(sc, R92C_LEDCFG2, reg | 0x60); 2169264912Skevlo if (!on) { 2170264912Skevlo reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0x90; 2171264912Skevlo urtwn_write_1(sc, R92C_LEDCFG2, 2172264912Skevlo reg | R92C_LEDCFG0_DIS); 2173264912Skevlo urtwn_write_1(sc, R92C_MAC_PINMUX_CFG, 2174264912Skevlo urtwn_read_1(sc, R92C_MAC_PINMUX_CFG) & 2175264912Skevlo 0xfe); 2176264912Skevlo } 2177264912Skevlo } else { 2178264912Skevlo reg = urtwn_read_1(sc, R92C_LEDCFG0) & 0x70; 2179264912Skevlo if (!on) 2180264912Skevlo reg |= R92C_LEDCFG0_DIS; 2181264912Skevlo urtwn_write_1(sc, R92C_LEDCFG0, reg); 2182264912Skevlo } 2183264912Skevlo sc->ledlink = on; /* Save LED state. */ 2184251538Srpaulo } 2185251538Srpaulo} 2186251538Srpaulo 2187289811Savosstatic void 2188289811Savosurtwn_set_mode(struct urtwn_softc *sc, uint8_t mode) 2189289811Savos{ 2190289811Savos uint8_t reg; 2191289811Savos 2192289811Savos reg = urtwn_read_1(sc, R92C_MSR); 2193289811Savos reg = (reg & ~R92C_MSR_MASK) | mode; 2194289811Savos urtwn_write_1(sc, R92C_MSR, reg); 2195289811Savos} 2196289811Savos 2197290651Savosstatic void 2198290651Savosurtwn_ibss_recv_mgmt(struct ieee80211_node *ni, struct mbuf *m, int subtype, 2199290651Savos const struct ieee80211_rx_stats *rxs, 2200290651Savos int rssi, int nf) 2201290651Savos{ 2202290651Savos struct ieee80211vap *vap = ni->ni_vap; 2203290651Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2204290651Savos struct urtwn_vap *uvp = URTWN_VAP(vap); 2205290651Savos uint64_t ni_tstamp, curr_tstamp; 2206290651Savos 2207290651Savos uvp->recv_mgmt(ni, m, subtype, rxs, rssi, nf); 2208290651Savos 2209290651Savos if (vap->iv_state == IEEE80211_S_RUN && 2210290651Savos (subtype == IEEE80211_FC0_SUBTYPE_BEACON || 2211290651Savos subtype == IEEE80211_FC0_SUBTYPE_PROBE_RESP)) { 2212290651Savos ni_tstamp = le64toh(ni->ni_tstamp.tsf); 2213290651Savos URTWN_LOCK(sc); 2214290651Savos urtwn_get_tsf(sc, &curr_tstamp); 2215290651Savos URTWN_UNLOCK(sc); 2216290651Savos curr_tstamp = le64toh(curr_tstamp); 2217290651Savos 2218290651Savos if (ni_tstamp >= curr_tstamp) 2219290651Savos (void) ieee80211_ibss_merge(ni); 2220290651Savos } 2221290651Savos} 2222290651Savos 2223251538Srpaulostatic int 2224251538Srpaulourtwn_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 2225251538Srpaulo{ 2226251538Srpaulo struct urtwn_vap *uvp = URTWN_VAP(vap); 2227251538Srpaulo struct ieee80211com *ic = vap->iv_ic; 2228286949Sadrian struct urtwn_softc *sc = ic->ic_softc; 2229251538Srpaulo struct ieee80211_node *ni; 2230251538Srpaulo enum ieee80211_state ostate; 2231290631Savos uint32_t reg; 2232290631Savos uint8_t mode; 2233290631Savos int error = 0; 2234251538Srpaulo 2235251538Srpaulo ostate = vap->iv_state; 2236251538Srpaulo DPRINTF("%s -> %s\n", ieee80211_state_name[ostate], 2237251538Srpaulo ieee80211_state_name[nstate]); 2238251538Srpaulo 2239251538Srpaulo IEEE80211_UNLOCK(ic); 2240251538Srpaulo URTWN_LOCK(sc); 2241251538Srpaulo callout_stop(&sc->sc_watchdog_ch); 2242251538Srpaulo 2243251538Srpaulo if (ostate == IEEE80211_S_RUN) { 2244251538Srpaulo /* Turn link LED off. */ 2245251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 0); 2246251538Srpaulo 2247251538Srpaulo /* Set media status to 'No Link'. */ 2248289811Savos urtwn_set_mode(sc, R92C_MSR_NOLINK); 2249251538Srpaulo 2250251538Srpaulo /* Stop Rx of data frames. */ 2251251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP2, 0); 2252251538Srpaulo 2253251538Srpaulo /* Disable TSF synchronization. */ 2254251538Srpaulo urtwn_write_1(sc, R92C_BCN_CTRL, 2255290631Savos (urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_EN_BCN) | 2256251538Srpaulo R92C_BCN_CTRL_DIS_TSF_UDT0); 2257251538Srpaulo 2258290631Savos /* Disable beaconing. */ 2259290631Savos urtwn_write_1(sc, R92C_MBID_NUM, 2260290631Savos urtwn_read_1(sc, R92C_MBID_NUM) & ~R92C_MBID_TXBCN_RPT0); 2261290631Savos 2262290631Savos /* Reset TSF. */ 2263290631Savos urtwn_write_1(sc, R92C_DUAL_TSF_RST, R92C_DUAL_TSF_RST0); 2264290631Savos 2265251538Srpaulo /* Reset EDCA parameters. */ 2266251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002f3217); 2267251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005e4317); 2268251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x00105320); 2269251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a444); 2270251538Srpaulo } 2271251538Srpaulo 2272251538Srpaulo switch (nstate) { 2273251538Srpaulo case IEEE80211_S_INIT: 2274251538Srpaulo /* Turn link LED off. */ 2275251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 0); 2276251538Srpaulo break; 2277251538Srpaulo case IEEE80211_S_SCAN: 2278251538Srpaulo /* Pause AC Tx queues. */ 2279251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 2280293180Savos urtwn_read_1(sc, R92C_TXPAUSE) | R92C_TX_QUEUE_AC); 2281251538Srpaulo break; 2282251538Srpaulo case IEEE80211_S_AUTH: 2283251538Srpaulo urtwn_set_chan(sc, ic->ic_curchan, NULL); 2284251538Srpaulo break; 2285251538Srpaulo case IEEE80211_S_RUN: 2286251538Srpaulo if (vap->iv_opmode == IEEE80211_M_MONITOR) { 2287251538Srpaulo /* Turn link LED on. */ 2288251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 1); 2289251538Srpaulo break; 2290251538Srpaulo } 2291251538Srpaulo 2292251538Srpaulo ni = ieee80211_ref_node(vap->iv_bss); 2293290631Savos 2294290631Savos if (ic->ic_bsschan == IEEE80211_CHAN_ANYC || 2295290631Savos ni->ni_chan == IEEE80211_CHAN_ANYC) { 2296290631Savos device_printf(sc->sc_dev, 2297290631Savos "%s: could not move to RUN state\n", __func__); 2298290631Savos error = EINVAL; 2299290631Savos goto end_run; 2300290631Savos } 2301290631Savos 2302290631Savos switch (vap->iv_opmode) { 2303290631Savos case IEEE80211_M_STA: 2304290631Savos mode = R92C_MSR_INFRA; 2305290631Savos break; 2306290651Savos case IEEE80211_M_IBSS: 2307290651Savos mode = R92C_MSR_ADHOC; 2308290651Savos break; 2309290631Savos case IEEE80211_M_HOSTAP: 2310290631Savos mode = R92C_MSR_AP; 2311290631Savos break; 2312290631Savos default: 2313290631Savos device_printf(sc->sc_dev, "undefined opmode %d\n", 2314290631Savos vap->iv_opmode); 2315290631Savos error = EINVAL; 2316290631Savos goto end_run; 2317290631Savos } 2318290631Savos 2319251538Srpaulo /* Set media status to 'Associated'. */ 2320290631Savos urtwn_set_mode(sc, mode); 2321251538Srpaulo 2322251538Srpaulo /* Set BSSID. */ 2323251538Srpaulo urtwn_write_4(sc, R92C_BSSID + 0, LE_READ_4(&ni->ni_bssid[0])); 2324251538Srpaulo urtwn_write_4(sc, R92C_BSSID + 4, LE_READ_2(&ni->ni_bssid[4])); 2325251538Srpaulo 2326251538Srpaulo if (ic->ic_curmode == IEEE80211_MODE_11B) 2327251538Srpaulo urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 0); 2328251538Srpaulo else /* 802.11b/g */ 2329251538Srpaulo urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 3); 2330251538Srpaulo 2331251538Srpaulo /* Enable Rx of data frames. */ 2332251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff); 2333251538Srpaulo 2334251538Srpaulo /* Flush all AC queues. */ 2335251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 0); 2336251538Srpaulo 2337251538Srpaulo /* Set beacon interval. */ 2338251538Srpaulo urtwn_write_2(sc, R92C_BCN_INTERVAL, ni->ni_intval); 2339251538Srpaulo 2340251538Srpaulo /* Allow Rx from our BSSID only. */ 2341290564Savos if (ic->ic_promisc == 0) { 2342290631Savos reg = urtwn_read_4(sc, R92C_RCR); 2343290631Savos 2344290631Savos if (vap->iv_opmode != IEEE80211_M_HOSTAP) 2345290631Savos reg |= R92C_RCR_CBSSID_DATA; 2346290651Savos if (vap->iv_opmode != IEEE80211_M_IBSS) 2347290651Savos reg |= R92C_RCR_CBSSID_BCN; 2348290631Savos 2349290631Savos urtwn_write_4(sc, R92C_RCR, reg); 2350290564Savos } 2351251538Srpaulo 2352290651Savos if (vap->iv_opmode == IEEE80211_M_HOSTAP || 2353290651Savos vap->iv_opmode == IEEE80211_M_IBSS) { 2354290631Savos error = urtwn_setup_beacon(sc, ni); 2355290631Savos if (error != 0) { 2356290631Savos device_printf(sc->sc_dev, 2357290631Savos "unable to push beacon into the chip, " 2358290631Savos "error %d\n", error); 2359290631Savos goto end_run; 2360290631Savos } 2361290631Savos } 2362290631Savos 2363251538Srpaulo /* Enable TSF synchronization. */ 2364290631Savos urtwn_tsf_sync_enable(sc, vap); 2365251538Srpaulo 2366251538Srpaulo urtwn_write_1(sc, R92C_SIFS_CCK + 1, 10); 2367251538Srpaulo urtwn_write_1(sc, R92C_SIFS_OFDM + 1, 10); 2368251538Srpaulo urtwn_write_1(sc, R92C_SPEC_SIFS + 1, 10); 2369251538Srpaulo urtwn_write_1(sc, R92C_MAC_SPEC_SIFS + 1, 10); 2370251538Srpaulo urtwn_write_1(sc, R92C_R2T_SIFS + 1, 10); 2371251538Srpaulo urtwn_write_1(sc, R92C_T2T_SIFS + 1, 10); 2372251538Srpaulo 2373251538Srpaulo /* Intialize rate adaptation. */ 2374292167Savos if (!(sc->chip & URTWN_CHIP_88E)) 2375264912Skevlo urtwn_ra_init(sc); 2376251538Srpaulo /* Turn link LED on. */ 2377251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 1); 2378251538Srpaulo 2379251538Srpaulo sc->avg_pwdb = -1; /* Reset average RSSI. */ 2380251538Srpaulo /* Reset temperature calibration state machine. */ 2381251538Srpaulo sc->thcal_state = 0; 2382251538Srpaulo sc->thcal_lctemp = 0; 2383290631Savos 2384290631Savosend_run: 2385251538Srpaulo ieee80211_free_node(ni); 2386251538Srpaulo break; 2387251538Srpaulo default: 2388251538Srpaulo break; 2389251538Srpaulo } 2390290631Savos 2391251538Srpaulo URTWN_UNLOCK(sc); 2392251538Srpaulo IEEE80211_LOCK(ic); 2393290631Savos return (error != 0 ? error : uvp->newstate(vap, nstate, arg)); 2394251538Srpaulo} 2395251538Srpaulo 2396251538Srpaulostatic void 2397251538Srpaulourtwn_watchdog(void *arg) 2398251538Srpaulo{ 2399251538Srpaulo struct urtwn_softc *sc = arg; 2400251538Srpaulo 2401251538Srpaulo if (sc->sc_txtimer > 0) { 2402251538Srpaulo if (--sc->sc_txtimer == 0) { 2403251538Srpaulo device_printf(sc->sc_dev, "device timeout\n"); 2404287197Sglebius counter_u64_add(sc->sc_ic.ic_oerrors, 1); 2405251538Srpaulo return; 2406251538Srpaulo } 2407251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 2408251538Srpaulo } 2409251538Srpaulo} 2410251538Srpaulo 2411251538Srpaulostatic void 2412251538Srpaulourtwn_update_avgrssi(struct urtwn_softc *sc, int rate, int8_t rssi) 2413251538Srpaulo{ 2414251538Srpaulo int pwdb; 2415251538Srpaulo 2416251538Srpaulo /* Convert antenna signal to percentage. */ 2417251538Srpaulo if (rssi <= -100 || rssi >= 20) 2418251538Srpaulo pwdb = 0; 2419251538Srpaulo else if (rssi >= 0) 2420251538Srpaulo pwdb = 100; 2421251538Srpaulo else 2422251538Srpaulo pwdb = 100 + rssi; 2423264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 2424289758Savos if (rate <= URTWN_RIDX_CCK11) { 2425264912Skevlo /* CCK gain is smaller than OFDM/MCS gain. */ 2426264912Skevlo pwdb += 6; 2427264912Skevlo if (pwdb > 100) 2428264912Skevlo pwdb = 100; 2429264912Skevlo if (pwdb <= 14) 2430264912Skevlo pwdb -= 4; 2431264912Skevlo else if (pwdb <= 26) 2432264912Skevlo pwdb -= 8; 2433264912Skevlo else if (pwdb <= 34) 2434264912Skevlo pwdb -= 6; 2435264912Skevlo else if (pwdb <= 42) 2436264912Skevlo pwdb -= 2; 2437264912Skevlo } 2438251538Srpaulo } 2439251538Srpaulo if (sc->avg_pwdb == -1) /* Init. */ 2440251538Srpaulo sc->avg_pwdb = pwdb; 2441251538Srpaulo else if (sc->avg_pwdb < pwdb) 2442251538Srpaulo sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20) + 1; 2443251538Srpaulo else 2444251538Srpaulo sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20); 2445251538Srpaulo DPRINTFN(4, "PWDB=%d EMA=%d\n", pwdb, sc->avg_pwdb); 2446251538Srpaulo} 2447251538Srpaulo 2448251538Srpaulostatic int8_t 2449251538Srpaulourtwn_get_rssi(struct urtwn_softc *sc, int rate, void *physt) 2450251538Srpaulo{ 2451251538Srpaulo static const int8_t cckoff[] = { 16, -12, -26, -46 }; 2452251538Srpaulo struct r92c_rx_phystat *phy; 2453251538Srpaulo struct r92c_rx_cck *cck; 2454251538Srpaulo uint8_t rpt; 2455251538Srpaulo int8_t rssi; 2456251538Srpaulo 2457289758Savos if (rate <= URTWN_RIDX_CCK11) { 2458251538Srpaulo cck = (struct r92c_rx_cck *)physt; 2459251538Srpaulo if (sc->sc_flags & URTWN_FLAG_CCK_HIPWR) { 2460251538Srpaulo rpt = (cck->agc_rpt >> 5) & 0x3; 2461251538Srpaulo rssi = (cck->agc_rpt & 0x1f) << 1; 2462251538Srpaulo } else { 2463251538Srpaulo rpt = (cck->agc_rpt >> 6) & 0x3; 2464251538Srpaulo rssi = cck->agc_rpt & 0x3e; 2465251538Srpaulo } 2466251538Srpaulo rssi = cckoff[rpt] - rssi; 2467251538Srpaulo } else { /* OFDM/HT. */ 2468251538Srpaulo phy = (struct r92c_rx_phystat *)physt; 2469251538Srpaulo rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110; 2470251538Srpaulo } 2471251538Srpaulo return (rssi); 2472251538Srpaulo} 2473251538Srpaulo 2474264912Skevlostatic int8_t 2475264912Skevlourtwn_r88e_get_rssi(struct urtwn_softc *sc, int rate, void *physt) 2476264912Skevlo{ 2477264912Skevlo struct r92c_rx_phystat *phy; 2478264912Skevlo struct r88e_rx_cck *cck; 2479264912Skevlo uint8_t cck_agc_rpt, lna_idx, vga_idx; 2480264912Skevlo int8_t rssi; 2481264912Skevlo 2482264972Skevlo rssi = 0; 2483289758Savos if (rate <= URTWN_RIDX_CCK11) { 2484264912Skevlo cck = (struct r88e_rx_cck *)physt; 2485264912Skevlo cck_agc_rpt = cck->agc_rpt; 2486264912Skevlo lna_idx = (cck_agc_rpt & 0xe0) >> 5; 2487281069Srpaulo vga_idx = cck_agc_rpt & 0x1f; 2488264912Skevlo switch (lna_idx) { 2489264912Skevlo case 7: 2490264912Skevlo if (vga_idx <= 27) 2491264912Skevlo rssi = -100 + 2* (27 - vga_idx); 2492264912Skevlo else 2493264912Skevlo rssi = -100; 2494264912Skevlo break; 2495264912Skevlo case 6: 2496264912Skevlo rssi = -48 + 2 * (2 - vga_idx); 2497264912Skevlo break; 2498264912Skevlo case 5: 2499264912Skevlo rssi = -42 + 2 * (7 - vga_idx); 2500264912Skevlo break; 2501264912Skevlo case 4: 2502264912Skevlo rssi = -36 + 2 * (7 - vga_idx); 2503264912Skevlo break; 2504264912Skevlo case 3: 2505264912Skevlo rssi = -24 + 2 * (7 - vga_idx); 2506264912Skevlo break; 2507264912Skevlo case 2: 2508264912Skevlo rssi = -12 + 2 * (5 - vga_idx); 2509264912Skevlo break; 2510264912Skevlo case 1: 2511264912Skevlo rssi = 8 - (2 * vga_idx); 2512264912Skevlo break; 2513264912Skevlo case 0: 2514264912Skevlo rssi = 14 - (2 * vga_idx); 2515264912Skevlo break; 2516264912Skevlo } 2517264912Skevlo rssi += 6; 2518264912Skevlo } else { /* OFDM/HT. */ 2519264912Skevlo phy = (struct r92c_rx_phystat *)physt; 2520264912Skevlo rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110; 2521264912Skevlo } 2522264912Skevlo return (rssi); 2523264912Skevlo} 2524264912Skevlo 2525292167Savosstatic __inline uint8_t 2526292167Savosrate2ridx(uint8_t rate) 2527292167Savos{ 2528292167Savos switch (rate) { 2529292167Savos case 12: return 4; 2530292167Savos case 18: return 5; 2531292167Savos case 24: return 6; 2532292167Savos case 36: return 7; 2533292167Savos case 48: return 8; 2534292167Savos case 72: return 9; 2535292167Savos case 96: return 10; 2536292167Savos case 108: return 11; 2537292167Savos case 2: return 0; 2538292167Savos case 4: return 1; 2539292167Savos case 11: return 2; 2540292167Savos case 22: return 3; 2541292167Savos default: return 0; 2542292167Savos } 2543292167Savos} 2544292167Savos 2545251538Srpaulostatic int 2546290630Savosurtwn_tx_data(struct urtwn_softc *sc, struct ieee80211_node *ni, 2547290630Savos struct mbuf *m, struct urtwn_data *data) 2548251538Srpaulo{ 2549292167Savos const struct ieee80211_txparam *tp; 2550287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 2551251538Srpaulo struct ieee80211vap *vap = ni->ni_vap; 2552292167Savos struct ieee80211_key *k = NULL; 2553292167Savos struct ieee80211_channel *chan; 2554292167Savos struct ieee80211_frame *wh; 2555251538Srpaulo struct r92c_tx_desc *txd; 2556292167Savos uint8_t macid, raid, rate, ridx, subtype, type, tid, qsel; 2557292014Savos int hasqos, ismcast; 2558251538Srpaulo 2559251538Srpaulo URTWN_ASSERT_LOCKED(sc); 2560251538Srpaulo 2561251538Srpaulo /* 2562251538Srpaulo * Software crypto. 2563251538Srpaulo */ 2564290630Savos wh = mtod(m, struct ieee80211_frame *); 2565264912Skevlo type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK; 2566290630Savos subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK; 2567292014Savos hasqos = IEEE80211_QOS_HAS_SEQ(wh); 2568290630Savos ismcast = IEEE80211_IS_MULTICAST(wh->i_addr1); 2569264912Skevlo 2570292014Savos /* Select TX ring for this frame. */ 2571292014Savos if (hasqos) { 2572292014Savos tid = ((const struct ieee80211_qosframe *)wh)->i_qos[0]; 2573292014Savos tid &= IEEE80211_QOS_TID; 2574292014Savos } else 2575292014Savos tid = 0; 2576292014Savos 2577292167Savos chan = (ni->ni_chan != IEEE80211_CHAN_ANYC) ? 2578292167Savos ni->ni_chan : ic->ic_curchan; 2579292167Savos tp = &vap->iv_txparms[ieee80211_chan2mode(chan)]; 2580292167Savos 2581292167Savos /* Choose a TX rate index. */ 2582292167Savos if (type == IEEE80211_FC0_TYPE_MGT) 2583292167Savos rate = tp->mgmtrate; 2584292167Savos else if (ismcast) 2585292167Savos rate = tp->mcastrate; 2586292167Savos else if (tp->ucastrate != IEEE80211_FIXED_RATE_NONE) 2587292167Savos rate = tp->ucastrate; 2588292167Savos else if (m->m_flags & M_EAPOL) 2589292167Savos rate = tp->mgmtrate; 2590292167Savos else { 2591292167Savos if (URTWN_CHIP_HAS_RATECTL(sc)) { 2592292167Savos /* XXX pass pktlen */ 2593292167Savos (void) ieee80211_ratectl_rate(ni, NULL, 0); 2594292167Savos rate = ni->ni_txrate; 2595292167Savos } else { 2596292167Savos if (ic->ic_curmode != IEEE80211_MODE_11B) 2597292167Savos rate = 108; 2598292167Savos else 2599292167Savos rate = 22; 2600292167Savos } 2601292167Savos } 2602292167Savos 2603292167Savos ridx = rate2ridx(rate); 2604292167Savos if (ic->ic_curmode != IEEE80211_MODE_11B) 2605292167Savos raid = R92C_RAID_11BG; 2606292167Savos else 2607292167Savos raid = R92C_RAID_11B; 2608292167Savos 2609260444Skevlo if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 2610290630Savos k = ieee80211_crypto_encap(ni, m); 2611251538Srpaulo if (k == NULL) { 2612251538Srpaulo device_printf(sc->sc_dev, 2613251538Srpaulo "ieee80211_crypto_encap returns NULL.\n"); 2614251538Srpaulo return (ENOBUFS); 2615251538Srpaulo } 2616251538Srpaulo 2617251538Srpaulo /* in case packet header moved, reset pointer */ 2618290630Savos wh = mtod(m, struct ieee80211_frame *); 2619251538Srpaulo } 2620281069Srpaulo 2621251538Srpaulo /* Fill Tx descriptor. */ 2622251538Srpaulo txd = (struct r92c_tx_desc *)data->buf; 2623251538Srpaulo memset(txd, 0, sizeof(*txd)); 2624251538Srpaulo 2625251538Srpaulo txd->txdw0 |= htole32( 2626251538Srpaulo SM(R92C_TXDW0_OFFSET, sizeof(*txd)) | 2627251538Srpaulo R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG); 2628290630Savos if (ismcast) 2629251538Srpaulo txd->txdw0 |= htole32(R92C_TXDW0_BMCAST); 2630290630Savos 2631290630Savos if (!ismcast) { 2632292167Savos if (sc->chip & URTWN_CHIP_88E) { 2633292167Savos struct urtwn_node *un = URTWN_NODE(ni); 2634292167Savos macid = un->id; 2635292167Savos } else 2636292167Savos macid = URTWN_MACID_BSS; 2637290630Savos 2638290630Savos if (type == IEEE80211_FC0_TYPE_DATA) { 2639292014Savos qsel = tid % URTWN_MAX_TID; 2640290630Savos 2641292167Savos if (sc->chip & URTWN_CHIP_88E) { 2642292167Savos txd->txdw2 |= htole32( 2643292167Savos R88E_TXDW2_AGGBK | 2644292167Savos R88E_TXDW2_CCX_RPT); 2645292167Savos } else 2646290630Savos txd->txdw1 |= htole32(R92C_TXDW1_AGGBK); 2647290630Savos 2648290630Savos if (ic->ic_flags & IEEE80211_F_USEPROT) { 2649290630Savos switch (ic->ic_protmode) { 2650290630Savos case IEEE80211_PROT_CTSONLY: 2651290630Savos txd->txdw4 |= htole32( 2652290630Savos R92C_TXDW4_CTS2SELF | 2653290630Savos R92C_TXDW4_HWRTSEN); 2654290630Savos break; 2655290630Savos case IEEE80211_PROT_RTSCTS: 2656290630Savos txd->txdw4 |= htole32( 2657290630Savos R92C_TXDW4_RTSEN | 2658290630Savos R92C_TXDW4_HWRTSEN); 2659290630Savos break; 2660290630Savos default: 2661290630Savos break; 2662290630Savos } 2663290630Savos } 2664290630Savos txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE, 2665290630Savos URTWN_RIDX_OFDM24)); 2666290630Savos txd->txdw5 |= htole32(0x0001ff00); 2667290630Savos } else /* IEEE80211_FC0_TYPE_MGT */ 2668290630Savos qsel = R92C_TXDW1_QSEL_MGNT; 2669251538Srpaulo } else { 2670290630Savos macid = URTWN_MACID_BC; 2671290630Savos qsel = R92C_TXDW1_QSEL_MGNT; 2672290630Savos } 2673251538Srpaulo 2674290630Savos txd->txdw1 |= htole32( 2675290630Savos SM(R92C_TXDW1_QSEL, qsel) | 2676290630Savos SM(R92C_TXDW1_RAID, raid)); 2677290630Savos 2678290630Savos if (sc->chip & URTWN_CHIP_88E) 2679290630Savos txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, macid)); 2680290630Savos else 2681290630Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, macid)); 2682290630Savos 2683290630Savos txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, ridx)); 2684291858Savos /* Force this rate if needed. */ 2685292167Savos if (URTWN_CHIP_HAS_RATECTL(sc) || ismcast || 2686292167Savos (m->m_flags & M_EAPOL) || type != IEEE80211_FC0_TYPE_DATA) 2687251538Srpaulo txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE); 2688251538Srpaulo 2689292014Savos if (!hasqos) { 2690251538Srpaulo /* Use HW sequence numbering for non-QoS frames. */ 2691291858Savos if (sc->chip & URTWN_CHIP_88E) 2692291858Savos txd->txdseq = htole16(R88E_TXDSEQ_HWSEQ_EN); 2693291858Savos else 2694291858Savos txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN); 2695290630Savos } else { 2696290630Savos /* Set sequence number. */ 2697290630Savos txd->txdseq = htole16(M_SEQNO_GET(m) % IEEE80211_SEQ_RANGE); 2698290630Savos } 2699251538Srpaulo 2700292175Savos if (k != NULL && !(k->wk_flags & IEEE80211_KEY_SWCRYPT)) { 2701292175Savos uint8_t cipher; 2702292175Savos 2703292175Savos switch (k->wk_cipher->ic_cipher) { 2704292175Savos case IEEE80211_CIPHER_WEP: 2705292175Savos case IEEE80211_CIPHER_TKIP: 2706292175Savos cipher = R92C_TXDW1_CIPHER_RC4; 2707292175Savos break; 2708292175Savos case IEEE80211_CIPHER_AES_CCM: 2709292175Savos cipher = R92C_TXDW1_CIPHER_AES; 2710292175Savos break; 2711292175Savos default: 2712292175Savos device_printf(sc->sc_dev, "%s: unknown cipher %d\n", 2713292175Savos __func__, k->wk_cipher->ic_cipher); 2714292175Savos return (EINVAL); 2715292175Savos } 2716292175Savos 2717292175Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_CIPHER, cipher)); 2718292175Savos } 2719292175Savos 2720251538Srpaulo if (ieee80211_radiotap_active_vap(vap)) { 2721251538Srpaulo struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap; 2722251538Srpaulo 2723251538Srpaulo tap->wt_flags = 0; 2724290630Savos if (k != NULL) 2725290630Savos tap->wt_flags |= IEEE80211_RADIOTAP_F_WEP; 2726290630Savos ieee80211_radiotap_tx(vap, m); 2727251538Srpaulo } 2728251538Srpaulo 2729290630Savos data->ni = ni; 2730251538Srpaulo 2731290630Savos urtwn_tx_start(sc, m, type, data); 2732290630Savos 2733290630Savos return (0); 2734290630Savos} 2735290630Savos 2736292221Savosstatic int 2737292221Savosurtwn_tx_raw(struct urtwn_softc *sc, struct ieee80211_node *ni, 2738292221Savos struct mbuf *m, struct urtwn_data *data, 2739292221Savos const struct ieee80211_bpf_params *params) 2740292221Savos{ 2741292221Savos struct ieee80211vap *vap = ni->ni_vap; 2742292221Savos struct ieee80211_key *k = NULL; 2743292221Savos struct ieee80211_frame *wh; 2744292221Savos struct r92c_tx_desc *txd; 2745292221Savos uint8_t cipher, ridx, type; 2746292221Savos 2747292221Savos /* Encrypt the frame if need be. */ 2748292221Savos cipher = R92C_TXDW1_CIPHER_NONE; 2749292221Savos if (params->ibp_flags & IEEE80211_BPF_CRYPTO) { 2750292221Savos /* Retrieve key for TX. */ 2751292221Savos k = ieee80211_crypto_encap(ni, m); 2752292221Savos if (k == NULL) 2753292221Savos return (ENOBUFS); 2754292221Savos 2755292221Savos if (!(k->wk_flags & IEEE80211_KEY_SWCRYPT)) { 2756292221Savos switch (k->wk_cipher->ic_cipher) { 2757292221Savos case IEEE80211_CIPHER_WEP: 2758292221Savos case IEEE80211_CIPHER_TKIP: 2759292221Savos cipher = R92C_TXDW1_CIPHER_RC4; 2760292221Savos break; 2761292221Savos case IEEE80211_CIPHER_AES_CCM: 2762292221Savos cipher = R92C_TXDW1_CIPHER_AES; 2763292221Savos break; 2764292221Savos default: 2765292221Savos device_printf(sc->sc_dev, 2766292221Savos "%s: unknown cipher %d\n", 2767292221Savos __func__, k->wk_cipher->ic_cipher); 2768292221Savos return (EINVAL); 2769292221Savos } 2770292221Savos } 2771292221Savos } 2772292221Savos 2773292221Savos wh = mtod(m, struct ieee80211_frame *); 2774292221Savos type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK; 2775292221Savos 2776292221Savos /* Fill Tx descriptor. */ 2777292221Savos txd = (struct r92c_tx_desc *)data->buf; 2778292221Savos memset(txd, 0, sizeof(*txd)); 2779292221Savos 2780292221Savos txd->txdw0 |= htole32( 2781292221Savos SM(R92C_TXDW0_OFFSET, sizeof(*txd)) | 2782292221Savos R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG); 2783292221Savos if (IEEE80211_IS_MULTICAST(wh->i_addr1)) 2784292221Savos txd->txdw0 |= htole32(R92C_TXDW0_BMCAST); 2785292221Savos 2786292221Savos if (params->ibp_flags & IEEE80211_BPF_RTS) 2787292221Savos txd->txdw4 |= htole32(R92C_TXDW4_RTSEN); 2788292221Savos if (params->ibp_flags & IEEE80211_BPF_CTS) 2789292221Savos txd->txdw4 |= htole32(R92C_TXDW4_CTS2SELF); 2790292221Savos if (txd->txdw4 & htole32(R92C_TXDW4_RTSEN | R92C_TXDW4_CTS2SELF)) { 2791292221Savos txd->txdw4 |= htole32(R92C_TXDW4_HWRTSEN); 2792292221Savos txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE, 2793292221Savos URTWN_RIDX_OFDM24)); 2794292221Savos } 2795292221Savos 2796292221Savos if (sc->chip & URTWN_CHIP_88E) 2797292221Savos txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, URTWN_MACID_BC)); 2798292221Savos else 2799292221Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, URTWN_MACID_BC)); 2800292221Savos 2801292221Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_MGNT)); 2802292221Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_CIPHER, cipher)); 2803292221Savos 2804292221Savos /* Choose a TX rate index. */ 2805292221Savos ridx = rate2ridx(params->ibp_rate0); 2806292221Savos txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, ridx)); 2807292221Savos txd->txdw5 |= htole32(0x0001ff00); 2808292221Savos txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE); 2809292221Savos 2810292221Savos if (!IEEE80211_QOS_HAS_SEQ(wh)) { 2811292221Savos /* Use HW sequence numbering for non-QoS frames. */ 2812292221Savos if (sc->chip & URTWN_CHIP_88E) 2813292221Savos txd->txdseq = htole16(R88E_TXDSEQ_HWSEQ_EN); 2814292221Savos else 2815292221Savos txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN); 2816292221Savos } else { 2817292221Savos /* Set sequence number. */ 2818292221Savos txd->txdseq = htole16(M_SEQNO_GET(m) % IEEE80211_SEQ_RANGE); 2819292221Savos } 2820292221Savos 2821292221Savos if (ieee80211_radiotap_active_vap(vap)) { 2822292221Savos struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap; 2823292221Savos 2824292221Savos tap->wt_flags = 0; 2825292221Savos if (k != NULL) 2826292221Savos tap->wt_flags |= IEEE80211_RADIOTAP_F_WEP; 2827292221Savos ieee80211_radiotap_tx(vap, m); 2828292221Savos } 2829292221Savos 2830292221Savos data->ni = ni; 2831292221Savos 2832292221Savos urtwn_tx_start(sc, m, type, data); 2833292221Savos 2834292221Savos return (0); 2835292221Savos} 2836292221Savos 2837290630Savosstatic void 2838290630Savosurtwn_tx_start(struct urtwn_softc *sc, struct mbuf *m, uint8_t type, 2839290630Savos struct urtwn_data *data) 2840290630Savos{ 2841290630Savos struct usb_xfer *xfer; 2842290630Savos struct r92c_tx_desc *txd; 2843290630Savos uint16_t ac, sum; 2844290630Savos int i, xferlen; 2845290630Savos 2846290630Savos URTWN_ASSERT_LOCKED(sc); 2847290630Savos 2848290630Savos ac = M_WME_GETAC(m); 2849290630Savos 2850290630Savos switch (type) { 2851290630Savos case IEEE80211_FC0_TYPE_CTL: 2852290630Savos case IEEE80211_FC0_TYPE_MGT: 2853290630Savos xfer = sc->sc_xfer[URTWN_BULK_TX_VO]; 2854290630Savos break; 2855290630Savos default: 2856292014Savos xfer = sc->sc_xfer[wme2queue[ac].qid]; 2857290630Savos break; 2858290630Savos } 2859290630Savos 2860290630Savos txd = (struct r92c_tx_desc *)data->buf; 2861290630Savos txd->txdw0 |= htole32(SM(R92C_TXDW0_PKTLEN, m->m_pkthdr.len)); 2862290630Savos 2863290630Savos /* Compute Tx descriptor checksum. */ 2864290630Savos sum = 0; 2865290630Savos for (i = 0; i < sizeof(*txd) / 2; i++) 2866290630Savos sum ^= ((uint16_t *)txd)[i]; 2867290630Savos txd->txdsum = sum; /* NB: already little endian. */ 2868290630Savos 2869290630Savos xferlen = sizeof(*txd) + m->m_pkthdr.len; 2870290630Savos m_copydata(m, 0, m->m_pkthdr.len, (caddr_t)&txd[1]); 2871290630Savos 2872251538Srpaulo data->buflen = xferlen; 2873290630Savos data->m = m; 2874251538Srpaulo 2875251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next); 2876251538Srpaulo usbd_transfer_start(xfer); 2877251538Srpaulo} 2878251538Srpaulo 2879287197Sglebiusstatic int 2880287197Sglebiusurtwn_transmit(struct ieee80211com *ic, struct mbuf *m) 2881251538Srpaulo{ 2882287197Sglebius struct urtwn_softc *sc = ic->ic_softc; 2883287197Sglebius int error; 2884261863Srpaulo 2885261863Srpaulo URTWN_LOCK(sc); 2886287197Sglebius if ((sc->sc_flags & URTWN_RUNNING) == 0) { 2887287197Sglebius URTWN_UNLOCK(sc); 2888287197Sglebius return (ENXIO); 2889287197Sglebius } 2890287197Sglebius error = mbufq_enqueue(&sc->sc_snd, m); 2891287197Sglebius if (error) { 2892287197Sglebius URTWN_UNLOCK(sc); 2893287197Sglebius return (error); 2894287197Sglebius } 2895287197Sglebius urtwn_start(sc); 2896261863Srpaulo URTWN_UNLOCK(sc); 2897287197Sglebius 2898287197Sglebius return (0); 2899261863Srpaulo} 2900261863Srpaulo 2901261863Srpaulostatic void 2902287197Sglebiusurtwn_start(struct urtwn_softc *sc) 2903261863Srpaulo{ 2904251538Srpaulo struct ieee80211_node *ni; 2905251538Srpaulo struct mbuf *m; 2906251538Srpaulo struct urtwn_data *bf; 2907251538Srpaulo 2908261863Srpaulo URTWN_ASSERT_LOCKED(sc); 2909287197Sglebius while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) { 2910251538Srpaulo bf = urtwn_getbuf(sc); 2911251538Srpaulo if (bf == NULL) { 2912287197Sglebius mbufq_prepend(&sc->sc_snd, m); 2913251538Srpaulo break; 2914251538Srpaulo } 2915251538Srpaulo ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 2916251538Srpaulo m->m_pkthdr.rcvif = NULL; 2917290630Savos if (urtwn_tx_data(sc, ni, m, bf) != 0) { 2918287197Sglebius if_inc_counter(ni->ni_vap->iv_ifp, 2919287197Sglebius IFCOUNTER_OERRORS, 1); 2920251538Srpaulo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 2921288353Sadrian m_freem(m); 2922251538Srpaulo ieee80211_free_node(ni); 2923251538Srpaulo break; 2924251538Srpaulo } 2925251538Srpaulo sc->sc_txtimer = 5; 2926251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 2927251538Srpaulo } 2928251538Srpaulo} 2929251538Srpaulo 2930287197Sglebiusstatic void 2931287197Sglebiusurtwn_parent(struct ieee80211com *ic) 2932251538Srpaulo{ 2933286949Sadrian struct urtwn_softc *sc = ic->ic_softc; 2934251538Srpaulo 2935263153Skevlo URTWN_LOCK(sc); 2936287197Sglebius if (sc->sc_flags & URTWN_DETACHED) { 2937287197Sglebius URTWN_UNLOCK(sc); 2938287197Sglebius return; 2939287197Sglebius } 2940291698Savos URTWN_UNLOCK(sc); 2941291698Savos 2942287197Sglebius if (ic->ic_nrunning > 0) { 2943291698Savos if (urtwn_init(sc) != 0) { 2944291698Savos struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 2945291698Savos if (vap != NULL) 2946291698Savos ieee80211_stop(vap); 2947291698Savos } else 2948291698Savos ieee80211_start_all(ic); 2949291698Savos } else 2950287197Sglebius urtwn_stop(sc); 2951251538Srpaulo} 2952251538Srpaulo 2953264912Skevlostatic __inline int 2954251538Srpaulourtwn_power_on(struct urtwn_softc *sc) 2955251538Srpaulo{ 2956264912Skevlo 2957264912Skevlo return sc->sc_power_on(sc); 2958264912Skevlo} 2959264912Skevlo 2960264912Skevlostatic int 2961264912Skevlourtwn_r92c_power_on(struct urtwn_softc *sc) 2962264912Skevlo{ 2963251538Srpaulo uint32_t reg; 2964291698Savos usb_error_t error; 2965251538Srpaulo int ntries; 2966251538Srpaulo 2967251538Srpaulo /* Wait for autoload done bit. */ 2968251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 2969251538Srpaulo if (urtwn_read_1(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_PFM_ALDN) 2970251538Srpaulo break; 2971266472Shselasky urtwn_ms_delay(sc); 2972251538Srpaulo } 2973251538Srpaulo if (ntries == 1000) { 2974251538Srpaulo device_printf(sc->sc_dev, 2975251538Srpaulo "timeout waiting for chip autoload\n"); 2976251538Srpaulo return (ETIMEDOUT); 2977251538Srpaulo } 2978251538Srpaulo 2979251538Srpaulo /* Unlock ISO/CLK/Power control register. */ 2980291698Savos error = urtwn_write_1(sc, R92C_RSV_CTRL, 0); 2981291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2982291698Savos return (EIO); 2983251538Srpaulo /* Move SPS into PWM mode. */ 2984291698Savos error = urtwn_write_1(sc, R92C_SPS0_CTRL, 0x2b); 2985291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2986291698Savos return (EIO); 2987266472Shselasky urtwn_ms_delay(sc); 2988251538Srpaulo 2989251538Srpaulo reg = urtwn_read_1(sc, R92C_LDOV12D_CTRL); 2990251538Srpaulo if (!(reg & R92C_LDOV12D_CTRL_LDV12_EN)) { 2991291698Savos error = urtwn_write_1(sc, R92C_LDOV12D_CTRL, 2992251538Srpaulo reg | R92C_LDOV12D_CTRL_LDV12_EN); 2993291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2994291698Savos return (EIO); 2995266472Shselasky urtwn_ms_delay(sc); 2996291698Savos error = urtwn_write_1(sc, R92C_SYS_ISO_CTRL, 2997251538Srpaulo urtwn_read_1(sc, R92C_SYS_ISO_CTRL) & 2998251538Srpaulo ~R92C_SYS_ISO_CTRL_MD2PP); 2999291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3000291698Savos return (EIO); 3001251538Srpaulo } 3002251538Srpaulo 3003251538Srpaulo /* Auto enable WLAN. */ 3004291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 3005251538Srpaulo urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC); 3006291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3007291698Savos return (EIO); 3008251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 3009262822Skevlo if (!(urtwn_read_2(sc, R92C_APS_FSMCO) & 3010262822Skevlo R92C_APS_FSMCO_APFM_ONMAC)) 3011251538Srpaulo break; 3012266472Shselasky urtwn_ms_delay(sc); 3013251538Srpaulo } 3014251538Srpaulo if (ntries == 1000) { 3015251538Srpaulo device_printf(sc->sc_dev, 3016251538Srpaulo "timeout waiting for MAC auto ON\n"); 3017251538Srpaulo return (ETIMEDOUT); 3018251538Srpaulo } 3019251538Srpaulo 3020251538Srpaulo /* Enable radio, GPIO and LED functions. */ 3021291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 3022251538Srpaulo R92C_APS_FSMCO_AFSM_HSUS | 3023251538Srpaulo R92C_APS_FSMCO_PDN_EN | 3024251538Srpaulo R92C_APS_FSMCO_PFM_ALDN); 3025291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3026291698Savos return (EIO); 3027251538Srpaulo /* Release RF digital isolation. */ 3028291698Savos error = urtwn_write_2(sc, R92C_SYS_ISO_CTRL, 3029251538Srpaulo urtwn_read_2(sc, R92C_SYS_ISO_CTRL) & ~R92C_SYS_ISO_CTRL_DIOR); 3030291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3031291698Savos return (EIO); 3032251538Srpaulo 3033251538Srpaulo /* Initialize MAC. */ 3034291698Savos error = urtwn_write_1(sc, R92C_APSD_CTRL, 3035251538Srpaulo urtwn_read_1(sc, R92C_APSD_CTRL) & ~R92C_APSD_CTRL_OFF); 3036291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3037291698Savos return (EIO); 3038251538Srpaulo for (ntries = 0; ntries < 200; ntries++) { 3039251538Srpaulo if (!(urtwn_read_1(sc, R92C_APSD_CTRL) & 3040251538Srpaulo R92C_APSD_CTRL_OFF_STATUS)) 3041251538Srpaulo break; 3042266472Shselasky urtwn_ms_delay(sc); 3043251538Srpaulo } 3044251538Srpaulo if (ntries == 200) { 3045251538Srpaulo device_printf(sc->sc_dev, 3046251538Srpaulo "timeout waiting for MAC initialization\n"); 3047251538Srpaulo return (ETIMEDOUT); 3048251538Srpaulo } 3049251538Srpaulo 3050251538Srpaulo /* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */ 3051251538Srpaulo reg = urtwn_read_2(sc, R92C_CR); 3052251538Srpaulo reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN | 3053251538Srpaulo R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN | 3054251538Srpaulo R92C_CR_SCHEDULE_EN | R92C_CR_MACTXEN | R92C_CR_MACRXEN | 3055251538Srpaulo R92C_CR_ENSEC; 3056291698Savos error = urtwn_write_2(sc, R92C_CR, reg); 3057291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3058291698Savos return (EIO); 3059251538Srpaulo 3060291698Savos error = urtwn_write_1(sc, 0xfe10, 0x19); 3061291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3062291698Savos return (EIO); 3063251538Srpaulo return (0); 3064251538Srpaulo} 3065251538Srpaulo 3066251538Srpaulostatic int 3067264912Skevlourtwn_r88e_power_on(struct urtwn_softc *sc) 3068264912Skevlo{ 3069264912Skevlo uint32_t reg; 3070291698Savos usb_error_t error; 3071264912Skevlo int ntries; 3072264912Skevlo 3073264912Skevlo /* Wait for power ready bit. */ 3074264912Skevlo for (ntries = 0; ntries < 5000; ntries++) { 3075281918Skevlo if (urtwn_read_4(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_SUS_HOST) 3076264912Skevlo break; 3077266472Shselasky urtwn_ms_delay(sc); 3078264912Skevlo } 3079264912Skevlo if (ntries == 5000) { 3080264912Skevlo device_printf(sc->sc_dev, 3081264912Skevlo "timeout waiting for chip power up\n"); 3082264912Skevlo return (ETIMEDOUT); 3083264912Skevlo } 3084264912Skevlo 3085264912Skevlo /* Reset BB. */ 3086291698Savos error = urtwn_write_1(sc, R92C_SYS_FUNC_EN, 3087264912Skevlo urtwn_read_1(sc, R92C_SYS_FUNC_EN) & ~(R92C_SYS_FUNC_EN_BBRSTB | 3088264912Skevlo R92C_SYS_FUNC_EN_BB_GLB_RST)); 3089291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3090291698Savos return (EIO); 3091264912Skevlo 3092291698Savos error = urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 2, 3093281918Skevlo urtwn_read_1(sc, R92C_AFE_XTAL_CTRL + 2) | 0x80); 3094291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3095291698Savos return (EIO); 3096264912Skevlo 3097264912Skevlo /* Disable HWPDN. */ 3098291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 3099281918Skevlo urtwn_read_2(sc, R92C_APS_FSMCO) & ~R92C_APS_FSMCO_APDM_HPDN); 3100291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3101291698Savos return (EIO); 3102264912Skevlo 3103264912Skevlo /* Disable WL suspend. */ 3104291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 3105281918Skevlo urtwn_read_2(sc, R92C_APS_FSMCO) & 3106281918Skevlo ~(R92C_APS_FSMCO_AFSM_HSUS | R92C_APS_FSMCO_AFSM_PCIE)); 3107291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3108291698Savos return (EIO); 3109264912Skevlo 3110291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 3111281918Skevlo urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC); 3112291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3113291698Savos return (EIO); 3114264912Skevlo for (ntries = 0; ntries < 5000; ntries++) { 3115281918Skevlo if (!(urtwn_read_2(sc, R92C_APS_FSMCO) & 3116281918Skevlo R92C_APS_FSMCO_APFM_ONMAC)) 3117264912Skevlo break; 3118266472Shselasky urtwn_ms_delay(sc); 3119264912Skevlo } 3120264912Skevlo if (ntries == 5000) 3121264912Skevlo return (ETIMEDOUT); 3122264912Skevlo 3123264912Skevlo /* Enable LDO normal mode. */ 3124291698Savos error = urtwn_write_1(sc, R92C_LPLDO_CTRL, 3125281918Skevlo urtwn_read_1(sc, R92C_LPLDO_CTRL) & ~0x10); 3126291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3127291698Savos return (EIO); 3128264912Skevlo 3129264912Skevlo /* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */ 3130291698Savos error = urtwn_write_2(sc, R92C_CR, 0); 3131291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3132291698Savos return (EIO); 3133264912Skevlo reg = urtwn_read_2(sc, R92C_CR); 3134264912Skevlo reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN | 3135264912Skevlo R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN | 3136264912Skevlo R92C_CR_SCHEDULE_EN | R92C_CR_ENSEC | R92C_CR_CALTMR_EN; 3137291698Savos error = urtwn_write_2(sc, R92C_CR, reg); 3138291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3139291698Savos return (EIO); 3140264912Skevlo 3141264912Skevlo return (0); 3142264912Skevlo} 3143264912Skevlo 3144264912Skevlostatic int 3145251538Srpaulourtwn_llt_init(struct urtwn_softc *sc) 3146251538Srpaulo{ 3147264912Skevlo int i, error, page_count, pktbuf_count; 3148251538Srpaulo 3149264912Skevlo page_count = (sc->chip & URTWN_CHIP_88E) ? 3150264912Skevlo R88E_TX_PAGE_COUNT : R92C_TX_PAGE_COUNT; 3151264912Skevlo pktbuf_count = (sc->chip & URTWN_CHIP_88E) ? 3152264912Skevlo R88E_TXPKTBUF_COUNT : R92C_TXPKTBUF_COUNT; 3153264912Skevlo 3154264912Skevlo /* Reserve pages [0; page_count]. */ 3155264912Skevlo for (i = 0; i < page_count; i++) { 3156251538Srpaulo if ((error = urtwn_llt_write(sc, i, i + 1)) != 0) 3157251538Srpaulo return (error); 3158251538Srpaulo } 3159251538Srpaulo /* NB: 0xff indicates end-of-list. */ 3160251538Srpaulo if ((error = urtwn_llt_write(sc, i, 0xff)) != 0) 3161251538Srpaulo return (error); 3162251538Srpaulo /* 3163264912Skevlo * Use pages [page_count + 1; pktbuf_count - 1] 3164251538Srpaulo * as ring buffer. 3165251538Srpaulo */ 3166264912Skevlo for (++i; i < pktbuf_count - 1; i++) { 3167251538Srpaulo if ((error = urtwn_llt_write(sc, i, i + 1)) != 0) 3168251538Srpaulo return (error); 3169251538Srpaulo } 3170251538Srpaulo /* Make the last page point to the beginning of the ring buffer. */ 3171264912Skevlo error = urtwn_llt_write(sc, i, page_count + 1); 3172251538Srpaulo return (error); 3173251538Srpaulo} 3174251538Srpaulo 3175251538Srpaulostatic void 3176251538Srpaulourtwn_fw_reset(struct urtwn_softc *sc) 3177251538Srpaulo{ 3178251538Srpaulo uint16_t reg; 3179251538Srpaulo int ntries; 3180251538Srpaulo 3181251538Srpaulo /* Tell 8051 to reset itself. */ 3182251538Srpaulo urtwn_write_1(sc, R92C_HMETFR + 3, 0x20); 3183251538Srpaulo 3184251538Srpaulo /* Wait until 8051 resets by itself. */ 3185251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 3186251538Srpaulo reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN); 3187251538Srpaulo if (!(reg & R92C_SYS_FUNC_EN_CPUEN)) 3188251538Srpaulo return; 3189266472Shselasky urtwn_ms_delay(sc); 3190251538Srpaulo } 3191251538Srpaulo /* Force 8051 reset. */ 3192251538Srpaulo urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN); 3193251538Srpaulo} 3194251538Srpaulo 3195264912Skevlostatic void 3196264912Skevlourtwn_r88e_fw_reset(struct urtwn_softc *sc) 3197264912Skevlo{ 3198264912Skevlo uint16_t reg; 3199264912Skevlo 3200264912Skevlo reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN); 3201264912Skevlo urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN); 3202264912Skevlo urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg | R92C_SYS_FUNC_EN_CPUEN); 3203264912Skevlo} 3204264912Skevlo 3205251538Srpaulostatic int 3206251538Srpaulourtwn_fw_loadpage(struct urtwn_softc *sc, int page, const uint8_t *buf, int len) 3207251538Srpaulo{ 3208251538Srpaulo uint32_t reg; 3209291698Savos usb_error_t error = USB_ERR_NORMAL_COMPLETION; 3210291698Savos int off, mlen; 3211251538Srpaulo 3212251538Srpaulo reg = urtwn_read_4(sc, R92C_MCUFWDL); 3213251538Srpaulo reg = RW(reg, R92C_MCUFWDL_PAGE, page); 3214251538Srpaulo urtwn_write_4(sc, R92C_MCUFWDL, reg); 3215251538Srpaulo 3216251538Srpaulo off = R92C_FW_START_ADDR; 3217251538Srpaulo while (len > 0) { 3218251538Srpaulo if (len > 196) 3219251538Srpaulo mlen = 196; 3220251538Srpaulo else if (len > 4) 3221251538Srpaulo mlen = 4; 3222251538Srpaulo else 3223251538Srpaulo mlen = 1; 3224251538Srpaulo /* XXX fix this deconst */ 3225281069Srpaulo error = urtwn_write_region_1(sc, off, 3226251538Srpaulo __DECONST(uint8_t *, buf), mlen); 3227291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3228251538Srpaulo break; 3229251538Srpaulo off += mlen; 3230251538Srpaulo buf += mlen; 3231251538Srpaulo len -= mlen; 3232251538Srpaulo } 3233251538Srpaulo return (error); 3234251538Srpaulo} 3235251538Srpaulo 3236251538Srpaulostatic int 3237251538Srpaulourtwn_load_firmware(struct urtwn_softc *sc) 3238251538Srpaulo{ 3239251538Srpaulo const struct firmware *fw; 3240251538Srpaulo const struct r92c_fw_hdr *hdr; 3241251538Srpaulo const char *imagename; 3242251538Srpaulo const u_char *ptr; 3243251538Srpaulo size_t len; 3244251538Srpaulo uint32_t reg; 3245251538Srpaulo int mlen, ntries, page, error; 3246251538Srpaulo 3247264864Skevlo URTWN_UNLOCK(sc); 3248251538Srpaulo /* Read firmware image from the filesystem. */ 3249264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3250264912Skevlo imagename = "urtwn-rtl8188eufw"; 3251264912Skevlo else if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) == 3252264912Skevlo URTWN_CHIP_UMC_A_CUT) 3253251538Srpaulo imagename = "urtwn-rtl8192cfwU"; 3254251538Srpaulo else 3255251538Srpaulo imagename = "urtwn-rtl8192cfwT"; 3256251538Srpaulo 3257251538Srpaulo fw = firmware_get(imagename); 3258264864Skevlo URTWN_LOCK(sc); 3259251538Srpaulo if (fw == NULL) { 3260251538Srpaulo device_printf(sc->sc_dev, 3261251538Srpaulo "failed loadfirmware of file %s\n", imagename); 3262251538Srpaulo return (ENOENT); 3263251538Srpaulo } 3264251538Srpaulo 3265251538Srpaulo len = fw->datasize; 3266251538Srpaulo 3267251538Srpaulo if (len < sizeof(*hdr)) { 3268251538Srpaulo device_printf(sc->sc_dev, "firmware too short\n"); 3269251538Srpaulo error = EINVAL; 3270251538Srpaulo goto fail; 3271251538Srpaulo } 3272251538Srpaulo ptr = fw->data; 3273251538Srpaulo hdr = (const struct r92c_fw_hdr *)ptr; 3274251538Srpaulo /* Check if there is a valid FW header and skip it. */ 3275251538Srpaulo if ((le16toh(hdr->signature) >> 4) == 0x88c || 3276264912Skevlo (le16toh(hdr->signature) >> 4) == 0x88e || 3277251538Srpaulo (le16toh(hdr->signature) >> 4) == 0x92c) { 3278251538Srpaulo DPRINTF("FW V%d.%d %02d-%02d %02d:%02d\n", 3279251538Srpaulo le16toh(hdr->version), le16toh(hdr->subversion), 3280251538Srpaulo hdr->month, hdr->date, hdr->hour, hdr->minute); 3281251538Srpaulo ptr += sizeof(*hdr); 3282251538Srpaulo len -= sizeof(*hdr); 3283251538Srpaulo } 3284251538Srpaulo 3285264912Skevlo if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RAM_DL_SEL) { 3286264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3287264912Skevlo urtwn_r88e_fw_reset(sc); 3288264912Skevlo else 3289264912Skevlo urtwn_fw_reset(sc); 3290251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 0); 3291251538Srpaulo } 3292264912Skevlo 3293268487Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 3294268487Skevlo urtwn_write_2(sc, R92C_SYS_FUNC_EN, 3295268487Skevlo urtwn_read_2(sc, R92C_SYS_FUNC_EN) | 3296268487Skevlo R92C_SYS_FUNC_EN_CPUEN); 3297268487Skevlo } 3298251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 3299251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_EN); 3300251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL + 2, 3301251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL + 2) & ~0x08); 3302251538Srpaulo 3303263154Skevlo /* Reset the FWDL checksum. */ 3304263154Skevlo urtwn_write_1(sc, R92C_MCUFWDL, 3305263154Skevlo urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_CHKSUM_RPT); 3306263154Skevlo 3307251538Srpaulo for (page = 0; len > 0; page++) { 3308251538Srpaulo mlen = min(len, R92C_FW_PAGE_SIZE); 3309251538Srpaulo error = urtwn_fw_loadpage(sc, page, ptr, mlen); 3310251538Srpaulo if (error != 0) { 3311251538Srpaulo device_printf(sc->sc_dev, 3312251538Srpaulo "could not load firmware page\n"); 3313251538Srpaulo goto fail; 3314251538Srpaulo } 3315251538Srpaulo ptr += mlen; 3316251538Srpaulo len -= mlen; 3317251538Srpaulo } 3318251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 3319251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL) & ~R92C_MCUFWDL_EN); 3320251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL + 1, 0); 3321251538Srpaulo 3322251538Srpaulo /* Wait for checksum report. */ 3323251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 3324251538Srpaulo if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_CHKSUM_RPT) 3325251538Srpaulo break; 3326266472Shselasky urtwn_ms_delay(sc); 3327251538Srpaulo } 3328251538Srpaulo if (ntries == 1000) { 3329251538Srpaulo device_printf(sc->sc_dev, 3330251538Srpaulo "timeout waiting for checksum report\n"); 3331251538Srpaulo error = ETIMEDOUT; 3332251538Srpaulo goto fail; 3333251538Srpaulo } 3334251538Srpaulo 3335251538Srpaulo reg = urtwn_read_4(sc, R92C_MCUFWDL); 3336251538Srpaulo reg = (reg & ~R92C_MCUFWDL_WINTINI_RDY) | R92C_MCUFWDL_RDY; 3337251538Srpaulo urtwn_write_4(sc, R92C_MCUFWDL, reg); 3338264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3339264912Skevlo urtwn_r88e_fw_reset(sc); 3340251538Srpaulo /* Wait for firmware readiness. */ 3341251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 3342251538Srpaulo if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_WINTINI_RDY) 3343251538Srpaulo break; 3344266472Shselasky urtwn_ms_delay(sc); 3345251538Srpaulo } 3346251538Srpaulo if (ntries == 1000) { 3347251538Srpaulo device_printf(sc->sc_dev, 3348251538Srpaulo "timeout waiting for firmware readiness\n"); 3349251538Srpaulo error = ETIMEDOUT; 3350251538Srpaulo goto fail; 3351251538Srpaulo } 3352251538Srpaulofail: 3353251538Srpaulo firmware_put(fw, FIRMWARE_UNLOAD); 3354251538Srpaulo return (error); 3355251538Srpaulo} 3356251538Srpaulo 3357291902Skevlostatic int 3358251538Srpaulourtwn_dma_init(struct urtwn_softc *sc) 3359251538Srpaulo{ 3360291902Skevlo struct usb_endpoint *ep, *ep_end; 3361291698Savos usb_error_t usb_err; 3362291902Skevlo uint32_t reg; 3363291902Skevlo int hashq, hasnq, haslq, nqueues, ntx; 3364291902Skevlo int error, pagecount, npubqpages, nqpages, nrempages, tx_boundary; 3365281069Srpaulo 3366291695Savos /* Initialize LLT table. */ 3367291695Savos error = urtwn_llt_init(sc); 3368291695Savos if (error != 0) 3369291695Savos return (error); 3370291695Savos 3371291902Skevlo /* Determine the number of bulk-out pipes. */ 3372291902Skevlo ntx = 0; 3373291902Skevlo ep = sc->sc_udev->endpoints; 3374291902Skevlo ep_end = sc->sc_udev->endpoints + sc->sc_udev->endpoints_max; 3375291902Skevlo for (; ep != ep_end; ep++) { 3376291902Skevlo if ((ep->edesc == NULL) || 3377291902Skevlo (ep->iface_index != sc->sc_iface_index)) 3378291902Skevlo continue; 3379291902Skevlo if (UE_GET_DIR(ep->edesc->bEndpointAddress) == UE_DIR_OUT) 3380291902Skevlo ntx++; 3381291902Skevlo } 3382291902Skevlo if (ntx == 0) { 3383291902Skevlo device_printf(sc->sc_dev, 3384291902Skevlo "%d: invalid number of Tx bulk pipes\n", ntx); 3385291698Savos return (EIO); 3386291902Skevlo } 3387291695Savos 3388251538Srpaulo /* Get Tx queues to USB endpoints mapping. */ 3389291902Skevlo hashq = hasnq = haslq = nqueues = 0; 3390291902Skevlo switch (ntx) { 3391291902Skevlo case 1: hashq = 1; break; 3392291902Skevlo case 2: hashq = hasnq = 1; break; 3393291902Skevlo case 3: case 4: hashq = hasnq = haslq = 1; break; 3394291902Skevlo } 3395251538Srpaulo nqueues = hashq + hasnq + haslq; 3396251538Srpaulo if (nqueues == 0) 3397251538Srpaulo return (EIO); 3398251538Srpaulo 3399291902Skevlo npubqpages = nqpages = nrempages = pagecount = 0; 3400291902Skevlo if (sc->chip & URTWN_CHIP_88E) 3401291902Skevlo tx_boundary = R88E_TX_PAGE_BOUNDARY; 3402291902Skevlo else { 3403291902Skevlo pagecount = R92C_TX_PAGE_COUNT; 3404291902Skevlo npubqpages = R92C_PUBQ_NPAGES; 3405291902Skevlo tx_boundary = R92C_TX_PAGE_BOUNDARY; 3406291902Skevlo } 3407291902Skevlo 3408251538Srpaulo /* Set number of pages for normal priority queue. */ 3409291902Skevlo if (sc->chip & URTWN_CHIP_88E) { 3410291902Skevlo usb_err = urtwn_write_2(sc, R92C_RQPN_NPQ, 0xd); 3411291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3412291902Skevlo return (EIO); 3413291902Skevlo usb_err = urtwn_write_4(sc, R92C_RQPN, 0x808e000d); 3414291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3415291902Skevlo return (EIO); 3416291902Skevlo } else { 3417291902Skevlo /* Get the number of pages for each queue. */ 3418291902Skevlo nqpages = (pagecount - npubqpages) / nqueues; 3419291902Skevlo /* 3420291902Skevlo * The remaining pages are assigned to the high priority 3421291902Skevlo * queue. 3422291902Skevlo */ 3423291902Skevlo nrempages = (pagecount - npubqpages) % nqueues; 3424291902Skevlo usb_err = urtwn_write_1(sc, R92C_RQPN_NPQ, hasnq ? nqpages : 0); 3425291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3426291902Skevlo return (EIO); 3427291902Skevlo usb_err = urtwn_write_4(sc, R92C_RQPN, 3428291902Skevlo /* Set number of pages for public queue. */ 3429291902Skevlo SM(R92C_RQPN_PUBQ, npubqpages) | 3430291902Skevlo /* Set number of pages for high priority queue. */ 3431291902Skevlo SM(R92C_RQPN_HPQ, hashq ? nqpages + nrempages : 0) | 3432291902Skevlo /* Set number of pages for low priority queue. */ 3433291902Skevlo SM(R92C_RQPN_LPQ, haslq ? nqpages : 0) | 3434291902Skevlo /* Load values. */ 3435291902Skevlo R92C_RQPN_LD); 3436291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3437291902Skevlo return (EIO); 3438291902Skevlo } 3439251538Srpaulo 3440291902Skevlo usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_BCNQ_BDNY, tx_boundary); 3441291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3442291698Savos return (EIO); 3443291902Skevlo usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_MGQ_BDNY, tx_boundary); 3444291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3445291698Savos return (EIO); 3446291902Skevlo usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_WMAC_LBK_BF_HD, tx_boundary); 3447291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3448291698Savos return (EIO); 3449291902Skevlo usb_err = urtwn_write_1(sc, R92C_TRXFF_BNDY, tx_boundary); 3450291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3451291698Savos return (EIO); 3452291902Skevlo usb_err = urtwn_write_1(sc, R92C_TDECTRL + 1, tx_boundary); 3453291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3454291698Savos return (EIO); 3455251538Srpaulo 3456251538Srpaulo /* Set queue to USB pipe mapping. */ 3457251538Srpaulo reg = urtwn_read_2(sc, R92C_TRXDMA_CTRL); 3458251538Srpaulo reg &= ~R92C_TRXDMA_CTRL_QMAP_M; 3459251538Srpaulo if (nqueues == 1) { 3460251538Srpaulo if (hashq) 3461251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_HQ; 3462251538Srpaulo else if (hasnq) 3463251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_NQ; 3464251538Srpaulo else 3465251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_LQ; 3466251538Srpaulo } else if (nqueues == 2) { 3467292056Skevlo /* 3468292056Skevlo * All 2-endpoints configs have high and normal 3469292056Skevlo * priority queues. 3470292056Skevlo */ 3471292056Skevlo reg |= R92C_TRXDMA_CTRL_QMAP_HQ_NQ; 3472251538Srpaulo } else 3473251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_3EP; 3474291902Skevlo usb_err = urtwn_write_2(sc, R92C_TRXDMA_CTRL, reg); 3475291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3476291698Savos return (EIO); 3477251538Srpaulo 3478251538Srpaulo /* Set Tx/Rx transfer page boundary. */ 3479291902Skevlo usb_err = urtwn_write_2(sc, R92C_TRXFF_BNDY + 2, 3480291902Skevlo (sc->chip & URTWN_CHIP_88E) ? 0x23ff : 0x27ff); 3481291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3482291698Savos return (EIO); 3483251538Srpaulo 3484291902Skevlo /* Set Tx/Rx transfer page size. */ 3485291902Skevlo usb_err = urtwn_write_1(sc, R92C_PBP, 3486291902Skevlo SM(R92C_PBP_PSRX, R92C_PBP_128) | 3487291902Skevlo SM(R92C_PBP_PSTX, R92C_PBP_128)); 3488291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3489264912Skevlo return (EIO); 3490264912Skevlo 3491264912Skevlo return (0); 3492264912Skevlo} 3493264912Skevlo 3494291698Savosstatic int 3495251538Srpaulourtwn_mac_init(struct urtwn_softc *sc) 3496251538Srpaulo{ 3497291698Savos usb_error_t error; 3498251538Srpaulo int i; 3499251538Srpaulo 3500251538Srpaulo /* Write MAC initialization values. */ 3501264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 3502264912Skevlo for (i = 0; i < nitems(rtl8188eu_mac); i++) { 3503291698Savos error = urtwn_write_1(sc, rtl8188eu_mac[i].reg, 3504264912Skevlo rtl8188eu_mac[i].val); 3505291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3506291698Savos return (EIO); 3507264912Skevlo } 3508264912Skevlo urtwn_write_1(sc, R92C_MAX_AGGR_NUM, 0x07); 3509264912Skevlo } else { 3510264912Skevlo for (i = 0; i < nitems(rtl8192cu_mac); i++) 3511291698Savos error = urtwn_write_1(sc, rtl8192cu_mac[i].reg, 3512264912Skevlo rtl8192cu_mac[i].val); 3513291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3514291698Savos return (EIO); 3515264912Skevlo } 3516291698Savos 3517291698Savos return (0); 3518251538Srpaulo} 3519251538Srpaulo 3520251538Srpaulostatic void 3521251538Srpaulourtwn_bb_init(struct urtwn_softc *sc) 3522251538Srpaulo{ 3523251538Srpaulo const struct urtwn_bb_prog *prog; 3524251538Srpaulo uint32_t reg; 3525264912Skevlo uint8_t crystalcap; 3526251538Srpaulo int i; 3527251538Srpaulo 3528251538Srpaulo /* Enable BB and RF. */ 3529251538Srpaulo urtwn_write_2(sc, R92C_SYS_FUNC_EN, 3530251538Srpaulo urtwn_read_2(sc, R92C_SYS_FUNC_EN) | 3531251538Srpaulo R92C_SYS_FUNC_EN_BBRSTB | R92C_SYS_FUNC_EN_BB_GLB_RST | 3532251538Srpaulo R92C_SYS_FUNC_EN_DIO_RF); 3533251538Srpaulo 3534264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) 3535264912Skevlo urtwn_write_2(sc, R92C_AFE_PLL_CTRL, 0xdb83); 3536251538Srpaulo 3537251538Srpaulo urtwn_write_1(sc, R92C_RF_CTRL, 3538251538Srpaulo R92C_RF_CTRL_EN | R92C_RF_CTRL_RSTB | R92C_RF_CTRL_SDMRSTB); 3539251538Srpaulo urtwn_write_1(sc, R92C_SYS_FUNC_EN, 3540251538Srpaulo R92C_SYS_FUNC_EN_USBA | R92C_SYS_FUNC_EN_USBD | 3541251538Srpaulo R92C_SYS_FUNC_EN_BB_GLB_RST | R92C_SYS_FUNC_EN_BBRSTB); 3542251538Srpaulo 3543264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 3544264912Skevlo urtwn_write_1(sc, R92C_LDOHCI12_CTRL, 0x0f); 3545264912Skevlo urtwn_write_1(sc, 0x15, 0xe9); 3546264912Skevlo urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 1, 0x80); 3547264912Skevlo } 3548251538Srpaulo 3549251538Srpaulo /* Select BB programming based on board type. */ 3550264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3551264912Skevlo prog = &rtl8188eu_bb_prog; 3552264912Skevlo else if (!(sc->chip & URTWN_CHIP_92C)) { 3553251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 3554251538Srpaulo prog = &rtl8188ce_bb_prog; 3555251538Srpaulo else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 3556251538Srpaulo prog = &rtl8188ru_bb_prog; 3557251538Srpaulo else 3558251538Srpaulo prog = &rtl8188cu_bb_prog; 3559251538Srpaulo } else { 3560251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 3561251538Srpaulo prog = &rtl8192ce_bb_prog; 3562251538Srpaulo else 3563251538Srpaulo prog = &rtl8192cu_bb_prog; 3564251538Srpaulo } 3565251538Srpaulo /* Write BB initialization values. */ 3566251538Srpaulo for (i = 0; i < prog->count; i++) { 3567251538Srpaulo urtwn_bb_write(sc, prog->regs[i], prog->vals[i]); 3568266472Shselasky urtwn_ms_delay(sc); 3569251538Srpaulo } 3570251538Srpaulo 3571251538Srpaulo if (sc->chip & URTWN_CHIP_92C_1T2R) { 3572251538Srpaulo /* 8192C 1T only configuration. */ 3573251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_TXINFO); 3574251538Srpaulo reg = (reg & ~0x00000003) | 0x2; 3575251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_TXINFO, reg); 3576251538Srpaulo 3577251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA1_TXINFO); 3578251538Srpaulo reg = (reg & ~0x00300033) | 0x00200022; 3579251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_TXINFO, reg); 3580251538Srpaulo 3581251538Srpaulo reg = urtwn_bb_read(sc, R92C_CCK0_AFESETTING); 3582251538Srpaulo reg = (reg & ~0xff000000) | 0x45 << 24; 3583251538Srpaulo urtwn_bb_write(sc, R92C_CCK0_AFESETTING, reg); 3584251538Srpaulo 3585251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_TRXPATHENA); 3586251538Srpaulo reg = (reg & ~0x000000ff) | 0x23; 3587251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_TRXPATHENA, reg); 3588251538Srpaulo 3589251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_AGCPARAM1); 3590251538Srpaulo reg = (reg & ~0x00000030) | 1 << 4; 3591251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCPARAM1, reg); 3592251538Srpaulo 3593251538Srpaulo reg = urtwn_bb_read(sc, 0xe74); 3594251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 3595251538Srpaulo urtwn_bb_write(sc, 0xe74, reg); 3596251538Srpaulo reg = urtwn_bb_read(sc, 0xe78); 3597251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 3598251538Srpaulo urtwn_bb_write(sc, 0xe78, reg); 3599251538Srpaulo reg = urtwn_bb_read(sc, 0xe7c); 3600251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 3601251538Srpaulo urtwn_bb_write(sc, 0xe7c, reg); 3602251538Srpaulo reg = urtwn_bb_read(sc, 0xe80); 3603251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 3604251538Srpaulo urtwn_bb_write(sc, 0xe80, reg); 3605251538Srpaulo reg = urtwn_bb_read(sc, 0xe88); 3606251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 3607251538Srpaulo urtwn_bb_write(sc, 0xe88, reg); 3608251538Srpaulo } 3609251538Srpaulo 3610251538Srpaulo /* Write AGC values. */ 3611251538Srpaulo for (i = 0; i < prog->agccount; i++) { 3612251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCRSSITABLE, 3613251538Srpaulo prog->agcvals[i]); 3614266472Shselasky urtwn_ms_delay(sc); 3615251538Srpaulo } 3616251538Srpaulo 3617264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 3618264912Skevlo urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553422); 3619266472Shselasky urtwn_ms_delay(sc); 3620264912Skevlo urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553420); 3621266472Shselasky urtwn_ms_delay(sc); 3622264912Skevlo 3623294198Savos crystalcap = sc->rom.r88e_rom.crystalcap; 3624264912Skevlo if (crystalcap == 0xff) 3625264912Skevlo crystalcap = 0x20; 3626264912Skevlo crystalcap &= 0x3f; 3627264912Skevlo reg = urtwn_bb_read(sc, R92C_AFE_XTAL_CTRL); 3628264912Skevlo urtwn_bb_write(sc, R92C_AFE_XTAL_CTRL, 3629264912Skevlo RW(reg, R92C_AFE_XTAL_CTRL_ADDR, 3630264912Skevlo crystalcap | crystalcap << 6)); 3631264912Skevlo } else { 3632264912Skevlo if (urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)) & 3633264912Skevlo R92C_HSSI_PARAM2_CCK_HIPWR) 3634264912Skevlo sc->sc_flags |= URTWN_FLAG_CCK_HIPWR; 3635264912Skevlo } 3636251538Srpaulo} 3637251538Srpaulo 3638289066Skevlostatic void 3639251538Srpaulourtwn_rf_init(struct urtwn_softc *sc) 3640251538Srpaulo{ 3641251538Srpaulo const struct urtwn_rf_prog *prog; 3642251538Srpaulo uint32_t reg, type; 3643251538Srpaulo int i, j, idx, off; 3644251538Srpaulo 3645251538Srpaulo /* Select RF programming based on board type. */ 3646264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3647264912Skevlo prog = rtl8188eu_rf_prog; 3648264912Skevlo else if (!(sc->chip & URTWN_CHIP_92C)) { 3649251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 3650251538Srpaulo prog = rtl8188ce_rf_prog; 3651251538Srpaulo else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 3652251538Srpaulo prog = rtl8188ru_rf_prog; 3653251538Srpaulo else 3654251538Srpaulo prog = rtl8188cu_rf_prog; 3655251538Srpaulo } else 3656251538Srpaulo prog = rtl8192ce_rf_prog; 3657251538Srpaulo 3658251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 3659251538Srpaulo /* Save RF_ENV control type. */ 3660251538Srpaulo idx = i / 2; 3661251538Srpaulo off = (i % 2) * 16; 3662251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx)); 3663251538Srpaulo type = (reg >> off) & 0x10; 3664251538Srpaulo 3665251538Srpaulo /* Set RF_ENV enable. */ 3666251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i)); 3667251538Srpaulo reg |= 0x100000; 3668251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg); 3669266472Shselasky urtwn_ms_delay(sc); 3670251538Srpaulo /* Set RF_ENV output high. */ 3671251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i)); 3672251538Srpaulo reg |= 0x10; 3673251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg); 3674266472Shselasky urtwn_ms_delay(sc); 3675251538Srpaulo /* Set address and data lengths of RF registers. */ 3676251538Srpaulo reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i)); 3677251538Srpaulo reg &= ~R92C_HSSI_PARAM2_ADDR_LENGTH; 3678251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg); 3679266472Shselasky urtwn_ms_delay(sc); 3680251538Srpaulo reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i)); 3681251538Srpaulo reg &= ~R92C_HSSI_PARAM2_DATA_LENGTH; 3682251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg); 3683266472Shselasky urtwn_ms_delay(sc); 3684251538Srpaulo 3685251538Srpaulo /* Write RF initialization values for this chain. */ 3686251538Srpaulo for (j = 0; j < prog[i].count; j++) { 3687251538Srpaulo if (prog[i].regs[j] >= 0xf9 && 3688251538Srpaulo prog[i].regs[j] <= 0xfe) { 3689251538Srpaulo /* 3690251538Srpaulo * These are fake RF registers offsets that 3691251538Srpaulo * indicate a delay is required. 3692251538Srpaulo */ 3693266472Shselasky usb_pause_mtx(&sc->sc_mtx, hz / 20); /* 50ms */ 3694251538Srpaulo continue; 3695251538Srpaulo } 3696251538Srpaulo urtwn_rf_write(sc, i, prog[i].regs[j], 3697251538Srpaulo prog[i].vals[j]); 3698266472Shselasky urtwn_ms_delay(sc); 3699251538Srpaulo } 3700251538Srpaulo 3701251538Srpaulo /* Restore RF_ENV control type. */ 3702251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx)); 3703251538Srpaulo reg &= ~(0x10 << off) | (type << off); 3704251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACESW(idx), reg); 3705251538Srpaulo 3706251538Srpaulo /* Cache RF register CHNLBW. */ 3707251538Srpaulo sc->rf_chnlbw[i] = urtwn_rf_read(sc, i, R92C_RF_CHNLBW); 3708251538Srpaulo } 3709251538Srpaulo 3710251538Srpaulo if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) == 3711251538Srpaulo URTWN_CHIP_UMC_A_CUT) { 3712251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_RX_G1, 0x30255); 3713251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_RX_G2, 0x50a00); 3714251538Srpaulo } 3715251538Srpaulo} 3716251538Srpaulo 3717251538Srpaulostatic void 3718251538Srpaulourtwn_cam_init(struct urtwn_softc *sc) 3719251538Srpaulo{ 3720251538Srpaulo /* Invalidate all CAM entries. */ 3721251538Srpaulo urtwn_write_4(sc, R92C_CAMCMD, 3722251538Srpaulo R92C_CAMCMD_POLLING | R92C_CAMCMD_CLR); 3723251538Srpaulo} 3724251538Srpaulo 3725292175Savosstatic int 3726292175Savosurtwn_cam_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data) 3727292175Savos{ 3728292175Savos usb_error_t error; 3729292175Savos 3730292175Savos error = urtwn_write_4(sc, R92C_CAMWRITE, data); 3731292175Savos if (error != USB_ERR_NORMAL_COMPLETION) 3732292175Savos return (EIO); 3733292175Savos error = urtwn_write_4(sc, R92C_CAMCMD, 3734292175Savos R92C_CAMCMD_POLLING | R92C_CAMCMD_WRITE | 3735292175Savos SM(R92C_CAMCMD_ADDR, addr)); 3736292175Savos if (error != USB_ERR_NORMAL_COMPLETION) 3737292175Savos return (EIO); 3738292175Savos 3739292175Savos return (0); 3740292175Savos} 3741292175Savos 3742251538Srpaulostatic void 3743251538Srpaulourtwn_pa_bias_init(struct urtwn_softc *sc) 3744251538Srpaulo{ 3745251538Srpaulo uint8_t reg; 3746251538Srpaulo int i; 3747251538Srpaulo 3748251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 3749251538Srpaulo if (sc->pa_setting & (1 << i)) 3750251538Srpaulo continue; 3751251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x0f406); 3752251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x4f406); 3753251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x8f406); 3754251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0xcf406); 3755251538Srpaulo } 3756251538Srpaulo if (!(sc->pa_setting & 0x10)) { 3757251538Srpaulo reg = urtwn_read_1(sc, 0x16); 3758251538Srpaulo reg = (reg & ~0xf0) | 0x90; 3759251538Srpaulo urtwn_write_1(sc, 0x16, reg); 3760251538Srpaulo } 3761251538Srpaulo} 3762251538Srpaulo 3763251538Srpaulostatic void 3764251538Srpaulourtwn_rxfilter_init(struct urtwn_softc *sc) 3765251538Srpaulo{ 3766290564Savos struct ieee80211com *ic = &sc->sc_ic; 3767290564Savos struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 3768290564Savos uint32_t rcr; 3769290564Savos uint16_t filter; 3770290564Savos 3771290564Savos URTWN_ASSERT_LOCKED(sc); 3772290564Savos 3773251538Srpaulo /* Accept all multicast frames. */ 3774251538Srpaulo urtwn_write_4(sc, R92C_MAR + 0, 0xffffffff); 3775251538Srpaulo urtwn_write_4(sc, R92C_MAR + 4, 0xffffffff); 3776290564Savos 3777290564Savos /* Filter for management frames. */ 3778290564Savos filter = 0x7f3f; 3779290631Savos switch (vap->iv_opmode) { 3780290631Savos case IEEE80211_M_STA: 3781290564Savos filter &= ~( 3782290564Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_ASSOC_REQ) | 3783290564Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_REASSOC_REQ) | 3784290564Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_PROBE_REQ)); 3785290631Savos break; 3786290631Savos case IEEE80211_M_HOSTAP: 3787290631Savos filter &= ~( 3788290631Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_ASSOC_RESP) | 3789290631Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_REASSOC_RESP) | 3790290631Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_BEACON)); 3791290631Savos break; 3792290631Savos case IEEE80211_M_MONITOR: 3793290651Savos case IEEE80211_M_IBSS: 3794290631Savos break; 3795290631Savos default: 3796290631Savos device_printf(sc->sc_dev, "%s: undefined opmode %d\n", 3797290631Savos __func__, vap->iv_opmode); 3798290631Savos break; 3799290564Savos } 3800290564Savos urtwn_write_2(sc, R92C_RXFLTMAP0, filter); 3801290564Savos 3802251538Srpaulo /* Reject all control frames. */ 3803251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP1, 0x0000); 3804290564Savos 3805290564Savos /* Reject all data frames. */ 3806290564Savos urtwn_write_2(sc, R92C_RXFLTMAP2, 0x0000); 3807290564Savos 3808290564Savos rcr = R92C_RCR_AM | R92C_RCR_AB | R92C_RCR_APM | 3809290564Savos R92C_RCR_HTC_LOC_CTRL | R92C_RCR_APP_PHYSTS | 3810290564Savos R92C_RCR_APP_ICV | R92C_RCR_APP_MIC; 3811290564Savos 3812290564Savos if (vap->iv_opmode == IEEE80211_M_MONITOR) { 3813290564Savos /* Accept all frames. */ 3814290564Savos rcr |= R92C_RCR_ACF | R92C_RCR_ADF | R92C_RCR_AMF | 3815290564Savos R92C_RCR_AAP; 3816290564Savos } 3817290564Savos 3818290564Savos /* Set Rx filter. */ 3819290564Savos urtwn_write_4(sc, R92C_RCR, rcr); 3820290564Savos 3821290564Savos if (ic->ic_promisc != 0) { 3822290564Savos /* Update Rx filter. */ 3823290564Savos urtwn_set_promisc(sc); 3824290564Savos } 3825251538Srpaulo} 3826251538Srpaulo 3827251538Srpaulostatic void 3828251538Srpaulourtwn_edca_init(struct urtwn_softc *sc) 3829251538Srpaulo{ 3830251538Srpaulo urtwn_write_2(sc, R92C_SPEC_SIFS, 0x100a); 3831251538Srpaulo urtwn_write_2(sc, R92C_MAC_SPEC_SIFS, 0x100a); 3832251538Srpaulo urtwn_write_2(sc, R92C_SIFS_CCK, 0x100a); 3833251538Srpaulo urtwn_write_2(sc, R92C_SIFS_OFDM, 0x100a); 3834251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x005ea42b); 3835251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a44f); 3836251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005ea324); 3837251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002fa226); 3838251538Srpaulo} 3839251538Srpaulo 3840289066Skevlostatic void 3841251538Srpaulourtwn_write_txpower(struct urtwn_softc *sc, int chain, 3842251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]) 3843251538Srpaulo{ 3844251538Srpaulo uint32_t reg; 3845251538Srpaulo 3846251538Srpaulo /* Write per-CCK rate Tx power. */ 3847251538Srpaulo if (chain == 0) { 3848251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_A_CCK1_MCS32); 3849251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK1, power[0]); 3850251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_A_CCK1_MCS32, reg); 3851251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11); 3852251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK2, power[1]); 3853251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK55, power[2]); 3854251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK11, power[3]); 3855251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg); 3856251538Srpaulo } else { 3857251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK1_55_MCS32); 3858251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK1, power[0]); 3859251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK2, power[1]); 3860251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK55, power[2]); 3861251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK1_55_MCS32, reg); 3862251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11); 3863251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK11, power[3]); 3864251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg); 3865251538Srpaulo } 3866251538Srpaulo /* Write per-OFDM rate Tx power. */ 3867251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_RATE18_06(chain), 3868251538Srpaulo SM(R92C_TXAGC_RATE06, power[ 4]) | 3869251538Srpaulo SM(R92C_TXAGC_RATE09, power[ 5]) | 3870251538Srpaulo SM(R92C_TXAGC_RATE12, power[ 6]) | 3871251538Srpaulo SM(R92C_TXAGC_RATE18, power[ 7])); 3872251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_RATE54_24(chain), 3873251538Srpaulo SM(R92C_TXAGC_RATE24, power[ 8]) | 3874251538Srpaulo SM(R92C_TXAGC_RATE36, power[ 9]) | 3875251538Srpaulo SM(R92C_TXAGC_RATE48, power[10]) | 3876251538Srpaulo SM(R92C_TXAGC_RATE54, power[11])); 3877251538Srpaulo /* Write per-MCS Tx power. */ 3878251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS03_MCS00(chain), 3879251538Srpaulo SM(R92C_TXAGC_MCS00, power[12]) | 3880251538Srpaulo SM(R92C_TXAGC_MCS01, power[13]) | 3881251538Srpaulo SM(R92C_TXAGC_MCS02, power[14]) | 3882251538Srpaulo SM(R92C_TXAGC_MCS03, power[15])); 3883251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS07_MCS04(chain), 3884251538Srpaulo SM(R92C_TXAGC_MCS04, power[16]) | 3885251538Srpaulo SM(R92C_TXAGC_MCS05, power[17]) | 3886251538Srpaulo SM(R92C_TXAGC_MCS06, power[18]) | 3887251538Srpaulo SM(R92C_TXAGC_MCS07, power[19])); 3888251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS11_MCS08(chain), 3889251538Srpaulo SM(R92C_TXAGC_MCS08, power[20]) | 3890261506Skevlo SM(R92C_TXAGC_MCS09, power[21]) | 3891251538Srpaulo SM(R92C_TXAGC_MCS10, power[22]) | 3892251538Srpaulo SM(R92C_TXAGC_MCS11, power[23])); 3893251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS15_MCS12(chain), 3894251538Srpaulo SM(R92C_TXAGC_MCS12, power[24]) | 3895251538Srpaulo SM(R92C_TXAGC_MCS13, power[25]) | 3896251538Srpaulo SM(R92C_TXAGC_MCS14, power[26]) | 3897251538Srpaulo SM(R92C_TXAGC_MCS15, power[27])); 3898251538Srpaulo} 3899251538Srpaulo 3900289066Skevlostatic void 3901251538Srpaulourtwn_get_txpower(struct urtwn_softc *sc, int chain, 3902251538Srpaulo struct ieee80211_channel *c, struct ieee80211_channel *extc, 3903251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]) 3904251538Srpaulo{ 3905287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 3906291264Savos struct r92c_rom *rom = &sc->rom.r92c_rom; 3907251538Srpaulo uint16_t cckpow, ofdmpow, htpow, diff, max; 3908251538Srpaulo const struct urtwn_txpwr *base; 3909251538Srpaulo int ridx, chan, group; 3910251538Srpaulo 3911251538Srpaulo /* Determine channel group. */ 3912251538Srpaulo chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */ 3913251538Srpaulo if (chan <= 3) 3914251538Srpaulo group = 0; 3915251538Srpaulo else if (chan <= 9) 3916251538Srpaulo group = 1; 3917251538Srpaulo else 3918251538Srpaulo group = 2; 3919251538Srpaulo 3920251538Srpaulo /* Get original Tx power based on board type and RF chain. */ 3921251538Srpaulo if (!(sc->chip & URTWN_CHIP_92C)) { 3922251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 3923251538Srpaulo base = &rtl8188ru_txagc[chain]; 3924251538Srpaulo else 3925251538Srpaulo base = &rtl8192cu_txagc[chain]; 3926251538Srpaulo } else 3927251538Srpaulo base = &rtl8192cu_txagc[chain]; 3928251538Srpaulo 3929251538Srpaulo memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0])); 3930251538Srpaulo if (sc->regulatory == 0) { 3931289758Savos for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) 3932251538Srpaulo power[ridx] = base->pwr[0][ridx]; 3933251538Srpaulo } 3934289758Savos for (ridx = URTWN_RIDX_OFDM6; ridx < URTWN_RIDX_COUNT; ridx++) { 3935251538Srpaulo if (sc->regulatory == 3) { 3936251538Srpaulo power[ridx] = base->pwr[0][ridx]; 3937251538Srpaulo /* Apply vendor limits. */ 3938251538Srpaulo if (extc != NULL) 3939251538Srpaulo max = rom->ht40_max_pwr[group]; 3940251538Srpaulo else 3941251538Srpaulo max = rom->ht20_max_pwr[group]; 3942251538Srpaulo max = (max >> (chain * 4)) & 0xf; 3943251538Srpaulo if (power[ridx] > max) 3944251538Srpaulo power[ridx] = max; 3945251538Srpaulo } else if (sc->regulatory == 1) { 3946251538Srpaulo if (extc == NULL) 3947251538Srpaulo power[ridx] = base->pwr[group][ridx]; 3948251538Srpaulo } else if (sc->regulatory != 2) 3949251538Srpaulo power[ridx] = base->pwr[0][ridx]; 3950251538Srpaulo } 3951251538Srpaulo 3952251538Srpaulo /* Compute per-CCK rate Tx power. */ 3953251538Srpaulo cckpow = rom->cck_tx_pwr[chain][group]; 3954289758Savos for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) { 3955251538Srpaulo power[ridx] += cckpow; 3956251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 3957251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 3958251538Srpaulo } 3959251538Srpaulo 3960251538Srpaulo htpow = rom->ht40_1s_tx_pwr[chain][group]; 3961251538Srpaulo if (sc->ntxchains > 1) { 3962251538Srpaulo /* Apply reduction for 2 spatial streams. */ 3963251538Srpaulo diff = rom->ht40_2s_tx_pwr_diff[group]; 3964251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 3965251538Srpaulo htpow = (htpow > diff) ? htpow - diff : 0; 3966251538Srpaulo } 3967251538Srpaulo 3968251538Srpaulo /* Compute per-OFDM rate Tx power. */ 3969251538Srpaulo diff = rom->ofdm_tx_pwr_diff[group]; 3970251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 3971251538Srpaulo ofdmpow = htpow + diff; /* HT->OFDM correction. */ 3972289758Savos for (ridx = URTWN_RIDX_OFDM6; ridx <= URTWN_RIDX_OFDM54; ridx++) { 3973251538Srpaulo power[ridx] += ofdmpow; 3974251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 3975251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 3976251538Srpaulo } 3977251538Srpaulo 3978251538Srpaulo /* Compute per-MCS Tx power. */ 3979251538Srpaulo if (extc == NULL) { 3980251538Srpaulo diff = rom->ht20_tx_pwr_diff[group]; 3981251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 3982251538Srpaulo htpow += diff; /* HT40->HT20 correction. */ 3983251538Srpaulo } 3984251538Srpaulo for (ridx = 12; ridx <= 27; ridx++) { 3985251538Srpaulo power[ridx] += htpow; 3986251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 3987251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 3988251538Srpaulo } 3989251538Srpaulo#ifdef URTWN_DEBUG 3990251538Srpaulo if (urtwn_debug >= 4) { 3991251538Srpaulo /* Dump per-rate Tx power values. */ 3992251538Srpaulo printf("Tx power for chain %d:\n", chain); 3993289758Savos for (ridx = URTWN_RIDX_CCK1; ridx < URTWN_RIDX_COUNT; ridx++) 3994251538Srpaulo printf("Rate %d = %u\n", ridx, power[ridx]); 3995251538Srpaulo } 3996251538Srpaulo#endif 3997251538Srpaulo} 3998251538Srpaulo 3999289066Skevlostatic void 4000264912Skevlourtwn_r88e_get_txpower(struct urtwn_softc *sc, int chain, 4001264912Skevlo struct ieee80211_channel *c, struct ieee80211_channel *extc, 4002264912Skevlo uint16_t power[URTWN_RIDX_COUNT]) 4003264912Skevlo{ 4004287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 4005294198Savos struct r88e_rom *rom = &sc->rom.r88e_rom; 4006264912Skevlo uint16_t cckpow, ofdmpow, bw20pow, htpow; 4007264912Skevlo const struct urtwn_r88e_txpwr *base; 4008264912Skevlo int ridx, chan, group; 4009264912Skevlo 4010264912Skevlo /* Determine channel group. */ 4011264912Skevlo chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */ 4012264912Skevlo if (chan <= 2) 4013264912Skevlo group = 0; 4014264912Skevlo else if (chan <= 5) 4015264912Skevlo group = 1; 4016264912Skevlo else if (chan <= 8) 4017264912Skevlo group = 2; 4018264912Skevlo else if (chan <= 11) 4019264912Skevlo group = 3; 4020264912Skevlo else if (chan <= 13) 4021264912Skevlo group = 4; 4022264912Skevlo else 4023264912Skevlo group = 5; 4024264912Skevlo 4025264912Skevlo /* Get original Tx power based on board type and RF chain. */ 4026264912Skevlo base = &rtl8188eu_txagc[chain]; 4027264912Skevlo 4028264912Skevlo memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0])); 4029264912Skevlo if (sc->regulatory == 0) { 4030289758Savos for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) 4031264912Skevlo power[ridx] = base->pwr[0][ridx]; 4032264912Skevlo } 4033289758Savos for (ridx = URTWN_RIDX_OFDM6; ridx < URTWN_RIDX_COUNT; ridx++) { 4034264912Skevlo if (sc->regulatory == 3) 4035264912Skevlo power[ridx] = base->pwr[0][ridx]; 4036264912Skevlo else if (sc->regulatory == 1) { 4037264912Skevlo if (extc == NULL) 4038264912Skevlo power[ridx] = base->pwr[group][ridx]; 4039264912Skevlo } else if (sc->regulatory != 2) 4040264912Skevlo power[ridx] = base->pwr[0][ridx]; 4041264912Skevlo } 4042264912Skevlo 4043264912Skevlo /* Compute per-CCK rate Tx power. */ 4044294198Savos cckpow = rom->cck_tx_pwr[group]; 4045289758Savos for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) { 4046264912Skevlo power[ridx] += cckpow; 4047264912Skevlo if (power[ridx] > R92C_MAX_TX_PWR) 4048264912Skevlo power[ridx] = R92C_MAX_TX_PWR; 4049264912Skevlo } 4050264912Skevlo 4051294198Savos htpow = rom->ht40_tx_pwr[group]; 4052264912Skevlo 4053264912Skevlo /* Compute per-OFDM rate Tx power. */ 4054264912Skevlo ofdmpow = htpow + sc->ofdm_tx_pwr_diff; 4055289758Savos for (ridx = URTWN_RIDX_OFDM6; ridx <= URTWN_RIDX_OFDM54; ridx++) { 4056264912Skevlo power[ridx] += ofdmpow; 4057264912Skevlo if (power[ridx] > R92C_MAX_TX_PWR) 4058264912Skevlo power[ridx] = R92C_MAX_TX_PWR; 4059264912Skevlo } 4060264912Skevlo 4061264912Skevlo bw20pow = htpow + sc->bw20_tx_pwr_diff; 4062264912Skevlo for (ridx = 12; ridx <= 27; ridx++) { 4063264912Skevlo power[ridx] += bw20pow; 4064264912Skevlo if (power[ridx] > R92C_MAX_TX_PWR) 4065264912Skevlo power[ridx] = R92C_MAX_TX_PWR; 4066264912Skevlo } 4067264912Skevlo} 4068264912Skevlo 4069289066Skevlostatic void 4070251538Srpaulourtwn_set_txpower(struct urtwn_softc *sc, struct ieee80211_channel *c, 4071251538Srpaulo struct ieee80211_channel *extc) 4072251538Srpaulo{ 4073251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]; 4074251538Srpaulo int i; 4075251538Srpaulo 4076251538Srpaulo for (i = 0; i < sc->ntxchains; i++) { 4077251538Srpaulo /* Compute per-rate Tx power values. */ 4078264912Skevlo if (sc->chip & URTWN_CHIP_88E) 4079264912Skevlo urtwn_r88e_get_txpower(sc, i, c, extc, power); 4080264912Skevlo else 4081264912Skevlo urtwn_get_txpower(sc, i, c, extc, power); 4082251538Srpaulo /* Write per-rate Tx power values to hardware. */ 4083251538Srpaulo urtwn_write_txpower(sc, i, power); 4084251538Srpaulo } 4085251538Srpaulo} 4086251538Srpaulo 4087251538Srpaulostatic void 4088290048Savosurtwn_set_rx_bssid_all(struct urtwn_softc *sc, int enable) 4089290048Savos{ 4090290048Savos uint32_t reg; 4091290048Savos 4092290048Savos reg = urtwn_read_4(sc, R92C_RCR); 4093290048Savos if (enable) 4094290048Savos reg &= ~R92C_RCR_CBSSID_BCN; 4095290048Savos else 4096290048Savos reg |= R92C_RCR_CBSSID_BCN; 4097290048Savos urtwn_write_4(sc, R92C_RCR, reg); 4098290048Savos} 4099290048Savos 4100290048Savosstatic void 4101290048Savosurtwn_set_gain(struct urtwn_softc *sc, uint8_t gain) 4102290048Savos{ 4103290048Savos uint32_t reg; 4104290048Savos 4105290048Savos reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0)); 4106290048Savos reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, gain); 4107290048Savos urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg); 4108290048Savos 4109290048Savos if (!(sc->chip & URTWN_CHIP_88E)) { 4110290048Savos reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1)); 4111290048Savos reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, gain); 4112290048Savos urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg); 4113290048Savos } 4114290048Savos} 4115290048Savos 4116290048Savosstatic void 4117251538Srpaulourtwn_scan_start(struct ieee80211com *ic) 4118251538Srpaulo{ 4119290048Savos struct urtwn_softc *sc = ic->ic_softc; 4120290048Savos 4121290048Savos URTWN_LOCK(sc); 4122290048Savos /* Receive beacons / probe responses from any BSSID. */ 4123290651Savos if (ic->ic_opmode != IEEE80211_M_IBSS) 4124290651Savos urtwn_set_rx_bssid_all(sc, 1); 4125290651Savos 4126290048Savos /* Set gain for scanning. */ 4127290048Savos urtwn_set_gain(sc, 0x20); 4128290048Savos URTWN_UNLOCK(sc); 4129251538Srpaulo} 4130251538Srpaulo 4131251538Srpaulostatic void 4132251538Srpaulourtwn_scan_end(struct ieee80211com *ic) 4133251538Srpaulo{ 4134290048Savos struct urtwn_softc *sc = ic->ic_softc; 4135290048Savos 4136290048Savos URTWN_LOCK(sc); 4137290048Savos /* Restore limitations. */ 4138290651Savos if (ic->ic_promisc == 0 && ic->ic_opmode != IEEE80211_M_IBSS) 4139290564Savos urtwn_set_rx_bssid_all(sc, 0); 4140290651Savos 4141290048Savos /* Set gain under link. */ 4142290048Savos urtwn_set_gain(sc, 0x32); 4143290048Savos URTWN_UNLOCK(sc); 4144251538Srpaulo} 4145251538Srpaulo 4146251538Srpaulostatic void 4147251538Srpaulourtwn_set_channel(struct ieee80211com *ic) 4148251538Srpaulo{ 4149286949Sadrian struct urtwn_softc *sc = ic->ic_softc; 4150292173Savos struct ieee80211_channel *c = ic->ic_curchan; 4151281070Srpaulo struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 4152251538Srpaulo 4153251538Srpaulo URTWN_LOCK(sc); 4154281070Srpaulo if (vap->iv_state == IEEE80211_S_SCAN) { 4155281070Srpaulo /* Make link LED blink during scan. */ 4156281070Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, !sc->ledlink); 4157281070Srpaulo } 4158292173Savos urtwn_set_chan(sc, c, NULL); 4159292173Savos sc->sc_rxtap.wr_chan_freq = htole16(c->ic_freq); 4160292173Savos sc->sc_rxtap.wr_chan_flags = htole16(c->ic_flags); 4161292173Savos sc->sc_txtap.wt_chan_freq = htole16(c->ic_freq); 4162292173Savos sc->sc_txtap.wt_chan_flags = htole16(c->ic_flags); 4163251538Srpaulo URTWN_UNLOCK(sc); 4164251538Srpaulo} 4165251538Srpaulo 4166292014Savosstatic int 4167292014Savosurtwn_wme_update(struct ieee80211com *ic) 4168292014Savos{ 4169292014Savos const struct wmeParams *wmep = 4170292014Savos ic->ic_wme.wme_chanParams.cap_wmeParams; 4171292014Savos struct urtwn_softc *sc = ic->ic_softc; 4172292014Savos uint8_t aifs, acm, slottime; 4173292014Savos int ac; 4174292014Savos 4175292014Savos acm = 0; 4176292165Savos slottime = IEEE80211_GET_SLOTTIME(ic); 4177292014Savos 4178292014Savos URTWN_LOCK(sc); 4179292014Savos for (ac = WME_AC_BE; ac < WME_NUM_AC; ac++) { 4180292014Savos /* AIFS[AC] = AIFSN[AC] * aSlotTime + aSIFSTime. */ 4181292014Savos aifs = wmep[ac].wmep_aifsn * slottime + IEEE80211_DUR_SIFS; 4182292014Savos urtwn_write_4(sc, wme2queue[ac].reg, 4183292014Savos SM(R92C_EDCA_PARAM_TXOP, wmep[ac].wmep_txopLimit) | 4184292014Savos SM(R92C_EDCA_PARAM_ECWMIN, wmep[ac].wmep_logcwmin) | 4185292014Savos SM(R92C_EDCA_PARAM_ECWMAX, wmep[ac].wmep_logcwmax) | 4186292014Savos SM(R92C_EDCA_PARAM_AIFS, aifs)); 4187292014Savos if (ac != WME_AC_BE) 4188292014Savos acm |= wmep[ac].wmep_acm << ac; 4189292014Savos } 4190292014Savos 4191292014Savos if (acm != 0) 4192292014Savos acm |= R92C_ACMHWCTRL_EN; 4193292014Savos urtwn_write_1(sc, R92C_ACMHWCTRL, 4194292014Savos (urtwn_read_1(sc, R92C_ACMHWCTRL) & ~R92C_ACMHWCTRL_ACM_MASK) | 4195292014Savos acm); 4196292014Savos 4197292014Savos URTWN_UNLOCK(sc); 4198292014Savos 4199292014Savos return 0; 4200292014Savos} 4201292014Savos 4202251538Srpaulostatic void 4203294465Savosurtwn_update_slot(struct ieee80211com *ic) 4204294465Savos{ 4205294465Savos urtwn_cmd_sleepable(ic->ic_softc, NULL, 0, urtwn_update_slot_cb); 4206294465Savos} 4207294465Savos 4208294465Savosstatic void 4209294465Savosurtwn_update_slot_cb(struct urtwn_softc *sc, union sec_param *data) 4210294465Savos{ 4211294465Savos struct ieee80211com *ic = &sc->sc_ic; 4212294465Savos uint8_t slottime; 4213294465Savos 4214294465Savos slottime = IEEE80211_GET_SLOTTIME(ic); 4215294465Savos 4216294465Savos DPRINTFN(10, "setting slot time to %uus\n", slottime); 4217294465Savos 4218294465Savos urtwn_write_1(sc, R92C_SLOT, slottime); 4219294465Savos urtwn_update_aifs(sc, slottime); 4220294465Savos} 4221294465Savos 4222294465Savosstatic void 4223294465Savosurtwn_update_aifs(struct urtwn_softc *sc, uint8_t slottime) 4224294465Savos{ 4225294465Savos const struct wmeParams *wmep = 4226294465Savos sc->sc_ic.ic_wme.wme_chanParams.cap_wmeParams; 4227294465Savos uint8_t aifs, ac; 4228294465Savos 4229294465Savos for (ac = WME_AC_BE; ac < WME_NUM_AC; ac++) { 4230294465Savos /* AIFS[AC] = AIFSN[AC] * aSlotTime + aSIFSTime. */ 4231294465Savos aifs = wmep[ac].wmep_aifsn * slottime + IEEE80211_DUR_SIFS; 4232294465Savos urtwn_write_1(sc, wme2queue[ac].reg, aifs); 4233294465Savos } 4234294465Savos} 4235294465Savos 4236294465Savosstatic void 4237290564Savosurtwn_set_promisc(struct urtwn_softc *sc) 4238290564Savos{ 4239290564Savos struct ieee80211com *ic = &sc->sc_ic; 4240290564Savos struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 4241290564Savos uint32_t rcr, mask1, mask2; 4242290564Savos 4243290564Savos URTWN_ASSERT_LOCKED(sc); 4244290564Savos 4245290564Savos if (vap->iv_opmode == IEEE80211_M_MONITOR) 4246290564Savos return; 4247290564Savos 4248290564Savos mask1 = R92C_RCR_ACF | R92C_RCR_ADF | R92C_RCR_AMF | R92C_RCR_AAP; 4249290564Savos mask2 = R92C_RCR_APM; 4250290564Savos 4251290564Savos if (vap->iv_state == IEEE80211_S_RUN) { 4252290564Savos switch (vap->iv_opmode) { 4253290564Savos case IEEE80211_M_STA: 4254290631Savos mask2 |= R92C_RCR_CBSSID_DATA; 4255290631Savos /* FALLTHROUGH */ 4256290631Savos case IEEE80211_M_HOSTAP: 4257290631Savos mask2 |= R92C_RCR_CBSSID_BCN; 4258290564Savos break; 4259290651Savos case IEEE80211_M_IBSS: 4260290651Savos mask2 |= R92C_RCR_CBSSID_DATA; 4261290651Savos break; 4262290564Savos default: 4263290564Savos device_printf(sc->sc_dev, "%s: undefined opmode %d\n", 4264290564Savos __func__, vap->iv_opmode); 4265290564Savos return; 4266290564Savos } 4267290564Savos } 4268290564Savos 4269290564Savos rcr = urtwn_read_4(sc, R92C_RCR); 4270290564Savos if (ic->ic_promisc == 0) 4271290564Savos rcr = (rcr & ~mask1) | mask2; 4272290564Savos else 4273290564Savos rcr = (rcr & ~mask2) | mask1; 4274290564Savos urtwn_write_4(sc, R92C_RCR, rcr); 4275290564Savos} 4276290564Savos 4277290564Savosstatic void 4278290564Savosurtwn_update_promisc(struct ieee80211com *ic) 4279290564Savos{ 4280290564Savos struct urtwn_softc *sc = ic->ic_softc; 4281290564Savos 4282290564Savos URTWN_LOCK(sc); 4283290564Savos if (sc->sc_flags & URTWN_RUNNING) 4284290564Savos urtwn_set_promisc(sc); 4285290564Savos URTWN_UNLOCK(sc); 4286290564Savos} 4287290564Savos 4288290564Savosstatic void 4289283540Sglebiusurtwn_update_mcast(struct ieee80211com *ic) 4290251538Srpaulo{ 4291251538Srpaulo /* XXX do nothing? */ 4292251538Srpaulo} 4293251538Srpaulo 4294292167Savosstatic struct ieee80211_node * 4295292167Savosurtwn_r88e_node_alloc(struct ieee80211vap *vap, 4296292167Savos const uint8_t mac[IEEE80211_ADDR_LEN]) 4297292167Savos{ 4298292167Savos struct urtwn_node *un; 4299292167Savos 4300292167Savos un = malloc(sizeof (struct urtwn_node), M_80211_NODE, 4301292167Savos M_NOWAIT | M_ZERO); 4302292167Savos 4303292167Savos if (un == NULL) 4304292167Savos return NULL; 4305292167Savos 4306292167Savos un->id = URTWN_MACID_UNDEFINED; 4307292167Savos 4308292167Savos return &un->ni; 4309292167Savos} 4310292167Savos 4311251538Srpaulostatic void 4312292167Savosurtwn_r88e_newassoc(struct ieee80211_node *ni, int isnew) 4313292167Savos{ 4314292167Savos struct urtwn_softc *sc = ni->ni_ic->ic_softc; 4315292167Savos struct urtwn_node *un = URTWN_NODE(ni); 4316292167Savos uint8_t id; 4317292167Savos 4318292167Savos if (!isnew) 4319292167Savos return; 4320292167Savos 4321292167Savos URTWN_NT_LOCK(sc); 4322292167Savos for (id = 0; id <= URTWN_MACID_MAX(sc); id++) { 4323292167Savos if (id != URTWN_MACID_BC && sc->node_list[id] == NULL) { 4324292167Savos un->id = id; 4325292167Savos sc->node_list[id] = ni; 4326292167Savos break; 4327292167Savos } 4328292167Savos } 4329292167Savos URTWN_NT_UNLOCK(sc); 4330292167Savos 4331292167Savos if (id > URTWN_MACID_MAX(sc)) { 4332292167Savos device_printf(sc->sc_dev, "%s: node table is full\n", 4333292167Savos __func__); 4334292167Savos } 4335292167Savos} 4336292167Savos 4337292167Savosstatic void 4338292167Savosurtwn_r88e_node_free(struct ieee80211_node *ni) 4339292167Savos{ 4340292167Savos struct urtwn_softc *sc = ni->ni_ic->ic_softc; 4341292167Savos struct urtwn_node *un = URTWN_NODE(ni); 4342292167Savos 4343292167Savos URTWN_NT_LOCK(sc); 4344292167Savos if (un->id != URTWN_MACID_UNDEFINED) 4345292167Savos sc->node_list[un->id] = NULL; 4346292167Savos URTWN_NT_UNLOCK(sc); 4347292167Savos 4348292167Savos sc->sc_node_free(ni); 4349292167Savos} 4350292167Savos 4351292167Savosstatic void 4352251538Srpaulourtwn_set_chan(struct urtwn_softc *sc, struct ieee80211_channel *c, 4353251538Srpaulo struct ieee80211_channel *extc) 4354251538Srpaulo{ 4355287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 4356251538Srpaulo uint32_t reg; 4357251538Srpaulo u_int chan; 4358251538Srpaulo int i; 4359251538Srpaulo 4360251538Srpaulo chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */ 4361251538Srpaulo if (chan == 0 || chan == IEEE80211_CHAN_ANY) { 4362251538Srpaulo device_printf(sc->sc_dev, 4363251538Srpaulo "%s: invalid channel %x\n", __func__, chan); 4364251538Srpaulo return; 4365251538Srpaulo } 4366251538Srpaulo 4367251538Srpaulo /* Set Tx power for this new channel. */ 4368251538Srpaulo urtwn_set_txpower(sc, c, extc); 4369251538Srpaulo 4370251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 4371251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_CHNLBW, 4372251538Srpaulo RW(sc->rf_chnlbw[i], R92C_RF_CHNLBW_CHNL, chan)); 4373251538Srpaulo } 4374251538Srpaulo#ifndef IEEE80211_NO_HT 4375251538Srpaulo if (extc != NULL) { 4376251538Srpaulo /* Is secondary channel below or above primary? */ 4377251538Srpaulo int prichlo = c->ic_freq < extc->ic_freq; 4378251538Srpaulo 4379251538Srpaulo urtwn_write_1(sc, R92C_BWOPMODE, 4380251538Srpaulo urtwn_read_1(sc, R92C_BWOPMODE) & ~R92C_BWOPMODE_20MHZ); 4381251538Srpaulo 4382251538Srpaulo reg = urtwn_read_1(sc, R92C_RRSR + 2); 4383251538Srpaulo reg = (reg & ~0x6f) | (prichlo ? 1 : 2) << 5; 4384251538Srpaulo urtwn_write_1(sc, R92C_RRSR + 2, reg); 4385251538Srpaulo 4386251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFMOD, 4387251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_RFMOD) | R92C_RFMOD_40MHZ); 4388251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_RFMOD, 4389251538Srpaulo urtwn_bb_read(sc, R92C_FPGA1_RFMOD) | R92C_RFMOD_40MHZ); 4390251538Srpaulo 4391251538Srpaulo /* Set CCK side band. */ 4392251538Srpaulo reg = urtwn_bb_read(sc, R92C_CCK0_SYSTEM); 4393251538Srpaulo reg = (reg & ~0x00000010) | (prichlo ? 0 : 1) << 4; 4394251538Srpaulo urtwn_bb_write(sc, R92C_CCK0_SYSTEM, reg); 4395251538Srpaulo 4396251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM1_LSTF); 4397251538Srpaulo reg = (reg & ~0x00000c00) | (prichlo ? 1 : 2) << 10; 4398251538Srpaulo urtwn_bb_write(sc, R92C_OFDM1_LSTF, reg); 4399251538Srpaulo 4400251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2, 4401251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) & 4402251538Srpaulo ~R92C_FPGA0_ANAPARAM2_CBW20); 4403251538Srpaulo 4404251538Srpaulo reg = urtwn_bb_read(sc, 0x818); 4405251538Srpaulo reg = (reg & ~0x0c000000) | (prichlo ? 2 : 1) << 26; 4406251538Srpaulo urtwn_bb_write(sc, 0x818, reg); 4407251538Srpaulo 4408251538Srpaulo /* Select 40MHz bandwidth. */ 4409251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 4410251538Srpaulo (sc->rf_chnlbw[0] & ~0xfff) | chan); 4411251538Srpaulo } else 4412251538Srpaulo#endif 4413251538Srpaulo { 4414251538Srpaulo urtwn_write_1(sc, R92C_BWOPMODE, 4415251538Srpaulo urtwn_read_1(sc, R92C_BWOPMODE) | R92C_BWOPMODE_20MHZ); 4416251538Srpaulo 4417251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFMOD, 4418251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_RFMOD) & ~R92C_RFMOD_40MHZ); 4419251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_RFMOD, 4420251538Srpaulo urtwn_bb_read(sc, R92C_FPGA1_RFMOD) & ~R92C_RFMOD_40MHZ); 4421251538Srpaulo 4422264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 4423264912Skevlo urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2, 4424264912Skevlo urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) | 4425264912Skevlo R92C_FPGA0_ANAPARAM2_CBW20); 4426264912Skevlo } 4427281069Srpaulo 4428251538Srpaulo /* Select 20MHz bandwidth. */ 4429251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 4430281069Srpaulo (sc->rf_chnlbw[0] & ~0xfff) | chan | 4431264912Skevlo ((sc->chip & URTWN_CHIP_88E) ? R88E_RF_CHNLBW_BW20 : 4432264912Skevlo R92C_RF_CHNLBW_BW20)); 4433251538Srpaulo } 4434251538Srpaulo} 4435251538Srpaulo 4436251538Srpaulostatic void 4437251538Srpaulourtwn_iq_calib(struct urtwn_softc *sc) 4438251538Srpaulo{ 4439251538Srpaulo /* TODO */ 4440251538Srpaulo} 4441251538Srpaulo 4442251538Srpaulostatic void 4443251538Srpaulourtwn_lc_calib(struct urtwn_softc *sc) 4444251538Srpaulo{ 4445251538Srpaulo uint32_t rf_ac[2]; 4446251538Srpaulo uint8_t txmode; 4447251538Srpaulo int i; 4448251538Srpaulo 4449251538Srpaulo txmode = urtwn_read_1(sc, R92C_OFDM1_LSTF + 3); 4450251538Srpaulo if ((txmode & 0x70) != 0) { 4451251538Srpaulo /* Disable all continuous Tx. */ 4452251538Srpaulo urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode & ~0x70); 4453251538Srpaulo 4454251538Srpaulo /* Set RF mode to standby mode. */ 4455251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 4456251538Srpaulo rf_ac[i] = urtwn_rf_read(sc, i, R92C_RF_AC); 4457251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_AC, 4458251538Srpaulo RW(rf_ac[i], R92C_RF_AC_MODE, 4459251538Srpaulo R92C_RF_AC_MODE_STANDBY)); 4460251538Srpaulo } 4461251538Srpaulo } else { 4462251538Srpaulo /* Block all Tx queues. */ 4463293180Savos urtwn_write_1(sc, R92C_TXPAUSE, R92C_TX_QUEUE_ALL); 4464251538Srpaulo } 4465251538Srpaulo /* Start calibration. */ 4466251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 4467251538Srpaulo urtwn_rf_read(sc, 0, R92C_RF_CHNLBW) | R92C_RF_CHNLBW_LCSTART); 4468251538Srpaulo 4469251538Srpaulo /* Give calibration the time to complete. */ 4470266472Shselasky usb_pause_mtx(&sc->sc_mtx, hz / 10); /* 100ms */ 4471251538Srpaulo 4472251538Srpaulo /* Restore configuration. */ 4473251538Srpaulo if ((txmode & 0x70) != 0) { 4474251538Srpaulo /* Restore Tx mode. */ 4475251538Srpaulo urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode); 4476251538Srpaulo /* Restore RF mode. */ 4477251538Srpaulo for (i = 0; i < sc->nrxchains; i++) 4478251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_AC, rf_ac[i]); 4479251538Srpaulo } else { 4480251538Srpaulo /* Unblock all Tx queues. */ 4481251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 0x00); 4482251538Srpaulo } 4483251538Srpaulo} 4484251538Srpaulo 4485291698Savosstatic int 4486287197Sglebiusurtwn_init(struct urtwn_softc *sc) 4487251538Srpaulo{ 4488287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 4489287197Sglebius struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 4490287197Sglebius uint8_t macaddr[IEEE80211_ADDR_LEN]; 4491251538Srpaulo uint32_t reg; 4492291698Savos usb_error_t usb_err = USB_ERR_NORMAL_COMPLETION; 4493251538Srpaulo int error; 4494251538Srpaulo 4495291698Savos URTWN_LOCK(sc); 4496291698Savos if (sc->sc_flags & URTWN_RUNNING) { 4497291698Savos URTWN_UNLOCK(sc); 4498291698Savos return (0); 4499291698Savos } 4500264864Skevlo 4501251538Srpaulo /* Init firmware commands ring. */ 4502251538Srpaulo sc->fwcur = 0; 4503251538Srpaulo 4504251538Srpaulo /* Allocate Tx/Rx buffers. */ 4505251538Srpaulo error = urtwn_alloc_rx_list(sc); 4506251538Srpaulo if (error != 0) 4507251538Srpaulo goto fail; 4508281069Srpaulo 4509251538Srpaulo error = urtwn_alloc_tx_list(sc); 4510251538Srpaulo if (error != 0) 4511251538Srpaulo goto fail; 4512251538Srpaulo 4513251538Srpaulo /* Power on adapter. */ 4514251538Srpaulo error = urtwn_power_on(sc); 4515251538Srpaulo if (error != 0) 4516251538Srpaulo goto fail; 4517251538Srpaulo 4518251538Srpaulo /* Initialize DMA. */ 4519251538Srpaulo error = urtwn_dma_init(sc); 4520251538Srpaulo if (error != 0) 4521251538Srpaulo goto fail; 4522251538Srpaulo 4523251538Srpaulo /* Set info size in Rx descriptors (in 64-bit words). */ 4524251538Srpaulo urtwn_write_1(sc, R92C_RX_DRVINFO_SZ, 4); 4525251538Srpaulo 4526251538Srpaulo /* Init interrupts. */ 4527264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 4528291698Savos usb_err = urtwn_write_4(sc, R88E_HISR, 0xffffffff); 4529291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4530291698Savos goto fail; 4531291698Savos usb_err = urtwn_write_4(sc, R88E_HIMR, R88E_HIMR_CPWM | R88E_HIMR_CPWM2 | 4532264912Skevlo R88E_HIMR_TBDER | R88E_HIMR_PSTIMEOUT); 4533291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4534291698Savos goto fail; 4535291698Savos usb_err = urtwn_write_4(sc, R88E_HIMRE, R88E_HIMRE_RXFOVW | 4536264912Skevlo R88E_HIMRE_TXFOVW | R88E_HIMRE_RXERR | R88E_HIMRE_TXERR); 4537291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4538291698Savos goto fail; 4539291698Savos usb_err = urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION, 4540264912Skevlo urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) | 4541264912Skevlo R92C_USB_SPECIAL_OPTION_INT_BULK_SEL); 4542291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4543291698Savos goto fail; 4544264912Skevlo } else { 4545291698Savos usb_err = urtwn_write_4(sc, R92C_HISR, 0xffffffff); 4546291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4547291698Savos goto fail; 4548291698Savos usb_err = urtwn_write_4(sc, R92C_HIMR, 0xffffffff); 4549291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4550291698Savos goto fail; 4551264912Skevlo } 4552251538Srpaulo 4553251538Srpaulo /* Set MAC address. */ 4554287197Sglebius IEEE80211_ADDR_COPY(macaddr, vap ? vap->iv_myaddr : ic->ic_macaddr); 4555291698Savos usb_err = urtwn_write_region_1(sc, R92C_MACID, macaddr, IEEE80211_ADDR_LEN); 4556291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4557291698Savos goto fail; 4558251538Srpaulo 4559251538Srpaulo /* Set initial network type. */ 4560289811Savos urtwn_set_mode(sc, R92C_MSR_INFRA); 4561251538Srpaulo 4562290564Savos /* Initialize Rx filter. */ 4563251538Srpaulo urtwn_rxfilter_init(sc); 4564251538Srpaulo 4565282623Skevlo /* Set response rate. */ 4566251538Srpaulo reg = urtwn_read_4(sc, R92C_RRSR); 4567251538Srpaulo reg = RW(reg, R92C_RRSR_RATE_BITMAP, R92C_RRSR_RATE_CCK_ONLY_1M); 4568251538Srpaulo urtwn_write_4(sc, R92C_RRSR, reg); 4569251538Srpaulo 4570251538Srpaulo /* Set short/long retry limits. */ 4571251538Srpaulo urtwn_write_2(sc, R92C_RL, 4572251538Srpaulo SM(R92C_RL_SRL, 0x30) | SM(R92C_RL_LRL, 0x30)); 4573251538Srpaulo 4574251538Srpaulo /* Initialize EDCA parameters. */ 4575251538Srpaulo urtwn_edca_init(sc); 4576251538Srpaulo 4577251538Srpaulo /* Setup rate fallback. */ 4578264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 4579264912Skevlo urtwn_write_4(sc, R92C_DARFRC + 0, 0x00000000); 4580264912Skevlo urtwn_write_4(sc, R92C_DARFRC + 4, 0x10080404); 4581264912Skevlo urtwn_write_4(sc, R92C_RARFRC + 0, 0x04030201); 4582264912Skevlo urtwn_write_4(sc, R92C_RARFRC + 4, 0x08070605); 4583264912Skevlo } 4584251538Srpaulo 4585251538Srpaulo urtwn_write_1(sc, R92C_FWHW_TXQ_CTRL, 4586251538Srpaulo urtwn_read_1(sc, R92C_FWHW_TXQ_CTRL) | 4587251538Srpaulo R92C_FWHW_TXQ_CTRL_AMPDU_RTY_NEW); 4588251538Srpaulo /* Set ACK timeout. */ 4589251538Srpaulo urtwn_write_1(sc, R92C_ACKTO, 0x40); 4590251538Srpaulo 4591251538Srpaulo /* Setup USB aggregation. */ 4592251538Srpaulo reg = urtwn_read_4(sc, R92C_TDECTRL); 4593251538Srpaulo reg = RW(reg, R92C_TDECTRL_BLK_DESC_NUM, 6); 4594251538Srpaulo urtwn_write_4(sc, R92C_TDECTRL, reg); 4595251538Srpaulo urtwn_write_1(sc, R92C_TRXDMA_CTRL, 4596251538Srpaulo urtwn_read_1(sc, R92C_TRXDMA_CTRL) | 4597251538Srpaulo R92C_TRXDMA_CTRL_RXDMA_AGG_EN); 4598251538Srpaulo urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH, 48); 4599264912Skevlo if (sc->chip & URTWN_CHIP_88E) 4600264912Skevlo urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH + 1, 4); 4601282266Skevlo else { 4602264912Skevlo urtwn_write_1(sc, R92C_USB_DMA_AGG_TO, 4); 4603282266Skevlo urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION, 4604282266Skevlo urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) | 4605282266Skevlo R92C_USB_SPECIAL_OPTION_AGG_EN); 4606282266Skevlo urtwn_write_1(sc, R92C_USB_AGG_TH, 8); 4607282266Skevlo urtwn_write_1(sc, R92C_USB_AGG_TO, 6); 4608282266Skevlo } 4609251538Srpaulo 4610251538Srpaulo /* Initialize beacon parameters. */ 4611264912Skevlo urtwn_write_2(sc, R92C_BCN_CTRL, 0x1010); 4612251538Srpaulo urtwn_write_2(sc, R92C_TBTT_PROHIBIT, 0x6404); 4613251538Srpaulo urtwn_write_1(sc, R92C_DRVERLYINT, 0x05); 4614251538Srpaulo urtwn_write_1(sc, R92C_BCNDMATIM, 0x02); 4615251538Srpaulo urtwn_write_2(sc, R92C_BCNTCFG, 0x660f); 4616251538Srpaulo 4617264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 4618264912Skevlo /* Setup AMPDU aggregation. */ 4619264912Skevlo urtwn_write_4(sc, R92C_AGGLEN_LMT, 0x99997631); /* MCS7~0 */ 4620264912Skevlo urtwn_write_1(sc, R92C_AGGR_BREAK_TIME, 0x16); 4621264912Skevlo urtwn_write_2(sc, R92C_MAX_AGGR_NUM, 0x0708); 4622251538Srpaulo 4623264912Skevlo urtwn_write_1(sc, R92C_BCN_MAX_ERR, 0xff); 4624264912Skevlo } 4625251538Srpaulo 4626251538Srpaulo /* Load 8051 microcode. */ 4627251538Srpaulo error = urtwn_load_firmware(sc); 4628251538Srpaulo if (error != 0) 4629251538Srpaulo goto fail; 4630251538Srpaulo 4631251538Srpaulo /* Initialize MAC/BB/RF blocks. */ 4632291698Savos error = urtwn_mac_init(sc); 4633291698Savos if (error != 0) { 4634291698Savos device_printf(sc->sc_dev, 4635291698Savos "%s: error while initializing MAC block\n", __func__); 4636291698Savos goto fail; 4637291698Savos } 4638251538Srpaulo urtwn_bb_init(sc); 4639251538Srpaulo urtwn_rf_init(sc); 4640251538Srpaulo 4641290564Savos /* Reinitialize Rx filter (D3845 is not committed yet). */ 4642290564Savos urtwn_rxfilter_init(sc); 4643290564Savos 4644264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 4645264912Skevlo urtwn_write_2(sc, R92C_CR, 4646264912Skevlo urtwn_read_2(sc, R92C_CR) | R92C_CR_MACTXEN | 4647264912Skevlo R92C_CR_MACRXEN); 4648264912Skevlo } 4649264912Skevlo 4650251538Srpaulo /* Turn CCK and OFDM blocks on. */ 4651251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD); 4652251538Srpaulo reg |= R92C_RFMOD_CCK_EN; 4653291698Savos usb_err = urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg); 4654291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4655291698Savos goto fail; 4656251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD); 4657251538Srpaulo reg |= R92C_RFMOD_OFDM_EN; 4658291698Savos usb_err = urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg); 4659291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4660291698Savos goto fail; 4661251538Srpaulo 4662251538Srpaulo /* Clear per-station keys table. */ 4663251538Srpaulo urtwn_cam_init(sc); 4664251538Srpaulo 4665292175Savos /* Enable decryption / encryption. */ 4666292175Savos urtwn_write_2(sc, R92C_SECCFG, 4667292175Savos R92C_SECCFG_TXUCKEY_DEF | R92C_SECCFG_RXUCKEY_DEF | 4668292175Savos R92C_SECCFG_TXENC_ENA | R92C_SECCFG_RXDEC_ENA | 4669292175Savos R92C_SECCFG_TXBCKEY_DEF | R92C_SECCFG_RXBCKEY_DEF); 4670292175Savos 4671292175Savos /* 4672292175Savos * Install static keys (if any). 4673292175Savos * Must be called after urtwn_cam_init(). 4674292175Savos */ 4675292175Savos ieee80211_runtask(ic, &sc->cmdq_task); 4676292175Savos 4677251538Srpaulo /* Enable hardware sequence numbering. */ 4678293180Savos urtwn_write_1(sc, R92C_HWSEQ_CTRL, R92C_TX_QUEUE_ALL); 4679251538Srpaulo 4680292167Savos /* Enable per-packet TX report. */ 4681292167Savos if (sc->chip & URTWN_CHIP_88E) { 4682292167Savos urtwn_write_1(sc, R88E_TX_RPT_CTRL, 4683292167Savos urtwn_read_1(sc, R88E_TX_RPT_CTRL) | R88E_TX_RPT1_ENA); 4684292167Savos } 4685292167Savos 4686251538Srpaulo /* Perform LO and IQ calibrations. */ 4687251538Srpaulo urtwn_iq_calib(sc); 4688251538Srpaulo /* Perform LC calibration. */ 4689251538Srpaulo urtwn_lc_calib(sc); 4690251538Srpaulo 4691251538Srpaulo /* Fix USB interference issue. */ 4692264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 4693264912Skevlo urtwn_write_1(sc, 0xfe40, 0xe0); 4694264912Skevlo urtwn_write_1(sc, 0xfe41, 0x8d); 4695264912Skevlo urtwn_write_1(sc, 0xfe42, 0x80); 4696251538Srpaulo 4697264912Skevlo urtwn_pa_bias_init(sc); 4698264912Skevlo } 4699251538Srpaulo 4700251538Srpaulo /* Initialize GPIO setting. */ 4701251538Srpaulo urtwn_write_1(sc, R92C_GPIO_MUXCFG, 4702251538Srpaulo urtwn_read_1(sc, R92C_GPIO_MUXCFG) & ~R92C_GPIO_MUXCFG_ENBT); 4703251538Srpaulo 4704251538Srpaulo /* Fix for lower temperature. */ 4705264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) 4706264912Skevlo urtwn_write_1(sc, 0x15, 0xe9); 4707251538Srpaulo 4708251538Srpaulo usbd_transfer_start(sc->sc_xfer[URTWN_BULK_RX]); 4709251538Srpaulo 4710287197Sglebius sc->sc_flags |= URTWN_RUNNING; 4711251538Srpaulo 4712251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 4713251538Srpaulofail: 4714291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4715291698Savos error = EIO; 4716291698Savos 4717291698Savos URTWN_UNLOCK(sc); 4718291698Savos 4719291698Savos return (error); 4720251538Srpaulo} 4721251538Srpaulo 4722251538Srpaulostatic void 4723287197Sglebiusurtwn_stop(struct urtwn_softc *sc) 4724251538Srpaulo{ 4725251538Srpaulo 4726291698Savos URTWN_LOCK(sc); 4727291698Savos if (!(sc->sc_flags & URTWN_RUNNING)) { 4728291698Savos URTWN_UNLOCK(sc); 4729291698Savos return; 4730291698Savos } 4731291698Savos 4732287197Sglebius sc->sc_flags &= ~URTWN_RUNNING; 4733251538Srpaulo callout_stop(&sc->sc_watchdog_ch); 4734251538Srpaulo urtwn_abort_xfers(sc); 4735288353Sadrian 4736288353Sadrian urtwn_drain_mbufq(sc); 4737291698Savos URTWN_UNLOCK(sc); 4738251538Srpaulo} 4739251538Srpaulo 4740251538Srpaulostatic void 4741251538Srpaulourtwn_abort_xfers(struct urtwn_softc *sc) 4742251538Srpaulo{ 4743251538Srpaulo int i; 4744251538Srpaulo 4745251538Srpaulo URTWN_ASSERT_LOCKED(sc); 4746251538Srpaulo 4747251538Srpaulo /* abort any pending transfers */ 4748251538Srpaulo for (i = 0; i < URTWN_N_TRANSFER; i++) 4749251538Srpaulo usbd_transfer_stop(sc->sc_xfer[i]); 4750251538Srpaulo} 4751251538Srpaulo 4752251538Srpaulostatic int 4753251538Srpaulourtwn_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 4754251538Srpaulo const struct ieee80211_bpf_params *params) 4755251538Srpaulo{ 4756251538Srpaulo struct ieee80211com *ic = ni->ni_ic; 4757286949Sadrian struct urtwn_softc *sc = ic->ic_softc; 4758251538Srpaulo struct urtwn_data *bf; 4759290630Savos int error; 4760251538Srpaulo 4761251538Srpaulo /* prevent management frames from being sent if we're not ready */ 4762290630Savos URTWN_LOCK(sc); 4763287197Sglebius if (!(sc->sc_flags & URTWN_RUNNING)) { 4764290630Savos error = ENETDOWN; 4765290630Savos goto end; 4766251538Srpaulo } 4767290630Savos 4768251538Srpaulo bf = urtwn_getbuf(sc); 4769251538Srpaulo if (bf == NULL) { 4770290630Savos error = ENOBUFS; 4771290630Savos goto end; 4772251538Srpaulo } 4773251538Srpaulo 4774292221Savos if (params == NULL) { 4775292221Savos /* 4776292221Savos * Legacy path; interpret frame contents to decide 4777292221Savos * precisely how to send the frame. 4778292221Savos */ 4779292221Savos error = urtwn_tx_data(sc, ni, m, bf); 4780292221Savos } else { 4781292221Savos /* 4782292221Savos * Caller supplied explicit parameters to use in 4783292221Savos * sending the frame. 4784292221Savos */ 4785292221Savos error = urtwn_tx_raw(sc, ni, m, bf, params); 4786292221Savos } 4787292221Savos if (error != 0) { 4788251538Srpaulo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 4789290630Savos goto end; 4790251538Srpaulo } 4791290630Savos 4792288353Sadrian sc->sc_txtimer = 5; 4793290630Savos callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 4794290630Savos 4795290630Savosend: 4796290630Savos if (error != 0) 4797290630Savos m_freem(m); 4798290630Savos 4799251538Srpaulo URTWN_UNLOCK(sc); 4800251538Srpaulo 4801290630Savos return (error); 4802251538Srpaulo} 4803251538Srpaulo 4804266472Shselaskystatic void 4805266472Shselaskyurtwn_ms_delay(struct urtwn_softc *sc) 4806266472Shselasky{ 4807266472Shselasky usb_pause_mtx(&sc->sc_mtx, hz / 1000); 4808266472Shselasky} 4809266472Shselasky 4810251538Srpaulostatic device_method_t urtwn_methods[] = { 4811251538Srpaulo /* Device interface */ 4812251538Srpaulo DEVMETHOD(device_probe, urtwn_match), 4813251538Srpaulo DEVMETHOD(device_attach, urtwn_attach), 4814251538Srpaulo DEVMETHOD(device_detach, urtwn_detach), 4815251538Srpaulo 4816264912Skevlo DEVMETHOD_END 4817251538Srpaulo}; 4818251538Srpaulo 4819251538Srpaulostatic driver_t urtwn_driver = { 4820251538Srpaulo "urtwn", 4821251538Srpaulo urtwn_methods, 4822251538Srpaulo sizeof(struct urtwn_softc) 4823251538Srpaulo}; 4824251538Srpaulo 4825251538Srpaulostatic devclass_t urtwn_devclass; 4826251538Srpaulo 4827251538SrpauloDRIVER_MODULE(urtwn, uhub, urtwn_driver, urtwn_devclass, NULL, NULL); 4828251538SrpauloMODULE_DEPEND(urtwn, usb, 1, 1, 1); 4829251538SrpauloMODULE_DEPEND(urtwn, wlan, 1, 1, 1); 4830251538SrpauloMODULE_DEPEND(urtwn, firmware, 1, 1, 1); 4831251538SrpauloMODULE_VERSION(urtwn, 1); 4832292080SimpUSB_PNP_HOST_INFO(urtwn_devs); 4833