rt2560.c revision 170530
1156321Sdamien/* $FreeBSD: head/sys/dev/ral/rt2560.c 170530 2007-06-11 03:36:55Z sam $ */ 2156321Sdamien 3156321Sdamien/*- 4156321Sdamien * Copyright (c) 2005, 2006 5156321Sdamien * Damien Bergamini <damien.bergamini@free.fr> 6156321Sdamien * 7156321Sdamien * Permission to use, copy, modify, and distribute this software for any 8156321Sdamien * purpose with or without fee is hereby granted, provided that the above 9156321Sdamien * copyright notice and this permission notice appear in all copies. 10156321Sdamien * 11156321Sdamien * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 12156321Sdamien * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 13156321Sdamien * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 14156321Sdamien * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 15156321Sdamien * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 16156321Sdamien * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 17156321Sdamien * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 18156321Sdamien */ 19156321Sdamien 20156321Sdamien#include <sys/cdefs.h> 21156321Sdamien__FBSDID("$FreeBSD: head/sys/dev/ral/rt2560.c 170530 2007-06-11 03:36:55Z sam $"); 22156321Sdamien 23156321Sdamien/*- 24156321Sdamien * Ralink Technology RT2560 chipset driver 25156321Sdamien * http://www.ralinktech.com/ 26156321Sdamien */ 27156321Sdamien 28156321Sdamien#include <sys/param.h> 29156321Sdamien#include <sys/sysctl.h> 30156321Sdamien#include <sys/sockio.h> 31156321Sdamien#include <sys/mbuf.h> 32156321Sdamien#include <sys/kernel.h> 33156321Sdamien#include <sys/socket.h> 34156321Sdamien#include <sys/systm.h> 35156321Sdamien#include <sys/malloc.h> 36164982Skevlo#include <sys/lock.h> 37164982Skevlo#include <sys/mutex.h> 38156321Sdamien#include <sys/module.h> 39156321Sdamien#include <sys/bus.h> 40156321Sdamien#include <sys/endian.h> 41156321Sdamien 42156321Sdamien#include <machine/bus.h> 43156321Sdamien#include <machine/resource.h> 44156321Sdamien#include <sys/rman.h> 45156321Sdamien 46156321Sdamien#include <net/bpf.h> 47156321Sdamien#include <net/if.h> 48156321Sdamien#include <net/if_arp.h> 49156321Sdamien#include <net/ethernet.h> 50156321Sdamien#include <net/if_dl.h> 51156321Sdamien#include <net/if_media.h> 52156321Sdamien#include <net/if_types.h> 53156321Sdamien 54156321Sdamien#include <net80211/ieee80211_var.h> 55156321Sdamien#include <net80211/ieee80211_radiotap.h> 56170530Ssam#include <net80211/ieee80211_regdomain.h> 57156321Sdamien 58156321Sdamien#include <netinet/in.h> 59156321Sdamien#include <netinet/in_systm.h> 60156321Sdamien#include <netinet/in_var.h> 61156321Sdamien#include <netinet/ip.h> 62156321Sdamien#include <netinet/if_ether.h> 63156321Sdamien 64156327Ssilby#include <dev/ral/if_ralrate.h> 65156327Ssilby#include <dev/ral/rt2560reg.h> 66156327Ssilby#include <dev/ral/rt2560var.h> 67156321Sdamien 68170530Ssam#define RT2560_RSSI(sc, rssi) \ 69170530Ssam ((rssi) > (RT2560_NOISE_FLOOR + (sc)->rssi_corr) ? \ 70170530Ssam ((rssi) - RT2560_NOISE_FLOOR - (sc)->rssi_corr) : 0) 71170530Ssam 72156321Sdamien#ifdef RAL_DEBUG 73156321Sdamien#define DPRINTF(x) do { if (ral_debug > 0) printf x; } while (0) 74156321Sdamien#define DPRINTFN(n, x) do { if (ral_debug >= (n)) printf x; } while (0) 75156321Sdamienextern int ral_debug; 76156321Sdamien#else 77156321Sdamien#define DPRINTF(x) 78156321Sdamien#define DPRINTFN(n, x) 79156321Sdamien#endif 80156321Sdamien 81156321Sdamienstatic void rt2560_dma_map_addr(void *, bus_dma_segment_t *, int, 82156321Sdamien int); 83156321Sdamienstatic int rt2560_alloc_tx_ring(struct rt2560_softc *, 84156321Sdamien struct rt2560_tx_ring *, int); 85156321Sdamienstatic void rt2560_reset_tx_ring(struct rt2560_softc *, 86156321Sdamien struct rt2560_tx_ring *); 87156321Sdamienstatic void rt2560_free_tx_ring(struct rt2560_softc *, 88156321Sdamien struct rt2560_tx_ring *); 89156321Sdamienstatic int rt2560_alloc_rx_ring(struct rt2560_softc *, 90156321Sdamien struct rt2560_rx_ring *, int); 91156321Sdamienstatic void rt2560_reset_rx_ring(struct rt2560_softc *, 92156321Sdamien struct rt2560_rx_ring *); 93156321Sdamienstatic void rt2560_free_rx_ring(struct rt2560_softc *, 94156321Sdamien struct rt2560_rx_ring *); 95156321Sdamienstatic struct ieee80211_node *rt2560_node_alloc( 96156321Sdamien struct ieee80211_node_table *); 97156321Sdamienstatic int rt2560_media_change(struct ifnet *); 98156321Sdamienstatic void rt2560_iter_func(void *, struct ieee80211_node *); 99156321Sdamienstatic void rt2560_update_rssadapt(void *); 100156321Sdamienstatic int rt2560_newstate(struct ieee80211com *, 101156321Sdamien enum ieee80211_state, int); 102156321Sdamienstatic uint16_t rt2560_eeprom_read(struct rt2560_softc *, uint8_t); 103156321Sdamienstatic void rt2560_encryption_intr(struct rt2560_softc *); 104156321Sdamienstatic void rt2560_tx_intr(struct rt2560_softc *); 105156321Sdamienstatic void rt2560_prio_intr(struct rt2560_softc *); 106156321Sdamienstatic void rt2560_decryption_intr(struct rt2560_softc *); 107156321Sdamienstatic void rt2560_rx_intr(struct rt2560_softc *); 108156321Sdamienstatic void rt2560_beacon_expire(struct rt2560_softc *); 109156321Sdamienstatic void rt2560_wakeup_expire(struct rt2560_softc *); 110156321Sdamienstatic uint8_t rt2560_rxrate(struct rt2560_rx_desc *); 111156321Sdamienstatic int rt2560_ack_rate(struct ieee80211com *, int); 112170530Ssamstatic void rt2560_scan_start(struct ieee80211com *); 113170530Ssamstatic void rt2560_scan_end(struct ieee80211com *); 114170530Ssamstatic void rt2560_set_channel(struct ieee80211com *); 115156321Sdamienstatic uint16_t rt2560_txtime(int, int, uint32_t); 116156321Sdamienstatic uint8_t rt2560_plcp_signal(int); 117156321Sdamienstatic void rt2560_setup_tx_desc(struct rt2560_softc *, 118156321Sdamien struct rt2560_tx_desc *, uint32_t, int, int, int, 119156321Sdamien bus_addr_t); 120156321Sdamienstatic int rt2560_tx_bcn(struct rt2560_softc *, struct mbuf *, 121156321Sdamien struct ieee80211_node *); 122156321Sdamienstatic int rt2560_tx_mgt(struct rt2560_softc *, struct mbuf *, 123156321Sdamien struct ieee80211_node *); 124156321Sdamienstatic struct mbuf *rt2560_get_rts(struct rt2560_softc *, 125156321Sdamien struct ieee80211_frame *, uint16_t); 126156321Sdamienstatic int rt2560_tx_data(struct rt2560_softc *, struct mbuf *, 127156321Sdamien struct ieee80211_node *); 128156321Sdamienstatic void rt2560_start(struct ifnet *); 129165352Sbmsstatic void rt2560_watchdog(void *); 130156321Sdamienstatic int rt2560_reset(struct ifnet *); 131156321Sdamienstatic int rt2560_ioctl(struct ifnet *, u_long, caddr_t); 132156321Sdamienstatic void rt2560_bbp_write(struct rt2560_softc *, uint8_t, 133156321Sdamien uint8_t); 134156321Sdamienstatic uint8_t rt2560_bbp_read(struct rt2560_softc *, uint8_t); 135156321Sdamienstatic void rt2560_rf_write(struct rt2560_softc *, uint8_t, 136156321Sdamien uint32_t); 137156321Sdamienstatic void rt2560_set_chan(struct rt2560_softc *, 138156321Sdamien struct ieee80211_channel *); 139156321Sdamien#if 0 140156321Sdamienstatic void rt2560_disable_rf_tune(struct rt2560_softc *); 141156321Sdamien#endif 142156321Sdamienstatic void rt2560_enable_tsf_sync(struct rt2560_softc *); 143156321Sdamienstatic void rt2560_update_plcp(struct rt2560_softc *); 144156321Sdamienstatic void rt2560_update_slot(struct ifnet *); 145156321Sdamienstatic void rt2560_set_basicrates(struct rt2560_softc *); 146156321Sdamienstatic void rt2560_update_led(struct rt2560_softc *, int, int); 147170530Ssamstatic void rt2560_set_bssid(struct rt2560_softc *, const uint8_t *); 148156321Sdamienstatic void rt2560_set_macaddr(struct rt2560_softc *, uint8_t *); 149156321Sdamienstatic void rt2560_get_macaddr(struct rt2560_softc *, uint8_t *); 150156321Sdamienstatic void rt2560_update_promisc(struct rt2560_softc *); 151156321Sdamienstatic const char *rt2560_get_rf(int); 152156321Sdamienstatic void rt2560_read_eeprom(struct rt2560_softc *); 153156321Sdamienstatic int rt2560_bbp_init(struct rt2560_softc *); 154156321Sdamienstatic void rt2560_set_txantenna(struct rt2560_softc *, int); 155156321Sdamienstatic void rt2560_set_rxantenna(struct rt2560_softc *, int); 156156321Sdamienstatic void rt2560_init(void *); 157160691Ssamstatic int rt2560_raw_xmit(struct ieee80211_node *, struct mbuf *, 158160691Ssam const struct ieee80211_bpf_params *); 159156321Sdamien 160156321Sdamienstatic const struct { 161156321Sdamien uint32_t reg; 162156321Sdamien uint32_t val; 163156321Sdamien} rt2560_def_mac[] = { 164156321Sdamien RT2560_DEF_MAC 165156321Sdamien}; 166156321Sdamien 167156321Sdamienstatic const struct { 168156321Sdamien uint8_t reg; 169156321Sdamien uint8_t val; 170156321Sdamien} rt2560_def_bbp[] = { 171156321Sdamien RT2560_DEF_BBP 172156321Sdamien}; 173156321Sdamien 174156321Sdamienstatic const uint32_t rt2560_rf2522_r2[] = RT2560_RF2522_R2; 175156321Sdamienstatic const uint32_t rt2560_rf2523_r2[] = RT2560_RF2523_R2; 176156321Sdamienstatic const uint32_t rt2560_rf2524_r2[] = RT2560_RF2524_R2; 177156321Sdamienstatic const uint32_t rt2560_rf2525_r2[] = RT2560_RF2525_R2; 178156321Sdamienstatic const uint32_t rt2560_rf2525_hi_r2[] = RT2560_RF2525_HI_R2; 179156321Sdamienstatic const uint32_t rt2560_rf2525e_r2[] = RT2560_RF2525E_R2; 180156321Sdamienstatic const uint32_t rt2560_rf2526_r2[] = RT2560_RF2526_R2; 181156321Sdamienstatic const uint32_t rt2560_rf2526_hi_r2[] = RT2560_RF2526_HI_R2; 182156321Sdamien 183156321Sdamienstatic const struct { 184156321Sdamien uint8_t chan; 185156321Sdamien uint32_t r1, r2, r4; 186156321Sdamien} rt2560_rf5222[] = { 187156321Sdamien RT2560_RF5222 188156321Sdamien}; 189156321Sdamien 190156321Sdamienint 191156321Sdamienrt2560_attach(device_t dev, int id) 192156321Sdamien{ 193156321Sdamien struct rt2560_softc *sc = device_get_softc(dev); 194156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 195156321Sdamien struct ifnet *ifp; 196170530Ssam int error, bands; 197156321Sdamien 198156321Sdamien sc->sc_dev = dev; 199156321Sdamien 200156321Sdamien mtx_init(&sc->sc_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK, 201156321Sdamien MTX_DEF | MTX_RECURSE); 202156321Sdamien 203165352Sbms callout_init_mtx(&sc->watchdog_ch, &sc->sc_mtx, 0); 204156321Sdamien callout_init(&sc->rssadapt_ch, CALLOUT_MPSAFE); 205156321Sdamien 206156321Sdamien /* retrieve RT2560 rev. no */ 207156321Sdamien sc->asic_rev = RAL_READ(sc, RT2560_CSR0); 208156321Sdamien 209156321Sdamien /* retrieve MAC address */ 210156321Sdamien rt2560_get_macaddr(sc, ic->ic_myaddr); 211156321Sdamien 212156321Sdamien /* retrieve RF rev. no and various other things from EEPROM */ 213156321Sdamien rt2560_read_eeprom(sc); 214156321Sdamien 215156321Sdamien device_printf(dev, "MAC/BBP RT2560 (rev 0x%02x), RF %s\n", 216156321Sdamien sc->asic_rev, rt2560_get_rf(sc->rf_rev)); 217156321Sdamien 218156321Sdamien /* 219156321Sdamien * Allocate Tx and Rx rings. 220156321Sdamien */ 221156321Sdamien error = rt2560_alloc_tx_ring(sc, &sc->txq, RT2560_TX_RING_COUNT); 222156321Sdamien if (error != 0) { 223156321Sdamien device_printf(sc->sc_dev, "could not allocate Tx ring\n"); 224156321Sdamien goto fail1; 225156321Sdamien } 226156321Sdamien 227156321Sdamien error = rt2560_alloc_tx_ring(sc, &sc->atimq, RT2560_ATIM_RING_COUNT); 228156321Sdamien if (error != 0) { 229156321Sdamien device_printf(sc->sc_dev, "could not allocate ATIM ring\n"); 230156321Sdamien goto fail2; 231156321Sdamien } 232156321Sdamien 233156321Sdamien error = rt2560_alloc_tx_ring(sc, &sc->prioq, RT2560_PRIO_RING_COUNT); 234156321Sdamien if (error != 0) { 235156321Sdamien device_printf(sc->sc_dev, "could not allocate Prio ring\n"); 236156321Sdamien goto fail3; 237156321Sdamien } 238156321Sdamien 239156321Sdamien error = rt2560_alloc_tx_ring(sc, &sc->bcnq, RT2560_BEACON_RING_COUNT); 240156321Sdamien if (error != 0) { 241156321Sdamien device_printf(sc->sc_dev, "could not allocate Beacon ring\n"); 242156321Sdamien goto fail4; 243156321Sdamien } 244156321Sdamien 245156321Sdamien error = rt2560_alloc_rx_ring(sc, &sc->rxq, RT2560_RX_RING_COUNT); 246156321Sdamien if (error != 0) { 247156321Sdamien device_printf(sc->sc_dev, "could not allocate Rx ring\n"); 248156321Sdamien goto fail5; 249156321Sdamien } 250156321Sdamien 251156321Sdamien ifp = sc->sc_ifp = if_alloc(IFT_ETHER); 252156321Sdamien if (ifp == NULL) { 253156321Sdamien device_printf(sc->sc_dev, "can not if_alloc()\n"); 254156321Sdamien goto fail6; 255156321Sdamien } 256156321Sdamien 257156321Sdamien ifp->if_softc = sc; 258156321Sdamien if_initname(ifp, device_get_name(dev), device_get_unit(dev)); 259156321Sdamien ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 260156321Sdamien ifp->if_init = rt2560_init; 261156321Sdamien ifp->if_ioctl = rt2560_ioctl; 262156321Sdamien ifp->if_start = rt2560_start; 263156321Sdamien IFQ_SET_MAXLEN(&ifp->if_snd, IFQ_MAXLEN); 264156321Sdamien ifp->if_snd.ifq_drv_maxlen = IFQ_MAXLEN; 265156321Sdamien IFQ_SET_READY(&ifp->if_snd); 266156321Sdamien 267156321Sdamien ic->ic_ifp = ifp; 268156321Sdamien ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ 269156321Sdamien ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */ 270156321Sdamien ic->ic_state = IEEE80211_S_INIT; 271156321Sdamien 272156321Sdamien /* set device capabilities */ 273156321Sdamien ic->ic_caps = 274156321Sdamien IEEE80211_C_IBSS | /* IBSS mode supported */ 275156321Sdamien IEEE80211_C_MONITOR | /* monitor mode supported */ 276156321Sdamien IEEE80211_C_HOSTAP | /* HostAp mode supported */ 277156321Sdamien IEEE80211_C_TXPMGT | /* tx power management */ 278156321Sdamien IEEE80211_C_SHPREAMBLE | /* short preamble supported */ 279156321Sdamien IEEE80211_C_SHSLOT | /* short slot time supported */ 280170530Ssam IEEE80211_C_BGSCAN | /* bg scanning support */ 281156321Sdamien IEEE80211_C_WPA; /* 802.11i */ 282156321Sdamien 283170530Ssam bands = 0; 284170530Ssam setbit(&bands, IEEE80211_MODE_11B); 285170530Ssam setbit(&bands, IEEE80211_MODE_11G); 286170530Ssam if (sc->rf_rev == RT2560_RF_5222) 287170530Ssam setbit(&bands, IEEE80211_MODE_11A); 288170530Ssam ieee80211_init_channels(ic, 0, CTRY_DEFAULT, bands, 0, 1); 289156321Sdamien 290156321Sdamien ieee80211_ifattach(ic); 291170530Ssam ic->ic_scan_start = rt2560_scan_start; 292170530Ssam ic->ic_scan_end = rt2560_scan_end; 293170530Ssam ic->ic_set_channel = rt2560_set_channel; 294156321Sdamien ic->ic_node_alloc = rt2560_node_alloc; 295156321Sdamien ic->ic_updateslot = rt2560_update_slot; 296156321Sdamien ic->ic_reset = rt2560_reset; 297156321Sdamien /* enable s/w bmiss handling in sta mode */ 298156321Sdamien ic->ic_flags_ext |= IEEE80211_FEXT_SWBMISS; 299156321Sdamien 300156321Sdamien /* override state transition machine */ 301156321Sdamien sc->sc_newstate = ic->ic_newstate; 302156321Sdamien ic->ic_newstate = rt2560_newstate; 303160691Ssam ic->ic_raw_xmit = rt2560_raw_xmit; 304156321Sdamien ieee80211_media_init(ic, rt2560_media_change, ieee80211_media_status); 305156321Sdamien 306156321Sdamien bpfattach2(ifp, DLT_IEEE802_11_RADIO, 307156321Sdamien sizeof (struct ieee80211_frame) + 64, &sc->sc_drvbpf); 308156321Sdamien 309156321Sdamien sc->sc_rxtap_len = sizeof sc->sc_rxtapu; 310156321Sdamien sc->sc_rxtap.wr_ihdr.it_len = htole16(sc->sc_rxtap_len); 311156321Sdamien sc->sc_rxtap.wr_ihdr.it_present = htole32(RT2560_RX_RADIOTAP_PRESENT); 312156321Sdamien 313156321Sdamien sc->sc_txtap_len = sizeof sc->sc_txtapu; 314156321Sdamien sc->sc_txtap.wt_ihdr.it_len = htole16(sc->sc_txtap_len); 315156321Sdamien sc->sc_txtap.wt_ihdr.it_present = htole32(RT2560_TX_RADIOTAP_PRESENT); 316156321Sdamien 317156321Sdamien /* 318156321Sdamien * Add a few sysctl knobs. 319156321Sdamien */ 320156321Sdamien sc->dwelltime = 200; 321156321Sdamien 322156321Sdamien SYSCTL_ADD_INT(device_get_sysctl_ctx(dev), 323156321Sdamien SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, 324156321Sdamien "txantenna", CTLFLAG_RW, &sc->tx_ant, 0, "tx antenna (0=auto)"); 325156321Sdamien 326156321Sdamien SYSCTL_ADD_INT(device_get_sysctl_ctx(dev), 327156321Sdamien SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, 328156321Sdamien "rxantenna", CTLFLAG_RW, &sc->rx_ant, 0, "rx antenna (0=auto)"); 329156321Sdamien 330156321Sdamien SYSCTL_ADD_INT(device_get_sysctl_ctx(dev), 331156321Sdamien SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "dwell", 332156321Sdamien CTLFLAG_RW, &sc->dwelltime, 0, 333156321Sdamien "channel dwell time (ms) for AP/station scanning"); 334156321Sdamien 335156321Sdamien if (bootverbose) 336156321Sdamien ieee80211_announce(ic); 337156321Sdamien 338156321Sdamien return 0; 339156321Sdamien 340156321Sdamienfail6: rt2560_free_rx_ring(sc, &sc->rxq); 341156321Sdamienfail5: rt2560_free_tx_ring(sc, &sc->bcnq); 342156321Sdamienfail4: rt2560_free_tx_ring(sc, &sc->prioq); 343156321Sdamienfail3: rt2560_free_tx_ring(sc, &sc->atimq); 344156321Sdamienfail2: rt2560_free_tx_ring(sc, &sc->txq); 345156321Sdamienfail1: mtx_destroy(&sc->sc_mtx); 346156321Sdamien 347156321Sdamien return ENXIO; 348156321Sdamien} 349156321Sdamien 350156321Sdamienint 351156321Sdamienrt2560_detach(void *xsc) 352156321Sdamien{ 353156321Sdamien struct rt2560_softc *sc = xsc; 354156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 355156321Sdamien struct ifnet *ifp = ic->ic_ifp; 356170530Ssam 357156321Sdamien rt2560_stop(sc); 358165352Sbms callout_stop(&sc->watchdog_ch); 359156321Sdamien callout_stop(&sc->rssadapt_ch); 360156321Sdamien 361156321Sdamien bpfdetach(ifp); 362156321Sdamien ieee80211_ifdetach(ic); 363156321Sdamien 364156321Sdamien rt2560_free_tx_ring(sc, &sc->txq); 365156321Sdamien rt2560_free_tx_ring(sc, &sc->atimq); 366156321Sdamien rt2560_free_tx_ring(sc, &sc->prioq); 367156321Sdamien rt2560_free_tx_ring(sc, &sc->bcnq); 368156321Sdamien rt2560_free_rx_ring(sc, &sc->rxq); 369156321Sdamien 370156321Sdamien if_free(ifp); 371156321Sdamien 372156321Sdamien mtx_destroy(&sc->sc_mtx); 373156321Sdamien 374156321Sdamien return 0; 375156321Sdamien} 376156321Sdamien 377156321Sdamienvoid 378156321Sdamienrt2560_resume(void *xsc) 379156321Sdamien{ 380156321Sdamien struct rt2560_softc *sc = xsc; 381156321Sdamien struct ifnet *ifp = sc->sc_ic.ic_ifp; 382156321Sdamien 383156321Sdamien if (ifp->if_flags & IFF_UP) { 384156321Sdamien ifp->if_init(ifp->if_softc); 385156321Sdamien if (ifp->if_drv_flags & IFF_DRV_RUNNING) 386156321Sdamien ifp->if_start(ifp); 387156321Sdamien } 388156321Sdamien} 389156321Sdamien 390156321Sdamienstatic void 391156321Sdamienrt2560_dma_map_addr(void *arg, bus_dma_segment_t *segs, int nseg, int error) 392156321Sdamien{ 393156321Sdamien if (error != 0) 394156321Sdamien return; 395156321Sdamien 396156321Sdamien KASSERT(nseg == 1, ("too many DMA segments, %d should be 1", nseg)); 397156321Sdamien 398156321Sdamien *(bus_addr_t *)arg = segs[0].ds_addr; 399156321Sdamien} 400156321Sdamien 401156321Sdamienstatic int 402156321Sdamienrt2560_alloc_tx_ring(struct rt2560_softc *sc, struct rt2560_tx_ring *ring, 403156321Sdamien int count) 404156321Sdamien{ 405156321Sdamien int i, error; 406156321Sdamien 407156321Sdamien ring->count = count; 408156321Sdamien ring->queued = 0; 409156321Sdamien ring->cur = ring->next = 0; 410156321Sdamien ring->cur_encrypt = ring->next_encrypt = 0; 411156321Sdamien 412156321Sdamien error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT, 413156321Sdamien BUS_SPACE_MAXADDR, NULL, NULL, count * RT2560_TX_DESC_SIZE, 1, 414156321Sdamien count * RT2560_TX_DESC_SIZE, 0, NULL, NULL, &ring->desc_dmat); 415156321Sdamien if (error != 0) { 416156321Sdamien device_printf(sc->sc_dev, "could not create desc DMA tag\n"); 417156321Sdamien goto fail; 418156321Sdamien } 419156321Sdamien 420156321Sdamien error = bus_dmamem_alloc(ring->desc_dmat, (void **)&ring->desc, 421156321Sdamien BUS_DMA_NOWAIT | BUS_DMA_ZERO, &ring->desc_map); 422156321Sdamien if (error != 0) { 423156321Sdamien device_printf(sc->sc_dev, "could not allocate DMA memory\n"); 424156321Sdamien goto fail; 425156321Sdamien } 426156321Sdamien 427156321Sdamien error = bus_dmamap_load(ring->desc_dmat, ring->desc_map, ring->desc, 428156321Sdamien count * RT2560_TX_DESC_SIZE, rt2560_dma_map_addr, &ring->physaddr, 429156321Sdamien 0); 430156321Sdamien if (error != 0) { 431156321Sdamien device_printf(sc->sc_dev, "could not load desc DMA map\n"); 432156321Sdamien goto fail; 433156321Sdamien } 434156321Sdamien 435156321Sdamien ring->data = malloc(count * sizeof (struct rt2560_tx_data), M_DEVBUF, 436156321Sdamien M_NOWAIT | M_ZERO); 437156321Sdamien if (ring->data == NULL) { 438156321Sdamien device_printf(sc->sc_dev, "could not allocate soft data\n"); 439156321Sdamien error = ENOMEM; 440156321Sdamien goto fail; 441156321Sdamien } 442156321Sdamien 443156321Sdamien error = bus_dma_tag_create(NULL, 1, 0, BUS_SPACE_MAXADDR_32BIT, 444156321Sdamien BUS_SPACE_MAXADDR, NULL, NULL, MCLBYTES, RT2560_MAX_SCATTER, 445156321Sdamien MCLBYTES, 0, NULL, NULL, &ring->data_dmat); 446156321Sdamien if (error != 0) { 447156321Sdamien device_printf(sc->sc_dev, "could not create data DMA tag\n"); 448156321Sdamien goto fail; 449156321Sdamien } 450156321Sdamien 451156321Sdamien for (i = 0; i < count; i++) { 452156321Sdamien error = bus_dmamap_create(ring->data_dmat, 0, 453156321Sdamien &ring->data[i].map); 454156321Sdamien if (error != 0) { 455156321Sdamien device_printf(sc->sc_dev, "could not create DMA map\n"); 456156321Sdamien goto fail; 457156321Sdamien } 458156321Sdamien } 459156321Sdamien 460156321Sdamien return 0; 461156321Sdamien 462156321Sdamienfail: rt2560_free_tx_ring(sc, ring); 463156321Sdamien return error; 464156321Sdamien} 465156321Sdamien 466156321Sdamienstatic void 467156321Sdamienrt2560_reset_tx_ring(struct rt2560_softc *sc, struct rt2560_tx_ring *ring) 468156321Sdamien{ 469156321Sdamien struct rt2560_tx_desc *desc; 470156321Sdamien struct rt2560_tx_data *data; 471156321Sdamien int i; 472156321Sdamien 473156321Sdamien for (i = 0; i < ring->count; i++) { 474156321Sdamien desc = &ring->desc[i]; 475156321Sdamien data = &ring->data[i]; 476156321Sdamien 477156321Sdamien if (data->m != NULL) { 478156321Sdamien bus_dmamap_sync(ring->data_dmat, data->map, 479156321Sdamien BUS_DMASYNC_POSTWRITE); 480156321Sdamien bus_dmamap_unload(ring->data_dmat, data->map); 481156321Sdamien m_freem(data->m); 482156321Sdamien data->m = NULL; 483156321Sdamien } 484156321Sdamien 485156321Sdamien if (data->ni != NULL) { 486156321Sdamien ieee80211_free_node(data->ni); 487156321Sdamien data->ni = NULL; 488156321Sdamien } 489156321Sdamien 490156321Sdamien desc->flags = 0; 491156321Sdamien } 492156321Sdamien 493156321Sdamien bus_dmamap_sync(ring->desc_dmat, ring->desc_map, BUS_DMASYNC_PREWRITE); 494156321Sdamien 495156321Sdamien ring->queued = 0; 496156321Sdamien ring->cur = ring->next = 0; 497156321Sdamien ring->cur_encrypt = ring->next_encrypt = 0; 498156321Sdamien} 499156321Sdamien 500156321Sdamienstatic void 501156321Sdamienrt2560_free_tx_ring(struct rt2560_softc *sc, struct rt2560_tx_ring *ring) 502156321Sdamien{ 503156321Sdamien struct rt2560_tx_data *data; 504156321Sdamien int i; 505156321Sdamien 506156321Sdamien if (ring->desc != NULL) { 507156321Sdamien bus_dmamap_sync(ring->desc_dmat, ring->desc_map, 508156321Sdamien BUS_DMASYNC_POSTWRITE); 509156321Sdamien bus_dmamap_unload(ring->desc_dmat, ring->desc_map); 510156321Sdamien bus_dmamem_free(ring->desc_dmat, ring->desc, ring->desc_map); 511156321Sdamien } 512156321Sdamien 513156321Sdamien if (ring->desc_dmat != NULL) 514156321Sdamien bus_dma_tag_destroy(ring->desc_dmat); 515156321Sdamien 516156321Sdamien if (ring->data != NULL) { 517156321Sdamien for (i = 0; i < ring->count; i++) { 518156321Sdamien data = &ring->data[i]; 519156321Sdamien 520156321Sdamien if (data->m != NULL) { 521156321Sdamien bus_dmamap_sync(ring->data_dmat, data->map, 522156321Sdamien BUS_DMASYNC_POSTWRITE); 523156321Sdamien bus_dmamap_unload(ring->data_dmat, data->map); 524156321Sdamien m_freem(data->m); 525156321Sdamien } 526156321Sdamien 527156321Sdamien if (data->ni != NULL) 528156321Sdamien ieee80211_free_node(data->ni); 529156321Sdamien 530156321Sdamien if (data->map != NULL) 531156321Sdamien bus_dmamap_destroy(ring->data_dmat, data->map); 532156321Sdamien } 533156321Sdamien 534156321Sdamien free(ring->data, M_DEVBUF); 535156321Sdamien } 536156321Sdamien 537156321Sdamien if (ring->data_dmat != NULL) 538156321Sdamien bus_dma_tag_destroy(ring->data_dmat); 539156321Sdamien} 540156321Sdamien 541156321Sdamienstatic int 542156321Sdamienrt2560_alloc_rx_ring(struct rt2560_softc *sc, struct rt2560_rx_ring *ring, 543156321Sdamien int count) 544156321Sdamien{ 545156321Sdamien struct rt2560_rx_desc *desc; 546156321Sdamien struct rt2560_rx_data *data; 547156321Sdamien bus_addr_t physaddr; 548156321Sdamien int i, error; 549156321Sdamien 550156321Sdamien ring->count = count; 551156321Sdamien ring->cur = ring->next = 0; 552156321Sdamien ring->cur_decrypt = 0; 553156321Sdamien 554156321Sdamien error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT, 555156321Sdamien BUS_SPACE_MAXADDR, NULL, NULL, count * RT2560_RX_DESC_SIZE, 1, 556156321Sdamien count * RT2560_RX_DESC_SIZE, 0, NULL, NULL, &ring->desc_dmat); 557156321Sdamien if (error != 0) { 558156321Sdamien device_printf(sc->sc_dev, "could not create desc DMA tag\n"); 559156321Sdamien goto fail; 560156321Sdamien } 561156321Sdamien 562156321Sdamien error = bus_dmamem_alloc(ring->desc_dmat, (void **)&ring->desc, 563156321Sdamien BUS_DMA_NOWAIT | BUS_DMA_ZERO, &ring->desc_map); 564156321Sdamien if (error != 0) { 565156321Sdamien device_printf(sc->sc_dev, "could not allocate DMA memory\n"); 566156321Sdamien goto fail; 567156321Sdamien } 568156321Sdamien 569156321Sdamien error = bus_dmamap_load(ring->desc_dmat, ring->desc_map, ring->desc, 570156321Sdamien count * RT2560_RX_DESC_SIZE, rt2560_dma_map_addr, &ring->physaddr, 571156321Sdamien 0); 572156321Sdamien if (error != 0) { 573156321Sdamien device_printf(sc->sc_dev, "could not load desc DMA map\n"); 574156321Sdamien goto fail; 575156321Sdamien } 576156321Sdamien 577156321Sdamien ring->data = malloc(count * sizeof (struct rt2560_rx_data), M_DEVBUF, 578156321Sdamien M_NOWAIT | M_ZERO); 579156321Sdamien if (ring->data == NULL) { 580156321Sdamien device_printf(sc->sc_dev, "could not allocate soft data\n"); 581156321Sdamien error = ENOMEM; 582156321Sdamien goto fail; 583156321Sdamien } 584156321Sdamien 585156321Sdamien /* 586156321Sdamien * Pre-allocate Rx buffers and populate Rx ring. 587156321Sdamien */ 588156321Sdamien error = bus_dma_tag_create(NULL, 1, 0, BUS_SPACE_MAXADDR_32BIT, 589156321Sdamien BUS_SPACE_MAXADDR, NULL, NULL, MCLBYTES, 1, MCLBYTES, 0, NULL, 590156321Sdamien NULL, &ring->data_dmat); 591156321Sdamien if (error != 0) { 592156321Sdamien device_printf(sc->sc_dev, "could not create data DMA tag\n"); 593156321Sdamien goto fail; 594156321Sdamien } 595156321Sdamien 596156321Sdamien for (i = 0; i < count; i++) { 597156321Sdamien desc = &sc->rxq.desc[i]; 598156321Sdamien data = &sc->rxq.data[i]; 599156321Sdamien 600156321Sdamien error = bus_dmamap_create(ring->data_dmat, 0, &data->map); 601156321Sdamien if (error != 0) { 602156321Sdamien device_printf(sc->sc_dev, "could not create DMA map\n"); 603156321Sdamien goto fail; 604156321Sdamien } 605156321Sdamien 606156321Sdamien data->m = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR); 607156321Sdamien if (data->m == NULL) { 608156321Sdamien device_printf(sc->sc_dev, 609156321Sdamien "could not allocate rx mbuf\n"); 610156321Sdamien error = ENOMEM; 611156321Sdamien goto fail; 612156321Sdamien } 613156321Sdamien 614156321Sdamien error = bus_dmamap_load(ring->data_dmat, data->map, 615156321Sdamien mtod(data->m, void *), MCLBYTES, rt2560_dma_map_addr, 616156321Sdamien &physaddr, 0); 617156321Sdamien if (error != 0) { 618156321Sdamien device_printf(sc->sc_dev, 619156321Sdamien "could not load rx buf DMA map"); 620156321Sdamien goto fail; 621156321Sdamien } 622156321Sdamien 623156321Sdamien desc->flags = htole32(RT2560_RX_BUSY); 624156321Sdamien desc->physaddr = htole32(physaddr); 625156321Sdamien } 626156321Sdamien 627156321Sdamien bus_dmamap_sync(ring->desc_dmat, ring->desc_map, BUS_DMASYNC_PREWRITE); 628156321Sdamien 629156321Sdamien return 0; 630156321Sdamien 631156321Sdamienfail: rt2560_free_rx_ring(sc, ring); 632156321Sdamien return error; 633156321Sdamien} 634156321Sdamien 635156321Sdamienstatic void 636156321Sdamienrt2560_reset_rx_ring(struct rt2560_softc *sc, struct rt2560_rx_ring *ring) 637156321Sdamien{ 638156321Sdamien int i; 639156321Sdamien 640156321Sdamien for (i = 0; i < ring->count; i++) { 641156321Sdamien ring->desc[i].flags = htole32(RT2560_RX_BUSY); 642156321Sdamien ring->data[i].drop = 0; 643156321Sdamien } 644156321Sdamien 645156321Sdamien bus_dmamap_sync(ring->desc_dmat, ring->desc_map, BUS_DMASYNC_PREWRITE); 646156321Sdamien 647156321Sdamien ring->cur = ring->next = 0; 648156321Sdamien ring->cur_decrypt = 0; 649156321Sdamien} 650156321Sdamien 651156321Sdamienstatic void 652156321Sdamienrt2560_free_rx_ring(struct rt2560_softc *sc, struct rt2560_rx_ring *ring) 653156321Sdamien{ 654156321Sdamien struct rt2560_rx_data *data; 655156321Sdamien int i; 656156321Sdamien 657156321Sdamien if (ring->desc != NULL) { 658156321Sdamien bus_dmamap_sync(ring->desc_dmat, ring->desc_map, 659156321Sdamien BUS_DMASYNC_POSTWRITE); 660156321Sdamien bus_dmamap_unload(ring->desc_dmat, ring->desc_map); 661156321Sdamien bus_dmamem_free(ring->desc_dmat, ring->desc, ring->desc_map); 662156321Sdamien } 663156321Sdamien 664156321Sdamien if (ring->desc_dmat != NULL) 665156321Sdamien bus_dma_tag_destroy(ring->desc_dmat); 666156321Sdamien 667156321Sdamien if (ring->data != NULL) { 668156321Sdamien for (i = 0; i < ring->count; i++) { 669156321Sdamien data = &ring->data[i]; 670156321Sdamien 671156321Sdamien if (data->m != NULL) { 672156321Sdamien bus_dmamap_sync(ring->data_dmat, data->map, 673156321Sdamien BUS_DMASYNC_POSTREAD); 674156321Sdamien bus_dmamap_unload(ring->data_dmat, data->map); 675156321Sdamien m_freem(data->m); 676156321Sdamien } 677156321Sdamien 678156321Sdamien if (data->map != NULL) 679156321Sdamien bus_dmamap_destroy(ring->data_dmat, data->map); 680156321Sdamien } 681156321Sdamien 682156321Sdamien free(ring->data, M_DEVBUF); 683156321Sdamien } 684156321Sdamien 685156321Sdamien if (ring->data_dmat != NULL) 686156321Sdamien bus_dma_tag_destroy(ring->data_dmat); 687156321Sdamien} 688156321Sdamien 689156321Sdamienstatic struct ieee80211_node * 690156321Sdamienrt2560_node_alloc(struct ieee80211_node_table *nt) 691156321Sdamien{ 692156321Sdamien struct rt2560_node *rn; 693156321Sdamien 694156321Sdamien rn = malloc(sizeof (struct rt2560_node), M_80211_NODE, 695156321Sdamien M_NOWAIT | M_ZERO); 696156321Sdamien 697156321Sdamien return (rn != NULL) ? &rn->ni : NULL; 698156321Sdamien} 699156321Sdamien 700156321Sdamienstatic int 701156321Sdamienrt2560_media_change(struct ifnet *ifp) 702156321Sdamien{ 703156321Sdamien struct rt2560_softc *sc = ifp->if_softc; 704156321Sdamien int error; 705156321Sdamien 706156321Sdamien error = ieee80211_media_change(ifp); 707156321Sdamien 708170530Ssam if (error == ENETRESET) { 709170530Ssam if ((ifp->if_flags & IFF_UP) && 710170530Ssam (ifp->if_drv_flags & IFF_DRV_RUNNING)) 711170530Ssam rt2560_init(sc); 712170530Ssam } 713170530Ssam return error; 714156321Sdamien} 715156321Sdamien 716156321Sdamien/* 717156321Sdamien * This function is called for each node present in the node station table. 718156321Sdamien */ 719156321Sdamienstatic void 720156321Sdamienrt2560_iter_func(void *arg, struct ieee80211_node *ni) 721156321Sdamien{ 722156321Sdamien struct rt2560_node *rn = (struct rt2560_node *)ni; 723156321Sdamien 724156321Sdamien ral_rssadapt_updatestats(&rn->rssadapt); 725156321Sdamien} 726156321Sdamien 727156321Sdamien/* 728156321Sdamien * This function is called periodically (every 100ms) in RUN state to update 729156321Sdamien * the rate adaptation statistics. 730156321Sdamien */ 731156321Sdamienstatic void 732156321Sdamienrt2560_update_rssadapt(void *arg) 733156321Sdamien{ 734156321Sdamien struct rt2560_softc *sc = arg; 735156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 736156321Sdamien 737156321Sdamien RAL_LOCK(sc); 738156321Sdamien 739156321Sdamien ieee80211_iterate_nodes(&ic->ic_sta, rt2560_iter_func, arg); 740156321Sdamien callout_reset(&sc->rssadapt_ch, hz / 10, rt2560_update_rssadapt, sc); 741156321Sdamien 742156321Sdamien RAL_UNLOCK(sc); 743156321Sdamien} 744156321Sdamien 745156321Sdamienstatic int 746156321Sdamienrt2560_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg) 747156321Sdamien{ 748156321Sdamien struct rt2560_softc *sc = ic->ic_ifp->if_softc; 749156321Sdamien enum ieee80211_state ostate; 750156321Sdamien struct ieee80211_node *ni; 751156321Sdamien struct mbuf *m; 752156321Sdamien int error = 0; 753156321Sdamien 754156321Sdamien ostate = ic->ic_state; 755156321Sdamien 756156321Sdamien switch (nstate) { 757156321Sdamien case IEEE80211_S_INIT: 758156321Sdamien callout_stop(&sc->rssadapt_ch); 759156321Sdamien 760156321Sdamien if (ostate == IEEE80211_S_RUN) { 761156321Sdamien /* abort TSF synchronization */ 762156321Sdamien RAL_WRITE(sc, RT2560_CSR14, 0); 763156321Sdamien 764156321Sdamien /* turn association led off */ 765156321Sdamien rt2560_update_led(sc, 0, 0); 766156321Sdamien } 767156321Sdamien break; 768156321Sdamien case IEEE80211_S_RUN: 769156321Sdamien ni = ic->ic_bss; 770156321Sdamien 771156321Sdamien if (ic->ic_opmode != IEEE80211_M_MONITOR) { 772156321Sdamien rt2560_update_plcp(sc); 773156321Sdamien rt2560_set_basicrates(sc); 774156321Sdamien rt2560_set_bssid(sc, ni->ni_bssid); 775156321Sdamien } 776156321Sdamien 777156321Sdamien if (ic->ic_opmode == IEEE80211_M_HOSTAP || 778156321Sdamien ic->ic_opmode == IEEE80211_M_IBSS) { 779156321Sdamien m = ieee80211_beacon_alloc(ic, ni, &sc->sc_bo); 780156321Sdamien if (m == NULL) { 781156321Sdamien device_printf(sc->sc_dev, 782156321Sdamien "could not allocate beacon\n"); 783156321Sdamien error = ENOBUFS; 784156321Sdamien break; 785156321Sdamien } 786156321Sdamien 787156321Sdamien ieee80211_ref_node(ni); 788156321Sdamien error = rt2560_tx_bcn(sc, m, ni); 789156321Sdamien if (error != 0) 790156321Sdamien break; 791156321Sdamien } 792156321Sdamien 793156321Sdamien /* turn assocation led on */ 794156321Sdamien rt2560_update_led(sc, 1, 0); 795156321Sdamien 796156321Sdamien if (ic->ic_opmode != IEEE80211_M_MONITOR) { 797156321Sdamien callout_reset(&sc->rssadapt_ch, hz / 10, 798156321Sdamien rt2560_update_rssadapt, sc); 799156321Sdamien 800156321Sdamien rt2560_enable_tsf_sync(sc); 801156321Sdamien } 802156321Sdamien break; 803170530Ssam case IEEE80211_S_SCAN: 804170530Ssam case IEEE80211_S_AUTH: 805170530Ssam case IEEE80211_S_ASSOC: 806170530Ssam break; 807156321Sdamien } 808156321Sdamien 809156321Sdamien return (error != 0) ? error : sc->sc_newstate(ic, nstate, arg); 810156321Sdamien} 811156321Sdamien 812156321Sdamien/* 813156321Sdamien * Read 16 bits at address 'addr' from the serial EEPROM (either 93C46 or 814156321Sdamien * 93C66). 815156321Sdamien */ 816156321Sdamienstatic uint16_t 817156321Sdamienrt2560_eeprom_read(struct rt2560_softc *sc, uint8_t addr) 818156321Sdamien{ 819156321Sdamien uint32_t tmp; 820156321Sdamien uint16_t val; 821156321Sdamien int n; 822156321Sdamien 823156321Sdamien /* clock C once before the first command */ 824156321Sdamien RT2560_EEPROM_CTL(sc, 0); 825156321Sdamien 826156321Sdamien RT2560_EEPROM_CTL(sc, RT2560_S); 827156321Sdamien RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_C); 828156321Sdamien RT2560_EEPROM_CTL(sc, RT2560_S); 829156321Sdamien 830156321Sdamien /* write start bit (1) */ 831156321Sdamien RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_D); 832156321Sdamien RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_D | RT2560_C); 833156321Sdamien 834156321Sdamien /* write READ opcode (10) */ 835156321Sdamien RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_D); 836156321Sdamien RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_D | RT2560_C); 837156321Sdamien RT2560_EEPROM_CTL(sc, RT2560_S); 838156321Sdamien RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_C); 839156321Sdamien 840156321Sdamien /* write address (A5-A0 or A7-A0) */ 841156321Sdamien n = (RAL_READ(sc, RT2560_CSR21) & RT2560_93C46) ? 5 : 7; 842156321Sdamien for (; n >= 0; n--) { 843156321Sdamien RT2560_EEPROM_CTL(sc, RT2560_S | 844156321Sdamien (((addr >> n) & 1) << RT2560_SHIFT_D)); 845156321Sdamien RT2560_EEPROM_CTL(sc, RT2560_S | 846156321Sdamien (((addr >> n) & 1) << RT2560_SHIFT_D) | RT2560_C); 847156321Sdamien } 848156321Sdamien 849156321Sdamien RT2560_EEPROM_CTL(sc, RT2560_S); 850156321Sdamien 851156321Sdamien /* read data Q15-Q0 */ 852156321Sdamien val = 0; 853156321Sdamien for (n = 15; n >= 0; n--) { 854156321Sdamien RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_C); 855156321Sdamien tmp = RAL_READ(sc, RT2560_CSR21); 856156321Sdamien val |= ((tmp & RT2560_Q) >> RT2560_SHIFT_Q) << n; 857156321Sdamien RT2560_EEPROM_CTL(sc, RT2560_S); 858156321Sdamien } 859156321Sdamien 860156321Sdamien RT2560_EEPROM_CTL(sc, 0); 861156321Sdamien 862156321Sdamien /* clear Chip Select and clock C */ 863156321Sdamien RT2560_EEPROM_CTL(sc, RT2560_S); 864156321Sdamien RT2560_EEPROM_CTL(sc, 0); 865156321Sdamien RT2560_EEPROM_CTL(sc, RT2560_C); 866156321Sdamien 867156321Sdamien return val; 868156321Sdamien} 869156321Sdamien 870156321Sdamien/* 871156321Sdamien * Some frames were processed by the hardware cipher engine and are ready for 872156321Sdamien * transmission. 873156321Sdamien */ 874156321Sdamienstatic void 875156321Sdamienrt2560_encryption_intr(struct rt2560_softc *sc) 876156321Sdamien{ 877156321Sdamien struct rt2560_tx_desc *desc; 878156321Sdamien int hw; 879156321Sdamien 880156321Sdamien /* retrieve last descriptor index processed by cipher engine */ 881156321Sdamien hw = RAL_READ(sc, RT2560_SECCSR1) - sc->txq.physaddr; 882156321Sdamien hw /= RT2560_TX_DESC_SIZE; 883156321Sdamien 884156321Sdamien bus_dmamap_sync(sc->txq.desc_dmat, sc->txq.desc_map, 885156321Sdamien BUS_DMASYNC_POSTREAD); 886156321Sdamien 887156321Sdamien for (; sc->txq.next_encrypt != hw;) { 888156321Sdamien desc = &sc->txq.desc[sc->txq.next_encrypt]; 889156321Sdamien 890156321Sdamien if ((le32toh(desc->flags) & RT2560_TX_BUSY) || 891156321Sdamien (le32toh(desc->flags) & RT2560_TX_CIPHER_BUSY)) 892156321Sdamien break; 893156321Sdamien 894156321Sdamien /* for TKIP, swap eiv field to fix a bug in ASIC */ 895156321Sdamien if ((le32toh(desc->flags) & RT2560_TX_CIPHER_MASK) == 896156321Sdamien RT2560_TX_CIPHER_TKIP) 897156321Sdamien desc->eiv = bswap32(desc->eiv); 898156321Sdamien 899156321Sdamien /* mark the frame ready for transmission */ 900156321Sdamien desc->flags |= htole32(RT2560_TX_BUSY | RT2560_TX_VALID); 901156321Sdamien 902156321Sdamien DPRINTFN(15, ("encryption done idx=%u\n", 903156321Sdamien sc->txq.next_encrypt)); 904156321Sdamien 905156321Sdamien sc->txq.next_encrypt = 906156321Sdamien (sc->txq.next_encrypt + 1) % RT2560_TX_RING_COUNT; 907156321Sdamien } 908156321Sdamien 909156321Sdamien bus_dmamap_sync(sc->txq.desc_dmat, sc->txq.desc_map, 910156321Sdamien BUS_DMASYNC_PREWRITE); 911156321Sdamien 912156321Sdamien /* kick Tx */ 913156321Sdamien RAL_WRITE(sc, RT2560_TXCSR0, RT2560_KICK_TX); 914156321Sdamien} 915156321Sdamien 916156321Sdamienstatic void 917156321Sdamienrt2560_tx_intr(struct rt2560_softc *sc) 918156321Sdamien{ 919156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 920156321Sdamien struct ifnet *ifp = ic->ic_ifp; 921156321Sdamien struct rt2560_tx_desc *desc; 922156321Sdamien struct rt2560_tx_data *data; 923156321Sdamien struct rt2560_node *rn; 924156321Sdamien 925156321Sdamien bus_dmamap_sync(sc->txq.desc_dmat, sc->txq.desc_map, 926156321Sdamien BUS_DMASYNC_POSTREAD); 927156321Sdamien 928156321Sdamien for (;;) { 929156321Sdamien desc = &sc->txq.desc[sc->txq.next]; 930156321Sdamien data = &sc->txq.data[sc->txq.next]; 931156321Sdamien 932156321Sdamien if ((le32toh(desc->flags) & RT2560_TX_BUSY) || 933156321Sdamien (le32toh(desc->flags) & RT2560_TX_CIPHER_BUSY) || 934156321Sdamien !(le32toh(desc->flags) & RT2560_TX_VALID)) 935156321Sdamien break; 936156321Sdamien 937156321Sdamien rn = (struct rt2560_node *)data->ni; 938156321Sdamien 939156321Sdamien switch (le32toh(desc->flags) & RT2560_TX_RESULT_MASK) { 940156321Sdamien case RT2560_TX_SUCCESS: 941156321Sdamien DPRINTFN(10, ("data frame sent successfully\n")); 942156321Sdamien if (data->id.id_node != NULL) { 943156321Sdamien ral_rssadapt_raise_rate(ic, &rn->rssadapt, 944156321Sdamien &data->id); 945156321Sdamien } 946156321Sdamien ifp->if_opackets++; 947156321Sdamien break; 948156321Sdamien 949156321Sdamien case RT2560_TX_SUCCESS_RETRY: 950156321Sdamien DPRINTFN(9, ("data frame sent after %u retries\n", 951156321Sdamien (le32toh(desc->flags) >> 5) & 0x7)); 952156321Sdamien ifp->if_opackets++; 953156321Sdamien break; 954156321Sdamien 955156321Sdamien case RT2560_TX_FAIL_RETRY: 956156321Sdamien DPRINTFN(9, ("sending data frame failed (too much " 957156321Sdamien "retries)\n")); 958156321Sdamien if (data->id.id_node != NULL) { 959156321Sdamien ral_rssadapt_lower_rate(ic, data->ni, 960156321Sdamien &rn->rssadapt, &data->id); 961156321Sdamien } 962156321Sdamien ifp->if_oerrors++; 963156321Sdamien break; 964156321Sdamien 965156321Sdamien case RT2560_TX_FAIL_INVALID: 966156321Sdamien case RT2560_TX_FAIL_OTHER: 967156321Sdamien default: 968156321Sdamien device_printf(sc->sc_dev, "sending data frame failed " 969156321Sdamien "0x%08x\n", le32toh(desc->flags)); 970156321Sdamien ifp->if_oerrors++; 971156321Sdamien } 972156321Sdamien 973156321Sdamien bus_dmamap_sync(sc->txq.data_dmat, data->map, 974156321Sdamien BUS_DMASYNC_POSTWRITE); 975156321Sdamien bus_dmamap_unload(sc->txq.data_dmat, data->map); 976156321Sdamien m_freem(data->m); 977156321Sdamien data->m = NULL; 978156321Sdamien ieee80211_free_node(data->ni); 979156321Sdamien data->ni = NULL; 980156321Sdamien 981156321Sdamien /* descriptor is no longer valid */ 982156321Sdamien desc->flags &= ~htole32(RT2560_TX_VALID); 983156321Sdamien 984156321Sdamien DPRINTFN(15, ("tx done idx=%u\n", sc->txq.next)); 985156321Sdamien 986156321Sdamien sc->txq.queued--; 987156321Sdamien sc->txq.next = (sc->txq.next + 1) % RT2560_TX_RING_COUNT; 988156321Sdamien } 989156321Sdamien 990156321Sdamien bus_dmamap_sync(sc->txq.desc_dmat, sc->txq.desc_map, 991156321Sdamien BUS_DMASYNC_PREWRITE); 992156321Sdamien 993156321Sdamien sc->sc_tx_timer = 0; 994156321Sdamien ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 995156321Sdamien rt2560_start(ifp); 996156321Sdamien} 997156321Sdamien 998156321Sdamienstatic void 999156321Sdamienrt2560_prio_intr(struct rt2560_softc *sc) 1000156321Sdamien{ 1001156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 1002156321Sdamien struct ifnet *ifp = ic->ic_ifp; 1003156321Sdamien struct rt2560_tx_desc *desc; 1004156321Sdamien struct rt2560_tx_data *data; 1005170530Ssam struct ieee80211_node *ni; 1006170530Ssam struct mbuf *m; 1007170530Ssam int flags; 1008156321Sdamien 1009156321Sdamien bus_dmamap_sync(sc->prioq.desc_dmat, sc->prioq.desc_map, 1010156321Sdamien BUS_DMASYNC_POSTREAD); 1011156321Sdamien 1012156321Sdamien for (;;) { 1013156321Sdamien desc = &sc->prioq.desc[sc->prioq.next]; 1014156321Sdamien data = &sc->prioq.data[sc->prioq.next]; 1015156321Sdamien 1016170530Ssam flags = le32toh(desc->flags); 1017170530Ssam if ((flags & RT2560_TX_BUSY) || (flags & RT2560_TX_VALID) == 0) 1018156321Sdamien break; 1019156321Sdamien 1020170530Ssam switch (flags & RT2560_TX_RESULT_MASK) { 1021156321Sdamien case RT2560_TX_SUCCESS: 1022156321Sdamien DPRINTFN(10, ("mgt frame sent successfully\n")); 1023156321Sdamien break; 1024156321Sdamien 1025156321Sdamien case RT2560_TX_SUCCESS_RETRY: 1026156321Sdamien DPRINTFN(9, ("mgt frame sent after %u retries\n", 1027170530Ssam (flags >> 5) & 0x7)); 1028156321Sdamien break; 1029156321Sdamien 1030156321Sdamien case RT2560_TX_FAIL_RETRY: 1031156321Sdamien DPRINTFN(9, ("sending mgt frame failed (too much " 1032156321Sdamien "retries)\n")); 1033156321Sdamien break; 1034156321Sdamien 1035156321Sdamien case RT2560_TX_FAIL_INVALID: 1036156321Sdamien case RT2560_TX_FAIL_OTHER: 1037156321Sdamien default: 1038156321Sdamien device_printf(sc->sc_dev, "sending mgt frame failed " 1039170530Ssam "0x%08x\n", flags); 1040170530Ssam break; 1041156321Sdamien } 1042156321Sdamien 1043156321Sdamien bus_dmamap_sync(sc->prioq.data_dmat, data->map, 1044156321Sdamien BUS_DMASYNC_POSTWRITE); 1045156321Sdamien bus_dmamap_unload(sc->prioq.data_dmat, data->map); 1046170530Ssam 1047170530Ssam m = data->m; 1048156321Sdamien data->m = NULL; 1049170530Ssam ni = data->ni; 1050156321Sdamien data->ni = NULL; 1051156321Sdamien 1052156321Sdamien /* descriptor is no longer valid */ 1053156321Sdamien desc->flags &= ~htole32(RT2560_TX_VALID); 1054156321Sdamien 1055156321Sdamien DPRINTFN(15, ("prio done idx=%u\n", sc->prioq.next)); 1056156321Sdamien 1057156321Sdamien sc->prioq.queued--; 1058156321Sdamien sc->prioq.next = (sc->prioq.next + 1) % RT2560_PRIO_RING_COUNT; 1059170530Ssam 1060170530Ssam if (m->m_flags & M_TXCB) 1061170530Ssam ieee80211_process_callback(ni, m, 1062170530Ssam (flags & RT2560_TX_RESULT_MASK) &~ 1063170530Ssam (RT2560_TX_SUCCESS | RT2560_TX_SUCCESS_RETRY)); 1064170530Ssam m_freem(m); 1065170530Ssam ieee80211_free_node(ni); 1066156321Sdamien } 1067156321Sdamien 1068156321Sdamien bus_dmamap_sync(sc->prioq.desc_dmat, sc->prioq.desc_map, 1069156321Sdamien BUS_DMASYNC_PREWRITE); 1070156321Sdamien 1071156321Sdamien sc->sc_tx_timer = 0; 1072156321Sdamien ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 1073156321Sdamien rt2560_start(ifp); 1074156321Sdamien} 1075156321Sdamien 1076156321Sdamien/* 1077156321Sdamien * Some frames were processed by the hardware cipher engine and are ready for 1078156321Sdamien * transmission to the IEEE802.11 layer. 1079156321Sdamien */ 1080156321Sdamienstatic void 1081156321Sdamienrt2560_decryption_intr(struct rt2560_softc *sc) 1082156321Sdamien{ 1083156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 1084156321Sdamien struct ifnet *ifp = ic->ic_ifp; 1085156321Sdamien struct rt2560_rx_desc *desc; 1086156321Sdamien struct rt2560_rx_data *data; 1087156321Sdamien bus_addr_t physaddr; 1088156321Sdamien struct ieee80211_frame *wh; 1089156321Sdamien struct ieee80211_node *ni; 1090156321Sdamien struct rt2560_node *rn; 1091156321Sdamien struct mbuf *mnew, *m; 1092156321Sdamien int hw, error; 1093156321Sdamien 1094156321Sdamien /* retrieve last decriptor index processed by cipher engine */ 1095156321Sdamien hw = RAL_READ(sc, RT2560_SECCSR0) - sc->rxq.physaddr; 1096156321Sdamien hw /= RT2560_RX_DESC_SIZE; 1097156321Sdamien 1098156321Sdamien bus_dmamap_sync(sc->rxq.desc_dmat, sc->rxq.desc_map, 1099156321Sdamien BUS_DMASYNC_POSTREAD); 1100156321Sdamien 1101156321Sdamien for (; sc->rxq.cur_decrypt != hw;) { 1102156321Sdamien desc = &sc->rxq.desc[sc->rxq.cur_decrypt]; 1103156321Sdamien data = &sc->rxq.data[sc->rxq.cur_decrypt]; 1104156321Sdamien 1105156321Sdamien if ((le32toh(desc->flags) & RT2560_RX_BUSY) || 1106156321Sdamien (le32toh(desc->flags) & RT2560_RX_CIPHER_BUSY)) 1107156321Sdamien break; 1108156321Sdamien 1109156321Sdamien if (data->drop) { 1110156321Sdamien ifp->if_ierrors++; 1111156321Sdamien goto skip; 1112156321Sdamien } 1113156321Sdamien 1114156321Sdamien if ((le32toh(desc->flags) & RT2560_RX_CIPHER_MASK) != 0 && 1115156321Sdamien (le32toh(desc->flags) & RT2560_RX_ICV_ERROR)) { 1116156321Sdamien ifp->if_ierrors++; 1117156321Sdamien goto skip; 1118156321Sdamien } 1119156321Sdamien 1120156321Sdamien /* 1121156321Sdamien * Try to allocate a new mbuf for this ring element and load it 1122156321Sdamien * before processing the current mbuf. If the ring element 1123156321Sdamien * cannot be loaded, drop the received packet and reuse the old 1124156321Sdamien * mbuf. In the unlikely case that the old mbuf can't be 1125156321Sdamien * reloaded either, explicitly panic. 1126156321Sdamien */ 1127156321Sdamien mnew = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR); 1128156321Sdamien if (mnew == NULL) { 1129156321Sdamien ifp->if_ierrors++; 1130156321Sdamien goto skip; 1131156321Sdamien } 1132156321Sdamien 1133156321Sdamien bus_dmamap_sync(sc->rxq.data_dmat, data->map, 1134156321Sdamien BUS_DMASYNC_POSTREAD); 1135156321Sdamien bus_dmamap_unload(sc->rxq.data_dmat, data->map); 1136156321Sdamien 1137156321Sdamien error = bus_dmamap_load(sc->rxq.data_dmat, data->map, 1138156321Sdamien mtod(mnew, void *), MCLBYTES, rt2560_dma_map_addr, 1139156321Sdamien &physaddr, 0); 1140156321Sdamien if (error != 0) { 1141156321Sdamien m_freem(mnew); 1142156321Sdamien 1143156321Sdamien /* try to reload the old mbuf */ 1144156321Sdamien error = bus_dmamap_load(sc->rxq.data_dmat, data->map, 1145156321Sdamien mtod(data->m, void *), MCLBYTES, 1146156321Sdamien rt2560_dma_map_addr, &physaddr, 0); 1147156321Sdamien if (error != 0) { 1148156321Sdamien /* very unlikely that it will fail... */ 1149156321Sdamien panic("%s: could not load old rx mbuf", 1150156321Sdamien device_get_name(sc->sc_dev)); 1151156321Sdamien } 1152156321Sdamien ifp->if_ierrors++; 1153156321Sdamien goto skip; 1154156321Sdamien } 1155156321Sdamien 1156156321Sdamien /* 1157156321Sdamien * New mbuf successfully loaded, update Rx ring and continue 1158156321Sdamien * processing. 1159156321Sdamien */ 1160156321Sdamien m = data->m; 1161156321Sdamien data->m = mnew; 1162156321Sdamien desc->physaddr = htole32(physaddr); 1163156321Sdamien 1164156321Sdamien /* finalize mbuf */ 1165156321Sdamien m->m_pkthdr.rcvif = ifp; 1166156321Sdamien m->m_pkthdr.len = m->m_len = 1167156321Sdamien (le32toh(desc->flags) >> 16) & 0xfff; 1168156321Sdamien 1169159180Scsjp if (bpf_peers_present(sc->sc_drvbpf)) { 1170156321Sdamien struct rt2560_rx_radiotap_header *tap = &sc->sc_rxtap; 1171156321Sdamien uint32_t tsf_lo, tsf_hi; 1172156321Sdamien 1173156321Sdamien /* get timestamp (low and high 32 bits) */ 1174156321Sdamien tsf_hi = RAL_READ(sc, RT2560_CSR17); 1175156321Sdamien tsf_lo = RAL_READ(sc, RT2560_CSR16); 1176156321Sdamien 1177156321Sdamien tap->wr_tsf = 1178156321Sdamien htole64(((uint64_t)tsf_hi << 32) | tsf_lo); 1179156321Sdamien tap->wr_flags = 0; 1180156321Sdamien tap->wr_rate = rt2560_rxrate(desc); 1181156321Sdamien tap->wr_chan_freq = htole16(ic->ic_curchan->ic_freq); 1182156321Sdamien tap->wr_chan_flags = htole16(ic->ic_curchan->ic_flags); 1183156321Sdamien tap->wr_antenna = sc->rx_ant; 1184170530Ssam tap->wr_antsignal = RT2560_RSSI(sc, desc->rssi); 1185156321Sdamien 1186156321Sdamien bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_rxtap_len, m); 1187156321Sdamien } 1188156321Sdamien 1189170530Ssam sc->sc_flags |= RAL_INPUT_RUNNING; 1190170530Ssam RAL_UNLOCK(sc); 1191156321Sdamien wh = mtod(m, struct ieee80211_frame *); 1192156321Sdamien ni = ieee80211_find_rxnode(ic, 1193156321Sdamien (struct ieee80211_frame_min *)wh); 1194156321Sdamien 1195156321Sdamien /* send the frame to the 802.11 layer */ 1196170530Ssam ieee80211_input(ic, m, ni, RT2560_RSSI(sc, desc->rssi), 1197170530Ssam RT2560_NOISE_FLOOR, 0); 1198156321Sdamien 1199156321Sdamien /* give rssi to the rate adatation algorithm */ 1200156321Sdamien rn = (struct rt2560_node *)ni; 1201170530Ssam ral_rssadapt_input(ic, ni, &rn->rssadapt, 1202170530Ssam RT2560_RSSI(sc, desc->rssi)); 1203156321Sdamien 1204156321Sdamien /* node is no longer needed */ 1205156321Sdamien ieee80211_free_node(ni); 1206156321Sdamien 1207170530Ssam RAL_LOCK(sc); 1208170530Ssam sc->sc_flags &= ~RAL_INPUT_RUNNING; 1209156321Sdamienskip: desc->flags = htole32(RT2560_RX_BUSY); 1210156321Sdamien 1211156321Sdamien DPRINTFN(15, ("decryption done idx=%u\n", sc->rxq.cur_decrypt)); 1212156321Sdamien 1213156321Sdamien sc->rxq.cur_decrypt = 1214156321Sdamien (sc->rxq.cur_decrypt + 1) % RT2560_RX_RING_COUNT; 1215156321Sdamien } 1216156321Sdamien 1217156321Sdamien bus_dmamap_sync(sc->rxq.desc_dmat, sc->rxq.desc_map, 1218156321Sdamien BUS_DMASYNC_PREWRITE); 1219156321Sdamien} 1220156321Sdamien 1221156321Sdamien/* 1222156321Sdamien * Some frames were received. Pass them to the hardware cipher engine before 1223156321Sdamien * sending them to the 802.11 layer. 1224156321Sdamien */ 1225156321Sdamienstatic void 1226156321Sdamienrt2560_rx_intr(struct rt2560_softc *sc) 1227156321Sdamien{ 1228156321Sdamien struct rt2560_rx_desc *desc; 1229156321Sdamien struct rt2560_rx_data *data; 1230156321Sdamien 1231156321Sdamien bus_dmamap_sync(sc->rxq.desc_dmat, sc->rxq.desc_map, 1232156321Sdamien BUS_DMASYNC_POSTREAD); 1233156321Sdamien 1234156321Sdamien for (;;) { 1235156321Sdamien desc = &sc->rxq.desc[sc->rxq.cur]; 1236156321Sdamien data = &sc->rxq.data[sc->rxq.cur]; 1237156321Sdamien 1238156321Sdamien if ((le32toh(desc->flags) & RT2560_RX_BUSY) || 1239156321Sdamien (le32toh(desc->flags) & RT2560_RX_CIPHER_BUSY)) 1240156321Sdamien break; 1241156321Sdamien 1242156321Sdamien data->drop = 0; 1243156321Sdamien 1244156321Sdamien if ((le32toh(desc->flags) & RT2560_RX_PHY_ERROR) || 1245156321Sdamien (le32toh(desc->flags) & RT2560_RX_CRC_ERROR)) { 1246156321Sdamien /* 1247156321Sdamien * This should not happen since we did not request 1248156321Sdamien * to receive those frames when we filled RXCSR0. 1249156321Sdamien */ 1250156321Sdamien DPRINTFN(5, ("PHY or CRC error flags 0x%08x\n", 1251156321Sdamien le32toh(desc->flags))); 1252156321Sdamien data->drop = 1; 1253156321Sdamien } 1254156321Sdamien 1255156321Sdamien if (((le32toh(desc->flags) >> 16) & 0xfff) > MCLBYTES) { 1256156321Sdamien DPRINTFN(5, ("bad length\n")); 1257156321Sdamien data->drop = 1; 1258156321Sdamien } 1259156321Sdamien 1260156321Sdamien /* mark the frame for decryption */ 1261156321Sdamien desc->flags |= htole32(RT2560_RX_CIPHER_BUSY); 1262156321Sdamien 1263156321Sdamien DPRINTFN(15, ("rx done idx=%u\n", sc->rxq.cur)); 1264156321Sdamien 1265156321Sdamien sc->rxq.cur = (sc->rxq.cur + 1) % RT2560_RX_RING_COUNT; 1266156321Sdamien } 1267156321Sdamien 1268156321Sdamien bus_dmamap_sync(sc->rxq.desc_dmat, sc->rxq.desc_map, 1269156321Sdamien BUS_DMASYNC_PREWRITE); 1270156321Sdamien 1271156321Sdamien /* kick decrypt */ 1272156321Sdamien RAL_WRITE(sc, RT2560_SECCSR0, RT2560_KICK_DECRYPT); 1273156321Sdamien} 1274156321Sdamien 1275156321Sdamien/* 1276156321Sdamien * This function is called periodically in IBSS mode when a new beacon must be 1277156321Sdamien * sent out. 1278156321Sdamien */ 1279156321Sdamienstatic void 1280156321Sdamienrt2560_beacon_expire(struct rt2560_softc *sc) 1281156321Sdamien{ 1282156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 1283156321Sdamien struct rt2560_tx_data *data; 1284156321Sdamien 1285156321Sdamien if (ic->ic_opmode != IEEE80211_M_IBSS && 1286156321Sdamien ic->ic_opmode != IEEE80211_M_HOSTAP) 1287170530Ssam return; 1288156321Sdamien 1289156321Sdamien data = &sc->bcnq.data[sc->bcnq.next]; 1290170530Ssam /* 1291170530Ssam * Don't send beacon if bsschan isn't set 1292170530Ssam */ 1293170530Ssam if (data->ni == NULL) 1294170530Ssam return; 1295156321Sdamien 1296156321Sdamien bus_dmamap_sync(sc->bcnq.data_dmat, data->map, BUS_DMASYNC_POSTWRITE); 1297156321Sdamien bus_dmamap_unload(sc->bcnq.data_dmat, data->map); 1298156321Sdamien 1299156321Sdamien ieee80211_beacon_update(ic, data->ni, &sc->sc_bo, data->m, 1); 1300156321Sdamien 1301159180Scsjp if (bpf_peers_present(ic->ic_rawbpf)) 1302156321Sdamien bpf_mtap(ic->ic_rawbpf, data->m); 1303156321Sdamien 1304156321Sdamien rt2560_tx_bcn(sc, data->m, data->ni); 1305156321Sdamien 1306156321Sdamien DPRINTFN(15, ("beacon expired\n")); 1307156321Sdamien 1308156321Sdamien sc->bcnq.next = (sc->bcnq.next + 1) % RT2560_BEACON_RING_COUNT; 1309156321Sdamien} 1310156321Sdamien 1311156321Sdamien/* ARGSUSED */ 1312156321Sdamienstatic void 1313156321Sdamienrt2560_wakeup_expire(struct rt2560_softc *sc) 1314156321Sdamien{ 1315156321Sdamien DPRINTFN(2, ("wakeup expired\n")); 1316156321Sdamien} 1317156321Sdamien 1318156321Sdamienvoid 1319156321Sdamienrt2560_intr(void *arg) 1320156321Sdamien{ 1321156321Sdamien struct rt2560_softc *sc = arg; 1322156975Sdamien struct ifnet *ifp = sc->sc_ifp; 1323156321Sdamien uint32_t r; 1324156321Sdamien 1325156321Sdamien RAL_LOCK(sc); 1326156321Sdamien 1327156321Sdamien /* disable interrupts */ 1328156321Sdamien RAL_WRITE(sc, RT2560_CSR8, 0xffffffff); 1329156321Sdamien 1330156975Sdamien /* don't re-enable interrupts if we're shutting down */ 1331156975Sdamien if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) { 1332156975Sdamien RAL_UNLOCK(sc); 1333156975Sdamien return; 1334156975Sdamien } 1335156975Sdamien 1336156321Sdamien r = RAL_READ(sc, RT2560_CSR7); 1337156321Sdamien RAL_WRITE(sc, RT2560_CSR7, r); 1338156321Sdamien 1339156321Sdamien if (r & RT2560_BEACON_EXPIRE) 1340156321Sdamien rt2560_beacon_expire(sc); 1341156321Sdamien 1342156321Sdamien if (r & RT2560_WAKEUP_EXPIRE) 1343156321Sdamien rt2560_wakeup_expire(sc); 1344156321Sdamien 1345156321Sdamien if (r & RT2560_ENCRYPTION_DONE) 1346156321Sdamien rt2560_encryption_intr(sc); 1347156321Sdamien 1348156321Sdamien if (r & RT2560_TX_DONE) 1349156321Sdamien rt2560_tx_intr(sc); 1350156321Sdamien 1351156321Sdamien if (r & RT2560_PRIO_DONE) 1352156321Sdamien rt2560_prio_intr(sc); 1353156321Sdamien 1354156321Sdamien if (r & RT2560_DECRYPTION_DONE) 1355156321Sdamien rt2560_decryption_intr(sc); 1356156321Sdamien 1357156321Sdamien if (r & RT2560_RX_DONE) 1358156321Sdamien rt2560_rx_intr(sc); 1359156321Sdamien 1360156321Sdamien /* re-enable interrupts */ 1361156321Sdamien RAL_WRITE(sc, RT2560_CSR8, RT2560_INTR_MASK); 1362156321Sdamien 1363156321Sdamien RAL_UNLOCK(sc); 1364156321Sdamien} 1365156321Sdamien 1366156321Sdamien/* quickly determine if a given rate is CCK or OFDM */ 1367156321Sdamien#define RAL_RATE_IS_OFDM(rate) ((rate) >= 12 && (rate) != 22) 1368156321Sdamien 1369156321Sdamien#define RAL_ACK_SIZE 14 /* 10 + 4(FCS) */ 1370156321Sdamien#define RAL_CTS_SIZE 14 /* 10 + 4(FCS) */ 1371156321Sdamien 1372156321Sdamien#define RAL_SIFS 10 /* us */ 1373156321Sdamien 1374156321Sdamien#define RT2560_TXRX_TURNAROUND 10 /* us */ 1375156321Sdamien 1376156321Sdamien/* 1377156321Sdamien * This function is only used by the Rx radiotap code. 1378156321Sdamien */ 1379156321Sdamienstatic uint8_t 1380156321Sdamienrt2560_rxrate(struct rt2560_rx_desc *desc) 1381156321Sdamien{ 1382156321Sdamien if (le32toh(desc->flags) & RT2560_RX_OFDM) { 1383156321Sdamien /* reverse function of rt2560_plcp_signal */ 1384156321Sdamien switch (desc->rate) { 1385156321Sdamien case 0xb: return 12; 1386156321Sdamien case 0xf: return 18; 1387156321Sdamien case 0xa: return 24; 1388156321Sdamien case 0xe: return 36; 1389156321Sdamien case 0x9: return 48; 1390156321Sdamien case 0xd: return 72; 1391156321Sdamien case 0x8: return 96; 1392156321Sdamien case 0xc: return 108; 1393156321Sdamien } 1394156321Sdamien } else { 1395156321Sdamien if (desc->rate == 10) 1396156321Sdamien return 2; 1397156321Sdamien if (desc->rate == 20) 1398156321Sdamien return 4; 1399156321Sdamien if (desc->rate == 55) 1400156321Sdamien return 11; 1401156321Sdamien if (desc->rate == 110) 1402156321Sdamien return 22; 1403156321Sdamien } 1404156321Sdamien return 2; /* should not get there */ 1405156321Sdamien} 1406156321Sdamien 1407156321Sdamien/* 1408156321Sdamien * Return the expected ack rate for a frame transmitted at rate `rate'. 1409156321Sdamien * XXX: this should depend on the destination node basic rate set. 1410156321Sdamien */ 1411156321Sdamienstatic int 1412156321Sdamienrt2560_ack_rate(struct ieee80211com *ic, int rate) 1413156321Sdamien{ 1414156321Sdamien switch (rate) { 1415156321Sdamien /* CCK rates */ 1416156321Sdamien case 2: 1417156321Sdamien return 2; 1418156321Sdamien case 4: 1419156321Sdamien case 11: 1420156321Sdamien case 22: 1421156321Sdamien return (ic->ic_curmode == IEEE80211_MODE_11B) ? 4 : rate; 1422156321Sdamien 1423156321Sdamien /* OFDM rates */ 1424156321Sdamien case 12: 1425156321Sdamien case 18: 1426156321Sdamien return 12; 1427156321Sdamien case 24: 1428156321Sdamien case 36: 1429156321Sdamien return 24; 1430156321Sdamien case 48: 1431156321Sdamien case 72: 1432156321Sdamien case 96: 1433156321Sdamien case 108: 1434156321Sdamien return 48; 1435156321Sdamien } 1436156321Sdamien 1437156321Sdamien /* default to 1Mbps */ 1438156321Sdamien return 2; 1439156321Sdamien} 1440156321Sdamien 1441156321Sdamien/* 1442156321Sdamien * Compute the duration (in us) needed to transmit `len' bytes at rate `rate'. 1443156321Sdamien * The function automatically determines the operating mode depending on the 1444156321Sdamien * given rate. `flags' indicates whether short preamble is in use or not. 1445156321Sdamien */ 1446156321Sdamienstatic uint16_t 1447156321Sdamienrt2560_txtime(int len, int rate, uint32_t flags) 1448156321Sdamien{ 1449156321Sdamien uint16_t txtime; 1450156321Sdamien 1451156321Sdamien if (RAL_RATE_IS_OFDM(rate)) { 1452156321Sdamien /* IEEE Std 802.11a-1999, pp. 37 */ 1453156321Sdamien txtime = (8 + 4 * len + 3 + rate - 1) / rate; 1454156321Sdamien txtime = 16 + 4 + 4 * txtime + 6; 1455156321Sdamien } else { 1456156321Sdamien /* IEEE Std 802.11b-1999, pp. 28 */ 1457156321Sdamien txtime = (16 * len + rate - 1) / rate; 1458156321Sdamien if (rate != 2 && (flags & IEEE80211_F_SHPREAMBLE)) 1459156321Sdamien txtime += 72 + 24; 1460156321Sdamien else 1461156321Sdamien txtime += 144 + 48; 1462156321Sdamien } 1463156321Sdamien 1464156321Sdamien return txtime; 1465156321Sdamien} 1466156321Sdamien 1467156321Sdamienstatic uint8_t 1468156321Sdamienrt2560_plcp_signal(int rate) 1469156321Sdamien{ 1470156321Sdamien switch (rate) { 1471156321Sdamien /* CCK rates (returned values are device-dependent) */ 1472156321Sdamien case 2: return 0x0; 1473156321Sdamien case 4: return 0x1; 1474156321Sdamien case 11: return 0x2; 1475156321Sdamien case 22: return 0x3; 1476156321Sdamien 1477156321Sdamien /* OFDM rates (cf IEEE Std 802.11a-1999, pp. 14 Table 80) */ 1478156321Sdamien case 12: return 0xb; 1479156321Sdamien case 18: return 0xf; 1480156321Sdamien case 24: return 0xa; 1481156321Sdamien case 36: return 0xe; 1482156321Sdamien case 48: return 0x9; 1483156321Sdamien case 72: return 0xd; 1484156321Sdamien case 96: return 0x8; 1485156321Sdamien case 108: return 0xc; 1486156321Sdamien 1487156321Sdamien /* unsupported rates (should not get there) */ 1488156321Sdamien default: return 0xff; 1489156321Sdamien } 1490156321Sdamien} 1491156321Sdamien 1492156321Sdamienstatic void 1493156321Sdamienrt2560_setup_tx_desc(struct rt2560_softc *sc, struct rt2560_tx_desc *desc, 1494156321Sdamien uint32_t flags, int len, int rate, int encrypt, bus_addr_t physaddr) 1495156321Sdamien{ 1496156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 1497156321Sdamien uint16_t plcp_length; 1498156321Sdamien int remainder; 1499156321Sdamien 1500156321Sdamien desc->flags = htole32(flags); 1501156321Sdamien desc->flags |= htole32(len << 16); 1502156321Sdamien desc->flags |= encrypt ? htole32(RT2560_TX_CIPHER_BUSY) : 1503156321Sdamien htole32(RT2560_TX_BUSY | RT2560_TX_VALID); 1504156321Sdamien 1505156321Sdamien desc->physaddr = htole32(physaddr); 1506156321Sdamien desc->wme = htole16( 1507156321Sdamien RT2560_AIFSN(2) | 1508156321Sdamien RT2560_LOGCWMIN(3) | 1509156321Sdamien RT2560_LOGCWMAX(8)); 1510156321Sdamien 1511156321Sdamien /* setup PLCP fields */ 1512156321Sdamien desc->plcp_signal = rt2560_plcp_signal(rate); 1513156321Sdamien desc->plcp_service = 4; 1514156321Sdamien 1515156321Sdamien len += IEEE80211_CRC_LEN; 1516156321Sdamien if (RAL_RATE_IS_OFDM(rate)) { 1517156321Sdamien desc->flags |= htole32(RT2560_TX_OFDM); 1518156321Sdamien 1519156321Sdamien plcp_length = len & 0xfff; 1520156321Sdamien desc->plcp_length_hi = plcp_length >> 6; 1521156321Sdamien desc->plcp_length_lo = plcp_length & 0x3f; 1522156321Sdamien } else { 1523156321Sdamien plcp_length = (16 * len + rate - 1) / rate; 1524156321Sdamien if (rate == 22) { 1525156321Sdamien remainder = (16 * len) % 22; 1526156321Sdamien if (remainder != 0 && remainder < 7) 1527156321Sdamien desc->plcp_service |= RT2560_PLCP_LENGEXT; 1528156321Sdamien } 1529156321Sdamien desc->plcp_length_hi = plcp_length >> 8; 1530156321Sdamien desc->plcp_length_lo = plcp_length & 0xff; 1531156321Sdamien 1532156321Sdamien if (rate != 2 && (ic->ic_flags & IEEE80211_F_SHPREAMBLE)) 1533156321Sdamien desc->plcp_signal |= 0x08; 1534156321Sdamien } 1535156321Sdamien} 1536156321Sdamien 1537156321Sdamienstatic int 1538156321Sdamienrt2560_tx_bcn(struct rt2560_softc *sc, struct mbuf *m0, 1539156321Sdamien struct ieee80211_node *ni) 1540156321Sdamien{ 1541156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 1542156321Sdamien struct rt2560_tx_desc *desc; 1543156321Sdamien struct rt2560_tx_data *data; 1544156321Sdamien bus_dma_segment_t segs[RT2560_MAX_SCATTER]; 1545156321Sdamien int nsegs, rate, error; 1546156321Sdamien 1547156321Sdamien desc = &sc->bcnq.desc[sc->bcnq.cur]; 1548156321Sdamien data = &sc->bcnq.data[sc->bcnq.cur]; 1549156321Sdamien 1550156321Sdamien rate = IEEE80211_IS_CHAN_5GHZ(ni->ni_chan) ? 12 : 2; 1551156321Sdamien 1552156321Sdamien error = bus_dmamap_load_mbuf_sg(sc->bcnq.data_dmat, data->map, m0, 1553156321Sdamien segs, &nsegs, BUS_DMA_NOWAIT); 1554156321Sdamien if (error != 0) { 1555156321Sdamien device_printf(sc->sc_dev, "could not map mbuf (error %d)\n", 1556156321Sdamien error); 1557156321Sdamien m_freem(m0); 1558156321Sdamien return error; 1559156321Sdamien } 1560156321Sdamien 1561159180Scsjp if (bpf_peers_present(sc->sc_drvbpf)) { 1562156321Sdamien struct rt2560_tx_radiotap_header *tap = &sc->sc_txtap; 1563156321Sdamien 1564156321Sdamien tap->wt_flags = 0; 1565156321Sdamien tap->wt_rate = rate; 1566156321Sdamien tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq); 1567156321Sdamien tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags); 1568156321Sdamien tap->wt_antenna = sc->tx_ant; 1569156321Sdamien 1570156321Sdamien bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m0); 1571156321Sdamien } 1572156321Sdamien 1573156321Sdamien data->m = m0; 1574156321Sdamien data->ni = ni; 1575156321Sdamien 1576156321Sdamien rt2560_setup_tx_desc(sc, desc, RT2560_TX_IFS_NEWBACKOFF | 1577156321Sdamien RT2560_TX_TIMESTAMP, m0->m_pkthdr.len, rate, 0, segs->ds_addr); 1578156321Sdamien 1579156321Sdamien DPRINTFN(10, ("sending beacon frame len=%u idx=%u rate=%u\n", 1580156321Sdamien m0->m_pkthdr.len, sc->bcnq.cur, rate)); 1581156321Sdamien 1582156321Sdamien bus_dmamap_sync(sc->bcnq.data_dmat, data->map, BUS_DMASYNC_PREWRITE); 1583156321Sdamien bus_dmamap_sync(sc->bcnq.desc_dmat, sc->bcnq.desc_map, 1584156321Sdamien BUS_DMASYNC_PREWRITE); 1585156321Sdamien 1586156321Sdamien sc->bcnq.cur = (sc->bcnq.cur + 1) % RT2560_BEACON_RING_COUNT; 1587156321Sdamien 1588156321Sdamien return 0; 1589156321Sdamien} 1590156321Sdamien 1591156321Sdamienstatic int 1592156321Sdamienrt2560_tx_mgt(struct rt2560_softc *sc, struct mbuf *m0, 1593156321Sdamien struct ieee80211_node *ni) 1594156321Sdamien{ 1595156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 1596156321Sdamien struct rt2560_tx_desc *desc; 1597156321Sdamien struct rt2560_tx_data *data; 1598156321Sdamien struct ieee80211_frame *wh; 1599156321Sdamien bus_dma_segment_t segs[RT2560_MAX_SCATTER]; 1600156321Sdamien uint16_t dur; 1601156321Sdamien uint32_t flags = 0; 1602156321Sdamien int nsegs, rate, error; 1603156321Sdamien 1604156321Sdamien desc = &sc->prioq.desc[sc->prioq.cur]; 1605156321Sdamien data = &sc->prioq.data[sc->prioq.cur]; 1606156321Sdamien 1607156321Sdamien rate = IEEE80211_IS_CHAN_5GHZ(ic->ic_curchan) ? 12 : 2; 1608156321Sdamien 1609156321Sdamien error = bus_dmamap_load_mbuf_sg(sc->prioq.data_dmat, data->map, m0, 1610156321Sdamien segs, &nsegs, 0); 1611156321Sdamien if (error != 0) { 1612156321Sdamien device_printf(sc->sc_dev, "could not map mbuf (error %d)\n", 1613156321Sdamien error); 1614156321Sdamien m_freem(m0); 1615156321Sdamien return error; 1616156321Sdamien } 1617156321Sdamien 1618159180Scsjp if (bpf_peers_present(sc->sc_drvbpf)) { 1619156321Sdamien struct rt2560_tx_radiotap_header *tap = &sc->sc_txtap; 1620156321Sdamien 1621156321Sdamien tap->wt_flags = 0; 1622156321Sdamien tap->wt_rate = rate; 1623156321Sdamien tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq); 1624156321Sdamien tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags); 1625156321Sdamien tap->wt_antenna = sc->tx_ant; 1626156321Sdamien 1627156321Sdamien bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m0); 1628156321Sdamien } 1629156321Sdamien 1630156321Sdamien data->m = m0; 1631156321Sdamien data->ni = ni; 1632156321Sdamien 1633156321Sdamien wh = mtod(m0, struct ieee80211_frame *); 1634156321Sdamien 1635156321Sdamien if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) { 1636156321Sdamien flags |= RT2560_TX_ACK; 1637156321Sdamien 1638156321Sdamien dur = rt2560_txtime(RAL_ACK_SIZE, rate, ic->ic_flags) + 1639156321Sdamien RAL_SIFS; 1640156321Sdamien *(uint16_t *)wh->i_dur = htole16(dur); 1641156321Sdamien 1642156321Sdamien /* tell hardware to add timestamp for probe responses */ 1643156321Sdamien if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) == 1644156321Sdamien IEEE80211_FC0_TYPE_MGT && 1645156321Sdamien (wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) == 1646156321Sdamien IEEE80211_FC0_SUBTYPE_PROBE_RESP) 1647156321Sdamien flags |= RT2560_TX_TIMESTAMP; 1648156321Sdamien } 1649156321Sdamien 1650156321Sdamien rt2560_setup_tx_desc(sc, desc, flags, m0->m_pkthdr.len, rate, 0, 1651156321Sdamien segs->ds_addr); 1652156321Sdamien 1653156321Sdamien bus_dmamap_sync(sc->prioq.data_dmat, data->map, BUS_DMASYNC_PREWRITE); 1654156321Sdamien bus_dmamap_sync(sc->prioq.desc_dmat, sc->prioq.desc_map, 1655156321Sdamien BUS_DMASYNC_PREWRITE); 1656156321Sdamien 1657156321Sdamien DPRINTFN(10, ("sending mgt frame len=%u idx=%u rate=%u\n", 1658156321Sdamien m0->m_pkthdr.len, sc->prioq.cur, rate)); 1659156321Sdamien 1660156321Sdamien /* kick prio */ 1661156321Sdamien sc->prioq.queued++; 1662156321Sdamien sc->prioq.cur = (sc->prioq.cur + 1) % RT2560_PRIO_RING_COUNT; 1663156321Sdamien RAL_WRITE(sc, RT2560_TXCSR0, RT2560_KICK_PRIO); 1664156321Sdamien 1665156321Sdamien return 0; 1666156321Sdamien} 1667156321Sdamien 1668160691Ssamstatic int 1669160691Ssamrt2560_tx_raw(struct rt2560_softc *sc, struct mbuf *m0, 1670160691Ssam struct ieee80211_node *ni, const struct ieee80211_bpf_params *params) 1671160691Ssam{ 1672160691Ssam struct ieee80211com *ic = &sc->sc_ic; 1673160691Ssam struct rt2560_tx_desc *desc; 1674160691Ssam struct rt2560_tx_data *data; 1675160691Ssam bus_dma_segment_t segs[RT2560_MAX_SCATTER]; 1676160691Ssam uint32_t flags; 1677160691Ssam int nsegs, rate, error; 1678160691Ssam 1679160691Ssam desc = &sc->prioq.desc[sc->prioq.cur]; 1680160691Ssam data = &sc->prioq.data[sc->prioq.cur]; 1681160691Ssam 1682160691Ssam rate = params->ibp_rate0 & IEEE80211_RATE_VAL; 1683160691Ssam /* XXX validate */ 1684168860Ssephe if (rate == 0) { 1685168860Ssephe m_freem(m0); 1686160691Ssam return EINVAL; 1687168860Ssephe } 1688160691Ssam 1689160691Ssam error = bus_dmamap_load_mbuf_sg(sc->prioq.data_dmat, data->map, m0, 1690160691Ssam segs, &nsegs, 0); 1691160691Ssam if (error != 0) { 1692160691Ssam device_printf(sc->sc_dev, "could not map mbuf (error %d)\n", 1693160691Ssam error); 1694160691Ssam m_freem(m0); 1695160691Ssam return error; 1696160691Ssam } 1697160691Ssam 1698160691Ssam if (bpf_peers_present(sc->sc_drvbpf)) { 1699160691Ssam struct rt2560_tx_radiotap_header *tap = &sc->sc_txtap; 1700160691Ssam 1701160691Ssam tap->wt_flags = 0; 1702160691Ssam tap->wt_rate = rate; 1703160691Ssam tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq); 1704160691Ssam tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags); 1705160691Ssam tap->wt_antenna = sc->tx_ant; 1706160691Ssam 1707160691Ssam bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m0); 1708160691Ssam } 1709160691Ssam 1710160691Ssam data->m = m0; 1711160691Ssam data->ni = ni; 1712160691Ssam 1713160691Ssam flags = 0; 1714160691Ssam if ((params->ibp_flags & IEEE80211_BPF_NOACK) == 0) 1715160691Ssam flags |= RT2560_TX_ACK; 1716160691Ssam 1717160691Ssam /* XXX need to setup descriptor ourself */ 1718160691Ssam rt2560_setup_tx_desc(sc, desc, flags, m0->m_pkthdr.len, 1719160691Ssam rate, (params->ibp_flags & IEEE80211_BPF_CRYPTO) != 0, 1720160691Ssam segs->ds_addr); 1721160691Ssam 1722160691Ssam bus_dmamap_sync(sc->prioq.data_dmat, data->map, BUS_DMASYNC_PREWRITE); 1723160691Ssam bus_dmamap_sync(sc->prioq.desc_dmat, sc->prioq.desc_map, 1724160691Ssam BUS_DMASYNC_PREWRITE); 1725160691Ssam 1726160691Ssam DPRINTFN(10, ("sending raw frame len=%u idx=%u rate=%u\n", 1727160691Ssam m0->m_pkthdr.len, sc->prioq.cur, rate)); 1728160691Ssam 1729160691Ssam /* kick prio */ 1730160691Ssam sc->prioq.queued++; 1731160691Ssam sc->prioq.cur = (sc->prioq.cur + 1) % RT2560_PRIO_RING_COUNT; 1732160691Ssam RAL_WRITE(sc, RT2560_TXCSR0, RT2560_KICK_PRIO); 1733160691Ssam 1734160691Ssam return 0; 1735160691Ssam} 1736160691Ssam 1737156321Sdamien/* 1738156321Sdamien * Build a RTS control frame. 1739156321Sdamien */ 1740156321Sdamienstatic struct mbuf * 1741156321Sdamienrt2560_get_rts(struct rt2560_softc *sc, struct ieee80211_frame *wh, 1742156321Sdamien uint16_t dur) 1743156321Sdamien{ 1744156321Sdamien struct ieee80211_frame_rts *rts; 1745156321Sdamien struct mbuf *m; 1746156321Sdamien 1747156321Sdamien MGETHDR(m, M_DONTWAIT, MT_DATA); 1748156321Sdamien if (m == NULL) { 1749156321Sdamien sc->sc_ic.ic_stats.is_tx_nobuf++; 1750156321Sdamien device_printf(sc->sc_dev, "could not allocate RTS frame\n"); 1751156321Sdamien return NULL; 1752156321Sdamien } 1753156321Sdamien 1754156321Sdamien rts = mtod(m, struct ieee80211_frame_rts *); 1755156321Sdamien 1756156321Sdamien rts->i_fc[0] = IEEE80211_FC0_VERSION_0 | IEEE80211_FC0_TYPE_CTL | 1757156321Sdamien IEEE80211_FC0_SUBTYPE_RTS; 1758156321Sdamien rts->i_fc[1] = IEEE80211_FC1_DIR_NODS; 1759156321Sdamien *(uint16_t *)rts->i_dur = htole16(dur); 1760156321Sdamien IEEE80211_ADDR_COPY(rts->i_ra, wh->i_addr1); 1761156321Sdamien IEEE80211_ADDR_COPY(rts->i_ta, wh->i_addr2); 1762156321Sdamien 1763156321Sdamien m->m_pkthdr.len = m->m_len = sizeof (struct ieee80211_frame_rts); 1764156321Sdamien 1765156321Sdamien return m; 1766156321Sdamien} 1767156321Sdamien 1768156321Sdamienstatic int 1769156321Sdamienrt2560_tx_data(struct rt2560_softc *sc, struct mbuf *m0, 1770156321Sdamien struct ieee80211_node *ni) 1771156321Sdamien{ 1772156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 1773156321Sdamien struct rt2560_tx_desc *desc; 1774156321Sdamien struct rt2560_tx_data *data; 1775156321Sdamien struct rt2560_node *rn; 1776156321Sdamien struct ieee80211_frame *wh; 1777156321Sdamien struct ieee80211_key *k; 1778156321Sdamien struct mbuf *mnew; 1779156321Sdamien bus_dma_segment_t segs[RT2560_MAX_SCATTER]; 1780156321Sdamien uint16_t dur; 1781156321Sdamien uint32_t flags = 0; 1782156321Sdamien int nsegs, rate, error; 1783156321Sdamien 1784156321Sdamien wh = mtod(m0, struct ieee80211_frame *); 1785156321Sdamien 1786156321Sdamien if (ic->ic_fixed_rate != IEEE80211_FIXED_RATE_NONE) { 1787170530Ssam rate = ic->ic_fixed_rate; 1788156321Sdamien } else { 1789170530Ssam struct ieee80211_rateset *rs; 1790170530Ssam 1791156321Sdamien rs = &ni->ni_rates; 1792156321Sdamien rn = (struct rt2560_node *)ni; 1793156321Sdamien ni->ni_txrate = ral_rssadapt_choose(&rn->rssadapt, rs, wh, 1794156321Sdamien m0->m_pkthdr.len, NULL, 0); 1795156321Sdamien rate = rs->rs_rates[ni->ni_txrate]; 1796156321Sdamien } 1797156321Sdamien rate &= IEEE80211_RATE_VAL; 1798156321Sdamien 1799156321Sdamien if (wh->i_fc[1] & IEEE80211_FC1_WEP) { 1800156321Sdamien k = ieee80211_crypto_encap(ic, ni, m0); 1801156321Sdamien if (k == NULL) { 1802156321Sdamien m_freem(m0); 1803156321Sdamien return ENOBUFS; 1804156321Sdamien } 1805156321Sdamien 1806156321Sdamien /* packet header may have moved, reset our local pointer */ 1807156321Sdamien wh = mtod(m0, struct ieee80211_frame *); 1808156321Sdamien } 1809156321Sdamien 1810156321Sdamien /* 1811156321Sdamien * IEEE Std 802.11-1999, pp 82: "A STA shall use an RTS/CTS exchange 1812156321Sdamien * for directed frames only when the length of the MPDU is greater 1813156321Sdamien * than the length threshold indicated by [...]" ic_rtsthreshold. 1814156321Sdamien */ 1815156321Sdamien if (!IEEE80211_IS_MULTICAST(wh->i_addr1) && 1816156321Sdamien m0->m_pkthdr.len > ic->ic_rtsthreshold) { 1817156321Sdamien struct mbuf *m; 1818156321Sdamien uint16_t dur; 1819156321Sdamien int rtsrate, ackrate; 1820156321Sdamien 1821156321Sdamien rtsrate = IEEE80211_IS_CHAN_5GHZ(ic->ic_curchan) ? 12 : 2; 1822156321Sdamien ackrate = rt2560_ack_rate(ic, rate); 1823156321Sdamien 1824156321Sdamien dur = rt2560_txtime(m0->m_pkthdr.len + 4, rate, ic->ic_flags) + 1825156321Sdamien rt2560_txtime(RAL_CTS_SIZE, rtsrate, ic->ic_flags) + 1826156321Sdamien rt2560_txtime(RAL_ACK_SIZE, ackrate, ic->ic_flags) + 1827156321Sdamien 3 * RAL_SIFS; 1828156321Sdamien 1829156321Sdamien m = rt2560_get_rts(sc, wh, dur); 1830156321Sdamien 1831156321Sdamien desc = &sc->txq.desc[sc->txq.cur_encrypt]; 1832156321Sdamien data = &sc->txq.data[sc->txq.cur_encrypt]; 1833156321Sdamien 1834156321Sdamien error = bus_dmamap_load_mbuf_sg(sc->txq.data_dmat, data->map, 1835156321Sdamien m, segs, &nsegs, 0); 1836156321Sdamien if (error != 0) { 1837156321Sdamien device_printf(sc->sc_dev, 1838156321Sdamien "could not map mbuf (error %d)\n", error); 1839156321Sdamien m_freem(m); 1840156321Sdamien m_freem(m0); 1841156321Sdamien return error; 1842156321Sdamien } 1843156321Sdamien 1844156321Sdamien /* avoid multiple free() of the same node for each fragment */ 1845156321Sdamien ieee80211_ref_node(ni); 1846156321Sdamien 1847156321Sdamien data->m = m; 1848156321Sdamien data->ni = ni; 1849156321Sdamien 1850156321Sdamien /* RTS frames are not taken into account for rssadapt */ 1851156321Sdamien data->id.id_node = NULL; 1852156321Sdamien 1853156321Sdamien rt2560_setup_tx_desc(sc, desc, RT2560_TX_ACK | 1854156321Sdamien RT2560_TX_MORE_FRAG, m->m_pkthdr.len, rtsrate, 1, 1855156321Sdamien segs->ds_addr); 1856156321Sdamien 1857156321Sdamien bus_dmamap_sync(sc->txq.data_dmat, data->map, 1858156321Sdamien BUS_DMASYNC_PREWRITE); 1859156321Sdamien 1860156321Sdamien sc->txq.queued++; 1861156321Sdamien sc->txq.cur_encrypt = 1862156321Sdamien (sc->txq.cur_encrypt + 1) % RT2560_TX_RING_COUNT; 1863156321Sdamien 1864156321Sdamien /* 1865156321Sdamien * IEEE Std 802.11-1999: when an RTS/CTS exchange is used, the 1866156321Sdamien * asynchronous data frame shall be transmitted after the CTS 1867156321Sdamien * frame and a SIFS period. 1868156321Sdamien */ 1869156321Sdamien flags |= RT2560_TX_LONG_RETRY | RT2560_TX_IFS_SIFS; 1870156321Sdamien } 1871156321Sdamien 1872156321Sdamien data = &sc->txq.data[sc->txq.cur_encrypt]; 1873156321Sdamien desc = &sc->txq.desc[sc->txq.cur_encrypt]; 1874156321Sdamien 1875156321Sdamien error = bus_dmamap_load_mbuf_sg(sc->txq.data_dmat, data->map, m0, 1876156321Sdamien segs, &nsegs, 0); 1877156321Sdamien if (error != 0 && error != EFBIG) { 1878156321Sdamien device_printf(sc->sc_dev, "could not map mbuf (error %d)\n", 1879156321Sdamien error); 1880156321Sdamien m_freem(m0); 1881156321Sdamien return error; 1882156321Sdamien } 1883156321Sdamien if (error != 0) { 1884156321Sdamien mnew = m_defrag(m0, M_DONTWAIT); 1885156321Sdamien if (mnew == NULL) { 1886156321Sdamien device_printf(sc->sc_dev, 1887156321Sdamien "could not defragment mbuf\n"); 1888156321Sdamien m_freem(m0); 1889156321Sdamien return ENOBUFS; 1890156321Sdamien } 1891156321Sdamien m0 = mnew; 1892156321Sdamien 1893156321Sdamien error = bus_dmamap_load_mbuf_sg(sc->txq.data_dmat, data->map, 1894156321Sdamien m0, segs, &nsegs, 0); 1895156321Sdamien if (error != 0) { 1896156321Sdamien device_printf(sc->sc_dev, 1897156321Sdamien "could not map mbuf (error %d)\n", error); 1898156321Sdamien m_freem(m0); 1899156321Sdamien return error; 1900156321Sdamien } 1901156321Sdamien 1902156321Sdamien /* packet header may have moved, reset our local pointer */ 1903156321Sdamien wh = mtod(m0, struct ieee80211_frame *); 1904156321Sdamien } 1905156321Sdamien 1906159180Scsjp if (bpf_peers_present(sc->sc_drvbpf)) { 1907156321Sdamien struct rt2560_tx_radiotap_header *tap = &sc->sc_txtap; 1908156321Sdamien 1909156321Sdamien tap->wt_flags = 0; 1910156321Sdamien tap->wt_rate = rate; 1911156321Sdamien tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq); 1912156321Sdamien tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags); 1913156321Sdamien tap->wt_antenna = sc->tx_ant; 1914156321Sdamien 1915156321Sdamien bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m0); 1916156321Sdamien } 1917156321Sdamien 1918156321Sdamien data->m = m0; 1919156321Sdamien data->ni = ni; 1920156321Sdamien 1921156321Sdamien /* remember link conditions for rate adaptation algorithm */ 1922156321Sdamien if (ic->ic_fixed_rate == IEEE80211_FIXED_RATE_NONE) { 1923156321Sdamien data->id.id_len = m0->m_pkthdr.len; 1924156321Sdamien data->id.id_rateidx = ni->ni_txrate; 1925156321Sdamien data->id.id_node = ni; 1926156321Sdamien data->id.id_rssi = ni->ni_rssi; 1927156321Sdamien } else 1928156321Sdamien data->id.id_node = NULL; 1929156321Sdamien 1930156321Sdamien if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) { 1931156321Sdamien flags |= RT2560_TX_ACK; 1932156321Sdamien 1933156321Sdamien dur = rt2560_txtime(RAL_ACK_SIZE, rt2560_ack_rate(ic, rate), 1934156321Sdamien ic->ic_flags) + RAL_SIFS; 1935156321Sdamien *(uint16_t *)wh->i_dur = htole16(dur); 1936156321Sdamien } 1937156321Sdamien 1938156321Sdamien rt2560_setup_tx_desc(sc, desc, flags, m0->m_pkthdr.len, rate, 1, 1939156321Sdamien segs->ds_addr); 1940156321Sdamien 1941156321Sdamien bus_dmamap_sync(sc->txq.data_dmat, data->map, BUS_DMASYNC_PREWRITE); 1942156321Sdamien bus_dmamap_sync(sc->txq.desc_dmat, sc->txq.desc_map, 1943156321Sdamien BUS_DMASYNC_PREWRITE); 1944156321Sdamien 1945156321Sdamien DPRINTFN(10, ("sending data frame len=%u idx=%u rate=%u\n", 1946156321Sdamien m0->m_pkthdr.len, sc->txq.cur_encrypt, rate)); 1947156321Sdamien 1948156321Sdamien /* kick encrypt */ 1949156321Sdamien sc->txq.queued++; 1950156321Sdamien sc->txq.cur_encrypt = (sc->txq.cur_encrypt + 1) % RT2560_TX_RING_COUNT; 1951156321Sdamien RAL_WRITE(sc, RT2560_SECCSR1, RT2560_KICK_ENCRYPT); 1952156321Sdamien 1953156321Sdamien return 0; 1954156321Sdamien} 1955156321Sdamien 1956156321Sdamienstatic void 1957156321Sdamienrt2560_start(struct ifnet *ifp) 1958156321Sdamien{ 1959156321Sdamien struct rt2560_softc *sc = ifp->if_softc; 1960156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 1961156321Sdamien struct mbuf *m0; 1962156321Sdamien struct ether_header *eh; 1963156321Sdamien struct ieee80211_node *ni; 1964156321Sdamien 1965156321Sdamien RAL_LOCK(sc); 1966156321Sdamien 1967156975Sdamien /* prevent management frames from being sent if we're not ready */ 1968156975Sdamien if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) { 1969156975Sdamien RAL_UNLOCK(sc); 1970156975Sdamien return; 1971156975Sdamien } 1972156975Sdamien 1973156321Sdamien for (;;) { 1974156321Sdamien IF_POLL(&ic->ic_mgtq, m0); 1975156321Sdamien if (m0 != NULL) { 1976156321Sdamien if (sc->prioq.queued >= RT2560_PRIO_RING_COUNT) { 1977156321Sdamien ifp->if_drv_flags |= IFF_DRV_OACTIVE; 1978156321Sdamien break; 1979156321Sdamien } 1980156321Sdamien IF_DEQUEUE(&ic->ic_mgtq, m0); 1981156321Sdamien 1982156321Sdamien ni = (struct ieee80211_node *)m0->m_pkthdr.rcvif; 1983156321Sdamien m0->m_pkthdr.rcvif = NULL; 1984156321Sdamien 1985159180Scsjp if (bpf_peers_present(ic->ic_rawbpf)) 1986156321Sdamien bpf_mtap(ic->ic_rawbpf, m0); 1987156321Sdamien 1988170530Ssam if (rt2560_tx_mgt(sc, m0, ni) != 0) { 1989170530Ssam ieee80211_free_node(ni); 1990156321Sdamien break; 1991170530Ssam } 1992156321Sdamien } else { 1993156321Sdamien if (ic->ic_state != IEEE80211_S_RUN) 1994156321Sdamien break; 1995156321Sdamien IFQ_DRV_DEQUEUE(&ifp->if_snd, m0); 1996156321Sdamien if (m0 == NULL) 1997156321Sdamien break; 1998156321Sdamien if (sc->txq.queued >= RT2560_TX_RING_COUNT - 1) { 1999156321Sdamien IFQ_DRV_PREPEND(&ifp->if_snd, m0); 2000156321Sdamien ifp->if_drv_flags |= IFF_DRV_OACTIVE; 2001156321Sdamien break; 2002156321Sdamien } 2003156321Sdamien 2004156321Sdamien if (m0->m_len < sizeof (struct ether_header) && 2005156321Sdamien !(m0 = m_pullup(m0, sizeof (struct ether_header)))) 2006156321Sdamien continue; 2007156321Sdamien 2008156321Sdamien eh = mtod(m0, struct ether_header *); 2009156321Sdamien ni = ieee80211_find_txnode(ic, eh->ether_dhost); 2010156321Sdamien if (ni == NULL) { 2011156321Sdamien m_freem(m0); 2012156321Sdamien continue; 2013156321Sdamien } 2014170530Ssam if ((ni->ni_flags & IEEE80211_NODE_PWR_MGT) && 2015170530Ssam (m0->m_flags & M_PWR_SAV) == 0) { 2016170530Ssam /* 2017170530Ssam * Station in power save mode; pass the frame 2018170530Ssam * to the 802.11 layer and continue. We'll get 2019170530Ssam * the frame back when the time is right. 2020170530Ssam */ 2021170530Ssam ieee80211_pwrsave(ni, m0); 2022170530Ssam /* 2023170530Ssam * If we're in power save mode 'cuz of a bg 2024170530Ssam * scan cancel it so the traffic can flow. 2025170530Ssam * The packet we just queued will automatically 2026170530Ssam * get sent when we drop out of power save. 2027170530Ssam * XXX locking 2028170530Ssam */ 2029170530Ssam if (ic->ic_flags & IEEE80211_F_SCAN) 2030170530Ssam ieee80211_cancel_scan(ic); 2031170530Ssam ieee80211_free_node(ni); 2032170530Ssam continue; 2033170530Ssam 2034170530Ssam } 2035170530Ssam 2036156321Sdamien BPF_MTAP(ifp, m0); 2037156321Sdamien 2038156321Sdamien m0 = ieee80211_encap(ic, m0, ni); 2039156321Sdamien if (m0 == NULL) { 2040156321Sdamien ieee80211_free_node(ni); 2041156321Sdamien continue; 2042156321Sdamien } 2043170530Ssam 2044159180Scsjp if (bpf_peers_present(ic->ic_rawbpf)) 2045156321Sdamien bpf_mtap(ic->ic_rawbpf, m0); 2046156321Sdamien 2047156321Sdamien if (rt2560_tx_data(sc, m0, ni) != 0) { 2048156321Sdamien ieee80211_free_node(ni); 2049156321Sdamien ifp->if_oerrors++; 2050156321Sdamien break; 2051156321Sdamien } 2052156321Sdamien } 2053156321Sdamien 2054156321Sdamien sc->sc_tx_timer = 5; 2055165352Sbms callout_reset(&sc->watchdog_ch, hz, rt2560_watchdog, sc); 2056156321Sdamien } 2057156321Sdamien 2058156321Sdamien RAL_UNLOCK(sc); 2059156321Sdamien} 2060156321Sdamien 2061156321Sdamienstatic void 2062165352Sbmsrt2560_watchdog(void *arg) 2063156321Sdamien{ 2064167470Ssam struct rt2560_softc *sc = arg; 2065156321Sdamien 2066156321Sdamien if (sc->sc_tx_timer > 0) { 2067156321Sdamien if (--sc->sc_tx_timer == 0) { 2068156321Sdamien device_printf(sc->sc_dev, "device timeout\n"); 2069156321Sdamien rt2560_init(sc); 2070165352Sbms sc->sc_ifp->if_oerrors++; 2071156321Sdamien return; 2072156321Sdamien } 2073165352Sbms callout_reset(&sc->watchdog_ch, hz, rt2560_watchdog, sc); 2074156321Sdamien } 2075156321Sdamien} 2076156321Sdamien 2077156321Sdamien/* 2078156321Sdamien * This function allows for fast channel switching in monitor mode (used by 2079156321Sdamien * net-mgmt/kismet). In IBSS mode, we must explicitly reset the interface to 2080156321Sdamien * generate a new beacon frame. 2081156321Sdamien */ 2082156321Sdamienstatic int 2083156321Sdamienrt2560_reset(struct ifnet *ifp) 2084156321Sdamien{ 2085156321Sdamien struct rt2560_softc *sc = ifp->if_softc; 2086156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 2087156321Sdamien 2088156321Sdamien if (ic->ic_opmode != IEEE80211_M_MONITOR) 2089156321Sdamien return ENETRESET; 2090156321Sdamien 2091156321Sdamien rt2560_set_chan(sc, ic->ic_curchan); 2092156321Sdamien 2093156321Sdamien return 0; 2094156321Sdamien} 2095156321Sdamien 2096156321Sdamienstatic int 2097156321Sdamienrt2560_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 2098156321Sdamien{ 2099156321Sdamien struct rt2560_softc *sc = ifp->if_softc; 2100156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 2101156321Sdamien int error = 0; 2102156321Sdamien 2103156321Sdamien 2104170530Ssam 2105156321Sdamien switch (cmd) { 2106156321Sdamien case SIOCSIFFLAGS: 2107156321Sdamien if (ifp->if_flags & IFF_UP) { 2108170530Ssam RAL_LOCK(sc); 2109156321Sdamien if (ifp->if_drv_flags & IFF_DRV_RUNNING) 2110156321Sdamien rt2560_update_promisc(sc); 2111156321Sdamien else 2112156321Sdamien rt2560_init(sc); 2113170530Ssam RAL_UNLOCK(sc); 2114156321Sdamien } else { 2115156321Sdamien if (ifp->if_drv_flags & IFF_DRV_RUNNING) 2116156321Sdamien rt2560_stop(sc); 2117156321Sdamien } 2118170530Ssam 2119156321Sdamien break; 2120156321Sdamien 2121156321Sdamien default: 2122156321Sdamien error = ieee80211_ioctl(ic, cmd, data); 2123156321Sdamien } 2124156321Sdamien 2125156321Sdamien if (error == ENETRESET) { 2126156321Sdamien if ((ifp->if_flags & IFF_UP) && 2127156321Sdamien (ifp->if_drv_flags & IFF_DRV_RUNNING) && 2128156321Sdamien (ic->ic_roaming != IEEE80211_ROAMING_MANUAL)) 2129156321Sdamien rt2560_init(sc); 2130156321Sdamien error = 0; 2131156321Sdamien } 2132156321Sdamien 2133156321Sdamien 2134156321Sdamien return error; 2135156321Sdamien} 2136156321Sdamien 2137156321Sdamienstatic void 2138156321Sdamienrt2560_bbp_write(struct rt2560_softc *sc, uint8_t reg, uint8_t val) 2139156321Sdamien{ 2140156321Sdamien uint32_t tmp; 2141156321Sdamien int ntries; 2142156321Sdamien 2143156321Sdamien for (ntries = 0; ntries < 100; ntries++) { 2144156321Sdamien if (!(RAL_READ(sc, RT2560_BBPCSR) & RT2560_BBP_BUSY)) 2145156321Sdamien break; 2146156321Sdamien DELAY(1); 2147156321Sdamien } 2148156321Sdamien if (ntries == 100) { 2149156321Sdamien device_printf(sc->sc_dev, "could not write to BBP\n"); 2150156321Sdamien return; 2151156321Sdamien } 2152156321Sdamien 2153156321Sdamien tmp = RT2560_BBP_WRITE | RT2560_BBP_BUSY | reg << 8 | val; 2154156321Sdamien RAL_WRITE(sc, RT2560_BBPCSR, tmp); 2155156321Sdamien 2156156321Sdamien DPRINTFN(15, ("BBP R%u <- 0x%02x\n", reg, val)); 2157156321Sdamien} 2158156321Sdamien 2159156321Sdamienstatic uint8_t 2160156321Sdamienrt2560_bbp_read(struct rt2560_softc *sc, uint8_t reg) 2161156321Sdamien{ 2162156321Sdamien uint32_t val; 2163156321Sdamien int ntries; 2164156321Sdamien 2165156321Sdamien val = RT2560_BBP_BUSY | reg << 8; 2166156321Sdamien RAL_WRITE(sc, RT2560_BBPCSR, val); 2167156321Sdamien 2168156321Sdamien for (ntries = 0; ntries < 100; ntries++) { 2169156321Sdamien val = RAL_READ(sc, RT2560_BBPCSR); 2170156321Sdamien if (!(val & RT2560_BBP_BUSY)) 2171156321Sdamien return val & 0xff; 2172156321Sdamien DELAY(1); 2173156321Sdamien } 2174156321Sdamien 2175156321Sdamien device_printf(sc->sc_dev, "could not read from BBP\n"); 2176156321Sdamien return 0; 2177156321Sdamien} 2178156321Sdamien 2179156321Sdamienstatic void 2180156321Sdamienrt2560_rf_write(struct rt2560_softc *sc, uint8_t reg, uint32_t val) 2181156321Sdamien{ 2182156321Sdamien uint32_t tmp; 2183156321Sdamien int ntries; 2184156321Sdamien 2185156321Sdamien for (ntries = 0; ntries < 100; ntries++) { 2186156321Sdamien if (!(RAL_READ(sc, RT2560_RFCSR) & RT2560_RF_BUSY)) 2187156321Sdamien break; 2188156321Sdamien DELAY(1); 2189156321Sdamien } 2190156321Sdamien if (ntries == 100) { 2191156321Sdamien device_printf(sc->sc_dev, "could not write to RF\n"); 2192156321Sdamien return; 2193156321Sdamien } 2194156321Sdamien 2195156321Sdamien tmp = RT2560_RF_BUSY | RT2560_RF_20BIT | (val & 0xfffff) << 2 | 2196156321Sdamien (reg & 0x3); 2197156321Sdamien RAL_WRITE(sc, RT2560_RFCSR, tmp); 2198156321Sdamien 2199156321Sdamien /* remember last written value in sc */ 2200156321Sdamien sc->rf_regs[reg] = val; 2201156321Sdamien 2202156321Sdamien DPRINTFN(15, ("RF R[%u] <- 0x%05x\n", reg & 0x3, val & 0xfffff)); 2203156321Sdamien} 2204156321Sdamien 2205156321Sdamienstatic void 2206156321Sdamienrt2560_set_chan(struct rt2560_softc *sc, struct ieee80211_channel *c) 2207156321Sdamien{ 2208156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 2209156321Sdamien uint8_t power, tmp; 2210156321Sdamien u_int i, chan; 2211156321Sdamien 2212156321Sdamien chan = ieee80211_chan2ieee(ic, c); 2213156321Sdamien if (chan == 0 || chan == IEEE80211_CHAN_ANY) 2214156321Sdamien return; 2215156321Sdamien 2216156321Sdamien if (IEEE80211_IS_CHAN_2GHZ(c)) 2217156321Sdamien power = min(sc->txpow[chan - 1], 31); 2218156321Sdamien else 2219156321Sdamien power = 31; 2220156321Sdamien 2221156321Sdamien /* adjust txpower using ifconfig settings */ 2222156321Sdamien power -= (100 - ic->ic_txpowlimit) / 8; 2223156321Sdamien 2224156321Sdamien DPRINTFN(2, ("setting channel to %u, txpower to %u\n", chan, power)); 2225156321Sdamien 2226156321Sdamien switch (sc->rf_rev) { 2227156321Sdamien case RT2560_RF_2522: 2228156321Sdamien rt2560_rf_write(sc, RAL_RF1, 0x00814); 2229156321Sdamien rt2560_rf_write(sc, RAL_RF2, rt2560_rf2522_r2[chan - 1]); 2230156321Sdamien rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x00040); 2231156321Sdamien break; 2232156321Sdamien 2233156321Sdamien case RT2560_RF_2523: 2234156321Sdamien rt2560_rf_write(sc, RAL_RF1, 0x08804); 2235156321Sdamien rt2560_rf_write(sc, RAL_RF2, rt2560_rf2523_r2[chan - 1]); 2236156321Sdamien rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x38044); 2237156321Sdamien rt2560_rf_write(sc, RAL_RF4, (chan == 14) ? 0x00280 : 0x00286); 2238156321Sdamien break; 2239156321Sdamien 2240156321Sdamien case RT2560_RF_2524: 2241156321Sdamien rt2560_rf_write(sc, RAL_RF1, 0x0c808); 2242156321Sdamien rt2560_rf_write(sc, RAL_RF2, rt2560_rf2524_r2[chan - 1]); 2243156321Sdamien rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x00040); 2244156321Sdamien rt2560_rf_write(sc, RAL_RF4, (chan == 14) ? 0x00280 : 0x00286); 2245156321Sdamien break; 2246156321Sdamien 2247156321Sdamien case RT2560_RF_2525: 2248156321Sdamien rt2560_rf_write(sc, RAL_RF1, 0x08808); 2249156321Sdamien rt2560_rf_write(sc, RAL_RF2, rt2560_rf2525_hi_r2[chan - 1]); 2250156321Sdamien rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x18044); 2251156321Sdamien rt2560_rf_write(sc, RAL_RF4, (chan == 14) ? 0x00280 : 0x00286); 2252156321Sdamien 2253156321Sdamien rt2560_rf_write(sc, RAL_RF1, 0x08808); 2254156321Sdamien rt2560_rf_write(sc, RAL_RF2, rt2560_rf2525_r2[chan - 1]); 2255156321Sdamien rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x18044); 2256156321Sdamien rt2560_rf_write(sc, RAL_RF4, (chan == 14) ? 0x00280 : 0x00286); 2257156321Sdamien break; 2258156321Sdamien 2259156321Sdamien case RT2560_RF_2525E: 2260156321Sdamien rt2560_rf_write(sc, RAL_RF1, 0x08808); 2261156321Sdamien rt2560_rf_write(sc, RAL_RF2, rt2560_rf2525e_r2[chan - 1]); 2262156321Sdamien rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x18044); 2263156321Sdamien rt2560_rf_write(sc, RAL_RF4, (chan == 14) ? 0x00286 : 0x00282); 2264156321Sdamien break; 2265156321Sdamien 2266156321Sdamien case RT2560_RF_2526: 2267156321Sdamien rt2560_rf_write(sc, RAL_RF2, rt2560_rf2526_hi_r2[chan - 1]); 2268156321Sdamien rt2560_rf_write(sc, RAL_RF4, (chan & 1) ? 0x00386 : 0x00381); 2269156321Sdamien rt2560_rf_write(sc, RAL_RF1, 0x08804); 2270156321Sdamien 2271156321Sdamien rt2560_rf_write(sc, RAL_RF2, rt2560_rf2526_r2[chan - 1]); 2272156321Sdamien rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x18044); 2273156321Sdamien rt2560_rf_write(sc, RAL_RF4, (chan & 1) ? 0x00386 : 0x00381); 2274156321Sdamien break; 2275156321Sdamien 2276156321Sdamien /* dual-band RF */ 2277156321Sdamien case RT2560_RF_5222: 2278156321Sdamien for (i = 0; rt2560_rf5222[i].chan != chan; i++); 2279156321Sdamien 2280156321Sdamien rt2560_rf_write(sc, RAL_RF1, rt2560_rf5222[i].r1); 2281156321Sdamien rt2560_rf_write(sc, RAL_RF2, rt2560_rf5222[i].r2); 2282156321Sdamien rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x00040); 2283156321Sdamien rt2560_rf_write(sc, RAL_RF4, rt2560_rf5222[i].r4); 2284156321Sdamien break; 2285170530Ssam default: 2286170530Ssam printf("unknown ral rev=%d\n", sc->rf_rev); 2287156321Sdamien } 2288156321Sdamien 2289156321Sdamien if (ic->ic_state != IEEE80211_S_SCAN) { 2290156321Sdamien /* set Japan filter bit for channel 14 */ 2291156321Sdamien tmp = rt2560_bbp_read(sc, 70); 2292156321Sdamien 2293156321Sdamien tmp &= ~RT2560_JAPAN_FILTER; 2294156321Sdamien if (chan == 14) 2295156321Sdamien tmp |= RT2560_JAPAN_FILTER; 2296156321Sdamien 2297156321Sdamien rt2560_bbp_write(sc, 70, tmp); 2298156321Sdamien 2299156321Sdamien /* clear CRC errors */ 2300156321Sdamien RAL_READ(sc, RT2560_CNT0); 2301156321Sdamien } 2302156321Sdamien} 2303156321Sdamien 2304170530Ssamstatic void 2305170530Ssamrt2560_set_channel(struct ieee80211com *ic) 2306170530Ssam{ 2307170530Ssam struct ifnet *ifp = ic->ic_ifp; 2308170530Ssam struct rt2560_softc *sc = ifp->if_softc; 2309170530Ssam 2310170530Ssam RAL_LOCK(sc); 2311170530Ssam rt2560_set_chan(sc, ic->ic_curchan); 2312170530Ssam RAL_UNLOCK(sc); 2313170530Ssam 2314170530Ssam} 2315170530Ssam 2316156321Sdamien#if 0 2317156321Sdamien/* 2318156321Sdamien * Disable RF auto-tuning. 2319156321Sdamien */ 2320156321Sdamienstatic void 2321156321Sdamienrt2560_disable_rf_tune(struct rt2560_softc *sc) 2322156321Sdamien{ 2323156321Sdamien uint32_t tmp; 2324156321Sdamien 2325156321Sdamien if (sc->rf_rev != RT2560_RF_2523) { 2326156321Sdamien tmp = sc->rf_regs[RAL_RF1] & ~RAL_RF1_AUTOTUNE; 2327156321Sdamien rt2560_rf_write(sc, RAL_RF1, tmp); 2328156321Sdamien } 2329156321Sdamien 2330156321Sdamien tmp = sc->rf_regs[RAL_RF3] & ~RAL_RF3_AUTOTUNE; 2331156321Sdamien rt2560_rf_write(sc, RAL_RF3, tmp); 2332156321Sdamien 2333156321Sdamien DPRINTFN(2, ("disabling RF autotune\n")); 2334156321Sdamien} 2335156321Sdamien#endif 2336156321Sdamien 2337156321Sdamien/* 2338156321Sdamien * Refer to IEEE Std 802.11-1999 pp. 123 for more information on TSF 2339156321Sdamien * synchronization. 2340156321Sdamien */ 2341156321Sdamienstatic void 2342156321Sdamienrt2560_enable_tsf_sync(struct rt2560_softc *sc) 2343156321Sdamien{ 2344156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 2345156321Sdamien uint16_t logcwmin, preload; 2346156321Sdamien uint32_t tmp; 2347156321Sdamien 2348156321Sdamien /* first, disable TSF synchronization */ 2349156321Sdamien RAL_WRITE(sc, RT2560_CSR14, 0); 2350156321Sdamien 2351156321Sdamien tmp = 16 * ic->ic_bss->ni_intval; 2352156321Sdamien RAL_WRITE(sc, RT2560_CSR12, tmp); 2353156321Sdamien 2354156321Sdamien RAL_WRITE(sc, RT2560_CSR13, 0); 2355156321Sdamien 2356156321Sdamien logcwmin = 5; 2357156321Sdamien preload = (ic->ic_opmode == IEEE80211_M_STA) ? 384 : 1024; 2358156321Sdamien tmp = logcwmin << 16 | preload; 2359156321Sdamien RAL_WRITE(sc, RT2560_BCNOCSR, tmp); 2360156321Sdamien 2361156321Sdamien /* finally, enable TSF synchronization */ 2362156321Sdamien tmp = RT2560_ENABLE_TSF | RT2560_ENABLE_TBCN; 2363156321Sdamien if (ic->ic_opmode == IEEE80211_M_STA) 2364156321Sdamien tmp |= RT2560_ENABLE_TSF_SYNC(1); 2365156321Sdamien else 2366156321Sdamien tmp |= RT2560_ENABLE_TSF_SYNC(2) | 2367156321Sdamien RT2560_ENABLE_BEACON_GENERATOR; 2368156321Sdamien RAL_WRITE(sc, RT2560_CSR14, tmp); 2369156321Sdamien 2370156321Sdamien DPRINTF(("enabling TSF synchronization\n")); 2371156321Sdamien} 2372156321Sdamien 2373156321Sdamienstatic void 2374156321Sdamienrt2560_update_plcp(struct rt2560_softc *sc) 2375156321Sdamien{ 2376156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 2377156321Sdamien 2378156321Sdamien /* no short preamble for 1Mbps */ 2379156321Sdamien RAL_WRITE(sc, RT2560_PLCP1MCSR, 0x00700400); 2380156321Sdamien 2381156321Sdamien if (!(ic->ic_flags & IEEE80211_F_SHPREAMBLE)) { 2382156321Sdamien /* values taken from the reference driver */ 2383156321Sdamien RAL_WRITE(sc, RT2560_PLCP2MCSR, 0x00380401); 2384156321Sdamien RAL_WRITE(sc, RT2560_PLCP5p5MCSR, 0x00150402); 2385156321Sdamien RAL_WRITE(sc, RT2560_PLCP11MCSR, 0x000b8403); 2386156321Sdamien } else { 2387156321Sdamien /* same values as above or'ed 0x8 */ 2388156321Sdamien RAL_WRITE(sc, RT2560_PLCP2MCSR, 0x00380409); 2389156321Sdamien RAL_WRITE(sc, RT2560_PLCP5p5MCSR, 0x0015040a); 2390156321Sdamien RAL_WRITE(sc, RT2560_PLCP11MCSR, 0x000b840b); 2391156321Sdamien } 2392156321Sdamien 2393156321Sdamien DPRINTF(("updating PLCP for %s preamble\n", 2394156321Sdamien (ic->ic_flags & IEEE80211_F_SHPREAMBLE) ? "short" : "long")); 2395156321Sdamien} 2396156321Sdamien 2397156321Sdamien/* 2398156321Sdamien * This function can be called by ieee80211_set_shortslottime(). Refer to 2399156321Sdamien * IEEE Std 802.11-1999 pp. 85 to know how these values are computed. 2400156321Sdamien */ 2401156321Sdamienstatic void 2402156321Sdamienrt2560_update_slot(struct ifnet *ifp) 2403156321Sdamien{ 2404156321Sdamien struct rt2560_softc *sc = ifp->if_softc; 2405156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 2406156321Sdamien uint8_t slottime; 2407156321Sdamien uint16_t tx_sifs, tx_pifs, tx_difs, eifs; 2408156321Sdamien uint32_t tmp; 2409156321Sdamien 2410156321Sdamien slottime = (ic->ic_flags & IEEE80211_F_SHSLOT) ? 9 : 20; 2411156321Sdamien 2412156321Sdamien /* update the MAC slot boundaries */ 2413156321Sdamien tx_sifs = RAL_SIFS - RT2560_TXRX_TURNAROUND; 2414156321Sdamien tx_pifs = tx_sifs + slottime; 2415156321Sdamien tx_difs = tx_sifs + 2 * slottime; 2416156321Sdamien eifs = (ic->ic_curmode == IEEE80211_MODE_11B) ? 364 : 60; 2417156321Sdamien 2418156321Sdamien tmp = RAL_READ(sc, RT2560_CSR11); 2419156321Sdamien tmp = (tmp & ~0x1f00) | slottime << 8; 2420156321Sdamien RAL_WRITE(sc, RT2560_CSR11, tmp); 2421156321Sdamien 2422156321Sdamien tmp = tx_pifs << 16 | tx_sifs; 2423156321Sdamien RAL_WRITE(sc, RT2560_CSR18, tmp); 2424156321Sdamien 2425156321Sdamien tmp = eifs << 16 | tx_difs; 2426156321Sdamien RAL_WRITE(sc, RT2560_CSR19, tmp); 2427156321Sdamien 2428156321Sdamien DPRINTF(("setting slottime to %uus\n", slottime)); 2429156321Sdamien} 2430156321Sdamien 2431156321Sdamienstatic void 2432156321Sdamienrt2560_set_basicrates(struct rt2560_softc *sc) 2433156321Sdamien{ 2434156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 2435156321Sdamien 2436156321Sdamien /* update basic rate set */ 2437156321Sdamien if (ic->ic_curmode == IEEE80211_MODE_11B) { 2438156321Sdamien /* 11b basic rates: 1, 2Mbps */ 2439156321Sdamien RAL_WRITE(sc, RT2560_ARSP_PLCP_1, 0x3); 2440156321Sdamien } else if (IEEE80211_IS_CHAN_5GHZ(ic->ic_curchan)) { 2441156321Sdamien /* 11a basic rates: 6, 12, 24Mbps */ 2442156321Sdamien RAL_WRITE(sc, RT2560_ARSP_PLCP_1, 0x150); 2443156321Sdamien } else { 2444156321Sdamien /* 11g basic rates: 1, 2, 5.5, 11, 6, 12, 24Mbps */ 2445156321Sdamien RAL_WRITE(sc, RT2560_ARSP_PLCP_1, 0x15f); 2446156321Sdamien } 2447156321Sdamien} 2448156321Sdamien 2449156321Sdamienstatic void 2450156321Sdamienrt2560_update_led(struct rt2560_softc *sc, int led1, int led2) 2451156321Sdamien{ 2452156321Sdamien uint32_t tmp; 2453156321Sdamien 2454156321Sdamien /* set ON period to 70ms and OFF period to 30ms */ 2455156321Sdamien tmp = led1 << 16 | led2 << 17 | 70 << 8 | 30; 2456156321Sdamien RAL_WRITE(sc, RT2560_LEDCSR, tmp); 2457156321Sdamien} 2458156321Sdamien 2459156321Sdamienstatic void 2460170530Ssamrt2560_set_bssid(struct rt2560_softc *sc, const uint8_t *bssid) 2461156321Sdamien{ 2462156321Sdamien uint32_t tmp; 2463156321Sdamien 2464156321Sdamien tmp = bssid[0] | bssid[1] << 8 | bssid[2] << 16 | bssid[3] << 24; 2465156321Sdamien RAL_WRITE(sc, RT2560_CSR5, tmp); 2466156321Sdamien 2467156321Sdamien tmp = bssid[4] | bssid[5] << 8; 2468156321Sdamien RAL_WRITE(sc, RT2560_CSR6, tmp); 2469156321Sdamien 2470156321Sdamien DPRINTF(("setting BSSID to %6D\n", bssid, ":")); 2471156321Sdamien} 2472156321Sdamien 2473156321Sdamienstatic void 2474156321Sdamienrt2560_set_macaddr(struct rt2560_softc *sc, uint8_t *addr) 2475156321Sdamien{ 2476156321Sdamien uint32_t tmp; 2477156321Sdamien 2478156321Sdamien tmp = addr[0] | addr[1] << 8 | addr[2] << 16 | addr[3] << 24; 2479156321Sdamien RAL_WRITE(sc, RT2560_CSR3, tmp); 2480156321Sdamien 2481156321Sdamien tmp = addr[4] | addr[5] << 8; 2482156321Sdamien RAL_WRITE(sc, RT2560_CSR4, tmp); 2483156321Sdamien 2484156321Sdamien DPRINTF(("setting MAC address to %6D\n", addr, ":")); 2485156321Sdamien} 2486156321Sdamien 2487156321Sdamienstatic void 2488156321Sdamienrt2560_get_macaddr(struct rt2560_softc *sc, uint8_t *addr) 2489156321Sdamien{ 2490156321Sdamien uint32_t tmp; 2491156321Sdamien 2492156321Sdamien tmp = RAL_READ(sc, RT2560_CSR3); 2493156321Sdamien addr[0] = tmp & 0xff; 2494156321Sdamien addr[1] = (tmp >> 8) & 0xff; 2495156321Sdamien addr[2] = (tmp >> 16) & 0xff; 2496156321Sdamien addr[3] = (tmp >> 24); 2497156321Sdamien 2498156321Sdamien tmp = RAL_READ(sc, RT2560_CSR4); 2499156321Sdamien addr[4] = tmp & 0xff; 2500156321Sdamien addr[5] = (tmp >> 8) & 0xff; 2501156321Sdamien} 2502156321Sdamien 2503156321Sdamienstatic void 2504156321Sdamienrt2560_update_promisc(struct rt2560_softc *sc) 2505156321Sdamien{ 2506156321Sdamien struct ifnet *ifp = sc->sc_ic.ic_ifp; 2507156321Sdamien uint32_t tmp; 2508156321Sdamien 2509156321Sdamien tmp = RAL_READ(sc, RT2560_RXCSR0); 2510156321Sdamien 2511156321Sdamien tmp &= ~RT2560_DROP_NOT_TO_ME; 2512156321Sdamien if (!(ifp->if_flags & IFF_PROMISC)) 2513156321Sdamien tmp |= RT2560_DROP_NOT_TO_ME; 2514156321Sdamien 2515156321Sdamien RAL_WRITE(sc, RT2560_RXCSR0, tmp); 2516156321Sdamien 2517156321Sdamien DPRINTF(("%s promiscuous mode\n", (ifp->if_flags & IFF_PROMISC) ? 2518156321Sdamien "entering" : "leaving")); 2519156321Sdamien} 2520156321Sdamien 2521156321Sdamienstatic const char * 2522156321Sdamienrt2560_get_rf(int rev) 2523156321Sdamien{ 2524156321Sdamien switch (rev) { 2525156321Sdamien case RT2560_RF_2522: return "RT2522"; 2526156321Sdamien case RT2560_RF_2523: return "RT2523"; 2527156321Sdamien case RT2560_RF_2524: return "RT2524"; 2528156321Sdamien case RT2560_RF_2525: return "RT2525"; 2529156321Sdamien case RT2560_RF_2525E: return "RT2525e"; 2530156321Sdamien case RT2560_RF_2526: return "RT2526"; 2531156321Sdamien case RT2560_RF_5222: return "RT5222"; 2532156321Sdamien default: return "unknown"; 2533156321Sdamien } 2534156321Sdamien} 2535156321Sdamien 2536156321Sdamienstatic void 2537156321Sdamienrt2560_read_eeprom(struct rt2560_softc *sc) 2538156321Sdamien{ 2539156321Sdamien uint16_t val; 2540156321Sdamien int i; 2541156321Sdamien 2542156321Sdamien val = rt2560_eeprom_read(sc, RT2560_EEPROM_CONFIG0); 2543156321Sdamien sc->rf_rev = (val >> 11) & 0x7; 2544156321Sdamien sc->hw_radio = (val >> 10) & 0x1; 2545156321Sdamien sc->led_mode = (val >> 6) & 0x7; 2546156321Sdamien sc->rx_ant = (val >> 4) & 0x3; 2547156321Sdamien sc->tx_ant = (val >> 2) & 0x3; 2548156321Sdamien sc->nb_ant = val & 0x3; 2549156321Sdamien 2550156321Sdamien /* read default values for BBP registers */ 2551156321Sdamien for (i = 0; i < 16; i++) { 2552156321Sdamien val = rt2560_eeprom_read(sc, RT2560_EEPROM_BBP_BASE + i); 2553156321Sdamien sc->bbp_prom[i].reg = val >> 8; 2554156321Sdamien sc->bbp_prom[i].val = val & 0xff; 2555156321Sdamien } 2556156321Sdamien 2557156321Sdamien /* read Tx power for all b/g channels */ 2558156321Sdamien for (i = 0; i < 14 / 2; i++) { 2559156321Sdamien val = rt2560_eeprom_read(sc, RT2560_EEPROM_TXPOWER + i); 2560156321Sdamien sc->txpow[i * 2] = val >> 8; 2561156321Sdamien sc->txpow[i * 2 + 1] = val & 0xff; 2562156321Sdamien } 2563170530Ssam 2564170530Ssam val = rt2560_eeprom_read(sc, RT2560_EEPROM_CALIBRATE); 2565170530Ssam if ((val & 0xff) == 0xff) 2566170530Ssam sc->rssi_corr = RT2560_DEFAULT_RSSI_CORR; 2567170530Ssam else 2568170530Ssam sc->rssi_corr = val & 0xff; 2569170530Ssam DPRINTF(("rssi correction %d, calibrate 0x%02x\n", 2570170530Ssam sc->rssi_corr, val)); 2571156321Sdamien} 2572156321Sdamien 2573170530Ssam 2574170530Ssamstatic void 2575170530Ssamrt2560_scan_start(struct ieee80211com *ic) 2576170530Ssam{ 2577170530Ssam struct ifnet *ifp = ic->ic_ifp; 2578170530Ssam struct rt2560_softc *sc = ifp->if_softc; 2579170530Ssam 2580170530Ssam /* abort TSF synchronization */ 2581170530Ssam RAL_WRITE(sc, RT2560_CSR14, 0); 2582170530Ssam rt2560_set_bssid(sc, ifp->if_broadcastaddr); 2583170530Ssam} 2584170530Ssam 2585170530Ssamstatic void 2586170530Ssamrt2560_scan_end(struct ieee80211com *ic) 2587170530Ssam{ 2588170530Ssam struct ifnet *ifp = ic->ic_ifp; 2589170530Ssam struct rt2560_softc *sc = ifp->if_softc; 2590170530Ssam 2591170530Ssam rt2560_enable_tsf_sync(sc); 2592170530Ssam /* XXX keep local copy */ 2593170530Ssam rt2560_set_bssid(sc, ic->ic_bss->ni_bssid); 2594170530Ssam} 2595170530Ssam 2596156321Sdamienstatic int 2597156321Sdamienrt2560_bbp_init(struct rt2560_softc *sc) 2598156321Sdamien{ 2599156321Sdamien#define N(a) (sizeof (a) / sizeof ((a)[0])) 2600156321Sdamien int i, ntries; 2601156321Sdamien 2602156321Sdamien /* wait for BBP to be ready */ 2603156321Sdamien for (ntries = 0; ntries < 100; ntries++) { 2604156321Sdamien if (rt2560_bbp_read(sc, RT2560_BBP_VERSION) != 0) 2605156321Sdamien break; 2606156321Sdamien DELAY(1); 2607156321Sdamien } 2608156321Sdamien if (ntries == 100) { 2609156321Sdamien device_printf(sc->sc_dev, "timeout waiting for BBP\n"); 2610156321Sdamien return EIO; 2611156321Sdamien } 2612156321Sdamien 2613156321Sdamien /* initialize BBP registers to default values */ 2614156321Sdamien for (i = 0; i < N(rt2560_def_bbp); i++) { 2615156321Sdamien rt2560_bbp_write(sc, rt2560_def_bbp[i].reg, 2616156321Sdamien rt2560_def_bbp[i].val); 2617156321Sdamien } 2618156321Sdamien#if 0 2619156321Sdamien /* initialize BBP registers to values stored in EEPROM */ 2620156321Sdamien for (i = 0; i < 16; i++) { 2621156321Sdamien if (sc->bbp_prom[i].reg == 0xff) 2622156321Sdamien continue; 2623156321Sdamien rt2560_bbp_write(sc, sc->bbp_prom[i].reg, sc->bbp_prom[i].val); 2624156321Sdamien } 2625156321Sdamien#endif 2626156321Sdamien 2627156321Sdamien return 0; 2628156321Sdamien#undef N 2629156321Sdamien} 2630156321Sdamien 2631156321Sdamienstatic void 2632156321Sdamienrt2560_set_txantenna(struct rt2560_softc *sc, int antenna) 2633156321Sdamien{ 2634156321Sdamien uint32_t tmp; 2635156321Sdamien uint8_t tx; 2636156321Sdamien 2637156321Sdamien tx = rt2560_bbp_read(sc, RT2560_BBP_TX) & ~RT2560_BBP_ANTMASK; 2638156321Sdamien if (antenna == 1) 2639156321Sdamien tx |= RT2560_BBP_ANTA; 2640156321Sdamien else if (antenna == 2) 2641156321Sdamien tx |= RT2560_BBP_ANTB; 2642156321Sdamien else 2643156321Sdamien tx |= RT2560_BBP_DIVERSITY; 2644156321Sdamien 2645156321Sdamien /* need to force I/Q flip for RF 2525e, 2526 and 5222 */ 2646156321Sdamien if (sc->rf_rev == RT2560_RF_2525E || sc->rf_rev == RT2560_RF_2526 || 2647156321Sdamien sc->rf_rev == RT2560_RF_5222) 2648156321Sdamien tx |= RT2560_BBP_FLIPIQ; 2649156321Sdamien 2650156321Sdamien rt2560_bbp_write(sc, RT2560_BBP_TX, tx); 2651156321Sdamien 2652156321Sdamien /* update values for CCK and OFDM in BBPCSR1 */ 2653156321Sdamien tmp = RAL_READ(sc, RT2560_BBPCSR1) & ~0x00070007; 2654156321Sdamien tmp |= (tx & 0x7) << 16 | (tx & 0x7); 2655156321Sdamien RAL_WRITE(sc, RT2560_BBPCSR1, tmp); 2656156321Sdamien} 2657156321Sdamien 2658156321Sdamienstatic void 2659156321Sdamienrt2560_set_rxantenna(struct rt2560_softc *sc, int antenna) 2660156321Sdamien{ 2661156321Sdamien uint8_t rx; 2662156321Sdamien 2663156321Sdamien rx = rt2560_bbp_read(sc, RT2560_BBP_RX) & ~RT2560_BBP_ANTMASK; 2664156321Sdamien if (antenna == 1) 2665156321Sdamien rx |= RT2560_BBP_ANTA; 2666156321Sdamien else if (antenna == 2) 2667156321Sdamien rx |= RT2560_BBP_ANTB; 2668156321Sdamien else 2669156321Sdamien rx |= RT2560_BBP_DIVERSITY; 2670156321Sdamien 2671156321Sdamien /* need to force no I/Q flip for RF 2525e and 2526 */ 2672156321Sdamien if (sc->rf_rev == RT2560_RF_2525E || sc->rf_rev == RT2560_RF_2526) 2673156321Sdamien rx &= ~RT2560_BBP_FLIPIQ; 2674156321Sdamien 2675156321Sdamien rt2560_bbp_write(sc, RT2560_BBP_RX, rx); 2676156321Sdamien} 2677156321Sdamien 2678156321Sdamienstatic void 2679156321Sdamienrt2560_init(void *priv) 2680156321Sdamien{ 2681156321Sdamien#define N(a) (sizeof (a) / sizeof ((a)[0])) 2682156321Sdamien struct rt2560_softc *sc = priv; 2683156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 2684156321Sdamien struct ifnet *ifp = ic->ic_ifp; 2685156321Sdamien uint32_t tmp; 2686156321Sdamien int i; 2687156321Sdamien 2688156975Sdamien 2689170530Ssam 2690156321Sdamien rt2560_stop(sc); 2691156321Sdamien 2692170530Ssam RAL_LOCK(sc); 2693156321Sdamien /* setup tx rings */ 2694156321Sdamien tmp = RT2560_PRIO_RING_COUNT << 24 | 2695156321Sdamien RT2560_ATIM_RING_COUNT << 16 | 2696156321Sdamien RT2560_TX_RING_COUNT << 8 | 2697156321Sdamien RT2560_TX_DESC_SIZE; 2698156321Sdamien 2699156321Sdamien /* rings must be initialized in this exact order */ 2700156321Sdamien RAL_WRITE(sc, RT2560_TXCSR2, tmp); 2701156321Sdamien RAL_WRITE(sc, RT2560_TXCSR3, sc->txq.physaddr); 2702156321Sdamien RAL_WRITE(sc, RT2560_TXCSR5, sc->prioq.physaddr); 2703156321Sdamien RAL_WRITE(sc, RT2560_TXCSR4, sc->atimq.physaddr); 2704156321Sdamien RAL_WRITE(sc, RT2560_TXCSR6, sc->bcnq.physaddr); 2705156321Sdamien 2706156321Sdamien /* setup rx ring */ 2707156321Sdamien tmp = RT2560_RX_RING_COUNT << 8 | RT2560_RX_DESC_SIZE; 2708156321Sdamien 2709156321Sdamien RAL_WRITE(sc, RT2560_RXCSR1, tmp); 2710156321Sdamien RAL_WRITE(sc, RT2560_RXCSR2, sc->rxq.physaddr); 2711156321Sdamien 2712156321Sdamien /* initialize MAC registers to default values */ 2713156321Sdamien for (i = 0; i < N(rt2560_def_mac); i++) 2714156321Sdamien RAL_WRITE(sc, rt2560_def_mac[i].reg, rt2560_def_mac[i].val); 2715156321Sdamien 2716156321Sdamien IEEE80211_ADDR_COPY(ic->ic_myaddr, IF_LLADDR(ifp)); 2717156321Sdamien rt2560_set_macaddr(sc, ic->ic_myaddr); 2718156321Sdamien 2719156321Sdamien /* set basic rate set (will be updated later) */ 2720156321Sdamien RAL_WRITE(sc, RT2560_ARSP_PLCP_1, 0x153); 2721156321Sdamien 2722156321Sdamien rt2560_set_txantenna(sc, sc->tx_ant); 2723156321Sdamien rt2560_set_rxantenna(sc, sc->rx_ant); 2724156321Sdamien rt2560_update_slot(ifp); 2725156321Sdamien rt2560_update_plcp(sc); 2726156321Sdamien rt2560_update_led(sc, 0, 0); 2727156321Sdamien 2728156321Sdamien RAL_WRITE(sc, RT2560_CSR1, RT2560_RESET_ASIC); 2729156321Sdamien RAL_WRITE(sc, RT2560_CSR1, RT2560_HOST_READY); 2730156321Sdamien 2731156321Sdamien if (rt2560_bbp_init(sc) != 0) { 2732156321Sdamien rt2560_stop(sc); 2733156975Sdamien RAL_UNLOCK(sc); 2734156321Sdamien return; 2735156321Sdamien } 2736156321Sdamien 2737156321Sdamien /* set default BSS channel */ 2738156321Sdamien rt2560_set_chan(sc, ic->ic_curchan); 2739156321Sdamien 2740156321Sdamien /* kick Rx */ 2741156321Sdamien tmp = RT2560_DROP_PHY_ERROR | RT2560_DROP_CRC_ERROR; 2742156321Sdamien if (ic->ic_opmode != IEEE80211_M_MONITOR) { 2743156321Sdamien tmp |= RT2560_DROP_CTL | RT2560_DROP_VERSION_ERROR; 2744156321Sdamien if (ic->ic_opmode != IEEE80211_M_HOSTAP) 2745156321Sdamien tmp |= RT2560_DROP_TODS; 2746156321Sdamien if (!(ifp->if_flags & IFF_PROMISC)) 2747156321Sdamien tmp |= RT2560_DROP_NOT_TO_ME; 2748156321Sdamien } 2749156321Sdamien RAL_WRITE(sc, RT2560_RXCSR0, tmp); 2750156321Sdamien 2751156321Sdamien /* clear old FCS and Rx FIFO errors */ 2752156321Sdamien RAL_READ(sc, RT2560_CNT0); 2753156321Sdamien RAL_READ(sc, RT2560_CNT4); 2754156321Sdamien 2755156321Sdamien /* clear any pending interrupts */ 2756156321Sdamien RAL_WRITE(sc, RT2560_CSR7, 0xffffffff); 2757156321Sdamien 2758156321Sdamien /* enable interrupts */ 2759156321Sdamien RAL_WRITE(sc, RT2560_CSR8, RT2560_INTR_MASK); 2760156321Sdamien 2761156321Sdamien ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 2762156321Sdamien ifp->if_drv_flags |= IFF_DRV_RUNNING; 2763156321Sdamien 2764156321Sdamien if (ic->ic_opmode != IEEE80211_M_MONITOR) { 2765156321Sdamien if (ic->ic_roaming != IEEE80211_ROAMING_MANUAL) 2766156321Sdamien ieee80211_new_state(ic, IEEE80211_S_SCAN, -1); 2767156321Sdamien } else 2768156321Sdamien ieee80211_new_state(ic, IEEE80211_S_RUN, -1); 2769156975Sdamien 2770156975Sdamien RAL_UNLOCK(sc); 2771156321Sdamien#undef N 2772156321Sdamien} 2773156321Sdamien 2774156321Sdamienvoid 2775170530Ssamrt2560_stop(void *arg) 2776156321Sdamien{ 2777170530Ssam struct rt2560_softc *sc = arg; 2778156321Sdamien struct ieee80211com *ic = &sc->sc_ic; 2779156321Sdamien struct ifnet *ifp = ic->ic_ifp; 2780170530Ssam volatile int *flags = &sc->sc_flags; 2781156321Sdamien 2782170530Ssam while (*flags & RAL_INPUT_RUNNING) { 2783170530Ssam tsleep(sc, 0, "ralrunning", hz/10); 2784170530Ssam } 2785156321Sdamien 2786170530Ssam RAL_LOCK(sc); 2787170530Ssam if (ifp->if_drv_flags & IFF_DRV_RUNNING) { 2788170530Ssam ieee80211_new_state(ic, IEEE80211_S_INIT, -1); 2789170530Ssam sc->sc_tx_timer = 0; 2790170530Ssam ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 2791156975Sdamien 2792170530Ssam /* abort Tx */ 2793170530Ssam RAL_WRITE(sc, RT2560_TXCSR0, RT2560_ABORT_TX); 2794170530Ssam 2795170530Ssam /* disable Rx */ 2796170530Ssam RAL_WRITE(sc, RT2560_RXCSR0, RT2560_DISABLE_RX); 2797156321Sdamien 2798170530Ssam /* reset ASIC (imply reset BBP) */ 2799170530Ssam RAL_WRITE(sc, RT2560_CSR1, RT2560_RESET_ASIC); 2800170530Ssam RAL_WRITE(sc, RT2560_CSR1, 0); 2801156321Sdamien 2802170530Ssam /* disable interrupts */ 2803170530Ssam RAL_WRITE(sc, RT2560_CSR8, 0xffffffff); 2804170530Ssam 2805170530Ssam /* reset Tx and Rx rings */ 2806170530Ssam rt2560_reset_tx_ring(sc, &sc->txq); 2807170530Ssam rt2560_reset_tx_ring(sc, &sc->atimq); 2808170530Ssam rt2560_reset_tx_ring(sc, &sc->prioq); 2809170530Ssam rt2560_reset_tx_ring(sc, &sc->bcnq); 2810170530Ssam rt2560_reset_rx_ring(sc, &sc->rxq); 2811170530Ssam } 2812170530Ssam RAL_UNLOCK(sc); 2813156321Sdamien} 2814160691Ssam 2815160691Ssamstatic int 2816160691Ssamrt2560_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 2817160691Ssam const struct ieee80211_bpf_params *params) 2818160691Ssam{ 2819160691Ssam struct ieee80211com *ic = ni->ni_ic; 2820160691Ssam struct ifnet *ifp = ic->ic_ifp; 2821160691Ssam struct rt2560_softc *sc = ifp->if_softc; 2822160691Ssam 2823160691Ssam RAL_LOCK(sc); 2824160691Ssam 2825160691Ssam /* prevent management frames from being sent if we're not ready */ 2826160691Ssam if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) { 2827160691Ssam RAL_UNLOCK(sc); 2828168860Ssephe m_freem(m); 2829168860Ssephe ieee80211_free_node(ni); 2830160691Ssam return ENETDOWN; 2831160691Ssam } 2832160691Ssam if (sc->prioq.queued >= RT2560_PRIO_RING_COUNT) { 2833160691Ssam ifp->if_drv_flags |= IFF_DRV_OACTIVE; 2834160691Ssam RAL_UNLOCK(sc); 2835168860Ssephe m_freem(m); 2836168860Ssephe ieee80211_free_node(ni); 2837160691Ssam return ENOBUFS; /* XXX */ 2838160691Ssam } 2839160691Ssam 2840160691Ssam if (bpf_peers_present(ic->ic_rawbpf)) 2841160691Ssam bpf_mtap(ic->ic_rawbpf, m); 2842160691Ssam 2843160691Ssam ifp->if_opackets++; 2844160691Ssam 2845160691Ssam if (params == NULL) { 2846160691Ssam /* 2847160691Ssam * Legacy path; interpret frame contents to decide 2848160691Ssam * precisely how to send the frame. 2849160691Ssam */ 2850160691Ssam if (rt2560_tx_mgt(sc, m, ni) != 0) 2851160691Ssam goto bad; 2852160691Ssam } else { 2853160691Ssam /* 2854160691Ssam * Caller supplied explicit parameters to use in 2855160691Ssam * sending the frame. 2856160691Ssam */ 2857160691Ssam if (rt2560_tx_raw(sc, m, ni, params)) 2858160691Ssam goto bad; 2859160691Ssam } 2860160691Ssam sc->sc_tx_timer = 5; 2861165352Sbms callout_reset(&sc->watchdog_ch, hz, rt2560_watchdog, sc); 2862160691Ssam 2863160691Ssam RAL_UNLOCK(sc); 2864160691Ssam 2865160691Ssam return 0; 2866160691Ssambad: 2867160691Ssam ifp->if_oerrors++; 2868160905Ssam ieee80211_free_node(ni); 2869160691Ssam RAL_UNLOCK(sc); 2870160691Ssam return EIO; /* XXX */ 2871160691Ssam} 2872170530Ssam 2873