102ac6454SAndrew Thompson /* $FreeBSD$ */ 202ac6454SAndrew Thompson 302ac6454SAndrew Thompson /*- 402ac6454SAndrew Thompson * Copyright (c) 2005-2007 Damien Bergamini <damien.bergamini@free.fr> 502ac6454SAndrew Thompson * Copyright (c) 2006 Niall O'Higgins <niallo@openbsd.org> 65d38a4d4SEd Schouten * Copyright (c) 2007-2008 Hans Petter Selasky <hselasky@FreeBSD.org> 7ce036b51SAndriy Voskoboinyk * Copyright (c) 2015 Andriy Voskoboinyk <avos@FreeBSD.org> 802ac6454SAndrew Thompson * 902ac6454SAndrew Thompson * Permission to use, copy, modify, and distribute this software for any 1002ac6454SAndrew Thompson * purpose with or without fee is hereby granted, provided that the above 1102ac6454SAndrew Thompson * copyright notice and this permission notice appear in all copies. 1202ac6454SAndrew Thompson * 1302ac6454SAndrew Thompson * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 1402ac6454SAndrew Thompson * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 1502ac6454SAndrew Thompson * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 1602ac6454SAndrew Thompson * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 1702ac6454SAndrew Thompson * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 1802ac6454SAndrew Thompson * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 1902ac6454SAndrew Thompson * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 2002ac6454SAndrew Thompson */ 2102ac6454SAndrew Thompson 2202ac6454SAndrew Thompson #include <sys/cdefs.h> 2302ac6454SAndrew Thompson __FBSDID("$FreeBSD$"); 2402ac6454SAndrew Thompson 2502ac6454SAndrew Thompson /*- 2602ac6454SAndrew Thompson * Ralink Technology RT2501USB/RT2601USB chipset driver 2702ac6454SAndrew Thompson * http://www.ralinktech.com.tw/ 2802ac6454SAndrew Thompson */ 2902ac6454SAndrew Thompson 305efea30fSAndrew Thompson #include <sys/param.h> 315efea30fSAndrew Thompson #include <sys/sockio.h> 325efea30fSAndrew Thompson #include <sys/sysctl.h> 335efea30fSAndrew Thompson #include <sys/lock.h> 345efea30fSAndrew Thompson #include <sys/mutex.h> 355efea30fSAndrew Thompson #include <sys/mbuf.h> 365efea30fSAndrew Thompson #include <sys/kernel.h> 375efea30fSAndrew Thompson #include <sys/socket.h> 385efea30fSAndrew Thompson #include <sys/systm.h> 395efea30fSAndrew Thompson #include <sys/malloc.h> 405efea30fSAndrew Thompson #include <sys/module.h> 415efea30fSAndrew Thompson #include <sys/bus.h> 425efea30fSAndrew Thompson #include <sys/endian.h> 435efea30fSAndrew Thompson #include <sys/kdb.h> 445efea30fSAndrew Thompson 455efea30fSAndrew Thompson #include <machine/bus.h> 4667784314SPoul-Henning Kamp #include <machine/resource.h> 4767784314SPoul-Henning Kamp #include <sys/rman.h> 485efea30fSAndrew Thompson 495efea30fSAndrew Thompson #include <net/bpf.h> 505efea30fSAndrew Thompson #include <net/if.h> 5176039bc8SGleb Smirnoff #include <net/if_var.h> 5267784314SPoul-Henning Kamp #include <net/if_arp.h> 535efea30fSAndrew Thompson #include <net/ethernet.h> 545efea30fSAndrew Thompson #include <net/if_dl.h> 555efea30fSAndrew Thompson #include <net/if_media.h> 565efea30fSAndrew Thompson #include <net/if_types.h> 575efea30fSAndrew Thompson 585efea30fSAndrew Thompson #ifdef INET 595efea30fSAndrew Thompson #include <netinet/in.h> 605efea30fSAndrew Thompson #include <netinet/in_systm.h> 615efea30fSAndrew Thompson #include <netinet/in_var.h> 625efea30fSAndrew Thompson #include <netinet/if_ether.h> 635efea30fSAndrew Thompson #include <netinet/ip.h> 645efea30fSAndrew Thompson #endif 655efea30fSAndrew Thompson 665efea30fSAndrew Thompson #include <net80211/ieee80211_var.h> 675efea30fSAndrew Thompson #include <net80211/ieee80211_regdomain.h> 685efea30fSAndrew Thompson #include <net80211/ieee80211_radiotap.h> 69b6108616SRui Paulo #include <net80211/ieee80211_ratectl.h> 7002ac6454SAndrew Thompson 715efea30fSAndrew Thompson #include <dev/usb/usb.h> 72ed6d949aSAndrew Thompson #include <dev/usb/usbdi.h> 735efea30fSAndrew Thompson #include "usbdevs.h" 7402ac6454SAndrew Thompson 75ed6d949aSAndrew Thompson #define USB_DEBUG_VAR rum_debug 76ed6d949aSAndrew Thompson #include <dev/usb/usb_debug.h> 77ed6d949aSAndrew Thompson 7802ac6454SAndrew Thompson #include <dev/usb/wlan/if_rumreg.h> 7902ac6454SAndrew Thompson #include <dev/usb/wlan/if_rumvar.h> 8002ac6454SAndrew Thompson #include <dev/usb/wlan/if_rumfw.h> 8102ac6454SAndrew Thompson 82b850ecc1SAndrew Thompson #ifdef USB_DEBUG 8302ac6454SAndrew Thompson static int rum_debug = 0; 8402ac6454SAndrew Thompson 856472ac3dSEd Schouten static SYSCTL_NODE(_hw_usb, OID_AUTO, rum, CTLFLAG_RW, 0, "USB rum"); 86ece4b0bdSHans Petter Selasky SYSCTL_INT(_hw_usb_rum, OID_AUTO, debug, CTLFLAG_RWTUN, &rum_debug, 0, 8702ac6454SAndrew Thompson "Debug level"); 8802ac6454SAndrew Thompson #endif 8902ac6454SAndrew Thompson 90f1a16106SHans Petter Selasky static const STRUCT_USB_HOST_ID rum_devs[] = { 919e6b5313SAndrew Thompson #define RUM_DEV(v,p) { USB_VP(USB_VENDOR_##v, USB_PRODUCT_##v##_##p) } 929e6b5313SAndrew Thompson RUM_DEV(ABOCOM, HWU54DM), 939e6b5313SAndrew Thompson RUM_DEV(ABOCOM, RT2573_2), 949e6b5313SAndrew Thompson RUM_DEV(ABOCOM, RT2573_3), 959e6b5313SAndrew Thompson RUM_DEV(ABOCOM, RT2573_4), 969e6b5313SAndrew Thompson RUM_DEV(ABOCOM, WUG2700), 979e6b5313SAndrew Thompson RUM_DEV(AMIT, CGWLUSB2GO), 989e6b5313SAndrew Thompson RUM_DEV(ASUS, RT2573_1), 999e6b5313SAndrew Thompson RUM_DEV(ASUS, RT2573_2), 1009e6b5313SAndrew Thompson RUM_DEV(BELKIN, F5D7050A), 1019e6b5313SAndrew Thompson RUM_DEV(BELKIN, F5D9050V3), 1029e6b5313SAndrew Thompson RUM_DEV(CISCOLINKSYS, WUSB54GC), 1039e6b5313SAndrew Thompson RUM_DEV(CISCOLINKSYS, WUSB54GR), 1049e6b5313SAndrew Thompson RUM_DEV(CONCEPTRONIC2, C54RU2), 1059e6b5313SAndrew Thompson RUM_DEV(COREGA, CGWLUSB2GL), 1069e6b5313SAndrew Thompson RUM_DEV(COREGA, CGWLUSB2GPX), 1079e6b5313SAndrew Thompson RUM_DEV(DICKSMITH, CWD854F), 1089e6b5313SAndrew Thompson RUM_DEV(DICKSMITH, RT2573), 109031c7388SAndrew Thompson RUM_DEV(EDIMAX, EW7318USG), 1109e6b5313SAndrew Thompson RUM_DEV(DLINK2, DWLG122C1), 1119e6b5313SAndrew Thompson RUM_DEV(DLINK2, WUA1340), 1129e6b5313SAndrew Thompson RUM_DEV(DLINK2, DWA111), 1139e6b5313SAndrew Thompson RUM_DEV(DLINK2, DWA110), 1149e6b5313SAndrew Thompson RUM_DEV(GIGABYTE, GNWB01GS), 1159e6b5313SAndrew Thompson RUM_DEV(GIGABYTE, GNWI05GS), 1169e6b5313SAndrew Thompson RUM_DEV(GIGASET, RT2573), 1179e6b5313SAndrew Thompson RUM_DEV(GOODWAY, RT2573), 1189e6b5313SAndrew Thompson RUM_DEV(GUILLEMOT, HWGUSB254LB), 1199e6b5313SAndrew Thompson RUM_DEV(GUILLEMOT, HWGUSB254V2AP), 1209e6b5313SAndrew Thompson RUM_DEV(HUAWEI3COM, WUB320G), 1219e6b5313SAndrew Thompson RUM_DEV(MELCO, G54HP), 1229e6b5313SAndrew Thompson RUM_DEV(MELCO, SG54HP), 1233232aae3SHans Petter Selasky RUM_DEV(MELCO, SG54HG), 12454de08a9SMIHIRA Sanpei Yoshiro RUM_DEV(MELCO, WLIUCG), 125e11ad60dSHans Petter Selasky RUM_DEV(MELCO, WLRUCG), 126e11ad60dSHans Petter Selasky RUM_DEV(MELCO, WLRUCGAOSS), 1279e6b5313SAndrew Thompson RUM_DEV(MSI, RT2573_1), 1289e6b5313SAndrew Thompson RUM_DEV(MSI, RT2573_2), 1299e6b5313SAndrew Thompson RUM_DEV(MSI, RT2573_3), 1309e6b5313SAndrew Thompson RUM_DEV(MSI, RT2573_4), 1319e6b5313SAndrew Thompson RUM_DEV(NOVATECH, RT2573), 1329e6b5313SAndrew Thompson RUM_DEV(PLANEX2, GWUS54HP), 1339e6b5313SAndrew Thompson RUM_DEV(PLANEX2, GWUS54MINI2), 1349e6b5313SAndrew Thompson RUM_DEV(PLANEX2, GWUSMM), 1359e6b5313SAndrew Thompson RUM_DEV(QCOM, RT2573), 1369e6b5313SAndrew Thompson RUM_DEV(QCOM, RT2573_2), 1379e6b5313SAndrew Thompson RUM_DEV(QCOM, RT2573_3), 1389e6b5313SAndrew Thompson RUM_DEV(RALINK, RT2573), 1399e6b5313SAndrew Thompson RUM_DEV(RALINK, RT2573_2), 1409e6b5313SAndrew Thompson RUM_DEV(RALINK, RT2671), 1419e6b5313SAndrew Thompson RUM_DEV(SITECOMEU, WL113R2), 1429e6b5313SAndrew Thompson RUM_DEV(SITECOMEU, WL172), 1439e6b5313SAndrew Thompson RUM_DEV(SPARKLAN, RT2573), 1449e6b5313SAndrew Thompson RUM_DEV(SURECOM, RT2573), 1459e6b5313SAndrew Thompson #undef RUM_DEV 14602ac6454SAndrew Thompson }; 14702ac6454SAndrew Thompson 14802ac6454SAndrew Thompson static device_probe_t rum_match; 14902ac6454SAndrew Thompson static device_attach_t rum_attach; 15002ac6454SAndrew Thompson static device_detach_t rum_detach; 15102ac6454SAndrew Thompson 152e0a69b51SAndrew Thompson static usb_callback_t rum_bulk_read_callback; 153e0a69b51SAndrew Thompson static usb_callback_t rum_bulk_write_callback; 15402ac6454SAndrew Thompson 155e0a69b51SAndrew Thompson static usb_error_t rum_do_request(struct rum_softc *sc, 156760bc48eSAndrew Thompson struct usb_device_request *req, void *data); 157fd7dae9cSAndriy Voskoboinyk static usb_error_t rum_do_mcu_request(struct rum_softc *sc, int); 15802ac6454SAndrew Thompson static struct ieee80211vap *rum_vap_create(struct ieee80211com *, 159fcd9500fSBernhard Schmidt const char [IFNAMSIZ], int, enum ieee80211_opmode, 160fcd9500fSBernhard Schmidt int, const uint8_t [IEEE80211_ADDR_LEN], 161fcd9500fSBernhard Schmidt const uint8_t [IEEE80211_ADDR_LEN]); 16202ac6454SAndrew Thompson static void rum_vap_delete(struct ieee80211vap *); 163f28c2f5eSAdrian Chadd static void rum_cmdq_cb(void *, int); 164f28c2f5eSAdrian Chadd static int rum_cmd_sleepable(struct rum_softc *, const void *, 165ed5711a1SAdrian Chadd size_t, uint8_t, CMD_FUNC_PROTO); 16602ac6454SAndrew Thompson static void rum_tx_free(struct rum_tx_data *, int); 16702ac6454SAndrew Thompson static void rum_setup_tx_list(struct rum_softc *); 16802ac6454SAndrew Thompson static void rum_unsetup_tx_list(struct rum_softc *); 169349156a9SAndriy Voskoboinyk static void rum_beacon_miss(struct ieee80211vap *); 170349156a9SAndriy Voskoboinyk static void rum_sta_recv_mgmt(struct ieee80211_node *, 171349156a9SAndriy Voskoboinyk struct mbuf *, int, 172349156a9SAndriy Voskoboinyk const struct ieee80211_rx_stats *, int, int); 173349156a9SAndriy Voskoboinyk static int rum_set_power_state(struct rum_softc *, int); 17402ac6454SAndrew Thompson static int rum_newstate(struct ieee80211vap *, 17502ac6454SAndrew Thompson enum ieee80211_state, int); 1762cb9ef8dSAdrian Chadd static uint8_t rum_crypto_mode(struct rum_softc *, u_int, int); 17702ac6454SAndrew Thompson static void rum_setup_tx_desc(struct rum_softc *, 1782cb9ef8dSAdrian Chadd struct rum_tx_desc *, struct ieee80211_key *, 1791354b52cSAdrian Chadd uint32_t, uint8_t, uint8_t, int, int, int); 1802cb9ef8dSAdrian Chadd static uint32_t rum_tx_crypto_flags(struct rum_softc *, 1812cb9ef8dSAdrian Chadd struct ieee80211_node *, 1822cb9ef8dSAdrian Chadd const struct ieee80211_key *); 18302ac6454SAndrew Thompson static int rum_tx_mgt(struct rum_softc *, struct mbuf *, 18402ac6454SAndrew Thompson struct ieee80211_node *); 18502ac6454SAndrew Thompson static int rum_tx_raw(struct rum_softc *, struct mbuf *, 18602ac6454SAndrew Thompson struct ieee80211_node *, 18702ac6454SAndrew Thompson const struct ieee80211_bpf_params *); 18802ac6454SAndrew Thompson static int rum_tx_data(struct rum_softc *, struct mbuf *, 18902ac6454SAndrew Thompson struct ieee80211_node *); 1907a79cebfSGleb Smirnoff static int rum_transmit(struct ieee80211com *, struct mbuf *); 1917a79cebfSGleb Smirnoff static void rum_start(struct rum_softc *); 1927a79cebfSGleb Smirnoff static void rum_parent(struct ieee80211com *); 19302ac6454SAndrew Thompson static void rum_eeprom_read(struct rum_softc *, uint16_t, void *, 19402ac6454SAndrew Thompson int); 19502ac6454SAndrew Thompson static uint32_t rum_read(struct rum_softc *, uint16_t); 19602ac6454SAndrew Thompson static void rum_read_multi(struct rum_softc *, uint16_t, void *, 19702ac6454SAndrew Thompson int); 198e0a69b51SAndrew Thompson static usb_error_t rum_write(struct rum_softc *, uint16_t, uint32_t); 199e0a69b51SAndrew Thompson static usb_error_t rum_write_multi(struct rum_softc *, uint16_t, void *, 20002ac6454SAndrew Thompson size_t); 201a05022b2SAdrian Chadd static usb_error_t rum_setbits(struct rum_softc *, uint16_t, uint32_t); 202a05022b2SAdrian Chadd static usb_error_t rum_clrbits(struct rum_softc *, uint16_t, uint32_t); 203a05022b2SAdrian Chadd static usb_error_t rum_modbits(struct rum_softc *, uint16_t, uint32_t, 204a05022b2SAdrian Chadd uint32_t); 205cc9ae761SAdrian Chadd static int rum_bbp_busy(struct rum_softc *); 20602ac6454SAndrew Thompson static void rum_bbp_write(struct rum_softc *, uint8_t, uint8_t); 20702ac6454SAndrew Thompson static uint8_t rum_bbp_read(struct rum_softc *, uint8_t); 20802ac6454SAndrew Thompson static void rum_rf_write(struct rum_softc *, uint8_t, uint32_t); 20902ac6454SAndrew Thompson static void rum_select_antenna(struct rum_softc *); 21002ac6454SAndrew Thompson static void rum_enable_mrr(struct rum_softc *); 21102ac6454SAndrew Thompson static void rum_set_txpreamble(struct rum_softc *); 21202ac6454SAndrew Thompson static void rum_set_basicrates(struct rum_softc *); 21302ac6454SAndrew Thompson static void rum_select_band(struct rum_softc *, 21402ac6454SAndrew Thompson struct ieee80211_channel *); 21502ac6454SAndrew Thompson static void rum_set_chan(struct rum_softc *, 21602ac6454SAndrew Thompson struct ieee80211_channel *); 217342ced03SAdrian Chadd static void rum_set_maxretry(struct rum_softc *, 218342ced03SAdrian Chadd struct ieee80211vap *); 219aa81f853SAdrian Chadd static int rum_enable_tsf_sync(struct rum_softc *); 2205463c4a4SSam Leffler static void rum_enable_tsf(struct rum_softc *); 2216d804321SAdrian Chadd static void rum_abort_tsf_sync(struct rum_softc *); 222a6ccd477SAdrian Chadd static void rum_get_tsf(struct rum_softc *, uint64_t *); 223a19dbd8dSAdrian Chadd static void rum_update_slot_cb(struct rum_softc *, 224ed5711a1SAdrian Chadd union sec_param *, uint8_t); 225a19dbd8dSAdrian Chadd static void rum_update_slot(struct ieee80211com *); 2261354b52cSAdrian Chadd static int rum_wme_update(struct ieee80211com *); 22702ac6454SAndrew Thompson static void rum_set_bssid(struct rum_softc *, const uint8_t *); 22802ac6454SAndrew Thompson static void rum_set_macaddr(struct rum_softc *, const uint8_t *); 229272f6adeSGleb Smirnoff static void rum_update_mcast(struct ieee80211com *); 230272f6adeSGleb Smirnoff static void rum_update_promisc(struct ieee80211com *); 2315efea30fSAndrew Thompson static void rum_setpromisc(struct rum_softc *); 23202ac6454SAndrew Thompson static const char *rum_get_rf(int); 23302ac6454SAndrew Thompson static void rum_read_eeprom(struct rum_softc *); 2346095f7caSAdrian Chadd static int rum_bbp_wakeup(struct rum_softc *); 23502ac6454SAndrew Thompson static int rum_bbp_init(struct rum_softc *); 2362cb9ef8dSAdrian Chadd static void rum_clr_shkey_regs(struct rum_softc *); 2370698c0b3SAdrian Chadd static int rum_init(struct rum_softc *); 2385efea30fSAndrew Thompson static void rum_stop(struct rum_softc *); 23977ddf3d3SAndrew Thompson static void rum_load_microcode(struct rum_softc *, const uint8_t *, 24002ac6454SAndrew Thompson size_t); 241349156a9SAndriy Voskoboinyk static int rum_set_sleep_time(struct rum_softc *, uint16_t); 242349156a9SAndriy Voskoboinyk static int rum_reset(struct ieee80211vap *, u_long); 243b780f864SAdrian Chadd static int rum_set_beacon(struct rum_softc *, 244b780f864SAdrian Chadd struct ieee80211vap *); 245b780f864SAdrian Chadd static int rum_alloc_beacon(struct rum_softc *, 24602ac6454SAndrew Thompson struct ieee80211vap *); 2470e3b4c60SAdrian Chadd static void rum_update_beacon_cb(struct rum_softc *, 248ed5711a1SAdrian Chadd union sec_param *, uint8_t); 2490e3b4c60SAdrian Chadd static void rum_update_beacon(struct ieee80211vap *, int); 2502cb9ef8dSAdrian Chadd static int rum_common_key_set(struct rum_softc *, 2512cb9ef8dSAdrian Chadd struct ieee80211_key *, uint16_t); 2522cb9ef8dSAdrian Chadd static void rum_group_key_set_cb(struct rum_softc *, 253ed5711a1SAdrian Chadd union sec_param *, uint8_t); 2542cb9ef8dSAdrian Chadd static void rum_group_key_del_cb(struct rum_softc *, 255ed5711a1SAdrian Chadd union sec_param *, uint8_t); 2562cb9ef8dSAdrian Chadd static void rum_pair_key_set_cb(struct rum_softc *, 257ed5711a1SAdrian Chadd union sec_param *, uint8_t); 2582cb9ef8dSAdrian Chadd static void rum_pair_key_del_cb(struct rum_softc *, 259ed5711a1SAdrian Chadd union sec_param *, uint8_t); 2602cb9ef8dSAdrian Chadd static int rum_key_alloc(struct ieee80211vap *, 2612cb9ef8dSAdrian Chadd struct ieee80211_key *, ieee80211_keyix *, 2622cb9ef8dSAdrian Chadd ieee80211_keyix *); 2632cb9ef8dSAdrian Chadd static int rum_key_set(struct ieee80211vap *, 264bc813c40SAdrian Chadd const struct ieee80211_key *); 2652cb9ef8dSAdrian Chadd static int rum_key_delete(struct ieee80211vap *, 2662cb9ef8dSAdrian Chadd const struct ieee80211_key *); 26702ac6454SAndrew Thompson static int rum_raw_xmit(struct ieee80211_node *, struct mbuf *, 26802ac6454SAndrew Thompson const struct ieee80211_bpf_params *); 26902ac6454SAndrew Thompson static void rum_scan_start(struct ieee80211com *); 27002ac6454SAndrew Thompson static void rum_scan_end(struct ieee80211com *); 27102ac6454SAndrew Thompson static void rum_set_channel(struct ieee80211com *); 27202ac6454SAndrew Thompson static int rum_get_rssi(struct rum_softc *, uint8_t); 273b6108616SRui Paulo static void rum_ratectl_start(struct rum_softc *, 27402ac6454SAndrew Thompson struct ieee80211_node *); 275b6108616SRui Paulo static void rum_ratectl_timeout(void *); 276b6108616SRui Paulo static void rum_ratectl_task(void *, int); 27702ac6454SAndrew Thompson static int rum_pause(struct rum_softc *, int); 27802ac6454SAndrew Thompson 27902ac6454SAndrew Thompson static const struct { 28002ac6454SAndrew Thompson uint32_t reg; 28102ac6454SAndrew Thompson uint32_t val; 28202ac6454SAndrew Thompson } rum_def_mac[] = { 28302ac6454SAndrew Thompson { RT2573_TXRX_CSR0, 0x025fb032 }, 28402ac6454SAndrew Thompson { RT2573_TXRX_CSR1, 0x9eaa9eaf }, 28502ac6454SAndrew Thompson { RT2573_TXRX_CSR2, 0x8a8b8c8d }, 28602ac6454SAndrew Thompson { RT2573_TXRX_CSR3, 0x00858687 }, 28702ac6454SAndrew Thompson { RT2573_TXRX_CSR7, 0x2e31353b }, 28802ac6454SAndrew Thompson { RT2573_TXRX_CSR8, 0x2a2a2a2c }, 28902ac6454SAndrew Thompson { RT2573_TXRX_CSR15, 0x0000000f }, 29002ac6454SAndrew Thompson { RT2573_MAC_CSR6, 0x00000fff }, 29102ac6454SAndrew Thompson { RT2573_MAC_CSR8, 0x016c030a }, 29202ac6454SAndrew Thompson { RT2573_MAC_CSR10, 0x00000718 }, 29302ac6454SAndrew Thompson { RT2573_MAC_CSR12, 0x00000004 }, 29402ac6454SAndrew Thompson { RT2573_MAC_CSR13, 0x00007f00 }, 2952cb9ef8dSAdrian Chadd { RT2573_SEC_CSR2, 0x00000000 }, 2962cb9ef8dSAdrian Chadd { RT2573_SEC_CSR3, 0x00000000 }, 2972cb9ef8dSAdrian Chadd { RT2573_SEC_CSR4, 0x00000000 }, 29802ac6454SAndrew Thompson { RT2573_PHY_CSR1, 0x000023b0 }, 29902ac6454SAndrew Thompson { RT2573_PHY_CSR5, 0x00040a06 }, 30002ac6454SAndrew Thompson { RT2573_PHY_CSR6, 0x00080606 }, 30102ac6454SAndrew Thompson { RT2573_PHY_CSR7, 0x00000408 }, 30202ac6454SAndrew Thompson { RT2573_AIFSN_CSR, 0x00002273 }, 30302ac6454SAndrew Thompson { RT2573_CWMIN_CSR, 0x00002344 }, 30402ac6454SAndrew Thompson { RT2573_CWMAX_CSR, 0x000034aa } 30502ac6454SAndrew Thompson }; 30602ac6454SAndrew Thompson 30702ac6454SAndrew Thompson static const struct { 30802ac6454SAndrew Thompson uint8_t reg; 30902ac6454SAndrew Thompson uint8_t val; 31002ac6454SAndrew Thompson } rum_def_bbp[] = { 31102ac6454SAndrew Thompson { 3, 0x80 }, 31202ac6454SAndrew Thompson { 15, 0x30 }, 31302ac6454SAndrew Thompson { 17, 0x20 }, 31402ac6454SAndrew Thompson { 21, 0xc8 }, 31502ac6454SAndrew Thompson { 22, 0x38 }, 31602ac6454SAndrew Thompson { 23, 0x06 }, 31702ac6454SAndrew Thompson { 24, 0xfe }, 31802ac6454SAndrew Thompson { 25, 0x0a }, 31902ac6454SAndrew Thompson { 26, 0x0d }, 32002ac6454SAndrew Thompson { 32, 0x0b }, 32102ac6454SAndrew Thompson { 34, 0x12 }, 32202ac6454SAndrew Thompson { 37, 0x07 }, 32302ac6454SAndrew Thompson { 39, 0xf8 }, 32402ac6454SAndrew Thompson { 41, 0x60 }, 32502ac6454SAndrew Thompson { 53, 0x10 }, 32602ac6454SAndrew Thompson { 54, 0x18 }, 32702ac6454SAndrew Thompson { 60, 0x10 }, 32802ac6454SAndrew Thompson { 61, 0x04 }, 32902ac6454SAndrew Thompson { 62, 0x04 }, 33002ac6454SAndrew Thompson { 75, 0xfe }, 33102ac6454SAndrew Thompson { 86, 0xfe }, 33202ac6454SAndrew Thompson { 88, 0xfe }, 33302ac6454SAndrew Thompson { 90, 0x0f }, 33402ac6454SAndrew Thompson { 99, 0x00 }, 33502ac6454SAndrew Thompson { 102, 0x16 }, 33602ac6454SAndrew Thompson { 107, 0x04 } 33702ac6454SAndrew Thompson }; 33802ac6454SAndrew Thompson 33902ac6454SAndrew Thompson static const struct rfprog { 34002ac6454SAndrew Thompson uint8_t chan; 34102ac6454SAndrew Thompson uint32_t r1, r2, r3, r4; 34202ac6454SAndrew Thompson } rum_rf5226[] = { 34302ac6454SAndrew Thompson { 1, 0x00b03, 0x001e1, 0x1a014, 0x30282 }, 34402ac6454SAndrew Thompson { 2, 0x00b03, 0x001e1, 0x1a014, 0x30287 }, 34502ac6454SAndrew Thompson { 3, 0x00b03, 0x001e2, 0x1a014, 0x30282 }, 34602ac6454SAndrew Thompson { 4, 0x00b03, 0x001e2, 0x1a014, 0x30287 }, 34702ac6454SAndrew Thompson { 5, 0x00b03, 0x001e3, 0x1a014, 0x30282 }, 34802ac6454SAndrew Thompson { 6, 0x00b03, 0x001e3, 0x1a014, 0x30287 }, 34902ac6454SAndrew Thompson { 7, 0x00b03, 0x001e4, 0x1a014, 0x30282 }, 35002ac6454SAndrew Thompson { 8, 0x00b03, 0x001e4, 0x1a014, 0x30287 }, 35102ac6454SAndrew Thompson { 9, 0x00b03, 0x001e5, 0x1a014, 0x30282 }, 35202ac6454SAndrew Thompson { 10, 0x00b03, 0x001e5, 0x1a014, 0x30287 }, 35302ac6454SAndrew Thompson { 11, 0x00b03, 0x001e6, 0x1a014, 0x30282 }, 35402ac6454SAndrew Thompson { 12, 0x00b03, 0x001e6, 0x1a014, 0x30287 }, 35502ac6454SAndrew Thompson { 13, 0x00b03, 0x001e7, 0x1a014, 0x30282 }, 35602ac6454SAndrew Thompson { 14, 0x00b03, 0x001e8, 0x1a014, 0x30284 }, 35702ac6454SAndrew Thompson 35802ac6454SAndrew Thompson { 34, 0x00b03, 0x20266, 0x36014, 0x30282 }, 35902ac6454SAndrew Thompson { 38, 0x00b03, 0x20267, 0x36014, 0x30284 }, 36002ac6454SAndrew Thompson { 42, 0x00b03, 0x20268, 0x36014, 0x30286 }, 36102ac6454SAndrew Thompson { 46, 0x00b03, 0x20269, 0x36014, 0x30288 }, 36202ac6454SAndrew Thompson 36302ac6454SAndrew Thompson { 36, 0x00b03, 0x00266, 0x26014, 0x30288 }, 36402ac6454SAndrew Thompson { 40, 0x00b03, 0x00268, 0x26014, 0x30280 }, 36502ac6454SAndrew Thompson { 44, 0x00b03, 0x00269, 0x26014, 0x30282 }, 36602ac6454SAndrew Thompson { 48, 0x00b03, 0x0026a, 0x26014, 0x30284 }, 36702ac6454SAndrew Thompson { 52, 0x00b03, 0x0026b, 0x26014, 0x30286 }, 36802ac6454SAndrew Thompson { 56, 0x00b03, 0x0026c, 0x26014, 0x30288 }, 36902ac6454SAndrew Thompson { 60, 0x00b03, 0x0026e, 0x26014, 0x30280 }, 37002ac6454SAndrew Thompson { 64, 0x00b03, 0x0026f, 0x26014, 0x30282 }, 37102ac6454SAndrew Thompson 37202ac6454SAndrew Thompson { 100, 0x00b03, 0x0028a, 0x2e014, 0x30280 }, 37302ac6454SAndrew Thompson { 104, 0x00b03, 0x0028b, 0x2e014, 0x30282 }, 37402ac6454SAndrew Thompson { 108, 0x00b03, 0x0028c, 0x2e014, 0x30284 }, 37502ac6454SAndrew Thompson { 112, 0x00b03, 0x0028d, 0x2e014, 0x30286 }, 37602ac6454SAndrew Thompson { 116, 0x00b03, 0x0028e, 0x2e014, 0x30288 }, 37702ac6454SAndrew Thompson { 120, 0x00b03, 0x002a0, 0x2e014, 0x30280 }, 37802ac6454SAndrew Thompson { 124, 0x00b03, 0x002a1, 0x2e014, 0x30282 }, 37902ac6454SAndrew Thompson { 128, 0x00b03, 0x002a2, 0x2e014, 0x30284 }, 38002ac6454SAndrew Thompson { 132, 0x00b03, 0x002a3, 0x2e014, 0x30286 }, 38102ac6454SAndrew Thompson { 136, 0x00b03, 0x002a4, 0x2e014, 0x30288 }, 38202ac6454SAndrew Thompson { 140, 0x00b03, 0x002a6, 0x2e014, 0x30280 }, 38302ac6454SAndrew Thompson 38402ac6454SAndrew Thompson { 149, 0x00b03, 0x002a8, 0x2e014, 0x30287 }, 38502ac6454SAndrew Thompson { 153, 0x00b03, 0x002a9, 0x2e014, 0x30289 }, 38602ac6454SAndrew Thompson { 157, 0x00b03, 0x002ab, 0x2e014, 0x30281 }, 38702ac6454SAndrew Thompson { 161, 0x00b03, 0x002ac, 0x2e014, 0x30283 }, 38802ac6454SAndrew Thompson { 165, 0x00b03, 0x002ad, 0x2e014, 0x30285 } 38902ac6454SAndrew Thompson }, rum_rf5225[] = { 39002ac6454SAndrew Thompson { 1, 0x00b33, 0x011e1, 0x1a014, 0x30282 }, 39102ac6454SAndrew Thompson { 2, 0x00b33, 0x011e1, 0x1a014, 0x30287 }, 39202ac6454SAndrew Thompson { 3, 0x00b33, 0x011e2, 0x1a014, 0x30282 }, 39302ac6454SAndrew Thompson { 4, 0x00b33, 0x011e2, 0x1a014, 0x30287 }, 39402ac6454SAndrew Thompson { 5, 0x00b33, 0x011e3, 0x1a014, 0x30282 }, 39502ac6454SAndrew Thompson { 6, 0x00b33, 0x011e3, 0x1a014, 0x30287 }, 39602ac6454SAndrew Thompson { 7, 0x00b33, 0x011e4, 0x1a014, 0x30282 }, 39702ac6454SAndrew Thompson { 8, 0x00b33, 0x011e4, 0x1a014, 0x30287 }, 39802ac6454SAndrew Thompson { 9, 0x00b33, 0x011e5, 0x1a014, 0x30282 }, 39902ac6454SAndrew Thompson { 10, 0x00b33, 0x011e5, 0x1a014, 0x30287 }, 40002ac6454SAndrew Thompson { 11, 0x00b33, 0x011e6, 0x1a014, 0x30282 }, 40102ac6454SAndrew Thompson { 12, 0x00b33, 0x011e6, 0x1a014, 0x30287 }, 40202ac6454SAndrew Thompson { 13, 0x00b33, 0x011e7, 0x1a014, 0x30282 }, 40302ac6454SAndrew Thompson { 14, 0x00b33, 0x011e8, 0x1a014, 0x30284 }, 40402ac6454SAndrew Thompson 40502ac6454SAndrew Thompson { 34, 0x00b33, 0x01266, 0x26014, 0x30282 }, 40602ac6454SAndrew Thompson { 38, 0x00b33, 0x01267, 0x26014, 0x30284 }, 40702ac6454SAndrew Thompson { 42, 0x00b33, 0x01268, 0x26014, 0x30286 }, 40802ac6454SAndrew Thompson { 46, 0x00b33, 0x01269, 0x26014, 0x30288 }, 40902ac6454SAndrew Thompson 41002ac6454SAndrew Thompson { 36, 0x00b33, 0x01266, 0x26014, 0x30288 }, 41102ac6454SAndrew Thompson { 40, 0x00b33, 0x01268, 0x26014, 0x30280 }, 41202ac6454SAndrew Thompson { 44, 0x00b33, 0x01269, 0x26014, 0x30282 }, 41302ac6454SAndrew Thompson { 48, 0x00b33, 0x0126a, 0x26014, 0x30284 }, 41402ac6454SAndrew Thompson { 52, 0x00b33, 0x0126b, 0x26014, 0x30286 }, 41502ac6454SAndrew Thompson { 56, 0x00b33, 0x0126c, 0x26014, 0x30288 }, 41602ac6454SAndrew Thompson { 60, 0x00b33, 0x0126e, 0x26014, 0x30280 }, 41702ac6454SAndrew Thompson { 64, 0x00b33, 0x0126f, 0x26014, 0x30282 }, 41802ac6454SAndrew Thompson 41902ac6454SAndrew Thompson { 100, 0x00b33, 0x0128a, 0x2e014, 0x30280 }, 42002ac6454SAndrew Thompson { 104, 0x00b33, 0x0128b, 0x2e014, 0x30282 }, 42102ac6454SAndrew Thompson { 108, 0x00b33, 0x0128c, 0x2e014, 0x30284 }, 42202ac6454SAndrew Thompson { 112, 0x00b33, 0x0128d, 0x2e014, 0x30286 }, 42302ac6454SAndrew Thompson { 116, 0x00b33, 0x0128e, 0x2e014, 0x30288 }, 42402ac6454SAndrew Thompson { 120, 0x00b33, 0x012a0, 0x2e014, 0x30280 }, 42502ac6454SAndrew Thompson { 124, 0x00b33, 0x012a1, 0x2e014, 0x30282 }, 42602ac6454SAndrew Thompson { 128, 0x00b33, 0x012a2, 0x2e014, 0x30284 }, 42702ac6454SAndrew Thompson { 132, 0x00b33, 0x012a3, 0x2e014, 0x30286 }, 42802ac6454SAndrew Thompson { 136, 0x00b33, 0x012a4, 0x2e014, 0x30288 }, 42902ac6454SAndrew Thompson { 140, 0x00b33, 0x012a6, 0x2e014, 0x30280 }, 43002ac6454SAndrew Thompson 43102ac6454SAndrew Thompson { 149, 0x00b33, 0x012a8, 0x2e014, 0x30287 }, 43202ac6454SAndrew Thompson { 153, 0x00b33, 0x012a9, 0x2e014, 0x30289 }, 43302ac6454SAndrew Thompson { 157, 0x00b33, 0x012ab, 0x2e014, 0x30281 }, 43402ac6454SAndrew Thompson { 161, 0x00b33, 0x012ac, 0x2e014, 0x30283 }, 43502ac6454SAndrew Thompson { 165, 0x00b33, 0x012ad, 0x2e014, 0x30285 } 43602ac6454SAndrew Thompson }; 43702ac6454SAndrew Thompson 438760bc48eSAndrew Thompson static const struct usb_config rum_config[RUM_N_TRANSFER] = { 43902ac6454SAndrew Thompson [RUM_BULK_WR] = { 44002ac6454SAndrew Thompson .type = UE_BULK, 44102ac6454SAndrew Thompson .endpoint = UE_ADDR_ANY, 44202ac6454SAndrew Thompson .direction = UE_DIR_OUT, 4434eae601eSAndrew Thompson .bufsize = (MCLBYTES + RT2573_TX_DESC_SIZE + 8), 4444eae601eSAndrew Thompson .flags = {.pipe_bof = 1,.force_short_xfer = 1,}, 4454eae601eSAndrew Thompson .callback = rum_bulk_write_callback, 4464eae601eSAndrew Thompson .timeout = 5000, /* ms */ 44702ac6454SAndrew Thompson }, 44802ac6454SAndrew Thompson [RUM_BULK_RD] = { 44902ac6454SAndrew Thompson .type = UE_BULK, 45002ac6454SAndrew Thompson .endpoint = UE_ADDR_ANY, 45102ac6454SAndrew Thompson .direction = UE_DIR_IN, 4524eae601eSAndrew Thompson .bufsize = (MCLBYTES + RT2573_RX_DESC_SIZE), 4534eae601eSAndrew Thompson .flags = {.pipe_bof = 1,.short_xfer_ok = 1,}, 4544eae601eSAndrew Thompson .callback = rum_bulk_read_callback, 45502ac6454SAndrew Thompson }, 45602ac6454SAndrew Thompson }; 45702ac6454SAndrew Thompson 45802ac6454SAndrew Thompson static int 45902ac6454SAndrew Thompson rum_match(device_t self) 46002ac6454SAndrew Thompson { 461760bc48eSAndrew Thompson struct usb_attach_arg *uaa = device_get_ivars(self); 46202ac6454SAndrew Thompson 463f29a0724SAndrew Thompson if (uaa->usb_mode != USB_MODE_HOST) 46402ac6454SAndrew Thompson return (ENXIO); 46502ac6454SAndrew Thompson if (uaa->info.bConfigIndex != 0) 46602ac6454SAndrew Thompson return (ENXIO); 46702ac6454SAndrew Thompson if (uaa->info.bIfaceIndex != RT2573_IFACE_INDEX) 46802ac6454SAndrew Thompson return (ENXIO); 46902ac6454SAndrew Thompson 470a593f6b8SAndrew Thompson return (usbd_lookup_id_by_uaa(rum_devs, sizeof(rum_devs), uaa)); 47102ac6454SAndrew Thompson } 47202ac6454SAndrew Thompson 47302ac6454SAndrew Thompson static int 47402ac6454SAndrew Thompson rum_attach(device_t self) 47502ac6454SAndrew Thompson { 476760bc48eSAndrew Thompson struct usb_attach_arg *uaa = device_get_ivars(self); 47702ac6454SAndrew Thompson struct rum_softc *sc = device_get_softc(self); 4787a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 4795efea30fSAndrew Thompson uint32_t tmp; 4800046e186SAndriy Voskoboinyk uint8_t bands[howmany(IEEE80211_MODE_MAX, 8)]; 4810046e186SAndriy Voskoboinyk uint8_t iface_index; 4825efea30fSAndrew Thompson int error, ntries; 48302ac6454SAndrew Thompson 484a593f6b8SAndrew Thompson device_set_usb_desc(self); 48502ac6454SAndrew Thompson sc->sc_udev = uaa->device; 48602ac6454SAndrew Thompson sc->sc_dev = self; 48702ac6454SAndrew Thompson 488f28c2f5eSAdrian Chadd RUM_LOCK_INIT(sc); 489f28c2f5eSAdrian Chadd RUM_CMDQ_LOCK_INIT(sc); 4907a79cebfSGleb Smirnoff mbufq_init(&sc->sc_snd, ifqmaxlen); 49102ac6454SAndrew Thompson 49202ac6454SAndrew Thompson iface_index = RT2573_IFACE_INDEX; 493a593f6b8SAndrew Thompson error = usbd_transfer_setup(uaa->device, &iface_index, 49402ac6454SAndrew Thompson sc->sc_xfer, rum_config, RUM_N_TRANSFER, sc, &sc->sc_mtx); 49502ac6454SAndrew Thompson if (error) { 49602ac6454SAndrew Thompson device_printf(self, "could not allocate USB transfers, " 497a593f6b8SAndrew Thompson "err=%s\n", usbd_errstr(error)); 49802ac6454SAndrew Thompson goto detach; 49902ac6454SAndrew Thompson } 50002ac6454SAndrew Thompson 50102ac6454SAndrew Thompson RUM_LOCK(sc); 50202ac6454SAndrew Thompson /* retrieve RT2573 rev. no */ 50302ac6454SAndrew Thompson for (ntries = 0; ntries < 100; ntries++) { 50402ac6454SAndrew Thompson if ((tmp = rum_read(sc, RT2573_MAC_CSR0)) != 0) 50502ac6454SAndrew Thompson break; 50602ac6454SAndrew Thompson if (rum_pause(sc, hz / 100)) 50702ac6454SAndrew Thompson break; 50802ac6454SAndrew Thompson } 50902ac6454SAndrew Thompson if (ntries == 100) { 51002ac6454SAndrew Thompson device_printf(sc->sc_dev, "timeout waiting for chip to settle\n"); 5115efea30fSAndrew Thompson RUM_UNLOCK(sc); 5125efea30fSAndrew Thompson goto detach; 51302ac6454SAndrew Thompson } 51402ac6454SAndrew Thompson 51502ac6454SAndrew Thompson /* retrieve MAC address and various other things from EEPROM */ 51602ac6454SAndrew Thompson rum_read_eeprom(sc); 51702ac6454SAndrew Thompson 51802ac6454SAndrew Thompson device_printf(sc->sc_dev, "MAC/BBP RT2573 (rev 0x%05x), RF %s\n", 51902ac6454SAndrew Thompson tmp, rum_get_rf(sc->rf_rev)); 52002ac6454SAndrew Thompson 52177ddf3d3SAndrew Thompson rum_load_microcode(sc, rt2573_ucode, sizeof(rt2573_ucode)); 52202ac6454SAndrew Thompson RUM_UNLOCK(sc); 52302ac6454SAndrew Thompson 52459686fe9SGleb Smirnoff ic->ic_softc = sc; 525c8550c02SGleb Smirnoff ic->ic_name = device_get_nameunit(self); 52602ac6454SAndrew Thompson ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ 52702ac6454SAndrew Thompson 52802ac6454SAndrew Thompson /* set device capabilities */ 52902ac6454SAndrew Thompson ic->ic_caps = 53002ac6454SAndrew Thompson IEEE80211_C_STA /* station mode supported */ 53102ac6454SAndrew Thompson | IEEE80211_C_IBSS /* IBSS mode supported */ 53202ac6454SAndrew Thompson | IEEE80211_C_MONITOR /* monitor mode supported */ 53302ac6454SAndrew Thompson | IEEE80211_C_HOSTAP /* HostAp mode supported */ 53450a31b48SAdrian Chadd | IEEE80211_C_AHDEMO /* adhoc demo mode */ 53502ac6454SAndrew Thompson | IEEE80211_C_TXPMGT /* tx power management */ 53602ac6454SAndrew Thompson | IEEE80211_C_SHPREAMBLE /* short preamble supported */ 53702ac6454SAndrew Thompson | IEEE80211_C_SHSLOT /* short slot time supported */ 53802ac6454SAndrew Thompson | IEEE80211_C_BGSCAN /* bg scanning supported */ 53902ac6454SAndrew Thompson | IEEE80211_C_WPA /* 802.11i */ 5401354b52cSAdrian Chadd | IEEE80211_C_WME /* 802.11e */ 541349156a9SAndriy Voskoboinyk | IEEE80211_C_PMGT /* Station-side power mgmt */ 542349156a9SAndriy Voskoboinyk | IEEE80211_C_SWSLEEP /* net80211 managed power mgmt */ 54302ac6454SAndrew Thompson ; 54402ac6454SAndrew Thompson 5452cb9ef8dSAdrian Chadd ic->ic_cryptocaps = 5462cb9ef8dSAdrian Chadd IEEE80211_CRYPTO_WEP | 5472cb9ef8dSAdrian Chadd IEEE80211_CRYPTO_AES_CCM | 5482cb9ef8dSAdrian Chadd IEEE80211_CRYPTO_TKIPMIC | 5492cb9ef8dSAdrian Chadd IEEE80211_CRYPTO_TKIP; 5502cb9ef8dSAdrian Chadd 5510046e186SAndriy Voskoboinyk memset(bands, 0, sizeof(bands)); 5520046e186SAndriy Voskoboinyk setbit(bands, IEEE80211_MODE_11B); 5530046e186SAndriy Voskoboinyk setbit(bands, IEEE80211_MODE_11G); 55402ac6454SAndrew Thompson if (sc->rf_rev == RT2573_RF_5225 || sc->rf_rev == RT2573_RF_5226) 5550046e186SAndriy Voskoboinyk setbit(bands, IEEE80211_MODE_11A); 5560046e186SAndriy Voskoboinyk ieee80211_init_channels(ic, NULL, bands); 55702ac6454SAndrew Thompson 5587a79cebfSGleb Smirnoff ieee80211_ifattach(ic); 55977ddf3d3SAndrew Thompson ic->ic_update_promisc = rum_update_promisc; 56002ac6454SAndrew Thompson ic->ic_raw_xmit = rum_raw_xmit; 56102ac6454SAndrew Thompson ic->ic_scan_start = rum_scan_start; 56202ac6454SAndrew Thompson ic->ic_scan_end = rum_scan_end; 56302ac6454SAndrew Thompson ic->ic_set_channel = rum_set_channel; 5647a79cebfSGleb Smirnoff ic->ic_transmit = rum_transmit; 5657a79cebfSGleb Smirnoff ic->ic_parent = rum_parent; 56602ac6454SAndrew Thompson ic->ic_vap_create = rum_vap_create; 56702ac6454SAndrew Thompson ic->ic_vap_delete = rum_vap_delete; 568a19dbd8dSAdrian Chadd ic->ic_updateslot = rum_update_slot; 5691354b52cSAdrian Chadd ic->ic_wme.wme_update = rum_wme_update; 5706dd8e071SEd Maste ic->ic_update_mcast = rum_update_mcast; 57102ac6454SAndrew Thompson 5725463c4a4SSam Leffler ieee80211_radiotap_attach(ic, 5735463c4a4SSam Leffler &sc->sc_txtap.wt_ihdr, sizeof(sc->sc_txtap), 5745463c4a4SSam Leffler RT2573_TX_RADIOTAP_PRESENT, 5755463c4a4SSam Leffler &sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap), 5765463c4a4SSam Leffler RT2573_RX_RADIOTAP_PRESENT); 57702ac6454SAndrew Thompson 578f28c2f5eSAdrian Chadd TASK_INIT(&sc->cmdq_task, 0, rum_cmdq_cb, sc); 579f28c2f5eSAdrian Chadd 58002ac6454SAndrew Thompson if (bootverbose) 58102ac6454SAndrew Thompson ieee80211_announce(ic); 58202ac6454SAndrew Thompson 5835efea30fSAndrew Thompson return (0); 5845efea30fSAndrew Thompson 5855efea30fSAndrew Thompson detach: 5865efea30fSAndrew Thompson rum_detach(self); 5875efea30fSAndrew Thompson return (ENXIO); /* failure */ 58802ac6454SAndrew Thompson } 58902ac6454SAndrew Thompson 59002ac6454SAndrew Thompson static int 59102ac6454SAndrew Thompson rum_detach(device_t self) 59202ac6454SAndrew Thompson { 59302ac6454SAndrew Thompson struct rum_softc *sc = device_get_softc(self); 594e7b7db3dSAdrian Chadd struct ieee80211com *ic = &sc->sc_ic; 59502ac6454SAndrew Thompson 596645e4d17SHans Petter Selasky /* Prevent further ioctls */ 597645e4d17SHans Petter Selasky RUM_LOCK(sc); 598645e4d17SHans Petter Selasky sc->sc_detached = 1; 599645e4d17SHans Petter Selasky RUM_UNLOCK(sc); 600645e4d17SHans Petter Selasky 60102ac6454SAndrew Thompson /* stop all USB transfers */ 602a593f6b8SAndrew Thompson usbd_transfer_unsetup(sc->sc_xfer, RUM_N_TRANSFER); 60302ac6454SAndrew Thompson 60402ac6454SAndrew Thompson /* free TX list, if any */ 60502ac6454SAndrew Thompson RUM_LOCK(sc); 60602ac6454SAndrew Thompson rum_unsetup_tx_list(sc); 60702ac6454SAndrew Thompson RUM_UNLOCK(sc); 60802ac6454SAndrew Thompson 609f28c2f5eSAdrian Chadd if (ic->ic_softc == sc) { 610f28c2f5eSAdrian Chadd ieee80211_draintask(ic, &sc->cmdq_task); 611e7b7db3dSAdrian Chadd ieee80211_ifdetach(ic); 612f28c2f5eSAdrian Chadd } 613f28c2f5eSAdrian Chadd 6147a79cebfSGleb Smirnoff mbufq_drain(&sc->sc_snd); 615f28c2f5eSAdrian Chadd RUM_CMDQ_LOCK_DESTROY(sc); 616f28c2f5eSAdrian Chadd RUM_LOCK_DESTROY(sc); 617f28c2f5eSAdrian Chadd 61802ac6454SAndrew Thompson return (0); 61902ac6454SAndrew Thompson } 62002ac6454SAndrew Thompson 621e0a69b51SAndrew Thompson static usb_error_t 62277ddf3d3SAndrew Thompson rum_do_request(struct rum_softc *sc, 623760bc48eSAndrew Thompson struct usb_device_request *req, void *data) 62477ddf3d3SAndrew Thompson { 625e0a69b51SAndrew Thompson usb_error_t err; 62677ddf3d3SAndrew Thompson int ntries = 10; 62777ddf3d3SAndrew Thompson 62877ddf3d3SAndrew Thompson while (ntries--) { 629a593f6b8SAndrew Thompson err = usbd_do_request_flags(sc->sc_udev, &sc->sc_mtx, 63077ddf3d3SAndrew Thompson req, data, 0, NULL, 250 /* ms */); 63177ddf3d3SAndrew Thompson if (err == 0) 63277ddf3d3SAndrew Thompson break; 63377ddf3d3SAndrew Thompson 63477ddf3d3SAndrew Thompson DPRINTFN(1, "Control request failed, %s (retrying)\n", 635a593f6b8SAndrew Thompson usbd_errstr(err)); 63677ddf3d3SAndrew Thompson if (rum_pause(sc, hz / 100)) 63777ddf3d3SAndrew Thompson break; 63877ddf3d3SAndrew Thompson } 63977ddf3d3SAndrew Thompson return (err); 64077ddf3d3SAndrew Thompson } 64177ddf3d3SAndrew Thompson 642fd7dae9cSAndriy Voskoboinyk static usb_error_t 643fd7dae9cSAndriy Voskoboinyk rum_do_mcu_request(struct rum_softc *sc, int request) 644fd7dae9cSAndriy Voskoboinyk { 645fd7dae9cSAndriy Voskoboinyk struct usb_device_request req; 646fd7dae9cSAndriy Voskoboinyk 647fd7dae9cSAndriy Voskoboinyk req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 648fd7dae9cSAndriy Voskoboinyk req.bRequest = RT2573_MCU_CNTL; 649fd7dae9cSAndriy Voskoboinyk USETW(req.wValue, request); 650fd7dae9cSAndriy Voskoboinyk USETW(req.wIndex, 0); 651fd7dae9cSAndriy Voskoboinyk USETW(req.wLength, 0); 652fd7dae9cSAndriy Voskoboinyk 653fd7dae9cSAndriy Voskoboinyk return (rum_do_request(sc, &req, NULL)); 654fd7dae9cSAndriy Voskoboinyk } 655fd7dae9cSAndriy Voskoboinyk 65602ac6454SAndrew Thompson static struct ieee80211vap * 657fcd9500fSBernhard Schmidt rum_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit, 658fcd9500fSBernhard Schmidt enum ieee80211_opmode opmode, int flags, 65902ac6454SAndrew Thompson const uint8_t bssid[IEEE80211_ADDR_LEN], 66002ac6454SAndrew Thompson const uint8_t mac[IEEE80211_ADDR_LEN]) 66102ac6454SAndrew Thompson { 662d3fdd08cSAdrian Chadd struct rum_softc *sc = ic->ic_softc; 66302ac6454SAndrew Thompson struct rum_vap *rvp; 66402ac6454SAndrew Thompson struct ieee80211vap *vap; 66502ac6454SAndrew Thompson 66602ac6454SAndrew Thompson if (!TAILQ_EMPTY(&ic->ic_vaps)) /* only one at a time */ 66702ac6454SAndrew Thompson return NULL; 6687a79cebfSGleb Smirnoff rvp = malloc(sizeof(struct rum_vap), M_80211_VAP, M_WAITOK | M_ZERO); 66902ac6454SAndrew Thompson vap = &rvp->vap; 67002ac6454SAndrew Thompson /* enable s/w bmiss handling for sta mode */ 671bb2f69e8SHans Petter Selasky 672bb2f69e8SHans Petter Selasky if (ieee80211_vap_setup(ic, vap, name, unit, opmode, 6737a79cebfSGleb Smirnoff flags | IEEE80211_CLONE_NOBEACONS, bssid) != 0) { 674bb2f69e8SHans Petter Selasky /* out of memory */ 675bb2f69e8SHans Petter Selasky free(rvp, M_80211_VAP); 676bb2f69e8SHans Petter Selasky return (NULL); 677bb2f69e8SHans Petter Selasky } 67802ac6454SAndrew Thompson 67902ac6454SAndrew Thompson /* override state transition machine */ 68002ac6454SAndrew Thompson rvp->newstate = vap->iv_newstate; 68102ac6454SAndrew Thompson vap->iv_newstate = rum_newstate; 6822cb9ef8dSAdrian Chadd vap->iv_key_alloc = rum_key_alloc; 6832cb9ef8dSAdrian Chadd vap->iv_key_set = rum_key_set; 6842cb9ef8dSAdrian Chadd vap->iv_key_delete = rum_key_delete; 6850e3b4c60SAdrian Chadd vap->iv_update_beacon = rum_update_beacon; 686349156a9SAndriy Voskoboinyk vap->iv_reset = rum_reset; 6872cb9ef8dSAdrian Chadd vap->iv_max_aid = RT2573_ADDR_MAX; 68802ac6454SAndrew Thompson 689349156a9SAndriy Voskoboinyk if (opmode == IEEE80211_M_STA) { 690349156a9SAndriy Voskoboinyk /* 691349156a9SAndriy Voskoboinyk * Move device to the sleep state when 692349156a9SAndriy Voskoboinyk * beacon is received and there is no data for us. 693349156a9SAndriy Voskoboinyk * 694349156a9SAndriy Voskoboinyk * Used only for IEEE80211_S_SLEEP state. 695349156a9SAndriy Voskoboinyk */ 696349156a9SAndriy Voskoboinyk rvp->recv_mgmt = vap->iv_recv_mgmt; 697349156a9SAndriy Voskoboinyk vap->iv_recv_mgmt = rum_sta_recv_mgmt; 698349156a9SAndriy Voskoboinyk 699349156a9SAndriy Voskoboinyk /* Ignored while sleeping. */ 700349156a9SAndriy Voskoboinyk rvp->bmiss = vap->iv_bmiss; 701349156a9SAndriy Voskoboinyk vap->iv_bmiss = rum_beacon_miss; 702349156a9SAndriy Voskoboinyk } 703349156a9SAndriy Voskoboinyk 704b6108616SRui Paulo usb_callout_init_mtx(&rvp->ratectl_ch, &sc->sc_mtx, 0); 705b6108616SRui Paulo TASK_INIT(&rvp->ratectl_task, 0, rum_ratectl_task, rvp); 706b6108616SRui Paulo ieee80211_ratectl_init(vap); 707b6108616SRui Paulo ieee80211_ratectl_setinterval(vap, 1000 /* 1 sec */); 70802ac6454SAndrew Thompson /* complete setup */ 7097a79cebfSGleb Smirnoff ieee80211_vap_attach(vap, ieee80211_media_change, 7107a79cebfSGleb Smirnoff ieee80211_media_status, mac); 71102ac6454SAndrew Thompson ic->ic_opmode = opmode; 71202ac6454SAndrew Thompson return vap; 71302ac6454SAndrew Thompson } 71402ac6454SAndrew Thompson 71502ac6454SAndrew Thompson static void 71602ac6454SAndrew Thompson rum_vap_delete(struct ieee80211vap *vap) 71702ac6454SAndrew Thompson { 71802ac6454SAndrew Thompson struct rum_vap *rvp = RUM_VAP(vap); 7195efea30fSAndrew Thompson struct ieee80211com *ic = vap->iv_ic; 72002ac6454SAndrew Thompson 721b780f864SAdrian Chadd m_freem(rvp->bcn_mbuf); 722b6108616SRui Paulo usb_callout_drain(&rvp->ratectl_ch); 723b6108616SRui Paulo ieee80211_draintask(ic, &rvp->ratectl_task); 724b6108616SRui Paulo ieee80211_ratectl_deinit(vap); 72502ac6454SAndrew Thompson ieee80211_vap_detach(vap); 72602ac6454SAndrew Thompson free(rvp, M_80211_VAP); 72702ac6454SAndrew Thompson } 72802ac6454SAndrew Thompson 72902ac6454SAndrew Thompson static void 730f28c2f5eSAdrian Chadd rum_cmdq_cb(void *arg, int pending) 731f28c2f5eSAdrian Chadd { 732f28c2f5eSAdrian Chadd struct rum_softc *sc = arg; 733f28c2f5eSAdrian Chadd struct rum_cmdq *rc; 734f28c2f5eSAdrian Chadd 735f28c2f5eSAdrian Chadd RUM_CMDQ_LOCK(sc); 736f28c2f5eSAdrian Chadd while (sc->cmdq[sc->cmdq_first].func != NULL) { 737f28c2f5eSAdrian Chadd rc = &sc->cmdq[sc->cmdq_first]; 738f28c2f5eSAdrian Chadd RUM_CMDQ_UNLOCK(sc); 739f28c2f5eSAdrian Chadd 740f28c2f5eSAdrian Chadd RUM_LOCK(sc); 741ed5711a1SAdrian Chadd rc->func(sc, &rc->data, rc->rvp_id); 742f28c2f5eSAdrian Chadd RUM_UNLOCK(sc); 743f28c2f5eSAdrian Chadd 744f28c2f5eSAdrian Chadd RUM_CMDQ_LOCK(sc); 745f28c2f5eSAdrian Chadd memset(rc, 0, sizeof (*rc)); 746f28c2f5eSAdrian Chadd sc->cmdq_first = (sc->cmdq_first + 1) % RUM_CMDQ_SIZE; 747f28c2f5eSAdrian Chadd } 748f28c2f5eSAdrian Chadd RUM_CMDQ_UNLOCK(sc); 749f28c2f5eSAdrian Chadd } 750f28c2f5eSAdrian Chadd 751f28c2f5eSAdrian Chadd static int 752f28c2f5eSAdrian Chadd rum_cmd_sleepable(struct rum_softc *sc, const void *ptr, size_t len, 753ed5711a1SAdrian Chadd uint8_t rvp_id, CMD_FUNC_PROTO) 754f28c2f5eSAdrian Chadd { 755f28c2f5eSAdrian Chadd struct ieee80211com *ic = &sc->sc_ic; 756f28c2f5eSAdrian Chadd 757f28c2f5eSAdrian Chadd KASSERT(len <= sizeof(union sec_param), ("buffer overflow")); 758f28c2f5eSAdrian Chadd 759f28c2f5eSAdrian Chadd RUM_CMDQ_LOCK(sc); 760f28c2f5eSAdrian Chadd if (sc->cmdq[sc->cmdq_last].func != NULL) { 761f28c2f5eSAdrian Chadd device_printf(sc->sc_dev, "%s: cmdq overflow\n", __func__); 762f28c2f5eSAdrian Chadd RUM_CMDQ_UNLOCK(sc); 763f28c2f5eSAdrian Chadd 764f28c2f5eSAdrian Chadd return EAGAIN; 765f28c2f5eSAdrian Chadd } 766f28c2f5eSAdrian Chadd 767f28c2f5eSAdrian Chadd if (ptr != NULL) 768f28c2f5eSAdrian Chadd memcpy(&sc->cmdq[sc->cmdq_last].data, ptr, len); 769f28c2f5eSAdrian Chadd sc->cmdq[sc->cmdq_last].rvp_id = rvp_id; 770f28c2f5eSAdrian Chadd sc->cmdq[sc->cmdq_last].func = func; 771f28c2f5eSAdrian Chadd sc->cmdq_last = (sc->cmdq_last + 1) % RUM_CMDQ_SIZE; 772f28c2f5eSAdrian Chadd RUM_CMDQ_UNLOCK(sc); 773f28c2f5eSAdrian Chadd 774f28c2f5eSAdrian Chadd ieee80211_runtask(ic, &sc->cmdq_task); 775f28c2f5eSAdrian Chadd 776f28c2f5eSAdrian Chadd return 0; 777f28c2f5eSAdrian Chadd } 778f28c2f5eSAdrian Chadd 779f28c2f5eSAdrian Chadd static void 78002ac6454SAndrew Thompson rum_tx_free(struct rum_tx_data *data, int txerr) 78102ac6454SAndrew Thompson { 78202ac6454SAndrew Thompson struct rum_softc *sc = data->sc; 78302ac6454SAndrew Thompson 78402ac6454SAndrew Thompson if (data->m != NULL) { 7857a79cebfSGleb Smirnoff ieee80211_tx_complete(data->ni, data->m, txerr); 78602ac6454SAndrew Thompson data->m = NULL; 78702ac6454SAndrew Thompson data->ni = NULL; 78802ac6454SAndrew Thompson } 78902ac6454SAndrew Thompson STAILQ_INSERT_TAIL(&sc->tx_free, data, next); 79002ac6454SAndrew Thompson sc->tx_nfree++; 79102ac6454SAndrew Thompson } 79202ac6454SAndrew Thompson 79302ac6454SAndrew Thompson static void 79402ac6454SAndrew Thompson rum_setup_tx_list(struct rum_softc *sc) 79502ac6454SAndrew Thompson { 79602ac6454SAndrew Thompson struct rum_tx_data *data; 79702ac6454SAndrew Thompson int i; 79802ac6454SAndrew Thompson 79902ac6454SAndrew Thompson sc->tx_nfree = 0; 80002ac6454SAndrew Thompson STAILQ_INIT(&sc->tx_q); 80102ac6454SAndrew Thompson STAILQ_INIT(&sc->tx_free); 80202ac6454SAndrew Thompson 80302ac6454SAndrew Thompson for (i = 0; i < RUM_TX_LIST_COUNT; i++) { 80402ac6454SAndrew Thompson data = &sc->tx_data[i]; 80502ac6454SAndrew Thompson 80602ac6454SAndrew Thompson data->sc = sc; 80702ac6454SAndrew Thompson STAILQ_INSERT_TAIL(&sc->tx_free, data, next); 80802ac6454SAndrew Thompson sc->tx_nfree++; 80902ac6454SAndrew Thompson } 81002ac6454SAndrew Thompson } 81102ac6454SAndrew Thompson 81202ac6454SAndrew Thompson static void 81302ac6454SAndrew Thompson rum_unsetup_tx_list(struct rum_softc *sc) 81402ac6454SAndrew Thompson { 81502ac6454SAndrew Thompson struct rum_tx_data *data; 81602ac6454SAndrew Thompson int i; 81702ac6454SAndrew Thompson 81802ac6454SAndrew Thompson /* make sure any subsequent use of the queues will fail */ 81902ac6454SAndrew Thompson sc->tx_nfree = 0; 82002ac6454SAndrew Thompson STAILQ_INIT(&sc->tx_q); 82102ac6454SAndrew Thompson STAILQ_INIT(&sc->tx_free); 82202ac6454SAndrew Thompson 82302ac6454SAndrew Thompson /* free up all node references and mbufs */ 82402ac6454SAndrew Thompson for (i = 0; i < RUM_TX_LIST_COUNT; i++) { 82502ac6454SAndrew Thompson data = &sc->tx_data[i]; 82602ac6454SAndrew Thompson 82702ac6454SAndrew Thompson if (data->m != NULL) { 82802ac6454SAndrew Thompson m_freem(data->m); 82902ac6454SAndrew Thompson data->m = NULL; 83002ac6454SAndrew Thompson } 83102ac6454SAndrew Thompson if (data->ni != NULL) { 83202ac6454SAndrew Thompson ieee80211_free_node(data->ni); 83302ac6454SAndrew Thompson data->ni = NULL; 83402ac6454SAndrew Thompson } 83502ac6454SAndrew Thompson } 83602ac6454SAndrew Thompson } 83702ac6454SAndrew Thompson 838349156a9SAndriy Voskoboinyk static void 839349156a9SAndriy Voskoboinyk rum_beacon_miss(struct ieee80211vap *vap) 840349156a9SAndriy Voskoboinyk { 841349156a9SAndriy Voskoboinyk struct ieee80211com *ic = vap->iv_ic; 842349156a9SAndriy Voskoboinyk struct rum_softc *sc = ic->ic_softc; 843349156a9SAndriy Voskoboinyk struct rum_vap *rvp = RUM_VAP(vap); 844349156a9SAndriy Voskoboinyk int sleep; 845349156a9SAndriy Voskoboinyk 846349156a9SAndriy Voskoboinyk RUM_LOCK(sc); 847349156a9SAndriy Voskoboinyk if (sc->sc_sleeping && sc->sc_sleep_end < ticks) { 848349156a9SAndriy Voskoboinyk DPRINTFN(12, "dropping 'sleeping' bit, " 849349156a9SAndriy Voskoboinyk "device must be awake now\n"); 850349156a9SAndriy Voskoboinyk 851349156a9SAndriy Voskoboinyk sc->sc_sleeping = 0; 852349156a9SAndriy Voskoboinyk } 853349156a9SAndriy Voskoboinyk 854349156a9SAndriy Voskoboinyk sleep = sc->sc_sleeping; 855349156a9SAndriy Voskoboinyk RUM_UNLOCK(sc); 856349156a9SAndriy Voskoboinyk 857349156a9SAndriy Voskoboinyk if (!sleep) 858349156a9SAndriy Voskoboinyk rvp->bmiss(vap); 859349156a9SAndriy Voskoboinyk #ifdef USB_DEBUG 860349156a9SAndriy Voskoboinyk else 861349156a9SAndriy Voskoboinyk DPRINTFN(13, "bmiss event is ignored whilst sleeping\n"); 862349156a9SAndriy Voskoboinyk #endif 863349156a9SAndriy Voskoboinyk } 864349156a9SAndriy Voskoboinyk 865349156a9SAndriy Voskoboinyk static void 866349156a9SAndriy Voskoboinyk rum_sta_recv_mgmt(struct ieee80211_node *ni, struct mbuf *m, int subtype, 867349156a9SAndriy Voskoboinyk const struct ieee80211_rx_stats *rxs, 868349156a9SAndriy Voskoboinyk int rssi, int nf) 869349156a9SAndriy Voskoboinyk { 870349156a9SAndriy Voskoboinyk struct ieee80211vap *vap = ni->ni_vap; 871349156a9SAndriy Voskoboinyk struct rum_softc *sc = vap->iv_ic->ic_softc; 872349156a9SAndriy Voskoboinyk struct rum_vap *rvp = RUM_VAP(vap); 873349156a9SAndriy Voskoboinyk 874349156a9SAndriy Voskoboinyk if (vap->iv_state == IEEE80211_S_SLEEP && 875349156a9SAndriy Voskoboinyk subtype == IEEE80211_FC0_SUBTYPE_BEACON) { 876349156a9SAndriy Voskoboinyk RUM_LOCK(sc); 877349156a9SAndriy Voskoboinyk DPRINTFN(12, "beacon, mybss %d (flags %02X)\n", 878349156a9SAndriy Voskoboinyk !!(sc->last_rx_flags & RT2573_RX_MYBSS), 879349156a9SAndriy Voskoboinyk sc->last_rx_flags); 880349156a9SAndriy Voskoboinyk 881349156a9SAndriy Voskoboinyk if ((sc->last_rx_flags & (RT2573_RX_MYBSS | RT2573_RX_BC)) == 882349156a9SAndriy Voskoboinyk (RT2573_RX_MYBSS | RT2573_RX_BC)) { 883349156a9SAndriy Voskoboinyk /* 884349156a9SAndriy Voskoboinyk * Put it to sleep here; in case if there is a data 885349156a9SAndriy Voskoboinyk * for us, iv_recv_mgmt() will wakeup the device via 886349156a9SAndriy Voskoboinyk * SLEEP -> RUN state transition. 887349156a9SAndriy Voskoboinyk */ 888349156a9SAndriy Voskoboinyk rum_set_power_state(sc, 1); 889349156a9SAndriy Voskoboinyk } 890349156a9SAndriy Voskoboinyk RUM_UNLOCK(sc); 891349156a9SAndriy Voskoboinyk } 892349156a9SAndriy Voskoboinyk 893349156a9SAndriy Voskoboinyk rvp->recv_mgmt(ni, m, subtype, rxs, rssi, nf); 894349156a9SAndriy Voskoboinyk } 895349156a9SAndriy Voskoboinyk 896349156a9SAndriy Voskoboinyk static int 897349156a9SAndriy Voskoboinyk rum_set_power_state(struct rum_softc *sc, int sleep) 898349156a9SAndriy Voskoboinyk { 899349156a9SAndriy Voskoboinyk usb_error_t uerror; 900349156a9SAndriy Voskoboinyk 901349156a9SAndriy Voskoboinyk RUM_LOCK_ASSERT(sc); 902349156a9SAndriy Voskoboinyk 903349156a9SAndriy Voskoboinyk DPRINTFN(12, "moving to %s state (sleep time %u)\n", 904349156a9SAndriy Voskoboinyk sleep ? "sleep" : "awake", sc->sc_sleep_time); 905349156a9SAndriy Voskoboinyk 906349156a9SAndriy Voskoboinyk uerror = rum_do_mcu_request(sc, 907349156a9SAndriy Voskoboinyk sleep ? RT2573_MCU_SLEEP : RT2573_MCU_WAKEUP); 908349156a9SAndriy Voskoboinyk if (uerror != USB_ERR_NORMAL_COMPLETION) { 909349156a9SAndriy Voskoboinyk device_printf(sc->sc_dev, 910349156a9SAndriy Voskoboinyk "%s: could not change power state: %s\n", 911349156a9SAndriy Voskoboinyk __func__, usbd_errstr(uerror)); 912349156a9SAndriy Voskoboinyk return (EIO); 913349156a9SAndriy Voskoboinyk } 914349156a9SAndriy Voskoboinyk 915349156a9SAndriy Voskoboinyk sc->sc_sleeping = !!sleep; 916349156a9SAndriy Voskoboinyk sc->sc_sleep_end = sleep ? ticks + sc->sc_sleep_time : 0; 917349156a9SAndriy Voskoboinyk 918349156a9SAndriy Voskoboinyk return (0); 919349156a9SAndriy Voskoboinyk } 920349156a9SAndriy Voskoboinyk 9215efea30fSAndrew Thompson static int 9225efea30fSAndrew Thompson rum_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 92302ac6454SAndrew Thompson { 92402ac6454SAndrew Thompson struct rum_vap *rvp = RUM_VAP(vap); 9255efea30fSAndrew Thompson struct ieee80211com *ic = vap->iv_ic; 926d3fdd08cSAdrian Chadd struct rum_softc *sc = ic->ic_softc; 92702ac6454SAndrew Thompson const struct ieee80211_txparam *tp; 92802ac6454SAndrew Thompson enum ieee80211_state ostate; 92902ac6454SAndrew Thompson struct ieee80211_node *ni; 930349156a9SAndriy Voskoboinyk usb_error_t uerror; 93196e29c26SAndriy Voskoboinyk int ret = 0; 93202ac6454SAndrew Thompson 93302ac6454SAndrew Thompson ostate = vap->iv_state; 9345efea30fSAndrew Thompson DPRINTF("%s -> %s\n", 9355efea30fSAndrew Thompson ieee80211_state_name[ostate], 9365efea30fSAndrew Thompson ieee80211_state_name[nstate]); 93702ac6454SAndrew Thompson 9385efea30fSAndrew Thompson IEEE80211_UNLOCK(ic); 9395efea30fSAndrew Thompson RUM_LOCK(sc); 940b6108616SRui Paulo usb_callout_stop(&rvp->ratectl_ch); 9415efea30fSAndrew Thompson 942349156a9SAndriy Voskoboinyk if (ostate == IEEE80211_S_SLEEP && vap->iv_opmode == IEEE80211_M_STA) { 943349156a9SAndriy Voskoboinyk rum_clrbits(sc, RT2573_TXRX_CSR4, RT2573_ACKCTS_PWRMGT); 944349156a9SAndriy Voskoboinyk rum_clrbits(sc, RT2573_MAC_CSR11, RT2573_AUTO_WAKEUP); 945349156a9SAndriy Voskoboinyk 946349156a9SAndriy Voskoboinyk /* 947349156a9SAndriy Voskoboinyk * Ignore any errors; 948349156a9SAndriy Voskoboinyk * any subsequent TX will wakeup it anyway 949349156a9SAndriy Voskoboinyk */ 950349156a9SAndriy Voskoboinyk (void) rum_set_power_state(sc, 0); 951349156a9SAndriy Voskoboinyk } 952349156a9SAndriy Voskoboinyk 9535efea30fSAndrew Thompson switch (nstate) { 95402ac6454SAndrew Thompson case IEEE80211_S_INIT: 9556d804321SAdrian Chadd if (ostate == IEEE80211_S_RUN) 9566d804321SAdrian Chadd rum_abort_tsf_sync(sc); 9576d804321SAdrian Chadd 95802ac6454SAndrew Thompson break; 95902ac6454SAndrew Thompson 96002ac6454SAndrew Thompson case IEEE80211_S_RUN: 961349156a9SAndriy Voskoboinyk if (ostate == IEEE80211_S_SLEEP) 962349156a9SAndriy Voskoboinyk break; /* already handled */ 963349156a9SAndriy Voskoboinyk 9648d8bdb01SAndrew Thompson ni = ieee80211_ref_node(vap->iv_bss); 96502ac6454SAndrew Thompson 96602ac6454SAndrew Thompson if (vap->iv_opmode != IEEE80211_M_MONITOR) { 967342ced03SAdrian Chadd if (ic->ic_bsschan == IEEE80211_CHAN_ANYC || 968342ced03SAdrian Chadd ni->ni_chan == IEEE80211_CHAN_ANYC) { 969aa81f853SAdrian Chadd ret = EINVAL; 970aa81f853SAdrian Chadd goto run_fail; 971bb571462SHans Petter Selasky } 972ed5711a1SAdrian Chadd rum_update_slot_cb(sc, NULL, 0); 97302ac6454SAndrew Thompson rum_enable_mrr(sc); 97402ac6454SAndrew Thompson rum_set_txpreamble(sc); 97502ac6454SAndrew Thompson rum_set_basicrates(sc); 976342ced03SAdrian Chadd rum_set_maxretry(sc, vap); 9771ba67b11SAdrian Chadd IEEE80211_ADDR_COPY(sc->sc_bssid, ni->ni_bssid); 9781ba67b11SAdrian Chadd rum_set_bssid(sc, sc->sc_bssid); 97902ac6454SAndrew Thompson } 98002ac6454SAndrew Thompson 98102ac6454SAndrew Thompson if (vap->iv_opmode == IEEE80211_M_HOSTAP || 982aa81f853SAdrian Chadd vap->iv_opmode == IEEE80211_M_IBSS) { 983b780f864SAdrian Chadd if ((ret = rum_alloc_beacon(sc, vap)) != 0) 984aa81f853SAdrian Chadd goto run_fail; 985aa81f853SAdrian Chadd } 98602ac6454SAndrew Thompson 98750a31b48SAdrian Chadd if (vap->iv_opmode != IEEE80211_M_MONITOR && 98850a31b48SAdrian Chadd vap->iv_opmode != IEEE80211_M_AHDEMO) { 989aa81f853SAdrian Chadd if ((ret = rum_enable_tsf_sync(sc)) != 0) 990aa81f853SAdrian Chadd goto run_fail; 991aa81f853SAdrian Chadd } else 9925463c4a4SSam Leffler rum_enable_tsf(sc); 99302ac6454SAndrew Thompson 99402ac6454SAndrew Thompson /* enable automatic rate adaptation */ 9955463c4a4SSam Leffler tp = &vap->iv_txparms[ieee80211_chan2mode(ic->ic_curchan)]; 99602ac6454SAndrew Thompson if (tp->ucastrate == IEEE80211_FIXED_RATE_NONE) 997b6108616SRui Paulo rum_ratectl_start(sc, ni); 99896e29c26SAndriy Voskoboinyk run_fail: 9998d8bdb01SAndrew Thompson ieee80211_free_node(ni); 100002ac6454SAndrew Thompson break; 1001349156a9SAndriy Voskoboinyk case IEEE80211_S_SLEEP: 1002349156a9SAndriy Voskoboinyk /* Implemented for STA mode only. */ 1003349156a9SAndriy Voskoboinyk if (vap->iv_opmode != IEEE80211_M_STA) 1004349156a9SAndriy Voskoboinyk break; 1005349156a9SAndriy Voskoboinyk 1006349156a9SAndriy Voskoboinyk uerror = rum_setbits(sc, RT2573_MAC_CSR11, RT2573_AUTO_WAKEUP); 1007349156a9SAndriy Voskoboinyk if (uerror != USB_ERR_NORMAL_COMPLETION) { 1008349156a9SAndriy Voskoboinyk ret = EIO; 1009349156a9SAndriy Voskoboinyk break; 1010349156a9SAndriy Voskoboinyk } 1011349156a9SAndriy Voskoboinyk 1012349156a9SAndriy Voskoboinyk uerror = rum_setbits(sc, RT2573_TXRX_CSR4, RT2573_ACKCTS_PWRMGT); 1013349156a9SAndriy Voskoboinyk if (uerror != USB_ERR_NORMAL_COMPLETION) { 1014349156a9SAndriy Voskoboinyk ret = EIO; 1015349156a9SAndriy Voskoboinyk break; 1016349156a9SAndriy Voskoboinyk } 1017349156a9SAndriy Voskoboinyk 1018349156a9SAndriy Voskoboinyk ret = rum_set_power_state(sc, 1); 1019349156a9SAndriy Voskoboinyk if (ret != 0) { 1020349156a9SAndriy Voskoboinyk device_printf(sc->sc_dev, 1021349156a9SAndriy Voskoboinyk "%s: could not move to the SLEEP state: %s\n", 1022349156a9SAndriy Voskoboinyk __func__, usbd_errstr(uerror)); 1023349156a9SAndriy Voskoboinyk } 1024349156a9SAndriy Voskoboinyk break; 102502ac6454SAndrew Thompson default: 102602ac6454SAndrew Thompson break; 102702ac6454SAndrew Thompson } 102802ac6454SAndrew Thompson RUM_UNLOCK(sc); 102902ac6454SAndrew Thompson IEEE80211_LOCK(ic); 103096e29c26SAndriy Voskoboinyk return (ret == 0 ? rvp->newstate(vap, nstate, arg) : ret); 103102ac6454SAndrew Thompson } 103202ac6454SAndrew Thompson 103302ac6454SAndrew Thompson static void 1034ed6d949aSAndrew Thompson rum_bulk_write_callback(struct usb_xfer *xfer, usb_error_t error) 103502ac6454SAndrew Thompson { 1036ed6d949aSAndrew Thompson struct rum_softc *sc = usbd_xfer_softc(xfer); 10375463c4a4SSam Leffler struct ieee80211vap *vap; 103802ac6454SAndrew Thompson struct rum_tx_data *data; 103902ac6454SAndrew Thompson struct mbuf *m; 1040ed6d949aSAndrew Thompson struct usb_page_cache *pc; 104102ac6454SAndrew Thompson unsigned int len; 1042ed6d949aSAndrew Thompson int actlen, sumlen; 1043ed6d949aSAndrew Thompson 1044ed6d949aSAndrew Thompson usbd_xfer_status(xfer, &actlen, &sumlen, NULL, NULL); 104502ac6454SAndrew Thompson 104602ac6454SAndrew Thompson switch (USB_GET_STATE(xfer)) { 104702ac6454SAndrew Thompson case USB_ST_TRANSFERRED: 1048ed6d949aSAndrew Thompson DPRINTFN(11, "transfer complete, %d bytes\n", actlen); 104902ac6454SAndrew Thompson 105002ac6454SAndrew Thompson /* free resources */ 1051ed6d949aSAndrew Thompson data = usbd_xfer_get_priv(xfer); 105202ac6454SAndrew Thompson rum_tx_free(data, 0); 1053ed6d949aSAndrew Thompson usbd_xfer_set_priv(xfer, NULL); 105402ac6454SAndrew Thompson 105502ac6454SAndrew Thompson /* FALLTHROUGH */ 105602ac6454SAndrew Thompson case USB_ST_SETUP: 105702ac6454SAndrew Thompson tr_setup: 105802ac6454SAndrew Thompson data = STAILQ_FIRST(&sc->tx_q); 105902ac6454SAndrew Thompson if (data) { 106002ac6454SAndrew Thompson STAILQ_REMOVE_HEAD(&sc->tx_q, next); 106102ac6454SAndrew Thompson m = data->m; 106202ac6454SAndrew Thompson 10636d917491SHans Petter Selasky if (m->m_pkthdr.len > (int)(MCLBYTES + RT2573_TX_DESC_SIZE)) { 106402ac6454SAndrew Thompson DPRINTFN(0, "data overflow, %u bytes\n", 106502ac6454SAndrew Thompson m->m_pkthdr.len); 106602ac6454SAndrew Thompson m->m_pkthdr.len = (MCLBYTES + RT2573_TX_DESC_SIZE); 106702ac6454SAndrew Thompson } 1068ed6d949aSAndrew Thompson pc = usbd_xfer_get_frame(xfer, 0); 1069ed6d949aSAndrew Thompson usbd_copy_in(pc, 0, &data->desc, RT2573_TX_DESC_SIZE); 1070ed6d949aSAndrew Thompson usbd_m_copy_in(pc, RT2573_TX_DESC_SIZE, m, 0, 1071ed6d949aSAndrew Thompson m->m_pkthdr.len); 107202ac6454SAndrew Thompson 10735463c4a4SSam Leffler vap = data->ni->ni_vap; 10745463c4a4SSam Leffler if (ieee80211_radiotap_active_vap(vap)) { 107502ac6454SAndrew Thompson struct rum_tx_radiotap_header *tap = &sc->sc_txtap; 107602ac6454SAndrew Thompson 107702ac6454SAndrew Thompson tap->wt_flags = 0; 107802ac6454SAndrew Thompson tap->wt_rate = data->rate; 1079a6ccd477SAdrian Chadd rum_get_tsf(sc, &tap->wt_tsf); 108002ac6454SAndrew Thompson tap->wt_antenna = sc->tx_ant; 108102ac6454SAndrew Thompson 10825463c4a4SSam Leffler ieee80211_radiotap_tx(vap, m); 108302ac6454SAndrew Thompson } 108402ac6454SAndrew Thompson 108502ac6454SAndrew Thompson /* align end on a 4-bytes boundary */ 108602ac6454SAndrew Thompson len = (RT2573_TX_DESC_SIZE + m->m_pkthdr.len + 3) & ~3; 108702ac6454SAndrew Thompson if ((len % 64) == 0) 108802ac6454SAndrew Thompson len += 4; 108902ac6454SAndrew Thompson 109002ac6454SAndrew Thompson DPRINTFN(11, "sending frame len=%u xferlen=%u\n", 109102ac6454SAndrew Thompson m->m_pkthdr.len, len); 109202ac6454SAndrew Thompson 1093ed6d949aSAndrew Thompson usbd_xfer_set_frame_len(xfer, 0, len); 1094ed6d949aSAndrew Thompson usbd_xfer_set_priv(xfer, data); 109502ac6454SAndrew Thompson 1096a593f6b8SAndrew Thompson usbd_transfer_submit(xfer); 109702ac6454SAndrew Thompson } 10987a79cebfSGleb Smirnoff rum_start(sc); 109902ac6454SAndrew Thompson break; 110002ac6454SAndrew Thompson 110102ac6454SAndrew Thompson default: /* Error */ 110202ac6454SAndrew Thompson DPRINTFN(11, "transfer error, %s\n", 1103ed6d949aSAndrew Thompson usbd_errstr(error)); 110402ac6454SAndrew Thompson 11057a79cebfSGleb Smirnoff counter_u64_add(sc->sc_ic.ic_oerrors, 1); 1106ed6d949aSAndrew Thompson data = usbd_xfer_get_priv(xfer); 110702ac6454SAndrew Thompson if (data != NULL) { 1108ed6d949aSAndrew Thompson rum_tx_free(data, error); 1109ed6d949aSAndrew Thompson usbd_xfer_set_priv(xfer, NULL); 111002ac6454SAndrew Thompson } 111102ac6454SAndrew Thompson 11120283fab7SAndrew Thompson if (error != USB_ERR_CANCELLED) { 11130283fab7SAndrew Thompson if (error == USB_ERR_TIMEOUT) 11140283fab7SAndrew Thompson device_printf(sc->sc_dev, "device timeout\n"); 11150283fab7SAndrew Thompson 11160283fab7SAndrew Thompson /* 11170283fab7SAndrew Thompson * Try to clear stall first, also if other 11180283fab7SAndrew Thompson * errors occur, hence clearing stall 11190283fab7SAndrew Thompson * introduces a 50 ms delay: 11200283fab7SAndrew Thompson */ 1121ed6d949aSAndrew Thompson usbd_xfer_set_stall(xfer); 112202ac6454SAndrew Thompson goto tr_setup; 112302ac6454SAndrew Thompson } 112402ac6454SAndrew Thompson break; 112502ac6454SAndrew Thompson } 112602ac6454SAndrew Thompson } 112702ac6454SAndrew Thompson 112802ac6454SAndrew Thompson static void 1129ed6d949aSAndrew Thompson rum_bulk_read_callback(struct usb_xfer *xfer, usb_error_t error) 113002ac6454SAndrew Thompson { 1131ed6d949aSAndrew Thompson struct rum_softc *sc = usbd_xfer_softc(xfer); 11327a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 1133aca2cf30SAdrian Chadd struct ieee80211_frame_min *wh; 113402ac6454SAndrew Thompson struct ieee80211_node *ni; 113502ac6454SAndrew Thompson struct mbuf *m = NULL; 1136ed6d949aSAndrew Thompson struct usb_page_cache *pc; 113702ac6454SAndrew Thompson uint32_t flags; 113802ac6454SAndrew Thompson uint8_t rssi = 0; 1139ed6d949aSAndrew Thompson int len; 1140ed6d949aSAndrew Thompson 1141ed6d949aSAndrew Thompson usbd_xfer_status(xfer, &len, NULL, NULL, NULL); 114202ac6454SAndrew Thompson 114302ac6454SAndrew Thompson switch (USB_GET_STATE(xfer)) { 114402ac6454SAndrew Thompson case USB_ST_TRANSFERRED: 114502ac6454SAndrew Thompson 1146ed6d949aSAndrew Thompson DPRINTFN(15, "rx done, actlen=%d\n", len); 114702ac6454SAndrew Thompson 11486d917491SHans Petter Selasky if (len < (int)(RT2573_RX_DESC_SIZE + IEEE80211_MIN_LEN)) { 114902ac6454SAndrew Thompson DPRINTF("%s: xfer too short %d\n", 115002ac6454SAndrew Thompson device_get_nameunit(sc->sc_dev), len); 11517a79cebfSGleb Smirnoff counter_u64_add(ic->ic_ierrors, 1); 115202ac6454SAndrew Thompson goto tr_setup; 115302ac6454SAndrew Thompson } 115402ac6454SAndrew Thompson 115502ac6454SAndrew Thompson len -= RT2573_RX_DESC_SIZE; 1156ed6d949aSAndrew Thompson pc = usbd_xfer_get_frame(xfer, 0); 1157ed6d949aSAndrew Thompson usbd_copy_out(pc, 0, &sc->sc_rx_desc, RT2573_RX_DESC_SIZE); 115802ac6454SAndrew Thompson 115902ac6454SAndrew Thompson rssi = rum_get_rssi(sc, sc->sc_rx_desc.rssi); 116002ac6454SAndrew Thompson flags = le32toh(sc->sc_rx_desc.flags); 1161349156a9SAndriy Voskoboinyk sc->last_rx_flags = flags; 116202ac6454SAndrew Thompson if (flags & RT2573_RX_CRC_ERROR) { 116302ac6454SAndrew Thompson /* 116402ac6454SAndrew Thompson * This should not happen since we did not 116502ac6454SAndrew Thompson * request to receive those frames when we 116602ac6454SAndrew Thompson * filled RUM_TXRX_CSR2: 116702ac6454SAndrew Thompson */ 116802ac6454SAndrew Thompson DPRINTFN(5, "PHY or CRC error\n"); 11697a79cebfSGleb Smirnoff counter_u64_add(ic->ic_ierrors, 1); 117002ac6454SAndrew Thompson goto tr_setup; 117102ac6454SAndrew Thompson } 11722cb9ef8dSAdrian Chadd if ((flags & RT2573_RX_DEC_MASK) != RT2573_RX_DEC_OK) { 11732cb9ef8dSAdrian Chadd switch (flags & RT2573_RX_DEC_MASK) { 11742cb9ef8dSAdrian Chadd case RT2573_RX_IV_ERROR: 11752cb9ef8dSAdrian Chadd DPRINTFN(5, "IV/EIV error\n"); 11762cb9ef8dSAdrian Chadd break; 11772cb9ef8dSAdrian Chadd case RT2573_RX_MIC_ERROR: 11782cb9ef8dSAdrian Chadd DPRINTFN(5, "MIC error\n"); 11792cb9ef8dSAdrian Chadd break; 11802cb9ef8dSAdrian Chadd case RT2573_RX_KEY_ERROR: 11812cb9ef8dSAdrian Chadd DPRINTFN(5, "Key error\n"); 11822cb9ef8dSAdrian Chadd break; 11832cb9ef8dSAdrian Chadd } 11842cb9ef8dSAdrian Chadd counter_u64_add(ic->ic_ierrors, 1); 11852cb9ef8dSAdrian Chadd goto tr_setup; 11862cb9ef8dSAdrian Chadd } 118702ac6454SAndrew Thompson 1188c6499eccSGleb Smirnoff m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 118902ac6454SAndrew Thompson if (m == NULL) { 119002ac6454SAndrew Thompson DPRINTF("could not allocate mbuf\n"); 11917a79cebfSGleb Smirnoff counter_u64_add(ic->ic_ierrors, 1); 119202ac6454SAndrew Thompson goto tr_setup; 119302ac6454SAndrew Thompson } 1194ed6d949aSAndrew Thompson usbd_copy_out(pc, RT2573_RX_DESC_SIZE, 119502ac6454SAndrew Thompson mtod(m, uint8_t *), len); 119602ac6454SAndrew Thompson 1197aca2cf30SAdrian Chadd wh = mtod(m, struct ieee80211_frame_min *); 1198aca2cf30SAdrian Chadd 11992cb9ef8dSAdrian Chadd if ((wh->i_fc[1] & IEEE80211_FC1_PROTECTED) && 12002cb9ef8dSAdrian Chadd (flags & RT2573_RX_CIP_MASK) != 12012cb9ef8dSAdrian Chadd RT2573_RX_CIP_MODE(RT2573_MODE_NOSEC)) { 12022cb9ef8dSAdrian Chadd wh->i_fc[1] &= ~IEEE80211_FC1_PROTECTED; 12032cb9ef8dSAdrian Chadd m->m_flags |= M_WEP; 12042cb9ef8dSAdrian Chadd } 12052cb9ef8dSAdrian Chadd 120602ac6454SAndrew Thompson /* finalize mbuf */ 120702ac6454SAndrew Thompson m->m_pkthdr.len = m->m_len = (flags >> 16) & 0xfff; 120802ac6454SAndrew Thompson 12095463c4a4SSam Leffler if (ieee80211_radiotap_active(ic)) { 121002ac6454SAndrew Thompson struct rum_rx_radiotap_header *tap = &sc->sc_rxtap; 121102ac6454SAndrew Thompson 12125463c4a4SSam Leffler tap->wr_flags = 0; 121302ac6454SAndrew Thompson tap->wr_rate = ieee80211_plcp2rate(sc->sc_rx_desc.rate, 121402ac6454SAndrew Thompson (flags & RT2573_RX_OFDM) ? 121502ac6454SAndrew Thompson IEEE80211_T_OFDM : IEEE80211_T_CCK); 1216a6ccd477SAdrian Chadd rum_get_tsf(sc, &tap->wr_tsf); 12175463c4a4SSam Leffler tap->wr_antsignal = RT2573_NOISE_FLOOR + rssi; 12185463c4a4SSam Leffler tap->wr_antnoise = RT2573_NOISE_FLOOR; 121902ac6454SAndrew Thompson tap->wr_antenna = sc->rx_ant; 122002ac6454SAndrew Thompson } 122102ac6454SAndrew Thompson /* FALLTHROUGH */ 122202ac6454SAndrew Thompson case USB_ST_SETUP: 122302ac6454SAndrew Thompson tr_setup: 1224ed6d949aSAndrew Thompson usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer)); 1225a593f6b8SAndrew Thompson usbd_transfer_submit(xfer); 122602ac6454SAndrew Thompson 122702ac6454SAndrew Thompson /* 122802ac6454SAndrew Thompson * At the end of a USB callback it is always safe to unlock 122902ac6454SAndrew Thompson * the private mutex of a device! That is why we do the 123002ac6454SAndrew Thompson * "ieee80211_input" here, and not some lines up! 123102ac6454SAndrew Thompson */ 123202ac6454SAndrew Thompson RUM_UNLOCK(sc); 1233db63fc93SWeongyo Jeong if (m) { 1234aca2cf30SAdrian Chadd if (m->m_len >= sizeof(struct ieee80211_frame_min)) 1235aca2cf30SAdrian Chadd ni = ieee80211_find_rxnode(ic, wh); 1236aca2cf30SAdrian Chadd else 1237aca2cf30SAdrian Chadd ni = NULL; 1238aca2cf30SAdrian Chadd 123902ac6454SAndrew Thompson if (ni != NULL) { 124002ac6454SAndrew Thompson (void) ieee80211_input(ni, m, rssi, 12415463c4a4SSam Leffler RT2573_NOISE_FLOOR); 124202ac6454SAndrew Thompson ieee80211_free_node(ni); 124302ac6454SAndrew Thompson } else 124402ac6454SAndrew Thompson (void) ieee80211_input_all(ic, m, rssi, 12455463c4a4SSam Leffler RT2573_NOISE_FLOOR); 124602ac6454SAndrew Thompson } 1247db63fc93SWeongyo Jeong RUM_LOCK(sc); 12487a79cebfSGleb Smirnoff rum_start(sc); 124902ac6454SAndrew Thompson return; 125002ac6454SAndrew Thompson 125102ac6454SAndrew Thompson default: /* Error */ 1252ed6d949aSAndrew Thompson if (error != USB_ERR_CANCELLED) { 125302ac6454SAndrew Thompson /* try to clear stall first */ 1254ed6d949aSAndrew Thompson usbd_xfer_set_stall(xfer); 125502ac6454SAndrew Thompson goto tr_setup; 125602ac6454SAndrew Thompson } 125702ac6454SAndrew Thompson return; 125802ac6454SAndrew Thompson } 125902ac6454SAndrew Thompson } 126002ac6454SAndrew Thompson 126102ac6454SAndrew Thompson static uint8_t 126202ac6454SAndrew Thompson rum_plcp_signal(int rate) 126302ac6454SAndrew Thompson { 126402ac6454SAndrew Thompson switch (rate) { 126502ac6454SAndrew Thompson /* OFDM rates (cf IEEE Std 802.11a-1999, pp. 14 Table 80) */ 126602ac6454SAndrew Thompson case 12: return 0xb; 126702ac6454SAndrew Thompson case 18: return 0xf; 126802ac6454SAndrew Thompson case 24: return 0xa; 126902ac6454SAndrew Thompson case 36: return 0xe; 127002ac6454SAndrew Thompson case 48: return 0x9; 127102ac6454SAndrew Thompson case 72: return 0xd; 127202ac6454SAndrew Thompson case 96: return 0x8; 127302ac6454SAndrew Thompson case 108: return 0xc; 127402ac6454SAndrew Thompson 127502ac6454SAndrew Thompson /* CCK rates (NB: not IEEE std, device-specific) */ 127602ac6454SAndrew Thompson case 2: return 0x0; 127702ac6454SAndrew Thompson case 4: return 0x1; 127802ac6454SAndrew Thompson case 11: return 0x2; 127902ac6454SAndrew Thompson case 22: return 0x3; 128002ac6454SAndrew Thompson } 128102ac6454SAndrew Thompson return 0xff; /* XXX unsupported/unknown rate */ 128202ac6454SAndrew Thompson } 128302ac6454SAndrew Thompson 12842cb9ef8dSAdrian Chadd /* 12852cb9ef8dSAdrian Chadd * Map net80211 cipher to RT2573 security mode. 12862cb9ef8dSAdrian Chadd */ 12872cb9ef8dSAdrian Chadd static uint8_t 12882cb9ef8dSAdrian Chadd rum_crypto_mode(struct rum_softc *sc, u_int cipher, int keylen) 12892cb9ef8dSAdrian Chadd { 12902cb9ef8dSAdrian Chadd switch (cipher) { 12912cb9ef8dSAdrian Chadd case IEEE80211_CIPHER_WEP: 12922cb9ef8dSAdrian Chadd return (keylen < 8 ? RT2573_MODE_WEP40 : RT2573_MODE_WEP104); 12932cb9ef8dSAdrian Chadd case IEEE80211_CIPHER_TKIP: 12942cb9ef8dSAdrian Chadd return RT2573_MODE_TKIP; 12952cb9ef8dSAdrian Chadd case IEEE80211_CIPHER_AES_CCM: 12962cb9ef8dSAdrian Chadd return RT2573_MODE_AES_CCMP; 12972cb9ef8dSAdrian Chadd default: 12982cb9ef8dSAdrian Chadd device_printf(sc->sc_dev, "unknown cipher %d\n", cipher); 12992cb9ef8dSAdrian Chadd return 0; 13002cb9ef8dSAdrian Chadd } 13012cb9ef8dSAdrian Chadd } 13022cb9ef8dSAdrian Chadd 130302ac6454SAndrew Thompson static void 130402ac6454SAndrew Thompson rum_setup_tx_desc(struct rum_softc *sc, struct rum_tx_desc *desc, 13051354b52cSAdrian Chadd struct ieee80211_key *k, uint32_t flags, uint8_t xflags, uint8_t qid, 13061354b52cSAdrian Chadd int hdrlen, int len, int rate) 130702ac6454SAndrew Thompson { 13087a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 13091354b52cSAdrian Chadd struct wmeParams *wmep = &sc->wme_params[qid]; 131002ac6454SAndrew Thompson uint16_t plcp_length; 131102ac6454SAndrew Thompson int remainder; 131202ac6454SAndrew Thompson 13132cb9ef8dSAdrian Chadd flags |= RT2573_TX_VALID; 13142cb9ef8dSAdrian Chadd flags |= len << 16; 131502ac6454SAndrew Thompson 13162cb9ef8dSAdrian Chadd if (k != NULL && !(k->wk_flags & IEEE80211_KEY_SWCRYPT)) { 13172cb9ef8dSAdrian Chadd const struct ieee80211_cipher *cip = k->wk_cipher; 131802ac6454SAndrew Thompson 13192cb9ef8dSAdrian Chadd len += cip->ic_header + cip->ic_trailer + cip->ic_miclen; 13202cb9ef8dSAdrian Chadd 13212cb9ef8dSAdrian Chadd desc->eiv = 0; /* for WEP */ 13222cb9ef8dSAdrian Chadd cip->ic_setiv(k, (uint8_t *)&desc->iv); 13232cb9ef8dSAdrian Chadd } 132402ac6454SAndrew Thompson 132502ac6454SAndrew Thompson /* setup PLCP fields */ 132602ac6454SAndrew Thompson desc->plcp_signal = rum_plcp_signal(rate); 132702ac6454SAndrew Thompson desc->plcp_service = 4; 132802ac6454SAndrew Thompson 132902ac6454SAndrew Thompson len += IEEE80211_CRC_LEN; 133026d39e2cSSam Leffler if (ieee80211_rate2phytype(ic->ic_rt, rate) == IEEE80211_T_OFDM) { 13312cb9ef8dSAdrian Chadd flags |= RT2573_TX_OFDM; 133202ac6454SAndrew Thompson 133302ac6454SAndrew Thompson plcp_length = len & 0xfff; 133402ac6454SAndrew Thompson desc->plcp_length_hi = plcp_length >> 6; 133502ac6454SAndrew Thompson desc->plcp_length_lo = plcp_length & 0x3f; 133602ac6454SAndrew Thompson } else { 1337b8e3094cSHans Petter Selasky if (rate == 0) 1338b8e3094cSHans Petter Selasky rate = 2; /* avoid division by zero */ 1339*057b4402SPedro F. Giffuni plcp_length = howmany(16 * len, rate); 134002ac6454SAndrew Thompson if (rate == 22) { 134102ac6454SAndrew Thompson remainder = (16 * len) % 22; 134202ac6454SAndrew Thompson if (remainder != 0 && remainder < 7) 134302ac6454SAndrew Thompson desc->plcp_service |= RT2573_PLCP_LENGEXT; 134402ac6454SAndrew Thompson } 134502ac6454SAndrew Thompson desc->plcp_length_hi = plcp_length >> 8; 134602ac6454SAndrew Thompson desc->plcp_length_lo = plcp_length & 0xff; 134702ac6454SAndrew Thompson 134802ac6454SAndrew Thompson if (rate != 2 && (ic->ic_flags & IEEE80211_F_SHPREAMBLE)) 134902ac6454SAndrew Thompson desc->plcp_signal |= 0x08; 135002ac6454SAndrew Thompson } 13512cb9ef8dSAdrian Chadd 13522cb9ef8dSAdrian Chadd desc->flags = htole32(flags); 13532cb9ef8dSAdrian Chadd desc->hdrlen = hdrlen; 13542cb9ef8dSAdrian Chadd desc->xflags = xflags; 13552cb9ef8dSAdrian Chadd 13561354b52cSAdrian Chadd desc->wme = htole16(RT2573_QID(qid) | 13571354b52cSAdrian Chadd RT2573_AIFSN(wmep->wmep_aifsn) | 13581354b52cSAdrian Chadd RT2573_LOGCWMIN(wmep->wmep_logcwmin) | 13591354b52cSAdrian Chadd RT2573_LOGCWMAX(wmep->wmep_logcwmax)); 136002ac6454SAndrew Thompson } 136102ac6454SAndrew Thompson 136202ac6454SAndrew Thompson static int 136302ac6454SAndrew Thompson rum_sendprot(struct rum_softc *sc, 136402ac6454SAndrew Thompson const struct mbuf *m, struct ieee80211_node *ni, int prot, int rate) 136502ac6454SAndrew Thompson { 136602ac6454SAndrew Thompson struct ieee80211com *ic = ni->ni_ic; 136702ac6454SAndrew Thompson const struct ieee80211_frame *wh; 136802ac6454SAndrew Thompson struct rum_tx_data *data; 136902ac6454SAndrew Thompson struct mbuf *mprot; 1370e7b7db3dSAdrian Chadd int protrate, pktlen, flags, isshort; 137102ac6454SAndrew Thompson uint16_t dur; 137202ac6454SAndrew Thompson 1373e7b7db3dSAdrian Chadd RUM_LOCK_ASSERT(sc); 137402ac6454SAndrew Thompson KASSERT(prot == IEEE80211_PROT_RTSCTS || prot == IEEE80211_PROT_CTSONLY, 137502ac6454SAndrew Thompson ("protection %d", prot)); 137602ac6454SAndrew Thompson 137702ac6454SAndrew Thompson wh = mtod(m, const struct ieee80211_frame *); 137802ac6454SAndrew Thompson pktlen = m->m_pkthdr.len + IEEE80211_CRC_LEN; 137902ac6454SAndrew Thompson 138026d39e2cSSam Leffler protrate = ieee80211_ctl_rate(ic->ic_rt, rate); 138102ac6454SAndrew Thompson 138202ac6454SAndrew Thompson isshort = (ic->ic_flags & IEEE80211_F_SHPREAMBLE) != 0; 13830f817de7SJung-uk Kim dur = ieee80211_compute_duration(ic->ic_rt, pktlen, rate, isshort) 138426d39e2cSSam Leffler + ieee80211_ack_duration(ic->ic_rt, rate, isshort); 1385c42e124eSAdrian Chadd flags = 0; 138602ac6454SAndrew Thompson if (prot == IEEE80211_PROT_RTSCTS) { 138702ac6454SAndrew Thompson /* NB: CTS is the same size as an ACK */ 138826d39e2cSSam Leffler dur += ieee80211_ack_duration(ic->ic_rt, rate, isshort); 138902ac6454SAndrew Thompson flags |= RT2573_TX_NEED_ACK; 139002ac6454SAndrew Thompson mprot = ieee80211_alloc_rts(ic, wh->i_addr1, wh->i_addr2, dur); 139102ac6454SAndrew Thompson } else { 139202ac6454SAndrew Thompson mprot = ieee80211_alloc_cts(ic, ni->ni_vap->iv_myaddr, dur); 139302ac6454SAndrew Thompson } 139402ac6454SAndrew Thompson if (mprot == NULL) { 139502ac6454SAndrew Thompson /* XXX stat + msg */ 139677ddf3d3SAndrew Thompson return (ENOBUFS); 139702ac6454SAndrew Thompson } 139802ac6454SAndrew Thompson data = STAILQ_FIRST(&sc->tx_free); 139902ac6454SAndrew Thompson STAILQ_REMOVE_HEAD(&sc->tx_free, next); 140002ac6454SAndrew Thompson sc->tx_nfree--; 140102ac6454SAndrew Thompson 140202ac6454SAndrew Thompson data->m = mprot; 140302ac6454SAndrew Thompson data->ni = ieee80211_ref_node(ni); 140402ac6454SAndrew Thompson data->rate = protrate; 14051354b52cSAdrian Chadd rum_setup_tx_desc(sc, &data->desc, NULL, flags, 0, 0, 0, 14062cb9ef8dSAdrian Chadd mprot->m_pkthdr.len, protrate); 140702ac6454SAndrew Thompson 140802ac6454SAndrew Thompson STAILQ_INSERT_TAIL(&sc->tx_q, data, next); 1409a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[RUM_BULK_WR]); 141002ac6454SAndrew Thompson 141102ac6454SAndrew Thompson return 0; 141202ac6454SAndrew Thompson } 141302ac6454SAndrew Thompson 14142cb9ef8dSAdrian Chadd static uint32_t 14152cb9ef8dSAdrian Chadd rum_tx_crypto_flags(struct rum_softc *sc, struct ieee80211_node *ni, 14162cb9ef8dSAdrian Chadd const struct ieee80211_key *k) 14172cb9ef8dSAdrian Chadd { 14182cb9ef8dSAdrian Chadd struct ieee80211vap *vap = ni->ni_vap; 14192cb9ef8dSAdrian Chadd u_int cipher; 14202cb9ef8dSAdrian Chadd uint32_t flags = 0; 14212cb9ef8dSAdrian Chadd uint8_t mode, pos; 14222cb9ef8dSAdrian Chadd 14232cb9ef8dSAdrian Chadd if (!(k->wk_flags & IEEE80211_KEY_SWCRYPT)) { 14242cb9ef8dSAdrian Chadd cipher = k->wk_cipher->ic_cipher; 14252cb9ef8dSAdrian Chadd pos = k->wk_keyix; 14262cb9ef8dSAdrian Chadd mode = rum_crypto_mode(sc, cipher, k->wk_keylen); 14272cb9ef8dSAdrian Chadd if (mode == 0) 14282cb9ef8dSAdrian Chadd return 0; 14292cb9ef8dSAdrian Chadd 14302cb9ef8dSAdrian Chadd flags |= RT2573_TX_CIP_MODE(mode); 14312cb9ef8dSAdrian Chadd 14322cb9ef8dSAdrian Chadd /* Do not trust GROUP flag */ 14332cb9ef8dSAdrian Chadd if (!(k >= &vap->iv_nw_keys[0] && 14342cb9ef8dSAdrian Chadd k < &vap->iv_nw_keys[IEEE80211_WEP_NKID])) 14352cb9ef8dSAdrian Chadd flags |= RT2573_TX_KEY_PAIR; 14362cb9ef8dSAdrian Chadd else 14372cb9ef8dSAdrian Chadd pos += 0 * RT2573_SKEY_MAX; /* vap id */ 14382cb9ef8dSAdrian Chadd 14392cb9ef8dSAdrian Chadd flags |= RT2573_TX_KEY_ID(pos); 14402cb9ef8dSAdrian Chadd 14412cb9ef8dSAdrian Chadd if (cipher == IEEE80211_CIPHER_TKIP) 14422cb9ef8dSAdrian Chadd flags |= RT2573_TX_TKIPMIC; 14432cb9ef8dSAdrian Chadd } 14442cb9ef8dSAdrian Chadd 14452cb9ef8dSAdrian Chadd return flags; 14462cb9ef8dSAdrian Chadd } 14472cb9ef8dSAdrian Chadd 144802ac6454SAndrew Thompson static int 144902ac6454SAndrew Thompson rum_tx_mgt(struct rum_softc *sc, struct mbuf *m0, struct ieee80211_node *ni) 145002ac6454SAndrew Thompson { 145102ac6454SAndrew Thompson struct ieee80211vap *vap = ni->ni_vap; 14527a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 145302ac6454SAndrew Thompson struct rum_tx_data *data; 145402ac6454SAndrew Thompson struct ieee80211_frame *wh; 145502ac6454SAndrew Thompson const struct ieee80211_txparam *tp; 14562cb9ef8dSAdrian Chadd struct ieee80211_key *k = NULL; 145702ac6454SAndrew Thompson uint32_t flags = 0; 145802ac6454SAndrew Thompson uint16_t dur; 14591354b52cSAdrian Chadd uint8_t ac, type, xflags = 0; 14602cb9ef8dSAdrian Chadd int hdrlen; 146102ac6454SAndrew Thompson 1462e7b7db3dSAdrian Chadd RUM_LOCK_ASSERT(sc); 146302ac6454SAndrew Thompson 146402ac6454SAndrew Thompson data = STAILQ_FIRST(&sc->tx_free); 146502ac6454SAndrew Thompson STAILQ_REMOVE_HEAD(&sc->tx_free, next); 146602ac6454SAndrew Thompson sc->tx_nfree--; 146702ac6454SAndrew Thompson 146802ac6454SAndrew Thompson wh = mtod(m0, struct ieee80211_frame *); 1469c42e124eSAdrian Chadd type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK; 14702cb9ef8dSAdrian Chadd hdrlen = ieee80211_anyhdrsize(wh); 14711354b52cSAdrian Chadd ac = M_WME_GETAC(m0); 14722cb9ef8dSAdrian Chadd 14735945b5f5SKevin Lo if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 14742cb9ef8dSAdrian Chadd k = ieee80211_crypto_get_txkey(ni, m0); 1475b2a76342SAdrian Chadd if (k == NULL) 14762cb9ef8dSAdrian Chadd return (ENOENT); 14772cb9ef8dSAdrian Chadd 14782cb9ef8dSAdrian Chadd if ((k->wk_flags & IEEE80211_KEY_SWCRYPT) && 14792cb9ef8dSAdrian Chadd !k->wk_cipher->ic_encap(k, m0)) 1480b2a76342SAdrian Chadd return (ENOBUFS); 1481b2a76342SAdrian Chadd 148202ac6454SAndrew Thompson wh = mtod(m0, struct ieee80211_frame *); 148302ac6454SAndrew Thompson } 148402ac6454SAndrew Thompson 148502ac6454SAndrew Thompson tp = &vap->iv_txparms[ieee80211_chan2mode(ic->ic_curchan)]; 148602ac6454SAndrew Thompson 148702ac6454SAndrew Thompson if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) { 148802ac6454SAndrew Thompson flags |= RT2573_TX_NEED_ACK; 148902ac6454SAndrew Thompson 149026d39e2cSSam Leffler dur = ieee80211_ack_duration(ic->ic_rt, tp->mgmtrate, 149102ac6454SAndrew Thompson ic->ic_flags & IEEE80211_F_SHPREAMBLE); 14928cfe5440SHans Petter Selasky USETW(wh->i_dur, dur); 149302ac6454SAndrew Thompson 149402ac6454SAndrew Thompson /* tell hardware to add timestamp for probe responses */ 1495c42e124eSAdrian Chadd if (type == IEEE80211_FC0_TYPE_MGT && 1496c42e124eSAdrian Chadd (wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) == 1497c42e124eSAdrian Chadd IEEE80211_FC0_SUBTYPE_PROBE_RESP) 149802ac6454SAndrew Thompson flags |= RT2573_TX_TIMESTAMP; 149902ac6454SAndrew Thompson } 150002ac6454SAndrew Thompson 1501c42e124eSAdrian Chadd if (type != IEEE80211_FC0_TYPE_CTL && !IEEE80211_QOS_HAS_SEQ(wh)) 1502c42e124eSAdrian Chadd xflags |= RT2573_TX_HWSEQ; 1503c42e124eSAdrian Chadd 15042cb9ef8dSAdrian Chadd if (k != NULL) 15052cb9ef8dSAdrian Chadd flags |= rum_tx_crypto_flags(sc, ni, k); 15062cb9ef8dSAdrian Chadd 150702ac6454SAndrew Thompson data->m = m0; 150802ac6454SAndrew Thompson data->ni = ni; 150902ac6454SAndrew Thompson data->rate = tp->mgmtrate; 151002ac6454SAndrew Thompson 15111354b52cSAdrian Chadd rum_setup_tx_desc(sc, &data->desc, k, flags, xflags, ac, hdrlen, 15122cb9ef8dSAdrian Chadd m0->m_pkthdr.len, tp->mgmtrate); 151302ac6454SAndrew Thompson 151402ac6454SAndrew Thompson DPRINTFN(10, "sending mgt frame len=%d rate=%d\n", 151502ac6454SAndrew Thompson m0->m_pkthdr.len + (int)RT2573_TX_DESC_SIZE, tp->mgmtrate); 151602ac6454SAndrew Thompson 151702ac6454SAndrew Thompson STAILQ_INSERT_TAIL(&sc->tx_q, data, next); 1518a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[RUM_BULK_WR]); 151902ac6454SAndrew Thompson 152077ddf3d3SAndrew Thompson return (0); 152102ac6454SAndrew Thompson } 152202ac6454SAndrew Thompson 152302ac6454SAndrew Thompson static int 152402ac6454SAndrew Thompson rum_tx_raw(struct rum_softc *sc, struct mbuf *m0, struct ieee80211_node *ni, 152502ac6454SAndrew Thompson const struct ieee80211_bpf_params *params) 152602ac6454SAndrew Thompson { 1527515db61dSSam Leffler struct ieee80211com *ic = ni->ni_ic; 1528c42e124eSAdrian Chadd struct ieee80211_frame *wh; 152902ac6454SAndrew Thompson struct rum_tx_data *data; 153002ac6454SAndrew Thompson uint32_t flags; 15311354b52cSAdrian Chadd uint8_t ac, type, xflags = 0; 153202ac6454SAndrew Thompson int rate, error; 153302ac6454SAndrew Thompson 1534e7b7db3dSAdrian Chadd RUM_LOCK_ASSERT(sc); 153502ac6454SAndrew Thompson 1536c42e124eSAdrian Chadd wh = mtod(m0, struct ieee80211_frame *); 1537c42e124eSAdrian Chadd type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK; 1538c42e124eSAdrian Chadd 15391354b52cSAdrian Chadd ac = params->ibp_pri & 3; 15401354b52cSAdrian Chadd 1541515db61dSSam Leffler rate = params->ibp_rate0; 1542b2a76342SAdrian Chadd if (!ieee80211_isratevalid(ic->ic_rt, rate)) 1543b2a76342SAdrian Chadd return (EINVAL); 1544b2a76342SAdrian Chadd 154502ac6454SAndrew Thompson flags = 0; 154602ac6454SAndrew Thompson if ((params->ibp_flags & IEEE80211_BPF_NOACK) == 0) 154702ac6454SAndrew Thompson flags |= RT2573_TX_NEED_ACK; 154802ac6454SAndrew Thompson if (params->ibp_flags & (IEEE80211_BPF_RTS|IEEE80211_BPF_CTS)) { 154902ac6454SAndrew Thompson error = rum_sendprot(sc, m0, ni, 155002ac6454SAndrew Thompson params->ibp_flags & IEEE80211_BPF_RTS ? 155102ac6454SAndrew Thompson IEEE80211_PROT_RTSCTS : IEEE80211_PROT_CTSONLY, 155202ac6454SAndrew Thompson rate); 1553b2a76342SAdrian Chadd if (error || sc->tx_nfree == 0) 1554b2a76342SAdrian Chadd return (ENOBUFS); 1555b2a76342SAdrian Chadd 155602ac6454SAndrew Thompson flags |= RT2573_TX_LONG_RETRY | RT2573_TX_IFS_SIFS; 155702ac6454SAndrew Thompson } 155802ac6454SAndrew Thompson 1559c42e124eSAdrian Chadd if (type != IEEE80211_FC0_TYPE_CTL && !IEEE80211_QOS_HAS_SEQ(wh)) 1560c42e124eSAdrian Chadd xflags |= RT2573_TX_HWSEQ; 1561c42e124eSAdrian Chadd 156296ca458fSAndrew Thompson data = STAILQ_FIRST(&sc->tx_free); 156396ca458fSAndrew Thompson STAILQ_REMOVE_HEAD(&sc->tx_free, next); 156496ca458fSAndrew Thompson sc->tx_nfree--; 156596ca458fSAndrew Thompson 156602ac6454SAndrew Thompson data->m = m0; 156702ac6454SAndrew Thompson data->ni = ni; 156802ac6454SAndrew Thompson data->rate = rate; 156902ac6454SAndrew Thompson 157002ac6454SAndrew Thompson /* XXX need to setup descriptor ourself */ 15711354b52cSAdrian Chadd rum_setup_tx_desc(sc, &data->desc, NULL, flags, xflags, ac, 0, 1572c42e124eSAdrian Chadd m0->m_pkthdr.len, rate); 157302ac6454SAndrew Thompson 157402ac6454SAndrew Thompson DPRINTFN(10, "sending raw frame len=%u rate=%u\n", 157502ac6454SAndrew Thompson m0->m_pkthdr.len, rate); 157602ac6454SAndrew Thompson 157702ac6454SAndrew Thompson STAILQ_INSERT_TAIL(&sc->tx_q, data, next); 1578a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[RUM_BULK_WR]); 157902ac6454SAndrew Thompson 158002ac6454SAndrew Thompson return 0; 158102ac6454SAndrew Thompson } 158202ac6454SAndrew Thompson 158302ac6454SAndrew Thompson static int 158402ac6454SAndrew Thompson rum_tx_data(struct rum_softc *sc, struct mbuf *m0, struct ieee80211_node *ni) 158502ac6454SAndrew Thompson { 158602ac6454SAndrew Thompson struct ieee80211vap *vap = ni->ni_vap; 15877a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 158802ac6454SAndrew Thompson struct rum_tx_data *data; 158902ac6454SAndrew Thompson struct ieee80211_frame *wh; 159002ac6454SAndrew Thompson const struct ieee80211_txparam *tp; 15912cb9ef8dSAdrian Chadd struct ieee80211_key *k = NULL; 159202ac6454SAndrew Thompson uint32_t flags = 0; 159302ac6454SAndrew Thompson uint16_t dur; 15941354b52cSAdrian Chadd uint8_t ac, type, qos, xflags = 0; 15952cb9ef8dSAdrian Chadd int error, hdrlen, rate; 159602ac6454SAndrew Thompson 1597e7b7db3dSAdrian Chadd RUM_LOCK_ASSERT(sc); 159802ac6454SAndrew Thompson 159902ac6454SAndrew Thompson wh = mtod(m0, struct ieee80211_frame *); 1600c42e124eSAdrian Chadd type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK; 16012cb9ef8dSAdrian Chadd hdrlen = ieee80211_anyhdrsize(wh); 160202ac6454SAndrew Thompson 16031354b52cSAdrian Chadd if (IEEE80211_QOS_HAS_SEQ(wh)) 16041354b52cSAdrian Chadd qos = ((const struct ieee80211_qosframe *)wh)->i_qos[0]; 16051354b52cSAdrian Chadd else 16061354b52cSAdrian Chadd qos = 0; 16071354b52cSAdrian Chadd ac = M_WME_GETAC(m0); 16081354b52cSAdrian Chadd 160902ac6454SAndrew Thompson tp = &vap->iv_txparms[ieee80211_chan2mode(ni->ni_chan)]; 161002ac6454SAndrew Thompson if (IEEE80211_IS_MULTICAST(wh->i_addr1)) 161102ac6454SAndrew Thompson rate = tp->mcastrate; 161202ac6454SAndrew Thompson else if (tp->ucastrate != IEEE80211_FIXED_RATE_NONE) 161302ac6454SAndrew Thompson rate = tp->ucastrate; 161402ac6454SAndrew Thompson else 161502ac6454SAndrew Thompson rate = ni->ni_txrate; 161602ac6454SAndrew Thompson 16175945b5f5SKevin Lo if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 16182cb9ef8dSAdrian Chadd k = ieee80211_crypto_get_txkey(ni, m0); 161902ac6454SAndrew Thompson if (k == NULL) { 162002ac6454SAndrew Thompson m_freem(m0); 16212cb9ef8dSAdrian Chadd return (ENOENT); 16222cb9ef8dSAdrian Chadd } 16232cb9ef8dSAdrian Chadd if ((k->wk_flags & IEEE80211_KEY_SWCRYPT) && 16242cb9ef8dSAdrian Chadd !k->wk_cipher->ic_encap(k, m0)) { 16252cb9ef8dSAdrian Chadd m_freem(m0); 16262cb9ef8dSAdrian Chadd return (ENOBUFS); 162702ac6454SAndrew Thompson } 162802ac6454SAndrew Thompson 162902ac6454SAndrew Thompson /* packet header may have moved, reset our local pointer */ 163002ac6454SAndrew Thompson wh = mtod(m0, struct ieee80211_frame *); 163102ac6454SAndrew Thompson } 163202ac6454SAndrew Thompson 1633c42e124eSAdrian Chadd if (type != IEEE80211_FC0_TYPE_CTL && !IEEE80211_QOS_HAS_SEQ(wh)) 1634c42e124eSAdrian Chadd xflags |= RT2573_TX_HWSEQ; 1635c42e124eSAdrian Chadd 163602ac6454SAndrew Thompson if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) { 163702ac6454SAndrew Thompson int prot = IEEE80211_PROT_NONE; 163802ac6454SAndrew Thompson if (m0->m_pkthdr.len + IEEE80211_CRC_LEN > vap->iv_rtsthreshold) 163902ac6454SAndrew Thompson prot = IEEE80211_PROT_RTSCTS; 164002ac6454SAndrew Thompson else if ((ic->ic_flags & IEEE80211_F_USEPROT) && 164126d39e2cSSam Leffler ieee80211_rate2phytype(ic->ic_rt, rate) == IEEE80211_T_OFDM) 164202ac6454SAndrew Thompson prot = ic->ic_protmode; 164302ac6454SAndrew Thompson if (prot != IEEE80211_PROT_NONE) { 164402ac6454SAndrew Thompson error = rum_sendprot(sc, m0, ni, prot, rate); 164596ca458fSAndrew Thompson if (error || sc->tx_nfree == 0) { 164602ac6454SAndrew Thompson m_freem(m0); 164796ca458fSAndrew Thompson return ENOBUFS; 164802ac6454SAndrew Thompson } 164902ac6454SAndrew Thompson flags |= RT2573_TX_LONG_RETRY | RT2573_TX_IFS_SIFS; 165002ac6454SAndrew Thompson } 165102ac6454SAndrew Thompson } 165202ac6454SAndrew Thompson 16532cb9ef8dSAdrian Chadd if (k != NULL) 16542cb9ef8dSAdrian Chadd flags |= rum_tx_crypto_flags(sc, ni, k); 16552cb9ef8dSAdrian Chadd 165602ac6454SAndrew Thompson data = STAILQ_FIRST(&sc->tx_free); 165702ac6454SAndrew Thompson STAILQ_REMOVE_HEAD(&sc->tx_free, next); 165802ac6454SAndrew Thompson sc->tx_nfree--; 165902ac6454SAndrew Thompson 166002ac6454SAndrew Thompson data->m = m0; 166102ac6454SAndrew Thompson data->ni = ni; 166202ac6454SAndrew Thompson data->rate = rate; 166302ac6454SAndrew Thompson 166402ac6454SAndrew Thompson if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) { 16651354b52cSAdrian Chadd /* Unicast frame, check if an ACK is expected. */ 16661354b52cSAdrian Chadd if (!qos || (qos & IEEE80211_QOS_ACKPOLICY) != 16671354b52cSAdrian Chadd IEEE80211_QOS_ACKPOLICY_NOACK) 166802ac6454SAndrew Thompson flags |= RT2573_TX_NEED_ACK; 166902ac6454SAndrew Thompson 167026d39e2cSSam Leffler dur = ieee80211_ack_duration(ic->ic_rt, rate, 167102ac6454SAndrew Thompson ic->ic_flags & IEEE80211_F_SHPREAMBLE); 16728cfe5440SHans Petter Selasky USETW(wh->i_dur, dur); 167302ac6454SAndrew Thompson } 167402ac6454SAndrew Thompson 16751354b52cSAdrian Chadd rum_setup_tx_desc(sc, &data->desc, k, flags, xflags, ac, hdrlen, 16762cb9ef8dSAdrian Chadd m0->m_pkthdr.len, rate); 167702ac6454SAndrew Thompson 167802ac6454SAndrew Thompson DPRINTFN(10, "sending frame len=%d rate=%d\n", 167902ac6454SAndrew Thompson m0->m_pkthdr.len + (int)RT2573_TX_DESC_SIZE, rate); 168002ac6454SAndrew Thompson 168102ac6454SAndrew Thompson STAILQ_INSERT_TAIL(&sc->tx_q, data, next); 1682a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[RUM_BULK_WR]); 168302ac6454SAndrew Thompson 168402ac6454SAndrew Thompson return 0; 168502ac6454SAndrew Thompson } 168602ac6454SAndrew Thompson 16877a79cebfSGleb Smirnoff static int 16887a79cebfSGleb Smirnoff rum_transmit(struct ieee80211com *ic, struct mbuf *m) 168979d2c5e8SGleb Smirnoff { 16907a79cebfSGleb Smirnoff struct rum_softc *sc = ic->ic_softc; 16917a79cebfSGleb Smirnoff int error; 16927a79cebfSGleb Smirnoff 16937a79cebfSGleb Smirnoff RUM_LOCK(sc); 16947a79cebfSGleb Smirnoff if (!sc->sc_running) { 16957a79cebfSGleb Smirnoff RUM_UNLOCK(sc); 16967a79cebfSGleb Smirnoff return (ENXIO); 16977a79cebfSGleb Smirnoff } 16987a79cebfSGleb Smirnoff error = mbufq_enqueue(&sc->sc_snd, m); 16997a79cebfSGleb Smirnoff if (error) { 17007a79cebfSGleb Smirnoff RUM_UNLOCK(sc); 17017a79cebfSGleb Smirnoff return (error); 17027a79cebfSGleb Smirnoff } 17037a79cebfSGleb Smirnoff rum_start(sc); 17047a79cebfSGleb Smirnoff RUM_UNLOCK(sc); 17057a79cebfSGleb Smirnoff 17067a79cebfSGleb Smirnoff return (0); 17077a79cebfSGleb Smirnoff } 17087a79cebfSGleb Smirnoff 17097a79cebfSGleb Smirnoff static void 17107a79cebfSGleb Smirnoff rum_start(struct rum_softc *sc) 17117a79cebfSGleb Smirnoff { 171202ac6454SAndrew Thompson struct ieee80211_node *ni; 171302ac6454SAndrew Thompson struct mbuf *m; 171402ac6454SAndrew Thompson 1715e7b7db3dSAdrian Chadd RUM_LOCK_ASSERT(sc); 17167a79cebfSGleb Smirnoff 17177a79cebfSGleb Smirnoff if (!sc->sc_running) 171802ac6454SAndrew Thompson return; 17197a79cebfSGleb Smirnoff 17207a79cebfSGleb Smirnoff while (sc->tx_nfree >= RUM_TX_MINFREE && 17217a79cebfSGleb Smirnoff (m = mbufq_dequeue(&sc->sc_snd)) != NULL) { 172202ac6454SAndrew Thompson ni = (struct ieee80211_node *) m->m_pkthdr.rcvif; 172302ac6454SAndrew Thompson if (rum_tx_data(sc, m, ni) != 0) { 17247a79cebfSGleb Smirnoff if_inc_counter(ni->ni_vap->iv_ifp, 17257a79cebfSGleb Smirnoff IFCOUNTER_OERRORS, 1); 172602ac6454SAndrew Thompson ieee80211_free_node(ni); 172702ac6454SAndrew Thompson break; 172802ac6454SAndrew Thompson } 172902ac6454SAndrew Thompson } 173002ac6454SAndrew Thompson } 173102ac6454SAndrew Thompson 17327a79cebfSGleb Smirnoff static void 17337a79cebfSGleb Smirnoff rum_parent(struct ieee80211com *ic) 173402ac6454SAndrew Thompson { 1735d3fdd08cSAdrian Chadd struct rum_softc *sc = ic->ic_softc; 17360698c0b3SAdrian Chadd struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 1737645e4d17SHans Petter Selasky 1738645e4d17SHans Petter Selasky RUM_LOCK(sc); 17397a79cebfSGleb Smirnoff if (sc->sc_detached) { 1740645e4d17SHans Petter Selasky RUM_UNLOCK(sc); 17417a79cebfSGleb Smirnoff return; 17427a79cebfSGleb Smirnoff } 174302ac6454SAndrew Thompson RUM_UNLOCK(sc); 17440698c0b3SAdrian Chadd 17450698c0b3SAdrian Chadd if (ic->ic_nrunning > 0) { 17460698c0b3SAdrian Chadd if (rum_init(sc) == 0) 174702ac6454SAndrew Thompson ieee80211_start_all(ic); 17480698c0b3SAdrian Chadd else 17490698c0b3SAdrian Chadd ieee80211_stop(vap); 17500698c0b3SAdrian Chadd } else 17510698c0b3SAdrian Chadd rum_stop(sc); 175202ac6454SAndrew Thompson } 175302ac6454SAndrew Thompson 175402ac6454SAndrew Thompson static void 175502ac6454SAndrew Thompson rum_eeprom_read(struct rum_softc *sc, uint16_t addr, void *buf, int len) 175602ac6454SAndrew Thompson { 1757760bc48eSAndrew Thompson struct usb_device_request req; 1758e0a69b51SAndrew Thompson usb_error_t error; 175902ac6454SAndrew Thompson 176002ac6454SAndrew Thompson req.bmRequestType = UT_READ_VENDOR_DEVICE; 176102ac6454SAndrew Thompson req.bRequest = RT2573_READ_EEPROM; 176202ac6454SAndrew Thompson USETW(req.wValue, 0); 176302ac6454SAndrew Thompson USETW(req.wIndex, addr); 176402ac6454SAndrew Thompson USETW(req.wLength, len); 176502ac6454SAndrew Thompson 176602ac6454SAndrew Thompson error = rum_do_request(sc, &req, buf); 176702ac6454SAndrew Thompson if (error != 0) { 176802ac6454SAndrew Thompson device_printf(sc->sc_dev, "could not read EEPROM: %s\n", 1769a593f6b8SAndrew Thompson usbd_errstr(error)); 177002ac6454SAndrew Thompson } 177102ac6454SAndrew Thompson } 177202ac6454SAndrew Thompson 177302ac6454SAndrew Thompson static uint32_t 177402ac6454SAndrew Thompson rum_read(struct rum_softc *sc, uint16_t reg) 177502ac6454SAndrew Thompson { 177602ac6454SAndrew Thompson uint32_t val; 177702ac6454SAndrew Thompson 177802ac6454SAndrew Thompson rum_read_multi(sc, reg, &val, sizeof val); 177902ac6454SAndrew Thompson 178002ac6454SAndrew Thompson return le32toh(val); 178102ac6454SAndrew Thompson } 178202ac6454SAndrew Thompson 178302ac6454SAndrew Thompson static void 178402ac6454SAndrew Thompson rum_read_multi(struct rum_softc *sc, uint16_t reg, void *buf, int len) 178502ac6454SAndrew Thompson { 1786760bc48eSAndrew Thompson struct usb_device_request req; 1787e0a69b51SAndrew Thompson usb_error_t error; 178802ac6454SAndrew Thompson 178902ac6454SAndrew Thompson req.bmRequestType = UT_READ_VENDOR_DEVICE; 179002ac6454SAndrew Thompson req.bRequest = RT2573_READ_MULTI_MAC; 179102ac6454SAndrew Thompson USETW(req.wValue, 0); 179202ac6454SAndrew Thompson USETW(req.wIndex, reg); 179302ac6454SAndrew Thompson USETW(req.wLength, len); 179402ac6454SAndrew Thompson 179502ac6454SAndrew Thompson error = rum_do_request(sc, &req, buf); 179602ac6454SAndrew Thompson if (error != 0) { 179702ac6454SAndrew Thompson device_printf(sc->sc_dev, 179802ac6454SAndrew Thompson "could not multi read MAC register: %s\n", 1799a593f6b8SAndrew Thompson usbd_errstr(error)); 180002ac6454SAndrew Thompson } 180102ac6454SAndrew Thompson } 180202ac6454SAndrew Thompson 1803e0a69b51SAndrew Thompson static usb_error_t 180402ac6454SAndrew Thompson rum_write(struct rum_softc *sc, uint16_t reg, uint32_t val) 180502ac6454SAndrew Thompson { 180602ac6454SAndrew Thompson uint32_t tmp = htole32(val); 180702ac6454SAndrew Thompson 180877ddf3d3SAndrew Thompson return (rum_write_multi(sc, reg, &tmp, sizeof tmp)); 180902ac6454SAndrew Thompson } 181002ac6454SAndrew Thompson 1811e0a69b51SAndrew Thompson static usb_error_t 181202ac6454SAndrew Thompson rum_write_multi(struct rum_softc *sc, uint16_t reg, void *buf, size_t len) 181302ac6454SAndrew Thompson { 1814760bc48eSAndrew Thompson struct usb_device_request req; 1815e0a69b51SAndrew Thompson usb_error_t error; 18166d917491SHans Petter Selasky size_t offset; 181702ac6454SAndrew Thompson 181802ac6454SAndrew Thompson req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 181902ac6454SAndrew Thompson req.bRequest = RT2573_WRITE_MULTI_MAC; 182002ac6454SAndrew Thompson USETW(req.wValue, 0); 182102ac6454SAndrew Thompson 182265d7e4d9SAdrian Chadd /* write at most 64 bytes at a time */ 182365d7e4d9SAdrian Chadd for (offset = 0; offset < len; offset += 64) { 182465d7e4d9SAdrian Chadd USETW(req.wIndex, reg + offset); 182565d7e4d9SAdrian Chadd USETW(req.wLength, MIN(len - offset, 64)); 182665d7e4d9SAdrian Chadd 18278797cafeSBjoern A. Zeeb error = rum_do_request(sc, &req, (char *)buf + offset); 182802ac6454SAndrew Thompson if (error != 0) { 182902ac6454SAndrew Thompson device_printf(sc->sc_dev, 183002ac6454SAndrew Thompson "could not multi write MAC register: %s\n", 1831a593f6b8SAndrew Thompson usbd_errstr(error)); 183277ddf3d3SAndrew Thompson return (error); 183302ac6454SAndrew Thompson } 183465d7e4d9SAdrian Chadd } 18358797cafeSBjoern A. Zeeb 18368797cafeSBjoern A. Zeeb return (USB_ERR_NORMAL_COMPLETION); 183765d7e4d9SAdrian Chadd } 183802ac6454SAndrew Thompson 1839a05022b2SAdrian Chadd static usb_error_t 1840a05022b2SAdrian Chadd rum_setbits(struct rum_softc *sc, uint16_t reg, uint32_t mask) 1841a05022b2SAdrian Chadd { 1842a05022b2SAdrian Chadd return (rum_write(sc, reg, rum_read(sc, reg) | mask)); 1843a05022b2SAdrian Chadd } 1844a05022b2SAdrian Chadd 1845a05022b2SAdrian Chadd static usb_error_t 1846a05022b2SAdrian Chadd rum_clrbits(struct rum_softc *sc, uint16_t reg, uint32_t mask) 1847a05022b2SAdrian Chadd { 1848a05022b2SAdrian Chadd return (rum_write(sc, reg, rum_read(sc, reg) & ~mask)); 1849a05022b2SAdrian Chadd } 1850a05022b2SAdrian Chadd 1851a05022b2SAdrian Chadd static usb_error_t 1852a05022b2SAdrian Chadd rum_modbits(struct rum_softc *sc, uint16_t reg, uint32_t set, uint32_t unset) 1853a05022b2SAdrian Chadd { 1854a05022b2SAdrian Chadd return (rum_write(sc, reg, (rum_read(sc, reg) & ~unset) | set)); 1855a05022b2SAdrian Chadd } 1856a05022b2SAdrian Chadd 1857cc9ae761SAdrian Chadd static int 1858cc9ae761SAdrian Chadd rum_bbp_busy(struct rum_softc *sc) 185902ac6454SAndrew Thompson { 186002ac6454SAndrew Thompson int ntries; 186102ac6454SAndrew Thompson 186202ac6454SAndrew Thompson for (ntries = 0; ntries < 100; ntries++) { 186302ac6454SAndrew Thompson if (!(rum_read(sc, RT2573_PHY_CSR3) & RT2573_BBP_BUSY)) 186402ac6454SAndrew Thompson break; 186502ac6454SAndrew Thompson if (rum_pause(sc, hz / 100)) 186602ac6454SAndrew Thompson break; 186702ac6454SAndrew Thompson } 1868cc9ae761SAdrian Chadd if (ntries == 100) 1869cc9ae761SAdrian Chadd return (ETIMEDOUT); 1870cc9ae761SAdrian Chadd 1871cc9ae761SAdrian Chadd return (0); 1872cc9ae761SAdrian Chadd } 1873cc9ae761SAdrian Chadd 1874cc9ae761SAdrian Chadd static void 1875cc9ae761SAdrian Chadd rum_bbp_write(struct rum_softc *sc, uint8_t reg, uint8_t val) 1876cc9ae761SAdrian Chadd { 1877cc9ae761SAdrian Chadd uint32_t tmp; 1878cc9ae761SAdrian Chadd 1879cc9ae761SAdrian Chadd DPRINTFN(2, "reg=0x%08x\n", reg); 1880cc9ae761SAdrian Chadd 1881cc9ae761SAdrian Chadd if (rum_bbp_busy(sc) != 0) { 188202ac6454SAndrew Thompson device_printf(sc->sc_dev, "could not write to BBP\n"); 188302ac6454SAndrew Thompson return; 188402ac6454SAndrew Thompson } 188502ac6454SAndrew Thompson 188602ac6454SAndrew Thompson tmp = RT2573_BBP_BUSY | (reg & 0x7f) << 8 | val; 188702ac6454SAndrew Thompson rum_write(sc, RT2573_PHY_CSR3, tmp); 188802ac6454SAndrew Thompson } 188902ac6454SAndrew Thompson 189002ac6454SAndrew Thompson static uint8_t 189102ac6454SAndrew Thompson rum_bbp_read(struct rum_softc *sc, uint8_t reg) 189202ac6454SAndrew Thompson { 189302ac6454SAndrew Thompson uint32_t val; 189402ac6454SAndrew Thompson int ntries; 189502ac6454SAndrew Thompson 189677ddf3d3SAndrew Thompson DPRINTFN(2, "reg=0x%08x\n", reg); 189777ddf3d3SAndrew Thompson 1898cc9ae761SAdrian Chadd if (rum_bbp_busy(sc) != 0) { 189902ac6454SAndrew Thompson device_printf(sc->sc_dev, "could not read BBP\n"); 190002ac6454SAndrew Thompson return 0; 190102ac6454SAndrew Thompson } 190202ac6454SAndrew Thompson 190302ac6454SAndrew Thompson val = RT2573_BBP_BUSY | RT2573_BBP_READ | reg << 8; 190402ac6454SAndrew Thompson rum_write(sc, RT2573_PHY_CSR3, val); 190502ac6454SAndrew Thompson 190602ac6454SAndrew Thompson for (ntries = 0; ntries < 100; ntries++) { 190702ac6454SAndrew Thompson val = rum_read(sc, RT2573_PHY_CSR3); 190802ac6454SAndrew Thompson if (!(val & RT2573_BBP_BUSY)) 190902ac6454SAndrew Thompson return val & 0xff; 191002ac6454SAndrew Thompson if (rum_pause(sc, hz / 100)) 191102ac6454SAndrew Thompson break; 191202ac6454SAndrew Thompson } 191302ac6454SAndrew Thompson 191402ac6454SAndrew Thompson device_printf(sc->sc_dev, "could not read BBP\n"); 191502ac6454SAndrew Thompson return 0; 191602ac6454SAndrew Thompson } 191702ac6454SAndrew Thompson 191802ac6454SAndrew Thompson static void 191902ac6454SAndrew Thompson rum_rf_write(struct rum_softc *sc, uint8_t reg, uint32_t val) 192002ac6454SAndrew Thompson { 192102ac6454SAndrew Thompson uint32_t tmp; 192202ac6454SAndrew Thompson int ntries; 192302ac6454SAndrew Thompson 192402ac6454SAndrew Thompson for (ntries = 0; ntries < 100; ntries++) { 192502ac6454SAndrew Thompson if (!(rum_read(sc, RT2573_PHY_CSR4) & RT2573_RF_BUSY)) 192602ac6454SAndrew Thompson break; 192702ac6454SAndrew Thompson if (rum_pause(sc, hz / 100)) 192802ac6454SAndrew Thompson break; 192902ac6454SAndrew Thompson } 193002ac6454SAndrew Thompson if (ntries == 100) { 193102ac6454SAndrew Thompson device_printf(sc->sc_dev, "could not write to RF\n"); 193202ac6454SAndrew Thompson return; 193302ac6454SAndrew Thompson } 193402ac6454SAndrew Thompson 193567784314SPoul-Henning Kamp tmp = RT2573_RF_BUSY | RT2573_RF_20BIT | (val & 0xfffff) << 2 | 193602ac6454SAndrew Thompson (reg & 3); 193702ac6454SAndrew Thompson rum_write(sc, RT2573_PHY_CSR4, tmp); 193802ac6454SAndrew Thompson 193902ac6454SAndrew Thompson /* remember last written value in sc */ 194002ac6454SAndrew Thompson sc->rf_regs[reg] = val; 194102ac6454SAndrew Thompson 194202ac6454SAndrew Thompson DPRINTFN(15, "RF R[%u] <- 0x%05x\n", reg & 3, val & 0xfffff); 194302ac6454SAndrew Thompson } 194402ac6454SAndrew Thompson 194502ac6454SAndrew Thompson static void 194602ac6454SAndrew Thompson rum_select_antenna(struct rum_softc *sc) 194702ac6454SAndrew Thompson { 194802ac6454SAndrew Thompson uint8_t bbp4, bbp77; 194902ac6454SAndrew Thompson uint32_t tmp; 195002ac6454SAndrew Thompson 195102ac6454SAndrew Thompson bbp4 = rum_bbp_read(sc, 4); 195202ac6454SAndrew Thompson bbp77 = rum_bbp_read(sc, 77); 195302ac6454SAndrew Thompson 195402ac6454SAndrew Thompson /* TBD */ 195502ac6454SAndrew Thompson 195602ac6454SAndrew Thompson /* make sure Rx is disabled before switching antenna */ 195702ac6454SAndrew Thompson tmp = rum_read(sc, RT2573_TXRX_CSR0); 195802ac6454SAndrew Thompson rum_write(sc, RT2573_TXRX_CSR0, tmp | RT2573_DISABLE_RX); 195902ac6454SAndrew Thompson 196002ac6454SAndrew Thompson rum_bbp_write(sc, 4, bbp4); 196102ac6454SAndrew Thompson rum_bbp_write(sc, 77, bbp77); 196202ac6454SAndrew Thompson 196302ac6454SAndrew Thompson rum_write(sc, RT2573_TXRX_CSR0, tmp); 196402ac6454SAndrew Thompson } 196502ac6454SAndrew Thompson 196602ac6454SAndrew Thompson /* 196702ac6454SAndrew Thompson * Enable multi-rate retries for frames sent at OFDM rates. 196802ac6454SAndrew Thompson * In 802.11b/g mode, allow fallback to CCK rates. 196902ac6454SAndrew Thompson */ 197002ac6454SAndrew Thompson static void 197102ac6454SAndrew Thompson rum_enable_mrr(struct rum_softc *sc) 197202ac6454SAndrew Thompson { 19737a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 197402ac6454SAndrew Thompson 1975a05022b2SAdrian Chadd if (!IEEE80211_IS_CHAN_5GHZ(ic->ic_bsschan)) { 1976a05022b2SAdrian Chadd rum_setbits(sc, RT2573_TXRX_CSR4, 1977a05022b2SAdrian Chadd RT2573_MRR_ENABLED | RT2573_MRR_CCK_FALLBACK); 1978a05022b2SAdrian Chadd } else { 1979a05022b2SAdrian Chadd rum_modbits(sc, RT2573_TXRX_CSR4, 1980a05022b2SAdrian Chadd RT2573_MRR_ENABLED, RT2573_MRR_CCK_FALLBACK); 1981a05022b2SAdrian Chadd } 198202ac6454SAndrew Thompson } 198302ac6454SAndrew Thompson 198402ac6454SAndrew Thompson static void 198502ac6454SAndrew Thompson rum_set_txpreamble(struct rum_softc *sc) 198602ac6454SAndrew Thompson { 19877a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 198802ac6454SAndrew Thompson 198902ac6454SAndrew Thompson if (ic->ic_flags & IEEE80211_F_SHPREAMBLE) 1990a05022b2SAdrian Chadd rum_setbits(sc, RT2573_TXRX_CSR4, RT2573_SHORT_PREAMBLE); 1991a05022b2SAdrian Chadd else 1992a05022b2SAdrian Chadd rum_clrbits(sc, RT2573_TXRX_CSR4, RT2573_SHORT_PREAMBLE); 199302ac6454SAndrew Thompson } 199402ac6454SAndrew Thompson 199502ac6454SAndrew Thompson static void 199602ac6454SAndrew Thompson rum_set_basicrates(struct rum_softc *sc) 199702ac6454SAndrew Thompson { 19987a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 199902ac6454SAndrew Thompson 200002ac6454SAndrew Thompson /* update basic rate set */ 200102ac6454SAndrew Thompson if (ic->ic_curmode == IEEE80211_MODE_11B) { 200202ac6454SAndrew Thompson /* 11b basic rates: 1, 2Mbps */ 200302ac6454SAndrew Thompson rum_write(sc, RT2573_TXRX_CSR5, 0x3); 200402ac6454SAndrew Thompson } else if (IEEE80211_IS_CHAN_5GHZ(ic->ic_bsschan)) { 200502ac6454SAndrew Thompson /* 11a basic rates: 6, 12, 24Mbps */ 200602ac6454SAndrew Thompson rum_write(sc, RT2573_TXRX_CSR5, 0x150); 200702ac6454SAndrew Thompson } else { 200802ac6454SAndrew Thompson /* 11b/g basic rates: 1, 2, 5.5, 11Mbps */ 200902ac6454SAndrew Thompson rum_write(sc, RT2573_TXRX_CSR5, 0xf); 201002ac6454SAndrew Thompson } 201102ac6454SAndrew Thompson } 201202ac6454SAndrew Thompson 201302ac6454SAndrew Thompson /* 201402ac6454SAndrew Thompson * Reprogram MAC/BBP to switch to a new band. Values taken from the reference 201502ac6454SAndrew Thompson * driver. 201602ac6454SAndrew Thompson */ 201702ac6454SAndrew Thompson static void 201802ac6454SAndrew Thompson rum_select_band(struct rum_softc *sc, struct ieee80211_channel *c) 201902ac6454SAndrew Thompson { 202002ac6454SAndrew Thompson uint8_t bbp17, bbp35, bbp96, bbp97, bbp98, bbp104; 202102ac6454SAndrew Thompson 202202ac6454SAndrew Thompson /* update all BBP registers that depend on the band */ 202302ac6454SAndrew Thompson bbp17 = 0x20; bbp96 = 0x48; bbp104 = 0x2c; 202402ac6454SAndrew Thompson bbp35 = 0x50; bbp97 = 0x48; bbp98 = 0x48; 202502ac6454SAndrew Thompson if (IEEE80211_IS_CHAN_5GHZ(c)) { 202602ac6454SAndrew Thompson bbp17 += 0x08; bbp96 += 0x10; bbp104 += 0x0c; 202702ac6454SAndrew Thompson bbp35 += 0x10; bbp97 += 0x10; bbp98 += 0x10; 202802ac6454SAndrew Thompson } 202902ac6454SAndrew Thompson if ((IEEE80211_IS_CHAN_2GHZ(c) && sc->ext_2ghz_lna) || 203002ac6454SAndrew Thompson (IEEE80211_IS_CHAN_5GHZ(c) && sc->ext_5ghz_lna)) { 203102ac6454SAndrew Thompson bbp17 += 0x10; bbp96 += 0x10; bbp104 += 0x10; 203202ac6454SAndrew Thompson } 203302ac6454SAndrew Thompson 203402ac6454SAndrew Thompson sc->bbp17 = bbp17; 203502ac6454SAndrew Thompson rum_bbp_write(sc, 17, bbp17); 203602ac6454SAndrew Thompson rum_bbp_write(sc, 96, bbp96); 203702ac6454SAndrew Thompson rum_bbp_write(sc, 104, bbp104); 203802ac6454SAndrew Thompson 203902ac6454SAndrew Thompson if ((IEEE80211_IS_CHAN_2GHZ(c) && sc->ext_2ghz_lna) || 204002ac6454SAndrew Thompson (IEEE80211_IS_CHAN_5GHZ(c) && sc->ext_5ghz_lna)) { 204102ac6454SAndrew Thompson rum_bbp_write(sc, 75, 0x80); 204202ac6454SAndrew Thompson rum_bbp_write(sc, 86, 0x80); 204302ac6454SAndrew Thompson rum_bbp_write(sc, 88, 0x80); 204402ac6454SAndrew Thompson } 204502ac6454SAndrew Thompson 204602ac6454SAndrew Thompson rum_bbp_write(sc, 35, bbp35); 204702ac6454SAndrew Thompson rum_bbp_write(sc, 97, bbp97); 204802ac6454SAndrew Thompson rum_bbp_write(sc, 98, bbp98); 204902ac6454SAndrew Thompson 2050a05022b2SAdrian Chadd if (IEEE80211_IS_CHAN_2GHZ(c)) { 2051a05022b2SAdrian Chadd rum_modbits(sc, RT2573_PHY_CSR0, RT2573_PA_PE_2GHZ, 2052a05022b2SAdrian Chadd RT2573_PA_PE_5GHZ); 2053a05022b2SAdrian Chadd } else { 2054a05022b2SAdrian Chadd rum_modbits(sc, RT2573_PHY_CSR0, RT2573_PA_PE_5GHZ, 2055a05022b2SAdrian Chadd RT2573_PA_PE_2GHZ); 2056a05022b2SAdrian Chadd } 205702ac6454SAndrew Thompson } 205802ac6454SAndrew Thompson 205902ac6454SAndrew Thompson static void 206002ac6454SAndrew Thompson rum_set_chan(struct rum_softc *sc, struct ieee80211_channel *c) 206102ac6454SAndrew Thompson { 20627a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 206302ac6454SAndrew Thompson const struct rfprog *rfprog; 206402ac6454SAndrew Thompson uint8_t bbp3, bbp94 = RT2573_BBPR94_DEFAULT; 206502ac6454SAndrew Thompson int8_t power; 206602ac6454SAndrew Thompson int i, chan; 206702ac6454SAndrew Thompson 206802ac6454SAndrew Thompson chan = ieee80211_chan2ieee(ic, c); 206902ac6454SAndrew Thompson if (chan == 0 || chan == IEEE80211_CHAN_ANY) 207002ac6454SAndrew Thompson return; 207102ac6454SAndrew Thompson 207202ac6454SAndrew Thompson /* select the appropriate RF settings based on what EEPROM says */ 207302ac6454SAndrew Thompson rfprog = (sc->rf_rev == RT2573_RF_5225 || 207402ac6454SAndrew Thompson sc->rf_rev == RT2573_RF_2527) ? rum_rf5225 : rum_rf5226; 207502ac6454SAndrew Thompson 207602ac6454SAndrew Thompson /* find the settings for this channel (we know it exists) */ 207702ac6454SAndrew Thompson for (i = 0; rfprog[i].chan != chan; i++); 207802ac6454SAndrew Thompson 207902ac6454SAndrew Thompson power = sc->txpow[i]; 208002ac6454SAndrew Thompson if (power < 0) { 208102ac6454SAndrew Thompson bbp94 += power; 208202ac6454SAndrew Thompson power = 0; 208302ac6454SAndrew Thompson } else if (power > 31) { 208402ac6454SAndrew Thompson bbp94 += power - 31; 208502ac6454SAndrew Thompson power = 31; 208602ac6454SAndrew Thompson } 208702ac6454SAndrew Thompson 208802ac6454SAndrew Thompson /* 208902ac6454SAndrew Thompson * If we are switching from the 2GHz band to the 5GHz band or 209002ac6454SAndrew Thompson * vice-versa, BBP registers need to be reprogrammed. 209102ac6454SAndrew Thompson */ 209202ac6454SAndrew Thompson if (c->ic_flags != ic->ic_curchan->ic_flags) { 209302ac6454SAndrew Thompson rum_select_band(sc, c); 209402ac6454SAndrew Thompson rum_select_antenna(sc); 209502ac6454SAndrew Thompson } 209602ac6454SAndrew Thompson ic->ic_curchan = c; 209702ac6454SAndrew Thompson 209802ac6454SAndrew Thompson rum_rf_write(sc, RT2573_RF1, rfprog[i].r1); 209902ac6454SAndrew Thompson rum_rf_write(sc, RT2573_RF2, rfprog[i].r2); 210002ac6454SAndrew Thompson rum_rf_write(sc, RT2573_RF3, rfprog[i].r3 | power << 7); 210102ac6454SAndrew Thompson rum_rf_write(sc, RT2573_RF4, rfprog[i].r4 | sc->rffreq << 10); 210202ac6454SAndrew Thompson 210302ac6454SAndrew Thompson rum_rf_write(sc, RT2573_RF1, rfprog[i].r1); 210402ac6454SAndrew Thompson rum_rf_write(sc, RT2573_RF2, rfprog[i].r2); 210502ac6454SAndrew Thompson rum_rf_write(sc, RT2573_RF3, rfprog[i].r3 | power << 7 | 1); 210602ac6454SAndrew Thompson rum_rf_write(sc, RT2573_RF4, rfprog[i].r4 | sc->rffreq << 10); 210702ac6454SAndrew Thompson 210802ac6454SAndrew Thompson rum_rf_write(sc, RT2573_RF1, rfprog[i].r1); 210902ac6454SAndrew Thompson rum_rf_write(sc, RT2573_RF2, rfprog[i].r2); 211002ac6454SAndrew Thompson rum_rf_write(sc, RT2573_RF3, rfprog[i].r3 | power << 7); 211102ac6454SAndrew Thompson rum_rf_write(sc, RT2573_RF4, rfprog[i].r4 | sc->rffreq << 10); 211202ac6454SAndrew Thompson 211302ac6454SAndrew Thompson rum_pause(sc, hz / 100); 211402ac6454SAndrew Thompson 211502ac6454SAndrew Thompson /* enable smart mode for MIMO-capable RFs */ 211602ac6454SAndrew Thompson bbp3 = rum_bbp_read(sc, 3); 211702ac6454SAndrew Thompson 211802ac6454SAndrew Thompson bbp3 &= ~RT2573_SMART_MODE; 211902ac6454SAndrew Thompson if (sc->rf_rev == RT2573_RF_5225 || sc->rf_rev == RT2573_RF_2527) 212002ac6454SAndrew Thompson bbp3 |= RT2573_SMART_MODE; 212102ac6454SAndrew Thompson 212202ac6454SAndrew Thompson rum_bbp_write(sc, 3, bbp3); 212302ac6454SAndrew Thompson 212402ac6454SAndrew Thompson if (bbp94 != RT2573_BBPR94_DEFAULT) 212502ac6454SAndrew Thompson rum_bbp_write(sc, 94, bbp94); 212677ddf3d3SAndrew Thompson 212777ddf3d3SAndrew Thompson /* give the chip some extra time to do the switchover */ 212877ddf3d3SAndrew Thompson rum_pause(sc, hz / 100); 212902ac6454SAndrew Thompson } 213002ac6454SAndrew Thompson 2131342ced03SAdrian Chadd static void 2132342ced03SAdrian Chadd rum_set_maxretry(struct rum_softc *sc, struct ieee80211vap *vap) 2133342ced03SAdrian Chadd { 2134342ced03SAdrian Chadd const struct ieee80211_txparam *tp; 2135342ced03SAdrian Chadd struct ieee80211_node *ni = vap->iv_bss; 2136342ced03SAdrian Chadd struct rum_vap *rvp = RUM_VAP(vap); 2137342ced03SAdrian Chadd 2138342ced03SAdrian Chadd tp = &vap->iv_txparms[ieee80211_chan2mode(ni->ni_chan)]; 2139342ced03SAdrian Chadd rvp->maxretry = tp->maxretry < 0xf ? tp->maxretry : 0xf; 2140342ced03SAdrian Chadd 2141342ced03SAdrian Chadd rum_modbits(sc, RT2573_TXRX_CSR4, RT2573_SHORT_RETRY(rvp->maxretry) | 2142342ced03SAdrian Chadd RT2573_LONG_RETRY(rvp->maxretry), 2143342ced03SAdrian Chadd RT2573_SHORT_RETRY_MASK | RT2573_LONG_RETRY_MASK); 2144342ced03SAdrian Chadd } 2145342ced03SAdrian Chadd 214602ac6454SAndrew Thompson /* 214702ac6454SAndrew Thompson * Enable TSF synchronization and tell h/w to start sending beacons for IBSS 214802ac6454SAndrew Thompson * and HostAP operating modes. 214902ac6454SAndrew Thompson */ 2150aa81f853SAdrian Chadd static int 215102ac6454SAndrew Thompson rum_enable_tsf_sync(struct rum_softc *sc) 215202ac6454SAndrew Thompson { 21537a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 215402ac6454SAndrew Thompson struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 215502ac6454SAndrew Thompson uint32_t tmp; 2156349156a9SAndriy Voskoboinyk uint16_t bintval; 215702ac6454SAndrew Thompson 215802ac6454SAndrew Thompson if (vap->iv_opmode != IEEE80211_M_STA) { 215902ac6454SAndrew Thompson /* 216002ac6454SAndrew Thompson * Change default 16ms TBTT adjustment to 8ms. 216102ac6454SAndrew Thompson * Must be done before enabling beacon generation. 216202ac6454SAndrew Thompson */ 2163aa81f853SAdrian Chadd if (rum_write(sc, RT2573_TXRX_CSR10, 1 << 12 | 8) != 0) 2164aa81f853SAdrian Chadd return EIO; 216502ac6454SAndrew Thompson } 216602ac6454SAndrew Thompson 216702ac6454SAndrew Thompson tmp = rum_read(sc, RT2573_TXRX_CSR9) & 0xff000000; 216802ac6454SAndrew Thompson 216902ac6454SAndrew Thompson /* set beacon interval (in 1/16ms unit) */ 2170349156a9SAndriy Voskoboinyk bintval = vap->iv_bss->ni_intval; 2171349156a9SAndriy Voskoboinyk tmp |= bintval * 16; 2172d847071cSAdrian Chadd tmp |= RT2573_TSF_TIMER_EN | RT2573_TBTT_TIMER_EN; 217302ac6454SAndrew Thompson 2174d847071cSAdrian Chadd switch (vap->iv_opmode) { 2175d847071cSAdrian Chadd case IEEE80211_M_STA: 2176d847071cSAdrian Chadd /* 2177d847071cSAdrian Chadd * Local TSF is always updated with remote TSF on beacon 2178d847071cSAdrian Chadd * reception. 2179d847071cSAdrian Chadd */ 2180d847071cSAdrian Chadd tmp |= RT2573_TSF_SYNC_MODE(RT2573_TSF_SYNC_MODE_STA); 2181d847071cSAdrian Chadd break; 2182d847071cSAdrian Chadd case IEEE80211_M_IBSS: 2183d847071cSAdrian Chadd /* 2184d847071cSAdrian Chadd * Local TSF is updated with remote TSF on beacon reception 2185d847071cSAdrian Chadd * only if the remote TSF is greater than local TSF. 2186d847071cSAdrian Chadd */ 2187d847071cSAdrian Chadd tmp |= RT2573_TSF_SYNC_MODE(RT2573_TSF_SYNC_MODE_IBSS); 2188d847071cSAdrian Chadd tmp |= RT2573_BCN_TX_EN; 2189d847071cSAdrian Chadd break; 2190d847071cSAdrian Chadd case IEEE80211_M_HOSTAP: 2191d847071cSAdrian Chadd /* SYNC with nobody */ 2192d847071cSAdrian Chadd tmp |= RT2573_TSF_SYNC_MODE(RT2573_TSF_SYNC_MODE_HOSTAP); 2193d847071cSAdrian Chadd tmp |= RT2573_BCN_TX_EN; 2194d847071cSAdrian Chadd break; 2195d847071cSAdrian Chadd default: 2196d847071cSAdrian Chadd device_printf(sc->sc_dev, 2197d847071cSAdrian Chadd "Enabling TSF failed. undefined opmode %d\n", 2198d847071cSAdrian Chadd vap->iv_opmode); 2199aa81f853SAdrian Chadd return EINVAL; 2200d847071cSAdrian Chadd } 220102ac6454SAndrew Thompson 2202aa81f853SAdrian Chadd if (rum_write(sc, RT2573_TXRX_CSR9, tmp) != 0) 2203aa81f853SAdrian Chadd return EIO; 2204aa81f853SAdrian Chadd 2205349156a9SAndriy Voskoboinyk /* refresh current sleep time */ 2206349156a9SAndriy Voskoboinyk return (rum_set_sleep_time(sc, bintval)); 220702ac6454SAndrew Thompson } 220802ac6454SAndrew Thompson 220902ac6454SAndrew Thompson static void 22105463c4a4SSam Leffler rum_enable_tsf(struct rum_softc *sc) 22115463c4a4SSam Leffler { 2212d847071cSAdrian Chadd rum_modbits(sc, RT2573_TXRX_CSR9, RT2573_TSF_TIMER_EN | 2213d847071cSAdrian Chadd RT2573_TSF_SYNC_MODE(RT2573_TSF_SYNC_MODE_DIS), 0x00ffffff); 22145463c4a4SSam Leffler } 22155463c4a4SSam Leffler 22165463c4a4SSam Leffler static void 22176d804321SAdrian Chadd rum_abort_tsf_sync(struct rum_softc *sc) 22186d804321SAdrian Chadd { 2219a05022b2SAdrian Chadd rum_clrbits(sc, RT2573_TXRX_CSR9, 0x00ffffff); 22206d804321SAdrian Chadd } 22216d804321SAdrian Chadd 22226d804321SAdrian Chadd static void 2223a6ccd477SAdrian Chadd rum_get_tsf(struct rum_softc *sc, uint64_t *buf) 2224a6ccd477SAdrian Chadd { 2225a6ccd477SAdrian Chadd rum_read_multi(sc, RT2573_TXRX_CSR12, buf, sizeof (*buf)); 2226a6ccd477SAdrian Chadd } 2227a6ccd477SAdrian Chadd 2228a6ccd477SAdrian Chadd static void 2229ed5711a1SAdrian Chadd rum_update_slot_cb(struct rum_softc *sc, union sec_param *data, uint8_t rvp_id) 223002ac6454SAndrew Thompson { 22317a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 223202ac6454SAndrew Thompson uint8_t slottime; 223302ac6454SAndrew Thompson 2234bdfff33fSAndriy Voskoboinyk slottime = IEEE80211_GET_SLOTTIME(ic); 223502ac6454SAndrew Thompson 2236a05022b2SAdrian Chadd rum_modbits(sc, RT2573_MAC_CSR9, slottime, 0xff); 223702ac6454SAndrew Thompson 223802ac6454SAndrew Thompson DPRINTF("setting slot time to %uus\n", slottime); 223902ac6454SAndrew Thompson } 224002ac6454SAndrew Thompson 224102ac6454SAndrew Thompson static void 2242a19dbd8dSAdrian Chadd rum_update_slot(struct ieee80211com *ic) 2243a19dbd8dSAdrian Chadd { 2244ed5711a1SAdrian Chadd rum_cmd_sleepable(ic->ic_softc, NULL, 0, 0, rum_update_slot_cb); 2245a19dbd8dSAdrian Chadd } 2246a19dbd8dSAdrian Chadd 2247a14954c5SAndriy Voskoboinyk static int 2248a14954c5SAndriy Voskoboinyk rum_wme_update(struct ieee80211com *ic) 22491354b52cSAdrian Chadd { 22507682e597SAdrian Chadd const struct wmeParams *chanp = 22517682e597SAdrian Chadd ic->ic_wme.wme_chanParams.cap_wmeParams; 2252a14954c5SAndriy Voskoboinyk struct rum_softc *sc = ic->ic_softc; 22531354b52cSAdrian Chadd int error = 0; 22541354b52cSAdrian Chadd 2255a14954c5SAndriy Voskoboinyk RUM_LOCK(sc); 22561354b52cSAdrian Chadd error = rum_write(sc, RT2573_AIFSN_CSR, 22577682e597SAdrian Chadd chanp[WME_AC_VO].wmep_aifsn << 12 | 22587682e597SAdrian Chadd chanp[WME_AC_VI].wmep_aifsn << 8 | 22597682e597SAdrian Chadd chanp[WME_AC_BK].wmep_aifsn << 4 | 22607682e597SAdrian Chadd chanp[WME_AC_BE].wmep_aifsn); 22611354b52cSAdrian Chadd if (error) 22621354b52cSAdrian Chadd goto print_err; 22631354b52cSAdrian Chadd error = rum_write(sc, RT2573_CWMIN_CSR, 22647682e597SAdrian Chadd chanp[WME_AC_VO].wmep_logcwmin << 12 | 22657682e597SAdrian Chadd chanp[WME_AC_VI].wmep_logcwmin << 8 | 22667682e597SAdrian Chadd chanp[WME_AC_BK].wmep_logcwmin << 4 | 22677682e597SAdrian Chadd chanp[WME_AC_BE].wmep_logcwmin); 22681354b52cSAdrian Chadd if (error) 22691354b52cSAdrian Chadd goto print_err; 22701354b52cSAdrian Chadd error = rum_write(sc, RT2573_CWMAX_CSR, 22717682e597SAdrian Chadd chanp[WME_AC_VO].wmep_logcwmax << 12 | 22727682e597SAdrian Chadd chanp[WME_AC_VI].wmep_logcwmax << 8 | 22737682e597SAdrian Chadd chanp[WME_AC_BK].wmep_logcwmax << 4 | 22747682e597SAdrian Chadd chanp[WME_AC_BE].wmep_logcwmax); 22751354b52cSAdrian Chadd if (error) 22761354b52cSAdrian Chadd goto print_err; 22771354b52cSAdrian Chadd error = rum_write(sc, RT2573_TXOP01_CSR, 22787682e597SAdrian Chadd chanp[WME_AC_BK].wmep_txopLimit << 16 | 22797682e597SAdrian Chadd chanp[WME_AC_BE].wmep_txopLimit); 22801354b52cSAdrian Chadd if (error) 22811354b52cSAdrian Chadd goto print_err; 22821354b52cSAdrian Chadd error = rum_write(sc, RT2573_TXOP23_CSR, 22837682e597SAdrian Chadd chanp[WME_AC_VO].wmep_txopLimit << 16 | 22847682e597SAdrian Chadd chanp[WME_AC_VI].wmep_txopLimit); 22851354b52cSAdrian Chadd if (error) 22861354b52cSAdrian Chadd goto print_err; 22871354b52cSAdrian Chadd 22881354b52cSAdrian Chadd memcpy(sc->wme_params, chanp, sizeof(*chanp) * WME_NUM_AC); 22891354b52cSAdrian Chadd 22901354b52cSAdrian Chadd print_err: 2291a14954c5SAndriy Voskoboinyk RUM_UNLOCK(sc); 2292a14954c5SAndriy Voskoboinyk if (error != 0) { 22931354b52cSAdrian Chadd device_printf(sc->sc_dev, "%s: WME update failed, error %d\n", 22941354b52cSAdrian Chadd __func__, error); 22951354b52cSAdrian Chadd } 22961354b52cSAdrian Chadd 2297a14954c5SAndriy Voskoboinyk return (error); 22981354b52cSAdrian Chadd } 22991354b52cSAdrian Chadd 23001354b52cSAdrian Chadd static void 230102ac6454SAndrew Thompson rum_set_bssid(struct rum_softc *sc, const uint8_t *bssid) 230202ac6454SAndrew Thompson { 230302ac6454SAndrew Thompson 230442769826SAdrian Chadd rum_write(sc, RT2573_MAC_CSR4, 230542769826SAdrian Chadd bssid[0] | bssid[1] << 8 | bssid[2] << 16 | bssid[3] << 24); 230642769826SAdrian Chadd rum_write(sc, RT2573_MAC_CSR5, 230742769826SAdrian Chadd bssid[4] | bssid[5] << 8 | RT2573_NUM_BSSID_MSK(1)); 230802ac6454SAndrew Thompson } 230902ac6454SAndrew Thompson 231002ac6454SAndrew Thompson static void 231102ac6454SAndrew Thompson rum_set_macaddr(struct rum_softc *sc, const uint8_t *addr) 231202ac6454SAndrew Thompson { 231302ac6454SAndrew Thompson 231442769826SAdrian Chadd rum_write(sc, RT2573_MAC_CSR2, 231542769826SAdrian Chadd addr[0] | addr[1] << 8 | addr[2] << 16 | addr[3] << 24); 231642769826SAdrian Chadd rum_write(sc, RT2573_MAC_CSR3, 231742769826SAdrian Chadd addr[4] | addr[5] << 8 | 0xff << 16); 231802ac6454SAndrew Thompson } 231902ac6454SAndrew Thompson 232002ac6454SAndrew Thompson static void 23215efea30fSAndrew Thompson rum_setpromisc(struct rum_softc *sc) 232202ac6454SAndrew Thompson { 2323a05022b2SAdrian Chadd struct ieee80211com *ic = &sc->sc_ic; 232402ac6454SAndrew Thompson 2325a05022b2SAdrian Chadd if (ic->ic_promisc == 0) 2326a05022b2SAdrian Chadd rum_setbits(sc, RT2573_TXRX_CSR0, RT2573_DROP_NOT_TO_ME); 2327a05022b2SAdrian Chadd else 2328a05022b2SAdrian Chadd rum_clrbits(sc, RT2573_TXRX_CSR0, RT2573_DROP_NOT_TO_ME); 232902ac6454SAndrew Thompson 2330a05022b2SAdrian Chadd DPRINTF("%s promiscuous mode\n", ic->ic_promisc > 0 ? 233102ac6454SAndrew Thompson "entering" : "leaving"); 233202ac6454SAndrew Thompson } 233302ac6454SAndrew Thompson 233477ddf3d3SAndrew Thompson static void 2335272f6adeSGleb Smirnoff rum_update_promisc(struct ieee80211com *ic) 233677ddf3d3SAndrew Thompson { 2337272f6adeSGleb Smirnoff struct rum_softc *sc = ic->ic_softc; 233877ddf3d3SAndrew Thompson 2339ba2c1fbcSAdrian Chadd RUM_LOCK(sc); 234042769826SAdrian Chadd if (sc->sc_running) 23415efea30fSAndrew Thompson rum_setpromisc(sc); 234277ddf3d3SAndrew Thompson RUM_UNLOCK(sc); 234377ddf3d3SAndrew Thompson } 234477ddf3d3SAndrew Thompson 23456dd8e071SEd Maste static void 2346272f6adeSGleb Smirnoff rum_update_mcast(struct ieee80211com *ic) 23476dd8e071SEd Maste { 2348e7b7db3dSAdrian Chadd /* Ignore. */ 23496dd8e071SEd Maste } 23506dd8e071SEd Maste 235102ac6454SAndrew Thompson static const char * 235202ac6454SAndrew Thompson rum_get_rf(int rev) 235302ac6454SAndrew Thompson { 235402ac6454SAndrew Thompson switch (rev) { 235502ac6454SAndrew Thompson case RT2573_RF_2527: return "RT2527 (MIMO XR)"; 235602ac6454SAndrew Thompson case RT2573_RF_2528: return "RT2528"; 235702ac6454SAndrew Thompson case RT2573_RF_5225: return "RT5225 (MIMO XR)"; 235802ac6454SAndrew Thompson case RT2573_RF_5226: return "RT5226"; 235902ac6454SAndrew Thompson default: return "unknown"; 236002ac6454SAndrew Thompson } 236102ac6454SAndrew Thompson } 236202ac6454SAndrew Thompson 236302ac6454SAndrew Thompson static void 236402ac6454SAndrew Thompson rum_read_eeprom(struct rum_softc *sc) 236502ac6454SAndrew Thompson { 236602ac6454SAndrew Thompson uint16_t val; 236702ac6454SAndrew Thompson #ifdef RUM_DEBUG 236802ac6454SAndrew Thompson int i; 236902ac6454SAndrew Thompson #endif 237002ac6454SAndrew Thompson 237102ac6454SAndrew Thompson /* read MAC address */ 23727a79cebfSGleb Smirnoff rum_eeprom_read(sc, RT2573_EEPROM_ADDRESS, sc->sc_ic.ic_macaddr, 6); 237302ac6454SAndrew Thompson 237402ac6454SAndrew Thompson rum_eeprom_read(sc, RT2573_EEPROM_ANTENNA, &val, 2); 237502ac6454SAndrew Thompson val = le16toh(val); 237602ac6454SAndrew Thompson sc->rf_rev = (val >> 11) & 0x1f; 237702ac6454SAndrew Thompson sc->hw_radio = (val >> 10) & 0x1; 237802ac6454SAndrew Thompson sc->rx_ant = (val >> 4) & 0x3; 237902ac6454SAndrew Thompson sc->tx_ant = (val >> 2) & 0x3; 238002ac6454SAndrew Thompson sc->nb_ant = val & 0x3; 238102ac6454SAndrew Thompson 238202ac6454SAndrew Thompson DPRINTF("RF revision=%d\n", sc->rf_rev); 238302ac6454SAndrew Thompson 238402ac6454SAndrew Thompson rum_eeprom_read(sc, RT2573_EEPROM_CONFIG2, &val, 2); 238502ac6454SAndrew Thompson val = le16toh(val); 238602ac6454SAndrew Thompson sc->ext_5ghz_lna = (val >> 6) & 0x1; 238702ac6454SAndrew Thompson sc->ext_2ghz_lna = (val >> 4) & 0x1; 238802ac6454SAndrew Thompson 238902ac6454SAndrew Thompson DPRINTF("External 2GHz LNA=%d\nExternal 5GHz LNA=%d\n", 239002ac6454SAndrew Thompson sc->ext_2ghz_lna, sc->ext_5ghz_lna); 239102ac6454SAndrew Thompson 239202ac6454SAndrew Thompson rum_eeprom_read(sc, RT2573_EEPROM_RSSI_2GHZ_OFFSET, &val, 2); 239302ac6454SAndrew Thompson val = le16toh(val); 239402ac6454SAndrew Thompson if ((val & 0xff) != 0xff) 239502ac6454SAndrew Thompson sc->rssi_2ghz_corr = (int8_t)(val & 0xff); /* signed */ 239602ac6454SAndrew Thompson 239702ac6454SAndrew Thompson /* Only [-10, 10] is valid */ 239802ac6454SAndrew Thompson if (sc->rssi_2ghz_corr < -10 || sc->rssi_2ghz_corr > 10) 239902ac6454SAndrew Thompson sc->rssi_2ghz_corr = 0; 240002ac6454SAndrew Thompson 240102ac6454SAndrew Thompson rum_eeprom_read(sc, RT2573_EEPROM_RSSI_5GHZ_OFFSET, &val, 2); 240202ac6454SAndrew Thompson val = le16toh(val); 240302ac6454SAndrew Thompson if ((val & 0xff) != 0xff) 240402ac6454SAndrew Thompson sc->rssi_5ghz_corr = (int8_t)(val & 0xff); /* signed */ 240502ac6454SAndrew Thompson 240602ac6454SAndrew Thompson /* Only [-10, 10] is valid */ 240702ac6454SAndrew Thompson if (sc->rssi_5ghz_corr < -10 || sc->rssi_5ghz_corr > 10) 240802ac6454SAndrew Thompson sc->rssi_5ghz_corr = 0; 240902ac6454SAndrew Thompson 241002ac6454SAndrew Thompson if (sc->ext_2ghz_lna) 241102ac6454SAndrew Thompson sc->rssi_2ghz_corr -= 14; 241202ac6454SAndrew Thompson if (sc->ext_5ghz_lna) 241302ac6454SAndrew Thompson sc->rssi_5ghz_corr -= 14; 241402ac6454SAndrew Thompson 241502ac6454SAndrew Thompson DPRINTF("RSSI 2GHz corr=%d\nRSSI 5GHz corr=%d\n", 241602ac6454SAndrew Thompson sc->rssi_2ghz_corr, sc->rssi_5ghz_corr); 241702ac6454SAndrew Thompson 241802ac6454SAndrew Thompson rum_eeprom_read(sc, RT2573_EEPROM_FREQ_OFFSET, &val, 2); 241902ac6454SAndrew Thompson val = le16toh(val); 242002ac6454SAndrew Thompson if ((val & 0xff) != 0xff) 242102ac6454SAndrew Thompson sc->rffreq = val & 0xff; 242202ac6454SAndrew Thompson 242302ac6454SAndrew Thompson DPRINTF("RF freq=%d\n", sc->rffreq); 242402ac6454SAndrew Thompson 242502ac6454SAndrew Thompson /* read Tx power for all a/b/g channels */ 242602ac6454SAndrew Thompson rum_eeprom_read(sc, RT2573_EEPROM_TXPOWER, sc->txpow, 14); 242702ac6454SAndrew Thompson /* XXX default Tx power for 802.11a channels */ 242802ac6454SAndrew Thompson memset(sc->txpow + 14, 24, sizeof (sc->txpow) - 14); 242902ac6454SAndrew Thompson #ifdef RUM_DEBUG 243002ac6454SAndrew Thompson for (i = 0; i < 14; i++) 243102ac6454SAndrew Thompson DPRINTF("Channel=%d Tx power=%d\n", i + 1, sc->txpow[i]); 243202ac6454SAndrew Thompson #endif 243302ac6454SAndrew Thompson 243402ac6454SAndrew Thompson /* read default values for BBP registers */ 243502ac6454SAndrew Thompson rum_eeprom_read(sc, RT2573_EEPROM_BBP_BASE, sc->bbp_prom, 2 * 16); 243602ac6454SAndrew Thompson #ifdef RUM_DEBUG 243702ac6454SAndrew Thompson for (i = 0; i < 14; i++) { 243802ac6454SAndrew Thompson if (sc->bbp_prom[i].reg == 0 || sc->bbp_prom[i].reg == 0xff) 243902ac6454SAndrew Thompson continue; 244002ac6454SAndrew Thompson DPRINTF("BBP R%d=%02x\n", sc->bbp_prom[i].reg, 244102ac6454SAndrew Thompson sc->bbp_prom[i].val); 244202ac6454SAndrew Thompson } 244302ac6454SAndrew Thompson #endif 244402ac6454SAndrew Thompson } 244502ac6454SAndrew Thompson 244602ac6454SAndrew Thompson static int 24476095f7caSAdrian Chadd rum_bbp_wakeup(struct rum_softc *sc) 24486095f7caSAdrian Chadd { 24496095f7caSAdrian Chadd unsigned int ntries; 24506095f7caSAdrian Chadd 24516095f7caSAdrian Chadd for (ntries = 0; ntries < 100; ntries++) { 24526095f7caSAdrian Chadd if (rum_read(sc, RT2573_MAC_CSR12) & 8) 24536095f7caSAdrian Chadd break; 24546095f7caSAdrian Chadd rum_write(sc, RT2573_MAC_CSR12, 4); /* force wakeup */ 24556095f7caSAdrian Chadd if (rum_pause(sc, hz / 100)) 24566095f7caSAdrian Chadd break; 24576095f7caSAdrian Chadd } 24586095f7caSAdrian Chadd if (ntries == 100) { 24596095f7caSAdrian Chadd device_printf(sc->sc_dev, 24606095f7caSAdrian Chadd "timeout waiting for BBP/RF to wakeup\n"); 24616095f7caSAdrian Chadd return (ETIMEDOUT); 24626095f7caSAdrian Chadd } 24636095f7caSAdrian Chadd 24646095f7caSAdrian Chadd return (0); 24656095f7caSAdrian Chadd } 24666095f7caSAdrian Chadd 24676095f7caSAdrian Chadd static int 246802ac6454SAndrew Thompson rum_bbp_init(struct rum_softc *sc) 246902ac6454SAndrew Thompson { 247002ac6454SAndrew Thompson int i, ntries; 247102ac6454SAndrew Thompson 247202ac6454SAndrew Thompson /* wait for BBP to be ready */ 247302ac6454SAndrew Thompson for (ntries = 0; ntries < 100; ntries++) { 247402ac6454SAndrew Thompson const uint8_t val = rum_bbp_read(sc, 0); 247502ac6454SAndrew Thompson if (val != 0 && val != 0xff) 247602ac6454SAndrew Thompson break; 247702ac6454SAndrew Thompson if (rum_pause(sc, hz / 100)) 247802ac6454SAndrew Thompson break; 247902ac6454SAndrew Thompson } 248002ac6454SAndrew Thompson if (ntries == 100) { 248102ac6454SAndrew Thompson device_printf(sc->sc_dev, "timeout waiting for BBP\n"); 248202ac6454SAndrew Thompson return EIO; 248302ac6454SAndrew Thompson } 248402ac6454SAndrew Thompson 248502ac6454SAndrew Thompson /* initialize BBP registers to default values */ 2486e7b7db3dSAdrian Chadd for (i = 0; i < nitems(rum_def_bbp); i++) 248702ac6454SAndrew Thompson rum_bbp_write(sc, rum_def_bbp[i].reg, rum_def_bbp[i].val); 248802ac6454SAndrew Thompson 248902ac6454SAndrew Thompson /* write vendor-specific BBP values (from EEPROM) */ 249002ac6454SAndrew Thompson for (i = 0; i < 16; i++) { 249102ac6454SAndrew Thompson if (sc->bbp_prom[i].reg == 0 || sc->bbp_prom[i].reg == 0xff) 249202ac6454SAndrew Thompson continue; 249302ac6454SAndrew Thompson rum_bbp_write(sc, sc->bbp_prom[i].reg, sc->bbp_prom[i].val); 249402ac6454SAndrew Thompson } 249502ac6454SAndrew Thompson 249602ac6454SAndrew Thompson return 0; 249702ac6454SAndrew Thompson } 249802ac6454SAndrew Thompson 24992cb9ef8dSAdrian Chadd static void 25002cb9ef8dSAdrian Chadd rum_clr_shkey_regs(struct rum_softc *sc) 25012cb9ef8dSAdrian Chadd { 25022cb9ef8dSAdrian Chadd rum_write(sc, RT2573_SEC_CSR0, 0); 25032cb9ef8dSAdrian Chadd rum_write(sc, RT2573_SEC_CSR1, 0); 25042cb9ef8dSAdrian Chadd rum_write(sc, RT2573_SEC_CSR5, 0); 25052cb9ef8dSAdrian Chadd } 25062cb9ef8dSAdrian Chadd 25070698c0b3SAdrian Chadd static int 25087a79cebfSGleb Smirnoff rum_init(struct rum_softc *sc) 250902ac6454SAndrew Thompson { 25107a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 25117a79cebfSGleb Smirnoff struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 251202ac6454SAndrew Thompson uint32_t tmp; 25136095f7caSAdrian Chadd int i, ret; 251402ac6454SAndrew Thompson 25150698c0b3SAdrian Chadd RUM_LOCK(sc); 25160698c0b3SAdrian Chadd if (sc->sc_running) { 25170698c0b3SAdrian Chadd ret = 0; 25180698c0b3SAdrian Chadd goto end; 25190698c0b3SAdrian Chadd } 252002ac6454SAndrew Thompson 252102ac6454SAndrew Thompson /* initialize MAC registers to default values */ 2522e7b7db3dSAdrian Chadd for (i = 0; i < nitems(rum_def_mac); i++) 252302ac6454SAndrew Thompson rum_write(sc, rum_def_mac[i].reg, rum_def_mac[i].val); 252402ac6454SAndrew Thompson 25251354b52cSAdrian Chadd /* reset some WME parameters to default values */ 25261354b52cSAdrian Chadd sc->wme_params[0].wmep_aifsn = 2; 25271354b52cSAdrian Chadd sc->wme_params[0].wmep_logcwmin = 4; 25281354b52cSAdrian Chadd sc->wme_params[0].wmep_logcwmax = 10; 25291354b52cSAdrian Chadd 253002ac6454SAndrew Thompson /* set host ready */ 2531e7b7db3dSAdrian Chadd rum_write(sc, RT2573_MAC_CSR1, RT2573_RESET_ASIC | RT2573_RESET_BBP); 253202ac6454SAndrew Thompson rum_write(sc, RT2573_MAC_CSR1, 0); 253302ac6454SAndrew Thompson 253402ac6454SAndrew Thompson /* wait for BBP/RF to wakeup */ 25356095f7caSAdrian Chadd if ((ret = rum_bbp_wakeup(sc)) != 0) 25360698c0b3SAdrian Chadd goto end; 253702ac6454SAndrew Thompson 25380698c0b3SAdrian Chadd if ((ret = rum_bbp_init(sc)) != 0) 25390698c0b3SAdrian Chadd goto end; 254002ac6454SAndrew Thompson 254102ac6454SAndrew Thompson /* select default channel */ 254202ac6454SAndrew Thompson rum_select_band(sc, ic->ic_curchan); 254302ac6454SAndrew Thompson rum_select_antenna(sc); 254402ac6454SAndrew Thompson rum_set_chan(sc, ic->ic_curchan); 254502ac6454SAndrew Thompson 254602ac6454SAndrew Thompson /* clear STA registers */ 254702ac6454SAndrew Thompson rum_read_multi(sc, RT2573_STA_CSR0, sc->sta, sizeof sc->sta); 254802ac6454SAndrew Thompson 25492cb9ef8dSAdrian Chadd /* clear security registers (if required) */ 25502cb9ef8dSAdrian Chadd if (sc->sc_clr_shkeys == 0) { 25512cb9ef8dSAdrian Chadd rum_clr_shkey_regs(sc); 25522cb9ef8dSAdrian Chadd sc->sc_clr_shkeys = 1; 25532cb9ef8dSAdrian Chadd } 25542cb9ef8dSAdrian Chadd 25557a79cebfSGleb Smirnoff rum_set_macaddr(sc, vap ? vap->iv_myaddr : ic->ic_macaddr); 255602ac6454SAndrew Thompson 255702ac6454SAndrew Thompson /* initialize ASIC */ 2558e7b7db3dSAdrian Chadd rum_write(sc, RT2573_MAC_CSR1, RT2573_HOST_READY); 255902ac6454SAndrew Thompson 256002ac6454SAndrew Thompson /* 256102ac6454SAndrew Thompson * Allocate Tx and Rx xfer queues. 256202ac6454SAndrew Thompson */ 256302ac6454SAndrew Thompson rum_setup_tx_list(sc); 256402ac6454SAndrew Thompson 256502ac6454SAndrew Thompson /* update Rx filter */ 256602ac6454SAndrew Thompson tmp = rum_read(sc, RT2573_TXRX_CSR0) & 0xffff; 256702ac6454SAndrew Thompson 256802ac6454SAndrew Thompson tmp |= RT2573_DROP_PHY_ERROR | RT2573_DROP_CRC_ERROR; 256902ac6454SAndrew Thompson if (ic->ic_opmode != IEEE80211_M_MONITOR) { 257002ac6454SAndrew Thompson tmp |= RT2573_DROP_CTL | RT2573_DROP_VER_ERROR | 257102ac6454SAndrew Thompson RT2573_DROP_ACKCTS; 257202ac6454SAndrew Thompson if (ic->ic_opmode != IEEE80211_M_HOSTAP) 257302ac6454SAndrew Thompson tmp |= RT2573_DROP_TODS; 25747a79cebfSGleb Smirnoff if (ic->ic_promisc == 0) 257502ac6454SAndrew Thompson tmp |= RT2573_DROP_NOT_TO_ME; 257602ac6454SAndrew Thompson } 257702ac6454SAndrew Thompson rum_write(sc, RT2573_TXRX_CSR0, tmp); 257802ac6454SAndrew Thompson 25797a79cebfSGleb Smirnoff sc->sc_running = 1; 2580ed6d949aSAndrew Thompson usbd_xfer_set_stall(sc->sc_xfer[RUM_BULK_WR]); 2581a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[RUM_BULK_RD]); 258202ac6454SAndrew Thompson 25830698c0b3SAdrian Chadd end: RUM_UNLOCK(sc); 25840698c0b3SAdrian Chadd 25850698c0b3SAdrian Chadd if (ret != 0) 25860698c0b3SAdrian Chadd rum_stop(sc); 25870698c0b3SAdrian Chadd 25880698c0b3SAdrian Chadd return ret; 258902ac6454SAndrew Thompson } 259002ac6454SAndrew Thompson 259102ac6454SAndrew Thompson static void 25925efea30fSAndrew Thompson rum_stop(struct rum_softc *sc) 259302ac6454SAndrew Thompson { 259402ac6454SAndrew Thompson 25950698c0b3SAdrian Chadd RUM_LOCK(sc); 25960698c0b3SAdrian Chadd if (!sc->sc_running) { 25970698c0b3SAdrian Chadd RUM_UNLOCK(sc); 25980698c0b3SAdrian Chadd return; 25990698c0b3SAdrian Chadd } 26007a79cebfSGleb Smirnoff sc->sc_running = 0; 260102ac6454SAndrew Thompson RUM_UNLOCK(sc); 260202ac6454SAndrew Thompson 260302ac6454SAndrew Thompson /* 260402ac6454SAndrew Thompson * Drain the USB transfers, if not already drained: 260502ac6454SAndrew Thompson */ 2606a593f6b8SAndrew Thompson usbd_transfer_drain(sc->sc_xfer[RUM_BULK_WR]); 2607a593f6b8SAndrew Thompson usbd_transfer_drain(sc->sc_xfer[RUM_BULK_RD]); 260802ac6454SAndrew Thompson 260902ac6454SAndrew Thompson RUM_LOCK(sc); 261002ac6454SAndrew Thompson rum_unsetup_tx_list(sc); 261102ac6454SAndrew Thompson 261202ac6454SAndrew Thompson /* disable Rx */ 2613a05022b2SAdrian Chadd rum_setbits(sc, RT2573_TXRX_CSR0, RT2573_DISABLE_RX); 261402ac6454SAndrew Thompson 261502ac6454SAndrew Thompson /* reset ASIC */ 2616e7b7db3dSAdrian Chadd rum_write(sc, RT2573_MAC_CSR1, RT2573_RESET_ASIC | RT2573_RESET_BBP); 261702ac6454SAndrew Thompson rum_write(sc, RT2573_MAC_CSR1, 0); 26180698c0b3SAdrian Chadd RUM_UNLOCK(sc); 261902ac6454SAndrew Thompson } 262002ac6454SAndrew Thompson 262177ddf3d3SAndrew Thompson static void 262277ddf3d3SAndrew Thompson rum_load_microcode(struct rum_softc *sc, const uint8_t *ucode, size_t size) 262302ac6454SAndrew Thompson { 262402ac6454SAndrew Thompson uint16_t reg = RT2573_MCU_CODE_BASE; 2625e0a69b51SAndrew Thompson usb_error_t err; 262602ac6454SAndrew Thompson 262702ac6454SAndrew Thompson /* copy firmware image into NIC */ 262877ddf3d3SAndrew Thompson for (; size >= 4; reg += 4, ucode += 4, size -= 4) { 262977ddf3d3SAndrew Thompson err = rum_write(sc, reg, UGETDW(ucode)); 263077ddf3d3SAndrew Thompson if (err) { 263177ddf3d3SAndrew Thompson /* firmware already loaded ? */ 263277ddf3d3SAndrew Thompson device_printf(sc->sc_dev, "Firmware load " 263377ddf3d3SAndrew Thompson "failure! (ignored)\n"); 263477ddf3d3SAndrew Thompson break; 263577ddf3d3SAndrew Thompson } 263677ddf3d3SAndrew Thompson } 263702ac6454SAndrew Thompson 2638fd7dae9cSAndriy Voskoboinyk err = rum_do_mcu_request(sc, RT2573_MCU_RUN); 2639fd7dae9cSAndriy Voskoboinyk if (err != USB_ERR_NORMAL_COMPLETION) { 264002ac6454SAndrew Thompson device_printf(sc->sc_dev, "could not run firmware: %s\n", 2641a593f6b8SAndrew Thompson usbd_errstr(err)); 264202ac6454SAndrew Thompson } 264377ddf3d3SAndrew Thompson 264477ddf3d3SAndrew Thompson /* give the chip some time to boot */ 264577ddf3d3SAndrew Thompson rum_pause(sc, hz / 8); 264602ac6454SAndrew Thompson } 264702ac6454SAndrew Thompson 2648aa81f853SAdrian Chadd static int 2649349156a9SAndriy Voskoboinyk rum_set_sleep_time(struct rum_softc *sc, uint16_t bintval) 2650349156a9SAndriy Voskoboinyk { 2651349156a9SAndriy Voskoboinyk struct ieee80211com *ic = &sc->sc_ic; 2652349156a9SAndriy Voskoboinyk usb_error_t uerror; 2653349156a9SAndriy Voskoboinyk int exp, delay; 2654349156a9SAndriy Voskoboinyk 2655349156a9SAndriy Voskoboinyk RUM_LOCK_ASSERT(sc); 2656349156a9SAndriy Voskoboinyk 2657349156a9SAndriy Voskoboinyk exp = ic->ic_lintval / bintval; 2658349156a9SAndriy Voskoboinyk delay = ic->ic_lintval % bintval; 2659349156a9SAndriy Voskoboinyk 2660349156a9SAndriy Voskoboinyk if (exp > RT2573_TBCN_EXP_MAX) 2661349156a9SAndriy Voskoboinyk exp = RT2573_TBCN_EXP_MAX; 2662349156a9SAndriy Voskoboinyk if (delay > RT2573_TBCN_DELAY_MAX) 2663349156a9SAndriy Voskoboinyk delay = RT2573_TBCN_DELAY_MAX; 2664349156a9SAndriy Voskoboinyk 2665349156a9SAndriy Voskoboinyk uerror = rum_modbits(sc, RT2573_MAC_CSR11, 2666349156a9SAndriy Voskoboinyk RT2573_TBCN_EXP(exp) | 2667349156a9SAndriy Voskoboinyk RT2573_TBCN_DELAY(delay), 2668349156a9SAndriy Voskoboinyk RT2573_TBCN_EXP(RT2573_TBCN_EXP_MAX) | 2669349156a9SAndriy Voskoboinyk RT2573_TBCN_DELAY(RT2573_TBCN_DELAY_MAX)); 2670349156a9SAndriy Voskoboinyk 2671349156a9SAndriy Voskoboinyk if (uerror != USB_ERR_NORMAL_COMPLETION) 2672349156a9SAndriy Voskoboinyk return (EIO); 2673349156a9SAndriy Voskoboinyk 2674349156a9SAndriy Voskoboinyk sc->sc_sleep_time = IEEE80211_TU_TO_TICKS(exp * bintval + delay); 2675349156a9SAndriy Voskoboinyk 2676349156a9SAndriy Voskoboinyk return (0); 2677349156a9SAndriy Voskoboinyk } 2678349156a9SAndriy Voskoboinyk 2679349156a9SAndriy Voskoboinyk static int 2680349156a9SAndriy Voskoboinyk rum_reset(struct ieee80211vap *vap, u_long cmd) 2681349156a9SAndriy Voskoboinyk { 2682349156a9SAndriy Voskoboinyk struct ieee80211com *ic = vap->iv_ic; 2683349156a9SAndriy Voskoboinyk struct ieee80211_node *ni; 2684349156a9SAndriy Voskoboinyk struct rum_softc *sc = ic->ic_softc; 2685349156a9SAndriy Voskoboinyk int error; 2686349156a9SAndriy Voskoboinyk 2687349156a9SAndriy Voskoboinyk switch (cmd) { 2688349156a9SAndriy Voskoboinyk case IEEE80211_IOC_POWERSAVE: 2689349156a9SAndriy Voskoboinyk error = 0; 2690349156a9SAndriy Voskoboinyk break; 2691349156a9SAndriy Voskoboinyk case IEEE80211_IOC_POWERSAVESLEEP: 2692349156a9SAndriy Voskoboinyk ni = ieee80211_ref_node(vap->iv_bss); 2693349156a9SAndriy Voskoboinyk 2694349156a9SAndriy Voskoboinyk RUM_LOCK(sc); 2695349156a9SAndriy Voskoboinyk error = rum_set_sleep_time(sc, ni->ni_intval); 2696349156a9SAndriy Voskoboinyk if (vap->iv_state == IEEE80211_S_SLEEP) { 2697349156a9SAndriy Voskoboinyk /* Use new values for wakeup timer. */ 2698349156a9SAndriy Voskoboinyk rum_clrbits(sc, RT2573_MAC_CSR11, RT2573_AUTO_WAKEUP); 2699349156a9SAndriy Voskoboinyk rum_setbits(sc, RT2573_MAC_CSR11, RT2573_AUTO_WAKEUP); 2700349156a9SAndriy Voskoboinyk } 2701349156a9SAndriy Voskoboinyk /* XXX send reassoc */ 2702349156a9SAndriy Voskoboinyk RUM_UNLOCK(sc); 2703349156a9SAndriy Voskoboinyk 2704349156a9SAndriy Voskoboinyk ieee80211_free_node(ni); 2705349156a9SAndriy Voskoboinyk break; 2706349156a9SAndriy Voskoboinyk default: 2707349156a9SAndriy Voskoboinyk error = ENETRESET; 2708349156a9SAndriy Voskoboinyk break; 2709349156a9SAndriy Voskoboinyk } 2710349156a9SAndriy Voskoboinyk 2711349156a9SAndriy Voskoboinyk return (error); 2712349156a9SAndriy Voskoboinyk } 2713349156a9SAndriy Voskoboinyk 2714349156a9SAndriy Voskoboinyk static int 2715b780f864SAdrian Chadd rum_set_beacon(struct rum_softc *sc, struct ieee80211vap *vap) 271602ac6454SAndrew Thompson { 271702ac6454SAndrew Thompson struct ieee80211com *ic = vap->iv_ic; 2718b780f864SAdrian Chadd struct rum_vap *rvp = RUM_VAP(vap); 2719b780f864SAdrian Chadd struct mbuf *m = rvp->bcn_mbuf; 272002ac6454SAndrew Thompson const struct ieee80211_txparam *tp; 272102ac6454SAndrew Thompson struct rum_tx_desc desc; 272202ac6454SAndrew Thompson 2723b780f864SAdrian Chadd RUM_LOCK_ASSERT(sc); 2724b780f864SAdrian Chadd 2725b780f864SAdrian Chadd if (m == NULL) 2726aa81f853SAdrian Chadd return EINVAL; 2727bb571462SHans Petter Selasky if (ic->ic_bsschan == IEEE80211_CHAN_ANYC) 2728aa81f853SAdrian Chadd return EINVAL; 2729f620e64dSKevin Lo 273002ac6454SAndrew Thompson tp = &vap->iv_txparms[ieee80211_chan2mode(ic->ic_bsschan)]; 27312cb9ef8dSAdrian Chadd rum_setup_tx_desc(sc, &desc, NULL, RT2573_TX_TIMESTAMP, 27321354b52cSAdrian Chadd RT2573_TX_HWSEQ, 0, 0, m->m_pkthdr.len, tp->mgmtrate); 273302ac6454SAndrew Thompson 2734b780f864SAdrian Chadd /* copy the Tx descriptor into NIC memory */ 2735b780f864SAdrian Chadd if (rum_write_multi(sc, RT2573_HW_BCN_BASE(0), (uint8_t *)&desc, 2736b780f864SAdrian Chadd RT2573_TX_DESC_SIZE) != 0) 2737b780f864SAdrian Chadd return EIO; 273802ac6454SAndrew Thompson 273902ac6454SAndrew Thompson /* copy beacon header and payload into NIC memory */ 2740b780f864SAdrian Chadd if (rum_write_multi(sc, RT2573_HW_BCN_BASE(0) + RT2573_TX_DESC_SIZE, 2741b780f864SAdrian Chadd mtod(m, uint8_t *), m->m_pkthdr.len) != 0) 2742b780f864SAdrian Chadd return EIO; 274302ac6454SAndrew Thompson 2744b780f864SAdrian Chadd return 0; 2745b780f864SAdrian Chadd } 2746b780f864SAdrian Chadd 2747b780f864SAdrian Chadd static int 2748b780f864SAdrian Chadd rum_alloc_beacon(struct rum_softc *sc, struct ieee80211vap *vap) 2749b780f864SAdrian Chadd { 2750b780f864SAdrian Chadd struct rum_vap *rvp = RUM_VAP(vap); 2751b780f864SAdrian Chadd struct ieee80211_node *ni = vap->iv_bss; 2752b780f864SAdrian Chadd struct mbuf *m; 2753b780f864SAdrian Chadd 2754b780f864SAdrian Chadd if (ni->ni_chan == IEEE80211_CHAN_ANYC) 2755b780f864SAdrian Chadd return EINVAL; 2756b780f864SAdrian Chadd 2757210ab3c2SAdrian Chadd m = ieee80211_beacon_alloc(ni); 2758b780f864SAdrian Chadd if (m == NULL) 2759b780f864SAdrian Chadd return ENOMEM; 2760b780f864SAdrian Chadd 2761b780f864SAdrian Chadd if (rvp->bcn_mbuf != NULL) 2762b780f864SAdrian Chadd m_freem(rvp->bcn_mbuf); 2763b780f864SAdrian Chadd 2764b780f864SAdrian Chadd rvp->bcn_mbuf = m; 2765b780f864SAdrian Chadd 2766b780f864SAdrian Chadd return (rum_set_beacon(sc, vap)); 276702ac6454SAndrew Thompson } 276802ac6454SAndrew Thompson 27690e3b4c60SAdrian Chadd static void 27700e3b4c60SAdrian Chadd rum_update_beacon_cb(struct rum_softc *sc, union sec_param *data, 2771ed5711a1SAdrian Chadd uint8_t rvp_id) 27720e3b4c60SAdrian Chadd { 27730e3b4c60SAdrian Chadd struct ieee80211vap *vap = data->vap; 27740e3b4c60SAdrian Chadd 27750e3b4c60SAdrian Chadd rum_set_beacon(sc, vap); 27760e3b4c60SAdrian Chadd } 27770e3b4c60SAdrian Chadd 27780e3b4c60SAdrian Chadd static void 27790e3b4c60SAdrian Chadd rum_update_beacon(struct ieee80211vap *vap, int item) 27800e3b4c60SAdrian Chadd { 27810e3b4c60SAdrian Chadd struct ieee80211com *ic = vap->iv_ic; 27820e3b4c60SAdrian Chadd struct rum_softc *sc = ic->ic_softc; 27830e3b4c60SAdrian Chadd struct rum_vap *rvp = RUM_VAP(vap); 27840e3b4c60SAdrian Chadd struct ieee80211_beacon_offsets *bo = &vap->iv_bcn_off; 27850e3b4c60SAdrian Chadd struct ieee80211_node *ni = vap->iv_bss; 27860e3b4c60SAdrian Chadd struct mbuf *m = rvp->bcn_mbuf; 27870e3b4c60SAdrian Chadd int mcast = 0; 27880e3b4c60SAdrian Chadd 27890e3b4c60SAdrian Chadd RUM_LOCK(sc); 27900e3b4c60SAdrian Chadd if (m == NULL) { 2791210ab3c2SAdrian Chadd m = ieee80211_beacon_alloc(ni); 27920e3b4c60SAdrian Chadd if (m == NULL) { 27930e3b4c60SAdrian Chadd device_printf(sc->sc_dev, 27940e3b4c60SAdrian Chadd "%s: could not allocate beacon frame\n", __func__); 27950e3b4c60SAdrian Chadd RUM_UNLOCK(sc); 27960e3b4c60SAdrian Chadd return; 27970e3b4c60SAdrian Chadd } 27980e3b4c60SAdrian Chadd rvp->bcn_mbuf = m; 27990e3b4c60SAdrian Chadd } 28000e3b4c60SAdrian Chadd 28010e3b4c60SAdrian Chadd switch (item) { 28020e3b4c60SAdrian Chadd case IEEE80211_BEACON_ERP: 28030e3b4c60SAdrian Chadd rum_update_slot(ic); 28040e3b4c60SAdrian Chadd break; 28050e3b4c60SAdrian Chadd case IEEE80211_BEACON_TIM: 28060e3b4c60SAdrian Chadd mcast = 1; /*TODO*/ 28070e3b4c60SAdrian Chadd break; 28080e3b4c60SAdrian Chadd default: 28090e3b4c60SAdrian Chadd break; 28100e3b4c60SAdrian Chadd } 28110e3b4c60SAdrian Chadd RUM_UNLOCK(sc); 28120e3b4c60SAdrian Chadd 28130e3b4c60SAdrian Chadd setbit(bo->bo_flags, item); 2814210ab3c2SAdrian Chadd ieee80211_beacon_update(ni, m, mcast); 28150e3b4c60SAdrian Chadd 2816ed5711a1SAdrian Chadd rum_cmd_sleepable(sc, &vap, sizeof(vap), 0, rum_update_beacon_cb); 28170e3b4c60SAdrian Chadd } 28180e3b4c60SAdrian Chadd 281902ac6454SAndrew Thompson static int 28202cb9ef8dSAdrian Chadd rum_common_key_set(struct rum_softc *sc, struct ieee80211_key *k, 28212cb9ef8dSAdrian Chadd uint16_t base) 28222cb9ef8dSAdrian Chadd { 28232cb9ef8dSAdrian Chadd 28242cb9ef8dSAdrian Chadd if (rum_write_multi(sc, base, k->wk_key, k->wk_keylen)) 28252cb9ef8dSAdrian Chadd return EIO; 28262cb9ef8dSAdrian Chadd 28272cb9ef8dSAdrian Chadd if (k->wk_cipher->ic_cipher == IEEE80211_CIPHER_TKIP) { 28282cb9ef8dSAdrian Chadd if (rum_write_multi(sc, base + IEEE80211_KEYBUF_SIZE, 28292cb9ef8dSAdrian Chadd k->wk_txmic, 8)) 28302cb9ef8dSAdrian Chadd return EIO; 28312cb9ef8dSAdrian Chadd if (rum_write_multi(sc, base + IEEE80211_KEYBUF_SIZE + 8, 28322cb9ef8dSAdrian Chadd k->wk_rxmic, 8)) 28332cb9ef8dSAdrian Chadd return EIO; 28342cb9ef8dSAdrian Chadd } 28352cb9ef8dSAdrian Chadd 28362cb9ef8dSAdrian Chadd return 0; 28372cb9ef8dSAdrian Chadd } 28382cb9ef8dSAdrian Chadd 28392cb9ef8dSAdrian Chadd static void 28402cb9ef8dSAdrian Chadd rum_group_key_set_cb(struct rum_softc *sc, union sec_param *data, 2841ed5711a1SAdrian Chadd uint8_t rvp_id) 28422cb9ef8dSAdrian Chadd { 28432cb9ef8dSAdrian Chadd struct ieee80211_key *k = &data->key; 28442cb9ef8dSAdrian Chadd uint8_t mode; 28452cb9ef8dSAdrian Chadd 28462cb9ef8dSAdrian Chadd if (sc->sc_clr_shkeys == 0) { 28472cb9ef8dSAdrian Chadd rum_clr_shkey_regs(sc); 28482cb9ef8dSAdrian Chadd sc->sc_clr_shkeys = 1; 28492cb9ef8dSAdrian Chadd } 28502cb9ef8dSAdrian Chadd 28512cb9ef8dSAdrian Chadd mode = rum_crypto_mode(sc, k->wk_cipher->ic_cipher, k->wk_keylen); 28522cb9ef8dSAdrian Chadd if (mode == 0) 28532cb9ef8dSAdrian Chadd goto print_err; 28542cb9ef8dSAdrian Chadd 28552cb9ef8dSAdrian Chadd DPRINTFN(1, "setting group key %d for vap %d, mode %d " 28562cb9ef8dSAdrian Chadd "(tx %s, rx %s)\n", k->wk_keyix, rvp_id, mode, 28572cb9ef8dSAdrian Chadd (k->wk_flags & IEEE80211_KEY_XMIT) ? "on" : "off", 28582cb9ef8dSAdrian Chadd (k->wk_flags & IEEE80211_KEY_RECV) ? "on" : "off"); 28592cb9ef8dSAdrian Chadd 28602cb9ef8dSAdrian Chadd /* Install the key. */ 28612cb9ef8dSAdrian Chadd if (rum_common_key_set(sc, k, RT2573_SKEY(rvp_id, k->wk_keyix)) != 0) 28622cb9ef8dSAdrian Chadd goto print_err; 28632cb9ef8dSAdrian Chadd 28642cb9ef8dSAdrian Chadd /* Set cipher mode. */ 28652cb9ef8dSAdrian Chadd if (rum_modbits(sc, rvp_id < 2 ? RT2573_SEC_CSR1 : RT2573_SEC_CSR5, 28662cb9ef8dSAdrian Chadd mode << (rvp_id % 2 + k->wk_keyix) * RT2573_SKEY_MAX, 28672cb9ef8dSAdrian Chadd RT2573_MODE_MASK << (rvp_id % 2 + k->wk_keyix) * RT2573_SKEY_MAX) 28682cb9ef8dSAdrian Chadd != 0) 28692cb9ef8dSAdrian Chadd goto print_err; 28702cb9ef8dSAdrian Chadd 28712cb9ef8dSAdrian Chadd /* Mark this key as valid. */ 28722cb9ef8dSAdrian Chadd if (rum_setbits(sc, RT2573_SEC_CSR0, 28732cb9ef8dSAdrian Chadd 1 << (rvp_id * RT2573_SKEY_MAX + k->wk_keyix)) != 0) 28742cb9ef8dSAdrian Chadd goto print_err; 28752cb9ef8dSAdrian Chadd 28762cb9ef8dSAdrian Chadd return; 28772cb9ef8dSAdrian Chadd 28782cb9ef8dSAdrian Chadd print_err: 28792cb9ef8dSAdrian Chadd device_printf(sc->sc_dev, "%s: cannot set group key %d for vap %d\n", 28802cb9ef8dSAdrian Chadd __func__, k->wk_keyix, rvp_id); 28812cb9ef8dSAdrian Chadd } 28822cb9ef8dSAdrian Chadd 28832cb9ef8dSAdrian Chadd static void 28842cb9ef8dSAdrian Chadd rum_group_key_del_cb(struct rum_softc *sc, union sec_param *data, 2885ed5711a1SAdrian Chadd uint8_t rvp_id) 28862cb9ef8dSAdrian Chadd { 28872cb9ef8dSAdrian Chadd struct ieee80211_key *k = &data->key; 28882cb9ef8dSAdrian Chadd 28892cb9ef8dSAdrian Chadd DPRINTF("%s: removing group key %d for vap %d\n", __func__, 28902cb9ef8dSAdrian Chadd k->wk_keyix, rvp_id); 28912cb9ef8dSAdrian Chadd rum_clrbits(sc, 28922cb9ef8dSAdrian Chadd rvp_id < 2 ? RT2573_SEC_CSR1 : RT2573_SEC_CSR5, 28932cb9ef8dSAdrian Chadd RT2573_MODE_MASK << (rvp_id % 2 + k->wk_keyix) * RT2573_SKEY_MAX); 28942cb9ef8dSAdrian Chadd rum_clrbits(sc, RT2573_SEC_CSR0, 28952cb9ef8dSAdrian Chadd rvp_id * RT2573_SKEY_MAX + k->wk_keyix); 28962cb9ef8dSAdrian Chadd } 28972cb9ef8dSAdrian Chadd 28982cb9ef8dSAdrian Chadd static void 2899ed5711a1SAdrian Chadd rum_pair_key_set_cb(struct rum_softc *sc, union sec_param *data, 29002cb9ef8dSAdrian Chadd uint8_t rvp_id) 29012cb9ef8dSAdrian Chadd { 29022cb9ef8dSAdrian Chadd struct ieee80211_key *k = &data->key; 29032cb9ef8dSAdrian Chadd uint8_t buf[IEEE80211_ADDR_LEN + 1]; 29042cb9ef8dSAdrian Chadd uint8_t mode; 29052cb9ef8dSAdrian Chadd 29062cb9ef8dSAdrian Chadd mode = rum_crypto_mode(sc, k->wk_cipher->ic_cipher, k->wk_keylen); 29072cb9ef8dSAdrian Chadd if (mode == 0) 29082cb9ef8dSAdrian Chadd goto print_err; 29092cb9ef8dSAdrian Chadd 29102cb9ef8dSAdrian Chadd DPRINTFN(1, "setting pairwise key %d for vap %d, mode %d " 29112cb9ef8dSAdrian Chadd "(tx %s, rx %s)\n", k->wk_keyix, rvp_id, mode, 29122cb9ef8dSAdrian Chadd (k->wk_flags & IEEE80211_KEY_XMIT) ? "on" : "off", 29132cb9ef8dSAdrian Chadd (k->wk_flags & IEEE80211_KEY_RECV) ? "on" : "off"); 29142cb9ef8dSAdrian Chadd 29152cb9ef8dSAdrian Chadd /* Install the key. */ 29162cb9ef8dSAdrian Chadd if (rum_common_key_set(sc, k, RT2573_PKEY(k->wk_keyix)) != 0) 29172cb9ef8dSAdrian Chadd goto print_err; 29182cb9ef8dSAdrian Chadd 29192cb9ef8dSAdrian Chadd IEEE80211_ADDR_COPY(buf, k->wk_macaddr); 29202cb9ef8dSAdrian Chadd buf[IEEE80211_ADDR_LEN] = mode; 29212cb9ef8dSAdrian Chadd 29222cb9ef8dSAdrian Chadd /* Set transmitter address and cipher mode. */ 29232cb9ef8dSAdrian Chadd if (rum_write_multi(sc, RT2573_ADDR_ENTRY(k->wk_keyix), 29242cb9ef8dSAdrian Chadd buf, sizeof buf) != 0) 29252cb9ef8dSAdrian Chadd goto print_err; 29262cb9ef8dSAdrian Chadd 29272cb9ef8dSAdrian Chadd /* Enable key table lookup for this vap. */ 29282cb9ef8dSAdrian Chadd if (sc->vap_key_count[rvp_id]++ == 0) 29292cb9ef8dSAdrian Chadd if (rum_setbits(sc, RT2573_SEC_CSR4, 1 << rvp_id) != 0) 29302cb9ef8dSAdrian Chadd goto print_err; 29312cb9ef8dSAdrian Chadd 29322cb9ef8dSAdrian Chadd /* Mark this key as valid. */ 29332cb9ef8dSAdrian Chadd if (rum_setbits(sc, 29342cb9ef8dSAdrian Chadd k->wk_keyix < 32 ? RT2573_SEC_CSR2 : RT2573_SEC_CSR3, 29352cb9ef8dSAdrian Chadd 1 << (k->wk_keyix % 32)) != 0) 29362cb9ef8dSAdrian Chadd goto print_err; 29372cb9ef8dSAdrian Chadd 29382cb9ef8dSAdrian Chadd return; 29392cb9ef8dSAdrian Chadd 29402cb9ef8dSAdrian Chadd print_err: 29412cb9ef8dSAdrian Chadd device_printf(sc->sc_dev, 29422cb9ef8dSAdrian Chadd "%s: cannot set pairwise key %d, vap %d\n", __func__, k->wk_keyix, 29432cb9ef8dSAdrian Chadd rvp_id); 29442cb9ef8dSAdrian Chadd } 29452cb9ef8dSAdrian Chadd 29462cb9ef8dSAdrian Chadd static void 2947ed5711a1SAdrian Chadd rum_pair_key_del_cb(struct rum_softc *sc, union sec_param *data, 29482cb9ef8dSAdrian Chadd uint8_t rvp_id) 29492cb9ef8dSAdrian Chadd { 29502cb9ef8dSAdrian Chadd struct ieee80211_key *k = &data->key; 29512cb9ef8dSAdrian Chadd 29522cb9ef8dSAdrian Chadd DPRINTF("%s: removing key %d\n", __func__, k->wk_keyix); 29532cb9ef8dSAdrian Chadd rum_clrbits(sc, (k->wk_keyix < 32) ? RT2573_SEC_CSR2 : RT2573_SEC_CSR3, 29542cb9ef8dSAdrian Chadd 1 << (k->wk_keyix % 32)); 2955fe3e4523SHans Petter Selasky sc->keys_bmap &= ~(1ULL << k->wk_keyix); 29562cb9ef8dSAdrian Chadd if (--sc->vap_key_count[rvp_id] == 0) 29572cb9ef8dSAdrian Chadd rum_clrbits(sc, RT2573_SEC_CSR4, 1 << rvp_id); 29582cb9ef8dSAdrian Chadd } 29592cb9ef8dSAdrian Chadd 29602cb9ef8dSAdrian Chadd static int 29612cb9ef8dSAdrian Chadd rum_key_alloc(struct ieee80211vap *vap, struct ieee80211_key *k, 29622cb9ef8dSAdrian Chadd ieee80211_keyix *keyix, ieee80211_keyix *rxkeyix) 29632cb9ef8dSAdrian Chadd { 29642cb9ef8dSAdrian Chadd struct rum_softc *sc = vap->iv_ic->ic_softc; 29652cb9ef8dSAdrian Chadd uint8_t i; 29662cb9ef8dSAdrian Chadd 29672cb9ef8dSAdrian Chadd if (!(&vap->iv_nw_keys[0] <= k && 29682cb9ef8dSAdrian Chadd k < &vap->iv_nw_keys[IEEE80211_WEP_NKID])) { 29692cb9ef8dSAdrian Chadd if (!(k->wk_flags & IEEE80211_KEY_SWCRYPT)) { 29702cb9ef8dSAdrian Chadd RUM_LOCK(sc); 29712cb9ef8dSAdrian Chadd for (i = 0; i < RT2573_ADDR_MAX; i++) { 2972fe3e4523SHans Petter Selasky if ((sc->keys_bmap & (1ULL << i)) == 0) { 2973fe3e4523SHans Petter Selasky sc->keys_bmap |= (1ULL << i); 29742cb9ef8dSAdrian Chadd *keyix = i; 29752cb9ef8dSAdrian Chadd break; 29762cb9ef8dSAdrian Chadd } 29772cb9ef8dSAdrian Chadd } 29782cb9ef8dSAdrian Chadd RUM_UNLOCK(sc); 29792cb9ef8dSAdrian Chadd if (i == RT2573_ADDR_MAX) { 29802cb9ef8dSAdrian Chadd device_printf(sc->sc_dev, 29812cb9ef8dSAdrian Chadd "%s: no free space in the key table\n", 29822cb9ef8dSAdrian Chadd __func__); 29832cb9ef8dSAdrian Chadd return 0; 29842cb9ef8dSAdrian Chadd } 29852cb9ef8dSAdrian Chadd } else 29862cb9ef8dSAdrian Chadd *keyix = 0; 29872cb9ef8dSAdrian Chadd } else { 29882cb9ef8dSAdrian Chadd *keyix = k - vap->iv_nw_keys; 29892cb9ef8dSAdrian Chadd } 29902cb9ef8dSAdrian Chadd *rxkeyix = *keyix; 29912cb9ef8dSAdrian Chadd return 1; 29922cb9ef8dSAdrian Chadd } 29932cb9ef8dSAdrian Chadd 29942cb9ef8dSAdrian Chadd static int 2995bc813c40SAdrian Chadd rum_key_set(struct ieee80211vap *vap, const struct ieee80211_key *k) 29962cb9ef8dSAdrian Chadd { 29972cb9ef8dSAdrian Chadd struct rum_softc *sc = vap->iv_ic->ic_softc; 29982cb9ef8dSAdrian Chadd int group; 29992cb9ef8dSAdrian Chadd 30002cb9ef8dSAdrian Chadd if (k->wk_flags & IEEE80211_KEY_SWCRYPT) { 30012cb9ef8dSAdrian Chadd /* Not for us. */ 30022cb9ef8dSAdrian Chadd return 1; 30032cb9ef8dSAdrian Chadd } 30042cb9ef8dSAdrian Chadd 30052cb9ef8dSAdrian Chadd group = k >= &vap->iv_nw_keys[0] && k < &vap->iv_nw_keys[IEEE80211_WEP_NKID]; 30062cb9ef8dSAdrian Chadd 3007ed5711a1SAdrian Chadd return !rum_cmd_sleepable(sc, k, sizeof(*k), 0, 30082cb9ef8dSAdrian Chadd group ? rum_group_key_set_cb : rum_pair_key_set_cb); 30092cb9ef8dSAdrian Chadd } 30102cb9ef8dSAdrian Chadd 30112cb9ef8dSAdrian Chadd static int 30122cb9ef8dSAdrian Chadd rum_key_delete(struct ieee80211vap *vap, const struct ieee80211_key *k) 30132cb9ef8dSAdrian Chadd { 30142cb9ef8dSAdrian Chadd struct rum_softc *sc = vap->iv_ic->ic_softc; 30152cb9ef8dSAdrian Chadd int group; 30162cb9ef8dSAdrian Chadd 30172cb9ef8dSAdrian Chadd if (k->wk_flags & IEEE80211_KEY_SWCRYPT) { 30182cb9ef8dSAdrian Chadd /* Not for us. */ 30192cb9ef8dSAdrian Chadd return 1; 30202cb9ef8dSAdrian Chadd } 30212cb9ef8dSAdrian Chadd 30222cb9ef8dSAdrian Chadd group = k >= &vap->iv_nw_keys[0] && k < &vap->iv_nw_keys[IEEE80211_WEP_NKID]; 30232cb9ef8dSAdrian Chadd 3024ed5711a1SAdrian Chadd return !rum_cmd_sleepable(sc, k, sizeof(*k), 0, 30252cb9ef8dSAdrian Chadd group ? rum_group_key_del_cb : rum_pair_key_del_cb); 30262cb9ef8dSAdrian Chadd } 30272cb9ef8dSAdrian Chadd 30282cb9ef8dSAdrian Chadd static int 302902ac6454SAndrew Thompson rum_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 303002ac6454SAndrew Thompson const struct ieee80211_bpf_params *params) 303102ac6454SAndrew Thompson { 3032d3fdd08cSAdrian Chadd struct rum_softc *sc = ni->ni_ic->ic_softc; 3033b2a76342SAdrian Chadd int ret; 303402ac6454SAndrew Thompson 303502ac6454SAndrew Thompson RUM_LOCK(sc); 303602ac6454SAndrew Thompson /* prevent management frames from being sent if we're not ready */ 30377a79cebfSGleb Smirnoff if (!sc->sc_running) { 3038b2a76342SAdrian Chadd ret = ENETDOWN; 3039b2a76342SAdrian Chadd goto bad; 304002ac6454SAndrew Thompson } 304196ca458fSAndrew Thompson if (sc->tx_nfree < RUM_TX_MINFREE) { 3042b2a76342SAdrian Chadd ret = EIO; 3043b2a76342SAdrian Chadd goto bad; 304402ac6454SAndrew Thompson } 304502ac6454SAndrew Thompson 304602ac6454SAndrew Thompson if (params == NULL) { 304702ac6454SAndrew Thompson /* 304802ac6454SAndrew Thompson * Legacy path; interpret frame contents to decide 304902ac6454SAndrew Thompson * precisely how to send the frame. 305002ac6454SAndrew Thompson */ 3051b2a76342SAdrian Chadd if ((ret = rum_tx_mgt(sc, m, ni)) != 0) 305202ac6454SAndrew Thompson goto bad; 305302ac6454SAndrew Thompson } else { 305402ac6454SAndrew Thompson /* 305502ac6454SAndrew Thompson * Caller supplied explicit parameters to use in 305602ac6454SAndrew Thompson * sending the frame. 305702ac6454SAndrew Thompson */ 3058b2a76342SAdrian Chadd if ((ret = rum_tx_raw(sc, m, ni, params)) != 0) 305902ac6454SAndrew Thompson goto bad; 306002ac6454SAndrew Thompson } 306102ac6454SAndrew Thompson RUM_UNLOCK(sc); 306202ac6454SAndrew Thompson 306302ac6454SAndrew Thompson return 0; 306402ac6454SAndrew Thompson bad: 306502ac6454SAndrew Thompson RUM_UNLOCK(sc); 3066b2a76342SAdrian Chadd m_freem(m); 3067b2a76342SAdrian Chadd return ret; 306802ac6454SAndrew Thompson } 306902ac6454SAndrew Thompson 307002ac6454SAndrew Thompson static void 3071b6108616SRui Paulo rum_ratectl_start(struct rum_softc *sc, struct ieee80211_node *ni) 307202ac6454SAndrew Thompson { 307302ac6454SAndrew Thompson struct ieee80211vap *vap = ni->ni_vap; 307402ac6454SAndrew Thompson struct rum_vap *rvp = RUM_VAP(vap); 307502ac6454SAndrew Thompson 307602ac6454SAndrew Thompson /* clear statistic registers (STA_CSR0 to STA_CSR5) */ 307702ac6454SAndrew Thompson rum_read_multi(sc, RT2573_STA_CSR0, sc->sta, sizeof sc->sta); 307802ac6454SAndrew Thompson 3079b6108616SRui Paulo usb_callout_reset(&rvp->ratectl_ch, hz, rum_ratectl_timeout, rvp); 308002ac6454SAndrew Thompson } 308102ac6454SAndrew Thompson 308202ac6454SAndrew Thompson static void 3083b6108616SRui Paulo rum_ratectl_timeout(void *arg) 308402ac6454SAndrew Thompson { 308502ac6454SAndrew Thompson struct rum_vap *rvp = arg; 30865efea30fSAndrew Thompson struct ieee80211vap *vap = &rvp->vap; 30875efea30fSAndrew Thompson struct ieee80211com *ic = vap->iv_ic; 308802ac6454SAndrew Thompson 3089b6108616SRui Paulo ieee80211_runtask(ic, &rvp->ratectl_task); 309002ac6454SAndrew Thompson } 309102ac6454SAndrew Thompson 309202ac6454SAndrew Thompson static void 3093b6108616SRui Paulo rum_ratectl_task(void *arg, int pending) 309402ac6454SAndrew Thompson { 30955efea30fSAndrew Thompson struct rum_vap *rvp = arg; 30965efea30fSAndrew Thompson struct ieee80211vap *vap = &rvp->vap; 3097f4ac78a2SAdrian Chadd struct rum_softc *sc = vap->iv_ic->ic_softc; 30988d8bdb01SAndrew Thompson struct ieee80211_node *ni; 3099f4ac78a2SAdrian Chadd int ok[3], fail; 3100f4ac78a2SAdrian Chadd int sum, success, retrycnt; 310102ac6454SAndrew Thompson 31025efea30fSAndrew Thompson RUM_LOCK(sc); 3103f4ac78a2SAdrian Chadd /* read and clear statistic registers (STA_CSR0 to STA_CSR5) */ 310402ac6454SAndrew Thompson rum_read_multi(sc, RT2573_STA_CSR0, sc->sta, sizeof(sc->sta)); 310502ac6454SAndrew Thompson 3106f4ac78a2SAdrian Chadd ok[0] = (le32toh(sc->sta[4]) & 0xffff); /* TX ok w/o retry */ 3107f4ac78a2SAdrian Chadd ok[1] = (le32toh(sc->sta[4]) >> 16); /* TX ok w/ one retry */ 3108f4ac78a2SAdrian Chadd ok[2] = (le32toh(sc->sta[5]) & 0xffff); /* TX ok w/ multiple retries */ 310902ac6454SAndrew Thompson fail = (le32toh(sc->sta[5]) >> 16); /* TX retry-fail count */ 311002ac6454SAndrew Thompson 3111f4ac78a2SAdrian Chadd success = ok[0] + ok[1] + ok[2]; 3112f4ac78a2SAdrian Chadd sum = success + fail; 3113f4ac78a2SAdrian Chadd /* XXX at least */ 3114f4ac78a2SAdrian Chadd retrycnt = ok[1] + ok[2] * 2 + fail * (rvp->maxretry + 1); 3115f4ac78a2SAdrian Chadd 3116f4ac78a2SAdrian Chadd if (sum != 0) { 31178d8bdb01SAndrew Thompson ni = ieee80211_ref_node(vap->iv_bss); 3118b6108616SRui Paulo ieee80211_ratectl_tx_update(vap, ni, &sum, &ok, &retrycnt); 3119b6108616SRui Paulo (void) ieee80211_ratectl_rate(ni, NULL, 0); 31208d8bdb01SAndrew Thompson ieee80211_free_node(ni); 3121f4ac78a2SAdrian Chadd } 312202ac6454SAndrew Thompson 31237a79cebfSGleb Smirnoff /* count TX retry-fail as Tx errors */ 3124f4ac78a2SAdrian Chadd if_inc_counter(vap->iv_ifp, IFCOUNTER_OERRORS, fail); 312502ac6454SAndrew Thompson 3126b6108616SRui Paulo usb_callout_reset(&rvp->ratectl_ch, hz, rum_ratectl_timeout, rvp); 31275efea30fSAndrew Thompson RUM_UNLOCK(sc); 312802ac6454SAndrew Thompson } 312902ac6454SAndrew Thompson 313002ac6454SAndrew Thompson static void 313102ac6454SAndrew Thompson rum_scan_start(struct ieee80211com *ic) 313202ac6454SAndrew Thompson { 3133d3fdd08cSAdrian Chadd struct rum_softc *sc = ic->ic_softc; 313402ac6454SAndrew Thompson 313502ac6454SAndrew Thompson RUM_LOCK(sc); 31366d804321SAdrian Chadd rum_abort_tsf_sync(sc); 31377a79cebfSGleb Smirnoff rum_set_bssid(sc, ieee80211broadcastaddr); 313802ac6454SAndrew Thompson RUM_UNLOCK(sc); 313902ac6454SAndrew Thompson 314002ac6454SAndrew Thompson } 314102ac6454SAndrew Thompson 314202ac6454SAndrew Thompson static void 314302ac6454SAndrew Thompson rum_scan_end(struct ieee80211com *ic) 314402ac6454SAndrew Thompson { 3145d3fdd08cSAdrian Chadd struct rum_softc *sc = ic->ic_softc; 314602ac6454SAndrew Thompson 314737704427SAndriy Voskoboinyk if (ic->ic_flags_ext & IEEE80211_FEXT_BGSCAN) { 314802ac6454SAndrew Thompson RUM_LOCK(sc); 314950a31b48SAdrian Chadd if (ic->ic_opmode != IEEE80211_M_AHDEMO) 31505efea30fSAndrew Thompson rum_enable_tsf_sync(sc); 315150a31b48SAdrian Chadd else 315250a31b48SAdrian Chadd rum_enable_tsf(sc); 31531ba67b11SAdrian Chadd rum_set_bssid(sc, sc->sc_bssid); 315402ac6454SAndrew Thompson RUM_UNLOCK(sc); 315537704427SAndriy Voskoboinyk } 315602ac6454SAndrew Thompson } 315702ac6454SAndrew Thompson 315802ac6454SAndrew Thompson static void 315902ac6454SAndrew Thompson rum_set_channel(struct ieee80211com *ic) 316002ac6454SAndrew Thompson { 3161d3fdd08cSAdrian Chadd struct rum_softc *sc = ic->ic_softc; 316202ac6454SAndrew Thompson 316302ac6454SAndrew Thompson RUM_LOCK(sc); 316402ac6454SAndrew Thompson rum_set_chan(sc, ic->ic_curchan); 31655efea30fSAndrew Thompson RUM_UNLOCK(sc); 316602ac6454SAndrew Thompson } 316702ac6454SAndrew Thompson 316802ac6454SAndrew Thompson static int 316902ac6454SAndrew Thompson rum_get_rssi(struct rum_softc *sc, uint8_t raw) 317002ac6454SAndrew Thompson { 31717a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 317202ac6454SAndrew Thompson int lna, agc, rssi; 317302ac6454SAndrew Thompson 317402ac6454SAndrew Thompson lna = (raw >> 5) & 0x3; 317502ac6454SAndrew Thompson agc = raw & 0x1f; 317602ac6454SAndrew Thompson 317702ac6454SAndrew Thompson if (lna == 0) { 317802ac6454SAndrew Thompson /* 317902ac6454SAndrew Thompson * No RSSI mapping 318002ac6454SAndrew Thompson * 318102ac6454SAndrew Thompson * NB: Since RSSI is relative to noise floor, -1 is 318202ac6454SAndrew Thompson * adequate for caller to know error happened. 318302ac6454SAndrew Thompson */ 318402ac6454SAndrew Thompson return -1; 318502ac6454SAndrew Thompson } 318602ac6454SAndrew Thompson 318702ac6454SAndrew Thompson rssi = (2 * agc) - RT2573_NOISE_FLOOR; 318802ac6454SAndrew Thompson 318902ac6454SAndrew Thompson if (IEEE80211_IS_CHAN_2GHZ(ic->ic_curchan)) { 319002ac6454SAndrew Thompson rssi += sc->rssi_2ghz_corr; 319102ac6454SAndrew Thompson 319202ac6454SAndrew Thompson if (lna == 1) 319302ac6454SAndrew Thompson rssi -= 64; 319402ac6454SAndrew Thompson else if (lna == 2) 319502ac6454SAndrew Thompson rssi -= 74; 319602ac6454SAndrew Thompson else if (lna == 3) 319702ac6454SAndrew Thompson rssi -= 90; 319802ac6454SAndrew Thompson } else { 319902ac6454SAndrew Thompson rssi += sc->rssi_5ghz_corr; 320002ac6454SAndrew Thompson 320102ac6454SAndrew Thompson if (!sc->ext_5ghz_lna && lna != 1) 320202ac6454SAndrew Thompson rssi += 4; 320302ac6454SAndrew Thompson 320402ac6454SAndrew Thompson if (lna == 1) 320502ac6454SAndrew Thompson rssi -= 64; 320602ac6454SAndrew Thompson else if (lna == 2) 320702ac6454SAndrew Thompson rssi -= 86; 320802ac6454SAndrew Thompson else if (lna == 3) 320902ac6454SAndrew Thompson rssi -= 100; 321002ac6454SAndrew Thompson } 321102ac6454SAndrew Thompson return rssi; 321202ac6454SAndrew Thompson } 321302ac6454SAndrew Thompson 321402ac6454SAndrew Thompson static int 321502ac6454SAndrew Thompson rum_pause(struct rum_softc *sc, int timeout) 321602ac6454SAndrew Thompson { 321702ac6454SAndrew Thompson 3218a593f6b8SAndrew Thompson usb_pause_mtx(&sc->sc_mtx, timeout); 321902ac6454SAndrew Thompson return (0); 322002ac6454SAndrew Thompson } 322102ac6454SAndrew Thompson 322202ac6454SAndrew Thompson static device_method_t rum_methods[] = { 322302ac6454SAndrew Thompson /* Device interface */ 322402ac6454SAndrew Thompson DEVMETHOD(device_probe, rum_match), 322502ac6454SAndrew Thompson DEVMETHOD(device_attach, rum_attach), 322602ac6454SAndrew Thompson DEVMETHOD(device_detach, rum_detach), 3227645e4d17SHans Petter Selasky DEVMETHOD_END 322802ac6454SAndrew Thompson }; 322902ac6454SAndrew Thompson 323002ac6454SAndrew Thompson static driver_t rum_driver = { 323102ac6454SAndrew Thompson .name = "rum", 323202ac6454SAndrew Thompson .methods = rum_methods, 323302ac6454SAndrew Thompson .size = sizeof(struct rum_softc), 323402ac6454SAndrew Thompson }; 323502ac6454SAndrew Thompson 323602ac6454SAndrew Thompson static devclass_t rum_devclass; 323702ac6454SAndrew Thompson 32389aef556dSAndrew Thompson DRIVER_MODULE(rum, uhub, rum_driver, rum_devclass, NULL, 0); 3239910cb8feSAndrew Thompson MODULE_DEPEND(rum, wlan, 1, 1, 1); 3240910cb8feSAndrew Thompson MODULE_DEPEND(rum, usb, 1, 1, 1); 3241910cb8feSAndrew Thompson MODULE_VERSION(rum, 1); 3242f809f280SWarner Losh USB_PNP_HOST_INFO(rum_devs); 3243