xref: /freebsd/sys/dev/ral/rt2560.c (revision 9ee0e22742562dd829cf859da8e904263c8880e9)
19c6307b1SDamien Bergamini /*	$FreeBSD$	*/
29c6307b1SDamien Bergamini 
39c6307b1SDamien Bergamini /*-
49c6307b1SDamien Bergamini  * Copyright (c) 2005, 2006
59c6307b1SDamien Bergamini  *	Damien Bergamini <damien.bergamini@free.fr>
69c6307b1SDamien Bergamini  *
79c6307b1SDamien Bergamini  * Permission to use, copy, modify, and distribute this software for any
89c6307b1SDamien Bergamini  * purpose with or without fee is hereby granted, provided that the above
99c6307b1SDamien Bergamini  * copyright notice and this permission notice appear in all copies.
109c6307b1SDamien Bergamini  *
119c6307b1SDamien Bergamini  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
129c6307b1SDamien Bergamini  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
139c6307b1SDamien Bergamini  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
149c6307b1SDamien Bergamini  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
159c6307b1SDamien Bergamini  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
169c6307b1SDamien Bergamini  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
179c6307b1SDamien Bergamini  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
189c6307b1SDamien Bergamini  */
199c6307b1SDamien Bergamini 
209c6307b1SDamien Bergamini #include <sys/cdefs.h>
219c6307b1SDamien Bergamini __FBSDID("$FreeBSD$");
229c6307b1SDamien Bergamini 
239c6307b1SDamien Bergamini /*-
249c6307b1SDamien Bergamini  * Ralink Technology RT2560 chipset driver
259c6307b1SDamien Bergamini  * http://www.ralinktech.com/
269c6307b1SDamien Bergamini  */
279c6307b1SDamien Bergamini 
289c6307b1SDamien Bergamini #include <sys/param.h>
299c6307b1SDamien Bergamini #include <sys/sysctl.h>
309c6307b1SDamien Bergamini #include <sys/sockio.h>
319c6307b1SDamien Bergamini #include <sys/mbuf.h>
329c6307b1SDamien Bergamini #include <sys/kernel.h>
339c6307b1SDamien Bergamini #include <sys/socket.h>
349c6307b1SDamien Bergamini #include <sys/systm.h>
359c6307b1SDamien Bergamini #include <sys/malloc.h>
369c6307b1SDamien Bergamini #include <sys/module.h>
379c6307b1SDamien Bergamini #include <sys/bus.h>
389c6307b1SDamien Bergamini #include <sys/endian.h>
399c6307b1SDamien Bergamini 
409c6307b1SDamien Bergamini #include <machine/bus.h>
419c6307b1SDamien Bergamini #include <machine/resource.h>
429c6307b1SDamien Bergamini #include <sys/rman.h>
439c6307b1SDamien Bergamini 
449c6307b1SDamien Bergamini #include <net/bpf.h>
459c6307b1SDamien Bergamini #include <net/if.h>
469c6307b1SDamien Bergamini #include <net/if_arp.h>
479c6307b1SDamien Bergamini #include <net/ethernet.h>
489c6307b1SDamien Bergamini #include <net/if_dl.h>
499c6307b1SDamien Bergamini #include <net/if_media.h>
509c6307b1SDamien Bergamini #include <net/if_types.h>
519c6307b1SDamien Bergamini 
529c6307b1SDamien Bergamini #include <net80211/ieee80211_var.h>
539c6307b1SDamien Bergamini #include <net80211/ieee80211_radiotap.h>
549c6307b1SDamien Bergamini 
559c6307b1SDamien Bergamini #include <netinet/in.h>
569c6307b1SDamien Bergamini #include <netinet/in_systm.h>
579c6307b1SDamien Bergamini #include <netinet/in_var.h>
589c6307b1SDamien Bergamini #include <netinet/ip.h>
599c6307b1SDamien Bergamini #include <netinet/if_ether.h>
609c6307b1SDamien Bergamini 
612017e1cbSMike Silbersack #include <dev/ral/if_ralrate.h>
622017e1cbSMike Silbersack #include <dev/ral/rt2560reg.h>
632017e1cbSMike Silbersack #include <dev/ral/rt2560var.h>
649c6307b1SDamien Bergamini 
659c6307b1SDamien Bergamini #ifdef RAL_DEBUG
669c6307b1SDamien Bergamini #define DPRINTF(x)	do { if (ral_debug > 0) printf x; } while (0)
679c6307b1SDamien Bergamini #define DPRINTFN(n, x)	do { if (ral_debug >= (n)) printf x; } while (0)
689c6307b1SDamien Bergamini extern int ral_debug;
699c6307b1SDamien Bergamini #else
709c6307b1SDamien Bergamini #define DPRINTF(x)
719c6307b1SDamien Bergamini #define DPRINTFN(n, x)
729c6307b1SDamien Bergamini #endif
739c6307b1SDamien Bergamini 
749c6307b1SDamien Bergamini static void		rt2560_dma_map_addr(void *, bus_dma_segment_t *, int,
759c6307b1SDamien Bergamini 			    int);
769c6307b1SDamien Bergamini static int		rt2560_alloc_tx_ring(struct rt2560_softc *,
779c6307b1SDamien Bergamini 			    struct rt2560_tx_ring *, int);
789c6307b1SDamien Bergamini static void		rt2560_reset_tx_ring(struct rt2560_softc *,
799c6307b1SDamien Bergamini 			    struct rt2560_tx_ring *);
809c6307b1SDamien Bergamini static void		rt2560_free_tx_ring(struct rt2560_softc *,
819c6307b1SDamien Bergamini 			    struct rt2560_tx_ring *);
829c6307b1SDamien Bergamini static int		rt2560_alloc_rx_ring(struct rt2560_softc *,
839c6307b1SDamien Bergamini 			    struct rt2560_rx_ring *, int);
849c6307b1SDamien Bergamini static void		rt2560_reset_rx_ring(struct rt2560_softc *,
859c6307b1SDamien Bergamini 			    struct rt2560_rx_ring *);
869c6307b1SDamien Bergamini static void		rt2560_free_rx_ring(struct rt2560_softc *,
879c6307b1SDamien Bergamini 			    struct rt2560_rx_ring *);
889c6307b1SDamien Bergamini static struct		ieee80211_node *rt2560_node_alloc(
899c6307b1SDamien Bergamini 			    struct ieee80211_node_table *);
909c6307b1SDamien Bergamini static int		rt2560_media_change(struct ifnet *);
919c6307b1SDamien Bergamini static void		rt2560_next_scan(void *);
929c6307b1SDamien Bergamini static void		rt2560_iter_func(void *, struct ieee80211_node *);
939c6307b1SDamien Bergamini static void		rt2560_update_rssadapt(void *);
949c6307b1SDamien Bergamini static int		rt2560_newstate(struct ieee80211com *,
959c6307b1SDamien Bergamini 			    enum ieee80211_state, int);
969c6307b1SDamien Bergamini static uint16_t		rt2560_eeprom_read(struct rt2560_softc *, uint8_t);
979c6307b1SDamien Bergamini static void		rt2560_encryption_intr(struct rt2560_softc *);
989c6307b1SDamien Bergamini static void		rt2560_tx_intr(struct rt2560_softc *);
999c6307b1SDamien Bergamini static void		rt2560_prio_intr(struct rt2560_softc *);
1009c6307b1SDamien Bergamini static void		rt2560_decryption_intr(struct rt2560_softc *);
1019c6307b1SDamien Bergamini static void		rt2560_rx_intr(struct rt2560_softc *);
1029c6307b1SDamien Bergamini static void		rt2560_beacon_expire(struct rt2560_softc *);
1039c6307b1SDamien Bergamini static void		rt2560_wakeup_expire(struct rt2560_softc *);
1049c6307b1SDamien Bergamini static uint8_t		rt2560_rxrate(struct rt2560_rx_desc *);
1059c6307b1SDamien Bergamini static int		rt2560_ack_rate(struct ieee80211com *, int);
1069c6307b1SDamien Bergamini static uint16_t		rt2560_txtime(int, int, uint32_t);
1079c6307b1SDamien Bergamini static uint8_t		rt2560_plcp_signal(int);
1089c6307b1SDamien Bergamini static void		rt2560_setup_tx_desc(struct rt2560_softc *,
1099c6307b1SDamien Bergamini 			    struct rt2560_tx_desc *, uint32_t, int, int, int,
1109c6307b1SDamien Bergamini 			    bus_addr_t);
1119c6307b1SDamien Bergamini static int		rt2560_tx_bcn(struct rt2560_softc *, struct mbuf *,
1129c6307b1SDamien Bergamini 			    struct ieee80211_node *);
1139c6307b1SDamien Bergamini static int		rt2560_tx_mgt(struct rt2560_softc *, struct mbuf *,
1149c6307b1SDamien Bergamini 			    struct ieee80211_node *);
1159c6307b1SDamien Bergamini static struct		mbuf *rt2560_get_rts(struct rt2560_softc *,
1169c6307b1SDamien Bergamini 			    struct ieee80211_frame *, uint16_t);
1179c6307b1SDamien Bergamini static int		rt2560_tx_data(struct rt2560_softc *, struct mbuf *,
1189c6307b1SDamien Bergamini 			    struct ieee80211_node *);
1199c6307b1SDamien Bergamini static void		rt2560_start(struct ifnet *);
1209c6307b1SDamien Bergamini static void		rt2560_watchdog(struct ifnet *);
1219c6307b1SDamien Bergamini static int		rt2560_reset(struct ifnet *);
1229c6307b1SDamien Bergamini static int		rt2560_ioctl(struct ifnet *, u_long, caddr_t);
1239c6307b1SDamien Bergamini static void		rt2560_bbp_write(struct rt2560_softc *, uint8_t,
1249c6307b1SDamien Bergamini 			    uint8_t);
1259c6307b1SDamien Bergamini static uint8_t		rt2560_bbp_read(struct rt2560_softc *, uint8_t);
1269c6307b1SDamien Bergamini static void		rt2560_rf_write(struct rt2560_softc *, uint8_t,
1279c6307b1SDamien Bergamini 			    uint32_t);
1289c6307b1SDamien Bergamini static void		rt2560_set_chan(struct rt2560_softc *,
1299c6307b1SDamien Bergamini 			    struct ieee80211_channel *);
1309c6307b1SDamien Bergamini #if 0
1319c6307b1SDamien Bergamini static void		rt2560_disable_rf_tune(struct rt2560_softc *);
1329c6307b1SDamien Bergamini #endif
1339c6307b1SDamien Bergamini static void		rt2560_enable_tsf_sync(struct rt2560_softc *);
1349c6307b1SDamien Bergamini static void		rt2560_update_plcp(struct rt2560_softc *);
1359c6307b1SDamien Bergamini static void		rt2560_update_slot(struct ifnet *);
1369c6307b1SDamien Bergamini static void		rt2560_set_basicrates(struct rt2560_softc *);
1379c6307b1SDamien Bergamini static void		rt2560_update_led(struct rt2560_softc *, int, int);
1389c6307b1SDamien Bergamini static void		rt2560_set_bssid(struct rt2560_softc *, uint8_t *);
1399c6307b1SDamien Bergamini static void		rt2560_set_macaddr(struct rt2560_softc *, uint8_t *);
1409c6307b1SDamien Bergamini static void		rt2560_get_macaddr(struct rt2560_softc *, uint8_t *);
1419c6307b1SDamien Bergamini static void		rt2560_update_promisc(struct rt2560_softc *);
1429c6307b1SDamien Bergamini static const char	*rt2560_get_rf(int);
1439c6307b1SDamien Bergamini static void		rt2560_read_eeprom(struct rt2560_softc *);
1449c6307b1SDamien Bergamini static int		rt2560_bbp_init(struct rt2560_softc *);
1459c6307b1SDamien Bergamini static void		rt2560_set_txantenna(struct rt2560_softc *, int);
1469c6307b1SDamien Bergamini static void		rt2560_set_rxantenna(struct rt2560_softc *, int);
1479c6307b1SDamien Bergamini static void		rt2560_init(void *);
1489c6307b1SDamien Bergamini static void		rt2560_stop(void *);
1499ee0e227SSam Leffler static int		rt2560_raw_xmit(struct ieee80211_node *, struct mbuf *,
1509ee0e227SSam Leffler 				const struct ieee80211_bpf_params *);
1519c6307b1SDamien Bergamini 
1529c6307b1SDamien Bergamini /*
1539c6307b1SDamien Bergamini  * Supported rates for 802.11a/b/g modes (in 500Kbps unit).
1549c6307b1SDamien Bergamini  */
1559c6307b1SDamien Bergamini static const struct ieee80211_rateset rt2560_rateset_11a =
1569c6307b1SDamien Bergamini 	{ 8, { 12, 18, 24, 36, 48, 72, 96, 108 } };
1579c6307b1SDamien Bergamini 
1589c6307b1SDamien Bergamini static const struct ieee80211_rateset rt2560_rateset_11b =
1599c6307b1SDamien Bergamini 	{ 4, { 2, 4, 11, 22 } };
1609c6307b1SDamien Bergamini 
1619c6307b1SDamien Bergamini static const struct ieee80211_rateset rt2560_rateset_11g =
1629c6307b1SDamien Bergamini 	{ 12, { 2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108 } };
1639c6307b1SDamien Bergamini 
1649c6307b1SDamien Bergamini static const struct {
1659c6307b1SDamien Bergamini 	uint32_t	reg;
1669c6307b1SDamien Bergamini 	uint32_t	val;
1679c6307b1SDamien Bergamini } rt2560_def_mac[] = {
1689c6307b1SDamien Bergamini 	RT2560_DEF_MAC
1699c6307b1SDamien Bergamini };
1709c6307b1SDamien Bergamini 
1719c6307b1SDamien Bergamini static const struct {
1729c6307b1SDamien Bergamini 	uint8_t	reg;
1739c6307b1SDamien Bergamini 	uint8_t	val;
1749c6307b1SDamien Bergamini } rt2560_def_bbp[] = {
1759c6307b1SDamien Bergamini 	RT2560_DEF_BBP
1769c6307b1SDamien Bergamini };
1779c6307b1SDamien Bergamini 
1789c6307b1SDamien Bergamini static const uint32_t rt2560_rf2522_r2[]    = RT2560_RF2522_R2;
1799c6307b1SDamien Bergamini static const uint32_t rt2560_rf2523_r2[]    = RT2560_RF2523_R2;
1809c6307b1SDamien Bergamini static const uint32_t rt2560_rf2524_r2[]    = RT2560_RF2524_R2;
1819c6307b1SDamien Bergamini static const uint32_t rt2560_rf2525_r2[]    = RT2560_RF2525_R2;
1829c6307b1SDamien Bergamini static const uint32_t rt2560_rf2525_hi_r2[] = RT2560_RF2525_HI_R2;
1839c6307b1SDamien Bergamini static const uint32_t rt2560_rf2525e_r2[]   = RT2560_RF2525E_R2;
1849c6307b1SDamien Bergamini static const uint32_t rt2560_rf2526_r2[]    = RT2560_RF2526_R2;
1859c6307b1SDamien Bergamini static const uint32_t rt2560_rf2526_hi_r2[] = RT2560_RF2526_HI_R2;
1869c6307b1SDamien Bergamini 
1879c6307b1SDamien Bergamini static const struct {
1889c6307b1SDamien Bergamini 	uint8_t		chan;
1899c6307b1SDamien Bergamini 	uint32_t	r1, r2, r4;
1909c6307b1SDamien Bergamini } rt2560_rf5222[] = {
1919c6307b1SDamien Bergamini 	RT2560_RF5222
1929c6307b1SDamien Bergamini };
1939c6307b1SDamien Bergamini 
1949c6307b1SDamien Bergamini int
1959c6307b1SDamien Bergamini rt2560_attach(device_t dev, int id)
1969c6307b1SDamien Bergamini {
1979c6307b1SDamien Bergamini 	struct rt2560_softc *sc = device_get_softc(dev);
1989c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1999c6307b1SDamien Bergamini 	struct ifnet *ifp;
2009c6307b1SDamien Bergamini 	int error, i;
2019c6307b1SDamien Bergamini 
2029c6307b1SDamien Bergamini 	sc->sc_dev = dev;
2039c6307b1SDamien Bergamini 
2049c6307b1SDamien Bergamini 	mtx_init(&sc->sc_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK,
2059c6307b1SDamien Bergamini 	    MTX_DEF | MTX_RECURSE);
2069c6307b1SDamien Bergamini 
2079c6307b1SDamien Bergamini 	callout_init(&sc->scan_ch, debug_mpsafenet ? CALLOUT_MPSAFE : 0);
2089c6307b1SDamien Bergamini 	callout_init(&sc->rssadapt_ch, CALLOUT_MPSAFE);
2099c6307b1SDamien Bergamini 
2109c6307b1SDamien Bergamini 	/* retrieve RT2560 rev. no */
2119c6307b1SDamien Bergamini 	sc->asic_rev = RAL_READ(sc, RT2560_CSR0);
2129c6307b1SDamien Bergamini 
2139c6307b1SDamien Bergamini 	/* retrieve MAC address */
2149c6307b1SDamien Bergamini 	rt2560_get_macaddr(sc, ic->ic_myaddr);
2159c6307b1SDamien Bergamini 
2169c6307b1SDamien Bergamini 	/* retrieve RF rev. no and various other things from EEPROM */
2179c6307b1SDamien Bergamini 	rt2560_read_eeprom(sc);
2189c6307b1SDamien Bergamini 
2199c6307b1SDamien Bergamini 	device_printf(dev, "MAC/BBP RT2560 (rev 0x%02x), RF %s\n",
2209c6307b1SDamien Bergamini 	    sc->asic_rev, rt2560_get_rf(sc->rf_rev));
2219c6307b1SDamien Bergamini 
2229c6307b1SDamien Bergamini 	/*
2239c6307b1SDamien Bergamini 	 * Allocate Tx and Rx rings.
2249c6307b1SDamien Bergamini 	 */
2259c6307b1SDamien Bergamini 	error = rt2560_alloc_tx_ring(sc, &sc->txq, RT2560_TX_RING_COUNT);
2269c6307b1SDamien Bergamini 	if (error != 0) {
2279c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate Tx ring\n");
2289c6307b1SDamien Bergamini 		goto fail1;
2299c6307b1SDamien Bergamini 	}
2309c6307b1SDamien Bergamini 
2319c6307b1SDamien Bergamini 	error = rt2560_alloc_tx_ring(sc, &sc->atimq, RT2560_ATIM_RING_COUNT);
2329c6307b1SDamien Bergamini 	if (error != 0) {
2339c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate ATIM ring\n");
2349c6307b1SDamien Bergamini 		goto fail2;
2359c6307b1SDamien Bergamini 	}
2369c6307b1SDamien Bergamini 
2379c6307b1SDamien Bergamini 	error = rt2560_alloc_tx_ring(sc, &sc->prioq, RT2560_PRIO_RING_COUNT);
2389c6307b1SDamien Bergamini 	if (error != 0) {
2399c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate Prio ring\n");
2409c6307b1SDamien Bergamini 		goto fail3;
2419c6307b1SDamien Bergamini 	}
2429c6307b1SDamien Bergamini 
2439c6307b1SDamien Bergamini 	error = rt2560_alloc_tx_ring(sc, &sc->bcnq, RT2560_BEACON_RING_COUNT);
2449c6307b1SDamien Bergamini 	if (error != 0) {
2459c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate Beacon ring\n");
2469c6307b1SDamien Bergamini 		goto fail4;
2479c6307b1SDamien Bergamini 	}
2489c6307b1SDamien Bergamini 
2499c6307b1SDamien Bergamini 	error = rt2560_alloc_rx_ring(sc, &sc->rxq, RT2560_RX_RING_COUNT);
2509c6307b1SDamien Bergamini 	if (error != 0) {
2519c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate Rx ring\n");
2529c6307b1SDamien Bergamini 		goto fail5;
2539c6307b1SDamien Bergamini 	}
2549c6307b1SDamien Bergamini 
2559c6307b1SDamien Bergamini 	ifp = sc->sc_ifp = if_alloc(IFT_ETHER);
2569c6307b1SDamien Bergamini 	if (ifp == NULL) {
2579c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "can not if_alloc()\n");
2589c6307b1SDamien Bergamini 		goto fail6;
2599c6307b1SDamien Bergamini 	}
2609c6307b1SDamien Bergamini 
2619c6307b1SDamien Bergamini 	ifp->if_softc = sc;
2629c6307b1SDamien Bergamini 	if_initname(ifp, device_get_name(dev), device_get_unit(dev));
2639c6307b1SDamien Bergamini 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
2649c6307b1SDamien Bergamini 	ifp->if_init = rt2560_init;
2659c6307b1SDamien Bergamini 	ifp->if_ioctl = rt2560_ioctl;
2669c6307b1SDamien Bergamini 	ifp->if_start = rt2560_start;
2679c6307b1SDamien Bergamini 	ifp->if_watchdog = rt2560_watchdog;
2689c6307b1SDamien Bergamini 	IFQ_SET_MAXLEN(&ifp->if_snd, IFQ_MAXLEN);
2699c6307b1SDamien Bergamini 	ifp->if_snd.ifq_drv_maxlen = IFQ_MAXLEN;
2709c6307b1SDamien Bergamini 	IFQ_SET_READY(&ifp->if_snd);
2719c6307b1SDamien Bergamini 
2729c6307b1SDamien Bergamini 	ic->ic_ifp = ifp;
2739c6307b1SDamien Bergamini 	ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */
2749c6307b1SDamien Bergamini 	ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */
2759c6307b1SDamien Bergamini 	ic->ic_state = IEEE80211_S_INIT;
2769c6307b1SDamien Bergamini 
2779c6307b1SDamien Bergamini 	/* set device capabilities */
2789c6307b1SDamien Bergamini 	ic->ic_caps =
2799c6307b1SDamien Bergamini 	    IEEE80211_C_IBSS |		/* IBSS mode supported */
2809c6307b1SDamien Bergamini 	    IEEE80211_C_MONITOR |	/* monitor mode supported */
2819c6307b1SDamien Bergamini 	    IEEE80211_C_HOSTAP |	/* HostAp mode supported */
2829c6307b1SDamien Bergamini 	    IEEE80211_C_TXPMGT |	/* tx power management */
2839c6307b1SDamien Bergamini 	    IEEE80211_C_SHPREAMBLE |	/* short preamble supported */
2849c6307b1SDamien Bergamini 	    IEEE80211_C_SHSLOT |	/* short slot time supported */
2859c6307b1SDamien Bergamini 	    IEEE80211_C_WPA;		/* 802.11i */
2869c6307b1SDamien Bergamini 
2879c6307b1SDamien Bergamini 	if (sc->rf_rev == RT2560_RF_5222) {
2889c6307b1SDamien Bergamini 		/* set supported .11a rates */
2899c6307b1SDamien Bergamini 		ic->ic_sup_rates[IEEE80211_MODE_11A] = rt2560_rateset_11a;
2909c6307b1SDamien Bergamini 
2919c6307b1SDamien Bergamini 		/* set supported .11a channels */
2929c6307b1SDamien Bergamini 		for (i = 36; i <= 64; i += 4) {
2939c6307b1SDamien Bergamini 			ic->ic_channels[i].ic_freq =
2949c6307b1SDamien Bergamini 			    ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ);
2959c6307b1SDamien Bergamini 			ic->ic_channels[i].ic_flags = IEEE80211_CHAN_A;
2969c6307b1SDamien Bergamini 		}
2979c6307b1SDamien Bergamini 		for (i = 100; i <= 140; i += 4) {
2989c6307b1SDamien Bergamini 			ic->ic_channels[i].ic_freq =
2999c6307b1SDamien Bergamini 			    ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ);
3009c6307b1SDamien Bergamini 			ic->ic_channels[i].ic_flags = IEEE80211_CHAN_A;
3019c6307b1SDamien Bergamini 		}
3029c6307b1SDamien Bergamini 		for (i = 149; i <= 161; i += 4) {
3039c6307b1SDamien Bergamini 			ic->ic_channels[i].ic_freq =
3049c6307b1SDamien Bergamini 			    ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ);
3059c6307b1SDamien Bergamini 			ic->ic_channels[i].ic_flags = IEEE80211_CHAN_A;
3069c6307b1SDamien Bergamini 		}
3079c6307b1SDamien Bergamini 	}
3089c6307b1SDamien Bergamini 
3099c6307b1SDamien Bergamini 	/* set supported .11b and .11g rates */
3109c6307b1SDamien Bergamini 	ic->ic_sup_rates[IEEE80211_MODE_11B] = rt2560_rateset_11b;
3119c6307b1SDamien Bergamini 	ic->ic_sup_rates[IEEE80211_MODE_11G] = rt2560_rateset_11g;
3129c6307b1SDamien Bergamini 
3139c6307b1SDamien Bergamini 	/* set supported .11b and .11g channels (1 through 14) */
3149c6307b1SDamien Bergamini 	for (i = 1; i <= 14; i++) {
3159c6307b1SDamien Bergamini 		ic->ic_channels[i].ic_freq =
3169c6307b1SDamien Bergamini 		    ieee80211_ieee2mhz(i, IEEE80211_CHAN_2GHZ);
3179c6307b1SDamien Bergamini 		ic->ic_channels[i].ic_flags =
3189c6307b1SDamien Bergamini 		    IEEE80211_CHAN_CCK | IEEE80211_CHAN_OFDM |
3199c6307b1SDamien Bergamini 		    IEEE80211_CHAN_DYN | IEEE80211_CHAN_2GHZ;
3209c6307b1SDamien Bergamini 	}
3219c6307b1SDamien Bergamini 
3229c6307b1SDamien Bergamini 	ieee80211_ifattach(ic);
3239c6307b1SDamien Bergamini 	ic->ic_node_alloc = rt2560_node_alloc;
3249c6307b1SDamien Bergamini 	ic->ic_updateslot = rt2560_update_slot;
3259c6307b1SDamien Bergamini 	ic->ic_reset = rt2560_reset;
3269c6307b1SDamien Bergamini 	/* enable s/w bmiss handling in sta mode */
3279c6307b1SDamien Bergamini 	ic->ic_flags_ext |= IEEE80211_FEXT_SWBMISS;
3289c6307b1SDamien Bergamini 
3299c6307b1SDamien Bergamini 	/* override state transition machine */
3309c6307b1SDamien Bergamini 	sc->sc_newstate = ic->ic_newstate;
3319c6307b1SDamien Bergamini 	ic->ic_newstate = rt2560_newstate;
3329ee0e227SSam Leffler 	ic->ic_raw_xmit = rt2560_raw_xmit;
3339c6307b1SDamien Bergamini 	ieee80211_media_init(ic, rt2560_media_change, ieee80211_media_status);
3349c6307b1SDamien Bergamini 
3359c6307b1SDamien Bergamini 	bpfattach2(ifp, DLT_IEEE802_11_RADIO,
3369c6307b1SDamien Bergamini 	    sizeof (struct ieee80211_frame) + 64, &sc->sc_drvbpf);
3379c6307b1SDamien Bergamini 
3389c6307b1SDamien Bergamini 	sc->sc_rxtap_len = sizeof sc->sc_rxtapu;
3399c6307b1SDamien Bergamini 	sc->sc_rxtap.wr_ihdr.it_len = htole16(sc->sc_rxtap_len);
3409c6307b1SDamien Bergamini 	sc->sc_rxtap.wr_ihdr.it_present = htole32(RT2560_RX_RADIOTAP_PRESENT);
3419c6307b1SDamien Bergamini 
3429c6307b1SDamien Bergamini 	sc->sc_txtap_len = sizeof sc->sc_txtapu;
3439c6307b1SDamien Bergamini 	sc->sc_txtap.wt_ihdr.it_len = htole16(sc->sc_txtap_len);
3449c6307b1SDamien Bergamini 	sc->sc_txtap.wt_ihdr.it_present = htole32(RT2560_TX_RADIOTAP_PRESENT);
3459c6307b1SDamien Bergamini 
3469c6307b1SDamien Bergamini 	/*
3479c6307b1SDamien Bergamini 	 * Add a few sysctl knobs.
3489c6307b1SDamien Bergamini 	 */
3499c6307b1SDamien Bergamini 	sc->dwelltime = 200;
3509c6307b1SDamien Bergamini 
3519c6307b1SDamien Bergamini 	SYSCTL_ADD_INT(device_get_sysctl_ctx(dev),
3529c6307b1SDamien Bergamini 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO,
3539c6307b1SDamien Bergamini 	    "txantenna", CTLFLAG_RW, &sc->tx_ant, 0, "tx antenna (0=auto)");
3549c6307b1SDamien Bergamini 
3559c6307b1SDamien Bergamini 	SYSCTL_ADD_INT(device_get_sysctl_ctx(dev),
3569c6307b1SDamien Bergamini 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO,
3579c6307b1SDamien Bergamini 	    "rxantenna", CTLFLAG_RW, &sc->rx_ant, 0, "rx antenna (0=auto)");
3589c6307b1SDamien Bergamini 
3599c6307b1SDamien Bergamini 	SYSCTL_ADD_INT(device_get_sysctl_ctx(dev),
3609c6307b1SDamien Bergamini 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "dwell",
3619c6307b1SDamien Bergamini 	    CTLFLAG_RW, &sc->dwelltime, 0,
3629c6307b1SDamien Bergamini 	    "channel dwell time (ms) for AP/station scanning");
3639c6307b1SDamien Bergamini 
3649c6307b1SDamien Bergamini 	if (bootverbose)
3659c6307b1SDamien Bergamini 		ieee80211_announce(ic);
3669c6307b1SDamien Bergamini 
3679c6307b1SDamien Bergamini 	return 0;
3689c6307b1SDamien Bergamini 
3699c6307b1SDamien Bergamini fail6:	rt2560_free_rx_ring(sc, &sc->rxq);
3709c6307b1SDamien Bergamini fail5:	rt2560_free_tx_ring(sc, &sc->bcnq);
3719c6307b1SDamien Bergamini fail4:	rt2560_free_tx_ring(sc, &sc->prioq);
3729c6307b1SDamien Bergamini fail3:	rt2560_free_tx_ring(sc, &sc->atimq);
3739c6307b1SDamien Bergamini fail2:	rt2560_free_tx_ring(sc, &sc->txq);
3749c6307b1SDamien Bergamini fail1:	mtx_destroy(&sc->sc_mtx);
3759c6307b1SDamien Bergamini 
3769c6307b1SDamien Bergamini 	return ENXIO;
3779c6307b1SDamien Bergamini }
3789c6307b1SDamien Bergamini 
3799c6307b1SDamien Bergamini int
3809c6307b1SDamien Bergamini rt2560_detach(void *xsc)
3819c6307b1SDamien Bergamini {
3829c6307b1SDamien Bergamini 	struct rt2560_softc *sc = xsc;
3839c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
3849c6307b1SDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
3859c6307b1SDamien Bergamini 
3869c6307b1SDamien Bergamini 	rt2560_stop(sc);
3879c6307b1SDamien Bergamini 	callout_stop(&sc->scan_ch);
3889c6307b1SDamien Bergamini 	callout_stop(&sc->rssadapt_ch);
3899c6307b1SDamien Bergamini 
3909c6307b1SDamien Bergamini 	bpfdetach(ifp);
3919c6307b1SDamien Bergamini 	ieee80211_ifdetach(ic);
3929c6307b1SDamien Bergamini 
3939c6307b1SDamien Bergamini 	rt2560_free_tx_ring(sc, &sc->txq);
3949c6307b1SDamien Bergamini 	rt2560_free_tx_ring(sc, &sc->atimq);
3959c6307b1SDamien Bergamini 	rt2560_free_tx_ring(sc, &sc->prioq);
3969c6307b1SDamien Bergamini 	rt2560_free_tx_ring(sc, &sc->bcnq);
3979c6307b1SDamien Bergamini 	rt2560_free_rx_ring(sc, &sc->rxq);
3989c6307b1SDamien Bergamini 
3999c6307b1SDamien Bergamini 	if_free(ifp);
4009c6307b1SDamien Bergamini 
4019c6307b1SDamien Bergamini 	mtx_destroy(&sc->sc_mtx);
4029c6307b1SDamien Bergamini 
4039c6307b1SDamien Bergamini 	return 0;
4049c6307b1SDamien Bergamini }
4059c6307b1SDamien Bergamini 
4069c6307b1SDamien Bergamini void
4079c6307b1SDamien Bergamini rt2560_shutdown(void *xsc)
4089c6307b1SDamien Bergamini {
4099c6307b1SDamien Bergamini 	struct rt2560_softc *sc = xsc;
4109c6307b1SDamien Bergamini 
4119c6307b1SDamien Bergamini 	rt2560_stop(sc);
4129c6307b1SDamien Bergamini }
4139c6307b1SDamien Bergamini 
4149c6307b1SDamien Bergamini void
4159c6307b1SDamien Bergamini rt2560_suspend(void *xsc)
4169c6307b1SDamien Bergamini {
4179c6307b1SDamien Bergamini 	struct rt2560_softc *sc = xsc;
4189c6307b1SDamien Bergamini 
4199c6307b1SDamien Bergamini 	rt2560_stop(sc);
4209c6307b1SDamien Bergamini }
4219c6307b1SDamien Bergamini 
4229c6307b1SDamien Bergamini void
4239c6307b1SDamien Bergamini rt2560_resume(void *xsc)
4249c6307b1SDamien Bergamini {
4259c6307b1SDamien Bergamini 	struct rt2560_softc *sc = xsc;
4269c6307b1SDamien Bergamini 	struct ifnet *ifp = sc->sc_ic.ic_ifp;
4279c6307b1SDamien Bergamini 
4289c6307b1SDamien Bergamini 	if (ifp->if_flags & IFF_UP) {
4299c6307b1SDamien Bergamini 		ifp->if_init(ifp->if_softc);
4309c6307b1SDamien Bergamini 		if (ifp->if_drv_flags & IFF_DRV_RUNNING)
4319c6307b1SDamien Bergamini 			ifp->if_start(ifp);
4329c6307b1SDamien Bergamini 	}
4339c6307b1SDamien Bergamini }
4349c6307b1SDamien Bergamini 
4359c6307b1SDamien Bergamini static void
4369c6307b1SDamien Bergamini rt2560_dma_map_addr(void *arg, bus_dma_segment_t *segs, int nseg, int error)
4379c6307b1SDamien Bergamini {
4389c6307b1SDamien Bergamini 	if (error != 0)
4399c6307b1SDamien Bergamini 		return;
4409c6307b1SDamien Bergamini 
4419c6307b1SDamien Bergamini 	KASSERT(nseg == 1, ("too many DMA segments, %d should be 1", nseg));
4429c6307b1SDamien Bergamini 
4439c6307b1SDamien Bergamini 	*(bus_addr_t *)arg = segs[0].ds_addr;
4449c6307b1SDamien Bergamini }
4459c6307b1SDamien Bergamini 
4469c6307b1SDamien Bergamini static int
4479c6307b1SDamien Bergamini rt2560_alloc_tx_ring(struct rt2560_softc *sc, struct rt2560_tx_ring *ring,
4489c6307b1SDamien Bergamini     int count)
4499c6307b1SDamien Bergamini {
4509c6307b1SDamien Bergamini 	int i, error;
4519c6307b1SDamien Bergamini 
4529c6307b1SDamien Bergamini 	ring->count = count;
4539c6307b1SDamien Bergamini 	ring->queued = 0;
4549c6307b1SDamien Bergamini 	ring->cur = ring->next = 0;
4559c6307b1SDamien Bergamini 	ring->cur_encrypt = ring->next_encrypt = 0;
4569c6307b1SDamien Bergamini 
4579c6307b1SDamien Bergamini 	error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT,
4589c6307b1SDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, count * RT2560_TX_DESC_SIZE, 1,
4599c6307b1SDamien Bergamini 	    count * RT2560_TX_DESC_SIZE, 0, NULL, NULL, &ring->desc_dmat);
4609c6307b1SDamien Bergamini 	if (error != 0) {
4619c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not create desc DMA tag\n");
4629c6307b1SDamien Bergamini 		goto fail;
4639c6307b1SDamien Bergamini 	}
4649c6307b1SDamien Bergamini 
4659c6307b1SDamien Bergamini 	error = bus_dmamem_alloc(ring->desc_dmat, (void **)&ring->desc,
4669c6307b1SDamien Bergamini 	    BUS_DMA_NOWAIT | BUS_DMA_ZERO, &ring->desc_map);
4679c6307b1SDamien Bergamini 	if (error != 0) {
4689c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate DMA memory\n");
4699c6307b1SDamien Bergamini 		goto fail;
4709c6307b1SDamien Bergamini 	}
4719c6307b1SDamien Bergamini 
4729c6307b1SDamien Bergamini 	error = bus_dmamap_load(ring->desc_dmat, ring->desc_map, ring->desc,
4739c6307b1SDamien Bergamini 	    count * RT2560_TX_DESC_SIZE, rt2560_dma_map_addr, &ring->physaddr,
4749c6307b1SDamien Bergamini 	    0);
4759c6307b1SDamien Bergamini 	if (error != 0) {
4769c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not load desc DMA map\n");
4779c6307b1SDamien Bergamini 		goto fail;
4789c6307b1SDamien Bergamini 	}
4799c6307b1SDamien Bergamini 
4809c6307b1SDamien Bergamini 	ring->data = malloc(count * sizeof (struct rt2560_tx_data), M_DEVBUF,
4819c6307b1SDamien Bergamini 	    M_NOWAIT | M_ZERO);
4829c6307b1SDamien Bergamini 	if (ring->data == NULL) {
4839c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate soft data\n");
4849c6307b1SDamien Bergamini 		error = ENOMEM;
4859c6307b1SDamien Bergamini 		goto fail;
4869c6307b1SDamien Bergamini 	}
4879c6307b1SDamien Bergamini 
4889c6307b1SDamien Bergamini 	error = bus_dma_tag_create(NULL, 1, 0, BUS_SPACE_MAXADDR_32BIT,
4899c6307b1SDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, MCLBYTES, RT2560_MAX_SCATTER,
4909c6307b1SDamien Bergamini 	    MCLBYTES, 0, NULL, NULL, &ring->data_dmat);
4919c6307b1SDamien Bergamini 	if (error != 0) {
4929c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not create data DMA tag\n");
4939c6307b1SDamien Bergamini 		goto fail;
4949c6307b1SDamien Bergamini 	}
4959c6307b1SDamien Bergamini 
4969c6307b1SDamien Bergamini 	for (i = 0; i < count; i++) {
4979c6307b1SDamien Bergamini 		error = bus_dmamap_create(ring->data_dmat, 0,
4989c6307b1SDamien Bergamini 		    &ring->data[i].map);
4999c6307b1SDamien Bergamini 		if (error != 0) {
5009c6307b1SDamien Bergamini 			device_printf(sc->sc_dev, "could not create DMA map\n");
5019c6307b1SDamien Bergamini 			goto fail;
5029c6307b1SDamien Bergamini 		}
5039c6307b1SDamien Bergamini 	}
5049c6307b1SDamien Bergamini 
5059c6307b1SDamien Bergamini 	return 0;
5069c6307b1SDamien Bergamini 
5079c6307b1SDamien Bergamini fail:	rt2560_free_tx_ring(sc, ring);
5089c6307b1SDamien Bergamini 	return error;
5099c6307b1SDamien Bergamini }
5109c6307b1SDamien Bergamini 
5119c6307b1SDamien Bergamini static void
5129c6307b1SDamien Bergamini rt2560_reset_tx_ring(struct rt2560_softc *sc, struct rt2560_tx_ring *ring)
5139c6307b1SDamien Bergamini {
5149c6307b1SDamien Bergamini 	struct rt2560_tx_desc *desc;
5159c6307b1SDamien Bergamini 	struct rt2560_tx_data *data;
5169c6307b1SDamien Bergamini 	int i;
5179c6307b1SDamien Bergamini 
5189c6307b1SDamien Bergamini 	for (i = 0; i < ring->count; i++) {
5199c6307b1SDamien Bergamini 		desc = &ring->desc[i];
5209c6307b1SDamien Bergamini 		data = &ring->data[i];
5219c6307b1SDamien Bergamini 
5229c6307b1SDamien Bergamini 		if (data->m != NULL) {
5239c6307b1SDamien Bergamini 			bus_dmamap_sync(ring->data_dmat, data->map,
5249c6307b1SDamien Bergamini 			    BUS_DMASYNC_POSTWRITE);
5259c6307b1SDamien Bergamini 			bus_dmamap_unload(ring->data_dmat, data->map);
5269c6307b1SDamien Bergamini 			m_freem(data->m);
5279c6307b1SDamien Bergamini 			data->m = NULL;
5289c6307b1SDamien Bergamini 		}
5299c6307b1SDamien Bergamini 
5309c6307b1SDamien Bergamini 		if (data->ni != NULL) {
5319c6307b1SDamien Bergamini 			ieee80211_free_node(data->ni);
5329c6307b1SDamien Bergamini 			data->ni = NULL;
5339c6307b1SDamien Bergamini 		}
5349c6307b1SDamien Bergamini 
5359c6307b1SDamien Bergamini 		desc->flags = 0;
5369c6307b1SDamien Bergamini 	}
5379c6307b1SDamien Bergamini 
5389c6307b1SDamien Bergamini 	bus_dmamap_sync(ring->desc_dmat, ring->desc_map, BUS_DMASYNC_PREWRITE);
5399c6307b1SDamien Bergamini 
5409c6307b1SDamien Bergamini 	ring->queued = 0;
5419c6307b1SDamien Bergamini 	ring->cur = ring->next = 0;
5429c6307b1SDamien Bergamini 	ring->cur_encrypt = ring->next_encrypt = 0;
5439c6307b1SDamien Bergamini }
5449c6307b1SDamien Bergamini 
5459c6307b1SDamien Bergamini static void
5469c6307b1SDamien Bergamini rt2560_free_tx_ring(struct rt2560_softc *sc, struct rt2560_tx_ring *ring)
5479c6307b1SDamien Bergamini {
5489c6307b1SDamien Bergamini 	struct rt2560_tx_data *data;
5499c6307b1SDamien Bergamini 	int i;
5509c6307b1SDamien Bergamini 
5519c6307b1SDamien Bergamini 	if (ring->desc != NULL) {
5529c6307b1SDamien Bergamini 		bus_dmamap_sync(ring->desc_dmat, ring->desc_map,
5539c6307b1SDamien Bergamini 		    BUS_DMASYNC_POSTWRITE);
5549c6307b1SDamien Bergamini 		bus_dmamap_unload(ring->desc_dmat, ring->desc_map);
5559c6307b1SDamien Bergamini 		bus_dmamem_free(ring->desc_dmat, ring->desc, ring->desc_map);
5569c6307b1SDamien Bergamini 	}
5579c6307b1SDamien Bergamini 
5589c6307b1SDamien Bergamini 	if (ring->desc_dmat != NULL)
5599c6307b1SDamien Bergamini 		bus_dma_tag_destroy(ring->desc_dmat);
5609c6307b1SDamien Bergamini 
5619c6307b1SDamien Bergamini 	if (ring->data != NULL) {
5629c6307b1SDamien Bergamini 		for (i = 0; i < ring->count; i++) {
5639c6307b1SDamien Bergamini 			data = &ring->data[i];
5649c6307b1SDamien Bergamini 
5659c6307b1SDamien Bergamini 			if (data->m != NULL) {
5669c6307b1SDamien Bergamini 				bus_dmamap_sync(ring->data_dmat, data->map,
5679c6307b1SDamien Bergamini 				    BUS_DMASYNC_POSTWRITE);
5689c6307b1SDamien Bergamini 				bus_dmamap_unload(ring->data_dmat, data->map);
5699c6307b1SDamien Bergamini 				m_freem(data->m);
5709c6307b1SDamien Bergamini 			}
5719c6307b1SDamien Bergamini 
5729c6307b1SDamien Bergamini 			if (data->ni != NULL)
5739c6307b1SDamien Bergamini 				ieee80211_free_node(data->ni);
5749c6307b1SDamien Bergamini 
5759c6307b1SDamien Bergamini 			if (data->map != NULL)
5769c6307b1SDamien Bergamini 				bus_dmamap_destroy(ring->data_dmat, data->map);
5779c6307b1SDamien Bergamini 		}
5789c6307b1SDamien Bergamini 
5799c6307b1SDamien Bergamini 		free(ring->data, M_DEVBUF);
5809c6307b1SDamien Bergamini 	}
5819c6307b1SDamien Bergamini 
5829c6307b1SDamien Bergamini 	if (ring->data_dmat != NULL)
5839c6307b1SDamien Bergamini 		bus_dma_tag_destroy(ring->data_dmat);
5849c6307b1SDamien Bergamini }
5859c6307b1SDamien Bergamini 
5869c6307b1SDamien Bergamini static int
5879c6307b1SDamien Bergamini rt2560_alloc_rx_ring(struct rt2560_softc *sc, struct rt2560_rx_ring *ring,
5889c6307b1SDamien Bergamini     int count)
5899c6307b1SDamien Bergamini {
5909c6307b1SDamien Bergamini 	struct rt2560_rx_desc *desc;
5919c6307b1SDamien Bergamini 	struct rt2560_rx_data *data;
5929c6307b1SDamien Bergamini 	bus_addr_t physaddr;
5939c6307b1SDamien Bergamini 	int i, error;
5949c6307b1SDamien Bergamini 
5959c6307b1SDamien Bergamini 	ring->count = count;
5969c6307b1SDamien Bergamini 	ring->cur = ring->next = 0;
5979c6307b1SDamien Bergamini 	ring->cur_decrypt = 0;
5989c6307b1SDamien Bergamini 
5999c6307b1SDamien Bergamini 	error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT,
6009c6307b1SDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, count * RT2560_RX_DESC_SIZE, 1,
6019c6307b1SDamien Bergamini 	    count * RT2560_RX_DESC_SIZE, 0, NULL, NULL, &ring->desc_dmat);
6029c6307b1SDamien Bergamini 	if (error != 0) {
6039c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not create desc DMA tag\n");
6049c6307b1SDamien Bergamini 		goto fail;
6059c6307b1SDamien Bergamini 	}
6069c6307b1SDamien Bergamini 
6079c6307b1SDamien Bergamini 	error = bus_dmamem_alloc(ring->desc_dmat, (void **)&ring->desc,
6089c6307b1SDamien Bergamini 	    BUS_DMA_NOWAIT | BUS_DMA_ZERO, &ring->desc_map);
6099c6307b1SDamien Bergamini 	if (error != 0) {
6109c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate DMA memory\n");
6119c6307b1SDamien Bergamini 		goto fail;
6129c6307b1SDamien Bergamini 	}
6139c6307b1SDamien Bergamini 
6149c6307b1SDamien Bergamini 	error = bus_dmamap_load(ring->desc_dmat, ring->desc_map, ring->desc,
6159c6307b1SDamien Bergamini 	    count * RT2560_RX_DESC_SIZE, rt2560_dma_map_addr, &ring->physaddr,
6169c6307b1SDamien Bergamini 	    0);
6179c6307b1SDamien Bergamini 	if (error != 0) {
6189c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not load desc DMA map\n");
6199c6307b1SDamien Bergamini 		goto fail;
6209c6307b1SDamien Bergamini 	}
6219c6307b1SDamien Bergamini 
6229c6307b1SDamien Bergamini 	ring->data = malloc(count * sizeof (struct rt2560_rx_data), M_DEVBUF,
6239c6307b1SDamien Bergamini 	    M_NOWAIT | M_ZERO);
6249c6307b1SDamien Bergamini 	if (ring->data == NULL) {
6259c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate soft data\n");
6269c6307b1SDamien Bergamini 		error = ENOMEM;
6279c6307b1SDamien Bergamini 		goto fail;
6289c6307b1SDamien Bergamini 	}
6299c6307b1SDamien Bergamini 
6309c6307b1SDamien Bergamini 	/*
6319c6307b1SDamien Bergamini 	 * Pre-allocate Rx buffers and populate Rx ring.
6329c6307b1SDamien Bergamini 	 */
6339c6307b1SDamien Bergamini 	error = bus_dma_tag_create(NULL, 1, 0, BUS_SPACE_MAXADDR_32BIT,
6349c6307b1SDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, MCLBYTES, 1, MCLBYTES, 0, NULL,
6359c6307b1SDamien Bergamini 	    NULL, &ring->data_dmat);
6369c6307b1SDamien Bergamini 	if (error != 0) {
6379c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not create data DMA tag\n");
6389c6307b1SDamien Bergamini 		goto fail;
6399c6307b1SDamien Bergamini 	}
6409c6307b1SDamien Bergamini 
6419c6307b1SDamien Bergamini 	for (i = 0; i < count; i++) {
6429c6307b1SDamien Bergamini 		desc = &sc->rxq.desc[i];
6439c6307b1SDamien Bergamini 		data = &sc->rxq.data[i];
6449c6307b1SDamien Bergamini 
6459c6307b1SDamien Bergamini 		error = bus_dmamap_create(ring->data_dmat, 0, &data->map);
6469c6307b1SDamien Bergamini 		if (error != 0) {
6479c6307b1SDamien Bergamini 			device_printf(sc->sc_dev, "could not create DMA map\n");
6489c6307b1SDamien Bergamini 			goto fail;
6499c6307b1SDamien Bergamini 		}
6509c6307b1SDamien Bergamini 
6519c6307b1SDamien Bergamini 		data->m = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR);
6529c6307b1SDamien Bergamini 		if (data->m == NULL) {
6539c6307b1SDamien Bergamini 			device_printf(sc->sc_dev,
6549c6307b1SDamien Bergamini 			    "could not allocate rx mbuf\n");
6559c6307b1SDamien Bergamini 			error = ENOMEM;
6569c6307b1SDamien Bergamini 			goto fail;
6579c6307b1SDamien Bergamini 		}
6589c6307b1SDamien Bergamini 
6599c6307b1SDamien Bergamini 		error = bus_dmamap_load(ring->data_dmat, data->map,
6609c6307b1SDamien Bergamini 		    mtod(data->m, void *), MCLBYTES, rt2560_dma_map_addr,
6619c6307b1SDamien Bergamini 		    &physaddr, 0);
6629c6307b1SDamien Bergamini 		if (error != 0) {
6639c6307b1SDamien Bergamini 			device_printf(sc->sc_dev,
6649c6307b1SDamien Bergamini 			    "could not load rx buf DMA map");
6659c6307b1SDamien Bergamini 			goto fail;
6669c6307b1SDamien Bergamini 		}
6679c6307b1SDamien Bergamini 
6689c6307b1SDamien Bergamini 		desc->flags = htole32(RT2560_RX_BUSY);
6699c6307b1SDamien Bergamini 		desc->physaddr = htole32(physaddr);
6709c6307b1SDamien Bergamini 	}
6719c6307b1SDamien Bergamini 
6729c6307b1SDamien Bergamini 	bus_dmamap_sync(ring->desc_dmat, ring->desc_map, BUS_DMASYNC_PREWRITE);
6739c6307b1SDamien Bergamini 
6749c6307b1SDamien Bergamini 	return 0;
6759c6307b1SDamien Bergamini 
6769c6307b1SDamien Bergamini fail:	rt2560_free_rx_ring(sc, ring);
6779c6307b1SDamien Bergamini 	return error;
6789c6307b1SDamien Bergamini }
6799c6307b1SDamien Bergamini 
6809c6307b1SDamien Bergamini static void
6819c6307b1SDamien Bergamini rt2560_reset_rx_ring(struct rt2560_softc *sc, struct rt2560_rx_ring *ring)
6829c6307b1SDamien Bergamini {
6839c6307b1SDamien Bergamini 	int i;
6849c6307b1SDamien Bergamini 
6859c6307b1SDamien Bergamini 	for (i = 0; i < ring->count; i++) {
6869c6307b1SDamien Bergamini 		ring->desc[i].flags = htole32(RT2560_RX_BUSY);
6879c6307b1SDamien Bergamini 		ring->data[i].drop = 0;
6889c6307b1SDamien Bergamini 	}
6899c6307b1SDamien Bergamini 
6909c6307b1SDamien Bergamini 	bus_dmamap_sync(ring->desc_dmat, ring->desc_map, BUS_DMASYNC_PREWRITE);
6919c6307b1SDamien Bergamini 
6929c6307b1SDamien Bergamini 	ring->cur = ring->next = 0;
6939c6307b1SDamien Bergamini 	ring->cur_decrypt = 0;
6949c6307b1SDamien Bergamini }
6959c6307b1SDamien Bergamini 
6969c6307b1SDamien Bergamini static void
6979c6307b1SDamien Bergamini rt2560_free_rx_ring(struct rt2560_softc *sc, struct rt2560_rx_ring *ring)
6989c6307b1SDamien Bergamini {
6999c6307b1SDamien Bergamini 	struct rt2560_rx_data *data;
7009c6307b1SDamien Bergamini 	int i;
7019c6307b1SDamien Bergamini 
7029c6307b1SDamien Bergamini 	if (ring->desc != NULL) {
7039c6307b1SDamien Bergamini 		bus_dmamap_sync(ring->desc_dmat, ring->desc_map,
7049c6307b1SDamien Bergamini 		    BUS_DMASYNC_POSTWRITE);
7059c6307b1SDamien Bergamini 		bus_dmamap_unload(ring->desc_dmat, ring->desc_map);
7069c6307b1SDamien Bergamini 		bus_dmamem_free(ring->desc_dmat, ring->desc, ring->desc_map);
7079c6307b1SDamien Bergamini 	}
7089c6307b1SDamien Bergamini 
7099c6307b1SDamien Bergamini 	if (ring->desc_dmat != NULL)
7109c6307b1SDamien Bergamini 		bus_dma_tag_destroy(ring->desc_dmat);
7119c6307b1SDamien Bergamini 
7129c6307b1SDamien Bergamini 	if (ring->data != NULL) {
7139c6307b1SDamien Bergamini 		for (i = 0; i < ring->count; i++) {
7149c6307b1SDamien Bergamini 			data = &ring->data[i];
7159c6307b1SDamien Bergamini 
7169c6307b1SDamien Bergamini 			if (data->m != NULL) {
7179c6307b1SDamien Bergamini 				bus_dmamap_sync(ring->data_dmat, data->map,
7189c6307b1SDamien Bergamini 				    BUS_DMASYNC_POSTREAD);
7199c6307b1SDamien Bergamini 				bus_dmamap_unload(ring->data_dmat, data->map);
7209c6307b1SDamien Bergamini 				m_freem(data->m);
7219c6307b1SDamien Bergamini 			}
7229c6307b1SDamien Bergamini 
7239c6307b1SDamien Bergamini 			if (data->map != NULL)
7249c6307b1SDamien Bergamini 				bus_dmamap_destroy(ring->data_dmat, data->map);
7259c6307b1SDamien Bergamini 		}
7269c6307b1SDamien Bergamini 
7279c6307b1SDamien Bergamini 		free(ring->data, M_DEVBUF);
7289c6307b1SDamien Bergamini 	}
7299c6307b1SDamien Bergamini 
7309c6307b1SDamien Bergamini 	if (ring->data_dmat != NULL)
7319c6307b1SDamien Bergamini 		bus_dma_tag_destroy(ring->data_dmat);
7329c6307b1SDamien Bergamini }
7339c6307b1SDamien Bergamini 
7349c6307b1SDamien Bergamini static struct ieee80211_node *
7359c6307b1SDamien Bergamini rt2560_node_alloc(struct ieee80211_node_table *nt)
7369c6307b1SDamien Bergamini {
7379c6307b1SDamien Bergamini 	struct rt2560_node *rn;
7389c6307b1SDamien Bergamini 
7399c6307b1SDamien Bergamini 	rn = malloc(sizeof (struct rt2560_node), M_80211_NODE,
7409c6307b1SDamien Bergamini 	    M_NOWAIT | M_ZERO);
7419c6307b1SDamien Bergamini 
7429c6307b1SDamien Bergamini 	return (rn != NULL) ? &rn->ni : NULL;
7439c6307b1SDamien Bergamini }
7449c6307b1SDamien Bergamini 
7459c6307b1SDamien Bergamini static int
7469c6307b1SDamien Bergamini rt2560_media_change(struct ifnet *ifp)
7479c6307b1SDamien Bergamini {
7489c6307b1SDamien Bergamini 	struct rt2560_softc *sc = ifp->if_softc;
7499c6307b1SDamien Bergamini 	int error;
7509c6307b1SDamien Bergamini 
7519c6307b1SDamien Bergamini 	error = ieee80211_media_change(ifp);
7529c6307b1SDamien Bergamini 	if (error != ENETRESET)
7539c6307b1SDamien Bergamini 		return error;
7549c6307b1SDamien Bergamini 
7559c6307b1SDamien Bergamini 	if ((ifp->if_flags & IFF_UP) &&
7569c6307b1SDamien Bergamini 	    (ifp->if_drv_flags & IFF_DRV_RUNNING))
7579c6307b1SDamien Bergamini 		rt2560_init(sc);
7589c6307b1SDamien Bergamini 
7599c6307b1SDamien Bergamini 	return 0;
7609c6307b1SDamien Bergamini }
7619c6307b1SDamien Bergamini 
7629c6307b1SDamien Bergamini /*
7639c6307b1SDamien Bergamini  * This function is called periodically (every 200ms) during scanning to
7649c6307b1SDamien Bergamini  * switch from one channel to another.
7659c6307b1SDamien Bergamini  */
7669c6307b1SDamien Bergamini static void
7679c6307b1SDamien Bergamini rt2560_next_scan(void *arg)
7689c6307b1SDamien Bergamini {
7699c6307b1SDamien Bergamini 	struct rt2560_softc *sc = arg;
7709c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
7719c6307b1SDamien Bergamini 
7729c6307b1SDamien Bergamini 	if (ic->ic_state == IEEE80211_S_SCAN)
7739c6307b1SDamien Bergamini 		ieee80211_next_scan(ic);
7749c6307b1SDamien Bergamini }
7759c6307b1SDamien Bergamini 
7769c6307b1SDamien Bergamini /*
7779c6307b1SDamien Bergamini  * This function is called for each node present in the node station table.
7789c6307b1SDamien Bergamini  */
7799c6307b1SDamien Bergamini static void
7809c6307b1SDamien Bergamini rt2560_iter_func(void *arg, struct ieee80211_node *ni)
7819c6307b1SDamien Bergamini {
7829c6307b1SDamien Bergamini 	struct rt2560_node *rn = (struct rt2560_node *)ni;
7839c6307b1SDamien Bergamini 
7849c6307b1SDamien Bergamini 	ral_rssadapt_updatestats(&rn->rssadapt);
7859c6307b1SDamien Bergamini }
7869c6307b1SDamien Bergamini 
7879c6307b1SDamien Bergamini /*
7889c6307b1SDamien Bergamini  * This function is called periodically (every 100ms) in RUN state to update
7899c6307b1SDamien Bergamini  * the rate adaptation statistics.
7909c6307b1SDamien Bergamini  */
7919c6307b1SDamien Bergamini static void
7929c6307b1SDamien Bergamini rt2560_update_rssadapt(void *arg)
7939c6307b1SDamien Bergamini {
7949c6307b1SDamien Bergamini 	struct rt2560_softc *sc = arg;
7959c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
7969c6307b1SDamien Bergamini 
7979c6307b1SDamien Bergamini 	RAL_LOCK(sc);
7989c6307b1SDamien Bergamini 
7999c6307b1SDamien Bergamini 	ieee80211_iterate_nodes(&ic->ic_sta, rt2560_iter_func, arg);
8009c6307b1SDamien Bergamini 	callout_reset(&sc->rssadapt_ch, hz / 10, rt2560_update_rssadapt, sc);
8019c6307b1SDamien Bergamini 
8029c6307b1SDamien Bergamini 	RAL_UNLOCK(sc);
8039c6307b1SDamien Bergamini }
8049c6307b1SDamien Bergamini 
8059c6307b1SDamien Bergamini static int
8069c6307b1SDamien Bergamini rt2560_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg)
8079c6307b1SDamien Bergamini {
8089c6307b1SDamien Bergamini 	struct rt2560_softc *sc = ic->ic_ifp->if_softc;
8099c6307b1SDamien Bergamini 	enum ieee80211_state ostate;
8109c6307b1SDamien Bergamini 	struct ieee80211_node *ni;
8119c6307b1SDamien Bergamini 	struct mbuf *m;
8129c6307b1SDamien Bergamini 	int error = 0;
8139c6307b1SDamien Bergamini 
8149c6307b1SDamien Bergamini 	ostate = ic->ic_state;
8159c6307b1SDamien Bergamini 	callout_stop(&sc->scan_ch);
8169c6307b1SDamien Bergamini 
8179c6307b1SDamien Bergamini 	switch (nstate) {
8189c6307b1SDamien Bergamini 	case IEEE80211_S_INIT:
8199c6307b1SDamien Bergamini 		callout_stop(&sc->rssadapt_ch);
8209c6307b1SDamien Bergamini 
8219c6307b1SDamien Bergamini 		if (ostate == IEEE80211_S_RUN) {
8229c6307b1SDamien Bergamini 			/* abort TSF synchronization */
8239c6307b1SDamien Bergamini 			RAL_WRITE(sc, RT2560_CSR14, 0);
8249c6307b1SDamien Bergamini 
8259c6307b1SDamien Bergamini 			/* turn association led off */
8269c6307b1SDamien Bergamini 			rt2560_update_led(sc, 0, 0);
8279c6307b1SDamien Bergamini 		}
8289c6307b1SDamien Bergamini 		break;
8299c6307b1SDamien Bergamini 
8309c6307b1SDamien Bergamini 	case IEEE80211_S_SCAN:
8319c6307b1SDamien Bergamini 		rt2560_set_chan(sc, ic->ic_curchan);
8329c6307b1SDamien Bergamini 		callout_reset(&sc->scan_ch, (sc->dwelltime * hz) / 1000,
8339c6307b1SDamien Bergamini 		    rt2560_next_scan, sc);
8349c6307b1SDamien Bergamini 		break;
8359c6307b1SDamien Bergamini 
8369c6307b1SDamien Bergamini 	case IEEE80211_S_AUTH:
8379c6307b1SDamien Bergamini 		rt2560_set_chan(sc, ic->ic_curchan);
8389c6307b1SDamien Bergamini 		break;
8399c6307b1SDamien Bergamini 
8409c6307b1SDamien Bergamini 	case IEEE80211_S_ASSOC:
8419c6307b1SDamien Bergamini 		rt2560_set_chan(sc, ic->ic_curchan);
8429c6307b1SDamien Bergamini 		break;
8439c6307b1SDamien Bergamini 
8449c6307b1SDamien Bergamini 	case IEEE80211_S_RUN:
8459c6307b1SDamien Bergamini 		rt2560_set_chan(sc, ic->ic_curchan);
8469c6307b1SDamien Bergamini 
8479c6307b1SDamien Bergamini 		ni = ic->ic_bss;
8489c6307b1SDamien Bergamini 
8499c6307b1SDamien Bergamini 		if (ic->ic_opmode != IEEE80211_M_MONITOR) {
8509c6307b1SDamien Bergamini 			rt2560_update_plcp(sc);
8519c6307b1SDamien Bergamini 			rt2560_set_basicrates(sc);
8529c6307b1SDamien Bergamini 			rt2560_set_bssid(sc, ni->ni_bssid);
8539c6307b1SDamien Bergamini 		}
8549c6307b1SDamien Bergamini 
8559c6307b1SDamien Bergamini 		if (ic->ic_opmode == IEEE80211_M_HOSTAP ||
8569c6307b1SDamien Bergamini 		    ic->ic_opmode == IEEE80211_M_IBSS) {
8579c6307b1SDamien Bergamini 			m = ieee80211_beacon_alloc(ic, ni, &sc->sc_bo);
8589c6307b1SDamien Bergamini 			if (m == NULL) {
8599c6307b1SDamien Bergamini 				device_printf(sc->sc_dev,
8609c6307b1SDamien Bergamini 				    "could not allocate beacon\n");
8619c6307b1SDamien Bergamini 				error = ENOBUFS;
8629c6307b1SDamien Bergamini 				break;
8639c6307b1SDamien Bergamini 			}
8649c6307b1SDamien Bergamini 
8659c6307b1SDamien Bergamini 			ieee80211_ref_node(ni);
8669c6307b1SDamien Bergamini 			error = rt2560_tx_bcn(sc, m, ni);
8679c6307b1SDamien Bergamini 			if (error != 0)
8689c6307b1SDamien Bergamini 				break;
8699c6307b1SDamien Bergamini 		}
8709c6307b1SDamien Bergamini 
8719c6307b1SDamien Bergamini 		/* turn assocation led on */
8729c6307b1SDamien Bergamini 		rt2560_update_led(sc, 1, 0);
8739c6307b1SDamien Bergamini 
8749c6307b1SDamien Bergamini 		if (ic->ic_opmode != IEEE80211_M_MONITOR) {
8759c6307b1SDamien Bergamini 			callout_reset(&sc->rssadapt_ch, hz / 10,
8769c6307b1SDamien Bergamini 			    rt2560_update_rssadapt, sc);
8779c6307b1SDamien Bergamini 
8789c6307b1SDamien Bergamini 			rt2560_enable_tsf_sync(sc);
8799c6307b1SDamien Bergamini 		}
8809c6307b1SDamien Bergamini 		break;
8819c6307b1SDamien Bergamini 	}
8829c6307b1SDamien Bergamini 
8839c6307b1SDamien Bergamini 	return (error != 0) ? error : sc->sc_newstate(ic, nstate, arg);
8849c6307b1SDamien Bergamini }
8859c6307b1SDamien Bergamini 
8869c6307b1SDamien Bergamini /*
8879c6307b1SDamien Bergamini  * Read 16 bits at address 'addr' from the serial EEPROM (either 93C46 or
8889c6307b1SDamien Bergamini  * 93C66).
8899c6307b1SDamien Bergamini  */
8909c6307b1SDamien Bergamini static uint16_t
8919c6307b1SDamien Bergamini rt2560_eeprom_read(struct rt2560_softc *sc, uint8_t addr)
8929c6307b1SDamien Bergamini {
8939c6307b1SDamien Bergamini 	uint32_t tmp;
8949c6307b1SDamien Bergamini 	uint16_t val;
8959c6307b1SDamien Bergamini 	int n;
8969c6307b1SDamien Bergamini 
8979c6307b1SDamien Bergamini 	/* clock C once before the first command */
8989c6307b1SDamien Bergamini 	RT2560_EEPROM_CTL(sc, 0);
8999c6307b1SDamien Bergamini 
9009c6307b1SDamien Bergamini 	RT2560_EEPROM_CTL(sc, RT2560_S);
9019c6307b1SDamien Bergamini 	RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_C);
9029c6307b1SDamien Bergamini 	RT2560_EEPROM_CTL(sc, RT2560_S);
9039c6307b1SDamien Bergamini 
9049c6307b1SDamien Bergamini 	/* write start bit (1) */
9059c6307b1SDamien Bergamini 	RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_D);
9069c6307b1SDamien Bergamini 	RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_D | RT2560_C);
9079c6307b1SDamien Bergamini 
9089c6307b1SDamien Bergamini 	/* write READ opcode (10) */
9099c6307b1SDamien Bergamini 	RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_D);
9109c6307b1SDamien Bergamini 	RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_D | RT2560_C);
9119c6307b1SDamien Bergamini 	RT2560_EEPROM_CTL(sc, RT2560_S);
9129c6307b1SDamien Bergamini 	RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_C);
9139c6307b1SDamien Bergamini 
9149c6307b1SDamien Bergamini 	/* write address (A5-A0 or A7-A0) */
9159c6307b1SDamien Bergamini 	n = (RAL_READ(sc, RT2560_CSR21) & RT2560_93C46) ? 5 : 7;
9169c6307b1SDamien Bergamini 	for (; n >= 0; n--) {
9179c6307b1SDamien Bergamini 		RT2560_EEPROM_CTL(sc, RT2560_S |
9189c6307b1SDamien Bergamini 		    (((addr >> n) & 1) << RT2560_SHIFT_D));
9199c6307b1SDamien Bergamini 		RT2560_EEPROM_CTL(sc, RT2560_S |
9209c6307b1SDamien Bergamini 		    (((addr >> n) & 1) << RT2560_SHIFT_D) | RT2560_C);
9219c6307b1SDamien Bergamini 	}
9229c6307b1SDamien Bergamini 
9239c6307b1SDamien Bergamini 	RT2560_EEPROM_CTL(sc, RT2560_S);
9249c6307b1SDamien Bergamini 
9259c6307b1SDamien Bergamini 	/* read data Q15-Q0 */
9269c6307b1SDamien Bergamini 	val = 0;
9279c6307b1SDamien Bergamini 	for (n = 15; n >= 0; n--) {
9289c6307b1SDamien Bergamini 		RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_C);
9299c6307b1SDamien Bergamini 		tmp = RAL_READ(sc, RT2560_CSR21);
9309c6307b1SDamien Bergamini 		val |= ((tmp & RT2560_Q) >> RT2560_SHIFT_Q) << n;
9319c6307b1SDamien Bergamini 		RT2560_EEPROM_CTL(sc, RT2560_S);
9329c6307b1SDamien Bergamini 	}
9339c6307b1SDamien Bergamini 
9349c6307b1SDamien Bergamini 	RT2560_EEPROM_CTL(sc, 0);
9359c6307b1SDamien Bergamini 
9369c6307b1SDamien Bergamini 	/* clear Chip Select and clock C */
9379c6307b1SDamien Bergamini 	RT2560_EEPROM_CTL(sc, RT2560_S);
9389c6307b1SDamien Bergamini 	RT2560_EEPROM_CTL(sc, 0);
9399c6307b1SDamien Bergamini 	RT2560_EEPROM_CTL(sc, RT2560_C);
9409c6307b1SDamien Bergamini 
9419c6307b1SDamien Bergamini 	return val;
9429c6307b1SDamien Bergamini }
9439c6307b1SDamien Bergamini 
9449c6307b1SDamien Bergamini /*
9459c6307b1SDamien Bergamini  * Some frames were processed by the hardware cipher engine and are ready for
9469c6307b1SDamien Bergamini  * transmission.
9479c6307b1SDamien Bergamini  */
9489c6307b1SDamien Bergamini static void
9499c6307b1SDamien Bergamini rt2560_encryption_intr(struct rt2560_softc *sc)
9509c6307b1SDamien Bergamini {
9519c6307b1SDamien Bergamini 	struct rt2560_tx_desc *desc;
9529c6307b1SDamien Bergamini 	int hw;
9539c6307b1SDamien Bergamini 
9549c6307b1SDamien Bergamini 	/* retrieve last descriptor index processed by cipher engine */
9559c6307b1SDamien Bergamini 	hw = RAL_READ(sc, RT2560_SECCSR1) - sc->txq.physaddr;
9569c6307b1SDamien Bergamini 	hw /= RT2560_TX_DESC_SIZE;
9579c6307b1SDamien Bergamini 
9589c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->txq.desc_dmat, sc->txq.desc_map,
9599c6307b1SDamien Bergamini 	    BUS_DMASYNC_POSTREAD);
9609c6307b1SDamien Bergamini 
9619c6307b1SDamien Bergamini 	for (; sc->txq.next_encrypt != hw;) {
9629c6307b1SDamien Bergamini 		desc = &sc->txq.desc[sc->txq.next_encrypt];
9639c6307b1SDamien Bergamini 
9649c6307b1SDamien Bergamini 		if ((le32toh(desc->flags) & RT2560_TX_BUSY) ||
9659c6307b1SDamien Bergamini 		    (le32toh(desc->flags) & RT2560_TX_CIPHER_BUSY))
9669c6307b1SDamien Bergamini 			break;
9679c6307b1SDamien Bergamini 
9689c6307b1SDamien Bergamini 		/* for TKIP, swap eiv field to fix a bug in ASIC */
9699c6307b1SDamien Bergamini 		if ((le32toh(desc->flags) & RT2560_TX_CIPHER_MASK) ==
9709c6307b1SDamien Bergamini 		    RT2560_TX_CIPHER_TKIP)
9719c6307b1SDamien Bergamini 			desc->eiv = bswap32(desc->eiv);
9729c6307b1SDamien Bergamini 
9739c6307b1SDamien Bergamini 		/* mark the frame ready for transmission */
9749c6307b1SDamien Bergamini 		desc->flags |= htole32(RT2560_TX_BUSY | RT2560_TX_VALID);
9759c6307b1SDamien Bergamini 
9769c6307b1SDamien Bergamini 		DPRINTFN(15, ("encryption done idx=%u\n",
9779c6307b1SDamien Bergamini 		    sc->txq.next_encrypt));
9789c6307b1SDamien Bergamini 
9799c6307b1SDamien Bergamini 		sc->txq.next_encrypt =
9809c6307b1SDamien Bergamini 		    (sc->txq.next_encrypt + 1) % RT2560_TX_RING_COUNT;
9819c6307b1SDamien Bergamini 	}
9829c6307b1SDamien Bergamini 
9839c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->txq.desc_dmat, sc->txq.desc_map,
9849c6307b1SDamien Bergamini 	    BUS_DMASYNC_PREWRITE);
9859c6307b1SDamien Bergamini 
9869c6307b1SDamien Bergamini 	/* kick Tx */
9879c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_TXCSR0, RT2560_KICK_TX);
9889c6307b1SDamien Bergamini }
9899c6307b1SDamien Bergamini 
9909c6307b1SDamien Bergamini static void
9919c6307b1SDamien Bergamini rt2560_tx_intr(struct rt2560_softc *sc)
9929c6307b1SDamien Bergamini {
9939c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
9949c6307b1SDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
9959c6307b1SDamien Bergamini 	struct rt2560_tx_desc *desc;
9969c6307b1SDamien Bergamini 	struct rt2560_tx_data *data;
9979c6307b1SDamien Bergamini 	struct rt2560_node *rn;
9989c6307b1SDamien Bergamini 
9999c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->txq.desc_dmat, sc->txq.desc_map,
10009c6307b1SDamien Bergamini 	    BUS_DMASYNC_POSTREAD);
10019c6307b1SDamien Bergamini 
10029c6307b1SDamien Bergamini 	for (;;) {
10039c6307b1SDamien Bergamini 		desc = &sc->txq.desc[sc->txq.next];
10049c6307b1SDamien Bergamini 		data = &sc->txq.data[sc->txq.next];
10059c6307b1SDamien Bergamini 
10069c6307b1SDamien Bergamini 		if ((le32toh(desc->flags) & RT2560_TX_BUSY) ||
10079c6307b1SDamien Bergamini 		    (le32toh(desc->flags) & RT2560_TX_CIPHER_BUSY) ||
10089c6307b1SDamien Bergamini 		    !(le32toh(desc->flags) & RT2560_TX_VALID))
10099c6307b1SDamien Bergamini 			break;
10109c6307b1SDamien Bergamini 
10119c6307b1SDamien Bergamini 		rn = (struct rt2560_node *)data->ni;
10129c6307b1SDamien Bergamini 
10139c6307b1SDamien Bergamini 		switch (le32toh(desc->flags) & RT2560_TX_RESULT_MASK) {
10149c6307b1SDamien Bergamini 		case RT2560_TX_SUCCESS:
10159c6307b1SDamien Bergamini 			DPRINTFN(10, ("data frame sent successfully\n"));
10169c6307b1SDamien Bergamini 			if (data->id.id_node != NULL) {
10179c6307b1SDamien Bergamini 				ral_rssadapt_raise_rate(ic, &rn->rssadapt,
10189c6307b1SDamien Bergamini 				    &data->id);
10199c6307b1SDamien Bergamini 			}
10209c6307b1SDamien Bergamini 			ifp->if_opackets++;
10219c6307b1SDamien Bergamini 			break;
10229c6307b1SDamien Bergamini 
10239c6307b1SDamien Bergamini 		case RT2560_TX_SUCCESS_RETRY:
10249c6307b1SDamien Bergamini 			DPRINTFN(9, ("data frame sent after %u retries\n",
10259c6307b1SDamien Bergamini 			    (le32toh(desc->flags) >> 5) & 0x7));
10269c6307b1SDamien Bergamini 			ifp->if_opackets++;
10279c6307b1SDamien Bergamini 			break;
10289c6307b1SDamien Bergamini 
10299c6307b1SDamien Bergamini 		case RT2560_TX_FAIL_RETRY:
10309c6307b1SDamien Bergamini 			DPRINTFN(9, ("sending data frame failed (too much "
10319c6307b1SDamien Bergamini 			    "retries)\n"));
10329c6307b1SDamien Bergamini 			if (data->id.id_node != NULL) {
10339c6307b1SDamien Bergamini 				ral_rssadapt_lower_rate(ic, data->ni,
10349c6307b1SDamien Bergamini 				    &rn->rssadapt, &data->id);
10359c6307b1SDamien Bergamini 			}
10369c6307b1SDamien Bergamini 			ifp->if_oerrors++;
10379c6307b1SDamien Bergamini 			break;
10389c6307b1SDamien Bergamini 
10399c6307b1SDamien Bergamini 		case RT2560_TX_FAIL_INVALID:
10409c6307b1SDamien Bergamini 		case RT2560_TX_FAIL_OTHER:
10419c6307b1SDamien Bergamini 		default:
10429c6307b1SDamien Bergamini 			device_printf(sc->sc_dev, "sending data frame failed "
10439c6307b1SDamien Bergamini 			    "0x%08x\n", le32toh(desc->flags));
10449c6307b1SDamien Bergamini 			ifp->if_oerrors++;
10459c6307b1SDamien Bergamini 		}
10469c6307b1SDamien Bergamini 
10479c6307b1SDamien Bergamini 		bus_dmamap_sync(sc->txq.data_dmat, data->map,
10489c6307b1SDamien Bergamini 		    BUS_DMASYNC_POSTWRITE);
10499c6307b1SDamien Bergamini 		bus_dmamap_unload(sc->txq.data_dmat, data->map);
10509c6307b1SDamien Bergamini 		m_freem(data->m);
10519c6307b1SDamien Bergamini 		data->m = NULL;
10529c6307b1SDamien Bergamini 		ieee80211_free_node(data->ni);
10539c6307b1SDamien Bergamini 		data->ni = NULL;
10549c6307b1SDamien Bergamini 
10559c6307b1SDamien Bergamini 		/* descriptor is no longer valid */
10569c6307b1SDamien Bergamini 		desc->flags &= ~htole32(RT2560_TX_VALID);
10579c6307b1SDamien Bergamini 
10589c6307b1SDamien Bergamini 		DPRINTFN(15, ("tx done idx=%u\n", sc->txq.next));
10599c6307b1SDamien Bergamini 
10609c6307b1SDamien Bergamini 		sc->txq.queued--;
10619c6307b1SDamien Bergamini 		sc->txq.next = (sc->txq.next + 1) % RT2560_TX_RING_COUNT;
10629c6307b1SDamien Bergamini 	}
10639c6307b1SDamien Bergamini 
10649c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->txq.desc_dmat, sc->txq.desc_map,
10659c6307b1SDamien Bergamini 	    BUS_DMASYNC_PREWRITE);
10669c6307b1SDamien Bergamini 
10679c6307b1SDamien Bergamini 	sc->sc_tx_timer = 0;
10689c6307b1SDamien Bergamini 	ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
10699c6307b1SDamien Bergamini 	rt2560_start(ifp);
10709c6307b1SDamien Bergamini }
10719c6307b1SDamien Bergamini 
10729c6307b1SDamien Bergamini static void
10739c6307b1SDamien Bergamini rt2560_prio_intr(struct rt2560_softc *sc)
10749c6307b1SDamien Bergamini {
10759c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
10769c6307b1SDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
10779c6307b1SDamien Bergamini 	struct rt2560_tx_desc *desc;
10789c6307b1SDamien Bergamini 	struct rt2560_tx_data *data;
10799c6307b1SDamien Bergamini 
10809c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->prioq.desc_dmat, sc->prioq.desc_map,
10819c6307b1SDamien Bergamini 	    BUS_DMASYNC_POSTREAD);
10829c6307b1SDamien Bergamini 
10839c6307b1SDamien Bergamini 	for (;;) {
10849c6307b1SDamien Bergamini 		desc = &sc->prioq.desc[sc->prioq.next];
10859c6307b1SDamien Bergamini 		data = &sc->prioq.data[sc->prioq.next];
10869c6307b1SDamien Bergamini 
10879c6307b1SDamien Bergamini 		if ((le32toh(desc->flags) & RT2560_TX_BUSY) ||
10889c6307b1SDamien Bergamini 		    !(le32toh(desc->flags) & RT2560_TX_VALID))
10899c6307b1SDamien Bergamini 			break;
10909c6307b1SDamien Bergamini 
10919c6307b1SDamien Bergamini 		switch (le32toh(desc->flags) & RT2560_TX_RESULT_MASK) {
10929c6307b1SDamien Bergamini 		case RT2560_TX_SUCCESS:
10939c6307b1SDamien Bergamini 			DPRINTFN(10, ("mgt frame sent successfully\n"));
10949c6307b1SDamien Bergamini 			break;
10959c6307b1SDamien Bergamini 
10969c6307b1SDamien Bergamini 		case RT2560_TX_SUCCESS_RETRY:
10979c6307b1SDamien Bergamini 			DPRINTFN(9, ("mgt frame sent after %u retries\n",
10989c6307b1SDamien Bergamini 			    (le32toh(desc->flags) >> 5) & 0x7));
10999c6307b1SDamien Bergamini 			break;
11009c6307b1SDamien Bergamini 
11019c6307b1SDamien Bergamini 		case RT2560_TX_FAIL_RETRY:
11029c6307b1SDamien Bergamini 			DPRINTFN(9, ("sending mgt frame failed (too much "
11039c6307b1SDamien Bergamini 			    "retries)\n"));
11049c6307b1SDamien Bergamini 			break;
11059c6307b1SDamien Bergamini 
11069c6307b1SDamien Bergamini 		case RT2560_TX_FAIL_INVALID:
11079c6307b1SDamien Bergamini 		case RT2560_TX_FAIL_OTHER:
11089c6307b1SDamien Bergamini 		default:
11099c6307b1SDamien Bergamini 			device_printf(sc->sc_dev, "sending mgt frame failed "
11109c6307b1SDamien Bergamini 			    "0x%08x\n", le32toh(desc->flags));
11119c6307b1SDamien Bergamini 		}
11129c6307b1SDamien Bergamini 
11139c6307b1SDamien Bergamini 		bus_dmamap_sync(sc->prioq.data_dmat, data->map,
11149c6307b1SDamien Bergamini 		    BUS_DMASYNC_POSTWRITE);
11159c6307b1SDamien Bergamini 		bus_dmamap_unload(sc->prioq.data_dmat, data->map);
11169c6307b1SDamien Bergamini 		m_freem(data->m);
11179c6307b1SDamien Bergamini 		data->m = NULL;
11189c6307b1SDamien Bergamini 		ieee80211_free_node(data->ni);
11199c6307b1SDamien Bergamini 		data->ni = NULL;
11209c6307b1SDamien Bergamini 
11219c6307b1SDamien Bergamini 		/* descriptor is no longer valid */
11229c6307b1SDamien Bergamini 		desc->flags &= ~htole32(RT2560_TX_VALID);
11239c6307b1SDamien Bergamini 
11249c6307b1SDamien Bergamini 		DPRINTFN(15, ("prio done idx=%u\n", sc->prioq.next));
11259c6307b1SDamien Bergamini 
11269c6307b1SDamien Bergamini 		sc->prioq.queued--;
11279c6307b1SDamien Bergamini 		sc->prioq.next = (sc->prioq.next + 1) % RT2560_PRIO_RING_COUNT;
11289c6307b1SDamien Bergamini 	}
11299c6307b1SDamien Bergamini 
11309c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->prioq.desc_dmat, sc->prioq.desc_map,
11319c6307b1SDamien Bergamini 	    BUS_DMASYNC_PREWRITE);
11329c6307b1SDamien Bergamini 
11339c6307b1SDamien Bergamini 	sc->sc_tx_timer = 0;
11349c6307b1SDamien Bergamini 	ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
11359c6307b1SDamien Bergamini 	rt2560_start(ifp);
11369c6307b1SDamien Bergamini }
11379c6307b1SDamien Bergamini 
11389c6307b1SDamien Bergamini /*
11399c6307b1SDamien Bergamini  * Some frames were processed by the hardware cipher engine and are ready for
11409c6307b1SDamien Bergamini  * transmission to the IEEE802.11 layer.
11419c6307b1SDamien Bergamini  */
11429c6307b1SDamien Bergamini static void
11439c6307b1SDamien Bergamini rt2560_decryption_intr(struct rt2560_softc *sc)
11449c6307b1SDamien Bergamini {
11459c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
11469c6307b1SDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
11479c6307b1SDamien Bergamini 	struct rt2560_rx_desc *desc;
11489c6307b1SDamien Bergamini 	struct rt2560_rx_data *data;
11499c6307b1SDamien Bergamini 	bus_addr_t physaddr;
11509c6307b1SDamien Bergamini 	struct ieee80211_frame *wh;
11519c6307b1SDamien Bergamini 	struct ieee80211_node *ni;
11529c6307b1SDamien Bergamini 	struct rt2560_node *rn;
11539c6307b1SDamien Bergamini 	struct mbuf *mnew, *m;
11549c6307b1SDamien Bergamini 	int hw, error;
11559c6307b1SDamien Bergamini 
11569c6307b1SDamien Bergamini 	/* retrieve last decriptor index processed by cipher engine */
11579c6307b1SDamien Bergamini 	hw = RAL_READ(sc, RT2560_SECCSR0) - sc->rxq.physaddr;
11589c6307b1SDamien Bergamini 	hw /= RT2560_RX_DESC_SIZE;
11599c6307b1SDamien Bergamini 
11609c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->rxq.desc_dmat, sc->rxq.desc_map,
11619c6307b1SDamien Bergamini 	    BUS_DMASYNC_POSTREAD);
11629c6307b1SDamien Bergamini 
11639c6307b1SDamien Bergamini 	for (; sc->rxq.cur_decrypt != hw;) {
11649c6307b1SDamien Bergamini 		desc = &sc->rxq.desc[sc->rxq.cur_decrypt];
11659c6307b1SDamien Bergamini 		data = &sc->rxq.data[sc->rxq.cur_decrypt];
11669c6307b1SDamien Bergamini 
11679c6307b1SDamien Bergamini 		if ((le32toh(desc->flags) & RT2560_RX_BUSY) ||
11689c6307b1SDamien Bergamini 		    (le32toh(desc->flags) & RT2560_RX_CIPHER_BUSY))
11699c6307b1SDamien Bergamini 			break;
11709c6307b1SDamien Bergamini 
11719c6307b1SDamien Bergamini 		if (data->drop) {
11729c6307b1SDamien Bergamini 			ifp->if_ierrors++;
11739c6307b1SDamien Bergamini 			goto skip;
11749c6307b1SDamien Bergamini 		}
11759c6307b1SDamien Bergamini 
11769c6307b1SDamien Bergamini 		if ((le32toh(desc->flags) & RT2560_RX_CIPHER_MASK) != 0 &&
11779c6307b1SDamien Bergamini 		    (le32toh(desc->flags) & RT2560_RX_ICV_ERROR)) {
11789c6307b1SDamien Bergamini 			ifp->if_ierrors++;
11799c6307b1SDamien Bergamini 			goto skip;
11809c6307b1SDamien Bergamini 		}
11819c6307b1SDamien Bergamini 
11829c6307b1SDamien Bergamini 		/*
11839c6307b1SDamien Bergamini 		 * Try to allocate a new mbuf for this ring element and load it
11849c6307b1SDamien Bergamini 		 * before processing the current mbuf. If the ring element
11859c6307b1SDamien Bergamini 		 * cannot be loaded, drop the received packet and reuse the old
11869c6307b1SDamien Bergamini 		 * mbuf. In the unlikely case that the old mbuf can't be
11879c6307b1SDamien Bergamini 		 * reloaded either, explicitly panic.
11889c6307b1SDamien Bergamini 		 */
11899c6307b1SDamien Bergamini 		mnew = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR);
11909c6307b1SDamien Bergamini 		if (mnew == NULL) {
11919c6307b1SDamien Bergamini 			ifp->if_ierrors++;
11929c6307b1SDamien Bergamini 			goto skip;
11939c6307b1SDamien Bergamini 		}
11949c6307b1SDamien Bergamini 
11959c6307b1SDamien Bergamini 		bus_dmamap_sync(sc->rxq.data_dmat, data->map,
11969c6307b1SDamien Bergamini 		    BUS_DMASYNC_POSTREAD);
11979c6307b1SDamien Bergamini 		bus_dmamap_unload(sc->rxq.data_dmat, data->map);
11989c6307b1SDamien Bergamini 
11999c6307b1SDamien Bergamini 		error = bus_dmamap_load(sc->rxq.data_dmat, data->map,
12009c6307b1SDamien Bergamini 		    mtod(mnew, void *), MCLBYTES, rt2560_dma_map_addr,
12019c6307b1SDamien Bergamini 		    &physaddr, 0);
12029c6307b1SDamien Bergamini 		if (error != 0) {
12039c6307b1SDamien Bergamini 			m_freem(mnew);
12049c6307b1SDamien Bergamini 
12059c6307b1SDamien Bergamini 			/* try to reload the old mbuf */
12069c6307b1SDamien Bergamini 			error = bus_dmamap_load(sc->rxq.data_dmat, data->map,
12079c6307b1SDamien Bergamini 			    mtod(data->m, void *), MCLBYTES,
12089c6307b1SDamien Bergamini 			    rt2560_dma_map_addr, &physaddr, 0);
12099c6307b1SDamien Bergamini 			if (error != 0) {
12109c6307b1SDamien Bergamini 				/* very unlikely that it will fail... */
12119c6307b1SDamien Bergamini 				panic("%s: could not load old rx mbuf",
12129c6307b1SDamien Bergamini 				    device_get_name(sc->sc_dev));
12139c6307b1SDamien Bergamini 			}
12149c6307b1SDamien Bergamini 			ifp->if_ierrors++;
12159c6307b1SDamien Bergamini 			goto skip;
12169c6307b1SDamien Bergamini 		}
12179c6307b1SDamien Bergamini 
12189c6307b1SDamien Bergamini 		/*
12199c6307b1SDamien Bergamini 	 	 * New mbuf successfully loaded, update Rx ring and continue
12209c6307b1SDamien Bergamini 		 * processing.
12219c6307b1SDamien Bergamini 		 */
12229c6307b1SDamien Bergamini 		m = data->m;
12239c6307b1SDamien Bergamini 		data->m = mnew;
12249c6307b1SDamien Bergamini 		desc->physaddr = htole32(physaddr);
12259c6307b1SDamien Bergamini 
12269c6307b1SDamien Bergamini 		/* finalize mbuf */
12279c6307b1SDamien Bergamini 		m->m_pkthdr.rcvif = ifp;
12289c6307b1SDamien Bergamini 		m->m_pkthdr.len = m->m_len =
12299c6307b1SDamien Bergamini 		    (le32toh(desc->flags) >> 16) & 0xfff;
12309c6307b1SDamien Bergamini 
123116d878ccSChristian S.J. Peron 		if (bpf_peers_present(sc->sc_drvbpf)) {
12329c6307b1SDamien Bergamini 			struct rt2560_rx_radiotap_header *tap = &sc->sc_rxtap;
12339c6307b1SDamien Bergamini 			uint32_t tsf_lo, tsf_hi;
12349c6307b1SDamien Bergamini 
12359c6307b1SDamien Bergamini 			/* get timestamp (low and high 32 bits) */
12369c6307b1SDamien Bergamini 			tsf_hi = RAL_READ(sc, RT2560_CSR17);
12379c6307b1SDamien Bergamini 			tsf_lo = RAL_READ(sc, RT2560_CSR16);
12389c6307b1SDamien Bergamini 
12399c6307b1SDamien Bergamini 			tap->wr_tsf =
12409c6307b1SDamien Bergamini 			    htole64(((uint64_t)tsf_hi << 32) | tsf_lo);
12419c6307b1SDamien Bergamini 			tap->wr_flags = 0;
12429c6307b1SDamien Bergamini 			tap->wr_rate = rt2560_rxrate(desc);
12439c6307b1SDamien Bergamini 			tap->wr_chan_freq = htole16(ic->ic_curchan->ic_freq);
12449c6307b1SDamien Bergamini 			tap->wr_chan_flags = htole16(ic->ic_curchan->ic_flags);
12459c6307b1SDamien Bergamini 			tap->wr_antenna = sc->rx_ant;
12469c6307b1SDamien Bergamini 			tap->wr_antsignal = desc->rssi;
12479c6307b1SDamien Bergamini 
12489c6307b1SDamien Bergamini 			bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_rxtap_len, m);
12499c6307b1SDamien Bergamini 		}
12509c6307b1SDamien Bergamini 
12519c6307b1SDamien Bergamini 		wh = mtod(m, struct ieee80211_frame *);
12529c6307b1SDamien Bergamini 		ni = ieee80211_find_rxnode(ic,
12539c6307b1SDamien Bergamini 		    (struct ieee80211_frame_min *)wh);
12549c6307b1SDamien Bergamini 
12559c6307b1SDamien Bergamini 		/* send the frame to the 802.11 layer */
12569c6307b1SDamien Bergamini 		ieee80211_input(ic, m, ni, desc->rssi, 0);
12579c6307b1SDamien Bergamini 
12589c6307b1SDamien Bergamini 		/* give rssi to the rate adatation algorithm */
12599c6307b1SDamien Bergamini 		rn = (struct rt2560_node *)ni;
12609c6307b1SDamien Bergamini 		ral_rssadapt_input(ic, ni, &rn->rssadapt, desc->rssi);
12619c6307b1SDamien Bergamini 
12629c6307b1SDamien Bergamini 		/* node is no longer needed */
12639c6307b1SDamien Bergamini 		ieee80211_free_node(ni);
12649c6307b1SDamien Bergamini 
12659c6307b1SDamien Bergamini skip:		desc->flags = htole32(RT2560_RX_BUSY);
12669c6307b1SDamien Bergamini 
12679c6307b1SDamien Bergamini 		DPRINTFN(15, ("decryption done idx=%u\n", sc->rxq.cur_decrypt));
12689c6307b1SDamien Bergamini 
12699c6307b1SDamien Bergamini 		sc->rxq.cur_decrypt =
12709c6307b1SDamien Bergamini 		    (sc->rxq.cur_decrypt + 1) % RT2560_RX_RING_COUNT;
12719c6307b1SDamien Bergamini 	}
12729c6307b1SDamien Bergamini 
12739c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->rxq.desc_dmat, sc->rxq.desc_map,
12749c6307b1SDamien Bergamini 	    BUS_DMASYNC_PREWRITE);
12759c6307b1SDamien Bergamini }
12769c6307b1SDamien Bergamini 
12779c6307b1SDamien Bergamini /*
12789c6307b1SDamien Bergamini  * Some frames were received. Pass them to the hardware cipher engine before
12799c6307b1SDamien Bergamini  * sending them to the 802.11 layer.
12809c6307b1SDamien Bergamini  */
12819c6307b1SDamien Bergamini static void
12829c6307b1SDamien Bergamini rt2560_rx_intr(struct rt2560_softc *sc)
12839c6307b1SDamien Bergamini {
12849c6307b1SDamien Bergamini 	struct rt2560_rx_desc *desc;
12859c6307b1SDamien Bergamini 	struct rt2560_rx_data *data;
12869c6307b1SDamien Bergamini 
12879c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->rxq.desc_dmat, sc->rxq.desc_map,
12889c6307b1SDamien Bergamini 	    BUS_DMASYNC_POSTREAD);
12899c6307b1SDamien Bergamini 
12909c6307b1SDamien Bergamini 	for (;;) {
12919c6307b1SDamien Bergamini 		desc = &sc->rxq.desc[sc->rxq.cur];
12929c6307b1SDamien Bergamini 		data = &sc->rxq.data[sc->rxq.cur];
12939c6307b1SDamien Bergamini 
12949c6307b1SDamien Bergamini 		if ((le32toh(desc->flags) & RT2560_RX_BUSY) ||
12959c6307b1SDamien Bergamini 		    (le32toh(desc->flags) & RT2560_RX_CIPHER_BUSY))
12969c6307b1SDamien Bergamini 			break;
12979c6307b1SDamien Bergamini 
12989c6307b1SDamien Bergamini 		data->drop = 0;
12999c6307b1SDamien Bergamini 
13009c6307b1SDamien Bergamini 		if ((le32toh(desc->flags) & RT2560_RX_PHY_ERROR) ||
13019c6307b1SDamien Bergamini 		    (le32toh(desc->flags) & RT2560_RX_CRC_ERROR)) {
13029c6307b1SDamien Bergamini 			/*
13039c6307b1SDamien Bergamini 			 * This should not happen since we did not request
13049c6307b1SDamien Bergamini 			 * to receive those frames when we filled RXCSR0.
13059c6307b1SDamien Bergamini 			 */
13069c6307b1SDamien Bergamini 			DPRINTFN(5, ("PHY or CRC error flags 0x%08x\n",
13079c6307b1SDamien Bergamini 			    le32toh(desc->flags)));
13089c6307b1SDamien Bergamini 			data->drop = 1;
13099c6307b1SDamien Bergamini 		}
13109c6307b1SDamien Bergamini 
13119c6307b1SDamien Bergamini 		if (((le32toh(desc->flags) >> 16) & 0xfff) > MCLBYTES) {
13129c6307b1SDamien Bergamini 			DPRINTFN(5, ("bad length\n"));
13139c6307b1SDamien Bergamini 			data->drop = 1;
13149c6307b1SDamien Bergamini 		}
13159c6307b1SDamien Bergamini 
13169c6307b1SDamien Bergamini 		/* mark the frame for decryption */
13179c6307b1SDamien Bergamini 		desc->flags |= htole32(RT2560_RX_CIPHER_BUSY);
13189c6307b1SDamien Bergamini 
13199c6307b1SDamien Bergamini 		DPRINTFN(15, ("rx done idx=%u\n", sc->rxq.cur));
13209c6307b1SDamien Bergamini 
13219c6307b1SDamien Bergamini 		sc->rxq.cur = (sc->rxq.cur + 1) % RT2560_RX_RING_COUNT;
13229c6307b1SDamien Bergamini 	}
13239c6307b1SDamien Bergamini 
13249c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->rxq.desc_dmat, sc->rxq.desc_map,
13259c6307b1SDamien Bergamini 	    BUS_DMASYNC_PREWRITE);
13269c6307b1SDamien Bergamini 
13279c6307b1SDamien Bergamini 	/* kick decrypt */
13289c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_SECCSR0, RT2560_KICK_DECRYPT);
13299c6307b1SDamien Bergamini }
13309c6307b1SDamien Bergamini 
13319c6307b1SDamien Bergamini /*
13329c6307b1SDamien Bergamini  * This function is called periodically in IBSS mode when a new beacon must be
13339c6307b1SDamien Bergamini  * sent out.
13349c6307b1SDamien Bergamini  */
13359c6307b1SDamien Bergamini static void
13369c6307b1SDamien Bergamini rt2560_beacon_expire(struct rt2560_softc *sc)
13379c6307b1SDamien Bergamini {
13389c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
13399c6307b1SDamien Bergamini 	struct rt2560_tx_data *data;
13409c6307b1SDamien Bergamini 
13419c6307b1SDamien Bergamini 	if (ic->ic_opmode != IEEE80211_M_IBSS &&
13429c6307b1SDamien Bergamini 	    ic->ic_opmode != IEEE80211_M_HOSTAP)
13439c6307b1SDamien Bergamini 		return;
13449c6307b1SDamien Bergamini 
13459c6307b1SDamien Bergamini 	data = &sc->bcnq.data[sc->bcnq.next];
13469c6307b1SDamien Bergamini 
13479c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->bcnq.data_dmat, data->map, BUS_DMASYNC_POSTWRITE);
13489c6307b1SDamien Bergamini 	bus_dmamap_unload(sc->bcnq.data_dmat, data->map);
13499c6307b1SDamien Bergamini 
13509c6307b1SDamien Bergamini 	ieee80211_beacon_update(ic, data->ni, &sc->sc_bo, data->m, 1);
13519c6307b1SDamien Bergamini 
135216d878ccSChristian S.J. Peron 	if (bpf_peers_present(ic->ic_rawbpf))
13539c6307b1SDamien Bergamini 		bpf_mtap(ic->ic_rawbpf, data->m);
13549c6307b1SDamien Bergamini 
13559c6307b1SDamien Bergamini 	rt2560_tx_bcn(sc, data->m, data->ni);
13569c6307b1SDamien Bergamini 
13579c6307b1SDamien Bergamini 	DPRINTFN(15, ("beacon expired\n"));
13589c6307b1SDamien Bergamini 
13599c6307b1SDamien Bergamini 	sc->bcnq.next = (sc->bcnq.next + 1) % RT2560_BEACON_RING_COUNT;
13609c6307b1SDamien Bergamini }
13619c6307b1SDamien Bergamini 
13629c6307b1SDamien Bergamini /* ARGSUSED */
13639c6307b1SDamien Bergamini static void
13649c6307b1SDamien Bergamini rt2560_wakeup_expire(struct rt2560_softc *sc)
13659c6307b1SDamien Bergamini {
13669c6307b1SDamien Bergamini 	DPRINTFN(2, ("wakeup expired\n"));
13679c6307b1SDamien Bergamini }
13689c6307b1SDamien Bergamini 
13699c6307b1SDamien Bergamini void
13709c6307b1SDamien Bergamini rt2560_intr(void *arg)
13719c6307b1SDamien Bergamini {
13729c6307b1SDamien Bergamini 	struct rt2560_softc *sc = arg;
1373d0934eb1SDamien Bergamini 	struct ifnet *ifp = sc->sc_ifp;
13749c6307b1SDamien Bergamini 	uint32_t r;
13759c6307b1SDamien Bergamini 
13769c6307b1SDamien Bergamini 	RAL_LOCK(sc);
13779c6307b1SDamien Bergamini 
13789c6307b1SDamien Bergamini 	/* disable interrupts */
13799c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR8, 0xffffffff);
13809c6307b1SDamien Bergamini 
1381d0934eb1SDamien Bergamini 	/* don't re-enable interrupts if we're shutting down */
1382d0934eb1SDamien Bergamini 	if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) {
1383d0934eb1SDamien Bergamini 		RAL_UNLOCK(sc);
1384d0934eb1SDamien Bergamini 		return;
1385d0934eb1SDamien Bergamini 	}
1386d0934eb1SDamien Bergamini 
13879c6307b1SDamien Bergamini 	r = RAL_READ(sc, RT2560_CSR7);
13889c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR7, r);
13899c6307b1SDamien Bergamini 
13909c6307b1SDamien Bergamini 	if (r & RT2560_BEACON_EXPIRE)
13919c6307b1SDamien Bergamini 		rt2560_beacon_expire(sc);
13929c6307b1SDamien Bergamini 
13939c6307b1SDamien Bergamini 	if (r & RT2560_WAKEUP_EXPIRE)
13949c6307b1SDamien Bergamini 		rt2560_wakeup_expire(sc);
13959c6307b1SDamien Bergamini 
13969c6307b1SDamien Bergamini 	if (r & RT2560_ENCRYPTION_DONE)
13979c6307b1SDamien Bergamini 		rt2560_encryption_intr(sc);
13989c6307b1SDamien Bergamini 
13999c6307b1SDamien Bergamini 	if (r & RT2560_TX_DONE)
14009c6307b1SDamien Bergamini 		rt2560_tx_intr(sc);
14019c6307b1SDamien Bergamini 
14029c6307b1SDamien Bergamini 	if (r & RT2560_PRIO_DONE)
14039c6307b1SDamien Bergamini 		rt2560_prio_intr(sc);
14049c6307b1SDamien Bergamini 
14059c6307b1SDamien Bergamini 	if (r & RT2560_DECRYPTION_DONE)
14069c6307b1SDamien Bergamini 		rt2560_decryption_intr(sc);
14079c6307b1SDamien Bergamini 
14089c6307b1SDamien Bergamini 	if (r & RT2560_RX_DONE)
14099c6307b1SDamien Bergamini 		rt2560_rx_intr(sc);
14109c6307b1SDamien Bergamini 
14119c6307b1SDamien Bergamini 	/* re-enable interrupts */
14129c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR8, RT2560_INTR_MASK);
14139c6307b1SDamien Bergamini 
14149c6307b1SDamien Bergamini 	RAL_UNLOCK(sc);
14159c6307b1SDamien Bergamini }
14169c6307b1SDamien Bergamini 
14179c6307b1SDamien Bergamini /* quickly determine if a given rate is CCK or OFDM */
14189c6307b1SDamien Bergamini #define RAL_RATE_IS_OFDM(rate) ((rate) >= 12 && (rate) != 22)
14199c6307b1SDamien Bergamini 
14209c6307b1SDamien Bergamini #define RAL_ACK_SIZE	14	/* 10 + 4(FCS) */
14219c6307b1SDamien Bergamini #define RAL_CTS_SIZE	14	/* 10 + 4(FCS) */
14229c6307b1SDamien Bergamini 
14239c6307b1SDamien Bergamini #define RAL_SIFS		10	/* us */
14249c6307b1SDamien Bergamini 
14259c6307b1SDamien Bergamini #define RT2560_TXRX_TURNAROUND	10	/* us */
14269c6307b1SDamien Bergamini 
14279c6307b1SDamien Bergamini /*
14289c6307b1SDamien Bergamini  * This function is only used by the Rx radiotap code.
14299c6307b1SDamien Bergamini  */
14309c6307b1SDamien Bergamini static uint8_t
14319c6307b1SDamien Bergamini rt2560_rxrate(struct rt2560_rx_desc *desc)
14329c6307b1SDamien Bergamini {
14339c6307b1SDamien Bergamini 	if (le32toh(desc->flags) & RT2560_RX_OFDM) {
14349c6307b1SDamien Bergamini 		/* reverse function of rt2560_plcp_signal */
14359c6307b1SDamien Bergamini 		switch (desc->rate) {
14369c6307b1SDamien Bergamini 		case 0xb:	return 12;
14379c6307b1SDamien Bergamini 		case 0xf:	return 18;
14389c6307b1SDamien Bergamini 		case 0xa:	return 24;
14399c6307b1SDamien Bergamini 		case 0xe:	return 36;
14409c6307b1SDamien Bergamini 		case 0x9:	return 48;
14419c6307b1SDamien Bergamini 		case 0xd:	return 72;
14429c6307b1SDamien Bergamini 		case 0x8:	return 96;
14439c6307b1SDamien Bergamini 		case 0xc:	return 108;
14449c6307b1SDamien Bergamini 		}
14459c6307b1SDamien Bergamini 	} else {
14469c6307b1SDamien Bergamini 		if (desc->rate == 10)
14479c6307b1SDamien Bergamini 			return 2;
14489c6307b1SDamien Bergamini 		if (desc->rate == 20)
14499c6307b1SDamien Bergamini 			return 4;
14509c6307b1SDamien Bergamini 		if (desc->rate == 55)
14519c6307b1SDamien Bergamini 			return 11;
14529c6307b1SDamien Bergamini 		if (desc->rate == 110)
14539c6307b1SDamien Bergamini 			return 22;
14549c6307b1SDamien Bergamini 	}
14559c6307b1SDamien Bergamini 	return 2;	/* should not get there */
14569c6307b1SDamien Bergamini }
14579c6307b1SDamien Bergamini 
14589c6307b1SDamien Bergamini /*
14599c6307b1SDamien Bergamini  * Return the expected ack rate for a frame transmitted at rate `rate'.
14609c6307b1SDamien Bergamini  * XXX: this should depend on the destination node basic rate set.
14619c6307b1SDamien Bergamini  */
14629c6307b1SDamien Bergamini static int
14639c6307b1SDamien Bergamini rt2560_ack_rate(struct ieee80211com *ic, int rate)
14649c6307b1SDamien Bergamini {
14659c6307b1SDamien Bergamini 	switch (rate) {
14669c6307b1SDamien Bergamini 	/* CCK rates */
14679c6307b1SDamien Bergamini 	case 2:
14689c6307b1SDamien Bergamini 		return 2;
14699c6307b1SDamien Bergamini 	case 4:
14709c6307b1SDamien Bergamini 	case 11:
14719c6307b1SDamien Bergamini 	case 22:
14729c6307b1SDamien Bergamini 		return (ic->ic_curmode == IEEE80211_MODE_11B) ? 4 : rate;
14739c6307b1SDamien Bergamini 
14749c6307b1SDamien Bergamini 	/* OFDM rates */
14759c6307b1SDamien Bergamini 	case 12:
14769c6307b1SDamien Bergamini 	case 18:
14779c6307b1SDamien Bergamini 		return 12;
14789c6307b1SDamien Bergamini 	case 24:
14799c6307b1SDamien Bergamini 	case 36:
14809c6307b1SDamien Bergamini 		return 24;
14819c6307b1SDamien Bergamini 	case 48:
14829c6307b1SDamien Bergamini 	case 72:
14839c6307b1SDamien Bergamini 	case 96:
14849c6307b1SDamien Bergamini 	case 108:
14859c6307b1SDamien Bergamini 		return 48;
14869c6307b1SDamien Bergamini 	}
14879c6307b1SDamien Bergamini 
14889c6307b1SDamien Bergamini 	/* default to 1Mbps */
14899c6307b1SDamien Bergamini 	return 2;
14909c6307b1SDamien Bergamini }
14919c6307b1SDamien Bergamini 
14929c6307b1SDamien Bergamini /*
14939c6307b1SDamien Bergamini  * Compute the duration (in us) needed to transmit `len' bytes at rate `rate'.
14949c6307b1SDamien Bergamini  * The function automatically determines the operating mode depending on the
14959c6307b1SDamien Bergamini  * given rate. `flags' indicates whether short preamble is in use or not.
14969c6307b1SDamien Bergamini  */
14979c6307b1SDamien Bergamini static uint16_t
14989c6307b1SDamien Bergamini rt2560_txtime(int len, int rate, uint32_t flags)
14999c6307b1SDamien Bergamini {
15009c6307b1SDamien Bergamini 	uint16_t txtime;
15019c6307b1SDamien Bergamini 
15029c6307b1SDamien Bergamini 	if (RAL_RATE_IS_OFDM(rate)) {
15039c6307b1SDamien Bergamini 		/* IEEE Std 802.11a-1999, pp. 37 */
15049c6307b1SDamien Bergamini 		txtime = (8 + 4 * len + 3 + rate - 1) / rate;
15059c6307b1SDamien Bergamini 		txtime = 16 + 4 + 4 * txtime + 6;
15069c6307b1SDamien Bergamini 	} else {
15079c6307b1SDamien Bergamini 		/* IEEE Std 802.11b-1999, pp. 28 */
15089c6307b1SDamien Bergamini 		txtime = (16 * len + rate - 1) / rate;
15099c6307b1SDamien Bergamini 		if (rate != 2 && (flags & IEEE80211_F_SHPREAMBLE))
15109c6307b1SDamien Bergamini 			txtime +=  72 + 24;
15119c6307b1SDamien Bergamini 		else
15129c6307b1SDamien Bergamini 			txtime += 144 + 48;
15139c6307b1SDamien Bergamini 	}
15149c6307b1SDamien Bergamini 
15159c6307b1SDamien Bergamini 	return txtime;
15169c6307b1SDamien Bergamini }
15179c6307b1SDamien Bergamini 
15189c6307b1SDamien Bergamini static uint8_t
15199c6307b1SDamien Bergamini rt2560_plcp_signal(int rate)
15209c6307b1SDamien Bergamini {
15219c6307b1SDamien Bergamini 	switch (rate) {
15229c6307b1SDamien Bergamini 	/* CCK rates (returned values are device-dependent) */
15239c6307b1SDamien Bergamini 	case 2:		return 0x0;
15249c6307b1SDamien Bergamini 	case 4:		return 0x1;
15259c6307b1SDamien Bergamini 	case 11:	return 0x2;
15269c6307b1SDamien Bergamini 	case 22:	return 0x3;
15279c6307b1SDamien Bergamini 
15289c6307b1SDamien Bergamini 	/* OFDM rates (cf IEEE Std 802.11a-1999, pp. 14 Table 80) */
15299c6307b1SDamien Bergamini 	case 12:	return 0xb;
15309c6307b1SDamien Bergamini 	case 18:	return 0xf;
15319c6307b1SDamien Bergamini 	case 24:	return 0xa;
15329c6307b1SDamien Bergamini 	case 36:	return 0xe;
15339c6307b1SDamien Bergamini 	case 48:	return 0x9;
15349c6307b1SDamien Bergamini 	case 72:	return 0xd;
15359c6307b1SDamien Bergamini 	case 96:	return 0x8;
15369c6307b1SDamien Bergamini 	case 108:	return 0xc;
15379c6307b1SDamien Bergamini 
15389c6307b1SDamien Bergamini 	/* unsupported rates (should not get there) */
15399c6307b1SDamien Bergamini 	default:	return 0xff;
15409c6307b1SDamien Bergamini 	}
15419c6307b1SDamien Bergamini }
15429c6307b1SDamien Bergamini 
15439c6307b1SDamien Bergamini static void
15449c6307b1SDamien Bergamini rt2560_setup_tx_desc(struct rt2560_softc *sc, struct rt2560_tx_desc *desc,
15459c6307b1SDamien Bergamini     uint32_t flags, int len, int rate, int encrypt, bus_addr_t physaddr)
15469c6307b1SDamien Bergamini {
15479c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
15489c6307b1SDamien Bergamini 	uint16_t plcp_length;
15499c6307b1SDamien Bergamini 	int remainder;
15509c6307b1SDamien Bergamini 
15519c6307b1SDamien Bergamini 	desc->flags = htole32(flags);
15529c6307b1SDamien Bergamini 	desc->flags |= htole32(len << 16);
15539c6307b1SDamien Bergamini 	desc->flags |= encrypt ? htole32(RT2560_TX_CIPHER_BUSY) :
15549c6307b1SDamien Bergamini 	    htole32(RT2560_TX_BUSY | RT2560_TX_VALID);
15559c6307b1SDamien Bergamini 
15569c6307b1SDamien Bergamini 	desc->physaddr = htole32(physaddr);
15579c6307b1SDamien Bergamini 	desc->wme = htole16(
15589c6307b1SDamien Bergamini 	    RT2560_AIFSN(2) |
15599c6307b1SDamien Bergamini 	    RT2560_LOGCWMIN(3) |
15609c6307b1SDamien Bergamini 	    RT2560_LOGCWMAX(8));
15619c6307b1SDamien Bergamini 
15629c6307b1SDamien Bergamini 	/* setup PLCP fields */
15639c6307b1SDamien Bergamini 	desc->plcp_signal  = rt2560_plcp_signal(rate);
15649c6307b1SDamien Bergamini 	desc->plcp_service = 4;
15659c6307b1SDamien Bergamini 
15669c6307b1SDamien Bergamini 	len += IEEE80211_CRC_LEN;
15679c6307b1SDamien Bergamini 	if (RAL_RATE_IS_OFDM(rate)) {
15689c6307b1SDamien Bergamini 		desc->flags |= htole32(RT2560_TX_OFDM);
15699c6307b1SDamien Bergamini 
15709c6307b1SDamien Bergamini 		plcp_length = len & 0xfff;
15719c6307b1SDamien Bergamini 		desc->plcp_length_hi = plcp_length >> 6;
15729c6307b1SDamien Bergamini 		desc->plcp_length_lo = plcp_length & 0x3f;
15739c6307b1SDamien Bergamini 	} else {
15749c6307b1SDamien Bergamini 		plcp_length = (16 * len + rate - 1) / rate;
15759c6307b1SDamien Bergamini 		if (rate == 22) {
15769c6307b1SDamien Bergamini 			remainder = (16 * len) % 22;
15779c6307b1SDamien Bergamini 			if (remainder != 0 && remainder < 7)
15789c6307b1SDamien Bergamini 				desc->plcp_service |= RT2560_PLCP_LENGEXT;
15799c6307b1SDamien Bergamini 		}
15809c6307b1SDamien Bergamini 		desc->plcp_length_hi = plcp_length >> 8;
15819c6307b1SDamien Bergamini 		desc->plcp_length_lo = plcp_length & 0xff;
15829c6307b1SDamien Bergamini 
15839c6307b1SDamien Bergamini 		if (rate != 2 && (ic->ic_flags & IEEE80211_F_SHPREAMBLE))
15849c6307b1SDamien Bergamini 			desc->plcp_signal |= 0x08;
15859c6307b1SDamien Bergamini 	}
15869c6307b1SDamien Bergamini }
15879c6307b1SDamien Bergamini 
15889c6307b1SDamien Bergamini static int
15899c6307b1SDamien Bergamini rt2560_tx_bcn(struct rt2560_softc *sc, struct mbuf *m0,
15909c6307b1SDamien Bergamini     struct ieee80211_node *ni)
15919c6307b1SDamien Bergamini {
15929c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
15939c6307b1SDamien Bergamini 	struct rt2560_tx_desc *desc;
15949c6307b1SDamien Bergamini 	struct rt2560_tx_data *data;
15959c6307b1SDamien Bergamini 	bus_dma_segment_t segs[RT2560_MAX_SCATTER];
15969c6307b1SDamien Bergamini 	int nsegs, rate, error;
15979c6307b1SDamien Bergamini 
15989c6307b1SDamien Bergamini 	desc = &sc->bcnq.desc[sc->bcnq.cur];
15999c6307b1SDamien Bergamini 	data = &sc->bcnq.data[sc->bcnq.cur];
16009c6307b1SDamien Bergamini 
16019c6307b1SDamien Bergamini 	rate = IEEE80211_IS_CHAN_5GHZ(ni->ni_chan) ? 12 : 2;
16029c6307b1SDamien Bergamini 
16039c6307b1SDamien Bergamini 	error = bus_dmamap_load_mbuf_sg(sc->bcnq.data_dmat, data->map, m0,
16049c6307b1SDamien Bergamini 	    segs, &nsegs, BUS_DMA_NOWAIT);
16059c6307b1SDamien Bergamini 	if (error != 0) {
16069c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not map mbuf (error %d)\n",
16079c6307b1SDamien Bergamini 		    error);
16089c6307b1SDamien Bergamini 		m_freem(m0);
16099c6307b1SDamien Bergamini 		return error;
16109c6307b1SDamien Bergamini 	}
16119c6307b1SDamien Bergamini 
161216d878ccSChristian S.J. Peron 	if (bpf_peers_present(sc->sc_drvbpf)) {
16139c6307b1SDamien Bergamini 		struct rt2560_tx_radiotap_header *tap = &sc->sc_txtap;
16149c6307b1SDamien Bergamini 
16159c6307b1SDamien Bergamini 		tap->wt_flags = 0;
16169c6307b1SDamien Bergamini 		tap->wt_rate = rate;
16179c6307b1SDamien Bergamini 		tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq);
16189c6307b1SDamien Bergamini 		tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags);
16199c6307b1SDamien Bergamini 		tap->wt_antenna = sc->tx_ant;
16209c6307b1SDamien Bergamini 
16219c6307b1SDamien Bergamini 		bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m0);
16229c6307b1SDamien Bergamini 	}
16239c6307b1SDamien Bergamini 
16249c6307b1SDamien Bergamini 	data->m = m0;
16259c6307b1SDamien Bergamini 	data->ni = ni;
16269c6307b1SDamien Bergamini 
16279c6307b1SDamien Bergamini 	rt2560_setup_tx_desc(sc, desc, RT2560_TX_IFS_NEWBACKOFF |
16289c6307b1SDamien Bergamini 	    RT2560_TX_TIMESTAMP, m0->m_pkthdr.len, rate, 0, segs->ds_addr);
16299c6307b1SDamien Bergamini 
16309c6307b1SDamien Bergamini 	DPRINTFN(10, ("sending beacon frame len=%u idx=%u rate=%u\n",
16319c6307b1SDamien Bergamini 	    m0->m_pkthdr.len, sc->bcnq.cur, rate));
16329c6307b1SDamien Bergamini 
16339c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->bcnq.data_dmat, data->map, BUS_DMASYNC_PREWRITE);
16349c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->bcnq.desc_dmat, sc->bcnq.desc_map,
16359c6307b1SDamien Bergamini 	    BUS_DMASYNC_PREWRITE);
16369c6307b1SDamien Bergamini 
16379c6307b1SDamien Bergamini 	sc->bcnq.cur = (sc->bcnq.cur + 1) % RT2560_BEACON_RING_COUNT;
16389c6307b1SDamien Bergamini 
16399c6307b1SDamien Bergamini 	return 0;
16409c6307b1SDamien Bergamini }
16419c6307b1SDamien Bergamini 
16429c6307b1SDamien Bergamini static int
16439c6307b1SDamien Bergamini rt2560_tx_mgt(struct rt2560_softc *sc, struct mbuf *m0,
16449c6307b1SDamien Bergamini     struct ieee80211_node *ni)
16459c6307b1SDamien Bergamini {
16469c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
16479c6307b1SDamien Bergamini 	struct rt2560_tx_desc *desc;
16489c6307b1SDamien Bergamini 	struct rt2560_tx_data *data;
16499c6307b1SDamien Bergamini 	struct ieee80211_frame *wh;
16509c6307b1SDamien Bergamini 	bus_dma_segment_t segs[RT2560_MAX_SCATTER];
16519c6307b1SDamien Bergamini 	uint16_t dur;
16529c6307b1SDamien Bergamini 	uint32_t flags = 0;
16539c6307b1SDamien Bergamini 	int nsegs, rate, error;
16549c6307b1SDamien Bergamini 
16559c6307b1SDamien Bergamini 	desc = &sc->prioq.desc[sc->prioq.cur];
16569c6307b1SDamien Bergamini 	data = &sc->prioq.data[sc->prioq.cur];
16579c6307b1SDamien Bergamini 
16589c6307b1SDamien Bergamini 	rate = IEEE80211_IS_CHAN_5GHZ(ic->ic_curchan) ? 12 : 2;
16599c6307b1SDamien Bergamini 
16609c6307b1SDamien Bergamini 	error = bus_dmamap_load_mbuf_sg(sc->prioq.data_dmat, data->map, m0,
16619c6307b1SDamien Bergamini 	    segs, &nsegs, 0);
16629c6307b1SDamien Bergamini 	if (error != 0) {
16639c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not map mbuf (error %d)\n",
16649c6307b1SDamien Bergamini 		    error);
16659c6307b1SDamien Bergamini 		m_freem(m0);
16669c6307b1SDamien Bergamini 		return error;
16679c6307b1SDamien Bergamini 	}
16689c6307b1SDamien Bergamini 
166916d878ccSChristian S.J. Peron 	if (bpf_peers_present(sc->sc_drvbpf)) {
16709c6307b1SDamien Bergamini 		struct rt2560_tx_radiotap_header *tap = &sc->sc_txtap;
16719c6307b1SDamien Bergamini 
16729c6307b1SDamien Bergamini 		tap->wt_flags = 0;
16739c6307b1SDamien Bergamini 		tap->wt_rate = rate;
16749c6307b1SDamien Bergamini 		tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq);
16759c6307b1SDamien Bergamini 		tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags);
16769c6307b1SDamien Bergamini 		tap->wt_antenna = sc->tx_ant;
16779c6307b1SDamien Bergamini 
16789c6307b1SDamien Bergamini 		bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m0);
16799c6307b1SDamien Bergamini 	}
16809c6307b1SDamien Bergamini 
16819c6307b1SDamien Bergamini 	data->m = m0;
16829c6307b1SDamien Bergamini 	data->ni = ni;
16839c6307b1SDamien Bergamini 
16849c6307b1SDamien Bergamini 	wh = mtod(m0, struct ieee80211_frame *);
16859c6307b1SDamien Bergamini 
16869c6307b1SDamien Bergamini 	if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) {
16879c6307b1SDamien Bergamini 		flags |= RT2560_TX_ACK;
16889c6307b1SDamien Bergamini 
16899c6307b1SDamien Bergamini 		dur = rt2560_txtime(RAL_ACK_SIZE, rate, ic->ic_flags) +
16909c6307b1SDamien Bergamini 		      RAL_SIFS;
16919c6307b1SDamien Bergamini 		*(uint16_t *)wh->i_dur = htole16(dur);
16929c6307b1SDamien Bergamini 
16939c6307b1SDamien Bergamini 		/* tell hardware to add timestamp for probe responses */
16949c6307b1SDamien Bergamini 		if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) ==
16959c6307b1SDamien Bergamini 		    IEEE80211_FC0_TYPE_MGT &&
16969c6307b1SDamien Bergamini 		    (wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) ==
16979c6307b1SDamien Bergamini 		    IEEE80211_FC0_SUBTYPE_PROBE_RESP)
16989c6307b1SDamien Bergamini 			flags |= RT2560_TX_TIMESTAMP;
16999c6307b1SDamien Bergamini 	}
17009c6307b1SDamien Bergamini 
17019c6307b1SDamien Bergamini 	rt2560_setup_tx_desc(sc, desc, flags, m0->m_pkthdr.len, rate, 0,
17029c6307b1SDamien Bergamini 	    segs->ds_addr);
17039c6307b1SDamien Bergamini 
17049c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->prioq.data_dmat, data->map, BUS_DMASYNC_PREWRITE);
17059c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->prioq.desc_dmat, sc->prioq.desc_map,
17069c6307b1SDamien Bergamini 	    BUS_DMASYNC_PREWRITE);
17079c6307b1SDamien Bergamini 
17089c6307b1SDamien Bergamini 	DPRINTFN(10, ("sending mgt frame len=%u idx=%u rate=%u\n",
17099c6307b1SDamien Bergamini 	    m0->m_pkthdr.len, sc->prioq.cur, rate));
17109c6307b1SDamien Bergamini 
17119c6307b1SDamien Bergamini 	/* kick prio */
17129c6307b1SDamien Bergamini 	sc->prioq.queued++;
17139c6307b1SDamien Bergamini 	sc->prioq.cur = (sc->prioq.cur + 1) % RT2560_PRIO_RING_COUNT;
17149c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_TXCSR0, RT2560_KICK_PRIO);
17159c6307b1SDamien Bergamini 
17169c6307b1SDamien Bergamini 	return 0;
17179c6307b1SDamien Bergamini }
17189c6307b1SDamien Bergamini 
17199ee0e227SSam Leffler static int
17209ee0e227SSam Leffler rt2560_tx_raw(struct rt2560_softc *sc, struct mbuf *m0,
17219ee0e227SSam Leffler     struct ieee80211_node *ni, const struct ieee80211_bpf_params *params)
17229ee0e227SSam Leffler {
17239ee0e227SSam Leffler 	struct ieee80211com *ic = &sc->sc_ic;
17249ee0e227SSam Leffler 	struct rt2560_tx_desc *desc;
17259ee0e227SSam Leffler 	struct rt2560_tx_data *data;
17269ee0e227SSam Leffler 	bus_dma_segment_t segs[RT2560_MAX_SCATTER];
17279ee0e227SSam Leffler 	uint32_t flags;
17289ee0e227SSam Leffler 	int nsegs, rate, error;
17299ee0e227SSam Leffler 
17309ee0e227SSam Leffler 	desc = &sc->prioq.desc[sc->prioq.cur];
17319ee0e227SSam Leffler 	data = &sc->prioq.data[sc->prioq.cur];
17329ee0e227SSam Leffler 
17339ee0e227SSam Leffler 	rate = params->ibp_rate0 & IEEE80211_RATE_VAL;
17349ee0e227SSam Leffler 	/* XXX validate */
17359ee0e227SSam Leffler 	if (rate == 0)
17369ee0e227SSam Leffler 		return EINVAL;
17379ee0e227SSam Leffler 
17389ee0e227SSam Leffler 	error = bus_dmamap_load_mbuf_sg(sc->prioq.data_dmat, data->map, m0,
17399ee0e227SSam Leffler 	    segs, &nsegs, 0);
17409ee0e227SSam Leffler 	if (error != 0) {
17419ee0e227SSam Leffler 		device_printf(sc->sc_dev, "could not map mbuf (error %d)\n",
17429ee0e227SSam Leffler 		    error);
17439ee0e227SSam Leffler 		m_freem(m0);
17449ee0e227SSam Leffler 		return error;
17459ee0e227SSam Leffler 	}
17469ee0e227SSam Leffler 
17479ee0e227SSam Leffler 	if (bpf_peers_present(sc->sc_drvbpf)) {
17489ee0e227SSam Leffler 		struct rt2560_tx_radiotap_header *tap = &sc->sc_txtap;
17499ee0e227SSam Leffler 
17509ee0e227SSam Leffler 		tap->wt_flags = 0;
17519ee0e227SSam Leffler 		tap->wt_rate = rate;
17529ee0e227SSam Leffler 		tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq);
17539ee0e227SSam Leffler 		tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags);
17549ee0e227SSam Leffler 		tap->wt_antenna = sc->tx_ant;
17559ee0e227SSam Leffler 
17569ee0e227SSam Leffler 		bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m0);
17579ee0e227SSam Leffler 	}
17589ee0e227SSam Leffler 
17599ee0e227SSam Leffler 	data->m = m0;
17609ee0e227SSam Leffler 	data->ni = ni;
17619ee0e227SSam Leffler 
17629ee0e227SSam Leffler 	flags = 0;
17639ee0e227SSam Leffler 	if ((params->ibp_flags & IEEE80211_BPF_NOACK) == 0)
17649ee0e227SSam Leffler 		flags |= RT2560_TX_ACK;
17659ee0e227SSam Leffler 
17669ee0e227SSam Leffler 	/* XXX need to setup descriptor ourself */
17679ee0e227SSam Leffler 	rt2560_setup_tx_desc(sc, desc, flags, m0->m_pkthdr.len,
17689ee0e227SSam Leffler 	    rate, (params->ibp_flags & IEEE80211_BPF_CRYPTO) != 0,
17699ee0e227SSam Leffler 	    segs->ds_addr);
17709ee0e227SSam Leffler 
17719ee0e227SSam Leffler 	bus_dmamap_sync(sc->prioq.data_dmat, data->map, BUS_DMASYNC_PREWRITE);
17729ee0e227SSam Leffler 	bus_dmamap_sync(sc->prioq.desc_dmat, sc->prioq.desc_map,
17739ee0e227SSam Leffler 	    BUS_DMASYNC_PREWRITE);
17749ee0e227SSam Leffler 
17759ee0e227SSam Leffler 	DPRINTFN(10, ("sending raw frame len=%u idx=%u rate=%u\n",
17769ee0e227SSam Leffler 	    m0->m_pkthdr.len, sc->prioq.cur, rate));
17779ee0e227SSam Leffler 
17789ee0e227SSam Leffler 	/* kick prio */
17799ee0e227SSam Leffler 	sc->prioq.queued++;
17809ee0e227SSam Leffler 	sc->prioq.cur = (sc->prioq.cur + 1) % RT2560_PRIO_RING_COUNT;
17819ee0e227SSam Leffler 	RAL_WRITE(sc, RT2560_TXCSR0, RT2560_KICK_PRIO);
17829ee0e227SSam Leffler 
17839ee0e227SSam Leffler 	return 0;
17849ee0e227SSam Leffler }
17859ee0e227SSam Leffler 
17869c6307b1SDamien Bergamini /*
17879c6307b1SDamien Bergamini  * Build a RTS control frame.
17889c6307b1SDamien Bergamini  */
17899c6307b1SDamien Bergamini static struct mbuf *
17909c6307b1SDamien Bergamini rt2560_get_rts(struct rt2560_softc *sc, struct ieee80211_frame *wh,
17919c6307b1SDamien Bergamini     uint16_t dur)
17929c6307b1SDamien Bergamini {
17939c6307b1SDamien Bergamini 	struct ieee80211_frame_rts *rts;
17949c6307b1SDamien Bergamini 	struct mbuf *m;
17959c6307b1SDamien Bergamini 
17969c6307b1SDamien Bergamini 	MGETHDR(m, M_DONTWAIT, MT_DATA);
17979c6307b1SDamien Bergamini 	if (m == NULL) {
17989c6307b1SDamien Bergamini 		sc->sc_ic.ic_stats.is_tx_nobuf++;
17999c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate RTS frame\n");
18009c6307b1SDamien Bergamini 		return NULL;
18019c6307b1SDamien Bergamini 	}
18029c6307b1SDamien Bergamini 
18039c6307b1SDamien Bergamini 	rts = mtod(m, struct ieee80211_frame_rts *);
18049c6307b1SDamien Bergamini 
18059c6307b1SDamien Bergamini 	rts->i_fc[0] = IEEE80211_FC0_VERSION_0 | IEEE80211_FC0_TYPE_CTL |
18069c6307b1SDamien Bergamini 	    IEEE80211_FC0_SUBTYPE_RTS;
18079c6307b1SDamien Bergamini 	rts->i_fc[1] = IEEE80211_FC1_DIR_NODS;
18089c6307b1SDamien Bergamini 	*(uint16_t *)rts->i_dur = htole16(dur);
18099c6307b1SDamien Bergamini 	IEEE80211_ADDR_COPY(rts->i_ra, wh->i_addr1);
18109c6307b1SDamien Bergamini 	IEEE80211_ADDR_COPY(rts->i_ta, wh->i_addr2);
18119c6307b1SDamien Bergamini 
18129c6307b1SDamien Bergamini 	m->m_pkthdr.len = m->m_len = sizeof (struct ieee80211_frame_rts);
18139c6307b1SDamien Bergamini 
18149c6307b1SDamien Bergamini 	return m;
18159c6307b1SDamien Bergamini }
18169c6307b1SDamien Bergamini 
18179c6307b1SDamien Bergamini static int
18189c6307b1SDamien Bergamini rt2560_tx_data(struct rt2560_softc *sc, struct mbuf *m0,
18199c6307b1SDamien Bergamini     struct ieee80211_node *ni)
18209c6307b1SDamien Bergamini {
18219c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
18229c6307b1SDamien Bergamini 	struct rt2560_tx_desc *desc;
18239c6307b1SDamien Bergamini 	struct rt2560_tx_data *data;
18249c6307b1SDamien Bergamini 	struct rt2560_node *rn;
18259c6307b1SDamien Bergamini 	struct ieee80211_rateset *rs;
18269c6307b1SDamien Bergamini 	struct ieee80211_frame *wh;
18279c6307b1SDamien Bergamini 	struct ieee80211_key *k;
18289c6307b1SDamien Bergamini 	struct mbuf *mnew;
18299c6307b1SDamien Bergamini 	bus_dma_segment_t segs[RT2560_MAX_SCATTER];
18309c6307b1SDamien Bergamini 	uint16_t dur;
18319c6307b1SDamien Bergamini 	uint32_t flags = 0;
18329c6307b1SDamien Bergamini 	int nsegs, rate, error;
18339c6307b1SDamien Bergamini 
18349c6307b1SDamien Bergamini 	wh = mtod(m0, struct ieee80211_frame *);
18359c6307b1SDamien Bergamini 
18369c6307b1SDamien Bergamini 	if (ic->ic_fixed_rate != IEEE80211_FIXED_RATE_NONE) {
18379c6307b1SDamien Bergamini 		rs = &ic->ic_sup_rates[ic->ic_curmode];
18389c6307b1SDamien Bergamini 		rate = rs->rs_rates[ic->ic_fixed_rate];
18399c6307b1SDamien Bergamini 	} else {
18409c6307b1SDamien Bergamini 		rs = &ni->ni_rates;
18419c6307b1SDamien Bergamini 		rn = (struct rt2560_node *)ni;
18429c6307b1SDamien Bergamini 		ni->ni_txrate = ral_rssadapt_choose(&rn->rssadapt, rs, wh,
18439c6307b1SDamien Bergamini 		    m0->m_pkthdr.len, NULL, 0);
18449c6307b1SDamien Bergamini 		rate = rs->rs_rates[ni->ni_txrate];
18459c6307b1SDamien Bergamini 	}
18469c6307b1SDamien Bergamini 	rate &= IEEE80211_RATE_VAL;
18479c6307b1SDamien Bergamini 
18489c6307b1SDamien Bergamini 	if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
18499c6307b1SDamien Bergamini 		k = ieee80211_crypto_encap(ic, ni, m0);
18509c6307b1SDamien Bergamini 		if (k == NULL) {
18519c6307b1SDamien Bergamini 			m_freem(m0);
18529c6307b1SDamien Bergamini 			return ENOBUFS;
18539c6307b1SDamien Bergamini 		}
18549c6307b1SDamien Bergamini 
18559c6307b1SDamien Bergamini 		/* packet header may have moved, reset our local pointer */
18569c6307b1SDamien Bergamini 		wh = mtod(m0, struct ieee80211_frame *);
18579c6307b1SDamien Bergamini 	}
18589c6307b1SDamien Bergamini 
18599c6307b1SDamien Bergamini 	/*
18609c6307b1SDamien Bergamini 	 * IEEE Std 802.11-1999, pp 82: "A STA shall use an RTS/CTS exchange
18619c6307b1SDamien Bergamini 	 * for directed frames only when the length of the MPDU is greater
18629c6307b1SDamien Bergamini 	 * than the length threshold indicated by [...]" ic_rtsthreshold.
18639c6307b1SDamien Bergamini 	 */
18649c6307b1SDamien Bergamini 	if (!IEEE80211_IS_MULTICAST(wh->i_addr1) &&
18659c6307b1SDamien Bergamini 	    m0->m_pkthdr.len > ic->ic_rtsthreshold) {
18669c6307b1SDamien Bergamini 		struct mbuf *m;
18679c6307b1SDamien Bergamini 		uint16_t dur;
18689c6307b1SDamien Bergamini 		int rtsrate, ackrate;
18699c6307b1SDamien Bergamini 
18709c6307b1SDamien Bergamini 		rtsrate = IEEE80211_IS_CHAN_5GHZ(ic->ic_curchan) ? 12 : 2;
18719c6307b1SDamien Bergamini 		ackrate = rt2560_ack_rate(ic, rate);
18729c6307b1SDamien Bergamini 
18739c6307b1SDamien Bergamini 		dur = rt2560_txtime(m0->m_pkthdr.len + 4, rate, ic->ic_flags) +
18749c6307b1SDamien Bergamini 		      rt2560_txtime(RAL_CTS_SIZE, rtsrate, ic->ic_flags) +
18759c6307b1SDamien Bergamini 		      rt2560_txtime(RAL_ACK_SIZE, ackrate, ic->ic_flags) +
18769c6307b1SDamien Bergamini 		      3 * RAL_SIFS;
18779c6307b1SDamien Bergamini 
18789c6307b1SDamien Bergamini 		m = rt2560_get_rts(sc, wh, dur);
18799c6307b1SDamien Bergamini 
18809c6307b1SDamien Bergamini 		desc = &sc->txq.desc[sc->txq.cur_encrypt];
18819c6307b1SDamien Bergamini 		data = &sc->txq.data[sc->txq.cur_encrypt];
18829c6307b1SDamien Bergamini 
18839c6307b1SDamien Bergamini 		error = bus_dmamap_load_mbuf_sg(sc->txq.data_dmat, data->map,
18849c6307b1SDamien Bergamini 		    m, segs, &nsegs, 0);
18859c6307b1SDamien Bergamini 		if (error != 0) {
18869c6307b1SDamien Bergamini 			device_printf(sc->sc_dev,
18879c6307b1SDamien Bergamini 			    "could not map mbuf (error %d)\n", error);
18889c6307b1SDamien Bergamini 			m_freem(m);
18899c6307b1SDamien Bergamini 			m_freem(m0);
18909c6307b1SDamien Bergamini 			return error;
18919c6307b1SDamien Bergamini 		}
18929c6307b1SDamien Bergamini 
18939c6307b1SDamien Bergamini 		/* avoid multiple free() of the same node for each fragment */
18949c6307b1SDamien Bergamini 		ieee80211_ref_node(ni);
18959c6307b1SDamien Bergamini 
18969c6307b1SDamien Bergamini 		data->m = m;
18979c6307b1SDamien Bergamini 		data->ni = ni;
18989c6307b1SDamien Bergamini 
18999c6307b1SDamien Bergamini 		/* RTS frames are not taken into account for rssadapt */
19009c6307b1SDamien Bergamini 		data->id.id_node = NULL;
19019c6307b1SDamien Bergamini 
19029c6307b1SDamien Bergamini 		rt2560_setup_tx_desc(sc, desc, RT2560_TX_ACK |
19039c6307b1SDamien Bergamini 		    RT2560_TX_MORE_FRAG, m->m_pkthdr.len, rtsrate, 1,
19049c6307b1SDamien Bergamini 		    segs->ds_addr);
19059c6307b1SDamien Bergamini 
19069c6307b1SDamien Bergamini 		bus_dmamap_sync(sc->txq.data_dmat, data->map,
19079c6307b1SDamien Bergamini 		    BUS_DMASYNC_PREWRITE);
19089c6307b1SDamien Bergamini 
19099c6307b1SDamien Bergamini 		sc->txq.queued++;
19109c6307b1SDamien Bergamini 		sc->txq.cur_encrypt =
19119c6307b1SDamien Bergamini 		    (sc->txq.cur_encrypt + 1) % RT2560_TX_RING_COUNT;
19129c6307b1SDamien Bergamini 
19139c6307b1SDamien Bergamini 		/*
19149c6307b1SDamien Bergamini 		 * IEEE Std 802.11-1999: when an RTS/CTS exchange is used, the
19159c6307b1SDamien Bergamini 		 * asynchronous data frame shall be transmitted after the CTS
19169c6307b1SDamien Bergamini 		 * frame and a SIFS period.
19179c6307b1SDamien Bergamini 		 */
19189c6307b1SDamien Bergamini 		flags |= RT2560_TX_LONG_RETRY | RT2560_TX_IFS_SIFS;
19199c6307b1SDamien Bergamini 	}
19209c6307b1SDamien Bergamini 
19219c6307b1SDamien Bergamini 	data = &sc->txq.data[sc->txq.cur_encrypt];
19229c6307b1SDamien Bergamini 	desc = &sc->txq.desc[sc->txq.cur_encrypt];
19239c6307b1SDamien Bergamini 
19249c6307b1SDamien Bergamini 	error = bus_dmamap_load_mbuf_sg(sc->txq.data_dmat, data->map, m0,
19259c6307b1SDamien Bergamini 	    segs, &nsegs, 0);
19269c6307b1SDamien Bergamini 	if (error != 0 && error != EFBIG) {
19279c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not map mbuf (error %d)\n",
19289c6307b1SDamien Bergamini 		    error);
19299c6307b1SDamien Bergamini 		m_freem(m0);
19309c6307b1SDamien Bergamini 		return error;
19319c6307b1SDamien Bergamini 	}
19329c6307b1SDamien Bergamini 	if (error != 0) {
19339c6307b1SDamien Bergamini 		mnew = m_defrag(m0, M_DONTWAIT);
19349c6307b1SDamien Bergamini 		if (mnew == NULL) {
19359c6307b1SDamien Bergamini 			device_printf(sc->sc_dev,
19369c6307b1SDamien Bergamini 			    "could not defragment mbuf\n");
19379c6307b1SDamien Bergamini 			m_freem(m0);
19389c6307b1SDamien Bergamini 			return ENOBUFS;
19399c6307b1SDamien Bergamini 		}
19409c6307b1SDamien Bergamini 		m0 = mnew;
19419c6307b1SDamien Bergamini 
19429c6307b1SDamien Bergamini 		error = bus_dmamap_load_mbuf_sg(sc->txq.data_dmat, data->map,
19439c6307b1SDamien Bergamini 		    m0, segs, &nsegs, 0);
19449c6307b1SDamien Bergamini 		if (error != 0) {
19459c6307b1SDamien Bergamini 			device_printf(sc->sc_dev,
19469c6307b1SDamien Bergamini 			    "could not map mbuf (error %d)\n", error);
19479c6307b1SDamien Bergamini 			m_freem(m0);
19489c6307b1SDamien Bergamini 			return error;
19499c6307b1SDamien Bergamini 		}
19509c6307b1SDamien Bergamini 
19519c6307b1SDamien Bergamini 		/* packet header may have moved, reset our local pointer */
19529c6307b1SDamien Bergamini 		wh = mtod(m0, struct ieee80211_frame *);
19539c6307b1SDamien Bergamini 	}
19549c6307b1SDamien Bergamini 
195516d878ccSChristian S.J. Peron 	if (bpf_peers_present(sc->sc_drvbpf)) {
19569c6307b1SDamien Bergamini 		struct rt2560_tx_radiotap_header *tap = &sc->sc_txtap;
19579c6307b1SDamien Bergamini 
19589c6307b1SDamien Bergamini 		tap->wt_flags = 0;
19599c6307b1SDamien Bergamini 		tap->wt_rate = rate;
19609c6307b1SDamien Bergamini 		tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq);
19619c6307b1SDamien Bergamini 		tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags);
19629c6307b1SDamien Bergamini 		tap->wt_antenna = sc->tx_ant;
19639c6307b1SDamien Bergamini 
19649c6307b1SDamien Bergamini 		bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m0);
19659c6307b1SDamien Bergamini 	}
19669c6307b1SDamien Bergamini 
19679c6307b1SDamien Bergamini 	data->m = m0;
19689c6307b1SDamien Bergamini 	data->ni = ni;
19699c6307b1SDamien Bergamini 
19709c6307b1SDamien Bergamini 	/* remember link conditions for rate adaptation algorithm */
19719c6307b1SDamien Bergamini 	if (ic->ic_fixed_rate == IEEE80211_FIXED_RATE_NONE) {
19729c6307b1SDamien Bergamini 		data->id.id_len = m0->m_pkthdr.len;
19739c6307b1SDamien Bergamini 		data->id.id_rateidx = ni->ni_txrate;
19749c6307b1SDamien Bergamini 		data->id.id_node = ni;
19759c6307b1SDamien Bergamini 		data->id.id_rssi = ni->ni_rssi;
19769c6307b1SDamien Bergamini 	} else
19779c6307b1SDamien Bergamini 		data->id.id_node = NULL;
19789c6307b1SDamien Bergamini 
19799c6307b1SDamien Bergamini 	if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) {
19809c6307b1SDamien Bergamini 		flags |= RT2560_TX_ACK;
19819c6307b1SDamien Bergamini 
19829c6307b1SDamien Bergamini 		dur = rt2560_txtime(RAL_ACK_SIZE, rt2560_ack_rate(ic, rate),
19839c6307b1SDamien Bergamini 		    ic->ic_flags) + RAL_SIFS;
19849c6307b1SDamien Bergamini 		*(uint16_t *)wh->i_dur = htole16(dur);
19859c6307b1SDamien Bergamini 	}
19869c6307b1SDamien Bergamini 
19879c6307b1SDamien Bergamini 	rt2560_setup_tx_desc(sc, desc, flags, m0->m_pkthdr.len, rate, 1,
19889c6307b1SDamien Bergamini 	    segs->ds_addr);
19899c6307b1SDamien Bergamini 
19909c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->txq.data_dmat, data->map, BUS_DMASYNC_PREWRITE);
19919c6307b1SDamien Bergamini 	bus_dmamap_sync(sc->txq.desc_dmat, sc->txq.desc_map,
19929c6307b1SDamien Bergamini 	    BUS_DMASYNC_PREWRITE);
19939c6307b1SDamien Bergamini 
19949c6307b1SDamien Bergamini 	DPRINTFN(10, ("sending data frame len=%u idx=%u rate=%u\n",
19959c6307b1SDamien Bergamini 	    m0->m_pkthdr.len, sc->txq.cur_encrypt, rate));
19969c6307b1SDamien Bergamini 
19979c6307b1SDamien Bergamini 	/* kick encrypt */
19989c6307b1SDamien Bergamini 	sc->txq.queued++;
19999c6307b1SDamien Bergamini 	sc->txq.cur_encrypt = (sc->txq.cur_encrypt + 1) % RT2560_TX_RING_COUNT;
20009c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_SECCSR1, RT2560_KICK_ENCRYPT);
20019c6307b1SDamien Bergamini 
20029c6307b1SDamien Bergamini 	return 0;
20039c6307b1SDamien Bergamini }
20049c6307b1SDamien Bergamini 
20059c6307b1SDamien Bergamini static void
20069c6307b1SDamien Bergamini rt2560_start(struct ifnet *ifp)
20079c6307b1SDamien Bergamini {
20089c6307b1SDamien Bergamini 	struct rt2560_softc *sc = ifp->if_softc;
20099c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
20109c6307b1SDamien Bergamini 	struct mbuf *m0;
20119c6307b1SDamien Bergamini 	struct ether_header *eh;
20129c6307b1SDamien Bergamini 	struct ieee80211_node *ni;
20139c6307b1SDamien Bergamini 
20149c6307b1SDamien Bergamini 	RAL_LOCK(sc);
20159c6307b1SDamien Bergamini 
2016d0934eb1SDamien Bergamini 	/* prevent management frames from being sent if we're not ready */
2017d0934eb1SDamien Bergamini 	if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) {
2018d0934eb1SDamien Bergamini 		RAL_UNLOCK(sc);
2019d0934eb1SDamien Bergamini 		return;
2020d0934eb1SDamien Bergamini 	}
2021d0934eb1SDamien Bergamini 
20229c6307b1SDamien Bergamini 	for (;;) {
20239c6307b1SDamien Bergamini 		IF_POLL(&ic->ic_mgtq, m0);
20249c6307b1SDamien Bergamini 		if (m0 != NULL) {
20259c6307b1SDamien Bergamini 			if (sc->prioq.queued >= RT2560_PRIO_RING_COUNT) {
20269c6307b1SDamien Bergamini 				ifp->if_drv_flags |= IFF_DRV_OACTIVE;
20279c6307b1SDamien Bergamini 				break;
20289c6307b1SDamien Bergamini 			}
20299c6307b1SDamien Bergamini 			IF_DEQUEUE(&ic->ic_mgtq, m0);
20309c6307b1SDamien Bergamini 
20319c6307b1SDamien Bergamini 			ni = (struct ieee80211_node *)m0->m_pkthdr.rcvif;
20329c6307b1SDamien Bergamini 			m0->m_pkthdr.rcvif = NULL;
20339c6307b1SDamien Bergamini 
203416d878ccSChristian S.J. Peron 			if (bpf_peers_present(ic->ic_rawbpf))
20359c6307b1SDamien Bergamini 				bpf_mtap(ic->ic_rawbpf, m0);
20369c6307b1SDamien Bergamini 
20379c6307b1SDamien Bergamini 			if (rt2560_tx_mgt(sc, m0, ni) != 0)
20389c6307b1SDamien Bergamini 				break;
20399c6307b1SDamien Bergamini 
20409c6307b1SDamien Bergamini 		} else {
20419c6307b1SDamien Bergamini 			if (ic->ic_state != IEEE80211_S_RUN)
20429c6307b1SDamien Bergamini 				break;
20439c6307b1SDamien Bergamini 			IFQ_DRV_DEQUEUE(&ifp->if_snd, m0);
20449c6307b1SDamien Bergamini 			if (m0 == NULL)
20459c6307b1SDamien Bergamini 				break;
20469c6307b1SDamien Bergamini 			if (sc->txq.queued >= RT2560_TX_RING_COUNT - 1) {
20479c6307b1SDamien Bergamini 				IFQ_DRV_PREPEND(&ifp->if_snd, m0);
20489c6307b1SDamien Bergamini 				ifp->if_drv_flags |= IFF_DRV_OACTIVE;
20499c6307b1SDamien Bergamini 				break;
20509c6307b1SDamien Bergamini 			}
20519c6307b1SDamien Bergamini 
20529c6307b1SDamien Bergamini 			if (m0->m_len < sizeof (struct ether_header) &&
20539c6307b1SDamien Bergamini 			    !(m0 = m_pullup(m0, sizeof (struct ether_header))))
20549c6307b1SDamien Bergamini 				continue;
20559c6307b1SDamien Bergamini 
20569c6307b1SDamien Bergamini 			eh = mtod(m0, struct ether_header *);
20579c6307b1SDamien Bergamini 			ni = ieee80211_find_txnode(ic, eh->ether_dhost);
20589c6307b1SDamien Bergamini 			if (ni == NULL) {
20599c6307b1SDamien Bergamini 				m_freem(m0);
20609c6307b1SDamien Bergamini 				continue;
20619c6307b1SDamien Bergamini 			}
20629c6307b1SDamien Bergamini 			BPF_MTAP(ifp, m0);
20639c6307b1SDamien Bergamini 
20649c6307b1SDamien Bergamini 			m0 = ieee80211_encap(ic, m0, ni);
20659c6307b1SDamien Bergamini 			if (m0 == NULL) {
20669c6307b1SDamien Bergamini 				ieee80211_free_node(ni);
20679c6307b1SDamien Bergamini 				continue;
20689c6307b1SDamien Bergamini 			}
20699c6307b1SDamien Bergamini 
207016d878ccSChristian S.J. Peron 			if (bpf_peers_present(ic->ic_rawbpf))
20719c6307b1SDamien Bergamini 				bpf_mtap(ic->ic_rawbpf, m0);
20729c6307b1SDamien Bergamini 
20739c6307b1SDamien Bergamini 			if (rt2560_tx_data(sc, m0, ni) != 0) {
20749c6307b1SDamien Bergamini 				ieee80211_free_node(ni);
20759c6307b1SDamien Bergamini 				ifp->if_oerrors++;
20769c6307b1SDamien Bergamini 				break;
20779c6307b1SDamien Bergamini 			}
20789c6307b1SDamien Bergamini 		}
20799c6307b1SDamien Bergamini 
20809c6307b1SDamien Bergamini 		sc->sc_tx_timer = 5;
20819c6307b1SDamien Bergamini 		ifp->if_timer = 1;
20829c6307b1SDamien Bergamini 	}
20839c6307b1SDamien Bergamini 
20849c6307b1SDamien Bergamini 	RAL_UNLOCK(sc);
20859c6307b1SDamien Bergamini }
20869c6307b1SDamien Bergamini 
20879c6307b1SDamien Bergamini static void
20889c6307b1SDamien Bergamini rt2560_watchdog(struct ifnet *ifp)
20899c6307b1SDamien Bergamini {
20909c6307b1SDamien Bergamini 	struct rt2560_softc *sc = ifp->if_softc;
20919c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
20929c6307b1SDamien Bergamini 
20939c6307b1SDamien Bergamini 	RAL_LOCK(sc);
20949c6307b1SDamien Bergamini 
20959c6307b1SDamien Bergamini 	ifp->if_timer = 0;
20969c6307b1SDamien Bergamini 
20979c6307b1SDamien Bergamini 	if (sc->sc_tx_timer > 0) {
20989c6307b1SDamien Bergamini 		if (--sc->sc_tx_timer == 0) {
20999c6307b1SDamien Bergamini 			device_printf(sc->sc_dev, "device timeout\n");
21009c6307b1SDamien Bergamini 			rt2560_init(sc);
21019c6307b1SDamien Bergamini 			ifp->if_oerrors++;
21029c6307b1SDamien Bergamini 			RAL_UNLOCK(sc);
21039c6307b1SDamien Bergamini 			return;
21049c6307b1SDamien Bergamini 		}
21059c6307b1SDamien Bergamini 		ifp->if_timer = 1;
21069c6307b1SDamien Bergamini 	}
21079c6307b1SDamien Bergamini 
21089c6307b1SDamien Bergamini 	ieee80211_watchdog(ic);
21099c6307b1SDamien Bergamini 
21109c6307b1SDamien Bergamini 	RAL_UNLOCK(sc);
21119c6307b1SDamien Bergamini }
21129c6307b1SDamien Bergamini 
21139c6307b1SDamien Bergamini /*
21149c6307b1SDamien Bergamini  * This function allows for fast channel switching in monitor mode (used by
21159c6307b1SDamien Bergamini  * net-mgmt/kismet). In IBSS mode, we must explicitly reset the interface to
21169c6307b1SDamien Bergamini  * generate a new beacon frame.
21179c6307b1SDamien Bergamini  */
21189c6307b1SDamien Bergamini static int
21199c6307b1SDamien Bergamini rt2560_reset(struct ifnet *ifp)
21209c6307b1SDamien Bergamini {
21219c6307b1SDamien Bergamini 	struct rt2560_softc *sc = ifp->if_softc;
21229c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
21239c6307b1SDamien Bergamini 
21249c6307b1SDamien Bergamini 	if (ic->ic_opmode != IEEE80211_M_MONITOR)
21259c6307b1SDamien Bergamini 		return ENETRESET;
21269c6307b1SDamien Bergamini 
21279c6307b1SDamien Bergamini 	rt2560_set_chan(sc, ic->ic_curchan);
21289c6307b1SDamien Bergamini 
21299c6307b1SDamien Bergamini 	return 0;
21309c6307b1SDamien Bergamini }
21319c6307b1SDamien Bergamini 
21329c6307b1SDamien Bergamini static int
21339c6307b1SDamien Bergamini rt2560_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
21349c6307b1SDamien Bergamini {
21359c6307b1SDamien Bergamini 	struct rt2560_softc *sc = ifp->if_softc;
21369c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
21379c6307b1SDamien Bergamini 	int error = 0;
21389c6307b1SDamien Bergamini 
21399c6307b1SDamien Bergamini 	RAL_LOCK(sc);
21409c6307b1SDamien Bergamini 
21419c6307b1SDamien Bergamini 	switch (cmd) {
21429c6307b1SDamien Bergamini 	case SIOCSIFFLAGS:
21439c6307b1SDamien Bergamini 		if (ifp->if_flags & IFF_UP) {
21449c6307b1SDamien Bergamini 			if (ifp->if_drv_flags & IFF_DRV_RUNNING)
21459c6307b1SDamien Bergamini 				rt2560_update_promisc(sc);
21469c6307b1SDamien Bergamini 			else
21479c6307b1SDamien Bergamini 				rt2560_init(sc);
21489c6307b1SDamien Bergamini 		} else {
21499c6307b1SDamien Bergamini 			if (ifp->if_drv_flags & IFF_DRV_RUNNING)
21509c6307b1SDamien Bergamini 				rt2560_stop(sc);
21519c6307b1SDamien Bergamini 		}
21529c6307b1SDamien Bergamini 		break;
21539c6307b1SDamien Bergamini 
21549c6307b1SDamien Bergamini 	default:
21559c6307b1SDamien Bergamini 		error = ieee80211_ioctl(ic, cmd, data);
21569c6307b1SDamien Bergamini 	}
21579c6307b1SDamien Bergamini 
21589c6307b1SDamien Bergamini 	if (error == ENETRESET) {
21599c6307b1SDamien Bergamini 		if ((ifp->if_flags & IFF_UP) &&
21609c6307b1SDamien Bergamini 		    (ifp->if_drv_flags & IFF_DRV_RUNNING) &&
21619c6307b1SDamien Bergamini 		    (ic->ic_roaming != IEEE80211_ROAMING_MANUAL))
21629c6307b1SDamien Bergamini 			rt2560_init(sc);
21639c6307b1SDamien Bergamini 		error = 0;
21649c6307b1SDamien Bergamini 	}
21659c6307b1SDamien Bergamini 
21669c6307b1SDamien Bergamini 	RAL_UNLOCK(sc);
21679c6307b1SDamien Bergamini 
21689c6307b1SDamien Bergamini 	return error;
21699c6307b1SDamien Bergamini }
21709c6307b1SDamien Bergamini 
21719c6307b1SDamien Bergamini static void
21729c6307b1SDamien Bergamini rt2560_bbp_write(struct rt2560_softc *sc, uint8_t reg, uint8_t val)
21739c6307b1SDamien Bergamini {
21749c6307b1SDamien Bergamini 	uint32_t tmp;
21759c6307b1SDamien Bergamini 	int ntries;
21769c6307b1SDamien Bergamini 
21779c6307b1SDamien Bergamini 	for (ntries = 0; ntries < 100; ntries++) {
21789c6307b1SDamien Bergamini 		if (!(RAL_READ(sc, RT2560_BBPCSR) & RT2560_BBP_BUSY))
21799c6307b1SDamien Bergamini 			break;
21809c6307b1SDamien Bergamini 		DELAY(1);
21819c6307b1SDamien Bergamini 	}
21829c6307b1SDamien Bergamini 	if (ntries == 100) {
21839c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not write to BBP\n");
21849c6307b1SDamien Bergamini 		return;
21859c6307b1SDamien Bergamini 	}
21869c6307b1SDamien Bergamini 
21879c6307b1SDamien Bergamini 	tmp = RT2560_BBP_WRITE | RT2560_BBP_BUSY | reg << 8 | val;
21889c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_BBPCSR, tmp);
21899c6307b1SDamien Bergamini 
21909c6307b1SDamien Bergamini 	DPRINTFN(15, ("BBP R%u <- 0x%02x\n", reg, val));
21919c6307b1SDamien Bergamini }
21929c6307b1SDamien Bergamini 
21939c6307b1SDamien Bergamini static uint8_t
21949c6307b1SDamien Bergamini rt2560_bbp_read(struct rt2560_softc *sc, uint8_t reg)
21959c6307b1SDamien Bergamini {
21969c6307b1SDamien Bergamini 	uint32_t val;
21979c6307b1SDamien Bergamini 	int ntries;
21989c6307b1SDamien Bergamini 
21999c6307b1SDamien Bergamini 	val = RT2560_BBP_BUSY | reg << 8;
22009c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_BBPCSR, val);
22019c6307b1SDamien Bergamini 
22029c6307b1SDamien Bergamini 	for (ntries = 0; ntries < 100; ntries++) {
22039c6307b1SDamien Bergamini 		val = RAL_READ(sc, RT2560_BBPCSR);
22049c6307b1SDamien Bergamini 		if (!(val & RT2560_BBP_BUSY))
22059c6307b1SDamien Bergamini 			return val & 0xff;
22069c6307b1SDamien Bergamini 		DELAY(1);
22079c6307b1SDamien Bergamini 	}
22089c6307b1SDamien Bergamini 
22099c6307b1SDamien Bergamini 	device_printf(sc->sc_dev, "could not read from BBP\n");
22109c6307b1SDamien Bergamini 	return 0;
22119c6307b1SDamien Bergamini }
22129c6307b1SDamien Bergamini 
22139c6307b1SDamien Bergamini static void
22149c6307b1SDamien Bergamini rt2560_rf_write(struct rt2560_softc *sc, uint8_t reg, uint32_t val)
22159c6307b1SDamien Bergamini {
22169c6307b1SDamien Bergamini 	uint32_t tmp;
22179c6307b1SDamien Bergamini 	int ntries;
22189c6307b1SDamien Bergamini 
22199c6307b1SDamien Bergamini 	for (ntries = 0; ntries < 100; ntries++) {
22209c6307b1SDamien Bergamini 		if (!(RAL_READ(sc, RT2560_RFCSR) & RT2560_RF_BUSY))
22219c6307b1SDamien Bergamini 			break;
22229c6307b1SDamien Bergamini 		DELAY(1);
22239c6307b1SDamien Bergamini 	}
22249c6307b1SDamien Bergamini 	if (ntries == 100) {
22259c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "could not write to RF\n");
22269c6307b1SDamien Bergamini 		return;
22279c6307b1SDamien Bergamini 	}
22289c6307b1SDamien Bergamini 
22299c6307b1SDamien Bergamini 	tmp = RT2560_RF_BUSY | RT2560_RF_20BIT | (val & 0xfffff) << 2 |
22309c6307b1SDamien Bergamini 	    (reg & 0x3);
22319c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_RFCSR, tmp);
22329c6307b1SDamien Bergamini 
22339c6307b1SDamien Bergamini 	/* remember last written value in sc */
22349c6307b1SDamien Bergamini 	sc->rf_regs[reg] = val;
22359c6307b1SDamien Bergamini 
22369c6307b1SDamien Bergamini 	DPRINTFN(15, ("RF R[%u] <- 0x%05x\n", reg & 0x3, val & 0xfffff));
22379c6307b1SDamien Bergamini }
22389c6307b1SDamien Bergamini 
22399c6307b1SDamien Bergamini static void
22409c6307b1SDamien Bergamini rt2560_set_chan(struct rt2560_softc *sc, struct ieee80211_channel *c)
22419c6307b1SDamien Bergamini {
22429c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
22439c6307b1SDamien Bergamini 	uint8_t power, tmp;
22449c6307b1SDamien Bergamini 	u_int i, chan;
22459c6307b1SDamien Bergamini 
22469c6307b1SDamien Bergamini 	chan = ieee80211_chan2ieee(ic, c);
22479c6307b1SDamien Bergamini 	if (chan == 0 || chan == IEEE80211_CHAN_ANY)
22489c6307b1SDamien Bergamini 		return;
22499c6307b1SDamien Bergamini 
22509c6307b1SDamien Bergamini 	if (IEEE80211_IS_CHAN_2GHZ(c))
22519c6307b1SDamien Bergamini 		power = min(sc->txpow[chan - 1], 31);
22529c6307b1SDamien Bergamini 	else
22539c6307b1SDamien Bergamini 		power = 31;
22549c6307b1SDamien Bergamini 
22559c6307b1SDamien Bergamini 	/* adjust txpower using ifconfig settings */
22569c6307b1SDamien Bergamini 	power -= (100 - ic->ic_txpowlimit) / 8;
22579c6307b1SDamien Bergamini 
22589c6307b1SDamien Bergamini 	DPRINTFN(2, ("setting channel to %u, txpower to %u\n", chan, power));
22599c6307b1SDamien Bergamini 
22609c6307b1SDamien Bergamini 	switch (sc->rf_rev) {
22619c6307b1SDamien Bergamini 	case RT2560_RF_2522:
22629c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF1, 0x00814);
22639c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf2522_r2[chan - 1]);
22649c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x00040);
22659c6307b1SDamien Bergamini 		break;
22669c6307b1SDamien Bergamini 
22679c6307b1SDamien Bergamini 	case RT2560_RF_2523:
22689c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF1, 0x08804);
22699c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf2523_r2[chan - 1]);
22709c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x38044);
22719c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF4, (chan == 14) ? 0x00280 : 0x00286);
22729c6307b1SDamien Bergamini 		break;
22739c6307b1SDamien Bergamini 
22749c6307b1SDamien Bergamini 	case RT2560_RF_2524:
22759c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF1, 0x0c808);
22769c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf2524_r2[chan - 1]);
22779c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x00040);
22789c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF4, (chan == 14) ? 0x00280 : 0x00286);
22799c6307b1SDamien Bergamini 		break;
22809c6307b1SDamien Bergamini 
22819c6307b1SDamien Bergamini 	case RT2560_RF_2525:
22829c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF1, 0x08808);
22839c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf2525_hi_r2[chan - 1]);
22849c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x18044);
22859c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF4, (chan == 14) ? 0x00280 : 0x00286);
22869c6307b1SDamien Bergamini 
22879c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF1, 0x08808);
22889c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf2525_r2[chan - 1]);
22899c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x18044);
22909c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF4, (chan == 14) ? 0x00280 : 0x00286);
22919c6307b1SDamien Bergamini 		break;
22929c6307b1SDamien Bergamini 
22939c6307b1SDamien Bergamini 	case RT2560_RF_2525E:
22949c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF1, 0x08808);
22959c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf2525e_r2[chan - 1]);
22969c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x18044);
22979c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF4, (chan == 14) ? 0x00286 : 0x00282);
22989c6307b1SDamien Bergamini 		break;
22999c6307b1SDamien Bergamini 
23009c6307b1SDamien Bergamini 	case RT2560_RF_2526:
23019c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf2526_hi_r2[chan - 1]);
23029c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF4, (chan & 1) ? 0x00386 : 0x00381);
23039c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF1, 0x08804);
23049c6307b1SDamien Bergamini 
23059c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf2526_r2[chan - 1]);
23069c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x18044);
23079c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF4, (chan & 1) ? 0x00386 : 0x00381);
23089c6307b1SDamien Bergamini 		break;
23099c6307b1SDamien Bergamini 
23109c6307b1SDamien Bergamini 	/* dual-band RF */
23119c6307b1SDamien Bergamini 	case RT2560_RF_5222:
23129c6307b1SDamien Bergamini 		for (i = 0; rt2560_rf5222[i].chan != chan; i++);
23139c6307b1SDamien Bergamini 
23149c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF1, rt2560_rf5222[i].r1);
23159c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf5222[i].r2);
23169c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x00040);
23179c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF4, rt2560_rf5222[i].r4);
23189c6307b1SDamien Bergamini 		break;
23199c6307b1SDamien Bergamini 	}
23209c6307b1SDamien Bergamini 
23219c6307b1SDamien Bergamini 	if (ic->ic_state != IEEE80211_S_SCAN) {
23229c6307b1SDamien Bergamini 		/* set Japan filter bit for channel 14 */
23239c6307b1SDamien Bergamini 		tmp = rt2560_bbp_read(sc, 70);
23249c6307b1SDamien Bergamini 
23259c6307b1SDamien Bergamini 		tmp &= ~RT2560_JAPAN_FILTER;
23269c6307b1SDamien Bergamini 		if (chan == 14)
23279c6307b1SDamien Bergamini 			tmp |= RT2560_JAPAN_FILTER;
23289c6307b1SDamien Bergamini 
23299c6307b1SDamien Bergamini 		rt2560_bbp_write(sc, 70, tmp);
23309c6307b1SDamien Bergamini 
23319c6307b1SDamien Bergamini 		/* clear CRC errors */
23329c6307b1SDamien Bergamini 		RAL_READ(sc, RT2560_CNT0);
23339c6307b1SDamien Bergamini 	}
23349c6307b1SDamien Bergamini }
23359c6307b1SDamien Bergamini 
23369c6307b1SDamien Bergamini #if 0
23379c6307b1SDamien Bergamini /*
23389c6307b1SDamien Bergamini  * Disable RF auto-tuning.
23399c6307b1SDamien Bergamini  */
23409c6307b1SDamien Bergamini static void
23419c6307b1SDamien Bergamini rt2560_disable_rf_tune(struct rt2560_softc *sc)
23429c6307b1SDamien Bergamini {
23439c6307b1SDamien Bergamini 	uint32_t tmp;
23449c6307b1SDamien Bergamini 
23459c6307b1SDamien Bergamini 	if (sc->rf_rev != RT2560_RF_2523) {
23469c6307b1SDamien Bergamini 		tmp = sc->rf_regs[RAL_RF1] & ~RAL_RF1_AUTOTUNE;
23479c6307b1SDamien Bergamini 		rt2560_rf_write(sc, RAL_RF1, tmp);
23489c6307b1SDamien Bergamini 	}
23499c6307b1SDamien Bergamini 
23509c6307b1SDamien Bergamini 	tmp = sc->rf_regs[RAL_RF3] & ~RAL_RF3_AUTOTUNE;
23519c6307b1SDamien Bergamini 	rt2560_rf_write(sc, RAL_RF3, tmp);
23529c6307b1SDamien Bergamini 
23539c6307b1SDamien Bergamini 	DPRINTFN(2, ("disabling RF autotune\n"));
23549c6307b1SDamien Bergamini }
23559c6307b1SDamien Bergamini #endif
23569c6307b1SDamien Bergamini 
23579c6307b1SDamien Bergamini /*
23589c6307b1SDamien Bergamini  * Refer to IEEE Std 802.11-1999 pp. 123 for more information on TSF
23599c6307b1SDamien Bergamini  * synchronization.
23609c6307b1SDamien Bergamini  */
23619c6307b1SDamien Bergamini static void
23629c6307b1SDamien Bergamini rt2560_enable_tsf_sync(struct rt2560_softc *sc)
23639c6307b1SDamien Bergamini {
23649c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
23659c6307b1SDamien Bergamini 	uint16_t logcwmin, preload;
23669c6307b1SDamien Bergamini 	uint32_t tmp;
23679c6307b1SDamien Bergamini 
23689c6307b1SDamien Bergamini 	/* first, disable TSF synchronization */
23699c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR14, 0);
23709c6307b1SDamien Bergamini 
23719c6307b1SDamien Bergamini 	tmp = 16 * ic->ic_bss->ni_intval;
23729c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR12, tmp);
23739c6307b1SDamien Bergamini 
23749c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR13, 0);
23759c6307b1SDamien Bergamini 
23769c6307b1SDamien Bergamini 	logcwmin = 5;
23779c6307b1SDamien Bergamini 	preload = (ic->ic_opmode == IEEE80211_M_STA) ? 384 : 1024;
23789c6307b1SDamien Bergamini 	tmp = logcwmin << 16 | preload;
23799c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_BCNOCSR, tmp);
23809c6307b1SDamien Bergamini 
23819c6307b1SDamien Bergamini 	/* finally, enable TSF synchronization */
23829c6307b1SDamien Bergamini 	tmp = RT2560_ENABLE_TSF | RT2560_ENABLE_TBCN;
23839c6307b1SDamien Bergamini 	if (ic->ic_opmode == IEEE80211_M_STA)
23849c6307b1SDamien Bergamini 		tmp |= RT2560_ENABLE_TSF_SYNC(1);
23859c6307b1SDamien Bergamini 	else
23869c6307b1SDamien Bergamini 		tmp |= RT2560_ENABLE_TSF_SYNC(2) |
23879c6307b1SDamien Bergamini 		       RT2560_ENABLE_BEACON_GENERATOR;
23889c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR14, tmp);
23899c6307b1SDamien Bergamini 
23909c6307b1SDamien Bergamini 	DPRINTF(("enabling TSF synchronization\n"));
23919c6307b1SDamien Bergamini }
23929c6307b1SDamien Bergamini 
23939c6307b1SDamien Bergamini static void
23949c6307b1SDamien Bergamini rt2560_update_plcp(struct rt2560_softc *sc)
23959c6307b1SDamien Bergamini {
23969c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
23979c6307b1SDamien Bergamini 
23989c6307b1SDamien Bergamini 	/* no short preamble for 1Mbps */
23999c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_PLCP1MCSR, 0x00700400);
24009c6307b1SDamien Bergamini 
24019c6307b1SDamien Bergamini 	if (!(ic->ic_flags & IEEE80211_F_SHPREAMBLE)) {
24029c6307b1SDamien Bergamini 		/* values taken from the reference driver */
24039c6307b1SDamien Bergamini 		RAL_WRITE(sc, RT2560_PLCP2MCSR,   0x00380401);
24049c6307b1SDamien Bergamini 		RAL_WRITE(sc, RT2560_PLCP5p5MCSR, 0x00150402);
24059c6307b1SDamien Bergamini 		RAL_WRITE(sc, RT2560_PLCP11MCSR,  0x000b8403);
24069c6307b1SDamien Bergamini 	} else {
24079c6307b1SDamien Bergamini 		/* same values as above or'ed 0x8 */
24089c6307b1SDamien Bergamini 		RAL_WRITE(sc, RT2560_PLCP2MCSR,   0x00380409);
24099c6307b1SDamien Bergamini 		RAL_WRITE(sc, RT2560_PLCP5p5MCSR, 0x0015040a);
24109c6307b1SDamien Bergamini 		RAL_WRITE(sc, RT2560_PLCP11MCSR,  0x000b840b);
24119c6307b1SDamien Bergamini 	}
24129c6307b1SDamien Bergamini 
24139c6307b1SDamien Bergamini 	DPRINTF(("updating PLCP for %s preamble\n",
24149c6307b1SDamien Bergamini 	    (ic->ic_flags & IEEE80211_F_SHPREAMBLE) ? "short" : "long"));
24159c6307b1SDamien Bergamini }
24169c6307b1SDamien Bergamini 
24179c6307b1SDamien Bergamini /*
24189c6307b1SDamien Bergamini  * This function can be called by ieee80211_set_shortslottime(). Refer to
24199c6307b1SDamien Bergamini  * IEEE Std 802.11-1999 pp. 85 to know how these values are computed.
24209c6307b1SDamien Bergamini  */
24219c6307b1SDamien Bergamini static void
24229c6307b1SDamien Bergamini rt2560_update_slot(struct ifnet *ifp)
24239c6307b1SDamien Bergamini {
24249c6307b1SDamien Bergamini 	struct rt2560_softc *sc = ifp->if_softc;
24259c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
24269c6307b1SDamien Bergamini 	uint8_t slottime;
24279c6307b1SDamien Bergamini 	uint16_t tx_sifs, tx_pifs, tx_difs, eifs;
24289c6307b1SDamien Bergamini 	uint32_t tmp;
24299c6307b1SDamien Bergamini 
24309c6307b1SDamien Bergamini 	slottime = (ic->ic_flags & IEEE80211_F_SHSLOT) ? 9 : 20;
24319c6307b1SDamien Bergamini 
24329c6307b1SDamien Bergamini 	/* update the MAC slot boundaries */
24339c6307b1SDamien Bergamini 	tx_sifs = RAL_SIFS - RT2560_TXRX_TURNAROUND;
24349c6307b1SDamien Bergamini 	tx_pifs = tx_sifs + slottime;
24359c6307b1SDamien Bergamini 	tx_difs = tx_sifs + 2 * slottime;
24369c6307b1SDamien Bergamini 	eifs = (ic->ic_curmode == IEEE80211_MODE_11B) ? 364 : 60;
24379c6307b1SDamien Bergamini 
24389c6307b1SDamien Bergamini 	tmp = RAL_READ(sc, RT2560_CSR11);
24399c6307b1SDamien Bergamini 	tmp = (tmp & ~0x1f00) | slottime << 8;
24409c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR11, tmp);
24419c6307b1SDamien Bergamini 
24429c6307b1SDamien Bergamini 	tmp = tx_pifs << 16 | tx_sifs;
24439c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR18, tmp);
24449c6307b1SDamien Bergamini 
24459c6307b1SDamien Bergamini 	tmp = eifs << 16 | tx_difs;
24469c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR19, tmp);
24479c6307b1SDamien Bergamini 
24489c6307b1SDamien Bergamini 	DPRINTF(("setting slottime to %uus\n", slottime));
24499c6307b1SDamien Bergamini }
24509c6307b1SDamien Bergamini 
24519c6307b1SDamien Bergamini static void
24529c6307b1SDamien Bergamini rt2560_set_basicrates(struct rt2560_softc *sc)
24539c6307b1SDamien Bergamini {
24549c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
24559c6307b1SDamien Bergamini 
24569c6307b1SDamien Bergamini 	/* update basic rate set */
24579c6307b1SDamien Bergamini 	if (ic->ic_curmode == IEEE80211_MODE_11B) {
24589c6307b1SDamien Bergamini 		/* 11b basic rates: 1, 2Mbps */
24599c6307b1SDamien Bergamini 		RAL_WRITE(sc, RT2560_ARSP_PLCP_1, 0x3);
24609c6307b1SDamien Bergamini 	} else if (IEEE80211_IS_CHAN_5GHZ(ic->ic_curchan)) {
24619c6307b1SDamien Bergamini 		/* 11a basic rates: 6, 12, 24Mbps */
24629c6307b1SDamien Bergamini 		RAL_WRITE(sc, RT2560_ARSP_PLCP_1, 0x150);
24639c6307b1SDamien Bergamini 	} else {
24649c6307b1SDamien Bergamini 		/* 11g basic rates: 1, 2, 5.5, 11, 6, 12, 24Mbps */
24659c6307b1SDamien Bergamini 		RAL_WRITE(sc, RT2560_ARSP_PLCP_1, 0x15f);
24669c6307b1SDamien Bergamini 	}
24679c6307b1SDamien Bergamini }
24689c6307b1SDamien Bergamini 
24699c6307b1SDamien Bergamini static void
24709c6307b1SDamien Bergamini rt2560_update_led(struct rt2560_softc *sc, int led1, int led2)
24719c6307b1SDamien Bergamini {
24729c6307b1SDamien Bergamini 	uint32_t tmp;
24739c6307b1SDamien Bergamini 
24749c6307b1SDamien Bergamini 	/* set ON period to 70ms and OFF period to 30ms */
24759c6307b1SDamien Bergamini 	tmp = led1 << 16 | led2 << 17 | 70 << 8 | 30;
24769c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_LEDCSR, tmp);
24779c6307b1SDamien Bergamini }
24789c6307b1SDamien Bergamini 
24799c6307b1SDamien Bergamini static void
24809c6307b1SDamien Bergamini rt2560_set_bssid(struct rt2560_softc *sc, uint8_t *bssid)
24819c6307b1SDamien Bergamini {
24829c6307b1SDamien Bergamini 	uint32_t tmp;
24839c6307b1SDamien Bergamini 
24849c6307b1SDamien Bergamini 	tmp = bssid[0] | bssid[1] << 8 | bssid[2] << 16 | bssid[3] << 24;
24859c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR5, tmp);
24869c6307b1SDamien Bergamini 
24879c6307b1SDamien Bergamini 	tmp = bssid[4] | bssid[5] << 8;
24889c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR6, tmp);
24899c6307b1SDamien Bergamini 
24909c6307b1SDamien Bergamini 	DPRINTF(("setting BSSID to %6D\n", bssid, ":"));
24919c6307b1SDamien Bergamini }
24929c6307b1SDamien Bergamini 
24939c6307b1SDamien Bergamini static void
24949c6307b1SDamien Bergamini rt2560_set_macaddr(struct rt2560_softc *sc, uint8_t *addr)
24959c6307b1SDamien Bergamini {
24969c6307b1SDamien Bergamini 	uint32_t tmp;
24979c6307b1SDamien Bergamini 
24989c6307b1SDamien Bergamini 	tmp = addr[0] | addr[1] << 8 | addr[2] << 16 | addr[3] << 24;
24999c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR3, tmp);
25009c6307b1SDamien Bergamini 
25019c6307b1SDamien Bergamini 	tmp = addr[4] | addr[5] << 8;
25029c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR4, tmp);
25039c6307b1SDamien Bergamini 
25049c6307b1SDamien Bergamini 	DPRINTF(("setting MAC address to %6D\n", addr, ":"));
25059c6307b1SDamien Bergamini }
25069c6307b1SDamien Bergamini 
25079c6307b1SDamien Bergamini static void
25089c6307b1SDamien Bergamini rt2560_get_macaddr(struct rt2560_softc *sc, uint8_t *addr)
25099c6307b1SDamien Bergamini {
25109c6307b1SDamien Bergamini 	uint32_t tmp;
25119c6307b1SDamien Bergamini 
25129c6307b1SDamien Bergamini 	tmp = RAL_READ(sc, RT2560_CSR3);
25139c6307b1SDamien Bergamini 	addr[0] = tmp & 0xff;
25149c6307b1SDamien Bergamini 	addr[1] = (tmp >>  8) & 0xff;
25159c6307b1SDamien Bergamini 	addr[2] = (tmp >> 16) & 0xff;
25169c6307b1SDamien Bergamini 	addr[3] = (tmp >> 24);
25179c6307b1SDamien Bergamini 
25189c6307b1SDamien Bergamini 	tmp = RAL_READ(sc, RT2560_CSR4);
25199c6307b1SDamien Bergamini 	addr[4] = tmp & 0xff;
25209c6307b1SDamien Bergamini 	addr[5] = (tmp >> 8) & 0xff;
25219c6307b1SDamien Bergamini }
25229c6307b1SDamien Bergamini 
25239c6307b1SDamien Bergamini static void
25249c6307b1SDamien Bergamini rt2560_update_promisc(struct rt2560_softc *sc)
25259c6307b1SDamien Bergamini {
25269c6307b1SDamien Bergamini 	struct ifnet *ifp = sc->sc_ic.ic_ifp;
25279c6307b1SDamien Bergamini 	uint32_t tmp;
25289c6307b1SDamien Bergamini 
25299c6307b1SDamien Bergamini 	tmp = RAL_READ(sc, RT2560_RXCSR0);
25309c6307b1SDamien Bergamini 
25319c6307b1SDamien Bergamini 	tmp &= ~RT2560_DROP_NOT_TO_ME;
25329c6307b1SDamien Bergamini 	if (!(ifp->if_flags & IFF_PROMISC))
25339c6307b1SDamien Bergamini 		tmp |= RT2560_DROP_NOT_TO_ME;
25349c6307b1SDamien Bergamini 
25359c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_RXCSR0, tmp);
25369c6307b1SDamien Bergamini 
25379c6307b1SDamien Bergamini 	DPRINTF(("%s promiscuous mode\n", (ifp->if_flags & IFF_PROMISC) ?
25389c6307b1SDamien Bergamini 	    "entering" : "leaving"));
25399c6307b1SDamien Bergamini }
25409c6307b1SDamien Bergamini 
25419c6307b1SDamien Bergamini static const char *
25429c6307b1SDamien Bergamini rt2560_get_rf(int rev)
25439c6307b1SDamien Bergamini {
25449c6307b1SDamien Bergamini 	switch (rev) {
25459c6307b1SDamien Bergamini 	case RT2560_RF_2522:	return "RT2522";
25469c6307b1SDamien Bergamini 	case RT2560_RF_2523:	return "RT2523";
25479c6307b1SDamien Bergamini 	case RT2560_RF_2524:	return "RT2524";
25489c6307b1SDamien Bergamini 	case RT2560_RF_2525:	return "RT2525";
25499c6307b1SDamien Bergamini 	case RT2560_RF_2525E:	return "RT2525e";
25509c6307b1SDamien Bergamini 	case RT2560_RF_2526:	return "RT2526";
25519c6307b1SDamien Bergamini 	case RT2560_RF_5222:	return "RT5222";
25529c6307b1SDamien Bergamini 	default:		return "unknown";
25539c6307b1SDamien Bergamini 	}
25549c6307b1SDamien Bergamini }
25559c6307b1SDamien Bergamini 
25569c6307b1SDamien Bergamini static void
25579c6307b1SDamien Bergamini rt2560_read_eeprom(struct rt2560_softc *sc)
25589c6307b1SDamien Bergamini {
25599c6307b1SDamien Bergamini 	uint16_t val;
25609c6307b1SDamien Bergamini 	int i;
25619c6307b1SDamien Bergamini 
25629c6307b1SDamien Bergamini 	val = rt2560_eeprom_read(sc, RT2560_EEPROM_CONFIG0);
25639c6307b1SDamien Bergamini 	sc->rf_rev =   (val >> 11) & 0x7;
25649c6307b1SDamien Bergamini 	sc->hw_radio = (val >> 10) & 0x1;
25659c6307b1SDamien Bergamini 	sc->led_mode = (val >> 6)  & 0x7;
25669c6307b1SDamien Bergamini 	sc->rx_ant =   (val >> 4)  & 0x3;
25679c6307b1SDamien Bergamini 	sc->tx_ant =   (val >> 2)  & 0x3;
25689c6307b1SDamien Bergamini 	sc->nb_ant =   val & 0x3;
25699c6307b1SDamien Bergamini 
25709c6307b1SDamien Bergamini 	/* read default values for BBP registers */
25719c6307b1SDamien Bergamini 	for (i = 0; i < 16; i++) {
25729c6307b1SDamien Bergamini 		val = rt2560_eeprom_read(sc, RT2560_EEPROM_BBP_BASE + i);
25739c6307b1SDamien Bergamini 		sc->bbp_prom[i].reg = val >> 8;
25749c6307b1SDamien Bergamini 		sc->bbp_prom[i].val = val & 0xff;
25759c6307b1SDamien Bergamini 	}
25769c6307b1SDamien Bergamini 
25779c6307b1SDamien Bergamini 	/* read Tx power for all b/g channels */
25789c6307b1SDamien Bergamini 	for (i = 0; i < 14 / 2; i++) {
25799c6307b1SDamien Bergamini 		val = rt2560_eeprom_read(sc, RT2560_EEPROM_TXPOWER + i);
25809c6307b1SDamien Bergamini 		sc->txpow[i * 2] = val >> 8;
25819c6307b1SDamien Bergamini 		sc->txpow[i * 2 + 1] = val & 0xff;
25829c6307b1SDamien Bergamini 	}
25839c6307b1SDamien Bergamini }
25849c6307b1SDamien Bergamini 
25859c6307b1SDamien Bergamini static int
25869c6307b1SDamien Bergamini rt2560_bbp_init(struct rt2560_softc *sc)
25879c6307b1SDamien Bergamini {
25889c6307b1SDamien Bergamini #define N(a)	(sizeof (a) / sizeof ((a)[0]))
25899c6307b1SDamien Bergamini 	int i, ntries;
25909c6307b1SDamien Bergamini 
25919c6307b1SDamien Bergamini 	/* wait for BBP to be ready */
25929c6307b1SDamien Bergamini 	for (ntries = 0; ntries < 100; ntries++) {
25939c6307b1SDamien Bergamini 		if (rt2560_bbp_read(sc, RT2560_BBP_VERSION) != 0)
25949c6307b1SDamien Bergamini 			break;
25959c6307b1SDamien Bergamini 		DELAY(1);
25969c6307b1SDamien Bergamini 	}
25979c6307b1SDamien Bergamini 	if (ntries == 100) {
25989c6307b1SDamien Bergamini 		device_printf(sc->sc_dev, "timeout waiting for BBP\n");
25999c6307b1SDamien Bergamini 		return EIO;
26009c6307b1SDamien Bergamini 	}
26019c6307b1SDamien Bergamini 
26029c6307b1SDamien Bergamini 	/* initialize BBP registers to default values */
26039c6307b1SDamien Bergamini 	for (i = 0; i < N(rt2560_def_bbp); i++) {
26049c6307b1SDamien Bergamini 		rt2560_bbp_write(sc, rt2560_def_bbp[i].reg,
26059c6307b1SDamien Bergamini 		    rt2560_def_bbp[i].val);
26069c6307b1SDamien Bergamini 	}
26079c6307b1SDamien Bergamini #if 0
26089c6307b1SDamien Bergamini 	/* initialize BBP registers to values stored in EEPROM */
26099c6307b1SDamien Bergamini 	for (i = 0; i < 16; i++) {
26109c6307b1SDamien Bergamini 		if (sc->bbp_prom[i].reg == 0xff)
26119c6307b1SDamien Bergamini 			continue;
26129c6307b1SDamien Bergamini 		rt2560_bbp_write(sc, sc->bbp_prom[i].reg, sc->bbp_prom[i].val);
26139c6307b1SDamien Bergamini 	}
26149c6307b1SDamien Bergamini #endif
26159c6307b1SDamien Bergamini 
26169c6307b1SDamien Bergamini 	return 0;
26179c6307b1SDamien Bergamini #undef N
26189c6307b1SDamien Bergamini }
26199c6307b1SDamien Bergamini 
26209c6307b1SDamien Bergamini static void
26219c6307b1SDamien Bergamini rt2560_set_txantenna(struct rt2560_softc *sc, int antenna)
26229c6307b1SDamien Bergamini {
26239c6307b1SDamien Bergamini 	uint32_t tmp;
26249c6307b1SDamien Bergamini 	uint8_t tx;
26259c6307b1SDamien Bergamini 
26269c6307b1SDamien Bergamini 	tx = rt2560_bbp_read(sc, RT2560_BBP_TX) & ~RT2560_BBP_ANTMASK;
26279c6307b1SDamien Bergamini 	if (antenna == 1)
26289c6307b1SDamien Bergamini 		tx |= RT2560_BBP_ANTA;
26299c6307b1SDamien Bergamini 	else if (antenna == 2)
26309c6307b1SDamien Bergamini 		tx |= RT2560_BBP_ANTB;
26319c6307b1SDamien Bergamini 	else
26329c6307b1SDamien Bergamini 		tx |= RT2560_BBP_DIVERSITY;
26339c6307b1SDamien Bergamini 
26349c6307b1SDamien Bergamini 	/* need to force I/Q flip for RF 2525e, 2526 and 5222 */
26359c6307b1SDamien Bergamini 	if (sc->rf_rev == RT2560_RF_2525E || sc->rf_rev == RT2560_RF_2526 ||
26369c6307b1SDamien Bergamini 	    sc->rf_rev == RT2560_RF_5222)
26379c6307b1SDamien Bergamini 		tx |= RT2560_BBP_FLIPIQ;
26389c6307b1SDamien Bergamini 
26399c6307b1SDamien Bergamini 	rt2560_bbp_write(sc, RT2560_BBP_TX, tx);
26409c6307b1SDamien Bergamini 
26419c6307b1SDamien Bergamini 	/* update values for CCK and OFDM in BBPCSR1 */
26429c6307b1SDamien Bergamini 	tmp = RAL_READ(sc, RT2560_BBPCSR1) & ~0x00070007;
26439c6307b1SDamien Bergamini 	tmp |= (tx & 0x7) << 16 | (tx & 0x7);
26449c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_BBPCSR1, tmp);
26459c6307b1SDamien Bergamini }
26469c6307b1SDamien Bergamini 
26479c6307b1SDamien Bergamini static void
26489c6307b1SDamien Bergamini rt2560_set_rxantenna(struct rt2560_softc *sc, int antenna)
26499c6307b1SDamien Bergamini {
26509c6307b1SDamien Bergamini 	uint8_t rx;
26519c6307b1SDamien Bergamini 
26529c6307b1SDamien Bergamini 	rx = rt2560_bbp_read(sc, RT2560_BBP_RX) & ~RT2560_BBP_ANTMASK;
26539c6307b1SDamien Bergamini 	if (antenna == 1)
26549c6307b1SDamien Bergamini 		rx |= RT2560_BBP_ANTA;
26559c6307b1SDamien Bergamini 	else if (antenna == 2)
26569c6307b1SDamien Bergamini 		rx |= RT2560_BBP_ANTB;
26579c6307b1SDamien Bergamini 	else
26589c6307b1SDamien Bergamini 		rx |= RT2560_BBP_DIVERSITY;
26599c6307b1SDamien Bergamini 
26609c6307b1SDamien Bergamini 	/* need to force no I/Q flip for RF 2525e and 2526 */
26619c6307b1SDamien Bergamini 	if (sc->rf_rev == RT2560_RF_2525E || sc->rf_rev == RT2560_RF_2526)
26629c6307b1SDamien Bergamini 		rx &= ~RT2560_BBP_FLIPIQ;
26639c6307b1SDamien Bergamini 
26649c6307b1SDamien Bergamini 	rt2560_bbp_write(sc, RT2560_BBP_RX, rx);
26659c6307b1SDamien Bergamini }
26669c6307b1SDamien Bergamini 
26679c6307b1SDamien Bergamini static void
26689c6307b1SDamien Bergamini rt2560_init(void *priv)
26699c6307b1SDamien Bergamini {
26709c6307b1SDamien Bergamini #define N(a)	(sizeof (a) / sizeof ((a)[0]))
26719c6307b1SDamien Bergamini 	struct rt2560_softc *sc = priv;
26729c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
26739c6307b1SDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
26749c6307b1SDamien Bergamini 	uint32_t tmp;
26759c6307b1SDamien Bergamini 	int i;
26769c6307b1SDamien Bergamini 
2677d0934eb1SDamien Bergamini 	RAL_LOCK(sc);
2678d0934eb1SDamien Bergamini 
26799c6307b1SDamien Bergamini 	rt2560_stop(sc);
26809c6307b1SDamien Bergamini 
26819c6307b1SDamien Bergamini 	/* setup tx rings */
26829c6307b1SDamien Bergamini 	tmp = RT2560_PRIO_RING_COUNT << 24 |
26839c6307b1SDamien Bergamini 	      RT2560_ATIM_RING_COUNT << 16 |
26849c6307b1SDamien Bergamini 	      RT2560_TX_RING_COUNT   <<  8 |
26859c6307b1SDamien Bergamini 	      RT2560_TX_DESC_SIZE;
26869c6307b1SDamien Bergamini 
26879c6307b1SDamien Bergamini 	/* rings must be initialized in this exact order */
26889c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_TXCSR2, tmp);
26899c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_TXCSR3, sc->txq.physaddr);
26909c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_TXCSR5, sc->prioq.physaddr);
26919c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_TXCSR4, sc->atimq.physaddr);
26929c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_TXCSR6, sc->bcnq.physaddr);
26939c6307b1SDamien Bergamini 
26949c6307b1SDamien Bergamini 	/* setup rx ring */
26959c6307b1SDamien Bergamini 	tmp = RT2560_RX_RING_COUNT << 8 | RT2560_RX_DESC_SIZE;
26969c6307b1SDamien Bergamini 
26979c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_RXCSR1, tmp);
26989c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_RXCSR2, sc->rxq.physaddr);
26999c6307b1SDamien Bergamini 
27009c6307b1SDamien Bergamini 	/* initialize MAC registers to default values */
27019c6307b1SDamien Bergamini 	for (i = 0; i < N(rt2560_def_mac); i++)
27029c6307b1SDamien Bergamini 		RAL_WRITE(sc, rt2560_def_mac[i].reg, rt2560_def_mac[i].val);
27039c6307b1SDamien Bergamini 
27049c6307b1SDamien Bergamini 	IEEE80211_ADDR_COPY(ic->ic_myaddr, IF_LLADDR(ifp));
27059c6307b1SDamien Bergamini 	rt2560_set_macaddr(sc, ic->ic_myaddr);
27069c6307b1SDamien Bergamini 
27079c6307b1SDamien Bergamini 	/* set basic rate set (will be updated later) */
27089c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_ARSP_PLCP_1, 0x153);
27099c6307b1SDamien Bergamini 
27109c6307b1SDamien Bergamini 	rt2560_set_txantenna(sc, sc->tx_ant);
27119c6307b1SDamien Bergamini 	rt2560_set_rxantenna(sc, sc->rx_ant);
27129c6307b1SDamien Bergamini 	rt2560_update_slot(ifp);
27139c6307b1SDamien Bergamini 	rt2560_update_plcp(sc);
27149c6307b1SDamien Bergamini 	rt2560_update_led(sc, 0, 0);
27159c6307b1SDamien Bergamini 
27169c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR1, RT2560_RESET_ASIC);
27179c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR1, RT2560_HOST_READY);
27189c6307b1SDamien Bergamini 
27199c6307b1SDamien Bergamini 	if (rt2560_bbp_init(sc) != 0) {
27209c6307b1SDamien Bergamini 		rt2560_stop(sc);
2721d0934eb1SDamien Bergamini 		RAL_UNLOCK(sc);
27229c6307b1SDamien Bergamini 		return;
27239c6307b1SDamien Bergamini 	}
27249c6307b1SDamien Bergamini 
27259c6307b1SDamien Bergamini 	/* set default BSS channel */
27269c6307b1SDamien Bergamini 	rt2560_set_chan(sc, ic->ic_curchan);
27279c6307b1SDamien Bergamini 
27289c6307b1SDamien Bergamini 	/* kick Rx */
27299c6307b1SDamien Bergamini 	tmp = RT2560_DROP_PHY_ERROR | RT2560_DROP_CRC_ERROR;
27309c6307b1SDamien Bergamini 	if (ic->ic_opmode != IEEE80211_M_MONITOR) {
27319c6307b1SDamien Bergamini 		tmp |= RT2560_DROP_CTL | RT2560_DROP_VERSION_ERROR;
27329c6307b1SDamien Bergamini 		if (ic->ic_opmode != IEEE80211_M_HOSTAP)
27339c6307b1SDamien Bergamini 			tmp |= RT2560_DROP_TODS;
27349c6307b1SDamien Bergamini 		if (!(ifp->if_flags & IFF_PROMISC))
27359c6307b1SDamien Bergamini 			tmp |= RT2560_DROP_NOT_TO_ME;
27369c6307b1SDamien Bergamini 	}
27379c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_RXCSR0, tmp);
27389c6307b1SDamien Bergamini 
27399c6307b1SDamien Bergamini 	/* clear old FCS and Rx FIFO errors */
27409c6307b1SDamien Bergamini 	RAL_READ(sc, RT2560_CNT0);
27419c6307b1SDamien Bergamini 	RAL_READ(sc, RT2560_CNT4);
27429c6307b1SDamien Bergamini 
27439c6307b1SDamien Bergamini 	/* clear any pending interrupts */
27449c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR7, 0xffffffff);
27459c6307b1SDamien Bergamini 
27469c6307b1SDamien Bergamini 	/* enable interrupts */
27479c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR8, RT2560_INTR_MASK);
27489c6307b1SDamien Bergamini 
27499c6307b1SDamien Bergamini 	ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
27509c6307b1SDamien Bergamini 	ifp->if_drv_flags |= IFF_DRV_RUNNING;
27519c6307b1SDamien Bergamini 
27529c6307b1SDamien Bergamini 	if (ic->ic_opmode != IEEE80211_M_MONITOR) {
27539c6307b1SDamien Bergamini 		if (ic->ic_roaming != IEEE80211_ROAMING_MANUAL)
27549c6307b1SDamien Bergamini 			ieee80211_new_state(ic, IEEE80211_S_SCAN, -1);
27559c6307b1SDamien Bergamini 	} else
27569c6307b1SDamien Bergamini 		ieee80211_new_state(ic, IEEE80211_S_RUN, -1);
2757d0934eb1SDamien Bergamini 
2758d0934eb1SDamien Bergamini 	RAL_UNLOCK(sc);
27599c6307b1SDamien Bergamini #undef N
27609c6307b1SDamien Bergamini }
27619c6307b1SDamien Bergamini 
27629c6307b1SDamien Bergamini void
27639c6307b1SDamien Bergamini rt2560_stop(void *priv)
27649c6307b1SDamien Bergamini {
27659c6307b1SDamien Bergamini 	struct rt2560_softc *sc = priv;
27669c6307b1SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
27679c6307b1SDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
27689c6307b1SDamien Bergamini 
27699c6307b1SDamien Bergamini 	sc->sc_tx_timer = 0;
27709c6307b1SDamien Bergamini 	ifp->if_timer = 0;
27719c6307b1SDamien Bergamini 	ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);
27729c6307b1SDamien Bergamini 
2773d0934eb1SDamien Bergamini 	ieee80211_new_state(ic, IEEE80211_S_INIT, -1);
2774d0934eb1SDamien Bergamini 
27759c6307b1SDamien Bergamini 	/* abort Tx */
27769c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_TXCSR0, RT2560_ABORT_TX);
27779c6307b1SDamien Bergamini 
27789c6307b1SDamien Bergamini 	/* disable Rx */
27799c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_RXCSR0, RT2560_DISABLE_RX);
27809c6307b1SDamien Bergamini 
27819c6307b1SDamien Bergamini 	/* reset ASIC (imply reset BBP) */
27829c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR1, RT2560_RESET_ASIC);
27839c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR1, 0);
27849c6307b1SDamien Bergamini 
27859c6307b1SDamien Bergamini 	/* disable interrupts */
27869c6307b1SDamien Bergamini 	RAL_WRITE(sc, RT2560_CSR8, 0xffffffff);
27879c6307b1SDamien Bergamini 
27889c6307b1SDamien Bergamini 	/* reset Tx and Rx rings */
27899c6307b1SDamien Bergamini 	rt2560_reset_tx_ring(sc, &sc->txq);
27909c6307b1SDamien Bergamini 	rt2560_reset_tx_ring(sc, &sc->atimq);
27919c6307b1SDamien Bergamini 	rt2560_reset_tx_ring(sc, &sc->prioq);
27929c6307b1SDamien Bergamini 	rt2560_reset_tx_ring(sc, &sc->bcnq);
27939c6307b1SDamien Bergamini 	rt2560_reset_rx_ring(sc, &sc->rxq);
27949c6307b1SDamien Bergamini }
27959ee0e227SSam Leffler 
27969ee0e227SSam Leffler static int
27979ee0e227SSam Leffler rt2560_raw_xmit(struct ieee80211_node *ni, struct mbuf *m,
27989ee0e227SSam Leffler 	const struct ieee80211_bpf_params *params)
27999ee0e227SSam Leffler {
28009ee0e227SSam Leffler 	struct ieee80211com *ic = ni->ni_ic;
28019ee0e227SSam Leffler 	struct ifnet *ifp = ic->ic_ifp;
28029ee0e227SSam Leffler 	struct rt2560_softc *sc = ifp->if_softc;
28039ee0e227SSam Leffler 
28049ee0e227SSam Leffler 	RAL_LOCK(sc);
28059ee0e227SSam Leffler 
28069ee0e227SSam Leffler 	/* prevent management frames from being sent if we're not ready */
28079ee0e227SSam Leffler 	if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) {
28089ee0e227SSam Leffler 		RAL_UNLOCK(sc);
28099ee0e227SSam Leffler 		return ENETDOWN;
28109ee0e227SSam Leffler 	}
28119ee0e227SSam Leffler 	if (sc->prioq.queued >= RT2560_PRIO_RING_COUNT) {
28129ee0e227SSam Leffler 		ifp->if_drv_flags |= IFF_DRV_OACTIVE;
28139ee0e227SSam Leffler 		RAL_UNLOCK(sc);
28149ee0e227SSam Leffler 		return ENOBUFS;		/* XXX */
28159ee0e227SSam Leffler 	}
28169ee0e227SSam Leffler 
28179ee0e227SSam Leffler 	if (bpf_peers_present(ic->ic_rawbpf))
28189ee0e227SSam Leffler 		bpf_mtap(ic->ic_rawbpf, m);
28199ee0e227SSam Leffler 
28209ee0e227SSam Leffler 	ifp->if_opackets++;
28219ee0e227SSam Leffler 
28229ee0e227SSam Leffler 	if (params == NULL) {
28239ee0e227SSam Leffler 		/*
28249ee0e227SSam Leffler 		 * Legacy path; interpret frame contents to decide
28259ee0e227SSam Leffler 		 * precisely how to send the frame.
28269ee0e227SSam Leffler 		 */
28279ee0e227SSam Leffler 		if (rt2560_tx_mgt(sc, m, ni) != 0)
28289ee0e227SSam Leffler 			goto bad;
28299ee0e227SSam Leffler 	} else {
28309ee0e227SSam Leffler 		/*
28319ee0e227SSam Leffler 		 * Caller supplied explicit parameters to use in
28329ee0e227SSam Leffler 		 * sending the frame.
28339ee0e227SSam Leffler 		 */
28349ee0e227SSam Leffler 		if (rt2560_tx_raw(sc, m, ni, params))
28359ee0e227SSam Leffler 			goto bad;
28369ee0e227SSam Leffler 	}
28379ee0e227SSam Leffler 	sc->sc_tx_timer = 5;
28389ee0e227SSam Leffler 	ifp->if_timer = 1;
28399ee0e227SSam Leffler 
28409ee0e227SSam Leffler 	RAL_UNLOCK(sc);
28419ee0e227SSam Leffler 
28429ee0e227SSam Leffler 	return 0;
28439ee0e227SSam Leffler bad:
28449ee0e227SSam Leffler 	ifp->if_oerrors++;
28459ee0e227SSam Leffler 	if (ni != NULL)
28469ee0e227SSam Leffler 		ieee80211_free_node(ni);
28479ee0e227SSam Leffler 	RAL_UNLOCK(sc);
28489ee0e227SSam Leffler 	return EIO;		/* XXX */
28499ee0e227SSam Leffler }
2850