if_urtwn.c revision 297175
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/urtwn/if_urtwn.c 297175 2016-03-22 01:09:15Z adrian $"); 23251538Srpaulo 24251538Srpaulo/* 25264912Skevlo * Driver for Realtek RTL8188CE-VAU/RTL8188CUS/RTL8188EU/RTL8188RU/RTL8192CU. 26251538Srpaulo */ 27251538Srpaulo 28288353Sadrian#include "opt_wlan.h" 29295871Savos#include "opt_urtwn.h" 30288353Sadrian 31251538Srpaulo#include <sys/param.h> 32251538Srpaulo#include <sys/sockio.h> 33251538Srpaulo#include <sys/sysctl.h> 34251538Srpaulo#include <sys/lock.h> 35251538Srpaulo#include <sys/mutex.h> 36291902Skevlo#include <sys/condvar.h> 37251538Srpaulo#include <sys/mbuf.h> 38251538Srpaulo#include <sys/kernel.h> 39251538Srpaulo#include <sys/socket.h> 40251538Srpaulo#include <sys/systm.h> 41251538Srpaulo#include <sys/malloc.h> 42251538Srpaulo#include <sys/module.h> 43251538Srpaulo#include <sys/bus.h> 44251538Srpaulo#include <sys/endian.h> 45251538Srpaulo#include <sys/linker.h> 46251538Srpaulo#include <sys/firmware.h> 47251538Srpaulo#include <sys/kdb.h> 48251538Srpaulo 49251538Srpaulo#include <machine/bus.h> 50251538Srpaulo#include <machine/resource.h> 51251538Srpaulo#include <sys/rman.h> 52251538Srpaulo 53251538Srpaulo#include <net/bpf.h> 54251538Srpaulo#include <net/if.h> 55257176Sglebius#include <net/if_var.h> 56251538Srpaulo#include <net/if_arp.h> 57251538Srpaulo#include <net/ethernet.h> 58251538Srpaulo#include <net/if_dl.h> 59251538Srpaulo#include <net/if_media.h> 60251538Srpaulo#include <net/if_types.h> 61251538Srpaulo 62251538Srpaulo#include <netinet/in.h> 63251538Srpaulo#include <netinet/in_systm.h> 64251538Srpaulo#include <netinet/in_var.h> 65251538Srpaulo#include <netinet/if_ether.h> 66251538Srpaulo#include <netinet/ip.h> 67251538Srpaulo 68251538Srpaulo#include <net80211/ieee80211_var.h> 69288088Sadrian#include <net80211/ieee80211_input.h> 70251538Srpaulo#include <net80211/ieee80211_regdomain.h> 71251538Srpaulo#include <net80211/ieee80211_radiotap.h> 72251538Srpaulo#include <net80211/ieee80211_ratectl.h> 73251538Srpaulo 74251538Srpaulo#include <dev/usb/usb.h> 75251538Srpaulo#include <dev/usb/usbdi.h> 76291902Skevlo#include <dev/usb/usb_device.h> 77251538Srpaulo#include "usbdevs.h" 78251538Srpaulo 79251538Srpaulo#include <dev/usb/usb_debug.h> 80251538Srpaulo 81297058Sadrian#include <dev/urtwn/if_urtwnreg.h> 82297058Sadrian#include <dev/urtwn/if_urtwnvar.h> 83251538Srpaulo 84251538Srpaulo#ifdef USB_DEBUG 85294471Savosenum { 86294471Savos URTWN_DEBUG_XMIT = 0x00000001, /* basic xmit operation */ 87294471Savos URTWN_DEBUG_RECV = 0x00000002, /* basic recv operation */ 88294471Savos URTWN_DEBUG_STATE = 0x00000004, /* 802.11 state transitions */ 89294471Savos URTWN_DEBUG_RA = 0x00000008, /* f/w rate adaptation setup */ 90294471Savos URTWN_DEBUG_USB = 0x00000010, /* usb requests */ 91294471Savos URTWN_DEBUG_FIRMWARE = 0x00000020, /* firmware(9) loading debug */ 92294471Savos URTWN_DEBUG_BEACON = 0x00000040, /* beacon handling */ 93294471Savos URTWN_DEBUG_INTR = 0x00000080, /* ISR */ 94294471Savos URTWN_DEBUG_TEMP = 0x00000100, /* temperature calibration */ 95294471Savos URTWN_DEBUG_ROM = 0x00000200, /* various ROM info */ 96294471Savos URTWN_DEBUG_KEY = 0x00000400, /* crypto keys management */ 97294471Savos URTWN_DEBUG_TXPWR = 0x00000800, /* dump Tx power values */ 98297175Sadrian URTWN_DEBUG_RSSI = 0x00001000, /* dump RSSI lookups */ 99294471Savos URTWN_DEBUG_ANY = 0xffffffff 100294471Savos}; 101251538Srpaulo 102294471Savos#define URTWN_DPRINTF(_sc, _m, ...) do { \ 103294471Savos if ((_sc)->sc_debug & (_m)) \ 104294471Savos device_printf((_sc)->sc_dev, __VA_ARGS__); \ 105294471Savos} while(0) 106294471Savos 107294471Savos#else 108294471Savos#define URTWN_DPRINTF(_sc, _m, ...) do { (void) sc; } while (0) 109251538Srpaulo#endif 110251538Srpaulo 111288088Sadrian#define IEEE80211_HAS_ADDR4(wh) IEEE80211_IS_DSTODS(wh) 112251538Srpaulo 113297175Sadrianstatic int urtwn_enable_11n = 1; 114297175SadrianTUNABLE_INT("hw.usb.urtwn.enable_11n", &urtwn_enable_11n); 115297175Sadrian 116251538Srpaulo/* various supported device vendors/products */ 117251596Srpaulostatic const STRUCT_USB_HOST_ID urtwn_devs[] = { 118251538Srpaulo#define URTWN_DEV(v,p) { USB_VP(USB_VENDOR_##v, USB_PRODUCT_##v##_##p) } 119264912Skevlo#define URTWN_RTL8188E_DEV(v,p) \ 120264912Skevlo { USB_VPI(USB_VENDOR_##v, USB_PRODUCT_##v##_##p, URTWN_RTL8188E) } 121264912Skevlo#define URTWN_RTL8188E 1 122251538Srpaulo URTWN_DEV(ABOCOM, RTL8188CU_1), 123251538Srpaulo URTWN_DEV(ABOCOM, RTL8188CU_2), 124251538Srpaulo URTWN_DEV(ABOCOM, RTL8192CU), 125251538Srpaulo URTWN_DEV(ASUS, RTL8192CU), 126266721Skevlo URTWN_DEV(ASUS, USBN10NANO), 127251538Srpaulo URTWN_DEV(AZUREWAVE, RTL8188CE_1), 128251538Srpaulo URTWN_DEV(AZUREWAVE, RTL8188CE_2), 129251538Srpaulo URTWN_DEV(AZUREWAVE, RTL8188CU), 130251538Srpaulo URTWN_DEV(BELKIN, F7D2102), 131251538Srpaulo URTWN_DEV(BELKIN, RTL8188CU), 132251538Srpaulo URTWN_DEV(BELKIN, RTL8192CU), 133251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_1), 134251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_2), 135251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_3), 136251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_4), 137251538Srpaulo URTWN_DEV(CHICONY, RTL8188CUS_5), 138251538Srpaulo URTWN_DEV(COREGA, RTL8192CU), 139251538Srpaulo URTWN_DEV(DLINK, RTL8188CU), 140251538Srpaulo URTWN_DEV(DLINK, RTL8192CU_1), 141251538Srpaulo URTWN_DEV(DLINK, RTL8192CU_2), 142251538Srpaulo URTWN_DEV(DLINK, RTL8192CU_3), 143252196Skevlo URTWN_DEV(DLINK, DWA131B), 144251538Srpaulo URTWN_DEV(EDIMAX, EW7811UN), 145251538Srpaulo URTWN_DEV(EDIMAX, RTL8192CU), 146251538Srpaulo URTWN_DEV(FEIXUN, RTL8188CU), 147251538Srpaulo URTWN_DEV(FEIXUN, RTL8192CU), 148251538Srpaulo URTWN_DEV(GUILLEMOT, HWNUP150), 149251538Srpaulo URTWN_DEV(HAWKING, RTL8192CU), 150251538Srpaulo URTWN_DEV(HP3, RTL8188CU), 151251538Srpaulo URTWN_DEV(NETGEAR, WNA1000M), 152251538Srpaulo URTWN_DEV(NETGEAR, RTL8192CU), 153251538Srpaulo URTWN_DEV(NETGEAR4, RTL8188CU), 154251538Srpaulo URTWN_DEV(NOVATECH, RTL8188CU), 155251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CU_1), 156251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CU_2), 157251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CU_3), 158251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CU_4), 159251538Srpaulo URTWN_DEV(PLANEX2, RTL8188CUS), 160251538Srpaulo URTWN_DEV(PLANEX2, RTL8192CU), 161251538Srpaulo URTWN_DEV(REALTEK, RTL8188CE_0), 162251538Srpaulo URTWN_DEV(REALTEK, RTL8188CE_1), 163251538Srpaulo URTWN_DEV(REALTEK, RTL8188CTV), 164251538Srpaulo URTWN_DEV(REALTEK, RTL8188CU_0), 165251538Srpaulo URTWN_DEV(REALTEK, RTL8188CU_1), 166251538Srpaulo URTWN_DEV(REALTEK, RTL8188CU_2), 167282119Skevlo URTWN_DEV(REALTEK, RTL8188CU_3), 168251538Srpaulo URTWN_DEV(REALTEK, RTL8188CU_COMBO), 169251538Srpaulo URTWN_DEV(REALTEK, RTL8188CUS), 170251538Srpaulo URTWN_DEV(REALTEK, RTL8188RU_1), 171251538Srpaulo URTWN_DEV(REALTEK, RTL8188RU_2), 172272410Shselasky URTWN_DEV(REALTEK, RTL8188RU_3), 173251538Srpaulo URTWN_DEV(REALTEK, RTL8191CU), 174251538Srpaulo URTWN_DEV(REALTEK, RTL8192CE), 175251538Srpaulo URTWN_DEV(REALTEK, RTL8192CU), 176251538Srpaulo URTWN_DEV(SITECOMEU, RTL8188CU_1), 177251538Srpaulo URTWN_DEV(SITECOMEU, RTL8188CU_2), 178251538Srpaulo URTWN_DEV(SITECOMEU, RTL8192CU), 179251538Srpaulo URTWN_DEV(TRENDNET, RTL8188CU), 180251538Srpaulo URTWN_DEV(TRENDNET, RTL8192CU), 181251538Srpaulo URTWN_DEV(ZYXEL, RTL8192CU), 182264912Skevlo /* URTWN_RTL8188E */ 183295907Skevlo URTWN_RTL8188E_DEV(ABOCOM, RTL8188EU), 184273589Skevlo URTWN_RTL8188E_DEV(DLINK, DWA123D1), 185270191Skevlo URTWN_RTL8188E_DEV(DLINK, DWA125D1), 186273589Skevlo URTWN_RTL8188E_DEV(ELECOM, WDC150SU2M), 187264912Skevlo URTWN_RTL8188E_DEV(REALTEK, RTL8188ETV), 188264912Skevlo URTWN_RTL8188E_DEV(REALTEK, RTL8188EU), 189264912Skevlo#undef URTWN_RTL8188E_DEV 190251538Srpaulo#undef URTWN_DEV 191251538Srpaulo}; 192251538Srpaulo 193251538Srpaulostatic device_probe_t urtwn_match; 194251538Srpaulostatic device_attach_t urtwn_attach; 195251538Srpaulostatic device_detach_t urtwn_detach; 196251538Srpaulo 197251538Srpaulostatic usb_callback_t urtwn_bulk_tx_callback; 198251538Srpaulostatic usb_callback_t urtwn_bulk_rx_callback; 199251538Srpaulo 200294471Savosstatic void urtwn_sysctlattach(struct urtwn_softc *); 201294471Savosstatic void urtwn_drain_mbufq(struct urtwn_softc *); 202287197Sglebiusstatic usb_error_t urtwn_do_request(struct urtwn_softc *, 203287197Sglebius struct usb_device_request *, void *); 204251538Srpaulostatic struct ieee80211vap *urtwn_vap_create(struct ieee80211com *, 205251538Srpaulo const char [IFNAMSIZ], int, enum ieee80211_opmode, int, 206251538Srpaulo const uint8_t [IEEE80211_ADDR_LEN], 207251538Srpaulo const uint8_t [IEEE80211_ADDR_LEN]); 208251538Srpaulostatic void urtwn_vap_delete(struct ieee80211vap *); 209292207Savosstatic struct mbuf * urtwn_rx_copy_to_mbuf(struct urtwn_softc *, 210292207Savos struct r92c_rx_stat *, int); 211292207Savosstatic struct mbuf * urtwn_report_intr(struct usb_xfer *, 212292207Savos struct urtwn_data *); 213292207Savosstatic struct mbuf * urtwn_rxeof(struct urtwn_softc *, uint8_t *, int); 214292167Savosstatic void urtwn_r88e_ratectl_tx_complete(struct urtwn_softc *, 215292167Savos void *); 216292207Savosstatic struct ieee80211_node *urtwn_rx_frame(struct urtwn_softc *, 217292207Savos struct mbuf *, int8_t *); 218289891Savosstatic void urtwn_txeof(struct urtwn_softc *, struct urtwn_data *, 219289891Savos int); 220281069Srpaulostatic int urtwn_alloc_list(struct urtwn_softc *, 221251538Srpaulo struct urtwn_data[], int, int); 222251538Srpaulostatic int urtwn_alloc_rx_list(struct urtwn_softc *); 223251538Srpaulostatic int urtwn_alloc_tx_list(struct urtwn_softc *); 224251538Srpaulostatic void urtwn_free_list(struct urtwn_softc *, 225251538Srpaulo struct urtwn_data data[], int); 226289066Skevlostatic void urtwn_free_rx_list(struct urtwn_softc *); 227289066Skevlostatic void urtwn_free_tx_list(struct urtwn_softc *); 228251538Srpaulostatic struct urtwn_data * _urtwn_getbuf(struct urtwn_softc *); 229251538Srpaulostatic struct urtwn_data * urtwn_getbuf(struct urtwn_softc *); 230291698Savosstatic usb_error_t urtwn_write_region_1(struct urtwn_softc *, uint16_t, 231251538Srpaulo uint8_t *, int); 232291698Savosstatic usb_error_t urtwn_write_1(struct urtwn_softc *, uint16_t, uint8_t); 233291698Savosstatic usb_error_t urtwn_write_2(struct urtwn_softc *, uint16_t, uint16_t); 234291698Savosstatic usb_error_t urtwn_write_4(struct urtwn_softc *, uint16_t, uint32_t); 235291698Savosstatic usb_error_t urtwn_read_region_1(struct urtwn_softc *, uint16_t, 236251538Srpaulo uint8_t *, int); 237251538Srpaulostatic uint8_t urtwn_read_1(struct urtwn_softc *, uint16_t); 238251538Srpaulostatic uint16_t urtwn_read_2(struct urtwn_softc *, uint16_t); 239251538Srpaulostatic uint32_t urtwn_read_4(struct urtwn_softc *, uint16_t); 240281069Srpaulostatic int urtwn_fw_cmd(struct urtwn_softc *, uint8_t, 241251538Srpaulo const void *, int); 242292174Savosstatic void urtwn_cmdq_cb(void *, int); 243292174Savosstatic int urtwn_cmd_sleepable(struct urtwn_softc *, const void *, 244292174Savos size_t, CMD_FUNC_PROTO); 245264912Skevlostatic void urtwn_r92c_rf_write(struct urtwn_softc *, int, 246264912Skevlo uint8_t, uint32_t); 247281069Srpaulostatic void urtwn_r88e_rf_write(struct urtwn_softc *, int, 248264912Skevlo uint8_t, uint32_t); 249251538Srpaulostatic uint32_t urtwn_rf_read(struct urtwn_softc *, int, uint8_t); 250281069Srpaulostatic int urtwn_llt_write(struct urtwn_softc *, uint32_t, 251251538Srpaulo uint32_t); 252291264Savosstatic int urtwn_efuse_read_next(struct urtwn_softc *, uint8_t *); 253291264Savosstatic int urtwn_efuse_read_data(struct urtwn_softc *, uint8_t *, 254291264Savos uint8_t, uint8_t); 255294471Savos#ifdef USB_DEBUG 256291264Savosstatic void urtwn_dump_rom_contents(struct urtwn_softc *, 257291264Savos uint8_t *, uint16_t); 258291264Savos#endif 259291264Savosstatic int urtwn_efuse_read(struct urtwn_softc *, uint8_t *, 260291264Savos uint16_t); 261291698Savosstatic int urtwn_efuse_switch_power(struct urtwn_softc *); 262251538Srpaulostatic int urtwn_read_chipid(struct urtwn_softc *); 263291264Savosstatic int urtwn_read_rom(struct urtwn_softc *); 264291264Savosstatic int urtwn_r88e_read_rom(struct urtwn_softc *); 265251538Srpaulostatic int urtwn_ra_init(struct urtwn_softc *); 266290631Savosstatic void urtwn_init_beacon(struct urtwn_softc *, 267290631Savos struct urtwn_vap *); 268290631Savosstatic int urtwn_setup_beacon(struct urtwn_softc *, 269290631Savos struct ieee80211_node *); 270290631Savosstatic void urtwn_update_beacon(struct ieee80211vap *, int); 271290631Savosstatic int urtwn_tx_beacon(struct urtwn_softc *sc, 272290631Savos struct urtwn_vap *); 273292175Savosstatic int urtwn_key_alloc(struct ieee80211vap *, 274292175Savos struct ieee80211_key *, ieee80211_keyix *, 275292175Savos ieee80211_keyix *); 276292175Savosstatic void urtwn_key_set_cb(struct urtwn_softc *, 277292175Savos union sec_param *); 278292175Savosstatic void urtwn_key_del_cb(struct urtwn_softc *, 279292175Savos union sec_param *); 280292175Savosstatic int urtwn_key_set(struct ieee80211vap *, 281292175Savos const struct ieee80211_key *); 282292175Savosstatic int urtwn_key_delete(struct ieee80211vap *, 283292175Savos const struct ieee80211_key *); 284290651Savosstatic void urtwn_tsf_task_adhoc(void *, int); 285290631Savosstatic void urtwn_tsf_sync_enable(struct urtwn_softc *, 286290631Savos struct ieee80211vap *); 287292203Savosstatic void urtwn_get_tsf(struct urtwn_softc *, uint64_t *); 288251538Srpaulostatic void urtwn_set_led(struct urtwn_softc *, int, int); 289289811Savosstatic void urtwn_set_mode(struct urtwn_softc *, uint8_t); 290290651Savosstatic void urtwn_ibss_recv_mgmt(struct ieee80211_node *, 291290651Savos struct mbuf *, int, 292290651Savos const struct ieee80211_rx_stats *, int, int); 293281069Srpaulostatic int urtwn_newstate(struct ieee80211vap *, 294251538Srpaulo enum ieee80211_state, int); 295294473Savosstatic void urtwn_calib_to(void *); 296294473Savosstatic void urtwn_calib_cb(struct urtwn_softc *, 297294473Savos union sec_param *); 298251538Srpaulostatic void urtwn_watchdog(void *); 299251538Srpaulostatic void urtwn_update_avgrssi(struct urtwn_softc *, int, int8_t); 300251538Srpaulostatic int8_t urtwn_get_rssi(struct urtwn_softc *, int, void *); 301264912Skevlostatic int8_t urtwn_r88e_get_rssi(struct urtwn_softc *, int, void *); 302290630Savosstatic int urtwn_tx_data(struct urtwn_softc *, 303251538Srpaulo struct ieee80211_node *, struct mbuf *, 304251538Srpaulo struct urtwn_data *); 305292221Savosstatic int urtwn_tx_raw(struct urtwn_softc *, 306292221Savos struct ieee80211_node *, struct mbuf *, 307292221Savos struct urtwn_data *, 308292221Savos const struct ieee80211_bpf_params *); 309290630Savosstatic void urtwn_tx_start(struct urtwn_softc *, struct mbuf *, 310290630Savos uint8_t, struct urtwn_data *); 311287197Sglebiusstatic int urtwn_transmit(struct ieee80211com *, struct mbuf *); 312287197Sglebiusstatic void urtwn_start(struct urtwn_softc *); 313287197Sglebiusstatic void urtwn_parent(struct ieee80211com *); 314264912Skevlostatic int urtwn_r92c_power_on(struct urtwn_softc *); 315264912Skevlostatic int urtwn_r88e_power_on(struct urtwn_softc *); 316295874Savosstatic void urtwn_r92c_power_off(struct urtwn_softc *); 317295874Savosstatic void urtwn_r88e_power_off(struct urtwn_softc *); 318251538Srpaulostatic int urtwn_llt_init(struct urtwn_softc *); 319295871Savos#ifndef URTWN_WITHOUT_UCODE 320251538Srpaulostatic void urtwn_fw_reset(struct urtwn_softc *); 321264912Skevlostatic void urtwn_r88e_fw_reset(struct urtwn_softc *); 322281069Srpaulostatic int urtwn_fw_loadpage(struct urtwn_softc *, int, 323251538Srpaulo const uint8_t *, int); 324251538Srpaulostatic int urtwn_load_firmware(struct urtwn_softc *); 325295871Savos#endif 326291902Skevlostatic int urtwn_dma_init(struct urtwn_softc *); 327291698Savosstatic int urtwn_mac_init(struct urtwn_softc *); 328251538Srpaulostatic void urtwn_bb_init(struct urtwn_softc *); 329251538Srpaulostatic void urtwn_rf_init(struct urtwn_softc *); 330251538Srpaulostatic void urtwn_cam_init(struct urtwn_softc *); 331292175Savosstatic int urtwn_cam_write(struct urtwn_softc *, uint32_t, 332292175Savos uint32_t); 333251538Srpaulostatic void urtwn_pa_bias_init(struct urtwn_softc *); 334251538Srpaulostatic void urtwn_rxfilter_init(struct urtwn_softc *); 335251538Srpaulostatic void urtwn_edca_init(struct urtwn_softc *); 336281069Srpaulostatic void urtwn_write_txpower(struct urtwn_softc *, int, 337251538Srpaulo uint16_t[]); 338251538Srpaulostatic void urtwn_get_txpower(struct urtwn_softc *, int, 339281069Srpaulo struct ieee80211_channel *, 340251538Srpaulo struct ieee80211_channel *, uint16_t[]); 341264912Skevlostatic void urtwn_r88e_get_txpower(struct urtwn_softc *, int, 342281069Srpaulo struct ieee80211_channel *, 343264912Skevlo struct ieee80211_channel *, uint16_t[]); 344251538Srpaulostatic void urtwn_set_txpower(struct urtwn_softc *, 345281069Srpaulo struct ieee80211_channel *, 346251538Srpaulo struct ieee80211_channel *); 347290048Savosstatic void urtwn_set_rx_bssid_all(struct urtwn_softc *, int); 348290048Savosstatic void urtwn_set_gain(struct urtwn_softc *, uint8_t); 349251538Srpaulostatic void urtwn_scan_start(struct ieee80211com *); 350251538Srpaulostatic void urtwn_scan_end(struct ieee80211com *); 351251538Srpaulostatic void urtwn_set_channel(struct ieee80211com *); 352292014Savosstatic int urtwn_wme_update(struct ieee80211com *); 353294465Savosstatic void urtwn_update_slot(struct ieee80211com *); 354294465Savosstatic void urtwn_update_slot_cb(struct urtwn_softc *, 355294465Savos union sec_param *); 356294465Savosstatic void urtwn_update_aifs(struct urtwn_softc *, uint8_t); 357290564Savosstatic void urtwn_set_promisc(struct urtwn_softc *); 358290564Savosstatic void urtwn_update_promisc(struct ieee80211com *); 359289066Skevlostatic void urtwn_update_mcast(struct ieee80211com *); 360292167Savosstatic struct ieee80211_node *urtwn_r88e_node_alloc(struct ieee80211vap *, 361292167Savos const uint8_t mac[IEEE80211_ADDR_LEN]); 362292167Savosstatic void urtwn_r88e_newassoc(struct ieee80211_node *, int); 363292167Savosstatic void urtwn_r88e_node_free(struct ieee80211_node *); 364251538Srpaulostatic void urtwn_set_chan(struct urtwn_softc *, 365281069Srpaulo struct ieee80211_channel *, 366251538Srpaulo struct ieee80211_channel *); 367251538Srpaulostatic void urtwn_iq_calib(struct urtwn_softc *); 368251538Srpaulostatic void urtwn_lc_calib(struct urtwn_softc *); 369294473Savosstatic void urtwn_temp_calib(struct urtwn_softc *); 370291698Savosstatic int urtwn_init(struct urtwn_softc *); 371287197Sglebiusstatic void urtwn_stop(struct urtwn_softc *); 372251538Srpaulostatic void urtwn_abort_xfers(struct urtwn_softc *); 373251538Srpaulostatic int urtwn_raw_xmit(struct ieee80211_node *, struct mbuf *, 374251538Srpaulo const struct ieee80211_bpf_params *); 375266472Shselaskystatic void urtwn_ms_delay(struct urtwn_softc *); 376251538Srpaulo 377251538Srpaulo/* Aliases. */ 378251538Srpaulo#define urtwn_bb_write urtwn_write_4 379251538Srpaulo#define urtwn_bb_read urtwn_read_4 380251538Srpaulo 381251538Srpaulostatic const struct usb_config urtwn_config[URTWN_N_TRANSFER] = { 382251538Srpaulo [URTWN_BULK_RX] = { 383251538Srpaulo .type = UE_BULK, 384251538Srpaulo .endpoint = UE_ADDR_ANY, 385251538Srpaulo .direction = UE_DIR_IN, 386251538Srpaulo .bufsize = URTWN_RXBUFSZ, 387251538Srpaulo .flags = { 388251538Srpaulo .pipe_bof = 1, 389251538Srpaulo .short_xfer_ok = 1 390251538Srpaulo }, 391251538Srpaulo .callback = urtwn_bulk_rx_callback, 392251538Srpaulo }, 393251538Srpaulo [URTWN_BULK_TX_BE] = { 394251538Srpaulo .type = UE_BULK, 395251538Srpaulo .endpoint = 0x03, 396251538Srpaulo .direction = UE_DIR_OUT, 397251538Srpaulo .bufsize = URTWN_TXBUFSZ, 398251538Srpaulo .flags = { 399251538Srpaulo .ext_buffer = 1, 400251538Srpaulo .pipe_bof = 1, 401251538Srpaulo .force_short_xfer = 1 402251538Srpaulo }, 403251538Srpaulo .callback = urtwn_bulk_tx_callback, 404251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 405251538Srpaulo }, 406251538Srpaulo [URTWN_BULK_TX_BK] = { 407251538Srpaulo .type = UE_BULK, 408251538Srpaulo .endpoint = 0x03, 409251538Srpaulo .direction = UE_DIR_OUT, 410251538Srpaulo .bufsize = URTWN_TXBUFSZ, 411251538Srpaulo .flags = { 412251538Srpaulo .ext_buffer = 1, 413251538Srpaulo .pipe_bof = 1, 414251538Srpaulo .force_short_xfer = 1, 415251538Srpaulo }, 416251538Srpaulo .callback = urtwn_bulk_tx_callback, 417251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 418251538Srpaulo }, 419251538Srpaulo [URTWN_BULK_TX_VI] = { 420251538Srpaulo .type = UE_BULK, 421251538Srpaulo .endpoint = 0x02, 422251538Srpaulo .direction = UE_DIR_OUT, 423251538Srpaulo .bufsize = URTWN_TXBUFSZ, 424251538Srpaulo .flags = { 425251538Srpaulo .ext_buffer = 1, 426251538Srpaulo .pipe_bof = 1, 427251538Srpaulo .force_short_xfer = 1 428251538Srpaulo }, 429251538Srpaulo .callback = urtwn_bulk_tx_callback, 430251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 431251538Srpaulo }, 432251538Srpaulo [URTWN_BULK_TX_VO] = { 433251538Srpaulo .type = UE_BULK, 434251538Srpaulo .endpoint = 0x02, 435251538Srpaulo .direction = UE_DIR_OUT, 436251538Srpaulo .bufsize = URTWN_TXBUFSZ, 437251538Srpaulo .flags = { 438251538Srpaulo .ext_buffer = 1, 439251538Srpaulo .pipe_bof = 1, 440251538Srpaulo .force_short_xfer = 1 441251538Srpaulo }, 442251538Srpaulo .callback = urtwn_bulk_tx_callback, 443251538Srpaulo .timeout = URTWN_TX_TIMEOUT, /* ms */ 444251538Srpaulo }, 445251538Srpaulo}; 446251538Srpaulo 447292014Savosstatic const struct wme_to_queue { 448292014Savos uint16_t reg; 449292014Savos uint8_t qid; 450292014Savos} wme2queue[WME_NUM_AC] = { 451292014Savos { R92C_EDCA_BE_PARAM, URTWN_BULK_TX_BE}, 452292014Savos { R92C_EDCA_BK_PARAM, URTWN_BULK_TX_BK}, 453292014Savos { R92C_EDCA_VI_PARAM, URTWN_BULK_TX_VI}, 454292014Savos { R92C_EDCA_VO_PARAM, URTWN_BULK_TX_VO} 455292014Savos}; 456292014Savos 457251538Srpaulostatic int 458251538Srpaulourtwn_match(device_t self) 459251538Srpaulo{ 460251538Srpaulo struct usb_attach_arg *uaa = device_get_ivars(self); 461251538Srpaulo 462251538Srpaulo if (uaa->usb_mode != USB_MODE_HOST) 463251538Srpaulo return (ENXIO); 464251538Srpaulo if (uaa->info.bConfigIndex != URTWN_CONFIG_INDEX) 465251538Srpaulo return (ENXIO); 466251538Srpaulo if (uaa->info.bIfaceIndex != URTWN_IFACE_INDEX) 467251538Srpaulo return (ENXIO); 468251538Srpaulo 469251538Srpaulo return (usbd_lookup_id_by_uaa(urtwn_devs, sizeof(urtwn_devs), uaa)); 470251538Srpaulo} 471251538Srpaulo 472297175Sadrianstatic void 473297175Sadrianurtwn_update_chw(struct ieee80211com *ic) 474297175Sadrian{ 475297175Sadrian} 476297175Sadrian 477251538Srpaulostatic int 478297175Sadrianurtwn_ampdu_enable(struct ieee80211_node *ni, struct ieee80211_tx_ampdu *tap) 479297175Sadrian{ 480297175Sadrian 481297175Sadrian /* We're driving this ourselves (eventually); don't involve net80211 */ 482297175Sadrian return (0); 483297175Sadrian} 484297175Sadrian 485297175Sadrianstatic int 486251538Srpaulourtwn_attach(device_t self) 487251538Srpaulo{ 488251538Srpaulo struct usb_attach_arg *uaa = device_get_ivars(self); 489251538Srpaulo struct urtwn_softc *sc = device_get_softc(self); 490287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 491293339Savos uint8_t bands[howmany(IEEE80211_MODE_MAX, 8)]; 492251538Srpaulo int error; 493251538Srpaulo 494251538Srpaulo device_set_usb_desc(self); 495251538Srpaulo sc->sc_udev = uaa->device; 496251538Srpaulo sc->sc_dev = self; 497264912Skevlo if (USB_GET_DRIVER_INFO(uaa) == URTWN_RTL8188E) 498264912Skevlo sc->chip |= URTWN_CHIP_88E; 499251538Srpaulo 500294471Savos#ifdef USB_DEBUG 501294471Savos int debug; 502294471Savos if (resource_int_value(device_get_name(sc->sc_dev), 503294471Savos device_get_unit(sc->sc_dev), "debug", &debug) == 0) 504294471Savos sc->sc_debug = debug; 505294471Savos#endif 506294471Savos 507251538Srpaulo mtx_init(&sc->sc_mtx, device_get_nameunit(self), 508251538Srpaulo MTX_NETWORK_LOCK, MTX_DEF); 509292174Savos URTWN_CMDQ_LOCK_INIT(sc); 510292167Savos URTWN_NT_LOCK_INIT(sc); 511294473Savos callout_init(&sc->sc_calib_to, 0); 512251538Srpaulo callout_init(&sc->sc_watchdog_ch, 0); 513287197Sglebius mbufq_init(&sc->sc_snd, ifqmaxlen); 514251538Srpaulo 515291902Skevlo sc->sc_iface_index = URTWN_IFACE_INDEX; 516291902Skevlo error = usbd_transfer_setup(uaa->device, &sc->sc_iface_index, 517291902Skevlo sc->sc_xfer, urtwn_config, URTWN_N_TRANSFER, sc, &sc->sc_mtx); 518251538Srpaulo if (error) { 519251538Srpaulo device_printf(self, "could not allocate USB transfers, " 520251538Srpaulo "err=%s\n", usbd_errstr(error)); 521251538Srpaulo goto detach; 522251538Srpaulo } 523251538Srpaulo 524251538Srpaulo URTWN_LOCK(sc); 525251538Srpaulo 526251538Srpaulo error = urtwn_read_chipid(sc); 527251538Srpaulo if (error) { 528251538Srpaulo device_printf(sc->sc_dev, "unsupported test chip\n"); 529251538Srpaulo URTWN_UNLOCK(sc); 530251538Srpaulo goto detach; 531251538Srpaulo } 532251538Srpaulo 533251538Srpaulo /* Determine number of Tx/Rx chains. */ 534251538Srpaulo if (sc->chip & URTWN_CHIP_92C) { 535251538Srpaulo sc->ntxchains = (sc->chip & URTWN_CHIP_92C_1T2R) ? 1 : 2; 536251538Srpaulo sc->nrxchains = 2; 537251538Srpaulo } else { 538251538Srpaulo sc->ntxchains = 1; 539251538Srpaulo sc->nrxchains = 1; 540251538Srpaulo } 541251538Srpaulo 542264912Skevlo if (sc->chip & URTWN_CHIP_88E) 543291264Savos error = urtwn_r88e_read_rom(sc); 544264912Skevlo else 545291264Savos error = urtwn_read_rom(sc); 546291264Savos if (error != 0) { 547291264Savos device_printf(sc->sc_dev, "%s: cannot read rom, error %d\n", 548291264Savos __func__, error); 549291264Savos URTWN_UNLOCK(sc); 550291264Savos goto detach; 551291264Savos } 552264912Skevlo 553251538Srpaulo device_printf(sc->sc_dev, "MAC/BB RTL%s, RF 6052 %dT%dR\n", 554251538Srpaulo (sc->chip & URTWN_CHIP_92C) ? "8192CU" : 555264912Skevlo (sc->chip & URTWN_CHIP_88E) ? "8188EU" : 556251538Srpaulo (sc->board_type == R92C_BOARD_TYPE_HIGHPA) ? "8188RU" : 557251538Srpaulo (sc->board_type == R92C_BOARD_TYPE_MINICARD) ? "8188CE-VAU" : 558251538Srpaulo "8188CUS", sc->ntxchains, sc->nrxchains); 559251538Srpaulo 560251538Srpaulo URTWN_UNLOCK(sc); 561251538Srpaulo 562283537Sglebius ic->ic_softc = sc; 563283527Sglebius ic->ic_name = device_get_nameunit(self); 564251538Srpaulo ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ 565251538Srpaulo ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */ 566251538Srpaulo 567251538Srpaulo /* set device capabilities */ 568251538Srpaulo ic->ic_caps = 569251538Srpaulo IEEE80211_C_STA /* station mode */ 570251538Srpaulo | IEEE80211_C_MONITOR /* monitor mode */ 571290651Savos | IEEE80211_C_IBSS /* adhoc mode */ 572290631Savos | IEEE80211_C_HOSTAP /* hostap mode */ 573251538Srpaulo | IEEE80211_C_SHPREAMBLE /* short preamble supported */ 574251538Srpaulo | IEEE80211_C_SHSLOT /* short slot time supported */ 575297175Sadrian#if 0 576251538Srpaulo | IEEE80211_C_BGSCAN /* capable of bg scanning */ 577297175Sadrian#endif 578251538Srpaulo | IEEE80211_C_WPA /* 802.11i */ 579292014Savos | IEEE80211_C_WME /* 802.11e */ 580251538Srpaulo ; 581251538Srpaulo 582292175Savos ic->ic_cryptocaps = 583292175Savos IEEE80211_CRYPTO_WEP | 584292175Savos IEEE80211_CRYPTO_TKIP | 585292175Savos IEEE80211_CRYPTO_AES_CCM; 586292175Savos 587297175Sadrian /* Assume they're all 11n capable for now */ 588297175Sadrian if (urtwn_enable_11n) { 589297175Sadrian device_printf(self, "enabling 11n\n"); 590297175Sadrian ic->ic_htcaps = IEEE80211_HTC_HT | 591297175Sadrian IEEE80211_HTC_AMPDU | 592297175Sadrian IEEE80211_HTC_AMSDU | 593297175Sadrian IEEE80211_HTCAP_MAXAMSDU_3839 | 594297175Sadrian IEEE80211_HTCAP_SMPS_OFF; 595297175Sadrian /* no HT40 just yet */ 596297175Sadrian // ic->ic_htcaps |= IEEE80211_HTCAP_CHWIDTH40; 597297175Sadrian 598297175Sadrian /* XXX TODO: verify chains versus streams for urtwn */ 599297175Sadrian ic->ic_txstream = sc->ntxchains; 600297175Sadrian ic->ic_rxstream = sc->nrxchains; 601297175Sadrian } 602297175Sadrian 603293339Savos memset(bands, 0, sizeof(bands)); 604293339Savos setbit(bands, IEEE80211_MODE_11B); 605293339Savos setbit(bands, IEEE80211_MODE_11G); 606297175Sadrian if (urtwn_enable_11n) 607297175Sadrian setbit(bands, IEEE80211_MODE_11NG); 608293339Savos ieee80211_init_channels(ic, NULL, bands); 609251538Srpaulo 610287197Sglebius ieee80211_ifattach(ic); 611251538Srpaulo ic->ic_raw_xmit = urtwn_raw_xmit; 612251538Srpaulo ic->ic_scan_start = urtwn_scan_start; 613251538Srpaulo ic->ic_scan_end = urtwn_scan_end; 614251538Srpaulo ic->ic_set_channel = urtwn_set_channel; 615287197Sglebius ic->ic_transmit = urtwn_transmit; 616287197Sglebius ic->ic_parent = urtwn_parent; 617251538Srpaulo ic->ic_vap_create = urtwn_vap_create; 618251538Srpaulo ic->ic_vap_delete = urtwn_vap_delete; 619292014Savos ic->ic_wme.wme_update = urtwn_wme_update; 620294465Savos ic->ic_updateslot = urtwn_update_slot; 621290564Savos ic->ic_update_promisc = urtwn_update_promisc; 622251538Srpaulo ic->ic_update_mcast = urtwn_update_mcast; 623292167Savos if (sc->chip & URTWN_CHIP_88E) { 624292167Savos ic->ic_node_alloc = urtwn_r88e_node_alloc; 625292167Savos ic->ic_newassoc = urtwn_r88e_newassoc; 626292167Savos sc->sc_node_free = ic->ic_node_free; 627292167Savos ic->ic_node_free = urtwn_r88e_node_free; 628292167Savos } 629297175Sadrian ic->ic_update_chw = urtwn_update_chw; 630297175Sadrian ic->ic_ampdu_enable = urtwn_ampdu_enable; 631251538Srpaulo 632281069Srpaulo ieee80211_radiotap_attach(ic, &sc->sc_txtap.wt_ihdr, 633251538Srpaulo sizeof(sc->sc_txtap), URTWN_TX_RADIOTAP_PRESENT, 634251538Srpaulo &sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap), 635251538Srpaulo URTWN_RX_RADIOTAP_PRESENT); 636251538Srpaulo 637292174Savos TASK_INIT(&sc->cmdq_task, 0, urtwn_cmdq_cb, sc); 638292174Savos 639294471Savos urtwn_sysctlattach(sc); 640294471Savos 641251538Srpaulo if (bootverbose) 642251538Srpaulo ieee80211_announce(ic); 643251538Srpaulo 644251538Srpaulo return (0); 645251538Srpaulo 646251538Srpaulodetach: 647251538Srpaulo urtwn_detach(self); 648251538Srpaulo return (ENXIO); /* failure */ 649251538Srpaulo} 650251538Srpaulo 651294471Savosstatic void 652294471Savosurtwn_sysctlattach(struct urtwn_softc *sc) 653294471Savos{ 654294471Savos#ifdef USB_DEBUG 655294471Savos struct sysctl_ctx_list *ctx = device_get_sysctl_ctx(sc->sc_dev); 656294471Savos struct sysctl_oid *tree = device_get_sysctl_tree(sc->sc_dev); 657294471Savos 658294471Savos SYSCTL_ADD_U32(ctx, SYSCTL_CHILDREN(tree), OID_AUTO, 659294471Savos "debug", CTLFLAG_RW, &sc->sc_debug, sc->sc_debug, 660294471Savos "control debugging printfs"); 661294471Savos#endif 662294471Savos} 663294471Savos 664251538Srpaulostatic int 665251538Srpaulourtwn_detach(device_t self) 666251538Srpaulo{ 667251538Srpaulo struct urtwn_softc *sc = device_get_softc(self); 668287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 669263153Skevlo unsigned int x; 670281069Srpaulo 671263153Skevlo /* Prevent further ioctls. */ 672263153Skevlo URTWN_LOCK(sc); 673263153Skevlo sc->sc_flags |= URTWN_DETACHED; 674263153Skevlo URTWN_UNLOCK(sc); 675251538Srpaulo 676291698Savos urtwn_stop(sc); 677291698Savos 678251538Srpaulo callout_drain(&sc->sc_watchdog_ch); 679294473Savos callout_drain(&sc->sc_calib_to); 680251538Srpaulo 681288353Sadrian /* stop all USB transfers */ 682288353Sadrian usbd_transfer_unsetup(sc->sc_xfer, URTWN_N_TRANSFER); 683288353Sadrian 684263153Skevlo /* Prevent further allocations from RX/TX data lists. */ 685263153Skevlo URTWN_LOCK(sc); 686263153Skevlo STAILQ_INIT(&sc->sc_tx_active); 687263153Skevlo STAILQ_INIT(&sc->sc_tx_inactive); 688263153Skevlo STAILQ_INIT(&sc->sc_tx_pending); 689263153Skevlo 690263153Skevlo STAILQ_INIT(&sc->sc_rx_active); 691263153Skevlo STAILQ_INIT(&sc->sc_rx_inactive); 692263153Skevlo URTWN_UNLOCK(sc); 693263153Skevlo 694263153Skevlo /* drain USB transfers */ 695263153Skevlo for (x = 0; x != URTWN_N_TRANSFER; x++) 696263153Skevlo usbd_transfer_drain(sc->sc_xfer[x]); 697263153Skevlo 698263153Skevlo /* Free data buffers. */ 699263153Skevlo URTWN_LOCK(sc); 700263153Skevlo urtwn_free_tx_list(sc); 701263153Skevlo urtwn_free_rx_list(sc); 702263153Skevlo URTWN_UNLOCK(sc); 703263153Skevlo 704292174Savos if (ic->ic_softc == sc) { 705292174Savos ieee80211_draintask(ic, &sc->cmdq_task); 706292174Savos ieee80211_ifdetach(ic); 707292174Savos } 708292174Savos 709292167Savos URTWN_NT_LOCK_DESTROY(sc); 710292174Savos URTWN_CMDQ_LOCK_DESTROY(sc); 711251538Srpaulo mtx_destroy(&sc->sc_mtx); 712251538Srpaulo 713251538Srpaulo return (0); 714251538Srpaulo} 715251538Srpaulo 716251538Srpaulostatic void 717289066Skevlourtwn_drain_mbufq(struct urtwn_softc *sc) 718251538Srpaulo{ 719289066Skevlo struct mbuf *m; 720289066Skevlo struct ieee80211_node *ni; 721289066Skevlo URTWN_ASSERT_LOCKED(sc); 722289066Skevlo while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) { 723289066Skevlo ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 724289066Skevlo m->m_pkthdr.rcvif = NULL; 725289066Skevlo ieee80211_free_node(ni); 726289066Skevlo m_freem(m); 727251538Srpaulo } 728251538Srpaulo} 729251538Srpaulo 730251538Srpaulostatic usb_error_t 731251538Srpaulourtwn_do_request(struct urtwn_softc *sc, struct usb_device_request *req, 732251538Srpaulo void *data) 733251538Srpaulo{ 734251538Srpaulo usb_error_t err; 735251538Srpaulo int ntries = 10; 736251538Srpaulo 737251538Srpaulo URTWN_ASSERT_LOCKED(sc); 738251538Srpaulo 739251538Srpaulo while (ntries--) { 740251538Srpaulo err = usbd_do_request_flags(sc->sc_udev, &sc->sc_mtx, 741251538Srpaulo req, data, 0, NULL, 250 /* ms */); 742251538Srpaulo if (err == 0) 743251538Srpaulo break; 744251538Srpaulo 745294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_USB, 746294471Savos "%s: control request failed, %s (retries left: %d)\n", 747294471Savos __func__, usbd_errstr(err), ntries); 748251538Srpaulo usb_pause_mtx(&sc->sc_mtx, hz / 100); 749251538Srpaulo } 750251538Srpaulo return (err); 751251538Srpaulo} 752251538Srpaulo 753251538Srpaulostatic struct ieee80211vap * 754251538Srpaulourtwn_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit, 755251538Srpaulo enum ieee80211_opmode opmode, int flags, 756251538Srpaulo const uint8_t bssid[IEEE80211_ADDR_LEN], 757251538Srpaulo const uint8_t mac[IEEE80211_ADDR_LEN]) 758251538Srpaulo{ 759290631Savos struct urtwn_softc *sc = ic->ic_softc; 760251538Srpaulo struct urtwn_vap *uvp; 761251538Srpaulo struct ieee80211vap *vap; 762251538Srpaulo 763251538Srpaulo if (!TAILQ_EMPTY(&ic->ic_vaps)) /* only one at a time */ 764251538Srpaulo return (NULL); 765251538Srpaulo 766287197Sglebius uvp = malloc(sizeof(struct urtwn_vap), M_80211_VAP, M_WAITOK | M_ZERO); 767251538Srpaulo vap = &uvp->vap; 768251538Srpaulo /* enable s/w bmiss handling for sta mode */ 769251538Srpaulo 770281069Srpaulo if (ieee80211_vap_setup(ic, vap, name, unit, opmode, 771287197Sglebius flags | IEEE80211_CLONE_NOBEACONS, bssid) != 0) { 772257743Shselasky /* out of memory */ 773257743Shselasky free(uvp, M_80211_VAP); 774257743Shselasky return (NULL); 775257743Shselasky } 776257743Shselasky 777290651Savos if (opmode == IEEE80211_M_HOSTAP || opmode == IEEE80211_M_IBSS) 778290631Savos urtwn_init_beacon(sc, uvp); 779290631Savos 780251538Srpaulo /* override state transition machine */ 781251538Srpaulo uvp->newstate = vap->iv_newstate; 782251538Srpaulo vap->iv_newstate = urtwn_newstate; 783290631Savos vap->iv_update_beacon = urtwn_update_beacon; 784292175Savos vap->iv_key_alloc = urtwn_key_alloc; 785292175Savos vap->iv_key_set = urtwn_key_set; 786292175Savos vap->iv_key_delete = urtwn_key_delete; 787290651Savos if (opmode == IEEE80211_M_IBSS) { 788290651Savos uvp->recv_mgmt = vap->iv_recv_mgmt; 789290651Savos vap->iv_recv_mgmt = urtwn_ibss_recv_mgmt; 790290651Savos TASK_INIT(&uvp->tsf_task_adhoc, 0, urtwn_tsf_task_adhoc, vap); 791290651Savos } 792251538Srpaulo 793292167Savos if (URTWN_CHIP_HAS_RATECTL(sc)) 794292167Savos ieee80211_ratectl_init(vap); 795251538Srpaulo /* complete setup */ 796251538Srpaulo ieee80211_vap_attach(vap, ieee80211_media_change, 797287197Sglebius ieee80211_media_status, mac); 798251538Srpaulo ic->ic_opmode = opmode; 799251538Srpaulo return (vap); 800251538Srpaulo} 801251538Srpaulo 802251538Srpaulostatic void 803251538Srpaulourtwn_vap_delete(struct ieee80211vap *vap) 804251538Srpaulo{ 805290651Savos struct ieee80211com *ic = vap->iv_ic; 806292167Savos struct urtwn_softc *sc = ic->ic_softc; 807251538Srpaulo struct urtwn_vap *uvp = URTWN_VAP(vap); 808251538Srpaulo 809290651Savos if (uvp->bcn_mbuf != NULL) 810290651Savos m_freem(uvp->bcn_mbuf); 811290651Savos if (vap->iv_opmode == IEEE80211_M_IBSS) 812290651Savos ieee80211_draintask(ic, &uvp->tsf_task_adhoc); 813292167Savos if (URTWN_CHIP_HAS_RATECTL(sc)) 814292167Savos ieee80211_ratectl_deinit(vap); 815251538Srpaulo ieee80211_vap_detach(vap); 816251538Srpaulo free(uvp, M_80211_VAP); 817251538Srpaulo} 818251538Srpaulo 819251538Srpaulostatic struct mbuf * 820292207Savosurtwn_rx_copy_to_mbuf(struct urtwn_softc *sc, struct r92c_rx_stat *stat, 821292207Savos int totlen) 822251538Srpaulo{ 823287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 824251538Srpaulo struct mbuf *m; 825292207Savos uint32_t rxdw0; 826292207Savos int pktlen; 827251538Srpaulo 828251538Srpaulo /* 829251538Srpaulo * don't pass packets to the ieee80211 framework if the driver isn't 830251538Srpaulo * RUNNING. 831251538Srpaulo */ 832287197Sglebius if (!(sc->sc_flags & URTWN_RUNNING)) 833251538Srpaulo return (NULL); 834251538Srpaulo 835251538Srpaulo rxdw0 = le32toh(stat->rxdw0); 836251538Srpaulo if (rxdw0 & (R92C_RXDW0_CRCERR | R92C_RXDW0_ICVERR)) { 837251538Srpaulo /* 838251538Srpaulo * This should not happen since we setup our Rx filter 839251538Srpaulo * to not receive these frames. 840251538Srpaulo */ 841294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_RECV, 842294471Savos "%s: RX flags error (%s)\n", __func__, 843292207Savos rxdw0 & R92C_RXDW0_CRCERR ? "CRC" : "ICV"); 844292207Savos goto fail; 845251538Srpaulo } 846292207Savos 847292207Savos pktlen = MS(rxdw0, R92C_RXDW0_PKTLEN); 848292207Savos if (pktlen < sizeof(struct ieee80211_frame_ack)) { 849294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_RECV, 850294471Savos "%s: frame is too short: %d\n", __func__, pktlen); 851292207Savos goto fail; 852271303Skevlo } 853251538Srpaulo 854292207Savos if (__predict_false(totlen > MCLBYTES)) { 855292207Savos /* convert to m_getjcl if this happens */ 856292207Savos device_printf(sc->sc_dev, "%s: frame too long: %d (%d)\n", 857292207Savos __func__, pktlen, totlen); 858292207Savos goto fail; 859251538Srpaulo } 860251538Srpaulo 861260463Skevlo m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 862292207Savos if (__predict_false(m == NULL)) { 863292207Savos device_printf(sc->sc_dev, "%s: could not allocate RX mbuf\n", 864292207Savos __func__); 865292207Savos goto fail; 866251538Srpaulo } 867251538Srpaulo 868251538Srpaulo /* Finalize mbuf. */ 869292207Savos memcpy(mtod(m, uint8_t *), (uint8_t *)stat, totlen); 870292207Savos m->m_pkthdr.len = m->m_len = totlen; 871292207Savos 872251538Srpaulo return (m); 873292207Savosfail: 874292207Savos counter_u64_add(ic->ic_ierrors, 1); 875292207Savos return (NULL); 876251538Srpaulo} 877251538Srpaulo 878251538Srpaulostatic struct mbuf * 879292207Savosurtwn_report_intr(struct usb_xfer *xfer, struct urtwn_data *data) 880251538Srpaulo{ 881251538Srpaulo struct urtwn_softc *sc = data->sc; 882287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 883251538Srpaulo struct r92c_rx_stat *stat; 884251538Srpaulo uint8_t *buf; 885292167Savos int len; 886251538Srpaulo 887251538Srpaulo usbd_xfer_status(xfer, &len, NULL, NULL, NULL); 888251538Srpaulo 889251538Srpaulo if (len < sizeof(*stat)) { 890287197Sglebius counter_u64_add(ic->ic_ierrors, 1); 891251538Srpaulo return (NULL); 892251538Srpaulo } 893251538Srpaulo 894251538Srpaulo buf = data->buf; 895292167Savos stat = (struct r92c_rx_stat *)buf; 896292167Savos 897292167Savos if (sc->chip & URTWN_CHIP_88E) { 898292167Savos int report_sel = MS(le32toh(stat->rxdw3), R88E_RXDW3_RPT); 899292167Savos 900292167Savos switch (report_sel) { 901292167Savos case R88E_RXDW3_RPT_RX: 902292207Savos return (urtwn_rxeof(sc, buf, len)); 903292167Savos case R88E_RXDW3_RPT_TX1: 904292167Savos urtwn_r88e_ratectl_tx_complete(sc, &stat[1]); 905292167Savos break; 906292167Savos default: 907294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_INTR, 908294471Savos "%s: case %d was not handled\n", __func__, 909294471Savos report_sel); 910292167Savos break; 911292167Savos } 912292167Savos } else 913292207Savos return (urtwn_rxeof(sc, buf, len)); 914292167Savos 915292167Savos return (NULL); 916292167Savos} 917292167Savos 918292167Savosstatic struct mbuf * 919292207Savosurtwn_rxeof(struct urtwn_softc *sc, uint8_t *buf, int len) 920292167Savos{ 921292167Savos struct r92c_rx_stat *stat; 922292167Savos struct mbuf *m, *m0 = NULL, *prevm = NULL; 923292167Savos uint32_t rxdw0; 924292167Savos int totlen, pktlen, infosz, npkts; 925292167Savos 926251538Srpaulo /* Get the number of encapsulated frames. */ 927251538Srpaulo stat = (struct r92c_rx_stat *)buf; 928251538Srpaulo npkts = MS(le32toh(stat->rxdw2), R92C_RXDW2_PKTCNT); 929294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_RECV, 930294471Savos "%s: Rx %d frames in one chunk\n", __func__, npkts); 931251538Srpaulo 932251538Srpaulo /* Process all of them. */ 933251538Srpaulo while (npkts-- > 0) { 934251538Srpaulo if (len < sizeof(*stat)) 935251538Srpaulo break; 936251538Srpaulo stat = (struct r92c_rx_stat *)buf; 937251538Srpaulo rxdw0 = le32toh(stat->rxdw0); 938251538Srpaulo 939251538Srpaulo pktlen = MS(rxdw0, R92C_RXDW0_PKTLEN); 940251538Srpaulo if (pktlen == 0) 941251538Srpaulo break; 942251538Srpaulo 943251538Srpaulo infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8; 944251538Srpaulo 945251538Srpaulo /* Make sure everything fits in xfer. */ 946251538Srpaulo totlen = sizeof(*stat) + infosz + pktlen; 947251538Srpaulo if (totlen > len) 948251538Srpaulo break; 949251538Srpaulo 950292207Savos m = urtwn_rx_copy_to_mbuf(sc, stat, totlen); 951251538Srpaulo if (m0 == NULL) 952251538Srpaulo m0 = m; 953251538Srpaulo if (prevm == NULL) 954251538Srpaulo prevm = m; 955251538Srpaulo else { 956251538Srpaulo prevm->m_next = m; 957251538Srpaulo prevm = m; 958251538Srpaulo } 959251538Srpaulo 960251538Srpaulo /* Next chunk is 128-byte aligned. */ 961251538Srpaulo totlen = (totlen + 127) & ~127; 962251538Srpaulo buf += totlen; 963251538Srpaulo len -= totlen; 964251538Srpaulo } 965251538Srpaulo 966251538Srpaulo return (m0); 967251538Srpaulo} 968251538Srpaulo 969251538Srpaulostatic void 970292167Savosurtwn_r88e_ratectl_tx_complete(struct urtwn_softc *sc, void *arg) 971292167Savos{ 972292167Savos struct r88e_tx_rpt_ccx *rpt = arg; 973292167Savos struct ieee80211vap *vap; 974292167Savos struct ieee80211_node *ni; 975292167Savos uint8_t macid; 976292167Savos int ntries; 977292167Savos 978292167Savos macid = MS(rpt->rptb1, R88E_RPTB1_MACID); 979292167Savos ntries = MS(rpt->rptb2, R88E_RPTB2_RETRY_CNT); 980292167Savos 981292167Savos URTWN_NT_LOCK(sc); 982292167Savos ni = sc->node_list[macid]; 983292167Savos if (ni != NULL) { 984292167Savos vap = ni->ni_vap; 985294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_INTR, "%s: frame for macid %d was" 986294471Savos "%s sent (%d retries)\n", __func__, macid, 987294471Savos (rpt->rptb1 & R88E_RPTB1_PKT_OK) ? "" : " not", 988294471Savos ntries); 989292167Savos 990292167Savos if (rpt->rptb1 & R88E_RPTB1_PKT_OK) { 991292167Savos ieee80211_ratectl_tx_complete(vap, ni, 992292167Savos IEEE80211_RATECTL_TX_SUCCESS, &ntries, NULL); 993292167Savos } else { 994292167Savos ieee80211_ratectl_tx_complete(vap, ni, 995292167Savos IEEE80211_RATECTL_TX_FAILURE, &ntries, NULL); 996292167Savos } 997294471Savos } else { 998294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_INTR, "%s: macid %d, ni is NULL\n", 999294471Savos __func__, macid); 1000294471Savos } 1001292167Savos URTWN_NT_UNLOCK(sc); 1002292167Savos} 1003292167Savos 1004292207Savosstatic struct ieee80211_node * 1005292207Savosurtwn_rx_frame(struct urtwn_softc *sc, struct mbuf *m, int8_t *rssi_p) 1006292207Savos{ 1007292207Savos struct ieee80211com *ic = &sc->sc_ic; 1008292207Savos struct ieee80211_frame_min *wh; 1009292207Savos struct r92c_rx_stat *stat; 1010292207Savos uint32_t rxdw0, rxdw3; 1011292207Savos uint8_t rate, cipher; 1012292207Savos int8_t rssi = URTWN_NOISE_FLOOR + 1; 1013292207Savos int infosz; 1014292207Savos 1015292207Savos stat = mtod(m, struct r92c_rx_stat *); 1016292207Savos rxdw0 = le32toh(stat->rxdw0); 1017292207Savos rxdw3 = le32toh(stat->rxdw3); 1018292207Savos 1019292207Savos rate = MS(rxdw3, R92C_RXDW3_RATE); 1020292207Savos cipher = MS(rxdw0, R92C_RXDW0_CIPHER); 1021292207Savos infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8; 1022292207Savos 1023292207Savos /* Get RSSI from PHY status descriptor if present. */ 1024292207Savos if (infosz != 0 && (rxdw0 & R92C_RXDW0_PHYST)) { 1025292207Savos if (sc->chip & URTWN_CHIP_88E) 1026292207Savos rssi = urtwn_r88e_get_rssi(sc, rate, &stat[1]); 1027292207Savos else 1028292207Savos rssi = urtwn_get_rssi(sc, rate, &stat[1]); 1029292207Savos /* Update our average RSSI. */ 1030292207Savos urtwn_update_avgrssi(sc, rate, rssi); 1031292207Savos } 1032292207Savos 1033292207Savos if (ieee80211_radiotap_active(ic)) { 1034292207Savos struct urtwn_rx_radiotap_header *tap = &sc->sc_rxtap; 1035292207Savos 1036292207Savos tap->wr_flags = 0; 1037292207Savos 1038292207Savos urtwn_get_tsf(sc, &tap->wr_tsft); 1039292207Savos if (__predict_false(le32toh((uint32_t)tap->wr_tsft) < 1040292207Savos le32toh(stat->rxdw5))) { 1041292207Savos tap->wr_tsft = le32toh(tap->wr_tsft >> 32) - 1; 1042292207Savos tap->wr_tsft = (uint64_t)htole32(tap->wr_tsft) << 32; 1043292207Savos } else 1044292207Savos tap->wr_tsft &= 0xffffffff00000000; 1045292207Savos tap->wr_tsft += stat->rxdw5; 1046292207Savos 1047297175Sadrian /* XXX 20/40? */ 1048297175Sadrian /* XXX shortgi? */ 1049297175Sadrian 1050292207Savos /* Map HW rate index to 802.11 rate. */ 1051292207Savos if (!(rxdw3 & R92C_RXDW3_HT)) { 1052292207Savos tap->wr_rate = ridx2rate[rate]; 1053292207Savos } else if (rate >= 12) { /* MCS0~15. */ 1054292207Savos /* Bit 7 set means HT MCS instead of rate. */ 1055292207Savos tap->wr_rate = 0x80 | (rate - 12); 1056292207Savos } 1057292207Savos tap->wr_dbm_antsignal = rssi; 1058292207Savos tap->wr_dbm_antnoise = URTWN_NOISE_FLOOR; 1059292207Savos } 1060292207Savos 1061292207Savos *rssi_p = rssi; 1062292207Savos 1063292207Savos /* Drop descriptor. */ 1064292207Savos m_adj(m, sizeof(*stat) + infosz); 1065292207Savos wh = mtod(m, struct ieee80211_frame_min *); 1066292207Savos 1067292207Savos if ((wh->i_fc[1] & IEEE80211_FC1_PROTECTED) && 1068292207Savos cipher != R92C_CAM_ALGO_NONE) { 1069292207Savos m->m_flags |= M_WEP; 1070292207Savos } 1071292207Savos 1072292207Savos if (m->m_len >= sizeof(*wh)) 1073292207Savos return (ieee80211_find_rxnode(ic, wh)); 1074292207Savos 1075292207Savos return (NULL); 1076292207Savos} 1077292207Savos 1078292167Savosstatic void 1079251538Srpaulourtwn_bulk_rx_callback(struct usb_xfer *xfer, usb_error_t error) 1080251538Srpaulo{ 1081251538Srpaulo struct urtwn_softc *sc = usbd_xfer_softc(xfer); 1082287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 1083251538Srpaulo struct ieee80211_node *ni; 1084251538Srpaulo struct mbuf *m = NULL, *next; 1085251538Srpaulo struct urtwn_data *data; 1086292207Savos int8_t nf, rssi; 1087251538Srpaulo 1088251538Srpaulo URTWN_ASSERT_LOCKED(sc); 1089251538Srpaulo 1090251538Srpaulo switch (USB_GET_STATE(xfer)) { 1091251538Srpaulo case USB_ST_TRANSFERRED: 1092251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_active); 1093251538Srpaulo if (data == NULL) 1094251538Srpaulo goto tr_setup; 1095251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 1096292207Savos m = urtwn_report_intr(xfer, data); 1097251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 1098251538Srpaulo /* FALLTHROUGH */ 1099251538Srpaulo case USB_ST_SETUP: 1100251538Srpaulotr_setup: 1101251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_inactive); 1102251538Srpaulo if (data == NULL) { 1103251538Srpaulo KASSERT(m == NULL, ("mbuf isn't NULL")); 1104251538Srpaulo return; 1105251538Srpaulo } 1106251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_inactive, next); 1107251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_active, data, next); 1108251538Srpaulo usbd_xfer_set_frame_data(xfer, 0, data->buf, 1109251538Srpaulo usbd_xfer_max_len(xfer)); 1110251538Srpaulo usbd_transfer_submit(xfer); 1111251538Srpaulo 1112251538Srpaulo /* 1113251538Srpaulo * To avoid LOR we should unlock our private mutex here to call 1114251538Srpaulo * ieee80211_input() because here is at the end of a USB 1115251538Srpaulo * callback and safe to unlock. 1116251538Srpaulo */ 1117251538Srpaulo while (m != NULL) { 1118251538Srpaulo next = m->m_next; 1119251538Srpaulo m->m_next = NULL; 1120292207Savos 1121292207Savos ni = urtwn_rx_frame(sc, m, &rssi); 1122292207Savos URTWN_UNLOCK(sc); 1123292207Savos 1124251538Srpaulo nf = URTWN_NOISE_FLOOR; 1125251538Srpaulo if (ni != NULL) { 1126297175Sadrian if (ni->ni_flags & IEEE80211_NODE_HT) 1127297175Sadrian m->m_flags |= M_AMPDU; 1128289799Savos (void)ieee80211_input(ni, m, rssi - nf, nf); 1129251538Srpaulo ieee80211_free_node(ni); 1130289799Savos } else { 1131289799Savos (void)ieee80211_input_all(ic, m, rssi - nf, 1132289799Savos nf); 1133289799Savos } 1134292207Savos 1135292207Savos URTWN_LOCK(sc); 1136251538Srpaulo m = next; 1137251538Srpaulo } 1138251538Srpaulo break; 1139251538Srpaulo default: 1140251538Srpaulo /* needs it to the inactive queue due to a error. */ 1141251538Srpaulo data = STAILQ_FIRST(&sc->sc_rx_active); 1142251538Srpaulo if (data != NULL) { 1143251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next); 1144251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next); 1145251538Srpaulo } 1146251538Srpaulo if (error != USB_ERR_CANCELLED) { 1147251538Srpaulo usbd_xfer_set_stall(xfer); 1148287197Sglebius counter_u64_add(ic->ic_ierrors, 1); 1149251538Srpaulo goto tr_setup; 1150251538Srpaulo } 1151251538Srpaulo break; 1152251538Srpaulo } 1153251538Srpaulo} 1154251538Srpaulo 1155251538Srpaulostatic void 1156289891Savosurtwn_txeof(struct urtwn_softc *sc, struct urtwn_data *data, int status) 1157251538Srpaulo{ 1158251538Srpaulo 1159251538Srpaulo URTWN_ASSERT_LOCKED(sc); 1160289891Savos 1161290631Savos if (data->ni != NULL) /* not a beacon frame */ 1162290631Savos ieee80211_tx_complete(data->ni, data->m, status); 1163289891Savos 1164287197Sglebius data->ni = NULL; 1165287197Sglebius data->m = NULL; 1166289891Savos 1167251538Srpaulo sc->sc_txtimer = 0; 1168289891Savos 1169289891Savos STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data, next); 1170251538Srpaulo} 1171251538Srpaulo 1172289066Skevlostatic int 1173289066Skevlourtwn_alloc_list(struct urtwn_softc *sc, struct urtwn_data data[], 1174289066Skevlo int ndata, int maxsz) 1175289066Skevlo{ 1176289066Skevlo int i, error; 1177289066Skevlo 1178289066Skevlo for (i = 0; i < ndata; i++) { 1179289066Skevlo struct urtwn_data *dp = &data[i]; 1180289066Skevlo dp->sc = sc; 1181289066Skevlo dp->m = NULL; 1182289066Skevlo dp->buf = malloc(maxsz, M_USBDEV, M_NOWAIT); 1183289066Skevlo if (dp->buf == NULL) { 1184289066Skevlo device_printf(sc->sc_dev, 1185289066Skevlo "could not allocate buffer\n"); 1186289066Skevlo error = ENOMEM; 1187289066Skevlo goto fail; 1188289066Skevlo } 1189289066Skevlo dp->ni = NULL; 1190289066Skevlo } 1191289066Skevlo 1192289066Skevlo return (0); 1193289066Skevlofail: 1194289066Skevlo urtwn_free_list(sc, data, ndata); 1195289066Skevlo return (error); 1196289066Skevlo} 1197289066Skevlo 1198289066Skevlostatic int 1199289066Skevlourtwn_alloc_rx_list(struct urtwn_softc *sc) 1200289066Skevlo{ 1201289066Skevlo int error, i; 1202289066Skevlo 1203289066Skevlo error = urtwn_alloc_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT, 1204289066Skevlo URTWN_RXBUFSZ); 1205289066Skevlo if (error != 0) 1206289066Skevlo return (error); 1207289066Skevlo 1208289066Skevlo STAILQ_INIT(&sc->sc_rx_active); 1209289066Skevlo STAILQ_INIT(&sc->sc_rx_inactive); 1210289066Skevlo 1211289066Skevlo for (i = 0; i < URTWN_RX_LIST_COUNT; i++) 1212289066Skevlo STAILQ_INSERT_HEAD(&sc->sc_rx_inactive, &sc->sc_rx[i], next); 1213289066Skevlo 1214289066Skevlo return (0); 1215289066Skevlo} 1216289066Skevlo 1217289066Skevlostatic int 1218289066Skevlourtwn_alloc_tx_list(struct urtwn_softc *sc) 1219289066Skevlo{ 1220289066Skevlo int error, i; 1221289066Skevlo 1222289066Skevlo error = urtwn_alloc_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT, 1223289066Skevlo URTWN_TXBUFSZ); 1224289066Skevlo if (error != 0) 1225289066Skevlo return (error); 1226289066Skevlo 1227289066Skevlo STAILQ_INIT(&sc->sc_tx_active); 1228289066Skevlo STAILQ_INIT(&sc->sc_tx_inactive); 1229289066Skevlo STAILQ_INIT(&sc->sc_tx_pending); 1230289066Skevlo 1231289066Skevlo for (i = 0; i < URTWN_TX_LIST_COUNT; i++) 1232289066Skevlo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, &sc->sc_tx[i], next); 1233289066Skevlo 1234289066Skevlo return (0); 1235289066Skevlo} 1236289066Skevlo 1237251538Srpaulostatic void 1238289066Skevlourtwn_free_list(struct urtwn_softc *sc, struct urtwn_data data[], int ndata) 1239289066Skevlo{ 1240289066Skevlo int i; 1241289066Skevlo 1242289066Skevlo for (i = 0; i < ndata; i++) { 1243289066Skevlo struct urtwn_data *dp = &data[i]; 1244289066Skevlo 1245289066Skevlo if (dp->buf != NULL) { 1246289066Skevlo free(dp->buf, M_USBDEV); 1247289066Skevlo dp->buf = NULL; 1248289066Skevlo } 1249289066Skevlo if (dp->ni != NULL) { 1250289066Skevlo ieee80211_free_node(dp->ni); 1251289066Skevlo dp->ni = NULL; 1252289066Skevlo } 1253289066Skevlo } 1254289066Skevlo} 1255289066Skevlo 1256289066Skevlostatic void 1257289066Skevlourtwn_free_rx_list(struct urtwn_softc *sc) 1258289066Skevlo{ 1259289066Skevlo urtwn_free_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT); 1260289066Skevlo} 1261289066Skevlo 1262289066Skevlostatic void 1263289066Skevlourtwn_free_tx_list(struct urtwn_softc *sc) 1264289066Skevlo{ 1265289066Skevlo urtwn_free_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT); 1266289066Skevlo} 1267289066Skevlo 1268289066Skevlostatic void 1269251538Srpaulourtwn_bulk_tx_callback(struct usb_xfer *xfer, usb_error_t error) 1270251538Srpaulo{ 1271251538Srpaulo struct urtwn_softc *sc = usbd_xfer_softc(xfer); 1272251538Srpaulo struct urtwn_data *data; 1273251538Srpaulo 1274251538Srpaulo URTWN_ASSERT_LOCKED(sc); 1275251538Srpaulo 1276251538Srpaulo switch (USB_GET_STATE(xfer)){ 1277251538Srpaulo case USB_ST_TRANSFERRED: 1278251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_active); 1279251538Srpaulo if (data == NULL) 1280251538Srpaulo goto tr_setup; 1281251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next); 1282289891Savos urtwn_txeof(sc, data, 0); 1283251538Srpaulo /* FALLTHROUGH */ 1284251538Srpaulo case USB_ST_SETUP: 1285251538Srpaulotr_setup: 1286251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_pending); 1287251538Srpaulo if (data == NULL) { 1288294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT, 1289294471Savos "%s: empty pending queue\n", __func__); 1290288353Sadrian goto finish; 1291251538Srpaulo } 1292251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_pending, next); 1293251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_tx_active, data, next); 1294251538Srpaulo usbd_xfer_set_frame_data(xfer, 0, data->buf, data->buflen); 1295251538Srpaulo usbd_transfer_submit(xfer); 1296251538Srpaulo break; 1297251538Srpaulo default: 1298251538Srpaulo data = STAILQ_FIRST(&sc->sc_tx_active); 1299251538Srpaulo if (data == NULL) 1300251538Srpaulo goto tr_setup; 1301289891Savos STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next); 1302289891Savos urtwn_txeof(sc, data, 1); 1303251538Srpaulo if (error != USB_ERR_CANCELLED) { 1304251538Srpaulo usbd_xfer_set_stall(xfer); 1305251538Srpaulo goto tr_setup; 1306251538Srpaulo } 1307251538Srpaulo break; 1308251538Srpaulo } 1309288353Sadrianfinish: 1310288353Sadrian /* Kick-start more transmit */ 1311288353Sadrian urtwn_start(sc); 1312251538Srpaulo} 1313251538Srpaulo 1314251538Srpaulostatic struct urtwn_data * 1315251538Srpaulo_urtwn_getbuf(struct urtwn_softc *sc) 1316251538Srpaulo{ 1317251538Srpaulo struct urtwn_data *bf; 1318251538Srpaulo 1319251538Srpaulo bf = STAILQ_FIRST(&sc->sc_tx_inactive); 1320251538Srpaulo if (bf != NULL) 1321251538Srpaulo STAILQ_REMOVE_HEAD(&sc->sc_tx_inactive, next); 1322294471Savos else { 1323294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT, 1324294471Savos "%s: out of xmit buffers\n", __func__); 1325294471Savos } 1326251538Srpaulo return (bf); 1327251538Srpaulo} 1328251538Srpaulo 1329251538Srpaulostatic struct urtwn_data * 1330251538Srpaulourtwn_getbuf(struct urtwn_softc *sc) 1331251538Srpaulo{ 1332251538Srpaulo struct urtwn_data *bf; 1333251538Srpaulo 1334251538Srpaulo URTWN_ASSERT_LOCKED(sc); 1335251538Srpaulo 1336251538Srpaulo bf = _urtwn_getbuf(sc); 1337294471Savos if (bf == NULL) { 1338294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT, "%s: stop queue\n", 1339294471Savos __func__); 1340294471Savos } 1341251538Srpaulo return (bf); 1342251538Srpaulo} 1343251538Srpaulo 1344291698Savosstatic usb_error_t 1345251538Srpaulourtwn_write_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf, 1346251538Srpaulo int len) 1347251538Srpaulo{ 1348251538Srpaulo usb_device_request_t req; 1349251538Srpaulo 1350251538Srpaulo req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 1351251538Srpaulo req.bRequest = R92C_REQ_REGS; 1352251538Srpaulo USETW(req.wValue, addr); 1353251538Srpaulo USETW(req.wIndex, 0); 1354251538Srpaulo USETW(req.wLength, len); 1355251538Srpaulo return (urtwn_do_request(sc, &req, buf)); 1356251538Srpaulo} 1357251538Srpaulo 1358291698Savosstatic usb_error_t 1359251538Srpaulourtwn_write_1(struct urtwn_softc *sc, uint16_t addr, uint8_t val) 1360251538Srpaulo{ 1361291698Savos return (urtwn_write_region_1(sc, addr, &val, sizeof(val))); 1362251538Srpaulo} 1363251538Srpaulo 1364291698Savosstatic usb_error_t 1365251538Srpaulourtwn_write_2(struct urtwn_softc *sc, uint16_t addr, uint16_t val) 1366251538Srpaulo{ 1367251538Srpaulo val = htole16(val); 1368291698Savos return (urtwn_write_region_1(sc, addr, (uint8_t *)&val, sizeof(val))); 1369251538Srpaulo} 1370251538Srpaulo 1371291698Savosstatic usb_error_t 1372251538Srpaulourtwn_write_4(struct urtwn_softc *sc, uint16_t addr, uint32_t val) 1373251538Srpaulo{ 1374251538Srpaulo val = htole32(val); 1375291698Savos return (urtwn_write_region_1(sc, addr, (uint8_t *)&val, sizeof(val))); 1376251538Srpaulo} 1377251538Srpaulo 1378291698Savosstatic usb_error_t 1379251538Srpaulourtwn_read_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf, 1380251538Srpaulo int len) 1381251538Srpaulo{ 1382251538Srpaulo usb_device_request_t req; 1383251538Srpaulo 1384251538Srpaulo req.bmRequestType = UT_READ_VENDOR_DEVICE; 1385251538Srpaulo req.bRequest = R92C_REQ_REGS; 1386251538Srpaulo USETW(req.wValue, addr); 1387251538Srpaulo USETW(req.wIndex, 0); 1388251538Srpaulo USETW(req.wLength, len); 1389251538Srpaulo return (urtwn_do_request(sc, &req, buf)); 1390251538Srpaulo} 1391251538Srpaulo 1392251538Srpaulostatic uint8_t 1393251538Srpaulourtwn_read_1(struct urtwn_softc *sc, uint16_t addr) 1394251538Srpaulo{ 1395251538Srpaulo uint8_t val; 1396251538Srpaulo 1397251538Srpaulo if (urtwn_read_region_1(sc, addr, &val, 1) != 0) 1398251538Srpaulo return (0xff); 1399251538Srpaulo return (val); 1400251538Srpaulo} 1401251538Srpaulo 1402251538Srpaulostatic uint16_t 1403251538Srpaulourtwn_read_2(struct urtwn_softc *sc, uint16_t addr) 1404251538Srpaulo{ 1405251538Srpaulo uint16_t val; 1406251538Srpaulo 1407251538Srpaulo if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 2) != 0) 1408251538Srpaulo return (0xffff); 1409251538Srpaulo return (le16toh(val)); 1410251538Srpaulo} 1411251538Srpaulo 1412251538Srpaulostatic uint32_t 1413251538Srpaulourtwn_read_4(struct urtwn_softc *sc, uint16_t addr) 1414251538Srpaulo{ 1415251538Srpaulo uint32_t val; 1416251538Srpaulo 1417251538Srpaulo if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 4) != 0) 1418251538Srpaulo return (0xffffffff); 1419251538Srpaulo return (le32toh(val)); 1420251538Srpaulo} 1421251538Srpaulo 1422251538Srpaulostatic int 1423251538Srpaulourtwn_fw_cmd(struct urtwn_softc *sc, uint8_t id, const void *buf, int len) 1424251538Srpaulo{ 1425251538Srpaulo struct r92c_fw_cmd cmd; 1426291698Savos usb_error_t error; 1427251538Srpaulo int ntries; 1428251538Srpaulo 1429295871Savos if (!(sc->sc_flags & URTWN_FW_LOADED)) { 1430295871Savos URTWN_DPRINTF(sc, URTWN_DEBUG_FIRMWARE, "%s: firmware " 1431295871Savos "was not loaded; command (id %d) will be discarded\n", 1432295871Savos __func__, id); 1433295871Savos return (0); 1434295871Savos } 1435295871Savos 1436251538Srpaulo /* Wait for current FW box to be empty. */ 1437251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 1438251538Srpaulo if (!(urtwn_read_1(sc, R92C_HMETFR) & (1 << sc->fwcur))) 1439251538Srpaulo break; 1440266472Shselasky urtwn_ms_delay(sc); 1441251538Srpaulo } 1442251538Srpaulo if (ntries == 100) { 1443251538Srpaulo device_printf(sc->sc_dev, 1444251538Srpaulo "could not send firmware command\n"); 1445251538Srpaulo return (ETIMEDOUT); 1446251538Srpaulo } 1447251538Srpaulo memset(&cmd, 0, sizeof(cmd)); 1448251538Srpaulo cmd.id = id; 1449251538Srpaulo if (len > 3) 1450251538Srpaulo cmd.id |= R92C_CMD_FLAG_EXT; 1451251538Srpaulo KASSERT(len <= sizeof(cmd.msg), ("urtwn_fw_cmd\n")); 1452251538Srpaulo memcpy(cmd.msg, buf, len); 1453251538Srpaulo 1454251538Srpaulo /* Write the first word last since that will trigger the FW. */ 1455291698Savos error = urtwn_write_region_1(sc, R92C_HMEBOX_EXT(sc->fwcur), 1456251538Srpaulo (uint8_t *)&cmd + 4, 2); 1457291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1458291698Savos return (EIO); 1459291698Savos error = urtwn_write_region_1(sc, R92C_HMEBOX(sc->fwcur), 1460251538Srpaulo (uint8_t *)&cmd + 0, 4); 1461291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1462291698Savos return (EIO); 1463251538Srpaulo 1464251538Srpaulo sc->fwcur = (sc->fwcur + 1) % R92C_H2C_NBOX; 1465251538Srpaulo return (0); 1466251538Srpaulo} 1467251538Srpaulo 1468292174Savosstatic void 1469292174Savosurtwn_cmdq_cb(void *arg, int pending) 1470292174Savos{ 1471292174Savos struct urtwn_softc *sc = arg; 1472292174Savos struct urtwn_cmdq *item; 1473292174Savos 1474292174Savos /* 1475292174Savos * Device must be powered on (via urtwn_power_on()) 1476292174Savos * before any command may be sent. 1477292174Savos */ 1478292174Savos URTWN_LOCK(sc); 1479292174Savos if (!(sc->sc_flags & URTWN_RUNNING)) { 1480292174Savos URTWN_UNLOCK(sc); 1481292174Savos return; 1482292174Savos } 1483292174Savos 1484292174Savos URTWN_CMDQ_LOCK(sc); 1485292174Savos while (sc->cmdq[sc->cmdq_first].func != NULL) { 1486292174Savos item = &sc->cmdq[sc->cmdq_first]; 1487292174Savos sc->cmdq_first = (sc->cmdq_first + 1) % URTWN_CMDQ_SIZE; 1488292174Savos URTWN_CMDQ_UNLOCK(sc); 1489292174Savos 1490292174Savos item->func(sc, &item->data); 1491292174Savos 1492292174Savos URTWN_CMDQ_LOCK(sc); 1493292174Savos memset(item, 0, sizeof (*item)); 1494292174Savos } 1495292174Savos URTWN_CMDQ_UNLOCK(sc); 1496292174Savos URTWN_UNLOCK(sc); 1497292174Savos} 1498292174Savos 1499292174Savosstatic int 1500292174Savosurtwn_cmd_sleepable(struct urtwn_softc *sc, const void *ptr, size_t len, 1501292174Savos CMD_FUNC_PROTO) 1502292174Savos{ 1503292174Savos struct ieee80211com *ic = &sc->sc_ic; 1504292174Savos 1505292174Savos KASSERT(len <= sizeof(union sec_param), ("buffer overflow")); 1506292174Savos 1507292174Savos URTWN_CMDQ_LOCK(sc); 1508292174Savos if (sc->cmdq[sc->cmdq_last].func != NULL) { 1509292174Savos device_printf(sc->sc_dev, "%s: cmdq overflow\n", __func__); 1510292174Savos URTWN_CMDQ_UNLOCK(sc); 1511292174Savos 1512292174Savos return (EAGAIN); 1513292174Savos } 1514292174Savos 1515292174Savos if (ptr != NULL) 1516292174Savos memcpy(&sc->cmdq[sc->cmdq_last].data, ptr, len); 1517292174Savos sc->cmdq[sc->cmdq_last].func = func; 1518292174Savos sc->cmdq_last = (sc->cmdq_last + 1) % URTWN_CMDQ_SIZE; 1519292174Savos URTWN_CMDQ_UNLOCK(sc); 1520292174Savos 1521292174Savos ieee80211_runtask(ic, &sc->cmdq_task); 1522292174Savos 1523292174Savos return (0); 1524292174Savos} 1525292174Savos 1526264912Skevlostatic __inline void 1527251538Srpaulourtwn_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, uint32_t val) 1528251538Srpaulo{ 1529264912Skevlo 1530264912Skevlo sc->sc_rf_write(sc, chain, addr, val); 1531264912Skevlo} 1532264912Skevlo 1533264912Skevlostatic void 1534264912Skevlourtwn_r92c_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, 1535264912Skevlo uint32_t val) 1536264912Skevlo{ 1537251538Srpaulo urtwn_bb_write(sc, R92C_LSSI_PARAM(chain), 1538251538Srpaulo SM(R92C_LSSI_PARAM_ADDR, addr) | 1539251538Srpaulo SM(R92C_LSSI_PARAM_DATA, val)); 1540251538Srpaulo} 1541251538Srpaulo 1542264912Skevlostatic void 1543264912Skevlourtwn_r88e_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, 1544264912Skevlouint32_t val) 1545264912Skevlo{ 1546264912Skevlo urtwn_bb_write(sc, R92C_LSSI_PARAM(chain), 1547264912Skevlo SM(R88E_LSSI_PARAM_ADDR, addr) | 1548264912Skevlo SM(R92C_LSSI_PARAM_DATA, val)); 1549264912Skevlo} 1550264912Skevlo 1551251538Srpaulostatic uint32_t 1552251538Srpaulourtwn_rf_read(struct urtwn_softc *sc, int chain, uint8_t addr) 1553251538Srpaulo{ 1554251538Srpaulo uint32_t reg[R92C_MAX_CHAINS], val; 1555251538Srpaulo 1556251538Srpaulo reg[0] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)); 1557251538Srpaulo if (chain != 0) 1558251538Srpaulo reg[chain] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(chain)); 1559251538Srpaulo 1560251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(0), 1561251538Srpaulo reg[0] & ~R92C_HSSI_PARAM2_READ_EDGE); 1562266472Shselasky urtwn_ms_delay(sc); 1563251538Srpaulo 1564251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(chain), 1565251538Srpaulo RW(reg[chain], R92C_HSSI_PARAM2_READ_ADDR, addr) | 1566251538Srpaulo R92C_HSSI_PARAM2_READ_EDGE); 1567266472Shselasky urtwn_ms_delay(sc); 1568251538Srpaulo 1569251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(0), 1570251538Srpaulo reg[0] | R92C_HSSI_PARAM2_READ_EDGE); 1571266472Shselasky urtwn_ms_delay(sc); 1572251538Srpaulo 1573251538Srpaulo if (urtwn_bb_read(sc, R92C_HSSI_PARAM1(chain)) & R92C_HSSI_PARAM1_PI) 1574251538Srpaulo val = urtwn_bb_read(sc, R92C_HSPI_READBACK(chain)); 1575251538Srpaulo else 1576251538Srpaulo val = urtwn_bb_read(sc, R92C_LSSI_READBACK(chain)); 1577251538Srpaulo return (MS(val, R92C_LSSI_READBACK_DATA)); 1578251538Srpaulo} 1579251538Srpaulo 1580251538Srpaulostatic int 1581251538Srpaulourtwn_llt_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data) 1582251538Srpaulo{ 1583291698Savos usb_error_t error; 1584251538Srpaulo int ntries; 1585251538Srpaulo 1586291698Savos error = urtwn_write_4(sc, R92C_LLT_INIT, 1587251538Srpaulo SM(R92C_LLT_INIT_OP, R92C_LLT_INIT_OP_WRITE) | 1588251538Srpaulo SM(R92C_LLT_INIT_ADDR, addr) | 1589251538Srpaulo SM(R92C_LLT_INIT_DATA, data)); 1590291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1591291698Savos return (EIO); 1592251538Srpaulo /* Wait for write operation to complete. */ 1593251538Srpaulo for (ntries = 0; ntries < 20; ntries++) { 1594251538Srpaulo if (MS(urtwn_read_4(sc, R92C_LLT_INIT), R92C_LLT_INIT_OP) == 1595251538Srpaulo R92C_LLT_INIT_OP_NO_ACTIVE) 1596251538Srpaulo return (0); 1597266472Shselasky urtwn_ms_delay(sc); 1598251538Srpaulo } 1599251538Srpaulo return (ETIMEDOUT); 1600251538Srpaulo} 1601251538Srpaulo 1602291264Savosstatic int 1603291264Savosurtwn_efuse_read_next(struct urtwn_softc *sc, uint8_t *val) 1604251538Srpaulo{ 1605251538Srpaulo uint32_t reg; 1606291698Savos usb_error_t error; 1607251538Srpaulo int ntries; 1608251538Srpaulo 1609291264Savos if (sc->last_rom_addr >= URTWN_EFUSE_MAX_LEN) 1610291264Savos return (EFAULT); 1611291264Savos 1612251538Srpaulo reg = urtwn_read_4(sc, R92C_EFUSE_CTRL); 1613291264Savos reg = RW(reg, R92C_EFUSE_CTRL_ADDR, sc->last_rom_addr); 1614251538Srpaulo reg &= ~R92C_EFUSE_CTRL_VALID; 1615291264Savos 1616291698Savos error = urtwn_write_4(sc, R92C_EFUSE_CTRL, reg); 1617291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1618291698Savos return (EIO); 1619251538Srpaulo /* Wait for read operation to complete. */ 1620251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 1621251538Srpaulo reg = urtwn_read_4(sc, R92C_EFUSE_CTRL); 1622251538Srpaulo if (reg & R92C_EFUSE_CTRL_VALID) 1623291264Savos break; 1624266472Shselasky urtwn_ms_delay(sc); 1625251538Srpaulo } 1626291264Savos if (ntries == 100) { 1627291264Savos device_printf(sc->sc_dev, 1628291264Savos "could not read efuse byte at address 0x%x\n", 1629291264Savos sc->last_rom_addr); 1630291264Savos return (ETIMEDOUT); 1631291264Savos } 1632291264Savos 1633291264Savos *val = MS(reg, R92C_EFUSE_CTRL_DATA); 1634291264Savos sc->last_rom_addr++; 1635291264Savos 1636291264Savos return (0); 1637251538Srpaulo} 1638251538Srpaulo 1639291264Savosstatic int 1640291264Savosurtwn_efuse_read_data(struct urtwn_softc *sc, uint8_t *rom, uint8_t off, 1641291264Savos uint8_t msk) 1642291264Savos{ 1643291264Savos uint8_t reg; 1644291264Savos int i, error; 1645291264Savos 1646291264Savos for (i = 0; i < 4; i++) { 1647291264Savos if (msk & (1 << i)) 1648291264Savos continue; 1649291264Savos error = urtwn_efuse_read_next(sc, ®); 1650291264Savos if (error != 0) 1651291264Savos return (error); 1652294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "rom[0x%03X] == 0x%02X\n", 1653294471Savos off * 8 + i * 2, reg); 1654291264Savos rom[off * 8 + i * 2 + 0] = reg; 1655291264Savos 1656291264Savos error = urtwn_efuse_read_next(sc, ®); 1657291264Savos if (error != 0) 1658291264Savos return (error); 1659294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "rom[0x%03X] == 0x%02X\n", 1660294471Savos off * 8 + i * 2 + 1, reg); 1661291264Savos rom[off * 8 + i * 2 + 1] = reg; 1662291264Savos } 1663291264Savos 1664291264Savos return (0); 1665291264Savos} 1666291264Savos 1667294471Savos#ifdef USB_DEBUG 1668251538Srpaulostatic void 1669291264Savosurtwn_dump_rom_contents(struct urtwn_softc *sc, uint8_t *rom, uint16_t size) 1670251538Srpaulo{ 1671251538Srpaulo int i; 1672251538Srpaulo 1673291264Savos /* Dump ROM contents. */ 1674291264Savos device_printf(sc->sc_dev, "%s:", __func__); 1675291264Savos for (i = 0; i < size; i++) { 1676291264Savos if (i % 32 == 0) 1677291264Savos printf("\n%03X: ", i); 1678291264Savos else if (i % 4 == 0) 1679291264Savos printf(" "); 1680291264Savos 1681291264Savos printf("%02X", rom[i]); 1682291264Savos } 1683291264Savos printf("\n"); 1684291264Savos} 1685291264Savos#endif 1686291264Savos 1687291264Savosstatic int 1688291264Savosurtwn_efuse_read(struct urtwn_softc *sc, uint8_t *rom, uint16_t size) 1689291264Savos{ 1690291264Savos#define URTWN_CHK(res) do { \ 1691291264Savos if ((error = res) != 0) \ 1692291264Savos goto end; \ 1693291264Savos} while(0) 1694291264Savos uint8_t msk, off, reg; 1695291264Savos int error; 1696291264Savos 1697291698Savos URTWN_CHK(urtwn_efuse_switch_power(sc)); 1698264912Skevlo 1699291264Savos /* Read full ROM image. */ 1700291264Savos sc->last_rom_addr = 0; 1701291264Savos memset(rom, 0xff, size); 1702291264Savos 1703291264Savos URTWN_CHK(urtwn_efuse_read_next(sc, ®)); 1704291264Savos while (reg != 0xff) { 1705291264Savos /* check for extended header */ 1706291264Savos if ((sc->chip & URTWN_CHIP_88E) && (reg & 0x1f) == 0x0f) { 1707291264Savos off = reg >> 5; 1708291264Savos URTWN_CHK(urtwn_efuse_read_next(sc, ®)); 1709291264Savos 1710291264Savos if ((reg & 0x0f) != 0x0f) 1711291264Savos off = ((reg & 0xf0) >> 1) | off; 1712291264Savos else 1713291264Savos continue; 1714291264Savos } else 1715291264Savos off = reg >> 4; 1716251538Srpaulo msk = reg & 0xf; 1717291264Savos 1718291264Savos URTWN_CHK(urtwn_efuse_read_data(sc, rom, off, msk)); 1719291264Savos URTWN_CHK(urtwn_efuse_read_next(sc, ®)); 1720251538Srpaulo } 1721291264Savos 1722291264Savosend: 1723291264Savos 1724294471Savos#ifdef USB_DEBUG 1725294471Savos if (sc->sc_debug & URTWN_DEBUG_ROM) 1726291264Savos urtwn_dump_rom_contents(sc, rom, size); 1727251538Srpaulo#endif 1728291264Savos 1729282623Skevlo urtwn_write_1(sc, R92C_EFUSE_ACCESS, R92C_EFUSE_ACCESS_OFF); 1730291264Savos 1731291264Savos if (error != 0) { 1732291264Savos device_printf(sc->sc_dev, "%s: error while reading ROM\n", 1733291264Savos __func__); 1734291264Savos } 1735291264Savos 1736291264Savos return (error); 1737291264Savos#undef URTWN_CHK 1738282623Skevlo} 1739281592Skevlo 1740291698Savosstatic int 1741264912Skevlourtwn_efuse_switch_power(struct urtwn_softc *sc) 1742264912Skevlo{ 1743291698Savos usb_error_t error; 1744264912Skevlo uint32_t reg; 1745251538Srpaulo 1746291698Savos error = urtwn_write_1(sc, R92C_EFUSE_ACCESS, R92C_EFUSE_ACCESS_ON); 1747291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1748291698Savos return (EIO); 1749281918Skevlo 1750264912Skevlo reg = urtwn_read_2(sc, R92C_SYS_ISO_CTRL); 1751264912Skevlo if (!(reg & R92C_SYS_ISO_CTRL_PWC_EV12V)) { 1752291698Savos error = urtwn_write_2(sc, R92C_SYS_ISO_CTRL, 1753264912Skevlo reg | R92C_SYS_ISO_CTRL_PWC_EV12V); 1754291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1755291698Savos return (EIO); 1756264912Skevlo } 1757264912Skevlo reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN); 1758264912Skevlo if (!(reg & R92C_SYS_FUNC_EN_ELDR)) { 1759291698Savos error = urtwn_write_2(sc, R92C_SYS_FUNC_EN, 1760264912Skevlo reg | R92C_SYS_FUNC_EN_ELDR); 1761291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1762291698Savos return (EIO); 1763264912Skevlo } 1764264912Skevlo reg = urtwn_read_2(sc, R92C_SYS_CLKR); 1765264912Skevlo if ((reg & (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) != 1766264912Skevlo (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) { 1767291698Savos error = urtwn_write_2(sc, R92C_SYS_CLKR, 1768264912Skevlo reg | R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M); 1769291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 1770291698Savos return (EIO); 1771264912Skevlo } 1772291698Savos 1773291698Savos return (0); 1774264912Skevlo} 1775264912Skevlo 1776251538Srpaulostatic int 1777251538Srpaulourtwn_read_chipid(struct urtwn_softc *sc) 1778251538Srpaulo{ 1779251538Srpaulo uint32_t reg; 1780251538Srpaulo 1781264912Skevlo if (sc->chip & URTWN_CHIP_88E) 1782264912Skevlo return (0); 1783264912Skevlo 1784251538Srpaulo reg = urtwn_read_4(sc, R92C_SYS_CFG); 1785251538Srpaulo if (reg & R92C_SYS_CFG_TRP_VAUX_EN) 1786251538Srpaulo return (EIO); 1787251538Srpaulo 1788251538Srpaulo if (reg & R92C_SYS_CFG_TYPE_92C) { 1789251538Srpaulo sc->chip |= URTWN_CHIP_92C; 1790251538Srpaulo /* Check if it is a castrated 8192C. */ 1791251538Srpaulo if (MS(urtwn_read_4(sc, R92C_HPON_FSM), 1792251538Srpaulo R92C_HPON_FSM_CHIP_BONDING_ID) == 1793251538Srpaulo R92C_HPON_FSM_CHIP_BONDING_ID_92C_1T2R) 1794251538Srpaulo sc->chip |= URTWN_CHIP_92C_1T2R; 1795251538Srpaulo } 1796251538Srpaulo if (reg & R92C_SYS_CFG_VENDOR_UMC) { 1797251538Srpaulo sc->chip |= URTWN_CHIP_UMC; 1798251538Srpaulo if (MS(reg, R92C_SYS_CFG_CHIP_VER_RTL) == 0) 1799251538Srpaulo sc->chip |= URTWN_CHIP_UMC_A_CUT; 1800251538Srpaulo } 1801251538Srpaulo return (0); 1802251538Srpaulo} 1803251538Srpaulo 1804291264Savosstatic int 1805251538Srpaulourtwn_read_rom(struct urtwn_softc *sc) 1806251538Srpaulo{ 1807291264Savos struct r92c_rom *rom = &sc->rom.r92c_rom; 1808291264Savos int error; 1809251538Srpaulo 1810251538Srpaulo /* Read full ROM image. */ 1811291264Savos error = urtwn_efuse_read(sc, (uint8_t *)rom, sizeof(*rom)); 1812291264Savos if (error != 0) 1813291264Savos return (error); 1814251538Srpaulo 1815251538Srpaulo /* XXX Weird but this is what the vendor driver does. */ 1816291264Savos sc->last_rom_addr = 0x1fa; 1817291264Savos error = urtwn_efuse_read_next(sc, &sc->pa_setting); 1818291264Savos if (error != 0) 1819291264Savos return (error); 1820294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "%s: PA setting=0x%x\n", __func__, 1821294471Savos sc->pa_setting); 1822251538Srpaulo 1823251538Srpaulo sc->board_type = MS(rom->rf_opt1, R92C_ROM_RF1_BOARD_TYPE); 1824251538Srpaulo 1825251538Srpaulo sc->regulatory = MS(rom->rf_opt1, R92C_ROM_RF1_REGULATORY); 1826294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "%s: regulatory type=%d\n", 1827294471Savos __func__, sc->regulatory); 1828287197Sglebius IEEE80211_ADDR_COPY(sc->sc_ic.ic_macaddr, rom->macaddr); 1829251538Srpaulo 1830264912Skevlo sc->sc_rf_write = urtwn_r92c_rf_write; 1831264912Skevlo sc->sc_power_on = urtwn_r92c_power_on; 1832295874Savos sc->sc_power_off = urtwn_r92c_power_off; 1833291264Savos 1834291264Savos return (0); 1835251538Srpaulo} 1836251538Srpaulo 1837291264Savosstatic int 1838264912Skevlourtwn_r88e_read_rom(struct urtwn_softc *sc) 1839264912Skevlo{ 1840294198Savos struct r88e_rom *rom = &sc->rom.r88e_rom; 1841294198Savos int error; 1842264912Skevlo 1843294198Savos error = urtwn_efuse_read(sc, (uint8_t *)rom, sizeof(sc->rom.r88e_rom)); 1844291264Savos if (error != 0) 1845291264Savos return (error); 1846264912Skevlo 1847294198Savos sc->bw20_tx_pwr_diff = (rom->tx_pwr_diff >> 4); 1848264912Skevlo if (sc->bw20_tx_pwr_diff & 0x08) 1849264912Skevlo sc->bw20_tx_pwr_diff |= 0xf0; 1850294198Savos sc->ofdm_tx_pwr_diff = (rom->tx_pwr_diff & 0xf); 1851264912Skevlo if (sc->ofdm_tx_pwr_diff & 0x08) 1852264912Skevlo sc->ofdm_tx_pwr_diff |= 0xf0; 1853294198Savos sc->regulatory = MS(rom->rf_board_opt, R92C_ROM_RF1_REGULATORY); 1854294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "%s: regulatory type %d\n", 1855294471Savos __func__,sc->regulatory); 1856294198Savos IEEE80211_ADDR_COPY(sc->sc_ic.ic_macaddr, rom->macaddr); 1857264912Skevlo 1858264912Skevlo sc->sc_rf_write = urtwn_r88e_rf_write; 1859264912Skevlo sc->sc_power_on = urtwn_r88e_power_on; 1860295874Savos sc->sc_power_off = urtwn_r88e_power_off; 1861291264Savos 1862291264Savos return (0); 1863264912Skevlo} 1864264912Skevlo 1865251538Srpaulo/* 1866251538Srpaulo * Initialize rate adaptation in firmware. 1867251538Srpaulo */ 1868251538Srpaulostatic int 1869251538Srpaulourtwn_ra_init(struct urtwn_softc *sc) 1870251538Srpaulo{ 1871287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 1872251538Srpaulo struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 1873251538Srpaulo struct ieee80211_node *ni; 1874297175Sadrian struct ieee80211_rateset *rs, *rs_ht; 1875251538Srpaulo struct r92c_fw_cmd_macid_cfg cmd; 1876251538Srpaulo uint32_t rates, basicrates; 1877251538Srpaulo uint8_t mode; 1878251538Srpaulo int maxrate, maxbasicrate, error, i, j; 1879251538Srpaulo 1880251538Srpaulo ni = ieee80211_ref_node(vap->iv_bss); 1881251538Srpaulo rs = &ni->ni_rates; 1882297175Sadrian rs_ht = (struct ieee80211_rateset *) &ni->ni_htrates; 1883251538Srpaulo 1884251538Srpaulo /* Get normal and basic rates mask. */ 1885251538Srpaulo rates = basicrates = 0; 1886251538Srpaulo maxrate = maxbasicrate = 0; 1887297175Sadrian 1888297175Sadrian /* This is for 11bg */ 1889251538Srpaulo for (i = 0; i < rs->rs_nrates; i++) { 1890251538Srpaulo /* Convert 802.11 rate to HW rate index. */ 1891289758Savos for (j = 0; j < nitems(ridx2rate); j++) 1892289758Savos if ((rs->rs_rates[i] & IEEE80211_RATE_VAL) == 1893289758Savos ridx2rate[j]) 1894251538Srpaulo break; 1895289758Savos if (j == nitems(ridx2rate)) /* Unknown rate, skip. */ 1896251538Srpaulo continue; 1897251538Srpaulo rates |= 1 << j; 1898251538Srpaulo if (j > maxrate) 1899251538Srpaulo maxrate = j; 1900251538Srpaulo if (rs->rs_rates[i] & IEEE80211_RATE_BASIC) { 1901251538Srpaulo basicrates |= 1 << j; 1902251538Srpaulo if (j > maxbasicrate) 1903251538Srpaulo maxbasicrate = j; 1904251538Srpaulo } 1905251538Srpaulo } 1906297175Sadrian 1907297175Sadrian /* If we're doing 11n, enable 11n rates */ 1908297175Sadrian if (ni->ni_flags & IEEE80211_NODE_HT) { 1909297175Sadrian for (i = 0; i < rs_ht->rs_nrates; i++) { 1910297175Sadrian if ((rs_ht->rs_rates[i] & 0x7f) > 0xf) 1911297175Sadrian continue; 1912297175Sadrian /* 11n rates start at index 12 */ 1913297175Sadrian j = ((rs_ht->rs_rates[i]) & 0xf) + 12; 1914297175Sadrian rates |= (1 << j); 1915297175Sadrian 1916297175Sadrian /* Guard against the rate table being oddly ordered */ 1917297175Sadrian if (j > maxrate) 1918297175Sadrian maxrate = j; 1919297175Sadrian } 1920297175Sadrian } 1921297175Sadrian 1922297175Sadrian#if 0 1923297175Sadrian if (ic->ic_curmode == IEEE80211_MODE_11NG) 1924297175Sadrian raid = R92C_RAID_11GN; 1925297175Sadrian#endif 1926297175Sadrian /* NB: group addressed frames are done at 11bg rates for now */ 1927251538Srpaulo if (ic->ic_curmode == IEEE80211_MODE_11B) 1928251538Srpaulo mode = R92C_RAID_11B; 1929251538Srpaulo else 1930251538Srpaulo mode = R92C_RAID_11BG; 1931297175Sadrian /* XXX misleading 'mode' value here for unicast frames */ 1932294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_RA, 1933294471Savos "%s: mode 0x%x, rates 0x%08x, basicrates 0x%08x\n", __func__, 1934251538Srpaulo mode, rates, basicrates); 1935251538Srpaulo 1936251538Srpaulo /* Set rates mask for group addressed frames. */ 1937251538Srpaulo cmd.macid = URTWN_MACID_BC | URTWN_MACID_VALID; 1938251538Srpaulo cmd.mask = htole32(mode << 28 | basicrates); 1939251538Srpaulo error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd)); 1940251538Srpaulo if (error != 0) { 1941252401Srpaulo ieee80211_free_node(ni); 1942251538Srpaulo device_printf(sc->sc_dev, 1943251538Srpaulo "could not add broadcast station\n"); 1944251538Srpaulo return (error); 1945251538Srpaulo } 1946297175Sadrian 1947251538Srpaulo /* Set initial MRR rate. */ 1948294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_RA, "%s: maxbasicrate %d\n", __func__, 1949294471Savos maxbasicrate); 1950251538Srpaulo urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BC), 1951251538Srpaulo maxbasicrate); 1952251538Srpaulo 1953251538Srpaulo /* Set rates mask for unicast frames. */ 1954297175Sadrian if (ni->ni_flags & IEEE80211_NODE_HT) 1955297175Sadrian mode = R92C_RAID_11GN; 1956297175Sadrian else if (ic->ic_curmode == IEEE80211_MODE_11B) 1957297175Sadrian mode = R92C_RAID_11B; 1958297175Sadrian else 1959297175Sadrian mode = R92C_RAID_11BG; 1960251538Srpaulo cmd.macid = URTWN_MACID_BSS | URTWN_MACID_VALID; 1961251538Srpaulo cmd.mask = htole32(mode << 28 | rates); 1962251538Srpaulo error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd)); 1963251538Srpaulo if (error != 0) { 1964252401Srpaulo ieee80211_free_node(ni); 1965251538Srpaulo device_printf(sc->sc_dev, "could not add BSS station\n"); 1966251538Srpaulo return (error); 1967251538Srpaulo } 1968251538Srpaulo /* Set initial MRR rate. */ 1969294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_RA, "%s: maxrate %d\n", __func__, 1970294471Savos maxrate); 1971251538Srpaulo urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BSS), 1972251538Srpaulo maxrate); 1973251538Srpaulo 1974251538Srpaulo /* Indicate highest supported rate. */ 1975297175Sadrian if (ni->ni_flags & IEEE80211_NODE_HT) 1976297175Sadrian ni->ni_txrate = rs_ht->rs_rates[rs_ht->rs_nrates - 1] 1977297175Sadrian | IEEE80211_RATE_MCS; 1978297175Sadrian else 1979297175Sadrian ni->ni_txrate = rs->rs_rates[rs->rs_nrates - 1]; 1980252401Srpaulo ieee80211_free_node(ni); 1981252401Srpaulo 1982251538Srpaulo return (0); 1983251538Srpaulo} 1984251538Srpaulo 1985290439Savosstatic void 1986290631Savosurtwn_init_beacon(struct urtwn_softc *sc, struct urtwn_vap *uvp) 1987251538Srpaulo{ 1988290631Savos struct r92c_tx_desc *txd = &uvp->bcn_desc; 1989290631Savos 1990290631Savos txd->txdw0 = htole32( 1991290631Savos SM(R92C_TXDW0_OFFSET, sizeof(*txd)) | R92C_TXDW0_BMCAST | 1992290631Savos R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG); 1993290631Savos txd->txdw1 = htole32( 1994290631Savos SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_BEACON) | 1995290631Savos SM(R92C_TXDW1_RAID, R92C_RAID_11B)); 1996290631Savos 1997291858Savos if (sc->chip & URTWN_CHIP_88E) { 1998290631Savos txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, URTWN_MACID_BC)); 1999291858Savos txd->txdseq |= htole16(R88E_TXDSEQ_HWSEQ_EN); 2000291858Savos } else { 2001290631Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, URTWN_MACID_BC)); 2002291858Savos txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN); 2003291858Savos } 2004290631Savos 2005290631Savos txd->txdw4 = htole32(R92C_TXDW4_DRVRATE); 2006290631Savos txd->txdw5 = htole32(SM(R92C_TXDW5_DATARATE, URTWN_RIDX_CCK1)); 2007251538Srpaulo} 2008251538Srpaulo 2009290631Savosstatic int 2010290631Savosurtwn_setup_beacon(struct urtwn_softc *sc, struct ieee80211_node *ni) 2011290631Savos{ 2012290631Savos struct ieee80211vap *vap = ni->ni_vap; 2013290631Savos struct urtwn_vap *uvp = URTWN_VAP(vap); 2014290631Savos struct mbuf *m; 2015290631Savos int error; 2016290631Savos 2017290631Savos URTWN_ASSERT_LOCKED(sc); 2018290631Savos 2019290631Savos if (ni->ni_chan == IEEE80211_CHAN_ANYC) 2020290631Savos return (EINVAL); 2021290631Savos 2022290631Savos m = ieee80211_beacon_alloc(ni); 2023290631Savos if (m == NULL) { 2024290631Savos device_printf(sc->sc_dev, 2025290631Savos "%s: could not allocate beacon frame\n", __func__); 2026290631Savos return (ENOMEM); 2027290631Savos } 2028290631Savos 2029290631Savos if (uvp->bcn_mbuf != NULL) 2030290631Savos m_freem(uvp->bcn_mbuf); 2031290631Savos 2032290631Savos uvp->bcn_mbuf = m; 2033290631Savos 2034290631Savos if ((error = urtwn_tx_beacon(sc, uvp)) != 0) 2035290631Savos return (error); 2036290631Savos 2037290631Savos /* XXX bcnq stuck workaround */ 2038290631Savos if ((error = urtwn_tx_beacon(sc, uvp)) != 0) 2039290631Savos return (error); 2040290631Savos 2041294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_BEACON, "%s: beacon was %srecognized\n", 2042294471Savos __func__, urtwn_read_1(sc, R92C_TDECTRL + 2) & 2043294471Savos (R92C_TDECTRL_BCN_VALID >> 16) ? "" : "not "); 2044294471Savos 2045290631Savos return (0); 2046290631Savos} 2047290631Savos 2048251538Srpaulostatic void 2049290631Savosurtwn_update_beacon(struct ieee80211vap *vap, int item) 2050290631Savos{ 2051290631Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2052290631Savos struct urtwn_vap *uvp = URTWN_VAP(vap); 2053290631Savos struct ieee80211_beacon_offsets *bo = &vap->iv_bcn_off; 2054290631Savos struct ieee80211_node *ni = vap->iv_bss; 2055290631Savos int mcast = 0; 2056290631Savos 2057290631Savos URTWN_LOCK(sc); 2058290631Savos if (uvp->bcn_mbuf == NULL) { 2059290631Savos uvp->bcn_mbuf = ieee80211_beacon_alloc(ni); 2060290631Savos if (uvp->bcn_mbuf == NULL) { 2061290631Savos device_printf(sc->sc_dev, 2062290631Savos "%s: could not allocate beacon frame\n", __func__); 2063290631Savos URTWN_UNLOCK(sc); 2064290631Savos return; 2065290631Savos } 2066290631Savos } 2067290631Savos URTWN_UNLOCK(sc); 2068290631Savos 2069290631Savos if (item == IEEE80211_BEACON_TIM) 2070290631Savos mcast = 1; /* XXX */ 2071290631Savos 2072290631Savos setbit(bo->bo_flags, item); 2073290631Savos ieee80211_beacon_update(ni, uvp->bcn_mbuf, mcast); 2074290631Savos 2075290631Savos URTWN_LOCK(sc); 2076290631Savos urtwn_tx_beacon(sc, uvp); 2077290631Savos URTWN_UNLOCK(sc); 2078290631Savos} 2079290631Savos 2080290631Savos/* 2081290631Savos * Push a beacon frame into the chip. Beacon will 2082290631Savos * be repeated by the chip every R92C_BCN_INTERVAL. 2083290631Savos */ 2084290631Savosstatic int 2085290631Savosurtwn_tx_beacon(struct urtwn_softc *sc, struct urtwn_vap *uvp) 2086290631Savos{ 2087290631Savos struct r92c_tx_desc *desc = &uvp->bcn_desc; 2088290631Savos struct urtwn_data *bf; 2089290631Savos 2090290631Savos URTWN_ASSERT_LOCKED(sc); 2091290631Savos 2092290631Savos bf = urtwn_getbuf(sc); 2093290631Savos if (bf == NULL) 2094290631Savos return (ENOMEM); 2095290631Savos 2096290631Savos memcpy(bf->buf, desc, sizeof(*desc)); 2097290631Savos urtwn_tx_start(sc, uvp->bcn_mbuf, IEEE80211_FC0_TYPE_MGT, bf); 2098290631Savos 2099290631Savos sc->sc_txtimer = 5; 2100290631Savos callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 2101290631Savos 2102290631Savos return (0); 2103290631Savos} 2104290631Savos 2105292175Savosstatic int 2106292175Savosurtwn_key_alloc(struct ieee80211vap *vap, struct ieee80211_key *k, 2107292175Savos ieee80211_keyix *keyix, ieee80211_keyix *rxkeyix) 2108292175Savos{ 2109292175Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2110292175Savos uint8_t i; 2111292175Savos 2112292175Savos if (!(&vap->iv_nw_keys[0] <= k && 2113292175Savos k < &vap->iv_nw_keys[IEEE80211_WEP_NKID])) { 2114292175Savos if (!(k->wk_flags & IEEE80211_KEY_SWCRYPT)) { 2115292175Savos URTWN_LOCK(sc); 2116292175Savos /* 2117292175Savos * First 4 slots for group keys, 2118292175Savos * what is left - for pairwise. 2119292175Savos * XXX incompatible with IBSS RSN. 2120292175Savos */ 2121292175Savos for (i = IEEE80211_WEP_NKID; 2122292175Savos i < R92C_CAM_ENTRY_COUNT; i++) { 2123292175Savos if ((sc->keys_bmap & (1 << i)) == 0) { 2124292175Savos sc->keys_bmap |= 1 << i; 2125292175Savos *keyix = i; 2126292175Savos break; 2127292175Savos } 2128292175Savos } 2129292175Savos URTWN_UNLOCK(sc); 2130292175Savos if (i == R92C_CAM_ENTRY_COUNT) { 2131292175Savos device_printf(sc->sc_dev, 2132292175Savos "%s: no free space in the key table\n", 2133292175Savos __func__); 2134292175Savos return 0; 2135292175Savos } 2136292175Savos } else 2137292175Savos *keyix = 0; 2138292175Savos } else { 2139292175Savos *keyix = k - vap->iv_nw_keys; 2140292175Savos } 2141292175Savos *rxkeyix = *keyix; 2142292175Savos return 1; 2143292175Savos} 2144292175Savos 2145290631Savosstatic void 2146292175Savosurtwn_key_set_cb(struct urtwn_softc *sc, union sec_param *data) 2147292175Savos{ 2148292175Savos struct ieee80211_key *k = &data->key; 2149292175Savos uint8_t algo, keyid; 2150292175Savos int i, error; 2151292175Savos 2152292175Savos if (k->wk_keyix < IEEE80211_WEP_NKID) 2153292175Savos keyid = k->wk_keyix; 2154292175Savos else 2155292175Savos keyid = 0; 2156292175Savos 2157292175Savos /* Map net80211 cipher to HW crypto algorithm. */ 2158292175Savos switch (k->wk_cipher->ic_cipher) { 2159292175Savos case IEEE80211_CIPHER_WEP: 2160292175Savos if (k->wk_keylen < 8) 2161292175Savos algo = R92C_CAM_ALGO_WEP40; 2162292175Savos else 2163292175Savos algo = R92C_CAM_ALGO_WEP104; 2164292175Savos break; 2165292175Savos case IEEE80211_CIPHER_TKIP: 2166292175Savos algo = R92C_CAM_ALGO_TKIP; 2167292175Savos break; 2168292175Savos case IEEE80211_CIPHER_AES_CCM: 2169292175Savos algo = R92C_CAM_ALGO_AES; 2170292175Savos break; 2171292175Savos default: 2172292175Savos device_printf(sc->sc_dev, "%s: undefined cipher %d\n", 2173292175Savos __func__, k->wk_cipher->ic_cipher); 2174292175Savos return; 2175292175Savos } 2176292175Savos 2177294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_KEY, 2178294471Savos "%s: keyix %d, keyid %d, algo %d/%d, flags %04X, len %d, " 2179294471Savos "macaddr %s\n", __func__, k->wk_keyix, keyid, 2180294471Savos k->wk_cipher->ic_cipher, algo, k->wk_flags, k->wk_keylen, 2181294471Savos ether_sprintf(k->wk_macaddr)); 2182292175Savos 2183292175Savos /* Write key. */ 2184292175Savos for (i = 0; i < 4; i++) { 2185292175Savos error = urtwn_cam_write(sc, R92C_CAM_KEY(k->wk_keyix, i), 2186292175Savos LE_READ_4(&k->wk_key[i * 4])); 2187292175Savos if (error != 0) 2188292175Savos goto fail; 2189292175Savos } 2190292175Savos 2191292175Savos /* Write CTL0 last since that will validate the CAM entry. */ 2192292175Savos error = urtwn_cam_write(sc, R92C_CAM_CTL1(k->wk_keyix), 2193292175Savos LE_READ_4(&k->wk_macaddr[2])); 2194292175Savos if (error != 0) 2195292175Savos goto fail; 2196292175Savos error = urtwn_cam_write(sc, R92C_CAM_CTL0(k->wk_keyix), 2197292175Savos SM(R92C_CAM_ALGO, algo) | 2198292175Savos SM(R92C_CAM_KEYID, keyid) | 2199292175Savos SM(R92C_CAM_MACLO, LE_READ_2(&k->wk_macaddr[0])) | 2200292175Savos R92C_CAM_VALID); 2201292175Savos if (error != 0) 2202292175Savos goto fail; 2203292175Savos 2204292175Savos return; 2205292175Savos 2206292175Savosfail: 2207292175Savos device_printf(sc->sc_dev, "%s fails, error %d\n", __func__, error); 2208292175Savos} 2209292175Savos 2210292175Savosstatic void 2211292175Savosurtwn_key_del_cb(struct urtwn_softc *sc, union sec_param *data) 2212292175Savos{ 2213292175Savos struct ieee80211_key *k = &data->key; 2214292175Savos int i; 2215292175Savos 2216294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_KEY, 2217294471Savos "%s: keyix %d, flags %04X, macaddr %s\n", __func__, 2218292175Savos k->wk_keyix, k->wk_flags, ether_sprintf(k->wk_macaddr)); 2219292175Savos 2220292175Savos urtwn_cam_write(sc, R92C_CAM_CTL0(k->wk_keyix), 0); 2221292175Savos urtwn_cam_write(sc, R92C_CAM_CTL1(k->wk_keyix), 0); 2222292175Savos 2223292175Savos /* Clear key. */ 2224292175Savos for (i = 0; i < 4; i++) 2225292175Savos urtwn_cam_write(sc, R92C_CAM_KEY(k->wk_keyix, i), 0); 2226292175Savos sc->keys_bmap &= ~(1 << k->wk_keyix); 2227292175Savos} 2228292175Savos 2229292175Savosstatic int 2230292175Savosurtwn_key_set(struct ieee80211vap *vap, const struct ieee80211_key *k) 2231292175Savos{ 2232292175Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2233292175Savos 2234292175Savos if (k->wk_flags & IEEE80211_KEY_SWCRYPT) { 2235292175Savos /* Not for us. */ 2236292175Savos return (1); 2237292175Savos } 2238292175Savos 2239292175Savos return (!urtwn_cmd_sleepable(sc, k, sizeof(*k), urtwn_key_set_cb)); 2240292175Savos} 2241292175Savos 2242292175Savosstatic int 2243292175Savosurtwn_key_delete(struct ieee80211vap *vap, const struct ieee80211_key *k) 2244292175Savos{ 2245292175Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2246292175Savos 2247292175Savos if (k->wk_flags & IEEE80211_KEY_SWCRYPT) { 2248292175Savos /* Not for us. */ 2249292175Savos return (1); 2250292175Savos } 2251292175Savos 2252292175Savos return (!urtwn_cmd_sleepable(sc, k, sizeof(*k), urtwn_key_del_cb)); 2253292175Savos} 2254292175Savos 2255292175Savosstatic void 2256290651Savosurtwn_tsf_task_adhoc(void *arg, int pending) 2257290651Savos{ 2258290651Savos struct ieee80211vap *vap = arg; 2259290651Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2260290651Savos struct ieee80211_node *ni; 2261290651Savos uint32_t reg; 2262290651Savos 2263290651Savos URTWN_LOCK(sc); 2264290651Savos ni = ieee80211_ref_node(vap->iv_bss); 2265290651Savos reg = urtwn_read_1(sc, R92C_BCN_CTRL); 2266290651Savos 2267290651Savos /* Accept beacons with the same BSSID. */ 2268290651Savos urtwn_set_rx_bssid_all(sc, 0); 2269290651Savos 2270290651Savos /* Enable synchronization. */ 2271290651Savos reg &= ~R92C_BCN_CTRL_DIS_TSF_UDT0; 2272290651Savos urtwn_write_1(sc, R92C_BCN_CTRL, reg); 2273290651Savos 2274290651Savos /* Synchronize. */ 2275290651Savos usb_pause_mtx(&sc->sc_mtx, hz * ni->ni_intval * 5 / 1000); 2276290651Savos 2277290651Savos /* Disable synchronization. */ 2278290651Savos reg |= R92C_BCN_CTRL_DIS_TSF_UDT0; 2279290651Savos urtwn_write_1(sc, R92C_BCN_CTRL, reg); 2280290651Savos 2281290651Savos /* Remove beacon filter. */ 2282290651Savos urtwn_set_rx_bssid_all(sc, 1); 2283290651Savos 2284290651Savos /* Enable beaconing. */ 2285290651Savos urtwn_write_1(sc, R92C_MBID_NUM, 2286290651Savos urtwn_read_1(sc, R92C_MBID_NUM) | R92C_MBID_TXBCN_RPT0); 2287290651Savos reg |= R92C_BCN_CTRL_EN_BCN; 2288290651Savos 2289290651Savos urtwn_write_1(sc, R92C_BCN_CTRL, reg); 2290290651Savos ieee80211_free_node(ni); 2291290651Savos URTWN_UNLOCK(sc); 2292290651Savos} 2293290651Savos 2294290651Savosstatic void 2295290631Savosurtwn_tsf_sync_enable(struct urtwn_softc *sc, struct ieee80211vap *vap) 2296290631Savos{ 2297290651Savos struct ieee80211com *ic = &sc->sc_ic; 2298290651Savos struct urtwn_vap *uvp = URTWN_VAP(vap); 2299290651Savos 2300290631Savos /* Reset TSF. */ 2301290631Savos urtwn_write_1(sc, R92C_DUAL_TSF_RST, R92C_DUAL_TSF_RST0); 2302290631Savos 2303290631Savos switch (vap->iv_opmode) { 2304290631Savos case IEEE80211_M_STA: 2305290631Savos /* Enable TSF synchronization. */ 2306290631Savos urtwn_write_1(sc, R92C_BCN_CTRL, 2307290631Savos urtwn_read_1(sc, R92C_BCN_CTRL) & 2308290631Savos ~R92C_BCN_CTRL_DIS_TSF_UDT0); 2309290631Savos break; 2310290651Savos case IEEE80211_M_IBSS: 2311290651Savos ieee80211_runtask(ic, &uvp->tsf_task_adhoc); 2312290651Savos break; 2313290631Savos case IEEE80211_M_HOSTAP: 2314290631Savos /* Enable beaconing. */ 2315290631Savos urtwn_write_1(sc, R92C_MBID_NUM, 2316290631Savos urtwn_read_1(sc, R92C_MBID_NUM) | R92C_MBID_TXBCN_RPT0); 2317290631Savos urtwn_write_1(sc, R92C_BCN_CTRL, 2318290631Savos urtwn_read_1(sc, R92C_BCN_CTRL) | R92C_BCN_CTRL_EN_BCN); 2319290631Savos break; 2320290631Savos default: 2321290631Savos device_printf(sc->sc_dev, "undefined opmode %d\n", 2322290631Savos vap->iv_opmode); 2323290631Savos return; 2324290631Savos } 2325290631Savos} 2326290631Savos 2327290631Savosstatic void 2328292203Savosurtwn_get_tsf(struct urtwn_softc *sc, uint64_t *buf) 2329292203Savos{ 2330292203Savos urtwn_read_region_1(sc, R92C_TSFTR, (uint8_t *)buf, sizeof(*buf)); 2331292203Savos} 2332292203Savos 2333292203Savosstatic void 2334251538Srpaulourtwn_set_led(struct urtwn_softc *sc, int led, int on) 2335251538Srpaulo{ 2336251538Srpaulo uint8_t reg; 2337281069Srpaulo 2338251538Srpaulo if (led == URTWN_LED_LINK) { 2339264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 2340264912Skevlo reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0xf0; 2341264912Skevlo urtwn_write_1(sc, R92C_LEDCFG2, reg | 0x60); 2342264912Skevlo if (!on) { 2343264912Skevlo reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0x90; 2344264912Skevlo urtwn_write_1(sc, R92C_LEDCFG2, 2345264912Skevlo reg | R92C_LEDCFG0_DIS); 2346264912Skevlo urtwn_write_1(sc, R92C_MAC_PINMUX_CFG, 2347264912Skevlo urtwn_read_1(sc, R92C_MAC_PINMUX_CFG) & 2348264912Skevlo 0xfe); 2349264912Skevlo } 2350264912Skevlo } else { 2351264912Skevlo reg = urtwn_read_1(sc, R92C_LEDCFG0) & 0x70; 2352264912Skevlo if (!on) 2353264912Skevlo reg |= R92C_LEDCFG0_DIS; 2354264912Skevlo urtwn_write_1(sc, R92C_LEDCFG0, reg); 2355264912Skevlo } 2356264912Skevlo sc->ledlink = on; /* Save LED state. */ 2357251538Srpaulo } 2358251538Srpaulo} 2359251538Srpaulo 2360289811Savosstatic void 2361289811Savosurtwn_set_mode(struct urtwn_softc *sc, uint8_t mode) 2362289811Savos{ 2363289811Savos uint8_t reg; 2364289811Savos 2365289811Savos reg = urtwn_read_1(sc, R92C_MSR); 2366289811Savos reg = (reg & ~R92C_MSR_MASK) | mode; 2367289811Savos urtwn_write_1(sc, R92C_MSR, reg); 2368289811Savos} 2369289811Savos 2370290651Savosstatic void 2371290651Savosurtwn_ibss_recv_mgmt(struct ieee80211_node *ni, struct mbuf *m, int subtype, 2372290651Savos const struct ieee80211_rx_stats *rxs, 2373290651Savos int rssi, int nf) 2374290651Savos{ 2375290651Savos struct ieee80211vap *vap = ni->ni_vap; 2376290651Savos struct urtwn_softc *sc = vap->iv_ic->ic_softc; 2377290651Savos struct urtwn_vap *uvp = URTWN_VAP(vap); 2378290651Savos uint64_t ni_tstamp, curr_tstamp; 2379290651Savos 2380290651Savos uvp->recv_mgmt(ni, m, subtype, rxs, rssi, nf); 2381290651Savos 2382290651Savos if (vap->iv_state == IEEE80211_S_RUN && 2383290651Savos (subtype == IEEE80211_FC0_SUBTYPE_BEACON || 2384290651Savos subtype == IEEE80211_FC0_SUBTYPE_PROBE_RESP)) { 2385290651Savos ni_tstamp = le64toh(ni->ni_tstamp.tsf); 2386290651Savos URTWN_LOCK(sc); 2387290651Savos urtwn_get_tsf(sc, &curr_tstamp); 2388290651Savos URTWN_UNLOCK(sc); 2389290651Savos curr_tstamp = le64toh(curr_tstamp); 2390290651Savos 2391290651Savos if (ni_tstamp >= curr_tstamp) 2392290651Savos (void) ieee80211_ibss_merge(ni); 2393290651Savos } 2394290651Savos} 2395290651Savos 2396251538Srpaulostatic int 2397251538Srpaulourtwn_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 2398251538Srpaulo{ 2399251538Srpaulo struct urtwn_vap *uvp = URTWN_VAP(vap); 2400251538Srpaulo struct ieee80211com *ic = vap->iv_ic; 2401286949Sadrian struct urtwn_softc *sc = ic->ic_softc; 2402251538Srpaulo struct ieee80211_node *ni; 2403251538Srpaulo enum ieee80211_state ostate; 2404290631Savos uint32_t reg; 2405290631Savos uint8_t mode; 2406290631Savos int error = 0; 2407251538Srpaulo 2408251538Srpaulo ostate = vap->iv_state; 2409294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_STATE, "%s -> %s\n", 2410294471Savos ieee80211_state_name[ostate], ieee80211_state_name[nstate]); 2411251538Srpaulo 2412251538Srpaulo IEEE80211_UNLOCK(ic); 2413251538Srpaulo URTWN_LOCK(sc); 2414251538Srpaulo callout_stop(&sc->sc_watchdog_ch); 2415251538Srpaulo 2416251538Srpaulo if (ostate == IEEE80211_S_RUN) { 2417294473Savos /* Stop calibration. */ 2418294473Savos callout_stop(&sc->sc_calib_to); 2419294473Savos 2420251538Srpaulo /* Turn link LED off. */ 2421251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 0); 2422251538Srpaulo 2423251538Srpaulo /* Set media status to 'No Link'. */ 2424289811Savos urtwn_set_mode(sc, R92C_MSR_NOLINK); 2425251538Srpaulo 2426251538Srpaulo /* Stop Rx of data frames. */ 2427251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP2, 0); 2428251538Srpaulo 2429251538Srpaulo /* Disable TSF synchronization. */ 2430251538Srpaulo urtwn_write_1(sc, R92C_BCN_CTRL, 2431290631Savos (urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_EN_BCN) | 2432251538Srpaulo R92C_BCN_CTRL_DIS_TSF_UDT0); 2433251538Srpaulo 2434290631Savos /* Disable beaconing. */ 2435290631Savos urtwn_write_1(sc, R92C_MBID_NUM, 2436290631Savos urtwn_read_1(sc, R92C_MBID_NUM) & ~R92C_MBID_TXBCN_RPT0); 2437290631Savos 2438290631Savos /* Reset TSF. */ 2439290631Savos urtwn_write_1(sc, R92C_DUAL_TSF_RST, R92C_DUAL_TSF_RST0); 2440290631Savos 2441251538Srpaulo /* Reset EDCA parameters. */ 2442251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002f3217); 2443251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005e4317); 2444251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x00105320); 2445251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a444); 2446251538Srpaulo } 2447251538Srpaulo 2448251538Srpaulo switch (nstate) { 2449251538Srpaulo case IEEE80211_S_INIT: 2450251538Srpaulo /* Turn link LED off. */ 2451251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 0); 2452251538Srpaulo break; 2453251538Srpaulo case IEEE80211_S_SCAN: 2454251538Srpaulo /* Pause AC Tx queues. */ 2455251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 2456293180Savos urtwn_read_1(sc, R92C_TXPAUSE) | R92C_TX_QUEUE_AC); 2457251538Srpaulo break; 2458251538Srpaulo case IEEE80211_S_AUTH: 2459251538Srpaulo urtwn_set_chan(sc, ic->ic_curchan, NULL); 2460251538Srpaulo break; 2461251538Srpaulo case IEEE80211_S_RUN: 2462251538Srpaulo if (vap->iv_opmode == IEEE80211_M_MONITOR) { 2463251538Srpaulo /* Turn link LED on. */ 2464251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 1); 2465251538Srpaulo break; 2466251538Srpaulo } 2467251538Srpaulo 2468251538Srpaulo ni = ieee80211_ref_node(vap->iv_bss); 2469290631Savos 2470290631Savos if (ic->ic_bsschan == IEEE80211_CHAN_ANYC || 2471290631Savos ni->ni_chan == IEEE80211_CHAN_ANYC) { 2472290631Savos device_printf(sc->sc_dev, 2473290631Savos "%s: could not move to RUN state\n", __func__); 2474290631Savos error = EINVAL; 2475290631Savos goto end_run; 2476290631Savos } 2477290631Savos 2478290631Savos switch (vap->iv_opmode) { 2479290631Savos case IEEE80211_M_STA: 2480290631Savos mode = R92C_MSR_INFRA; 2481290631Savos break; 2482290651Savos case IEEE80211_M_IBSS: 2483290651Savos mode = R92C_MSR_ADHOC; 2484290651Savos break; 2485290631Savos case IEEE80211_M_HOSTAP: 2486290631Savos mode = R92C_MSR_AP; 2487290631Savos break; 2488290631Savos default: 2489290631Savos device_printf(sc->sc_dev, "undefined opmode %d\n", 2490290631Savos vap->iv_opmode); 2491290631Savos error = EINVAL; 2492290631Savos goto end_run; 2493290631Savos } 2494290631Savos 2495251538Srpaulo /* Set media status to 'Associated'. */ 2496290631Savos urtwn_set_mode(sc, mode); 2497251538Srpaulo 2498251538Srpaulo /* Set BSSID. */ 2499251538Srpaulo urtwn_write_4(sc, R92C_BSSID + 0, LE_READ_4(&ni->ni_bssid[0])); 2500251538Srpaulo urtwn_write_4(sc, R92C_BSSID + 4, LE_READ_2(&ni->ni_bssid[4])); 2501251538Srpaulo 2502251538Srpaulo if (ic->ic_curmode == IEEE80211_MODE_11B) 2503251538Srpaulo urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 0); 2504251538Srpaulo else /* 802.11b/g */ 2505251538Srpaulo urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 3); 2506251538Srpaulo 2507251538Srpaulo /* Enable Rx of data frames. */ 2508251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff); 2509251538Srpaulo 2510251538Srpaulo /* Flush all AC queues. */ 2511251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 0); 2512251538Srpaulo 2513251538Srpaulo /* Set beacon interval. */ 2514251538Srpaulo urtwn_write_2(sc, R92C_BCN_INTERVAL, ni->ni_intval); 2515251538Srpaulo 2516251538Srpaulo /* Allow Rx from our BSSID only. */ 2517290564Savos if (ic->ic_promisc == 0) { 2518290631Savos reg = urtwn_read_4(sc, R92C_RCR); 2519290631Savos 2520290631Savos if (vap->iv_opmode != IEEE80211_M_HOSTAP) 2521290631Savos reg |= R92C_RCR_CBSSID_DATA; 2522290651Savos if (vap->iv_opmode != IEEE80211_M_IBSS) 2523290651Savos reg |= R92C_RCR_CBSSID_BCN; 2524290631Savos 2525290631Savos urtwn_write_4(sc, R92C_RCR, reg); 2526290564Savos } 2527251538Srpaulo 2528290651Savos if (vap->iv_opmode == IEEE80211_M_HOSTAP || 2529290651Savos vap->iv_opmode == IEEE80211_M_IBSS) { 2530290631Savos error = urtwn_setup_beacon(sc, ni); 2531290631Savos if (error != 0) { 2532290631Savos device_printf(sc->sc_dev, 2533290631Savos "unable to push beacon into the chip, " 2534290631Savos "error %d\n", error); 2535290631Savos goto end_run; 2536290631Savos } 2537290631Savos } 2538290631Savos 2539251538Srpaulo /* Enable TSF synchronization. */ 2540290631Savos urtwn_tsf_sync_enable(sc, vap); 2541251538Srpaulo 2542251538Srpaulo urtwn_write_1(sc, R92C_SIFS_CCK + 1, 10); 2543251538Srpaulo urtwn_write_1(sc, R92C_SIFS_OFDM + 1, 10); 2544251538Srpaulo urtwn_write_1(sc, R92C_SPEC_SIFS + 1, 10); 2545251538Srpaulo urtwn_write_1(sc, R92C_MAC_SPEC_SIFS + 1, 10); 2546251538Srpaulo urtwn_write_1(sc, R92C_R2T_SIFS + 1, 10); 2547251538Srpaulo urtwn_write_1(sc, R92C_T2T_SIFS + 1, 10); 2548251538Srpaulo 2549251538Srpaulo /* Intialize rate adaptation. */ 2550292167Savos if (!(sc->chip & URTWN_CHIP_88E)) 2551264912Skevlo urtwn_ra_init(sc); 2552251538Srpaulo /* Turn link LED on. */ 2553251538Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, 1); 2554251538Srpaulo 2555251538Srpaulo sc->avg_pwdb = -1; /* Reset average RSSI. */ 2556251538Srpaulo /* Reset temperature calibration state machine. */ 2557294473Savos sc->sc_flags &= ~URTWN_TEMP_MEASURED; 2558251538Srpaulo sc->thcal_lctemp = 0; 2559294473Savos /* Start periodic calibration. */ 2560294473Savos callout_reset(&sc->sc_calib_to, 2*hz, urtwn_calib_to, sc); 2561290631Savos 2562290631Savosend_run: 2563251538Srpaulo ieee80211_free_node(ni); 2564251538Srpaulo break; 2565251538Srpaulo default: 2566251538Srpaulo break; 2567251538Srpaulo } 2568290631Savos 2569251538Srpaulo URTWN_UNLOCK(sc); 2570251538Srpaulo IEEE80211_LOCK(ic); 2571290631Savos return (error != 0 ? error : uvp->newstate(vap, nstate, arg)); 2572251538Srpaulo} 2573251538Srpaulo 2574251538Srpaulostatic void 2575294473Savosurtwn_calib_to(void *arg) 2576294473Savos{ 2577294473Savos struct urtwn_softc *sc = arg; 2578294473Savos 2579294473Savos /* Do it in a process context. */ 2580294473Savos urtwn_cmd_sleepable(sc, NULL, 0, urtwn_calib_cb); 2581294473Savos} 2582294473Savos 2583294473Savosstatic void 2584294473Savosurtwn_calib_cb(struct urtwn_softc *sc, union sec_param *data) 2585294473Savos{ 2586294473Savos /* Do temperature compensation. */ 2587294473Savos urtwn_temp_calib(sc); 2588294473Savos 2589294473Savos if ((urtwn_read_1(sc, R92C_MSR) & R92C_MSR_MASK) != R92C_MSR_NOLINK) 2590294473Savos callout_reset(&sc->sc_calib_to, 2*hz, urtwn_calib_to, sc); 2591294473Savos} 2592294473Savos 2593294473Savosstatic void 2594251538Srpaulourtwn_watchdog(void *arg) 2595251538Srpaulo{ 2596251538Srpaulo struct urtwn_softc *sc = arg; 2597251538Srpaulo 2598251538Srpaulo if (sc->sc_txtimer > 0) { 2599251538Srpaulo if (--sc->sc_txtimer == 0) { 2600251538Srpaulo device_printf(sc->sc_dev, "device timeout\n"); 2601287197Sglebius counter_u64_add(sc->sc_ic.ic_oerrors, 1); 2602251538Srpaulo return; 2603251538Srpaulo } 2604251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 2605251538Srpaulo } 2606251538Srpaulo} 2607251538Srpaulo 2608251538Srpaulostatic void 2609251538Srpaulourtwn_update_avgrssi(struct urtwn_softc *sc, int rate, int8_t rssi) 2610251538Srpaulo{ 2611251538Srpaulo int pwdb; 2612251538Srpaulo 2613251538Srpaulo /* Convert antenna signal to percentage. */ 2614251538Srpaulo if (rssi <= -100 || rssi >= 20) 2615251538Srpaulo pwdb = 0; 2616251538Srpaulo else if (rssi >= 0) 2617251538Srpaulo pwdb = 100; 2618251538Srpaulo else 2619251538Srpaulo pwdb = 100 + rssi; 2620264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 2621289758Savos if (rate <= URTWN_RIDX_CCK11) { 2622264912Skevlo /* CCK gain is smaller than OFDM/MCS gain. */ 2623264912Skevlo pwdb += 6; 2624264912Skevlo if (pwdb > 100) 2625264912Skevlo pwdb = 100; 2626264912Skevlo if (pwdb <= 14) 2627264912Skevlo pwdb -= 4; 2628264912Skevlo else if (pwdb <= 26) 2629264912Skevlo pwdb -= 8; 2630264912Skevlo else if (pwdb <= 34) 2631264912Skevlo pwdb -= 6; 2632264912Skevlo else if (pwdb <= 42) 2633264912Skevlo pwdb -= 2; 2634264912Skevlo } 2635251538Srpaulo } 2636251538Srpaulo if (sc->avg_pwdb == -1) /* Init. */ 2637251538Srpaulo sc->avg_pwdb = pwdb; 2638251538Srpaulo else if (sc->avg_pwdb < pwdb) 2639251538Srpaulo sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20) + 1; 2640251538Srpaulo else 2641251538Srpaulo sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20); 2642297175Sadrian URTWN_DPRINTF(sc, URTWN_DEBUG_RSSI, "%s: PWDB %d, EMA %d\n", __func__, 2643294471Savos pwdb, sc->avg_pwdb); 2644251538Srpaulo} 2645251538Srpaulo 2646251538Srpaulostatic int8_t 2647251538Srpaulourtwn_get_rssi(struct urtwn_softc *sc, int rate, void *physt) 2648251538Srpaulo{ 2649251538Srpaulo static const int8_t cckoff[] = { 16, -12, -26, -46 }; 2650251538Srpaulo struct r92c_rx_phystat *phy; 2651251538Srpaulo struct r92c_rx_cck *cck; 2652251538Srpaulo uint8_t rpt; 2653251538Srpaulo int8_t rssi; 2654251538Srpaulo 2655289758Savos if (rate <= URTWN_RIDX_CCK11) { 2656251538Srpaulo cck = (struct r92c_rx_cck *)physt; 2657251538Srpaulo if (sc->sc_flags & URTWN_FLAG_CCK_HIPWR) { 2658251538Srpaulo rpt = (cck->agc_rpt >> 5) & 0x3; 2659251538Srpaulo rssi = (cck->agc_rpt & 0x1f) << 1; 2660251538Srpaulo } else { 2661251538Srpaulo rpt = (cck->agc_rpt >> 6) & 0x3; 2662251538Srpaulo rssi = cck->agc_rpt & 0x3e; 2663251538Srpaulo } 2664251538Srpaulo rssi = cckoff[rpt] - rssi; 2665251538Srpaulo } else { /* OFDM/HT. */ 2666251538Srpaulo phy = (struct r92c_rx_phystat *)physt; 2667251538Srpaulo rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110; 2668251538Srpaulo } 2669251538Srpaulo return (rssi); 2670251538Srpaulo} 2671251538Srpaulo 2672264912Skevlostatic int8_t 2673264912Skevlourtwn_r88e_get_rssi(struct urtwn_softc *sc, int rate, void *physt) 2674264912Skevlo{ 2675264912Skevlo struct r92c_rx_phystat *phy; 2676264912Skevlo struct r88e_rx_cck *cck; 2677264912Skevlo uint8_t cck_agc_rpt, lna_idx, vga_idx; 2678264912Skevlo int8_t rssi; 2679264912Skevlo 2680264972Skevlo rssi = 0; 2681289758Savos if (rate <= URTWN_RIDX_CCK11) { 2682264912Skevlo cck = (struct r88e_rx_cck *)physt; 2683264912Skevlo cck_agc_rpt = cck->agc_rpt; 2684264912Skevlo lna_idx = (cck_agc_rpt & 0xe0) >> 5; 2685281069Srpaulo vga_idx = cck_agc_rpt & 0x1f; 2686264912Skevlo switch (lna_idx) { 2687264912Skevlo case 7: 2688264912Skevlo if (vga_idx <= 27) 2689264912Skevlo rssi = -100 + 2* (27 - vga_idx); 2690264912Skevlo else 2691264912Skevlo rssi = -100; 2692264912Skevlo break; 2693264912Skevlo case 6: 2694264912Skevlo rssi = -48 + 2 * (2 - vga_idx); 2695264912Skevlo break; 2696264912Skevlo case 5: 2697264912Skevlo rssi = -42 + 2 * (7 - vga_idx); 2698264912Skevlo break; 2699264912Skevlo case 4: 2700264912Skevlo rssi = -36 + 2 * (7 - vga_idx); 2701264912Skevlo break; 2702264912Skevlo case 3: 2703264912Skevlo rssi = -24 + 2 * (7 - vga_idx); 2704264912Skevlo break; 2705264912Skevlo case 2: 2706264912Skevlo rssi = -12 + 2 * (5 - vga_idx); 2707264912Skevlo break; 2708264912Skevlo case 1: 2709264912Skevlo rssi = 8 - (2 * vga_idx); 2710264912Skevlo break; 2711264912Skevlo case 0: 2712264912Skevlo rssi = 14 - (2 * vga_idx); 2713264912Skevlo break; 2714264912Skevlo } 2715264912Skevlo rssi += 6; 2716264912Skevlo } else { /* OFDM/HT. */ 2717264912Skevlo phy = (struct r92c_rx_phystat *)physt; 2718264912Skevlo rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110; 2719264912Skevlo } 2720264912Skevlo return (rssi); 2721264912Skevlo} 2722264912Skevlo 2723292167Savosstatic __inline uint8_t 2724292167Savosrate2ridx(uint8_t rate) 2725292167Savos{ 2726297175Sadrian if (rate & IEEE80211_RATE_MCS) { 2727297175Sadrian /* 11n rates start at idx 12 */ 2728297175Sadrian return ((rate & 0xf) + 12); 2729297175Sadrian } 2730292167Savos switch (rate) { 2731297175Sadrian /* 11g */ 2732292167Savos case 12: return 4; 2733292167Savos case 18: return 5; 2734292167Savos case 24: return 6; 2735292167Savos case 36: return 7; 2736292167Savos case 48: return 8; 2737292167Savos case 72: return 9; 2738292167Savos case 96: return 10; 2739292167Savos case 108: return 11; 2740297175Sadrian /* 11b */ 2741292167Savos case 2: return 0; 2742292167Savos case 4: return 1; 2743292167Savos case 11: return 2; 2744292167Savos case 22: return 3; 2745292167Savos default: return 0; 2746292167Savos } 2747292167Savos} 2748292167Savos 2749251538Srpaulostatic int 2750290630Savosurtwn_tx_data(struct urtwn_softc *sc, struct ieee80211_node *ni, 2751290630Savos struct mbuf *m, struct urtwn_data *data) 2752251538Srpaulo{ 2753292167Savos const struct ieee80211_txparam *tp; 2754287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 2755251538Srpaulo struct ieee80211vap *vap = ni->ni_vap; 2756292167Savos struct ieee80211_key *k = NULL; 2757292167Savos struct ieee80211_channel *chan; 2758292167Savos struct ieee80211_frame *wh; 2759251538Srpaulo struct r92c_tx_desc *txd; 2760292167Savos uint8_t macid, raid, rate, ridx, subtype, type, tid, qsel; 2761292014Savos int hasqos, ismcast; 2762251538Srpaulo 2763251538Srpaulo URTWN_ASSERT_LOCKED(sc); 2764251538Srpaulo 2765251538Srpaulo /* 2766251538Srpaulo * Software crypto. 2767251538Srpaulo */ 2768290630Savos wh = mtod(m, struct ieee80211_frame *); 2769264912Skevlo type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK; 2770290630Savos subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK; 2771292014Savos hasqos = IEEE80211_QOS_HAS_SEQ(wh); 2772290630Savos ismcast = IEEE80211_IS_MULTICAST(wh->i_addr1); 2773264912Skevlo 2774292014Savos /* Select TX ring for this frame. */ 2775292014Savos if (hasqos) { 2776292014Savos tid = ((const struct ieee80211_qosframe *)wh)->i_qos[0]; 2777292014Savos tid &= IEEE80211_QOS_TID; 2778292014Savos } else 2779292014Savos tid = 0; 2780292014Savos 2781292167Savos chan = (ni->ni_chan != IEEE80211_CHAN_ANYC) ? 2782292167Savos ni->ni_chan : ic->ic_curchan; 2783292167Savos tp = &vap->iv_txparms[ieee80211_chan2mode(chan)]; 2784292167Savos 2785292167Savos /* Choose a TX rate index. */ 2786292167Savos if (type == IEEE80211_FC0_TYPE_MGT) 2787292167Savos rate = tp->mgmtrate; 2788292167Savos else if (ismcast) 2789292167Savos rate = tp->mcastrate; 2790292167Savos else if (tp->ucastrate != IEEE80211_FIXED_RATE_NONE) 2791292167Savos rate = tp->ucastrate; 2792292167Savos else if (m->m_flags & M_EAPOL) 2793292167Savos rate = tp->mgmtrate; 2794292167Savos else { 2795292167Savos if (URTWN_CHIP_HAS_RATECTL(sc)) { 2796292167Savos /* XXX pass pktlen */ 2797292167Savos (void) ieee80211_ratectl_rate(ni, NULL, 0); 2798292167Savos rate = ni->ni_txrate; 2799292167Savos } else { 2800297175Sadrian /* XXX TODO: drop the default rate for 11b/11g? */ 2801297175Sadrian if (ni->ni_flags & IEEE80211_NODE_HT) 2802297175Sadrian rate = IEEE80211_RATE_MCS | 0x4; /* MCS4 */ 2803297175Sadrian else if (ic->ic_curmode != IEEE80211_MODE_11B) 2804292167Savos rate = 108; 2805292167Savos else 2806292167Savos rate = 22; 2807292167Savos } 2808292167Savos } 2809292167Savos 2810297175Sadrian /* 2811297175Sadrian * XXX TODO: this should be per-node, for 11b versus 11bg 2812297175Sadrian * nodes in hostap mode 2813297175Sadrian */ 2814292167Savos ridx = rate2ridx(rate); 2815297175Sadrian if (ni->ni_flags & IEEE80211_NODE_HT) 2816297175Sadrian raid = R92C_RAID_11GN; 2817297175Sadrian else if (ic->ic_curmode != IEEE80211_MODE_11B) 2818292167Savos raid = R92C_RAID_11BG; 2819292167Savos else 2820292167Savos raid = R92C_RAID_11B; 2821292167Savos 2822260444Skevlo if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 2823290630Savos k = ieee80211_crypto_encap(ni, m); 2824251538Srpaulo if (k == NULL) { 2825251538Srpaulo device_printf(sc->sc_dev, 2826251538Srpaulo "ieee80211_crypto_encap returns NULL.\n"); 2827251538Srpaulo return (ENOBUFS); 2828251538Srpaulo } 2829251538Srpaulo 2830251538Srpaulo /* in case packet header moved, reset pointer */ 2831290630Savos wh = mtod(m, struct ieee80211_frame *); 2832251538Srpaulo } 2833281069Srpaulo 2834251538Srpaulo /* Fill Tx descriptor. */ 2835251538Srpaulo txd = (struct r92c_tx_desc *)data->buf; 2836251538Srpaulo memset(txd, 0, sizeof(*txd)); 2837251538Srpaulo 2838251538Srpaulo txd->txdw0 |= htole32( 2839251538Srpaulo SM(R92C_TXDW0_OFFSET, sizeof(*txd)) | 2840251538Srpaulo R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG); 2841290630Savos if (ismcast) 2842251538Srpaulo txd->txdw0 |= htole32(R92C_TXDW0_BMCAST); 2843290630Savos 2844290630Savos if (!ismcast) { 2845292167Savos if (sc->chip & URTWN_CHIP_88E) { 2846292167Savos struct urtwn_node *un = URTWN_NODE(ni); 2847292167Savos macid = un->id; 2848292167Savos } else 2849292167Savos macid = URTWN_MACID_BSS; 2850290630Savos 2851290630Savos if (type == IEEE80211_FC0_TYPE_DATA) { 2852292014Savos qsel = tid % URTWN_MAX_TID; 2853290630Savos 2854292167Savos if (sc->chip & URTWN_CHIP_88E) { 2855292167Savos txd->txdw2 |= htole32( 2856292167Savos R88E_TXDW2_AGGBK | 2857292167Savos R88E_TXDW2_CCX_RPT); 2858292167Savos } else 2859290630Savos txd->txdw1 |= htole32(R92C_TXDW1_AGGBK); 2860290630Savos 2861297175Sadrian /* protmode, non-HT */ 2862297175Sadrian /* XXX TODO: noack frames? */ 2863297175Sadrian if ((rate & 0x80) == 0 && 2864297175Sadrian (ic->ic_flags & IEEE80211_F_USEPROT)) { 2865290630Savos switch (ic->ic_protmode) { 2866290630Savos case IEEE80211_PROT_CTSONLY: 2867290630Savos txd->txdw4 |= htole32( 2868290630Savos R92C_TXDW4_CTS2SELF | 2869290630Savos R92C_TXDW4_HWRTSEN); 2870290630Savos break; 2871290630Savos case IEEE80211_PROT_RTSCTS: 2872290630Savos txd->txdw4 |= htole32( 2873290630Savos R92C_TXDW4_RTSEN | 2874290630Savos R92C_TXDW4_HWRTSEN); 2875290630Savos break; 2876290630Savos default: 2877290630Savos break; 2878290630Savos } 2879290630Savos } 2880297175Sadrian 2881297175Sadrian /* protmode, HT */ 2882297175Sadrian /* XXX TODO: noack frames? */ 2883297175Sadrian if ((rate & 0x80) && 2884297175Sadrian (ic->ic_htprotmode == IEEE80211_PROT_RTSCTS)) { 2885297175Sadrian txd->txdw4 |= htole32( 2886297175Sadrian R92C_TXDW4_RTSEN | 2887297175Sadrian R92C_TXDW4_HWRTSEN); 2888297175Sadrian } 2889297175Sadrian 2890297175Sadrian /* XXX TODO: rtsrate is configurable? 24mbit may 2891297175Sadrian * be a bit high for RTS rate? */ 2892290630Savos txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE, 2893290630Savos URTWN_RIDX_OFDM24)); 2894297175Sadrian 2895290630Savos txd->txdw5 |= htole32(0x0001ff00); 2896290630Savos } else /* IEEE80211_FC0_TYPE_MGT */ 2897290630Savos qsel = R92C_TXDW1_QSEL_MGNT; 2898251538Srpaulo } else { 2899290630Savos macid = URTWN_MACID_BC; 2900290630Savos qsel = R92C_TXDW1_QSEL_MGNT; 2901290630Savos } 2902251538Srpaulo 2903290630Savos txd->txdw1 |= htole32( 2904290630Savos SM(R92C_TXDW1_QSEL, qsel) | 2905290630Savos SM(R92C_TXDW1_RAID, raid)); 2906290630Savos 2907297175Sadrian /* XXX TODO: 40MHZ flag? */ 2908297175Sadrian /* XXX TODO: AMPDU flag? (AGG_ENABLE or AGG_BREAK?) Density shift? */ 2909297175Sadrian /* XXX Short preamble? */ 2910297175Sadrian /* XXX Short-GI? */ 2911297175Sadrian 2912290630Savos if (sc->chip & URTWN_CHIP_88E) 2913290630Savos txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, macid)); 2914290630Savos else 2915290630Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, macid)); 2916290630Savos 2917290630Savos txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, ridx)); 2918297175Sadrian 2919291858Savos /* Force this rate if needed. */ 2920292167Savos if (URTWN_CHIP_HAS_RATECTL(sc) || ismcast || 2921297175Sadrian (tp->ucastrate != IEEE80211_FIXED_RATE_NONE) || 2922292167Savos (m->m_flags & M_EAPOL) || type != IEEE80211_FC0_TYPE_DATA) 2923251538Srpaulo txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE); 2924251538Srpaulo 2925292014Savos if (!hasqos) { 2926251538Srpaulo /* Use HW sequence numbering for non-QoS frames. */ 2927291858Savos if (sc->chip & URTWN_CHIP_88E) 2928291858Savos txd->txdseq = htole16(R88E_TXDSEQ_HWSEQ_EN); 2929291858Savos else 2930291858Savos txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN); 2931290630Savos } else { 2932290630Savos /* Set sequence number. */ 2933290630Savos txd->txdseq = htole16(M_SEQNO_GET(m) % IEEE80211_SEQ_RANGE); 2934290630Savos } 2935251538Srpaulo 2936292175Savos if (k != NULL && !(k->wk_flags & IEEE80211_KEY_SWCRYPT)) { 2937292175Savos uint8_t cipher; 2938292175Savos 2939292175Savos switch (k->wk_cipher->ic_cipher) { 2940292175Savos case IEEE80211_CIPHER_WEP: 2941292175Savos case IEEE80211_CIPHER_TKIP: 2942292175Savos cipher = R92C_TXDW1_CIPHER_RC4; 2943292175Savos break; 2944292175Savos case IEEE80211_CIPHER_AES_CCM: 2945292175Savos cipher = R92C_TXDW1_CIPHER_AES; 2946292175Savos break; 2947292175Savos default: 2948292175Savos device_printf(sc->sc_dev, "%s: unknown cipher %d\n", 2949292175Savos __func__, k->wk_cipher->ic_cipher); 2950292175Savos return (EINVAL); 2951292175Savos } 2952292175Savos 2953292175Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_CIPHER, cipher)); 2954292175Savos } 2955292175Savos 2956251538Srpaulo if (ieee80211_radiotap_active_vap(vap)) { 2957251538Srpaulo struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap; 2958251538Srpaulo 2959251538Srpaulo tap->wt_flags = 0; 2960290630Savos if (k != NULL) 2961290630Savos tap->wt_flags |= IEEE80211_RADIOTAP_F_WEP; 2962290630Savos ieee80211_radiotap_tx(vap, m); 2963251538Srpaulo } 2964251538Srpaulo 2965290630Savos data->ni = ni; 2966251538Srpaulo 2967290630Savos urtwn_tx_start(sc, m, type, data); 2968290630Savos 2969290630Savos return (0); 2970290630Savos} 2971290630Savos 2972292221Savosstatic int 2973292221Savosurtwn_tx_raw(struct urtwn_softc *sc, struct ieee80211_node *ni, 2974292221Savos struct mbuf *m, struct urtwn_data *data, 2975292221Savos const struct ieee80211_bpf_params *params) 2976292221Savos{ 2977292221Savos struct ieee80211vap *vap = ni->ni_vap; 2978292221Savos struct ieee80211_key *k = NULL; 2979292221Savos struct ieee80211_frame *wh; 2980292221Savos struct r92c_tx_desc *txd; 2981292221Savos uint8_t cipher, ridx, type; 2982292221Savos 2983292221Savos /* Encrypt the frame if need be. */ 2984292221Savos cipher = R92C_TXDW1_CIPHER_NONE; 2985292221Savos if (params->ibp_flags & IEEE80211_BPF_CRYPTO) { 2986292221Savos /* Retrieve key for TX. */ 2987292221Savos k = ieee80211_crypto_encap(ni, m); 2988292221Savos if (k == NULL) 2989292221Savos return (ENOBUFS); 2990292221Savos 2991292221Savos if (!(k->wk_flags & IEEE80211_KEY_SWCRYPT)) { 2992292221Savos switch (k->wk_cipher->ic_cipher) { 2993292221Savos case IEEE80211_CIPHER_WEP: 2994292221Savos case IEEE80211_CIPHER_TKIP: 2995292221Savos cipher = R92C_TXDW1_CIPHER_RC4; 2996292221Savos break; 2997292221Savos case IEEE80211_CIPHER_AES_CCM: 2998292221Savos cipher = R92C_TXDW1_CIPHER_AES; 2999292221Savos break; 3000292221Savos default: 3001292221Savos device_printf(sc->sc_dev, 3002292221Savos "%s: unknown cipher %d\n", 3003292221Savos __func__, k->wk_cipher->ic_cipher); 3004292221Savos return (EINVAL); 3005292221Savos } 3006292221Savos } 3007292221Savos } 3008292221Savos 3009297175Sadrian /* XXX TODO: 11n checks, matching urtwn_tx_data() */ 3010297175Sadrian 3011292221Savos wh = mtod(m, struct ieee80211_frame *); 3012292221Savos type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK; 3013292221Savos 3014292221Savos /* Fill Tx descriptor. */ 3015292221Savos txd = (struct r92c_tx_desc *)data->buf; 3016292221Savos memset(txd, 0, sizeof(*txd)); 3017292221Savos 3018292221Savos txd->txdw0 |= htole32( 3019292221Savos SM(R92C_TXDW0_OFFSET, sizeof(*txd)) | 3020292221Savos R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG); 3021292221Savos if (IEEE80211_IS_MULTICAST(wh->i_addr1)) 3022292221Savos txd->txdw0 |= htole32(R92C_TXDW0_BMCAST); 3023292221Savos 3024292221Savos if (params->ibp_flags & IEEE80211_BPF_RTS) 3025292221Savos txd->txdw4 |= htole32(R92C_TXDW4_RTSEN); 3026292221Savos if (params->ibp_flags & IEEE80211_BPF_CTS) 3027292221Savos txd->txdw4 |= htole32(R92C_TXDW4_CTS2SELF); 3028292221Savos if (txd->txdw4 & htole32(R92C_TXDW4_RTSEN | R92C_TXDW4_CTS2SELF)) { 3029292221Savos txd->txdw4 |= htole32(R92C_TXDW4_HWRTSEN); 3030292221Savos txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE, 3031292221Savos URTWN_RIDX_OFDM24)); 3032292221Savos } 3033292221Savos 3034292221Savos if (sc->chip & URTWN_CHIP_88E) 3035292221Savos txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, URTWN_MACID_BC)); 3036292221Savos else 3037292221Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, URTWN_MACID_BC)); 3038292221Savos 3039297175Sadrian /* XXX TODO: rate index/config (RAID) for 11n? */ 3040292221Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_MGNT)); 3041292221Savos txd->txdw1 |= htole32(SM(R92C_TXDW1_CIPHER, cipher)); 3042292221Savos 3043292221Savos /* Choose a TX rate index. */ 3044292221Savos ridx = rate2ridx(params->ibp_rate0); 3045292221Savos txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, ridx)); 3046292221Savos txd->txdw5 |= htole32(0x0001ff00); 3047292221Savos txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE); 3048292221Savos 3049292221Savos if (!IEEE80211_QOS_HAS_SEQ(wh)) { 3050292221Savos /* Use HW sequence numbering for non-QoS frames. */ 3051292221Savos if (sc->chip & URTWN_CHIP_88E) 3052292221Savos txd->txdseq = htole16(R88E_TXDSEQ_HWSEQ_EN); 3053292221Savos else 3054292221Savos txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN); 3055292221Savos } else { 3056292221Savos /* Set sequence number. */ 3057292221Savos txd->txdseq = htole16(M_SEQNO_GET(m) % IEEE80211_SEQ_RANGE); 3058292221Savos } 3059292221Savos 3060292221Savos if (ieee80211_radiotap_active_vap(vap)) { 3061292221Savos struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap; 3062292221Savos 3063292221Savos tap->wt_flags = 0; 3064292221Savos if (k != NULL) 3065292221Savos tap->wt_flags |= IEEE80211_RADIOTAP_F_WEP; 3066292221Savos ieee80211_radiotap_tx(vap, m); 3067292221Savos } 3068292221Savos 3069292221Savos data->ni = ni; 3070292221Savos 3071292221Savos urtwn_tx_start(sc, m, type, data); 3072292221Savos 3073292221Savos return (0); 3074292221Savos} 3075292221Savos 3076290630Savosstatic void 3077290630Savosurtwn_tx_start(struct urtwn_softc *sc, struct mbuf *m, uint8_t type, 3078290630Savos struct urtwn_data *data) 3079290630Savos{ 3080290630Savos struct usb_xfer *xfer; 3081290630Savos struct r92c_tx_desc *txd; 3082290630Savos uint16_t ac, sum; 3083290630Savos int i, xferlen; 3084290630Savos 3085290630Savos URTWN_ASSERT_LOCKED(sc); 3086290630Savos 3087290630Savos ac = M_WME_GETAC(m); 3088290630Savos 3089290630Savos switch (type) { 3090290630Savos case IEEE80211_FC0_TYPE_CTL: 3091290630Savos case IEEE80211_FC0_TYPE_MGT: 3092290630Savos xfer = sc->sc_xfer[URTWN_BULK_TX_VO]; 3093290630Savos break; 3094290630Savos default: 3095292014Savos xfer = sc->sc_xfer[wme2queue[ac].qid]; 3096290630Savos break; 3097290630Savos } 3098290630Savos 3099290630Savos txd = (struct r92c_tx_desc *)data->buf; 3100290630Savos txd->txdw0 |= htole32(SM(R92C_TXDW0_PKTLEN, m->m_pkthdr.len)); 3101290630Savos 3102290630Savos /* Compute Tx descriptor checksum. */ 3103290630Savos sum = 0; 3104290630Savos for (i = 0; i < sizeof(*txd) / 2; i++) 3105290630Savos sum ^= ((uint16_t *)txd)[i]; 3106290630Savos txd->txdsum = sum; /* NB: already little endian. */ 3107290630Savos 3108290630Savos xferlen = sizeof(*txd) + m->m_pkthdr.len; 3109290630Savos m_copydata(m, 0, m->m_pkthdr.len, (caddr_t)&txd[1]); 3110290630Savos 3111251538Srpaulo data->buflen = xferlen; 3112290630Savos data->m = m; 3113251538Srpaulo 3114251538Srpaulo STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next); 3115251538Srpaulo usbd_transfer_start(xfer); 3116251538Srpaulo} 3117251538Srpaulo 3118287197Sglebiusstatic int 3119287197Sglebiusurtwn_transmit(struct ieee80211com *ic, struct mbuf *m) 3120251538Srpaulo{ 3121287197Sglebius struct urtwn_softc *sc = ic->ic_softc; 3122287197Sglebius int error; 3123261863Srpaulo 3124261863Srpaulo URTWN_LOCK(sc); 3125287197Sglebius if ((sc->sc_flags & URTWN_RUNNING) == 0) { 3126287197Sglebius URTWN_UNLOCK(sc); 3127287197Sglebius return (ENXIO); 3128287197Sglebius } 3129287197Sglebius error = mbufq_enqueue(&sc->sc_snd, m); 3130287197Sglebius if (error) { 3131287197Sglebius URTWN_UNLOCK(sc); 3132287197Sglebius return (error); 3133287197Sglebius } 3134287197Sglebius urtwn_start(sc); 3135261863Srpaulo URTWN_UNLOCK(sc); 3136287197Sglebius 3137287197Sglebius return (0); 3138261863Srpaulo} 3139261863Srpaulo 3140261863Srpaulostatic void 3141287197Sglebiusurtwn_start(struct urtwn_softc *sc) 3142261863Srpaulo{ 3143251538Srpaulo struct ieee80211_node *ni; 3144251538Srpaulo struct mbuf *m; 3145251538Srpaulo struct urtwn_data *bf; 3146251538Srpaulo 3147261863Srpaulo URTWN_ASSERT_LOCKED(sc); 3148287197Sglebius while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) { 3149251538Srpaulo bf = urtwn_getbuf(sc); 3150251538Srpaulo if (bf == NULL) { 3151287197Sglebius mbufq_prepend(&sc->sc_snd, m); 3152251538Srpaulo break; 3153251538Srpaulo } 3154251538Srpaulo ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 3155251538Srpaulo m->m_pkthdr.rcvif = NULL; 3156290630Savos if (urtwn_tx_data(sc, ni, m, bf) != 0) { 3157287197Sglebius if_inc_counter(ni->ni_vap->iv_ifp, 3158287197Sglebius IFCOUNTER_OERRORS, 1); 3159251538Srpaulo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 3160288353Sadrian m_freem(m); 3161251538Srpaulo ieee80211_free_node(ni); 3162251538Srpaulo break; 3163251538Srpaulo } 3164251538Srpaulo sc->sc_txtimer = 5; 3165251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 3166251538Srpaulo } 3167251538Srpaulo} 3168251538Srpaulo 3169287197Sglebiusstatic void 3170287197Sglebiusurtwn_parent(struct ieee80211com *ic) 3171251538Srpaulo{ 3172286949Sadrian struct urtwn_softc *sc = ic->ic_softc; 3173251538Srpaulo 3174263153Skevlo URTWN_LOCK(sc); 3175287197Sglebius if (sc->sc_flags & URTWN_DETACHED) { 3176287197Sglebius URTWN_UNLOCK(sc); 3177287197Sglebius return; 3178287197Sglebius } 3179291698Savos URTWN_UNLOCK(sc); 3180291698Savos 3181287197Sglebius if (ic->ic_nrunning > 0) { 3182291698Savos if (urtwn_init(sc) != 0) { 3183291698Savos struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 3184291698Savos if (vap != NULL) 3185291698Savos ieee80211_stop(vap); 3186291698Savos } else 3187291698Savos ieee80211_start_all(ic); 3188291698Savos } else 3189287197Sglebius urtwn_stop(sc); 3190251538Srpaulo} 3191251538Srpaulo 3192264912Skevlostatic __inline int 3193251538Srpaulourtwn_power_on(struct urtwn_softc *sc) 3194251538Srpaulo{ 3195264912Skevlo 3196264912Skevlo return sc->sc_power_on(sc); 3197264912Skevlo} 3198264912Skevlo 3199264912Skevlostatic int 3200264912Skevlourtwn_r92c_power_on(struct urtwn_softc *sc) 3201264912Skevlo{ 3202251538Srpaulo uint32_t reg; 3203291698Savos usb_error_t error; 3204251538Srpaulo int ntries; 3205251538Srpaulo 3206251538Srpaulo /* Wait for autoload done bit. */ 3207251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 3208251538Srpaulo if (urtwn_read_1(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_PFM_ALDN) 3209251538Srpaulo break; 3210266472Shselasky urtwn_ms_delay(sc); 3211251538Srpaulo } 3212251538Srpaulo if (ntries == 1000) { 3213251538Srpaulo device_printf(sc->sc_dev, 3214251538Srpaulo "timeout waiting for chip autoload\n"); 3215251538Srpaulo return (ETIMEDOUT); 3216251538Srpaulo } 3217251538Srpaulo 3218251538Srpaulo /* Unlock ISO/CLK/Power control register. */ 3219291698Savos error = urtwn_write_1(sc, R92C_RSV_CTRL, 0); 3220291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3221291698Savos return (EIO); 3222251538Srpaulo /* Move SPS into PWM mode. */ 3223291698Savos error = urtwn_write_1(sc, R92C_SPS0_CTRL, 0x2b); 3224291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3225291698Savos return (EIO); 3226266472Shselasky urtwn_ms_delay(sc); 3227251538Srpaulo 3228251538Srpaulo reg = urtwn_read_1(sc, R92C_LDOV12D_CTRL); 3229251538Srpaulo if (!(reg & R92C_LDOV12D_CTRL_LDV12_EN)) { 3230291698Savos error = urtwn_write_1(sc, R92C_LDOV12D_CTRL, 3231251538Srpaulo reg | R92C_LDOV12D_CTRL_LDV12_EN); 3232291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3233291698Savos return (EIO); 3234266472Shselasky urtwn_ms_delay(sc); 3235291698Savos error = urtwn_write_1(sc, R92C_SYS_ISO_CTRL, 3236251538Srpaulo urtwn_read_1(sc, R92C_SYS_ISO_CTRL) & 3237251538Srpaulo ~R92C_SYS_ISO_CTRL_MD2PP); 3238291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3239291698Savos return (EIO); 3240251538Srpaulo } 3241251538Srpaulo 3242251538Srpaulo /* Auto enable WLAN. */ 3243291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 3244251538Srpaulo urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC); 3245291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3246291698Savos return (EIO); 3247251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 3248262822Skevlo if (!(urtwn_read_2(sc, R92C_APS_FSMCO) & 3249262822Skevlo R92C_APS_FSMCO_APFM_ONMAC)) 3250251538Srpaulo break; 3251266472Shselasky urtwn_ms_delay(sc); 3252251538Srpaulo } 3253251538Srpaulo if (ntries == 1000) { 3254251538Srpaulo device_printf(sc->sc_dev, 3255251538Srpaulo "timeout waiting for MAC auto ON\n"); 3256251538Srpaulo return (ETIMEDOUT); 3257251538Srpaulo } 3258251538Srpaulo 3259251538Srpaulo /* Enable radio, GPIO and LED functions. */ 3260291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 3261251538Srpaulo R92C_APS_FSMCO_AFSM_HSUS | 3262251538Srpaulo R92C_APS_FSMCO_PDN_EN | 3263251538Srpaulo R92C_APS_FSMCO_PFM_ALDN); 3264291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3265291698Savos return (EIO); 3266251538Srpaulo /* Release RF digital isolation. */ 3267291698Savos error = urtwn_write_2(sc, R92C_SYS_ISO_CTRL, 3268251538Srpaulo urtwn_read_2(sc, R92C_SYS_ISO_CTRL) & ~R92C_SYS_ISO_CTRL_DIOR); 3269291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3270291698Savos return (EIO); 3271251538Srpaulo 3272251538Srpaulo /* Initialize MAC. */ 3273291698Savos error = urtwn_write_1(sc, R92C_APSD_CTRL, 3274251538Srpaulo urtwn_read_1(sc, R92C_APSD_CTRL) & ~R92C_APSD_CTRL_OFF); 3275291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3276291698Savos return (EIO); 3277251538Srpaulo for (ntries = 0; ntries < 200; ntries++) { 3278251538Srpaulo if (!(urtwn_read_1(sc, R92C_APSD_CTRL) & 3279251538Srpaulo R92C_APSD_CTRL_OFF_STATUS)) 3280251538Srpaulo break; 3281266472Shselasky urtwn_ms_delay(sc); 3282251538Srpaulo } 3283251538Srpaulo if (ntries == 200) { 3284251538Srpaulo device_printf(sc->sc_dev, 3285251538Srpaulo "timeout waiting for MAC initialization\n"); 3286251538Srpaulo return (ETIMEDOUT); 3287251538Srpaulo } 3288251538Srpaulo 3289251538Srpaulo /* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */ 3290251538Srpaulo reg = urtwn_read_2(sc, R92C_CR); 3291251538Srpaulo reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN | 3292251538Srpaulo R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN | 3293251538Srpaulo R92C_CR_SCHEDULE_EN | R92C_CR_MACTXEN | R92C_CR_MACRXEN | 3294251538Srpaulo R92C_CR_ENSEC; 3295291698Savos error = urtwn_write_2(sc, R92C_CR, reg); 3296291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3297291698Savos return (EIO); 3298251538Srpaulo 3299291698Savos error = urtwn_write_1(sc, 0xfe10, 0x19); 3300291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3301291698Savos return (EIO); 3302251538Srpaulo return (0); 3303251538Srpaulo} 3304251538Srpaulo 3305251538Srpaulostatic int 3306264912Skevlourtwn_r88e_power_on(struct urtwn_softc *sc) 3307264912Skevlo{ 3308264912Skevlo uint32_t reg; 3309291698Savos usb_error_t error; 3310264912Skevlo int ntries; 3311264912Skevlo 3312264912Skevlo /* Wait for power ready bit. */ 3313264912Skevlo for (ntries = 0; ntries < 5000; ntries++) { 3314281918Skevlo if (urtwn_read_4(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_SUS_HOST) 3315264912Skevlo break; 3316266472Shselasky urtwn_ms_delay(sc); 3317264912Skevlo } 3318264912Skevlo if (ntries == 5000) { 3319264912Skevlo device_printf(sc->sc_dev, 3320264912Skevlo "timeout waiting for chip power up\n"); 3321264912Skevlo return (ETIMEDOUT); 3322264912Skevlo } 3323264912Skevlo 3324264912Skevlo /* Reset BB. */ 3325291698Savos error = urtwn_write_1(sc, R92C_SYS_FUNC_EN, 3326264912Skevlo urtwn_read_1(sc, R92C_SYS_FUNC_EN) & ~(R92C_SYS_FUNC_EN_BBRSTB | 3327264912Skevlo R92C_SYS_FUNC_EN_BB_GLB_RST)); 3328291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3329291698Savos return (EIO); 3330264912Skevlo 3331291698Savos error = urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 2, 3332281918Skevlo urtwn_read_1(sc, R92C_AFE_XTAL_CTRL + 2) | 0x80); 3333291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3334291698Savos return (EIO); 3335264912Skevlo 3336264912Skevlo /* Disable HWPDN. */ 3337291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 3338281918Skevlo urtwn_read_2(sc, R92C_APS_FSMCO) & ~R92C_APS_FSMCO_APDM_HPDN); 3339291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3340291698Savos return (EIO); 3341264912Skevlo 3342264912Skevlo /* Disable WL suspend. */ 3343291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 3344281918Skevlo urtwn_read_2(sc, R92C_APS_FSMCO) & 3345281918Skevlo ~(R92C_APS_FSMCO_AFSM_HSUS | R92C_APS_FSMCO_AFSM_PCIE)); 3346291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3347291698Savos return (EIO); 3348264912Skevlo 3349291698Savos error = urtwn_write_2(sc, R92C_APS_FSMCO, 3350281918Skevlo urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC); 3351291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3352291698Savos return (EIO); 3353264912Skevlo for (ntries = 0; ntries < 5000; ntries++) { 3354281918Skevlo if (!(urtwn_read_2(sc, R92C_APS_FSMCO) & 3355281918Skevlo R92C_APS_FSMCO_APFM_ONMAC)) 3356264912Skevlo break; 3357266472Shselasky urtwn_ms_delay(sc); 3358264912Skevlo } 3359264912Skevlo if (ntries == 5000) 3360264912Skevlo return (ETIMEDOUT); 3361264912Skevlo 3362264912Skevlo /* Enable LDO normal mode. */ 3363291698Savos error = urtwn_write_1(sc, R92C_LPLDO_CTRL, 3364295874Savos urtwn_read_1(sc, R92C_LPLDO_CTRL) & ~R92C_LPLDO_CTRL_SLEEP); 3365291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3366291698Savos return (EIO); 3367264912Skevlo 3368264912Skevlo /* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */ 3369291698Savos error = urtwn_write_2(sc, R92C_CR, 0); 3370291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3371291698Savos return (EIO); 3372264912Skevlo reg = urtwn_read_2(sc, R92C_CR); 3373264912Skevlo reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN | 3374264912Skevlo R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN | 3375264912Skevlo R92C_CR_SCHEDULE_EN | R92C_CR_ENSEC | R92C_CR_CALTMR_EN; 3376291698Savos error = urtwn_write_2(sc, R92C_CR, reg); 3377291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3378291698Savos return (EIO); 3379264912Skevlo 3380264912Skevlo return (0); 3381264912Skevlo} 3382264912Skevlo 3383295874Savosstatic __inline void 3384295874Savosurtwn_power_off(struct urtwn_softc *sc) 3385295874Savos{ 3386295874Savos 3387295874Savos return sc->sc_power_off(sc); 3388295874Savos} 3389295874Savos 3390295874Savosstatic void 3391295874Savosurtwn_r92c_power_off(struct urtwn_softc *sc) 3392295874Savos{ 3393295874Savos uint32_t reg; 3394295874Savos 3395295874Savos /* Block all Tx queues. */ 3396295874Savos urtwn_write_1(sc, R92C_TXPAUSE, R92C_TX_QUEUE_ALL); 3397295874Savos 3398295874Savos /* Disable RF */ 3399295874Savos urtwn_rf_write(sc, 0, 0, 0); 3400295874Savos 3401295874Savos urtwn_write_1(sc, R92C_APSD_CTRL, R92C_APSD_CTRL_OFF); 3402295874Savos 3403295874Savos /* Reset BB state machine */ 3404295874Savos urtwn_write_1(sc, R92C_SYS_FUNC_EN, 3405295874Savos R92C_SYS_FUNC_EN_USBD | R92C_SYS_FUNC_EN_USBA | 3406295874Savos R92C_SYS_FUNC_EN_BB_GLB_RST); 3407295874Savos urtwn_write_1(sc, R92C_SYS_FUNC_EN, 3408295874Savos R92C_SYS_FUNC_EN_USBD | R92C_SYS_FUNC_EN_USBA); 3409295874Savos 3410295874Savos /* 3411295874Savos * Reset digital sequence 3412295874Savos */ 3413295874Savos#ifndef URTWN_WITHOUT_UCODE 3414295874Savos if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RDY) { 3415295874Savos /* Reset MCU ready status */ 3416295874Savos urtwn_write_1(sc, R92C_MCUFWDL, 0); 3417295874Savos 3418295874Savos /* If firmware in ram code, do reset */ 3419295874Savos urtwn_fw_reset(sc); 3420295874Savos } 3421295874Savos#endif 3422295874Savos 3423295874Savos /* Reset MAC and Enable 8051 */ 3424295874Savos urtwn_write_1(sc, R92C_SYS_FUNC_EN + 1, 3425295874Savos (R92C_SYS_FUNC_EN_CPUEN | 3426295874Savos R92C_SYS_FUNC_EN_ELDR | 3427295874Savos R92C_SYS_FUNC_EN_HWPDN) >> 8); 3428295874Savos 3429295874Savos /* Reset MCU ready status */ 3430295874Savos urtwn_write_1(sc, R92C_MCUFWDL, 0); 3431295874Savos 3432295874Savos /* Disable MAC clock */ 3433295874Savos urtwn_write_2(sc, R92C_SYS_CLKR, 3434295874Savos R92C_SYS_CLKR_ANAD16V_EN | 3435295874Savos R92C_SYS_CLKR_ANA8M | 3436295874Savos R92C_SYS_CLKR_LOADER_EN | 3437295874Savos R92C_SYS_CLKR_80M_SSC_DIS | 3438295874Savos R92C_SYS_CLKR_SYS_EN | 3439295874Savos R92C_SYS_CLKR_RING_EN | 3440295874Savos 0x4000); 3441295874Savos 3442295874Savos /* Disable AFE PLL */ 3443295874Savos urtwn_write_1(sc, R92C_AFE_PLL_CTRL, 0x80); 3444295874Savos 3445295874Savos /* Gated AFE DIG_CLOCK */ 3446295874Savos urtwn_write_2(sc, R92C_AFE_XTAL_CTRL, 0x880F); 3447295874Savos 3448295874Savos /* Isolated digital to PON */ 3449295874Savos urtwn_write_1(sc, R92C_SYS_ISO_CTRL, 3450295874Savos R92C_SYS_ISO_CTRL_MD2PP | 3451295874Savos R92C_SYS_ISO_CTRL_PA2PCIE | 3452295874Savos R92C_SYS_ISO_CTRL_PD2CORE | 3453295874Savos R92C_SYS_ISO_CTRL_IP2MAC | 3454295874Savos R92C_SYS_ISO_CTRL_DIOP | 3455295874Savos R92C_SYS_ISO_CTRL_DIOE); 3456295874Savos 3457295874Savos /* 3458295874Savos * Pull GPIO PIN to balance level and LED control 3459295874Savos */ 3460295874Savos /* 1. Disable GPIO[7:0] */ 3461295874Savos urtwn_write_2(sc, R92C_GPIO_IOSEL, 0x0000); 3462295874Savos 3463295874Savos reg = urtwn_read_4(sc, R92C_GPIO_PIN_CTRL) & ~0x0000ff00; 3464295874Savos reg |= ((reg << 8) & 0x0000ff00) | 0x00ff0000; 3465295874Savos urtwn_write_4(sc, R92C_GPIO_PIN_CTRL, reg); 3466295874Savos 3467295874Savos /* Disable GPIO[10:8] */ 3468295874Savos urtwn_write_1(sc, R92C_MAC_PINMUX_CFG, 0x00); 3469295874Savos 3470295874Savos reg = urtwn_read_2(sc, R92C_GPIO_IO_SEL) & ~0x00f0; 3471295874Savos reg |= (((reg & 0x000f) << 4) | 0x0780); 3472295874Savos urtwn_write_2(sc, R92C_GPIO_IO_SEL, reg); 3473295874Savos 3474295874Savos /* Disable LED0 & 1 */ 3475295874Savos urtwn_write_2(sc, R92C_LEDCFG0, 0x8080); 3476295874Savos 3477295874Savos /* 3478295874Savos * Reset digital sequence 3479295874Savos */ 3480295874Savos /* Disable ELDR clock */ 3481295874Savos urtwn_write_2(sc, R92C_SYS_CLKR, 3482295874Savos R92C_SYS_CLKR_ANAD16V_EN | 3483295874Savos R92C_SYS_CLKR_ANA8M | 3484295874Savos R92C_SYS_CLKR_LOADER_EN | 3485295874Savos R92C_SYS_CLKR_80M_SSC_DIS | 3486295874Savos R92C_SYS_CLKR_SYS_EN | 3487295874Savos R92C_SYS_CLKR_RING_EN | 3488295874Savos 0x4000); 3489295874Savos 3490295874Savos /* Isolated ELDR to PON */ 3491295874Savos urtwn_write_1(sc, R92C_SYS_ISO_CTRL + 1, 3492295874Savos (R92C_SYS_ISO_CTRL_DIOR | 3493295874Savos R92C_SYS_ISO_CTRL_PWC_EV12V) >> 8); 3494295874Savos 3495295874Savos /* 3496295874Savos * Disable analog sequence 3497295874Savos */ 3498295874Savos /* Disable A15 power */ 3499295874Savos urtwn_write_1(sc, R92C_LDOA15_CTRL, R92C_LDOA15_CTRL_OBUF); 3500295874Savos /* Disable digital core power */ 3501295874Savos urtwn_write_1(sc, R92C_LDOV12D_CTRL, 3502295874Savos urtwn_read_1(sc, R92C_LDOV12D_CTRL) & 3503295874Savos ~R92C_LDOV12D_CTRL_LDV12_EN); 3504295874Savos 3505295874Savos /* Enter PFM mode */ 3506295874Savos urtwn_write_1(sc, R92C_SPS0_CTRL, 0x23); 3507295874Savos 3508295874Savos /* Set USB suspend */ 3509295874Savos urtwn_write_2(sc, R92C_APS_FSMCO, 3510295874Savos R92C_APS_FSMCO_APDM_HOST | 3511295874Savos R92C_APS_FSMCO_AFSM_HSUS | 3512295874Savos R92C_APS_FSMCO_PFM_ALDN); 3513295874Savos 3514295874Savos /* Lock ISO/CLK/Power control register. */ 3515295874Savos urtwn_write_1(sc, R92C_RSV_CTRL, 0x0E); 3516295874Savos} 3517295874Savos 3518295874Savosstatic void 3519295874Savosurtwn_r88e_power_off(struct urtwn_softc *sc) 3520295874Savos{ 3521295874Savos uint8_t reg; 3522295874Savos int ntries; 3523295874Savos 3524295874Savos /* Disable any kind of TX reports. */ 3525295874Savos urtwn_write_1(sc, R88E_TX_RPT_CTRL, 3526295874Savos urtwn_read_1(sc, R88E_TX_RPT_CTRL) & 3527295874Savos ~(R88E_TX_RPT1_ENA | R88E_TX_RPT2_ENA)); 3528295874Savos 3529295874Savos /* Stop Rx. */ 3530295874Savos urtwn_write_1(sc, R92C_CR, 0); 3531295874Savos 3532295874Savos /* Move card to Low Power State. */ 3533295874Savos /* Block all Tx queues. */ 3534295874Savos urtwn_write_1(sc, R92C_TXPAUSE, R92C_TX_QUEUE_ALL); 3535295874Savos 3536295874Savos for (ntries = 0; ntries < 20; ntries++) { 3537295874Savos /* Should be zero if no packet is transmitting. */ 3538295874Savos if (urtwn_read_4(sc, R88E_SCH_TXCMD) == 0) 3539295874Savos break; 3540295874Savos 3541295874Savos urtwn_ms_delay(sc); 3542295874Savos } 3543295874Savos if (ntries == 20) { 3544295874Savos device_printf(sc->sc_dev, "%s: failed to block Tx queues\n", 3545295874Savos __func__); 3546295874Savos return; 3547295874Savos } 3548295874Savos 3549295874Savos /* CCK and OFDM are disabled, and clock are gated. */ 3550295874Savos urtwn_write_1(sc, R92C_SYS_FUNC_EN, 3551295874Savos urtwn_read_1(sc, R92C_SYS_FUNC_EN) & ~R92C_SYS_FUNC_EN_BBRSTB); 3552295874Savos 3553295874Savos urtwn_ms_delay(sc); 3554295874Savos 3555295874Savos /* Reset MAC TRX */ 3556295874Savos urtwn_write_1(sc, R92C_CR, 3557295874Savos R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN | 3558295874Savos R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | 3559295874Savos R92C_CR_PROTOCOL_EN | R92C_CR_SCHEDULE_EN); 3560295874Savos 3561295874Savos /* check if removed later */ 3562295874Savos urtwn_write_1(sc, R92C_CR + 1, 3563295874Savos urtwn_read_1(sc, R92C_CR + 1) & ~(R92C_CR_ENSEC >> 8)); 3564295874Savos 3565295874Savos /* Respond TxOK to scheduler */ 3566295874Savos urtwn_write_1(sc, R92C_DUAL_TSF_RST, 3567295874Savos urtwn_read_1(sc, R92C_DUAL_TSF_RST) | 0x20); 3568295874Savos 3569295874Savos /* If firmware in ram code, do reset. */ 3570295874Savos#ifndef URTWN_WITHOUT_UCODE 3571295874Savos if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RDY) 3572295874Savos urtwn_r88e_fw_reset(sc); 3573295874Savos#endif 3574295874Savos 3575295874Savos /* Reset MCU ready status. */ 3576295874Savos urtwn_write_1(sc, R92C_MCUFWDL, 0x00); 3577295874Savos 3578295874Savos /* Disable 32k. */ 3579295874Savos urtwn_write_1(sc, R88E_32K_CTRL, 3580295874Savos urtwn_read_1(sc, R88E_32K_CTRL) & ~0x01); 3581295874Savos 3582295874Savos /* Move card to Disabled state. */ 3583295874Savos /* Turn off RF. */ 3584295874Savos urtwn_write_1(sc, R92C_RF_CTRL, 0); 3585295874Savos 3586295874Savos /* LDO Sleep mode. */ 3587295874Savos urtwn_write_1(sc, R92C_LPLDO_CTRL, 3588295874Savos urtwn_read_1(sc, R92C_LPLDO_CTRL) | R92C_LPLDO_CTRL_SLEEP); 3589295874Savos 3590295874Savos /* Turn off MAC by HW state machine */ 3591295874Savos urtwn_write_1(sc, R92C_APS_FSMCO + 1, 3592295874Savos urtwn_read_1(sc, R92C_APS_FSMCO + 1) | 3593295874Savos (R92C_APS_FSMCO_APFM_OFF >> 8)); 3594295874Savos 3595295874Savos for (ntries = 0; ntries < 20; ntries++) { 3596295874Savos /* Wait until it will be disabled. */ 3597295874Savos if ((urtwn_read_1(sc, R92C_APS_FSMCO + 1) & 3598295874Savos (R92C_APS_FSMCO_APFM_OFF >> 8)) == 0) 3599295874Savos break; 3600295874Savos 3601295874Savos urtwn_ms_delay(sc); 3602295874Savos } 3603295874Savos if (ntries == 20) { 3604295874Savos device_printf(sc->sc_dev, "%s: could not turn off MAC\n", 3605295874Savos __func__); 3606295874Savos return; 3607295874Savos } 3608295874Savos 3609295874Savos /* schmit trigger */ 3610295874Savos urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 2, 3611295874Savos urtwn_read_1(sc, R92C_AFE_XTAL_CTRL + 2) | 0x80); 3612295874Savos 3613295874Savos /* Enable WL suspend. */ 3614295874Savos urtwn_write_1(sc, R92C_APS_FSMCO + 1, 3615295874Savos (urtwn_read_1(sc, R92C_APS_FSMCO + 1) & ~0x10) | 0x08); 3616295874Savos 3617295874Savos /* Enable bandgap mbias in suspend. */ 3618295874Savos urtwn_write_1(sc, R92C_APS_FSMCO + 3, 0); 3619295874Savos 3620295874Savos /* Clear SIC_EN register. */ 3621295874Savos urtwn_write_1(sc, R92C_GPIO_MUXCFG + 1, 3622295874Savos urtwn_read_1(sc, R92C_GPIO_MUXCFG + 1) & ~0x10); 3623295874Savos 3624295874Savos /* Set USB suspend enable local register */ 3625295874Savos urtwn_write_1(sc, R92C_USB_SUSPEND, 3626295874Savos urtwn_read_1(sc, R92C_USB_SUSPEND) | 0x10); 3627295874Savos 3628295874Savos /* Reset MCU IO Wrapper. */ 3629295874Savos reg = urtwn_read_1(sc, R92C_RSV_CTRL + 1); 3630295874Savos urtwn_write_1(sc, R92C_RSV_CTRL + 1, reg & ~0x08); 3631295874Savos urtwn_write_1(sc, R92C_RSV_CTRL + 1, reg | 0x08); 3632295874Savos 3633295874Savos /* marked as 'For Power Consumption' code. */ 3634295874Savos urtwn_write_1(sc, R92C_GPIO_OUT, urtwn_read_1(sc, R92C_GPIO_IN)); 3635295874Savos urtwn_write_1(sc, R92C_GPIO_IOSEL, 0xff); 3636295874Savos 3637295874Savos urtwn_write_1(sc, R92C_GPIO_IO_SEL, 3638295874Savos urtwn_read_1(sc, R92C_GPIO_IO_SEL) << 4); 3639295874Savos urtwn_write_1(sc, R92C_GPIO_MOD, 3640295874Savos urtwn_read_1(sc, R92C_GPIO_MOD) | 0x0f); 3641295874Savos 3642295874Savos /* Set LNA, TRSW, EX_PA Pin to output mode. */ 3643295874Savos urtwn_write_4(sc, R88E_BB_PAD_CTRL, 0x00080808); 3644295874Savos} 3645295874Savos 3646264912Skevlostatic int 3647251538Srpaulourtwn_llt_init(struct urtwn_softc *sc) 3648251538Srpaulo{ 3649264912Skevlo int i, error, page_count, pktbuf_count; 3650251538Srpaulo 3651264912Skevlo page_count = (sc->chip & URTWN_CHIP_88E) ? 3652264912Skevlo R88E_TX_PAGE_COUNT : R92C_TX_PAGE_COUNT; 3653264912Skevlo pktbuf_count = (sc->chip & URTWN_CHIP_88E) ? 3654264912Skevlo R88E_TXPKTBUF_COUNT : R92C_TXPKTBUF_COUNT; 3655264912Skevlo 3656264912Skevlo /* Reserve pages [0; page_count]. */ 3657264912Skevlo for (i = 0; i < page_count; i++) { 3658251538Srpaulo if ((error = urtwn_llt_write(sc, i, i + 1)) != 0) 3659251538Srpaulo return (error); 3660251538Srpaulo } 3661251538Srpaulo /* NB: 0xff indicates end-of-list. */ 3662251538Srpaulo if ((error = urtwn_llt_write(sc, i, 0xff)) != 0) 3663251538Srpaulo return (error); 3664251538Srpaulo /* 3665264912Skevlo * Use pages [page_count + 1; pktbuf_count - 1] 3666251538Srpaulo * as ring buffer. 3667251538Srpaulo */ 3668264912Skevlo for (++i; i < pktbuf_count - 1; i++) { 3669251538Srpaulo if ((error = urtwn_llt_write(sc, i, i + 1)) != 0) 3670251538Srpaulo return (error); 3671251538Srpaulo } 3672251538Srpaulo /* Make the last page point to the beginning of the ring buffer. */ 3673264912Skevlo error = urtwn_llt_write(sc, i, page_count + 1); 3674251538Srpaulo return (error); 3675251538Srpaulo} 3676251538Srpaulo 3677295871Savos#ifndef URTWN_WITHOUT_UCODE 3678251538Srpaulostatic void 3679251538Srpaulourtwn_fw_reset(struct urtwn_softc *sc) 3680251538Srpaulo{ 3681251538Srpaulo uint16_t reg; 3682251538Srpaulo int ntries; 3683251538Srpaulo 3684251538Srpaulo /* Tell 8051 to reset itself. */ 3685251538Srpaulo urtwn_write_1(sc, R92C_HMETFR + 3, 0x20); 3686251538Srpaulo 3687251538Srpaulo /* Wait until 8051 resets by itself. */ 3688251538Srpaulo for (ntries = 0; ntries < 100; ntries++) { 3689251538Srpaulo reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN); 3690251538Srpaulo if (!(reg & R92C_SYS_FUNC_EN_CPUEN)) 3691251538Srpaulo return; 3692266472Shselasky urtwn_ms_delay(sc); 3693251538Srpaulo } 3694251538Srpaulo /* Force 8051 reset. */ 3695251538Srpaulo urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN); 3696251538Srpaulo} 3697251538Srpaulo 3698264912Skevlostatic void 3699264912Skevlourtwn_r88e_fw_reset(struct urtwn_softc *sc) 3700264912Skevlo{ 3701264912Skevlo uint16_t reg; 3702264912Skevlo 3703264912Skevlo reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN); 3704264912Skevlo urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN); 3705264912Skevlo urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg | R92C_SYS_FUNC_EN_CPUEN); 3706264912Skevlo} 3707264912Skevlo 3708251538Srpaulostatic int 3709251538Srpaulourtwn_fw_loadpage(struct urtwn_softc *sc, int page, const uint8_t *buf, int len) 3710251538Srpaulo{ 3711251538Srpaulo uint32_t reg; 3712291698Savos usb_error_t error = USB_ERR_NORMAL_COMPLETION; 3713291698Savos int off, mlen; 3714251538Srpaulo 3715251538Srpaulo reg = urtwn_read_4(sc, R92C_MCUFWDL); 3716251538Srpaulo reg = RW(reg, R92C_MCUFWDL_PAGE, page); 3717251538Srpaulo urtwn_write_4(sc, R92C_MCUFWDL, reg); 3718251538Srpaulo 3719251538Srpaulo off = R92C_FW_START_ADDR; 3720251538Srpaulo while (len > 0) { 3721251538Srpaulo if (len > 196) 3722251538Srpaulo mlen = 196; 3723251538Srpaulo else if (len > 4) 3724251538Srpaulo mlen = 4; 3725251538Srpaulo else 3726251538Srpaulo mlen = 1; 3727251538Srpaulo /* XXX fix this deconst */ 3728281069Srpaulo error = urtwn_write_region_1(sc, off, 3729251538Srpaulo __DECONST(uint8_t *, buf), mlen); 3730291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 3731251538Srpaulo break; 3732251538Srpaulo off += mlen; 3733251538Srpaulo buf += mlen; 3734251538Srpaulo len -= mlen; 3735251538Srpaulo } 3736251538Srpaulo return (error); 3737251538Srpaulo} 3738251538Srpaulo 3739251538Srpaulostatic int 3740251538Srpaulourtwn_load_firmware(struct urtwn_softc *sc) 3741251538Srpaulo{ 3742251538Srpaulo const struct firmware *fw; 3743251538Srpaulo const struct r92c_fw_hdr *hdr; 3744251538Srpaulo const char *imagename; 3745251538Srpaulo const u_char *ptr; 3746251538Srpaulo size_t len; 3747251538Srpaulo uint32_t reg; 3748251538Srpaulo int mlen, ntries, page, error; 3749251538Srpaulo 3750264864Skevlo URTWN_UNLOCK(sc); 3751251538Srpaulo /* Read firmware image from the filesystem. */ 3752264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3753264912Skevlo imagename = "urtwn-rtl8188eufw"; 3754264912Skevlo else if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) == 3755264912Skevlo URTWN_CHIP_UMC_A_CUT) 3756251538Srpaulo imagename = "urtwn-rtl8192cfwU"; 3757251538Srpaulo else 3758251538Srpaulo imagename = "urtwn-rtl8192cfwT"; 3759251538Srpaulo 3760251538Srpaulo fw = firmware_get(imagename); 3761264864Skevlo URTWN_LOCK(sc); 3762251538Srpaulo if (fw == NULL) { 3763251538Srpaulo device_printf(sc->sc_dev, 3764251538Srpaulo "failed loadfirmware of file %s\n", imagename); 3765251538Srpaulo return (ENOENT); 3766251538Srpaulo } 3767251538Srpaulo 3768251538Srpaulo len = fw->datasize; 3769251538Srpaulo 3770251538Srpaulo if (len < sizeof(*hdr)) { 3771251538Srpaulo device_printf(sc->sc_dev, "firmware too short\n"); 3772251538Srpaulo error = EINVAL; 3773251538Srpaulo goto fail; 3774251538Srpaulo } 3775251538Srpaulo ptr = fw->data; 3776251538Srpaulo hdr = (const struct r92c_fw_hdr *)ptr; 3777251538Srpaulo /* Check if there is a valid FW header and skip it. */ 3778251538Srpaulo if ((le16toh(hdr->signature) >> 4) == 0x88c || 3779264912Skevlo (le16toh(hdr->signature) >> 4) == 0x88e || 3780251538Srpaulo (le16toh(hdr->signature) >> 4) == 0x92c) { 3781294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_FIRMWARE, 3782294471Savos "FW V%d.%d %02d-%02d %02d:%02d\n", 3783251538Srpaulo le16toh(hdr->version), le16toh(hdr->subversion), 3784251538Srpaulo hdr->month, hdr->date, hdr->hour, hdr->minute); 3785251538Srpaulo ptr += sizeof(*hdr); 3786251538Srpaulo len -= sizeof(*hdr); 3787251538Srpaulo } 3788251538Srpaulo 3789264912Skevlo if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RAM_DL_SEL) { 3790264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3791264912Skevlo urtwn_r88e_fw_reset(sc); 3792264912Skevlo else 3793264912Skevlo urtwn_fw_reset(sc); 3794251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 0); 3795251538Srpaulo } 3796264912Skevlo 3797268487Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 3798268487Skevlo urtwn_write_2(sc, R92C_SYS_FUNC_EN, 3799268487Skevlo urtwn_read_2(sc, R92C_SYS_FUNC_EN) | 3800268487Skevlo R92C_SYS_FUNC_EN_CPUEN); 3801268487Skevlo } 3802251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 3803251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_EN); 3804251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL + 2, 3805251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL + 2) & ~0x08); 3806251538Srpaulo 3807263154Skevlo /* Reset the FWDL checksum. */ 3808263154Skevlo urtwn_write_1(sc, R92C_MCUFWDL, 3809263154Skevlo urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_CHKSUM_RPT); 3810263154Skevlo 3811251538Srpaulo for (page = 0; len > 0; page++) { 3812251538Srpaulo mlen = min(len, R92C_FW_PAGE_SIZE); 3813251538Srpaulo error = urtwn_fw_loadpage(sc, page, ptr, mlen); 3814251538Srpaulo if (error != 0) { 3815251538Srpaulo device_printf(sc->sc_dev, 3816251538Srpaulo "could not load firmware page\n"); 3817251538Srpaulo goto fail; 3818251538Srpaulo } 3819251538Srpaulo ptr += mlen; 3820251538Srpaulo len -= mlen; 3821251538Srpaulo } 3822251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL, 3823251538Srpaulo urtwn_read_1(sc, R92C_MCUFWDL) & ~R92C_MCUFWDL_EN); 3824251538Srpaulo urtwn_write_1(sc, R92C_MCUFWDL + 1, 0); 3825251538Srpaulo 3826251538Srpaulo /* Wait for checksum report. */ 3827251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 3828251538Srpaulo if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_CHKSUM_RPT) 3829251538Srpaulo break; 3830266472Shselasky urtwn_ms_delay(sc); 3831251538Srpaulo } 3832251538Srpaulo if (ntries == 1000) { 3833251538Srpaulo device_printf(sc->sc_dev, 3834251538Srpaulo "timeout waiting for checksum report\n"); 3835251538Srpaulo error = ETIMEDOUT; 3836251538Srpaulo goto fail; 3837251538Srpaulo } 3838251538Srpaulo 3839251538Srpaulo reg = urtwn_read_4(sc, R92C_MCUFWDL); 3840251538Srpaulo reg = (reg & ~R92C_MCUFWDL_WINTINI_RDY) | R92C_MCUFWDL_RDY; 3841251538Srpaulo urtwn_write_4(sc, R92C_MCUFWDL, reg); 3842264912Skevlo if (sc->chip & URTWN_CHIP_88E) 3843264912Skevlo urtwn_r88e_fw_reset(sc); 3844251538Srpaulo /* Wait for firmware readiness. */ 3845251538Srpaulo for (ntries = 0; ntries < 1000; ntries++) { 3846251538Srpaulo if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_WINTINI_RDY) 3847251538Srpaulo break; 3848266472Shselasky urtwn_ms_delay(sc); 3849251538Srpaulo } 3850251538Srpaulo if (ntries == 1000) { 3851251538Srpaulo device_printf(sc->sc_dev, 3852251538Srpaulo "timeout waiting for firmware readiness\n"); 3853251538Srpaulo error = ETIMEDOUT; 3854251538Srpaulo goto fail; 3855251538Srpaulo } 3856251538Srpaulofail: 3857251538Srpaulo firmware_put(fw, FIRMWARE_UNLOAD); 3858251538Srpaulo return (error); 3859251538Srpaulo} 3860295871Savos#endif 3861251538Srpaulo 3862291902Skevlostatic int 3863251538Srpaulourtwn_dma_init(struct urtwn_softc *sc) 3864251538Srpaulo{ 3865291902Skevlo struct usb_endpoint *ep, *ep_end; 3866291698Savos usb_error_t usb_err; 3867291902Skevlo uint32_t reg; 3868291902Skevlo int hashq, hasnq, haslq, nqueues, ntx; 3869291902Skevlo int error, pagecount, npubqpages, nqpages, nrempages, tx_boundary; 3870281069Srpaulo 3871291695Savos /* Initialize LLT table. */ 3872291695Savos error = urtwn_llt_init(sc); 3873291695Savos if (error != 0) 3874291695Savos return (error); 3875291695Savos 3876291902Skevlo /* Determine the number of bulk-out pipes. */ 3877291902Skevlo ntx = 0; 3878291902Skevlo ep = sc->sc_udev->endpoints; 3879291902Skevlo ep_end = sc->sc_udev->endpoints + sc->sc_udev->endpoints_max; 3880291902Skevlo for (; ep != ep_end; ep++) { 3881291902Skevlo if ((ep->edesc == NULL) || 3882291902Skevlo (ep->iface_index != sc->sc_iface_index)) 3883291902Skevlo continue; 3884291902Skevlo if (UE_GET_DIR(ep->edesc->bEndpointAddress) == UE_DIR_OUT) 3885291902Skevlo ntx++; 3886291902Skevlo } 3887291902Skevlo if (ntx == 0) { 3888291902Skevlo device_printf(sc->sc_dev, 3889291902Skevlo "%d: invalid number of Tx bulk pipes\n", ntx); 3890291698Savos return (EIO); 3891291902Skevlo } 3892291695Savos 3893251538Srpaulo /* Get Tx queues to USB endpoints mapping. */ 3894291902Skevlo hashq = hasnq = haslq = nqueues = 0; 3895291902Skevlo switch (ntx) { 3896291902Skevlo case 1: hashq = 1; break; 3897291902Skevlo case 2: hashq = hasnq = 1; break; 3898291902Skevlo case 3: case 4: hashq = hasnq = haslq = 1; break; 3899291902Skevlo } 3900251538Srpaulo nqueues = hashq + hasnq + haslq; 3901251538Srpaulo if (nqueues == 0) 3902251538Srpaulo return (EIO); 3903251538Srpaulo 3904291902Skevlo npubqpages = nqpages = nrempages = pagecount = 0; 3905291902Skevlo if (sc->chip & URTWN_CHIP_88E) 3906291902Skevlo tx_boundary = R88E_TX_PAGE_BOUNDARY; 3907291902Skevlo else { 3908291902Skevlo pagecount = R92C_TX_PAGE_COUNT; 3909291902Skevlo npubqpages = R92C_PUBQ_NPAGES; 3910291902Skevlo tx_boundary = R92C_TX_PAGE_BOUNDARY; 3911291902Skevlo } 3912291902Skevlo 3913251538Srpaulo /* Set number of pages for normal priority queue. */ 3914291902Skevlo if (sc->chip & URTWN_CHIP_88E) { 3915291902Skevlo usb_err = urtwn_write_2(sc, R92C_RQPN_NPQ, 0xd); 3916291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3917291902Skevlo return (EIO); 3918291902Skevlo usb_err = urtwn_write_4(sc, R92C_RQPN, 0x808e000d); 3919291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3920291902Skevlo return (EIO); 3921291902Skevlo } else { 3922291902Skevlo /* Get the number of pages for each queue. */ 3923291902Skevlo nqpages = (pagecount - npubqpages) / nqueues; 3924291902Skevlo /* 3925291902Skevlo * The remaining pages are assigned to the high priority 3926291902Skevlo * queue. 3927291902Skevlo */ 3928291902Skevlo nrempages = (pagecount - npubqpages) % nqueues; 3929291902Skevlo usb_err = urtwn_write_1(sc, R92C_RQPN_NPQ, hasnq ? nqpages : 0); 3930291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3931291902Skevlo return (EIO); 3932291902Skevlo usb_err = urtwn_write_4(sc, R92C_RQPN, 3933291902Skevlo /* Set number of pages for public queue. */ 3934291902Skevlo SM(R92C_RQPN_PUBQ, npubqpages) | 3935291902Skevlo /* Set number of pages for high priority queue. */ 3936291902Skevlo SM(R92C_RQPN_HPQ, hashq ? nqpages + nrempages : 0) | 3937291902Skevlo /* Set number of pages for low priority queue. */ 3938291902Skevlo SM(R92C_RQPN_LPQ, haslq ? nqpages : 0) | 3939291902Skevlo /* Load values. */ 3940291902Skevlo R92C_RQPN_LD); 3941291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3942291902Skevlo return (EIO); 3943291902Skevlo } 3944251538Srpaulo 3945291902Skevlo usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_BCNQ_BDNY, tx_boundary); 3946291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3947291698Savos return (EIO); 3948291902Skevlo usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_MGQ_BDNY, tx_boundary); 3949291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3950291698Savos return (EIO); 3951291902Skevlo usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_WMAC_LBK_BF_HD, tx_boundary); 3952291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3953291698Savos return (EIO); 3954291902Skevlo usb_err = urtwn_write_1(sc, R92C_TRXFF_BNDY, tx_boundary); 3955291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3956291698Savos return (EIO); 3957291902Skevlo usb_err = urtwn_write_1(sc, R92C_TDECTRL + 1, tx_boundary); 3958291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3959291698Savos return (EIO); 3960251538Srpaulo 3961251538Srpaulo /* Set queue to USB pipe mapping. */ 3962251538Srpaulo reg = urtwn_read_2(sc, R92C_TRXDMA_CTRL); 3963251538Srpaulo reg &= ~R92C_TRXDMA_CTRL_QMAP_M; 3964251538Srpaulo if (nqueues == 1) { 3965251538Srpaulo if (hashq) 3966251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_HQ; 3967251538Srpaulo else if (hasnq) 3968251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_NQ; 3969251538Srpaulo else 3970251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_LQ; 3971251538Srpaulo } else if (nqueues == 2) { 3972292056Skevlo /* 3973292056Skevlo * All 2-endpoints configs have high and normal 3974292056Skevlo * priority queues. 3975292056Skevlo */ 3976292056Skevlo reg |= R92C_TRXDMA_CTRL_QMAP_HQ_NQ; 3977251538Srpaulo } else 3978251538Srpaulo reg |= R92C_TRXDMA_CTRL_QMAP_3EP; 3979291902Skevlo usb_err = urtwn_write_2(sc, R92C_TRXDMA_CTRL, reg); 3980291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3981291698Savos return (EIO); 3982251538Srpaulo 3983251538Srpaulo /* Set Tx/Rx transfer page boundary. */ 3984291902Skevlo usb_err = urtwn_write_2(sc, R92C_TRXFF_BNDY + 2, 3985291902Skevlo (sc->chip & URTWN_CHIP_88E) ? 0x23ff : 0x27ff); 3986291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3987291698Savos return (EIO); 3988251538Srpaulo 3989291902Skevlo /* Set Tx/Rx transfer page size. */ 3990291902Skevlo usb_err = urtwn_write_1(sc, R92C_PBP, 3991291902Skevlo SM(R92C_PBP_PSRX, R92C_PBP_128) | 3992291902Skevlo SM(R92C_PBP_PSTX, R92C_PBP_128)); 3993291902Skevlo if (usb_err != USB_ERR_NORMAL_COMPLETION) 3994264912Skevlo return (EIO); 3995264912Skevlo 3996264912Skevlo return (0); 3997264912Skevlo} 3998264912Skevlo 3999291698Savosstatic int 4000251538Srpaulourtwn_mac_init(struct urtwn_softc *sc) 4001251538Srpaulo{ 4002291698Savos usb_error_t error; 4003251538Srpaulo int i; 4004251538Srpaulo 4005251538Srpaulo /* Write MAC initialization values. */ 4006264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 4007264912Skevlo for (i = 0; i < nitems(rtl8188eu_mac); i++) { 4008291698Savos error = urtwn_write_1(sc, rtl8188eu_mac[i].reg, 4009264912Skevlo rtl8188eu_mac[i].val); 4010291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 4011291698Savos return (EIO); 4012264912Skevlo } 4013264912Skevlo urtwn_write_1(sc, R92C_MAX_AGGR_NUM, 0x07); 4014264912Skevlo } else { 4015264912Skevlo for (i = 0; i < nitems(rtl8192cu_mac); i++) 4016291698Savos error = urtwn_write_1(sc, rtl8192cu_mac[i].reg, 4017264912Skevlo rtl8192cu_mac[i].val); 4018291698Savos if (error != USB_ERR_NORMAL_COMPLETION) 4019291698Savos return (EIO); 4020264912Skevlo } 4021291698Savos 4022291698Savos return (0); 4023251538Srpaulo} 4024251538Srpaulo 4025251538Srpaulostatic void 4026251538Srpaulourtwn_bb_init(struct urtwn_softc *sc) 4027251538Srpaulo{ 4028251538Srpaulo const struct urtwn_bb_prog *prog; 4029251538Srpaulo uint32_t reg; 4030264912Skevlo uint8_t crystalcap; 4031251538Srpaulo int i; 4032251538Srpaulo 4033251538Srpaulo /* Enable BB and RF. */ 4034251538Srpaulo urtwn_write_2(sc, R92C_SYS_FUNC_EN, 4035251538Srpaulo urtwn_read_2(sc, R92C_SYS_FUNC_EN) | 4036251538Srpaulo R92C_SYS_FUNC_EN_BBRSTB | R92C_SYS_FUNC_EN_BB_GLB_RST | 4037251538Srpaulo R92C_SYS_FUNC_EN_DIO_RF); 4038251538Srpaulo 4039264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) 4040264912Skevlo urtwn_write_2(sc, R92C_AFE_PLL_CTRL, 0xdb83); 4041251538Srpaulo 4042251538Srpaulo urtwn_write_1(sc, R92C_RF_CTRL, 4043251538Srpaulo R92C_RF_CTRL_EN | R92C_RF_CTRL_RSTB | R92C_RF_CTRL_SDMRSTB); 4044251538Srpaulo urtwn_write_1(sc, R92C_SYS_FUNC_EN, 4045251538Srpaulo R92C_SYS_FUNC_EN_USBA | R92C_SYS_FUNC_EN_USBD | 4046251538Srpaulo R92C_SYS_FUNC_EN_BB_GLB_RST | R92C_SYS_FUNC_EN_BBRSTB); 4047251538Srpaulo 4048264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 4049264912Skevlo urtwn_write_1(sc, R92C_LDOHCI12_CTRL, 0x0f); 4050264912Skevlo urtwn_write_1(sc, 0x15, 0xe9); 4051264912Skevlo urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 1, 0x80); 4052264912Skevlo } 4053251538Srpaulo 4054251538Srpaulo /* Select BB programming based on board type. */ 4055264912Skevlo if (sc->chip & URTWN_CHIP_88E) 4056264912Skevlo prog = &rtl8188eu_bb_prog; 4057264912Skevlo else if (!(sc->chip & URTWN_CHIP_92C)) { 4058251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 4059251538Srpaulo prog = &rtl8188ce_bb_prog; 4060251538Srpaulo else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 4061251538Srpaulo prog = &rtl8188ru_bb_prog; 4062251538Srpaulo else 4063251538Srpaulo prog = &rtl8188cu_bb_prog; 4064251538Srpaulo } else { 4065251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 4066251538Srpaulo prog = &rtl8192ce_bb_prog; 4067251538Srpaulo else 4068251538Srpaulo prog = &rtl8192cu_bb_prog; 4069251538Srpaulo } 4070251538Srpaulo /* Write BB initialization values. */ 4071251538Srpaulo for (i = 0; i < prog->count; i++) { 4072251538Srpaulo urtwn_bb_write(sc, prog->regs[i], prog->vals[i]); 4073266472Shselasky urtwn_ms_delay(sc); 4074251538Srpaulo } 4075251538Srpaulo 4076251538Srpaulo if (sc->chip & URTWN_CHIP_92C_1T2R) { 4077251538Srpaulo /* 8192C 1T only configuration. */ 4078251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_TXINFO); 4079251538Srpaulo reg = (reg & ~0x00000003) | 0x2; 4080251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_TXINFO, reg); 4081251538Srpaulo 4082251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA1_TXINFO); 4083251538Srpaulo reg = (reg & ~0x00300033) | 0x00200022; 4084251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_TXINFO, reg); 4085251538Srpaulo 4086251538Srpaulo reg = urtwn_bb_read(sc, R92C_CCK0_AFESETTING); 4087251538Srpaulo reg = (reg & ~0xff000000) | 0x45 << 24; 4088251538Srpaulo urtwn_bb_write(sc, R92C_CCK0_AFESETTING, reg); 4089251538Srpaulo 4090251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_TRXPATHENA); 4091251538Srpaulo reg = (reg & ~0x000000ff) | 0x23; 4092251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_TRXPATHENA, reg); 4093251538Srpaulo 4094251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM0_AGCPARAM1); 4095251538Srpaulo reg = (reg & ~0x00000030) | 1 << 4; 4096251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCPARAM1, reg); 4097251538Srpaulo 4098251538Srpaulo reg = urtwn_bb_read(sc, 0xe74); 4099251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 4100251538Srpaulo urtwn_bb_write(sc, 0xe74, reg); 4101251538Srpaulo reg = urtwn_bb_read(sc, 0xe78); 4102251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 4103251538Srpaulo urtwn_bb_write(sc, 0xe78, reg); 4104251538Srpaulo reg = urtwn_bb_read(sc, 0xe7c); 4105251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 4106251538Srpaulo urtwn_bb_write(sc, 0xe7c, reg); 4107251538Srpaulo reg = urtwn_bb_read(sc, 0xe80); 4108251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 4109251538Srpaulo urtwn_bb_write(sc, 0xe80, reg); 4110251538Srpaulo reg = urtwn_bb_read(sc, 0xe88); 4111251538Srpaulo reg = (reg & ~0x0c000000) | 2 << 26; 4112251538Srpaulo urtwn_bb_write(sc, 0xe88, reg); 4113251538Srpaulo } 4114251538Srpaulo 4115251538Srpaulo /* Write AGC values. */ 4116251538Srpaulo for (i = 0; i < prog->agccount; i++) { 4117251538Srpaulo urtwn_bb_write(sc, R92C_OFDM0_AGCRSSITABLE, 4118251538Srpaulo prog->agcvals[i]); 4119266472Shselasky urtwn_ms_delay(sc); 4120251538Srpaulo } 4121251538Srpaulo 4122264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 4123264912Skevlo urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553422); 4124266472Shselasky urtwn_ms_delay(sc); 4125264912Skevlo urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553420); 4126266472Shselasky urtwn_ms_delay(sc); 4127264912Skevlo 4128294198Savos crystalcap = sc->rom.r88e_rom.crystalcap; 4129264912Skevlo if (crystalcap == 0xff) 4130264912Skevlo crystalcap = 0x20; 4131264912Skevlo crystalcap &= 0x3f; 4132264912Skevlo reg = urtwn_bb_read(sc, R92C_AFE_XTAL_CTRL); 4133264912Skevlo urtwn_bb_write(sc, R92C_AFE_XTAL_CTRL, 4134264912Skevlo RW(reg, R92C_AFE_XTAL_CTRL_ADDR, 4135264912Skevlo crystalcap | crystalcap << 6)); 4136264912Skevlo } else { 4137264912Skevlo if (urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)) & 4138264912Skevlo R92C_HSSI_PARAM2_CCK_HIPWR) 4139264912Skevlo sc->sc_flags |= URTWN_FLAG_CCK_HIPWR; 4140264912Skevlo } 4141251538Srpaulo} 4142251538Srpaulo 4143289066Skevlostatic void 4144251538Srpaulourtwn_rf_init(struct urtwn_softc *sc) 4145251538Srpaulo{ 4146251538Srpaulo const struct urtwn_rf_prog *prog; 4147251538Srpaulo uint32_t reg, type; 4148251538Srpaulo int i, j, idx, off; 4149251538Srpaulo 4150251538Srpaulo /* Select RF programming based on board type. */ 4151264912Skevlo if (sc->chip & URTWN_CHIP_88E) 4152264912Skevlo prog = rtl8188eu_rf_prog; 4153264912Skevlo else if (!(sc->chip & URTWN_CHIP_92C)) { 4154251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_MINICARD) 4155251538Srpaulo prog = rtl8188ce_rf_prog; 4156251538Srpaulo else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 4157251538Srpaulo prog = rtl8188ru_rf_prog; 4158251538Srpaulo else 4159251538Srpaulo prog = rtl8188cu_rf_prog; 4160251538Srpaulo } else 4161251538Srpaulo prog = rtl8192ce_rf_prog; 4162251538Srpaulo 4163251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 4164251538Srpaulo /* Save RF_ENV control type. */ 4165251538Srpaulo idx = i / 2; 4166251538Srpaulo off = (i % 2) * 16; 4167251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx)); 4168251538Srpaulo type = (reg >> off) & 0x10; 4169251538Srpaulo 4170251538Srpaulo /* Set RF_ENV enable. */ 4171251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i)); 4172251538Srpaulo reg |= 0x100000; 4173251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg); 4174266472Shselasky urtwn_ms_delay(sc); 4175251538Srpaulo /* Set RF_ENV output high. */ 4176251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i)); 4177251538Srpaulo reg |= 0x10; 4178251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg); 4179266472Shselasky urtwn_ms_delay(sc); 4180251538Srpaulo /* Set address and data lengths of RF registers. */ 4181251538Srpaulo reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i)); 4182251538Srpaulo reg &= ~R92C_HSSI_PARAM2_ADDR_LENGTH; 4183251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg); 4184266472Shselasky urtwn_ms_delay(sc); 4185251538Srpaulo reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i)); 4186251538Srpaulo reg &= ~R92C_HSSI_PARAM2_DATA_LENGTH; 4187251538Srpaulo urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg); 4188266472Shselasky urtwn_ms_delay(sc); 4189251538Srpaulo 4190251538Srpaulo /* Write RF initialization values for this chain. */ 4191251538Srpaulo for (j = 0; j < prog[i].count; j++) { 4192251538Srpaulo if (prog[i].regs[j] >= 0xf9 && 4193251538Srpaulo prog[i].regs[j] <= 0xfe) { 4194251538Srpaulo /* 4195251538Srpaulo * These are fake RF registers offsets that 4196251538Srpaulo * indicate a delay is required. 4197251538Srpaulo */ 4198266472Shselasky usb_pause_mtx(&sc->sc_mtx, hz / 20); /* 50ms */ 4199251538Srpaulo continue; 4200251538Srpaulo } 4201251538Srpaulo urtwn_rf_write(sc, i, prog[i].regs[j], 4202251538Srpaulo prog[i].vals[j]); 4203266472Shselasky urtwn_ms_delay(sc); 4204251538Srpaulo } 4205251538Srpaulo 4206251538Srpaulo /* Restore RF_ENV control type. */ 4207251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx)); 4208251538Srpaulo reg &= ~(0x10 << off) | (type << off); 4209251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFIFACESW(idx), reg); 4210251538Srpaulo 4211251538Srpaulo /* Cache RF register CHNLBW. */ 4212251538Srpaulo sc->rf_chnlbw[i] = urtwn_rf_read(sc, i, R92C_RF_CHNLBW); 4213251538Srpaulo } 4214251538Srpaulo 4215251538Srpaulo if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) == 4216251538Srpaulo URTWN_CHIP_UMC_A_CUT) { 4217251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_RX_G1, 0x30255); 4218251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_RX_G2, 0x50a00); 4219251538Srpaulo } 4220251538Srpaulo} 4221251538Srpaulo 4222251538Srpaulostatic void 4223251538Srpaulourtwn_cam_init(struct urtwn_softc *sc) 4224251538Srpaulo{ 4225251538Srpaulo /* Invalidate all CAM entries. */ 4226251538Srpaulo urtwn_write_4(sc, R92C_CAMCMD, 4227251538Srpaulo R92C_CAMCMD_POLLING | R92C_CAMCMD_CLR); 4228251538Srpaulo} 4229251538Srpaulo 4230292175Savosstatic int 4231292175Savosurtwn_cam_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data) 4232292175Savos{ 4233292175Savos usb_error_t error; 4234292175Savos 4235292175Savos error = urtwn_write_4(sc, R92C_CAMWRITE, data); 4236292175Savos if (error != USB_ERR_NORMAL_COMPLETION) 4237292175Savos return (EIO); 4238292175Savos error = urtwn_write_4(sc, R92C_CAMCMD, 4239292175Savos R92C_CAMCMD_POLLING | R92C_CAMCMD_WRITE | 4240292175Savos SM(R92C_CAMCMD_ADDR, addr)); 4241292175Savos if (error != USB_ERR_NORMAL_COMPLETION) 4242292175Savos return (EIO); 4243292175Savos 4244292175Savos return (0); 4245292175Savos} 4246292175Savos 4247251538Srpaulostatic void 4248251538Srpaulourtwn_pa_bias_init(struct urtwn_softc *sc) 4249251538Srpaulo{ 4250251538Srpaulo uint8_t reg; 4251251538Srpaulo int i; 4252251538Srpaulo 4253251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 4254251538Srpaulo if (sc->pa_setting & (1 << i)) 4255251538Srpaulo continue; 4256251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x0f406); 4257251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x4f406); 4258251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0x8f406); 4259251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_IPA, 0xcf406); 4260251538Srpaulo } 4261251538Srpaulo if (!(sc->pa_setting & 0x10)) { 4262251538Srpaulo reg = urtwn_read_1(sc, 0x16); 4263251538Srpaulo reg = (reg & ~0xf0) | 0x90; 4264251538Srpaulo urtwn_write_1(sc, 0x16, reg); 4265251538Srpaulo } 4266251538Srpaulo} 4267251538Srpaulo 4268251538Srpaulostatic void 4269251538Srpaulourtwn_rxfilter_init(struct urtwn_softc *sc) 4270251538Srpaulo{ 4271290564Savos struct ieee80211com *ic = &sc->sc_ic; 4272290564Savos struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 4273290564Savos uint32_t rcr; 4274290564Savos uint16_t filter; 4275290564Savos 4276290564Savos URTWN_ASSERT_LOCKED(sc); 4277290564Savos 4278251538Srpaulo /* Accept all multicast frames. */ 4279251538Srpaulo urtwn_write_4(sc, R92C_MAR + 0, 0xffffffff); 4280251538Srpaulo urtwn_write_4(sc, R92C_MAR + 4, 0xffffffff); 4281290564Savos 4282290564Savos /* Filter for management frames. */ 4283290564Savos filter = 0x7f3f; 4284290631Savos switch (vap->iv_opmode) { 4285290631Savos case IEEE80211_M_STA: 4286290564Savos filter &= ~( 4287290564Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_ASSOC_REQ) | 4288290564Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_REASSOC_REQ) | 4289290564Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_PROBE_REQ)); 4290290631Savos break; 4291290631Savos case IEEE80211_M_HOSTAP: 4292290631Savos filter &= ~( 4293290631Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_ASSOC_RESP) | 4294296174Savos R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_REASSOC_RESP)); 4295290631Savos break; 4296290631Savos case IEEE80211_M_MONITOR: 4297290651Savos case IEEE80211_M_IBSS: 4298290631Savos break; 4299290631Savos default: 4300290631Savos device_printf(sc->sc_dev, "%s: undefined opmode %d\n", 4301290631Savos __func__, vap->iv_opmode); 4302290631Savos break; 4303290564Savos } 4304290564Savos urtwn_write_2(sc, R92C_RXFLTMAP0, filter); 4305290564Savos 4306251538Srpaulo /* Reject all control frames. */ 4307251538Srpaulo urtwn_write_2(sc, R92C_RXFLTMAP1, 0x0000); 4308290564Savos 4309290564Savos /* Reject all data frames. */ 4310290564Savos urtwn_write_2(sc, R92C_RXFLTMAP2, 0x0000); 4311290564Savos 4312290564Savos rcr = R92C_RCR_AM | R92C_RCR_AB | R92C_RCR_APM | 4313290564Savos R92C_RCR_HTC_LOC_CTRL | R92C_RCR_APP_PHYSTS | 4314290564Savos R92C_RCR_APP_ICV | R92C_RCR_APP_MIC; 4315290564Savos 4316290564Savos if (vap->iv_opmode == IEEE80211_M_MONITOR) { 4317290564Savos /* Accept all frames. */ 4318290564Savos rcr |= R92C_RCR_ACF | R92C_RCR_ADF | R92C_RCR_AMF | 4319290564Savos R92C_RCR_AAP; 4320290564Savos } 4321290564Savos 4322290564Savos /* Set Rx filter. */ 4323290564Savos urtwn_write_4(sc, R92C_RCR, rcr); 4324290564Savos 4325290564Savos if (ic->ic_promisc != 0) { 4326290564Savos /* Update Rx filter. */ 4327290564Savos urtwn_set_promisc(sc); 4328290564Savos } 4329251538Srpaulo} 4330251538Srpaulo 4331251538Srpaulostatic void 4332251538Srpaulourtwn_edca_init(struct urtwn_softc *sc) 4333251538Srpaulo{ 4334251538Srpaulo urtwn_write_2(sc, R92C_SPEC_SIFS, 0x100a); 4335251538Srpaulo urtwn_write_2(sc, R92C_MAC_SPEC_SIFS, 0x100a); 4336251538Srpaulo urtwn_write_2(sc, R92C_SIFS_CCK, 0x100a); 4337251538Srpaulo urtwn_write_2(sc, R92C_SIFS_OFDM, 0x100a); 4338251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x005ea42b); 4339251538Srpaulo urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a44f); 4340251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005ea324); 4341251538Srpaulo urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002fa226); 4342251538Srpaulo} 4343251538Srpaulo 4344289066Skevlostatic void 4345251538Srpaulourtwn_write_txpower(struct urtwn_softc *sc, int chain, 4346251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]) 4347251538Srpaulo{ 4348251538Srpaulo uint32_t reg; 4349251538Srpaulo 4350251538Srpaulo /* Write per-CCK rate Tx power. */ 4351251538Srpaulo if (chain == 0) { 4352251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_A_CCK1_MCS32); 4353251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK1, power[0]); 4354251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_A_CCK1_MCS32, reg); 4355251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11); 4356251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK2, power[1]); 4357251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK55, power[2]); 4358251538Srpaulo reg = RW(reg, R92C_TXAGC_A_CCK11, power[3]); 4359251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg); 4360251538Srpaulo } else { 4361251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK1_55_MCS32); 4362251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK1, power[0]); 4363251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK2, power[1]); 4364251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK55, power[2]); 4365251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK1_55_MCS32, reg); 4366251538Srpaulo reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11); 4367251538Srpaulo reg = RW(reg, R92C_TXAGC_B_CCK11, power[3]); 4368251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg); 4369251538Srpaulo } 4370251538Srpaulo /* Write per-OFDM rate Tx power. */ 4371251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_RATE18_06(chain), 4372251538Srpaulo SM(R92C_TXAGC_RATE06, power[ 4]) | 4373251538Srpaulo SM(R92C_TXAGC_RATE09, power[ 5]) | 4374251538Srpaulo SM(R92C_TXAGC_RATE12, power[ 6]) | 4375251538Srpaulo SM(R92C_TXAGC_RATE18, power[ 7])); 4376251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_RATE54_24(chain), 4377251538Srpaulo SM(R92C_TXAGC_RATE24, power[ 8]) | 4378251538Srpaulo SM(R92C_TXAGC_RATE36, power[ 9]) | 4379251538Srpaulo SM(R92C_TXAGC_RATE48, power[10]) | 4380251538Srpaulo SM(R92C_TXAGC_RATE54, power[11])); 4381251538Srpaulo /* Write per-MCS Tx power. */ 4382251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS03_MCS00(chain), 4383251538Srpaulo SM(R92C_TXAGC_MCS00, power[12]) | 4384251538Srpaulo SM(R92C_TXAGC_MCS01, power[13]) | 4385251538Srpaulo SM(R92C_TXAGC_MCS02, power[14]) | 4386251538Srpaulo SM(R92C_TXAGC_MCS03, power[15])); 4387251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS07_MCS04(chain), 4388251538Srpaulo SM(R92C_TXAGC_MCS04, power[16]) | 4389251538Srpaulo SM(R92C_TXAGC_MCS05, power[17]) | 4390251538Srpaulo SM(R92C_TXAGC_MCS06, power[18]) | 4391251538Srpaulo SM(R92C_TXAGC_MCS07, power[19])); 4392251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS11_MCS08(chain), 4393251538Srpaulo SM(R92C_TXAGC_MCS08, power[20]) | 4394261506Skevlo SM(R92C_TXAGC_MCS09, power[21]) | 4395251538Srpaulo SM(R92C_TXAGC_MCS10, power[22]) | 4396251538Srpaulo SM(R92C_TXAGC_MCS11, power[23])); 4397251538Srpaulo urtwn_bb_write(sc, R92C_TXAGC_MCS15_MCS12(chain), 4398251538Srpaulo SM(R92C_TXAGC_MCS12, power[24]) | 4399251538Srpaulo SM(R92C_TXAGC_MCS13, power[25]) | 4400251538Srpaulo SM(R92C_TXAGC_MCS14, power[26]) | 4401251538Srpaulo SM(R92C_TXAGC_MCS15, power[27])); 4402251538Srpaulo} 4403251538Srpaulo 4404289066Skevlostatic void 4405251538Srpaulourtwn_get_txpower(struct urtwn_softc *sc, int chain, 4406251538Srpaulo struct ieee80211_channel *c, struct ieee80211_channel *extc, 4407251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]) 4408251538Srpaulo{ 4409287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 4410291264Savos struct r92c_rom *rom = &sc->rom.r92c_rom; 4411251538Srpaulo uint16_t cckpow, ofdmpow, htpow, diff, max; 4412251538Srpaulo const struct urtwn_txpwr *base; 4413251538Srpaulo int ridx, chan, group; 4414251538Srpaulo 4415251538Srpaulo /* Determine channel group. */ 4416251538Srpaulo chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */ 4417251538Srpaulo if (chan <= 3) 4418251538Srpaulo group = 0; 4419251538Srpaulo else if (chan <= 9) 4420251538Srpaulo group = 1; 4421251538Srpaulo else 4422251538Srpaulo group = 2; 4423251538Srpaulo 4424251538Srpaulo /* Get original Tx power based on board type and RF chain. */ 4425251538Srpaulo if (!(sc->chip & URTWN_CHIP_92C)) { 4426251538Srpaulo if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) 4427251538Srpaulo base = &rtl8188ru_txagc[chain]; 4428251538Srpaulo else 4429251538Srpaulo base = &rtl8192cu_txagc[chain]; 4430251538Srpaulo } else 4431251538Srpaulo base = &rtl8192cu_txagc[chain]; 4432251538Srpaulo 4433251538Srpaulo memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0])); 4434251538Srpaulo if (sc->regulatory == 0) { 4435289758Savos for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) 4436251538Srpaulo power[ridx] = base->pwr[0][ridx]; 4437251538Srpaulo } 4438289758Savos for (ridx = URTWN_RIDX_OFDM6; ridx < URTWN_RIDX_COUNT; ridx++) { 4439251538Srpaulo if (sc->regulatory == 3) { 4440251538Srpaulo power[ridx] = base->pwr[0][ridx]; 4441251538Srpaulo /* Apply vendor limits. */ 4442251538Srpaulo if (extc != NULL) 4443251538Srpaulo max = rom->ht40_max_pwr[group]; 4444251538Srpaulo else 4445251538Srpaulo max = rom->ht20_max_pwr[group]; 4446251538Srpaulo max = (max >> (chain * 4)) & 0xf; 4447251538Srpaulo if (power[ridx] > max) 4448251538Srpaulo power[ridx] = max; 4449251538Srpaulo } else if (sc->regulatory == 1) { 4450251538Srpaulo if (extc == NULL) 4451251538Srpaulo power[ridx] = base->pwr[group][ridx]; 4452251538Srpaulo } else if (sc->regulatory != 2) 4453251538Srpaulo power[ridx] = base->pwr[0][ridx]; 4454251538Srpaulo } 4455251538Srpaulo 4456251538Srpaulo /* Compute per-CCK rate Tx power. */ 4457251538Srpaulo cckpow = rom->cck_tx_pwr[chain][group]; 4458289758Savos for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) { 4459251538Srpaulo power[ridx] += cckpow; 4460251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 4461251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 4462251538Srpaulo } 4463251538Srpaulo 4464251538Srpaulo htpow = rom->ht40_1s_tx_pwr[chain][group]; 4465251538Srpaulo if (sc->ntxchains > 1) { 4466251538Srpaulo /* Apply reduction for 2 spatial streams. */ 4467251538Srpaulo diff = rom->ht40_2s_tx_pwr_diff[group]; 4468251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 4469251538Srpaulo htpow = (htpow > diff) ? htpow - diff : 0; 4470251538Srpaulo } 4471251538Srpaulo 4472251538Srpaulo /* Compute per-OFDM rate Tx power. */ 4473251538Srpaulo diff = rom->ofdm_tx_pwr_diff[group]; 4474251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 4475251538Srpaulo ofdmpow = htpow + diff; /* HT->OFDM correction. */ 4476289758Savos for (ridx = URTWN_RIDX_OFDM6; ridx <= URTWN_RIDX_OFDM54; ridx++) { 4477251538Srpaulo power[ridx] += ofdmpow; 4478251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 4479251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 4480251538Srpaulo } 4481251538Srpaulo 4482251538Srpaulo /* Compute per-MCS Tx power. */ 4483251538Srpaulo if (extc == NULL) { 4484251538Srpaulo diff = rom->ht20_tx_pwr_diff[group]; 4485251538Srpaulo diff = (diff >> (chain * 4)) & 0xf; 4486251538Srpaulo htpow += diff; /* HT40->HT20 correction. */ 4487251538Srpaulo } 4488251538Srpaulo for (ridx = 12; ridx <= 27; ridx++) { 4489251538Srpaulo power[ridx] += htpow; 4490251538Srpaulo if (power[ridx] > R92C_MAX_TX_PWR) 4491251538Srpaulo power[ridx] = R92C_MAX_TX_PWR; 4492251538Srpaulo } 4493294471Savos#ifdef USB_DEBUG 4494294471Savos if (sc->sc_debug & URTWN_DEBUG_TXPWR) { 4495251538Srpaulo /* Dump per-rate Tx power values. */ 4496251538Srpaulo printf("Tx power for chain %d:\n", chain); 4497289758Savos for (ridx = URTWN_RIDX_CCK1; ridx < URTWN_RIDX_COUNT; ridx++) 4498251538Srpaulo printf("Rate %d = %u\n", ridx, power[ridx]); 4499251538Srpaulo } 4500251538Srpaulo#endif 4501251538Srpaulo} 4502251538Srpaulo 4503289066Skevlostatic void 4504264912Skevlourtwn_r88e_get_txpower(struct urtwn_softc *sc, int chain, 4505264912Skevlo struct ieee80211_channel *c, struct ieee80211_channel *extc, 4506264912Skevlo uint16_t power[URTWN_RIDX_COUNT]) 4507264912Skevlo{ 4508287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 4509294198Savos struct r88e_rom *rom = &sc->rom.r88e_rom; 4510264912Skevlo uint16_t cckpow, ofdmpow, bw20pow, htpow; 4511264912Skevlo const struct urtwn_r88e_txpwr *base; 4512264912Skevlo int ridx, chan, group; 4513264912Skevlo 4514264912Skevlo /* Determine channel group. */ 4515264912Skevlo chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */ 4516264912Skevlo if (chan <= 2) 4517264912Skevlo group = 0; 4518264912Skevlo else if (chan <= 5) 4519264912Skevlo group = 1; 4520264912Skevlo else if (chan <= 8) 4521264912Skevlo group = 2; 4522264912Skevlo else if (chan <= 11) 4523264912Skevlo group = 3; 4524264912Skevlo else if (chan <= 13) 4525264912Skevlo group = 4; 4526264912Skevlo else 4527264912Skevlo group = 5; 4528264912Skevlo 4529264912Skevlo /* Get original Tx power based on board type and RF chain. */ 4530264912Skevlo base = &rtl8188eu_txagc[chain]; 4531264912Skevlo 4532264912Skevlo memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0])); 4533264912Skevlo if (sc->regulatory == 0) { 4534289758Savos for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) 4535264912Skevlo power[ridx] = base->pwr[0][ridx]; 4536264912Skevlo } 4537289758Savos for (ridx = URTWN_RIDX_OFDM6; ridx < URTWN_RIDX_COUNT; ridx++) { 4538264912Skevlo if (sc->regulatory == 3) 4539264912Skevlo power[ridx] = base->pwr[0][ridx]; 4540264912Skevlo else if (sc->regulatory == 1) { 4541264912Skevlo if (extc == NULL) 4542264912Skevlo power[ridx] = base->pwr[group][ridx]; 4543264912Skevlo } else if (sc->regulatory != 2) 4544264912Skevlo power[ridx] = base->pwr[0][ridx]; 4545264912Skevlo } 4546264912Skevlo 4547264912Skevlo /* Compute per-CCK rate Tx power. */ 4548294198Savos cckpow = rom->cck_tx_pwr[group]; 4549289758Savos for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) { 4550264912Skevlo power[ridx] += cckpow; 4551264912Skevlo if (power[ridx] > R92C_MAX_TX_PWR) 4552264912Skevlo power[ridx] = R92C_MAX_TX_PWR; 4553264912Skevlo } 4554264912Skevlo 4555294198Savos htpow = rom->ht40_tx_pwr[group]; 4556264912Skevlo 4557264912Skevlo /* Compute per-OFDM rate Tx power. */ 4558264912Skevlo ofdmpow = htpow + sc->ofdm_tx_pwr_diff; 4559289758Savos for (ridx = URTWN_RIDX_OFDM6; ridx <= URTWN_RIDX_OFDM54; ridx++) { 4560264912Skevlo power[ridx] += ofdmpow; 4561264912Skevlo if (power[ridx] > R92C_MAX_TX_PWR) 4562264912Skevlo power[ridx] = R92C_MAX_TX_PWR; 4563264912Skevlo } 4564264912Skevlo 4565264912Skevlo bw20pow = htpow + sc->bw20_tx_pwr_diff; 4566264912Skevlo for (ridx = 12; ridx <= 27; ridx++) { 4567264912Skevlo power[ridx] += bw20pow; 4568264912Skevlo if (power[ridx] > R92C_MAX_TX_PWR) 4569264912Skevlo power[ridx] = R92C_MAX_TX_PWR; 4570264912Skevlo } 4571264912Skevlo} 4572264912Skevlo 4573289066Skevlostatic void 4574251538Srpaulourtwn_set_txpower(struct urtwn_softc *sc, struct ieee80211_channel *c, 4575251538Srpaulo struct ieee80211_channel *extc) 4576251538Srpaulo{ 4577251538Srpaulo uint16_t power[URTWN_RIDX_COUNT]; 4578251538Srpaulo int i; 4579251538Srpaulo 4580251538Srpaulo for (i = 0; i < sc->ntxchains; i++) { 4581251538Srpaulo /* Compute per-rate Tx power values. */ 4582264912Skevlo if (sc->chip & URTWN_CHIP_88E) 4583264912Skevlo urtwn_r88e_get_txpower(sc, i, c, extc, power); 4584264912Skevlo else 4585264912Skevlo urtwn_get_txpower(sc, i, c, extc, power); 4586251538Srpaulo /* Write per-rate Tx power values to hardware. */ 4587251538Srpaulo urtwn_write_txpower(sc, i, power); 4588251538Srpaulo } 4589251538Srpaulo} 4590251538Srpaulo 4591251538Srpaulostatic void 4592290048Savosurtwn_set_rx_bssid_all(struct urtwn_softc *sc, int enable) 4593290048Savos{ 4594290048Savos uint32_t reg; 4595290048Savos 4596290048Savos reg = urtwn_read_4(sc, R92C_RCR); 4597290048Savos if (enable) 4598290048Savos reg &= ~R92C_RCR_CBSSID_BCN; 4599290048Savos else 4600290048Savos reg |= R92C_RCR_CBSSID_BCN; 4601290048Savos urtwn_write_4(sc, R92C_RCR, reg); 4602290048Savos} 4603290048Savos 4604290048Savosstatic void 4605290048Savosurtwn_set_gain(struct urtwn_softc *sc, uint8_t gain) 4606290048Savos{ 4607290048Savos uint32_t reg; 4608290048Savos 4609290048Savos reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0)); 4610290048Savos reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, gain); 4611290048Savos urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg); 4612290048Savos 4613290048Savos if (!(sc->chip & URTWN_CHIP_88E)) { 4614290048Savos reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1)); 4615290048Savos reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, gain); 4616290048Savos urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg); 4617290048Savos } 4618290048Savos} 4619290048Savos 4620290048Savosstatic void 4621251538Srpaulourtwn_scan_start(struct ieee80211com *ic) 4622251538Srpaulo{ 4623290048Savos struct urtwn_softc *sc = ic->ic_softc; 4624290048Savos 4625290048Savos URTWN_LOCK(sc); 4626290048Savos /* Receive beacons / probe responses from any BSSID. */ 4627290651Savos if (ic->ic_opmode != IEEE80211_M_IBSS) 4628290651Savos urtwn_set_rx_bssid_all(sc, 1); 4629290651Savos 4630290048Savos /* Set gain for scanning. */ 4631290048Savos urtwn_set_gain(sc, 0x20); 4632290048Savos URTWN_UNLOCK(sc); 4633251538Srpaulo} 4634251538Srpaulo 4635251538Srpaulostatic void 4636251538Srpaulourtwn_scan_end(struct ieee80211com *ic) 4637251538Srpaulo{ 4638290048Savos struct urtwn_softc *sc = ic->ic_softc; 4639290048Savos 4640290048Savos URTWN_LOCK(sc); 4641290048Savos /* Restore limitations. */ 4642290651Savos if (ic->ic_promisc == 0 && ic->ic_opmode != IEEE80211_M_IBSS) 4643290564Savos urtwn_set_rx_bssid_all(sc, 0); 4644290651Savos 4645290048Savos /* Set gain under link. */ 4646290048Savos urtwn_set_gain(sc, 0x32); 4647290048Savos URTWN_UNLOCK(sc); 4648251538Srpaulo} 4649251538Srpaulo 4650251538Srpaulostatic void 4651251538Srpaulourtwn_set_channel(struct ieee80211com *ic) 4652251538Srpaulo{ 4653286949Sadrian struct urtwn_softc *sc = ic->ic_softc; 4654292173Savos struct ieee80211_channel *c = ic->ic_curchan; 4655281070Srpaulo struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 4656251538Srpaulo 4657251538Srpaulo URTWN_LOCK(sc); 4658281070Srpaulo if (vap->iv_state == IEEE80211_S_SCAN) { 4659281070Srpaulo /* Make link LED blink during scan. */ 4660281070Srpaulo urtwn_set_led(sc, URTWN_LED_LINK, !sc->ledlink); 4661281070Srpaulo } 4662292173Savos urtwn_set_chan(sc, c, NULL); 4663292173Savos sc->sc_rxtap.wr_chan_freq = htole16(c->ic_freq); 4664292173Savos sc->sc_rxtap.wr_chan_flags = htole16(c->ic_flags); 4665292173Savos sc->sc_txtap.wt_chan_freq = htole16(c->ic_freq); 4666292173Savos sc->sc_txtap.wt_chan_flags = htole16(c->ic_flags); 4667251538Srpaulo URTWN_UNLOCK(sc); 4668251538Srpaulo} 4669251538Srpaulo 4670292014Savosstatic int 4671292014Savosurtwn_wme_update(struct ieee80211com *ic) 4672292014Savos{ 4673292014Savos const struct wmeParams *wmep = 4674292014Savos ic->ic_wme.wme_chanParams.cap_wmeParams; 4675292014Savos struct urtwn_softc *sc = ic->ic_softc; 4676292014Savos uint8_t aifs, acm, slottime; 4677292014Savos int ac; 4678292014Savos 4679292014Savos acm = 0; 4680292165Savos slottime = IEEE80211_GET_SLOTTIME(ic); 4681292014Savos 4682292014Savos URTWN_LOCK(sc); 4683292014Savos for (ac = WME_AC_BE; ac < WME_NUM_AC; ac++) { 4684292014Savos /* AIFS[AC] = AIFSN[AC] * aSlotTime + aSIFSTime. */ 4685292014Savos aifs = wmep[ac].wmep_aifsn * slottime + IEEE80211_DUR_SIFS; 4686292014Savos urtwn_write_4(sc, wme2queue[ac].reg, 4687292014Savos SM(R92C_EDCA_PARAM_TXOP, wmep[ac].wmep_txopLimit) | 4688292014Savos SM(R92C_EDCA_PARAM_ECWMIN, wmep[ac].wmep_logcwmin) | 4689292014Savos SM(R92C_EDCA_PARAM_ECWMAX, wmep[ac].wmep_logcwmax) | 4690292014Savos SM(R92C_EDCA_PARAM_AIFS, aifs)); 4691292014Savos if (ac != WME_AC_BE) 4692292014Savos acm |= wmep[ac].wmep_acm << ac; 4693292014Savos } 4694292014Savos 4695292014Savos if (acm != 0) 4696292014Savos acm |= R92C_ACMHWCTRL_EN; 4697292014Savos urtwn_write_1(sc, R92C_ACMHWCTRL, 4698292014Savos (urtwn_read_1(sc, R92C_ACMHWCTRL) & ~R92C_ACMHWCTRL_ACM_MASK) | 4699292014Savos acm); 4700292014Savos 4701292014Savos URTWN_UNLOCK(sc); 4702292014Savos 4703292014Savos return 0; 4704292014Savos} 4705292014Savos 4706251538Srpaulostatic void 4707294465Savosurtwn_update_slot(struct ieee80211com *ic) 4708294465Savos{ 4709294465Savos urtwn_cmd_sleepable(ic->ic_softc, NULL, 0, urtwn_update_slot_cb); 4710294465Savos} 4711294465Savos 4712294465Savosstatic void 4713294465Savosurtwn_update_slot_cb(struct urtwn_softc *sc, union sec_param *data) 4714294465Savos{ 4715294465Savos struct ieee80211com *ic = &sc->sc_ic; 4716294465Savos uint8_t slottime; 4717294465Savos 4718294465Savos slottime = IEEE80211_GET_SLOTTIME(ic); 4719294465Savos 4720294471Savos URTWN_DPRINTF(sc, URTWN_DEBUG_ANY, "%s: setting slot time to %uus\n", 4721294471Savos __func__, slottime); 4722294465Savos 4723294465Savos urtwn_write_1(sc, R92C_SLOT, slottime); 4724294465Savos urtwn_update_aifs(sc, slottime); 4725294465Savos} 4726294465Savos 4727294465Savosstatic void 4728294465Savosurtwn_update_aifs(struct urtwn_softc *sc, uint8_t slottime) 4729294465Savos{ 4730294465Savos const struct wmeParams *wmep = 4731294465Savos sc->sc_ic.ic_wme.wme_chanParams.cap_wmeParams; 4732294465Savos uint8_t aifs, ac; 4733294465Savos 4734294465Savos for (ac = WME_AC_BE; ac < WME_NUM_AC; ac++) { 4735294465Savos /* AIFS[AC] = AIFSN[AC] * aSlotTime + aSIFSTime. */ 4736294465Savos aifs = wmep[ac].wmep_aifsn * slottime + IEEE80211_DUR_SIFS; 4737294465Savos urtwn_write_1(sc, wme2queue[ac].reg, aifs); 4738294465Savos } 4739294465Savos} 4740294465Savos 4741294465Savosstatic void 4742290564Savosurtwn_set_promisc(struct urtwn_softc *sc) 4743290564Savos{ 4744290564Savos struct ieee80211com *ic = &sc->sc_ic; 4745290564Savos struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 4746290564Savos uint32_t rcr, mask1, mask2; 4747290564Savos 4748290564Savos URTWN_ASSERT_LOCKED(sc); 4749290564Savos 4750290564Savos if (vap->iv_opmode == IEEE80211_M_MONITOR) 4751290564Savos return; 4752290564Savos 4753290564Savos mask1 = R92C_RCR_ACF | R92C_RCR_ADF | R92C_RCR_AMF | R92C_RCR_AAP; 4754290564Savos mask2 = R92C_RCR_APM; 4755290564Savos 4756290564Savos if (vap->iv_state == IEEE80211_S_RUN) { 4757290564Savos switch (vap->iv_opmode) { 4758290564Savos case IEEE80211_M_STA: 4759290631Savos mask2 |= R92C_RCR_CBSSID_DATA; 4760290631Savos /* FALLTHROUGH */ 4761290631Savos case IEEE80211_M_HOSTAP: 4762290631Savos mask2 |= R92C_RCR_CBSSID_BCN; 4763290564Savos break; 4764290651Savos case IEEE80211_M_IBSS: 4765290651Savos mask2 |= R92C_RCR_CBSSID_DATA; 4766290651Savos break; 4767290564Savos default: 4768290564Savos device_printf(sc->sc_dev, "%s: undefined opmode %d\n", 4769290564Savos __func__, vap->iv_opmode); 4770290564Savos return; 4771290564Savos } 4772290564Savos } 4773290564Savos 4774290564Savos rcr = urtwn_read_4(sc, R92C_RCR); 4775290564Savos if (ic->ic_promisc == 0) 4776290564Savos rcr = (rcr & ~mask1) | mask2; 4777290564Savos else 4778290564Savos rcr = (rcr & ~mask2) | mask1; 4779290564Savos urtwn_write_4(sc, R92C_RCR, rcr); 4780290564Savos} 4781290564Savos 4782290564Savosstatic void 4783290564Savosurtwn_update_promisc(struct ieee80211com *ic) 4784290564Savos{ 4785290564Savos struct urtwn_softc *sc = ic->ic_softc; 4786290564Savos 4787290564Savos URTWN_LOCK(sc); 4788290564Savos if (sc->sc_flags & URTWN_RUNNING) 4789290564Savos urtwn_set_promisc(sc); 4790290564Savos URTWN_UNLOCK(sc); 4791290564Savos} 4792290564Savos 4793290564Savosstatic void 4794283540Sglebiusurtwn_update_mcast(struct ieee80211com *ic) 4795251538Srpaulo{ 4796251538Srpaulo /* XXX do nothing? */ 4797251538Srpaulo} 4798251538Srpaulo 4799292167Savosstatic struct ieee80211_node * 4800292167Savosurtwn_r88e_node_alloc(struct ieee80211vap *vap, 4801292167Savos const uint8_t mac[IEEE80211_ADDR_LEN]) 4802292167Savos{ 4803292167Savos struct urtwn_node *un; 4804292167Savos 4805292167Savos un = malloc(sizeof (struct urtwn_node), M_80211_NODE, 4806292167Savos M_NOWAIT | M_ZERO); 4807292167Savos 4808292167Savos if (un == NULL) 4809292167Savos return NULL; 4810292167Savos 4811292167Savos un->id = URTWN_MACID_UNDEFINED; 4812292167Savos 4813292167Savos return &un->ni; 4814292167Savos} 4815292167Savos 4816251538Srpaulostatic void 4817292167Savosurtwn_r88e_newassoc(struct ieee80211_node *ni, int isnew) 4818292167Savos{ 4819292167Savos struct urtwn_softc *sc = ni->ni_ic->ic_softc; 4820292167Savos struct urtwn_node *un = URTWN_NODE(ni); 4821292167Savos uint8_t id; 4822292167Savos 4823292167Savos if (!isnew) 4824292167Savos return; 4825292167Savos 4826292167Savos URTWN_NT_LOCK(sc); 4827292167Savos for (id = 0; id <= URTWN_MACID_MAX(sc); id++) { 4828292167Savos if (id != URTWN_MACID_BC && sc->node_list[id] == NULL) { 4829292167Savos un->id = id; 4830292167Savos sc->node_list[id] = ni; 4831292167Savos break; 4832292167Savos } 4833292167Savos } 4834292167Savos URTWN_NT_UNLOCK(sc); 4835292167Savos 4836292167Savos if (id > URTWN_MACID_MAX(sc)) { 4837292167Savos device_printf(sc->sc_dev, "%s: node table is full\n", 4838292167Savos __func__); 4839292167Savos } 4840292167Savos} 4841292167Savos 4842292167Savosstatic void 4843292167Savosurtwn_r88e_node_free(struct ieee80211_node *ni) 4844292167Savos{ 4845292167Savos struct urtwn_softc *sc = ni->ni_ic->ic_softc; 4846292167Savos struct urtwn_node *un = URTWN_NODE(ni); 4847292167Savos 4848292167Savos URTWN_NT_LOCK(sc); 4849292167Savos if (un->id != URTWN_MACID_UNDEFINED) 4850292167Savos sc->node_list[un->id] = NULL; 4851292167Savos URTWN_NT_UNLOCK(sc); 4852292167Savos 4853292167Savos sc->sc_node_free(ni); 4854292167Savos} 4855292167Savos 4856292167Savosstatic void 4857251538Srpaulourtwn_set_chan(struct urtwn_softc *sc, struct ieee80211_channel *c, 4858251538Srpaulo struct ieee80211_channel *extc) 4859251538Srpaulo{ 4860287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 4861251538Srpaulo uint32_t reg; 4862251538Srpaulo u_int chan; 4863251538Srpaulo int i; 4864251538Srpaulo 4865251538Srpaulo chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */ 4866251538Srpaulo if (chan == 0 || chan == IEEE80211_CHAN_ANY) { 4867251538Srpaulo device_printf(sc->sc_dev, 4868251538Srpaulo "%s: invalid channel %x\n", __func__, chan); 4869251538Srpaulo return; 4870251538Srpaulo } 4871251538Srpaulo 4872251538Srpaulo /* Set Tx power for this new channel. */ 4873251538Srpaulo urtwn_set_txpower(sc, c, extc); 4874251538Srpaulo 4875251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 4876251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_CHNLBW, 4877251538Srpaulo RW(sc->rf_chnlbw[i], R92C_RF_CHNLBW_CHNL, chan)); 4878251538Srpaulo } 4879251538Srpaulo#ifndef IEEE80211_NO_HT 4880251538Srpaulo if (extc != NULL) { 4881251538Srpaulo /* Is secondary channel below or above primary? */ 4882251538Srpaulo int prichlo = c->ic_freq < extc->ic_freq; 4883251538Srpaulo 4884251538Srpaulo urtwn_write_1(sc, R92C_BWOPMODE, 4885251538Srpaulo urtwn_read_1(sc, R92C_BWOPMODE) & ~R92C_BWOPMODE_20MHZ); 4886251538Srpaulo 4887251538Srpaulo reg = urtwn_read_1(sc, R92C_RRSR + 2); 4888251538Srpaulo reg = (reg & ~0x6f) | (prichlo ? 1 : 2) << 5; 4889251538Srpaulo urtwn_write_1(sc, R92C_RRSR + 2, reg); 4890251538Srpaulo 4891251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFMOD, 4892251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_RFMOD) | R92C_RFMOD_40MHZ); 4893251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_RFMOD, 4894251538Srpaulo urtwn_bb_read(sc, R92C_FPGA1_RFMOD) | R92C_RFMOD_40MHZ); 4895251538Srpaulo 4896251538Srpaulo /* Set CCK side band. */ 4897251538Srpaulo reg = urtwn_bb_read(sc, R92C_CCK0_SYSTEM); 4898251538Srpaulo reg = (reg & ~0x00000010) | (prichlo ? 0 : 1) << 4; 4899251538Srpaulo urtwn_bb_write(sc, R92C_CCK0_SYSTEM, reg); 4900251538Srpaulo 4901251538Srpaulo reg = urtwn_bb_read(sc, R92C_OFDM1_LSTF); 4902251538Srpaulo reg = (reg & ~0x00000c00) | (prichlo ? 1 : 2) << 10; 4903251538Srpaulo urtwn_bb_write(sc, R92C_OFDM1_LSTF, reg); 4904251538Srpaulo 4905251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2, 4906251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) & 4907251538Srpaulo ~R92C_FPGA0_ANAPARAM2_CBW20); 4908251538Srpaulo 4909251538Srpaulo reg = urtwn_bb_read(sc, 0x818); 4910251538Srpaulo reg = (reg & ~0x0c000000) | (prichlo ? 2 : 1) << 26; 4911251538Srpaulo urtwn_bb_write(sc, 0x818, reg); 4912251538Srpaulo 4913251538Srpaulo /* Select 40MHz bandwidth. */ 4914251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 4915251538Srpaulo (sc->rf_chnlbw[0] & ~0xfff) | chan); 4916251538Srpaulo } else 4917251538Srpaulo#endif 4918251538Srpaulo { 4919251538Srpaulo urtwn_write_1(sc, R92C_BWOPMODE, 4920251538Srpaulo urtwn_read_1(sc, R92C_BWOPMODE) | R92C_BWOPMODE_20MHZ); 4921251538Srpaulo 4922251538Srpaulo urtwn_bb_write(sc, R92C_FPGA0_RFMOD, 4923251538Srpaulo urtwn_bb_read(sc, R92C_FPGA0_RFMOD) & ~R92C_RFMOD_40MHZ); 4924251538Srpaulo urtwn_bb_write(sc, R92C_FPGA1_RFMOD, 4925251538Srpaulo urtwn_bb_read(sc, R92C_FPGA1_RFMOD) & ~R92C_RFMOD_40MHZ); 4926251538Srpaulo 4927264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 4928264912Skevlo urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2, 4929264912Skevlo urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) | 4930264912Skevlo R92C_FPGA0_ANAPARAM2_CBW20); 4931264912Skevlo } 4932281069Srpaulo 4933251538Srpaulo /* Select 20MHz bandwidth. */ 4934251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 4935281069Srpaulo (sc->rf_chnlbw[0] & ~0xfff) | chan | 4936264912Skevlo ((sc->chip & URTWN_CHIP_88E) ? R88E_RF_CHNLBW_BW20 : 4937264912Skevlo R92C_RF_CHNLBW_BW20)); 4938251538Srpaulo } 4939251538Srpaulo} 4940251538Srpaulo 4941251538Srpaulostatic void 4942251538Srpaulourtwn_iq_calib(struct urtwn_softc *sc) 4943251538Srpaulo{ 4944251538Srpaulo /* TODO */ 4945251538Srpaulo} 4946251538Srpaulo 4947251538Srpaulostatic void 4948251538Srpaulourtwn_lc_calib(struct urtwn_softc *sc) 4949251538Srpaulo{ 4950251538Srpaulo uint32_t rf_ac[2]; 4951251538Srpaulo uint8_t txmode; 4952251538Srpaulo int i; 4953251538Srpaulo 4954251538Srpaulo txmode = urtwn_read_1(sc, R92C_OFDM1_LSTF + 3); 4955251538Srpaulo if ((txmode & 0x70) != 0) { 4956251538Srpaulo /* Disable all continuous Tx. */ 4957251538Srpaulo urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode & ~0x70); 4958251538Srpaulo 4959251538Srpaulo /* Set RF mode to standby mode. */ 4960251538Srpaulo for (i = 0; i < sc->nrxchains; i++) { 4961251538Srpaulo rf_ac[i] = urtwn_rf_read(sc, i, R92C_RF_AC); 4962251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_AC, 4963251538Srpaulo RW(rf_ac[i], R92C_RF_AC_MODE, 4964251538Srpaulo R92C_RF_AC_MODE_STANDBY)); 4965251538Srpaulo } 4966251538Srpaulo } else { 4967251538Srpaulo /* Block all Tx queues. */ 4968293180Savos urtwn_write_1(sc, R92C_TXPAUSE, R92C_TX_QUEUE_ALL); 4969251538Srpaulo } 4970251538Srpaulo /* Start calibration. */ 4971251538Srpaulo urtwn_rf_write(sc, 0, R92C_RF_CHNLBW, 4972251538Srpaulo urtwn_rf_read(sc, 0, R92C_RF_CHNLBW) | R92C_RF_CHNLBW_LCSTART); 4973251538Srpaulo 4974251538Srpaulo /* Give calibration the time to complete. */ 4975266472Shselasky usb_pause_mtx(&sc->sc_mtx, hz / 10); /* 100ms */ 4976251538Srpaulo 4977251538Srpaulo /* Restore configuration. */ 4978251538Srpaulo if ((txmode & 0x70) != 0) { 4979251538Srpaulo /* Restore Tx mode. */ 4980251538Srpaulo urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode); 4981251538Srpaulo /* Restore RF mode. */ 4982251538Srpaulo for (i = 0; i < sc->nrxchains; i++) 4983251538Srpaulo urtwn_rf_write(sc, i, R92C_RF_AC, rf_ac[i]); 4984251538Srpaulo } else { 4985251538Srpaulo /* Unblock all Tx queues. */ 4986251538Srpaulo urtwn_write_1(sc, R92C_TXPAUSE, 0x00); 4987251538Srpaulo } 4988251538Srpaulo} 4989251538Srpaulo 4990294473Savosstatic void 4991294473Savosurtwn_temp_calib(struct urtwn_softc *sc) 4992294473Savos{ 4993294473Savos uint8_t temp; 4994294473Savos 4995294473Savos URTWN_ASSERT_LOCKED(sc); 4996294473Savos 4997294473Savos if (!(sc->sc_flags & URTWN_TEMP_MEASURED)) { 4998294473Savos /* Start measuring temperature. */ 4999294473Savos URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP, 5000294473Savos "%s: start measuring temperature\n", __func__); 5001294473Savos if (sc->chip & URTWN_CHIP_88E) { 5002294473Savos urtwn_rf_write(sc, 0, R88E_RF_T_METER, 5003294473Savos R88E_RF_T_METER_START); 5004294473Savos } else { 5005294473Savos urtwn_rf_write(sc, 0, R92C_RF_T_METER, 5006294473Savos R92C_RF_T_METER_START); 5007294473Savos } 5008294473Savos sc->sc_flags |= URTWN_TEMP_MEASURED; 5009294473Savos return; 5010294473Savos } 5011294473Savos sc->sc_flags &= ~URTWN_TEMP_MEASURED; 5012294473Savos 5013294473Savos /* Read measured temperature. */ 5014294473Savos if (sc->chip & URTWN_CHIP_88E) { 5015294473Savos temp = MS(urtwn_rf_read(sc, 0, R88E_RF_T_METER), 5016294473Savos R88E_RF_T_METER_VAL); 5017294473Savos } else { 5018294473Savos temp = MS(urtwn_rf_read(sc, 0, R92C_RF_T_METER), 5019294473Savos R92C_RF_T_METER_VAL); 5020294473Savos } 5021294473Savos if (temp == 0) { /* Read failed, skip. */ 5022294473Savos URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP, 5023294473Savos "%s: temperature read failed, skipping\n", __func__); 5024294473Savos return; 5025294473Savos } 5026294473Savos 5027294473Savos URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP, 5028294473Savos "%s: temperature: previous %u, current %u\n", 5029294473Savos __func__, sc->thcal_lctemp, temp); 5030294473Savos 5031294473Savos /* 5032294473Savos * Redo LC calibration if temperature changed significantly since 5033294473Savos * last calibration. 5034294473Savos */ 5035294473Savos if (sc->thcal_lctemp == 0) { 5036294473Savos /* First LC calibration is performed in urtwn_init(). */ 5037294473Savos sc->thcal_lctemp = temp; 5038294473Savos } else if (abs(temp - sc->thcal_lctemp) > 1) { 5039294473Savos URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP, 5040294473Savos "%s: LC calib triggered by temp: %u -> %u\n", 5041294473Savos __func__, sc->thcal_lctemp, temp); 5042294473Savos urtwn_lc_calib(sc); 5043294473Savos /* Record temperature of last LC calibration. */ 5044294473Savos sc->thcal_lctemp = temp; 5045294473Savos } 5046294473Savos} 5047294473Savos 5048291698Savosstatic int 5049287197Sglebiusurtwn_init(struct urtwn_softc *sc) 5050251538Srpaulo{ 5051287197Sglebius struct ieee80211com *ic = &sc->sc_ic; 5052287197Sglebius struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 5053287197Sglebius uint8_t macaddr[IEEE80211_ADDR_LEN]; 5054251538Srpaulo uint32_t reg; 5055291698Savos usb_error_t usb_err = USB_ERR_NORMAL_COMPLETION; 5056251538Srpaulo int error; 5057251538Srpaulo 5058291698Savos URTWN_LOCK(sc); 5059291698Savos if (sc->sc_flags & URTWN_RUNNING) { 5060291698Savos URTWN_UNLOCK(sc); 5061291698Savos return (0); 5062291698Savos } 5063264864Skevlo 5064251538Srpaulo /* Init firmware commands ring. */ 5065251538Srpaulo sc->fwcur = 0; 5066251538Srpaulo 5067251538Srpaulo /* Allocate Tx/Rx buffers. */ 5068251538Srpaulo error = urtwn_alloc_rx_list(sc); 5069251538Srpaulo if (error != 0) 5070251538Srpaulo goto fail; 5071281069Srpaulo 5072251538Srpaulo error = urtwn_alloc_tx_list(sc); 5073251538Srpaulo if (error != 0) 5074251538Srpaulo goto fail; 5075251538Srpaulo 5076251538Srpaulo /* Power on adapter. */ 5077251538Srpaulo error = urtwn_power_on(sc); 5078251538Srpaulo if (error != 0) 5079251538Srpaulo goto fail; 5080251538Srpaulo 5081251538Srpaulo /* Initialize DMA. */ 5082251538Srpaulo error = urtwn_dma_init(sc); 5083251538Srpaulo if (error != 0) 5084251538Srpaulo goto fail; 5085251538Srpaulo 5086251538Srpaulo /* Set info size in Rx descriptors (in 64-bit words). */ 5087251538Srpaulo urtwn_write_1(sc, R92C_RX_DRVINFO_SZ, 4); 5088251538Srpaulo 5089251538Srpaulo /* Init interrupts. */ 5090264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 5091291698Savos usb_err = urtwn_write_4(sc, R88E_HISR, 0xffffffff); 5092291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 5093291698Savos goto fail; 5094291698Savos usb_err = urtwn_write_4(sc, R88E_HIMR, R88E_HIMR_CPWM | R88E_HIMR_CPWM2 | 5095264912Skevlo R88E_HIMR_TBDER | R88E_HIMR_PSTIMEOUT); 5096291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 5097291698Savos goto fail; 5098291698Savos usb_err = urtwn_write_4(sc, R88E_HIMRE, R88E_HIMRE_RXFOVW | 5099264912Skevlo R88E_HIMRE_TXFOVW | R88E_HIMRE_RXERR | R88E_HIMRE_TXERR); 5100291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 5101291698Savos goto fail; 5102291698Savos usb_err = urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION, 5103264912Skevlo urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) | 5104264912Skevlo R92C_USB_SPECIAL_OPTION_INT_BULK_SEL); 5105291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 5106291698Savos goto fail; 5107264912Skevlo } else { 5108291698Savos usb_err = urtwn_write_4(sc, R92C_HISR, 0xffffffff); 5109291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 5110291698Savos goto fail; 5111291698Savos usb_err = urtwn_write_4(sc, R92C_HIMR, 0xffffffff); 5112291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 5113291698Savos goto fail; 5114264912Skevlo } 5115251538Srpaulo 5116251538Srpaulo /* Set MAC address. */ 5117287197Sglebius IEEE80211_ADDR_COPY(macaddr, vap ? vap->iv_myaddr : ic->ic_macaddr); 5118291698Savos usb_err = urtwn_write_region_1(sc, R92C_MACID, macaddr, IEEE80211_ADDR_LEN); 5119291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 5120291698Savos goto fail; 5121251538Srpaulo 5122251538Srpaulo /* Set initial network type. */ 5123289811Savos urtwn_set_mode(sc, R92C_MSR_INFRA); 5124251538Srpaulo 5125290564Savos /* Initialize Rx filter. */ 5126251538Srpaulo urtwn_rxfilter_init(sc); 5127251538Srpaulo 5128282623Skevlo /* Set response rate. */ 5129251538Srpaulo reg = urtwn_read_4(sc, R92C_RRSR); 5130251538Srpaulo reg = RW(reg, R92C_RRSR_RATE_BITMAP, R92C_RRSR_RATE_CCK_ONLY_1M); 5131251538Srpaulo urtwn_write_4(sc, R92C_RRSR, reg); 5132251538Srpaulo 5133251538Srpaulo /* Set short/long retry limits. */ 5134251538Srpaulo urtwn_write_2(sc, R92C_RL, 5135251538Srpaulo SM(R92C_RL_SRL, 0x30) | SM(R92C_RL_LRL, 0x30)); 5136251538Srpaulo 5137251538Srpaulo /* Initialize EDCA parameters. */ 5138251538Srpaulo urtwn_edca_init(sc); 5139251538Srpaulo 5140251538Srpaulo /* Setup rate fallback. */ 5141264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 5142264912Skevlo urtwn_write_4(sc, R92C_DARFRC + 0, 0x00000000); 5143264912Skevlo urtwn_write_4(sc, R92C_DARFRC + 4, 0x10080404); 5144264912Skevlo urtwn_write_4(sc, R92C_RARFRC + 0, 0x04030201); 5145264912Skevlo urtwn_write_4(sc, R92C_RARFRC + 4, 0x08070605); 5146264912Skevlo } 5147251538Srpaulo 5148251538Srpaulo urtwn_write_1(sc, R92C_FWHW_TXQ_CTRL, 5149251538Srpaulo urtwn_read_1(sc, R92C_FWHW_TXQ_CTRL) | 5150251538Srpaulo R92C_FWHW_TXQ_CTRL_AMPDU_RTY_NEW); 5151251538Srpaulo /* Set ACK timeout. */ 5152251538Srpaulo urtwn_write_1(sc, R92C_ACKTO, 0x40); 5153251538Srpaulo 5154251538Srpaulo /* Setup USB aggregation. */ 5155251538Srpaulo reg = urtwn_read_4(sc, R92C_TDECTRL); 5156251538Srpaulo reg = RW(reg, R92C_TDECTRL_BLK_DESC_NUM, 6); 5157251538Srpaulo urtwn_write_4(sc, R92C_TDECTRL, reg); 5158251538Srpaulo urtwn_write_1(sc, R92C_TRXDMA_CTRL, 5159251538Srpaulo urtwn_read_1(sc, R92C_TRXDMA_CTRL) | 5160251538Srpaulo R92C_TRXDMA_CTRL_RXDMA_AGG_EN); 5161251538Srpaulo urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH, 48); 5162264912Skevlo if (sc->chip & URTWN_CHIP_88E) 5163264912Skevlo urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH + 1, 4); 5164282266Skevlo else { 5165264912Skevlo urtwn_write_1(sc, R92C_USB_DMA_AGG_TO, 4); 5166282266Skevlo urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION, 5167282266Skevlo urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) | 5168282266Skevlo R92C_USB_SPECIAL_OPTION_AGG_EN); 5169282266Skevlo urtwn_write_1(sc, R92C_USB_AGG_TH, 8); 5170282266Skevlo urtwn_write_1(sc, R92C_USB_AGG_TO, 6); 5171282266Skevlo } 5172251538Srpaulo 5173251538Srpaulo /* Initialize beacon parameters. */ 5174264912Skevlo urtwn_write_2(sc, R92C_BCN_CTRL, 0x1010); 5175251538Srpaulo urtwn_write_2(sc, R92C_TBTT_PROHIBIT, 0x6404); 5176251538Srpaulo urtwn_write_1(sc, R92C_DRVERLYINT, 0x05); 5177251538Srpaulo urtwn_write_1(sc, R92C_BCNDMATIM, 0x02); 5178251538Srpaulo urtwn_write_2(sc, R92C_BCNTCFG, 0x660f); 5179251538Srpaulo 5180264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 5181264912Skevlo /* Setup AMPDU aggregation. */ 5182264912Skevlo urtwn_write_4(sc, R92C_AGGLEN_LMT, 0x99997631); /* MCS7~0 */ 5183264912Skevlo urtwn_write_1(sc, R92C_AGGR_BREAK_TIME, 0x16); 5184264912Skevlo urtwn_write_2(sc, R92C_MAX_AGGR_NUM, 0x0708); 5185251538Srpaulo 5186264912Skevlo urtwn_write_1(sc, R92C_BCN_MAX_ERR, 0xff); 5187264912Skevlo } 5188251538Srpaulo 5189295871Savos#ifndef URTWN_WITHOUT_UCODE 5190251538Srpaulo /* Load 8051 microcode. */ 5191251538Srpaulo error = urtwn_load_firmware(sc); 5192295871Savos if (error == 0) 5193295871Savos sc->sc_flags |= URTWN_FW_LOADED; 5194295871Savos#endif 5195251538Srpaulo 5196251538Srpaulo /* Initialize MAC/BB/RF blocks. */ 5197291698Savos error = urtwn_mac_init(sc); 5198291698Savos if (error != 0) { 5199291698Savos device_printf(sc->sc_dev, 5200291698Savos "%s: error while initializing MAC block\n", __func__); 5201291698Savos goto fail; 5202291698Savos } 5203251538Srpaulo urtwn_bb_init(sc); 5204251538Srpaulo urtwn_rf_init(sc); 5205251538Srpaulo 5206290564Savos /* Reinitialize Rx filter (D3845 is not committed yet). */ 5207290564Savos urtwn_rxfilter_init(sc); 5208290564Savos 5209264912Skevlo if (sc->chip & URTWN_CHIP_88E) { 5210264912Skevlo urtwn_write_2(sc, R92C_CR, 5211264912Skevlo urtwn_read_2(sc, R92C_CR) | R92C_CR_MACTXEN | 5212264912Skevlo R92C_CR_MACRXEN); 5213264912Skevlo } 5214264912Skevlo 5215251538Srpaulo /* Turn CCK and OFDM blocks on. */ 5216251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD); 5217251538Srpaulo reg |= R92C_RFMOD_CCK_EN; 5218291698Savos usb_err = urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg); 5219291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 5220291698Savos goto fail; 5221251538Srpaulo reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD); 5222251538Srpaulo reg |= R92C_RFMOD_OFDM_EN; 5223291698Savos usb_err = urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg); 5224291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 5225291698Savos goto fail; 5226251538Srpaulo 5227251538Srpaulo /* Clear per-station keys table. */ 5228251538Srpaulo urtwn_cam_init(sc); 5229251538Srpaulo 5230292175Savos /* Enable decryption / encryption. */ 5231292175Savos urtwn_write_2(sc, R92C_SECCFG, 5232292175Savos R92C_SECCFG_TXUCKEY_DEF | R92C_SECCFG_RXUCKEY_DEF | 5233292175Savos R92C_SECCFG_TXENC_ENA | R92C_SECCFG_RXDEC_ENA | 5234292175Savos R92C_SECCFG_TXBCKEY_DEF | R92C_SECCFG_RXBCKEY_DEF); 5235292175Savos 5236292175Savos /* 5237292175Savos * Install static keys (if any). 5238292175Savos * Must be called after urtwn_cam_init(). 5239292175Savos */ 5240292175Savos ieee80211_runtask(ic, &sc->cmdq_task); 5241292175Savos 5242251538Srpaulo /* Enable hardware sequence numbering. */ 5243293180Savos urtwn_write_1(sc, R92C_HWSEQ_CTRL, R92C_TX_QUEUE_ALL); 5244251538Srpaulo 5245292167Savos /* Enable per-packet TX report. */ 5246292167Savos if (sc->chip & URTWN_CHIP_88E) { 5247292167Savos urtwn_write_1(sc, R88E_TX_RPT_CTRL, 5248292167Savos urtwn_read_1(sc, R88E_TX_RPT_CTRL) | R88E_TX_RPT1_ENA); 5249292167Savos } 5250292167Savos 5251251538Srpaulo /* Perform LO and IQ calibrations. */ 5252251538Srpaulo urtwn_iq_calib(sc); 5253251538Srpaulo /* Perform LC calibration. */ 5254251538Srpaulo urtwn_lc_calib(sc); 5255251538Srpaulo 5256251538Srpaulo /* Fix USB interference issue. */ 5257264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) { 5258264912Skevlo urtwn_write_1(sc, 0xfe40, 0xe0); 5259264912Skevlo urtwn_write_1(sc, 0xfe41, 0x8d); 5260264912Skevlo urtwn_write_1(sc, 0xfe42, 0x80); 5261251538Srpaulo 5262264912Skevlo urtwn_pa_bias_init(sc); 5263264912Skevlo } 5264251538Srpaulo 5265251538Srpaulo /* Initialize GPIO setting. */ 5266251538Srpaulo urtwn_write_1(sc, R92C_GPIO_MUXCFG, 5267251538Srpaulo urtwn_read_1(sc, R92C_GPIO_MUXCFG) & ~R92C_GPIO_MUXCFG_ENBT); 5268251538Srpaulo 5269251538Srpaulo /* Fix for lower temperature. */ 5270264912Skevlo if (!(sc->chip & URTWN_CHIP_88E)) 5271264912Skevlo urtwn_write_1(sc, 0x15, 0xe9); 5272251538Srpaulo 5273251538Srpaulo usbd_transfer_start(sc->sc_xfer[URTWN_BULK_RX]); 5274251538Srpaulo 5275287197Sglebius sc->sc_flags |= URTWN_RUNNING; 5276251538Srpaulo 5277251538Srpaulo callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 5278251538Srpaulofail: 5279291698Savos if (usb_err != USB_ERR_NORMAL_COMPLETION) 5280291698Savos error = EIO; 5281291698Savos 5282291698Savos URTWN_UNLOCK(sc); 5283291698Savos 5284291698Savos return (error); 5285251538Srpaulo} 5286251538Srpaulo 5287251538Srpaulostatic void 5288287197Sglebiusurtwn_stop(struct urtwn_softc *sc) 5289251538Srpaulo{ 5290251538Srpaulo 5291291698Savos URTWN_LOCK(sc); 5292291698Savos if (!(sc->sc_flags & URTWN_RUNNING)) { 5293291698Savos URTWN_UNLOCK(sc); 5294291698Savos return; 5295291698Savos } 5296291698Savos 5297295871Savos sc->sc_flags &= ~(URTWN_RUNNING | URTWN_FW_LOADED | 5298295871Savos URTWN_TEMP_MEASURED); 5299294473Savos sc->thcal_lctemp = 0; 5300251538Srpaulo callout_stop(&sc->sc_watchdog_ch); 5301295874Savos 5302251538Srpaulo urtwn_abort_xfers(sc); 5303288353Sadrian urtwn_drain_mbufq(sc); 5304295874Savos urtwn_power_off(sc); 5305291698Savos URTWN_UNLOCK(sc); 5306251538Srpaulo} 5307251538Srpaulo 5308251538Srpaulostatic void 5309251538Srpaulourtwn_abort_xfers(struct urtwn_softc *sc) 5310251538Srpaulo{ 5311251538Srpaulo int i; 5312251538Srpaulo 5313251538Srpaulo URTWN_ASSERT_LOCKED(sc); 5314251538Srpaulo 5315251538Srpaulo /* abort any pending transfers */ 5316251538Srpaulo for (i = 0; i < URTWN_N_TRANSFER; i++) 5317251538Srpaulo usbd_transfer_stop(sc->sc_xfer[i]); 5318251538Srpaulo} 5319251538Srpaulo 5320251538Srpaulostatic int 5321251538Srpaulourtwn_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 5322251538Srpaulo const struct ieee80211_bpf_params *params) 5323251538Srpaulo{ 5324251538Srpaulo struct ieee80211com *ic = ni->ni_ic; 5325286949Sadrian struct urtwn_softc *sc = ic->ic_softc; 5326251538Srpaulo struct urtwn_data *bf; 5327290630Savos int error; 5328251538Srpaulo 5329251538Srpaulo /* prevent management frames from being sent if we're not ready */ 5330290630Savos URTWN_LOCK(sc); 5331287197Sglebius if (!(sc->sc_flags & URTWN_RUNNING)) { 5332290630Savos error = ENETDOWN; 5333290630Savos goto end; 5334251538Srpaulo } 5335290630Savos 5336251538Srpaulo bf = urtwn_getbuf(sc); 5337251538Srpaulo if (bf == NULL) { 5338290630Savos error = ENOBUFS; 5339290630Savos goto end; 5340251538Srpaulo } 5341251538Srpaulo 5342292221Savos if (params == NULL) { 5343292221Savos /* 5344292221Savos * Legacy path; interpret frame contents to decide 5345292221Savos * precisely how to send the frame. 5346292221Savos */ 5347292221Savos error = urtwn_tx_data(sc, ni, m, bf); 5348292221Savos } else { 5349292221Savos /* 5350292221Savos * Caller supplied explicit parameters to use in 5351292221Savos * sending the frame. 5352292221Savos */ 5353292221Savos error = urtwn_tx_raw(sc, ni, m, bf, params); 5354292221Savos } 5355292221Savos if (error != 0) { 5356251538Srpaulo STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next); 5357290630Savos goto end; 5358251538Srpaulo } 5359290630Savos 5360288353Sadrian sc->sc_txtimer = 5; 5361290630Savos callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc); 5362290630Savos 5363290630Savosend: 5364290630Savos if (error != 0) 5365290630Savos m_freem(m); 5366290630Savos 5367251538Srpaulo URTWN_UNLOCK(sc); 5368251538Srpaulo 5369290630Savos return (error); 5370251538Srpaulo} 5371251538Srpaulo 5372266472Shselaskystatic void 5373266472Shselaskyurtwn_ms_delay(struct urtwn_softc *sc) 5374266472Shselasky{ 5375266472Shselasky usb_pause_mtx(&sc->sc_mtx, hz / 1000); 5376266472Shselasky} 5377266472Shselasky 5378251538Srpaulostatic device_method_t urtwn_methods[] = { 5379251538Srpaulo /* Device interface */ 5380251538Srpaulo DEVMETHOD(device_probe, urtwn_match), 5381251538Srpaulo DEVMETHOD(device_attach, urtwn_attach), 5382251538Srpaulo DEVMETHOD(device_detach, urtwn_detach), 5383251538Srpaulo 5384264912Skevlo DEVMETHOD_END 5385251538Srpaulo}; 5386251538Srpaulo 5387251538Srpaulostatic driver_t urtwn_driver = { 5388251538Srpaulo "urtwn", 5389251538Srpaulo urtwn_methods, 5390251538Srpaulo sizeof(struct urtwn_softc) 5391251538Srpaulo}; 5392251538Srpaulo 5393251538Srpaulostatic devclass_t urtwn_devclass; 5394251538Srpaulo 5395251538SrpauloDRIVER_MODULE(urtwn, uhub, urtwn_driver, urtwn_devclass, NULL, NULL); 5396251538SrpauloMODULE_DEPEND(urtwn, usb, 1, 1, 1); 5397251538SrpauloMODULE_DEPEND(urtwn, wlan, 1, 1, 1); 5398295871Savos#ifndef URTWN_WITHOUT_UCODE 5399251538SrpauloMODULE_DEPEND(urtwn, firmware, 1, 1, 1); 5400295871Savos#endif 5401251538SrpauloMODULE_VERSION(urtwn, 1); 5402292080SimpUSB_PNP_HOST_INFO(urtwn_devs); 5403