if_urtwn.c revision 292176
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 292176 2015-12-13 22:08:27Z 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 *); 185281069Srpaulostatic struct mbuf * urtwn_rx_frame(struct urtwn_softc *, uint8_t *, int, 186251538Srpaulo int *); 187292167Savosstatic struct mbuf * urtwn_report_intr(struct usb_xfer *, struct urtwn_data *, 188251538Srpaulo int *, int8_t *); 189292167Savosstatic struct mbuf * urtwn_rxeof(struct urtwn_softc *, uint8_t *, int, 190292167Savos int *, int8_t *); 191292167Savosstatic void urtwn_r88e_ratectl_tx_complete(struct urtwn_softc *, 192292167Savos void *); 193289891Savosstatic void urtwn_txeof(struct urtwn_softc *, struct urtwn_data *, 194289891Savos int); 195281069Srpaulostatic int urtwn_alloc_list(struct urtwn_softc *, 196251538Srpaulo struct urtwn_data[], int, int); 197251538Srpaulostatic int urtwn_alloc_rx_list(struct urtwn_softc *); 198251538Srpaulostatic int urtwn_alloc_tx_list(struct urtwn_softc *); 199251538Srpaulostatic void urtwn_free_list(struct urtwn_softc *, 200251538Srpaulo struct urtwn_data data[], int); 201289066Skevlostatic void urtwn_free_rx_list(struct urtwn_softc *); 202289066Skevlostatic void urtwn_free_tx_list(struct urtwn_softc *); 203251538Srpaulostatic struct urtwn_data * _urtwn_getbuf(struct urtwn_softc *); 204251538Srpaulostatic struct urtwn_data * urtwn_getbuf(struct urtwn_softc *); 205291698Savosstatic usb_error_t urtwn_write_region_1(struct urtwn_softc *, uint16_t, 206251538Srpaulo uint8_t *, int); 207291698Savosstatic usb_error_t urtwn_write_1(struct urtwn_softc *, uint16_t, uint8_t); 208291698Savosstatic usb_error_t urtwn_write_2(struct urtwn_softc *, uint16_t, uint16_t); 209291698Savosstatic usb_error_t urtwn_write_4(struct urtwn_softc *, uint16_t, uint32_t); 210291698Savosstatic usb_error_t urtwn_read_region_1(struct urtwn_softc *, uint16_t, 211251538Srpaulo uint8_t *, int); 212251538Srpaulostatic uint8_t urtwn_read_1(struct urtwn_softc *, uint16_t); 213251538Srpaulostatic uint16_t urtwn_read_2(struct urtwn_softc *, uint16_t); 214251538Srpaulostatic uint32_t urtwn_read_4(struct urtwn_softc *, uint16_t); 215281069Srpaulostatic int urtwn_fw_cmd(struct urtwn_softc *, uint8_t, 216251538Srpaulo const void *, int); 217292174Savosstatic void urtwn_cmdq_cb(void *, int); 218292174Savosstatic int urtwn_cmd_sleepable(struct urtwn_softc *, const void *, 219292174Savos size_t, CMD_FUNC_PROTO); 220264912Skevlostatic void urtwn_r92c_rf_write(struct urtwn_softc *, int, 221264912Skevlo uint8_t, uint32_t); 222281069Srpaulostatic void urtwn_r88e_rf_write(struct urtwn_softc *, int, 223264912Skevlo uint8_t, uint32_t); 224251538Srpaulostatic uint32_t urtwn_rf_read(struct urtwn_softc *, int, uint8_t); 225281069Srpaulostatic int urtwn_llt_write(struct urtwn_softc *, uint32_t, 226251538Srpaulo uint32_t); 227291264Savosstatic int urtwn_efuse_read_next(struct urtwn_softc *, uint8_t *); 228291264Savosstatic int urtwn_efuse_read_data(struct urtwn_softc *, uint8_t *, 229291264Savos uint8_t, uint8_t); 230291264Savos#ifdef URTWN_DEBUG 231291264Savosstatic void urtwn_dump_rom_contents(struct urtwn_softc *, 232291264Savos uint8_t *, uint16_t); 233291264Savos#endif 234291264Savosstatic int urtwn_efuse_read(struct urtwn_softc *, uint8_t *, 235291264Savos uint16_t); 236291698Savosstatic int urtwn_efuse_switch_power(struct urtwn_softc *); 237251538Srpaulostatic int urtwn_read_chipid(struct urtwn_softc *); 238291264Savosstatic int urtwn_read_rom(struct urtwn_softc *); 239291264Savosstatic int urtwn_r88e_read_rom(struct urtwn_softc *); 240251538Srpaulostatic int urtwn_ra_init(struct urtwn_softc *); 241290631Savosstatic void urtwn_init_beacon(struct urtwn_softc *, 242290631Savos struct urtwn_vap *); 243290631Savosstatic int urtwn_setup_beacon(struct urtwn_softc *, 244290631Savos struct ieee80211_node *); 245290631Savosstatic void urtwn_update_beacon(struct ieee80211vap *, int); 246290631Savosstatic int urtwn_tx_beacon(struct urtwn_softc *sc, 247290631Savos struct urtwn_vap *); 248292175Savosstatic int urtwn_key_alloc(struct ieee80211vap *, 249292175Savos struct ieee80211_key *, ieee80211_keyix *, 250292175Savos ieee80211_keyix *); 251292175Savosstatic void urtwn_key_set_cb(struct urtwn_softc *, 252292175Savos union sec_param *); 253292175Savosstatic void urtwn_key_del_cb(struct urtwn_softc *, 254292175Savos union sec_param *); 255292175Savosstatic int urtwn_key_set(struct ieee80211vap *, 256292175Savos const struct ieee80211_key *); 257292175Savosstatic int urtwn_key_delete(struct ieee80211vap *, 258292175Savos const struct ieee80211_key *); 259290651Savosstatic void urtwn_tsf_task_adhoc(void *, int); 260290631Savosstatic void urtwn_tsf_sync_enable(struct urtwn_softc *, 261290631Savos struct ieee80211vap *); 262251538Srpaulostatic void urtwn_set_led(struct urtwn_softc *, int, int); 263289811Savosstatic void urtwn_set_mode(struct urtwn_softc *, uint8_t); 264290651Savosstatic void urtwn_ibss_recv_mgmt(struct ieee80211_node *, 265290651Savos struct mbuf *, int, 266290651Savos const struct ieee80211_rx_stats *, int, int); 267281069Srpaulostatic int urtwn_newstate(struct ieee80211vap *, 268251538Srpaulo enum ieee80211_state, int); 269251538Srpaulostatic void urtwn_watchdog(void *); 270251538Srpaulostatic void urtwn_update_avgrssi(struct urtwn_softc *, int, int8_t); 271251538Srpaulostatic int8_t urtwn_get_rssi(struct urtwn_softc *, int, void *); 272264912Skevlostatic int8_t urtwn_r88e_get_rssi(struct urtwn_softc *, int, void *); 273290630Savosstatic int urtwn_tx_data(struct urtwn_softc *, 274251538Srpaulo struct ieee80211_node *, struct mbuf *, 275251538Srpaulo struct urtwn_data *); 276290630Savosstatic void urtwn_tx_start(struct urtwn_softc *, struct mbuf *, 277290630Savos uint8_t, struct urtwn_data *); 278287197Sglebiusstatic int urtwn_transmit(struct ieee80211com *, struct mbuf *); 279287197Sglebiusstatic void urtwn_start(struct urtwn_softc *); 280287197Sglebiusstatic void urtwn_parent(struct ieee80211com *); 281264912Skevlostatic int urtwn_r92c_power_on(struct urtwn_softc *); 282264912Skevlostatic int urtwn_r88e_power_on(struct urtwn_softc *); 283251538Srpaulostatic int urtwn_llt_init(struct urtwn_softc *); 284251538Srpaulostatic void urtwn_fw_reset(struct urtwn_softc *); 285264912Skevlostatic void urtwn_r88e_fw_reset(struct urtwn_softc *); 286281069Srpaulostatic int urtwn_fw_loadpage(struct urtwn_softc *, int, 287251538Srpaulo const uint8_t *, int); 288251538Srpaulostatic int urtwn_load_firmware(struct urtwn_softc *); 289291902Skevlostatic int urtwn_dma_init(struct urtwn_softc *); 290291698Savosstatic int urtwn_mac_init(struct urtwn_softc *); 291251538Srpaulostatic void urtwn_bb_init(struct urtwn_softc *); 292251538Srpaulostatic void urtwn_rf_init(struct urtwn_softc *); 293251538Srpaulostatic void urtwn_cam_init(struct urtwn_softc *); 294292175Savosstatic int urtwn_cam_write(struct urtwn_softc *, uint32_t, 295292175Savos uint32_t); 296251538Srpaulostatic void urtwn_pa_bias_init(struct urtwn_softc *); 297251538Srpaulostatic void urtwn_rxfilter_init(struct urtwn_softc *); 298251538Srpaulostatic void urtwn_edca_init(struct urtwn_softc *); 299281069Srpaulostatic void urtwn_write_txpower(struct urtwn_softc *, int, 300251538Srpaulo uint16_t[]); 301251538Srpaulostatic void urtwn_get_txpower(struct urtwn_softc *, int, 302281069Srpaulo struct ieee80211_channel *, 303251538Srpaulo struct ieee80211_channel *, uint16_t[]); 304264912Skevlostatic void urtwn_r88e_get_txpower(struct urtwn_softc *, int, 305281069Srpaulo struct ieee80211_channel *, 306264912Skevlo struct ieee80211_channel *, uint16_t[]); 307251538Srpaulostatic void urtwn_set_txpower(struct urtwn_softc *, 308281069Srpaulo struct ieee80211_channel *, 309251538Srpaulo struct ieee80211_channel *); 310290048Savosstatic void urtwn_set_rx_bssid_all(struct urtwn_softc *, int); 311290048Savosstatic void urtwn_set_gain(struct urtwn_softc *, uint8_t); 312251538Srpaulostatic void urtwn_scan_start(struct ieee80211com *); 313251538Srpaulostatic void urtwn_scan_end(struct ieee80211com *); 314251538Srpaulostatic void urtwn_set_channel(struct ieee80211com *); 315292014Savosstatic int urtwn_wme_update(struct ieee80211com *); 316290564Savosstatic void urtwn_set_promisc(struct urtwn_softc *); 317290564Savosstatic void urtwn_update_promisc(struct ieee80211com *); 318289066Skevlostatic void urtwn_update_mcast(struct ieee80211com *); 319292167Savosstatic struct ieee80211_node *urtwn_r88e_node_alloc(struct ieee80211vap *, 320292167Savos const uint8_t mac[IEEE80211_ADDR_LEN]); 321292167Savosstatic void urtwn_r88e_newassoc(struct ieee80211_node *, int); 322292167Savosstatic void urtwn_r88e_node_free(struct ieee80211_node *); 323251538Srpaulostatic void urtwn_set_chan(struct urtwn_softc *, 324281069Srpaulo struct ieee80211_channel *, 325251538Srpaulo struct ieee80211_channel *); 326251538Srpaulostatic void urtwn_iq_calib(struct urtwn_softc *); 327251538Srpaulostatic void urtwn_lc_calib(struct urtwn_softc *); 328291698Savosstatic int urtwn_init(struct urtwn_softc *); 329287197Sglebiusstatic void urtwn_stop(struct urtwn_softc *); 330251538Srpaulostatic void urtwn_abort_xfers(struct urtwn_softc *); 331251538Srpaulostatic int urtwn_raw_xmit(struct ieee80211_node *, struct mbuf *, 332251538Srpaulo const struct ieee80211_bpf_params *); 333266472Shselaskystatic void urtwn_ms_delay(struct urtwn_softc *); 334251538Srpaulo 335251538Srpaulo/* Aliases. */ 336251538Srpaulo#define urtwn_bb_write urtwn_write_4 337251538Srpaulo#define urtwn_bb_read urtwn_read_4 338251538Srpaulo 339251538Srpaulostatic const struct usb_config urtwn_config[URTWN_N_TRANSFER] = { 340251538Srpaulo [URTWN_BULK_RX] = { 341251538Srpaulo .type = UE_BULK, 342251538Srpaulo .endpoint = UE_ADDR_ANY, 343251538Srpaulo .direction = UE_DIR_IN, 344251538Srpaulo .bufsize = URTWN_RXBUFSZ, 345251538Srpaulo .flags = { 346251538Srpaulo .pipe_bof = 1, 347251538Srpaulo .short_xfer_ok = 1 348251538Srpaulo }, 349251538Srpaulo .callback = urtwn_bulk_rx_callback, 350251538Srpaulo }, 351251538Srpaulo [URTWN_BULK_TX_BE] = { 352251538Srpaulo .type = UE_BULK, 353251538Srpaulo .endpoint = 0x03, 354251538Srpaulo .direction = UE_DIR_OUT, 355251538Srpaulo .bufsize = URTWN_TXBUFSZ, 356251538Srpaulo .flags = { 357251538Srpaulo .ext_buffer = 1, 358251538Srpaulo .pipe_bof = 1, 359251538Srpaulo .force_short_xfer = 1 360251538Srpaulo }, 361251538Srpaulo .callback = urtwn_bulk_tx_callback, 362251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 363251538Srpaulo }, 364251538Srpaulo [URTWN_BULK_TX_BK] = { 365251538Srpaulo .type = UE_BULK, 366251538Srpaulo .endpoint = 0x03, 367251538Srpaulo .direction = UE_DIR_OUT, 368251538Srpaulo .bufsize = URTWN_TXBUFSZ, 369251538Srpaulo .flags = { 370251538Srpaulo .ext_buffer = 1, 371251538Srpaulo .pipe_bof = 1, 372251538Srpaulo .force_short_xfer = 1, 373251538Srpaulo }, 374251538Srpaulo .callback = urtwn_bulk_tx_callback, 375251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 376251538Srpaulo }, 377251538Srpaulo [URTWN_BULK_TX_VI] = { 378251538Srpaulo .type = UE_BULK, 379251538Srpaulo .endpoint = 0x02, 380251538Srpaulo .direction = UE_DIR_OUT, 381251538Srpaulo .bufsize = URTWN_TXBUFSZ, 382251538Srpaulo .flags = { 383251538Srpaulo .ext_buffer = 1, 384251538Srpaulo .pipe_bof = 1, 385251538Srpaulo .force_short_xfer = 1 386251538Srpaulo }, 387251538Srpaulo .callback = urtwn_bulk_tx_callback, 388251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 389251538Srpaulo }, 390251538Srpaulo [URTWN_BULK_TX_VO] = { 391251538Srpaulo .type = UE_BULK, 392251538Srpaulo .endpoint = 0x02, 393251538Srpaulo .direction = UE_DIR_OUT, 394251538Srpaulo .bufsize = URTWN_TXBUFSZ, 395251538Srpaulo .flags = { 396251538Srpaulo .ext_buffer = 1, 397251538Srpaulo .pipe_bof = 1, 398251538Srpaulo .force_short_xfer = 1 399251538Srpaulo }, 400251538Srpaulo .callback = urtwn_bulk_tx_callback, 401251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 402251538Srpaulo }, 403251538Srpaulo}; 404251538Srpaulo 405292014Savosstatic const struct wme_to_queue { 406292014Savos uint16_t reg; 407292014Savos uint8_t qid; 408292014Savos} wme2queue[WME_NUM_AC] = { 409292014Savos { R92C_EDCA_BE_PARAM, URTWN_BULK_TX_BE}, 410292014Savos { R92C_EDCA_BK_PARAM, URTWN_BULK_TX_BK}, 411292014Savos { R92C_EDCA_VI_PARAM, URTWN_BULK_TX_VI}, 412292014Savos { R92C_EDCA_VO_PARAM, URTWN_BULK_TX_VO} 413292014Savos}; 414292014Savos 415251538Srpaulostatic int 416251538Srpaulourtwn_match(device_t self) 417251538Srpaulo{ 418251538Srpaulo struct usb_attach_arg *uaa = device_get_ivars(self); 419251538Srpaulo 420251538Srpaulo if (uaa->usb_mode != USB_MODE_HOST) 421251538Srpaulo return (ENXIO); 422251538Srpaulo if (uaa->info.bConfigIndex != URTWN_CONFIG_INDEX) 423251538Srpaulo return (ENXIO); 424251538Srpaulo if (uaa->info.bIfaceIndex != URTWN_IFACE_INDEX) 425251538Srpaulo return (ENXIO); 426251538Srpaulo 427251538Srpaulo return (usbd_lookup_id_by_uaa(urtwn_devs, sizeof(urtwn_devs), uaa)); 428251538Srpaulo} 429251538Srpaulo 430251538Srpaulostatic int 431251538Srpaulourtwn_attach(device_t self) 432251538Srpaulo{ 433251538Srpaulo struct usb_attach_arg *uaa = device_get_ivars(self); 434251538Srpaulo struct urtwn_softc *sc = device_get_softc(self); 435287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 436291902Skevlo uint8_t bands; 437251538Srpaulo int error; 438251538Srpaulo 439251538Srpaulo device_set_usb_desc(self); 440251538Srpaulo sc->sc_udev = uaa->device; 441251538Srpaulo sc->sc_dev = self; 442264912Skevlo if (USB_GET_DRIVER_INFO(uaa) == URTWN_RTL8188E) 443264912Skevlo sc->chip |= URTWN_CHIP_88E; 444251538Srpaulo 445251538Srpaulo mtx_init(&sc->sc_mtx, device_get_nameunit(self), 446251538Srpaulo MTX_NETWORK_LOCK, MTX_DEF); 447292174Savos URTWN_CMDQ_LOCK_INIT(sc); 448292167Savos URTWN_NT_LOCK_INIT(sc); 449251538Srpaulo callout_init(&sc->sc_watchdog_ch, 0); 450287197Sglebius mbufq_init(&sc->sc_snd, ifqmaxlen); 451251538Srpaulo 452291902Skevlo sc->sc_iface_index = URTWN_IFACE_INDEX; 453291902Skevlo error = usbd_transfer_setup(uaa->device, &sc->sc_iface_index, 454291902Skevlo sc->sc_xfer, urtwn_config, URTWN_N_TRANSFER, sc, &sc->sc_mtx); 455251538Srpaulo if (error) { 456251538Srpaulo device_printf(self, "could not allocate USB transfers, " 457251538Srpaulo "err=%s\n", usbd_errstr(error)); 458251538Srpaulo goto detach; 459251538Srpaulo } 460251538Srpaulo 461251538Srpaulo URTWN_LOCK(sc); 462251538Srpaulo 463251538Srpaulo error = urtwn_read_chipid(sc); 464251538Srpaulo if (error) { 465251538Srpaulo device_printf(sc->sc_dev, "unsupported test chip\n"); 466251538Srpaulo URTWN_UNLOCK(sc); 467251538Srpaulo goto detach; 468251538Srpaulo } 469251538Srpaulo 470251538Srpaulo /* Determine number of Tx/Rx chains. */ 471251538Srpaulo if (sc->chip & URTWN_CHIP_92C) { 472251538Srpaulo sc->ntxchains = (sc->chip & URTWN_CHIP_92C_1T2R) ? 1 : 2; 473251538Srpaulo sc->nrxchains = 2; 474251538Srpaulo } else { 475251538Srpaulo sc->ntxchains = 1; 476251538Srpaulo sc->nrxchains = 1; 477251538Srpaulo } 478251538Srpaulo 479264912Skevlo if (sc->chip & URTWN_CHIP_88E) 480291264Savos error = urtwn_r88e_read_rom(sc); 481264912Skevlo else 482291264Savos error = urtwn_read_rom(sc); 483291264Savos if (error != 0) { 484291264Savos device_printf(sc->sc_dev, "%s: cannot read rom, error %d\n", 485291264Savos __func__, error); 486291264Savos URTWN_UNLOCK(sc); 487291264Savos goto detach; 488291264Savos } 489264912Skevlo 490251538Srpaulo device_printf(sc->sc_dev, "MAC/BB RTL%s, RF 6052 %dT%dR\n", 491251538Srpaulo (sc->chip & URTWN_CHIP_92C) ? "8192CU" : 492264912Skevlo (sc->chip & URTWN_CHIP_88E) ? "8188EU" : 493251538Srpaulo (sc->board_type == R92C_BOARD_TYPE_HIGHPA) ? "8188RU" : 494251538Srpaulo (sc->board_type == R92C_BOARD_TYPE_MINICARD) ? "8188CE-VAU" : 495251538Srpaulo "8188CUS", sc->ntxchains, sc->nrxchains); 496251538Srpaulo 497251538Srpaulo URTWN_UNLOCK(sc); 498251538Srpaulo 499283537Sglebius ic->ic_softc = sc; 500283527Sglebius ic->ic_name = device_get_nameunit(self); 501251538Srpaulo ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ 502251538Srpaulo ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */ 503251538Srpaulo 504251538Srpaulo /* set device capabilities */ 505251538Srpaulo ic->ic_caps = 506251538Srpaulo IEEE80211_C_STA /* station mode */ 507251538Srpaulo | IEEE80211_C_MONITOR /* monitor mode */ 508290651Savos | IEEE80211_C_IBSS /* adhoc mode */ 509290631Savos | IEEE80211_C_HOSTAP /* hostap mode */ 510251538Srpaulo | IEEE80211_C_SHPREAMBLE /* short preamble supported */ 511251538Srpaulo | IEEE80211_C_SHSLOT /* short slot time supported */ 512251538Srpaulo | IEEE80211_C_BGSCAN /* capable of bg scanning */ 513251538Srpaulo | IEEE80211_C_WPA /* 802.11i */ 514292014Savos | IEEE80211_C_WME /* 802.11e */ 515251538Srpaulo ; 516251538Srpaulo 517292175Savos ic->ic_cryptocaps = 518292175Savos IEEE80211_CRYPTO_WEP | 519292175Savos IEEE80211_CRYPTO_TKIP | 520292175Savos IEEE80211_CRYPTO_AES_CCM; 521292175Savos 522251538Srpaulo bands = 0; 523251538Srpaulo setbit(&bands, IEEE80211_MODE_11B); 524251538Srpaulo setbit(&bands, IEEE80211_MODE_11G); 525251538Srpaulo ieee80211_init_channels(ic, NULL, &bands); 526251538Srpaulo 527287197Sglebius ieee80211_ifattach(ic); 528251538Srpaulo ic->ic_raw_xmit = urtwn_raw_xmit; 529251538Srpaulo ic->ic_scan_start = urtwn_scan_start; 530251538Srpaulo ic->ic_scan_end = urtwn_scan_end; 531251538Srpaulo ic->ic_set_channel = urtwn_set_channel; 532287197Sglebius ic->ic_transmit = urtwn_transmit; 533287197Sglebius ic->ic_parent = urtwn_parent; 534251538Srpaulo ic->ic_vap_create = urtwn_vap_create; 535251538Srpaulo ic->ic_vap_delete = urtwn_vap_delete; 536292014Savos ic->ic_wme.wme_update = urtwn_wme_update; 537290564Savos ic->ic_update_promisc = urtwn_update_promisc; 538251538Srpaulo ic->ic_update_mcast = urtwn_update_mcast; 539292167Savos if (sc->chip & URTWN_CHIP_88E) { 540292167Savos ic->ic_node_alloc = urtwn_r88e_node_alloc; 541292167Savos ic->ic_newassoc = urtwn_r88e_newassoc; 542292167Savos sc->sc_node_free = ic->ic_node_free; 543292167Savos ic->ic_node_free = urtwn_r88e_node_free; 544292167Savos } 545251538Srpaulo 546281069Srpaulo ieee80211_radiotap_attach(ic, &sc->sc_txtap.wt_ihdr, 547251538Srpaulo sizeof(sc->sc_txtap), URTWN_TX_RADIOTAP_PRESENT, 548251538Srpaulo &sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap), 549251538Srpaulo URTWN_RX_RADIOTAP_PRESENT); 550251538Srpaulo 551292174Savos TASK_INIT(&sc->cmdq_task, 0, urtwn_cmdq_cb, sc); 552292174Savos 553251538Srpaulo if (bootverbose) 554251538Srpaulo ieee80211_announce(ic); 555251538Srpaulo 556251538Srpaulo return (0); 557251538Srpaulo 558251538Srpaulodetach: 559251538Srpaulo urtwn_detach(self); 560251538Srpaulo return (ENXIO); /* failure */ 561251538Srpaulo} 562251538Srpaulo 563251538Srpaulostatic int 564251538Srpaulourtwn_detach(device_t self) 565251538Srpaulo{ 566251538Srpaulo struct urtwn_softc *sc = device_get_softc(self); 567287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 568263153Skevlo unsigned int x; 569281069Srpaulo 570263153Skevlo /* Prevent further ioctls. */ 571263153Skevlo URTWN_LOCK(sc); 572263153Skevlo sc->sc_flags |= URTWN_DETACHED; 573263153Skevlo URTWN_UNLOCK(sc); 574251538Srpaulo 575291698Savos urtwn_stop(sc); 576291698Savos 577251538Srpaulo callout_drain(&sc->sc_watchdog_ch); 578251538Srpaulo 579288353Sadrian /* stop all USB transfers */ 580288353Sadrian usbd_transfer_unsetup(sc->sc_xfer, URTWN_N_TRANSFER); 581288353Sadrian 582263153Skevlo /* Prevent further allocations from RX/TX data lists. */ 583263153Skevlo URTWN_LOCK(sc); 584263153Skevlo STAILQ_INIT(&sc->sc_tx_active); 585263153Skevlo STAILQ_INIT(&sc->sc_tx_inactive); 586263153Skevlo STAILQ_INIT(&sc->sc_tx_pending); 587263153Skevlo 588263153Skevlo STAILQ_INIT(&sc->sc_rx_active); 589263153Skevlo STAILQ_INIT(&sc->sc_rx_inactive); 590263153Skevlo URTWN_UNLOCK(sc); 591263153Skevlo 592263153Skevlo /* drain USB transfers */ 593263153Skevlo for (x = 0; x != URTWN_N_TRANSFER; x++) 594263153Skevlo usbd_transfer_drain(sc->sc_xfer[x]); 595263153Skevlo 596263153Skevlo /* Free data buffers. */ 597263153Skevlo URTWN_LOCK(sc); 598263153Skevlo urtwn_free_tx_list(sc); 599263153Skevlo urtwn_free_rx_list(sc); 600263153Skevlo URTWN_UNLOCK(sc); 601263153Skevlo 602292174Savos if (ic->ic_softc == sc) { 603292174Savos ieee80211_draintask(ic, &sc->cmdq_task); 604292174Savos ieee80211_ifdetach(ic); 605292174Savos } 606292174Savos 607292167Savos URTWN_NT_LOCK_DESTROY(sc); 608292174Savos URTWN_CMDQ_LOCK_DESTROY(sc); 609251538Srpaulo mtx_destroy(&sc->sc_mtx); 610251538Srpaulo 611251538Srpaulo return (0); 612251538Srpaulo} 613251538Srpaulo 614251538Srpaulostatic void 615289066Skevlourtwn_drain_mbufq(struct urtwn_softc *sc) 616251538Srpaulo{ 617289066Skevlo struct mbuf *m; 618289066Skevlo struct ieee80211_node *ni; 619289066Skevlo URTWN_ASSERT_LOCKED(sc); 620289066Skevlo while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) { 621289066Skevlo ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 622289066Skevlo m->m_pkthdr.rcvif = NULL; 623289066Skevlo ieee80211_free_node(ni); 624289066Skevlo m_freem(m); 625251538Srpaulo } 626251538Srpaulo} 627251538Srpaulo 628251538Srpaulostatic usb_error_t 629251538Srpaulourtwn_do_request(struct urtwn_softc *sc, struct usb_device_request *req, 630251538Srpaulo void *data) 631251538Srpaulo{ 632251538Srpaulo usb_error_t err; 633251538Srpaulo int ntries = 10; 634251538Srpaulo 635251538Srpaulo URTWN_ASSERT_LOCKED(sc); 636251538Srpaulo 637251538Srpaulo while (ntries--) { 638251538Srpaulo err = usbd_do_request_flags(sc->sc_udev, &sc->sc_mtx, 639251538Srpaulo req, data, 0, NULL, 250 /* ms */); 640251538Srpaulo if (err == 0) 641251538Srpaulo break; 642251538Srpaulo 643251538Srpaulo DPRINTFN(1, "Control request failed, %s (retrying)\n", 644251538Srpaulo usbd_errstr(err)); 645251538Srpaulo usb_pause_mtx(&sc->sc_mtx, hz / 100); 646251538Srpaulo } 647251538Srpaulo return (err); 648251538Srpaulo} 649251538Srpaulo 650251538Srpaulostatic struct ieee80211vap * 651251538Srpaulourtwn_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit, 652251538Srpaulo enum ieee80211_opmode opmode, int flags, 653251538Srpaulo const uint8_t bssid[IEEE80211_ADDR_LEN], 654251538Srpaulo const uint8_t mac[IEEE80211_ADDR_LEN]) 655251538Srpaulo{ 656290631Savos struct urtwn_softc *sc = ic->ic_softc; 657251538Srpaulo struct urtwn_vap *uvp; 658251538Srpaulo struct ieee80211vap *vap; 659251538Srpaulo 660251538Srpaulo if (!TAILQ_EMPTY(&ic->ic_vaps)) /* only one at a time */ 661251538Srpaulo return (NULL); 662251538Srpaulo 663287197Sglebius uvp = malloc(sizeof(struct urtwn_vap), M_80211_VAP, M_WAITOK | M_ZERO); 664251538Srpaulo vap = &uvp->vap; 665251538Srpaulo /* enable s/w bmiss handling for sta mode */ 666251538Srpaulo 667281069Srpaulo if (ieee80211_vap_setup(ic, vap, name, unit, opmode, 668287197Sglebius flags | IEEE80211_CLONE_NOBEACONS, bssid) != 0) { 669257743Shselasky /* out of memory */ 670257743Shselasky free(uvp, M_80211_VAP); 671257743Shselasky return (NULL); 672257743Shselasky } 673257743Shselasky 674290651Savos if (opmode == IEEE80211_M_HOSTAP || opmode == IEEE80211_M_IBSS) 675290631Savos urtwn_init_beacon(sc, uvp); 676290631Savos 677251538Srpaulo /* override state transition machine */ 678251538Srpaulo uvp->newstate = vap->iv_newstate; 679251538Srpaulo vap->iv_newstate = urtwn_newstate; 680290631Savos vap->iv_update_beacon = urtwn_update_beacon; 681292175Savos vap->iv_key_alloc = urtwn_key_alloc; 682292175Savos vap->iv_key_set = urtwn_key_set; 683292175Savos vap->iv_key_delete = urtwn_key_delete; 684290651Savos if (opmode == IEEE80211_M_IBSS) { 685290651Savos uvp->recv_mgmt = vap->iv_recv_mgmt; 686290651Savos vap->iv_recv_mgmt = urtwn_ibss_recv_mgmt; 687290651Savos TASK_INIT(&uvp->tsf_task_adhoc, 0, urtwn_tsf_task_adhoc, vap); 688290651Savos } 689251538Srpaulo 690292167Savos if (URTWN_CHIP_HAS_RATECTL(sc)) 691292167Savos ieee80211_ratectl_init(vap); 692251538Srpaulo /* complete setup */ 693251538Srpaulo ieee80211_vap_attach(vap, ieee80211_media_change, 694287197Sglebius ieee80211_media_status, mac); 695251538Srpaulo ic->ic_opmode = opmode; 696251538Srpaulo return (vap); 697251538Srpaulo} 698251538Srpaulo 699251538Srpaulostatic void 700251538Srpaulourtwn_vap_delete(struct ieee80211vap *vap) 701251538Srpaulo{ 702290651Savos struct ieee80211com *ic = vap->iv_ic; 703292167Savos struct urtwn_softc *sc = ic->ic_softc; 704251538Srpaulo struct urtwn_vap *uvp = URTWN_VAP(vap); 705251538Srpaulo 706290651Savos if (uvp->bcn_mbuf != NULL) 707290651Savos m_freem(uvp->bcn_mbuf); 708290651Savos if (vap->iv_opmode == IEEE80211_M_IBSS) 709290651Savos ieee80211_draintask(ic, &uvp->tsf_task_adhoc); 710292167Savos if (URTWN_CHIP_HAS_RATECTL(sc)) 711292167Savos ieee80211_ratectl_deinit(vap); 712251538Srpaulo ieee80211_vap_detach(vap); 713251538Srpaulo free(uvp, M_80211_VAP); 714251538Srpaulo} 715251538Srpaulo 716251538Srpaulostatic struct mbuf * 717251538Srpaulourtwn_rx_frame(struct urtwn_softc *sc, uint8_t *buf, int pktlen, int *rssi_p) 718251538Srpaulo{ 719287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 720251538Srpaulo struct ieee80211_frame *wh; 721251538Srpaulo struct mbuf *m; 722251538Srpaulo struct r92c_rx_stat *stat; 723251538Srpaulo uint32_t rxdw0, rxdw3; 724292175Savos uint8_t rate, cipher; 725251538Srpaulo int8_t rssi = 0; 726251538Srpaulo int infosz; 727251538Srpaulo 728251538Srpaulo /* 729251538Srpaulo * don't pass packets to the ieee80211 framework if the driver isn't 730251538Srpaulo * RUNNING. 731251538Srpaulo */ 732287197Sglebius if (!(sc->sc_flags & URTWN_RUNNING)) 733251538Srpaulo return (NULL); 734251538Srpaulo 735251538Srpaulo stat = (struct r92c_rx_stat *)buf; 736251538Srpaulo rxdw0 = le32toh(stat->rxdw0); 737251538Srpaulo rxdw3 = le32toh(stat->rxdw3); 738251538Srpaulo 739251538Srpaulo if (rxdw0 & (R92C_RXDW0_CRCERR | R92C_RXDW0_ICVERR)) { 740251538Srpaulo /* 741251538Srpaulo * This should not happen since we setup our Rx filter 742251538Srpaulo * to not receive these frames. 743251538Srpaulo */ 744287197Sglebius counter_u64_add(ic->ic_ierrors, 1); 745251538Srpaulo return (NULL); 746251538Srpaulo } 747290022Savos if (pktlen < sizeof(struct ieee80211_frame_ack) || 748290022Savos pktlen > MCLBYTES) { 749287197Sglebius counter_u64_add(ic->ic_ierrors, 1); 750271303Skevlo return (NULL); 751271303Skevlo } 752251538Srpaulo 753251538Srpaulo rate = MS(rxdw3, R92C_RXDW3_RATE); 754292175Savos cipher = MS(rxdw0, R92C_RXDW0_CIPHER); 755251538Srpaulo infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8; 756251538Srpaulo 757251538Srpaulo /* Get RSSI from PHY status descriptor if present. */ 758251538Srpaulo if (infosz != 0 && (rxdw0 & R92C_RXDW0_PHYST)) { 759281069Srpaulo if (sc->chip & URTWN_CHIP_88E) 760264912Skevlo rssi = urtwn_r88e_get_rssi(sc, rate, &stat[1]); 761264912Skevlo else 762264912Skevlo rssi = urtwn_get_rssi(sc, rate, &stat[1]); 763251538Srpaulo /* Update our average RSSI. */ 764251538Srpaulo urtwn_update_avgrssi(sc, rate, rssi); 765251538Srpaulo } 766251538Srpaulo 767260463Skevlo m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 768251538Srpaulo if (m == NULL) { 769251538Srpaulo device_printf(sc->sc_dev, "could not create RX mbuf\n"); 770251538Srpaulo return (NULL); 771251538Srpaulo } 772251538Srpaulo 773251538Srpaulo /* Finalize mbuf. */ 774292175Savos memcpy(mtod(m, uint8_t *), (uint8_t *)&stat[1] + infosz, pktlen); 775292175Savos m->m_pkthdr.len = m->m_len = pktlen; 776292175Savos wh = mtod(m, struct ieee80211_frame *); 777251538Srpaulo 778292175Savos if ((wh->i_fc[1] & IEEE80211_FC1_PROTECTED) && 779292175Savos cipher != R92C_CAM_ALGO_NONE) { 780292175Savos m->m_flags |= M_WEP; 781292175Savos } 782292175Savos 783251538Srpaulo if (ieee80211_radiotap_active(ic)) { 784251538Srpaulo struct urtwn_rx_radiotap_header *tap = &sc->sc_rxtap; 785251538Srpaulo 786251538Srpaulo tap->wr_flags = 0; 787251538Srpaulo /* Map HW rate index to 802.11 rate. */ 788251538Srpaulo if (!(rxdw3 & R92C_RXDW3_HT)) { 789289758Savos tap->wr_rate = ridx2rate[rate]; 790251538Srpaulo } else if (rate >= 12) { /* MCS0~15. */ 791251538Srpaulo /* Bit 7 set means HT MCS instead of rate. */ 792251538Srpaulo tap->wr_rate = 0x80 | (rate - 12); 793251538Srpaulo } 794251538Srpaulo tap->wr_dbm_antsignal = rssi; 795289816Savos tap->wr_dbm_antnoise = URTWN_NOISE_FLOOR; 796251538Srpaulo } 797251538Srpaulo 798251538Srpaulo *rssi_p = rssi; 799251538Srpaulo 800251538Srpaulo return (m); 801251538Srpaulo} 802251538Srpaulo 803251538Srpaulostatic struct mbuf * 804292167Savosurtwn_report_intr(struct usb_xfer *xfer, struct urtwn_data *data, int *rssi, 805251538Srpaulo int8_t *nf) 806251538Srpaulo{ 807251538Srpaulo struct urtwn_softc *sc = data->sc; 808287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 809251538Srpaulo struct r92c_rx_stat *stat; 810251538Srpaulo uint8_t *buf; 811292167Savos int len; 812251538Srpaulo 813251538Srpaulo usbd_xfer_status(xfer, &len, NULL, NULL, NULL); 814251538Srpaulo 815251538Srpaulo if (len < sizeof(*stat)) { 816287197Sglebius counter_u64_add(ic->ic_ierrors, 1); 817251538Srpaulo return (NULL); 818251538Srpaulo } 819251538Srpaulo 820251538Srpaulo buf = data->buf; 821292167Savos stat = (struct r92c_rx_stat *)buf; 822292167Savos 823292167Savos if (sc->chip & URTWN_CHIP_88E) { 824292167Savos int report_sel = MS(le32toh(stat->rxdw3), R88E_RXDW3_RPT); 825292167Savos 826292167Savos switch (report_sel) { 827292167Savos case R88E_RXDW3_RPT_RX: 828292167Savos return (urtwn_rxeof(sc, buf, len, rssi, nf)); 829292167Savos case R88E_RXDW3_RPT_TX1: 830292167Savos urtwn_r88e_ratectl_tx_complete(sc, &stat[1]); 831292167Savos break; 832292167Savos default: 833292167Savos DPRINTFN(7, "case %d was not handled\n", report_sel); 834292167Savos break; 835292167Savos } 836292167Savos } else 837292167Savos return (urtwn_rxeof(sc, buf, len, rssi, nf)); 838292167Savos 839292167Savos return (NULL); 840292167Savos} 841292167Savos 842292167Savosstatic struct mbuf * 843292167Savosurtwn_rxeof(struct urtwn_softc *sc, uint8_t *buf, int len, int *rssi, 844292167Savos int8_t *nf) 845292167Savos{ 846292167Savos struct r92c_rx_stat *stat; 847292167Savos struct mbuf *m, *m0 = NULL, *prevm = NULL; 848292167Savos uint32_t rxdw0; 849292167Savos int totlen, pktlen, infosz, npkts; 850292167Savos 851251538Srpaulo /* Get the number of encapsulated frames. */ 852251538Srpaulo stat = (struct r92c_rx_stat *)buf; 853251538Srpaulo npkts = MS(le32toh(stat->rxdw2), R92C_RXDW2_PKTCNT); 854251538Srpaulo DPRINTFN(6, "Rx %d frames in one chunk\n", npkts); 855251538Srpaulo 856251538Srpaulo /* Process all of them. */ 857251538Srpaulo while (npkts-- > 0) { 858251538Srpaulo if (len < sizeof(*stat)) 859251538Srpaulo break; 860251538Srpaulo stat = (struct r92c_rx_stat *)buf; 861251538Srpaulo rxdw0 = le32toh(stat->rxdw0); 862251538Srpaulo 863251538Srpaulo pktlen = MS(rxdw0, R92C_RXDW0_PKTLEN); 864251538Srpaulo if (pktlen == 0) 865251538Srpaulo break; 866251538Srpaulo 867251538Srpaulo infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8; 868251538Srpaulo 869251538Srpaulo /* Make sure everything fits in xfer. */ 870251538Srpaulo totlen = sizeof(*stat) + infosz + pktlen; 871251538Srpaulo if (totlen > len) 872251538Srpaulo break; 873251538Srpaulo 874251538Srpaulo m = urtwn_rx_frame(sc, buf, pktlen, rssi); 875251538Srpaulo if (m0 == NULL) 876251538Srpaulo m0 = m; 877251538Srpaulo if (prevm == NULL) 878251538Srpaulo prevm = m; 879251538Srpaulo else { 880251538Srpaulo prevm->m_next = m; 881251538Srpaulo prevm = m; 882251538Srpaulo } 883251538Srpaulo 884251538Srpaulo /* Next chunk is 128-byte aligned. */ 885251538Srpaulo totlen = (totlen + 127) & ~127; 886251538Srpaulo buf += totlen; 887251538Srpaulo len -= totlen; 888251538Srpaulo } 889251538Srpaulo 890251538Srpaulo return (m0); 891251538Srpaulo} 892251538Srpaulo 893251538Srpaulostatic void 894292167Savosurtwn_r88e_ratectl_tx_complete(struct urtwn_softc *sc, void *arg) 895292167Savos{ 896292167Savos struct r88e_tx_rpt_ccx *rpt = arg; 897292167Savos struct ieee80211vap *vap; 898292167Savos struct ieee80211_node *ni; 899292167Savos uint8_t macid; 900292167Savos int ntries; 901292167Savos 902292167Savos macid = MS(rpt->rptb1, R88E_RPTB1_MACID); 903292167Savos ntries = MS(rpt->rptb2, R88E_RPTB2_RETRY_CNT); 904292167Savos 905292167Savos URTWN_NT_LOCK(sc); 906292167Savos ni = sc->node_list[macid]; 907292167Savos if (ni != NULL) { 908292167Savos vap = ni->ni_vap; 909292167Savos 910292167Savos if (rpt->rptb1 & R88E_RPTB1_PKT_OK) { 911292167Savos ieee80211_ratectl_tx_complete(vap, ni, 912292167Savos IEEE80211_RATECTL_TX_SUCCESS, &ntries, NULL); 913292167Savos } else { 914292167Savos ieee80211_ratectl_tx_complete(vap, ni, 915292167Savos IEEE80211_RATECTL_TX_FAILURE, &ntries, NULL); 916292167Savos } 917292167Savos } else 918292167Savos DPRINTFN(8, "macid %d, ni is NULL\n", macid); 919292167Savos URTWN_NT_UNLOCK(sc); 920292167Savos} 921292167Savos 922292167Savosstatic void 923251538Srpaulourtwn_bulk_rx_callback(struct usb_xfer *xfer, usb_error_t error) 924251538Srpaulo{ 925251538Srpaulo struct urtwn_softc *sc = usbd_xfer_softc(xfer); 926287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 927290022Savos struct ieee80211_frame_min *wh; 928251538Srpaulo struct ieee80211_node *ni; 929251538Srpaulo struct mbuf *m = NULL, *next; 930251538Srpaulo struct urtwn_data *data; 931251538Srpaulo int8_t nf; 932251538Srpaulo int rssi = 1; 933251538Srpaulo 934251538Srpaulo URTWN_ASSERT_LOCKED(sc); 935251538Srpaulo 936251538Srpaulo switch (USB_GET_STATE(xfer)) { 937251538Srpaulo case USB_ST_TRANSFERRED: 938251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_active); 939251538Srpaulo if (data == NULL) 940251538Srpaulo goto tr_setup; 941251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 942292167Savos m = urtwn_report_intr(xfer, data, &rssi, &nf); 943251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 944251538Srpaulo /* FALLTHROUGH */ 945251538Srpaulo case USB_ST_SETUP: 946251538Srpaulotr_setup: 947251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_inactive); 948251538Srpaulo if (data == NULL) { 949251538Srpaulo KASSERT(m == NULL, ("mbuf isn't NULL")); 950251538Srpaulo return; 951251538Srpaulo } 952251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_inactive, next); 953251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_active, data, next); 954251538Srpaulo usbd_xfer_set_frame_data(xfer, 0, data->buf, 955251538Srpaulo usbd_xfer_max_len(xfer)); 956251538Srpaulo usbd_transfer_submit(xfer); 957251538Srpaulo 958251538Srpaulo /* 959251538Srpaulo * To avoid LOR we should unlock our private mutex here to call 960251538Srpaulo * ieee80211_input() because here is at the end of a USB 961251538Srpaulo * callback and safe to unlock. 962251538Srpaulo */ 963251538Srpaulo URTWN_UNLOCK(sc); 964251538Srpaulo while (m != NULL) { 965251538Srpaulo next = m->m_next; 966251538Srpaulo m->m_next = NULL; 967290022Savos wh = mtod(m, struct ieee80211_frame_min *); 968290022Savos if (m->m_len >= sizeof(*wh)) 969290022Savos ni = ieee80211_find_rxnode(ic, wh); 970290022Savos else 971290022Savos ni = NULL; 972251538Srpaulo nf = URTWN_NOISE_FLOOR; 973251538Srpaulo if (ni != NULL) { 974289799Savos (void)ieee80211_input(ni, m, rssi - nf, nf); 975251538Srpaulo ieee80211_free_node(ni); 976289799Savos } else { 977289799Savos (void)ieee80211_input_all(ic, m, rssi - nf, 978289799Savos nf); 979289799Savos } 980251538Srpaulo m = next; 981251538Srpaulo } 982251538Srpaulo URTWN_LOCK(sc); 983251538Srpaulo break; 984251538Srpaulo default: 985251538Srpaulo /* needs it to the inactive queue due to a error. */ 986251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_active); 987251538Srpaulo if (data != NULL) { 988251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 989251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 990251538Srpaulo } 991251538Srpaulo if (error != USB_ERR_CANCELLED) { 992251538Srpaulo usbd_xfer_set_stall(xfer); 993287197Sglebius counter_u64_add(ic->ic_ierrors, 1); 994251538Srpaulo goto tr_setup; 995251538Srpaulo } 996251538Srpaulo break; 997251538Srpaulo } 998251538Srpaulo} 999251538Srpaulo 1000251538Srpaulostatic void 1001289891Savosurtwn_txeof(struct urtwn_softc *sc, struct urtwn_data *data, int status) 1002251538Srpaulo{ 1003251538Srpaulo 1004251538Srpaulo URTWN_ASSERT_LOCKED(sc); 1005289891Savos 1006290631Savos if (data->ni != NULL) /* not a beacon frame */ 1007290631Savos ieee80211_tx_complete(data->ni, data->m, status); 1008289891Savos 1009287197Sglebius data->ni = NULL; 1010287197Sglebius data->m = NULL; 1011289891Savos 1012251538Srpaulo sc->sc_txtimer = 0; 1013289891Savos 1014289891Savos STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data, next); 1015251538Srpaulo} 1016251538Srpaulo 1017289066Skevlostatic int 1018289066Skevlourtwn_alloc_list(struct urtwn_softc *sc, struct urtwn_data data[], 1019289066Skevlo int ndata, int maxsz) 1020289066Skevlo{ 1021289066Skevlo int i, error; 1022289066Skevlo 1023289066Skevlo for (i = 0; i < ndata; i++) { 1024289066Skevlo struct urtwn_data *dp = &data[i]; 1025289066Skevlo dp->sc = sc; 1026289066Skevlo dp->m = NULL; 1027289066Skevlo dp->buf = malloc(maxsz, M_USBDEV, M_NOWAIT); 1028289066Skevlo if (dp->buf == NULL) { 1029289066Skevlo device_printf(sc->sc_dev, 1030289066Skevlo "could not allocate buffer\n"); 1031289066Skevlo error = ENOMEM; 1032289066Skevlo goto fail; 1033289066Skevlo } 1034289066Skevlo dp->ni = NULL; 1035289066Skevlo } 1036289066Skevlo 1037289066Skevlo return (0); 1038289066Skevlofail: 1039289066Skevlo urtwn_free_list(sc, data, ndata); 1040289066Skevlo return (error); 1041289066Skevlo} 1042289066Skevlo 1043289066Skevlostatic int 1044289066Skevlourtwn_alloc_rx_list(struct urtwn_softc *sc) 1045289066Skevlo{ 1046289066Skevlo int error, i; 1047289066Skevlo 1048289066Skevlo error = urtwn_alloc_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT, 1049289066Skevlo URTWN_RXBUFSZ); 1050289066Skevlo if (error != 0) 1051289066Skevlo return (error); 1052289066Skevlo 1053289066Skevlo STAILQ_INIT(&sc->sc_rx_active); 1054289066Skevlo STAILQ_INIT(&sc->sc_rx_inactive); 1055289066Skevlo 1056289066Skevlo for (i = 0; i < URTWN_RX_LIST_COUNT; i++) 1057289066Skevlo STAILQ_INSERT_HEAD(&sc->sc_rx_inactive, &sc->sc_rx[i], next); 1058289066Skevlo 1059289066Skevlo return (0); 1060289066Skevlo} 1061289066Skevlo 1062289066Skevlostatic int 1063289066Skevlourtwn_alloc_tx_list(struct urtwn_softc *sc) 1064289066Skevlo{ 1065289066Skevlo int error, i; 1066289066Skevlo 1067289066Skevlo error = urtwn_alloc_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT, 1068289066Skevlo URTWN_TXBUFSZ); 1069289066Skevlo if (error != 0) 1070289066Skevlo return (error); 1071289066Skevlo 1072289066Skevlo STAILQ_INIT(&sc->sc_tx_active); 1073289066Skevlo STAILQ_INIT(&sc->sc_tx_inactive); 1074289066Skevlo STAILQ_INIT(&sc->sc_tx_pending); 1075289066Skevlo 1076289066Skevlo for (i = 0; i < URTWN_TX_LIST_COUNT; i++) 1077289066Skevlo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, &sc->sc_tx[i], next); 1078289066Skevlo 1079289066Skevlo return (0); 1080289066Skevlo} 1081289066Skevlo 1082251538Srpaulostatic void 1083289066Skevlourtwn_free_list(struct urtwn_softc *sc, struct urtwn_data data[], int ndata) 1084289066Skevlo{ 1085289066Skevlo int i; 1086289066Skevlo 1087289066Skevlo for (i = 0; i < ndata; i++) { 1088289066Skevlo struct urtwn_data *dp = &data[i]; 1089289066Skevlo 1090289066Skevlo if (dp->buf != NULL) { 1091289066Skevlo free(dp->buf, M_USBDEV); 1092289066Skevlo dp->buf = NULL; 1093289066Skevlo } 1094289066Skevlo if (dp->ni != NULL) { 1095289066Skevlo ieee80211_free_node(dp->ni); 1096289066Skevlo dp->ni = NULL; 1097289066Skevlo } 1098289066Skevlo } 1099289066Skevlo} 1100289066Skevlo 1101289066Skevlostatic void 1102289066Skevlourtwn_free_rx_list(struct urtwn_softc *sc) 1103289066Skevlo{ 1104289066Skevlo urtwn_free_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT); 1105289066Skevlo} 1106289066Skevlo 1107289066Skevlostatic void 1108289066Skevlourtwn_free_tx_list(struct urtwn_softc *sc) 1109289066Skevlo{ 1110289066Skevlo urtwn_free_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT); 1111289066Skevlo} 1112289066Skevlo 1113289066Skevlostatic void 1114251538Srpaulourtwn_bulk_tx_callback(struct usb_xfer *xfer, usb_error_t error) 1115251538Srpaulo{ 1116251538Srpaulo struct urtwn_softc *sc = usbd_xfer_softc(xfer); 1117251538Srpaulo struct urtwn_data *data; 1118251538Srpaulo 1119251538Srpaulo URTWN_ASSERT_LOCKED(sc); 1120251538Srpaulo 1121251538Srpaulo switch (USB_GET_STATE(xfer)){ 1122251538Srpaulo case USB_ST_TRANSFERRED: 1123251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_active); 1124251538Srpaulo if (data == NULL) 1125251538Srpaulo goto tr_setup; 1126251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next); 1127289891Savos urtwn_txeof(sc, data, 0); 1128251538Srpaulo /* FALLTHROUGH */ 1129251538Srpaulo case USB_ST_SETUP: 1130251538Srpaulotr_setup: 1131251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_pending); 1132251538Srpaulo if (data == NULL) { 1133251538Srpaulo DPRINTF("%s: empty pending queue\n", __func__); 1134288353Sadrian goto finish; 1135251538Srpaulo } 1136251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_pending, next); 1137251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_tx_active, data, next); 1138251538Srpaulo usbd_xfer_set_frame_data(xfer, 0, data->buf, data->buflen); 1139251538Srpaulo usbd_transfer_submit(xfer); 1140251538Srpaulo break; 1141251538Srpaulo default: 1142251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_active); 1143251538Srpaulo if (data == NULL) 1144251538Srpaulo goto tr_setup; 1145289891Savos STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next); 1146289891Savos urtwn_txeof(sc, data, 1); 1147251538Srpaulo if (error != USB_ERR_CANCELLED) { 1148251538Srpaulo usbd_xfer_set_stall(xfer); 1149251538Srpaulo goto tr_setup; 1150251538Srpaulo } 1151251538Srpaulo break; 1152251538Srpaulo } 1153288353Sadrianfinish: 1154288353Sadrian /* Kick-start more transmit */ 1155288353Sadrian urtwn_start(sc); 1156251538Srpaulo} 1157251538Srpaulo 1158251538Srpaulostatic struct urtwn_data * 1159251538Srpaulo_urtwn_getbuf(struct urtwn_softc *sc) 1160251538Srpaulo{ 1161251538Srpaulo struct urtwn_data *bf; 1162251538Srpaulo 1163251538Srpaulo bf = STAILQ_FIRST(&sc->sc_tx_inactive); 1164251538Srpaulo if (bf != NULL) 1165251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_inactive, next); 1166251538Srpaulo else 1167251538Srpaulo DPRINTF("%s: %s\n", __func__, "out of xmit buffers"); 1168251538Srpaulo return (bf); 1169251538Srpaulo} 1170251538Srpaulo 1171251538Srpaulostatic struct urtwn_data * 1172251538Srpaulourtwn_getbuf(struct urtwn_softc *sc) 1173251538Srpaulo{ 1174251538Srpaulo struct urtwn_data *bf; 1175251538Srpaulo 1176251538Srpaulo URTWN_ASSERT_LOCKED(sc); 1177251538Srpaulo 1178251538Srpaulo bf = _urtwn_getbuf(sc); 1179287197Sglebius if (bf == NULL) 1180251538Srpaulo DPRINTF("%s: stop queue\n", __func__); 1181251538Srpaulo return (bf); 1182251538Srpaulo} 1183251538Srpaulo 1184291698Savosstatic usb_error_t 1185251538Srpaulourtwn_write_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf, 1186251538Srpaulo int len) 1187251538Srpaulo{ 1188251538Srpaulo usb_device_request_t req; 1189251538Srpaulo 1190251538Srpaulo req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 1191251538Srpaulo req.bRequest = R92C_REQ_REGS; 1192251538Srpaulo USETW(req.wValue, addr); 1193251538Srpaulo USETW(req.wIndex, 0); 1194251538Srpaulo USETW(req.wLength, len); 1195251538Srpaulo return (urtwn_do_request(sc, &req, buf)); 1196251538Srpaulo} 1197251538Srpaulo 1198291698Savosstatic usb_error_t 1199251538Srpaulourtwn_write_1(struct urtwn_softc *sc, uint16_t addr, uint8_t val) 1200251538Srpaulo{ 1201291698Savos return (urtwn_write_region_1(sc, addr, &val, sizeof(val))); 1202251538Srpaulo} 1203251538Srpaulo 1204291698Savosstatic usb_error_t 1205251538Srpaulourtwn_write_2(struct urtwn_softc *sc, uint16_t addr, uint16_t val) 1206251538Srpaulo{ 1207251538Srpaulo val = htole16(val); 1208291698Savos return (urtwn_write_region_1(sc, addr, (uint8_t *)&val, sizeof(val))); 1209251538Srpaulo} 1210251538Srpaulo 1211291698Savosstatic usb_error_t 1212251538Srpaulourtwn_write_4(struct urtwn_softc *sc, uint16_t addr, uint32_t val) 1213251538Srpaulo{ 1214251538Srpaulo val = htole32(val); 1215291698Savos return (urtwn_write_region_1(sc, addr, (uint8_t *)&val, sizeof(val))); 1216251538Srpaulo} 1217251538Srpaulo 1218291698Savosstatic usb_error_t 1219251538Srpaulourtwn_read_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf, 1220251538Srpaulo int len) 1221251538Srpaulo{ 1222251538Srpaulo usb_device_request_t req; 1223251538Srpaulo 1224251538Srpaulo req.bmRequestType = UT_READ_VENDOR_DEVICE; 1225251538Srpaulo req.bRequest = R92C_REQ_REGS; 1226251538Srpaulo USETW(req.wValue, addr); 1227251538Srpaulo USETW(req.wIndex, 0); 1228251538Srpaulo USETW(req.wLength, len); 1229251538Srpaulo return (urtwn_do_request(sc, &req, buf)); 1230251538Srpaulo} 1231251538Srpaulo 1232251538Srpaulostatic uint8_t 1233251538Srpaulourtwn_read_1(struct urtwn_softc *sc, uint16_t addr) 1234251538Srpaulo{ 1235251538Srpaulo uint8_t val; 1236251538Srpaulo 1237251538Srpaulo if (urtwn_read_region_1(sc, addr, &val, 1) != 0) 1238251538Srpaulo return (0xff); 1239251538Srpaulo return (val); 1240251538Srpaulo} 1241251538Srpaulo 1242251538Srpaulostatic uint16_t 1243251538Srpaulourtwn_read_2(struct urtwn_softc *sc, uint16_t addr) 1244251538Srpaulo{ 1245251538Srpaulo uint16_t val; 1246251538Srpaulo 1247251538Srpaulo if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 2) != 0) 1248251538Srpaulo return (0xffff); 1249251538Srpaulo return (le16toh(val)); 1250251538Srpaulo} 1251251538Srpaulo 1252251538Srpaulostatic uint32_t 1253251538Srpaulourtwn_read_4(struct urtwn_softc *sc, uint16_t addr) 1254251538Srpaulo{ 1255251538Srpaulo uint32_t val; 1256251538Srpaulo 1257251538Srpaulo if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 4) != 0) 1258251538Srpaulo return (0xffffffff); 1259251538Srpaulo return (le32toh(val)); 1260251538Srpaulo} 1261251538Srpaulo 1262251538Srpaulostatic int 1263251538Srpaulourtwn_fw_cmd(struct urtwn_softc *sc, uint8_t id, const void *buf, int len) 1264251538Srpaulo{ 1265251538Srpaulo struct r92c_fw_cmd cmd; 1266291698Savos usb_error_t error; 1267251538Srpaulo int ntries; 1268251538Srpaulo 1269251538Srpaulo /* Wait for current FW box to be empty. */ 1270251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 1271251538Srpaulo if (!(urtwn_read_1(sc, R92C_HMETFR) & (1 << sc->fwcur))) 1272251538Srpaulo break; 1273266472Shselasky urtwn_ms_delay(sc); 1274251538Srpaulo } 1275251538Srpaulo if (ntries == 100) { 1276251538Srpaulo device_printf(sc->sc_dev, 1277251538Srpaulo "could not send firmware command\n"); 1278251538Srpaulo return (ETIMEDOUT); 1279251538Srpaulo } 1280251538Srpaulo memset(&cmd, 0, sizeof(cmd)); 1281251538Srpaulo cmd.id = id; 1282251538Srpaulo if (len > 3) 1283251538Srpaulo cmd.id |= R92C_CMD_FLAG_EXT; 1284251538Srpaulo KASSERT(len <= sizeof(cmd.msg), ("urtwn_fw_cmd\n")); 1285251538Srpaulo memcpy(cmd.msg, buf, len); 1286251538Srpaulo 1287251538Srpaulo /* Write the first word last since that will trigger the FW. */ 1288291698Savos error = urtwn_write_region_1(sc, R92C_HMEBOX_EXT(sc->fwcur), 1289251538Srpaulo (uint8_t *)&cmd + 4, 2); 1290291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1291291698Savos return (EIO); 1292291698Savos error = urtwn_write_region_1(sc, R92C_HMEBOX(sc->fwcur), 1293251538Srpaulo (uint8_t *)&cmd + 0, 4); 1294291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1295291698Savos return (EIO); 1296251538Srpaulo 1297251538Srpaulo sc->fwcur = (sc->fwcur + 1) % R92C_H2C_NBOX; 1298251538Srpaulo return (0); 1299251538Srpaulo} 1300251538Srpaulo 1301292174Savosstatic void 1302292174Savosurtwn_cmdq_cb(void *arg, int pending) 1303292174Savos{ 1304292174Savos struct urtwn_softc *sc = arg; 1305292174Savos struct urtwn_cmdq *item; 1306292174Savos 1307292174Savos /* 1308292174Savos * Device must be powered on (via urtwn_power_on()) 1309292174Savos * before any command may be sent. 1310292174Savos */ 1311292174Savos URTWN_LOCK(sc); 1312292174Savos if (!(sc->sc_flags & URTWN_RUNNING)) { 1313292174Savos URTWN_UNLOCK(sc); 1314292174Savos return; 1315292174Savos } 1316292174Savos 1317292174Savos URTWN_CMDQ_LOCK(sc); 1318292174Savos while (sc->cmdq[sc->cmdq_first].func != NULL) { 1319292174Savos item = &sc->cmdq[sc->cmdq_first]; 1320292174Savos sc->cmdq_first = (sc->cmdq_first + 1) % URTWN_CMDQ_SIZE; 1321292174Savos URTWN_CMDQ_UNLOCK(sc); 1322292174Savos 1323292174Savos item->func(sc, &item->data); 1324292174Savos 1325292174Savos URTWN_CMDQ_LOCK(sc); 1326292174Savos memset(item, 0, sizeof (*item)); 1327292174Savos } 1328292174Savos URTWN_CMDQ_UNLOCK(sc); 1329292174Savos URTWN_UNLOCK(sc); 1330292174Savos} 1331292174Savos 1332292174Savosstatic int 1333292174Savosurtwn_cmd_sleepable(struct urtwn_softc *sc, const void *ptr, size_t len, 1334292174Savos CMD_FUNC_PROTO) 1335292174Savos{ 1336292174Savos struct ieee80211com *ic = &sc->sc_ic; 1337292174Savos 1338292174Savos KASSERT(len <= sizeof(union sec_param), ("buffer overflow")); 1339292174Savos 1340292174Savos URTWN_CMDQ_LOCK(sc); 1341292174Savos if (sc->cmdq[sc->cmdq_last].func != NULL) { 1342292174Savos device_printf(sc->sc_dev, "%s: cmdq overflow\n", __func__); 1343292174Savos URTWN_CMDQ_UNLOCK(sc); 1344292174Savos 1345292174Savos return (EAGAIN); 1346292174Savos } 1347292174Savos 1348292174Savos if (ptr != NULL) 1349292174Savos memcpy(&sc->cmdq[sc->cmdq_last].data, ptr, len); 1350292174Savos sc->cmdq[sc->cmdq_last].func = func; 1351292174Savos sc->cmdq_last = (sc->cmdq_last + 1) % URTWN_CMDQ_SIZE; 1352292174Savos URTWN_CMDQ_UNLOCK(sc); 1353292174Savos 1354292174Savos ieee80211_runtask(ic, &sc->cmdq_task); 1355292174Savos 1356292174Savos return (0); 1357292174Savos} 1358292174Savos 1359264912Skevlostatic __inline void 1360251538Srpaulourtwn_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, uint32_t val) 1361251538Srpaulo{ 1362264912Skevlo 1363264912Skevlo sc->sc_rf_write(sc, chain, addr, val); 1364264912Skevlo} 1365264912Skevlo 1366264912Skevlostatic void 1367264912Skevlourtwn_r92c_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, 1368264912Skevlo uint32_t val) 1369264912Skevlo{ 1370251538Srpaulo urtwn_bb_write(sc, R92C_LSSI_PARAM(chain), 1371251538Srpaulo SM(R92C_LSSI_PARAM_ADDR, addr) | 1372251538Srpaulo SM(R92C_LSSI_PARAM_DATA, val)); 1373251538Srpaulo} 1374251538Srpaulo 1375264912Skevlostatic void 1376264912Skevlourtwn_r88e_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, 1377264912Skevlouint32_t val) 1378264912Skevlo{ 1379264912Skevlo urtwn_bb_write(sc, R92C_LSSI_PARAM(chain), 1380264912Skevlo SM(R88E_LSSI_PARAM_ADDR, addr) | 1381264912Skevlo SM(R92C_LSSI_PARAM_DATA, val)); 1382264912Skevlo} 1383264912Skevlo 1384251538Srpaulostatic uint32_t 1385251538Srpaulourtwn_rf_read(struct urtwn_softc *sc, int chain, uint8_t addr) 1386251538Srpaulo{ 1387251538Srpaulo uint32_t reg[R92C_MAX_CHAINS], val; 1388251538Srpaulo 1389251538Srpaulo reg[0] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)); 1390251538Srpaulo if (chain != 0) 1391251538Srpaulo reg[chain] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(chain)); 1392251538Srpaulo 1393251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(0), 1394251538Srpaulo reg[0] & ~R92C_HSSI_PARAM2_READ_EDGE); 1395266472Shselasky urtwn_ms_delay(sc); 1396251538Srpaulo 1397251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(chain), 1398251538Srpaulo RW(reg[chain], R92C_HSSI_PARAM2_READ_ADDR, addr) | 1399251538Srpaulo R92C_HSSI_PARAM2_READ_EDGE); 1400266472Shselasky urtwn_ms_delay(sc); 1401251538Srpaulo 1402251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(0), 1403251538Srpaulo reg[0] | R92C_HSSI_PARAM2_READ_EDGE); 1404266472Shselasky urtwn_ms_delay(sc); 1405251538Srpaulo 1406251538Srpaulo if (urtwn_bb_read(sc, R92C_HSSI_PARAM1(chain)) & R92C_HSSI_PARAM1_PI) 1407251538Srpaulo val = urtwn_bb_read(sc, R92C_HSPI_READBACK(chain)); 1408251538Srpaulo else 1409251538Srpaulo val = urtwn_bb_read(sc, R92C_LSSI_READBACK(chain)); 1410251538Srpaulo return (MS(val, R92C_LSSI_READBACK_DATA)); 1411251538Srpaulo} 1412251538Srpaulo 1413251538Srpaulostatic int 1414251538Srpaulourtwn_llt_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data) 1415251538Srpaulo{ 1416291698Savos usb_error_t error; 1417251538Srpaulo int ntries; 1418251538Srpaulo 1419291698Savos error = urtwn_write_4(sc, R92C_LLT_INIT, 1420251538Srpaulo SM(R92C_LLT_INIT_OP, R92C_LLT_INIT_OP_WRITE) | 1421251538Srpaulo SM(R92C_LLT_INIT_ADDR, addr) | 1422251538Srpaulo SM(R92C_LLT_INIT_DATA, data)); 1423291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1424291698Savos return (EIO); 1425251538Srpaulo /* Wait for write operation to complete. */ 1426251538Srpaulo for (ntries = 0; ntries < 20; ntries++) { 1427251538Srpaulo if (MS(urtwn_read_4(sc, R92C_LLT_INIT), R92C_LLT_INIT_OP) == 1428251538Srpaulo R92C_LLT_INIT_OP_NO_ACTIVE) 1429251538Srpaulo return (0); 1430266472Shselasky urtwn_ms_delay(sc); 1431251538Srpaulo } 1432251538Srpaulo return (ETIMEDOUT); 1433251538Srpaulo} 1434251538Srpaulo 1435291264Savosstatic int 1436291264Savosurtwn_efuse_read_next(struct urtwn_softc *sc, uint8_t *val) 1437251538Srpaulo{ 1438251538Srpaulo uint32_t reg; 1439291698Savos usb_error_t error; 1440251538Srpaulo int ntries; 1441251538Srpaulo 1442291264Savos if (sc->last_rom_addr >= URTWN_EFUSE_MAX_LEN) 1443291264Savos return (EFAULT); 1444291264Savos 1445251538Srpaulo reg = urtwn_read_4(sc, R92C_EFUSE_CTRL); 1446291264Savos reg = RW(reg, R92C_EFUSE_CTRL_ADDR, sc->last_rom_addr); 1447251538Srpaulo reg &= ~R92C_EFUSE_CTRL_VALID; 1448291264Savos 1449291698Savos error = urtwn_write_4(sc, R92C_EFUSE_CTRL, reg); 1450291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1451291698Savos return (EIO); 1452251538Srpaulo /* Wait for read operation to complete. */ 1453251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 1454251538Srpaulo reg = urtwn_read_4(sc, R92C_EFUSE_CTRL); 1455251538Srpaulo if (reg & R92C_EFUSE_CTRL_VALID) 1456291264Savos break; 1457266472Shselasky urtwn_ms_delay(sc); 1458251538Srpaulo } 1459291264Savos if (ntries == 100) { 1460291264Savos device_printf(sc->sc_dev, 1461291264Savos "could not read efuse byte at address 0x%x\n", 1462291264Savos sc->last_rom_addr); 1463291264Savos return (ETIMEDOUT); 1464291264Savos } 1465291264Savos 1466291264Savos *val = MS(reg, R92C_EFUSE_CTRL_DATA); 1467291264Savos sc->last_rom_addr++; 1468291264Savos 1469291264Savos return (0); 1470251538Srpaulo} 1471251538Srpaulo 1472291264Savosstatic int 1473291264Savosurtwn_efuse_read_data(struct urtwn_softc *sc, uint8_t *rom, uint8_t off, 1474291264Savos uint8_t msk) 1475291264Savos{ 1476291264Savos uint8_t reg; 1477291264Savos int i, error; 1478291264Savos 1479291264Savos for (i = 0; i < 4; i++) { 1480291264Savos if (msk & (1 << i)) 1481291264Savos continue; 1482291264Savos error = urtwn_efuse_read_next(sc, ®); 1483291264Savos if (error != 0) 1484291264Savos return (error); 1485291264Savos DPRINTF("rom[0x%03X] == 0x%02X\n", off * 8 + i * 2, reg); 1486291264Savos rom[off * 8 + i * 2 + 0] = reg; 1487291264Savos 1488291264Savos error = urtwn_efuse_read_next(sc, ®); 1489291264Savos if (error != 0) 1490291264Savos return (error); 1491291264Savos DPRINTF("rom[0x%03X] == 0x%02X\n", off * 8 + i * 2 + 1, reg); 1492291264Savos rom[off * 8 + i * 2 + 1] = reg; 1493291264Savos } 1494291264Savos 1495291264Savos return (0); 1496291264Savos} 1497291264Savos 1498291264Savos#ifdef URTWN_DEBUG 1499251538Srpaulostatic void 1500291264Savosurtwn_dump_rom_contents(struct urtwn_softc *sc, uint8_t *rom, uint16_t size) 1501251538Srpaulo{ 1502251538Srpaulo int i; 1503251538Srpaulo 1504291264Savos /* Dump ROM contents. */ 1505291264Savos device_printf(sc->sc_dev, "%s:", __func__); 1506291264Savos for (i = 0; i < size; i++) { 1507291264Savos if (i % 32 == 0) 1508291264Savos printf("\n%03X: ", i); 1509291264Savos else if (i % 4 == 0) 1510291264Savos printf(" "); 1511291264Savos 1512291264Savos printf("%02X", rom[i]); 1513291264Savos } 1514291264Savos printf("\n"); 1515291264Savos} 1516291264Savos#endif 1517291264Savos 1518291264Savosstatic int 1519291264Savosurtwn_efuse_read(struct urtwn_softc *sc, uint8_t *rom, uint16_t size) 1520291264Savos{ 1521291264Savos#define URTWN_CHK(res) do { \ 1522291264Savos if ((error = res) != 0) \ 1523291264Savos goto end; \ 1524291264Savos} while(0) 1525291264Savos uint8_t msk, off, reg; 1526291264Savos int error; 1527291264Savos 1528291698Savos URTWN_CHK(urtwn_efuse_switch_power(sc)); 1529264912Skevlo 1530291264Savos /* Read full ROM image. */ 1531291264Savos sc->last_rom_addr = 0; 1532291264Savos memset(rom, 0xff, size); 1533291264Savos 1534291264Savos URTWN_CHK(urtwn_efuse_read_next(sc, ®)); 1535291264Savos while (reg != 0xff) { 1536291264Savos /* check for extended header */ 1537291264Savos if ((sc->chip & URTWN_CHIP_88E) && (reg & 0x1f) == 0x0f) { 1538291264Savos off = reg >> 5; 1539291264Savos URTWN_CHK(urtwn_efuse_read_next(sc, ®)); 1540291264Savos 1541291264Savos if ((reg & 0x0f) != 0x0f) 1542291264Savos off = ((reg & 0xf0) >> 1) | off; 1543291264Savos else 1544291264Savos continue; 1545291264Savos } else 1546291264Savos off = reg >> 4; 1547251538Srpaulo msk = reg & 0xf; 1548291264Savos 1549291264Savos URTWN_CHK(urtwn_efuse_read_data(sc, rom, off, msk)); 1550291264Savos URTWN_CHK(urtwn_efuse_read_next(sc, ®)); 1551251538Srpaulo } 1552291264Savos 1553291264Savosend: 1554291264Savos 1555251538Srpaulo#ifdef URTWN_DEBUG 1556291264Savos if (urtwn_debug >= 2) 1557291264Savos urtwn_dump_rom_contents(sc, rom, size); 1558251538Srpaulo#endif 1559291264Savos 1560282623Skevlo urtwn_write_1(sc, R92C_EFUSE_ACCESS, R92C_EFUSE_ACCESS_OFF); 1561291264Savos 1562291264Savos if (error != 0) { 1563291264Savos device_printf(sc->sc_dev, "%s: error while reading ROM\n", 1564291264Savos __func__); 1565291264Savos } 1566291264Savos 1567291264Savos return (error); 1568291264Savos#undef URTWN_CHK 1569282623Skevlo} 1570281592Skevlo 1571291698Savosstatic int 1572264912Skevlourtwn_efuse_switch_power(struct urtwn_softc *sc) 1573264912Skevlo{ 1574291698Savos usb_error_t error; 1575264912Skevlo uint32_t reg; 1576251538Srpaulo 1577291698Savos error = urtwn_write_1(sc, R92C_EFUSE_ACCESS, R92C_EFUSE_ACCESS_ON); 1578291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1579291698Savos return (EIO); 1580281918Skevlo 1581264912Skevlo reg = urtwn_read_2(sc, R92C_SYS_ISO_CTRL); 1582264912Skevlo if (!(reg & R92C_SYS_ISO_CTRL_PWC_EV12V)) { 1583291698Savos error = urtwn_write_2(sc, R92C_SYS_ISO_CTRL, 1584264912Skevlo reg | R92C_SYS_ISO_CTRL_PWC_EV12V); 1585291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1586291698Savos return (EIO); 1587264912Skevlo } 1588264912Skevlo reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN); 1589264912Skevlo if (!(reg & R92C_SYS_FUNC_EN_ELDR)) { 1590291698Savos error = urtwn_write_2(sc, R92C_SYS_FUNC_EN, 1591264912Skevlo reg | R92C_SYS_FUNC_EN_ELDR); 1592291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1593291698Savos return (EIO); 1594264912Skevlo } 1595264912Skevlo reg = urtwn_read_2(sc, R92C_SYS_CLKR); 1596264912Skevlo if ((reg & (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) != 1597264912Skevlo (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) { 1598291698Savos error = urtwn_write_2(sc, R92C_SYS_CLKR, 1599264912Skevlo reg | R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M); 1600291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1601291698Savos return (EIO); 1602264912Skevlo } 1603291698Savos 1604291698Savos return (0); 1605264912Skevlo} 1606264912Skevlo 1607251538Srpaulostatic int 1608251538Srpaulourtwn_read_chipid(struct urtwn_softc *sc) 1609251538Srpaulo{ 1610251538Srpaulo uint32_t reg; 1611251538Srpaulo 1612264912Skevlo if (sc->chip & URTWN_CHIP_88E) 1613264912Skevlo return (0); 1614264912Skevlo 1615251538Srpaulo reg = urtwn_read_4(sc, R92C_SYS_CFG); 1616251538Srpaulo if (reg & R92C_SYS_CFG_TRP_VAUX_EN) 1617251538Srpaulo return (EIO); 1618251538Srpaulo 1619251538Srpaulo if (reg & R92C_SYS_CFG_TYPE_92C) { 1620251538Srpaulo sc->chip |= URTWN_CHIP_92C; 1621251538Srpaulo /* Check if it is a castrated 8192C. */ 1622251538Srpaulo if (MS(urtwn_read_4(sc, R92C_HPON_FSM), 1623251538Srpaulo R92C_HPON_FSM_CHIP_BONDING_ID) == 1624251538Srpaulo R92C_HPON_FSM_CHIP_BONDING_ID_92C_1T2R) 1625251538Srpaulo sc->chip |= URTWN_CHIP_92C_1T2R; 1626251538Srpaulo } 1627251538Srpaulo if (reg & R92C_SYS_CFG_VENDOR_UMC) { 1628251538Srpaulo sc->chip |= URTWN_CHIP_UMC; 1629251538Srpaulo if (MS(reg, R92C_SYS_CFG_CHIP_VER_RTL) == 0) 1630251538Srpaulo sc->chip |= URTWN_CHIP_UMC_A_CUT; 1631251538Srpaulo } 1632251538Srpaulo return (0); 1633251538Srpaulo} 1634251538Srpaulo 1635291264Savosstatic int 1636251538Srpaulourtwn_read_rom(struct urtwn_softc *sc) 1637251538Srpaulo{ 1638291264Savos struct r92c_rom *rom = &sc->rom.r92c_rom; 1639291264Savos int error; 1640251538Srpaulo 1641251538Srpaulo /* Read full ROM image. */ 1642291264Savos error = urtwn_efuse_read(sc, (uint8_t *)rom, sizeof(*rom)); 1643291264Savos if (error != 0) 1644291264Savos return (error); 1645251538Srpaulo 1646251538Srpaulo /* XXX Weird but this is what the vendor driver does. */ 1647291264Savos sc->last_rom_addr = 0x1fa; 1648291264Savos error = urtwn_efuse_read_next(sc, &sc->pa_setting); 1649291264Savos if (error != 0) 1650291264Savos return (error); 1651251538Srpaulo DPRINTF("PA setting=0x%x\n", sc->pa_setting); 1652251538Srpaulo 1653251538Srpaulo sc->board_type = MS(rom->rf_opt1, R92C_ROM_RF1_BOARD_TYPE); 1654251538Srpaulo 1655251538Srpaulo sc->regulatory = MS(rom->rf_opt1, R92C_ROM_RF1_REGULATORY); 1656251538Srpaulo DPRINTF("regulatory type=%d\n", sc->regulatory); 1657287197Sglebius IEEE80211_ADDR_COPY(sc->sc_ic.ic_macaddr, rom->macaddr); 1658251538Srpaulo 1659264912Skevlo sc->sc_rf_write = urtwn_r92c_rf_write; 1660264912Skevlo sc->sc_power_on = urtwn_r92c_power_on; 1661291264Savos 1662291264Savos return (0); 1663251538Srpaulo} 1664251538Srpaulo 1665291264Savosstatic int 1666264912Skevlourtwn_r88e_read_rom(struct urtwn_softc *sc) 1667264912Skevlo{ 1668291264Savos uint8_t *rom = sc->rom.r88e_rom; 1669291264Savos uint16_t addr; 1670291264Savos int error, i; 1671264912Skevlo 1672291264Savos error = urtwn_efuse_read(sc, rom, sizeof(sc->rom.r88e_rom)); 1673291264Savos if (error != 0) 1674291264Savos return (error); 1675264912Skevlo 1676264912Skevlo addr = 0x10; 1677264912Skevlo for (i = 0; i < 6; i++) 1678291264Savos sc->cck_tx_pwr[i] = rom[addr++]; 1679264912Skevlo for (i = 0; i < 5; i++) 1680291264Savos sc->ht40_tx_pwr[i] = rom[addr++]; 1681291264Savos sc->bw20_tx_pwr_diff = (rom[addr] & 0xf0) >> 4; 1682264912Skevlo if (sc->bw20_tx_pwr_diff & 0x08) 1683264912Skevlo sc->bw20_tx_pwr_diff |= 0xf0; 1684291264Savos sc->ofdm_tx_pwr_diff = (rom[addr] & 0xf); 1685264912Skevlo if (sc->ofdm_tx_pwr_diff & 0x08) 1686264912Skevlo sc->ofdm_tx_pwr_diff |= 0xf0; 1687291264Savos sc->regulatory = MS(rom[0xc1], R92C_ROM_RF1_REGULATORY); 1688291264Savos IEEE80211_ADDR_COPY(sc->sc_ic.ic_macaddr, &rom[0xd7]); 1689264912Skevlo 1690264912Skevlo sc->sc_rf_write = urtwn_r88e_rf_write; 1691264912Skevlo sc->sc_power_on = urtwn_r88e_power_on; 1692291264Savos 1693291264Savos return (0); 1694264912Skevlo} 1695264912Skevlo 1696251538Srpaulo/* 1697251538Srpaulo * Initialize rate adaptation in firmware. 1698251538Srpaulo */ 1699251538Srpaulostatic int 1700251538Srpaulourtwn_ra_init(struct urtwn_softc *sc) 1701251538Srpaulo{ 1702287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 1703251538Srpaulo struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 1704251538Srpaulo struct ieee80211_node *ni; 1705251538Srpaulo struct ieee80211_rateset *rs; 1706251538Srpaulo struct r92c_fw_cmd_macid_cfg cmd; 1707251538Srpaulo uint32_t rates, basicrates; 1708251538Srpaulo uint8_t mode; 1709251538Srpaulo int maxrate, maxbasicrate, error, i, j; 1710251538Srpaulo 1711251538Srpaulo ni = ieee80211_ref_node(vap->iv_bss); 1712251538Srpaulo rs = &ni->ni_rates; 1713251538Srpaulo 1714251538Srpaulo /* Get normal and basic rates mask. */ 1715251538Srpaulo rates = basicrates = 0; 1716251538Srpaulo maxrate = maxbasicrate = 0; 1717251538Srpaulo for (i = 0; i < rs->rs_nrates; i++) { 1718251538Srpaulo /* Convert 802.11 rate to HW rate index. */ 1719289758Savos for (j = 0; j < nitems(ridx2rate); j++) 1720289758Savos if ((rs->rs_rates[i] & IEEE80211_RATE_VAL) == 1721289758Savos ridx2rate[j]) 1722251538Srpaulo break; 1723289758Savos if (j == nitems(ridx2rate)) /* Unknown rate, skip. */ 1724251538Srpaulo continue; 1725251538Srpaulo rates |= 1 << j; 1726251538Srpaulo if (j > maxrate) 1727251538Srpaulo maxrate = j; 1728251538Srpaulo if (rs->rs_rates[i] & IEEE80211_RATE_BASIC) { 1729251538Srpaulo basicrates |= 1 << j; 1730251538Srpaulo if (j > maxbasicrate) 1731251538Srpaulo maxbasicrate = j; 1732251538Srpaulo } 1733251538Srpaulo } 1734251538Srpaulo if (ic->ic_curmode == IEEE80211_MODE_11B) 1735251538Srpaulo mode = R92C_RAID_11B; 1736251538Srpaulo else 1737251538Srpaulo mode = R92C_RAID_11BG; 1738251538Srpaulo DPRINTF("mode=0x%x rates=0x%08x, basicrates=0x%08x\n", 1739251538Srpaulo mode, rates, basicrates); 1740251538Srpaulo 1741251538Srpaulo /* Set rates mask for group addressed frames. */ 1742251538Srpaulo cmd.macid = URTWN_MACID_BC | URTWN_MACID_VALID; 1743251538Srpaulo cmd.mask = htole32(mode << 28 | basicrates); 1744251538Srpaulo error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd)); 1745251538Srpaulo if (error != 0) { 1746252401Srpaulo ieee80211_free_node(ni); 1747251538Srpaulo device_printf(sc->sc_dev, 1748251538Srpaulo "could not add broadcast station\n"); 1749251538Srpaulo return (error); 1750251538Srpaulo } 1751251538Srpaulo /* Set initial MRR rate. */ 1752251538Srpaulo DPRINTF("maxbasicrate=%d\n", maxbasicrate); 1753251538Srpaulo urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BC), 1754251538Srpaulo maxbasicrate); 1755251538Srpaulo 1756251538Srpaulo /* Set rates mask for unicast frames. */ 1757251538Srpaulo cmd.macid = URTWN_MACID_BSS | URTWN_MACID_VALID; 1758251538Srpaulo cmd.mask = htole32(mode << 28 | rates); 1759251538Srpaulo error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd)); 1760251538Srpaulo if (error != 0) { 1761252401Srpaulo ieee80211_free_node(ni); 1762251538Srpaulo device_printf(sc->sc_dev, "could not add BSS station\n"); 1763251538Srpaulo return (error); 1764251538Srpaulo } 1765251538Srpaulo /* Set initial MRR rate. */ 1766251538Srpaulo DPRINTF("maxrate=%d\n", maxrate); 1767251538Srpaulo urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BSS), 1768251538Srpaulo maxrate); 1769251538Srpaulo 1770251538Srpaulo /* Indicate highest supported rate. */ 1771252403Srpaulo ni->ni_txrate = rs->rs_rates[rs->rs_nrates - 1]; 1772252401Srpaulo ieee80211_free_node(ni); 1773252401Srpaulo 1774251538Srpaulo return (0); 1775251538Srpaulo} 1776251538Srpaulo 1777290439Savosstatic void 1778290631Savosurtwn_init_beacon(struct urtwn_softc *sc, struct urtwn_vap *uvp) 1779251538Srpaulo{ 1780290631Savos struct r92c_tx_desc *txd = &uvp->bcn_desc; 1781290631Savos 1782290631Savos txd->txdw0 = htole32( 1783290631Savos SM(R92C_TXDW0_OFFSET, sizeof(*txd)) | R92C_TXDW0_BMCAST | 1784290631Savos R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG); 1785290631Savos txd->txdw1 = htole32( 1786290631Savos SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_BEACON) | 1787290631Savos SM(R92C_TXDW1_RAID, R92C_RAID_11B)); 1788290631Savos 1789291858Savos if (sc->chip & URTWN_CHIP_88E) { 1790290631Savos txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, URTWN_MACID_BC)); 1791291858Savos txd->txdseq |= htole16(R88E_TXDSEQ_HWSEQ_EN); 1792291858Savos } else { 1793290631Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, URTWN_MACID_BC)); 1794291858Savos txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN); 1795291858Savos } 1796290631Savos 1797290631Savos txd->txdw4 = htole32(R92C_TXDW4_DRVRATE); 1798290631Savos txd->txdw5 = htole32(SM(R92C_TXDW5_DATARATE, URTWN_RIDX_CCK1)); 1799251538Srpaulo} 1800251538Srpaulo 1801290631Savosstatic int 1802290631Savosurtwn_setup_beacon(struct urtwn_softc *sc, struct ieee80211_node *ni) 1803290631Savos{ 1804290631Savos struct ieee80211vap *vap = ni->ni_vap; 1805290631Savos struct urtwn_vap *uvp = URTWN_VAP(vap); 1806290631Savos struct mbuf *m; 1807290631Savos int error; 1808290631Savos 1809290631Savos URTWN_ASSERT_LOCKED(sc); 1810290631Savos 1811290631Savos if (ni->ni_chan == IEEE80211_CHAN_ANYC) 1812290631Savos return (EINVAL); 1813290631Savos 1814290631Savos m = ieee80211_beacon_alloc(ni); 1815290631Savos if (m == NULL) { 1816290631Savos device_printf(sc->sc_dev, 1817290631Savos "%s: could not allocate beacon frame\n", __func__); 1818290631Savos return (ENOMEM); 1819290631Savos } 1820290631Savos 1821290631Savos if (uvp->bcn_mbuf != NULL) 1822290631Savos m_freem(uvp->bcn_mbuf); 1823290631Savos 1824290631Savos uvp->bcn_mbuf = m; 1825290631Savos 1826290631Savos if ((error = urtwn_tx_beacon(sc, uvp)) != 0) 1827290631Savos return (error); 1828290631Savos 1829290631Savos /* XXX bcnq stuck workaround */ 1830290631Savos if ((error = urtwn_tx_beacon(sc, uvp)) != 0) 1831290631Savos return (error); 1832290631Savos 1833290631Savos return (0); 1834290631Savos} 1835290631Savos 1836251538Srpaulostatic void 1837290631Savosurtwn_update_beacon(struct ieee80211vap *vap, int item) 1838290631Savos{ 1839290631Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 1840290631Savos struct urtwn_vap *uvp = URTWN_VAP(vap); 1841290631Savos struct ieee80211_beacon_offsets *bo = &vap->iv_bcn_off; 1842290631Savos struct ieee80211_node *ni = vap->iv_bss; 1843290631Savos int mcast = 0; 1844290631Savos 1845290631Savos URTWN_LOCK(sc); 1846290631Savos if (uvp->bcn_mbuf == NULL) { 1847290631Savos uvp->bcn_mbuf = ieee80211_beacon_alloc(ni); 1848290631Savos if (uvp->bcn_mbuf == NULL) { 1849290631Savos device_printf(sc->sc_dev, 1850290631Savos "%s: could not allocate beacon frame\n", __func__); 1851290631Savos URTWN_UNLOCK(sc); 1852290631Savos return; 1853290631Savos } 1854290631Savos } 1855290631Savos URTWN_UNLOCK(sc); 1856290631Savos 1857290631Savos if (item == IEEE80211_BEACON_TIM) 1858290631Savos mcast = 1; /* XXX */ 1859290631Savos 1860290631Savos setbit(bo->bo_flags, item); 1861290631Savos ieee80211_beacon_update(ni, uvp->bcn_mbuf, mcast); 1862290631Savos 1863290631Savos URTWN_LOCK(sc); 1864290631Savos urtwn_tx_beacon(sc, uvp); 1865290631Savos URTWN_UNLOCK(sc); 1866290631Savos} 1867290631Savos 1868290631Savos/* 1869290631Savos * Push a beacon frame into the chip. Beacon will 1870290631Savos * be repeated by the chip every R92C_BCN_INTERVAL. 1871290631Savos */ 1872290631Savosstatic int 1873290631Savosurtwn_tx_beacon(struct urtwn_softc *sc, struct urtwn_vap *uvp) 1874290631Savos{ 1875290631Savos struct r92c_tx_desc *desc = &uvp->bcn_desc; 1876290631Savos struct urtwn_data *bf; 1877290631Savos 1878290631Savos URTWN_ASSERT_LOCKED(sc); 1879290631Savos 1880290631Savos bf = urtwn_getbuf(sc); 1881290631Savos if (bf == NULL) 1882290631Savos return (ENOMEM); 1883290631Savos 1884290631Savos memcpy(bf->buf, desc, sizeof(*desc)); 1885290631Savos urtwn_tx_start(sc, uvp->bcn_mbuf, IEEE80211_FC0_TYPE_MGT, bf); 1886290631Savos 1887290631Savos sc->sc_txtimer = 5; 1888290631Savos callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 1889290631Savos 1890290631Savos return (0); 1891290631Savos} 1892290631Savos 1893292175Savosstatic int 1894292175Savosurtwn_key_alloc(struct ieee80211vap *vap, struct ieee80211_key *k, 1895292175Savos ieee80211_keyix *keyix, ieee80211_keyix *rxkeyix) 1896292175Savos{ 1897292175Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 1898292175Savos uint8_t i; 1899292175Savos 1900292175Savos if (!(&vap->iv_nw_keys[0] <= k && 1901292175Savos k < &vap->iv_nw_keys[IEEE80211_WEP_NKID])) { 1902292175Savos if (!(k->wk_flags & IEEE80211_KEY_SWCRYPT)) { 1903292175Savos URTWN_LOCK(sc); 1904292175Savos /* 1905292175Savos * First 4 slots for group keys, 1906292175Savos * what is left - for pairwise. 1907292175Savos * XXX incompatible with IBSS RSN. 1908292175Savos */ 1909292175Savos for (i = IEEE80211_WEP_NKID; 1910292175Savos i < R92C_CAM_ENTRY_COUNT; i++) { 1911292175Savos if ((sc->keys_bmap & (1 << i)) == 0) { 1912292175Savos sc->keys_bmap |= 1 << i; 1913292175Savos *keyix = i; 1914292175Savos break; 1915292175Savos } 1916292175Savos } 1917292175Savos URTWN_UNLOCK(sc); 1918292175Savos if (i == R92C_CAM_ENTRY_COUNT) { 1919292175Savos device_printf(sc->sc_dev, 1920292175Savos "%s: no free space in the key table\n", 1921292175Savos __func__); 1922292175Savos return 0; 1923292175Savos } 1924292175Savos } else 1925292175Savos *keyix = 0; 1926292175Savos } else { 1927292175Savos *keyix = k - vap->iv_nw_keys; 1928292175Savos } 1929292175Savos *rxkeyix = *keyix; 1930292175Savos return 1; 1931292175Savos} 1932292175Savos 1933290631Savosstatic void 1934292175Savosurtwn_key_set_cb(struct urtwn_softc *sc, union sec_param *data) 1935292175Savos{ 1936292175Savos struct ieee80211_key *k = &data->key; 1937292175Savos uint8_t algo, keyid; 1938292175Savos int i, error; 1939292175Savos 1940292175Savos if (k->wk_keyix < IEEE80211_WEP_NKID) 1941292175Savos keyid = k->wk_keyix; 1942292175Savos else 1943292175Savos keyid = 0; 1944292175Savos 1945292175Savos /* Map net80211 cipher to HW crypto algorithm. */ 1946292175Savos switch (k->wk_cipher->ic_cipher) { 1947292175Savos case IEEE80211_CIPHER_WEP: 1948292175Savos if (k->wk_keylen < 8) 1949292175Savos algo = R92C_CAM_ALGO_WEP40; 1950292175Savos else 1951292175Savos algo = R92C_CAM_ALGO_WEP104; 1952292175Savos break; 1953292175Savos case IEEE80211_CIPHER_TKIP: 1954292175Savos algo = R92C_CAM_ALGO_TKIP; 1955292175Savos break; 1956292175Savos case IEEE80211_CIPHER_AES_CCM: 1957292175Savos algo = R92C_CAM_ALGO_AES; 1958292175Savos break; 1959292175Savos default: 1960292175Savos device_printf(sc->sc_dev, "%s: undefined cipher %d\n", 1961292175Savos __func__, k->wk_cipher->ic_cipher); 1962292175Savos return; 1963292175Savos } 1964292175Savos 1965292175Savos DPRINTFN(9, "keyix %d, keyid %d, algo %d/%d, flags %04X, len %d, " 1966292175Savos "macaddr %s\n", k->wk_keyix, keyid, k->wk_cipher->ic_cipher, algo, 1967292175Savos k->wk_flags, k->wk_keylen, ether_sprintf(k->wk_macaddr)); 1968292175Savos 1969292175Savos /* Write key. */ 1970292175Savos for (i = 0; i < 4; i++) { 1971292175Savos error = urtwn_cam_write(sc, R92C_CAM_KEY(k->wk_keyix, i), 1972292175Savos LE_READ_4(&k->wk_key[i * 4])); 1973292175Savos if (error != 0) 1974292175Savos goto fail; 1975292175Savos } 1976292175Savos 1977292175Savos /* Write CTL0 last since that will validate the CAM entry. */ 1978292175Savos error = urtwn_cam_write(sc, R92C_CAM_CTL1(k->wk_keyix), 1979292175Savos LE_READ_4(&k->wk_macaddr[2])); 1980292175Savos if (error != 0) 1981292175Savos goto fail; 1982292175Savos error = urtwn_cam_write(sc, R92C_CAM_CTL0(k->wk_keyix), 1983292175Savos SM(R92C_CAM_ALGO, algo) | 1984292175Savos SM(R92C_CAM_KEYID, keyid) | 1985292175Savos SM(R92C_CAM_MACLO, LE_READ_2(&k->wk_macaddr[0])) | 1986292175Savos R92C_CAM_VALID); 1987292175Savos if (error != 0) 1988292175Savos goto fail; 1989292175Savos 1990292175Savos return; 1991292175Savos 1992292175Savosfail: 1993292175Savos device_printf(sc->sc_dev, "%s fails, error %d\n", __func__, error); 1994292175Savos} 1995292175Savos 1996292175Savosstatic void 1997292175Savosurtwn_key_del_cb(struct urtwn_softc *sc, union sec_param *data) 1998292175Savos{ 1999292175Savos struct ieee80211_key *k = &data->key; 2000292175Savos int i; 2001292175Savos 2002292175Savos DPRINTFN(9, "keyix %d, flags %04X, macaddr %s\n", 2003292175Savos k->wk_keyix, k->wk_flags, ether_sprintf(k->wk_macaddr)); 2004292175Savos 2005292175Savos urtwn_cam_write(sc, R92C_CAM_CTL0(k->wk_keyix), 0); 2006292175Savos urtwn_cam_write(sc, R92C_CAM_CTL1(k->wk_keyix), 0); 2007292175Savos 2008292175Savos /* Clear key. */ 2009292175Savos for (i = 0; i < 4; i++) 2010292175Savos urtwn_cam_write(sc, R92C_CAM_KEY(k->wk_keyix, i), 0); 2011292175Savos sc->keys_bmap &= ~(1 << k->wk_keyix); 2012292175Savos} 2013292175Savos 2014292175Savosstatic int 2015292175Savosurtwn_key_set(struct ieee80211vap *vap, const struct ieee80211_key *k) 2016292175Savos{ 2017292175Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2018292175Savos 2019292175Savos if (k->wk_flags & IEEE80211_KEY_SWCRYPT) { 2020292175Savos /* Not for us. */ 2021292175Savos return (1); 2022292175Savos } 2023292175Savos 2024292175Savos return (!urtwn_cmd_sleepable(sc, k, sizeof(*k), urtwn_key_set_cb)); 2025292175Savos} 2026292175Savos 2027292175Savosstatic int 2028292175Savosurtwn_key_delete(struct ieee80211vap *vap, const struct ieee80211_key *k) 2029292175Savos{ 2030292175Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2031292175Savos 2032292175Savos if (k->wk_flags & IEEE80211_KEY_SWCRYPT) { 2033292175Savos /* Not for us. */ 2034292175Savos return (1); 2035292175Savos } 2036292175Savos 2037292175Savos return (!urtwn_cmd_sleepable(sc, k, sizeof(*k), urtwn_key_del_cb)); 2038292175Savos} 2039292175Savos 2040292175Savosstatic void 2041290651Savosurtwn_tsf_task_adhoc(void *arg, int pending) 2042290651Savos{ 2043290651Savos struct ieee80211vap *vap = arg; 2044290651Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2045290651Savos struct ieee80211_node *ni; 2046290651Savos uint32_t reg; 2047290651Savos 2048290651Savos URTWN_LOCK(sc); 2049290651Savos ni = ieee80211_ref_node(vap->iv_bss); 2050290651Savos reg = urtwn_read_1(sc, R92C_BCN_CTRL); 2051290651Savos 2052290651Savos /* Accept beacons with the same BSSID. */ 2053290651Savos urtwn_set_rx_bssid_all(sc, 0); 2054290651Savos 2055290651Savos /* Enable synchronization. */ 2056290651Savos reg &= ~R92C_BCN_CTRL_DIS_TSF_UDT0; 2057290651Savos urtwn_write_1(sc, R92C_BCN_CTRL, reg); 2058290651Savos 2059290651Savos /* Synchronize. */ 2060290651Savos usb_pause_mtx(&sc->sc_mtx, hz * ni->ni_intval * 5 / 1000); 2061290651Savos 2062290651Savos /* Disable synchronization. */ 2063290651Savos reg |= R92C_BCN_CTRL_DIS_TSF_UDT0; 2064290651Savos urtwn_write_1(sc, R92C_BCN_CTRL, reg); 2065290651Savos 2066290651Savos /* Remove beacon filter. */ 2067290651Savos urtwn_set_rx_bssid_all(sc, 1); 2068290651Savos 2069290651Savos /* Enable beaconing. */ 2070290651Savos urtwn_write_1(sc, R92C_MBID_NUM, 2071290651Savos urtwn_read_1(sc, R92C_MBID_NUM) | R92C_MBID_TXBCN_RPT0); 2072290651Savos reg |= R92C_BCN_CTRL_EN_BCN; 2073290651Savos 2074290651Savos urtwn_write_1(sc, R92C_BCN_CTRL, reg); 2075290651Savos ieee80211_free_node(ni); 2076290651Savos URTWN_UNLOCK(sc); 2077290651Savos} 2078290651Savos 2079290651Savosstatic void 2080290631Savosurtwn_tsf_sync_enable(struct urtwn_softc *sc, struct ieee80211vap *vap) 2081290631Savos{ 2082290651Savos struct ieee80211com *ic = &sc->sc_ic; 2083290651Savos struct urtwn_vap *uvp = URTWN_VAP(vap); 2084290651Savos 2085290631Savos /* Reset TSF. */ 2086290631Savos urtwn_write_1(sc, R92C_DUAL_TSF_RST, R92C_DUAL_TSF_RST0); 2087290631Savos 2088290631Savos switch (vap->iv_opmode) { 2089290631Savos case IEEE80211_M_STA: 2090290631Savos /* Enable TSF synchronization. */ 2091290631Savos urtwn_write_1(sc, R92C_BCN_CTRL, 2092290631Savos urtwn_read_1(sc, R92C_BCN_CTRL) & 2093290631Savos ~R92C_BCN_CTRL_DIS_TSF_UDT0); 2094290631Savos break; 2095290651Savos case IEEE80211_M_IBSS: 2096290651Savos ieee80211_runtask(ic, &uvp->tsf_task_adhoc); 2097290651Savos break; 2098290631Savos case IEEE80211_M_HOSTAP: 2099290631Savos /* Enable beaconing. */ 2100290631Savos urtwn_write_1(sc, R92C_MBID_NUM, 2101290631Savos urtwn_read_1(sc, R92C_MBID_NUM) | R92C_MBID_TXBCN_RPT0); 2102290631Savos urtwn_write_1(sc, R92C_BCN_CTRL, 2103290631Savos urtwn_read_1(sc, R92C_BCN_CTRL) | R92C_BCN_CTRL_EN_BCN); 2104290631Savos break; 2105290631Savos default: 2106290631Savos device_printf(sc->sc_dev, "undefined opmode %d\n", 2107290631Savos vap->iv_opmode); 2108290631Savos return; 2109290631Savos } 2110290631Savos} 2111290631Savos 2112290631Savosstatic void 2113251538Srpaulourtwn_set_led(struct urtwn_softc *sc, int led, int on) 2114251538Srpaulo{ 2115251538Srpaulo uint8_t reg; 2116281069Srpaulo 2117251538Srpaulo if (led == URTWN_LED_LINK) { 2118264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 2119264912Skevlo reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0xf0; 2120264912Skevlo urtwn_write_1(sc, R92C_LEDCFG2, reg | 0x60); 2121264912Skevlo if (!on) { 2122264912Skevlo reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0x90; 2123264912Skevlo urtwn_write_1(sc, R92C_LEDCFG2, 2124264912Skevlo reg | R92C_LEDCFG0_DIS); 2125264912Skevlo urtwn_write_1(sc, R92C_MAC_PINMUX_CFG, 2126264912Skevlo urtwn_read_1(sc, R92C_MAC_PINMUX_CFG) & 2127264912Skevlo 0xfe); 2128264912Skevlo } 2129264912Skevlo } else { 2130264912Skevlo reg = urtwn_read_1(sc, R92C_LEDCFG0) & 0x70; 2131264912Skevlo if (!on) 2132264912Skevlo reg |= R92C_LEDCFG0_DIS; 2133264912Skevlo urtwn_write_1(sc, R92C_LEDCFG0, reg); 2134264912Skevlo } 2135264912Skevlo sc->ledlink = on; /* Save LED state. */ 2136251538Srpaulo } 2137251538Srpaulo} 2138251538Srpaulo 2139289811Savosstatic void 2140289811Savosurtwn_set_mode(struct urtwn_softc *sc, uint8_t mode) 2141289811Savos{ 2142289811Savos uint8_t reg; 2143289811Savos 2144289811Savos reg = urtwn_read_1(sc, R92C_MSR); 2145289811Savos reg = (reg & ~R92C_MSR_MASK) | mode; 2146289811Savos urtwn_write_1(sc, R92C_MSR, reg); 2147289811Savos} 2148289811Savos 2149290651Savosstatic void 2150290651Savosurtwn_ibss_recv_mgmt(struct ieee80211_node *ni, struct mbuf *m, int subtype, 2151290651Savos const struct ieee80211_rx_stats *rxs, 2152290651Savos int rssi, int nf) 2153290651Savos{ 2154290651Savos struct ieee80211vap *vap = ni->ni_vap; 2155290651Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2156290651Savos struct urtwn_vap *uvp = URTWN_VAP(vap); 2157290651Savos uint64_t ni_tstamp, curr_tstamp; 2158290651Savos 2159290651Savos uvp->recv_mgmt(ni, m, subtype, rxs, rssi, nf); 2160290651Savos 2161290651Savos if (vap->iv_state == IEEE80211_S_RUN && 2162290651Savos (subtype == IEEE80211_FC0_SUBTYPE_BEACON || 2163290651Savos subtype == IEEE80211_FC0_SUBTYPE_PROBE_RESP)) { 2164290651Savos ni_tstamp = le64toh(ni->ni_tstamp.tsf); 2165290651Savos#ifdef D3831 2166290651Savos URTWN_LOCK(sc); 2167290651Savos urtwn_get_tsf(sc, &curr_tstamp); 2168290651Savos URTWN_UNLOCK(sc); 2169290651Savos curr_tstamp = le64toh(curr_tstamp); 2170290651Savos 2171290651Savos if (ni_tstamp >= curr_tstamp) 2172290651Savos (void) ieee80211_ibss_merge(ni); 2173290651Savos#else 2174290651Savos (void) sc; 2175290651Savos (void) curr_tstamp; 2176290651Savos#endif 2177290651Savos } 2178290651Savos} 2179290651Savos 2180251538Srpaulostatic int 2181251538Srpaulourtwn_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 2182251538Srpaulo{ 2183251538Srpaulo struct urtwn_vap *uvp = URTWN_VAP(vap); 2184251538Srpaulo struct ieee80211com *ic = vap->iv_ic; 2185286949Sadrian struct urtwn_softc *sc = ic->ic_softc; 2186251538Srpaulo struct ieee80211_node *ni; 2187251538Srpaulo enum ieee80211_state ostate; 2188290631Savos uint32_t reg; 2189290631Savos uint8_t mode; 2190290631Savos int error = 0; 2191251538Srpaulo 2192251538Srpaulo ostate = vap->iv_state; 2193251538Srpaulo DPRINTF("%s -> %s\n", ieee80211_state_name[ostate], 2194251538Srpaulo ieee80211_state_name[nstate]); 2195251538Srpaulo 2196251538Srpaulo IEEE80211_UNLOCK(ic); 2197251538Srpaulo URTWN_LOCK(sc); 2198251538Srpaulo callout_stop(&sc->sc_watchdog_ch); 2199251538Srpaulo 2200251538Srpaulo if (ostate == IEEE80211_S_RUN) { 2201251538Srpaulo /* Turn link LED off. */ 2202251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 0); 2203251538Srpaulo 2204251538Srpaulo /* Set media status to 'No Link'. */ 2205289811Savos urtwn_set_mode(sc, R92C_MSR_NOLINK); 2206251538Srpaulo 2207251538Srpaulo /* Stop Rx of data frames. */ 2208251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP2, 0); 2209251538Srpaulo 2210251538Srpaulo /* Disable TSF synchronization. */ 2211251538Srpaulo urtwn_write_1(sc, R92C_BCN_CTRL, 2212290631Savos (urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_EN_BCN) | 2213251538Srpaulo R92C_BCN_CTRL_DIS_TSF_UDT0); 2214251538Srpaulo 2215290631Savos /* Disable beaconing. */ 2216290631Savos urtwn_write_1(sc, R92C_MBID_NUM, 2217290631Savos urtwn_read_1(sc, R92C_MBID_NUM) & ~R92C_MBID_TXBCN_RPT0); 2218290631Savos 2219290631Savos /* Reset TSF. */ 2220290631Savos urtwn_write_1(sc, R92C_DUAL_TSF_RST, R92C_DUAL_TSF_RST0); 2221290631Savos 2222251538Srpaulo /* Reset EDCA parameters. */ 2223251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002f3217); 2224251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005e4317); 2225251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x00105320); 2226251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a444); 2227251538Srpaulo } 2228251538Srpaulo 2229251538Srpaulo switch (nstate) { 2230251538Srpaulo case IEEE80211_S_INIT: 2231251538Srpaulo /* Turn link LED off. */ 2232251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 0); 2233251538Srpaulo break; 2234251538Srpaulo case IEEE80211_S_SCAN: 2235251538Srpaulo /* Pause AC Tx queues. */ 2236251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 2237251538Srpaulo urtwn_read_1(sc, R92C_TXPAUSE) | 0x0f); 2238251538Srpaulo break; 2239251538Srpaulo case IEEE80211_S_AUTH: 2240251538Srpaulo urtwn_set_chan(sc, ic->ic_curchan, NULL); 2241251538Srpaulo break; 2242251538Srpaulo case IEEE80211_S_RUN: 2243251538Srpaulo if (vap->iv_opmode == IEEE80211_M_MONITOR) { 2244251538Srpaulo /* Turn link LED on. */ 2245251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 1); 2246251538Srpaulo break; 2247251538Srpaulo } 2248251538Srpaulo 2249251538Srpaulo ni = ieee80211_ref_node(vap->iv_bss); 2250290631Savos 2251290631Savos if (ic->ic_bsschan == IEEE80211_CHAN_ANYC || 2252290631Savos ni->ni_chan == IEEE80211_CHAN_ANYC) { 2253290631Savos device_printf(sc->sc_dev, 2254290631Savos "%s: could not move to RUN state\n", __func__); 2255290631Savos error = EINVAL; 2256290631Savos goto end_run; 2257290631Savos } 2258290631Savos 2259290631Savos switch (vap->iv_opmode) { 2260290631Savos case IEEE80211_M_STA: 2261290631Savos mode = R92C_MSR_INFRA; 2262290631Savos break; 2263290651Savos case IEEE80211_M_IBSS: 2264290651Savos mode = R92C_MSR_ADHOC; 2265290651Savos break; 2266290631Savos case IEEE80211_M_HOSTAP: 2267290631Savos mode = R92C_MSR_AP; 2268290631Savos break; 2269290631Savos default: 2270290631Savos device_printf(sc->sc_dev, "undefined opmode %d\n", 2271290631Savos vap->iv_opmode); 2272290631Savos error = EINVAL; 2273290631Savos goto end_run; 2274290631Savos } 2275290631Savos 2276251538Srpaulo /* Set media status to 'Associated'. */ 2277290631Savos urtwn_set_mode(sc, mode); 2278251538Srpaulo 2279251538Srpaulo /* Set BSSID. */ 2280251538Srpaulo urtwn_write_4(sc, R92C_BSSID + 0, LE_READ_4(&ni->ni_bssid[0])); 2281251538Srpaulo urtwn_write_4(sc, R92C_BSSID + 4, LE_READ_2(&ni->ni_bssid[4])); 2282251538Srpaulo 2283251538Srpaulo if (ic->ic_curmode == IEEE80211_MODE_11B) 2284251538Srpaulo urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 0); 2285251538Srpaulo else /* 802.11b/g */ 2286251538Srpaulo urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 3); 2287251538Srpaulo 2288251538Srpaulo /* Enable Rx of data frames. */ 2289251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff); 2290251538Srpaulo 2291251538Srpaulo /* Flush all AC queues. */ 2292251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 0); 2293251538Srpaulo 2294251538Srpaulo /* Set beacon interval. */ 2295251538Srpaulo urtwn_write_2(sc, R92C_BCN_INTERVAL, ni->ni_intval); 2296251538Srpaulo 2297251538Srpaulo /* Allow Rx from our BSSID only. */ 2298290564Savos if (ic->ic_promisc == 0) { 2299290631Savos reg = urtwn_read_4(sc, R92C_RCR); 2300290631Savos 2301290631Savos if (vap->iv_opmode != IEEE80211_M_HOSTAP) 2302290631Savos reg |= R92C_RCR_CBSSID_DATA; 2303290651Savos if (vap->iv_opmode != IEEE80211_M_IBSS) 2304290651Savos reg |= R92C_RCR_CBSSID_BCN; 2305290631Savos 2306290631Savos urtwn_write_4(sc, R92C_RCR, reg); 2307290564Savos } 2308251538Srpaulo 2309290651Savos if (vap->iv_opmode == IEEE80211_M_HOSTAP || 2310290651Savos vap->iv_opmode == IEEE80211_M_IBSS) { 2311290631Savos error = urtwn_setup_beacon(sc, ni); 2312290631Savos if (error != 0) { 2313290631Savos device_printf(sc->sc_dev, 2314290631Savos "unable to push beacon into the chip, " 2315290631Savos "error %d\n", error); 2316290631Savos goto end_run; 2317290631Savos } 2318290631Savos } 2319290631Savos 2320251538Srpaulo /* Enable TSF synchronization. */ 2321290631Savos urtwn_tsf_sync_enable(sc, vap); 2322251538Srpaulo 2323251538Srpaulo urtwn_write_1(sc, R92C_SIFS_CCK + 1, 10); 2324251538Srpaulo urtwn_write_1(sc, R92C_SIFS_OFDM + 1, 10); 2325251538Srpaulo urtwn_write_1(sc, R92C_SPEC_SIFS + 1, 10); 2326251538Srpaulo urtwn_write_1(sc, R92C_MAC_SPEC_SIFS + 1, 10); 2327251538Srpaulo urtwn_write_1(sc, R92C_R2T_SIFS + 1, 10); 2328251538Srpaulo urtwn_write_1(sc, R92C_T2T_SIFS + 1, 10); 2329251538Srpaulo 2330251538Srpaulo /* Intialize rate adaptation. */ 2331292167Savos if (!(sc->chip & URTWN_CHIP_88E)) 2332264912Skevlo urtwn_ra_init(sc); 2333251538Srpaulo /* Turn link LED on. */ 2334251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 1); 2335251538Srpaulo 2336251538Srpaulo sc->avg_pwdb = -1; /* Reset average RSSI. */ 2337251538Srpaulo /* Reset temperature calibration state machine. */ 2338251538Srpaulo sc->thcal_state = 0; 2339251538Srpaulo sc->thcal_lctemp = 0; 2340290631Savos 2341290631Savosend_run: 2342251538Srpaulo ieee80211_free_node(ni); 2343251538Srpaulo break; 2344251538Srpaulo default: 2345251538Srpaulo break; 2346251538Srpaulo } 2347290631Savos 2348251538Srpaulo URTWN_UNLOCK(sc); 2349251538Srpaulo IEEE80211_LOCK(ic); 2350290631Savos return (error != 0 ? error : uvp->newstate(vap, nstate, arg)); 2351251538Srpaulo} 2352251538Srpaulo 2353251538Srpaulostatic void 2354251538Srpaulourtwn_watchdog(void *arg) 2355251538Srpaulo{ 2356251538Srpaulo struct urtwn_softc *sc = arg; 2357251538Srpaulo 2358251538Srpaulo if (sc->sc_txtimer > 0) { 2359251538Srpaulo if (--sc->sc_txtimer == 0) { 2360251538Srpaulo device_printf(sc->sc_dev, "device timeout\n"); 2361287197Sglebius counter_u64_add(sc->sc_ic.ic_oerrors, 1); 2362251538Srpaulo return; 2363251538Srpaulo } 2364251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 2365251538Srpaulo } 2366251538Srpaulo} 2367251538Srpaulo 2368251538Srpaulostatic void 2369251538Srpaulourtwn_update_avgrssi(struct urtwn_softc *sc, int rate, int8_t rssi) 2370251538Srpaulo{ 2371251538Srpaulo int pwdb; 2372251538Srpaulo 2373251538Srpaulo /* Convert antenna signal to percentage. */ 2374251538Srpaulo if (rssi <= -100 || rssi >= 20) 2375251538Srpaulo pwdb = 0; 2376251538Srpaulo else if (rssi >= 0) 2377251538Srpaulo pwdb = 100; 2378251538Srpaulo else 2379251538Srpaulo pwdb = 100 + rssi; 2380264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 2381289758Savos if (rate <= URTWN_RIDX_CCK11) { 2382264912Skevlo /* CCK gain is smaller than OFDM/MCS gain. */ 2383264912Skevlo pwdb += 6; 2384264912Skevlo if (pwdb > 100) 2385264912Skevlo pwdb = 100; 2386264912Skevlo if (pwdb <= 14) 2387264912Skevlo pwdb -= 4; 2388264912Skevlo else if (pwdb <= 26) 2389264912Skevlo pwdb -= 8; 2390264912Skevlo else if (pwdb <= 34) 2391264912Skevlo pwdb -= 6; 2392264912Skevlo else if (pwdb <= 42) 2393264912Skevlo pwdb -= 2; 2394264912Skevlo } 2395251538Srpaulo } 2396251538Srpaulo if (sc->avg_pwdb == -1) /* Init. */ 2397251538Srpaulo sc->avg_pwdb = pwdb; 2398251538Srpaulo else if (sc->avg_pwdb < pwdb) 2399251538Srpaulo sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20) + 1; 2400251538Srpaulo else 2401251538Srpaulo sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20); 2402251538Srpaulo DPRINTFN(4, "PWDB=%d EMA=%d\n", pwdb, sc->avg_pwdb); 2403251538Srpaulo} 2404251538Srpaulo 2405251538Srpaulostatic int8_t 2406251538Srpaulourtwn_get_rssi(struct urtwn_softc *sc, int rate, void *physt) 2407251538Srpaulo{ 2408251538Srpaulo static const int8_t cckoff[] = { 16, -12, -26, -46 }; 2409251538Srpaulo struct r92c_rx_phystat *phy; 2410251538Srpaulo struct r92c_rx_cck *cck; 2411251538Srpaulo uint8_t rpt; 2412251538Srpaulo int8_t rssi; 2413251538Srpaulo 2414289758Savos if (rate <= URTWN_RIDX_CCK11) { 2415251538Srpaulo cck = (struct r92c_rx_cck *)physt; 2416251538Srpaulo if (sc->sc_flags & URTWN_FLAG_CCK_HIPWR) { 2417251538Srpaulo rpt = (cck->agc_rpt >> 5) & 0x3; 2418251538Srpaulo rssi = (cck->agc_rpt & 0x1f) << 1; 2419251538Srpaulo } else { 2420251538Srpaulo rpt = (cck->agc_rpt >> 6) & 0x3; 2421251538Srpaulo rssi = cck->agc_rpt & 0x3e; 2422251538Srpaulo } 2423251538Srpaulo rssi = cckoff[rpt] - rssi; 2424251538Srpaulo } else { /* OFDM/HT. */ 2425251538Srpaulo phy = (struct r92c_rx_phystat *)physt; 2426251538Srpaulo rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110; 2427251538Srpaulo } 2428251538Srpaulo return (rssi); 2429251538Srpaulo} 2430251538Srpaulo 2431264912Skevlostatic int8_t 2432264912Skevlourtwn_r88e_get_rssi(struct urtwn_softc *sc, int rate, void *physt) 2433264912Skevlo{ 2434264912Skevlo struct r92c_rx_phystat *phy; 2435264912Skevlo struct r88e_rx_cck *cck; 2436264912Skevlo uint8_t cck_agc_rpt, lna_idx, vga_idx; 2437264912Skevlo int8_t rssi; 2438264912Skevlo 2439264972Skevlo rssi = 0; 2440289758Savos if (rate <= URTWN_RIDX_CCK11) { 2441264912Skevlo cck = (struct r88e_rx_cck *)physt; 2442264912Skevlo cck_agc_rpt = cck->agc_rpt; 2443264912Skevlo lna_idx = (cck_agc_rpt & 0xe0) >> 5; 2444281069Srpaulo vga_idx = cck_agc_rpt & 0x1f; 2445264912Skevlo switch (lna_idx) { 2446264912Skevlo case 7: 2447264912Skevlo if (vga_idx <= 27) 2448264912Skevlo rssi = -100 + 2* (27 - vga_idx); 2449264912Skevlo else 2450264912Skevlo rssi = -100; 2451264912Skevlo break; 2452264912Skevlo case 6: 2453264912Skevlo rssi = -48 + 2 * (2 - vga_idx); 2454264912Skevlo break; 2455264912Skevlo case 5: 2456264912Skevlo rssi = -42 + 2 * (7 - vga_idx); 2457264912Skevlo break; 2458264912Skevlo case 4: 2459264912Skevlo rssi = -36 + 2 * (7 - vga_idx); 2460264912Skevlo break; 2461264912Skevlo case 3: 2462264912Skevlo rssi = -24 + 2 * (7 - vga_idx); 2463264912Skevlo break; 2464264912Skevlo case 2: 2465264912Skevlo rssi = -12 + 2 * (5 - vga_idx); 2466264912Skevlo break; 2467264912Skevlo case 1: 2468264912Skevlo rssi = 8 - (2 * vga_idx); 2469264912Skevlo break; 2470264912Skevlo case 0: 2471264912Skevlo rssi = 14 - (2 * vga_idx); 2472264912Skevlo break; 2473264912Skevlo } 2474264912Skevlo rssi += 6; 2475264912Skevlo } else { /* OFDM/HT. */ 2476264912Skevlo phy = (struct r92c_rx_phystat *)physt; 2477264912Skevlo rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110; 2478264912Skevlo } 2479264912Skevlo return (rssi); 2480264912Skevlo} 2481264912Skevlo 2482292167Savosstatic __inline uint8_t 2483292167Savosrate2ridx(uint8_t rate) 2484292167Savos{ 2485292167Savos switch (rate) { 2486292167Savos case 12: return 4; 2487292167Savos case 18: return 5; 2488292167Savos case 24: return 6; 2489292167Savos case 36: return 7; 2490292167Savos case 48: return 8; 2491292167Savos case 72: return 9; 2492292167Savos case 96: return 10; 2493292167Savos case 108: return 11; 2494292167Savos case 2: return 0; 2495292167Savos case 4: return 1; 2496292167Savos case 11: return 2; 2497292167Savos case 22: return 3; 2498292167Savos default: return 0; 2499292167Savos } 2500292167Savos} 2501292167Savos 2502251538Srpaulostatic int 2503290630Savosurtwn_tx_data(struct urtwn_softc *sc, struct ieee80211_node *ni, 2504290630Savos struct mbuf *m, struct urtwn_data *data) 2505251538Srpaulo{ 2506292167Savos const struct ieee80211_txparam *tp; 2507287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 2508251538Srpaulo struct ieee80211vap *vap = ni->ni_vap; 2509292167Savos struct ieee80211_key *k = NULL; 2510292167Savos struct ieee80211_channel *chan; 2511292167Savos struct ieee80211_frame *wh; 2512251538Srpaulo struct r92c_tx_desc *txd; 2513292167Savos uint8_t macid, raid, rate, ridx, subtype, type, tid, qsel; 2514292014Savos int hasqos, ismcast; 2515251538Srpaulo 2516251538Srpaulo URTWN_ASSERT_LOCKED(sc); 2517251538Srpaulo 2518251538Srpaulo /* 2519251538Srpaulo * Software crypto. 2520251538Srpaulo */ 2521290630Savos wh = mtod(m, struct ieee80211_frame *); 2522264912Skevlo type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK; 2523290630Savos subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK; 2524292014Savos hasqos = IEEE80211_QOS_HAS_SEQ(wh); 2525290630Savos ismcast = IEEE80211_IS_MULTICAST(wh->i_addr1); 2526264912Skevlo 2527292014Savos /* Select TX ring for this frame. */ 2528292014Savos if (hasqos) { 2529292014Savos tid = ((const struct ieee80211_qosframe *)wh)->i_qos[0]; 2530292014Savos tid &= IEEE80211_QOS_TID; 2531292014Savos } else 2532292014Savos tid = 0; 2533292014Savos 2534292167Savos chan = (ni->ni_chan != IEEE80211_CHAN_ANYC) ? 2535292167Savos ni->ni_chan : ic->ic_curchan; 2536292167Savos tp = &vap->iv_txparms[ieee80211_chan2mode(chan)]; 2537292167Savos 2538292167Savos /* Choose a TX rate index. */ 2539292167Savos if (type == IEEE80211_FC0_TYPE_MGT) 2540292167Savos rate = tp->mgmtrate; 2541292167Savos else if (ismcast) 2542292167Savos rate = tp->mcastrate; 2543292167Savos else if (tp->ucastrate != IEEE80211_FIXED_RATE_NONE) 2544292167Savos rate = tp->ucastrate; 2545292167Savos else if (m->m_flags & M_EAPOL) 2546292167Savos rate = tp->mgmtrate; 2547292167Savos else { 2548292167Savos if (URTWN_CHIP_HAS_RATECTL(sc)) { 2549292167Savos /* XXX pass pktlen */ 2550292167Savos (void) ieee80211_ratectl_rate(ni, NULL, 0); 2551292167Savos rate = ni->ni_txrate; 2552292167Savos } else { 2553292167Savos if (ic->ic_curmode != IEEE80211_MODE_11B) 2554292167Savos rate = 108; 2555292167Savos else 2556292167Savos rate = 22; 2557292167Savos } 2558292167Savos } 2559292167Savos 2560292167Savos ridx = rate2ridx(rate); 2561292167Savos if (ic->ic_curmode != IEEE80211_MODE_11B) 2562292167Savos raid = R92C_RAID_11BG; 2563292167Savos else 2564292167Savos raid = R92C_RAID_11B; 2565292167Savos 2566260444Skevlo if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 2567290630Savos k = ieee80211_crypto_encap(ni, m); 2568251538Srpaulo if (k == NULL) { 2569251538Srpaulo device_printf(sc->sc_dev, 2570251538Srpaulo "ieee80211_crypto_encap returns NULL.\n"); 2571251538Srpaulo return (ENOBUFS); 2572251538Srpaulo } 2573251538Srpaulo 2574251538Srpaulo /* in case packet header moved, reset pointer */ 2575290630Savos wh = mtod(m, struct ieee80211_frame *); 2576251538Srpaulo } 2577281069Srpaulo 2578251538Srpaulo /* Fill Tx descriptor. */ 2579251538Srpaulo txd = (struct r92c_tx_desc *)data->buf; 2580251538Srpaulo memset(txd, 0, sizeof(*txd)); 2581251538Srpaulo 2582251538Srpaulo txd->txdw0 |= htole32( 2583251538Srpaulo SM(R92C_TXDW0_OFFSET, sizeof(*txd)) | 2584251538Srpaulo R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG); 2585290630Savos if (ismcast) 2586251538Srpaulo txd->txdw0 |= htole32(R92C_TXDW0_BMCAST); 2587290630Savos 2588290630Savos if (!ismcast) { 2589292167Savos if (sc->chip & URTWN_CHIP_88E) { 2590292167Savos struct urtwn_node *un = URTWN_NODE(ni); 2591292167Savos macid = un->id; 2592292167Savos } else 2593292167Savos macid = URTWN_MACID_BSS; 2594290630Savos 2595290630Savos if (type == IEEE80211_FC0_TYPE_DATA) { 2596292014Savos qsel = tid % URTWN_MAX_TID; 2597290630Savos 2598292167Savos if (sc->chip & URTWN_CHIP_88E) { 2599292167Savos txd->txdw2 |= htole32( 2600292167Savos R88E_TXDW2_AGGBK | 2601292167Savos R88E_TXDW2_CCX_RPT); 2602292167Savos } else 2603290630Savos txd->txdw1 |= htole32(R92C_TXDW1_AGGBK); 2604290630Savos 2605290630Savos if (ic->ic_flags & IEEE80211_F_USEPROT) { 2606290630Savos switch (ic->ic_protmode) { 2607290630Savos case IEEE80211_PROT_CTSONLY: 2608290630Savos txd->txdw4 |= htole32( 2609290630Savos R92C_TXDW4_CTS2SELF | 2610290630Savos R92C_TXDW4_HWRTSEN); 2611290630Savos break; 2612290630Savos case IEEE80211_PROT_RTSCTS: 2613290630Savos txd->txdw4 |= htole32( 2614290630Savos R92C_TXDW4_RTSEN | 2615290630Savos R92C_TXDW4_HWRTSEN); 2616290630Savos break; 2617290630Savos default: 2618290630Savos break; 2619290630Savos } 2620290630Savos } 2621290630Savos txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE, 2622290630Savos URTWN_RIDX_OFDM24)); 2623290630Savos txd->txdw5 |= htole32(0x0001ff00); 2624290630Savos } else /* IEEE80211_FC0_TYPE_MGT */ 2625290630Savos qsel = R92C_TXDW1_QSEL_MGNT; 2626251538Srpaulo } else { 2627290630Savos macid = URTWN_MACID_BC; 2628290630Savos qsel = R92C_TXDW1_QSEL_MGNT; 2629290630Savos } 2630251538Srpaulo 2631290630Savos txd->txdw1 |= htole32( 2632290630Savos SM(R92C_TXDW1_QSEL, qsel) | 2633290630Savos SM(R92C_TXDW1_RAID, raid)); 2634290630Savos 2635290630Savos if (sc->chip & URTWN_CHIP_88E) 2636290630Savos txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, macid)); 2637290630Savos else 2638290630Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, macid)); 2639290630Savos 2640290630Savos txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, ridx)); 2641291858Savos /* Force this rate if needed. */ 2642292167Savos if (URTWN_CHIP_HAS_RATECTL(sc) || ismcast || 2643292167Savos (m->m_flags & M_EAPOL) || type != IEEE80211_FC0_TYPE_DATA) 2644251538Srpaulo txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE); 2645251538Srpaulo 2646292014Savos if (!hasqos) { 2647251538Srpaulo /* Use HW sequence numbering for non-QoS frames. */ 2648291858Savos if (sc->chip & URTWN_CHIP_88E) 2649291858Savos txd->txdseq = htole16(R88E_TXDSEQ_HWSEQ_EN); 2650291858Savos else 2651291858Savos txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN); 2652290630Savos } else { 2653290630Savos /* Set sequence number. */ 2654290630Savos txd->txdseq = htole16(M_SEQNO_GET(m) % IEEE80211_SEQ_RANGE); 2655290630Savos } 2656251538Srpaulo 2657292175Savos if (k != NULL && !(k->wk_flags & IEEE80211_KEY_SWCRYPT)) { 2658292175Savos uint8_t cipher; 2659292175Savos 2660292175Savos switch (k->wk_cipher->ic_cipher) { 2661292175Savos case IEEE80211_CIPHER_WEP: 2662292175Savos case IEEE80211_CIPHER_TKIP: 2663292175Savos cipher = R92C_TXDW1_CIPHER_RC4; 2664292175Savos break; 2665292175Savos case IEEE80211_CIPHER_AES_CCM: 2666292175Savos cipher = R92C_TXDW1_CIPHER_AES; 2667292175Savos break; 2668292175Savos default: 2669292175Savos device_printf(sc->sc_dev, "%s: unknown cipher %d\n", 2670292175Savos __func__, k->wk_cipher->ic_cipher); 2671292175Savos return (EINVAL); 2672292175Savos } 2673292175Savos 2674292175Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_CIPHER, cipher)); 2675292175Savos } 2676292175Savos 2677251538Srpaulo if (ieee80211_radiotap_active_vap(vap)) { 2678251538Srpaulo struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap; 2679251538Srpaulo 2680251538Srpaulo tap->wt_flags = 0; 2681290630Savos if (k != NULL) 2682290630Savos tap->wt_flags |= IEEE80211_RADIOTAP_F_WEP; 2683290630Savos ieee80211_radiotap_tx(vap, m); 2684251538Srpaulo } 2685251538Srpaulo 2686290630Savos data->ni = ni; 2687251538Srpaulo 2688290630Savos urtwn_tx_start(sc, m, type, data); 2689290630Savos 2690290630Savos return (0); 2691290630Savos} 2692290630Savos 2693290630Savosstatic void 2694290630Savosurtwn_tx_start(struct urtwn_softc *sc, struct mbuf *m, uint8_t type, 2695290630Savos struct urtwn_data *data) 2696290630Savos{ 2697290630Savos struct usb_xfer *xfer; 2698290630Savos struct r92c_tx_desc *txd; 2699290630Savos uint16_t ac, sum; 2700290630Savos int i, xferlen; 2701290630Savos 2702290630Savos URTWN_ASSERT_LOCKED(sc); 2703290630Savos 2704290630Savos ac = M_WME_GETAC(m); 2705290630Savos 2706290630Savos switch (type) { 2707290630Savos case IEEE80211_FC0_TYPE_CTL: 2708290630Savos case IEEE80211_FC0_TYPE_MGT: 2709290630Savos xfer = sc->sc_xfer[URTWN_BULK_TX_VO]; 2710290630Savos break; 2711290630Savos default: 2712292014Savos xfer = sc->sc_xfer[wme2queue[ac].qid]; 2713290630Savos break; 2714290630Savos } 2715290630Savos 2716290630Savos txd = (struct r92c_tx_desc *)data->buf; 2717290630Savos txd->txdw0 |= htole32(SM(R92C_TXDW0_PKTLEN, m->m_pkthdr.len)); 2718290630Savos 2719290630Savos /* Compute Tx descriptor checksum. */ 2720290630Savos sum = 0; 2721290630Savos for (i = 0; i < sizeof(*txd) / 2; i++) 2722290630Savos sum ^= ((uint16_t *)txd)[i]; 2723290630Savos txd->txdsum = sum; /* NB: already little endian. */ 2724290630Savos 2725290630Savos xferlen = sizeof(*txd) + m->m_pkthdr.len; 2726290630Savos m_copydata(m, 0, m->m_pkthdr.len, (caddr_t)&txd[1]); 2727290630Savos 2728251538Srpaulo data->buflen = xferlen; 2729290630Savos data->m = m; 2730251538Srpaulo 2731251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next); 2732251538Srpaulo usbd_transfer_start(xfer); 2733251538Srpaulo} 2734251538Srpaulo 2735287197Sglebiusstatic int 2736287197Sglebiusurtwn_transmit(struct ieee80211com *ic, struct mbuf *m) 2737251538Srpaulo{ 2738287197Sglebius struct urtwn_softc *sc = ic->ic_softc; 2739287197Sglebius int error; 2740261863Srpaulo 2741261863Srpaulo URTWN_LOCK(sc); 2742287197Sglebius if ((sc->sc_flags & URTWN_RUNNING) == 0) { 2743287197Sglebius URTWN_UNLOCK(sc); 2744287197Sglebius return (ENXIO); 2745287197Sglebius } 2746287197Sglebius error = mbufq_enqueue(&sc->sc_snd, m); 2747287197Sglebius if (error) { 2748287197Sglebius URTWN_UNLOCK(sc); 2749287197Sglebius return (error); 2750287197Sglebius } 2751287197Sglebius urtwn_start(sc); 2752261863Srpaulo URTWN_UNLOCK(sc); 2753287197Sglebius 2754287197Sglebius return (0); 2755261863Srpaulo} 2756261863Srpaulo 2757261863Srpaulostatic void 2758287197Sglebiusurtwn_start(struct urtwn_softc *sc) 2759261863Srpaulo{ 2760251538Srpaulo struct ieee80211_node *ni; 2761251538Srpaulo struct mbuf *m; 2762251538Srpaulo struct urtwn_data *bf; 2763251538Srpaulo 2764261863Srpaulo URTWN_ASSERT_LOCKED(sc); 2765287197Sglebius while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) { 2766251538Srpaulo bf = urtwn_getbuf(sc); 2767251538Srpaulo if (bf == NULL) { 2768287197Sglebius mbufq_prepend(&sc->sc_snd, m); 2769251538Srpaulo break; 2770251538Srpaulo } 2771251538Srpaulo ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 2772251538Srpaulo m->m_pkthdr.rcvif = NULL; 2773290630Savos if (urtwn_tx_data(sc, ni, m, bf) != 0) { 2774287197Sglebius if_inc_counter(ni->ni_vap->iv_ifp, 2775287197Sglebius IFCOUNTER_OERRORS, 1); 2776251538Srpaulo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 2777288353Sadrian m_freem(m); 2778251538Srpaulo ieee80211_free_node(ni); 2779251538Srpaulo break; 2780251538Srpaulo } 2781251538Srpaulo sc->sc_txtimer = 5; 2782251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 2783251538Srpaulo } 2784251538Srpaulo} 2785251538Srpaulo 2786287197Sglebiusstatic void 2787287197Sglebiusurtwn_parent(struct ieee80211com *ic) 2788251538Srpaulo{ 2789286949Sadrian struct urtwn_softc *sc = ic->ic_softc; 2790251538Srpaulo 2791263153Skevlo URTWN_LOCK(sc); 2792287197Sglebius if (sc->sc_flags & URTWN_DETACHED) { 2793287197Sglebius URTWN_UNLOCK(sc); 2794287197Sglebius return; 2795287197Sglebius } 2796291698Savos URTWN_UNLOCK(sc); 2797291698Savos 2798287197Sglebius if (ic->ic_nrunning > 0) { 2799291698Savos if (urtwn_init(sc) != 0) { 2800291698Savos struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 2801291698Savos if (vap != NULL) 2802291698Savos ieee80211_stop(vap); 2803291698Savos } else 2804291698Savos ieee80211_start_all(ic); 2805291698Savos } else 2806287197Sglebius urtwn_stop(sc); 2807251538Srpaulo} 2808251538Srpaulo 2809264912Skevlostatic __inline int 2810251538Srpaulourtwn_power_on(struct urtwn_softc *sc) 2811251538Srpaulo{ 2812264912Skevlo 2813264912Skevlo return sc->sc_power_on(sc); 2814264912Skevlo} 2815264912Skevlo 2816264912Skevlostatic int 2817264912Skevlourtwn_r92c_power_on(struct urtwn_softc *sc) 2818264912Skevlo{ 2819251538Srpaulo uint32_t reg; 2820291698Savos usb_error_t error; 2821251538Srpaulo int ntries; 2822251538Srpaulo 2823251538Srpaulo /* Wait for autoload done bit. */ 2824251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 2825251538Srpaulo if (urtwn_read_1(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_PFM_ALDN) 2826251538Srpaulo break; 2827266472Shselasky urtwn_ms_delay(sc); 2828251538Srpaulo } 2829251538Srpaulo if (ntries == 1000) { 2830251538Srpaulo device_printf(sc->sc_dev, 2831251538Srpaulo "timeout waiting for chip autoload\n"); 2832251538Srpaulo return (ETIMEDOUT); 2833251538Srpaulo } 2834251538Srpaulo 2835251538Srpaulo /* Unlock ISO/CLK/Power control register. */ 2836291698Savos error = urtwn_write_1(sc, R92C_RSV_CTRL, 0); 2837291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2838291698Savos return (EIO); 2839251538Srpaulo /* Move SPS into PWM mode. */ 2840291698Savos error = urtwn_write_1(sc, R92C_SPS0_CTRL, 0x2b); 2841291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2842291698Savos return (EIO); 2843266472Shselasky urtwn_ms_delay(sc); 2844251538Srpaulo 2845251538Srpaulo reg = urtwn_read_1(sc, R92C_LDOV12D_CTRL); 2846251538Srpaulo if (!(reg & R92C_LDOV12D_CTRL_LDV12_EN)) { 2847291698Savos error = urtwn_write_1(sc, R92C_LDOV12D_CTRL, 2848251538Srpaulo reg | R92C_LDOV12D_CTRL_LDV12_EN); 2849291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2850291698Savos return (EIO); 2851266472Shselasky urtwn_ms_delay(sc); 2852291698Savos error = urtwn_write_1(sc, R92C_SYS_ISO_CTRL, 2853251538Srpaulo urtwn_read_1(sc, R92C_SYS_ISO_CTRL) & 2854251538Srpaulo ~R92C_SYS_ISO_CTRL_MD2PP); 2855291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2856291698Savos return (EIO); 2857251538Srpaulo } 2858251538Srpaulo 2859251538Srpaulo /* Auto enable WLAN. */ 2860291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 2861251538Srpaulo urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC); 2862291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2863291698Savos return (EIO); 2864251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 2865262822Skevlo if (!(urtwn_read_2(sc, R92C_APS_FSMCO) & 2866262822Skevlo R92C_APS_FSMCO_APFM_ONMAC)) 2867251538Srpaulo break; 2868266472Shselasky urtwn_ms_delay(sc); 2869251538Srpaulo } 2870251538Srpaulo if (ntries == 1000) { 2871251538Srpaulo device_printf(sc->sc_dev, 2872251538Srpaulo "timeout waiting for MAC auto ON\n"); 2873251538Srpaulo return (ETIMEDOUT); 2874251538Srpaulo } 2875251538Srpaulo 2876251538Srpaulo /* Enable radio, GPIO and LED functions. */ 2877291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 2878251538Srpaulo R92C_APS_FSMCO_AFSM_HSUS | 2879251538Srpaulo R92C_APS_FSMCO_PDN_EN | 2880251538Srpaulo R92C_APS_FSMCO_PFM_ALDN); 2881291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2882291698Savos return (EIO); 2883251538Srpaulo /* Release RF digital isolation. */ 2884291698Savos error = urtwn_write_2(sc, R92C_SYS_ISO_CTRL, 2885251538Srpaulo urtwn_read_2(sc, R92C_SYS_ISO_CTRL) & ~R92C_SYS_ISO_CTRL_DIOR); 2886291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2887291698Savos return (EIO); 2888251538Srpaulo 2889251538Srpaulo /* Initialize MAC. */ 2890291698Savos error = urtwn_write_1(sc, R92C_APSD_CTRL, 2891251538Srpaulo urtwn_read_1(sc, R92C_APSD_CTRL) & ~R92C_APSD_CTRL_OFF); 2892291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2893291698Savos return (EIO); 2894251538Srpaulo for (ntries = 0; ntries < 200; ntries++) { 2895251538Srpaulo if (!(urtwn_read_1(sc, R92C_APSD_CTRL) & 2896251538Srpaulo R92C_APSD_CTRL_OFF_STATUS)) 2897251538Srpaulo break; 2898266472Shselasky urtwn_ms_delay(sc); 2899251538Srpaulo } 2900251538Srpaulo if (ntries == 200) { 2901251538Srpaulo device_printf(sc->sc_dev, 2902251538Srpaulo "timeout waiting for MAC initialization\n"); 2903251538Srpaulo return (ETIMEDOUT); 2904251538Srpaulo } 2905251538Srpaulo 2906251538Srpaulo /* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */ 2907251538Srpaulo reg = urtwn_read_2(sc, R92C_CR); 2908251538Srpaulo reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN | 2909251538Srpaulo R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN | 2910251538Srpaulo R92C_CR_SCHEDULE_EN | R92C_CR_MACTXEN | R92C_CR_MACRXEN | 2911251538Srpaulo R92C_CR_ENSEC; 2912291698Savos error = urtwn_write_2(sc, R92C_CR, reg); 2913291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2914291698Savos return (EIO); 2915251538Srpaulo 2916291698Savos error = urtwn_write_1(sc, 0xfe10, 0x19); 2917291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2918291698Savos return (EIO); 2919251538Srpaulo return (0); 2920251538Srpaulo} 2921251538Srpaulo 2922251538Srpaulostatic int 2923264912Skevlourtwn_r88e_power_on(struct urtwn_softc *sc) 2924264912Skevlo{ 2925264912Skevlo uint32_t reg; 2926291698Savos usb_error_t error; 2927264912Skevlo int ntries; 2928264912Skevlo 2929264912Skevlo /* Wait for power ready bit. */ 2930264912Skevlo for (ntries = 0; ntries < 5000; ntries++) { 2931281918Skevlo if (urtwn_read_4(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_SUS_HOST) 2932264912Skevlo break; 2933266472Shselasky urtwn_ms_delay(sc); 2934264912Skevlo } 2935264912Skevlo if (ntries == 5000) { 2936264912Skevlo device_printf(sc->sc_dev, 2937264912Skevlo "timeout waiting for chip power up\n"); 2938264912Skevlo return (ETIMEDOUT); 2939264912Skevlo } 2940264912Skevlo 2941264912Skevlo /* Reset BB. */ 2942291698Savos error = urtwn_write_1(sc, R92C_SYS_FUNC_EN, 2943264912Skevlo urtwn_read_1(sc, R92C_SYS_FUNC_EN) & ~(R92C_SYS_FUNC_EN_BBRSTB | 2944264912Skevlo R92C_SYS_FUNC_EN_BB_GLB_RST)); 2945291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2946291698Savos return (EIO); 2947264912Skevlo 2948291698Savos error = urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 2, 2949281918Skevlo urtwn_read_1(sc, R92C_AFE_XTAL_CTRL + 2) | 0x80); 2950291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2951291698Savos return (EIO); 2952264912Skevlo 2953264912Skevlo /* Disable HWPDN. */ 2954291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 2955281918Skevlo urtwn_read_2(sc, R92C_APS_FSMCO) & ~R92C_APS_FSMCO_APDM_HPDN); 2956291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2957291698Savos return (EIO); 2958264912Skevlo 2959264912Skevlo /* Disable WL suspend. */ 2960291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 2961281918Skevlo urtwn_read_2(sc, R92C_APS_FSMCO) & 2962281918Skevlo ~(R92C_APS_FSMCO_AFSM_HSUS | R92C_APS_FSMCO_AFSM_PCIE)); 2963291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2964291698Savos return (EIO); 2965264912Skevlo 2966291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 2967281918Skevlo urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC); 2968291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2969291698Savos return (EIO); 2970264912Skevlo for (ntries = 0; ntries < 5000; ntries++) { 2971281918Skevlo if (!(urtwn_read_2(sc, R92C_APS_FSMCO) & 2972281918Skevlo R92C_APS_FSMCO_APFM_ONMAC)) 2973264912Skevlo break; 2974266472Shselasky urtwn_ms_delay(sc); 2975264912Skevlo } 2976264912Skevlo if (ntries == 5000) 2977264912Skevlo return (ETIMEDOUT); 2978264912Skevlo 2979264912Skevlo /* Enable LDO normal mode. */ 2980291698Savos error = urtwn_write_1(sc, R92C_LPLDO_CTRL, 2981281918Skevlo urtwn_read_1(sc, R92C_LPLDO_CTRL) & ~0x10); 2982291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2983291698Savos return (EIO); 2984264912Skevlo 2985264912Skevlo /* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */ 2986291698Savos error = urtwn_write_2(sc, R92C_CR, 0); 2987291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2988291698Savos return (EIO); 2989264912Skevlo reg = urtwn_read_2(sc, R92C_CR); 2990264912Skevlo reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN | 2991264912Skevlo R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN | 2992264912Skevlo R92C_CR_SCHEDULE_EN | R92C_CR_ENSEC | R92C_CR_CALTMR_EN; 2993291698Savos error = urtwn_write_2(sc, R92C_CR, reg); 2994291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 2995291698Savos return (EIO); 2996264912Skevlo 2997264912Skevlo return (0); 2998264912Skevlo} 2999264912Skevlo 3000264912Skevlostatic int 3001251538Srpaulourtwn_llt_init(struct urtwn_softc *sc) 3002251538Srpaulo{ 3003264912Skevlo int i, error, page_count, pktbuf_count; 3004251538Srpaulo 3005264912Skevlo page_count = (sc->chip & URTWN_CHIP_88E) ? 3006264912Skevlo R88E_TX_PAGE_COUNT : R92C_TX_PAGE_COUNT; 3007264912Skevlo pktbuf_count = (sc->chip & URTWN_CHIP_88E) ? 3008264912Skevlo R88E_TXPKTBUF_COUNT : R92C_TXPKTBUF_COUNT; 3009264912Skevlo 3010264912Skevlo /* Reserve pages [0; page_count]. */ 3011264912Skevlo for (i = 0; i < page_count; i++) { 3012251538Srpaulo if ((error = urtwn_llt_write(sc, i, i + 1)) != 0) 3013251538Srpaulo return (error); 3014251538Srpaulo } 3015251538Srpaulo /* NB: 0xff indicates end-of-list. */ 3016251538Srpaulo if ((error = urtwn_llt_write(sc, i, 0xff)) != 0) 3017251538Srpaulo return (error); 3018251538Srpaulo /* 3019264912Skevlo * Use pages [page_count + 1; pktbuf_count - 1] 3020251538Srpaulo * as ring buffer. 3021251538Srpaulo */ 3022264912Skevlo for (++i; i < pktbuf_count - 1; i++) { 3023251538Srpaulo if ((error = urtwn_llt_write(sc, i, i + 1)) != 0) 3024251538Srpaulo return (error); 3025251538Srpaulo } 3026251538Srpaulo /* Make the last page point to the beginning of the ring buffer. */ 3027264912Skevlo error = urtwn_llt_write(sc, i, page_count + 1); 3028251538Srpaulo return (error); 3029251538Srpaulo} 3030251538Srpaulo 3031251538Srpaulostatic void 3032251538Srpaulourtwn_fw_reset(struct urtwn_softc *sc) 3033251538Srpaulo{ 3034251538Srpaulo uint16_t reg; 3035251538Srpaulo int ntries; 3036251538Srpaulo 3037251538Srpaulo /* Tell 8051 to reset itself. */ 3038251538Srpaulo urtwn_write_1(sc, R92C_HMETFR + 3, 0x20); 3039251538Srpaulo 3040251538Srpaulo /* Wait until 8051 resets by itself. */ 3041251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 3042251538Srpaulo reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN); 3043251538Srpaulo if (!(reg & R92C_SYS_FUNC_EN_CPUEN)) 3044251538Srpaulo return; 3045266472Shselasky urtwn_ms_delay(sc); 3046251538Srpaulo } 3047251538Srpaulo /* Force 8051 reset. */ 3048251538Srpaulo urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN); 3049251538Srpaulo} 3050251538Srpaulo 3051264912Skevlostatic void 3052264912Skevlourtwn_r88e_fw_reset(struct urtwn_softc *sc) 3053264912Skevlo{ 3054264912Skevlo uint16_t reg; 3055264912Skevlo 3056264912Skevlo reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN); 3057264912Skevlo urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN); 3058264912Skevlo urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg | R92C_SYS_FUNC_EN_CPUEN); 3059264912Skevlo} 3060264912Skevlo 3061251538Srpaulostatic int 3062251538Srpaulourtwn_fw_loadpage(struct urtwn_softc *sc, int page, const uint8_t *buf, int len) 3063251538Srpaulo{ 3064251538Srpaulo uint32_t reg; 3065291698Savos usb_error_t error = USB_ERR_NORMAL_COMPLETION; 3066291698Savos int off, mlen; 3067251538Srpaulo 3068251538Srpaulo reg = urtwn_read_4(sc, R92C_MCUFWDL); 3069251538Srpaulo reg = RW(reg, R92C_MCUFWDL_PAGE, page); 3070251538Srpaulo urtwn_write_4(sc, R92C_MCUFWDL, reg); 3071251538Srpaulo 3072251538Srpaulo off = R92C_FW_START_ADDR; 3073251538Srpaulo while (len > 0) { 3074251538Srpaulo if (len > 196) 3075251538Srpaulo mlen = 196; 3076251538Srpaulo else if (len > 4) 3077251538Srpaulo mlen = 4; 3078251538Srpaulo else 3079251538Srpaulo mlen = 1; 3080251538Srpaulo /* XXX fix this deconst */ 3081281069Srpaulo error = urtwn_write_region_1(sc, off, 3082251538Srpaulo __DECONST(uint8_t *, buf), mlen); 3083291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3084251538Srpaulo break; 3085251538Srpaulo off += mlen; 3086251538Srpaulo buf += mlen; 3087251538Srpaulo len -= mlen; 3088251538Srpaulo } 3089251538Srpaulo return (error); 3090251538Srpaulo} 3091251538Srpaulo 3092251538Srpaulostatic int 3093251538Srpaulourtwn_load_firmware(struct urtwn_softc *sc) 3094251538Srpaulo{ 3095251538Srpaulo const struct firmware *fw; 3096251538Srpaulo const struct r92c_fw_hdr *hdr; 3097251538Srpaulo const char *imagename; 3098251538Srpaulo const u_char *ptr; 3099251538Srpaulo size_t len; 3100251538Srpaulo uint32_t reg; 3101251538Srpaulo int mlen, ntries, page, error; 3102251538Srpaulo 3103264864Skevlo URTWN_UNLOCK(sc); 3104251538Srpaulo /* Read firmware image from the filesystem. */ 3105264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3106264912Skevlo imagename = "urtwn-rtl8188eufw"; 3107264912Skevlo else if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) == 3108264912Skevlo URTWN_CHIP_UMC_A_CUT) 3109251538Srpaulo imagename = "urtwn-rtl8192cfwU"; 3110251538Srpaulo else 3111251538Srpaulo imagename = "urtwn-rtl8192cfwT"; 3112251538Srpaulo 3113251538Srpaulo fw = firmware_get(imagename); 3114264864Skevlo URTWN_LOCK(sc); 3115251538Srpaulo if (fw == NULL) { 3116251538Srpaulo device_printf(sc->sc_dev, 3117251538Srpaulo "failed loadfirmware of file %s\n", imagename); 3118251538Srpaulo return (ENOENT); 3119251538Srpaulo } 3120251538Srpaulo 3121251538Srpaulo len = fw->datasize; 3122251538Srpaulo 3123251538Srpaulo if (len < sizeof(*hdr)) { 3124251538Srpaulo device_printf(sc->sc_dev, "firmware too short\n"); 3125251538Srpaulo error = EINVAL; 3126251538Srpaulo goto fail; 3127251538Srpaulo } 3128251538Srpaulo ptr = fw->data; 3129251538Srpaulo hdr = (const struct r92c_fw_hdr *)ptr; 3130251538Srpaulo /* Check if there is a valid FW header and skip it. */ 3131251538Srpaulo if ((le16toh(hdr->signature) >> 4) == 0x88c || 3132264912Skevlo (le16toh(hdr->signature) >> 4) == 0x88e || 3133251538Srpaulo (le16toh(hdr->signature) >> 4) == 0x92c) { 3134251538Srpaulo DPRINTF("FW V%d.%d %02d-%02d %02d:%02d\n", 3135251538Srpaulo le16toh(hdr->version), le16toh(hdr->subversion), 3136251538Srpaulo hdr->month, hdr->date, hdr->hour, hdr->minute); 3137251538Srpaulo ptr += sizeof(*hdr); 3138251538Srpaulo len -= sizeof(*hdr); 3139251538Srpaulo } 3140251538Srpaulo 3141264912Skevlo if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RAM_DL_SEL) { 3142264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3143264912Skevlo urtwn_r88e_fw_reset(sc); 3144264912Skevlo else 3145264912Skevlo urtwn_fw_reset(sc); 3146251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 0); 3147251538Srpaulo } 3148264912Skevlo 3149268487Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 3150268487Skevlo urtwn_write_2(sc, R92C_SYS_FUNC_EN, 3151268487Skevlo urtwn_read_2(sc, R92C_SYS_FUNC_EN) | 3152268487Skevlo R92C_SYS_FUNC_EN_CPUEN); 3153268487Skevlo } 3154251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 3155251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_EN); 3156251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL + 2, 3157251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL + 2) & ~0x08); 3158251538Srpaulo 3159263154Skevlo /* Reset the FWDL checksum. */ 3160263154Skevlo urtwn_write_1(sc, R92C_MCUFWDL, 3161263154Skevlo urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_CHKSUM_RPT); 3162263154Skevlo 3163251538Srpaulo for (page = 0; len > 0; page++) { 3164251538Srpaulo mlen = min(len, R92C_FW_PAGE_SIZE); 3165251538Srpaulo error = urtwn_fw_loadpage(sc, page, ptr, mlen); 3166251538Srpaulo if (error != 0) { 3167251538Srpaulo device_printf(sc->sc_dev, 3168251538Srpaulo "could not load firmware page\n"); 3169251538Srpaulo goto fail; 3170251538Srpaulo } 3171251538Srpaulo ptr += mlen; 3172251538Srpaulo len -= mlen; 3173251538Srpaulo } 3174251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 3175251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL) & ~R92C_MCUFWDL_EN); 3176251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL + 1, 0); 3177251538Srpaulo 3178251538Srpaulo /* Wait for checksum report. */ 3179251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 3180251538Srpaulo if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_CHKSUM_RPT) 3181251538Srpaulo break; 3182266472Shselasky urtwn_ms_delay(sc); 3183251538Srpaulo } 3184251538Srpaulo if (ntries == 1000) { 3185251538Srpaulo device_printf(sc->sc_dev, 3186251538Srpaulo "timeout waiting for checksum report\n"); 3187251538Srpaulo error = ETIMEDOUT; 3188251538Srpaulo goto fail; 3189251538Srpaulo } 3190251538Srpaulo 3191251538Srpaulo reg = urtwn_read_4(sc, R92C_MCUFWDL); 3192251538Srpaulo reg = (reg & ~R92C_MCUFWDL_WINTINI_RDY) | R92C_MCUFWDL_RDY; 3193251538Srpaulo urtwn_write_4(sc, R92C_MCUFWDL, reg); 3194264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3195264912Skevlo urtwn_r88e_fw_reset(sc); 3196251538Srpaulo /* Wait for firmware readiness. */ 3197251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 3198251538Srpaulo if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_WINTINI_RDY) 3199251538Srpaulo break; 3200266472Shselasky urtwn_ms_delay(sc); 3201251538Srpaulo } 3202251538Srpaulo if (ntries == 1000) { 3203251538Srpaulo device_printf(sc->sc_dev, 3204251538Srpaulo "timeout waiting for firmware readiness\n"); 3205251538Srpaulo error = ETIMEDOUT; 3206251538Srpaulo goto fail; 3207251538Srpaulo } 3208251538Srpaulofail: 3209251538Srpaulo firmware_put(fw, FIRMWARE_UNLOAD); 3210251538Srpaulo return (error); 3211251538Srpaulo} 3212251538Srpaulo 3213291902Skevlostatic int 3214251538Srpaulourtwn_dma_init(struct urtwn_softc *sc) 3215251538Srpaulo{ 3216291902Skevlo struct usb_endpoint *ep, *ep_end; 3217291698Savos usb_error_t usb_err; 3218291902Skevlo uint32_t reg; 3219291902Skevlo int hashq, hasnq, haslq, nqueues, ntx; 3220291902Skevlo int error, pagecount, npubqpages, nqpages, nrempages, tx_boundary; 3221281069Srpaulo 3222291695Savos /* Initialize LLT table. */ 3223291695Savos error = urtwn_llt_init(sc); 3224291695Savos if (error != 0) 3225291695Savos return (error); 3226291695Savos 3227291902Skevlo /* Determine the number of bulk-out pipes. */ 3228291902Skevlo ntx = 0; 3229291902Skevlo ep = sc->sc_udev->endpoints; 3230291902Skevlo ep_end = sc->sc_udev->endpoints + sc->sc_udev->endpoints_max; 3231291902Skevlo for (; ep != ep_end; ep++) { 3232291902Skevlo if ((ep->edesc == NULL) || 3233291902Skevlo (ep->iface_index != sc->sc_iface_index)) 3234291902Skevlo continue; 3235291902Skevlo if (UE_GET_DIR(ep->edesc->bEndpointAddress) == UE_DIR_OUT) 3236291902Skevlo ntx++; 3237291902Skevlo } 3238291902Skevlo if (ntx == 0) { 3239291902Skevlo device_printf(sc->sc_dev, 3240291902Skevlo "%d: invalid number of Tx bulk pipes\n", ntx); 3241291698Savos return (EIO); 3242291902Skevlo } 3243291695Savos 3244251538Srpaulo /* Get Tx queues to USB endpoints mapping. */ 3245291902Skevlo hashq = hasnq = haslq = nqueues = 0; 3246291902Skevlo switch (ntx) { 3247291902Skevlo case 1: hashq = 1; break; 3248291902Skevlo case 2: hashq = hasnq = 1; break; 3249291902Skevlo case 3: case 4: hashq = hasnq = haslq = 1; break; 3250291902Skevlo } 3251251538Srpaulo nqueues = hashq + hasnq + haslq; 3252251538Srpaulo if (nqueues == 0) 3253251538Srpaulo return (EIO); 3254251538Srpaulo 3255291902Skevlo npubqpages = nqpages = nrempages = pagecount = 0; 3256291902Skevlo if (sc->chip & URTWN_CHIP_88E) 3257291902Skevlo tx_boundary = R88E_TX_PAGE_BOUNDARY; 3258291902Skevlo else { 3259291902Skevlo pagecount = R92C_TX_PAGE_COUNT; 3260291902Skevlo npubqpages = R92C_PUBQ_NPAGES; 3261291902Skevlo tx_boundary = R92C_TX_PAGE_BOUNDARY; 3262291902Skevlo } 3263291902Skevlo 3264251538Srpaulo /* Set number of pages for normal priority queue. */ 3265291902Skevlo if (sc->chip & URTWN_CHIP_88E) { 3266291902Skevlo usb_err = urtwn_write_2(sc, R92C_RQPN_NPQ, 0xd); 3267291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3268291902Skevlo return (EIO); 3269291902Skevlo usb_err = urtwn_write_4(sc, R92C_RQPN, 0x808e000d); 3270291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3271291902Skevlo return (EIO); 3272291902Skevlo } else { 3273291902Skevlo /* Get the number of pages for each queue. */ 3274291902Skevlo nqpages = (pagecount - npubqpages) / nqueues; 3275291902Skevlo /* 3276291902Skevlo * The remaining pages are assigned to the high priority 3277291902Skevlo * queue. 3278291902Skevlo */ 3279291902Skevlo nrempages = (pagecount - npubqpages) % nqueues; 3280291902Skevlo usb_err = urtwn_write_1(sc, R92C_RQPN_NPQ, hasnq ? nqpages : 0); 3281291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3282291902Skevlo return (EIO); 3283291902Skevlo usb_err = urtwn_write_4(sc, R92C_RQPN, 3284291902Skevlo /* Set number of pages for public queue. */ 3285291902Skevlo SM(R92C_RQPN_PUBQ, npubqpages) | 3286291902Skevlo /* Set number of pages for high priority queue. */ 3287291902Skevlo SM(R92C_RQPN_HPQ, hashq ? nqpages + nrempages : 0) | 3288291902Skevlo /* Set number of pages for low priority queue. */ 3289291902Skevlo SM(R92C_RQPN_LPQ, haslq ? nqpages : 0) | 3290291902Skevlo /* Load values. */ 3291291902Skevlo R92C_RQPN_LD); 3292291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3293291902Skevlo return (EIO); 3294291902Skevlo } 3295251538Srpaulo 3296291902Skevlo usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_BCNQ_BDNY, tx_boundary); 3297291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3298291698Savos return (EIO); 3299291902Skevlo usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_MGQ_BDNY, tx_boundary); 3300291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3301291698Savos return (EIO); 3302291902Skevlo usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_WMAC_LBK_BF_HD, tx_boundary); 3303291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3304291698Savos return (EIO); 3305291902Skevlo usb_err = urtwn_write_1(sc, R92C_TRXFF_BNDY, tx_boundary); 3306291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3307291698Savos return (EIO); 3308291902Skevlo usb_err = urtwn_write_1(sc, R92C_TDECTRL + 1, tx_boundary); 3309291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3310291698Savos return (EIO); 3311251538Srpaulo 3312251538Srpaulo /* Set queue to USB pipe mapping. */ 3313251538Srpaulo reg = urtwn_read_2(sc, R92C_TRXDMA_CTRL); 3314251538Srpaulo reg &= ~R92C_TRXDMA_CTRL_QMAP_M; 3315251538Srpaulo if (nqueues == 1) { 3316251538Srpaulo if (hashq) 3317251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_HQ; 3318251538Srpaulo else if (hasnq) 3319251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_NQ; 3320251538Srpaulo else 3321251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_LQ; 3322251538Srpaulo } else if (nqueues == 2) { 3323292056Skevlo /* 3324292056Skevlo * All 2-endpoints configs have high and normal 3325292056Skevlo * priority queues. 3326292056Skevlo */ 3327292056Skevlo reg |= R92C_TRXDMA_CTRL_QMAP_HQ_NQ; 3328251538Srpaulo } else 3329251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_3EP; 3330291902Skevlo usb_err = urtwn_write_2(sc, R92C_TRXDMA_CTRL, reg); 3331291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3332291698Savos return (EIO); 3333251538Srpaulo 3334251538Srpaulo /* Set Tx/Rx transfer page boundary. */ 3335291902Skevlo usb_err = urtwn_write_2(sc, R92C_TRXFF_BNDY + 2, 3336291902Skevlo (sc->chip & URTWN_CHIP_88E) ? 0x23ff : 0x27ff); 3337291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3338291698Savos return (EIO); 3339251538Srpaulo 3340291902Skevlo /* Set Tx/Rx transfer page size. */ 3341291902Skevlo usb_err = urtwn_write_1(sc, R92C_PBP, 3342291902Skevlo SM(R92C_PBP_PSRX, R92C_PBP_128) | 3343291902Skevlo SM(R92C_PBP_PSTX, R92C_PBP_128)); 3344291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3345264912Skevlo return (EIO); 3346264912Skevlo 3347264912Skevlo return (0); 3348264912Skevlo} 3349264912Skevlo 3350291698Savosstatic int 3351251538Srpaulourtwn_mac_init(struct urtwn_softc *sc) 3352251538Srpaulo{ 3353291698Savos usb_error_t error; 3354251538Srpaulo int i; 3355251538Srpaulo 3356251538Srpaulo /* Write MAC initialization values. */ 3357264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 3358264912Skevlo for (i = 0; i < nitems(rtl8188eu_mac); i++) { 3359291698Savos error = urtwn_write_1(sc, rtl8188eu_mac[i].reg, 3360264912Skevlo rtl8188eu_mac[i].val); 3361291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3362291698Savos return (EIO); 3363264912Skevlo } 3364264912Skevlo urtwn_write_1(sc, R92C_MAX_AGGR_NUM, 0x07); 3365264912Skevlo } else { 3366264912Skevlo for (i = 0; i < nitems(rtl8192cu_mac); i++) 3367291698Savos error = urtwn_write_1(sc, rtl8192cu_mac[i].reg, 3368264912Skevlo rtl8192cu_mac[i].val); 3369291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3370291698Savos return (EIO); 3371264912Skevlo } 3372291698Savos 3373291698Savos return (0); 3374251538Srpaulo} 3375251538Srpaulo 3376251538Srpaulostatic void 3377251538Srpaulourtwn_bb_init(struct urtwn_softc *sc) 3378251538Srpaulo{ 3379251538Srpaulo const struct urtwn_bb_prog *prog; 3380251538Srpaulo uint32_t reg; 3381264912Skevlo uint8_t crystalcap; 3382251538Srpaulo int i; 3383251538Srpaulo 3384251538Srpaulo /* Enable BB and RF. */ 3385251538Srpaulo urtwn_write_2(sc, R92C_SYS_FUNC_EN, 3386251538Srpaulo urtwn_read_2(sc, R92C_SYS_FUNC_EN) | 3387251538Srpaulo R92C_SYS_FUNC_EN_BBRSTB | R92C_SYS_FUNC_EN_BB_GLB_RST | 3388251538Srpaulo R92C_SYS_FUNC_EN_DIO_RF); 3389251538Srpaulo 3390264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) 3391264912Skevlo urtwn_write_2(sc, R92C_AFE_PLL_CTRL, 0xdb83); 3392251538Srpaulo 3393251538Srpaulo urtwn_write_1(sc, R92C_RF_CTRL, 3394251538Srpaulo R92C_RF_CTRL_EN | R92C_RF_CTRL_RSTB | R92C_RF_CTRL_SDMRSTB); 3395251538Srpaulo urtwn_write_1(sc, R92C_SYS_FUNC_EN, 3396251538Srpaulo R92C_SYS_FUNC_EN_USBA | R92C_SYS_FUNC_EN_USBD | 3397251538Srpaulo R92C_SYS_FUNC_EN_BB_GLB_RST | R92C_SYS_FUNC_EN_BBRSTB); 3398251538Srpaulo 3399264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 3400264912Skevlo urtwn_write_1(sc, R92C_LDOHCI12_CTRL, 0x0f); 3401264912Skevlo urtwn_write_1(sc, 0x15, 0xe9); 3402264912Skevlo urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 1, 0x80); 3403264912Skevlo } 3404251538Srpaulo 3405251538Srpaulo /* Select BB programming based on board type. */ 3406264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3407264912Skevlo prog = &rtl8188eu_bb_prog; 3408264912Skevlo else if (!(sc->chip & URTWN_CHIP_92C)) { 3409251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 3410251538Srpaulo prog = &rtl8188ce_bb_prog; 3411251538Srpaulo else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 3412251538Srpaulo prog = &rtl8188ru_bb_prog; 3413251538Srpaulo else 3414251538Srpaulo prog = &rtl8188cu_bb_prog; 3415251538Srpaulo } else { 3416251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 3417251538Srpaulo prog = &rtl8192ce_bb_prog; 3418251538Srpaulo else 3419251538Srpaulo prog = &rtl8192cu_bb_prog; 3420251538Srpaulo } 3421251538Srpaulo /* Write BB initialization values. */ 3422251538Srpaulo for (i = 0; i < prog->count; i++) { 3423251538Srpaulo urtwn_bb_write(sc, prog->regs[i], prog->vals[i]); 3424266472Shselasky urtwn_ms_delay(sc); 3425251538Srpaulo } 3426251538Srpaulo 3427251538Srpaulo if (sc->chip & URTWN_CHIP_92C_1T2R) { 3428251538Srpaulo /* 8192C 1T only configuration. */ 3429251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_TXINFO); 3430251538Srpaulo reg = (reg & ~0x00000003) | 0x2; 3431251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_TXINFO, reg); 3432251538Srpaulo 3433251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA1_TXINFO); 3434251538Srpaulo reg = (reg & ~0x00300033) | 0x00200022; 3435251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_TXINFO, reg); 3436251538Srpaulo 3437251538Srpaulo reg = urtwn_bb_read(sc, R92C_CCK0_AFESETTING); 3438251538Srpaulo reg = (reg & ~0xff000000) | 0x45 << 24; 3439251538Srpaulo urtwn_bb_write(sc, R92C_CCK0_AFESETTING, reg); 3440251538Srpaulo 3441251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_TRXPATHENA); 3442251538Srpaulo reg = (reg & ~0x000000ff) | 0x23; 3443251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_TRXPATHENA, reg); 3444251538Srpaulo 3445251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_AGCPARAM1); 3446251538Srpaulo reg = (reg & ~0x00000030) | 1 << 4; 3447251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCPARAM1, reg); 3448251538Srpaulo 3449251538Srpaulo reg = urtwn_bb_read(sc, 0xe74); 3450251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 3451251538Srpaulo urtwn_bb_write(sc, 0xe74, reg); 3452251538Srpaulo reg = urtwn_bb_read(sc, 0xe78); 3453251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 3454251538Srpaulo urtwn_bb_write(sc, 0xe78, reg); 3455251538Srpaulo reg = urtwn_bb_read(sc, 0xe7c); 3456251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 3457251538Srpaulo urtwn_bb_write(sc, 0xe7c, reg); 3458251538Srpaulo reg = urtwn_bb_read(sc, 0xe80); 3459251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 3460251538Srpaulo urtwn_bb_write(sc, 0xe80, reg); 3461251538Srpaulo reg = urtwn_bb_read(sc, 0xe88); 3462251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 3463251538Srpaulo urtwn_bb_write(sc, 0xe88, reg); 3464251538Srpaulo } 3465251538Srpaulo 3466251538Srpaulo /* Write AGC values. */ 3467251538Srpaulo for (i = 0; i < prog->agccount; i++) { 3468251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCRSSITABLE, 3469251538Srpaulo prog->agcvals[i]); 3470266472Shselasky urtwn_ms_delay(sc); 3471251538Srpaulo } 3472251538Srpaulo 3473264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 3474264912Skevlo urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553422); 3475266472Shselasky urtwn_ms_delay(sc); 3476264912Skevlo urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553420); 3477266472Shselasky urtwn_ms_delay(sc); 3478264912Skevlo 3479291264Savos crystalcap = sc->rom.r88e_rom[0xb9]; 3480264912Skevlo if (crystalcap == 0xff) 3481264912Skevlo crystalcap = 0x20; 3482264912Skevlo crystalcap &= 0x3f; 3483264912Skevlo reg = urtwn_bb_read(sc, R92C_AFE_XTAL_CTRL); 3484264912Skevlo urtwn_bb_write(sc, R92C_AFE_XTAL_CTRL, 3485264912Skevlo RW(reg, R92C_AFE_XTAL_CTRL_ADDR, 3486264912Skevlo crystalcap | crystalcap << 6)); 3487264912Skevlo } else { 3488264912Skevlo if (urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)) & 3489264912Skevlo R92C_HSSI_PARAM2_CCK_HIPWR) 3490264912Skevlo sc->sc_flags |= URTWN_FLAG_CCK_HIPWR; 3491264912Skevlo } 3492251538Srpaulo} 3493251538Srpaulo 3494289066Skevlostatic void 3495251538Srpaulourtwn_rf_init(struct urtwn_softc *sc) 3496251538Srpaulo{ 3497251538Srpaulo const struct urtwn_rf_prog *prog; 3498251538Srpaulo uint32_t reg, type; 3499251538Srpaulo int i, j, idx, off; 3500251538Srpaulo 3501251538Srpaulo /* Select RF programming based on board type. */ 3502264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3503264912Skevlo prog = rtl8188eu_rf_prog; 3504264912Skevlo else if (!(sc->chip & URTWN_CHIP_92C)) { 3505251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 3506251538Srpaulo prog = rtl8188ce_rf_prog; 3507251538Srpaulo else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 3508251538Srpaulo prog = rtl8188ru_rf_prog; 3509251538Srpaulo else 3510251538Srpaulo prog = rtl8188cu_rf_prog; 3511251538Srpaulo } else 3512251538Srpaulo prog = rtl8192ce_rf_prog; 3513251538Srpaulo 3514251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 3515251538Srpaulo /* Save RF_ENV control type. */ 3516251538Srpaulo idx = i / 2; 3517251538Srpaulo off = (i % 2) * 16; 3518251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx)); 3519251538Srpaulo type = (reg >> off) & 0x10; 3520251538Srpaulo 3521251538Srpaulo /* Set RF_ENV enable. */ 3522251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i)); 3523251538Srpaulo reg |= 0x100000; 3524251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg); 3525266472Shselasky urtwn_ms_delay(sc); 3526251538Srpaulo /* Set RF_ENV output high. */ 3527251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i)); 3528251538Srpaulo reg |= 0x10; 3529251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg); 3530266472Shselasky urtwn_ms_delay(sc); 3531251538Srpaulo /* Set address and data lengths of RF registers. */ 3532251538Srpaulo reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i)); 3533251538Srpaulo reg &= ~R92C_HSSI_PARAM2_ADDR_LENGTH; 3534251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg); 3535266472Shselasky urtwn_ms_delay(sc); 3536251538Srpaulo reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i)); 3537251538Srpaulo reg &= ~R92C_HSSI_PARAM2_DATA_LENGTH; 3538251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg); 3539266472Shselasky urtwn_ms_delay(sc); 3540251538Srpaulo 3541251538Srpaulo /* Write RF initialization values for this chain. */ 3542251538Srpaulo for (j = 0; j < prog[i].count; j++) { 3543251538Srpaulo if (prog[i].regs[j] >= 0xf9 && 3544251538Srpaulo prog[i].regs[j] <= 0xfe) { 3545251538Srpaulo /* 3546251538Srpaulo * These are fake RF registers offsets that 3547251538Srpaulo * indicate a delay is required. 3548251538Srpaulo */ 3549266472Shselasky usb_pause_mtx(&sc->sc_mtx, hz / 20); /* 50ms */ 3550251538Srpaulo continue; 3551251538Srpaulo } 3552251538Srpaulo urtwn_rf_write(sc, i, prog[i].regs[j], 3553251538Srpaulo prog[i].vals[j]); 3554266472Shselasky urtwn_ms_delay(sc); 3555251538Srpaulo } 3556251538Srpaulo 3557251538Srpaulo /* Restore RF_ENV control type. */ 3558251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx)); 3559251538Srpaulo reg &= ~(0x10 << off) | (type << off); 3560251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACESW(idx), reg); 3561251538Srpaulo 3562251538Srpaulo /* Cache RF register CHNLBW. */ 3563251538Srpaulo sc->rf_chnlbw[i] = urtwn_rf_read(sc, i, R92C_RF_CHNLBW); 3564251538Srpaulo } 3565251538Srpaulo 3566251538Srpaulo if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) == 3567251538Srpaulo URTWN_CHIP_UMC_A_CUT) { 3568251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_RX_G1, 0x30255); 3569251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_RX_G2, 0x50a00); 3570251538Srpaulo } 3571251538Srpaulo} 3572251538Srpaulo 3573251538Srpaulostatic void 3574251538Srpaulourtwn_cam_init(struct urtwn_softc *sc) 3575251538Srpaulo{ 3576251538Srpaulo /* Invalidate all CAM entries. */ 3577251538Srpaulo urtwn_write_4(sc, R92C_CAMCMD, 3578251538Srpaulo R92C_CAMCMD_POLLING | R92C_CAMCMD_CLR); 3579251538Srpaulo} 3580251538Srpaulo 3581292175Savosstatic int 3582292175Savosurtwn_cam_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data) 3583292175Savos{ 3584292175Savos usb_error_t error; 3585292175Savos 3586292175Savos error = urtwn_write_4(sc, R92C_CAMWRITE, data); 3587292175Savos if (error != USB_ERR_NORMAL_COMPLETION) 3588292175Savos return (EIO); 3589292175Savos error = urtwn_write_4(sc, R92C_CAMCMD, 3590292175Savos R92C_CAMCMD_POLLING | R92C_CAMCMD_WRITE | 3591292175Savos SM(R92C_CAMCMD_ADDR, addr)); 3592292175Savos if (error != USB_ERR_NORMAL_COMPLETION) 3593292175Savos return (EIO); 3594292175Savos 3595292175Savos return (0); 3596292175Savos} 3597292175Savos 3598251538Srpaulostatic void 3599251538Srpaulourtwn_pa_bias_init(struct urtwn_softc *sc) 3600251538Srpaulo{ 3601251538Srpaulo uint8_t reg; 3602251538Srpaulo int i; 3603251538Srpaulo 3604251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 3605251538Srpaulo if (sc->pa_setting & (1 << i)) 3606251538Srpaulo continue; 3607251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x0f406); 3608251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x4f406); 3609251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x8f406); 3610251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0xcf406); 3611251538Srpaulo } 3612251538Srpaulo if (!(sc->pa_setting & 0x10)) { 3613251538Srpaulo reg = urtwn_read_1(sc, 0x16); 3614251538Srpaulo reg = (reg & ~0xf0) | 0x90; 3615251538Srpaulo urtwn_write_1(sc, 0x16, reg); 3616251538Srpaulo } 3617251538Srpaulo} 3618251538Srpaulo 3619251538Srpaulostatic void 3620251538Srpaulourtwn_rxfilter_init(struct urtwn_softc *sc) 3621251538Srpaulo{ 3622290564Savos struct ieee80211com *ic = &sc->sc_ic; 3623290564Savos struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 3624290564Savos uint32_t rcr; 3625290564Savos uint16_t filter; 3626290564Savos 3627290564Savos URTWN_ASSERT_LOCKED(sc); 3628290564Savos 3629251538Srpaulo /* Accept all multicast frames. */ 3630251538Srpaulo urtwn_write_4(sc, R92C_MAR + 0, 0xffffffff); 3631251538Srpaulo urtwn_write_4(sc, R92C_MAR + 4, 0xffffffff); 3632290564Savos 3633290564Savos /* Filter for management frames. */ 3634290564Savos filter = 0x7f3f; 3635290631Savos switch (vap->iv_opmode) { 3636290631Savos case IEEE80211_M_STA: 3637290564Savos filter &= ~( 3638290564Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_ASSOC_REQ) | 3639290564Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_REASSOC_REQ) | 3640290564Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_PROBE_REQ)); 3641290631Savos break; 3642290631Savos case IEEE80211_M_HOSTAP: 3643290631Savos filter &= ~( 3644290631Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_ASSOC_RESP) | 3645290631Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_REASSOC_RESP) | 3646290631Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_BEACON)); 3647290631Savos break; 3648290631Savos case IEEE80211_M_MONITOR: 3649290651Savos case IEEE80211_M_IBSS: 3650290631Savos break; 3651290631Savos default: 3652290631Savos device_printf(sc->sc_dev, "%s: undefined opmode %d\n", 3653290631Savos __func__, vap->iv_opmode); 3654290631Savos break; 3655290564Savos } 3656290564Savos urtwn_write_2(sc, R92C_RXFLTMAP0, filter); 3657290564Savos 3658251538Srpaulo /* Reject all control frames. */ 3659251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP1, 0x0000); 3660290564Savos 3661290564Savos /* Reject all data frames. */ 3662290564Savos urtwn_write_2(sc, R92C_RXFLTMAP2, 0x0000); 3663290564Savos 3664290564Savos rcr = R92C_RCR_AM | R92C_RCR_AB | R92C_RCR_APM | 3665290564Savos R92C_RCR_HTC_LOC_CTRL | R92C_RCR_APP_PHYSTS | 3666290564Savos R92C_RCR_APP_ICV | R92C_RCR_APP_MIC; 3667290564Savos 3668290564Savos if (vap->iv_opmode == IEEE80211_M_MONITOR) { 3669290564Savos /* Accept all frames. */ 3670290564Savos rcr |= R92C_RCR_ACF | R92C_RCR_ADF | R92C_RCR_AMF | 3671290564Savos R92C_RCR_AAP; 3672290564Savos } 3673290564Savos 3674290564Savos /* Set Rx filter. */ 3675290564Savos urtwn_write_4(sc, R92C_RCR, rcr); 3676290564Savos 3677290564Savos if (ic->ic_promisc != 0) { 3678290564Savos /* Update Rx filter. */ 3679290564Savos urtwn_set_promisc(sc); 3680290564Savos } 3681251538Srpaulo} 3682251538Srpaulo 3683251538Srpaulostatic void 3684251538Srpaulourtwn_edca_init(struct urtwn_softc *sc) 3685251538Srpaulo{ 3686251538Srpaulo urtwn_write_2(sc, R92C_SPEC_SIFS, 0x100a); 3687251538Srpaulo urtwn_write_2(sc, R92C_MAC_SPEC_SIFS, 0x100a); 3688251538Srpaulo urtwn_write_2(sc, R92C_SIFS_CCK, 0x100a); 3689251538Srpaulo urtwn_write_2(sc, R92C_SIFS_OFDM, 0x100a); 3690251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x005ea42b); 3691251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a44f); 3692251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005ea324); 3693251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002fa226); 3694251538Srpaulo} 3695251538Srpaulo 3696289066Skevlostatic void 3697251538Srpaulourtwn_write_txpower(struct urtwn_softc *sc, int chain, 3698251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]) 3699251538Srpaulo{ 3700251538Srpaulo uint32_t reg; 3701251538Srpaulo 3702251538Srpaulo /* Write per-CCK rate Tx power. */ 3703251538Srpaulo if (chain == 0) { 3704251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_A_CCK1_MCS32); 3705251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK1, power[0]); 3706251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_A_CCK1_MCS32, reg); 3707251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11); 3708251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK2, power[1]); 3709251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK55, power[2]); 3710251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK11, power[3]); 3711251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg); 3712251538Srpaulo } else { 3713251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK1_55_MCS32); 3714251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK1, power[0]); 3715251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK2, power[1]); 3716251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK55, power[2]); 3717251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK1_55_MCS32, reg); 3718251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11); 3719251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK11, power[3]); 3720251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg); 3721251538Srpaulo } 3722251538Srpaulo /* Write per-OFDM rate Tx power. */ 3723251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_RATE18_06(chain), 3724251538Srpaulo SM(R92C_TXAGC_RATE06, power[ 4]) | 3725251538Srpaulo SM(R92C_TXAGC_RATE09, power[ 5]) | 3726251538Srpaulo SM(R92C_TXAGC_RATE12, power[ 6]) | 3727251538Srpaulo SM(R92C_TXAGC_RATE18, power[ 7])); 3728251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_RATE54_24(chain), 3729251538Srpaulo SM(R92C_TXAGC_RATE24, power[ 8]) | 3730251538Srpaulo SM(R92C_TXAGC_RATE36, power[ 9]) | 3731251538Srpaulo SM(R92C_TXAGC_RATE48, power[10]) | 3732251538Srpaulo SM(R92C_TXAGC_RATE54, power[11])); 3733251538Srpaulo /* Write per-MCS Tx power. */ 3734251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS03_MCS00(chain), 3735251538Srpaulo SM(R92C_TXAGC_MCS00, power[12]) | 3736251538Srpaulo SM(R92C_TXAGC_MCS01, power[13]) | 3737251538Srpaulo SM(R92C_TXAGC_MCS02, power[14]) | 3738251538Srpaulo SM(R92C_TXAGC_MCS03, power[15])); 3739251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS07_MCS04(chain), 3740251538Srpaulo SM(R92C_TXAGC_MCS04, power[16]) | 3741251538Srpaulo SM(R92C_TXAGC_MCS05, power[17]) | 3742251538Srpaulo SM(R92C_TXAGC_MCS06, power[18]) | 3743251538Srpaulo SM(R92C_TXAGC_MCS07, power[19])); 3744251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS11_MCS08(chain), 3745251538Srpaulo SM(R92C_TXAGC_MCS08, power[20]) | 3746261506Skevlo SM(R92C_TXAGC_MCS09, power[21]) | 3747251538Srpaulo SM(R92C_TXAGC_MCS10, power[22]) | 3748251538Srpaulo SM(R92C_TXAGC_MCS11, power[23])); 3749251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS15_MCS12(chain), 3750251538Srpaulo SM(R92C_TXAGC_MCS12, power[24]) | 3751251538Srpaulo SM(R92C_TXAGC_MCS13, power[25]) | 3752251538Srpaulo SM(R92C_TXAGC_MCS14, power[26]) | 3753251538Srpaulo SM(R92C_TXAGC_MCS15, power[27])); 3754251538Srpaulo} 3755251538Srpaulo 3756289066Skevlostatic void 3757251538Srpaulourtwn_get_txpower(struct urtwn_softc *sc, int chain, 3758251538Srpaulo struct ieee80211_channel *c, struct ieee80211_channel *extc, 3759251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]) 3760251538Srpaulo{ 3761287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 3762291264Savos struct r92c_rom *rom = &sc->rom.r92c_rom; 3763251538Srpaulo uint16_t cckpow, ofdmpow, htpow, diff, max; 3764251538Srpaulo const struct urtwn_txpwr *base; 3765251538Srpaulo int ridx, chan, group; 3766251538Srpaulo 3767251538Srpaulo /* Determine channel group. */ 3768251538Srpaulo chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */ 3769251538Srpaulo if (chan <= 3) 3770251538Srpaulo group = 0; 3771251538Srpaulo else if (chan <= 9) 3772251538Srpaulo group = 1; 3773251538Srpaulo else 3774251538Srpaulo group = 2; 3775251538Srpaulo 3776251538Srpaulo /* Get original Tx power based on board type and RF chain. */ 3777251538Srpaulo if (!(sc->chip & URTWN_CHIP_92C)) { 3778251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 3779251538Srpaulo base = &rtl8188ru_txagc[chain]; 3780251538Srpaulo else 3781251538Srpaulo base = &rtl8192cu_txagc[chain]; 3782251538Srpaulo } else 3783251538Srpaulo base = &rtl8192cu_txagc[chain]; 3784251538Srpaulo 3785251538Srpaulo memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0])); 3786251538Srpaulo if (sc->regulatory == 0) { 3787289758Savos for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) 3788251538Srpaulo power[ridx] = base->pwr[0][ridx]; 3789251538Srpaulo } 3790289758Savos for (ridx = URTWN_RIDX_OFDM6; ridx < URTWN_RIDX_COUNT; ridx++) { 3791251538Srpaulo if (sc->regulatory == 3) { 3792251538Srpaulo power[ridx] = base->pwr[0][ridx]; 3793251538Srpaulo /* Apply vendor limits. */ 3794251538Srpaulo if (extc != NULL) 3795251538Srpaulo max = rom->ht40_max_pwr[group]; 3796251538Srpaulo else 3797251538Srpaulo max = rom->ht20_max_pwr[group]; 3798251538Srpaulo max = (max >> (chain * 4)) & 0xf; 3799251538Srpaulo if (power[ridx] > max) 3800251538Srpaulo power[ridx] = max; 3801251538Srpaulo } else if (sc->regulatory == 1) { 3802251538Srpaulo if (extc == NULL) 3803251538Srpaulo power[ridx] = base->pwr[group][ridx]; 3804251538Srpaulo } else if (sc->regulatory != 2) 3805251538Srpaulo power[ridx] = base->pwr[0][ridx]; 3806251538Srpaulo } 3807251538Srpaulo 3808251538Srpaulo /* Compute per-CCK rate Tx power. */ 3809251538Srpaulo cckpow = rom->cck_tx_pwr[chain][group]; 3810289758Savos for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) { 3811251538Srpaulo power[ridx] += cckpow; 3812251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 3813251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 3814251538Srpaulo } 3815251538Srpaulo 3816251538Srpaulo htpow = rom->ht40_1s_tx_pwr[chain][group]; 3817251538Srpaulo if (sc->ntxchains > 1) { 3818251538Srpaulo /* Apply reduction for 2 spatial streams. */ 3819251538Srpaulo diff = rom->ht40_2s_tx_pwr_diff[group]; 3820251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 3821251538Srpaulo htpow = (htpow > diff) ? htpow - diff : 0; 3822251538Srpaulo } 3823251538Srpaulo 3824251538Srpaulo /* Compute per-OFDM rate Tx power. */ 3825251538Srpaulo diff = rom->ofdm_tx_pwr_diff[group]; 3826251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 3827251538Srpaulo ofdmpow = htpow + diff; /* HT->OFDM correction. */ 3828289758Savos for (ridx = URTWN_RIDX_OFDM6; ridx <= URTWN_RIDX_OFDM54; ridx++) { 3829251538Srpaulo power[ridx] += ofdmpow; 3830251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 3831251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 3832251538Srpaulo } 3833251538Srpaulo 3834251538Srpaulo /* Compute per-MCS Tx power. */ 3835251538Srpaulo if (extc == NULL) { 3836251538Srpaulo diff = rom->ht20_tx_pwr_diff[group]; 3837251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 3838251538Srpaulo htpow += diff; /* HT40->HT20 correction. */ 3839251538Srpaulo } 3840251538Srpaulo for (ridx = 12; ridx <= 27; ridx++) { 3841251538Srpaulo power[ridx] += htpow; 3842251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 3843251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 3844251538Srpaulo } 3845251538Srpaulo#ifdef URTWN_DEBUG 3846251538Srpaulo if (urtwn_debug >= 4) { 3847251538Srpaulo /* Dump per-rate Tx power values. */ 3848251538Srpaulo printf("Tx power for chain %d:\n", chain); 3849289758Savos for (ridx = URTWN_RIDX_CCK1; ridx < URTWN_RIDX_COUNT; ridx++) 3850251538Srpaulo printf("Rate %d = %u\n", ridx, power[ridx]); 3851251538Srpaulo } 3852251538Srpaulo#endif 3853251538Srpaulo} 3854251538Srpaulo 3855289066Skevlostatic void 3856264912Skevlourtwn_r88e_get_txpower(struct urtwn_softc *sc, int chain, 3857264912Skevlo struct ieee80211_channel *c, struct ieee80211_channel *extc, 3858264912Skevlo uint16_t power[URTWN_RIDX_COUNT]) 3859264912Skevlo{ 3860287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 3861264912Skevlo uint16_t cckpow, ofdmpow, bw20pow, htpow; 3862264912Skevlo const struct urtwn_r88e_txpwr *base; 3863264912Skevlo int ridx, chan, group; 3864264912Skevlo 3865264912Skevlo /* Determine channel group. */ 3866264912Skevlo chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */ 3867264912Skevlo if (chan <= 2) 3868264912Skevlo group = 0; 3869264912Skevlo else if (chan <= 5) 3870264912Skevlo group = 1; 3871264912Skevlo else if (chan <= 8) 3872264912Skevlo group = 2; 3873264912Skevlo else if (chan <= 11) 3874264912Skevlo group = 3; 3875264912Skevlo else if (chan <= 13) 3876264912Skevlo group = 4; 3877264912Skevlo else 3878264912Skevlo group = 5; 3879264912Skevlo 3880264912Skevlo /* Get original Tx power based on board type and RF chain. */ 3881264912Skevlo base = &rtl8188eu_txagc[chain]; 3882264912Skevlo 3883264912Skevlo memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0])); 3884264912Skevlo if (sc->regulatory == 0) { 3885289758Savos for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) 3886264912Skevlo power[ridx] = base->pwr[0][ridx]; 3887264912Skevlo } 3888289758Savos for (ridx = URTWN_RIDX_OFDM6; ridx < URTWN_RIDX_COUNT; ridx++) { 3889264912Skevlo if (sc->regulatory == 3) 3890264912Skevlo power[ridx] = base->pwr[0][ridx]; 3891264912Skevlo else if (sc->regulatory == 1) { 3892264912Skevlo if (extc == NULL) 3893264912Skevlo power[ridx] = base->pwr[group][ridx]; 3894264912Skevlo } else if (sc->regulatory != 2) 3895264912Skevlo power[ridx] = base->pwr[0][ridx]; 3896264912Skevlo } 3897264912Skevlo 3898264912Skevlo /* Compute per-CCK rate Tx power. */ 3899264912Skevlo cckpow = sc->cck_tx_pwr[group]; 3900289758Savos for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) { 3901264912Skevlo power[ridx] += cckpow; 3902264912Skevlo if (power[ridx] > R92C_MAX_TX_PWR) 3903264912Skevlo power[ridx] = R92C_MAX_TX_PWR; 3904264912Skevlo } 3905264912Skevlo 3906264912Skevlo htpow = sc->ht40_tx_pwr[group]; 3907264912Skevlo 3908264912Skevlo /* Compute per-OFDM rate Tx power. */ 3909264912Skevlo ofdmpow = htpow + sc->ofdm_tx_pwr_diff; 3910289758Savos for (ridx = URTWN_RIDX_OFDM6; ridx <= URTWN_RIDX_OFDM54; ridx++) { 3911264912Skevlo power[ridx] += ofdmpow; 3912264912Skevlo if (power[ridx] > R92C_MAX_TX_PWR) 3913264912Skevlo power[ridx] = R92C_MAX_TX_PWR; 3914264912Skevlo } 3915264912Skevlo 3916264912Skevlo bw20pow = htpow + sc->bw20_tx_pwr_diff; 3917264912Skevlo for (ridx = 12; ridx <= 27; ridx++) { 3918264912Skevlo power[ridx] += bw20pow; 3919264912Skevlo if (power[ridx] > R92C_MAX_TX_PWR) 3920264912Skevlo power[ridx] = R92C_MAX_TX_PWR; 3921264912Skevlo } 3922264912Skevlo} 3923264912Skevlo 3924289066Skevlostatic void 3925251538Srpaulourtwn_set_txpower(struct urtwn_softc *sc, struct ieee80211_channel *c, 3926251538Srpaulo struct ieee80211_channel *extc) 3927251538Srpaulo{ 3928251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]; 3929251538Srpaulo int i; 3930251538Srpaulo 3931251538Srpaulo for (i = 0; i < sc->ntxchains; i++) { 3932251538Srpaulo /* Compute per-rate Tx power values. */ 3933264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3934264912Skevlo urtwn_r88e_get_txpower(sc, i, c, extc, power); 3935264912Skevlo else 3936264912Skevlo urtwn_get_txpower(sc, i, c, extc, power); 3937251538Srpaulo /* Write per-rate Tx power values to hardware. */ 3938251538Srpaulo urtwn_write_txpower(sc, i, power); 3939251538Srpaulo } 3940251538Srpaulo} 3941251538Srpaulo 3942251538Srpaulostatic void 3943290048Savosurtwn_set_rx_bssid_all(struct urtwn_softc *sc, int enable) 3944290048Savos{ 3945290048Savos uint32_t reg; 3946290048Savos 3947290048Savos reg = urtwn_read_4(sc, R92C_RCR); 3948290048Savos if (enable) 3949290048Savos reg &= ~R92C_RCR_CBSSID_BCN; 3950290048Savos else 3951290048Savos reg |= R92C_RCR_CBSSID_BCN; 3952290048Savos urtwn_write_4(sc, R92C_RCR, reg); 3953290048Savos} 3954290048Savos 3955290048Savosstatic void 3956290048Savosurtwn_set_gain(struct urtwn_softc *sc, uint8_t gain) 3957290048Savos{ 3958290048Savos uint32_t reg; 3959290048Savos 3960290048Savos reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0)); 3961290048Savos reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, gain); 3962290048Savos urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg); 3963290048Savos 3964290048Savos if (!(sc->chip & URTWN_CHIP_88E)) { 3965290048Savos reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1)); 3966290048Savos reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, gain); 3967290048Savos urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg); 3968290048Savos } 3969290048Savos} 3970290048Savos 3971290048Savosstatic void 3972251538Srpaulourtwn_scan_start(struct ieee80211com *ic) 3973251538Srpaulo{ 3974290048Savos struct urtwn_softc *sc = ic->ic_softc; 3975290048Savos 3976290048Savos URTWN_LOCK(sc); 3977290048Savos /* Receive beacons / probe responses from any BSSID. */ 3978290651Savos if (ic->ic_opmode != IEEE80211_M_IBSS) 3979290651Savos urtwn_set_rx_bssid_all(sc, 1); 3980290651Savos 3981290048Savos /* Set gain for scanning. */ 3982290048Savos urtwn_set_gain(sc, 0x20); 3983290048Savos URTWN_UNLOCK(sc); 3984251538Srpaulo} 3985251538Srpaulo 3986251538Srpaulostatic void 3987251538Srpaulourtwn_scan_end(struct ieee80211com *ic) 3988251538Srpaulo{ 3989290048Savos struct urtwn_softc *sc = ic->ic_softc; 3990290048Savos 3991290048Savos URTWN_LOCK(sc); 3992290048Savos /* Restore limitations. */ 3993290651Savos if (ic->ic_promisc == 0 && ic->ic_opmode != IEEE80211_M_IBSS) 3994290564Savos urtwn_set_rx_bssid_all(sc, 0); 3995290651Savos 3996290048Savos /* Set gain under link. */ 3997290048Savos urtwn_set_gain(sc, 0x32); 3998290048Savos URTWN_UNLOCK(sc); 3999251538Srpaulo} 4000251538Srpaulo 4001251538Srpaulostatic void 4002251538Srpaulourtwn_set_channel(struct ieee80211com *ic) 4003251538Srpaulo{ 4004286949Sadrian struct urtwn_softc *sc = ic->ic_softc; 4005292173Savos struct ieee80211_channel *c = ic->ic_curchan; 4006281070Srpaulo struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 4007251538Srpaulo 4008251538Srpaulo URTWN_LOCK(sc); 4009281070Srpaulo if (vap->iv_state == IEEE80211_S_SCAN) { 4010281070Srpaulo /* Make link LED blink during scan. */ 4011281070Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, !sc->ledlink); 4012281070Srpaulo } 4013292173Savos urtwn_set_chan(sc, c, NULL); 4014292173Savos sc->sc_rxtap.wr_chan_freq = htole16(c->ic_freq); 4015292173Savos sc->sc_rxtap.wr_chan_flags = htole16(c->ic_flags); 4016292173Savos sc->sc_txtap.wt_chan_freq = htole16(c->ic_freq); 4017292173Savos sc->sc_txtap.wt_chan_flags = htole16(c->ic_flags); 4018251538Srpaulo URTWN_UNLOCK(sc); 4019251538Srpaulo} 4020251538Srpaulo 4021292014Savosstatic int 4022292014Savosurtwn_wme_update(struct ieee80211com *ic) 4023292014Savos{ 4024292014Savos const struct wmeParams *wmep = 4025292014Savos ic->ic_wme.wme_chanParams.cap_wmeParams; 4026292014Savos struct urtwn_softc *sc = ic->ic_softc; 4027292014Savos uint8_t aifs, acm, slottime; 4028292014Savos int ac; 4029292014Savos 4030292014Savos acm = 0; 4031292165Savos slottime = IEEE80211_GET_SLOTTIME(ic); 4032292014Savos 4033292014Savos URTWN_LOCK(sc); 4034292014Savos for (ac = WME_AC_BE; ac < WME_NUM_AC; ac++) { 4035292014Savos /* AIFS[AC] = AIFSN[AC] * aSlotTime + aSIFSTime. */ 4036292014Savos aifs = wmep[ac].wmep_aifsn * slottime + IEEE80211_DUR_SIFS; 4037292014Savos urtwn_write_4(sc, wme2queue[ac].reg, 4038292014Savos SM(R92C_EDCA_PARAM_TXOP, wmep[ac].wmep_txopLimit) | 4039292014Savos SM(R92C_EDCA_PARAM_ECWMIN, wmep[ac].wmep_logcwmin) | 4040292014Savos SM(R92C_EDCA_PARAM_ECWMAX, wmep[ac].wmep_logcwmax) | 4041292014Savos SM(R92C_EDCA_PARAM_AIFS, aifs)); 4042292014Savos if (ac != WME_AC_BE) 4043292014Savos acm |= wmep[ac].wmep_acm << ac; 4044292014Savos } 4045292014Savos 4046292014Savos if (acm != 0) 4047292014Savos acm |= R92C_ACMHWCTRL_EN; 4048292014Savos urtwn_write_1(sc, R92C_ACMHWCTRL, 4049292014Savos (urtwn_read_1(sc, R92C_ACMHWCTRL) & ~R92C_ACMHWCTRL_ACM_MASK) | 4050292014Savos acm); 4051292014Savos 4052292014Savos URTWN_UNLOCK(sc); 4053292014Savos 4054292014Savos return 0; 4055292014Savos} 4056292014Savos 4057251538Srpaulostatic void 4058290564Savosurtwn_set_promisc(struct urtwn_softc *sc) 4059290564Savos{ 4060290564Savos struct ieee80211com *ic = &sc->sc_ic; 4061290564Savos struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 4062290564Savos uint32_t rcr, mask1, mask2; 4063290564Savos 4064290564Savos URTWN_ASSERT_LOCKED(sc); 4065290564Savos 4066290564Savos if (vap->iv_opmode == IEEE80211_M_MONITOR) 4067290564Savos return; 4068290564Savos 4069290564Savos mask1 = R92C_RCR_ACF | R92C_RCR_ADF | R92C_RCR_AMF | R92C_RCR_AAP; 4070290564Savos mask2 = R92C_RCR_APM; 4071290564Savos 4072290564Savos if (vap->iv_state == IEEE80211_S_RUN) { 4073290564Savos switch (vap->iv_opmode) { 4074290564Savos case IEEE80211_M_STA: 4075290631Savos mask2 |= R92C_RCR_CBSSID_DATA; 4076290631Savos /* FALLTHROUGH */ 4077290631Savos case IEEE80211_M_HOSTAP: 4078290631Savos mask2 |= R92C_RCR_CBSSID_BCN; 4079290564Savos break; 4080290651Savos case IEEE80211_M_IBSS: 4081290651Savos mask2 |= R92C_RCR_CBSSID_DATA; 4082290651Savos break; 4083290564Savos default: 4084290564Savos device_printf(sc->sc_dev, "%s: undefined opmode %d\n", 4085290564Savos __func__, vap->iv_opmode); 4086290564Savos return; 4087290564Savos } 4088290564Savos } 4089290564Savos 4090290564Savos rcr = urtwn_read_4(sc, R92C_RCR); 4091290564Savos if (ic->ic_promisc == 0) 4092290564Savos rcr = (rcr & ~mask1) | mask2; 4093290564Savos else 4094290564Savos rcr = (rcr & ~mask2) | mask1; 4095290564Savos urtwn_write_4(sc, R92C_RCR, rcr); 4096290564Savos} 4097290564Savos 4098290564Savosstatic void 4099290564Savosurtwn_update_promisc(struct ieee80211com *ic) 4100290564Savos{ 4101290564Savos struct urtwn_softc *sc = ic->ic_softc; 4102290564Savos 4103290564Savos URTWN_LOCK(sc); 4104290564Savos if (sc->sc_flags & URTWN_RUNNING) 4105290564Savos urtwn_set_promisc(sc); 4106290564Savos URTWN_UNLOCK(sc); 4107290564Savos} 4108290564Savos 4109290564Savosstatic void 4110283540Sglebiusurtwn_update_mcast(struct ieee80211com *ic) 4111251538Srpaulo{ 4112251538Srpaulo /* XXX do nothing? */ 4113251538Srpaulo} 4114251538Srpaulo 4115292167Savosstatic struct ieee80211_node * 4116292167Savosurtwn_r88e_node_alloc(struct ieee80211vap *vap, 4117292167Savos const uint8_t mac[IEEE80211_ADDR_LEN]) 4118292167Savos{ 4119292167Savos struct urtwn_node *un; 4120292167Savos 4121292167Savos un = malloc(sizeof (struct urtwn_node), M_80211_NODE, 4122292167Savos M_NOWAIT | M_ZERO); 4123292167Savos 4124292167Savos if (un == NULL) 4125292167Savos return NULL; 4126292167Savos 4127292167Savos un->id = URTWN_MACID_UNDEFINED; 4128292167Savos 4129292167Savos return &un->ni; 4130292167Savos} 4131292167Savos 4132251538Srpaulostatic void 4133292167Savosurtwn_r88e_newassoc(struct ieee80211_node *ni, int isnew) 4134292167Savos{ 4135292167Savos struct urtwn_softc *sc = ni->ni_ic->ic_softc; 4136292167Savos struct urtwn_node *un = URTWN_NODE(ni); 4137292167Savos uint8_t id; 4138292167Savos 4139292167Savos if (!isnew) 4140292167Savos return; 4141292167Savos 4142292167Savos URTWN_NT_LOCK(sc); 4143292167Savos for (id = 0; id <= URTWN_MACID_MAX(sc); id++) { 4144292167Savos if (id != URTWN_MACID_BC && sc->node_list[id] == NULL) { 4145292167Savos un->id = id; 4146292167Savos sc->node_list[id] = ni; 4147292167Savos break; 4148292167Savos } 4149292167Savos } 4150292167Savos URTWN_NT_UNLOCK(sc); 4151292167Savos 4152292167Savos if (id > URTWN_MACID_MAX(sc)) { 4153292167Savos device_printf(sc->sc_dev, "%s: node table is full\n", 4154292167Savos __func__); 4155292167Savos } 4156292167Savos} 4157292167Savos 4158292167Savosstatic void 4159292167Savosurtwn_r88e_node_free(struct ieee80211_node *ni) 4160292167Savos{ 4161292167Savos struct urtwn_softc *sc = ni->ni_ic->ic_softc; 4162292167Savos struct urtwn_node *un = URTWN_NODE(ni); 4163292167Savos 4164292167Savos URTWN_NT_LOCK(sc); 4165292167Savos if (un->id != URTWN_MACID_UNDEFINED) 4166292167Savos sc->node_list[un->id] = NULL; 4167292167Savos URTWN_NT_UNLOCK(sc); 4168292167Savos 4169292167Savos sc->sc_node_free(ni); 4170292167Savos} 4171292167Savos 4172292167Savosstatic void 4173251538Srpaulourtwn_set_chan(struct urtwn_softc *sc, struct ieee80211_channel *c, 4174251538Srpaulo struct ieee80211_channel *extc) 4175251538Srpaulo{ 4176287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 4177251538Srpaulo uint32_t reg; 4178251538Srpaulo u_int chan; 4179251538Srpaulo int i; 4180251538Srpaulo 4181251538Srpaulo chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */ 4182251538Srpaulo if (chan == 0 || chan == IEEE80211_CHAN_ANY) { 4183251538Srpaulo device_printf(sc->sc_dev, 4184251538Srpaulo "%s: invalid channel %x\n", __func__, chan); 4185251538Srpaulo return; 4186251538Srpaulo } 4187251538Srpaulo 4188251538Srpaulo /* Set Tx power for this new channel. */ 4189251538Srpaulo urtwn_set_txpower(sc, c, extc); 4190251538Srpaulo 4191251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 4192251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_CHNLBW, 4193251538Srpaulo RW(sc->rf_chnlbw[i], R92C_RF_CHNLBW_CHNL, chan)); 4194251538Srpaulo } 4195251538Srpaulo#ifndef IEEE80211_NO_HT 4196251538Srpaulo if (extc != NULL) { 4197251538Srpaulo /* Is secondary channel below or above primary? */ 4198251538Srpaulo int prichlo = c->ic_freq < extc->ic_freq; 4199251538Srpaulo 4200251538Srpaulo urtwn_write_1(sc, R92C_BWOPMODE, 4201251538Srpaulo urtwn_read_1(sc, R92C_BWOPMODE) & ~R92C_BWOPMODE_20MHZ); 4202251538Srpaulo 4203251538Srpaulo reg = urtwn_read_1(sc, R92C_RRSR + 2); 4204251538Srpaulo reg = (reg & ~0x6f) | (prichlo ? 1 : 2) << 5; 4205251538Srpaulo urtwn_write_1(sc, R92C_RRSR + 2, reg); 4206251538Srpaulo 4207251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFMOD, 4208251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_RFMOD) | R92C_RFMOD_40MHZ); 4209251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_RFMOD, 4210251538Srpaulo urtwn_bb_read(sc, R92C_FPGA1_RFMOD) | R92C_RFMOD_40MHZ); 4211251538Srpaulo 4212251538Srpaulo /* Set CCK side band. */ 4213251538Srpaulo reg = urtwn_bb_read(sc, R92C_CCK0_SYSTEM); 4214251538Srpaulo reg = (reg & ~0x00000010) | (prichlo ? 0 : 1) << 4; 4215251538Srpaulo urtwn_bb_write(sc, R92C_CCK0_SYSTEM, reg); 4216251538Srpaulo 4217251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM1_LSTF); 4218251538Srpaulo reg = (reg & ~0x00000c00) | (prichlo ? 1 : 2) << 10; 4219251538Srpaulo urtwn_bb_write(sc, R92C_OFDM1_LSTF, reg); 4220251538Srpaulo 4221251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2, 4222251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) & 4223251538Srpaulo ~R92C_FPGA0_ANAPARAM2_CBW20); 4224251538Srpaulo 4225251538Srpaulo reg = urtwn_bb_read(sc, 0x818); 4226251538Srpaulo reg = (reg & ~0x0c000000) | (prichlo ? 2 : 1) << 26; 4227251538Srpaulo urtwn_bb_write(sc, 0x818, reg); 4228251538Srpaulo 4229251538Srpaulo /* Select 40MHz bandwidth. */ 4230251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 4231251538Srpaulo (sc->rf_chnlbw[0] & ~0xfff) | chan); 4232251538Srpaulo } else 4233251538Srpaulo#endif 4234251538Srpaulo { 4235251538Srpaulo urtwn_write_1(sc, R92C_BWOPMODE, 4236251538Srpaulo urtwn_read_1(sc, R92C_BWOPMODE) | R92C_BWOPMODE_20MHZ); 4237251538Srpaulo 4238251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFMOD, 4239251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_RFMOD) & ~R92C_RFMOD_40MHZ); 4240251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_RFMOD, 4241251538Srpaulo urtwn_bb_read(sc, R92C_FPGA1_RFMOD) & ~R92C_RFMOD_40MHZ); 4242251538Srpaulo 4243264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 4244264912Skevlo urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2, 4245264912Skevlo urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) | 4246264912Skevlo R92C_FPGA0_ANAPARAM2_CBW20); 4247264912Skevlo } 4248281069Srpaulo 4249251538Srpaulo /* Select 20MHz bandwidth. */ 4250251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 4251281069Srpaulo (sc->rf_chnlbw[0] & ~0xfff) | chan | 4252264912Skevlo ((sc->chip & URTWN_CHIP_88E) ? R88E_RF_CHNLBW_BW20 : 4253264912Skevlo R92C_RF_CHNLBW_BW20)); 4254251538Srpaulo } 4255251538Srpaulo} 4256251538Srpaulo 4257251538Srpaulostatic void 4258251538Srpaulourtwn_iq_calib(struct urtwn_softc *sc) 4259251538Srpaulo{ 4260251538Srpaulo /* TODO */ 4261251538Srpaulo} 4262251538Srpaulo 4263251538Srpaulostatic void 4264251538Srpaulourtwn_lc_calib(struct urtwn_softc *sc) 4265251538Srpaulo{ 4266251538Srpaulo uint32_t rf_ac[2]; 4267251538Srpaulo uint8_t txmode; 4268251538Srpaulo int i; 4269251538Srpaulo 4270251538Srpaulo txmode = urtwn_read_1(sc, R92C_OFDM1_LSTF + 3); 4271251538Srpaulo if ((txmode & 0x70) != 0) { 4272251538Srpaulo /* Disable all continuous Tx. */ 4273251538Srpaulo urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode & ~0x70); 4274251538Srpaulo 4275251538Srpaulo /* Set RF mode to standby mode. */ 4276251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 4277251538Srpaulo rf_ac[i] = urtwn_rf_read(sc, i, R92C_RF_AC); 4278251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_AC, 4279251538Srpaulo RW(rf_ac[i], R92C_RF_AC_MODE, 4280251538Srpaulo R92C_RF_AC_MODE_STANDBY)); 4281251538Srpaulo } 4282251538Srpaulo } else { 4283251538Srpaulo /* Block all Tx queues. */ 4284251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 0xff); 4285251538Srpaulo } 4286251538Srpaulo /* Start calibration. */ 4287251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 4288251538Srpaulo urtwn_rf_read(sc, 0, R92C_RF_CHNLBW) | R92C_RF_CHNLBW_LCSTART); 4289251538Srpaulo 4290251538Srpaulo /* Give calibration the time to complete. */ 4291266472Shselasky usb_pause_mtx(&sc->sc_mtx, hz / 10); /* 100ms */ 4292251538Srpaulo 4293251538Srpaulo /* Restore configuration. */ 4294251538Srpaulo if ((txmode & 0x70) != 0) { 4295251538Srpaulo /* Restore Tx mode. */ 4296251538Srpaulo urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode); 4297251538Srpaulo /* Restore RF mode. */ 4298251538Srpaulo for (i = 0; i < sc->nrxchains; i++) 4299251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_AC, rf_ac[i]); 4300251538Srpaulo } else { 4301251538Srpaulo /* Unblock all Tx queues. */ 4302251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 0x00); 4303251538Srpaulo } 4304251538Srpaulo} 4305251538Srpaulo 4306291698Savosstatic int 4307287197Sglebiusurtwn_init(struct urtwn_softc *sc) 4308251538Srpaulo{ 4309287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 4310287197Sglebius struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 4311287197Sglebius uint8_t macaddr[IEEE80211_ADDR_LEN]; 4312251538Srpaulo uint32_t reg; 4313291698Savos usb_error_t usb_err = USB_ERR_NORMAL_COMPLETION; 4314251538Srpaulo int error; 4315251538Srpaulo 4316291698Savos URTWN_LOCK(sc); 4317291698Savos if (sc->sc_flags & URTWN_RUNNING) { 4318291698Savos URTWN_UNLOCK(sc); 4319291698Savos return (0); 4320291698Savos } 4321264864Skevlo 4322251538Srpaulo /* Init firmware commands ring. */ 4323251538Srpaulo sc->fwcur = 0; 4324251538Srpaulo 4325251538Srpaulo /* Allocate Tx/Rx buffers. */ 4326251538Srpaulo error = urtwn_alloc_rx_list(sc); 4327251538Srpaulo if (error != 0) 4328251538Srpaulo goto fail; 4329281069Srpaulo 4330251538Srpaulo error = urtwn_alloc_tx_list(sc); 4331251538Srpaulo if (error != 0) 4332251538Srpaulo goto fail; 4333251538Srpaulo 4334251538Srpaulo /* Power on adapter. */ 4335251538Srpaulo error = urtwn_power_on(sc); 4336251538Srpaulo if (error != 0) 4337251538Srpaulo goto fail; 4338251538Srpaulo 4339251538Srpaulo /* Initialize DMA. */ 4340251538Srpaulo error = urtwn_dma_init(sc); 4341251538Srpaulo if (error != 0) 4342251538Srpaulo goto fail; 4343251538Srpaulo 4344251538Srpaulo /* Set info size in Rx descriptors (in 64-bit words). */ 4345251538Srpaulo urtwn_write_1(sc, R92C_RX_DRVINFO_SZ, 4); 4346251538Srpaulo 4347251538Srpaulo /* Init interrupts. */ 4348264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 4349291698Savos usb_err = urtwn_write_4(sc, R88E_HISR, 0xffffffff); 4350291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4351291698Savos goto fail; 4352291698Savos usb_err = urtwn_write_4(sc, R88E_HIMR, R88E_HIMR_CPWM | R88E_HIMR_CPWM2 | 4353264912Skevlo R88E_HIMR_TBDER | R88E_HIMR_PSTIMEOUT); 4354291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4355291698Savos goto fail; 4356291698Savos usb_err = urtwn_write_4(sc, R88E_HIMRE, R88E_HIMRE_RXFOVW | 4357264912Skevlo R88E_HIMRE_TXFOVW | R88E_HIMRE_RXERR | R88E_HIMRE_TXERR); 4358291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4359291698Savos goto fail; 4360291698Savos usb_err = urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION, 4361264912Skevlo urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) | 4362264912Skevlo R92C_USB_SPECIAL_OPTION_INT_BULK_SEL); 4363291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4364291698Savos goto fail; 4365264912Skevlo } else { 4366291698Savos usb_err = urtwn_write_4(sc, R92C_HISR, 0xffffffff); 4367291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4368291698Savos goto fail; 4369291698Savos usb_err = urtwn_write_4(sc, R92C_HIMR, 0xffffffff); 4370291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4371291698Savos goto fail; 4372264912Skevlo } 4373251538Srpaulo 4374251538Srpaulo /* Set MAC address. */ 4375287197Sglebius IEEE80211_ADDR_COPY(macaddr, vap ? vap->iv_myaddr : ic->ic_macaddr); 4376291698Savos usb_err = urtwn_write_region_1(sc, R92C_MACID, macaddr, IEEE80211_ADDR_LEN); 4377291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4378291698Savos goto fail; 4379251538Srpaulo 4380251538Srpaulo /* Set initial network type. */ 4381289811Savos urtwn_set_mode(sc, R92C_MSR_INFRA); 4382251538Srpaulo 4383290564Savos /* Initialize Rx filter. */ 4384251538Srpaulo urtwn_rxfilter_init(sc); 4385251538Srpaulo 4386282623Skevlo /* Set response rate. */ 4387251538Srpaulo reg = urtwn_read_4(sc, R92C_RRSR); 4388251538Srpaulo reg = RW(reg, R92C_RRSR_RATE_BITMAP, R92C_RRSR_RATE_CCK_ONLY_1M); 4389251538Srpaulo urtwn_write_4(sc, R92C_RRSR, reg); 4390251538Srpaulo 4391251538Srpaulo /* Set short/long retry limits. */ 4392251538Srpaulo urtwn_write_2(sc, R92C_RL, 4393251538Srpaulo SM(R92C_RL_SRL, 0x30) | SM(R92C_RL_LRL, 0x30)); 4394251538Srpaulo 4395251538Srpaulo /* Initialize EDCA parameters. */ 4396251538Srpaulo urtwn_edca_init(sc); 4397251538Srpaulo 4398251538Srpaulo /* Setup rate fallback. */ 4399264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 4400264912Skevlo urtwn_write_4(sc, R92C_DARFRC + 0, 0x00000000); 4401264912Skevlo urtwn_write_4(sc, R92C_DARFRC + 4, 0x10080404); 4402264912Skevlo urtwn_write_4(sc, R92C_RARFRC + 0, 0x04030201); 4403264912Skevlo urtwn_write_4(sc, R92C_RARFRC + 4, 0x08070605); 4404264912Skevlo } 4405251538Srpaulo 4406251538Srpaulo urtwn_write_1(sc, R92C_FWHW_TXQ_CTRL, 4407251538Srpaulo urtwn_read_1(sc, R92C_FWHW_TXQ_CTRL) | 4408251538Srpaulo R92C_FWHW_TXQ_CTRL_AMPDU_RTY_NEW); 4409251538Srpaulo /* Set ACK timeout. */ 4410251538Srpaulo urtwn_write_1(sc, R92C_ACKTO, 0x40); 4411251538Srpaulo 4412251538Srpaulo /* Setup USB aggregation. */ 4413251538Srpaulo reg = urtwn_read_4(sc, R92C_TDECTRL); 4414251538Srpaulo reg = RW(reg, R92C_TDECTRL_BLK_DESC_NUM, 6); 4415251538Srpaulo urtwn_write_4(sc, R92C_TDECTRL, reg); 4416251538Srpaulo urtwn_write_1(sc, R92C_TRXDMA_CTRL, 4417251538Srpaulo urtwn_read_1(sc, R92C_TRXDMA_CTRL) | 4418251538Srpaulo R92C_TRXDMA_CTRL_RXDMA_AGG_EN); 4419251538Srpaulo urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH, 48); 4420264912Skevlo if (sc->chip & URTWN_CHIP_88E) 4421264912Skevlo urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH + 1, 4); 4422282266Skevlo else { 4423264912Skevlo urtwn_write_1(sc, R92C_USB_DMA_AGG_TO, 4); 4424282266Skevlo urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION, 4425282266Skevlo urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) | 4426282266Skevlo R92C_USB_SPECIAL_OPTION_AGG_EN); 4427282266Skevlo urtwn_write_1(sc, R92C_USB_AGG_TH, 8); 4428282266Skevlo urtwn_write_1(sc, R92C_USB_AGG_TO, 6); 4429282266Skevlo } 4430251538Srpaulo 4431251538Srpaulo /* Initialize beacon parameters. */ 4432264912Skevlo urtwn_write_2(sc, R92C_BCN_CTRL, 0x1010); 4433251538Srpaulo urtwn_write_2(sc, R92C_TBTT_PROHIBIT, 0x6404); 4434251538Srpaulo urtwn_write_1(sc, R92C_DRVERLYINT, 0x05); 4435251538Srpaulo urtwn_write_1(sc, R92C_BCNDMATIM, 0x02); 4436251538Srpaulo urtwn_write_2(sc, R92C_BCNTCFG, 0x660f); 4437251538Srpaulo 4438264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 4439264912Skevlo /* Setup AMPDU aggregation. */ 4440264912Skevlo urtwn_write_4(sc, R92C_AGGLEN_LMT, 0x99997631); /* MCS7~0 */ 4441264912Skevlo urtwn_write_1(sc, R92C_AGGR_BREAK_TIME, 0x16); 4442264912Skevlo urtwn_write_2(sc, R92C_MAX_AGGR_NUM, 0x0708); 4443251538Srpaulo 4444264912Skevlo urtwn_write_1(sc, R92C_BCN_MAX_ERR, 0xff); 4445264912Skevlo } 4446251538Srpaulo 4447251538Srpaulo /* Load 8051 microcode. */ 4448251538Srpaulo error = urtwn_load_firmware(sc); 4449251538Srpaulo if (error != 0) 4450251538Srpaulo goto fail; 4451251538Srpaulo 4452251538Srpaulo /* Initialize MAC/BB/RF blocks. */ 4453291698Savos error = urtwn_mac_init(sc); 4454291698Savos if (error != 0) { 4455291698Savos device_printf(sc->sc_dev, 4456291698Savos "%s: error while initializing MAC block\n", __func__); 4457291698Savos goto fail; 4458291698Savos } 4459251538Srpaulo urtwn_bb_init(sc); 4460251538Srpaulo urtwn_rf_init(sc); 4461251538Srpaulo 4462290564Savos /* Reinitialize Rx filter (D3845 is not committed yet). */ 4463290564Savos urtwn_rxfilter_init(sc); 4464290564Savos 4465264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 4466264912Skevlo urtwn_write_2(sc, R92C_CR, 4467264912Skevlo urtwn_read_2(sc, R92C_CR) | R92C_CR_MACTXEN | 4468264912Skevlo R92C_CR_MACRXEN); 4469264912Skevlo } 4470264912Skevlo 4471251538Srpaulo /* Turn CCK and OFDM blocks on. */ 4472251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD); 4473251538Srpaulo reg |= R92C_RFMOD_CCK_EN; 4474291698Savos usb_err = urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg); 4475291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4476291698Savos goto fail; 4477251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD); 4478251538Srpaulo reg |= R92C_RFMOD_OFDM_EN; 4479291698Savos usb_err = urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg); 4480291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4481291698Savos goto fail; 4482251538Srpaulo 4483251538Srpaulo /* Clear per-station keys table. */ 4484251538Srpaulo urtwn_cam_init(sc); 4485251538Srpaulo 4486292175Savos /* Enable decryption / encryption. */ 4487292175Savos urtwn_write_2(sc, R92C_SECCFG, 4488292175Savos R92C_SECCFG_TXUCKEY_DEF | R92C_SECCFG_RXUCKEY_DEF | 4489292175Savos R92C_SECCFG_TXENC_ENA | R92C_SECCFG_RXDEC_ENA | 4490292175Savos R92C_SECCFG_TXBCKEY_DEF | R92C_SECCFG_RXBCKEY_DEF); 4491292175Savos 4492292175Savos /* 4493292175Savos * Install static keys (if any). 4494292175Savos * Must be called after urtwn_cam_init(). 4495292175Savos */ 4496292175Savos ieee80211_runtask(ic, &sc->cmdq_task); 4497292175Savos 4498251538Srpaulo /* Enable hardware sequence numbering. */ 4499251538Srpaulo urtwn_write_1(sc, R92C_HWSEQ_CTRL, 0xff); 4500251538Srpaulo 4501292167Savos /* Enable per-packet TX report. */ 4502292167Savos if (sc->chip & URTWN_CHIP_88E) { 4503292167Savos urtwn_write_1(sc, R88E_TX_RPT_CTRL, 4504292167Savos urtwn_read_1(sc, R88E_TX_RPT_CTRL) | R88E_TX_RPT1_ENA); 4505292167Savos } 4506292167Savos 4507251538Srpaulo /* Perform LO and IQ calibrations. */ 4508251538Srpaulo urtwn_iq_calib(sc); 4509251538Srpaulo /* Perform LC calibration. */ 4510251538Srpaulo urtwn_lc_calib(sc); 4511251538Srpaulo 4512251538Srpaulo /* Fix USB interference issue. */ 4513264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 4514264912Skevlo urtwn_write_1(sc, 0xfe40, 0xe0); 4515264912Skevlo urtwn_write_1(sc, 0xfe41, 0x8d); 4516264912Skevlo urtwn_write_1(sc, 0xfe42, 0x80); 4517251538Srpaulo 4518264912Skevlo urtwn_pa_bias_init(sc); 4519264912Skevlo } 4520251538Srpaulo 4521251538Srpaulo /* Initialize GPIO setting. */ 4522251538Srpaulo urtwn_write_1(sc, R92C_GPIO_MUXCFG, 4523251538Srpaulo urtwn_read_1(sc, R92C_GPIO_MUXCFG) & ~R92C_GPIO_MUXCFG_ENBT); 4524251538Srpaulo 4525251538Srpaulo /* Fix for lower temperature. */ 4526264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) 4527264912Skevlo urtwn_write_1(sc, 0x15, 0xe9); 4528251538Srpaulo 4529251538Srpaulo usbd_transfer_start(sc->sc_xfer[URTWN_BULK_RX]); 4530251538Srpaulo 4531287197Sglebius sc->sc_flags |= URTWN_RUNNING; 4532251538Srpaulo 4533251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 4534251538Srpaulofail: 4535291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 4536291698Savos error = EIO; 4537291698Savos 4538291698Savos URTWN_UNLOCK(sc); 4539291698Savos 4540291698Savos return (error); 4541251538Srpaulo} 4542251538Srpaulo 4543251538Srpaulostatic void 4544287197Sglebiusurtwn_stop(struct urtwn_softc *sc) 4545251538Srpaulo{ 4546251538Srpaulo 4547291698Savos URTWN_LOCK(sc); 4548291698Savos if (!(sc->sc_flags & URTWN_RUNNING)) { 4549291698Savos URTWN_UNLOCK(sc); 4550291698Savos return; 4551291698Savos } 4552291698Savos 4553287197Sglebius sc->sc_flags &= ~URTWN_RUNNING; 4554251538Srpaulo callout_stop(&sc->sc_watchdog_ch); 4555251538Srpaulo urtwn_abort_xfers(sc); 4556288353Sadrian 4557288353Sadrian urtwn_drain_mbufq(sc); 4558291698Savos URTWN_UNLOCK(sc); 4559251538Srpaulo} 4560251538Srpaulo 4561251538Srpaulostatic void 4562251538Srpaulourtwn_abort_xfers(struct urtwn_softc *sc) 4563251538Srpaulo{ 4564251538Srpaulo int i; 4565251538Srpaulo 4566251538Srpaulo URTWN_ASSERT_LOCKED(sc); 4567251538Srpaulo 4568251538Srpaulo /* abort any pending transfers */ 4569251538Srpaulo for (i = 0; i < URTWN_N_TRANSFER; i++) 4570251538Srpaulo usbd_transfer_stop(sc->sc_xfer[i]); 4571251538Srpaulo} 4572251538Srpaulo 4573251538Srpaulostatic int 4574251538Srpaulourtwn_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 4575251538Srpaulo const struct ieee80211_bpf_params *params) 4576251538Srpaulo{ 4577251538Srpaulo struct ieee80211com *ic = ni->ni_ic; 4578286949Sadrian struct urtwn_softc *sc = ic->ic_softc; 4579251538Srpaulo struct urtwn_data *bf; 4580290630Savos int error; 4581251538Srpaulo 4582251538Srpaulo /* prevent management frames from being sent if we're not ready */ 4583290630Savos URTWN_LOCK(sc); 4584287197Sglebius if (!(sc->sc_flags & URTWN_RUNNING)) { 4585290630Savos error = ENETDOWN; 4586290630Savos goto end; 4587251538Srpaulo } 4588290630Savos 4589251538Srpaulo bf = urtwn_getbuf(sc); 4590251538Srpaulo if (bf == NULL) { 4591290630Savos error = ENOBUFS; 4592290630Savos goto end; 4593251538Srpaulo } 4594251538Srpaulo 4595290630Savos if ((error = urtwn_tx_data(sc, ni, m, bf)) != 0) { 4596251538Srpaulo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 4597290630Savos goto end; 4598251538Srpaulo } 4599290630Savos 4600288353Sadrian sc->sc_txtimer = 5; 4601290630Savos callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 4602290630Savos 4603290630Savosend: 4604290630Savos if (error != 0) 4605290630Savos m_freem(m); 4606290630Savos 4607251538Srpaulo URTWN_UNLOCK(sc); 4608251538Srpaulo 4609290630Savos return (error); 4610251538Srpaulo} 4611251538Srpaulo 4612266472Shselaskystatic void 4613266472Shselaskyurtwn_ms_delay(struct urtwn_softc *sc) 4614266472Shselasky{ 4615266472Shselasky usb_pause_mtx(&sc->sc_mtx, hz / 1000); 4616266472Shselasky} 4617266472Shselasky 4618251538Srpaulostatic device_method_t urtwn_methods[] = { 4619251538Srpaulo /* Device interface */ 4620251538Srpaulo DEVMETHOD(device_probe, urtwn_match), 4621251538Srpaulo DEVMETHOD(device_attach, urtwn_attach), 4622251538Srpaulo DEVMETHOD(device_detach, urtwn_detach), 4623251538Srpaulo 4624264912Skevlo DEVMETHOD_END 4625251538Srpaulo}; 4626251538Srpaulo 4627251538Srpaulostatic driver_t urtwn_driver = { 4628251538Srpaulo "urtwn", 4629251538Srpaulo urtwn_methods, 4630251538Srpaulo sizeof(struct urtwn_softc) 4631251538Srpaulo}; 4632251538Srpaulo 4633251538Srpaulostatic devclass_t urtwn_devclass; 4634251538Srpaulo 4635251538SrpauloDRIVER_MODULE(urtwn, uhub, urtwn_driver, urtwn_devclass, NULL, NULL); 4636251538SrpauloMODULE_DEPEND(urtwn, usb, 1, 1, 1); 4637251538SrpauloMODULE_DEPEND(urtwn, wlan, 1, 1, 1); 4638251538SrpauloMODULE_DEPEND(urtwn, firmware, 1, 1, 1); 4639251538SrpauloMODULE_VERSION(urtwn, 1); 4640292080SimpUSB_PNP_HOST_INFO(urtwn_devs); 4641