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