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); 157*8099SQuaker.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, 163*8099SQuaker.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*8099SQuaker.Fang@Sun.COM "Ralink RT2500 driver v1.5", /* 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 *); 185*8099SQuaker.Fang@Sun.COM static int rt2560_m_setprop(void *, const char *, mac_prop_id_t, 186*8099SQuaker.Fang@Sun.COM uint_t, const void *); 187*8099SQuaker.Fang@Sun.COM static int rt2560_m_getprop(void *, const char *, mac_prop_id_t, 188*8099SQuaker.Fang@Sun.COM uint_t, uint_t, void *); 1894609Szf162725 1904609Szf162725 static mac_callbacks_t rt2560_m_callbacks = { 191*8099SQuaker.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, 201*8099SQuaker.Fang@Sun.COM NULL, /* mc_getcapab */ 202*8099SQuaker.Fang@Sun.COM NULL, 203*8099SQuaker.Fang@Sun.COM NULL, 204*8099SQuaker.Fang@Sun.COM rt2560_m_setprop, 205*8099SQuaker.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 14664609Szf162725 if (sc->prioq.queued >= RT2560_PRIO_RING_COUNT) { 14674609Szf162725 err = ENOMEM; 14684609Szf162725 sc->sc_tx_nobuf++; 14694609Szf162725 goto fail1; 14704609Szf162725 } 14714609Szf162725 14724609Szf162725 m = allocb(msgdsize(mp) + 32, BPRI_MED); 14734609Szf162725 if (m == NULL) { 14744609Szf162725 RAL_DEBUG(RAL_DBG_TX, "rt2560_mgmt_send: can't alloc mblk.\n"); 14754609Szf162725 err = DDI_FAILURE; 14764609Szf162725 goto fail1; 14774609Szf162725 } 14784609Szf162725 14794609Szf162725 for (off = 0, m0 = mp; m0 != NULL; m0 = m0->b_cont) { 14804609Szf162725 mblen = MBLKL(m0); 14814609Szf162725 (void) memcpy(m->b_rptr + off, m0->b_rptr, mblen); 14824609Szf162725 off += mblen; 14834609Szf162725 } 14844609Szf162725 m->b_wptr += off; 14854609Szf162725 14864609Szf162725 wh = (struct ieee80211_frame *)m->b_rptr; 14874609Szf162725 ni = ieee80211_find_txnode(ic, wh->i_addr1); 14884609Szf162725 14894609Szf162725 if (ni == NULL) { 14904609Szf162725 err = DDI_FAILURE; 14914609Szf162725 sc->sc_tx_err++; 14924609Szf162725 goto fail2; 14934609Szf162725 } 14944609Szf162725 14954609Szf162725 /* to support shared_key auth mode */ 14964609Szf162725 if (wh->i_fc[1] & IEEE80211_FC1_WEP) { 14974609Szf162725 k = ieee80211_crypto_encap(ic, m); 14984609Szf162725 if (k == NULL) { 14994609Szf162725 err = DDI_FAILURE; 15004609Szf162725 sc->sc_tx_err++; 15014609Szf162725 goto fail3; 15024609Szf162725 } 15034609Szf162725 /* packet header may have moved, reset our local pointer */ 15044609Szf162725 wh = (struct ieee80211_frame *)m->b_rptr; 15054609Szf162725 } 15064609Szf162725 15074609Szf162725 desc = &sc->prioq.desc[sc->prioq.cur]; 15084609Szf162725 data = &sc->prioq.data[sc->prioq.cur]; 15094609Szf162725 15104609Szf162725 rate = IEEE80211_IS_CHAN_5GHZ(ic->ic_curchan) ? 12 : 2; 15114609Szf162725 data->ni = ieee80211_ref_node(ni); 15124609Szf162725 15134609Szf162725 pktlen = msgdsize(m); 15144609Szf162725 dest = data->buf; 15154609Szf162725 bcopy(m->b_rptr, dest, pktlen); 15164609Szf162725 15174609Szf162725 wh = (struct ieee80211_frame *)m->b_rptr; 15184609Szf162725 if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) { 15194609Szf162725 flags |= RT2560_TX_ACK; 15204609Szf162725 15214609Szf162725 dur = rt2560_txtime(RAL_ACK_SIZE, rate, ic->ic_flags) + 15224609Szf162725 RAL_SIFS; 15237249Sff224033 /* LINTED E_BAD_PTR_CAST_ALIGN */ 15244609Szf162725 *(uint16_t *)wh->i_dur = LE_16(dur); 15254609Szf162725 15264609Szf162725 /* tell hardware to add timestamp for probe responses */ 15274609Szf162725 if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) == 15284609Szf162725 IEEE80211_FC0_TYPE_MGT && 15294609Szf162725 (wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) == 15304609Szf162725 IEEE80211_FC0_SUBTYPE_PROBE_RESP) 15314609Szf162725 flags |= RT2560_TX_TIMESTAMP; 15324609Szf162725 } 15334609Szf162725 15344609Szf162725 rt2560_setup_tx_desc(sc, desc, flags, pktlen, rate, 0); 15354609Szf162725 15364609Szf162725 idx = sc->prioq.cur; 15374609Szf162725 15384609Szf162725 dr = &sc->prioq.dr_txbuf[idx]; 15394609Szf162725 (void) ddi_dma_sync(dr->dr_hnd, 0, RAL_TXBUF_SIZE, DDI_DMA_SYNC_FORDEV); 15404609Szf162725 15414609Szf162725 dr = &sc->prioq.dr_desc; 15424609Szf162725 (void) ddi_dma_sync(dr->dr_hnd, idx * RT2560_TX_DESC_SIZE, 15434609Szf162725 RT2560_TX_DESC_SIZE, DDI_DMA_SYNC_FORDEV); 15444609Szf162725 15454609Szf162725 RAL_DEBUG(RAL_DBG_MGMT, "sending mgt frame len=%u idx=%u rate=%u\n", 15464609Szf162725 pktlen, sc->prioq.cur, rate); 15474609Szf162725 15484609Szf162725 /* kick prio */ 15494609Szf162725 sc->prioq.queued++; /* IF > RT2560_PRIO_RING_COUNT? FULL */ 15504609Szf162725 sc->prioq.cur = (sc->prioq.cur + 1) % RT2560_PRIO_RING_COUNT; 15514609Szf162725 RAL_WRITE(sc, RT2560_TXCSR0, RT2560_KICK_PRIO); 15524609Szf162725 15534609Szf162725 sc->sc_tx_timer = 5; 15544609Szf162725 15556411Szf162725 ic->ic_stats.is_tx_frags++; 15566411Szf162725 ic->ic_stats.is_tx_bytes += pktlen; 15576411Szf162725 15584609Szf162725 fail3: 15594609Szf162725 ieee80211_free_node(ni); 15604609Szf162725 fail2: 15614609Szf162725 freemsg(m); 15624609Szf162725 fail1: 15634609Szf162725 freemsg(mp); 15644609Szf162725 mutex_exit(&sc->prioq.tx_lock); 15654609Szf162725 15664609Szf162725 return (err); 15674609Szf162725 } 15684609Szf162725 15694609Szf162725 static int 15704609Szf162725 rt2560_send(ieee80211com_t *ic, mblk_t *mp) 15714609Szf162725 { 15724609Szf162725 struct rt2560_softc *sc = (struct rt2560_softc *)ic; 15734609Szf162725 struct rt2560_tx_desc *desc; 15744609Szf162725 struct rt2560_tx_data *data; 15754609Szf162725 struct rt2560_node *rn; 15764609Szf162725 struct ieee80211_rateset *rs; 15774609Szf162725 struct ieee80211_frame *wh; 15784609Szf162725 struct ieee80211_key *k; 15794609Szf162725 uint16_t dur; 15804609Szf162725 uint32_t flags = 0; 15814609Szf162725 int rate, err = DDI_SUCCESS; 15824609Szf162725 15834609Szf162725 struct ieee80211_node *ni; 15844609Szf162725 mblk_t *m, *m0; 15854609Szf162725 int off, mblen, pktlen; 15864609Szf162725 caddr_t dest; 15874609Szf162725 15884609Szf162725 struct dma_region *dr; 15894609Szf162725 uint32_t idx; 15904609Szf162725 15914609Szf162725 mutex_enter(&sc->txq.tx_lock); 15924609Szf162725 15934609Szf162725 if (sc->txq.queued >= RT2560_TX_RING_COUNT - 1) { 15944609Szf162725 RAL_DEBUG(RAL_DBG_TX, "ral: rt2560_tx_data(): " 15954609Szf162725 "no TX DMA buffer available!\n"); 15964609Szf162725 sc->sc_need_sched = 1; 15974609Szf162725 sc->sc_tx_nobuf++; 15984609Szf162725 err = ENOMEM; 15994609Szf162725 goto fail1; 16004609Szf162725 } 16014609Szf162725 16024609Szf162725 m = allocb(msgdsize(mp) + 32, BPRI_MED); 16034609Szf162725 if (m == NULL) { 16044609Szf162725 RAL_DEBUG(RAL_DBG_TX, "rt2560_xmit(): can't alloc mblk.\n"); 16054609Szf162725 err = DDI_FAILURE; 16064609Szf162725 goto fail1; 16074609Szf162725 } 16084609Szf162725 16094609Szf162725 for (off = 0, m0 = mp; m0 != NULL; m0 = m0->b_cont) { 16104609Szf162725 mblen = MBLKL(m0); 16114609Szf162725 (void) memcpy(m->b_rptr + off, m0->b_rptr, mblen); 16124609Szf162725 off += mblen; 16134609Szf162725 } 16144609Szf162725 m->b_wptr += off; 16154609Szf162725 16164609Szf162725 wh = (struct ieee80211_frame *)m->b_rptr; 16174609Szf162725 ni = ieee80211_find_txnode(ic, wh->i_addr1); 16184609Szf162725 16194609Szf162725 if (ni == NULL) { 16204609Szf162725 err = DDI_FAILURE; 16214609Szf162725 sc->sc_tx_err++; 16224609Szf162725 goto fail2; 16234609Szf162725 } 16244609Szf162725 16254609Szf162725 (void) ieee80211_encap(ic, m, ni); 16264609Szf162725 16274609Szf162725 if (wh->i_fc[1] & IEEE80211_FC1_WEP) { 16284609Szf162725 k = ieee80211_crypto_encap(ic, m); 16294609Szf162725 if (k == NULL) { 16304609Szf162725 sc->sc_tx_err++; 16314609Szf162725 err = DDI_FAILURE; 16324609Szf162725 goto fail3; 16334609Szf162725 } 16344609Szf162725 /* packet header may have moved, reset our local pointer */ 16354609Szf162725 wh = (struct ieee80211_frame *)m->b_rptr; 16364609Szf162725 } 16374609Szf162725 16384609Szf162725 /* 16394609Szf162725 * RTS/CTS exchange ignore, since the max packet will less than 16404609Szf162725 * the rtsthreshold (2346) 16414609Szf162725 * Unnecessary codes deleted. 16424609Szf162725 */ 16434609Szf162725 16444609Szf162725 data = &sc->txq.data[sc->txq.cur]; 16454609Szf162725 desc = &sc->txq.desc[sc->txq.cur]; 16464609Szf162725 16474609Szf162725 data->ni = ieee80211_ref_node(ni); 16484609Szf162725 16494609Szf162725 pktlen = msgdsize(m); 16504609Szf162725 dest = data->buf; 16514609Szf162725 bcopy(m->b_rptr, dest, pktlen); 16524609Szf162725 16534609Szf162725 if (ic->ic_fixed_rate != IEEE80211_FIXED_RATE_NONE) { 16544609Szf162725 rs = &ic->ic_sup_rates[ic->ic_curmode]; 16554609Szf162725 rate = rs->ir_rates[ic->ic_fixed_rate]; 16564609Szf162725 } else { 16574609Szf162725 rs = &ni->in_rates; 16584609Szf162725 rn = (struct rt2560_node *)ni; 16594609Szf162725 ni->in_txrate = ral_rssadapt_choose(&rn->rssadapt, rs, wh, 16604609Szf162725 pktlen, NULL, 0); 16614609Szf162725 rate = rs->ir_rates[ni->in_txrate]; 16624609Szf162725 } 16634609Szf162725 16644609Szf162725 rate &= IEEE80211_RATE_VAL; 16654609Szf162725 if (rate <= 0) { 16664609Szf162725 rate = 2; /* basic rate */ 16674609Szf162725 } 16684609Szf162725 16694609Szf162725 /* remember link conditions for rate adaptation algorithm */ 16704609Szf162725 if (ic->ic_fixed_rate == IEEE80211_FIXED_RATE_NONE) { 16714609Szf162725 data->id.id_len = pktlen; 16724609Szf162725 data->id.id_rateidx = ni->in_txrate; 16734609Szf162725 data->id.id_node = ni; 16744609Szf162725 data->id.id_rssi = ni->in_rssi; 16754609Szf162725 } else 16764609Szf162725 data->id.id_node = NULL; 16774609Szf162725 16784609Szf162725 if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) { 16794609Szf162725 flags |= RT2560_TX_ACK; 16804609Szf162725 16814609Szf162725 dur = rt2560_txtime(RAL_ACK_SIZE, rt2560_ack_rate(ic, rate), 16824609Szf162725 ic->ic_flags) + RAL_SIFS; 16837249Sff224033 /* LINTED E_BAD_PTR_CAST_ALIGN */ 16844609Szf162725 *(uint16_t *)wh->i_dur = LE_16(dur); 16854609Szf162725 } 16864609Szf162725 16874609Szf162725 /* flags |= RT2560_TX_CIPHER_NONE; */ 16884609Szf162725 rt2560_setup_tx_desc(sc, desc, flags, pktlen, rate, 0); 16894609Szf162725 16904609Szf162725 idx = sc->txq.cur; 16914609Szf162725 16924609Szf162725 dr = &sc->txq.dr_txbuf[idx]; 16934609Szf162725 (void) ddi_dma_sync(dr->dr_hnd, 0, RAL_TXBUF_SIZE, DDI_DMA_SYNC_FORDEV); 16944609Szf162725 16954609Szf162725 dr = &sc->txq.dr_desc; 16964609Szf162725 (void) ddi_dma_sync(dr->dr_hnd, idx * RT2560_TX_DESC_SIZE, 16974609Szf162725 RT2560_TX_DESC_SIZE, DDI_DMA_SYNC_FORDEV); 16984609Szf162725 16994609Szf162725 RAL_DEBUG(RAL_DBG_TX, "sending data frame len=%u idx=%u rate=%u\n", 17004609Szf162725 pktlen, sc->txq.cur, rate); 17014609Szf162725 17024609Szf162725 /* kick tx */ 17034609Szf162725 sc->txq.queued++; 17044609Szf162725 sc->txq.cur = (sc->txq.cur + 1) % RT2560_TX_RING_COUNT; 17054609Szf162725 RAL_WRITE(sc, RT2560_TXCSR0, RT2560_KICK_TX); 17064609Szf162725 17074609Szf162725 sc->sc_tx_timer = 5; 17084609Szf162725 17096411Szf162725 ic->ic_stats.is_tx_frags++; 17106411Szf162725 ic->ic_stats.is_tx_bytes += pktlen; 17116411Szf162725 17124609Szf162725 freemsg(mp); 17134609Szf162725 fail3: 17144609Szf162725 ieee80211_free_node(ni); 17154609Szf162725 fail2: 17164609Szf162725 freemsg(m); 17174609Szf162725 fail1: 17184609Szf162725 mutex_exit(&sc->txq.tx_lock); 17194609Szf162725 return (err); 17204609Szf162725 } 17214609Szf162725 17224609Szf162725 static mblk_t * 17234609Szf162725 rt2560_m_tx(void *arg, mblk_t *mp) 17244609Szf162725 { 17254609Szf162725 struct rt2560_softc *sc = (struct rt2560_softc *)arg; 17264609Szf162725 struct ieee80211com *ic = &sc->sc_ic; 17274609Szf162725 mblk_t *next; 17284609Szf162725 17294609Szf162725 /* 17304609Szf162725 * No data frames go out unless we're associated; this 17314609Szf162725 * should not happen as the 802.11 layer does not enable 17324609Szf162725 * the xmit queue until we enter the RUN state. 17334609Szf162725 */ 17344609Szf162725 if (ic->ic_state != IEEE80211_S_RUN) { 17354609Szf162725 RAL_DEBUG(RAL_DBG_TX, "ral: rt2560_tx_data(): " 17364609Szf162725 "discard, state %u\n", ic->ic_state); 17374609Szf162725 freemsgchain(mp); 17384609Szf162725 return (NULL); 17394609Szf162725 } 17404609Szf162725 17414609Szf162725 while (mp != NULL) { 17424609Szf162725 next = mp->b_next; 17434609Szf162725 mp->b_next = NULL; 17444609Szf162725 if (rt2560_send(ic, mp) != DDI_SUCCESS) { 17454609Szf162725 mp->b_next = next; 17464609Szf162725 freemsgchain(mp); 17474609Szf162725 return (NULL); 17484609Szf162725 } 17494609Szf162725 mp = next; 17504609Szf162725 } 17514609Szf162725 return (mp); 17524609Szf162725 } 17534609Szf162725 17544609Szf162725 static void 17554609Szf162725 rt2560_set_macaddr(struct rt2560_softc *sc, uint8_t *addr) 17564609Szf162725 { 17574609Szf162725 uint32_t tmp; 17584609Szf162725 17594609Szf162725 tmp = addr[0] | addr[1] << 8 | addr[2] << 16 | addr[3] << 24; 17604609Szf162725 RAL_WRITE(sc, RT2560_CSR3, tmp); 17614609Szf162725 17624609Szf162725 tmp = addr[4] | addr[5] << 8; 17634609Szf162725 RAL_WRITE(sc, RT2560_CSR4, tmp); 17644609Szf162725 17654609Szf162725 RAL_DEBUG(RAL_DBG_HW, 17664609Szf162725 "setting MAC address to " MACSTR "\n", MAC2STR(addr)); 17674609Szf162725 } 17684609Szf162725 17694609Szf162725 static void 17704609Szf162725 rt2560_get_macaddr(struct rt2560_softc *sc, uint8_t *addr) 17714609Szf162725 { 17724609Szf162725 uint32_t tmp; 17734609Szf162725 17744609Szf162725 tmp = RAL_READ(sc, RT2560_CSR3); 17754609Szf162725 addr[0] = tmp & 0xff; 17764609Szf162725 addr[1] = (tmp >> 8) & 0xff; 17774609Szf162725 addr[2] = (tmp >> 16) & 0xff; 17784609Szf162725 addr[3] = (tmp >> 24); 17794609Szf162725 17804609Szf162725 tmp = RAL_READ(sc, RT2560_CSR4); 17814609Szf162725 addr[4] = tmp & 0xff; 17824609Szf162725 addr[5] = (tmp >> 8) & 0xff; 17834609Szf162725 } 17844609Szf162725 17854609Szf162725 static void 17864609Szf162725 rt2560_update_promisc(struct rt2560_softc *sc) 17874609Szf162725 { 17884609Szf162725 uint32_t tmp; 17894609Szf162725 17904609Szf162725 tmp = RAL_READ(sc, RT2560_RXCSR0); 17914609Szf162725 tmp &= ~RT2560_DROP_NOT_TO_ME; 17924609Szf162725 if (!(sc->sc_rcr & RAL_RCR_PROMISC)) 17934609Szf162725 tmp |= RT2560_DROP_NOT_TO_ME; 17944609Szf162725 17954609Szf162725 RAL_WRITE(sc, RT2560_RXCSR0, tmp); 17964609Szf162725 RAL_DEBUG(RAL_DBG_HW, "%s promiscuous mode\n", 17974609Szf162725 (sc->sc_rcr & RAL_RCR_PROMISC) ? "entering" : "leaving"); 17984609Szf162725 } 17994609Szf162725 18004609Szf162725 static const char * 18014609Szf162725 rt2560_get_rf(int rev) 18024609Szf162725 { 18034609Szf162725 switch (rev) { 18044609Szf162725 case RT2560_RF_2522: return ("RT2522"); 18054609Szf162725 case RT2560_RF_2523: return ("RT2523"); 18064609Szf162725 case RT2560_RF_2524: return ("RT2524"); 18074609Szf162725 case RT2560_RF_2525: return ("RT2525"); 18084609Szf162725 case RT2560_RF_2525E: return ("RT2525e"); 18094609Szf162725 case RT2560_RF_2526: return ("RT2526"); 18104609Szf162725 case RT2560_RF_5222: return ("RT5222"); 18114609Szf162725 default: return ("unknown"); 18124609Szf162725 } 18134609Szf162725 } 18144609Szf162725 18154609Szf162725 static void 18164609Szf162725 rt2560_read_eeprom(struct rt2560_softc *sc) 18174609Szf162725 { 18184609Szf162725 uint16_t val; 18194609Szf162725 int i; 18204609Szf162725 18214609Szf162725 val = rt2560_eeprom_read(sc, RT2560_EEPROM_CONFIG0); 18224609Szf162725 sc->rf_rev = (val >> 11) & 0x7; 18234609Szf162725 sc->hw_radio = (val >> 10) & 0x1; 18244609Szf162725 sc->led_mode = (val >> 6) & 0x7; 18254609Szf162725 sc->rx_ant = (val >> 4) & 0x3; 18264609Szf162725 sc->tx_ant = (val >> 2) & 0x3; 18274609Szf162725 sc->nb_ant = val & 0x3; 18284609Szf162725 18294609Szf162725 /* read default values for BBP registers */ 18304609Szf162725 for (i = 0; i < 16; i++) { 18314609Szf162725 val = rt2560_eeprom_read(sc, RT2560_EEPROM_BBP_BASE + i); 18324609Szf162725 sc->bbp_prom[i].reg = val >> 8; 18334609Szf162725 sc->bbp_prom[i].val = val & 0xff; 18344609Szf162725 } 18354609Szf162725 18364609Szf162725 /* read Tx power for all b/g channels */ 18374609Szf162725 for (i = 0; i < 14 / 2; i++) { 18384609Szf162725 val = rt2560_eeprom_read(sc, RT2560_EEPROM_TXPOWER + i); 18394609Szf162725 sc->txpow[i * 2] = val >> 8; 18404609Szf162725 sc->txpow[i * 2 + 1] = val & 0xff; 18414609Szf162725 } 18424609Szf162725 } 18434609Szf162725 18444609Szf162725 static int 18454609Szf162725 rt2560_bbp_init(struct rt2560_softc *sc) 18464609Szf162725 { 18474609Szf162725 #define N(a) (sizeof (a) / sizeof ((a)[0])) 18484609Szf162725 int i, ntries; 18494609Szf162725 18504609Szf162725 /* wait for BBP to be ready */ 18514609Szf162725 for (ntries = 0; ntries < 100; ntries++) { 18524609Szf162725 if (rt2560_bbp_read(sc, RT2560_BBP_VERSION) != 0) 18534609Szf162725 break; 18544609Szf162725 drv_usecwait(1); 18554609Szf162725 } 18564609Szf162725 if (ntries == 100) { 18574609Szf162725 RAL_DEBUG(RAL_DBG_HW, "timeout waiting for BBP\n"); 18584609Szf162725 return (EIO); 18594609Szf162725 } 18604609Szf162725 /* initialize BBP registers to default values */ 18614609Szf162725 for (i = 0; i < N(rt2560_def_bbp); i++) { 18624609Szf162725 rt2560_bbp_write(sc, rt2560_def_bbp[i].reg, 18634609Szf162725 rt2560_def_bbp[i].val); 18644609Szf162725 } 18654609Szf162725 18664609Szf162725 return (0); 18674609Szf162725 #undef N 18684609Szf162725 } 18694609Szf162725 18704609Szf162725 static void 18714609Szf162725 rt2560_set_txantenna(struct rt2560_softc *sc, int antenna) 18724609Szf162725 { 18734609Szf162725 uint32_t tmp; 18744609Szf162725 uint8_t tx; 18754609Szf162725 18764609Szf162725 tx = rt2560_bbp_read(sc, RT2560_BBP_TX) & ~RT2560_BBP_ANTMASK; 18774609Szf162725 if (antenna == 1) 18784609Szf162725 tx |= RT2560_BBP_ANTA; 18794609Szf162725 else if (antenna == 2) 18804609Szf162725 tx |= RT2560_BBP_ANTB; 18814609Szf162725 else 18824609Szf162725 tx |= RT2560_BBP_DIVERSITY; 18834609Szf162725 18844609Szf162725 /* need to force I/Q flip for RF 2525e, 2526 and 5222 */ 18854609Szf162725 if (sc->rf_rev == RT2560_RF_2525E || sc->rf_rev == RT2560_RF_2526 || 18864609Szf162725 sc->rf_rev == RT2560_RF_5222) 18874609Szf162725 tx |= RT2560_BBP_FLIPIQ; 18884609Szf162725 18894609Szf162725 rt2560_bbp_write(sc, RT2560_BBP_TX, tx); 18904609Szf162725 18914609Szf162725 /* update values for CCK and OFDM in BBPCSR1 */ 18924609Szf162725 tmp = RAL_READ(sc, RT2560_BBPCSR1) & ~0x00070007; 18934609Szf162725 tmp |= (tx & 0x7) << 16 | (tx & 0x7); 18944609Szf162725 RAL_WRITE(sc, RT2560_BBPCSR1, tmp); 18954609Szf162725 } 18964609Szf162725 18974609Szf162725 static void 18984609Szf162725 rt2560_set_rxantenna(struct rt2560_softc *sc, int antenna) 18994609Szf162725 { 19004609Szf162725 uint8_t rx; 19014609Szf162725 19024609Szf162725 rx = rt2560_bbp_read(sc, RT2560_BBP_RX) & ~RT2560_BBP_ANTMASK; 19034609Szf162725 if (antenna == 1) 19044609Szf162725 rx |= RT2560_BBP_ANTA; 19054609Szf162725 else if (antenna == 2) 19064609Szf162725 rx |= RT2560_BBP_ANTB; 19074609Szf162725 else 19084609Szf162725 rx |= RT2560_BBP_DIVERSITY; 19094609Szf162725 19104609Szf162725 /* need to force no I/Q flip for RF 2525e and 2526 */ 19114609Szf162725 if (sc->rf_rev == RT2560_RF_2525E || sc->rf_rev == RT2560_RF_2526) 19124609Szf162725 rx &= ~RT2560_BBP_FLIPIQ; 19134609Szf162725 19144609Szf162725 rt2560_bbp_write(sc, RT2560_BBP_RX, rx); 19154609Szf162725 } 19164609Szf162725 19174609Szf162725 static void 19184609Szf162725 rt2560_stop(struct rt2560_softc *sc) 19194609Szf162725 { 19204609Szf162725 struct ieee80211com *ic = &sc->sc_ic; 19214609Szf162725 19224609Szf162725 ieee80211_new_state(ic, IEEE80211_S_INIT, -1); 19234609Szf162725 ieee80211_stop_watchdog(ic); /* stop the watchdog */ 19244609Szf162725 19254609Szf162725 RAL_LOCK(sc); 19264609Szf162725 sc->sc_tx_timer = 0; 19274609Szf162725 19284609Szf162725 /* abort Tx */ 19294609Szf162725 RAL_WRITE(sc, RT2560_TXCSR0, RT2560_ABORT_TX); 19304609Szf162725 19314609Szf162725 /* disable Rx */ 19324609Szf162725 RAL_WRITE(sc, RT2560_RXCSR0, RT2560_DISABLE_RX); 19334609Szf162725 19344609Szf162725 /* reset ASIC (imply reset BBP) */ 19354609Szf162725 RAL_WRITE(sc, RT2560_CSR1, RT2560_RESET_ASIC); 19364609Szf162725 RAL_WRITE(sc, RT2560_CSR1, 0); 19374609Szf162725 19384609Szf162725 /* disable interrupts */ 19394609Szf162725 RAL_WRITE(sc, RT2560_CSR8, 0xffffffff); 19404609Szf162725 19414609Szf162725 /* reset Tx and Rx rings */ 19424609Szf162725 rt2560_reset_tx_ring(sc, &sc->txq); 19434609Szf162725 rt2560_reset_tx_ring(sc, &sc->prioq); 19444609Szf162725 rt2560_reset_rx_ring(sc, &sc->rxq); 19454609Szf162725 RAL_UNLOCK(sc); 19464609Szf162725 } 19474609Szf162725 19484609Szf162725 static int 19494609Szf162725 rt2560_init(struct rt2560_softc *sc) 19504609Szf162725 { 19514609Szf162725 #define N(a) (sizeof (a) / sizeof ((a)[0])) 19524609Szf162725 /* struct rt2560_softc *sc = priv; */ 19534609Szf162725 struct ieee80211com *ic = &sc->sc_ic; 19544609Szf162725 uint32_t tmp; 19554609Szf162725 int i; 19564609Szf162725 19574609Szf162725 rt2560_stop(sc); 19584609Szf162725 19594609Szf162725 RAL_LOCK(sc); 19604609Szf162725 /* setup tx/rx ring */ 19614609Szf162725 rt2560_ring_hwsetup(sc); 19624609Szf162725 19634609Szf162725 /* initialize MAC registers to default values */ 19644609Szf162725 for (i = 0; i < N(rt2560_def_mac); i++) 19654609Szf162725 RAL_WRITE(sc, rt2560_def_mac[i].reg, rt2560_def_mac[i].val); 19664609Szf162725 19674609Szf162725 rt2560_set_macaddr(sc, ic->ic_macaddr); 19684609Szf162725 19694609Szf162725 /* set basic rate set (will be updated later) */ 19704609Szf162725 RAL_WRITE(sc, RT2560_ARSP_PLCP_1, 0x153); 19714609Szf162725 19724609Szf162725 rt2560_set_txantenna(sc, sc->tx_ant); 19734609Szf162725 rt2560_set_rxantenna(sc, sc->rx_ant); 19744609Szf162725 rt2560_update_slot(ic, 1); 19754609Szf162725 rt2560_update_plcp(sc); 19764609Szf162725 rt2560_update_led(sc, 0, 0); 19774609Szf162725 19784609Szf162725 RAL_WRITE(sc, RT2560_CSR1, RT2560_RESET_ASIC); 19794609Szf162725 RAL_WRITE(sc, RT2560_CSR1, RT2560_HOST_READY); 19804609Szf162725 19814609Szf162725 if (rt2560_bbp_init(sc) != 0) { 19824609Szf162725 RAL_UNLOCK(sc); 19834609Szf162725 rt2560_stop(sc); 19844609Szf162725 return (DDI_FAILURE); 19854609Szf162725 } 19864609Szf162725 19874609Szf162725 /* set default BSS channel */ 19884609Szf162725 rt2560_set_chan(sc, ic->ic_curchan); 19894609Szf162725 19904609Szf162725 /* kick Rx */ 19914609Szf162725 tmp = RT2560_DROP_PHY_ERROR | RT2560_DROP_CRC_ERROR; 19924609Szf162725 if (ic->ic_opmode != IEEE80211_M_MONITOR) { 19934609Szf162725 tmp |= RT2560_DROP_CTL | RT2560_DROP_VERSION_ERROR; 19944609Szf162725 if (ic->ic_opmode != IEEE80211_M_HOSTAP) 19954609Szf162725 tmp |= RT2560_DROP_TODS; 19964609Szf162725 if (!(sc->sc_rcr & RAL_RCR_PROMISC)) 19974609Szf162725 tmp |= RT2560_DROP_NOT_TO_ME; 19984609Szf162725 19994609Szf162725 } 20004609Szf162725 RAL_WRITE(sc, RT2560_RXCSR0, tmp); 20014609Szf162725 20024609Szf162725 /* clear old FCS and Rx FIFO errors */ 20034609Szf162725 (void) RAL_READ(sc, RT2560_CNT0); 20044609Szf162725 (void) RAL_READ(sc, RT2560_CNT4); 20054609Szf162725 20064609Szf162725 /* clear any pending interrupts */ 20074609Szf162725 RAL_WRITE(sc, RT2560_CSR7, 0xffffffff); 20084609Szf162725 /* enable interrupts */ 20094609Szf162725 RAL_WRITE(sc, RT2560_CSR8, RT2560_INTR_MASK); 20104609Szf162725 20114609Szf162725 RAL_UNLOCK(sc); 20124609Szf162725 #undef N 20134609Szf162725 return (DDI_SUCCESS); 20144609Szf162725 } 20154609Szf162725 20164609Szf162725 void 20174609Szf162725 rt2560_watchdog(void *arg) 20184609Szf162725 { 20194609Szf162725 struct rt2560_softc *sc = arg; 20204609Szf162725 struct ieee80211com *ic = &sc->sc_ic; 20214609Szf162725 int ntimer = 0; 20224609Szf162725 20234609Szf162725 RAL_LOCK(sc); 20244609Szf162725 ic->ic_watchdog_timer = 0; 20254609Szf162725 20264609Szf162725 if (!RAL_IS_RUNNING(sc)) { 20274609Szf162725 RAL_UNLOCK(sc); 20284609Szf162725 return; 20294609Szf162725 } 20304609Szf162725 20314609Szf162725 if (sc->sc_tx_timer > 0) { 20324609Szf162725 if (--sc->sc_tx_timer == 0) { 20334609Szf162725 RAL_DEBUG(RAL_DBG_MSG, "tx timer timeout\n"); 20344609Szf162725 RAL_UNLOCK(sc); 20354609Szf162725 (void) rt2560_init(sc); 20364609Szf162725 (void) ieee80211_new_state(ic, IEEE80211_S_SCAN, -1); 20374609Szf162725 return; 20384609Szf162725 } 20394609Szf162725 } 20404609Szf162725 20414609Szf162725 if (ic->ic_state == IEEE80211_S_RUN) 20424609Szf162725 ntimer = 1; 20434609Szf162725 20444609Szf162725 RAL_UNLOCK(sc); 20454609Szf162725 20464609Szf162725 ieee80211_watchdog(ic); 20474609Szf162725 20484609Szf162725 if (ntimer) 20494609Szf162725 ieee80211_start_watchdog(ic, ntimer); 20504609Szf162725 } 20514609Szf162725 20524609Szf162725 static int 20534609Szf162725 rt2560_m_start(void *arg) 20544609Szf162725 { 20554609Szf162725 struct rt2560_softc *sc = (struct rt2560_softc *)arg; 20564609Szf162725 crypto_mech_type_t type; 20574609Szf162725 int err; 20584609Szf162725 20594609Szf162725 20604609Szf162725 type = crypto_mech2id(SUN_CKM_RC4); /* load rc4 module into kernel */ 20614609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "enter rt2560_m_start(%d)\n", type); 20624609Szf162725 20634609Szf162725 /* 20644609Szf162725 * initialize rt2560 hardware 20654609Szf162725 */ 20664609Szf162725 err = rt2560_init(sc); 20674609Szf162725 if (err != DDI_SUCCESS) { 20684609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "device configuration failed\n"); 20694609Szf162725 goto fail; 20704609Szf162725 } 20714609Szf162725 sc->sc_flags |= RAL_FLAG_RUNNING; /* RUNNING */ 20724609Szf162725 return (err); 20734609Szf162725 20744609Szf162725 fail: 20754609Szf162725 rt2560_stop(sc); 20764609Szf162725 return (err); 20774609Szf162725 } 20784609Szf162725 20794609Szf162725 static void 20804609Szf162725 rt2560_m_stop(void *arg) 20814609Szf162725 { 20824609Szf162725 struct rt2560_softc *sc = (struct rt2560_softc *)arg; 20834609Szf162725 20844609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "enter rt2560_m_stop()\n"); 20854609Szf162725 20864609Szf162725 (void) rt2560_stop(sc); 20874609Szf162725 sc->sc_flags &= ~RAL_FLAG_RUNNING; /* STOP */ 20884609Szf162725 } 20894609Szf162725 20904609Szf162725 static int 20914609Szf162725 rt2560_m_unicst(void *arg, const uint8_t *macaddr) 20924609Szf162725 { 20934609Szf162725 struct rt2560_softc *sc = (struct rt2560_softc *)arg; 20944609Szf162725 struct ieee80211com *ic = &sc->sc_ic; 20954609Szf162725 20964609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "rt2560_m_unicst(): " MACSTR "\n", 20974609Szf162725 MAC2STR(macaddr)); 20984609Szf162725 20994609Szf162725 IEEE80211_ADDR_COPY(ic->ic_macaddr, macaddr); 21004609Szf162725 (void) rt2560_set_macaddr(sc, (uint8_t *)macaddr); 21014609Szf162725 (void) rt2560_init(sc); 21024609Szf162725 21034609Szf162725 return (0); 21044609Szf162725 } 21054609Szf162725 21064609Szf162725 /*ARGSUSED*/ 21074609Szf162725 static int 21084609Szf162725 rt2560_m_multicst(void *arg, boolean_t add, const uint8_t *mca) 21094609Szf162725 { 21104609Szf162725 return (0); 21114609Szf162725 } 21124609Szf162725 21134609Szf162725 static int 21144609Szf162725 rt2560_m_promisc(void *arg, boolean_t on) 21154609Szf162725 { 21164609Szf162725 struct rt2560_softc *sc = (struct rt2560_softc *)arg; 21174609Szf162725 21184609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "rt2560_m_promisc()\n"); 21194609Szf162725 21204609Szf162725 if (on) { 21214609Szf162725 sc->sc_rcr |= RAL_RCR_PROMISC; 21224609Szf162725 sc->sc_rcr |= RAL_RCR_MULTI; 21234609Szf162725 } else { 21244609Szf162725 sc->sc_rcr &= ~RAL_RCR_PROMISC; 21254609Szf162725 sc->sc_rcr &= ~RAL_RCR_PROMISC; 21264609Szf162725 } 21274609Szf162725 21284609Szf162725 rt2560_update_promisc(sc); 21294609Szf162725 return (0); 21304609Szf162725 } 21314609Szf162725 2132*8099SQuaker.Fang@Sun.COM /* 2133*8099SQuaker.Fang@Sun.COM * callback functions for /get/set properties 2134*8099SQuaker.Fang@Sun.COM */ 2135*8099SQuaker.Fang@Sun.COM static int 2136*8099SQuaker.Fang@Sun.COM rt2560_m_setprop(void *arg, const char *pr_name, mac_prop_id_t wldp_pr_num, 2137*8099SQuaker.Fang@Sun.COM uint_t wldp_length, const void *wldp_buf) 2138*8099SQuaker.Fang@Sun.COM { 2139*8099SQuaker.Fang@Sun.COM struct rt2560_softc *sc = arg; 2140*8099SQuaker.Fang@Sun.COM struct ieee80211com *ic = &sc->sc_ic; 2141*8099SQuaker.Fang@Sun.COM int err; 2142*8099SQuaker.Fang@Sun.COM 2143*8099SQuaker.Fang@Sun.COM err = ieee80211_setprop(ic, pr_name, wldp_pr_num, 2144*8099SQuaker.Fang@Sun.COM wldp_length, wldp_buf); 2145*8099SQuaker.Fang@Sun.COM RAL_LOCK(sc); 2146*8099SQuaker.Fang@Sun.COM if (err == ENETRESET) { 2147*8099SQuaker.Fang@Sun.COM if (RAL_IS_RUNNING(sc)) { 2148*8099SQuaker.Fang@Sun.COM RAL_UNLOCK(sc); 2149*8099SQuaker.Fang@Sun.COM (void) rt2560_init(sc); 2150*8099SQuaker.Fang@Sun.COM (void) ieee80211_new_state(ic, IEEE80211_S_SCAN, -1); 2151*8099SQuaker.Fang@Sun.COM RAL_LOCK(sc); 2152*8099SQuaker.Fang@Sun.COM } 2153*8099SQuaker.Fang@Sun.COM err = 0; 2154*8099SQuaker.Fang@Sun.COM } 2155*8099SQuaker.Fang@Sun.COM RAL_UNLOCK(sc); 2156*8099SQuaker.Fang@Sun.COM 2157*8099SQuaker.Fang@Sun.COM return (err); 2158*8099SQuaker.Fang@Sun.COM } 2159*8099SQuaker.Fang@Sun.COM 2160*8099SQuaker.Fang@Sun.COM static int 2161*8099SQuaker.Fang@Sun.COM rt2560_m_getprop(void *arg, const char *pr_name, mac_prop_id_t wldp_pr_num, 2162*8099SQuaker.Fang@Sun.COM uint_t pr_flags, uint_t wldp_length, void *wldp_buf) 2163*8099SQuaker.Fang@Sun.COM { 2164*8099SQuaker.Fang@Sun.COM struct rt2560_softc *sc = arg; 2165*8099SQuaker.Fang@Sun.COM int err; 2166*8099SQuaker.Fang@Sun.COM 2167*8099SQuaker.Fang@Sun.COM err = ieee80211_getprop(&sc->sc_ic, pr_name, wldp_pr_num, 2168*8099SQuaker.Fang@Sun.COM pr_flags, wldp_length, wldp_buf); 2169*8099SQuaker.Fang@Sun.COM 2170*8099SQuaker.Fang@Sun.COM return (err); 2171*8099SQuaker.Fang@Sun.COM } 2172*8099SQuaker.Fang@Sun.COM 21734609Szf162725 static void 21744609Szf162725 rt2560_m_ioctl(void* arg, queue_t *wq, mblk_t *mp) 21754609Szf162725 { 21764609Szf162725 struct rt2560_softc *sc = (struct rt2560_softc *)arg; 21774609Szf162725 struct ieee80211com *ic = &sc->sc_ic; 21784609Szf162725 int err; 21794609Szf162725 21804609Szf162725 err = ieee80211_ioctl(ic, wq, mp); 21814609Szf162725 RAL_LOCK(sc); 21824609Szf162725 if (err == ENETRESET) { 21834609Szf162725 if (RAL_IS_RUNNING(sc)) { 21844609Szf162725 RAL_UNLOCK(sc); 21854609Szf162725 (void) rt2560_init(sc); 21864609Szf162725 (void) ieee80211_new_state(ic, IEEE80211_S_SCAN, -1); 21874609Szf162725 RAL_LOCK(sc); 21884609Szf162725 } 21894609Szf162725 } 21904609Szf162725 RAL_UNLOCK(sc); 21914609Szf162725 } 21924609Szf162725 21934609Szf162725 static int 21944609Szf162725 rt2560_m_stat(void *arg, uint_t stat, uint64_t *val) 21954609Szf162725 { 21964609Szf162725 struct rt2560_softc *sc = (struct rt2560_softc *)arg; 21974609Szf162725 ieee80211com_t *ic = &sc->sc_ic; 21984609Szf162725 ieee80211_node_t *ni = ic->ic_bss; 21994609Szf162725 struct ieee80211_rateset *rs = &ni->in_rates; 22004609Szf162725 22014609Szf162725 RAL_LOCK(sc); 22024609Szf162725 switch (stat) { 22034609Szf162725 case MAC_STAT_IFSPEED: 22044609Szf162725 *val = ((ic->ic_fixed_rate == IEEE80211_FIXED_RATE_NONE) ? 22054609Szf162725 (rs->ir_rates[ni->in_txrate] & IEEE80211_RATE_VAL) 22066890Sql147931 : ic->ic_fixed_rate) / 2 * 1000000; 22074609Szf162725 break; 22084609Szf162725 case MAC_STAT_NOXMTBUF: 22094609Szf162725 *val = sc->sc_tx_nobuf; 22104609Szf162725 break; 22114609Szf162725 case MAC_STAT_NORCVBUF: 22124609Szf162725 *val = sc->sc_rx_nobuf; 22134609Szf162725 break; 22144609Szf162725 case MAC_STAT_IERRORS: 22154609Szf162725 *val = sc->sc_rx_err; 22164609Szf162725 break; 22174609Szf162725 case MAC_STAT_RBYTES: 22184609Szf162725 *val = ic->ic_stats.is_rx_bytes; 22194609Szf162725 break; 22204609Szf162725 case MAC_STAT_IPACKETS: 22214609Szf162725 *val = ic->ic_stats.is_rx_frags; 22224609Szf162725 break; 22234609Szf162725 case MAC_STAT_OBYTES: 22244609Szf162725 *val = ic->ic_stats.is_tx_bytes; 22254609Szf162725 break; 22264609Szf162725 case MAC_STAT_OPACKETS: 22274609Szf162725 *val = ic->ic_stats.is_tx_frags; 22284609Szf162725 break; 22294609Szf162725 case MAC_STAT_OERRORS: 22304609Szf162725 case WIFI_STAT_TX_FAILED: 22314609Szf162725 *val = sc->sc_tx_err; 22324609Szf162725 break; 22334609Szf162725 case WIFI_STAT_TX_RETRANS: 22344609Szf162725 *val = sc->sc_tx_retries; 22354609Szf162725 break; 22364609Szf162725 case WIFI_STAT_FCS_ERRORS: 22374609Szf162725 case WIFI_STAT_WEP_ERRORS: 22384609Szf162725 case WIFI_STAT_TX_FRAGS: 22394609Szf162725 case WIFI_STAT_MCAST_TX: 22404609Szf162725 case WIFI_STAT_RTS_SUCCESS: 22414609Szf162725 case WIFI_STAT_RTS_FAILURE: 22424609Szf162725 case WIFI_STAT_ACK_FAILURE: 22434609Szf162725 case WIFI_STAT_RX_FRAGS: 22444609Szf162725 case WIFI_STAT_MCAST_RX: 22454609Szf162725 case WIFI_STAT_RX_DUPS: 22464609Szf162725 RAL_UNLOCK(sc); 22474609Szf162725 return (ieee80211_stat(ic, stat, val)); 22484609Szf162725 default: 22494609Szf162725 RAL_UNLOCK(sc); 22504609Szf162725 return (ENOTSUP); 22514609Szf162725 } 22524609Szf162725 RAL_UNLOCK(sc); 22534609Szf162725 22544609Szf162725 return (0); 22554609Szf162725 } 22564609Szf162725 22574609Szf162725 static uint_t 22584609Szf162725 rt2560_intr(caddr_t arg) 22594609Szf162725 { 22607249Sff224033 /* LINTED E_BAD_PTR_CAST_ALIGN */ 22614609Szf162725 struct rt2560_softc *sc = (struct rt2560_softc *)arg; 22624609Szf162725 uint32_t r; 22634609Szf162725 22644609Szf162725 RAL_LOCK(sc); 22654609Szf162725 22664609Szf162725 r = RAL_READ(sc, RT2560_CSR7); 22674609Szf162725 RAL_WRITE(sc, RT2560_CSR7, r); 22684609Szf162725 22694609Szf162725 if (r == 0xffffffff) { 22704609Szf162725 RAL_UNLOCK(sc); 22714609Szf162725 return (DDI_INTR_UNCLAIMED); 22724609Szf162725 } 22734609Szf162725 22744609Szf162725 if (!(r & RT2560_INTR_ALL)) { 22754609Szf162725 RAL_UNLOCK(sc); 22764609Szf162725 return (DDI_INTR_UNCLAIMED); 22774609Szf162725 } 22784609Szf162725 22794609Szf162725 /* disable interrupts */ 22804609Szf162725 RAL_WRITE(sc, RT2560_CSR8, 0xffffffff); 22814609Szf162725 22824609Szf162725 if (r & RT2560_TX_DONE) { 22834609Szf162725 RAL_UNLOCK(sc); 22844609Szf162725 rt2560_tx_intr(sc); 22854609Szf162725 RAL_LOCK(sc); 22864609Szf162725 } 22874609Szf162725 22884609Szf162725 if (r & RT2560_PRIO_DONE) { 22894609Szf162725 RAL_UNLOCK(sc); 22904609Szf162725 rt2560_prio_intr(sc); 22914609Szf162725 RAL_LOCK(sc); 22924609Szf162725 } 22934609Szf162725 22944609Szf162725 if (r & RT2560_RX_DONE) { 22954609Szf162725 sc->sc_rx_pend = 1; 22964609Szf162725 ddi_trigger_softintr(sc->sc_softint_id); 22974609Szf162725 } 22984609Szf162725 22994609Szf162725 /* re-enable interrupts */ 23004609Szf162725 RAL_WRITE(sc, RT2560_CSR8, RT2560_INTR_MASK); 23014609Szf162725 RAL_UNLOCK(sc); 23024609Szf162725 23034609Szf162725 return (DDI_INTR_CLAIMED); 23044609Szf162725 } 23054609Szf162725 2306*8099SQuaker.Fang@Sun.COM /* 2307*8099SQuaker.Fang@Sun.COM * quiesce(9E) entry point. 2308*8099SQuaker.Fang@Sun.COM * 2309*8099SQuaker.Fang@Sun.COM * This function is called when the system is single-threaded at high 2310*8099SQuaker.Fang@Sun.COM * PIL with preemption disabled. Therefore, this function must not be 2311*8099SQuaker.Fang@Sun.COM * blocked. 2312*8099SQuaker.Fang@Sun.COM * 2313*8099SQuaker.Fang@Sun.COM * This function returns DDI_SUCCESS on success, or DDI_FAILURE on failure. 2314*8099SQuaker.Fang@Sun.COM * DDI_FAILURE indicates an error condition and should almost never happen. 2315*8099SQuaker.Fang@Sun.COM */ 2316*8099SQuaker.Fang@Sun.COM static int32_t 2317*8099SQuaker.Fang@Sun.COM rt2560_quiesce(dev_info_t *devinfo) 23184609Szf162725 { 23194609Szf162725 struct rt2560_softc *sc; 23204609Szf162725 2321*8099SQuaker.Fang@Sun.COM sc = ddi_get_soft_state(ral_soft_state_p, ddi_get_instance(devinfo)); 2322*8099SQuaker.Fang@Sun.COM if (sc == NULL) 23234609Szf162725 return (DDI_FAILURE); 23244609Szf162725 23254609Szf162725 /* abort Tx */ 23264609Szf162725 RAL_WRITE(sc, RT2560_TXCSR0, RT2560_ABORT_TX); 23274609Szf162725 23284609Szf162725 /* disable Rx */ 23294609Szf162725 RAL_WRITE(sc, RT2560_RXCSR0, RT2560_DISABLE_RX); 23304609Szf162725 23314609Szf162725 /* reset ASIC (imply reset BBP) */ 23324609Szf162725 RAL_WRITE(sc, RT2560_CSR1, RT2560_RESET_ASIC); 23334609Szf162725 RAL_WRITE(sc, RT2560_CSR1, 0); 23344609Szf162725 23354609Szf162725 /* disable interrupts */ 23364609Szf162725 RAL_WRITE(sc, RT2560_CSR8, 0xffffffff); 23374609Szf162725 23384609Szf162725 return (DDI_SUCCESS); 23394609Szf162725 } 23404609Szf162725 23414609Szf162725 static int 23424609Szf162725 rt2560_attach(dev_info_t *devinfo, ddi_attach_cmd_t cmd) 23434609Szf162725 { 23444609Szf162725 struct rt2560_softc *sc; 23454609Szf162725 struct ieee80211com *ic; 23464609Szf162725 int err, i; 23474609Szf162725 int instance; 23484609Szf162725 23494609Szf162725 ddi_acc_handle_t ioh; 23504609Szf162725 caddr_t regs; 23514609Szf162725 uint16_t vendor_id, device_id, command; 23524609Szf162725 uint8_t cachelsz; 23534609Szf162725 char strbuf[32]; 23544609Szf162725 23554609Szf162725 wifi_data_t wd = { 0 }; 23564609Szf162725 mac_register_t *macp; 23574609Szf162725 23584609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "enter rt2560_attach()\n"); 23594609Szf162725 23604609Szf162725 if (cmd != DDI_ATTACH) 23614609Szf162725 return (DDI_FAILURE); 23624609Szf162725 23634609Szf162725 instance = ddi_get_instance(devinfo); 23644609Szf162725 23654609Szf162725 if (ddi_soft_state_zalloc(ral_soft_state_p, instance) != DDI_SUCCESS) { 23664609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): " 23674609Szf162725 "unable to alloc soft_state_p\n"); 23684609Szf162725 return (DDI_FAILURE); 23694609Szf162725 } 23704609Szf162725 23714609Szf162725 sc = ddi_get_soft_state(ral_soft_state_p, instance); 23724609Szf162725 ic = (ieee80211com_t *)&sc->sc_ic; 23734609Szf162725 sc->sc_dev = devinfo; 23744609Szf162725 23754609Szf162725 /* pci configuration */ 23764609Szf162725 err = ddi_regs_map_setup(devinfo, 0, ®s, 0, 0, &ral_csr_accattr, 23774609Szf162725 &ioh); 23784609Szf162725 if (err != DDI_SUCCESS) { 23794609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): " 23804609Szf162725 "ddi_regs_map_setup() failed"); 23814609Szf162725 goto fail1; 23824609Szf162725 } 23834609Szf162725 23844609Szf162725 cachelsz = ddi_get8(ioh, (uint8_t *)(regs + PCI_CONF_CACHE_LINESZ)); 23854609Szf162725 if (cachelsz == 0) 23864609Szf162725 cachelsz = 0x10; 23874609Szf162725 sc->sc_cachelsz = cachelsz << 2; 23884609Szf162725 23897249Sff224033 vendor_id = ddi_get16(ioh, 23907249Sff224033 (uint16_t *)((uintptr_t)regs + PCI_CONF_VENID)); 23917249Sff224033 device_id = ddi_get16(ioh, 23927249Sff224033 (uint16_t *)((uintptr_t)regs + PCI_CONF_DEVID)); 23934609Szf162725 23944609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): vendor 0x%x, " 23954609Szf162725 "device id 0x%x, cache size %d\n", vendor_id, device_id, cachelsz); 23964609Szf162725 23974609Szf162725 /* 23984609Szf162725 * Enable response to memory space accesses, 23994609Szf162725 * and enabe bus master. 24004609Szf162725 */ 24014609Szf162725 command = PCI_COMM_MAE | PCI_COMM_ME; 24027249Sff224033 ddi_put16(ioh, (uint16_t *)((uintptr_t)regs + PCI_CONF_COMM), command); 24034609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): " 24044609Szf162725 "set command reg to 0x%x \n", command); 24054609Szf162725 24064609Szf162725 ddi_put8(ioh, (uint8_t *)(regs + PCI_CONF_LATENCY_TIMER), 0xa8); 24074609Szf162725 ddi_put8(ioh, (uint8_t *)(regs + PCI_CONF_ILINE), 0x10); 24084609Szf162725 ddi_regs_map_free(&ioh); 24094609Szf162725 24104609Szf162725 /* pci i/o space */ 24114609Szf162725 err = ddi_regs_map_setup(devinfo, 1, 24124609Szf162725 &sc->sc_rbase, 0, 0, &ral_csr_accattr, &sc->sc_ioh); 24134609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): " 24144609Szf162725 "regs map1 = %x err=%d\n", regs, err); 24154609Szf162725 if (err != DDI_SUCCESS) { 24164609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): " 24174609Szf162725 "ddi_regs_map_setup() failed"); 24184609Szf162725 goto fail1; 24194609Szf162725 } 24204609Szf162725 24214609Szf162725 /* initialize the ral rate */ 24224609Szf162725 ral_rate_init(); 24234609Szf162725 24244609Szf162725 /* retrieve RT2560 rev. no */ 24254609Szf162725 sc->asic_rev = RAL_READ(sc, RT2560_CSR0); 24264609Szf162725 24274609Szf162725 /* retrieve MAC address */ 24284609Szf162725 rt2560_get_macaddr(sc, ic->ic_macaddr); 24294609Szf162725 24304609Szf162725 /* retrieve RF rev. no and various other things from EEPROM */ 24314609Szf162725 rt2560_read_eeprom(sc); 24324609Szf162725 24334609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "MAC/BBP RT2560 (rev 0x%02x), RF %s\n", 24344609Szf162725 sc->asic_rev, rt2560_get_rf(sc->rf_rev)); 24354609Szf162725 24364609Szf162725 /* 24374609Szf162725 * Allocate Tx and Rx rings. 24384609Szf162725 */ 24394609Szf162725 err = rt2560_alloc_tx_ring(sc, &sc->txq, RT2560_TX_RING_COUNT); 24404609Szf162725 if (err != DDI_SUCCESS) { 24414609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "could not allocate Tx ring\n"); 24424609Szf162725 goto fail2; 24434609Szf162725 } 24444609Szf162725 err = rt2560_alloc_tx_ring(sc, &sc->prioq, RT2560_PRIO_RING_COUNT); 24454609Szf162725 if (err != DDI_SUCCESS) { 24464609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "could not allocate Prio ring\n"); 24474609Szf162725 goto fail3; 24484609Szf162725 } 24494609Szf162725 err = rt2560_alloc_rx_ring(sc, &sc->rxq, RT2560_RX_RING_COUNT); 24504609Szf162725 if (err != DDI_SUCCESS) { 24514609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "could not allocate Rx ring\n"); 24524609Szf162725 goto fail4; 24534609Szf162725 } 24544609Szf162725 24554609Szf162725 mutex_init(&sc->sc_genlock, NULL, MUTEX_DRIVER, NULL); 24564609Szf162725 mutex_init(&sc->txq.tx_lock, NULL, MUTEX_DRIVER, NULL); 24574609Szf162725 mutex_init(&sc->prioq.tx_lock, NULL, MUTEX_DRIVER, NULL); 24584609Szf162725 mutex_init(&sc->rxq.rx_lock, NULL, MUTEX_DRIVER, NULL); 24594609Szf162725 24604609Szf162725 24614609Szf162725 ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ 24624609Szf162725 ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */ 24634609Szf162725 ic->ic_state = IEEE80211_S_INIT; 24644609Szf162725 24654609Szf162725 ic->ic_maxrssi = 63; 24664609Szf162725 ic->ic_set_shortslot = rt2560_update_slot; 24674609Szf162725 ic->ic_xmit = rt2560_mgmt_send; 24684609Szf162725 24694609Szf162725 /* set device capabilities */ 24704609Szf162725 ic->ic_caps = 24714609Szf162725 IEEE80211_C_TXPMGT | /* tx power management */ 24724609Szf162725 IEEE80211_C_SHPREAMBLE | /* short preamble supported */ 24734609Szf162725 IEEE80211_C_SHSLOT; /* short slot time supported */ 24744609Szf162725 24755296Szf162725 ic->ic_caps |= IEEE80211_C_WPA; /* Support WPA/WPA2 */ 24765296Szf162725 24774609Szf162725 #define IEEE80211_CHAN_A \ 24784609Szf162725 (IEEE80211_CHAN_5GHZ | IEEE80211_CHAN_OFDM) 24794609Szf162725 24804609Szf162725 if (sc->rf_rev == RT2560_RF_5222) { 24814609Szf162725 /* set supported .11a rates */ 24824609Szf162725 ic->ic_sup_rates[IEEE80211_MODE_11A] = rt2560_rateset_11a; 24834609Szf162725 24844609Szf162725 /* set supported .11a channels */ 24854609Szf162725 for (i = 36; i <= 64; i += 4) { 24864609Szf162725 ic->ic_sup_channels[i].ich_freq = 24874609Szf162725 ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ); 24884609Szf162725 ic->ic_sup_channels[i].ich_flags = IEEE80211_CHAN_A; 24894609Szf162725 } 24904609Szf162725 for (i = 100; i <= 140; i += 4) { 24914609Szf162725 ic->ic_sup_channels[i].ich_freq = 24924609Szf162725 ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ); 24934609Szf162725 ic->ic_sup_channels[i].ich_flags = IEEE80211_CHAN_A; 24944609Szf162725 } 24954609Szf162725 for (i = 149; i <= 161; i += 4) { 24964609Szf162725 ic->ic_sup_channels[i].ich_freq = 24974609Szf162725 ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ); 24984609Szf162725 ic->ic_sup_channels[i].ich_flags = IEEE80211_CHAN_A; 24994609Szf162725 } 25004609Szf162725 } 25014609Szf162725 25024609Szf162725 /* set supported .11b and .11g rates */ 25034609Szf162725 ic->ic_sup_rates[IEEE80211_MODE_11B] = rt2560_rateset_11b; 25044609Szf162725 ic->ic_sup_rates[IEEE80211_MODE_11G] = rt2560_rateset_11g; 25054609Szf162725 25064609Szf162725 /* set supported .11b and .11g channels (1 through 14) */ 25074609Szf162725 for (i = 1; i <= 14; i++) { 25084609Szf162725 ic->ic_sup_channels[i].ich_freq = 25094609Szf162725 ieee80211_ieee2mhz(i, IEEE80211_CHAN_2GHZ); 25104609Szf162725 ic->ic_sup_channels[i].ich_flags = 25114609Szf162725 IEEE80211_CHAN_CCK | IEEE80211_CHAN_OFDM | 25124609Szf162725 IEEE80211_CHAN_DYN | IEEE80211_CHAN_2GHZ; 25134609Szf162725 } 25144609Szf162725 25154609Szf162725 ieee80211_attach(ic); 25164609Szf162725 25175296Szf162725 /* register WPA door */ 25185296Szf162725 ieee80211_register_door(ic, ddi_driver_name(devinfo), 25195296Szf162725 ddi_get_instance(devinfo)); 25205296Szf162725 25214609Szf162725 ic->ic_node_alloc = rt2560_node_alloc; 25224609Szf162725 ic->ic_node_free = rt2560_node_free; 25234609Szf162725 25244609Szf162725 /* override state transition machine */ 25254609Szf162725 sc->sc_newstate = ic->ic_newstate; 25264609Szf162725 ic->ic_newstate = rt2560_newstate; 25274609Szf162725 ic->ic_watchdog = rt2560_watchdog; 25284609Szf162725 ieee80211_media_init(ic); 25294609Szf162725 ic->ic_def_txkey = 0; 25304609Szf162725 25314609Szf162725 sc->sc_rcr = 0; 25324609Szf162725 sc->sc_rx_pend = 0; 25334609Szf162725 sc->dwelltime = 300; 25344609Szf162725 sc->sc_flags &= ~RAL_FLAG_RUNNING; 25354609Szf162725 25364609Szf162725 err = ddi_add_softintr(devinfo, DDI_SOFTINT_LOW, 25374609Szf162725 &sc->sc_softint_id, NULL, 0, ral_softint_handler, (caddr_t)sc); 25384609Szf162725 if (err != DDI_SUCCESS) { 25394609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): " 25404609Szf162725 "ddi_add_softintr() failed"); 25414609Szf162725 goto fail5; 25424609Szf162725 } 25434609Szf162725 25444609Szf162725 err = ddi_get_iblock_cookie(devinfo, 0, &sc->sc_iblock); 25454609Szf162725 if (err != DDI_SUCCESS) { 25464609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): " 25474609Szf162725 "Can not get iblock cookie for INT\n"); 25484609Szf162725 goto fail6; 25494609Szf162725 } 25504609Szf162725 25514609Szf162725 err = ddi_add_intr(devinfo, 0, NULL, NULL, rt2560_intr, (caddr_t)sc); 25524609Szf162725 if (err != DDI_SUCCESS) { 25534609Szf162725 RAL_DEBUG(RAL_DBG_GLD, 25544609Szf162725 "unable to add device interrupt handler\n"); 25554609Szf162725 goto fail6; 25564609Szf162725 } 25574609Szf162725 25584609Szf162725 /* 25594609Szf162725 * Provide initial settings for the WiFi plugin; whenever this 25604609Szf162725 * information changes, we need to call mac_plugindata_update() 25614609Szf162725 */ 25624609Szf162725 wd.wd_opmode = ic->ic_opmode; 25634609Szf162725 wd.wd_secalloc = WIFI_SEC_NONE; 25644609Szf162725 IEEE80211_ADDR_COPY(wd.wd_bssid, ic->ic_bss->in_bssid); 25654609Szf162725 25664609Szf162725 if ((macp = mac_alloc(MAC_VERSION)) == NULL) { 25674609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): " 25684609Szf162725 "MAC version mismatch\n"); 25694609Szf162725 goto fail7; 25704609Szf162725 } 25714609Szf162725 25724609Szf162725 macp->m_type_ident = MAC_PLUGIN_IDENT_WIFI; 25734609Szf162725 macp->m_driver = sc; 25744609Szf162725 macp->m_dip = devinfo; 25754609Szf162725 macp->m_src_addr = ic->ic_macaddr; 25764609Szf162725 macp->m_callbacks = &rt2560_m_callbacks; 25774609Szf162725 macp->m_min_sdu = 0; 25784609Szf162725 macp->m_max_sdu = IEEE80211_MTU; 25794609Szf162725 macp->m_pdata = &wd; 25804609Szf162725 macp->m_pdata_size = sizeof (wd); 25814609Szf162725 25824609Szf162725 err = mac_register(macp, &ic->ic_mach); 25834609Szf162725 mac_free(macp); 25844609Szf162725 if (err != 0) { 25854609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "ral: rt2560_attach(): " 25864609Szf162725 "mac_register err %x\n", err); 25874609Szf162725 goto fail7; 25884609Szf162725 } 25894609Szf162725 25904609Szf162725 /* 25914609Szf162725 * Create minor node of type DDI_NT_NET_WIFI 25924609Szf162725 */ 25934609Szf162725 (void) snprintf(strbuf, sizeof (strbuf), "%s%d", 25944609Szf162725 "ral", instance); 25954609Szf162725 err = ddi_create_minor_node(devinfo, strbuf, S_IFCHR, 25964609Szf162725 instance + 1, DDI_NT_NET_WIFI, 0); 25974609Szf162725 25984609Szf162725 if (err != DDI_SUCCESS) 25994609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "ddi_create_minor_node() failed\n"); 26004609Szf162725 26014609Szf162725 /* 26024609Szf162725 * Notify link is down now 26034609Szf162725 */ 26044609Szf162725 mac_link_update(ic->ic_mach, LINK_STATE_DOWN); 26054609Szf162725 26064609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "rt2560_attach() exit successfully.\n"); 26074609Szf162725 return (DDI_SUCCESS); 26084609Szf162725 fail7: 26094609Szf162725 ddi_remove_intr(devinfo, 0, sc->sc_iblock); 26104609Szf162725 fail6: 26114609Szf162725 ddi_remove_softintr(sc->sc_softint_id); 26124609Szf162725 fail5: 26134609Szf162725 mutex_destroy(&sc->sc_genlock); 26144609Szf162725 mutex_destroy(&sc->txq.tx_lock); 26154609Szf162725 mutex_destroy(&sc->prioq.tx_lock); 26164609Szf162725 mutex_destroy(&sc->rxq.rx_lock); 26174609Szf162725 26184609Szf162725 rt2560_free_rx_ring(sc, &sc->rxq); 26194609Szf162725 fail4: 26204609Szf162725 rt2560_free_tx_ring(sc, &sc->prioq); 26214609Szf162725 fail3: 26224609Szf162725 rt2560_free_tx_ring(sc, &sc->txq); 26234609Szf162725 fail2: 26244609Szf162725 ddi_regs_map_free(&sc->sc_ioh); 26254609Szf162725 fail1: 26264609Szf162725 ddi_soft_state_free(ral_soft_state_p, ddi_get_instance(devinfo)); 26274609Szf162725 26284609Szf162725 return (DDI_FAILURE); 26294609Szf162725 } 26304609Szf162725 26314609Szf162725 static int 26324609Szf162725 rt2560_detach(dev_info_t *devinfo, ddi_detach_cmd_t cmd) 26334609Szf162725 { 26344609Szf162725 struct rt2560_softc *sc; 26354609Szf162725 26364609Szf162725 RAL_DEBUG(RAL_DBG_GLD, "enter rt2560_detach()\n"); 26374609Szf162725 sc = ddi_get_soft_state(ral_soft_state_p, ddi_get_instance(devinfo)); 26384609Szf162725 26394609Szf162725 if (cmd != DDI_DETACH) 26404609Szf162725 return (DDI_FAILURE); 26414609Szf162725 26427507SXinghua.Wen@Sun.COM if (mac_disable(sc->sc_ic.ic_mach) != 0) 26437507SXinghua.Wen@Sun.COM return (DDI_FAILURE); 26447507SXinghua.Wen@Sun.COM 26454609Szf162725 rt2560_stop(sc); 26464609Szf162725 26474609Szf162725 /* 26484609Szf162725 * Unregister from the MAC layer subsystem 26494609Szf162725 */ 26507507SXinghua.Wen@Sun.COM (void) mac_unregister(sc->sc_ic.ic_mach); 26514609Szf162725 26524609Szf162725 ddi_remove_intr(devinfo, 0, sc->sc_iblock); 26534609Szf162725 ddi_remove_softintr(sc->sc_softint_id); 26544609Szf162725 26554609Szf162725 /* 26564609Szf162725 * detach ieee80211 layer 26574609Szf162725 */ 26584609Szf162725 ieee80211_detach(&sc->sc_ic); 26594609Szf162725 26604609Szf162725 rt2560_free_tx_ring(sc, &sc->txq); 26614609Szf162725 rt2560_free_tx_ring(sc, &sc->prioq); 26624609Szf162725 rt2560_free_rx_ring(sc, &sc->rxq); 26634609Szf162725 26644609Szf162725 ddi_regs_map_free(&sc->sc_ioh); 26654609Szf162725 26664609Szf162725 mutex_destroy(&sc->sc_genlock); 26674609Szf162725 mutex_destroy(&sc->txq.tx_lock); 26684609Szf162725 mutex_destroy(&sc->prioq.tx_lock); 26694609Szf162725 mutex_destroy(&sc->rxq.rx_lock); 26704609Szf162725 26714609Szf162725 ddi_remove_minor_node(devinfo, NULL); 26724609Szf162725 ddi_soft_state_free(ral_soft_state_p, ddi_get_instance(devinfo)); 26734609Szf162725 26744609Szf162725 return (DDI_SUCCESS); 26754609Szf162725 } 26764609Szf162725 26774609Szf162725 int 26784609Szf162725 _info(struct modinfo *modinfop) 26794609Szf162725 { 26804609Szf162725 return (mod_info(&modlinkage, modinfop)); 26814609Szf162725 } 26824609Szf162725 26834609Szf162725 int 26844609Szf162725 _init(void) 26854609Szf162725 { 26864609Szf162725 int status; 26874609Szf162725 26884609Szf162725 status = ddi_soft_state_init(&ral_soft_state_p, 26894609Szf162725 sizeof (struct rt2560_softc), 1); 26904609Szf162725 if (status != 0) 26914609Szf162725 return (status); 26924609Szf162725 26934609Szf162725 mac_init_ops(&ral_dev_ops, "ral"); 26944609Szf162725 status = mod_install(&modlinkage); 26954609Szf162725 if (status != 0) { 26964609Szf162725 mac_fini_ops(&ral_dev_ops); 26974609Szf162725 ddi_soft_state_fini(&ral_soft_state_p); 26984609Szf162725 } 26994609Szf162725 return (status); 27004609Szf162725 } 27014609Szf162725 27024609Szf162725 int 27034609Szf162725 _fini(void) 27044609Szf162725 { 27054609Szf162725 int status; 27064609Szf162725 27074609Szf162725 status = mod_remove(&modlinkage); 27084609Szf162725 if (status == 0) { 27094609Szf162725 mac_fini_ops(&ral_dev_ops); 27104609Szf162725 ddi_soft_state_fini(&ral_soft_state_p); 27114609Szf162725 } 27124609Szf162725 return (status); 27134609Szf162725 } 2714