xref: /onnv-gate/usr/src/uts/common/io/ral/rt2560.c (revision 8230:f7236dfe6b55)
14609Szf162725 /*
26411Szf162725  * Copyright 2008 Sun Microsystems, Inc.  All rights reserved.
34609Szf162725  * Use is subject to license terms.
44609Szf162725  */
54609Szf162725 
64609Szf162725 /*
74609Szf162725  * Copyright (c) 2005, 2006
84609Szf162725  *	Damien Bergamini <damien.bergamini@free.fr>
94609Szf162725  *
104609Szf162725  * Permission to use, copy, modify, and distribute this software for any
114609Szf162725  * purpose with or without fee is hereby granted, provided that the above
124609Szf162725  * copyright notice and this permission notice appear in all copies.
134609Szf162725  *
144609Szf162725  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
154609Szf162725  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
164609Szf162725  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
174609Szf162725  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
184609Szf162725  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
194609Szf162725  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
204609Szf162725  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
214609Szf162725  */
224609Szf162725 
234609Szf162725 /*
244609Szf162725  * Ralink Technology RT2560 chipset driver
254609Szf162725  * http://www.ralinktech.com/
264609Szf162725  */
274609Szf162725 
284609Szf162725 #include <sys/types.h>
294609Szf162725 #include <sys/byteorder.h>
304609Szf162725 #include <sys/conf.h>
314609Szf162725 #include <sys/cmn_err.h>
324609Szf162725 #include <sys/stat.h>
334609Szf162725 #include <sys/ddi.h>
344609Szf162725 #include <sys/sunddi.h>
354609Szf162725 #include <sys/strsubr.h>
364609Szf162725 #include <sys/ethernet.h>
374609Szf162725 #include <inet/common.h>
384609Szf162725 #include <inet/nd.h>
394609Szf162725 #include <inet/mi.h>
404609Szf162725 #include <sys/note.h>
414609Szf162725 #include <sys/stream.h>
424609Szf162725 #include <sys/strsun.h>
434609Szf162725 #include <sys/modctl.h>
444609Szf162725 #include <sys/devops.h>
454609Szf162725 #include <sys/dlpi.h>
464609Szf162725 #include <sys/mac.h>
474609Szf162725 #include <sys/mac_wifi.h>
484609Szf162725 #include <sys/net80211.h>
494609Szf162725 #include <sys/net80211_proto.h>
504609Szf162725 #include <sys/varargs.h>
514609Szf162725 #include <sys/policy.h>
524609Szf162725 #include <sys/pci.h>
534609Szf162725 #include <sys/crypto/common.h>
544609Szf162725 #include <sys/crypto/api.h>
554609Szf162725 #include <inet/wifi_ioctl.h>
564609Szf162725 
574609Szf162725 #include "ral_rate.h"
584609Szf162725 #include "rt2560_reg.h"
594609Szf162725 #include "rt2560_var.h"
604609Szf162725 
614609Szf162725 
624609Szf162725 static void *ral_soft_state_p = NULL;
634609Szf162725 
644609Szf162725 #define	RAL_TXBUF_SIZE  	(IEEE80211_MAX_LEN)
654609Szf162725 #define	RAL_RXBUF_SIZE  	(IEEE80211_MAX_LEN)
664609Szf162725 
674609Szf162725 /* quickly determine if a given rate is CCK or OFDM */
684609Szf162725 #define	RAL_RATE_IS_OFDM(rate)	((rate) >= 12 && (rate) != 22)
694609Szf162725 #define	RAL_ACK_SIZE		14	/* 10 + 4(FCS) */
704609Szf162725 #define	RAL_CTS_SIZE		14	/* 10 + 4(FCS) */
714609Szf162725 #define	RAL_SIFS		10	/* us */
724609Szf162725 #define	RT2560_TXRX_TURNAROUND	10	/* us */
734609Szf162725 
744609Szf162725 /*
754609Szf162725  * Supported rates for 802.11a/b/g modes (in 500Kbps unit).
764609Szf162725  */
774609Szf162725 static const struct ieee80211_rateset rt2560_rateset_11a =
784609Szf162725 	{ 8, { 12, 18, 24, 36, 48, 72, 96, 108 } };
794609Szf162725 
804609Szf162725 static const struct ieee80211_rateset rt2560_rateset_11b =
814609Szf162725 	{ 4, { 2, 4, 11, 22 } };
824609Szf162725 
834609Szf162725 static const struct ieee80211_rateset rt2560_rateset_11g =
844609Szf162725 	{ 12, { 2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108 } };
854609Szf162725 
864609Szf162725 static const struct {
874609Szf162725 	uint32_t	reg;
884609Szf162725 	uint32_t	val;
894609Szf162725 } rt2560_def_mac[] = {
904609Szf162725 	RT2560_DEF_MAC
914609Szf162725 };
924609Szf162725 
934609Szf162725 static const struct {
944609Szf162725 	uint8_t	reg;
954609Szf162725 	uint8_t	val;
964609Szf162725 } rt2560_def_bbp[] = {
974609Szf162725 	RT2560_DEF_BBP
984609Szf162725 };
994609Szf162725 
1004609Szf162725 static const uint32_t rt2560_rf2522_r2[]    = RT2560_RF2522_R2;
1014609Szf162725 static const uint32_t rt2560_rf2523_r2[]    = RT2560_RF2523_R2;
1024609Szf162725 static const uint32_t rt2560_rf2524_r2[]    = RT2560_RF2524_R2;
1034609Szf162725 static const uint32_t rt2560_rf2525_r2[]    = RT2560_RF2525_R2;
1044609Szf162725 static const uint32_t rt2560_rf2525_hi_r2[] = RT2560_RF2525_HI_R2;
1054609Szf162725 static const uint32_t rt2560_rf2525e_r2[]   = RT2560_RF2525E_R2;
1064609Szf162725 static const uint32_t rt2560_rf2526_r2[]    = RT2560_RF2526_R2;
1074609Szf162725 static const uint32_t rt2560_rf2526_hi_r2[] = RT2560_RF2526_HI_R2;
1084609Szf162725 
1094609Szf162725 static const struct {
1104609Szf162725 	uint8_t		chan;
1114609Szf162725 	uint32_t	r1, r2, r4;
1124609Szf162725 } rt2560_rf5222[] = {
1134609Szf162725 	RT2560_RF5222
1144609Szf162725 };
1154609Szf162725 
1164609Szf162725 /*
1174609Szf162725  * PIO access attributes for registers
1184609Szf162725  */
1194609Szf162725 static ddi_device_acc_attr_t ral_csr_accattr = {
1204609Szf162725 	DDI_DEVICE_ATTR_V0,
1214609Szf162725 	DDI_STRUCTURE_LE_ACC,
1224609Szf162725 	DDI_STRICTORDER_ACC
1234609Szf162725 };
1244609Szf162725 
1254609Szf162725 /*
1264609Szf162725  * DMA access attributes for descriptors: NOT to be byte swapped.
1274609Szf162725  */
1284609Szf162725 static ddi_device_acc_attr_t ral_desc_accattr = {
1294609Szf162725 	DDI_DEVICE_ATTR_V0,
1304609Szf162725 	DDI_STRUCTURE_LE_ACC,
1314609Szf162725 	DDI_STRICTORDER_ACC
1324609Szf162725 };
1334609Szf162725 
1344609Szf162725 /*
1354609Szf162725  * Describes the chip's DMA engine
1364609Szf162725  */
1374609Szf162725 static ddi_dma_attr_t ral_dma_attr = {
1384609Szf162725 	DMA_ATTR_V0,			/* dma_attr version */
1394609Szf162725 	0x0000000000000000ull,		/* dma_attr_addr_lo */
1406890Sql147931 	0xFFFFFFFF,			/* dma_attr_addr_hi */
1414609Szf162725 	0x00000000FFFFFFFFull,		/* dma_attr_count_max */
1424609Szf162725 	0x0000000000000001ull,		/* dma_attr_align */
1434609Szf162725 	0x00000FFF,			/* dma_attr_burstsizes */
1444609Szf162725 	0x00000001,			/* dma_attr_minxfer */
1454609Szf162725 	0x000000000000FFFFull,		/* dma_attr_maxxfer */
1464609Szf162725 	0xFFFFFFFFFFFFFFFFull,		/* dma_attr_seg */
1474609Szf162725 	1,				/* dma_attr_sgllen */
1484609Szf162725 	0x00000001,			/* dma_attr_granular */
1494609Szf162725 	0				/* dma_attr_flags */
1504609Szf162725 };
1514609Szf162725 
1524609Szf162725 /*
1534609Szf162725  * device operations
1544609Szf162725  */
1554609Szf162725 static int rt2560_attach(dev_info_t *, ddi_attach_cmd_t);
1564609Szf162725 static int rt2560_detach(dev_info_t *, ddi_detach_cmd_t);
1578099SQuaker.Fang@Sun.COM static int32_t rt2560_quiesce(dev_info_t *);
1584609Szf162725 
1594609Szf162725 /*
1604609Szf162725  * Module Loading Data & Entry Points
1614609Szf162725  */
1624609Szf162725 DDI_DEFINE_STREAM_OPS(ral_dev_ops, nulldev, nulldev, rt2560_attach,
1638099SQuaker.Fang@Sun.COM     rt2560_detach, nodev, NULL, D_MP, NULL, rt2560_quiesce);
1644609Szf162725 
1654609Szf162725 static struct modldrv ral_modldrv = {
1664609Szf162725 	&mod_driverops,		/* Type of module.  This one is a driver */
167*8230SQuaker.Fang@Sun.COM 	"Ralink RT2500 driver v1.6",	/* short description */
1684609Szf162725 	&ral_dev_ops		/* driver specific ops */
1694609Szf162725 };
1704609Szf162725 
1714609Szf162725 static struct modlinkage modlinkage = {
1724609Szf162725 	MODREV_1,
1734609Szf162725 	(void *)&ral_modldrv,
1744609Szf162725 	NULL
1754609Szf162725 };
1764609Szf162725 
1774609Szf162725 static int	rt2560_m_stat(void *,  uint_t, uint64_t *);
1784609Szf162725 static int	rt2560_m_start(void *);
1794609Szf162725 static void	rt2560_m_stop(void *);
1804609Szf162725 static int	rt2560_m_promisc(void *, boolean_t);
1814609Szf162725 static int	rt2560_m_multicst(void *, boolean_t, const uint8_t *);
1824609Szf162725 static int	rt2560_m_unicst(void *, const uint8_t *);
1834609Szf162725 static mblk_t	*rt2560_m_tx(void *, mblk_t *);
1844609Szf162725 static void	rt2560_m_ioctl(void *, queue_t *, mblk_t *);
1858099SQuaker.Fang@Sun.COM static int	rt2560_m_setprop(void *, const char *, mac_prop_id_t,
1868099SQuaker.Fang@Sun.COM     uint_t, const void *);
1878099SQuaker.Fang@Sun.COM static int	rt2560_m_getprop(void *, const char *, mac_prop_id_t,
1888118SVasumathi.Sundaram@Sun.COM     uint_t, uint_t, void *, uint_t *);
1894609Szf162725 
1904609Szf162725 static mac_callbacks_t rt2560_m_callbacks = {
1918099SQuaker.Fang@Sun.COM 	MC_IOCTL | MC_SETPROP | MC_GETPROP,
1924609Szf162725 	rt2560_m_stat,
1934609Szf162725 	rt2560_m_start,
1944609Szf162725 	rt2560_m_stop,
1954609Szf162725 	rt2560_m_promisc,
1964609Szf162725 	rt2560_m_multicst,
1974609Szf162725 	rt2560_m_unicst,
1984609Szf162725 	rt2560_m_tx,
1994609Szf162725 	NULL,		/* mc_resources; */
2004609Szf162725 	rt2560_m_ioctl,
2018099SQuaker.Fang@Sun.COM 	NULL,		/* mc_getcapab */
2028099SQuaker.Fang@Sun.COM 	NULL,
2038099SQuaker.Fang@Sun.COM 	NULL,
2048099SQuaker.Fang@Sun.COM 	rt2560_m_setprop,
2058099SQuaker.Fang@Sun.COM 	rt2560_m_getprop
2064609Szf162725 };
2074609Szf162725 
2084609Szf162725 uint32_t ral_dbg_flags = 0;
2094609Szf162725 
2104609Szf162725 void
2114609Szf162725 ral_debug(uint32_t dbg_flags, const int8_t *fmt, ...)
2124609Szf162725 {
2134609Szf162725 	va_list args;
2144609Szf162725 
2154609Szf162725 	if (dbg_flags & ral_dbg_flags) {
2164609Szf162725 		va_start(args, fmt);
2174609Szf162725 		vcmn_err(CE_CONT, fmt, args);
2184609Szf162725 		va_end(args);
2194609Szf162725 	}
2204609Szf162725 }
2214609Szf162725 
2224609Szf162725 static void
2234609Szf162725 rt2560_set_basicrates(struct rt2560_softc *sc)
2244609Szf162725 {
2254609Szf162725 	struct ieee80211com *ic = &sc->sc_ic;
2264609Szf162725 
2274609Szf162725 	/* update basic rate set */
2284609Szf162725 	if (ic->ic_curmode == IEEE80211_MODE_11B) {
2294609Szf162725 		/* 11b basic rates: 1, 2Mbps */
2304609Szf162725 		RAL_WRITE(sc, RT2560_ARSP_PLCP_1, 0x3);
2314609Szf162725 	} else if (IEEE80211_IS_CHAN_5GHZ(ic->ic_curchan)) {
2324609Szf162725 		/* 11a basic rates: 6, 12, 24Mbps */
2334609Szf162725 		RAL_WRITE(sc, RT2560_ARSP_PLCP_1, 0x150);
2344609Szf162725 	} else {
2354609Szf162725 		/* 11g basic rates: 1, 2, 5.5, 11, 6, 12, 24Mbps */
2364609Szf162725 		RAL_WRITE(sc, RT2560_ARSP_PLCP_1, 0x15f);
2374609Szf162725 	}
2384609Szf162725 }
2394609Szf162725 
2404609Szf162725 static void
2414609Szf162725 rt2560_update_led(struct rt2560_softc *sc, int led1, int led2)
2424609Szf162725 {
2434609Szf162725 	uint32_t tmp;
2444609Szf162725 
2454609Szf162725 	/* set ON period to 70ms and OFF period to 30ms */
2464609Szf162725 	tmp = led1 << 16 | led2 << 17 | 70 << 8 | 30;
2474609Szf162725 	RAL_WRITE(sc, RT2560_LEDCSR, tmp);
2484609Szf162725 }
2494609Szf162725 
2504609Szf162725 static void
2514609Szf162725 rt2560_set_bssid(struct rt2560_softc *sc, uint8_t *bssid)
2524609Szf162725 {
2534609Szf162725 	uint32_t tmp;
2544609Szf162725 
2554609Szf162725 	tmp = bssid[0] | bssid[1] << 8 | bssid[2] << 16 | bssid[3] << 24;
2564609Szf162725 	RAL_WRITE(sc, RT2560_CSR5, tmp);
2574609Szf162725 
2584609Szf162725 	tmp = bssid[4] | bssid[5] << 8;
2594609Szf162725 	RAL_WRITE(sc, RT2560_CSR6, tmp);
2604609Szf162725 
2614609Szf162725 	RAL_DEBUG(RAL_DBG_HW, "setting BSSID to " MACSTR "\n", MAC2STR(bssid));
2624609Szf162725 }
2634609Szf162725 
2644609Szf162725 
2654609Szf162725 static void
2664609Szf162725 rt2560_bbp_write(struct rt2560_softc *sc, uint8_t reg, uint8_t val)
2674609Szf162725 {
2684609Szf162725 	uint32_t tmp;
2694609Szf162725 	int ntries;
2704609Szf162725 
2714609Szf162725 	for (ntries = 0; ntries < 100; ntries++) {
2724609Szf162725 		if (!(RAL_READ(sc, RT2560_BBPCSR) & RT2560_BBP_BUSY))
2734609Szf162725 			break;
2744609Szf162725 		drv_usecwait(1);
2754609Szf162725 	}
2764609Szf162725 	if (ntries == 100) {
2774609Szf162725 		RAL_DEBUG(RAL_DBG_HW, "could not write to BBP\n");
2784609Szf162725 		return;
2794609Szf162725 	}
2804609Szf162725 
2814609Szf162725 	tmp = RT2560_BBP_WRITE | RT2560_BBP_BUSY | reg << 8 | val;
2824609Szf162725 	RAL_WRITE(sc, RT2560_BBPCSR, tmp);
2834609Szf162725 
2844609Szf162725 	RAL_DEBUG(RAL_DBG_HW, "BBP R%u <- 0x%02x\n", reg, val);
2854609Szf162725 }
2864609Szf162725 
2874609Szf162725 static uint8_t
2884609Szf162725 rt2560_bbp_read(struct rt2560_softc *sc, uint8_t reg)
2894609Szf162725 {
2904609Szf162725 	uint32_t val;
2914609Szf162725 	int ntries;
2924609Szf162725 
2934609Szf162725 	val = RT2560_BBP_BUSY | reg << 8;
2944609Szf162725 	RAL_WRITE(sc, RT2560_BBPCSR, val);
2954609Szf162725 
2964609Szf162725 	for (ntries = 0; ntries < 100; ntries++) {
2974609Szf162725 		val = RAL_READ(sc, RT2560_BBPCSR);
2984609Szf162725 		if (!(val & RT2560_BBP_BUSY))
2994609Szf162725 			return (val & 0xff);
3004609Szf162725 		drv_usecwait(1);
3014609Szf162725 	}
3024609Szf162725 
3034609Szf162725 	RAL_DEBUG(RAL_DBG_HW, "could not read from BBP\n");
3044609Szf162725 	return (0);
3054609Szf162725 }
3064609Szf162725 
3074609Szf162725 static void
3084609Szf162725 rt2560_rf_write(struct rt2560_softc *sc, uint8_t reg, uint32_t val)
3094609Szf162725 {
3104609Szf162725 	uint32_t tmp;
3114609Szf162725 	int ntries;
3124609Szf162725 
3134609Szf162725 	for (ntries = 0; ntries < 100; ntries++) {
3144609Szf162725 		if (!(RAL_READ(sc, RT2560_RFCSR) & RT2560_RF_BUSY))
3154609Szf162725 			break;
3164609Szf162725 		drv_usecwait(1);
3174609Szf162725 	}
3184609Szf162725 	if (ntries == 100) {
3194609Szf162725 		RAL_DEBUG(RAL_DBG_HW, "could not write to RF\n");
3204609Szf162725 		return;
3214609Szf162725 	}
3224609Szf162725 
3234609Szf162725 	tmp = RT2560_RF_BUSY | RT2560_RF_20BIT | (val & 0xfffff) << 2 |
3244609Szf162725 	    (reg & 0x3);
3254609Szf162725 	RAL_WRITE(sc, RT2560_RFCSR, tmp);
3264609Szf162725 
3274609Szf162725 	/* remember last written value in sc */
3284609Szf162725 	sc->rf_regs[reg] = val;
3294609Szf162725 
3304609Szf162725 	RAL_DEBUG(RAL_DBG_HW, "RF R[%u] <- 0x%05x\n", reg & 0x3, val & 0xfffff);
3314609Szf162725 }
3324609Szf162725 
3334609Szf162725 static void
3344609Szf162725 rt2560_set_chan(struct rt2560_softc *sc, struct ieee80211_channel *c)
3354609Szf162725 {
3364609Szf162725 	struct ieee80211com *ic = &sc->sc_ic;
3374609Szf162725 	uint8_t power, tmp;
3384609Szf162725 	uint_t i, chan;
3394609Szf162725 
3404609Szf162725 	chan = ieee80211_chan2ieee(ic, c);
3414609Szf162725 	if (chan == 0 || chan == IEEE80211_CHAN_ANY)
3424609Szf162725 		return;
3434609Szf162725 
3444609Szf162725 	if (IEEE80211_IS_CHAN_2GHZ(c))
3454609Szf162725 		power = min(sc->txpow[chan - 1], 31);
3464609Szf162725 	else
3474609Szf162725 		power = 31;
3484609Szf162725 
3494609Szf162725 	/* adjust txpower using ifconfig settings */
3504609Szf162725 	power -= (100 - ic->ic_txpowlimit) / 8;
3514609Szf162725 
3524609Szf162725 	RAL_DEBUG(RAL_DBG_CHAN, "setting channel to %u, txpower to %u\n",
3534609Szf162725 	    chan, power);
3544609Szf162725 
3554609Szf162725 	switch (sc->rf_rev) {
3564609Szf162725 	case RT2560_RF_2522:
3574609Szf162725 		rt2560_rf_write(sc, RAL_RF1, 0x00814);
3584609Szf162725 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf2522_r2[chan - 1]);
3594609Szf162725 		rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x00040);
3604609Szf162725 		break;
3614609Szf162725 
3624609Szf162725 	case RT2560_RF_2523:
3634609Szf162725 		rt2560_rf_write(sc, RAL_RF1, 0x08804);
3644609Szf162725 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf2523_r2[chan - 1]);
3654609Szf162725 		rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x38044);
3664609Szf162725 		rt2560_rf_write(sc, RAL_RF4, (chan == 14) ? 0x00280 : 0x00286);
3674609Szf162725 		break;
3684609Szf162725 
3694609Szf162725 	case RT2560_RF_2524:
3704609Szf162725 		rt2560_rf_write(sc, RAL_RF1, 0x0c808);
3714609Szf162725 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf2524_r2[chan - 1]);
3724609Szf162725 		rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x00040);
3734609Szf162725 		rt2560_rf_write(sc, RAL_RF4, (chan == 14) ? 0x00280 : 0x00286);
3744609Szf162725 		break;
3754609Szf162725 
3764609Szf162725 	case RT2560_RF_2525:
3774609Szf162725 		rt2560_rf_write(sc, RAL_RF1, 0x08808);
3784609Szf162725 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf2525_hi_r2[chan - 1]);
3794609Szf162725 		rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x18044);
3804609Szf162725 		rt2560_rf_write(sc, RAL_RF4, (chan == 14) ? 0x00280 : 0x00286);
3814609Szf162725 
3824609Szf162725 		rt2560_rf_write(sc, RAL_RF1, 0x08808);
3834609Szf162725 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf2525_r2[chan - 1]);
3844609Szf162725 		rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x18044);
3854609Szf162725 		rt2560_rf_write(sc, RAL_RF4, (chan == 14) ? 0x00280 : 0x00286);
3864609Szf162725 		break;
3874609Szf162725 
3884609Szf162725 	case RT2560_RF_2525E:
3894609Szf162725 		rt2560_rf_write(sc, RAL_RF1, 0x08808);
3904609Szf162725 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf2525e_r2[chan - 1]);
3914609Szf162725 		rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x18044);
3924609Szf162725 		rt2560_rf_write(sc, RAL_RF4, (chan == 14) ? 0x00286 : 0x00282);
3934609Szf162725 		break;
3944609Szf162725 
3954609Szf162725 	case RT2560_RF_2526:
3964609Szf162725 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf2526_hi_r2[chan - 1]);
3974609Szf162725 		rt2560_rf_write(sc, RAL_RF4, (chan & 1) ? 0x00386 : 0x00381);
3984609Szf162725 		rt2560_rf_write(sc, RAL_RF1, 0x08804);
3994609Szf162725 
4004609Szf162725 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf2526_r2[chan - 1]);
4014609Szf162725 		rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x18044);
4024609Szf162725 		rt2560_rf_write(sc, RAL_RF4, (chan & 1) ? 0x00386 : 0x00381);
4034609Szf162725 		break;
4044609Szf162725 
4054609Szf162725 	/* dual-band RF */
4064609Szf162725 	case RT2560_RF_5222:
4074609Szf162725 		for (i = 0; rt2560_rf5222[i].chan != chan; i++) {
4084609Szf162725 		}
4094609Szf162725 
4104609Szf162725 		rt2560_rf_write(sc, RAL_RF1, rt2560_rf5222[i].r1);
4114609Szf162725 		rt2560_rf_write(sc, RAL_RF2, rt2560_rf5222[i].r2);
4124609Szf162725 		rt2560_rf_write(sc, RAL_RF3, power << 7 | 0x00040);
4134609Szf162725 		rt2560_rf_write(sc, RAL_RF4, rt2560_rf5222[i].r4);
4144609Szf162725 		break;
4154609Szf162725 	}
4164609Szf162725 
4174609Szf162725 	if (ic->ic_state != IEEE80211_S_SCAN) {
4184609Szf162725 		/* set Japan filter bit for channel 14 */
4194609Szf162725 		tmp = rt2560_bbp_read(sc, 70);
4204609Szf162725 
4214609Szf162725 		tmp &= ~RT2560_JAPAN_FILTER;
4224609Szf162725 		if (chan == 14)
4234609Szf162725 			tmp |= RT2560_JAPAN_FILTER;
4244609Szf162725 
4254609Szf162725 		rt2560_bbp_write(sc, 70, tmp);
4264609Szf162725 
4274609Szf162725 		/* clear CRC errors */
4284609Szf162725 		(void) RAL_READ(sc, RT2560_CNT0);
4294609Szf162725 	}
4304609Szf162725 }
4314609Szf162725 
4324609Szf162725 /*
4334609Szf162725  * Refer to IEEE Std 802.11-1999 pp. 123 for more information on TSF
4344609Szf162725  * synchronization.
4354609Szf162725  */
4364609Szf162725 static void
4374609Szf162725 rt2560_enable_tsf_sync(struct rt2560_softc *sc)
4384609Szf162725 {
4394609Szf162725 	struct ieee80211com *ic = &sc->sc_ic;
4404609Szf162725 	uint16_t logcwmin, preload;
4414609Szf162725 	uint32_t tmp;
4424609Szf162725 
4434609Szf162725 	/* first, disable TSF synchronization */
4444609Szf162725 	RAL_WRITE(sc, RT2560_CSR14, 0);
4454609Szf162725 
4464609Szf162725 	tmp = 16 * ic->ic_bss->in_intval;
4474609Szf162725 	RAL_WRITE(sc, RT2560_CSR12, tmp);
4484609Szf162725 
4494609Szf162725 	RAL_WRITE(sc, RT2560_CSR13, 0);
4504609Szf162725 
4514609Szf162725 	logcwmin = 5;
4524609Szf162725 	preload = (ic->ic_opmode == IEEE80211_M_STA) ? 384 : 1024;
4534609Szf162725 	tmp = logcwmin << 16 | preload;
4544609Szf162725 	RAL_WRITE(sc, RT2560_BCNOCSR, tmp);
4554609Szf162725 
4564609Szf162725 	/* finally, enable TSF synchronization */
4574609Szf162725 	tmp = RT2560_ENABLE_TSF | RT2560_ENABLE_TBCN;
4584609Szf162725 	if (ic->ic_opmode == IEEE80211_M_STA)
4594609Szf162725 		tmp |= RT2560_ENABLE_TSF_SYNC(1);
4604609Szf162725 	else
4614609Szf162725 		tmp |= RT2560_ENABLE_TSF_SYNC(2) |
4624609Szf162725 		    RT2560_ENABLE_BEACON_GENERATOR;
4634609Szf162725 	RAL_WRITE(sc, RT2560_CSR14, tmp);
4644609Szf162725 
4654609Szf162725 	RAL_DEBUG(RAL_DBG_HW, "enabling TSF synchronization\n");
4664609Szf162725 }
4674609Szf162725 
4684609Szf162725 static void
4694609Szf162725 rt2560_update_plcp(struct rt2560_softc *sc)
4704609Szf162725 {
4714609Szf162725 	struct ieee80211com *ic = &sc->sc_ic;
4724609Szf162725 
4734609Szf162725 	/* no short preamble for 1Mbps */
4744609Szf162725 	RAL_WRITE(sc, RT2560_PLCP1MCSR, 0x00700400);
4754609Szf162725 
4764609Szf162725 	if (!(ic->ic_flags & IEEE80211_F_SHPREAMBLE)) {
4774609Szf162725 		/* values taken from the reference driver */
4784609Szf162725 		RAL_WRITE(sc, RT2560_PLCP2MCSR,   0x00380401);
4794609Szf162725 		RAL_WRITE(sc, RT2560_PLCP5p5MCSR, 0x00150402);
4804609Szf162725 		RAL_WRITE(sc, RT2560_PLCP11MCSR,  0x000b8403);
4814609Szf162725 	} else {
4824609Szf162725 		/* same values as above or'ed 0x8 */
4834609Szf162725 		RAL_WRITE(sc, RT2560_PLCP2MCSR,   0x00380409);
4844609Szf162725 		RAL_WRITE(sc, RT2560_PLCP5p5MCSR, 0x0015040a);
4854609Szf162725 		RAL_WRITE(sc, RT2560_PLCP11MCSR,  0x000b840b);
4864609Szf162725 	}
4874609Szf162725 
4884609Szf162725 	RAL_DEBUG(RAL_DBG_HW, "updating PLCP for %s preamble\n",
4894609Szf162725 	    (ic->ic_flags & IEEE80211_F_SHPREAMBLE) ? "short" : "long");
4904609Szf162725 }
4914609Szf162725 
4924609Szf162725 /*
4934609Szf162725  * This function can be called by ieee80211_set_shortslottime(). Refer to
4944609Szf162725  * IEEE Std 802.11-1999 pp. 85 to know how these values are computed.
4954609Szf162725  */
4964609Szf162725 void
4974609Szf162725 rt2560_update_slot(struct ieee80211com *ic, int onoff)
4984609Szf162725 {
4994609Szf162725 	struct rt2560_softc *sc = (struct rt2560_softc *)ic;
5004609Szf162725 	uint8_t slottime;
5014609Szf162725 	uint16_t tx_sifs, tx_pifs, tx_difs, eifs;
5024609Szf162725 	uint32_t tmp;
5034609Szf162725 
5044609Szf162725 	/* slottime = (ic->ic_flags & IEEE80211_F_SHSLOT) ? 9 : 20; */
5054609Szf162725 	slottime = (onoff ? 9 : 20);
5064609Szf162725 
5074609Szf162725 	/* update the MAC slot boundaries */
5084609Szf162725 	tx_sifs = RAL_SIFS - RT2560_TXRX_TURNAROUND;
5094609Szf162725 	tx_pifs = tx_sifs + slottime;
5104609Szf162725 	tx_difs = tx_sifs + 2 * slottime;
5114609Szf162725 	eifs = (ic->ic_curmode == IEEE80211_MODE_11B) ? 364 : 60;
5124609Szf162725 
5134609Szf162725 	tmp = RAL_READ(sc, RT2560_CSR11);
5144609Szf162725 	tmp = (tmp & ~0x1f00) | slottime << 8;
5154609Szf162725 	RAL_WRITE(sc, RT2560_CSR11, tmp);
5164609Szf162725 
5174609Szf162725 	tmp = tx_pifs << 16 | tx_sifs;
5184609Szf162725 	RAL_WRITE(sc, RT2560_CSR18, tmp);
5194609Szf162725 
5204609Szf162725 	tmp = eifs << 16 | tx_difs;
5214609Szf162725 	RAL_WRITE(sc, RT2560_CSR19, tmp);
5224609Szf162725 
5234609Szf162725 	RAL_DEBUG(RAL_DBG_HW, "setting slottime to %uus\n", slottime);
5244609Szf162725 }
5254609Szf162725 
5264609Szf162725 int
5274609Szf162725 ral_dma_region_alloc(struct rt2560_softc *sc, struct dma_region *dr,
5284609Szf162725     size_t size, uint_t alloc_flags, uint_t bind_flags)
5294609Szf162725 {
5304609Szf162725 	dev_info_t *dip = sc->sc_dev;
5314609Szf162725 	int err;
5324609Szf162725 
5334609Szf162725 	RAL_DEBUG(RAL_DBG_DMA, "ral_dma_region_alloc() size=%u\n", size);
5344609Szf162725 
5354609Szf162725 	err = ddi_dma_alloc_handle(dip, &ral_dma_attr, DDI_DMA_SLEEP, NULL,
5364609Szf162725 	    &dr->dr_hnd);
5374609Szf162725 	if (err != DDI_SUCCESS)
5384609Szf162725 		goto fail1;
5394609Szf162725 
5404609Szf162725 	err = ddi_dma_mem_alloc(dr->dr_hnd, size, &ral_desc_accattr,
5414609Szf162725 	    alloc_flags, DDI_DMA_SLEEP, NULL,
5424609Szf162725 	    &dr->dr_base, &dr->dr_size, &dr->dr_acc);
5434609Szf162725 	if (err != DDI_SUCCESS)
5444609Szf162725 		goto fail2;
5454609Szf162725 
5464609Szf162725 	err = ddi_dma_addr_bind_handle(dr->dr_hnd, NULL,
5474609Szf162725 	    dr->dr_base, dr->dr_size,
5484609Szf162725 	    bind_flags, DDI_DMA_SLEEP, NULL, &dr->dr_cookie, &dr->dr_ccnt);
5494609Szf162725 	if (err != DDI_SUCCESS)
5504609Szf162725 		goto fail3;
5514609Szf162725 
5524609Szf162725 	if (dr->dr_ccnt != 1) {
5534609Szf162725 		err = DDI_FAILURE;
5544609Szf162725 		goto fail4;
5554609Szf162725 	}
5564609Szf162725 
5574609Szf162725 	dr->dr_pbase = dr->dr_cookie.dmac_address;
5584609Szf162725 	RAL_DEBUG(RAL_DBG_DMA, "get physical-base=0x%08x\n", dr->dr_pbase);
5594609Szf162725 
5604609Szf162725 	return (DDI_SUCCESS);
5614609Szf162725 
5624609Szf162725 fail4:
5634609Szf162725 	(void) ddi_dma_unbind_handle(dr->dr_hnd);
5644609Szf162725 fail3:
5654609Szf162725 	ddi_dma_mem_free(&dr->dr_acc);
5664609Szf162725 fail2:
5674609Szf162725 	ddi_dma_free_handle(&dr->dr_hnd);
5684609Szf162725 fail1:
5694609Szf162725 	return (err);
5704609Szf162725 }
5714609Szf162725 
5724609Szf162725 /* ARGSUSED */
5734609Szf162725 void
5744609Szf162725 ral_dma_region_free(struct rt2560_softc *sc, struct dma_region *dr)
5754609Szf162725 {
5764609Szf162725 	(void) ddi_dma_unbind_handle(dr->dr_hnd);
5774609Szf162725 	ddi_dma_mem_free(&dr->dr_acc);
5784609Szf162725 	ddi_dma_free_handle(&dr->dr_hnd);
5794609Szf162725 }
5804609Szf162725 
5814609Szf162725 int
5824609Szf162725 rt2560_alloc_tx_ring(struct rt2560_softc *sc, struct rt2560_tx_ring *ring,
5834609Szf162725 	int count)
5844609Szf162725 {
5854609Szf162725 	int i, err;
5864609Szf162725 	int size;
5874609Szf162725 
5884609Szf162725 	ring->count = count;
5894609Szf162725 	ring->queued = 0;
5904609Szf162725 	ring->cur = ring->next = 0;
5914609Szf162725 	ring->cur_encrypt = ring->next_encrypt = 0;
5924609Szf162725 
5934609Szf162725 	ring->data = kmem_zalloc(count * (sizeof (struct rt2560_tx_data)),
5944609Szf162725 	    KM_SLEEP);
5954609Szf162725 	ring->dr_txbuf = kmem_zalloc(count * (sizeof (struct dma_region)),
5964609Szf162725 	    KM_SLEEP);
5974609Szf162725 
5984609Szf162725 	err = ral_dma_region_alloc(sc, &ring->dr_desc,
5994609Szf162725 	    count * (sizeof (struct rt2560_tx_desc)),
6004609Szf162725 	    DDI_DMA_CONSISTENT, DDI_DMA_RDWR | DDI_DMA_CONSISTENT);
6014609Szf162725 
6024609Szf162725 	if (err != DDI_SUCCESS)
6034609Szf162725 		goto fail1;
6044609Szf162725 
6054609Szf162725 	size = roundup(RAL_TXBUF_SIZE, sc->sc_cachelsz);
6064609Szf162725 	for (i = 0; i < count; i++) {
6074609Szf162725 		err = ral_dma_region_alloc(sc, &ring->dr_txbuf[i], size,
6084609Szf162725 		    DDI_DMA_STREAMING, DDI_DMA_WRITE | DDI_DMA_STREAMING);
6094609Szf162725 		if (err != DDI_SUCCESS) {
6104609Szf162725 			while (i >= 0) {
6114609Szf162725 				ral_dma_region_free(sc, &ring->dr_txbuf[i]);
6124609Szf162725 				i--;
6134609Szf162725 			}
6144609Szf162725 			goto fail2;
6154609Szf162725 		}
6164609Szf162725 	}
6174609Szf162725 
6184609Szf162725 	ring->physaddr = LE_32(ring->dr_desc.dr_pbase);
6194609Szf162725 	ring->desc = (struct rt2560_tx_desc *)ring->dr_desc.dr_base;
6204609Szf162725 
6214609Szf162725 	for (i = 0; i < count; i++) {
6224609Szf162725 		ring->desc[i].physaddr = LE_32(ring->dr_txbuf[i].dr_pbase);
6234609Szf162725 		ring->data[i].buf = ring->dr_txbuf[i].dr_base;
6244609Szf162725 	}
6254609Szf162725 
6264609Szf162725 	return (DDI_SUCCESS);
6274609Szf162725 fail2:
6284609Szf162725 	ral_dma_region_free(sc, &ring->dr_desc);
6294609Szf162725 fail1:
6304609Szf162725 	return (err);
6314609Szf162725 }
6324609Szf162725 
6334609Szf162725 /* ARGSUSED */
6344609Szf162725 void
6354609Szf162725 rt2560_reset_tx_ring(struct rt2560_softc *sc, struct rt2560_tx_ring *ring)
6364609Szf162725 {
6374609Szf162725 	struct rt2560_tx_desc *desc;
6384609Szf162725 	struct rt2560_tx_data *data;
6394609Szf162725 	int i;
6404609Szf162725 
6414609Szf162725 	for (i = 0; i < ring->count; i++) {
6424609Szf162725 		desc = &ring->desc[i];
6434609Szf162725 		data = &ring->data[i];
6444609Szf162725 
6454609Szf162725 		if (data->ni != NULL) {
6464609Szf162725 			ieee80211_free_node(data->ni);
6474609Szf162725 			data->ni = NULL;
6484609Szf162725 		}
6494609Szf162725 
6504609Szf162725 		desc->flags = 0;
6514609Szf162725 	}
6524609Szf162725 
6534609Szf162725 	(void) ddi_dma_sync(ring->dr_desc.dr_hnd, 0,
6544609Szf162725 	    ring->count * sizeof (struct rt2560_tx_desc), DDI_DMA_SYNC_FORDEV);
6554609Szf162725 
6564609Szf162725 	ring->queued = 0;
6574609Szf162725 	ring->cur = ring->next = 0;
6584609Szf162725 	ring->cur_encrypt = ring->next_encrypt = 0;
6594609Szf162725 }
6604609Szf162725 
6614609Szf162725 void
6624609Szf162725 rt2560_free_tx_ring(struct rt2560_softc *sc, struct rt2560_tx_ring *ring)
6634609Szf162725 {
6644609Szf162725 	struct rt2560_tx_data *data;
6654609Szf162725 	int i;
6664609Szf162725 
6674609Szf162725 	ral_dma_region_free(sc, &ring->dr_desc);
6684609Szf162725 	/* tx buf */
6694609Szf162725 	for (i = 0; i < ring->count; i++) {
6704609Szf162725 		data = &ring->data[i];
6714609Szf162725 		if (data->ni != NULL) {
6724609Szf162725 			ieee80211_free_node(data->ni);
6734609Szf162725 			data->ni = NULL;
6744609Szf162725 		}
6754609Szf162725 
6764609Szf162725 		ral_dma_region_free(sc, &ring->dr_txbuf[i]);
6774609Szf162725 	}
6784609Szf162725 
6794609Szf162725 	kmem_free(ring->data, ring->count * (sizeof (struct rt2560_tx_data)));
6804609Szf162725 	kmem_free(ring->dr_txbuf, ring->count * (sizeof (struct dma_region)));
6814609Szf162725 }
6824609Szf162725 
6834609Szf162725 void
6844609Szf162725 rt2560_ring_hwsetup(struct rt2560_softc *sc)
6854609Szf162725 {
6864609Szf162725 	uint32_t tmp;
6874609Szf162725 
6884609Szf162725 	/* setup tx rings */
6894609Szf162725 	tmp = ((uint32_t)RT2560_PRIO_RING_COUNT << 24) |
6904609Szf162725 	    RT2560_ATIM_RING_COUNT << 16 |
6914609Szf162725 	    RT2560_TX_RING_COUNT   <<  8 |
6924609Szf162725 	    RT2560_TX_DESC_SIZE;
6934609Szf162725 
6944609Szf162725 	/* rings must be initialized in this exact order */
6954609Szf162725 	RAL_WRITE(sc, RT2560_TXCSR2, tmp);
6964609Szf162725 	RAL_WRITE(sc, RT2560_TXCSR3, sc->txq.physaddr);
6974609Szf162725 	RAL_WRITE(sc, RT2560_TXCSR5, sc->prioq.physaddr);
6984609Szf162725 
6994609Szf162725 	/* setup rx ring */
7004609Szf162725 	tmp = RT2560_RX_RING_COUNT << 8 | RT2560_RX_DESC_SIZE;
7014609Szf162725 
7024609Szf162725 	RAL_WRITE(sc, RT2560_RXCSR1, tmp);
7034609Szf162725 	RAL_WRITE(sc, RT2560_RXCSR2, sc->rxq.physaddr);
7044609Szf162725 }
7054609Szf162725 
7064609Szf162725 int
7074609Szf162725 rt2560_alloc_rx_ring(struct rt2560_softc *sc, struct rt2560_rx_ring *ring,
7084609Szf162725 	int count)
7094609Szf162725 {
7104609Szf162725 	struct rt2560_rx_desc *desc;
7114609Szf162725 	struct rt2560_rx_data *data;
7124609Szf162725 	int i, err;
7134609Szf162725 	int size;
7144609Szf162725 
7154609Szf162725 	ring->count = count;
7164609Szf162725 	ring->cur = ring->next = 0;
7174609Szf162725 	ring->cur_decrypt = 0;
7184609Szf162725 
7194609Szf162725 	ring->data = kmem_zalloc(count * (sizeof (struct rt2560_rx_data)),
7204609Szf162725 	    KM_SLEEP);
7214609Szf162725 	ring->dr_rxbuf = kmem_zalloc(count * (sizeof (struct dma_region)),
7224609Szf162725 	    KM_SLEEP);
7234609Szf162725 
7244609Szf162725 	err = ral_dma_region_alloc(sc, &ring->dr_desc,
7254609Szf162725 	    count * (sizeof (struct rt2560_rx_desc)),
7264609Szf162725 	    DDI_DMA_CONSISTENT, DDI_DMA_RDWR | DDI_DMA_CONSISTENT);
7274609Szf162725 
7284609Szf162725 	if (err != DDI_SUCCESS)
7294609Szf162725 		goto fail1;
7304609Szf162725 
7314609Szf162725 	size = roundup(RAL_RXBUF_SIZE, sc->sc_cachelsz);
7324609Szf162725 	for (i = 0; i < count; i++) {
7334609Szf162725 		err = ral_dma_region_alloc(sc, &ring->dr_rxbuf[i], size,
7344609Szf162725 		    DDI_DMA_STREAMING, DDI_DMA_READ | DDI_DMA_STREAMING);
7354609Szf162725 		if (err != DDI_SUCCESS) {
7364609Szf162725 			while (i >= 0) {
7374609Szf162725 				ral_dma_region_free(sc, &ring->dr_rxbuf[i]);
7384609Szf162725 				i--;
7394609Szf162725 			}
7404609Szf162725 			goto fail2;
7414609Szf162725 		}
7424609Szf162725 	}
7434609Szf162725 
7444609Szf162725 	ring->physaddr = ring->dr_desc.dr_pbase;
7454609Szf162725 	ring->desc = (struct rt2560_rx_desc *)ring->dr_desc.dr_base;
7464609Szf162725 
7474609Szf162725 	for (i = 0; i < count; i++) {
7484609Szf162725 		desc = &ring->desc[i];
7494609Szf162725 		data = &ring->data[i];
7504609Szf162725 
7514609Szf162725 		desc->physaddr = LE_32(ring->dr_rxbuf[i].dr_pbase);
7524609Szf162725 		desc->flags = LE_32(RT2560_RX_BUSY);
7534609Szf162725 
7544609Szf162725 		data->buf = ring->dr_rxbuf[i].dr_base;
7554609Szf162725 	}
7564609Szf162725 
7574609Szf162725 	return (DDI_SUCCESS);
7584609Szf162725 fail2:
7594609Szf162725 	ral_dma_region_free(sc, &ring->dr_desc);
7604609Szf162725 fail1:
7614609Szf162725 	return (err);
7624609Szf162725 }
7634609Szf162725 
7644609Szf162725 /* ARGSUSED */
7654609Szf162725 static void
7664609Szf162725 rt2560_reset_rx_ring(struct rt2560_softc *sc, struct rt2560_rx_ring *ring)
7674609Szf162725 {
7684609Szf162725 	int i;
7694609Szf162725 
7704609Szf162725 	for (i = 0; i < ring->count; i++) {
7714609Szf162725 		ring->desc[i].flags = LE_32(RT2560_RX_BUSY);
7724609Szf162725 		ring->data[i].drop = 0;
7734609Szf162725 	}
7744609Szf162725 
7754609Szf162725 	(void) ddi_dma_sync(ring->dr_desc.dr_hnd, 0,
7764609Szf162725 	    ring->count * sizeof (struct rt2560_rx_desc),
7774609Szf162725 	    DDI_DMA_SYNC_FORKERNEL);
7784609Szf162725 
7794609Szf162725 	ring->cur = ring->next = 0;
7804609Szf162725 	ring->cur_decrypt = 0;
7814609Szf162725 }
7824609Szf162725 
7834609Szf162725 static void
7844609Szf162725 rt2560_free_rx_ring(struct rt2560_softc *sc, struct rt2560_rx_ring *ring)
7854609Szf162725 {
7864609Szf162725 	int i;
7874609Szf162725 
7884609Szf162725 	ral_dma_region_free(sc, &ring->dr_desc);
7894609Szf162725 	/* rx buf */
7904609Szf162725 	for (i = 0; i < ring->count; i++)
7914609Szf162725 		ral_dma_region_free(sc, &ring->dr_rxbuf[i]);
7924609Szf162725 
7934609Szf162725 	kmem_free(ring->data, ring->count * (sizeof (struct rt2560_rx_data)));
7944609Szf162725 	kmem_free(ring->dr_rxbuf, ring->count * (sizeof (struct dma_region)));
7954609Szf162725 }
7964609Szf162725 
7974609Szf162725 /* ARGSUSED */
7984609Szf162725 static struct ieee80211_node *
7994609Szf162725 rt2560_node_alloc(ieee80211com_t *ic)
8004609Szf162725 {
8014609Szf162725 	struct rt2560_node *rn;
8024609Szf162725 
8034609Szf162725 	rn = kmem_zalloc(sizeof (struct rt2560_node), KM_SLEEP);
8044609Szf162725 	return ((rn != NULL) ? &rn->ni : NULL);
8054609Szf162725 }
8064609Szf162725 
8074609Szf162725 static void
8084609Szf162725 rt2560_node_free(struct ieee80211_node *in)
8094609Szf162725 {
8104609Szf162725 	ieee80211com_t *ic = in->in_ic;
8114609Szf162725 
8124609Szf162725 	ic->ic_node_cleanup(in);
8134609Szf162725 	if (in->in_wpa_ie != NULL)
8144609Szf162725 		ieee80211_free(in->in_wpa_ie);
8154609Szf162725 	kmem_free(in, sizeof (struct rt2560_node));
8164609Szf162725 }
8174609Szf162725 
8184609Szf162725 /*
8194609Szf162725  * This function is called periodically (every 200ms) during scanning to
8204609Szf162725  * switch from one channel to another.
8214609Szf162725  */
8224609Szf162725 static void
8234609Szf162725 rt2560_next_scan(void *arg)
8244609Szf162725 {
8254609Szf162725 	struct rt2560_softc *sc = arg;
8264609Szf162725 	struct ieee80211com *ic = &sc->sc_ic;
8274609Szf162725 
8284609Szf162725 	if (ic->ic_state == IEEE80211_S_SCAN)
8294609Szf162725 		(void) ieee80211_next_scan(ic);
8304609Szf162725 }
8314609Szf162725 
8324609Szf162725 /*
8334609Szf162725  * This function is called for each node present in the node station table.
8344609Szf162725  */
8354609Szf162725 /* ARGSUSED */
8364609Szf162725 static void
8374609Szf162725 rt2560_iter_func(void *arg, struct ieee80211_node *ni)
8384609Szf162725 {
8394609Szf162725 	struct rt2560_node *rn = (struct rt2560_node *)ni;
8404609Szf162725 
8414609Szf162725 	ral_rssadapt_updatestats(&rn->rssadapt);
8424609Szf162725 }
8434609Szf162725 
8444609Szf162725 /*
8454609Szf162725  * This function is called periodically (every 100ms) in RUN state to update
8464609Szf162725  * the rate adaptation statistics.
8474609Szf162725  */
8484609Szf162725 static void
8494609Szf162725 rt2560_update_rssadapt(void *arg)
8504609Szf162725 {
8514609Szf162725 	struct rt2560_softc *sc = arg;
8524609Szf162725 	struct ieee80211com *ic = &sc->sc_ic;
8534609Szf162725 
8544609Szf162725 	ieee80211_iterate_nodes(&ic->ic_sta, rt2560_iter_func, arg);
8554609Szf162725 	sc->sc_rssadapt_id = timeout(rt2560_update_rssadapt, (void *)sc,
8564609Szf162725 	    drv_usectohz(100 * 1000));
8574609Szf162725 }
8584609Szf162725 
8594609Szf162725 static void
8604609Szf162725 rt2560_statedog(void *arg)
8614609Szf162725 {
8624609Szf162725 	struct rt2560_softc *sc = arg;
8634609Szf162725 	struct ieee80211com *ic = &sc->sc_ic;
8644609Szf162725 	enum ieee80211_state state;
8654609Szf162725 
8664609Szf162725 	RAL_LOCK(sc);
8674609Szf162725 
8684609Szf162725 	RAL_DEBUG(RAL_DBG_MSG, "rt2560_statedog(...)\n");
8694609Szf162725 
8704609Szf162725 	sc->sc_state_id = 0;
8714609Szf162725 	state = ic->ic_state;
8724609Szf162725 	ic->ic_state = sc->sc_ostate;
8734609Szf162725 
8744609Szf162725 	RAL_UNLOCK(sc);
8754609Szf162725 
8764609Szf162725 	ieee80211_new_state(ic, state, -1);
8774609Szf162725 
8784609Szf162725 }
8794609Szf162725 
8804609Szf162725 static int
8814609Szf162725 rt2560_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg)
8824609Szf162725 {
8834609Szf162725 	struct rt2560_softc *sc = (struct rt2560_softc *)ic;
8844609Szf162725 	enum ieee80211_state ostate;
8854609Szf162725 	struct ieee80211_node *ni;
8864609Szf162725 	int err;
8874609Szf162725 
8884609Szf162725 	RAL_LOCK(sc);
8894609Szf162725 
8904609Szf162725 	ostate = ic->ic_state;
8914609Szf162725 	sc->sc_ostate = ostate;
8924609Szf162725 
8934609Szf162725 	if (sc->sc_scan_id != 0) {
8944609Szf162725 		(void) untimeout(sc->sc_scan_id);
8954609Szf162725 		sc->sc_scan_id = 0;
8964609Szf162725 	}
8974609Szf162725 
8984609Szf162725 	if (sc->sc_rssadapt_id != 0) {
8994609Szf162725 		(void) untimeout(sc->sc_rssadapt_id);
9004609Szf162725 		sc->sc_rssadapt_id = 0;
9014609Szf162725 	}
9024609Szf162725 
9034609Szf162725 	if (sc->sc_state_id != 0) {
9044609Szf162725 		(void) untimeout(sc->sc_state_id);
9054609Szf162725 		sc->sc_state_id = 0;
9064609Szf162725 	}
9074609Szf162725 
9084609Szf162725 	switch (nstate) {
9094609Szf162725 	case IEEE80211_S_INIT:
9104609Szf162725 		if (ostate == IEEE80211_S_RUN) {
9114609Szf162725 			/* abort TSF synchronization */
9124609Szf162725 			RAL_WRITE(sc, RT2560_CSR14, 0);
9134609Szf162725 			/* turn association led off */
9144609Szf162725 			rt2560_update_led(sc, 0, 0);
9154609Szf162725 		}
9164609Szf162725 		break;
9174609Szf162725 
9184609Szf162725 	case IEEE80211_S_SCAN:
9194609Szf162725 		rt2560_set_chan(sc, ic->ic_curchan);
9204609Szf162725 		sc->sc_scan_id = timeout(rt2560_next_scan, (void *)sc,
9214609Szf162725 		    drv_usectohz(sc->dwelltime * 1000));
9224609Szf162725 		break;
9234609Szf162725 
9244609Szf162725 	case IEEE80211_S_AUTH:
9254609Szf162725 		RAL_DEBUG(RAL_DBG_STATE, "-> IEEE80211_S_AUTH ...\n");
9264609Szf162725 		rt2560_set_chan(sc, ic->ic_curchan);
9274609Szf162725 		break;
9284609Szf162725 
9294609Szf162725 	case IEEE80211_S_ASSOC:
9304609Szf162725 		RAL_DEBUG(RAL_DBG_STATE, "-> IEEE80211_S_ASSOC ...\n");
9314609Szf162725 		rt2560_set_chan(sc, ic->ic_curchan);
9324609Szf162725 
9334609Szf162725 		drv_usecwait(10 * 1000);	/* dlink */
9344609Szf162725 		sc->sc_state_id = timeout(rt2560_statedog, (void *)sc,
9354609Szf162725 		    drv_usectohz(300 * 1000));	/* ap7-3 */
9364609Szf162725 		break;
9374609Szf162725 
9384609Szf162725 	case IEEE80211_S_RUN:
9394609Szf162725 		RAL_DEBUG(RAL_DBG_STATE, "-> IEEE80211_S_RUN ...\n");
9404609Szf162725 		rt2560_set_chan(sc, ic->ic_curchan);
9414609Szf162725 
9424609Szf162725 		ni = ic->ic_bss;
9434609Szf162725 
9444609Szf162725 		if (ic->ic_opmode != IEEE80211_M_MONITOR) {
9454609Szf162725 			rt2560_update_plcp(sc);
9464609Szf162725 			rt2560_set_basicrates(sc);
9474609Szf162725 			rt2560_set_bssid(sc, ni->in_bssid);
9484609Szf162725 		}
9494609Szf162725 
9504609Szf162725 		/* turn assocation led on */
9514609Szf162725 		rt2560_update_led(sc, 1, 0);
9524609Szf162725 		if (ic->ic_opmode != IEEE80211_M_MONITOR) {
9534609Szf162725 			sc->sc_rssadapt_id = timeout(rt2560_update_rssadapt,
9544609Szf162725 			    (void *)sc, drv_usectohz(100 * 1000));
9554609Szf162725 			rt2560_enable_tsf_sync(sc);
9564609Szf162725 		}
9574609Szf162725 		break;
9584609Szf162725 	}
9594609Szf162725 
9604609Szf162725 	RAL_UNLOCK(sc);
9614609Szf162725 
9624609Szf162725 	err = sc->sc_newstate(ic, nstate, arg);
9634609Szf162725 	/*
9644609Szf162725 	 * Finally, start any timers.
9654609Szf162725 	 */
9664609Szf162725 	if (nstate == IEEE80211_S_RUN)
9674609Szf162725 		ieee80211_start_watchdog(ic, 1);
9684609Szf162725 
9694609Szf162725 	return (err);
9704609Szf162725 }
9714609Szf162725 
9724609Szf162725 /*
9734609Szf162725  * Read 16 bits at address 'addr' from the serial EEPROM (either 93C46 or
9744609Szf162725  * 93C66).
9754609Szf162725  */
9764609Szf162725 static uint16_t
9774609Szf162725 rt2560_eeprom_read(struct rt2560_softc *sc, uint8_t addr)
9784609Szf162725 {
9794609Szf162725 	uint32_t tmp;
9804609Szf162725 	uint16_t val;
9814609Szf162725 	int n;
9824609Szf162725 
9834609Szf162725 	/* clock C once before the first command */
9844609Szf162725 	RT2560_EEPROM_CTL(sc, 0);
9854609Szf162725 
9864609Szf162725 	RT2560_EEPROM_CTL(sc, RT2560_S);
9874609Szf162725 	RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_C);
9884609Szf162725 	RT2560_EEPROM_CTL(sc, RT2560_S);
9894609Szf162725 
9904609Szf162725 	/* write start bit (1) */
9914609Szf162725 	RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_D);
9924609Szf162725 	RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_D | RT2560_C);
9934609Szf162725 
9944609Szf162725 	/* write READ opcode (10) */
9954609Szf162725 	RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_D);
9964609Szf162725 	RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_D | RT2560_C);
9974609Szf162725 	RT2560_EEPROM_CTL(sc, RT2560_S);
9984609Szf162725 	RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_C);
9994609Szf162725 
10004609Szf162725 	/* write address (A5-A0 or A7-A0) */
10014609Szf162725 	n = (RAL_READ(sc, RT2560_CSR21) & RT2560_93C46) ? 5 : 7;
10024609Szf162725 	for (; n >= 0; n--) {
10034609Szf162725 		RT2560_EEPROM_CTL(sc, RT2560_S |
10044609Szf162725 		    (((addr >> n) & 1) << RT2560_SHIFT_D));
10054609Szf162725 		RT2560_EEPROM_CTL(sc, RT2560_S |
10064609Szf162725 		    (((addr >> n) & 1) << RT2560_SHIFT_D) | RT2560_C);
10074609Szf162725 	}
10084609Szf162725 
10094609Szf162725 	RT2560_EEPROM_CTL(sc, RT2560_S);
10104609Szf162725 
10114609Szf162725 	/* read data Q15-Q0 */
10124609Szf162725 	val = 0;
10134609Szf162725 	for (n = 15; n >= 0; n--) {
10144609Szf162725 		RT2560_EEPROM_CTL(sc, RT2560_S | RT2560_C);
10154609Szf162725 		tmp = RAL_READ(sc, RT2560_CSR21);
10164609Szf162725 		val |= ((tmp & RT2560_Q) >> RT2560_SHIFT_Q) << n;
10174609Szf162725 		RT2560_EEPROM_CTL(sc, RT2560_S);
10184609Szf162725 	}
10194609Szf162725 
10204609Szf162725 	RT2560_EEPROM_CTL(sc, 0);
10214609Szf162725 
10224609Szf162725 	/* clear Chip Select and clock C */
10234609Szf162725 	RT2560_EEPROM_CTL(sc, RT2560_S);
10244609Szf162725 	RT2560_EEPROM_CTL(sc, 0);
10254609Szf162725 	RT2560_EEPROM_CTL(sc, RT2560_C);
10264609Szf162725 
10274609Szf162725 	return (val);
10284609Szf162725 }
10294609Szf162725 
10304609Szf162725 static void
10314609Szf162725 rt2560_tx_intr(struct rt2560_softc *sc)
10324609Szf162725 {
10334609Szf162725 	struct ieee80211com *ic = &sc->sc_ic;
10344609Szf162725 	struct rt2560_tx_desc *desc;
10354609Szf162725 	struct rt2560_tx_data *data;
10364609Szf162725 	struct rt2560_node *rn;
10374609Szf162725 
10384609Szf162725 	struct dma_region *dr;
10394609Szf162725 	int count;
10404609Szf162725 
10414609Szf162725 	dr = &sc->txq.dr_desc;
10424609Szf162725 	count = sc->txq.count;
10434609Szf162725 
10444609Szf162725 	(void) ddi_dma_sync(dr->dr_hnd, 0, count * RT2560_TX_DESC_SIZE,
10454609Szf162725 	    DDI_DMA_SYNC_FORKERNEL);
10464609Szf162725 
10474609Szf162725 	mutex_enter(&sc->txq.tx_lock);
10484609Szf162725 
10494609Szf162725 	for (;;) {
10504609Szf162725 		desc = &sc->txq.desc[sc->txq.next];
10514609Szf162725 		data = &sc->txq.data[sc->txq.next];
10524609Szf162725 
10534609Szf162725 		if ((LE_32(desc->flags) & RT2560_TX_BUSY) ||
10544609Szf162725 		    (LE_32(desc->flags) & RT2560_TX_CIPHER_BUSY) ||
10554609Szf162725 		    !(LE_32(desc->flags) & RT2560_TX_VALID))
10564609Szf162725 			break;
10574609Szf162725 
10584609Szf162725 		rn = (struct rt2560_node *)data->ni;
10594609Szf162725 
10604609Szf162725 		switch (LE_32(desc->flags) & RT2560_TX_RESULT_MASK) {
10614609Szf162725 		case RT2560_TX_SUCCESS:
10624609Szf162725 			RAL_DEBUG(RAL_DBG_INTR, "data frame sent success\n");
10634609Szf162725 			if (data->id.id_node != NULL) {
10644609Szf162725 				ral_rssadapt_raise_rate(ic, &rn->rssadapt,
10654609Szf162725 				    &data->id);
10664609Szf162725 			}
10674609Szf162725 			break;
10684609Szf162725 
10694609Szf162725 		case RT2560_TX_SUCCESS_RETRY:
10704609Szf162725 			RAL_DEBUG(RAL_DBG_INTR,
10714609Szf162725 			    "data frame sent after %u retries\n",
10724609Szf162725 			    (LE_32(desc->flags) >> 5) & 0x7);
10734609Szf162725 			sc->sc_tx_retries++;
10744609Szf162725 			break;
10754609Szf162725 
10764609Szf162725 		case RT2560_TX_FAIL_RETRY:
10774609Szf162725 			RAL_DEBUG(RAL_DBG_INTR,
10784609Szf162725 			    "sending data frame failed (too much retries)\n");
10794609Szf162725 			if (data->id.id_node != NULL) {
10804609Szf162725 				ral_rssadapt_lower_rate(ic, data->ni,
10814609Szf162725 				    &rn->rssadapt, &data->id);
10824609Szf162725 			}
10834609Szf162725 			break;
10844609Szf162725 
10854609Szf162725 		case RT2560_TX_FAIL_INVALID:
10864609Szf162725 		case RT2560_TX_FAIL_OTHER:
10874609Szf162725 		default:
10884609Szf162725 			RAL_DEBUG(RAL_DBG_INTR, "sending data frame failed "
10894609Szf162725 			    "0x%08x\n", LE_32(desc->flags));
10904609Szf162725 			break;
10914609Szf162725 		}
10924609Szf162725 
10934609Szf162725 		ieee80211_free_node(data->ni);
10944609Szf162725 		data->ni = NULL;
10954609Szf162725 
10964609Szf162725 		/* descriptor is no longer valid */
10974609Szf162725 		desc->flags &= ~LE_32(RT2560_TX_VALID);
10984609Szf162725 
10994609Szf162725 		RAL_DEBUG(RAL_DBG_INTR, "tx done idx=%u\n", sc->txq.next);
11004609Szf162725 
11014609Szf162725 		sc->txq.queued--;
11024609Szf162725 		sc->txq.next = (sc->txq.next + 1) % RT2560_TX_RING_COUNT;
11034609Szf162725 
11044609Szf162725 		if (sc->sc_need_sched &&
11054609Szf162725 		    sc->txq.queued < (RT2560_TX_RING_COUNT - 32)) {
11064609Szf162725 			sc->sc_need_sched = 0;
11074609Szf162725 			mac_tx_update(ic->ic_mach);
11084609Szf162725 		}
11094609Szf162725 	}
11104609Szf162725 
11114609Szf162725 	(void) ddi_dma_sync(dr->dr_hnd, 0, count * RT2560_TX_DESC_SIZE,
11124609Szf162725 	    DDI_DMA_SYNC_FORDEV);
11134609Szf162725 
11144609Szf162725 	sc->sc_tx_timer = 0;
11154609Szf162725 	mutex_exit(&sc->txq.tx_lock);
11164609Szf162725 }
11174609Szf162725 
11184609Szf162725 static void
11194609Szf162725 rt2560_prio_intr(struct rt2560_softc *sc)
11204609Szf162725 {
11214609Szf162725 	struct rt2560_tx_desc *desc;
11224609Szf162725 	struct rt2560_tx_data *data;
11234609Szf162725 
11244609Szf162725 	struct dma_region *dr;
11254609Szf162725 	int count;
11264609Szf162725 
11274609Szf162725 	dr = &sc->prioq.dr_desc;
11284609Szf162725 	count = sc->prioq.count;
11294609Szf162725 
11304609Szf162725 	(void) ddi_dma_sync(dr->dr_hnd, 0, count * RT2560_TX_DESC_SIZE,
11314609Szf162725 	    DDI_DMA_SYNC_FORKERNEL);
11324609Szf162725 
11334609Szf162725 	mutex_enter(&sc->prioq.tx_lock);
11344609Szf162725 
11354609Szf162725 	for (;;) {
11364609Szf162725 		desc = &sc->prioq.desc[sc->prioq.next];
11374609Szf162725 		data = &sc->prioq.data[sc->prioq.next];
11384609Szf162725 
11394609Szf162725 		if ((LE_32(desc->flags) & RT2560_TX_BUSY) ||
11404609Szf162725 		    !(LE_32(desc->flags) & RT2560_TX_VALID))
11414609Szf162725 			break;
11424609Szf162725 
11434609Szf162725 		switch (LE_32(desc->flags) & RT2560_TX_RESULT_MASK) {
11444609Szf162725 		case RT2560_TX_SUCCESS:
11454609Szf162725 			RAL_DEBUG(RAL_DBG_INTR, "mgt frame sent success\n");
11464609Szf162725 			break;
11474609Szf162725 
11484609Szf162725 		case RT2560_TX_SUCCESS_RETRY:
11494609Szf162725 			RAL_DEBUG(RAL_DBG_INTR,
11504609Szf162725 			    "mgt frame sent after %u retries\n",
11514609Szf162725 			    (LE_32(desc->flags) >> 5) & 0x7);
11524609Szf162725 			break;
11534609Szf162725 
11544609Szf162725 		case RT2560_TX_FAIL_RETRY:
11554609Szf162725 			RAL_DEBUG(RAL_DBG_INTR,
11564609Szf162725 			    "sending mgt frame failed (too much " "retries)\n");
11574609Szf162725 			break;
11584609Szf162725 
11594609Szf162725 		case RT2560_TX_FAIL_INVALID:
11604609Szf162725 		case RT2560_TX_FAIL_OTHER:
11614609Szf162725 		default:
11624609Szf162725 			RAL_DEBUG(RAL_DBG_INTR, "sending mgt frame failed "
11634609Szf162725 			    "0x%08x\n", LE_32(desc->flags));
11644609Szf162725 		}
11654609Szf162725 
11664609Szf162725 		ieee80211_free_node(data->ni);
11674609Szf162725 		data->ni = NULL;
11684609Szf162725 
11694609Szf162725 		/* descriptor is no longer valid */
11704609Szf162725 		desc->flags &= ~LE_32(RT2560_TX_VALID);
11714609Szf162725 
11724609Szf162725 		RAL_DEBUG(RAL_DBG_INTR, "prio done idx=%u\n", sc->prioq.next);
11734609Szf162725 
11744609Szf162725 		sc->prioq.queued--;
11754609Szf162725 		sc->prioq.next = (sc->prioq.next + 1) % RT2560_PRIO_RING_COUNT;
11764609Szf162725 	}
11774609Szf162725 
11784609Szf162725 	(void) ddi_dma_sync(dr->dr_hnd, 0, count * RT2560_TX_DESC_SIZE,
11794609Szf162725 	    DDI_DMA_SYNC_FORDEV);
11804609Szf162725 
11814609Szf162725 	sc->sc_tx_timer = 0;
11824609Szf162725 	mutex_exit(&sc->prioq.tx_lock);
11834609Szf162725 }
11844609Szf162725 
11854609Szf162725 /*
11864609Szf162725  * Some frames were received. Pass them to the hardware cipher engine before
11874609Szf162725  * sending them to the 802.11 layer.
11884609Szf162725  */
11894609Szf162725 void
11904609Szf162725 rt2560_rx_intr(struct rt2560_softc *sc)
11914609Szf162725 {
11924609Szf162725 	struct ieee80211com *ic = &sc->sc_ic;
11934609Szf162725 	struct rt2560_rx_desc *desc;
11944609Szf162725 	struct rt2560_rx_data *data;
11954609Szf162725 	struct ieee80211_frame *wh;
11964609Szf162725 	struct ieee80211_node *ni;
11974609Szf162725 	struct rt2560_node *rn;
11984609Szf162725 
11994609Szf162725 	mblk_t *m;
12004609Szf162725 	uint32_t len;
12014609Szf162725 	char *rxbuf;
12024609Szf162725 
12034609Szf162725 	struct dma_region *dr, *dr_bf;
12044609Szf162725 	int count;
12054609Szf162725 
12064609Szf162725 	dr = &sc->rxq.dr_desc;
12074609Szf162725 	count = sc->rxq.count;
12084609Szf162725 
12094609Szf162725 	mutex_enter(&sc->rxq.rx_lock);
12104609Szf162725 
12114609Szf162725 	(void) ddi_dma_sync(dr->dr_hnd, 0, count * RT2560_RX_DESC_SIZE,
12124609Szf162725 	    DDI_DMA_SYNC_FORKERNEL);
12134609Szf162725 
12144609Szf162725 	for (;;) {
12154609Szf162725 		desc = &sc->rxq.desc[sc->rxq.cur];
12164609Szf162725 		data = &sc->rxq.data[sc->rxq.cur];
12174609Szf162725 
12184609Szf162725 		if ((LE_32(desc->flags) & RT2560_RX_BUSY) ||
12194609Szf162725 		    (LE_32(desc->flags) & RT2560_RX_CIPHER_BUSY))
12204609Szf162725 			break;
12214609Szf162725 
12224609Szf162725 		data->drop = 0;
12234609Szf162725 
12244609Szf162725 		if ((LE_32(desc->flags) & RT2560_RX_PHY_ERROR) ||
12254609Szf162725 		    (LE_32(desc->flags) & RT2560_RX_CRC_ERROR)) {
12264609Szf162725 			/*
12274609Szf162725 			 * This should not happen since we did not request
12284609Szf162725 			 * to receive those frames when we filled RXCSR0.
12294609Szf162725 			 */
12304609Szf162725 			RAL_DEBUG(RAL_DBG_RX, "PHY or CRC error flags 0x%08x\n",
12314609Szf162725 			    LE_32(desc->flags));
12324609Szf162725 			data->drop = 1;
12334609Szf162725 		}
12344609Szf162725 
12354609Szf162725 		if (((LE_32(desc->flags) >> 16) & 0xfff) > RAL_RXBUF_SIZE) {
12364609Szf162725 			RAL_DEBUG(RAL_DBG_RX, "bad length\n");
12374609Szf162725 			data->drop = 1;
12384609Szf162725 		}
12394609Szf162725 
12404609Szf162725 		if (data->drop) {
12414609Szf162725 			sc->sc_rx_err++;
12424609Szf162725 			goto skip;
12434609Szf162725 		}
12444609Szf162725 
12454609Szf162725 		rxbuf = data->buf;
12464609Szf162725 		len = (LE_32(desc->flags) >> 16) & 0xfff;
12474609Szf162725 
12484609Szf162725 		if ((len < sizeof (struct ieee80211_frame_min)) ||
12494609Szf162725 		    (len > RAL_RXBUF_SIZE)) {
12504609Szf162725 			RAL_DEBUG(RAL_DBG_RX, "bad frame length=%u\n", len);
12514609Szf162725 			sc->sc_rx_err++;
12524609Szf162725 			goto skip;
12534609Szf162725 		}
12544609Szf162725 
12554609Szf162725 		if ((m = allocb(len, BPRI_MED)) == NULL) {
12564609Szf162725 			RAL_DEBUG(RAL_DBG_RX, "rt2560_rx_intr():"
12574609Szf162725 			    " allocate mblk failed.\n");
12584609Szf162725 			sc->sc_rx_nobuf++;
12594609Szf162725 			goto skip;
12604609Szf162725 		}
12614609Szf162725 
12624609Szf162725 		dr_bf = &sc->rxq.dr_rxbuf[sc->rxq.cur];
12634609Szf162725 		(void) ddi_dma_sync(dr_bf->dr_hnd, 0, dr_bf->dr_size,
12644609Szf162725 		    DDI_DMA_SYNC_FORCPU);
12654609Szf162725 
12664609Szf162725 		bcopy(rxbuf, m->b_rptr, len);
12674609Szf162725 		m->b_wptr += len;
12684609Szf162725 
12694609Szf162725 		wh = (struct ieee80211_frame *)m->b_rptr;
12704609Szf162725 		ni = ieee80211_find_rxnode(ic, wh);
12714609Szf162725 
12724609Szf162725 		/* give rssi to the rate adatation algorithm */
12734609Szf162725 		rn = (struct rt2560_node *)ni;
12744609Szf162725 		ral_rssadapt_input(ic, ni, &rn->rssadapt, desc->rssi);
12754609Szf162725 
12764609Szf162725 		/* send the frame to the 802.11 layer */
12774609Szf162725 		(void) ieee80211_input(ic, m, ni, desc->rssi, 0);
12784609Szf162725 
12794609Szf162725 		/* node is no longer needed */
12804609Szf162725 		ieee80211_free_node(ni);
12814609Szf162725 
12824609Szf162725 skip:		desc->flags = LE_32(RT2560_RX_BUSY);
12834609Szf162725 		RAL_DEBUG(RAL_DBG_RX, "rx done idx=%u\n", sc->rxq.cur);
12844609Szf162725 
12854609Szf162725 		sc->rxq.cur = (sc->rxq.cur + 1) % RT2560_RX_RING_COUNT;
12864609Szf162725 	}
12874609Szf162725 	mutex_exit(&sc->rxq.rx_lock);
12884609Szf162725 
12894609Szf162725 	(void) ddi_dma_sync(dr->dr_hnd, 0, count * RT2560_TX_DESC_SIZE,
12904609Szf162725 	    DDI_DMA_SYNC_FORDEV);
12914609Szf162725 }
12924609Szf162725 
12934609Szf162725 uint_t
12944609Szf162725 ral_softint_handler(caddr_t data)
12954609Szf162725 {
12967249Sff224033 	/* LINTED E_BAD_PTR_CAST_ALIGN */
12974609Szf162725 	struct rt2560_softc *sc = (struct rt2560_softc *)data;
12984609Szf162725 
12994609Szf162725 	/*
13004609Szf162725 	 * Check if the soft interrupt is triggered by another
13014609Szf162725 	 * driver at the same level.
13024609Szf162725 	 */
13034609Szf162725 	RAL_LOCK(sc);
13044609Szf162725 	if (sc->sc_rx_pend) {
13054609Szf162725 		sc->sc_rx_pend = 0;
13064609Szf162725 		RAL_UNLOCK(sc);
13077249Sff224033 		rt2560_rx_intr(sc);
13084609Szf162725 		return (DDI_INTR_CLAIMED);
13094609Szf162725 	}
13104609Szf162725 	RAL_UNLOCK(sc);
13114609Szf162725 	return (DDI_INTR_UNCLAIMED);
13124609Szf162725 }
13134609Szf162725 
13144609Szf162725 /*
13154609Szf162725  * Return the expected ack rate for a frame transmitted at rate `rate'.
13164609Szf162725  * XXX: this should depend on the destination node basic rate set.
13174609Szf162725  */
13184609Szf162725 static int
13194609Szf162725 rt2560_ack_rate(struct ieee80211com *ic, int rate)
13204609Szf162725 {
13214609Szf162725 	switch (rate) {
13224609Szf162725 	/* CCK rates */
13234609Szf162725 	case 2:
13244609Szf162725 		return (2);
13254609Szf162725 	case 4:
13264609Szf162725 	case 11:
13274609Szf162725 	case 22:
13284609Szf162725 		return ((ic->ic_curmode == IEEE80211_MODE_11B) ? 4 : rate);
13294609Szf162725 
13304609Szf162725 	/* OFDM rates */
13314609Szf162725 	case 12:
13324609Szf162725 	case 18:
13334609Szf162725 		return (12);
13344609Szf162725 	case 24:
13354609Szf162725 	case 36:
13364609Szf162725 		return (24);
13374609Szf162725 	case 48:
13384609Szf162725 	case 72:
13394609Szf162725 	case 96:
13404609Szf162725 	case 108:
13414609Szf162725 		return (48);
13424609Szf162725 	}
13434609Szf162725 
13444609Szf162725 	/* default to 1Mbps */
13454609Szf162725 	return (2);
13464609Szf162725 }
13474609Szf162725 
13484609Szf162725 /*
13494609Szf162725  * Compute the duration (in us) needed to transmit `len' bytes at rate `rate'.
13504609Szf162725  * The function automatically determines the operating mode depending on the
13514609Szf162725  * given rate. `flags' indicates whether short preamble is in use or not.
13524609Szf162725  */
13534609Szf162725 static uint16_t
13544609Szf162725 rt2560_txtime(int len, int rate, uint32_t flags)
13554609Szf162725 {
13564609Szf162725 	uint16_t txtime;
13574609Szf162725 
13584609Szf162725 	if (RAL_RATE_IS_OFDM(rate)) {
13594609Szf162725 		/* IEEE Std 802.11a-1999, pp. 37 */
13604609Szf162725 		txtime = (8 + 4 * len + 3 + rate - 1) / rate;
13614609Szf162725 		txtime = 16 + 4 + 4 * txtime + 6;
13624609Szf162725 	} else {
13634609Szf162725 		/* IEEE Std 802.11b-1999, pp. 28 */
13644609Szf162725 		txtime = (16 * len + rate - 1) / rate;
13654609Szf162725 		if (rate != 2 && (flags & IEEE80211_F_SHPREAMBLE))
13664609Szf162725 			txtime +=  72 + 24;
13674609Szf162725 		else
13684609Szf162725 			txtime += 144 + 48;
13694609Szf162725 	}
13704609Szf162725 
13714609Szf162725 	return (txtime);
13724609Szf162725 }
13734609Szf162725 
13744609Szf162725 static uint8_t
13754609Szf162725 rt2560_plcp_signal(int rate)
13764609Szf162725 {
13774609Szf162725 	switch (rate) {
13784609Szf162725 	/* CCK rates (returned values are device-dependent) */
13794609Szf162725 	case 2:		return (0x0);
13804609Szf162725 	case 4:		return (0x1);
13814609Szf162725 	case 11:	return (0x2);
13824609Szf162725 	case 22:	return (0x3);
13834609Szf162725 
13844609Szf162725 	/* OFDM rates (cf IEEE Std 802.11a-1999, pp. 14 Table 80) */
13854609Szf162725 	case 12:	return (0xb);
13864609Szf162725 	case 18:	return (0xf);
13874609Szf162725 	case 24:	return (0xa);
13884609Szf162725 	case 36:	return (0xe);
13894609Szf162725 	case 48:	return (0x9);
13904609Szf162725 	case 72:	return (0xd);
13914609Szf162725 	case 96:	return (0x8);
13924609Szf162725 	case 108:	return (0xc);
13934609Szf162725 
13944609Szf162725 	/* unsupported rates (should not get there) */
13954609Szf162725 	default:	return (0xff);
13964609Szf162725 	}
13974609Szf162725 }
13984609Szf162725 
13994609Szf162725 void
14004609Szf162725 rt2560_setup_tx_desc(struct rt2560_softc *sc, struct rt2560_tx_desc *desc,
14014609Szf162725     uint32_t flags, int len, int rate, int encrypt)
14024609Szf162725 {
14034609Szf162725 	struct ieee80211com *ic = &sc->sc_ic;
14044609Szf162725 	uint16_t plcp_length;
14054609Szf162725 	int remainder;
14064609Szf162725 
14074609Szf162725 	desc->flags = LE_32(flags);
14084609Szf162725 	desc->flags |= LE_32(len << 16);
14094609Szf162725 	desc->flags |= encrypt ? LE_32(RT2560_TX_CIPHER_BUSY) :
14104609Szf162725 	    LE_32(RT2560_TX_BUSY | RT2560_TX_VALID);
14114609Szf162725 
14124609Szf162725 	desc->wme = LE_16(
14134609Szf162725 	    RT2560_AIFSN(2) |
14144609Szf162725 	    RT2560_LOGCWMIN(3) |
14154609Szf162725 	    RT2560_LOGCWMAX(8));
14164609Szf162725 
14174609Szf162725 	/* setup PLCP fields */
14184609Szf162725 	desc->plcp_signal  = rt2560_plcp_signal(rate);
14194609Szf162725 	desc->plcp_service = 4;
14204609Szf162725 
14214609Szf162725 	len += IEEE80211_CRC_LEN;
14224609Szf162725 	if (RAL_RATE_IS_OFDM(rate)) {
14234609Szf162725 		desc->flags |= LE_32(RT2560_TX_OFDM);
14244609Szf162725 
14254609Szf162725 		plcp_length = len & 0xfff;
14264609Szf162725 		desc->plcp_length_hi = plcp_length >> 6;
14274609Szf162725 		desc->plcp_length_lo = plcp_length & 0x3f;
14284609Szf162725 	} else {
14294609Szf162725 		plcp_length = (16 * len + rate - 1) / rate;
14304609Szf162725 		if (rate == 22) {
14314609Szf162725 			remainder = (16 * len) % 22;
14324609Szf162725 			if (remainder != 0 && remainder < 7)
14334609Szf162725 				desc->plcp_service |= RT2560_PLCP_LENGEXT;
14344609Szf162725 		}
14354609Szf162725 		desc->plcp_length_hi = plcp_length >> 8;
14364609Szf162725 		desc->plcp_length_lo = plcp_length & 0xff;
14374609Szf162725 
14384609Szf162725 		if (rate != 2 && (ic->ic_flags & IEEE80211_F_SHPREAMBLE))
14394609Szf162725 			desc->plcp_signal |= 0x08;
14404609Szf162725 	}
14414609Szf162725 }
14424609Szf162725 
14434609Szf162725 /* ARGSUSED */
14444609Szf162725 int
14454609Szf162725 rt2560_mgmt_send(ieee80211com_t *ic, mblk_t *mp, uint8_t type)
14464609Szf162725 {
14474609Szf162725 	struct rt2560_softc *sc = (struct rt2560_softc *)ic;
14484609Szf162725 	struct rt2560_tx_desc *desc;
14494609Szf162725 	struct rt2560_tx_data *data;
14504609Szf162725 	struct ieee80211_frame *wh;
14514609Szf162725 	uint16_t dur;
14524609Szf162725 	uint32_t flags = 0;
14534609Szf162725 	int rate, err = DDI_SUCCESS;
14544609Szf162725 
14554609Szf162725 	int off, pktlen, mblen;
14564609Szf162725 	caddr_t dest;
14574609Szf162725 	mblk_t *m, *m0;
14584609Szf162725 
14594609Szf162725 	struct dma_region *dr;
14604609Szf162725 	uint32_t idx;
14614609Szf162725 	struct ieee80211_node *ni;
14624609Szf162725 	struct ieee80211_key *k;
14634609Szf162725 
14644609Szf162725 	mutex_enter(&sc->prioq.tx_lock);
14654609Szf162725 
1466*8230SQuaker.Fang@Sun.COM 	if (!RAL_IS_RUNNING(sc)) {
1467*8230SQuaker.Fang@Sun.COM 		err = ENXIO;
1468*8230SQuaker.Fang@Sun.COM 		goto fail1;
1469*8230SQuaker.Fang@Sun.COM 	}
1470*8230SQuaker.Fang@Sun.COM 
14714609Szf162725 	if (sc->prioq.queued >= RT2560_PRIO_RING_COUNT) {
14724609Szf162725 		err = ENOMEM;
14734609Szf162725 		sc->sc_tx_nobuf++;
14744609Szf162725 		goto fail1;
14754609Szf162725 	}
14764609Szf162725 
14774609Szf162725 	m = allocb(msgdsize(mp) + 32, BPRI_MED);
14784609Szf162725 	if (m == NULL) {
14794609Szf162725 		RAL_DEBUG(RAL_DBG_TX, "rt2560_mgmt_send: can't alloc mblk.\n");
14804609Szf162725 		err = DDI_FAILURE;
14814609Szf162725 		goto fail1;
14824609Szf162725 	}
14834609Szf162725 
14844609Szf162725 	for (off = 0, m0 = mp; m0 != NULL; m0 = m0->b_cont) {
14854609Szf162725 		mblen = MBLKL(m0);
14864609Szf162725 		(void) memcpy(m->b_rptr + off, m0->b_rptr, mblen);
14874609Szf162725 		off += mblen;
14884609Szf162725 	}
14894609Szf162725 	m->b_wptr += off;
14904609Szf162725 
14914609Szf162725 	wh = (struct ieee80211_frame *)m->b_rptr;
14924609Szf162725 	ni = ieee80211_find_txnode(ic, wh->i_addr1);
14934609Szf162725 
14944609Szf162725 	if (ni == NULL) {
14954609Szf162725 		err = DDI_FAILURE;
14964609Szf162725 		sc->sc_tx_err++;
14974609Szf162725 		goto fail2;
14984609Szf162725 	}
14994609Szf162725 
15004609Szf162725 	/* to support shared_key auth mode */
15014609Szf162725 	if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
15024609Szf162725 		k = ieee80211_crypto_encap(ic, m);
15034609Szf162725 		if (k == NULL) {
15044609Szf162725 			err = DDI_FAILURE;
15054609Szf162725 			sc->sc_tx_err++;
15064609Szf162725 			goto fail3;
15074609Szf162725 		}
15084609Szf162725 		/* packet header may have moved, reset our local pointer */
15094609Szf162725 		wh = (struct ieee80211_frame *)m->b_rptr;
15104609Szf162725 	}
15114609Szf162725 
15124609Szf162725 	desc = &sc->prioq.desc[sc->prioq.cur];
15134609Szf162725 	data = &sc->prioq.data[sc->prioq.cur];
15144609Szf162725 
15154609Szf162725 	rate = IEEE80211_IS_CHAN_5GHZ(ic->ic_curchan) ? 12 : 2;
15164609Szf162725 	data->ni = ieee80211_ref_node(ni);
15174609Szf162725 
15184609Szf162725 	pktlen = msgdsize(m);
15194609Szf162725 	dest = data->buf;
15204609Szf162725 	bcopy(m->b_rptr, dest, pktlen);
15214609Szf162725 
15224609Szf162725 	wh = (struct ieee80211_frame *)m->b_rptr;
15234609Szf162725 	if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) {
15244609Szf162725 		flags |= RT2560_TX_ACK;
15254609Szf162725 
15264609Szf162725 		dur = rt2560_txtime(RAL_ACK_SIZE, rate, ic->ic_flags) +
15274609Szf162725 		    RAL_SIFS;
15287249Sff224033 		/* LINTED E_BAD_PTR_CAST_ALIGN */
15294609Szf162725 		*(uint16_t *)wh->i_dur = LE_16(dur);
15304609Szf162725 
15314609Szf162725 		/* tell hardware to add timestamp for probe responses */
15324609Szf162725 		if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) ==
15334609Szf162725 		    IEEE80211_FC0_TYPE_MGT &&
15344609Szf162725 		    (wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) ==
15354609Szf162725 		    IEEE80211_FC0_SUBTYPE_PROBE_RESP)
15364609Szf162725 			flags |= RT2560_TX_TIMESTAMP;
15374609Szf162725 	}
15384609Szf162725 
15394609Szf162725 	rt2560_setup_tx_desc(sc, desc, flags, pktlen, rate, 0);
15404609Szf162725 
15414609Szf162725 	idx = sc->prioq.cur;
15424609Szf162725 
15434609Szf162725 	dr = &sc->prioq.dr_txbuf[idx];
15444609Szf162725 	(void) ddi_dma_sync(dr->dr_hnd, 0, RAL_TXBUF_SIZE, DDI_DMA_SYNC_FORDEV);
15454609Szf162725 
15464609Szf162725 	dr = &sc->prioq.dr_desc;
15474609Szf162725 	(void) ddi_dma_sync(dr->dr_hnd, idx * RT2560_TX_DESC_SIZE,
15484609Szf162725 	    RT2560_TX_DESC_SIZE, DDI_DMA_SYNC_FORDEV);
15494609Szf162725 
15504609Szf162725 	RAL_DEBUG(RAL_DBG_MGMT, "sending mgt frame len=%u idx=%u rate=%u\n",
15514609Szf162725 	    pktlen, sc->prioq.cur, rate);
15524609Szf162725 
15534609Szf162725 	/* kick prio */
15544609Szf162725 	sc->prioq.queued++; /* IF > RT2560_PRIO_RING_COUNT? FULL */
15554609Szf162725 	sc->prioq.cur = (sc->prioq.cur + 1) % RT2560_PRIO_RING_COUNT;
15564609Szf162725 	RAL_WRITE(sc, RT2560_TXCSR0, RT2560_KICK_PRIO);
15574609Szf162725 
15584609Szf162725 	sc->sc_tx_timer = 5;
15594609Szf162725 
15606411Szf162725 	ic->ic_stats.is_tx_frags++;
15616411Szf162725 	ic->ic_stats.is_tx_bytes += pktlen;
15626411Szf162725 
15634609Szf162725 fail3:
15644609Szf162725 	ieee80211_free_node(ni);
15654609Szf162725 fail2:
15664609Szf162725 	freemsg(m);
15674609Szf162725 fail1:
15684609Szf162725 	freemsg(mp);
15694609Szf162725 	mutex_exit(&sc->prioq.tx_lock);
15704609Szf162725 
15714609Szf162725 	return (err);
15724609Szf162725 }
15734609Szf162725 
15744609Szf162725 static int
15754609Szf162725 rt2560_send(ieee80211com_t *ic, mblk_t *mp)
15764609Szf162725 {
15774609Szf162725 	struct rt2560_softc *sc = (struct rt2560_softc *)ic;
15784609Szf162725 	struct rt2560_tx_desc *desc;
15794609Szf162725 	struct rt2560_tx_data *data;
15804609Szf162725 	struct rt2560_node *rn;
15814609Szf162725 	struct ieee80211_rateset *rs;
15824609Szf162725 	struct ieee80211_frame *wh;
15834609Szf162725 	struct ieee80211_key *k;
15844609Szf162725 	uint16_t dur;
15854609Szf162725 	uint32_t flags = 0;
15864609Szf162725 	int rate, err = DDI_SUCCESS;
15874609Szf162725 
15884609Szf162725 	struct ieee80211_node *ni;
15894609Szf162725 	mblk_t *m, *m0;
15904609Szf162725 	int off, mblen, pktlen;
15914609Szf162725 	caddr_t dest;
15924609Szf162725 
15934609Szf162725 	struct dma_region *dr;
15944609Szf162725 	uint32_t idx;
15954609Szf162725 
15964609Szf162725 	mutex_enter(&sc->txq.tx_lock);
15974609Szf162725 
15984609Szf162725 	if (sc->txq.queued >= RT2560_TX_RING_COUNT - 1) {
15994609Szf162725 		RAL_DEBUG(RAL_DBG_TX, "ral: rt2560_tx_data(): "
16004609Szf162725 		    "no TX DMA buffer available!\n");
16014609Szf162725 		sc->sc_need_sched = 1;
16024609Szf162725 		sc->sc_tx_nobuf++;
16034609Szf162725 		err = ENOMEM;
16044609Szf162725 		goto fail1;
16054609Szf162725 	}
16064609Szf162725 
16074609Szf162725 	m = allocb(msgdsize(mp) + 32, BPRI_MED);
16084609Szf162725 	if (m == NULL) {
16094609Szf162725 		RAL_DEBUG(RAL_DBG_TX, "rt2560_xmit(): can't alloc mblk.\n");
16104609Szf162725 		err = DDI_FAILURE;
16114609Szf162725 		goto fail1;
16124609Szf162725 	}
16134609Szf162725 
16144609Szf162725 	for (off = 0, m0 = mp; m0 != NULL; m0 = m0->b_cont) {
16154609Szf162725 		mblen = MBLKL(m0);
16164609Szf162725 		(void) memcpy(m->b_rptr + off, m0->b_rptr, mblen);
16174609Szf162725 		off += mblen;
16184609Szf162725 	}
16194609Szf162725 	m->b_wptr += off;
16204609Szf162725 
16214609Szf162725 	wh = (struct ieee80211_frame *)m->b_rptr;
16224609Szf162725 	ni = ieee80211_find_txnode(ic, wh->i_addr1);
16234609Szf162725 
16244609Szf162725 	if (ni == NULL) {
16254609Szf162725 		err = DDI_FAILURE;
16264609Szf162725 		sc->sc_tx_err++;
16274609Szf162725 		goto fail2;
16284609Szf162725 	}
16294609Szf162725 
16304609Szf162725 	(void) ieee80211_encap(ic, m, ni);
16314609Szf162725 
16324609Szf162725 	if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
16334609Szf162725 		k = ieee80211_crypto_encap(ic, m);
16344609Szf162725 		if (k == NULL) {
16354609Szf162725 			sc->sc_tx_err++;
16364609Szf162725 			err = DDI_FAILURE;
16374609Szf162725 			goto fail3;
16384609Szf162725 		}
16394609Szf162725 		/* packet header may have moved, reset our local pointer */
16404609Szf162725 		wh = (struct ieee80211_frame *)m->b_rptr;
16414609Szf162725 	}
16424609Szf162725 
16434609Szf162725 	/*
16444609Szf162725 	 * RTS/CTS exchange ignore, since the max packet will less than
16454609Szf162725 	 * the rtsthreshold (2346)
16464609Szf162725 	 * Unnecessary codes deleted.
16474609Szf162725 	 */
16484609Szf162725 
16494609Szf162725 	data = &sc->txq.data[sc->txq.cur];
16504609Szf162725 	desc = &sc->txq.desc[sc->txq.cur];
16514609Szf162725 
16524609Szf162725 	data->ni = ieee80211_ref_node(ni);
16534609Szf162725 
16544609Szf162725 	pktlen = msgdsize(m);
16554609Szf162725 	dest = data->buf;
16564609Szf162725 	bcopy(m->b_rptr, dest, pktlen);
16574609Szf162725 
16584609Szf162725 	if (ic->ic_fixed_rate != IEEE80211_FIXED_RATE_NONE) {
16594609Szf162725 		rs = &ic->ic_sup_rates[ic->ic_curmode];
16604609Szf162725 		rate = rs->ir_rates[ic->ic_fixed_rate];
16614609Szf162725 	} else {
16624609Szf162725 		rs = &ni->in_rates;
16634609Szf162725 		rn = (struct rt2560_node *)ni;
16644609Szf162725 		ni->in_txrate = ral_rssadapt_choose(&rn->rssadapt, rs, wh,
16654609Szf162725 		    pktlen, NULL, 0);
16664609Szf162725 		rate = rs->ir_rates[ni->in_txrate];
16674609Szf162725 	}
16684609Szf162725 
16694609Szf162725 	rate &= IEEE80211_RATE_VAL;
16704609Szf162725 	if (rate <= 0) {
16714609Szf162725 		rate = 2;	/* basic rate */
16724609Szf162725 	}
16734609Szf162725 
16744609Szf162725 	/* remember link conditions for rate adaptation algorithm */
16754609Szf162725 	if (ic->ic_fixed_rate == IEEE80211_FIXED_RATE_NONE) {
16764609Szf162725 		data->id.id_len = pktlen;
16774609Szf162725 		data->id.id_rateidx = ni->in_txrate;
16784609Szf162725 		data->id.id_node = ni;
16794609Szf162725 		data->id.id_rssi = ni->in_rssi;
16804609Szf162725 	} else
16814609Szf162725 		data->id.id_node = NULL;
16824609Szf162725 
16834609Szf162725 	if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) {
16844609Szf162725 		flags |= RT2560_TX_ACK;
16854609Szf162725 
16864609Szf162725 		dur = rt2560_txtime(RAL_ACK_SIZE, rt2560_ack_rate(ic, rate),
16874609Szf162725 		    ic->ic_flags) + RAL_SIFS;
16887249Sff224033 		/* LINTED E_BAD_PTR_CAST_ALIGN */
16894609Szf162725 		*(uint16_t *)wh->i_dur = LE_16(dur);
16904609Szf162725 	}
16914609Szf162725 
16924609Szf162725 	/* flags |= RT2560_TX_CIPHER_NONE; */
16934609Szf162725 	rt2560_setup_tx_desc(sc, desc, flags, pktlen, rate, 0);
16944609Szf162725 
16954609Szf162725 	idx = sc->txq.cur;
16964609Szf162725 
16974609Szf162725 	dr = &sc->txq.dr_txbuf[idx];
16984609Szf162725 	(void) ddi_dma_sync(dr->dr_hnd, 0, RAL_TXBUF_SIZE, DDI_DMA_SYNC_FORDEV);
16994609Szf162725 
17004609Szf162725 	dr = &sc->txq.dr_desc;
17014609Szf162725 	(void) ddi_dma_sync(dr->dr_hnd, idx * RT2560_TX_DESC_SIZE,
17024609Szf162725 	    RT2560_TX_DESC_SIZE, DDI_DMA_SYNC_FORDEV);
17034609Szf162725 
17044609Szf162725 	RAL_DEBUG(RAL_DBG_TX, "sending data frame len=%u idx=%u rate=%u\n",
17054609Szf162725 	    pktlen, sc->txq.cur, rate);
17064609Szf162725 
17074609Szf162725 	/* kick tx */
17084609Szf162725 	sc->txq.queued++;
17094609Szf162725 	sc->txq.cur = (sc->txq.cur + 1) % RT2560_TX_RING_COUNT;
17104609Szf162725 	RAL_WRITE(sc, RT2560_TXCSR0, RT2560_KICK_TX);
17114609Szf162725 
17124609Szf162725 	sc->sc_tx_timer = 5;
17134609Szf162725 
17146411Szf162725 	ic->ic_stats.is_tx_frags++;
17156411Szf162725 	ic->ic_stats.is_tx_bytes += pktlen;
17166411Szf162725 
17174609Szf162725 	freemsg(mp);
17184609Szf162725 fail3:
17194609Szf162725 	ieee80211_free_node(ni);
17204609Szf162725 fail2:
17214609Szf162725 	freemsg(m);
17224609Szf162725 fail1:
17234609Szf162725 	mutex_exit(&sc->txq.tx_lock);
17244609Szf162725 	return (err);
17254609Szf162725 }
17264609Szf162725 
17274609Szf162725 static mblk_t *
17284609Szf162725 rt2560_m_tx(void *arg, mblk_t *mp)
17294609Szf162725 {
17304609Szf162725 	struct rt2560_softc *sc = (struct rt2560_softc *)arg;
17314609Szf162725 	struct ieee80211com *ic = &sc->sc_ic;
17324609Szf162725 	mblk_t *next;
17334609Szf162725 
1734*8230SQuaker.Fang@Sun.COM 	if (!RAL_IS_RUNNING(sc)) {
1735*8230SQuaker.Fang@Sun.COM 		freemsgchain(mp);
1736*8230SQuaker.Fang@Sun.COM 		return (NULL);
1737*8230SQuaker.Fang@Sun.COM 	}
17384609Szf162725 	/*
17394609Szf162725 	 * No data frames go out unless we're associated; this
17404609Szf162725 	 * should not happen as the 802.11 layer does not enable
17414609Szf162725 	 * the xmit queue until we enter the RUN state.
17424609Szf162725 	 */
17434609Szf162725 	if (ic->ic_state != IEEE80211_S_RUN) {
1744*8230SQuaker.Fang@Sun.COM 		RAL_DEBUG(RAL_DBG_TX, "ral: rt2560_m_tx(): "
17454609Szf162725 		    "discard, state %u\n", ic->ic_state);
17464609Szf162725 		freemsgchain(mp);
17474609Szf162725 		return (NULL);
17484609Szf162725 	}
17494609Szf162725 
17504609Szf162725 	while (mp != NULL) {
17514609Szf162725 		next = mp->b_next;
17524609Szf162725 		mp->b_next = NULL;
17534609Szf162725 		if (rt2560_send(ic, mp) != DDI_SUCCESS) {
17544609Szf162725 			mp->b_next = next;
17554609Szf162725 			freemsgchain(mp);
17564609Szf162725 			return (NULL);
17574609Szf162725 		}
17584609Szf162725 		mp = next;
17594609Szf162725 	}
17604609Szf162725 	return (mp);
17614609Szf162725 }
17624609Szf162725 
17634609Szf162725 static void
17644609Szf162725 rt2560_set_macaddr(struct rt2560_softc *sc, uint8_t *addr)
17654609Szf162725 {
17664609Szf162725 	uint32_t tmp;
17674609Szf162725 
17684609Szf162725 	tmp = addr[0] | addr[1] << 8 | addr[2] << 16 | addr[3] << 24;
17694609Szf162725 	RAL_WRITE(sc, RT2560_CSR3, tmp);
17704609Szf162725 
17714609Szf162725 	tmp = addr[4] | addr[5] << 8;
17724609Szf162725 	RAL_WRITE(sc, RT2560_CSR4, tmp);
17734609Szf162725 
17744609Szf162725 	RAL_DEBUG(RAL_DBG_HW,
17754609Szf162725 	    "setting MAC address to " MACSTR "\n", MAC2STR(addr));
17764609Szf162725 }
17774609Szf162725 
17784609Szf162725 static void
17794609Szf162725 rt2560_get_macaddr(struct rt2560_softc *sc, uint8_t *addr)
17804609Szf162725 {
17814609Szf162725 	uint32_t tmp;
17824609Szf162725 
17834609Szf162725 	tmp = RAL_READ(sc, RT2560_CSR3);
17844609Szf162725 	addr[0] = tmp & 0xff;
17854609Szf162725 	addr[1] = (tmp >>  8) & 0xff;
17864609Szf162725 	addr[2] = (tmp >> 16) & 0xff;
17874609Szf162725 	addr[3] = (tmp >> 24);
17884609Szf162725 
17894609Szf162725 	tmp = RAL_READ(sc, RT2560_CSR4);
17904609Szf162725 	addr[4] = tmp & 0xff;
17914609Szf162725 	addr[5] = (tmp >> 8) & 0xff;
17924609Szf162725 }
17934609Szf162725 
17944609Szf162725 static void
17954609Szf162725 rt2560_update_promisc(struct rt2560_softc *sc)
17964609Szf162725 {
17974609Szf162725 	uint32_t tmp;
17984609Szf162725 
17994609Szf162725 	tmp = RAL_READ(sc, RT2560_RXCSR0);
18004609Szf162725 	tmp &= ~RT2560_DROP_NOT_TO_ME;
18014609Szf162725 	if (!(sc->sc_rcr & RAL_RCR_PROMISC))
18024609Szf162725 		tmp |= RT2560_DROP_NOT_TO_ME;
18034609Szf162725 
18044609Szf162725 	RAL_WRITE(sc, RT2560_RXCSR0, tmp);
18054609Szf162725 	RAL_DEBUG(RAL_DBG_HW, "%s promiscuous mode\n",
18064609Szf162725 	    (sc->sc_rcr & RAL_RCR_PROMISC) ?  "entering" : "leaving");
18074609Szf162725 }
18084609Szf162725 
18094609Szf162725 static const char *
18104609Szf162725 rt2560_get_rf(int rev)
18114609Szf162725 {
18124609Szf162725 	switch (rev) {
18134609Szf162725 	case RT2560_RF_2522:	return ("RT2522");
18144609Szf162725 	case RT2560_RF_2523:	return ("RT2523");
18154609Szf162725 	case RT2560_RF_2524:	return ("RT2524");
18164609Szf162725 	case RT2560_RF_2525:	return ("RT2525");
18174609Szf162725 	case RT2560_RF_2525E:	return ("RT2525e");
18184609Szf162725 	case RT2560_RF_2526:	return ("RT2526");
18194609Szf162725 	case RT2560_RF_5222:	return ("RT5222");
18204609Szf162725 	default:		return ("unknown");
18214609Szf162725 	}
18224609Szf162725 }
18234609Szf162725 
18244609Szf162725 static void
18254609Szf162725 rt2560_read_eeprom(struct rt2560_softc *sc)
18264609Szf162725 {
18274609Szf162725 	uint16_t val;
18284609Szf162725 	int i;
18294609Szf162725 
18304609Szf162725 	val = rt2560_eeprom_read(sc, RT2560_EEPROM_CONFIG0);
18314609Szf162725 	sc->rf_rev =   (val >> 11) & 0x7;
18324609Szf162725 	sc->hw_radio = (val >> 10) & 0x1;
18334609Szf162725 	sc->led_mode = (val >> 6)  & 0x7;
18344609Szf162725 	sc->rx_ant =   (val >> 4)  & 0x3;
18354609Szf162725 	sc->tx_ant =   (val >> 2)  & 0x3;
18364609Szf162725 	sc->nb_ant =   val & 0x3;
18374609Szf162725 
18384609Szf162725 	/* read default values for BBP registers */
18394609Szf162725 	for (i = 0; i < 16; i++) {
18404609Szf162725 		val = rt2560_eeprom_read(sc, RT2560_EEPROM_BBP_BASE + i);
18414609Szf162725 		sc->bbp_prom[i].reg = val >> 8;
18424609Szf162725 		sc->bbp_prom[i].val = val & 0xff;
18434609Szf162725 	}
18444609Szf162725 
18454609Szf162725 	/* read Tx power for all b/g channels */
18464609Szf162725 	for (i = 0; i < 14 / 2; i++) {
18474609Szf162725 		val = rt2560_eeprom_read(sc, RT2560_EEPROM_TXPOWER + i);
18484609Szf162725 		sc->txpow[i * 2] = val >> 8;
18494609Szf162725 		sc->txpow[i * 2 + 1] = val & 0xff;
18504609Szf162725 	}
18514609Szf162725 }
18524609Szf162725 
18534609Szf162725 static int
18544609Szf162725 rt2560_bbp_init(struct rt2560_softc *sc)
18554609Szf162725 {
18564609Szf162725 #define	N(a)	(sizeof (a) / sizeof ((a)[0]))
18574609Szf162725 	int i, ntries;
18584609Szf162725 
18594609Szf162725 	/* wait for BBP to be ready */
18604609Szf162725 	for (ntries = 0; ntries < 100; ntries++) {
18614609Szf162725 		if (rt2560_bbp_read(sc, RT2560_BBP_VERSION) != 0)
18624609Szf162725 			break;
18634609Szf162725 		drv_usecwait(1);
18644609Szf162725 	}
18654609Szf162725 	if (ntries == 100) {
18664609Szf162725 		RAL_DEBUG(RAL_DBG_HW, "timeout waiting for BBP\n");
18674609Szf162725 		return (EIO);
18684609Szf162725 	}
18694609Szf162725 	/* initialize BBP registers to default values */
18704609Szf162725 	for (i = 0; i < N(rt2560_def_bbp); i++) {
18714609Szf162725 		rt2560_bbp_write(sc, rt2560_def_bbp[i].reg,
18724609Szf162725 		    rt2560_def_bbp[i].val);
18734609Szf162725 	}
18744609Szf162725 
18754609Szf162725 	return (0);
18764609Szf162725 #undef N
18774609Szf162725 }
18784609Szf162725 
18794609Szf162725 static void
18804609Szf162725 rt2560_set_txantenna(struct rt2560_softc *sc, int antenna)
18814609Szf162725 {
18824609Szf162725 	uint32_t tmp;
18834609Szf162725 	uint8_t tx;
18844609Szf162725 
18854609Szf162725 	tx = rt2560_bbp_read(sc, RT2560_BBP_TX) & ~RT2560_BBP_ANTMASK;
18864609Szf162725 	if (antenna == 1)
18874609Szf162725 		tx |= RT2560_BBP_ANTA;
18884609Szf162725 	else if (antenna == 2)
18894609Szf162725 		tx |= RT2560_BBP_ANTB;
18904609Szf162725 	else
18914609Szf162725 		tx |= RT2560_BBP_DIVERSITY;
18924609Szf162725 
18934609Szf162725 	/* need to force I/Q flip for RF 2525e, 2526 and 5222 */
18944609Szf162725 	if (sc->rf_rev == RT2560_RF_2525E || sc->rf_rev == RT2560_RF_2526 ||
18954609Szf162725 	    sc->rf_rev == RT2560_RF_5222)
18964609Szf162725 		tx |= RT2560_BBP_FLIPIQ;
18974609Szf162725 
18984609Szf162725 	rt2560_bbp_write(sc, RT2560_BBP_TX, tx);
18994609Szf162725 
19004609Szf162725 	/* update values for CCK and OFDM in BBPCSR1 */
19014609Szf162725 	tmp = RAL_READ(sc, RT2560_BBPCSR1) & ~0x00070007;
19024609Szf162725 	tmp |= (tx & 0x7) << 16 | (tx & 0x7);
19034609Szf162725 	RAL_WRITE(sc, RT2560_BBPCSR1, tmp);
19044609Szf162725 }
19054609Szf162725 
19064609Szf162725 static void
19074609Szf162725 rt2560_set_rxantenna(struct rt2560_softc *sc, int antenna)
19084609Szf162725 {
19094609Szf162725 	uint8_t rx;
19104609Szf162725 
19114609Szf162725 	rx = rt2560_bbp_read(sc, RT2560_BBP_RX) & ~RT2560_BBP_ANTMASK;
19124609Szf162725 	if (antenna == 1)
19134609Szf162725 		rx |= RT2560_BBP_ANTA;
19144609Szf162725 	else if (antenna == 2)
19154609Szf162725 		rx |= RT2560_BBP_ANTB;
19164609Szf162725 	else
19174609Szf162725 		rx |= RT2560_BBP_DIVERSITY;
19184609Szf162725 
19194609Szf162725 	/* need to force no I/Q flip for RF 2525e and 2526 */
19204609Szf162725 	if (sc->rf_rev == RT2560_RF_2525E || sc->rf_rev == RT2560_RF_2526)
19214609Szf162725 		rx &= ~RT2560_BBP_FLIPIQ;
19224609Szf162725 
19234609Szf162725 	rt2560_bbp_write(sc, RT2560_BBP_RX, rx);
19244609Szf162725 }
19254609Szf162725 
19264609Szf162725 static void
19274609Szf162725 rt2560_stop(struct rt2560_softc *sc)
19284609Szf162725 {
19294609Szf162725 	struct ieee80211com *ic = &sc->sc_ic;
19304609Szf162725 
19314609Szf162725 	ieee80211_new_state(ic, IEEE80211_S_INIT, -1);
19324609Szf162725 	ieee80211_stop_watchdog(ic);	/* stop the watchdog */
19334609Szf162725 
19344609Szf162725 	RAL_LOCK(sc);
19354609Szf162725 	sc->sc_tx_timer = 0;
19364609Szf162725 
19374609Szf162725 	/* abort Tx */
19384609Szf162725 	RAL_WRITE(sc, RT2560_TXCSR0, RT2560_ABORT_TX);
19394609Szf162725 
19404609Szf162725 	/* disable Rx */
19414609Szf162725 	RAL_WRITE(sc, RT2560_RXCSR0, RT2560_DISABLE_RX);
19424609Szf162725 
19434609Szf162725 	/* reset ASIC (imply reset BBP) */
19444609Szf162725 	RAL_WRITE(sc, RT2560_CSR1, RT2560_RESET_ASIC);
19454609Szf162725 	RAL_WRITE(sc, RT2560_CSR1, 0);
19464609Szf162725 
19474609Szf162725 	/* disable interrupts */
19484609Szf162725 	RAL_WRITE(sc, RT2560_CSR8, 0xffffffff);
19494609Szf162725 
19504609Szf162725 	/* reset Tx and Rx rings */
19514609Szf162725 	rt2560_reset_tx_ring(sc, &sc->txq);
19524609Szf162725 	rt2560_reset_tx_ring(sc, &sc->prioq);
19534609Szf162725 	rt2560_reset_rx_ring(sc, &sc->rxq);
19544609Szf162725 	RAL_UNLOCK(sc);
19554609Szf162725 }
19564609Szf162725 
19574609Szf162725 static int
19584609Szf162725 rt2560_init(struct rt2560_softc *sc)
19594609Szf162725 {
19604609Szf162725 #define	N(a)	(sizeof (a) / sizeof ((a)[0]))
19614609Szf162725 	/* struct rt2560_softc *sc = priv; */
19624609Szf162725 	struct ieee80211com *ic = &sc->sc_ic;
19634609Szf162725 	uint32_t tmp;
19644609Szf162725 	int i;
19654609Szf162725 
19664609Szf162725 	rt2560_stop(sc);
19674609Szf162725 
19684609Szf162725 	RAL_LOCK(sc);
19694609Szf162725 	/* setup tx/rx ring */
19704609Szf162725 	rt2560_ring_hwsetup(sc);
19714609Szf162725 
19724609Szf162725 	/* initialize MAC registers to default values */
19734609Szf162725 	for (i = 0; i < N(rt2560_def_mac); i++)
19744609Szf162725 		RAL_WRITE(sc, rt2560_def_mac[i].reg, rt2560_def_mac[i].val);
19754609Szf162725 
19764609Szf162725 	rt2560_set_macaddr(sc, ic->ic_macaddr);
19774609Szf162725 
19784609Szf162725 	/* set basic rate set (will be updated later) */
19794609Szf162725 	RAL_WRITE(sc, RT2560_ARSP_PLCP_1, 0x153);
19804609Szf162725 
19814609Szf162725 	rt2560_set_txantenna(sc, sc->tx_ant);
19824609Szf162725 	rt2560_set_rxantenna(sc, sc->rx_ant);
19834609Szf162725 	rt2560_update_slot(ic, 1);
19844609Szf162725 	rt2560_update_plcp(sc);
19854609Szf162725 	rt2560_update_led(sc, 0, 0);
19864609Szf162725 
19874609Szf162725 	RAL_WRITE(sc, RT2560_CSR1, RT2560_RESET_ASIC);
19884609Szf162725 	RAL_WRITE(sc, RT2560_CSR1, RT2560_HOST_READY);
19894609Szf162725 
19904609Szf162725 	if (rt2560_bbp_init(sc) != 0) {
19914609Szf162725 		RAL_UNLOCK(sc);
19924609Szf162725 		rt2560_stop(sc);
19934609Szf162725 		return (DDI_FAILURE);
19944609Szf162725 	}
19954609Szf162725 
19964609Szf162725 	/* set default BSS channel */
19974609Szf162725 	rt2560_set_chan(sc, ic->ic_curchan);
19984609Szf162725 
19994609Szf162725 	/* kick Rx */
20004609Szf162725 	tmp = RT2560_DROP_PHY_ERROR | RT2560_DROP_CRC_ERROR;
20014609Szf162725 	if (ic->ic_opmode != IEEE80211_M_MONITOR) {
20024609Szf162725 		tmp |= RT2560_DROP_CTL | RT2560_DROP_VERSION_ERROR;
20034609Szf162725 		if (ic->ic_opmode != IEEE80211_M_HOSTAP)
20044609Szf162725 			tmp |= RT2560_DROP_TODS;
20054609Szf162725 		if (!(sc->sc_rcr & RAL_RCR_PROMISC))
20064609Szf162725 			tmp |= RT2560_DROP_NOT_TO_ME;
20074609Szf162725 
20084609Szf162725 	}
20094609Szf162725 	RAL_WRITE(sc, RT2560_RXCSR0, tmp);
20104609Szf162725 
20114609Szf162725 	/* clear old FCS and Rx FIFO errors */
20124609Szf162725 	(void) RAL_READ(sc, RT2560_CNT0);
20134609Szf162725 	(void) RAL_READ(sc, RT2560_CNT4);
20144609Szf162725 
20154609Szf162725 	/* clear any pending interrupts */
20164609Szf162725 	RAL_WRITE(sc, RT2560_CSR7, 0xffffffff);
20174609Szf162725 	/* enable interrupts */
20184609Szf162725 	RAL_WRITE(sc, RT2560_CSR8, RT2560_INTR_MASK);
20194609Szf162725 
20204609Szf162725 	RAL_UNLOCK(sc);
20214609Szf162725 #undef N
20224609Szf162725 	return (DDI_SUCCESS);
20234609Szf162725 }
20244609Szf162725 
20254609Szf162725 void
20264609Szf162725 rt2560_watchdog(void *arg)
20274609Szf162725 {
20284609Szf162725 	struct rt2560_softc *sc = arg;
20294609Szf162725 	struct ieee80211com *ic = &sc->sc_ic;
20304609Szf162725 	int ntimer = 0;
20314609Szf162725 
20324609Szf162725 	RAL_LOCK(sc);
20334609Szf162725 	ic->ic_watchdog_timer = 0;
20344609Szf162725 
20354609Szf162725 	if (!RAL_IS_RUNNING(sc)) {
20364609Szf162725 		RAL_UNLOCK(sc);
20374609Szf162725 		return;
20384609Szf162725 	}
20394609Szf162725 
20404609Szf162725 	if (sc->sc_tx_timer > 0) {
20414609Szf162725 		if (--sc->sc_tx_timer == 0) {
20424609Szf162725 			RAL_DEBUG(RAL_DBG_MSG, "tx timer timeout\n");
20434609Szf162725 			RAL_UNLOCK(sc);
20444609Szf162725 			(void) rt2560_init(sc);
20454609Szf162725 			(void) ieee80211_new_state(ic, IEEE80211_S_SCAN, -1);
20464609Szf162725 			return;
20474609Szf162725 		}
20484609Szf162725 	}
20494609Szf162725 
20504609Szf162725 	if (ic->ic_state == IEEE80211_S_RUN)
20514609Szf162725 		ntimer = 1;
20524609Szf162725 
20534609Szf162725 	RAL_UNLOCK(sc);
20544609Szf162725 
20554609Szf162725 	ieee80211_watchdog(ic);
20564609Szf162725 
20574609Szf162725 	if (ntimer)
20584609Szf162725 		ieee80211_start_watchdog(ic, ntimer);
20594609Szf162725 }
20604609Szf162725 
20614609Szf162725 static int
20624609Szf162725 rt2560_m_start(void *arg)
20634609Szf162725 {
20644609Szf162725 	struct rt2560_softc *sc = (struct rt2560_softc *)arg;
20654609Szf162725 	crypto_mech_type_t type;
20664609Szf162725 	int err;
20674609Szf162725 
20684609Szf162725 
20694609Szf162725 	type = crypto_mech2id(SUN_CKM_RC4); /* load rc4 module into kernel */
20704609Szf162725 	RAL_DEBUG(RAL_DBG_GLD, "enter rt2560_m_start(%d)\n", type);
20714609Szf162725 
20724609Szf162725 	/*
20734609Szf162725 	 * initialize rt2560 hardware
20744609Szf162725 	 */
20754609Szf162725 	err = rt2560_init(sc);
20764609Szf162725 	if (err != DDI_SUCCESS) {
20774609Szf162725 		RAL_DEBUG(RAL_DBG_GLD, "device configuration failed\n");
20784609Szf162725 		goto fail;
20794609Szf162725 	}
20804609Szf162725 	sc->sc_flags |= RAL_FLAG_RUNNING;	/* RUNNING */
20814609Szf162725 	return (err);
20824609Szf162725 
20834609Szf162725 fail:
20844609Szf162725 	rt2560_stop(sc);
20854609Szf162725 	return (err);
20864609Szf162725 }
20874609Szf162725 
20884609Szf162725 static void
20894609Szf162725 rt2560_m_stop(void *arg)
20904609Szf162725 {
20914609Szf162725 	struct rt2560_softc *sc = (struct rt2560_softc *)arg;
20924609Szf162725 
20934609Szf162725 	RAL_DEBUG(RAL_DBG_GLD, "enter rt2560_m_stop()\n");
20944609Szf162725 
20954609Szf162725 	(void) rt2560_stop(sc);
20964609Szf162725 	sc->sc_flags &= ~RAL_FLAG_RUNNING;	/* STOP */
20974609Szf162725 }
20984609Szf162725 
20994609Szf162725 static int
21004609Szf162725 rt2560_m_unicst(void *arg, const uint8_t *macaddr)
21014609Szf162725 {
21024609Szf162725 	struct rt2560_softc *sc = (struct rt2560_softc *)arg;
21034609Szf162725 	struct ieee80211com *ic = &sc->sc_ic;
21044609Szf162725 
21054609Szf162725 	RAL_DEBUG(RAL_DBG_GLD, "rt2560_m_unicst(): " MACSTR "\n",
21064609Szf162725 	    MAC2STR(macaddr));
21074609Szf162725 
21084609Szf162725 	IEEE80211_ADDR_COPY(ic->ic_macaddr, macaddr);
21094609Szf162725 	(void) rt2560_set_macaddr(sc, (uint8_t *)macaddr);
21104609Szf162725 	(void) rt2560_init(sc);
21114609Szf162725 
21124609Szf162725 	return (0);
21134609Szf162725 }
21144609Szf162725 
21154609Szf162725 /*ARGSUSED*/
21164609Szf162725 static int
21174609Szf162725 rt2560_m_multicst(void *arg, boolean_t add, const uint8_t *mca)
21184609Szf162725 {
21194609Szf162725 	return (0);
21204609Szf162725 }
21214609Szf162725 
21224609Szf162725 static int
21234609Szf162725 rt2560_m_promisc(void *arg, boolean_t on)
21244609Szf162725 {
21254609Szf162725 	struct rt2560_softc *sc = (struct rt2560_softc *)arg;
21264609Szf162725 
21274609Szf162725 	RAL_DEBUG(RAL_DBG_GLD, "rt2560_m_promisc()\n");
21284609Szf162725 
21294609Szf162725 	if (on) {
21304609Szf162725 		sc->sc_rcr |= RAL_RCR_PROMISC;
21314609Szf162725 		sc->sc_rcr |= RAL_RCR_MULTI;
21324609Szf162725 	} else {
21334609Szf162725 		sc->sc_rcr &= ~RAL_RCR_PROMISC;
21344609Szf162725 		sc->sc_rcr &= ~RAL_RCR_PROMISC;
21354609Szf162725 	}
21364609Szf162725 
21374609Szf162725 	rt2560_update_promisc(sc);
21384609Szf162725 	return (0);
21394609Szf162725 }
21404609Szf162725 
21418099SQuaker.Fang@Sun.COM /*
21428099SQuaker.Fang@Sun.COM  * callback functions for /get/set properties
21438099SQuaker.Fang@Sun.COM  */
21448099SQuaker.Fang@Sun.COM static int
21458099SQuaker.Fang@Sun.COM rt2560_m_setprop(void *arg, const char *pr_name, mac_prop_id_t wldp_pr_num,
21468099SQuaker.Fang@Sun.COM     uint_t wldp_length, const void *wldp_buf)
21478099SQuaker.Fang@Sun.COM {
21488099SQuaker.Fang@Sun.COM 	struct rt2560_softc *sc = arg;
21498099SQuaker.Fang@Sun.COM 	struct ieee80211com *ic = &sc->sc_ic;
21508099SQuaker.Fang@Sun.COM 	int err;
21518099SQuaker.Fang@Sun.COM 
21528099SQuaker.Fang@Sun.COM 	err = ieee80211_setprop(ic, pr_name, wldp_pr_num,
21538099SQuaker.Fang@Sun.COM 	    wldp_length, wldp_buf);
21548099SQuaker.Fang@Sun.COM 	RAL_LOCK(sc);
21558099SQuaker.Fang@Sun.COM 	if (err == ENETRESET) {
21568099SQuaker.Fang@Sun.COM 		if (RAL_IS_RUNNING(sc)) {
21578099SQuaker.Fang@Sun.COM 			RAL_UNLOCK(sc);
21588099SQuaker.Fang@Sun.COM 			(void) rt2560_init(sc);
21598099SQuaker.Fang@Sun.COM 			(void) ieee80211_new_state(ic, IEEE80211_S_SCAN, -1);
21608099SQuaker.Fang@Sun.COM 			RAL_LOCK(sc);
21618099SQuaker.Fang@Sun.COM 		}
21628099SQuaker.Fang@Sun.COM 		err = 0;
21638099SQuaker.Fang@Sun.COM 	}
21648099SQuaker.Fang@Sun.COM 	RAL_UNLOCK(sc);
21658099SQuaker.Fang@Sun.COM 
21668099SQuaker.Fang@Sun.COM 	return (err);
21678099SQuaker.Fang@Sun.COM }
21688099SQuaker.Fang@Sun.COM 
21698099SQuaker.Fang@Sun.COM static int
21708099SQuaker.Fang@Sun.COM rt2560_m_getprop(void *arg, const char *pr_name, mac_prop_id_t wldp_pr_num,
21718118SVasumathi.Sundaram@Sun.COM     uint_t pr_flags, uint_t wldp_length, void *wldp_buf, uint_t *perm)
21728099SQuaker.Fang@Sun.COM {
21738099SQuaker.Fang@Sun.COM 	struct rt2560_softc *sc = arg;
21748099SQuaker.Fang@Sun.COM 	int err;
21758099SQuaker.Fang@Sun.COM 
21768099SQuaker.Fang@Sun.COM 	err = ieee80211_getprop(&sc->sc_ic, pr_name, wldp_pr_num,
21778118SVasumathi.Sundaram@Sun.COM 	    pr_flags, wldp_length, wldp_buf, perm);
21788099SQuaker.Fang@Sun.COM 
21798099SQuaker.Fang@Sun.COM 	return (err);
21808099SQuaker.Fang@Sun.COM }
21818099SQuaker.Fang@Sun.COM 
21824609Szf162725 static void
21834609Szf162725 rt2560_m_ioctl(void* arg, queue_t *wq, mblk_t *mp)
21844609Szf162725 {
21854609Szf162725 	struct rt2560_softc *sc = (struct rt2560_softc *)arg;
21864609Szf162725 	struct ieee80211com *ic = &sc->sc_ic;
21874609Szf162725 	int err;
21884609Szf162725 
21894609Szf162725 	err = ieee80211_ioctl(ic, wq, mp);
21904609Szf162725 	RAL_LOCK(sc);
21914609Szf162725 	if (err == ENETRESET) {
21924609Szf162725 		if (RAL_IS_RUNNING(sc)) {
21934609Szf162725 			RAL_UNLOCK(sc);
21944609Szf162725 			(void) rt2560_init(sc);
21954609Szf162725 			(void) ieee80211_new_state(ic, IEEE80211_S_SCAN, -1);
21964609Szf162725 			RAL_LOCK(sc);
21974609Szf162725 		}
21984609Szf162725 	}
21994609Szf162725 	RAL_UNLOCK(sc);
22004609Szf162725 }
22014609Szf162725 
22024609Szf162725 static int
22034609Szf162725 rt2560_m_stat(void *arg, uint_t stat, uint64_t *val)
22044609Szf162725 {
22054609Szf162725 	struct rt2560_softc *sc  = (struct rt2560_softc *)arg;
22064609Szf162725 	ieee80211com_t	*ic = &sc->sc_ic;
22074609Szf162725 	ieee80211_node_t *ni = ic->ic_bss;
22084609Szf162725 	struct ieee80211_rateset *rs = &ni->in_rates;
22094609Szf162725 
22104609Szf162725 	RAL_LOCK(sc);
22114609Szf162725 	switch (stat) {
22124609Szf162725 	case MAC_STAT_IFSPEED:
22134609Szf162725 		*val = ((ic->ic_fixed_rate == IEEE80211_FIXED_RATE_NONE) ?
22144609Szf162725 		    (rs->ir_rates[ni->in_txrate] & IEEE80211_RATE_VAL)
22156890Sql147931 		    : ic->ic_fixed_rate) / 2 * 1000000;
22164609Szf162725 		break;
22174609Szf162725 	case MAC_STAT_NOXMTBUF:
22184609Szf162725 		*val = sc->sc_tx_nobuf;
22194609Szf162725 		break;
22204609Szf162725 	case MAC_STAT_NORCVBUF:
22214609Szf162725 		*val = sc->sc_rx_nobuf;
22224609Szf162725 		break;
22234609Szf162725 	case MAC_STAT_IERRORS:
22244609Szf162725 		*val = sc->sc_rx_err;
22254609Szf162725 		break;
22264609Szf162725 	case MAC_STAT_RBYTES:
22274609Szf162725 		*val = ic->ic_stats.is_rx_bytes;
22284609Szf162725 		break;
22294609Szf162725 	case MAC_STAT_IPACKETS:
22304609Szf162725 		*val = ic->ic_stats.is_rx_frags;
22314609Szf162725 		break;
22324609Szf162725 	case MAC_STAT_OBYTES:
22334609Szf162725 		*val = ic->ic_stats.is_tx_bytes;
22344609Szf162725 		break;
22354609Szf162725 	case MAC_STAT_OPACKETS:
22364609Szf162725 		*val = ic->ic_stats.is_tx_frags;
22374609Szf162725 		break;
22384609Szf162725 	case MAC_STAT_OERRORS:
22394609Szf162725 	case WIFI_STAT_TX_FAILED:
22404609Szf162725 		*val = sc->sc_tx_err;
22414609Szf162725 		break;
22424609Szf162725 	case WIFI_STAT_TX_RETRANS:
22434609Szf162725 		*val = sc->sc_tx_retries;
22444609Szf162725 		break;
22454609Szf162725 	case WIFI_STAT_FCS_ERRORS:
22464609Szf162725 	case WIFI_STAT_WEP_ERRORS:
22474609Szf162725 	case WIFI_STAT_TX_FRAGS:
22484609Szf162725 	case WIFI_STAT_MCAST_TX:
22494609Szf162725 	case WIFI_STAT_RTS_SUCCESS:
22504609Szf162725 	case WIFI_STAT_RTS_FAILURE:
22514609Szf162725 	case WIFI_STAT_ACK_FAILURE:
22524609Szf162725 	case WIFI_STAT_RX_FRAGS:
22534609Szf162725 	case WIFI_STAT_MCAST_RX:
22544609Szf162725 	case WIFI_STAT_RX_DUPS:
22554609Szf162725 		RAL_UNLOCK(sc);
22564609Szf162725 		return (ieee80211_stat(ic, stat, val));
22574609Szf162725 	default:
22584609Szf162725 		RAL_UNLOCK(sc);
22594609Szf162725 		return (ENOTSUP);
22604609Szf162725 	}
22614609Szf162725 	RAL_UNLOCK(sc);
22624609Szf162725 
22634609Szf162725 	return (0);
22644609Szf162725 }
22654609Szf162725 
22664609Szf162725 static uint_t
22674609Szf162725 rt2560_intr(caddr_t arg)
22684609Szf162725 {
22697249Sff224033 	/* LINTED E_BAD_PTR_CAST_ALIGN */
22704609Szf162725 	struct rt2560_softc *sc = (struct rt2560_softc *)arg;
22714609Szf162725 	uint32_t r;
22724609Szf162725 
22734609Szf162725 	RAL_LOCK(sc);
22744609Szf162725 
2275*8230SQuaker.Fang@Sun.COM 	if (!RAL_IS_RUNNING(sc)) {
2276*8230SQuaker.Fang@Sun.COM 		/*
2277*8230SQuaker.Fang@Sun.COM 		 * The hardware is not ready/present, don't touch anything.
2278*8230SQuaker.Fang@Sun.COM 		 * Note this can happen early on if the IRQ is shared.
2279*8230SQuaker.Fang@Sun.COM 		 */
2280*8230SQuaker.Fang@Sun.COM 		RAL_UNLOCK(sc);
2281*8230SQuaker.Fang@Sun.COM 		return (DDI_INTR_UNCLAIMED);
2282*8230SQuaker.Fang@Sun.COM 	}
2283*8230SQuaker.Fang@Sun.COM 
22844609Szf162725 	r = RAL_READ(sc, RT2560_CSR7);
22854609Szf162725 	RAL_WRITE(sc, RT2560_CSR7, r);
22864609Szf162725 
22874609Szf162725 	if (r == 0xffffffff) {
22884609Szf162725 		RAL_UNLOCK(sc);
22894609Szf162725 		return (DDI_INTR_UNCLAIMED);
22904609Szf162725 	}
22914609Szf162725 
22924609Szf162725 	if (!(r & RT2560_INTR_ALL)) {
22934609Szf162725 		RAL_UNLOCK(sc);
22944609Szf162725 		return (DDI_INTR_UNCLAIMED);
22954609Szf162725 	}
22964609Szf162725 
22974609Szf162725 	/* disable interrupts */
22984609Szf162725 	RAL_WRITE(sc, RT2560_CSR8, 0xffffffff);
22994609Szf162725 
23004609Szf162725 	if (r & RT2560_TX_DONE) {
23014609Szf162725 		RAL_UNLOCK(sc);
23024609Szf162725 		rt2560_tx_intr(sc);
23034609Szf162725 		RAL_LOCK(sc);
23044609Szf162725 	}
23054609Szf162725 
23064609Szf162725 	if (r & RT2560_PRIO_DONE) {
23074609Szf162725 		RAL_UNLOCK(sc);
23084609Szf162725 		rt2560_prio_intr(sc);
23094609Szf162725 		RAL_LOCK(sc);
23104609Szf162725 	}
23114609Szf162725 
23124609Szf162725 	if (r & RT2560_RX_DONE) {
23134609Szf162725 		sc->sc_rx_pend = 1;
23144609Szf162725 		ddi_trigger_softintr(sc->sc_softint_id);
23154609Szf162725 	}
23164609Szf162725 
23174609Szf162725 	/* re-enable interrupts */
23184609Szf162725 	RAL_WRITE(sc, RT2560_CSR8, RT2560_INTR_MASK);
23194609Szf162725 	RAL_UNLOCK(sc);
23204609Szf162725 
23214609Szf162725 	return (DDI_INTR_CLAIMED);
23224609Szf162725 }
23234609Szf162725 
23248099SQuaker.Fang@Sun.COM /*
23258099SQuaker.Fang@Sun.COM  * quiesce(9E) entry point.
23268099SQuaker.Fang@Sun.COM  *
23278099SQuaker.Fang@Sun.COM  * This function is called when the system is single-threaded at high
23288099SQuaker.Fang@Sun.COM  * PIL with preemption disabled. Therefore, this function must not be
23298099SQuaker.Fang@Sun.COM  * blocked.
23308099SQuaker.Fang@Sun.COM  *
23318099SQuaker.Fang@Sun.COM  * This function returns DDI_SUCCESS on success, or DDI_FAILURE on failure.
23328099SQuaker.Fang@Sun.COM  * DDI_FAILURE indicates an error condition and should almost never happen.
23338099SQuaker.Fang@Sun.COM  */
23348099SQuaker.Fang@Sun.COM static int32_t
23358099SQuaker.Fang@Sun.COM rt2560_quiesce(dev_info_t *devinfo)
23364609Szf162725 {
23374609Szf162725 	struct rt2560_softc *sc;
23384609Szf162725 
23398099SQuaker.Fang@Sun.COM 	sc = ddi_get_soft_state(ral_soft_state_p, ddi_get_instance(devinfo));
23408099SQuaker.Fang@Sun.COM 	if (sc == NULL)
23414609Szf162725 		return (DDI_FAILURE);
23424609Szf162725 
23434609Szf162725 	/* abort Tx */
23444609Szf162725 	RAL_WRITE(sc, RT2560_TXCSR0, RT2560_ABORT_TX);
23454609Szf162725 
23464609Szf162725 	/* disable Rx */
23474609Szf162725 	RAL_WRITE(sc, RT2560_RXCSR0, RT2560_DISABLE_RX);
23484609Szf162725 
23494609Szf162725 	/* reset ASIC (imply reset BBP) */
23504609Szf162725 	RAL_WRITE(sc, RT2560_CSR1, RT2560_RESET_ASIC);
23514609Szf162725 	RAL_WRITE(sc, RT2560_CSR1, 0);
23524609Szf162725 
23534609Szf162725 	/* disable interrupts */
23544609Szf162725 	RAL_WRITE(sc, RT2560_CSR8, 0xffffffff);
23554609Szf162725 
23564609Szf162725 	return (DDI_SUCCESS);
23574609Szf162725 }
23584609Szf162725 
23594609Szf162725 static int
23604609Szf162725 rt2560_attach(dev_info_t *devinfo, ddi_attach_cmd_t cmd)
23614609Szf162725 {
23624609Szf162725 	struct rt2560_softc *sc;
23634609Szf162725 	struct ieee80211com *ic;
23644609Szf162725 	int err, i;
23654609Szf162725 	int instance;
23664609Szf162725 
23674609Szf162725 	ddi_acc_handle_t ioh;
23684609Szf162725 	caddr_t regs;
23694609Szf162725 	uint16_t vendor_id, device_id, command;
23704609Szf162725 	uint8_t cachelsz;
23714609Szf162725 	char strbuf[32];
23724609Szf162725 
23734609Szf162725 	wifi_data_t wd = { 0 };
23744609Szf162725 	mac_register_t *macp;
23754609Szf162725 
23764609Szf162725 	RAL_DEBUG(RAL_DBG_GLD, "enter rt2560_attach()\n");
23774609Szf162725 
2378*8230SQuaker.Fang@Sun.COM 	switch (cmd) {
2379*8230SQuaker.Fang@Sun.COM 	case DDI_ATTACH:
2380*8230SQuaker.Fang@Sun.COM 		break;
2381*8230SQuaker.Fang@Sun.COM 	case DDI_RESUME:
2382*8230SQuaker.Fang@Sun.COM 		sc = ddi_get_soft_state(ral_soft_state_p,
2383*8230SQuaker.Fang@Sun.COM 		    ddi_get_instance(devinfo));
2384*8230SQuaker.Fang@Sun.COM 		sc->sc_flags &= ~RAL_FLAG_SUSPENDING;
2385*8230SQuaker.Fang@Sun.COM 		if (RAL_IS_INITED(sc))
2386*8230SQuaker.Fang@Sun.COM 			(void) rt2560_init(sc);
2387*8230SQuaker.Fang@Sun.COM 		RAL_DEBUG(RAL_DBG_SUSPEND, "ral resume ...\n");
2388*8230SQuaker.Fang@Sun.COM 		return (DDI_SUCCESS);
2389*8230SQuaker.Fang@Sun.COM 	default:
23904609Szf162725 		return (DDI_FAILURE);
2391*8230SQuaker.Fang@Sun.COM 	}
23924609Szf162725 
23934609Szf162725 	instance = ddi_get_instance(devinfo);
23944609Szf162725 
23954609Szf162725 	if (ddi_soft_state_zalloc(ral_soft_state_p, instance) != DDI_SUCCESS) {
23964609Szf162725 		RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): "
23974609Szf162725 		    "unable to alloc soft_state_p\n");
23984609Szf162725 		return (DDI_FAILURE);
23994609Szf162725 	}
24004609Szf162725 
24014609Szf162725 	sc = ddi_get_soft_state(ral_soft_state_p, instance);
24024609Szf162725 	ic = (ieee80211com_t *)&sc->sc_ic;
24034609Szf162725 	sc->sc_dev = devinfo;
24044609Szf162725 
24054609Szf162725 	/* pci configuration */
24064609Szf162725 	err = ddi_regs_map_setup(devinfo, 0, &regs, 0, 0, &ral_csr_accattr,
24074609Szf162725 	    &ioh);
24084609Szf162725 	if (err != DDI_SUCCESS) {
24094609Szf162725 		RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): "
24104609Szf162725 		    "ddi_regs_map_setup() failed");
24114609Szf162725 		goto fail1;
24124609Szf162725 	}
24134609Szf162725 
24144609Szf162725 	cachelsz = ddi_get8(ioh, (uint8_t *)(regs + PCI_CONF_CACHE_LINESZ));
24154609Szf162725 	if (cachelsz == 0)
24164609Szf162725 		cachelsz = 0x10;
24174609Szf162725 	sc->sc_cachelsz = cachelsz << 2;
24184609Szf162725 
24197249Sff224033 	vendor_id = ddi_get16(ioh,
24207249Sff224033 	    (uint16_t *)((uintptr_t)regs + PCI_CONF_VENID));
24217249Sff224033 	device_id = ddi_get16(ioh,
24227249Sff224033 	    (uint16_t *)((uintptr_t)regs + PCI_CONF_DEVID));
24234609Szf162725 
24244609Szf162725 	RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): vendor 0x%x, "
24254609Szf162725 	    "device id 0x%x, cache size %d\n", vendor_id, device_id, cachelsz);
24264609Szf162725 
24274609Szf162725 	/*
24284609Szf162725 	 * Enable response to memory space accesses,
24294609Szf162725 	 * and enabe bus master.
24304609Szf162725 	 */
24314609Szf162725 	command = PCI_COMM_MAE | PCI_COMM_ME;
24327249Sff224033 	ddi_put16(ioh, (uint16_t *)((uintptr_t)regs + PCI_CONF_COMM), command);
24334609Szf162725 	RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): "
24344609Szf162725 	    "set command reg to 0x%x \n", command);
24354609Szf162725 
24364609Szf162725 	ddi_put8(ioh, (uint8_t *)(regs + PCI_CONF_LATENCY_TIMER), 0xa8);
24374609Szf162725 	ddi_put8(ioh, (uint8_t *)(regs + PCI_CONF_ILINE), 0x10);
24384609Szf162725 	ddi_regs_map_free(&ioh);
24394609Szf162725 
24404609Szf162725 	/* pci i/o space */
24414609Szf162725 	err = ddi_regs_map_setup(devinfo, 1,
24424609Szf162725 	    &sc->sc_rbase, 0, 0, &ral_csr_accattr, &sc->sc_ioh);
24434609Szf162725 	RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): "
24444609Szf162725 	    "regs map1 = %x err=%d\n", regs, err);
24454609Szf162725 	if (err != DDI_SUCCESS) {
24464609Szf162725 		RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): "
24474609Szf162725 		    "ddi_regs_map_setup() failed");
24484609Szf162725 		goto fail1;
24494609Szf162725 	}
24504609Szf162725 
24514609Szf162725 	/* initialize the ral rate */
24524609Szf162725 	ral_rate_init();
24534609Szf162725 
24544609Szf162725 	/* retrieve RT2560 rev. no */
24554609Szf162725 	sc->asic_rev = RAL_READ(sc, RT2560_CSR0);
24564609Szf162725 
24574609Szf162725 	/* retrieve MAC address */
24584609Szf162725 	rt2560_get_macaddr(sc, ic->ic_macaddr);
24594609Szf162725 
24604609Szf162725 	/* retrieve RF rev. no and various other things from EEPROM */
24614609Szf162725 	rt2560_read_eeprom(sc);
24624609Szf162725 
24634609Szf162725 	RAL_DEBUG(RAL_DBG_GLD, "MAC/BBP RT2560 (rev 0x%02x), RF %s\n",
24644609Szf162725 	    sc->asic_rev, rt2560_get_rf(sc->rf_rev));
24654609Szf162725 
24664609Szf162725 	/*
24674609Szf162725 	 * Allocate Tx and Rx rings.
24684609Szf162725 	 */
24694609Szf162725 	err = rt2560_alloc_tx_ring(sc, &sc->txq, RT2560_TX_RING_COUNT);
24704609Szf162725 	if (err != DDI_SUCCESS) {
24714609Szf162725 		RAL_DEBUG(RAL_DBG_GLD, "could not allocate Tx ring\n");
24724609Szf162725 		goto fail2;
24734609Szf162725 	}
24744609Szf162725 	err = rt2560_alloc_tx_ring(sc, &sc->prioq, RT2560_PRIO_RING_COUNT);
24754609Szf162725 	if (err != DDI_SUCCESS) {
24764609Szf162725 		RAL_DEBUG(RAL_DBG_GLD, "could not allocate Prio ring\n");
24774609Szf162725 		goto fail3;
24784609Szf162725 	}
24794609Szf162725 	err = rt2560_alloc_rx_ring(sc, &sc->rxq, RT2560_RX_RING_COUNT);
24804609Szf162725 	if (err != DDI_SUCCESS) {
24814609Szf162725 		RAL_DEBUG(RAL_DBG_GLD, "could not allocate Rx ring\n");
24824609Szf162725 		goto fail4;
24834609Szf162725 	}
24844609Szf162725 
24854609Szf162725 	mutex_init(&sc->sc_genlock, NULL, MUTEX_DRIVER, NULL);
24864609Szf162725 	mutex_init(&sc->txq.tx_lock, NULL, MUTEX_DRIVER, NULL);
24874609Szf162725 	mutex_init(&sc->prioq.tx_lock, NULL, MUTEX_DRIVER, NULL);
24884609Szf162725 	mutex_init(&sc->rxq.rx_lock, NULL, MUTEX_DRIVER, NULL);
24894609Szf162725 
24904609Szf162725 
24914609Szf162725 	ic->ic_phytype = IEEE80211_T_OFDM;	/* not only, but not used */
24924609Szf162725 	ic->ic_opmode = IEEE80211_M_STA;	/* default to BSS mode */
24934609Szf162725 	ic->ic_state = IEEE80211_S_INIT;
24944609Szf162725 
24954609Szf162725 	ic->ic_maxrssi = 63;
24964609Szf162725 	ic->ic_set_shortslot = rt2560_update_slot;
24974609Szf162725 	ic->ic_xmit = rt2560_mgmt_send;
24984609Szf162725 
24994609Szf162725 	/* set device capabilities */
25004609Szf162725 	ic->ic_caps =
25014609Szf162725 	    IEEE80211_C_TXPMGT |	/* tx power management */
25024609Szf162725 	    IEEE80211_C_SHPREAMBLE |	/* short preamble supported */
25034609Szf162725 	    IEEE80211_C_SHSLOT;		/* short slot time supported */
25044609Szf162725 
25055296Szf162725 	ic->ic_caps |= IEEE80211_C_WPA; /* Support WPA/WPA2 */
25065296Szf162725 
25074609Szf162725 #define	IEEE80211_CHAN_A	\
25084609Szf162725 	(IEEE80211_CHAN_5GHZ | IEEE80211_CHAN_OFDM)
25094609Szf162725 
25104609Szf162725 	if (sc->rf_rev == RT2560_RF_5222) {
25114609Szf162725 		/* set supported .11a rates */
25124609Szf162725 		ic->ic_sup_rates[IEEE80211_MODE_11A] = rt2560_rateset_11a;
25134609Szf162725 
25144609Szf162725 		/* set supported .11a channels */
25154609Szf162725 		for (i = 36; i <= 64; i += 4) {
25164609Szf162725 			ic->ic_sup_channels[i].ich_freq =
25174609Szf162725 			    ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ);
25184609Szf162725 			ic->ic_sup_channels[i].ich_flags = IEEE80211_CHAN_A;
25194609Szf162725 		}
25204609Szf162725 		for (i = 100; i <= 140; i += 4) {
25214609Szf162725 			ic->ic_sup_channels[i].ich_freq =
25224609Szf162725 			    ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ);
25234609Szf162725 			ic->ic_sup_channels[i].ich_flags = IEEE80211_CHAN_A;
25244609Szf162725 		}
25254609Szf162725 		for (i = 149; i <= 161; i += 4) {
25264609Szf162725 			ic->ic_sup_channels[i].ich_freq =
25274609Szf162725 			    ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ);
25284609Szf162725 			ic->ic_sup_channels[i].ich_flags = IEEE80211_CHAN_A;
25294609Szf162725 		}
25304609Szf162725 	}
25314609Szf162725 
25324609Szf162725 	/* set supported .11b and .11g rates */
25334609Szf162725 	ic->ic_sup_rates[IEEE80211_MODE_11B] = rt2560_rateset_11b;
25344609Szf162725 	ic->ic_sup_rates[IEEE80211_MODE_11G] = rt2560_rateset_11g;
25354609Szf162725 
25364609Szf162725 	/* set supported .11b and .11g channels (1 through 14) */
25374609Szf162725 	for (i = 1; i <= 14; i++) {
25384609Szf162725 		ic->ic_sup_channels[i].ich_freq =
25394609Szf162725 		    ieee80211_ieee2mhz(i, IEEE80211_CHAN_2GHZ);
25404609Szf162725 		ic->ic_sup_channels[i].ich_flags =
25414609Szf162725 		    IEEE80211_CHAN_CCK | IEEE80211_CHAN_OFDM |
25424609Szf162725 		    IEEE80211_CHAN_DYN | IEEE80211_CHAN_2GHZ;
25434609Szf162725 	}
25444609Szf162725 
25454609Szf162725 	ieee80211_attach(ic);
25464609Szf162725 
25475296Szf162725 	/* register WPA door */
25485296Szf162725 	ieee80211_register_door(ic, ddi_driver_name(devinfo),
25495296Szf162725 	    ddi_get_instance(devinfo));
25505296Szf162725 
25514609Szf162725 	ic->ic_node_alloc = rt2560_node_alloc;
25524609Szf162725 	ic->ic_node_free = rt2560_node_free;
25534609Szf162725 
25544609Szf162725 	/* override state transition machine */
25554609Szf162725 	sc->sc_newstate = ic->ic_newstate;
25564609Szf162725 	ic->ic_newstate = rt2560_newstate;
25574609Szf162725 	ic->ic_watchdog = rt2560_watchdog;
25584609Szf162725 	ieee80211_media_init(ic);
25594609Szf162725 	ic->ic_def_txkey = 0;
25604609Szf162725 
25614609Szf162725 	sc->sc_rcr = 0;
25624609Szf162725 	sc->sc_rx_pend = 0;
25634609Szf162725 	sc->dwelltime = 300;
25644609Szf162725 	sc->sc_flags &= ~RAL_FLAG_RUNNING;
25654609Szf162725 
25664609Szf162725 	err = ddi_add_softintr(devinfo, DDI_SOFTINT_LOW,
25674609Szf162725 	    &sc->sc_softint_id, NULL, 0, ral_softint_handler, (caddr_t)sc);
25684609Szf162725 	if (err != DDI_SUCCESS) {
25694609Szf162725 		RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): "
25704609Szf162725 		    "ddi_add_softintr() failed");
25714609Szf162725 		goto fail5;
25724609Szf162725 	}
25734609Szf162725 
25744609Szf162725 	err = ddi_get_iblock_cookie(devinfo, 0, &sc->sc_iblock);
25754609Szf162725 	if (err != DDI_SUCCESS) {
25764609Szf162725 		RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): "
25774609Szf162725 		    "Can not get iblock cookie for INT\n");
25784609Szf162725 		goto fail6;
25794609Szf162725 	}
25804609Szf162725 
25814609Szf162725 	err = ddi_add_intr(devinfo, 0, NULL, NULL, rt2560_intr, (caddr_t)sc);
25824609Szf162725 	if (err != DDI_SUCCESS) {
25834609Szf162725 		RAL_DEBUG(RAL_DBG_GLD,
25844609Szf162725 		    "unable to add device interrupt handler\n");
25854609Szf162725 		goto fail6;
25864609Szf162725 	}
25874609Szf162725 
25884609Szf162725 	/*
25894609Szf162725 	 * Provide initial settings for the WiFi plugin; whenever this
25904609Szf162725 	 * information changes, we need to call mac_plugindata_update()
25914609Szf162725 	 */
25924609Szf162725 	wd.wd_opmode = ic->ic_opmode;
25934609Szf162725 	wd.wd_secalloc = WIFI_SEC_NONE;
25944609Szf162725 	IEEE80211_ADDR_COPY(wd.wd_bssid, ic->ic_bss->in_bssid);
25954609Szf162725 
25964609Szf162725 	if ((macp = mac_alloc(MAC_VERSION)) == NULL) {
25974609Szf162725 		RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): "
25984609Szf162725 		    "MAC version mismatch\n");
25994609Szf162725 		goto fail7;
26004609Szf162725 	}
26014609Szf162725 
26024609Szf162725 	macp->m_type_ident	= MAC_PLUGIN_IDENT_WIFI;
26034609Szf162725 	macp->m_driver		= sc;
26044609Szf162725 	macp->m_dip		= devinfo;
26054609Szf162725 	macp->m_src_addr	= ic->ic_macaddr;
26064609Szf162725 	macp->m_callbacks	= &rt2560_m_callbacks;
26074609Szf162725 	macp->m_min_sdu		= 0;
26084609Szf162725 	macp->m_max_sdu		= IEEE80211_MTU;
26094609Szf162725 	macp->m_pdata		= &wd;
26104609Szf162725 	macp->m_pdata_size	= sizeof (wd);
26114609Szf162725 
26124609Szf162725 	err = mac_register(macp, &ic->ic_mach);
26134609Szf162725 	mac_free(macp);
26144609Szf162725 	if (err != 0) {
26154609Szf162725 		RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): "
26164609Szf162725 		    "mac_register err %x\n", err);
26174609Szf162725 		goto fail7;
26184609Szf162725 	}
26194609Szf162725 
26204609Szf162725 	/*
26214609Szf162725 	 * Create minor node of type DDI_NT_NET_WIFI
26224609Szf162725 	 */
26234609Szf162725 	(void) snprintf(strbuf, sizeof (strbuf), "%s%d",
26244609Szf162725 	    "ral", instance);
26254609Szf162725 	err = ddi_create_minor_node(devinfo, strbuf, S_IFCHR,
26264609Szf162725 	    instance + 1, DDI_NT_NET_WIFI, 0);
26274609Szf162725 
26284609Szf162725 	if (err != DDI_SUCCESS)
26294609Szf162725 		RAL_DEBUG(RAL_DBG_GLD, "ddi_create_minor_node() failed\n");
26304609Szf162725 
26314609Szf162725 	/*
26324609Szf162725 	 * Notify link is down now
26334609Szf162725 	 */
26344609Szf162725 	mac_link_update(ic->ic_mach, LINK_STATE_DOWN);
26354609Szf162725 
26364609Szf162725 	RAL_DEBUG(RAL_DBG_GLD, "rt2560_attach() exit successfully.\n");
26374609Szf162725 	return (DDI_SUCCESS);
26384609Szf162725 fail7:
26394609Szf162725 	ddi_remove_intr(devinfo, 0, sc->sc_iblock);
26404609Szf162725 fail6:
26414609Szf162725 	ddi_remove_softintr(sc->sc_softint_id);
26424609Szf162725 fail5:
26434609Szf162725 	mutex_destroy(&sc->sc_genlock);
26444609Szf162725 	mutex_destroy(&sc->txq.tx_lock);
26454609Szf162725 	mutex_destroy(&sc->prioq.tx_lock);
26464609Szf162725 	mutex_destroy(&sc->rxq.rx_lock);
26474609Szf162725 
26484609Szf162725 	rt2560_free_rx_ring(sc, &sc->rxq);
26494609Szf162725 fail4:
26504609Szf162725 	rt2560_free_tx_ring(sc, &sc->prioq);
26514609Szf162725 fail3:
26524609Szf162725 	rt2560_free_tx_ring(sc, &sc->txq);
26534609Szf162725 fail2:
26544609Szf162725 	ddi_regs_map_free(&sc->sc_ioh);
26554609Szf162725 fail1:
26564609Szf162725 	ddi_soft_state_free(ral_soft_state_p, ddi_get_instance(devinfo));
26574609Szf162725 
26584609Szf162725 	return (DDI_FAILURE);
26594609Szf162725 }
26604609Szf162725 
26614609Szf162725 static int
26624609Szf162725 rt2560_detach(dev_info_t *devinfo, ddi_detach_cmd_t cmd)
26634609Szf162725 {
26644609Szf162725 	struct rt2560_softc *sc;
26654609Szf162725 
26664609Szf162725 	RAL_DEBUG(RAL_DBG_GLD, "enter rt2560_detach()\n");
26674609Szf162725 	sc = ddi_get_soft_state(ral_soft_state_p, ddi_get_instance(devinfo));
26684609Szf162725 
2669*8230SQuaker.Fang@Sun.COM 	switch (cmd) {
2670*8230SQuaker.Fang@Sun.COM 	case DDI_DETACH:
2671*8230SQuaker.Fang@Sun.COM 		break;
2672*8230SQuaker.Fang@Sun.COM 	case DDI_SUSPEND:
2673*8230SQuaker.Fang@Sun.COM 		if (RAL_IS_INITED(sc))
2674*8230SQuaker.Fang@Sun.COM 			(void) rt2560_stop(sc);
2675*8230SQuaker.Fang@Sun.COM 		sc->sc_flags |= RAL_FLAG_SUSPENDING;
2676*8230SQuaker.Fang@Sun.COM 		RAL_DEBUG(RAL_DBG_SUSPEND, "ral suspend ...\n");
2677*8230SQuaker.Fang@Sun.COM 		return (DDI_SUCCESS);
2678*8230SQuaker.Fang@Sun.COM 	default:
26794609Szf162725 		return (DDI_FAILURE);
2680*8230SQuaker.Fang@Sun.COM 	}
26814609Szf162725 
26827507SXinghua.Wen@Sun.COM 	if (mac_disable(sc->sc_ic.ic_mach) != 0)
26837507SXinghua.Wen@Sun.COM 		return (DDI_FAILURE);
26847507SXinghua.Wen@Sun.COM 
26854609Szf162725 	rt2560_stop(sc);
26864609Szf162725 
26874609Szf162725 	/*
26884609Szf162725 	 * Unregister from the MAC layer subsystem
26894609Szf162725 	 */
26907507SXinghua.Wen@Sun.COM 	(void) mac_unregister(sc->sc_ic.ic_mach);
26914609Szf162725 
26924609Szf162725 	ddi_remove_intr(devinfo, 0, sc->sc_iblock);
26934609Szf162725 	ddi_remove_softintr(sc->sc_softint_id);
26944609Szf162725 
26954609Szf162725 	/*
26964609Szf162725 	 * detach ieee80211 layer
26974609Szf162725 	 */
26984609Szf162725 	ieee80211_detach(&sc->sc_ic);
26994609Szf162725 
27004609Szf162725 	rt2560_free_tx_ring(sc, &sc->txq);
27014609Szf162725 	rt2560_free_tx_ring(sc, &sc->prioq);
27024609Szf162725 	rt2560_free_rx_ring(sc, &sc->rxq);
27034609Szf162725 
27044609Szf162725 	ddi_regs_map_free(&sc->sc_ioh);
27054609Szf162725 
27064609Szf162725 	mutex_destroy(&sc->sc_genlock);
27074609Szf162725 	mutex_destroy(&sc->txq.tx_lock);
27084609Szf162725 	mutex_destroy(&sc->prioq.tx_lock);
27094609Szf162725 	mutex_destroy(&sc->rxq.rx_lock);
27104609Szf162725 
27114609Szf162725 	ddi_remove_minor_node(devinfo, NULL);
27124609Szf162725 	ddi_soft_state_free(ral_soft_state_p, ddi_get_instance(devinfo));
27134609Szf162725 
27144609Szf162725 	return (DDI_SUCCESS);
27154609Szf162725 }
27164609Szf162725 
27174609Szf162725 int
27184609Szf162725 _info(struct modinfo *modinfop)
27194609Szf162725 {
27204609Szf162725 	return (mod_info(&modlinkage, modinfop));
27214609Szf162725 }
27224609Szf162725 
27234609Szf162725 int
27244609Szf162725 _init(void)
27254609Szf162725 {
27264609Szf162725 	int status;
27274609Szf162725 
27284609Szf162725 	status = ddi_soft_state_init(&ral_soft_state_p,
27294609Szf162725 	    sizeof (struct rt2560_softc), 1);
27304609Szf162725 	if (status != 0)
27314609Szf162725 		return (status);
27324609Szf162725 
27334609Szf162725 	mac_init_ops(&ral_dev_ops, "ral");
27344609Szf162725 	status = mod_install(&modlinkage);
27354609Szf162725 	if (status != 0) {
27364609Szf162725 		mac_fini_ops(&ral_dev_ops);
27374609Szf162725 		ddi_soft_state_fini(&ral_soft_state_p);
27384609Szf162725 	}
27394609Szf162725 	return (status);
27404609Szf162725 }
27414609Szf162725 
27424609Szf162725 int
27434609Szf162725 _fini(void)
27444609Szf162725 {
27454609Szf162725 	int status;
27464609Szf162725 
27474609Szf162725 	status = mod_remove(&modlinkage);
27484609Szf162725 	if (status == 0) {
27494609Szf162725 		mac_fini_ops(&ral_dev_ops);
27504609Szf162725 		ddi_soft_state_fini(&ral_soft_state_p);
27514609Szf162725 	}
27524609Szf162725 	return (status);
27534609Szf162725 }
2754