Home | History | Annotate | Line # | Download | only in ic
rtw.c revision 1.64.2.1
      1  1.64.2.1     yamt /* $NetBSD: rtw.c,v 1.64.2.1 2006/02/18 15:39:05 yamt Exp $ */
      2       1.1   dyoung /*-
      3       1.1   dyoung  * Copyright (c) 2004, 2005 David Young.  All rights reserved.
      4       1.1   dyoung  *
      5       1.1   dyoung  * Programmed for NetBSD by David Young.
      6       1.1   dyoung  *
      7       1.1   dyoung  * Redistribution and use in source and binary forms, with or without
      8       1.1   dyoung  * modification, are permitted provided that the following conditions
      9       1.1   dyoung  * are met:
     10       1.1   dyoung  * 1. Redistributions of source code must retain the above copyright
     11       1.1   dyoung  *    notice, this list of conditions and the following disclaimer.
     12       1.1   dyoung  * 2. Redistributions in binary form must reproduce the above copyright
     13       1.1   dyoung  *    notice, this list of conditions and the following disclaimer in the
     14       1.1   dyoung  *    documentation and/or other materials provided with the distribution.
     15       1.1   dyoung  * 3. The name of David Young may not be used to endorse or promote
     16       1.1   dyoung  *    products derived from this software without specific prior
     17       1.1   dyoung  *    written permission.
     18       1.1   dyoung  *
     19       1.1   dyoung  * THIS SOFTWARE IS PROVIDED BY David Young ``AS IS'' AND ANY
     20       1.1   dyoung  * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
     21       1.1   dyoung  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
     22       1.1   dyoung  * PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL David
     23       1.1   dyoung  * Young BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
     24       1.1   dyoung  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED
     25       1.1   dyoung  * TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     26       1.1   dyoung  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
     27       1.1   dyoung  * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     28       1.1   dyoung  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     29       1.1   dyoung  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
     30       1.1   dyoung  * OF SUCH DAMAGE.
     31       1.1   dyoung  */
     32       1.1   dyoung /*
     33       1.1   dyoung  * Device driver for the Realtek RTL8180 802.11 MAC/BBP.
     34       1.1   dyoung  */
     35       1.1   dyoung 
     36       1.1   dyoung #include <sys/cdefs.h>
     37  1.64.2.1     yamt __KERNEL_RCSID(0, "$NetBSD: rtw.c,v 1.64.2.1 2006/02/18 15:39:05 yamt Exp $");
     38       1.1   dyoung 
     39       1.1   dyoung #include "bpfilter.h"
     40       1.1   dyoung 
     41       1.1   dyoung #include <sys/param.h>
     42       1.4   dyoung #include <sys/sysctl.h>
     43      1.44    perry #include <sys/systm.h>
     44       1.1   dyoung #include <sys/callout.h>
     45      1.44    perry #include <sys/mbuf.h>
     46       1.1   dyoung #include <sys/malloc.h>
     47       1.1   dyoung #include <sys/kernel.h>
     48       1.1   dyoung #include <sys/time.h>
     49       1.1   dyoung #include <sys/types.h>
     50       1.1   dyoung 
     51       1.1   dyoung #include <machine/endian.h>
     52       1.1   dyoung #include <machine/bus.h>
     53       1.1   dyoung #include <machine/intr.h>	/* splnet */
     54       1.1   dyoung 
     55       1.1   dyoung #include <uvm/uvm_extern.h>
     56      1.44    perry 
     57       1.1   dyoung #include <net/if.h>
     58       1.1   dyoung #include <net/if_media.h>
     59       1.1   dyoung #include <net/if_ether.h>
     60       1.1   dyoung 
     61      1.48   dyoung #include <net80211/ieee80211_netbsd.h>
     62       1.1   dyoung #include <net80211/ieee80211_var.h>
     63       1.1   dyoung #include <net80211/ieee80211_radiotap.h>
     64       1.1   dyoung 
     65      1.44    perry #if NBPFILTER > 0
     66       1.1   dyoung #include <net/bpf.h>
     67      1.44    perry #endif
     68       1.1   dyoung 
     69       1.1   dyoung #include <dev/ic/rtwreg.h>
     70       1.1   dyoung #include <dev/ic/rtwvar.h>
     71       1.1   dyoung #include <dev/ic/rtwphyio.h>
     72       1.1   dyoung #include <dev/ic/rtwphy.h>
     73       1.1   dyoung 
     74       1.1   dyoung #include <dev/ic/smc93cx6var.h>
     75       1.1   dyoung 
     76       1.1   dyoung #define	KASSERT2(__cond, __msg)		\
     77       1.1   dyoung 	do {				\
     78       1.1   dyoung 		if (!(__cond))		\
     79       1.1   dyoung 			panic __msg ;	\
     80       1.1   dyoung 	} while (0)
     81       1.1   dyoung 
     82      1.58   dyoung static int rtw_rfprog_fallback = 0;
     83      1.58   dyoung static int rtw_host_rfio = 0;
     84       1.4   dyoung 
     85       1.1   dyoung #ifdef RTW_DEBUG
     86      1.21   dyoung int rtw_debug = 0;
     87      1.58   dyoung static int rtw_rxbufs_limit = RTW_RXQLEN;
     88       1.1   dyoung #endif /* RTW_DEBUG */
     89       1.1   dyoung 
     90      1.21   dyoung #define NEXT_ATTACH_STATE(sc, state) do {			\
     91      1.21   dyoung 	DPRINTF(sc, RTW_DEBUG_ATTACH,				\
     92      1.21   dyoung 	    ("%s: attach state %s\n", __func__, #state));	\
     93      1.21   dyoung 	sc->sc_attach_state = state;				\
     94       1.1   dyoung } while (0)
     95       1.1   dyoung 
     96      1.58   dyoung static int rtw_xmtr_restart = 0;
     97      1.58   dyoung static int rtw_do_chip_reset = 0;
     98      1.58   dyoung static int rtw_ring_reset = 0;
     99      1.58   dyoung 
    100      1.26   dyoung int rtw_dwelltime = 200;	/* milliseconds */
    101      1.50   dyoung static struct ieee80211_cipher rtw_cipher_wep;
    102       1.1   dyoung 
    103       1.5   dyoung static void rtw_start(struct ifnet *);
    104      1.58   dyoung static void rtw_reset_oactive(struct rtw_softc *);
    105      1.58   dyoung static struct mbuf *rtw_beacon_alloc(struct rtw_softc *,
    106      1.58   dyoung     struct ieee80211_node *);
    107      1.58   dyoung static u_int rtw_txring_next(struct rtw_regs *, struct rtw_txdesc_blk *);
    108       1.5   dyoung 
    109      1.49   dyoung static void rtw_io_enable(struct rtw_regs *, uint8_t, int);
    110      1.49   dyoung static int rtw_key_delete(struct ieee80211com *, const struct ieee80211_key *);
    111      1.49   dyoung static int rtw_key_set(struct ieee80211com *, const struct ieee80211_key *,
    112      1.49   dyoung     const u_int8_t[IEEE80211_ADDR_LEN]);
    113      1.49   dyoung static void rtw_key_update_end(struct ieee80211com *);
    114      1.49   dyoung static void rtw_key_update_begin(struct ieee80211com *);
    115      1.54   dogcow static int rtw_wep_decap(struct ieee80211_key *, struct mbuf *, int);
    116      1.49   dyoung static void rtw_wep_setkeys(struct rtw_softc *, struct ieee80211_key *, int);
    117      1.49   dyoung 
    118      1.45   dyoung static void rtw_led_attach(struct rtw_led_state *, void *);
    119      1.42   dyoung static void rtw_led_init(struct rtw_regs *);
    120      1.42   dyoung static void rtw_led_slowblink(void *);
    121      1.42   dyoung static void rtw_led_fastblink(void *);
    122      1.42   dyoung static void rtw_led_set(struct rtw_led_state *, struct rtw_regs *, int);
    123      1.42   dyoung 
    124       1.4   dyoung static int rtw_sysctl_verify_rfio(SYSCTLFN_PROTO);
    125       1.4   dyoung static int rtw_sysctl_verify_rfprog(SYSCTLFN_PROTO);
    126       1.4   dyoung #ifdef RTW_DEBUG
    127      1.21   dyoung static void rtw_print_txdesc(struct rtw_softc *, const char *,
    128      1.34   dyoung     struct rtw_txsoft *, struct rtw_txdesc_blk *, int);
    129       1.4   dyoung static int rtw_sysctl_verify_debug(SYSCTLFN_PROTO);
    130      1.31   dyoung static int rtw_sysctl_verify_rxbufs_limit(SYSCTLFN_PROTO);
    131       1.4   dyoung #endif /* RTW_DEBUG */
    132       1.4   dyoung 
    133       1.4   dyoung /*
    134       1.4   dyoung  * Setup sysctl(3) MIB, hw.rtw.*
    135       1.4   dyoung  *
    136       1.4   dyoung  * TBD condition CTLFLAG_PERMANENT on being an LKM or not
    137       1.4   dyoung  */
    138       1.4   dyoung SYSCTL_SETUP(sysctl_rtw, "sysctl rtw(4) subtree setup")
    139       1.4   dyoung {
    140       1.4   dyoung 	int rc;
    141      1.47   atatat 	const struct sysctlnode *cnode, *rnode;
    142       1.4   dyoung 
    143       1.4   dyoung 	if ((rc = sysctl_createv(clog, 0, NULL, &rnode,
    144       1.4   dyoung 	    CTLFLAG_PERMANENT, CTLTYPE_NODE, "hw", NULL,
    145       1.4   dyoung 	    NULL, 0, NULL, 0, CTL_HW, CTL_EOL)) != 0)
    146       1.4   dyoung 		goto err;
    147       1.4   dyoung 
    148       1.4   dyoung 	if ((rc = sysctl_createv(clog, 0, &rnode, &rnode,
    149       1.4   dyoung 	    CTLFLAG_PERMANENT, CTLTYPE_NODE, "rtw",
    150       1.4   dyoung 	    "Realtek RTL818x 802.11 controls",
    151       1.4   dyoung 	    NULL, 0, NULL, 0, CTL_CREATE, CTL_EOL)) != 0)
    152       1.4   dyoung 		goto err;
    153       1.4   dyoung 
    154      1.58   dyoung 	if ((rc = sysctl_createv(clog, 0, &rnode, &cnode,
    155      1.58   dyoung 	    CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
    156      1.58   dyoung 	    "chip_reset", SYSCTL_DESCR("Gratuitously reset chip on rcvr error"),
    157      1.58   dyoung 	    NULL, 0, &rtw_do_chip_reset, 0,
    158      1.58   dyoung 	    CTL_CREATE, CTL_EOL)) != 0)
    159      1.58   dyoung 		goto err;
    160      1.58   dyoung 
    161      1.58   dyoung 	if ((rc = sysctl_createv(clog, 0, &rnode, &cnode,
    162      1.58   dyoung 	    CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
    163      1.58   dyoung 	    "ring_reset", SYSCTL_DESCR("Reset ring pointers on rcvr error"),
    164      1.58   dyoung 	    NULL, 0, &rtw_ring_reset, 0,
    165      1.58   dyoung 	    CTL_CREATE, CTL_EOL)) != 0)
    166      1.58   dyoung 		goto err;
    167      1.58   dyoung 
    168      1.58   dyoung 	if ((rc = sysctl_createv(clog, 0, &rnode, &cnode,
    169      1.58   dyoung 	    CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
    170      1.58   dyoung 	    "xmtr_restart",
    171      1.58   dyoung 	    SYSCTL_DESCR("Gratuitously reset xmtr on rcvr error"),
    172      1.58   dyoung 	    NULL, 0, &rtw_xmtr_restart, 0,
    173      1.58   dyoung 	    CTL_CREATE, CTL_EOL)) != 0)
    174      1.58   dyoung 		goto err;
    175      1.58   dyoung 
    176       1.4   dyoung #ifdef RTW_DEBUG
    177       1.4   dyoung 	/* control debugging printfs */
    178       1.4   dyoung 	if ((rc = sysctl_createv(clog, 0, &rnode, &cnode,
    179       1.4   dyoung 	    CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
    180       1.4   dyoung 	    "debug", SYSCTL_DESCR("Enable RTL818x debugging output"),
    181       1.4   dyoung 	    rtw_sysctl_verify_debug, 0, &rtw_debug, 0,
    182       1.4   dyoung 	    CTL_CREATE, CTL_EOL)) != 0)
    183       1.4   dyoung 		goto err;
    184      1.31   dyoung 
    185      1.31   dyoung 	/* Limit rx buffers, for simulating resource exhaustion. */
    186      1.31   dyoung 	if ((rc = sysctl_createv(clog, 0, &rnode, &cnode,
    187      1.31   dyoung 	    CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
    188      1.31   dyoung 	    "rxbufs_limit",
    189      1.31   dyoung 	    SYSCTL_DESCR("Set rx buffers limit"),
    190      1.31   dyoung 	    rtw_sysctl_verify_rxbufs_limit, 0, &rtw_rxbufs_limit, 0,
    191      1.31   dyoung 	    CTL_CREATE, CTL_EOL)) != 0)
    192      1.31   dyoung 		goto err;
    193      1.31   dyoung 
    194       1.4   dyoung #endif /* RTW_DEBUG */
    195       1.4   dyoung 	/* set fallback RF programming method */
    196       1.4   dyoung 	if ((rc = sysctl_createv(clog, 0, &rnode, &cnode,
    197       1.4   dyoung 	    CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
    198       1.4   dyoung 	    "rfprog_fallback",
    199       1.4   dyoung 	    SYSCTL_DESCR("Set fallback RF programming method"),
    200       1.4   dyoung 	    rtw_sysctl_verify_rfprog, 0, &rtw_rfprog_fallback, 0,
    201       1.4   dyoung 	    CTL_CREATE, CTL_EOL)) != 0)
    202       1.4   dyoung 		goto err;
    203       1.4   dyoung 
    204       1.4   dyoung 	/* force host to control RF I/O bus */
    205       1.4   dyoung 	if ((rc = sysctl_createv(clog, 0, &rnode, &cnode,
    206       1.4   dyoung 	    CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
    207       1.4   dyoung 	    "host_rfio", SYSCTL_DESCR("Enable host control of RF I/O"),
    208       1.4   dyoung 	    rtw_sysctl_verify_rfio, 0, &rtw_host_rfio, 0,
    209       1.4   dyoung 	    CTL_CREATE, CTL_EOL)) != 0)
    210       1.4   dyoung 		goto err;
    211       1.4   dyoung 
    212       1.4   dyoung 	return;
    213       1.4   dyoung err:
    214       1.4   dyoung 	printf("%s: sysctl_createv failed (rc = %d)\n", __func__, rc);
    215       1.4   dyoung }
    216       1.4   dyoung 
    217       1.4   dyoung static int
    218       1.4   dyoung rtw_sysctl_verify(SYSCTLFN_ARGS, int lower, int upper)
    219       1.4   dyoung {
    220       1.4   dyoung 	int error, t;
    221       1.4   dyoung 	struct sysctlnode node;
    222       1.4   dyoung 
    223       1.4   dyoung 	node = *rnode;
    224       1.4   dyoung 	t = *(int*)rnode->sysctl_data;
    225       1.4   dyoung 	node.sysctl_data = &t;
    226       1.4   dyoung 	error = sysctl_lookup(SYSCTLFN_CALL(&node));
    227       1.4   dyoung 	if (error || newp == NULL)
    228       1.4   dyoung 		return (error);
    229       1.4   dyoung 
    230       1.4   dyoung 	if (t < lower || t > upper)
    231       1.4   dyoung 		return (EINVAL);
    232       1.4   dyoung 
    233       1.4   dyoung 	*(int*)rnode->sysctl_data = t;
    234       1.4   dyoung 
    235       1.4   dyoung 	return (0);
    236       1.4   dyoung }
    237       1.4   dyoung 
    238       1.4   dyoung static int
    239       1.4   dyoung rtw_sysctl_verify_rfprog(SYSCTLFN_ARGS)
    240       1.4   dyoung {
    241      1.46   dyoung 	return rtw_sysctl_verify(SYSCTLFN_CALL(__UNCONST(rnode)), 0,
    242       1.4   dyoung 	    MASK_AND_RSHIFT(RTW_CONFIG4_RFTYPE_MASK, RTW_CONFIG4_RFTYPE_MASK));
    243       1.4   dyoung }
    244       1.4   dyoung 
    245       1.4   dyoung static int
    246       1.4   dyoung rtw_sysctl_verify_rfio(SYSCTLFN_ARGS)
    247       1.4   dyoung {
    248      1.46   dyoung 	return rtw_sysctl_verify(SYSCTLFN_CALL(__UNCONST(rnode)), 0, 1);
    249       1.4   dyoung }
    250       1.4   dyoung 
    251       1.1   dyoung #ifdef RTW_DEBUG
    252       1.4   dyoung static int
    253       1.4   dyoung rtw_sysctl_verify_debug(SYSCTLFN_ARGS)
    254       1.4   dyoung {
    255      1.46   dyoung 	return rtw_sysctl_verify(SYSCTLFN_CALL(__UNCONST(rnode)),
    256      1.46   dyoung 	    0, RTW_DEBUG_MAX);
    257       1.4   dyoung }
    258       1.4   dyoung 
    259      1.31   dyoung static int
    260      1.31   dyoung rtw_sysctl_verify_rxbufs_limit(SYSCTLFN_ARGS)
    261      1.31   dyoung {
    262      1.46   dyoung 	return rtw_sysctl_verify(SYSCTLFN_CALL(__UNCONST(rnode)),
    263      1.46   dyoung 	    0, RTW_RXQLEN);
    264      1.31   dyoung }
    265      1.31   dyoung 
    266       1.1   dyoung static void
    267       1.1   dyoung rtw_print_regs(struct rtw_regs *regs, const char *dvname, const char *where)
    268       1.1   dyoung {
    269      1.21   dyoung #define PRINTREG32(sc, reg)				\
    270      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_REGDUMP,			\
    271      1.21   dyoung 	    ("%s: reg[ " #reg " / %03x ] = %08x\n",	\
    272       1.1   dyoung 	    dvname, reg, RTW_READ(regs, reg)))
    273       1.1   dyoung 
    274      1.21   dyoung #define PRINTREG16(sc, reg)				\
    275      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_REGDUMP,			\
    276      1.21   dyoung 	    ("%s: reg[ " #reg " / %03x ] = %04x\n",	\
    277       1.1   dyoung 	    dvname, reg, RTW_READ16(regs, reg)))
    278       1.1   dyoung 
    279      1.21   dyoung #define PRINTREG8(sc, reg)				\
    280      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_REGDUMP,			\
    281      1.21   dyoung 	    ("%s: reg[ " #reg " / %03x ] = %02x\n",	\
    282       1.1   dyoung 	    dvname, reg, RTW_READ8(regs, reg)))
    283       1.1   dyoung 
    284      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_REGDUMP, ("%s: %s\n", dvname, where));
    285       1.1   dyoung 
    286       1.1   dyoung 	PRINTREG32(regs, RTW_IDR0);
    287       1.1   dyoung 	PRINTREG32(regs, RTW_IDR1);
    288       1.1   dyoung 	PRINTREG32(regs, RTW_MAR0);
    289       1.1   dyoung 	PRINTREG32(regs, RTW_MAR1);
    290       1.1   dyoung 	PRINTREG32(regs, RTW_TSFTRL);
    291       1.1   dyoung 	PRINTREG32(regs, RTW_TSFTRH);
    292       1.1   dyoung 	PRINTREG32(regs, RTW_TLPDA);
    293       1.1   dyoung 	PRINTREG32(regs, RTW_TNPDA);
    294       1.1   dyoung 	PRINTREG32(regs, RTW_THPDA);
    295       1.1   dyoung 	PRINTREG32(regs, RTW_TCR);
    296       1.1   dyoung 	PRINTREG32(regs, RTW_RCR);
    297       1.1   dyoung 	PRINTREG32(regs, RTW_TINT);
    298       1.1   dyoung 	PRINTREG32(regs, RTW_TBDA);
    299       1.1   dyoung 	PRINTREG32(regs, RTW_ANAPARM);
    300       1.1   dyoung 	PRINTREG32(regs, RTW_BB);
    301       1.1   dyoung 	PRINTREG32(regs, RTW_PHYCFG);
    302       1.1   dyoung 	PRINTREG32(regs, RTW_WAKEUP0L);
    303       1.1   dyoung 	PRINTREG32(regs, RTW_WAKEUP0H);
    304       1.1   dyoung 	PRINTREG32(regs, RTW_WAKEUP1L);
    305       1.1   dyoung 	PRINTREG32(regs, RTW_WAKEUP1H);
    306       1.1   dyoung 	PRINTREG32(regs, RTW_WAKEUP2LL);
    307       1.1   dyoung 	PRINTREG32(regs, RTW_WAKEUP2LH);
    308       1.1   dyoung 	PRINTREG32(regs, RTW_WAKEUP2HL);
    309       1.1   dyoung 	PRINTREG32(regs, RTW_WAKEUP2HH);
    310       1.1   dyoung 	PRINTREG32(regs, RTW_WAKEUP3LL);
    311       1.1   dyoung 	PRINTREG32(regs, RTW_WAKEUP3LH);
    312       1.1   dyoung 	PRINTREG32(regs, RTW_WAKEUP3HL);
    313       1.1   dyoung 	PRINTREG32(regs, RTW_WAKEUP3HH);
    314       1.1   dyoung 	PRINTREG32(regs, RTW_WAKEUP4LL);
    315       1.1   dyoung 	PRINTREG32(regs, RTW_WAKEUP4LH);
    316       1.1   dyoung 	PRINTREG32(regs, RTW_WAKEUP4HL);
    317       1.1   dyoung 	PRINTREG32(regs, RTW_WAKEUP4HH);
    318       1.1   dyoung 	PRINTREG32(regs, RTW_DK0);
    319       1.1   dyoung 	PRINTREG32(regs, RTW_DK1);
    320       1.1   dyoung 	PRINTREG32(regs, RTW_DK2);
    321       1.1   dyoung 	PRINTREG32(regs, RTW_DK3);
    322       1.1   dyoung 	PRINTREG32(regs, RTW_RETRYCTR);
    323       1.1   dyoung 	PRINTREG32(regs, RTW_RDSAR);
    324       1.1   dyoung 	PRINTREG32(regs, RTW_FER);
    325       1.1   dyoung 	PRINTREG32(regs, RTW_FEMR);
    326       1.1   dyoung 	PRINTREG32(regs, RTW_FPSR);
    327       1.1   dyoung 	PRINTREG32(regs, RTW_FFER);
    328       1.1   dyoung 
    329       1.1   dyoung 	/* 16-bit registers */
    330       1.1   dyoung 	PRINTREG16(regs, RTW_BRSR);
    331       1.1   dyoung 	PRINTREG16(regs, RTW_IMR);
    332       1.1   dyoung 	PRINTREG16(regs, RTW_ISR);
    333       1.1   dyoung 	PRINTREG16(regs, RTW_BCNITV);
    334       1.1   dyoung 	PRINTREG16(regs, RTW_ATIMWND);
    335       1.1   dyoung 	PRINTREG16(regs, RTW_BINTRITV);
    336       1.1   dyoung 	PRINTREG16(regs, RTW_ATIMTRITV);
    337       1.1   dyoung 	PRINTREG16(regs, RTW_CRC16ERR);
    338       1.1   dyoung 	PRINTREG16(regs, RTW_CRC0);
    339       1.1   dyoung 	PRINTREG16(regs, RTW_CRC1);
    340       1.1   dyoung 	PRINTREG16(regs, RTW_CRC2);
    341       1.1   dyoung 	PRINTREG16(regs, RTW_CRC3);
    342       1.1   dyoung 	PRINTREG16(regs, RTW_CRC4);
    343       1.1   dyoung 	PRINTREG16(regs, RTW_CWR);
    344       1.1   dyoung 
    345       1.1   dyoung 	/* 8-bit registers */
    346       1.1   dyoung 	PRINTREG8(regs, RTW_CR);
    347       1.1   dyoung 	PRINTREG8(regs, RTW_9346CR);
    348       1.1   dyoung 	PRINTREG8(regs, RTW_CONFIG0);
    349       1.1   dyoung 	PRINTREG8(regs, RTW_CONFIG1);
    350       1.1   dyoung 	PRINTREG8(regs, RTW_CONFIG2);
    351       1.1   dyoung 	PRINTREG8(regs, RTW_MSR);
    352       1.1   dyoung 	PRINTREG8(regs, RTW_CONFIG3);
    353       1.1   dyoung 	PRINTREG8(regs, RTW_CONFIG4);
    354       1.1   dyoung 	PRINTREG8(regs, RTW_TESTR);
    355       1.1   dyoung 	PRINTREG8(regs, RTW_PSR);
    356       1.1   dyoung 	PRINTREG8(regs, RTW_SCR);
    357       1.1   dyoung 	PRINTREG8(regs, RTW_PHYDELAY);
    358       1.1   dyoung 	PRINTREG8(regs, RTW_CRCOUNT);
    359       1.1   dyoung 	PRINTREG8(regs, RTW_PHYADDR);
    360       1.1   dyoung 	PRINTREG8(regs, RTW_PHYDATAW);
    361       1.1   dyoung 	PRINTREG8(regs, RTW_PHYDATAR);
    362       1.1   dyoung 	PRINTREG8(regs, RTW_CONFIG5);
    363       1.1   dyoung 	PRINTREG8(regs, RTW_TPPOLL);
    364       1.1   dyoung 
    365       1.1   dyoung 	PRINTREG16(regs, RTW_BSSID16);
    366       1.1   dyoung 	PRINTREG32(regs, RTW_BSSID32);
    367       1.1   dyoung #undef PRINTREG32
    368       1.1   dyoung #undef PRINTREG16
    369       1.1   dyoung #undef PRINTREG8
    370       1.1   dyoung }
    371       1.1   dyoung #endif /* RTW_DEBUG */
    372       1.1   dyoung 
    373       1.1   dyoung void
    374       1.3   dyoung rtw_continuous_tx_enable(struct rtw_softc *sc, int enable)
    375       1.1   dyoung {
    376       1.3   dyoung 	struct rtw_regs *regs = &sc->sc_regs;
    377       1.3   dyoung 
    378      1.37   dyoung 	uint32_t tcr;
    379       1.1   dyoung 	tcr = RTW_READ(regs, RTW_TCR);
    380       1.1   dyoung 	tcr &= ~RTW_TCR_LBK_MASK;
    381       1.1   dyoung 	if (enable)
    382       1.1   dyoung 		tcr |= RTW_TCR_LBK_CONT;
    383       1.1   dyoung 	else
    384       1.1   dyoung 		tcr |= RTW_TCR_LBK_NORMAL;
    385       1.1   dyoung 	RTW_WRITE(regs, RTW_TCR, tcr);
    386       1.1   dyoung 	RTW_SYNC(regs, RTW_TCR, RTW_TCR);
    387      1.42   dyoung 	rtw_set_access(regs, RTW_ACCESS_ANAPARM);
    388       1.4   dyoung 	rtw_txdac_enable(sc, !enable);
    389      1.42   dyoung 	rtw_set_access(regs, RTW_ACCESS_ANAPARM);/* XXX Voodoo from Linux. */
    390      1.42   dyoung 	rtw_set_access(regs, RTW_ACCESS_NONE);
    391       1.3   dyoung }
    392       1.3   dyoung 
    393      1.24   dyoung #ifdef RTW_DEBUG
    394       1.3   dyoung static const char *
    395       1.3   dyoung rtw_access_string(enum rtw_access access)
    396       1.3   dyoung {
    397       1.3   dyoung 	switch (access) {
    398       1.3   dyoung 	case RTW_ACCESS_NONE:
    399       1.3   dyoung 		return "none";
    400       1.3   dyoung 	case RTW_ACCESS_CONFIG:
    401       1.3   dyoung 		return "config";
    402       1.3   dyoung 	case RTW_ACCESS_ANAPARM:
    403       1.3   dyoung 		return "anaparm";
    404       1.3   dyoung 	default:
    405       1.3   dyoung 		return "unknown";
    406       1.3   dyoung 	}
    407       1.3   dyoung }
    408      1.24   dyoung #endif /* RTW_DEBUG */
    409       1.3   dyoung 
    410       1.3   dyoung static void
    411      1.42   dyoung rtw_set_access1(struct rtw_regs *regs, enum rtw_access naccess)
    412       1.3   dyoung {
    413       1.3   dyoung 	KASSERT(naccess >= RTW_ACCESS_NONE && naccess <= RTW_ACCESS_ANAPARM);
    414      1.42   dyoung 	KASSERT(regs->r_access >= RTW_ACCESS_NONE &&
    415      1.42   dyoung 	        regs->r_access <= RTW_ACCESS_ANAPARM);
    416       1.3   dyoung 
    417      1.42   dyoung 	if (naccess == regs->r_access)
    418       1.3   dyoung 		return;
    419       1.3   dyoung 
    420       1.3   dyoung 	switch (naccess) {
    421       1.3   dyoung 	case RTW_ACCESS_NONE:
    422      1.42   dyoung 		switch (regs->r_access) {
    423       1.3   dyoung 		case RTW_ACCESS_ANAPARM:
    424       1.3   dyoung 			rtw_anaparm_enable(regs, 0);
    425       1.3   dyoung 			/*FALLTHROUGH*/
    426       1.3   dyoung 		case RTW_ACCESS_CONFIG:
    427       1.3   dyoung 			rtw_config0123_enable(regs, 0);
    428       1.3   dyoung 			/*FALLTHROUGH*/
    429       1.3   dyoung 		case RTW_ACCESS_NONE:
    430       1.3   dyoung 			break;
    431       1.3   dyoung 		}
    432       1.3   dyoung 		break;
    433       1.3   dyoung 	case RTW_ACCESS_CONFIG:
    434      1.42   dyoung 		switch (regs->r_access) {
    435       1.3   dyoung 		case RTW_ACCESS_NONE:
    436       1.3   dyoung 			rtw_config0123_enable(regs, 1);
    437       1.3   dyoung 			/*FALLTHROUGH*/
    438       1.3   dyoung 		case RTW_ACCESS_CONFIG:
    439       1.3   dyoung 			break;
    440       1.3   dyoung 		case RTW_ACCESS_ANAPARM:
    441       1.3   dyoung 			rtw_anaparm_enable(regs, 0);
    442       1.3   dyoung 			break;
    443       1.3   dyoung 		}
    444       1.3   dyoung 		break;
    445       1.3   dyoung 	case RTW_ACCESS_ANAPARM:
    446      1.42   dyoung 		switch (regs->r_access) {
    447       1.3   dyoung 		case RTW_ACCESS_NONE:
    448       1.3   dyoung 			rtw_config0123_enable(regs, 1);
    449       1.3   dyoung 			/*FALLTHROUGH*/
    450       1.3   dyoung 		case RTW_ACCESS_CONFIG:
    451       1.3   dyoung 			rtw_anaparm_enable(regs, 1);
    452       1.3   dyoung 			/*FALLTHROUGH*/
    453       1.3   dyoung 		case RTW_ACCESS_ANAPARM:
    454       1.3   dyoung 			break;
    455       1.3   dyoung 		}
    456       1.3   dyoung 		break;
    457       1.1   dyoung 	}
    458       1.1   dyoung }
    459       1.1   dyoung 
    460       1.3   dyoung void
    461      1.42   dyoung rtw_set_access(struct rtw_regs *regs, enum rtw_access access)
    462       1.3   dyoung {
    463      1.42   dyoung 	rtw_set_access1(regs, access);
    464      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_ACCESS,
    465      1.42   dyoung 	    ("%s: access %s -> %s\n", __func__,
    466      1.42   dyoung 	    rtw_access_string(regs->r_access),
    467       1.3   dyoung 	    rtw_access_string(access)));
    468      1.42   dyoung 	regs->r_access = access;
    469       1.3   dyoung }
    470       1.3   dyoung 
    471       1.1   dyoung /*
    472       1.1   dyoung  * Enable registers, switch register banks.
    473       1.1   dyoung  */
    474       1.1   dyoung void
    475       1.1   dyoung rtw_config0123_enable(struct rtw_regs *regs, int enable)
    476       1.1   dyoung {
    477      1.37   dyoung 	uint8_t ecr;
    478       1.1   dyoung 	ecr = RTW_READ8(regs, RTW_9346CR);
    479       1.1   dyoung 	ecr &= ~(RTW_9346CR_EEM_MASK | RTW_9346CR_EECS | RTW_9346CR_EESK);
    480       1.1   dyoung 	if (enable)
    481       1.1   dyoung 		ecr |= RTW_9346CR_EEM_CONFIG;
    482       1.8   dyoung 	else {
    483       1.8   dyoung 		RTW_WBW(regs, RTW_9346CR, MAX(RTW_CONFIG0, RTW_CONFIG3));
    484       1.1   dyoung 		ecr |= RTW_9346CR_EEM_NORMAL;
    485       1.8   dyoung 	}
    486       1.1   dyoung 	RTW_WRITE8(regs, RTW_9346CR, ecr);
    487       1.1   dyoung 	RTW_SYNC(regs, RTW_9346CR, RTW_9346CR);
    488       1.1   dyoung }
    489       1.1   dyoung 
    490       1.1   dyoung /* requires rtw_config0123_enable(, 1) */
    491       1.1   dyoung void
    492       1.1   dyoung rtw_anaparm_enable(struct rtw_regs *regs, int enable)
    493       1.1   dyoung {
    494      1.37   dyoung 	uint8_t cfg3;
    495       1.1   dyoung 
    496       1.1   dyoung 	cfg3 = RTW_READ8(regs, RTW_CONFIG3);
    497       1.3   dyoung 	cfg3 |= RTW_CONFIG3_CLKRUNEN;
    498       1.3   dyoung 	if (enable)
    499       1.3   dyoung 		cfg3 |= RTW_CONFIG3_PARMEN;
    500       1.3   dyoung 	else
    501       1.1   dyoung 		cfg3 &= ~RTW_CONFIG3_PARMEN;
    502       1.1   dyoung 	RTW_WRITE8(regs, RTW_CONFIG3, cfg3);
    503       1.1   dyoung 	RTW_SYNC(regs, RTW_CONFIG3, RTW_CONFIG3);
    504       1.1   dyoung }
    505       1.1   dyoung 
    506       1.1   dyoung /* requires rtw_anaparm_enable(, 1) */
    507       1.1   dyoung void
    508       1.4   dyoung rtw_txdac_enable(struct rtw_softc *sc, int enable)
    509       1.1   dyoung {
    510      1.37   dyoung 	uint32_t anaparm;
    511       1.4   dyoung 	struct rtw_regs *regs = &sc->sc_regs;
    512       1.1   dyoung 
    513       1.1   dyoung 	anaparm = RTW_READ(regs, RTW_ANAPARM);
    514       1.1   dyoung 	if (enable)
    515       1.1   dyoung 		anaparm &= ~RTW_ANAPARM_TXDACOFF;
    516       1.1   dyoung 	else
    517       1.1   dyoung 		anaparm |= RTW_ANAPARM_TXDACOFF;
    518       1.1   dyoung 	RTW_WRITE(regs, RTW_ANAPARM, anaparm);
    519       1.1   dyoung 	RTW_SYNC(regs, RTW_ANAPARM, RTW_ANAPARM);
    520       1.1   dyoung }
    521       1.1   dyoung 
    522      1.61    perry static inline int
    523       1.7   dyoung rtw_chip_reset1(struct rtw_regs *regs, const char *dvname)
    524       1.1   dyoung {
    525      1.37   dyoung 	uint8_t cr;
    526       1.1   dyoung 	int i;
    527       1.1   dyoung 
    528       1.1   dyoung 	RTW_WRITE8(regs, RTW_CR, RTW_CR_RST);
    529       1.1   dyoung 
    530       1.1   dyoung 	RTW_WBR(regs, RTW_CR, RTW_CR);
    531       1.1   dyoung 
    532      1.21   dyoung 	for (i = 0; i < 1000; i++) {
    533       1.1   dyoung 		if ((cr = RTW_READ8(regs, RTW_CR) & RTW_CR_RST) == 0) {
    534      1.21   dyoung 			RTW_DPRINTF(RTW_DEBUG_RESET,
    535      1.21   dyoung 			    ("%s: reset in %dus\n", dvname, i));
    536       1.1   dyoung 			return 0;
    537       1.1   dyoung 		}
    538       1.1   dyoung 		RTW_RBR(regs, RTW_CR, RTW_CR);
    539      1.21   dyoung 		DELAY(10); /* 10us */
    540       1.1   dyoung 	}
    541       1.1   dyoung 
    542       1.7   dyoung 	printf("%s: reset failed\n", dvname);
    543       1.1   dyoung 	return ETIMEDOUT;
    544       1.1   dyoung }
    545       1.1   dyoung 
    546      1.61    perry static inline int
    547       1.7   dyoung rtw_chip_reset(struct rtw_regs *regs, const char *dvname)
    548       1.3   dyoung {
    549       1.3   dyoung 	uint32_t tcr;
    550       1.3   dyoung 
    551       1.3   dyoung 	/* from Linux driver */
    552       1.3   dyoung 	tcr = RTW_TCR_CWMIN | RTW_TCR_MXDMA_2048 |
    553       1.3   dyoung 	      LSHIFT(7, RTW_TCR_SRL_MASK) | LSHIFT(7, RTW_TCR_LRL_MASK);
    554       1.3   dyoung 
    555       1.3   dyoung 	RTW_WRITE(regs, RTW_TCR, tcr);
    556       1.3   dyoung 
    557       1.3   dyoung 	RTW_WBW(regs, RTW_CR, RTW_TCR);
    558       1.3   dyoung 
    559       1.3   dyoung 	return rtw_chip_reset1(regs, dvname);
    560       1.3   dyoung }
    561       1.3   dyoung 
    562      1.49   dyoung static int
    563      1.58   dyoung rtw_wep_decap(struct ieee80211_key *k, struct mbuf *m, int hdrlen)
    564      1.50   dyoung {
    565      1.50   dyoung 	struct ieee80211_key keycopy;
    566      1.50   dyoung 
    567      1.50   dyoung 	RTW_DPRINTF(RTW_DEBUG_KEY, ("%s:\n", __func__));
    568      1.50   dyoung 
    569      1.50   dyoung 	keycopy = *k;
    570      1.50   dyoung 	keycopy.wk_flags &= ~IEEE80211_KEY_SWCRYPT;
    571      1.50   dyoung 
    572      1.58   dyoung 	return (*ieee80211_cipher_wep.ic_decap)(&keycopy, m, hdrlen);
    573      1.50   dyoung }
    574      1.50   dyoung 
    575      1.50   dyoung static int
    576      1.49   dyoung rtw_key_delete(struct ieee80211com *ic, const struct ieee80211_key *k)
    577      1.49   dyoung {
    578      1.49   dyoung 	struct rtw_softc *sc = ic->ic_ifp->if_softc;
    579      1.49   dyoung 	u_int keyix = k->wk_keyix;
    580      1.49   dyoung 
    581      1.49   dyoung 	DPRINTF(sc, RTW_DEBUG_KEY, ("%s: delete key %u\n", __func__, keyix));
    582      1.49   dyoung 
    583      1.49   dyoung 	if (keyix >= IEEE80211_WEP_NKID)
    584      1.49   dyoung 		return 0;
    585      1.49   dyoung 	if (k->wk_keylen != 0)
    586      1.49   dyoung 		sc->sc_flags &= ~RTW_F_DK_VALID;
    587      1.49   dyoung 
    588      1.49   dyoung 	return 1;
    589      1.49   dyoung }
    590      1.49   dyoung 
    591      1.49   dyoung static int
    592      1.49   dyoung rtw_key_set(struct ieee80211com *ic, const struct ieee80211_key *k,
    593      1.49   dyoung 	const u_int8_t mac[IEEE80211_ADDR_LEN])
    594      1.49   dyoung {
    595      1.49   dyoung 	struct rtw_softc *sc = ic->ic_ifp->if_softc;
    596      1.49   dyoung 
    597      1.49   dyoung 	DPRINTF(sc, RTW_DEBUG_KEY, ("%s: set key %u\n", __func__, k->wk_keyix));
    598      1.49   dyoung 
    599      1.49   dyoung 	if (k->wk_keyix >= IEEE80211_WEP_NKID)
    600      1.49   dyoung 		return 0;
    601      1.49   dyoung 
    602      1.49   dyoung 	sc->sc_flags &= ~RTW_F_DK_VALID;
    603      1.49   dyoung 
    604      1.49   dyoung 	return 1;
    605      1.49   dyoung }
    606      1.49   dyoung 
    607      1.49   dyoung static void
    608      1.49   dyoung rtw_key_update_begin(struct ieee80211com *ic)
    609      1.49   dyoung {
    610      1.55   dogcow #ifdef RTW_DEBUG
    611      1.49   dyoung 	struct ifnet *ifp = ic->ic_ifp;
    612      1.49   dyoung 	struct rtw_softc *sc = ifp->if_softc;
    613      1.49   dyoung #endif
    614      1.49   dyoung 
    615      1.49   dyoung 	DPRINTF(sc, RTW_DEBUG_KEY, ("%s:\n", __func__));
    616      1.49   dyoung }
    617      1.49   dyoung 
    618      1.49   dyoung static void
    619      1.49   dyoung rtw_key_update_end(struct ieee80211com *ic)
    620      1.49   dyoung {
    621      1.49   dyoung 	struct ifnet *ifp = ic->ic_ifp;
    622      1.49   dyoung 	struct rtw_softc *sc = ifp->if_softc;
    623      1.49   dyoung 
    624      1.49   dyoung 	DPRINTF(sc, RTW_DEBUG_KEY, ("%s:\n", __func__));
    625      1.49   dyoung 
    626      1.58   dyoung 	if ((sc->sc_flags & RTW_F_DK_VALID) != 0 ||
    627      1.58   dyoung 	    (sc->sc_flags & RTW_F_ENABLED) == 0 ||
    628      1.58   dyoung 	    (sc->sc_flags & RTW_F_INVALID) != 0)
    629      1.49   dyoung 		return;
    630      1.49   dyoung 
    631      1.49   dyoung 	rtw_io_enable(&sc->sc_regs, RTW_CR_RE | RTW_CR_TE, 0);
    632      1.49   dyoung 	rtw_wep_setkeys(sc, ic->ic_nw_keys, ic->ic_def_txkey);
    633      1.49   dyoung 	rtw_io_enable(&sc->sc_regs, RTW_CR_RE | RTW_CR_TE,
    634      1.49   dyoung 	    (ifp->if_flags & IFF_RUNNING) != 0);
    635      1.49   dyoung }
    636      1.49   dyoung 
    637      1.61    perry static inline int
    638      1.58   dyoung rtw_key_hwsupp(uint32_t flags, const struct ieee80211_key *k)
    639      1.58   dyoung {
    640      1.58   dyoung 	if (k->wk_cipher->ic_cipher != IEEE80211_CIPHER_WEP)
    641      1.58   dyoung 		return 0;
    642      1.58   dyoung 
    643      1.58   dyoung 	return	((flags & RTW_C_RXWEP_40) != 0 && k->wk_keylen == 5) ||
    644      1.58   dyoung 		((flags & RTW_C_RXWEP_104) != 0 && k->wk_keylen == 13);
    645      1.58   dyoung }
    646      1.58   dyoung 
    647      1.42   dyoung static void
    648      1.48   dyoung rtw_wep_setkeys(struct rtw_softc *sc, struct ieee80211_key *wk, int txkey)
    649      1.42   dyoung {
    650      1.58   dyoung 	uint8_t psr, scr;
    651      1.49   dyoung 	int i, tx_key_len;
    652      1.42   dyoung 	struct rtw_regs *regs;
    653      1.42   dyoung 	union rtw_keys *rk;
    654      1.42   dyoung 
    655      1.42   dyoung 	regs = &sc->sc_regs;
    656      1.42   dyoung 	rk = &sc->sc_keys;
    657      1.42   dyoung 
    658      1.42   dyoung 	(void)memset(rk->rk_keys, 0, sizeof(rk->rk_keys));
    659      1.42   dyoung 
    660      1.58   dyoung 	/* Temporarily use software crypto for all keys. */
    661      1.58   dyoung 	for (i = 0; i < IEEE80211_WEP_NKID; i++) {
    662      1.58   dyoung 		if (wk[i].wk_cipher == &rtw_cipher_wep)
    663      1.58   dyoung 			wk[i].wk_cipher = &ieee80211_cipher_wep;
    664      1.58   dyoung 	}
    665      1.58   dyoung 
    666      1.50   dyoung 	rtw_set_access(regs, RTW_ACCESS_CONFIG);
    667      1.50   dyoung 
    668      1.50   dyoung 	psr = RTW_READ8(regs, RTW_PSR);
    669      1.42   dyoung 	scr = RTW_READ8(regs, RTW_SCR);
    670      1.42   dyoung 	scr &= ~(RTW_SCR_KM_MASK | RTW_SCR_TXSECON | RTW_SCR_RXSECON);
    671      1.42   dyoung 
    672      1.42   dyoung 	if ((sc->sc_ic.ic_flags & IEEE80211_F_PRIVACY) == 0)
    673      1.42   dyoung 		goto out;
    674      1.42   dyoung 
    675      1.58   dyoung 	if (!rtw_key_hwsupp(sc->sc_flags, &wk[txkey]))
    676      1.58   dyoung 		goto out;
    677      1.58   dyoung 
    678      1.48   dyoung 	tx_key_len = wk[txkey].wk_keylen;
    679      1.42   dyoung 
    680      1.42   dyoung 	switch (tx_key_len) {
    681      1.42   dyoung 	case 5:
    682      1.58   dyoung 		scr |= RTW_SCR_KM_WEP40;
    683      1.42   dyoung 		break;
    684      1.42   dyoung 	case 13:
    685      1.58   dyoung 		scr |= RTW_SCR_KM_WEP104;
    686      1.42   dyoung 		break;
    687      1.42   dyoung 	default:
    688      1.42   dyoung 		goto out;
    689      1.42   dyoung 	}
    690      1.42   dyoung 
    691      1.58   dyoung 	scr |= RTW_SCR_RXSECON;
    692      1.42   dyoung 
    693      1.49   dyoung 	for (i = 0; i < IEEE80211_WEP_NKID; i++) {
    694      1.58   dyoung 		if (wk[i].wk_keylen != tx_key_len ||
    695      1.58   dyoung 		    wk[i].wk_cipher->ic_cipher != IEEE80211_CIPHER_WEP)
    696      1.42   dyoung 			continue;
    697      1.58   dyoung 		/* h/w will decrypt, s/w still strips headers */
    698      1.58   dyoung 		wk[i].wk_cipher = &rtw_cipher_wep;
    699      1.49   dyoung 		(void)memcpy(rk->rk_keys[i], wk[i].wk_key, wk[i].wk_keylen);
    700      1.42   dyoung 	}
    701      1.42   dyoung 
    702      1.42   dyoung out:
    703      1.50   dyoung 	RTW_WRITE8(regs, RTW_PSR, psr & ~RTW_PSR_PSEN);
    704      1.50   dyoung 
    705      1.42   dyoung 	bus_space_write_region_4(regs->r_bt, regs->r_bh,
    706      1.42   dyoung 	    RTW_DK0, rk->rk_words,
    707      1.42   dyoung 	    sizeof(rk->rk_words) / sizeof(rk->rk_words[0]));
    708      1.42   dyoung 
    709      1.50   dyoung 	bus_space_barrier(regs->r_bt, regs->r_bh, RTW_DK0, sizeof(rk->rk_words),
    710      1.42   dyoung 	    BUS_SPACE_BARRIER_SYNC);
    711      1.42   dyoung 
    712      1.58   dyoung 	RTW_WBW(regs, RTW_DK0, RTW_PSR);
    713      1.50   dyoung 	RTW_WRITE8(regs, RTW_PSR, psr);
    714      1.58   dyoung 	RTW_WBW(regs, RTW_PSR, RTW_SCR);
    715      1.42   dyoung 	RTW_WRITE8(regs, RTW_SCR, scr);
    716      1.42   dyoung 	RTW_SYNC(regs, RTW_SCR, RTW_SCR);
    717      1.42   dyoung 	rtw_set_access(regs, RTW_ACCESS_NONE);
    718      1.49   dyoung 	sc->sc_flags |= RTW_F_DK_VALID;
    719      1.42   dyoung }
    720      1.42   dyoung 
    721      1.61    perry static inline int
    722       1.7   dyoung rtw_recall_eeprom(struct rtw_regs *regs, const char *dvname)
    723       1.1   dyoung {
    724       1.1   dyoung 	int i;
    725      1.37   dyoung 	uint8_t ecr;
    726       1.1   dyoung 
    727       1.1   dyoung 	ecr = RTW_READ8(regs, RTW_9346CR);
    728       1.1   dyoung 	ecr = (ecr & ~RTW_9346CR_EEM_MASK) | RTW_9346CR_EEM_AUTOLOAD;
    729       1.1   dyoung 	RTW_WRITE8(regs, RTW_9346CR, ecr);
    730       1.1   dyoung 
    731       1.1   dyoung 	RTW_WBR(regs, RTW_9346CR, RTW_9346CR);
    732       1.1   dyoung 
    733      1.55   dogcow 	/* wait 25ms for completion */
    734      1.55   dogcow 	for (i = 0; i < 250; i++) {
    735       1.1   dyoung 		ecr = RTW_READ8(regs, RTW_9346CR);
    736       1.1   dyoung 		if ((ecr & RTW_9346CR_EEM_MASK) == RTW_9346CR_EEM_NORMAL) {
    737      1.21   dyoung 			RTW_DPRINTF(RTW_DEBUG_RESET,
    738      1.21   dyoung 			    ("%s: recall EEPROM in %dus\n", dvname, i * 100));
    739       1.1   dyoung 			return 0;
    740       1.1   dyoung 		}
    741       1.1   dyoung 		RTW_RBR(regs, RTW_9346CR, RTW_9346CR);
    742       1.1   dyoung 		DELAY(100);
    743       1.1   dyoung 	}
    744       1.7   dyoung 	printf("%s: recall EEPROM failed\n", dvname);
    745       1.1   dyoung 	return ETIMEDOUT;
    746       1.1   dyoung }
    747       1.1   dyoung 
    748      1.61    perry static inline int
    749       1.1   dyoung rtw_reset(struct rtw_softc *sc)
    750       1.1   dyoung {
    751       1.1   dyoung 	int rc;
    752       1.4   dyoung 	uint8_t config1;
    753       1.1   dyoung 
    754      1.49   dyoung 	sc->sc_flags &= ~RTW_F_DK_VALID;
    755      1.49   dyoung 
    756       1.7   dyoung 	if ((rc = rtw_chip_reset(&sc->sc_regs, sc->sc_dev.dv_xname)) != 0)
    757       1.1   dyoung 		return rc;
    758       1.1   dyoung 
    759       1.7   dyoung 	if ((rc = rtw_recall_eeprom(&sc->sc_regs, sc->sc_dev.dv_xname)) != 0)
    760       1.1   dyoung 		;
    761       1.1   dyoung 
    762       1.4   dyoung 	config1 = RTW_READ8(&sc->sc_regs, RTW_CONFIG1);
    763       1.4   dyoung 	RTW_WRITE8(&sc->sc_regs, RTW_CONFIG1, config1 & ~RTW_CONFIG1_PMEN);
    764       1.1   dyoung 	/* TBD turn off maximum power saving? */
    765       1.1   dyoung 
    766       1.1   dyoung 	return 0;
    767       1.1   dyoung }
    768       1.1   dyoung 
    769      1.61    perry static inline int
    770      1.34   dyoung rtw_txdesc_dmamaps_create(bus_dma_tag_t dmat, struct rtw_txsoft *descs,
    771       1.1   dyoung     u_int ndescs)
    772       1.1   dyoung {
    773       1.1   dyoung 	int i, rc = 0;
    774       1.1   dyoung 	for (i = 0; i < ndescs; i++) {
    775       1.1   dyoung 		rc = bus_dmamap_create(dmat, MCLBYTES, RTW_MAXPKTSEGS, MCLBYTES,
    776      1.34   dyoung 		    0, 0, &descs[i].ts_dmamap);
    777       1.1   dyoung 		if (rc != 0)
    778       1.1   dyoung 			break;
    779       1.1   dyoung 	}
    780       1.1   dyoung 	return rc;
    781       1.1   dyoung }
    782       1.1   dyoung 
    783      1.61    perry static inline int
    784      1.34   dyoung rtw_rxdesc_dmamaps_create(bus_dma_tag_t dmat, struct rtw_rxsoft *descs,
    785       1.1   dyoung     u_int ndescs)
    786       1.1   dyoung {
    787       1.1   dyoung 	int i, rc = 0;
    788       1.1   dyoung 	for (i = 0; i < ndescs; i++) {
    789       1.1   dyoung 		rc = bus_dmamap_create(dmat, MCLBYTES, 1, MCLBYTES, 0, 0,
    790      1.34   dyoung 		    &descs[i].rs_dmamap);
    791       1.1   dyoung 		if (rc != 0)
    792       1.1   dyoung 			break;
    793       1.1   dyoung 	}
    794       1.1   dyoung 	return rc;
    795       1.1   dyoung }
    796       1.1   dyoung 
    797      1.61    perry static inline void
    798      1.34   dyoung rtw_rxdesc_dmamaps_destroy(bus_dma_tag_t dmat, struct rtw_rxsoft *descs,
    799       1.1   dyoung     u_int ndescs)
    800       1.1   dyoung {
    801       1.1   dyoung 	int i;
    802       1.1   dyoung 	for (i = 0; i < ndescs; i++) {
    803      1.34   dyoung 		if (descs[i].rs_dmamap != NULL)
    804      1.34   dyoung 			bus_dmamap_destroy(dmat, descs[i].rs_dmamap);
    805       1.1   dyoung 	}
    806       1.1   dyoung }
    807       1.1   dyoung 
    808      1.61    perry static inline void
    809      1.34   dyoung rtw_txdesc_dmamaps_destroy(bus_dma_tag_t dmat, struct rtw_txsoft *descs,
    810       1.1   dyoung     u_int ndescs)
    811       1.1   dyoung {
    812       1.1   dyoung 	int i;
    813       1.1   dyoung 	for (i = 0; i < ndescs; i++) {
    814      1.34   dyoung 		if (descs[i].ts_dmamap != NULL)
    815      1.34   dyoung 			bus_dmamap_destroy(dmat, descs[i].ts_dmamap);
    816       1.1   dyoung 	}
    817       1.1   dyoung }
    818       1.1   dyoung 
    819      1.61    perry static inline void
    820       1.1   dyoung rtw_srom_free(struct rtw_srom *sr)
    821       1.1   dyoung {
    822       1.1   dyoung 	sr->sr_size = 0;
    823       1.1   dyoung 	if (sr->sr_content == NULL)
    824       1.1   dyoung 		return;
    825       1.1   dyoung 	free(sr->sr_content, M_DEVBUF);
    826       1.1   dyoung 	sr->sr_content = NULL;
    827       1.1   dyoung }
    828       1.1   dyoung 
    829       1.1   dyoung static void
    830      1.37   dyoung rtw_srom_defaults(struct rtw_srom *sr, uint32_t *flags, uint8_t *cs_threshold,
    831      1.37   dyoung     enum rtw_rfchipid *rfchipid, uint32_t *rcr)
    832       1.1   dyoung {
    833       1.1   dyoung 	*flags |= (RTW_F_DIGPHY|RTW_F_ANTDIV);
    834       1.1   dyoung 	*cs_threshold = RTW_SR_ENERGYDETTHR_DEFAULT;
    835       1.1   dyoung 	*rcr |= RTW_RCR_ENCS1;
    836       1.1   dyoung 	*rfchipid = RTW_RFCHIPID_PHILIPS;
    837       1.1   dyoung }
    838       1.1   dyoung 
    839       1.1   dyoung static int
    840      1.37   dyoung rtw_srom_parse(struct rtw_srom *sr, uint32_t *flags, uint8_t *cs_threshold,
    841      1.37   dyoung     enum rtw_rfchipid *rfchipid, uint32_t *rcr, enum rtw_locale *locale,
    842       1.7   dyoung     const char *dvname)
    843       1.1   dyoung {
    844       1.1   dyoung 	int i;
    845       1.1   dyoung 	const char *rfname, *paname;
    846       1.1   dyoung 	char scratch[sizeof("unknown 0xXX")];
    847      1.46   dyoung 	uint16_t srom_version;
    848      1.37   dyoung 	uint8_t mac[IEEE80211_ADDR_LEN];
    849       1.1   dyoung 
    850       1.1   dyoung 	*flags &= ~(RTW_F_DIGPHY|RTW_F_DFLANTB|RTW_F_ANTDIV);
    851       1.1   dyoung 	*rcr &= ~(RTW_RCR_ENCS1 | RTW_RCR_ENCS2);
    852       1.1   dyoung 
    853      1.46   dyoung 	srom_version = RTW_SR_GET16(sr, RTW_SR_VERSION);
    854      1.46   dyoung 	printf("%s: SROM version %d.%d", dvname,
    855      1.46   dyoung 	    srom_version >> 8, srom_version & 0xff);
    856       1.1   dyoung 
    857      1.46   dyoung 	if (srom_version <= 0x0101) {
    858       1.1   dyoung 		printf(" is not understood, limping along with defaults\n");
    859       1.7   dyoung 		rtw_srom_defaults(sr, flags, cs_threshold, rfchipid, rcr);
    860       1.1   dyoung 		return 0;
    861       1.1   dyoung 	}
    862       1.1   dyoung 	printf("\n");
    863       1.1   dyoung 
    864       1.1   dyoung 	for (i = 0; i < IEEE80211_ADDR_LEN; i++)
    865       1.1   dyoung 		mac[i] = RTW_SR_GET(sr, RTW_SR_MAC + i);
    866       1.1   dyoung 
    867      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_ATTACH,
    868      1.21   dyoung 	    ("%s: EEPROM MAC %s\n", dvname, ether_sprintf(mac)));
    869       1.1   dyoung 
    870       1.1   dyoung 	*cs_threshold = RTW_SR_GET(sr, RTW_SR_ENERGYDETTHR);
    871       1.1   dyoung 
    872       1.1   dyoung 	if ((RTW_SR_GET(sr, RTW_SR_CONFIG2) & RTW_CONFIG2_ANT) != 0)
    873       1.1   dyoung 		*flags |= RTW_F_ANTDIV;
    874       1.1   dyoung 
    875      1.10   dyoung 	/* Note well: the sense of the RTW_SR_RFPARM_DIGPHY bit seems
    876      1.10   dyoung 	 * to be reversed.
    877      1.10   dyoung 	 */
    878      1.10   dyoung 	if ((RTW_SR_GET(sr, RTW_SR_RFPARM) & RTW_SR_RFPARM_DIGPHY) == 0)
    879       1.1   dyoung 		*flags |= RTW_F_DIGPHY;
    880       1.1   dyoung 	if ((RTW_SR_GET(sr, RTW_SR_RFPARM) & RTW_SR_RFPARM_DFLANTB) != 0)
    881       1.1   dyoung 		*flags |= RTW_F_DFLANTB;
    882       1.1   dyoung 
    883       1.1   dyoung 	*rcr |= LSHIFT(MASK_AND_RSHIFT(RTW_SR_GET(sr, RTW_SR_RFPARM),
    884       1.1   dyoung 	    RTW_SR_RFPARM_CS_MASK), RTW_RCR_ENCS1);
    885       1.1   dyoung 
    886      1.58   dyoung 	if ((RTW_SR_GET(sr, RTW_SR_CONFIG0) & RTW_CONFIG0_WEP104) != 0)
    887      1.58   dyoung 		*flags |= RTW_C_RXWEP_104;
    888      1.58   dyoung 
    889      1.58   dyoung 	*flags |= RTW_C_RXWEP_40;	/* XXX */
    890      1.58   dyoung 
    891       1.1   dyoung 	*rfchipid = RTW_SR_GET(sr, RTW_SR_RFCHIPID);
    892       1.1   dyoung 	switch (*rfchipid) {
    893       1.1   dyoung 	case RTW_RFCHIPID_GCT:		/* this combo seen in the wild */
    894       1.1   dyoung 		rfname = "GCT GRF5101";
    895       1.1   dyoung 		paname = "Winspring WS9901";
    896       1.1   dyoung 		break;
    897       1.1   dyoung 	case RTW_RFCHIPID_MAXIM:
    898       1.1   dyoung 		rfname = "Maxim MAX2820";	/* guess */
    899       1.1   dyoung 		paname = "Maxim MAX2422";	/* guess */
    900       1.1   dyoung 		break;
    901       1.1   dyoung 	case RTW_RFCHIPID_INTERSIL:
    902       1.1   dyoung 		rfname = "Intersil HFA3873";	/* guess */
    903       1.1   dyoung 		paname = "Intersil <unknown>";
    904       1.1   dyoung 		break;
    905       1.1   dyoung 	case RTW_RFCHIPID_PHILIPS:	/* this combo seen in the wild */
    906       1.1   dyoung 		rfname = "Philips SA2400A";
    907       1.1   dyoung 		paname = "Philips SA2411";
    908       1.1   dyoung 		break;
    909       1.1   dyoung 	case RTW_RFCHIPID_RFMD:
    910       1.1   dyoung 		/* this is the same front-end as an atw(4)! */
    911       1.1   dyoung 		rfname = "RFMD RF2948B, "	/* mentioned in Realtek docs */
    912       1.1   dyoung 			 "LNA: RFMD RF2494, "	/* mentioned in Realtek docs */
    913       1.1   dyoung 			 "SYN: Silicon Labs Si4126";	/* inferred from
    914       1.1   dyoung 			 				 * reference driver
    915       1.1   dyoung 							 */
    916       1.1   dyoung 		paname = "RFMD RF2189";		/* mentioned in Realtek docs */
    917       1.1   dyoung 		break;
    918       1.1   dyoung 	case RTW_RFCHIPID_RESERVED:
    919       1.1   dyoung 		rfname = paname = "reserved";
    920       1.1   dyoung 		break;
    921       1.1   dyoung 	default:
    922       1.1   dyoung 		snprintf(scratch, sizeof(scratch), "unknown 0x%02x", *rfchipid);
    923       1.1   dyoung 		rfname = paname = scratch;
    924       1.1   dyoung 	}
    925       1.7   dyoung 	printf("%s: RF: %s, PA: %s\n", dvname, rfname, paname);
    926       1.1   dyoung 
    927       1.1   dyoung 	switch (RTW_SR_GET(sr, RTW_SR_CONFIG0) & RTW_CONFIG0_GL_MASK) {
    928       1.1   dyoung 	case RTW_CONFIG0_GL_USA:
    929      1.55   dogcow 	case _RTW_CONFIG0_GL_USA:
    930       1.1   dyoung 		*locale = RTW_LOCALE_USA;
    931       1.1   dyoung 		break;
    932       1.1   dyoung 	case RTW_CONFIG0_GL_EUROPE:
    933       1.1   dyoung 		*locale = RTW_LOCALE_EUROPE;
    934       1.1   dyoung 		break;
    935       1.1   dyoung 	case RTW_CONFIG0_GL_JAPAN:
    936       1.1   dyoung 		*locale = RTW_LOCALE_JAPAN;
    937       1.1   dyoung 		break;
    938       1.1   dyoung 	default:
    939       1.1   dyoung 		*locale = RTW_LOCALE_UNKNOWN;
    940       1.1   dyoung 		break;
    941       1.1   dyoung 	}
    942       1.1   dyoung 	return 0;
    943       1.1   dyoung }
    944       1.1   dyoung 
    945       1.1   dyoung /* Returns -1 on failure. */
    946       1.1   dyoung static int
    947      1.37   dyoung rtw_srom_read(struct rtw_regs *regs, uint32_t flags, struct rtw_srom *sr,
    948       1.7   dyoung     const char *dvname)
    949       1.1   dyoung {
    950       1.1   dyoung 	int rc;
    951       1.1   dyoung 	struct seeprom_descriptor sd;
    952      1.37   dyoung 	uint8_t ecr;
    953       1.1   dyoung 
    954       1.1   dyoung 	(void)memset(&sd, 0, sizeof(sd));
    955       1.1   dyoung 
    956       1.1   dyoung 	ecr = RTW_READ8(regs, RTW_9346CR);
    957       1.1   dyoung 
    958       1.1   dyoung 	if ((flags & RTW_F_9356SROM) != 0) {
    959      1.21   dyoung 		RTW_DPRINTF(RTW_DEBUG_ATTACH, ("%s: 93c56 SROM\n", dvname));
    960       1.1   dyoung 		sr->sr_size = 256;
    961       1.1   dyoung 		sd.sd_chip = C56_66;
    962       1.1   dyoung 	} else {
    963      1.21   dyoung 		RTW_DPRINTF(RTW_DEBUG_ATTACH, ("%s: 93c46 SROM\n", dvname));
    964       1.1   dyoung 		sr->sr_size = 128;
    965       1.1   dyoung 		sd.sd_chip = C46;
    966       1.1   dyoung 	}
    967       1.1   dyoung 
    968       1.1   dyoung 	ecr &= ~(RTW_9346CR_EEDI | RTW_9346CR_EEDO | RTW_9346CR_EESK |
    969      1.41   dyoung 	    RTW_9346CR_EEM_MASK | RTW_9346CR_EECS);
    970       1.1   dyoung 	ecr |= RTW_9346CR_EEM_PROGRAM;
    971       1.1   dyoung 
    972       1.1   dyoung 	RTW_WRITE8(regs, RTW_9346CR, ecr);
    973       1.1   dyoung 
    974       1.1   dyoung 	sr->sr_content = malloc(sr->sr_size, M_DEVBUF, M_NOWAIT);
    975       1.1   dyoung 
    976       1.1   dyoung 	if (sr->sr_content == NULL) {
    977       1.7   dyoung 		printf("%s: unable to allocate SROM buffer\n", dvname);
    978       1.1   dyoung 		return ENOMEM;
    979       1.1   dyoung 	}
    980       1.1   dyoung 
    981       1.1   dyoung 	(void)memset(sr->sr_content, 0, sr->sr_size);
    982       1.1   dyoung 
    983       1.1   dyoung 	/* RTL8180 has a single 8-bit register for controlling the
    984       1.1   dyoung 	 * 93cx6 SROM.  There is no "ready" bit. The RTL8180
    985       1.1   dyoung 	 * input/output sense is the reverse of read_seeprom's.
    986       1.1   dyoung 	 */
    987       1.1   dyoung 	sd.sd_tag = regs->r_bt;
    988       1.1   dyoung 	sd.sd_bsh = regs->r_bh;
    989       1.1   dyoung 	sd.sd_regsize = 1;
    990       1.1   dyoung 	sd.sd_control_offset = RTW_9346CR;
    991       1.1   dyoung 	sd.sd_status_offset = RTW_9346CR;
    992       1.1   dyoung 	sd.sd_dataout_offset = RTW_9346CR;
    993       1.1   dyoung 	sd.sd_CK = RTW_9346CR_EESK;
    994       1.1   dyoung 	sd.sd_CS = RTW_9346CR_EECS;
    995       1.1   dyoung 	sd.sd_DI = RTW_9346CR_EEDO;
    996       1.1   dyoung 	sd.sd_DO = RTW_9346CR_EEDI;
    997      1.44    perry 	/* make read_seeprom enter EEPROM read/write mode */
    998       1.1   dyoung 	sd.sd_MS = ecr;
    999       1.1   dyoung 	sd.sd_RDY = 0;
   1000       1.1   dyoung 
   1001       1.8   dyoung 	/* TBD bus barriers */
   1002       1.1   dyoung 	if (!read_seeprom(&sd, sr->sr_content, 0, sr->sr_size/2)) {
   1003       1.7   dyoung 		printf("%s: could not read SROM\n", dvname);
   1004       1.1   dyoung 		free(sr->sr_content, M_DEVBUF);
   1005       1.1   dyoung 		sr->sr_content = NULL;
   1006       1.1   dyoung 		return -1;	/* XXX */
   1007       1.1   dyoung 	}
   1008       1.1   dyoung 
   1009      1.44    perry 	/* end EEPROM read/write mode */
   1010       1.1   dyoung 	RTW_WRITE8(regs, RTW_9346CR,
   1011       1.1   dyoung 	    (ecr & ~RTW_9346CR_EEM_MASK) | RTW_9346CR_EEM_NORMAL);
   1012       1.1   dyoung 	RTW_WBRW(regs, RTW_9346CR, RTW_9346CR);
   1013       1.1   dyoung 
   1014       1.1   dyoung 	if ((rc = rtw_recall_eeprom(regs, dvname)) != 0)
   1015       1.1   dyoung 		return rc;
   1016       1.1   dyoung 
   1017       1.1   dyoung #ifdef RTW_DEBUG
   1018       1.1   dyoung 	{
   1019       1.1   dyoung 		int i;
   1020      1.21   dyoung 		RTW_DPRINTF(RTW_DEBUG_ATTACH,
   1021      1.21   dyoung 		    ("\n%s: serial ROM:\n\t", dvname));
   1022       1.1   dyoung 		for (i = 0; i < sr->sr_size/2; i++) {
   1023       1.1   dyoung 			if (((i % 8) == 0) && (i != 0))
   1024      1.21   dyoung 				RTW_DPRINTF(RTW_DEBUG_ATTACH, ("\n\t"));
   1025      1.21   dyoung 			RTW_DPRINTF(RTW_DEBUG_ATTACH,
   1026      1.21   dyoung 			    (" %04x", sr->sr_content[i]));
   1027       1.1   dyoung 		}
   1028      1.21   dyoung 		RTW_DPRINTF(RTW_DEBUG_ATTACH, ("\n"));
   1029       1.1   dyoung 	}
   1030       1.1   dyoung #endif /* RTW_DEBUG */
   1031       1.1   dyoung 	return 0;
   1032       1.1   dyoung }
   1033       1.1   dyoung 
   1034       1.4   dyoung static void
   1035       1.4   dyoung rtw_set_rfprog(struct rtw_regs *regs, enum rtw_rfchipid rfchipid,
   1036       1.4   dyoung     const char *dvname)
   1037       1.4   dyoung {
   1038      1.37   dyoung 	uint8_t cfg4;
   1039       1.4   dyoung 	const char *method;
   1040       1.4   dyoung 
   1041       1.4   dyoung 	cfg4 = RTW_READ8(regs, RTW_CONFIG4) & ~RTW_CONFIG4_RFTYPE_MASK;
   1042       1.4   dyoung 
   1043       1.4   dyoung 	switch (rfchipid) {
   1044       1.4   dyoung 	default:
   1045       1.4   dyoung 		cfg4 |= LSHIFT(rtw_rfprog_fallback, RTW_CONFIG4_RFTYPE_MASK);
   1046       1.4   dyoung 		method = "fallback";
   1047       1.4   dyoung 		break;
   1048       1.4   dyoung 	case RTW_RFCHIPID_INTERSIL:
   1049       1.4   dyoung 		cfg4 |= RTW_CONFIG4_RFTYPE_INTERSIL;
   1050       1.4   dyoung 		method = "Intersil";
   1051       1.4   dyoung 		break;
   1052       1.4   dyoung 	case RTW_RFCHIPID_PHILIPS:
   1053       1.4   dyoung 		cfg4 |= RTW_CONFIG4_RFTYPE_PHILIPS;
   1054       1.4   dyoung 		method = "Philips";
   1055       1.4   dyoung 		break;
   1056      1.42   dyoung 	case RTW_RFCHIPID_GCT:	/* XXX a guess */
   1057       1.4   dyoung 	case RTW_RFCHIPID_RFMD:
   1058       1.4   dyoung 		cfg4 |= RTW_CONFIG4_RFTYPE_RFMD;
   1059       1.4   dyoung 		method = "RFMD";
   1060       1.4   dyoung 		break;
   1061       1.4   dyoung 	}
   1062       1.4   dyoung 
   1063       1.4   dyoung 	RTW_WRITE8(regs, RTW_CONFIG4, cfg4);
   1064       1.4   dyoung 
   1065       1.8   dyoung 	RTW_WBR(regs, RTW_CONFIG4, RTW_CONFIG4);
   1066       1.8   dyoung 
   1067      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_INIT,
   1068      1.21   dyoung 	    ("%s: %s RF programming method, %#02x\n", dvname, method,
   1069      1.10   dyoung 	    RTW_READ8(regs, RTW_CONFIG4)));
   1070       1.4   dyoung }
   1071       1.4   dyoung 
   1072      1.61    perry static inline void
   1073       1.1   dyoung rtw_init_channels(enum rtw_locale locale,
   1074       1.1   dyoung     struct ieee80211_channel (*chans)[IEEE80211_CHAN_MAX+1],
   1075       1.7   dyoung     const char *dvname)
   1076       1.1   dyoung {
   1077       1.1   dyoung 	int i;
   1078       1.1   dyoung 	const char *name = NULL;
   1079       1.1   dyoung #define ADD_CHANNEL(_chans, _chan) do {			\
   1080       1.1   dyoung 	(*_chans)[_chan].ic_flags = IEEE80211_CHAN_B;		\
   1081       1.1   dyoung 	(*_chans)[_chan].ic_freq =				\
   1082       1.1   dyoung 	    ieee80211_ieee2mhz(_chan, (*_chans)[_chan].ic_flags);\
   1083       1.1   dyoung } while (0)
   1084       1.1   dyoung 
   1085       1.1   dyoung 	switch (locale) {
   1086       1.1   dyoung 	case RTW_LOCALE_USA:	/* 1-11 */
   1087       1.1   dyoung 		name = "USA";
   1088       1.1   dyoung 		for (i = 1; i <= 11; i++)
   1089       1.1   dyoung 			ADD_CHANNEL(chans, i);
   1090       1.1   dyoung 		break;
   1091       1.1   dyoung 	case RTW_LOCALE_JAPAN:	/* 1-14 */
   1092       1.1   dyoung 		name = "Japan";
   1093       1.1   dyoung 		ADD_CHANNEL(chans, 14);
   1094       1.1   dyoung 		for (i = 1; i <= 14; i++)
   1095       1.1   dyoung 			ADD_CHANNEL(chans, i);
   1096       1.1   dyoung 		break;
   1097       1.1   dyoung 	case RTW_LOCALE_EUROPE:	/* 1-13 */
   1098       1.1   dyoung 		name = "Europe";
   1099       1.1   dyoung 		for (i = 1; i <= 13; i++)
   1100       1.1   dyoung 			ADD_CHANNEL(chans, i);
   1101       1.1   dyoung 		break;
   1102       1.1   dyoung 	default:			/* 10-11 allowed by most countries */
   1103       1.1   dyoung 		name = "<unknown>";
   1104       1.1   dyoung 		for (i = 10; i <= 11; i++)
   1105       1.1   dyoung 			ADD_CHANNEL(chans, i);
   1106       1.1   dyoung 		break;
   1107       1.1   dyoung 	}
   1108       1.7   dyoung 	printf("%s: Geographic Location %s\n", dvname, name);
   1109       1.1   dyoung #undef ADD_CHANNEL
   1110       1.1   dyoung }
   1111       1.1   dyoung 
   1112      1.58   dyoung 
   1113      1.61    perry static inline void
   1114      1.58   dyoung rtw_identify_country(struct rtw_regs *regs, enum rtw_locale *locale)
   1115       1.1   dyoung {
   1116      1.37   dyoung 	uint8_t cfg0 = RTW_READ8(regs, RTW_CONFIG0);
   1117       1.1   dyoung 
   1118       1.1   dyoung 	switch (cfg0 & RTW_CONFIG0_GL_MASK) {
   1119       1.1   dyoung 	case RTW_CONFIG0_GL_USA:
   1120      1.55   dogcow 	case _RTW_CONFIG0_GL_USA:
   1121       1.1   dyoung 		*locale = RTW_LOCALE_USA;
   1122       1.1   dyoung 		break;
   1123       1.1   dyoung 	case RTW_CONFIG0_GL_JAPAN:
   1124       1.1   dyoung 		*locale = RTW_LOCALE_JAPAN;
   1125       1.1   dyoung 		break;
   1126       1.1   dyoung 	case RTW_CONFIG0_GL_EUROPE:
   1127       1.1   dyoung 		*locale = RTW_LOCALE_EUROPE;
   1128       1.1   dyoung 		break;
   1129       1.1   dyoung 	default:
   1130       1.1   dyoung 		*locale = RTW_LOCALE_UNKNOWN;
   1131       1.1   dyoung 		break;
   1132       1.1   dyoung 	}
   1133       1.1   dyoung }
   1134       1.1   dyoung 
   1135      1.61    perry static inline int
   1136      1.37   dyoung rtw_identify_sta(struct rtw_regs *regs, uint8_t (*addr)[IEEE80211_ADDR_LEN],
   1137       1.7   dyoung     const char *dvname)
   1138       1.1   dyoung {
   1139      1.37   dyoung 	static const uint8_t empty_macaddr[IEEE80211_ADDR_LEN] = {
   1140       1.1   dyoung 		0x00, 0x00, 0x00, 0x00, 0x00, 0x00
   1141       1.1   dyoung 	};
   1142      1.37   dyoung 	uint32_t idr0 = RTW_READ(regs, RTW_IDR0),
   1143       1.1   dyoung 	          idr1 = RTW_READ(regs, RTW_IDR1);
   1144       1.1   dyoung 
   1145       1.1   dyoung 	(*addr)[0] = MASK_AND_RSHIFT(idr0, BITS(0,  7));
   1146       1.1   dyoung 	(*addr)[1] = MASK_AND_RSHIFT(idr0, BITS(8,  15));
   1147       1.1   dyoung 	(*addr)[2] = MASK_AND_RSHIFT(idr0, BITS(16, 23));
   1148       1.1   dyoung 	(*addr)[3] = MASK_AND_RSHIFT(idr0, BITS(24 ,31));
   1149       1.1   dyoung 
   1150       1.1   dyoung 	(*addr)[4] = MASK_AND_RSHIFT(idr1, BITS(0,  7));
   1151       1.1   dyoung 	(*addr)[5] = MASK_AND_RSHIFT(idr1, BITS(8, 15));
   1152       1.1   dyoung 
   1153       1.1   dyoung 	if (IEEE80211_ADDR_EQ(addr, empty_macaddr)) {
   1154       1.1   dyoung 		printf("%s: could not get mac address, attach failed\n",
   1155       1.7   dyoung 		    dvname);
   1156       1.1   dyoung 		return ENXIO;
   1157       1.1   dyoung 	}
   1158       1.1   dyoung 
   1159       1.7   dyoung 	printf("%s: 802.11 address %s\n", dvname, ether_sprintf(*addr));
   1160       1.1   dyoung 
   1161       1.1   dyoung 	return 0;
   1162       1.1   dyoung }
   1163       1.1   dyoung 
   1164      1.37   dyoung static uint8_t
   1165       1.1   dyoung rtw_chan2txpower(struct rtw_srom *sr, struct ieee80211com *ic,
   1166       1.1   dyoung     struct ieee80211_channel *chan)
   1167       1.1   dyoung {
   1168       1.1   dyoung 	u_int idx = RTW_SR_TXPOWER1 + ieee80211_chan2ieee(ic, chan) - 1;
   1169       1.1   dyoung 	KASSERT2(idx >= RTW_SR_TXPOWER1 && idx <= RTW_SR_TXPOWER14,
   1170       1.1   dyoung 	    ("%s: channel %d out of range", __func__,
   1171       1.1   dyoung 	     idx - RTW_SR_TXPOWER1 + 1));
   1172       1.1   dyoung 	return RTW_SR_GET(sr, idx);
   1173       1.1   dyoung }
   1174       1.1   dyoung 
   1175       1.1   dyoung static void
   1176      1.34   dyoung rtw_txdesc_blk_init_all(struct rtw_txdesc_blk *tdb)
   1177       1.1   dyoung {
   1178       1.1   dyoung 	int pri;
   1179      1.58   dyoung 	/* nfree: the number of free descriptors in each ring.
   1180      1.58   dyoung 	 * The beacon ring is a special case: I do not let the
   1181      1.58   dyoung 	 * driver use all of the descriptors on the beacon ring.
   1182      1.58   dyoung 	 * The reasons are two-fold:
   1183      1.58   dyoung 	 *
   1184      1.58   dyoung 	 * (1) A BEACON descriptor's OWN bit is (apparently) not
   1185      1.58   dyoung 	 * updated, so the driver cannot easily know if the descriptor
   1186      1.58   dyoung 	 * belongs to it, or if it is racing the NIC.  If the NIC
   1187      1.58   dyoung 	 * does not OWN every descriptor, then the driver can safely
   1188      1.58   dyoung 	 * update the descriptors when RTW_TBDA points at tdb_next.
   1189      1.58   dyoung 	 *
   1190      1.58   dyoung 	 * (2) I hope that the NIC will process more than one BEACON
   1191      1.58   dyoung 	 * descriptor in a single beacon interval, since that will
   1192      1.58   dyoung 	 * enable multiple-BSS support.  Since the NIC does not
   1193      1.58   dyoung 	 * clear the OWN bit, there is no natural place for it to
   1194      1.58   dyoung 	 * stop processing BEACON desciptors.  Maybe it will *not*
   1195      1.58   dyoung 	 * stop processing them!  I do not want to chance the NIC
   1196      1.58   dyoung 	 * looping around and around a saturated beacon ring, so
   1197      1.58   dyoung 	 * I will leave one descriptor unOWNed at all times.
   1198      1.58   dyoung 	 */
   1199      1.58   dyoung 	u_int nfree[RTW_NTXPRI] =
   1200      1.58   dyoung 	    {RTW_NTXDESCLO, RTW_NTXDESCMD, RTW_NTXDESCHI,
   1201      1.58   dyoung 	     RTW_NTXDESCBCN - 1};
   1202       1.1   dyoung 
   1203       1.1   dyoung 	for (pri = 0; pri < RTW_NTXPRI; pri++) {
   1204      1.58   dyoung 		tdb[pri].tdb_nfree = nfree[pri];
   1205      1.34   dyoung 		tdb[pri].tdb_next = 0;
   1206       1.1   dyoung 	}
   1207       1.1   dyoung }
   1208       1.1   dyoung 
   1209       1.1   dyoung static int
   1210      1.34   dyoung rtw_txsoft_blk_init(struct rtw_txsoft_blk *tsb)
   1211       1.1   dyoung {
   1212       1.1   dyoung 	int i;
   1213      1.34   dyoung 	struct rtw_txsoft *ts;
   1214       1.1   dyoung 
   1215      1.34   dyoung 	SIMPLEQ_INIT(&tsb->tsb_dirtyq);
   1216      1.34   dyoung 	SIMPLEQ_INIT(&tsb->tsb_freeq);
   1217      1.34   dyoung 	for (i = 0; i < tsb->tsb_ndesc; i++) {
   1218      1.34   dyoung 		ts = &tsb->tsb_desc[i];
   1219      1.34   dyoung 		ts->ts_mbuf = NULL;
   1220      1.34   dyoung 		SIMPLEQ_INSERT_TAIL(&tsb->tsb_freeq, ts, ts_q);
   1221       1.1   dyoung 	}
   1222      1.58   dyoung 	tsb->tsb_tx_timer = 0;
   1223       1.1   dyoung 	return 0;
   1224       1.1   dyoung }
   1225       1.1   dyoung 
   1226       1.1   dyoung static void
   1227      1.34   dyoung rtw_txsoft_blk_init_all(struct rtw_txsoft_blk *tsb)
   1228       1.1   dyoung {
   1229       1.1   dyoung 	int pri;
   1230       1.3   dyoung 	for (pri = 0; pri < RTW_NTXPRI; pri++)
   1231      1.34   dyoung 		rtw_txsoft_blk_init(&tsb[pri]);
   1232       1.1   dyoung }
   1233       1.1   dyoung 
   1234      1.61    perry static inline void
   1235      1.34   dyoung rtw_rxdescs_sync(struct rtw_rxdesc_blk *rdb, int desc0, int nsync, int ops)
   1236       1.1   dyoung {
   1237      1.34   dyoung 	KASSERT(nsync <= rdb->rdb_ndesc);
   1238       1.1   dyoung 	/* sync to end of ring */
   1239      1.34   dyoung 	if (desc0 + nsync > rdb->rdb_ndesc) {
   1240      1.34   dyoung 		bus_dmamap_sync(rdb->rdb_dmat, rdb->rdb_dmamap,
   1241       1.1   dyoung 		    offsetof(struct rtw_descs, hd_rx[desc0]),
   1242      1.34   dyoung 		    sizeof(struct rtw_rxdesc) * (rdb->rdb_ndesc - desc0), ops);
   1243      1.34   dyoung 		nsync -= (rdb->rdb_ndesc - desc0);
   1244       1.1   dyoung 		desc0 = 0;
   1245       1.1   dyoung 	}
   1246       1.1   dyoung 
   1247      1.34   dyoung 	KASSERT(desc0 < rdb->rdb_ndesc);
   1248      1.34   dyoung 	KASSERT(nsync <= rdb->rdb_ndesc);
   1249      1.34   dyoung 	KASSERT(desc0 + nsync <= rdb->rdb_ndesc);
   1250      1.21   dyoung 
   1251       1.1   dyoung 	/* sync what remains */
   1252      1.34   dyoung 	bus_dmamap_sync(rdb->rdb_dmat, rdb->rdb_dmamap,
   1253       1.1   dyoung 	    offsetof(struct rtw_descs, hd_rx[desc0]),
   1254       1.1   dyoung 	    sizeof(struct rtw_rxdesc) * nsync, ops);
   1255       1.1   dyoung }
   1256       1.1   dyoung 
   1257       1.1   dyoung static void
   1258      1.34   dyoung rtw_txdescs_sync(struct rtw_txdesc_blk *tdb, u_int desc0, u_int nsync, int ops)
   1259       1.1   dyoung {
   1260       1.1   dyoung 	/* sync to end of ring */
   1261      1.34   dyoung 	if (desc0 + nsync > tdb->tdb_ndesc) {
   1262      1.34   dyoung 		bus_dmamap_sync(tdb->tdb_dmat, tdb->tdb_dmamap,
   1263      1.34   dyoung 		    tdb->tdb_ofs + sizeof(struct rtw_txdesc) * desc0,
   1264      1.34   dyoung 		    sizeof(struct rtw_txdesc) * (tdb->tdb_ndesc - desc0),
   1265       1.1   dyoung 		    ops);
   1266      1.34   dyoung 		nsync -= (tdb->tdb_ndesc - desc0);
   1267       1.1   dyoung 		desc0 = 0;
   1268       1.1   dyoung 	}
   1269       1.1   dyoung 
   1270       1.1   dyoung 	/* sync what remains */
   1271      1.34   dyoung 	bus_dmamap_sync(tdb->tdb_dmat, tdb->tdb_dmamap,
   1272      1.34   dyoung 	    tdb->tdb_ofs + sizeof(struct rtw_txdesc) * desc0,
   1273       1.1   dyoung 	    sizeof(struct rtw_txdesc) * nsync, ops);
   1274       1.1   dyoung }
   1275       1.1   dyoung 
   1276       1.1   dyoung static void
   1277      1.34   dyoung rtw_txdescs_sync_all(struct rtw_txdesc_blk *tdb)
   1278       1.1   dyoung {
   1279       1.1   dyoung 	int pri;
   1280       1.1   dyoung 	for (pri = 0; pri < RTW_NTXPRI; pri++) {
   1281      1.34   dyoung 		rtw_txdescs_sync(&tdb[pri], 0, tdb[pri].tdb_ndesc,
   1282       1.1   dyoung 		    BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
   1283       1.1   dyoung 	}
   1284       1.1   dyoung }
   1285       1.1   dyoung 
   1286       1.1   dyoung static void
   1287      1.34   dyoung rtw_rxbufs_release(bus_dma_tag_t dmat, struct rtw_rxsoft *desc)
   1288       1.1   dyoung {
   1289       1.1   dyoung 	int i;
   1290      1.34   dyoung 	struct rtw_rxsoft *rs;
   1291       1.1   dyoung 
   1292      1.21   dyoung 	for (i = 0; i < RTW_RXQLEN; i++) {
   1293      1.34   dyoung 		rs = &desc[i];
   1294      1.34   dyoung 		if (rs->rs_mbuf == NULL)
   1295      1.31   dyoung 			continue;
   1296      1.34   dyoung 		bus_dmamap_sync(dmat, rs->rs_dmamap, 0,
   1297      1.34   dyoung 		    rs->rs_dmamap->dm_mapsize, BUS_DMASYNC_POSTREAD);
   1298      1.34   dyoung 		bus_dmamap_unload(dmat, rs->rs_dmamap);
   1299      1.34   dyoung 		m_freem(rs->rs_mbuf);
   1300      1.34   dyoung 		rs->rs_mbuf = NULL;
   1301       1.1   dyoung 	}
   1302       1.1   dyoung }
   1303       1.1   dyoung 
   1304      1.61    perry static inline int
   1305      1.34   dyoung rtw_rxsoft_alloc(bus_dma_tag_t dmat, struct rtw_rxsoft *rs)
   1306       1.1   dyoung {
   1307       1.1   dyoung 	int rc;
   1308       1.1   dyoung 	struct mbuf *m;
   1309       1.1   dyoung 
   1310      1.44    perry 	MGETHDR(m, M_DONTWAIT, MT_DATA);
   1311       1.1   dyoung 	if (m == NULL)
   1312      1.18   dyoung 		return ENOBUFS;
   1313       1.1   dyoung 
   1314      1.44    perry 	MCLGET(m, M_DONTWAIT);
   1315      1.31   dyoung 	if ((m->m_flags & M_EXT) == 0) {
   1316      1.31   dyoung 		m_freem(m);
   1317      1.18   dyoung 		return ENOBUFS;
   1318      1.31   dyoung 	}
   1319       1.1   dyoung 
   1320       1.1   dyoung 	m->m_pkthdr.len = m->m_len = m->m_ext.ext_size;
   1321       1.1   dyoung 
   1322      1.34   dyoung 	if (rs->rs_mbuf != NULL)
   1323      1.34   dyoung 		bus_dmamap_unload(dmat, rs->rs_dmamap);
   1324      1.18   dyoung 
   1325      1.34   dyoung 	rs->rs_mbuf = NULL;
   1326      1.18   dyoung 
   1327      1.34   dyoung 	rc = bus_dmamap_load_mbuf(dmat, rs->rs_dmamap, m, BUS_DMA_NOWAIT);
   1328      1.18   dyoung 	if (rc != 0) {
   1329      1.18   dyoung 		m_freem(m);
   1330      1.18   dyoung 		return -1;
   1331      1.18   dyoung 	}
   1332       1.1   dyoung 
   1333      1.34   dyoung 	rs->rs_mbuf = m;
   1334       1.1   dyoung 
   1335       1.1   dyoung 	return 0;
   1336       1.1   dyoung }
   1337       1.1   dyoung 
   1338       1.1   dyoung static int
   1339      1.34   dyoung rtw_rxsoft_init_all(bus_dma_tag_t dmat, struct rtw_rxsoft *desc,
   1340      1.31   dyoung     int *ndesc, const char *dvname)
   1341       1.1   dyoung {
   1342      1.31   dyoung 	int i, rc = 0;
   1343      1.34   dyoung 	struct rtw_rxsoft *rs;
   1344       1.1   dyoung 
   1345      1.21   dyoung 	for (i = 0; i < RTW_RXQLEN; i++) {
   1346      1.34   dyoung 		rs = &desc[i];
   1347      1.31   dyoung 		/* we're in rtw_init, so there should be no mbufs allocated */
   1348      1.34   dyoung 		KASSERT(rs->rs_mbuf == NULL);
   1349      1.31   dyoung #ifdef RTW_DEBUG
   1350      1.31   dyoung 		if (i == rtw_rxbufs_limit) {
   1351      1.31   dyoung 			printf("%s: TEST hit %d-buffer limit\n", dvname, i);
   1352      1.31   dyoung 			rc = ENOBUFS;
   1353      1.31   dyoung 			break;
   1354      1.31   dyoung 		}
   1355      1.31   dyoung #endif /* RTW_DEBUG */
   1356      1.34   dyoung 		if ((rc = rtw_rxsoft_alloc(dmat, rs)) != 0) {
   1357      1.34   dyoung 			printf("%s: rtw_rxsoft_alloc failed, %d buffers, "
   1358      1.31   dyoung 			       "rc %d\n", dvname, i, rc);
   1359      1.31   dyoung 			break;
   1360       1.1   dyoung 		}
   1361       1.1   dyoung 	}
   1362      1.31   dyoung 	*ndesc = i;
   1363      1.31   dyoung 	return rc;
   1364       1.1   dyoung }
   1365       1.1   dyoung 
   1366      1.61    perry static inline void
   1367      1.34   dyoung rtw_rxdesc_init(struct rtw_rxdesc_blk *rdb, struct rtw_rxsoft *rs,
   1368      1.33   dyoung     int idx, int kick)
   1369       1.1   dyoung {
   1370      1.34   dyoung 	int is_last = (idx == rdb->rdb_ndesc - 1);
   1371      1.21   dyoung 	uint32_t ctl, octl, obuf;
   1372      1.34   dyoung 	struct rtw_rxdesc *rd = &rdb->rdb_desc[idx];
   1373       1.1   dyoung 
   1374      1.34   dyoung 	obuf = rd->rd_buf;
   1375      1.34   dyoung 	rd->rd_buf = htole32(rs->rs_dmamap->dm_segs[0].ds_addr);
   1376       1.1   dyoung 
   1377      1.34   dyoung 	ctl = LSHIFT(rs->rs_mbuf->m_len, RTW_RXCTL_LENGTH_MASK) |
   1378       1.1   dyoung 	    RTW_RXCTL_OWN | RTW_RXCTL_FS | RTW_RXCTL_LS;
   1379       1.1   dyoung 
   1380       1.1   dyoung 	if (is_last)
   1381       1.1   dyoung 		ctl |= RTW_RXCTL_EOR;
   1382       1.1   dyoung 
   1383      1.34   dyoung 	octl = rd->rd_ctl;
   1384      1.34   dyoung 	rd->rd_ctl = htole32(ctl);
   1385       1.1   dyoung 
   1386      1.24   dyoung 	RTW_DPRINTF(
   1387      1.24   dyoung 	    kick ? (RTW_DEBUG_RECV_DESC | RTW_DEBUG_IO_KICK)
   1388      1.24   dyoung 	         : RTW_DEBUG_RECV_DESC,
   1389      1.34   dyoung 	    ("%s: rd %p buf %08x -> %08x ctl %08x -> %08x\n", __func__, rd,
   1390      1.34   dyoung 	     le32toh(obuf), le32toh(rd->rd_buf), le32toh(octl),
   1391      1.34   dyoung 	     le32toh(rd->rd_ctl)));
   1392      1.21   dyoung 
   1393       1.1   dyoung 	/* sync the mbuf */
   1394      1.34   dyoung 	bus_dmamap_sync(rdb->rdb_dmat, rs->rs_dmamap, 0,
   1395      1.34   dyoung 	    rs->rs_dmamap->dm_mapsize, BUS_DMASYNC_PREREAD);
   1396       1.1   dyoung 
   1397       1.1   dyoung 	/* sync the descriptor */
   1398      1.34   dyoung 	bus_dmamap_sync(rdb->rdb_dmat, rdb->rdb_dmamap,
   1399      1.33   dyoung 	    RTW_DESC_OFFSET(hd_rx, idx), sizeof(struct rtw_rxdesc),
   1400       1.1   dyoung 	    BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
   1401       1.1   dyoung }
   1402       1.1   dyoung 
   1403       1.1   dyoung static void
   1404      1.34   dyoung rtw_rxdesc_init_all(struct rtw_rxdesc_blk *rdb, struct rtw_rxsoft *ctl, int kick)
   1405       1.1   dyoung {
   1406       1.1   dyoung 	int i;
   1407      1.34   dyoung 	struct rtw_rxdesc *rd;
   1408      1.34   dyoung 	struct rtw_rxsoft *rs;
   1409       1.1   dyoung 
   1410      1.34   dyoung 	for (i = 0; i < rdb->rdb_ndesc; i++) {
   1411      1.34   dyoung 		rd = &rdb->rdb_desc[i];
   1412      1.34   dyoung 		rs = &ctl[i];
   1413      1.34   dyoung 		rtw_rxdesc_init(rdb, rs, i, kick);
   1414       1.1   dyoung 	}
   1415       1.1   dyoung }
   1416       1.1   dyoung 
   1417       1.1   dyoung static void
   1418      1.37   dyoung rtw_io_enable(struct rtw_regs *regs, uint8_t flags, int enable)
   1419       1.1   dyoung {
   1420      1.37   dyoung 	uint8_t cr;
   1421       1.1   dyoung 
   1422      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_IOSTATE, ("%s: %s 0x%02x\n", __func__,
   1423       1.1   dyoung 	    enable ? "enable" : "disable", flags));
   1424       1.1   dyoung 
   1425       1.1   dyoung 	cr = RTW_READ8(regs, RTW_CR);
   1426       1.1   dyoung 
   1427       1.1   dyoung 	/* XXX reference source does not enable MULRW */
   1428       1.1   dyoung #if 0
   1429       1.1   dyoung 	/* enable PCI Read/Write Multiple */
   1430       1.1   dyoung 	cr |= RTW_CR_MULRW;
   1431       1.1   dyoung #endif
   1432       1.1   dyoung 
   1433       1.1   dyoung 	RTW_RBW(regs, RTW_CR, RTW_CR);	/* XXX paranoia? */
   1434       1.1   dyoung 	if (enable)
   1435       1.1   dyoung 		cr |= flags;
   1436       1.1   dyoung 	else
   1437       1.1   dyoung 		cr &= ~flags;
   1438       1.1   dyoung 	RTW_WRITE8(regs, RTW_CR, cr);
   1439       1.1   dyoung 	RTW_SYNC(regs, RTW_CR, RTW_CR);
   1440       1.1   dyoung }
   1441       1.1   dyoung 
   1442       1.1   dyoung static void
   1443      1.37   dyoung rtw_intr_rx(struct rtw_softc *sc, uint16_t isr)
   1444       1.1   dyoung {
   1445      1.42   dyoung #define	IS_BEACON(__fc0)						\
   1446      1.42   dyoung     ((__fc0 & (IEEE80211_FC0_TYPE_MASK | IEEE80211_FC0_SUBTYPE_MASK)) ==\
   1447      1.42   dyoung      (IEEE80211_FC0_TYPE_MGT | IEEE80211_FC0_SUBTYPE_BEACON))
   1448      1.42   dyoung 
   1449      1.30   dyoung 	static const int ratetbl[4] = {2, 4, 11, 22};	/* convert rates:
   1450      1.30   dyoung 							 * hardware -> net80211
   1451      1.30   dyoung 							 */
   1452      1.21   dyoung 	u_int next, nproc = 0;
   1453      1.32   dyoung 	int hwrate, len, rate, rssi, sq;
   1454      1.37   dyoung 	uint32_t hrssi, hstat, htsfth, htsftl;
   1455      1.34   dyoung 	struct rtw_rxdesc *rd;
   1456      1.34   dyoung 	struct rtw_rxsoft *rs;
   1457      1.34   dyoung 	struct rtw_rxdesc_blk *rdb;
   1458       1.1   dyoung 	struct mbuf *m;
   1459      1.48   dyoung 	struct ifnet *ifp = &sc->sc_if;
   1460       1.1   dyoung 
   1461       1.1   dyoung 	struct ieee80211_node *ni;
   1462      1.48   dyoung 	struct ieee80211_frame_min *wh;
   1463       1.1   dyoung 
   1464      1.34   dyoung 	rdb = &sc->sc_rxdesc_blk;
   1465      1.21   dyoung 
   1466      1.34   dyoung 	KASSERT(rdb->rdb_next < rdb->rdb_ndesc);
   1467      1.33   dyoung 
   1468      1.34   dyoung 	for (next = rdb->rdb_next; ; next = (next + 1) % rdb->rdb_ndesc) {
   1469      1.34   dyoung 		rtw_rxdescs_sync(rdb, next, 1,
   1470      1.31   dyoung 		    BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
   1471      1.34   dyoung 		rd = &rdb->rdb_desc[next];
   1472      1.34   dyoung 		rs = &sc->sc_rxsoft[next];
   1473       1.1   dyoung 
   1474      1.34   dyoung 		hstat = le32toh(rd->rd_stat);
   1475      1.34   dyoung 		hrssi = le32toh(rd->rd_rssi);
   1476      1.34   dyoung 		htsfth = le32toh(rd->rd_tsfth);
   1477      1.34   dyoung 		htsftl = le32toh(rd->rd_tsftl);
   1478       1.1   dyoung 
   1479      1.21   dyoung 		RTW_DPRINTF(RTW_DEBUG_RECV_DESC,
   1480      1.21   dyoung 		    ("%s: rxdesc[%d] hstat %08x hrssi %08x htsft %08x%08x\n",
   1481      1.21   dyoung 		    __func__, next, hstat, hrssi, htsfth, htsftl));
   1482      1.21   dyoung 
   1483      1.21   dyoung 		++nproc;
   1484      1.21   dyoung 
   1485      1.21   dyoung 		/* still belongs to NIC */
   1486      1.21   dyoung 		if ((hstat & RTW_RXSTAT_OWN) != 0) {
   1487      1.21   dyoung 			if (nproc > 1)
   1488      1.21   dyoung 				break;
   1489       1.1   dyoung 
   1490      1.21   dyoung 			/* sometimes the NIC skips to the 0th descriptor */
   1491      1.34   dyoung 			rtw_rxdescs_sync(rdb, 0, 1,
   1492      1.31   dyoung 			    BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
   1493      1.34   dyoung 			rd = &rdb->rdb_desc[0];
   1494      1.34   dyoung 			if ((rd->rd_stat & htole32(RTW_RXSTAT_OWN)) != 0)
   1495      1.21   dyoung 				break;
   1496      1.23   dyoung 			RTW_DPRINTF(RTW_DEBUG_BUGS,
   1497      1.45   dyoung 			    ("%s: NIC skipped from rxdesc[%u] to rxdesc[0]\n",
   1498      1.45   dyoung 			     sc->sc_dev.dv_xname, next));
   1499      1.45   dyoung 			next = rdb->rdb_ndesc - 1;
   1500      1.21   dyoung 			continue;
   1501      1.21   dyoung 		}
   1502       1.1   dyoung 
   1503      1.45   dyoung #ifdef RTW_DEBUG
   1504      1.45   dyoung #define PRINTSTAT(flag) do { \
   1505      1.45   dyoung 	if ((hstat & flag) != 0) { \
   1506      1.45   dyoung 		printf("%s" #flag, delim); \
   1507      1.45   dyoung 		delim = ","; \
   1508      1.45   dyoung 	} \
   1509      1.45   dyoung } while (0)
   1510      1.45   dyoung 		if ((rtw_debug & RTW_DEBUG_RECV_DESC) != 0) {
   1511      1.45   dyoung 			const char *delim = "<";
   1512      1.45   dyoung 			printf("%s: ", sc->sc_dev.dv_xname);
   1513      1.45   dyoung 			if ((hstat & RTW_RXSTAT_DEBUG) != 0) {
   1514      1.45   dyoung 				printf("status %08x", hstat);
   1515      1.45   dyoung 				PRINTSTAT(RTW_RXSTAT_SPLCP);
   1516      1.45   dyoung 				PRINTSTAT(RTW_RXSTAT_MAR);
   1517      1.45   dyoung 				PRINTSTAT(RTW_RXSTAT_PAR);
   1518      1.45   dyoung 				PRINTSTAT(RTW_RXSTAT_BAR);
   1519      1.45   dyoung 				PRINTSTAT(RTW_RXSTAT_PWRMGT);
   1520      1.45   dyoung 				PRINTSTAT(RTW_RXSTAT_CRC32);
   1521      1.45   dyoung 				PRINTSTAT(RTW_RXSTAT_ICV);
   1522      1.45   dyoung 				printf(">, ");
   1523      1.45   dyoung 			}
   1524      1.45   dyoung 		}
   1525      1.45   dyoung #endif /* RTW_DEBUG */
   1526      1.45   dyoung 
   1527       1.1   dyoung 		if ((hstat & RTW_RXSTAT_IOERROR) != 0) {
   1528       1.1   dyoung 			printf("%s: DMA error/FIFO overflow %08x, "
   1529       1.1   dyoung 			    "rx descriptor %d\n", sc->sc_dev.dv_xname,
   1530       1.1   dyoung 			    hstat & RTW_RXSTAT_IOERROR, next);
   1531      1.48   dyoung 			ifp->if_ierrors++;
   1532       1.1   dyoung 			goto next;
   1533       1.1   dyoung 		}
   1534       1.1   dyoung 
   1535      1.22   dyoung 		len = MASK_AND_RSHIFT(hstat, RTW_RXSTAT_LENGTH_MASK);
   1536      1.22   dyoung 		if (len < IEEE80211_MIN_LEN) {
   1537      1.22   dyoung 			sc->sc_ic.ic_stats.is_rx_tooshort++;
   1538      1.22   dyoung 			goto next;
   1539      1.22   dyoung 		}
   1540      1.22   dyoung 
   1541      1.43  thorpej 		/* CRC is included with the packet; trim it off. */
   1542      1.43  thorpej 		len -= IEEE80211_CRC_LEN;
   1543      1.43  thorpej 
   1544      1.30   dyoung 		hwrate = MASK_AND_RSHIFT(hstat, RTW_RXSTAT_RATE_MASK);
   1545      1.30   dyoung 		if (hwrate >= sizeof(ratetbl) / sizeof(ratetbl[0])) {
   1546      1.22   dyoung 			printf("%s: unknown rate #%d\n", sc->sc_dev.dv_xname,
   1547      1.22   dyoung 			    MASK_AND_RSHIFT(hstat, RTW_RXSTAT_RATE_MASK));
   1548      1.48   dyoung 			ifp->if_ierrors++;
   1549      1.22   dyoung 			goto next;
   1550       1.1   dyoung 		}
   1551      1.30   dyoung 		rate = ratetbl[hwrate];
   1552       1.1   dyoung 
   1553       1.1   dyoung #ifdef RTW_DEBUG
   1554      1.45   dyoung 		RTW_DPRINTF(RTW_DEBUG_RECV_DESC,
   1555      1.45   dyoung 		    ("rate %d.%d Mb/s, time %08x%08x\n", (rate * 5) / 10,
   1556      1.45   dyoung 		     (rate * 5) % 10, htsfth, htsftl));
   1557       1.1   dyoung #endif /* RTW_DEBUG */
   1558       1.1   dyoung 
   1559       1.1   dyoung 		if ((hstat & RTW_RXSTAT_RES) != 0 &&
   1560       1.1   dyoung 		    sc->sc_ic.ic_opmode != IEEE80211_M_MONITOR)
   1561       1.1   dyoung 			goto next;
   1562       1.1   dyoung 
   1563       1.1   dyoung 		/* if bad flags, skip descriptor */
   1564       1.1   dyoung 		if ((hstat & RTW_RXSTAT_ONESEG) != RTW_RXSTAT_ONESEG) {
   1565       1.1   dyoung 			printf("%s: too many rx segments\n",
   1566       1.1   dyoung 			    sc->sc_dev.dv_xname);
   1567       1.1   dyoung 			goto next;
   1568       1.1   dyoung 		}
   1569       1.1   dyoung 
   1570      1.34   dyoung 		bus_dmamap_sync(sc->sc_dmat, rs->rs_dmamap, 0,
   1571      1.34   dyoung 		    rs->rs_dmamap->dm_mapsize, BUS_DMASYNC_POSTREAD);
   1572      1.18   dyoung 
   1573      1.34   dyoung 		m = rs->rs_mbuf;
   1574       1.1   dyoung 
   1575       1.1   dyoung 		/* if temporarily out of memory, re-use mbuf */
   1576      1.34   dyoung 		switch (rtw_rxsoft_alloc(sc->sc_dmat, rs)) {
   1577      1.18   dyoung 		case 0:
   1578      1.18   dyoung 			break;
   1579      1.18   dyoung 		case ENOBUFS:
   1580      1.34   dyoung 			printf("%s: rtw_rxsoft_alloc(, %d) failed, "
   1581      1.31   dyoung 			    "dropping packet\n", sc->sc_dev.dv_xname, next);
   1582       1.1   dyoung 			goto next;
   1583      1.18   dyoung 		default:
   1584      1.18   dyoung 			/* XXX shorten rx ring, instead? */
   1585      1.18   dyoung 			panic("%s: could not load DMA map\n",
   1586      1.18   dyoung 			    sc->sc_dev.dv_xname);
   1587       1.1   dyoung 		}
   1588       1.1   dyoung 
   1589       1.1   dyoung 		if (sc->sc_rfchipid == RTW_RFCHIPID_PHILIPS)
   1590       1.1   dyoung 			rssi = MASK_AND_RSHIFT(hrssi, RTW_RXRSSI_RSSI);
   1591       1.1   dyoung 		else {
   1592       1.1   dyoung 			rssi = MASK_AND_RSHIFT(hrssi, RTW_RXRSSI_IMR_RSSI);
   1593       1.1   dyoung 			/* TBD find out each front-end's LNA gain in the
   1594       1.1   dyoung 			 * front-end's units
   1595       1.1   dyoung 			 */
   1596       1.1   dyoung 			if ((hrssi & RTW_RXRSSI_IMR_LNA) == 0)
   1597       1.1   dyoung 				rssi |= 0x80;
   1598       1.1   dyoung 		}
   1599      1.32   dyoung 		sq = MASK_AND_RSHIFT(hrssi, RTW_RXRSSI_SQ);
   1600       1.1   dyoung 
   1601      1.34   dyoung 		/* Note well: now we cannot recycle the rs_mbuf unless
   1602      1.32   dyoung 		 * we restore its original length.
   1603      1.32   dyoung 		 */
   1604      1.48   dyoung 		m->m_pkthdr.rcvif = ifp;
   1605      1.22   dyoung 		m->m_pkthdr.len = m->m_len = len;
   1606       1.1   dyoung 
   1607      1.48   dyoung 		wh = mtod(m, struct ieee80211_frame_min *);
   1608      1.42   dyoung 
   1609      1.42   dyoung 		if (!IS_BEACON(wh->i_fc[0]))
   1610      1.42   dyoung 			sc->sc_led_state.ls_event |= RTW_LED_S_RX;
   1611       1.1   dyoung 		/* TBD use _MAR, _BAR, _PAR flags as hints to _find_rxnode? */
   1612       1.1   dyoung 		ni = ieee80211_find_rxnode(&sc->sc_ic, wh);
   1613       1.1   dyoung 
   1614       1.1   dyoung 		sc->sc_tsfth = htsfth;
   1615       1.1   dyoung 
   1616      1.10   dyoung #ifdef RTW_DEBUG
   1617      1.48   dyoung 		if ((ifp->if_flags & (IFF_DEBUG|IFF_LINK2)) ==
   1618      1.10   dyoung 		    (IFF_DEBUG|IFF_LINK2)) {
   1619      1.10   dyoung 			ieee80211_dump_pkt(mtod(m, uint8_t *), m->m_pkthdr.len,
   1620      1.10   dyoung 			    rate, rssi);
   1621      1.10   dyoung 		}
   1622      1.10   dyoung #endif /* RTW_DEBUG */
   1623      1.32   dyoung 
   1624      1.32   dyoung #if NBPFILTER > 0
   1625      1.32   dyoung 		if (sc->sc_radiobpf != NULL) {
   1626      1.32   dyoung 			struct ieee80211com *ic = &sc->sc_ic;
   1627      1.32   dyoung 			struct rtw_rx_radiotap_header *rr = &sc->sc_rxtap;
   1628      1.32   dyoung 
   1629      1.32   dyoung 			rr->rr_tsft =
   1630      1.32   dyoung 			    htole64(((uint64_t)htsfth << 32) | htsftl);
   1631      1.32   dyoung 
   1632      1.32   dyoung 			if ((hstat & RTW_RXSTAT_SPLCP) != 0)
   1633      1.32   dyoung 				rr->rr_flags = IEEE80211_RADIOTAP_F_SHORTPRE;
   1634      1.32   dyoung 
   1635      1.32   dyoung 			rr->rr_flags = 0;
   1636      1.32   dyoung 			rr->rr_rate = rate;
   1637      1.57    skrll 			rr->rr_chan_freq = htole16(ic->ic_curchan->ic_freq);
   1638      1.57    skrll 			rr->rr_chan_flags = htole16(ic->ic_curchan->ic_flags);
   1639      1.32   dyoung 			rr->rr_antsignal = rssi;
   1640      1.36   dyoung 			rr->rr_barker_lock = htole16(sq);
   1641      1.32   dyoung 
   1642      1.32   dyoung 			bpf_mtap2(sc->sc_radiobpf, (caddr_t)rr,
   1643      1.32   dyoung 			    sizeof(sc->sc_rxtapu), m);
   1644      1.32   dyoung 		}
   1645      1.32   dyoung #endif /* NPBFILTER > 0 */
   1646      1.32   dyoung 
   1647      1.48   dyoung 		ieee80211_input(&sc->sc_ic, m, ni, rssi, htsftl);
   1648      1.48   dyoung 		ieee80211_free_node(ni);
   1649       1.1   dyoung next:
   1650      1.34   dyoung 		rtw_rxdesc_init(rdb, rs, next, 0);
   1651       1.1   dyoung 	}
   1652      1.34   dyoung 	rdb->rdb_next = next;
   1653      1.21   dyoung 
   1654      1.34   dyoung 	KASSERT(rdb->rdb_next < rdb->rdb_ndesc);
   1655       1.3   dyoung 
   1656       1.1   dyoung 	return;
   1657      1.42   dyoung #undef IS_BEACON
   1658       1.1   dyoung }
   1659       1.1   dyoung 
   1660       1.1   dyoung static void
   1661      1.34   dyoung rtw_txsoft_release(bus_dma_tag_t dmat, struct ieee80211com *ic,
   1662      1.34   dyoung     struct rtw_txsoft *ts)
   1663       1.5   dyoung {
   1664       1.5   dyoung 	struct mbuf *m;
   1665       1.5   dyoung 	struct ieee80211_node *ni;
   1666       1.5   dyoung 
   1667      1.34   dyoung 	m = ts->ts_mbuf;
   1668      1.34   dyoung 	ni = ts->ts_ni;
   1669      1.21   dyoung 	KASSERT(m != NULL);
   1670      1.21   dyoung 	KASSERT(ni != NULL);
   1671      1.34   dyoung 	ts->ts_mbuf = NULL;
   1672      1.34   dyoung 	ts->ts_ni = NULL;
   1673       1.5   dyoung 
   1674      1.34   dyoung 	bus_dmamap_sync(dmat, ts->ts_dmamap, 0, ts->ts_dmamap->dm_mapsize,
   1675       1.5   dyoung 	    BUS_DMASYNC_POSTWRITE);
   1676      1.34   dyoung 	bus_dmamap_unload(dmat, ts->ts_dmamap);
   1677       1.5   dyoung 	m_freem(m);
   1678      1.48   dyoung 	ieee80211_free_node(ni);
   1679       1.5   dyoung }
   1680       1.5   dyoung 
   1681       1.5   dyoung static void
   1682      1.34   dyoung rtw_txsofts_release(bus_dma_tag_t dmat, struct ieee80211com *ic,
   1683      1.34   dyoung     struct rtw_txsoft_blk *tsb)
   1684       1.5   dyoung {
   1685      1.34   dyoung 	struct rtw_txsoft *ts;
   1686       1.5   dyoung 
   1687      1.34   dyoung 	while ((ts = SIMPLEQ_FIRST(&tsb->tsb_dirtyq)) != NULL) {
   1688      1.34   dyoung 		rtw_txsoft_release(dmat, ic, ts);
   1689      1.34   dyoung 		SIMPLEQ_REMOVE_HEAD(&tsb->tsb_dirtyq, ts_q);
   1690      1.34   dyoung 		SIMPLEQ_INSERT_TAIL(&tsb->tsb_freeq, ts, ts_q);
   1691       1.5   dyoung 	}
   1692      1.58   dyoung 	tsb->tsb_tx_timer = 0;
   1693       1.5   dyoung }
   1694       1.5   dyoung 
   1695      1.61    perry static inline void
   1696      1.34   dyoung rtw_collect_txpkt(struct rtw_softc *sc, struct rtw_txdesc_blk *tdb,
   1697      1.34   dyoung     struct rtw_txsoft *ts, int ndesc)
   1698       1.5   dyoung {
   1699      1.11   dyoung 	uint32_t hstat;
   1700       1.5   dyoung 	int data_retry, rts_retry;
   1701      1.34   dyoung 	struct rtw_txdesc *tdn;
   1702       1.5   dyoung 	const char *condstring;
   1703      1.48   dyoung 	struct ifnet *ifp = &sc->sc_if;
   1704       1.5   dyoung 
   1705      1.34   dyoung 	rtw_txsoft_release(sc->sc_dmat, &sc->sc_ic, ts);
   1706       1.5   dyoung 
   1707      1.34   dyoung 	tdb->tdb_nfree += ndesc;
   1708       1.5   dyoung 
   1709      1.34   dyoung 	tdn = &tdb->tdb_desc[ts->ts_last];
   1710       1.5   dyoung 
   1711      1.34   dyoung 	hstat = le32toh(tdn->td_stat);
   1712      1.11   dyoung 	rts_retry = MASK_AND_RSHIFT(hstat, RTW_TXSTAT_RTSRETRY_MASK);
   1713      1.11   dyoung 	data_retry = MASK_AND_RSHIFT(hstat, RTW_TXSTAT_DRC_MASK);
   1714       1.5   dyoung 
   1715      1.48   dyoung 	ifp->if_collisions += rts_retry + data_retry;
   1716       1.5   dyoung 
   1717      1.11   dyoung 	if ((hstat & RTW_TXSTAT_TOK) != 0)
   1718       1.5   dyoung 		condstring = "ok";
   1719       1.5   dyoung 	else {
   1720      1.48   dyoung 		ifp->if_oerrors++;
   1721       1.5   dyoung 		condstring = "error";
   1722       1.5   dyoung 	}
   1723       1.5   dyoung 
   1724      1.21   dyoung 	DPRINTF(sc, RTW_DEBUG_XMIT_DESC,
   1725      1.34   dyoung 	    ("%s: ts %p txdesc[%d, %d] %s tries rts %u data %u\n",
   1726      1.34   dyoung 	    sc->sc_dev.dv_xname, ts, ts->ts_first, ts->ts_last,
   1727       1.5   dyoung 	    condstring, rts_retry, data_retry));
   1728       1.5   dyoung }
   1729       1.5   dyoung 
   1730      1.58   dyoung static void
   1731      1.58   dyoung rtw_reset_oactive(struct rtw_softc *sc)
   1732      1.58   dyoung {
   1733      1.58   dyoung 	short oflags;
   1734      1.58   dyoung 	int pri;
   1735      1.58   dyoung 	struct rtw_txsoft_blk *tsb;
   1736      1.58   dyoung 	struct rtw_txdesc_blk *tdb;
   1737      1.58   dyoung 	oflags = sc->sc_if.if_flags;
   1738      1.58   dyoung 	for (pri = 0; pri < RTW_NTXPRI; pri++) {
   1739      1.58   dyoung 		tsb = &sc->sc_txsoft_blk[pri];
   1740      1.58   dyoung 		tdb = &sc->sc_txdesc_blk[pri];
   1741      1.58   dyoung 		if (!SIMPLEQ_EMPTY(&tsb->tsb_freeq) && tdb->tdb_nfree > 0)
   1742      1.58   dyoung 			sc->sc_if.if_flags &= ~IFF_OACTIVE;
   1743      1.58   dyoung 	}
   1744      1.58   dyoung 	if (oflags != sc->sc_if.if_flags) {
   1745      1.58   dyoung 		DPRINTF(sc, RTW_DEBUG_OACTIVE,
   1746      1.58   dyoung 		    ("%s: reset OACTIVE\n", __func__));
   1747      1.58   dyoung 	}
   1748      1.58   dyoung }
   1749      1.58   dyoung 
   1750       1.5   dyoung /* Collect transmitted packets. */
   1751      1.61    perry static inline void
   1752      1.34   dyoung rtw_collect_txring(struct rtw_softc *sc, struct rtw_txsoft_blk *tsb,
   1753      1.58   dyoung     struct rtw_txdesc_blk *tdb, int force)
   1754       1.5   dyoung {
   1755       1.5   dyoung 	int ndesc;
   1756      1.34   dyoung 	struct rtw_txsoft *ts;
   1757       1.5   dyoung 
   1758      1.34   dyoung 	while ((ts = SIMPLEQ_FIRST(&tsb->tsb_dirtyq)) != NULL) {
   1759      1.34   dyoung 		ndesc = 1 + ts->ts_last - ts->ts_first;
   1760      1.34   dyoung 		if (ts->ts_last < ts->ts_first)
   1761      1.34   dyoung 			ndesc += tdb->tdb_ndesc;
   1762       1.5   dyoung 
   1763       1.6   dyoung 		KASSERT(ndesc > 0);
   1764       1.6   dyoung 
   1765      1.34   dyoung 		rtw_txdescs_sync(tdb, ts->ts_first, ndesc,
   1766       1.5   dyoung 		    BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
   1767       1.5   dyoung 
   1768      1.58   dyoung 		if (force) {
   1769      1.58   dyoung 			int i;
   1770      1.58   dyoung 			for (i = ts->ts_first; ; i = RTW_NEXT_IDX(tdb, i)) {
   1771      1.58   dyoung 				tdb->tdb_desc[i].td_stat &=
   1772      1.58   dyoung 				    ~htole32(RTW_TXSTAT_OWN);
   1773      1.58   dyoung 				if (i == ts->ts_last)
   1774      1.58   dyoung 					break;
   1775      1.58   dyoung 			}
   1776      1.58   dyoung 			rtw_txdescs_sync(tdb, ts->ts_first, ndesc,
   1777      1.58   dyoung 			    BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
   1778      1.58   dyoung 		} else if ((tdb->tdb_desc[ts->ts_last].td_stat &
   1779      1.44    perry 		    htole32(RTW_TXSTAT_OWN)) != 0)
   1780       1.5   dyoung 			break;
   1781       1.5   dyoung 
   1782      1.34   dyoung 		rtw_collect_txpkt(sc, tdb, ts, ndesc);
   1783      1.34   dyoung 		SIMPLEQ_REMOVE_HEAD(&tsb->tsb_dirtyq, ts_q);
   1784      1.34   dyoung 		SIMPLEQ_INSERT_TAIL(&tsb->tsb_freeq, ts, ts_q);
   1785       1.5   dyoung 	}
   1786      1.58   dyoung 	/* no more pending transmissions, cancel watchdog */
   1787      1.34   dyoung 	if (ts == NULL)
   1788      1.34   dyoung 		tsb->tsb_tx_timer = 0;
   1789      1.58   dyoung 	rtw_reset_oactive(sc);
   1790       1.5   dyoung }
   1791       1.5   dyoung 
   1792       1.5   dyoung static void
   1793      1.37   dyoung rtw_intr_tx(struct rtw_softc *sc, uint16_t isr)
   1794       1.1   dyoung {
   1795       1.5   dyoung 	int pri;
   1796      1.34   dyoung 	struct rtw_txsoft_blk	*tsb;
   1797      1.34   dyoung 	struct rtw_txdesc_blk	*tdb;
   1798      1.48   dyoung 	struct ifnet *ifp = &sc->sc_if;
   1799       1.5   dyoung 
   1800       1.5   dyoung 	for (pri = 0; pri < RTW_NTXPRI; pri++) {
   1801      1.34   dyoung 		tsb = &sc->sc_txsoft_blk[pri];
   1802      1.34   dyoung 		tdb = &sc->sc_txdesc_blk[pri];
   1803       1.5   dyoung 
   1804      1.58   dyoung 		rtw_collect_txring(sc, tsb, tdb, 0);
   1805      1.58   dyoung 	}
   1806       1.5   dyoung 
   1807      1.58   dyoung 	if ((isr & RTW_INTR_TX) != 0)
   1808      1.58   dyoung 		rtw_start(ifp);
   1809       1.5   dyoung 
   1810       1.1   dyoung 	return;
   1811       1.1   dyoung }
   1812       1.1   dyoung 
   1813       1.1   dyoung static void
   1814      1.37   dyoung rtw_intr_beacon(struct rtw_softc *sc, uint16_t isr)
   1815       1.1   dyoung {
   1816      1.58   dyoung 	u_int next;
   1817      1.58   dyoung 	uint32_t tsfth, tsftl;
   1818      1.58   dyoung 	struct ieee80211com *ic;
   1819      1.58   dyoung 	struct rtw_txdesc_blk *tdb = &sc->sc_txdesc_blk[RTW_TXPRIBCN];
   1820      1.58   dyoung 	struct rtw_txsoft_blk *tsb = &sc->sc_txsoft_blk[RTW_TXPRIBCN];
   1821      1.58   dyoung 	struct mbuf *m;
   1822      1.58   dyoung 
   1823      1.58   dyoung 	tsfth = RTW_READ(&sc->sc_regs, RTW_TSFTRH);
   1824      1.58   dyoung 	tsftl = RTW_READ(&sc->sc_regs, RTW_TSFTRL);
   1825      1.58   dyoung 
   1826      1.58   dyoung 	if ((isr & (RTW_INTR_TBDOK|RTW_INTR_TBDER)) != 0) {
   1827      1.58   dyoung 		next = rtw_txring_next(&sc->sc_regs, tdb);
   1828      1.58   dyoung 		RTW_DPRINTF(RTW_DEBUG_BEACON,
   1829      1.58   dyoung 		    ("%s: beacon ring %sprocessed, isr = %#04" PRIx16
   1830      1.58   dyoung 		     ", next %u expected %u, %" PRIu64 "\n", __func__,
   1831      1.58   dyoung 		     (next == tdb->tdb_next) ? "" : "un", isr, next,
   1832      1.58   dyoung 		     tdb->tdb_next, (uint64_t)tsfth << 32 | tsftl));
   1833      1.58   dyoung 		if ((RTW_READ8(&sc->sc_regs, RTW_TPPOLL) & RTW_TPPOLL_BQ) == 0){
   1834      1.58   dyoung 			rtw_collect_txring(sc, tsb, tdb, 1);
   1835      1.58   dyoung 			tdb->tdb_next = 0;
   1836      1.58   dyoung 		}
   1837      1.58   dyoung 	}
   1838      1.58   dyoung 	/* Start beacon transmission. */
   1839      1.58   dyoung 
   1840      1.58   dyoung 	if ((isr & RTW_INTR_BCNINT) != 0 &&
   1841      1.58   dyoung 	    sc->sc_ic.ic_state == IEEE80211_S_RUN &&
   1842      1.58   dyoung 	    SIMPLEQ_EMPTY(&tsb->tsb_dirtyq)) {
   1843      1.58   dyoung 		RTW_DPRINTF(RTW_DEBUG_BEACON,
   1844      1.58   dyoung 		    ("%s: beacon prep. time, isr = %#04" PRIx16
   1845      1.58   dyoung 		     ", %16" PRIu64 "\n", __func__, isr,
   1846      1.58   dyoung 		     (uint64_t)tsfth << 32 | tsftl));
   1847      1.58   dyoung 		ic = &sc->sc_ic;
   1848      1.58   dyoung 		m = rtw_beacon_alloc(sc, ic->ic_bss);
   1849      1.58   dyoung 
   1850      1.58   dyoung 		if (m == NULL) {
   1851      1.58   dyoung 			printf("%s: could not allocate beacon\n",
   1852      1.58   dyoung 			    sc->sc_dev.dv_xname);
   1853      1.58   dyoung 			return;
   1854      1.58   dyoung 		}
   1855      1.58   dyoung 		m->m_pkthdr.rcvif = (void *)ieee80211_ref_node(ic->ic_bss);
   1856      1.58   dyoung 		IF_ENQUEUE(&sc->sc_beaconq, m);
   1857      1.58   dyoung 		rtw_start(&sc->sc_if);
   1858      1.58   dyoung 	}
   1859       1.1   dyoung }
   1860       1.1   dyoung 
   1861       1.1   dyoung static void
   1862       1.1   dyoung rtw_intr_atim(struct rtw_softc *sc)
   1863       1.1   dyoung {
   1864       1.1   dyoung 	/* TBD */
   1865       1.1   dyoung 	return;
   1866       1.1   dyoung }
   1867       1.1   dyoung 
   1868      1.21   dyoung #ifdef RTW_DEBUG
   1869      1.21   dyoung static void
   1870      1.21   dyoung rtw_dump_rings(struct rtw_softc *sc)
   1871      1.21   dyoung {
   1872      1.34   dyoung 	struct rtw_txdesc_blk *tdb;
   1873      1.34   dyoung 	struct rtw_rxdesc *rd;
   1874      1.34   dyoung 	struct rtw_rxdesc_blk *rdb;
   1875      1.21   dyoung 	int desc, pri;
   1876      1.21   dyoung 
   1877      1.21   dyoung 	if ((rtw_debug & RTW_DEBUG_IO_KICK) == 0)
   1878      1.21   dyoung 		return;
   1879      1.21   dyoung 
   1880      1.21   dyoung 	for (pri = 0; pri < RTW_NTXPRI; pri++) {
   1881      1.34   dyoung 		tdb = &sc->sc_txdesc_blk[pri];
   1882      1.21   dyoung 		printf("%s: txpri %d ndesc %d nfree %d\n", __func__, pri,
   1883      1.34   dyoung 		    tdb->tdb_ndesc, tdb->tdb_nfree);
   1884      1.34   dyoung 		for (desc = 0; desc < tdb->tdb_ndesc; desc++)
   1885      1.34   dyoung 			rtw_print_txdesc(sc, ".", NULL, tdb, desc);
   1886      1.21   dyoung 	}
   1887      1.21   dyoung 
   1888      1.34   dyoung 	rdb = &sc->sc_rxdesc_blk;
   1889      1.33   dyoung 
   1890      1.21   dyoung 	for (desc = 0; desc < RTW_RXQLEN; desc++) {
   1891      1.34   dyoung 		rd = &rdb->rdb_desc[desc];
   1892      1.31   dyoung 		printf("%s: %sctl %08x rsvd0/rssi %08x buf/tsftl %08x "
   1893      1.21   dyoung 		    "rsvd1/tsfth %08x\n", __func__,
   1894      1.34   dyoung 		    (desc >= rdb->rdb_ndesc) ? "UNUSED " : "",
   1895      1.34   dyoung 		    le32toh(rd->rd_ctl), le32toh(rd->rd_rssi),
   1896      1.34   dyoung 		    le32toh(rd->rd_buf), le32toh(rd->rd_tsfth));
   1897      1.21   dyoung 	}
   1898      1.21   dyoung }
   1899      1.21   dyoung #endif /* RTW_DEBUG */
   1900      1.21   dyoung 
   1901       1.1   dyoung static void
   1902       1.3   dyoung rtw_hwring_setup(struct rtw_softc *sc)
   1903       1.3   dyoung {
   1904      1.58   dyoung 	int pri;
   1905       1.3   dyoung 	struct rtw_regs *regs = &sc->sc_regs;
   1906      1.58   dyoung 	struct rtw_txdesc_blk *tdb;
   1907      1.58   dyoung 
   1908      1.58   dyoung 	sc->sc_txdesc_blk[RTW_TXPRILO].tdb_basereg = RTW_TLPDA;
   1909      1.58   dyoung 	sc->sc_txdesc_blk[RTW_TXPRILO].tdb_base = RTW_RING_BASE(sc, hd_txlo);
   1910      1.58   dyoung 	sc->sc_txdesc_blk[RTW_TXPRIMD].tdb_basereg = RTW_TNPDA;
   1911      1.58   dyoung 	sc->sc_txdesc_blk[RTW_TXPRIMD].tdb_base = RTW_RING_BASE(sc, hd_txmd);
   1912      1.58   dyoung 	sc->sc_txdesc_blk[RTW_TXPRIHI].tdb_basereg = RTW_THPDA;
   1913      1.58   dyoung 	sc->sc_txdesc_blk[RTW_TXPRIHI].tdb_base = RTW_RING_BASE(sc, hd_txhi);
   1914      1.58   dyoung 	sc->sc_txdesc_blk[RTW_TXPRIBCN].tdb_basereg = RTW_TBDA;
   1915      1.58   dyoung 	sc->sc_txdesc_blk[RTW_TXPRIBCN].tdb_base = RTW_RING_BASE(sc, hd_bcn);
   1916      1.58   dyoung 
   1917      1.58   dyoung 	for (pri = 0; pri < RTW_NTXPRI; pri++) {
   1918      1.58   dyoung 		tdb = &sc->sc_txdesc_blk[pri];
   1919      1.58   dyoung 		RTW_WRITE(regs, tdb->tdb_basereg, tdb->tdb_base);
   1920      1.58   dyoung 		RTW_DPRINTF(RTW_DEBUG_XMIT_DESC,
   1921      1.58   dyoung 		    ("%s: reg[tdb->tdb_basereg] <- %" PRIxPTR "\n", __func__,
   1922      1.58   dyoung 		     (uintptr_t)tdb->tdb_base));
   1923      1.58   dyoung 	}
   1924      1.58   dyoung 
   1925       1.3   dyoung 	RTW_WRITE(regs, RTW_RDSAR, RTW_RING_BASE(sc, hd_rx));
   1926      1.58   dyoung 
   1927      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_RECV_DESC,
   1928      1.21   dyoung 	    ("%s: reg[RDSAR] <- %" PRIxPTR "\n", __func__,
   1929      1.21   dyoung 	     (uintptr_t)RTW_RING_BASE(sc, hd_rx)));
   1930      1.58   dyoung 
   1931      1.58   dyoung 	RTW_SYNC(regs, RTW_TLPDA, RTW_RDSAR);
   1932      1.58   dyoung 
   1933       1.3   dyoung }
   1934       1.3   dyoung 
   1935      1.31   dyoung static int
   1936       1.3   dyoung rtw_swring_setup(struct rtw_softc *sc)
   1937       1.3   dyoung {
   1938      1.31   dyoung 	int rc;
   1939      1.34   dyoung 	struct rtw_rxdesc_blk *rdb;
   1940      1.33   dyoung 
   1941       1.3   dyoung 	rtw_txdesc_blk_init_all(&sc->sc_txdesc_blk[0]);
   1942       1.3   dyoung 
   1943      1.34   dyoung 	rtw_txsoft_blk_init_all(&sc->sc_txsoft_blk[0]);
   1944       1.3   dyoung 
   1945      1.34   dyoung 	rdb = &sc->sc_rxdesc_blk;
   1946      1.34   dyoung 	if ((rc = rtw_rxsoft_init_all(sc->sc_dmat, sc->sc_rxsoft, &rdb->rdb_ndesc,
   1947      1.34   dyoung 	     sc->sc_dev.dv_xname)) != 0 && rdb->rdb_ndesc == 0) {
   1948      1.31   dyoung 		printf("%s: could not allocate rx buffers\n",
   1949      1.31   dyoung 		    sc->sc_dev.dv_xname);
   1950      1.31   dyoung 		return rc;
   1951      1.31   dyoung 	}
   1952      1.44    perry 
   1953      1.34   dyoung 	rdb = &sc->sc_rxdesc_blk;
   1954      1.34   dyoung 	rtw_rxdescs_sync(rdb, 0, rdb->rdb_ndesc,
   1955      1.31   dyoung 	    BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
   1956      1.34   dyoung 	rtw_rxdesc_init_all(rdb, sc->sc_rxsoft, 1);
   1957      1.58   dyoung 	rdb->rdb_next = 0;
   1958       1.3   dyoung 
   1959      1.33   dyoung 	rtw_txdescs_sync_all(&sc->sc_txdesc_blk[0]);
   1960      1.31   dyoung 	return 0;
   1961       1.3   dyoung }
   1962       1.3   dyoung 
   1963       1.3   dyoung static void
   1964      1.58   dyoung rtw_txdesc_blk_init(struct rtw_txdesc_blk *tdb)
   1965      1.21   dyoung {
   1966      1.21   dyoung 	int i;
   1967      1.21   dyoung 
   1968      1.34   dyoung 	(void)memset(tdb->tdb_desc, 0,
   1969      1.34   dyoung 	    sizeof(tdb->tdb_desc[0]) * tdb->tdb_ndesc);
   1970      1.34   dyoung 	for (i = 0; i < tdb->tdb_ndesc; i++)
   1971      1.34   dyoung 		tdb->tdb_desc[i].td_next = htole32(RTW_NEXT_DESC(tdb, i));
   1972      1.58   dyoung }
   1973      1.58   dyoung 
   1974      1.58   dyoung static u_int
   1975      1.58   dyoung rtw_txring_next(struct rtw_regs *regs, struct rtw_txdesc_blk *tdb)
   1976      1.58   dyoung {
   1977      1.58   dyoung 	return (le32toh(RTW_READ(regs, tdb->tdb_basereg)) - tdb->tdb_base) /
   1978      1.58   dyoung 	    sizeof(struct rtw_txdesc);
   1979      1.21   dyoung }
   1980      1.21   dyoung 
   1981      1.21   dyoung static void
   1982      1.58   dyoung rtw_txring_fixup(struct rtw_softc *sc)
   1983       1.3   dyoung {
   1984       1.5   dyoung 	int pri;
   1985      1.58   dyoung 	u_int next;
   1986      1.34   dyoung 	struct rtw_txdesc_blk *tdb;
   1987      1.58   dyoung 	struct rtw_regs *regs = &sc->sc_regs;
   1988      1.21   dyoung 
   1989      1.21   dyoung 	for (pri = 0; pri < RTW_NTXPRI; pri++) {
   1990      1.34   dyoung 		tdb = &sc->sc_txdesc_blk[pri];
   1991      1.58   dyoung 		next = rtw_txring_next(regs, tdb);
   1992      1.58   dyoung 		if (tdb->tdb_next == next)
   1993      1.58   dyoung 			continue;
   1994      1.58   dyoung 		printf("%s: tx-ring %d expected next %u, read %u\n", __func__,
   1995      1.58   dyoung 		    pri, tdb->tdb_next, next);
   1996  1.64.2.1     yamt 		tdb->tdb_next = MIN(next, tdb->tdb_ndesc - 1);
   1997      1.58   dyoung 	}
   1998      1.58   dyoung }
   1999      1.58   dyoung 
   2000      1.58   dyoung static void
   2001      1.58   dyoung rtw_rxring_fixup(struct rtw_softc *sc)
   2002      1.58   dyoung {
   2003      1.58   dyoung 	u_int next;
   2004      1.58   dyoung 	uint32_t rdsar;
   2005      1.58   dyoung 	struct rtw_rxdesc_blk *rdb;
   2006      1.58   dyoung 
   2007      1.58   dyoung 	rdsar = le32toh(RTW_READ(&sc->sc_regs, RTW_RDSAR));
   2008      1.58   dyoung 	next = (rdsar - RTW_RING_BASE(sc, hd_rx)) / sizeof(struct rtw_rxdesc);
   2009      1.58   dyoung 
   2010      1.58   dyoung 	rdb = &sc->sc_rxdesc_blk;
   2011      1.58   dyoung 	if (rdb->rdb_next != next) {
   2012      1.58   dyoung 		printf("%s: rx-ring expected next %u, read %u\n", __func__,
   2013      1.58   dyoung 		    rdb->rdb_next, next);
   2014  1.64.2.1     yamt 		rdb->rdb_next = MIN(next, rdb->rdb_ndesc - 1);
   2015      1.21   dyoung 	}
   2016      1.21   dyoung }
   2017      1.21   dyoung 
   2018      1.21   dyoung static void
   2019      1.58   dyoung rtw_txdescs_reset(struct rtw_softc *sc)
   2020      1.21   dyoung {
   2021      1.58   dyoung 	int pri;
   2022      1.58   dyoung 
   2023      1.58   dyoung 	for (pri = 0; pri < RTW_NTXPRI; pri++) {
   2024      1.58   dyoung 		rtw_collect_txring(sc, &sc->sc_txsoft_blk[pri],
   2025      1.58   dyoung 		    &sc->sc_txdesc_blk[pri], 1);
   2026      1.58   dyoung 	}
   2027      1.21   dyoung }
   2028      1.21   dyoung 
   2029      1.21   dyoung static void
   2030      1.21   dyoung rtw_intr_ioerror(struct rtw_softc *sc, uint16_t isr)
   2031      1.21   dyoung {
   2032      1.58   dyoung 	uint8_t cr = 0;
   2033      1.58   dyoung 	int xmtr = 0, rcvr = 0;
   2034       1.3   dyoung 	struct rtw_regs *regs = &sc->sc_regs;
   2035       1.5   dyoung 
   2036      1.58   dyoung 	if ((isr & RTW_INTR_TXFOVW) != 0) {
   2037      1.60   dyoung 		printf("%s: tx fifo underflow\n", sc->sc_dev.dv_xname);
   2038      1.59   dyoung 		rcvr = xmtr = 1;
   2039      1.59   dyoung 		cr |= RTW_CR_TE | RTW_CR_RE;
   2040      1.58   dyoung 	}
   2041      1.21   dyoung 
   2042      1.58   dyoung 	if ((isr & (RTW_INTR_RDU|RTW_INTR_RXFOVW)) != 0) {
   2043      1.59   dyoung 		cr |= RTW_CR_RE;
   2044      1.58   dyoung 		rcvr = 1;
   2045      1.58   dyoung 	}
   2046      1.15   dyoung 
   2047      1.45   dyoung 	RTW_DPRINTF(RTW_DEBUG_BUGS, ("%s: restarting xmit/recv, isr %" PRIx16
   2048      1.45   dyoung 	    "\n", sc->sc_dev.dv_xname, isr));
   2049      1.15   dyoung 
   2050      1.24   dyoung #ifdef RTW_DEBUG
   2051      1.21   dyoung 	rtw_dump_rings(sc);
   2052      1.24   dyoung #endif /* RTW_DEBUG */
   2053      1.15   dyoung 
   2054      1.58   dyoung 	rtw_io_enable(regs, cr, 0);
   2055      1.15   dyoung 
   2056      1.44    perry 	/* Collect rx'd packets.  Refresh rx buffers. */
   2057      1.58   dyoung 	if (rcvr)
   2058      1.58   dyoung 		rtw_intr_rx(sc, 0);
   2059      1.58   dyoung 	/* Collect tx'd packets.  XXX let's hope this stops the transmit
   2060      1.58   dyoung 	 * timeouts.
   2061      1.58   dyoung 	 */
   2062      1.58   dyoung 	if (xmtr)
   2063      1.58   dyoung 		rtw_txdescs_reset(sc);
   2064      1.21   dyoung 
   2065      1.21   dyoung 	RTW_WRITE16(regs, RTW_IMR, 0);
   2066      1.21   dyoung 	RTW_SYNC(regs, RTW_IMR, RTW_IMR);
   2067      1.21   dyoung 
   2068      1.58   dyoung 	if (rtw_do_chip_reset) {
   2069      1.58   dyoung 		rtw_chip_reset1(regs, sc->sc_dev.dv_xname);
   2070      1.58   dyoung 		rtw_wep_setkeys(sc, sc->sc_ic.ic_nw_keys,
   2071      1.58   dyoung 		    sc->sc_ic.ic_def_txkey);
   2072      1.58   dyoung 	}
   2073      1.21   dyoung 
   2074      1.58   dyoung 	rtw_rxdesc_init_all(&sc->sc_rxdesc_blk, &sc->sc_rxsoft[0], 1);
   2075      1.21   dyoung 
   2076      1.24   dyoung #ifdef RTW_DEBUG
   2077      1.21   dyoung 	rtw_dump_rings(sc);
   2078      1.24   dyoung #endif /* RTW_DEBUG */
   2079      1.21   dyoung 
   2080       1.3   dyoung 	RTW_WRITE16(regs, RTW_IMR, sc->sc_inten);
   2081       1.8   dyoung 	RTW_SYNC(regs, RTW_IMR, RTW_IMR);
   2082      1.58   dyoung 	if (rcvr)
   2083      1.58   dyoung 		rtw_rxring_fixup(sc);
   2084      1.58   dyoung 	rtw_io_enable(regs, cr, 1);
   2085      1.58   dyoung 	if (xmtr)
   2086      1.58   dyoung 		rtw_txring_fixup(sc);
   2087       1.3   dyoung }
   2088       1.3   dyoung 
   2089      1.61    perry static inline void
   2090       1.1   dyoung rtw_suspend_ticks(struct rtw_softc *sc)
   2091       1.1   dyoung {
   2092      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_TIMEOUT,
   2093      1.21   dyoung 	    ("%s: suspending ticks\n", sc->sc_dev.dv_xname));
   2094       1.1   dyoung 	sc->sc_do_tick = 0;
   2095       1.1   dyoung }
   2096       1.1   dyoung 
   2097      1.61    perry static inline void
   2098       1.1   dyoung rtw_resume_ticks(struct rtw_softc *sc)
   2099       1.1   dyoung {
   2100      1.37   dyoung 	uint32_t tsftrl0, tsftrl1, next_tick;
   2101       1.1   dyoung 
   2102       1.1   dyoung 	tsftrl0 = RTW_READ(&sc->sc_regs, RTW_TSFTRL);
   2103       1.1   dyoung 
   2104       1.1   dyoung 	tsftrl1 = RTW_READ(&sc->sc_regs, RTW_TSFTRL);
   2105       1.4   dyoung 	next_tick = tsftrl1 + 1000000;
   2106       1.1   dyoung 	RTW_WRITE(&sc->sc_regs, RTW_TINT, next_tick);
   2107       1.1   dyoung 
   2108       1.1   dyoung 	sc->sc_do_tick = 1;
   2109       1.1   dyoung 
   2110      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_TIMEOUT,
   2111      1.21   dyoung 	    ("%s: resume ticks delta %#08x now %#08x next %#08x\n",
   2112       1.8   dyoung 	    sc->sc_dev.dv_xname, tsftrl1 - tsftrl0, tsftrl1, next_tick));
   2113       1.1   dyoung }
   2114       1.1   dyoung 
   2115       1.1   dyoung static void
   2116       1.1   dyoung rtw_intr_timeout(struct rtw_softc *sc)
   2117       1.1   dyoung {
   2118      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_TIMEOUT, ("%s: timeout\n", sc->sc_dev.dv_xname));
   2119       1.1   dyoung 	if (sc->sc_do_tick)
   2120       1.1   dyoung 		rtw_resume_ticks(sc);
   2121       1.1   dyoung 	return;
   2122       1.1   dyoung }
   2123       1.1   dyoung 
   2124       1.1   dyoung int
   2125       1.1   dyoung rtw_intr(void *arg)
   2126       1.1   dyoung {
   2127       1.3   dyoung 	int i;
   2128       1.1   dyoung 	struct rtw_softc *sc = arg;
   2129       1.1   dyoung 	struct rtw_regs *regs = &sc->sc_regs;
   2130      1.37   dyoung 	uint16_t isr;
   2131      1.48   dyoung 	struct ifnet *ifp = &sc->sc_if;
   2132       1.1   dyoung 
   2133       1.1   dyoung 	/*
   2134       1.1   dyoung 	 * If the interface isn't running, the interrupt couldn't
   2135       1.1   dyoung 	 * possibly have come from us.
   2136       1.1   dyoung 	 */
   2137       1.3   dyoung 	if ((sc->sc_flags & RTW_F_ENABLED) == 0 ||
   2138      1.48   dyoung 	    (ifp->if_flags & IFF_RUNNING) == 0 ||
   2139       1.1   dyoung 	    (sc->sc_dev.dv_flags & DVF_ACTIVE) == 0) {
   2140      1.21   dyoung 		RTW_DPRINTF(RTW_DEBUG_INTR, ("%s: stray interrupt\n", sc->sc_dev.dv_xname));
   2141       1.1   dyoung 		return (0);
   2142       1.1   dyoung 	}
   2143       1.1   dyoung 
   2144       1.3   dyoung 	for (i = 0; i < 10; i++) {
   2145       1.1   dyoung 		isr = RTW_READ16(regs, RTW_ISR);
   2146       1.1   dyoung 
   2147       1.1   dyoung 		RTW_WRITE16(regs, RTW_ISR, isr);
   2148       1.8   dyoung 		RTW_WBR(regs, RTW_ISR, RTW_ISR);
   2149       1.1   dyoung 
   2150       1.1   dyoung 		if (sc->sc_intr_ack != NULL)
   2151       1.1   dyoung 			(*sc->sc_intr_ack)(regs);
   2152       1.1   dyoung 
   2153       1.1   dyoung 		if (isr == 0)
   2154       1.1   dyoung 			break;
   2155       1.1   dyoung 
   2156       1.1   dyoung #ifdef RTW_DEBUG
   2157       1.1   dyoung #define PRINTINTR(flag) do { \
   2158       1.1   dyoung 	if ((isr & flag) != 0) { \
   2159       1.1   dyoung 		printf("%s" #flag, delim); \
   2160       1.1   dyoung 		delim = ","; \
   2161       1.1   dyoung 	} \
   2162       1.1   dyoung } while (0)
   2163       1.1   dyoung 
   2164      1.21   dyoung 		if ((rtw_debug & RTW_DEBUG_INTR) != 0 && isr != 0) {
   2165       1.1   dyoung 			const char *delim = "<";
   2166       1.1   dyoung 
   2167       1.1   dyoung 			printf("%s: reg[ISR] = %x", sc->sc_dev.dv_xname, isr);
   2168       1.1   dyoung 
   2169       1.1   dyoung 			PRINTINTR(RTW_INTR_TXFOVW);
   2170       1.1   dyoung 			PRINTINTR(RTW_INTR_TIMEOUT);
   2171       1.1   dyoung 			PRINTINTR(RTW_INTR_BCNINT);
   2172       1.1   dyoung 			PRINTINTR(RTW_INTR_ATIMINT);
   2173       1.1   dyoung 			PRINTINTR(RTW_INTR_TBDER);
   2174       1.1   dyoung 			PRINTINTR(RTW_INTR_TBDOK);
   2175       1.1   dyoung 			PRINTINTR(RTW_INTR_THPDER);
   2176       1.1   dyoung 			PRINTINTR(RTW_INTR_THPDOK);
   2177       1.1   dyoung 			PRINTINTR(RTW_INTR_TNPDER);
   2178       1.1   dyoung 			PRINTINTR(RTW_INTR_TNPDOK);
   2179       1.1   dyoung 			PRINTINTR(RTW_INTR_RXFOVW);
   2180       1.1   dyoung 			PRINTINTR(RTW_INTR_RDU);
   2181       1.1   dyoung 			PRINTINTR(RTW_INTR_TLPDER);
   2182       1.1   dyoung 			PRINTINTR(RTW_INTR_TLPDOK);
   2183       1.1   dyoung 			PRINTINTR(RTW_INTR_RER);
   2184       1.1   dyoung 			PRINTINTR(RTW_INTR_ROK);
   2185       1.1   dyoung 
   2186       1.1   dyoung 			printf(">\n");
   2187       1.1   dyoung 		}
   2188       1.1   dyoung #undef PRINTINTR
   2189       1.1   dyoung #endif /* RTW_DEBUG */
   2190       1.1   dyoung 
   2191       1.1   dyoung 		if ((isr & RTW_INTR_RX) != 0)
   2192       1.1   dyoung 			rtw_intr_rx(sc, isr & RTW_INTR_RX);
   2193       1.1   dyoung 		if ((isr & RTW_INTR_TX) != 0)
   2194       1.1   dyoung 			rtw_intr_tx(sc, isr & RTW_INTR_TX);
   2195       1.1   dyoung 		if ((isr & RTW_INTR_BEACON) != 0)
   2196       1.1   dyoung 			rtw_intr_beacon(sc, isr & RTW_INTR_BEACON);
   2197       1.1   dyoung 		if ((isr & RTW_INTR_ATIMINT) != 0)
   2198       1.1   dyoung 			rtw_intr_atim(sc);
   2199       1.1   dyoung 		if ((isr & RTW_INTR_IOERROR) != 0)
   2200       1.1   dyoung 			rtw_intr_ioerror(sc, isr & RTW_INTR_IOERROR);
   2201       1.1   dyoung 		if ((isr & RTW_INTR_TIMEOUT) != 0)
   2202       1.1   dyoung 			rtw_intr_timeout(sc);
   2203       1.1   dyoung 	}
   2204       1.1   dyoung 
   2205       1.1   dyoung 	return 1;
   2206       1.1   dyoung }
   2207       1.1   dyoung 
   2208      1.21   dyoung /* Must be called at splnet. */
   2209       1.1   dyoung static void
   2210       1.1   dyoung rtw_stop(struct ifnet *ifp, int disable)
   2211       1.1   dyoung {
   2212      1.21   dyoung 	int pri;
   2213       1.1   dyoung 	struct rtw_softc *sc = (struct rtw_softc *)ifp->if_softc;
   2214       1.1   dyoung 	struct ieee80211com *ic = &sc->sc_ic;
   2215       1.1   dyoung 	struct rtw_regs *regs = &sc->sc_regs;
   2216       1.1   dyoung 
   2217       1.3   dyoung 	if ((sc->sc_flags & RTW_F_ENABLED) == 0)
   2218       1.3   dyoung 		return;
   2219       1.3   dyoung 
   2220       1.1   dyoung 	rtw_suspend_ticks(sc);
   2221       1.1   dyoung 
   2222       1.1   dyoung 	ieee80211_new_state(ic, IEEE80211_S_INIT, -1);
   2223       1.1   dyoung 
   2224       1.3   dyoung 	if ((sc->sc_flags & RTW_F_INVALID) == 0) {
   2225       1.3   dyoung 		/* Disable interrupts. */
   2226       1.3   dyoung 		RTW_WRITE16(regs, RTW_IMR, 0);
   2227       1.3   dyoung 
   2228       1.8   dyoung 		RTW_WBW(regs, RTW_TPPOLL, RTW_IMR);
   2229       1.8   dyoung 
   2230       1.3   dyoung 		/* Stop the transmit and receive processes. First stop DMA,
   2231       1.3   dyoung 		 * then disable receiver and transmitter.
   2232       1.3   dyoung 		 */
   2233      1.42   dyoung 		RTW_WRITE8(regs, RTW_TPPOLL, RTW_TPPOLL_SALL);
   2234       1.1   dyoung 
   2235       1.8   dyoung 		RTW_SYNC(regs, RTW_TPPOLL, RTW_IMR);
   2236       1.8   dyoung 
   2237       1.3   dyoung 		rtw_io_enable(&sc->sc_regs, RTW_CR_RE|RTW_CR_TE, 0);
   2238       1.3   dyoung 	}
   2239       1.1   dyoung 
   2240       1.5   dyoung 	for (pri = 0; pri < RTW_NTXPRI; pri++) {
   2241      1.34   dyoung 		rtw_txsofts_release(sc->sc_dmat, &sc->sc_ic,
   2242      1.34   dyoung 		    &sc->sc_txsoft_blk[pri]);
   2243       1.5   dyoung 	}
   2244       1.1   dyoung 
   2245      1.34   dyoung 	rtw_rxbufs_release(sc->sc_dmat, &sc->sc_rxsoft[0]);
   2246      1.31   dyoung 
   2247      1.31   dyoung 	if (disable)
   2248       1.1   dyoung 		rtw_disable(sc);
   2249       1.1   dyoung 
   2250       1.1   dyoung 	/* Mark the interface as not running.  Cancel the watchdog timer. */
   2251      1.21   dyoung 	ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
   2252       1.1   dyoung 	ifp->if_timer = 0;
   2253       1.3   dyoung 
   2254       1.1   dyoung 	return;
   2255       1.1   dyoung }
   2256       1.1   dyoung 
   2257       1.1   dyoung const char *
   2258       1.1   dyoung rtw_pwrstate_string(enum rtw_pwrstate power)
   2259       1.1   dyoung {
   2260       1.1   dyoung 	switch (power) {
   2261       1.1   dyoung 	case RTW_ON:
   2262       1.1   dyoung 		return "on";
   2263       1.1   dyoung 	case RTW_SLEEP:
   2264       1.1   dyoung 		return "sleep";
   2265       1.1   dyoung 	case RTW_OFF:
   2266       1.1   dyoung 		return "off";
   2267       1.1   dyoung 	default:
   2268       1.1   dyoung 		return "unknown";
   2269       1.1   dyoung 	}
   2270       1.1   dyoung }
   2271       1.1   dyoung 
   2272      1.10   dyoung /* XXX For Maxim, I am using the RFMD settings gleaned from the
   2273      1.10   dyoung  * reference driver, plus a magic Maxim "ON" value that comes from
   2274      1.10   dyoung  * the Realtek document "Windows PG for Rtl8180."
   2275       1.1   dyoung  */
   2276       1.1   dyoung static void
   2277       1.1   dyoung rtw_maxim_pwrstate(struct rtw_regs *regs, enum rtw_pwrstate power,
   2278      1.10   dyoung     int before_rf, int digphy)
   2279       1.1   dyoung {
   2280      1.37   dyoung 	uint32_t anaparm;
   2281       1.1   dyoung 
   2282      1.10   dyoung 	anaparm = RTW_READ(regs, RTW_ANAPARM);
   2283      1.10   dyoung 	anaparm &= ~(RTW_ANAPARM_RFPOW_MASK | RTW_ANAPARM_TXDACOFF);
   2284      1.10   dyoung 
   2285      1.10   dyoung 	switch (power) {
   2286      1.10   dyoung 	case RTW_OFF:
   2287      1.10   dyoung 		if (before_rf)
   2288      1.10   dyoung 			return;
   2289      1.10   dyoung 		anaparm |= RTW_ANAPARM_RFPOW_MAXIM_OFF;
   2290      1.10   dyoung 		anaparm |= RTW_ANAPARM_TXDACOFF;
   2291      1.10   dyoung 		break;
   2292      1.10   dyoung 	case RTW_SLEEP:
   2293      1.10   dyoung 		if (!before_rf)
   2294      1.10   dyoung 			return;
   2295      1.10   dyoung 		anaparm |= RTW_ANAPARM_RFPOW_MAXIM_SLEEP;
   2296      1.10   dyoung 		anaparm |= RTW_ANAPARM_TXDACOFF;
   2297      1.10   dyoung 		break;
   2298      1.10   dyoung 	case RTW_ON:
   2299      1.10   dyoung 		if (!before_rf)
   2300      1.10   dyoung 			return;
   2301      1.10   dyoung 		anaparm |= RTW_ANAPARM_RFPOW_MAXIM_ON;
   2302      1.10   dyoung 		break;
   2303      1.10   dyoung 	}
   2304      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_PWR,
   2305      1.21   dyoung 	    ("%s: power state %s, %s RF, reg[ANAPARM] <- %08x\n",
   2306      1.10   dyoung 	    __func__, rtw_pwrstate_string(power),
   2307      1.10   dyoung 	    (before_rf) ? "before" : "after", anaparm));
   2308      1.10   dyoung 
   2309      1.10   dyoung 	RTW_WRITE(regs, RTW_ANAPARM, anaparm);
   2310      1.10   dyoung 	RTW_SYNC(regs, RTW_ANAPARM, RTW_ANAPARM);
   2311      1.10   dyoung }
   2312      1.10   dyoung 
   2313      1.10   dyoung /* XXX I am using the RFMD settings gleaned from the reference
   2314      1.44    perry  * driver.  They agree
   2315      1.10   dyoung  */
   2316      1.10   dyoung static void
   2317      1.10   dyoung rtw_rfmd_pwrstate(struct rtw_regs *regs, enum rtw_pwrstate power,
   2318      1.10   dyoung     int before_rf, int digphy)
   2319      1.10   dyoung {
   2320      1.37   dyoung 	uint32_t anaparm;
   2321       1.1   dyoung 
   2322       1.1   dyoung 	anaparm = RTW_READ(regs, RTW_ANAPARM);
   2323      1.10   dyoung 	anaparm &= ~(RTW_ANAPARM_RFPOW_MASK | RTW_ANAPARM_TXDACOFF);
   2324       1.1   dyoung 
   2325       1.1   dyoung 	switch (power) {
   2326       1.1   dyoung 	case RTW_OFF:
   2327       1.1   dyoung 		if (before_rf)
   2328       1.1   dyoung 			return;
   2329      1.10   dyoung 		anaparm |= RTW_ANAPARM_RFPOW_RFMD_OFF;
   2330       1.1   dyoung 		anaparm |= RTW_ANAPARM_TXDACOFF;
   2331       1.1   dyoung 		break;
   2332       1.1   dyoung 	case RTW_SLEEP:
   2333       1.1   dyoung 		if (!before_rf)
   2334       1.1   dyoung 			return;
   2335      1.10   dyoung 		anaparm |= RTW_ANAPARM_RFPOW_RFMD_SLEEP;
   2336       1.1   dyoung 		anaparm |= RTW_ANAPARM_TXDACOFF;
   2337       1.1   dyoung 		break;
   2338       1.1   dyoung 	case RTW_ON:
   2339       1.1   dyoung 		if (!before_rf)
   2340       1.1   dyoung 			return;
   2341      1.10   dyoung 		anaparm |= RTW_ANAPARM_RFPOW_RFMD_ON;
   2342       1.1   dyoung 		break;
   2343       1.1   dyoung 	}
   2344      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_PWR,
   2345      1.21   dyoung 	    ("%s: power state %s, %s RF, reg[ANAPARM] <- %08x\n",
   2346      1.10   dyoung 	    __func__, rtw_pwrstate_string(power),
   2347      1.10   dyoung 	    (before_rf) ? "before" : "after", anaparm));
   2348      1.10   dyoung 
   2349       1.1   dyoung 	RTW_WRITE(regs, RTW_ANAPARM, anaparm);
   2350       1.1   dyoung 	RTW_SYNC(regs, RTW_ANAPARM, RTW_ANAPARM);
   2351       1.1   dyoung }
   2352       1.1   dyoung 
   2353       1.1   dyoung static void
   2354       1.1   dyoung rtw_philips_pwrstate(struct rtw_regs *regs, enum rtw_pwrstate power,
   2355      1.10   dyoung     int before_rf, int digphy)
   2356       1.1   dyoung {
   2357      1.37   dyoung 	uint32_t anaparm;
   2358       1.1   dyoung 
   2359       1.1   dyoung 	anaparm = RTW_READ(regs, RTW_ANAPARM);
   2360      1.10   dyoung 	anaparm &= ~(RTW_ANAPARM_RFPOW_MASK | RTW_ANAPARM_TXDACOFF);
   2361       1.1   dyoung 
   2362       1.1   dyoung 	switch (power) {
   2363       1.1   dyoung 	case RTW_OFF:
   2364       1.1   dyoung 		if (before_rf)
   2365       1.1   dyoung 			return;
   2366      1.10   dyoung 		anaparm |= RTW_ANAPARM_RFPOW_PHILIPS_OFF;
   2367       1.1   dyoung 		anaparm |= RTW_ANAPARM_TXDACOFF;
   2368       1.1   dyoung 		break;
   2369       1.1   dyoung 	case RTW_SLEEP:
   2370       1.1   dyoung 		if (!before_rf)
   2371       1.1   dyoung 			return;
   2372      1.10   dyoung 		anaparm |= RTW_ANAPARM_RFPOW_PHILIPS_SLEEP;
   2373       1.1   dyoung 		anaparm |= RTW_ANAPARM_TXDACOFF;
   2374       1.1   dyoung 		break;
   2375       1.1   dyoung 	case RTW_ON:
   2376       1.1   dyoung 		if (!before_rf)
   2377       1.1   dyoung 			return;
   2378      1.10   dyoung 		if (digphy) {
   2379      1.10   dyoung 			anaparm |= RTW_ANAPARM_RFPOW_DIG_PHILIPS_ON;
   2380      1.10   dyoung 			/* XXX guess */
   2381      1.10   dyoung 			anaparm |= RTW_ANAPARM_TXDACOFF;
   2382      1.10   dyoung 		} else
   2383      1.10   dyoung 			anaparm |= RTW_ANAPARM_RFPOW_ANA_PHILIPS_ON;
   2384       1.1   dyoung 		break;
   2385       1.1   dyoung 	}
   2386      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_PWR,
   2387      1.21   dyoung 	    ("%s: power state %s, %s RF, reg[ANAPARM] <- %08x\n",
   2388      1.10   dyoung 	    __func__, rtw_pwrstate_string(power),
   2389      1.10   dyoung 	    (before_rf) ? "before" : "after", anaparm));
   2390      1.10   dyoung 
   2391       1.1   dyoung 	RTW_WRITE(regs, RTW_ANAPARM, anaparm);
   2392       1.1   dyoung 	RTW_SYNC(regs, RTW_ANAPARM, RTW_ANAPARM);
   2393       1.1   dyoung }
   2394       1.1   dyoung 
   2395       1.1   dyoung static void
   2396      1.10   dyoung rtw_pwrstate0(struct rtw_softc *sc, enum rtw_pwrstate power, int before_rf,
   2397      1.10   dyoung     int digphy)
   2398       1.1   dyoung {
   2399       1.1   dyoung 	struct rtw_regs *regs = &sc->sc_regs;
   2400       1.1   dyoung 
   2401      1.42   dyoung 	rtw_set_access(regs, RTW_ACCESS_ANAPARM);
   2402       1.1   dyoung 
   2403      1.10   dyoung 	(*sc->sc_pwrstate_cb)(regs, power, before_rf, digphy);
   2404       1.1   dyoung 
   2405      1.42   dyoung 	rtw_set_access(regs, RTW_ACCESS_NONE);
   2406       1.1   dyoung 
   2407       1.1   dyoung 	return;
   2408       1.1   dyoung }
   2409       1.1   dyoung 
   2410       1.1   dyoung static int
   2411       1.1   dyoung rtw_pwrstate(struct rtw_softc *sc, enum rtw_pwrstate power)
   2412       1.1   dyoung {
   2413       1.1   dyoung 	int rc;
   2414       1.1   dyoung 
   2415      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_PWR,
   2416      1.21   dyoung 	    ("%s: %s->%s\n", __func__,
   2417       1.1   dyoung 	    rtw_pwrstate_string(sc->sc_pwrstate), rtw_pwrstate_string(power)));
   2418       1.1   dyoung 
   2419       1.1   dyoung 	if (sc->sc_pwrstate == power)
   2420       1.1   dyoung 		return 0;
   2421       1.1   dyoung 
   2422      1.10   dyoung 	rtw_pwrstate0(sc, power, 1, sc->sc_flags & RTW_F_DIGPHY);
   2423       1.1   dyoung 	rc = rtw_rf_pwrstate(sc->sc_rf, power);
   2424      1.10   dyoung 	rtw_pwrstate0(sc, power, 0, sc->sc_flags & RTW_F_DIGPHY);
   2425       1.1   dyoung 
   2426       1.1   dyoung 	switch (power) {
   2427       1.1   dyoung 	case RTW_ON:
   2428       1.4   dyoung 		/* TBD set LEDs */
   2429       1.1   dyoung 		break;
   2430       1.1   dyoung 	case RTW_SLEEP:
   2431       1.1   dyoung 		/* TBD */
   2432       1.1   dyoung 		break;
   2433       1.1   dyoung 	case RTW_OFF:
   2434       1.1   dyoung 		/* TBD */
   2435       1.1   dyoung 		break;
   2436       1.1   dyoung 	}
   2437       1.1   dyoung 	if (rc == 0)
   2438       1.1   dyoung 		sc->sc_pwrstate = power;
   2439       1.1   dyoung 	else
   2440       1.1   dyoung 		sc->sc_pwrstate = RTW_OFF;
   2441       1.1   dyoung 	return rc;
   2442       1.1   dyoung }
   2443       1.1   dyoung 
   2444       1.1   dyoung static int
   2445       1.1   dyoung rtw_tune(struct rtw_softc *sc)
   2446       1.1   dyoung {
   2447       1.1   dyoung 	struct ieee80211com *ic = &sc->sc_ic;
   2448       1.1   dyoung 	u_int chan;
   2449       1.1   dyoung 	int rc;
   2450       1.1   dyoung 	int antdiv = sc->sc_flags & RTW_F_ANTDIV,
   2451       1.1   dyoung 	    dflantb = sc->sc_flags & RTW_F_DFLANTB;
   2452       1.1   dyoung 
   2453      1.57    skrll 	chan = ieee80211_chan2ieee(ic, ic->ic_curchan);
   2454       1.1   dyoung 	if (chan == IEEE80211_CHAN_ANY)
   2455       1.1   dyoung 		panic("%s: chan == IEEE80211_CHAN_ANY\n", __func__);
   2456       1.1   dyoung 
   2457       1.1   dyoung 	if (chan == sc->sc_cur_chan) {
   2458      1.21   dyoung 		RTW_DPRINTF(RTW_DEBUG_TUNE,
   2459      1.44    perry 		    ("%s: already tuned chan #%d\n", __func__, chan));
   2460       1.1   dyoung 		return 0;
   2461       1.1   dyoung 	}
   2462       1.1   dyoung 
   2463       1.1   dyoung 	rtw_suspend_ticks(sc);
   2464       1.1   dyoung 
   2465       1.1   dyoung 	rtw_io_enable(&sc->sc_regs, RTW_CR_RE | RTW_CR_TE, 0);
   2466       1.1   dyoung 
   2467       1.1   dyoung 	/* TBD wait for Tx to complete */
   2468       1.1   dyoung 
   2469       1.1   dyoung 	KASSERT((sc->sc_flags & RTW_F_ENABLED) != 0);
   2470       1.1   dyoung 
   2471       1.1   dyoung 	if ((rc = rtw_phy_init(&sc->sc_regs, sc->sc_rf,
   2472      1.57    skrll 	    rtw_chan2txpower(&sc->sc_srom, ic, ic->ic_curchan), sc->sc_csthr,
   2473      1.57    skrll 	        ic->ic_curchan->ic_freq, antdiv, dflantb, RTW_ON)) != 0) {
   2474       1.1   dyoung 		/* XXX condition on powersaving */
   2475       1.1   dyoung 		printf("%s: phy init failed\n", sc->sc_dev.dv_xname);
   2476       1.1   dyoung 	}
   2477       1.1   dyoung 
   2478       1.1   dyoung 	sc->sc_cur_chan = chan;
   2479       1.1   dyoung 
   2480       1.1   dyoung 	rtw_io_enable(&sc->sc_regs, RTW_CR_RE | RTW_CR_TE, 1);
   2481       1.1   dyoung 
   2482       1.1   dyoung 	rtw_resume_ticks(sc);
   2483       1.1   dyoung 
   2484       1.1   dyoung 	return rc;
   2485       1.1   dyoung }
   2486       1.1   dyoung 
   2487       1.1   dyoung void
   2488       1.1   dyoung rtw_disable(struct rtw_softc *sc)
   2489       1.1   dyoung {
   2490       1.1   dyoung 	int rc;
   2491       1.1   dyoung 
   2492       1.1   dyoung 	if ((sc->sc_flags & RTW_F_ENABLED) == 0)
   2493       1.1   dyoung 		return;
   2494       1.1   dyoung 
   2495       1.1   dyoung 	/* turn off PHY */
   2496      1.36   dyoung 	if ((sc->sc_flags & RTW_F_INVALID) == 0 &&
   2497      1.36   dyoung 	    (rc = rtw_pwrstate(sc, RTW_OFF)) != 0) {
   2498       1.1   dyoung 		printf("%s: failed to turn off PHY (%d)\n",
   2499       1.1   dyoung 		    sc->sc_dev.dv_xname, rc);
   2500      1.36   dyoung 	}
   2501       1.1   dyoung 
   2502       1.1   dyoung 	if (sc->sc_disable != NULL)
   2503       1.1   dyoung 		(*sc->sc_disable)(sc);
   2504       1.1   dyoung 
   2505       1.1   dyoung 	sc->sc_flags &= ~RTW_F_ENABLED;
   2506       1.1   dyoung }
   2507       1.1   dyoung 
   2508       1.1   dyoung int
   2509       1.1   dyoung rtw_enable(struct rtw_softc *sc)
   2510       1.1   dyoung {
   2511       1.1   dyoung 	if ((sc->sc_flags & RTW_F_ENABLED) == 0) {
   2512       1.1   dyoung 		if (sc->sc_enable != NULL && (*sc->sc_enable)(sc) != 0) {
   2513       1.1   dyoung 			printf("%s: device enable failed\n",
   2514       1.1   dyoung 			    sc->sc_dev.dv_xname);
   2515       1.1   dyoung 			return (EIO);
   2516       1.1   dyoung 		}
   2517       1.1   dyoung 		sc->sc_flags |= RTW_F_ENABLED;
   2518       1.1   dyoung 	}
   2519       1.1   dyoung 	return (0);
   2520       1.1   dyoung }
   2521       1.1   dyoung 
   2522       1.1   dyoung static void
   2523       1.1   dyoung rtw_transmit_config(struct rtw_regs *regs)
   2524       1.1   dyoung {
   2525      1.37   dyoung 	uint32_t tcr;
   2526       1.1   dyoung 
   2527       1.1   dyoung 	tcr = RTW_READ(regs, RTW_TCR);
   2528       1.1   dyoung 
   2529      1.10   dyoung 	tcr |= RTW_TCR_CWMIN;
   2530      1.10   dyoung 	tcr &= ~RTW_TCR_MXDMA_MASK;
   2531      1.10   dyoung 	tcr |= RTW_TCR_MXDMA_256;
   2532       1.1   dyoung 	tcr |= RTW_TCR_SAT;		/* send ACK as fast as possible */
   2533       1.1   dyoung 	tcr &= ~RTW_TCR_LBK_MASK;
   2534       1.1   dyoung 	tcr |= RTW_TCR_LBK_NORMAL;	/* normal operating mode */
   2535       1.1   dyoung 
   2536       1.1   dyoung 	/* set short/long retry limits */
   2537       1.1   dyoung 	tcr &= ~(RTW_TCR_SRL_MASK|RTW_TCR_LRL_MASK);
   2538      1.10   dyoung 	tcr |= LSHIFT(4, RTW_TCR_SRL_MASK) | LSHIFT(4, RTW_TCR_LRL_MASK);
   2539       1.1   dyoung 
   2540      1.13   dyoung 	tcr &= ~RTW_TCR_CRC;	/* NIC appends CRC32 */
   2541       1.1   dyoung 
   2542       1.1   dyoung 	RTW_WRITE(regs, RTW_TCR, tcr);
   2543       1.8   dyoung 	RTW_SYNC(regs, RTW_TCR, RTW_TCR);
   2544       1.1   dyoung }
   2545       1.1   dyoung 
   2546      1.61    perry static inline void
   2547       1.1   dyoung rtw_enable_interrupts(struct rtw_softc *sc)
   2548       1.1   dyoung {
   2549       1.1   dyoung 	struct rtw_regs *regs = &sc->sc_regs;
   2550       1.1   dyoung 
   2551       1.1   dyoung 	sc->sc_inten = RTW_INTR_RX|RTW_INTR_TX|RTW_INTR_BEACON|RTW_INTR_ATIMINT;
   2552       1.1   dyoung 	sc->sc_inten |= RTW_INTR_IOERROR|RTW_INTR_TIMEOUT;
   2553       1.1   dyoung 
   2554       1.1   dyoung 	RTW_WRITE16(regs, RTW_IMR, sc->sc_inten);
   2555       1.8   dyoung 	RTW_WBW(regs, RTW_IMR, RTW_ISR);
   2556       1.1   dyoung 	RTW_WRITE16(regs, RTW_ISR, 0xffff);
   2557       1.8   dyoung 	RTW_SYNC(regs, RTW_IMR, RTW_ISR);
   2558       1.1   dyoung 
   2559       1.1   dyoung 	/* XXX necessary? */
   2560       1.1   dyoung 	if (sc->sc_intr_ack != NULL)
   2561       1.1   dyoung 		(*sc->sc_intr_ack)(regs);
   2562       1.1   dyoung }
   2563       1.1   dyoung 
   2564      1.10   dyoung static void
   2565      1.10   dyoung rtw_set_nettype(struct rtw_softc *sc, enum ieee80211_opmode opmode)
   2566      1.10   dyoung {
   2567      1.10   dyoung 	uint8_t msr;
   2568      1.10   dyoung 
   2569      1.10   dyoung 	/* I'm guessing that MSR is protected as CONFIG[0123] are. */
   2570      1.42   dyoung 	rtw_set_access(&sc->sc_regs, RTW_ACCESS_CONFIG);
   2571      1.10   dyoung 
   2572      1.10   dyoung 	msr = RTW_READ8(&sc->sc_regs, RTW_MSR) & ~RTW_MSR_NETYPE_MASK;
   2573      1.10   dyoung 
   2574      1.10   dyoung 	switch (opmode) {
   2575      1.10   dyoung 	case IEEE80211_M_AHDEMO:
   2576      1.10   dyoung 	case IEEE80211_M_IBSS:
   2577      1.10   dyoung 		msr |= RTW_MSR_NETYPE_ADHOC_OK;
   2578      1.10   dyoung 		break;
   2579      1.10   dyoung 	case IEEE80211_M_HOSTAP:
   2580      1.10   dyoung 		msr |= RTW_MSR_NETYPE_AP_OK;
   2581      1.10   dyoung 		break;
   2582      1.10   dyoung 	case IEEE80211_M_MONITOR:
   2583      1.10   dyoung 		/* XXX */
   2584      1.10   dyoung 		msr |= RTW_MSR_NETYPE_NOLINK;
   2585      1.10   dyoung 		break;
   2586      1.10   dyoung 	case IEEE80211_M_STA:
   2587      1.10   dyoung 		msr |= RTW_MSR_NETYPE_INFRA_OK;
   2588      1.10   dyoung 		break;
   2589      1.10   dyoung 	}
   2590      1.10   dyoung 	RTW_WRITE8(&sc->sc_regs, RTW_MSR, msr);
   2591      1.10   dyoung 
   2592      1.42   dyoung 	rtw_set_access(&sc->sc_regs, RTW_ACCESS_NONE);
   2593      1.10   dyoung }
   2594      1.10   dyoung 
   2595       1.1   dyoung #define	rtw_calchash(addr) \
   2596      1.38   dyoung 	(ether_crc32_be((addr), IEEE80211_ADDR_LEN) >> 26)
   2597       1.1   dyoung 
   2598       1.1   dyoung static void
   2599       1.1   dyoung rtw_pktfilt_load(struct rtw_softc *sc)
   2600       1.1   dyoung {
   2601       1.1   dyoung 	struct rtw_regs *regs = &sc->sc_regs;
   2602       1.1   dyoung 	struct ieee80211com *ic = &sc->sc_ic;
   2603      1.48   dyoung 	struct ethercom *ec = &sc->sc_ec;
   2604      1.48   dyoung 	struct ifnet *ifp = &sc->sc_if;
   2605       1.1   dyoung 	int hash;
   2606      1.37   dyoung 	uint32_t hashes[2] = { 0, 0 };
   2607       1.1   dyoung 	struct ether_multi *enm;
   2608       1.1   dyoung 	struct ether_multistep step;
   2609       1.1   dyoung 
   2610       1.1   dyoung 	/* XXX might be necessary to stop Rx/Tx engines while setting filters */
   2611       1.1   dyoung 
   2612      1.38   dyoung 	sc->sc_rcr &= ~RTW_RCR_PKTFILTER_MASK;
   2613      1.38   dyoung 	sc->sc_rcr &= ~(RTW_RCR_MXDMA_MASK | RTW_RCR_RXFTH_MASK);
   2614       1.1   dyoung 
   2615      1.38   dyoung 	sc->sc_rcr |= RTW_RCR_PKTFILTER_DEFAULT;
   2616      1.38   dyoung 	/* MAC auto-reset PHY (huh?) */
   2617      1.10   dyoung 	sc->sc_rcr |= RTW_RCR_ENMARP;
   2618      1.38   dyoung 	/* DMA whole Rx packets, only.  Set Tx DMA burst size to 1024 bytes. */
   2619      1.38   dyoung 	sc->sc_rcr |= RTW_RCR_MXDMA_1024 | RTW_RCR_RXFTH_WHOLE;
   2620       1.1   dyoung 
   2621      1.38   dyoung 	switch (ic->ic_opmode) {
   2622      1.38   dyoung 	case IEEE80211_M_MONITOR:
   2623      1.38   dyoung 		sc->sc_rcr |= RTW_RCR_MONITOR;
   2624      1.38   dyoung 		break;
   2625      1.38   dyoung 	case IEEE80211_M_AHDEMO:
   2626      1.38   dyoung 	case IEEE80211_M_IBSS:
   2627      1.38   dyoung 		/* receive broadcasts in our BSS */
   2628      1.38   dyoung 		sc->sc_rcr |= RTW_RCR_ADD3;
   2629      1.38   dyoung 		break;
   2630      1.38   dyoung 	default:
   2631      1.38   dyoung 		break;
   2632      1.38   dyoung 	}
   2633       1.1   dyoung 
   2634       1.1   dyoung 	ifp->if_flags &= ~IFF_ALLMULTI;
   2635       1.1   dyoung 
   2636      1.38   dyoung 	/* XXX accept all broadcast if scanning */
   2637      1.38   dyoung 	if ((ifp->if_flags & IFF_BROADCAST) != 0)
   2638      1.38   dyoung 		sc->sc_rcr |= RTW_RCR_AB;	/* accept all broadcast */
   2639      1.38   dyoung 
   2640       1.1   dyoung 	if (ifp->if_flags & IFF_PROMISC) {
   2641       1.1   dyoung 		sc->sc_rcr |= RTW_RCR_AB;	/* accept all broadcast */
   2642       1.1   dyoung allmulti:
   2643       1.1   dyoung 		ifp->if_flags |= IFF_ALLMULTI;
   2644       1.1   dyoung 		goto setit;
   2645       1.1   dyoung 	}
   2646       1.1   dyoung 
   2647       1.1   dyoung 	/*
   2648       1.1   dyoung 	 * Program the 64-bit multicast hash filter.
   2649       1.1   dyoung 	 */
   2650       1.1   dyoung 	ETHER_FIRST_MULTI(step, ec, enm);
   2651       1.1   dyoung 	while (enm != NULL) {
   2652       1.1   dyoung 		/* XXX */
   2653       1.1   dyoung 		if (memcmp(enm->enm_addrlo, enm->enm_addrhi,
   2654       1.1   dyoung 		    ETHER_ADDR_LEN) != 0)
   2655       1.1   dyoung 			goto allmulti;
   2656       1.1   dyoung 
   2657       1.1   dyoung 		hash = rtw_calchash(enm->enm_addrlo);
   2658      1.38   dyoung 		hashes[hash >> 5] |= (1 << (hash & 0x1f));
   2659      1.38   dyoung 		sc->sc_rcr |= RTW_RCR_AM;
   2660       1.1   dyoung 		ETHER_NEXT_MULTI(step, enm);
   2661       1.1   dyoung 	}
   2662       1.1   dyoung 
   2663       1.1   dyoung 	/* all bits set => hash is useless */
   2664       1.1   dyoung 	if (~(hashes[0] & hashes[1]) == 0)
   2665       1.1   dyoung 		goto allmulti;
   2666       1.1   dyoung 
   2667       1.1   dyoung  setit:
   2668      1.38   dyoung 	if (ifp->if_flags & IFF_ALLMULTI) {
   2669       1.1   dyoung 		sc->sc_rcr |= RTW_RCR_AM;	/* accept all multicast */
   2670      1.38   dyoung 		hashes[0] = hashes[1] = 0xffffffff;
   2671      1.38   dyoung 	}
   2672       1.1   dyoung 
   2673       1.1   dyoung 	RTW_WRITE(regs, RTW_MAR0, hashes[0]);
   2674       1.1   dyoung 	RTW_WRITE(regs, RTW_MAR1, hashes[1]);
   2675       1.1   dyoung 	RTW_WRITE(regs, RTW_RCR, sc->sc_rcr);
   2676       1.1   dyoung 	RTW_SYNC(regs, RTW_MAR0, RTW_RCR); /* RTW_MAR0 < RTW_MAR1 < RTW_RCR */
   2677       1.1   dyoung 
   2678      1.21   dyoung 	DPRINTF(sc, RTW_DEBUG_PKTFILT,
   2679      1.21   dyoung 	    ("%s: RTW_MAR0 %08x RTW_MAR1 %08x RTW_RCR %08x\n",
   2680       1.1   dyoung 	    sc->sc_dev.dv_xname, RTW_READ(regs, RTW_MAR0),
   2681       1.1   dyoung 	    RTW_READ(regs, RTW_MAR1), RTW_READ(regs, RTW_RCR)));
   2682       1.1   dyoung 
   2683       1.1   dyoung 	return;
   2684       1.1   dyoung }
   2685       1.1   dyoung 
   2686      1.42   dyoung static struct mbuf *
   2687      1.42   dyoung rtw_beacon_alloc(struct rtw_softc *sc, struct ieee80211_node *ni)
   2688      1.42   dyoung {
   2689      1.42   dyoung 	struct ieee80211com *ic = &sc->sc_ic;
   2690      1.42   dyoung 	struct mbuf *m;
   2691      1.48   dyoung 	struct ieee80211_beacon_offsets	boff;
   2692      1.42   dyoung 
   2693      1.58   dyoung 	if ((m = ieee80211_beacon_alloc(ic, ni, &boff)) != NULL) {
   2694      1.58   dyoung 		RTW_DPRINTF(RTW_DEBUG_BEACON,
   2695      1.58   dyoung 		    ("%s: m %p len %u\n", __func__, m, m->m_len));
   2696      1.58   dyoung 	}
   2697      1.42   dyoung 	return m;
   2698      1.42   dyoung }
   2699      1.42   dyoung 
   2700      1.21   dyoung /* Must be called at splnet. */
   2701       1.1   dyoung static int
   2702       1.1   dyoung rtw_init(struct ifnet *ifp)
   2703       1.1   dyoung {
   2704       1.1   dyoung 	struct rtw_softc *sc = (struct rtw_softc *)ifp->if_softc;
   2705       1.1   dyoung 	struct ieee80211com *ic = &sc->sc_ic;
   2706       1.1   dyoung 	struct rtw_regs *regs = &sc->sc_regs;
   2707       1.4   dyoung 	int rc = 0;
   2708       1.1   dyoung 
   2709       1.1   dyoung 	if ((rc = rtw_enable(sc)) != 0)
   2710       1.1   dyoung 		goto out;
   2711       1.1   dyoung 
   2712       1.1   dyoung 	/* Cancel pending I/O and reset. */
   2713       1.1   dyoung 	rtw_stop(ifp, 0);
   2714       1.1   dyoung 
   2715      1.21   dyoung 	DPRINTF(sc, RTW_DEBUG_TUNE, ("%s: channel %d freq %d flags 0x%04x\n",
   2716      1.57    skrll 	    __func__, ieee80211_chan2ieee(ic, ic->ic_curchan),
   2717      1.57    skrll 	    ic->ic_curchan->ic_freq, ic->ic_curchan->ic_flags));
   2718       1.1   dyoung 
   2719       1.1   dyoung 	if ((rc = rtw_pwrstate(sc, RTW_OFF)) != 0)
   2720       1.1   dyoung 		goto out;
   2721       1.1   dyoung 
   2722      1.31   dyoung 	if ((rc = rtw_swring_setup(sc)) != 0)
   2723      1.31   dyoung 		goto out;
   2724       1.1   dyoung 
   2725       1.1   dyoung 	rtw_transmit_config(regs);
   2726       1.1   dyoung 
   2727      1.42   dyoung 	rtw_set_access(regs, RTW_ACCESS_CONFIG);
   2728       1.1   dyoung 
   2729       1.4   dyoung 	RTW_WRITE8(regs, RTW_MSR, 0x0);	/* no link */
   2730       1.8   dyoung 	RTW_WBW(regs, RTW_MSR, RTW_BRSR);
   2731       1.1   dyoung 
   2732      1.27  mycroft 	/* long PLCP header, 1Mb/2Mb basic rate */
   2733      1.27  mycroft 	RTW_WRITE16(regs, RTW_BRSR, RTW_BRSR_MBR8180_2MBPS);
   2734       1.8   dyoung 	RTW_SYNC(regs, RTW_BRSR, RTW_BRSR);
   2735       1.1   dyoung 
   2736      1.42   dyoung 	rtw_set_access(regs, RTW_ACCESS_ANAPARM);
   2737      1.42   dyoung 	rtw_set_access(regs, RTW_ACCESS_NONE);
   2738       1.1   dyoung 
   2739       1.1   dyoung 	/* XXX from reference sources */
   2740       1.1   dyoung 	RTW_WRITE(regs, RTW_FEMR, 0xffff);
   2741       1.8   dyoung 	RTW_SYNC(regs, RTW_FEMR, RTW_FEMR);
   2742       1.1   dyoung 
   2743       1.4   dyoung 	rtw_set_rfprog(regs, sc->sc_rfchipid, sc->sc_dev.dv_xname);
   2744       1.4   dyoung 
   2745       1.4   dyoung 	RTW_WRITE8(regs, RTW_PHYDELAY, sc->sc_phydelay);
   2746       1.1   dyoung 	/* from Linux driver */
   2747       1.4   dyoung 	RTW_WRITE8(regs, RTW_CRCOUNT, RTW_CRCOUNT_MAGIC);
   2748       1.1   dyoung 
   2749       1.8   dyoung 	RTW_SYNC(regs, RTW_PHYDELAY, RTW_CRCOUNT);
   2750       1.8   dyoung 
   2751       1.1   dyoung 	rtw_enable_interrupts(sc);
   2752       1.1   dyoung 
   2753       1.1   dyoung 	rtw_pktfilt_load(sc);
   2754       1.1   dyoung 
   2755       1.3   dyoung 	rtw_hwring_setup(sc);
   2756       1.1   dyoung 
   2757      1.48   dyoung 	rtw_wep_setkeys(sc, ic->ic_nw_keys, ic->ic_def_txkey);
   2758      1.42   dyoung 
   2759       1.1   dyoung 	rtw_io_enable(regs, RTW_CR_RE|RTW_CR_TE, 1);
   2760       1.1   dyoung 
   2761       1.1   dyoung 	ifp->if_flags |= IFF_RUNNING;
   2762       1.1   dyoung 	ic->ic_state = IEEE80211_S_INIT;
   2763       1.1   dyoung 
   2764       1.1   dyoung 	RTW_WRITE16(regs, RTW_BSSID16, 0x0);
   2765       1.1   dyoung 	RTW_WRITE(regs, RTW_BSSID32, 0x0);
   2766       1.1   dyoung 
   2767       1.4   dyoung 	rtw_resume_ticks(sc);
   2768       1.1   dyoung 
   2769      1.10   dyoung 	rtw_set_nettype(sc, IEEE80211_M_MONITOR);
   2770       1.4   dyoung 
   2771       1.4   dyoung 	if (ic->ic_opmode == IEEE80211_M_MONITOR)
   2772       1.4   dyoung 		return ieee80211_new_state(ic, IEEE80211_S_RUN, -1);
   2773       1.4   dyoung 	else
   2774       1.4   dyoung 		return ieee80211_new_state(ic, IEEE80211_S_SCAN, -1);
   2775       1.4   dyoung 
   2776       1.1   dyoung out:
   2777      1.31   dyoung 	printf("%s: interface not running\n", sc->sc_dev.dv_xname);
   2778       1.1   dyoung 	return rc;
   2779       1.1   dyoung }
   2780       1.1   dyoung 
   2781      1.61    perry static inline void
   2782      1.42   dyoung rtw_led_init(struct rtw_regs *regs)
   2783      1.42   dyoung {
   2784      1.42   dyoung 	uint8_t cfg0, cfg1;
   2785      1.42   dyoung 
   2786      1.42   dyoung 	rtw_set_access(regs, RTW_ACCESS_CONFIG);
   2787      1.42   dyoung 
   2788      1.42   dyoung 	cfg0 = RTW_READ8(regs, RTW_CONFIG0);
   2789      1.42   dyoung 	cfg0 |= RTW_CONFIG0_LEDGPOEN;
   2790      1.42   dyoung 	RTW_WRITE8(regs, RTW_CONFIG0, cfg0);
   2791      1.42   dyoung 
   2792      1.42   dyoung 	cfg1 = RTW_READ8(regs, RTW_CONFIG1);
   2793      1.42   dyoung 	RTW_DPRINTF(RTW_DEBUG_LED,
   2794      1.42   dyoung 	    ("%s: read %" PRIx8 " from reg[CONFIG1]\n", __func__, cfg1));
   2795      1.42   dyoung 
   2796      1.42   dyoung 	cfg1 &= ~RTW_CONFIG1_LEDS_MASK;
   2797      1.42   dyoung 	cfg1 |= RTW_CONFIG1_LEDS_TX_RX;
   2798      1.42   dyoung 	RTW_WRITE8(regs, RTW_CONFIG1, cfg1);
   2799      1.42   dyoung 
   2800      1.42   dyoung 	rtw_set_access(regs, RTW_ACCESS_NONE);
   2801      1.42   dyoung }
   2802      1.42   dyoung 
   2803      1.44    perry /*
   2804      1.42   dyoung  * IEEE80211_S_INIT: 		LED1 off
   2805      1.42   dyoung  *
   2806      1.42   dyoung  * IEEE80211_S_AUTH,
   2807      1.42   dyoung  * IEEE80211_S_ASSOC,
   2808      1.42   dyoung  * IEEE80211_S_SCAN: 		LED1 blinks @ 1 Hz, blinks at 5Hz for tx/rx
   2809      1.42   dyoung  *
   2810      1.42   dyoung  * IEEE80211_S_RUN: 		LED1 on, blinks @ 5Hz for tx/rx
   2811      1.42   dyoung  */
   2812      1.42   dyoung static void
   2813      1.42   dyoung rtw_led_newstate(struct rtw_softc *sc, enum ieee80211_state nstate)
   2814      1.42   dyoung {
   2815      1.42   dyoung 	struct rtw_led_state *ls;
   2816      1.42   dyoung 
   2817      1.42   dyoung 	ls = &sc->sc_led_state;
   2818      1.42   dyoung 
   2819      1.42   dyoung 	switch (nstate) {
   2820      1.42   dyoung 	case IEEE80211_S_INIT:
   2821      1.42   dyoung 		rtw_led_init(&sc->sc_regs);
   2822      1.42   dyoung 		callout_stop(&ls->ls_slow_ch);
   2823      1.42   dyoung 		callout_stop(&ls->ls_fast_ch);
   2824      1.42   dyoung 		ls->ls_slowblink = 0;
   2825      1.42   dyoung 		ls->ls_actblink = 0;
   2826      1.42   dyoung 		ls->ls_default = 0;
   2827      1.42   dyoung 		break;
   2828      1.42   dyoung 	case IEEE80211_S_SCAN:
   2829      1.42   dyoung 		callout_schedule(&ls->ls_slow_ch, RTW_LED_SLOW_TICKS);
   2830      1.42   dyoung 		callout_schedule(&ls->ls_fast_ch, RTW_LED_FAST_TICKS);
   2831      1.42   dyoung 		/*FALLTHROUGH*/
   2832      1.42   dyoung 	case IEEE80211_S_AUTH:
   2833      1.42   dyoung 	case IEEE80211_S_ASSOC:
   2834      1.42   dyoung 		ls->ls_default = RTW_LED1;
   2835      1.42   dyoung 		ls->ls_actblink = RTW_LED1;
   2836      1.42   dyoung 		ls->ls_slowblink = RTW_LED1;
   2837      1.42   dyoung 		break;
   2838      1.42   dyoung 	case IEEE80211_S_RUN:
   2839      1.42   dyoung 		ls->ls_slowblink = 0;
   2840      1.42   dyoung 		break;
   2841      1.42   dyoung 	}
   2842      1.42   dyoung 	rtw_led_set(ls, &sc->sc_regs, sc->sc_hwverid);
   2843      1.42   dyoung }
   2844      1.42   dyoung 
   2845      1.42   dyoung static void
   2846      1.42   dyoung rtw_led_set(struct rtw_led_state *ls, struct rtw_regs *regs, int hwverid)
   2847      1.42   dyoung {
   2848      1.42   dyoung 	uint8_t led_condition;
   2849      1.42   dyoung 	bus_size_t ofs;
   2850      1.42   dyoung 	uint8_t mask, newval, val;
   2851      1.42   dyoung 
   2852      1.42   dyoung 	led_condition = ls->ls_default;
   2853      1.42   dyoung 
   2854      1.42   dyoung 	if (ls->ls_state & RTW_LED_S_SLOW)
   2855      1.42   dyoung 		led_condition ^= ls->ls_slowblink;
   2856      1.42   dyoung 	if (ls->ls_state & (RTW_LED_S_RX|RTW_LED_S_TX))
   2857      1.42   dyoung 		led_condition ^= ls->ls_actblink;
   2858      1.42   dyoung 
   2859      1.42   dyoung 	RTW_DPRINTF(RTW_DEBUG_LED,
   2860      1.42   dyoung 	    ("%s: LED condition %" PRIx8 "\n", __func__, led_condition));
   2861      1.42   dyoung 
   2862      1.42   dyoung 	switch (hwverid) {
   2863      1.42   dyoung 	default:
   2864      1.42   dyoung 	case 'F':
   2865      1.42   dyoung 		ofs = RTW_PSR;
   2866      1.42   dyoung 		newval = mask = RTW_PSR_LEDGPO0 | RTW_PSR_LEDGPO1;
   2867      1.42   dyoung 		if (led_condition & RTW_LED0)
   2868      1.42   dyoung 			newval &= ~RTW_PSR_LEDGPO0;
   2869      1.42   dyoung 		if (led_condition & RTW_LED1)
   2870      1.42   dyoung 			newval &= ~RTW_PSR_LEDGPO1;
   2871      1.42   dyoung 		break;
   2872      1.42   dyoung 	case 'D':
   2873      1.42   dyoung 		ofs = RTW_9346CR;
   2874      1.42   dyoung 		mask = RTW_9346CR_EEM_MASK | RTW_9346CR_EEDI | RTW_9346CR_EECS;
   2875      1.42   dyoung 		newval = RTW_9346CR_EEM_PROGRAM;
   2876      1.42   dyoung 		if (led_condition & RTW_LED0)
   2877      1.42   dyoung 			newval |= RTW_9346CR_EEDI;
   2878      1.42   dyoung 		if (led_condition & RTW_LED1)
   2879      1.42   dyoung 			newval |= RTW_9346CR_EECS;
   2880      1.42   dyoung 		break;
   2881      1.42   dyoung 	}
   2882      1.42   dyoung 	val = RTW_READ8(regs, ofs);
   2883      1.42   dyoung 	RTW_DPRINTF(RTW_DEBUG_LED,
   2884      1.45   dyoung 	    ("%s: read %" PRIx8 " from reg[%#02" PRIxPTR "]\n", __func__, val,
   2885      1.45   dyoung 	     (uintptr_t)ofs));
   2886      1.42   dyoung 	val &= ~mask;
   2887      1.42   dyoung 	val |= newval;
   2888      1.42   dyoung 	RTW_WRITE8(regs, ofs, val);
   2889      1.42   dyoung 	RTW_DPRINTF(RTW_DEBUG_LED,
   2890      1.45   dyoung 	    ("%s: wrote %" PRIx8 " to reg[%#02" PRIxPTR "]\n", __func__, val,
   2891      1.45   dyoung 	     (uintptr_t)ofs));
   2892      1.42   dyoung 	RTW_SYNC(regs, ofs, ofs);
   2893      1.42   dyoung }
   2894      1.42   dyoung 
   2895      1.42   dyoung static void
   2896      1.42   dyoung rtw_led_fastblink(void *arg)
   2897      1.42   dyoung {
   2898      1.42   dyoung 	int ostate, s;
   2899      1.42   dyoung 	struct rtw_softc *sc = (struct rtw_softc *)arg;
   2900      1.42   dyoung 	struct rtw_led_state *ls = &sc->sc_led_state;
   2901      1.42   dyoung 
   2902      1.42   dyoung 	s = splnet();
   2903      1.42   dyoung 	ostate = ls->ls_state;
   2904      1.42   dyoung 	ls->ls_state ^= ls->ls_event;
   2905      1.42   dyoung 
   2906      1.42   dyoung 	if ((ls->ls_event & RTW_LED_S_TX) == 0)
   2907      1.42   dyoung 		ls->ls_state &= ~RTW_LED_S_TX;
   2908      1.42   dyoung 
   2909      1.42   dyoung 	if ((ls->ls_event & RTW_LED_S_RX) == 0)
   2910      1.42   dyoung 		ls->ls_state &= ~RTW_LED_S_RX;
   2911      1.42   dyoung 
   2912      1.42   dyoung 	ls->ls_event = 0;
   2913      1.42   dyoung 
   2914      1.42   dyoung 	if (ostate != ls->ls_state)
   2915      1.42   dyoung 		rtw_led_set(ls, &sc->sc_regs, sc->sc_hwverid);
   2916      1.42   dyoung 	splx(s);
   2917      1.42   dyoung 
   2918      1.42   dyoung 	callout_schedule(&ls->ls_fast_ch, RTW_LED_FAST_TICKS);
   2919      1.42   dyoung }
   2920      1.42   dyoung 
   2921      1.42   dyoung static void
   2922      1.42   dyoung rtw_led_slowblink(void *arg)
   2923      1.42   dyoung {
   2924      1.42   dyoung 	int s;
   2925      1.42   dyoung 	struct rtw_softc *sc = (struct rtw_softc *)arg;
   2926      1.42   dyoung 	struct rtw_led_state *ls = &sc->sc_led_state;
   2927      1.42   dyoung 
   2928      1.42   dyoung 	s = splnet();
   2929      1.42   dyoung 	ls->ls_state ^= RTW_LED_S_SLOW;
   2930      1.42   dyoung 	rtw_led_set(ls, &sc->sc_regs, sc->sc_hwverid);
   2931      1.42   dyoung 	splx(s);
   2932      1.42   dyoung 	callout_schedule(&ls->ls_slow_ch, RTW_LED_SLOW_TICKS);
   2933      1.42   dyoung }
   2934      1.42   dyoung 
   2935      1.61    perry static inline void
   2936      1.45   dyoung rtw_led_attach(struct rtw_led_state *ls, void *arg)
   2937      1.42   dyoung {
   2938      1.42   dyoung 	callout_init(&ls->ls_fast_ch);
   2939      1.42   dyoung 	callout_init(&ls->ls_slow_ch);
   2940      1.45   dyoung 	callout_setfunc(&ls->ls_fast_ch, rtw_led_fastblink, arg);
   2941      1.45   dyoung 	callout_setfunc(&ls->ls_slow_ch, rtw_led_slowblink, arg);
   2942      1.42   dyoung }
   2943      1.42   dyoung 
   2944       1.1   dyoung static int
   2945       1.1   dyoung rtw_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
   2946       1.1   dyoung {
   2947      1.21   dyoung 	int rc = 0, s;
   2948       1.1   dyoung 	struct rtw_softc *sc = ifp->if_softc;
   2949       1.1   dyoung 	struct ifreq *ifr = (struct ifreq *)data;
   2950       1.1   dyoung 
   2951      1.21   dyoung 	s = splnet();
   2952       1.1   dyoung 	switch (cmd) {
   2953       1.1   dyoung 	case SIOCSIFFLAGS:
   2954       1.1   dyoung 		if ((ifp->if_flags & IFF_UP) != 0) {
   2955      1.38   dyoung 			if ((sc->sc_flags & RTW_F_ENABLED) != 0) {
   2956       1.1   dyoung 				rtw_pktfilt_load(sc);
   2957       1.1   dyoung 			} else
   2958       1.1   dyoung 				rc = rtw_init(ifp);
   2959      1.39   dyoung 			RTW_PRINT_REGS(&sc->sc_regs, ifp->if_xname, __func__);
   2960       1.1   dyoung 		} else if ((sc->sc_flags & RTW_F_ENABLED) != 0) {
   2961      1.39   dyoung 			RTW_PRINT_REGS(&sc->sc_regs, ifp->if_xname, __func__);
   2962       1.1   dyoung 			rtw_stop(ifp, 1);
   2963       1.1   dyoung 		}
   2964       1.1   dyoung 		break;
   2965       1.1   dyoung 	case SIOCADDMULTI:
   2966       1.1   dyoung 	case SIOCDELMULTI:
   2967       1.1   dyoung 		if (cmd == SIOCADDMULTI)
   2968      1.48   dyoung 			rc = ether_addmulti(ifr, &sc->sc_ec);
   2969       1.1   dyoung 		else
   2970      1.48   dyoung 			rc = ether_delmulti(ifr, &sc->sc_ec);
   2971      1.39   dyoung 		if (rc != ENETRESET)
   2972      1.39   dyoung 			break;
   2973      1.39   dyoung 		if (ifp->if_flags & IFF_RUNNING)
   2974      1.39   dyoung 			rtw_pktfilt_load(sc);
   2975      1.39   dyoung 		rc = 0;
   2976       1.1   dyoung 		break;
   2977       1.1   dyoung 	default:
   2978      1.48   dyoung 		if ((rc = ieee80211_ioctl(&sc->sc_ic, cmd, data)) != ENETRESET)
   2979      1.39   dyoung 			break;
   2980      1.39   dyoung 		if ((sc->sc_flags & RTW_F_ENABLED) != 0)
   2981      1.39   dyoung 			rc = rtw_init(ifp);
   2982      1.39   dyoung 		else
   2983      1.39   dyoung 			rc = 0;
   2984       1.1   dyoung 		break;
   2985       1.1   dyoung 	}
   2986      1.21   dyoung 	splx(s);
   2987       1.1   dyoung 	return rc;
   2988       1.1   dyoung }
   2989       1.1   dyoung 
   2990      1.42   dyoung /* Select a transmit ring with at least one h/w and s/w descriptor free.
   2991      1.42   dyoung  * Return 0 on success, -1 on failure.
   2992      1.42   dyoung  */
   2993      1.61    perry static inline int
   2994      1.42   dyoung rtw_txring_choose(struct rtw_softc *sc, struct rtw_txsoft_blk **tsbp,
   2995      1.42   dyoung     struct rtw_txdesc_blk **tdbp, int pri)
   2996      1.42   dyoung {
   2997      1.42   dyoung 	struct rtw_txsoft_blk *tsb;
   2998      1.42   dyoung 	struct rtw_txdesc_blk *tdb;
   2999      1.42   dyoung 
   3000      1.42   dyoung 	KASSERT(pri >= 0 && pri < RTW_NTXPRI);
   3001      1.42   dyoung 
   3002      1.42   dyoung 	tsb = &sc->sc_txsoft_blk[pri];
   3003      1.42   dyoung 	tdb = &sc->sc_txdesc_blk[pri];
   3004      1.42   dyoung 
   3005      1.42   dyoung 	if (SIMPLEQ_EMPTY(&tsb->tsb_freeq) || tdb->tdb_nfree == 0) {
   3006      1.58   dyoung 		if (tsb->tsb_tx_timer == 0)
   3007      1.58   dyoung 			tsb->tsb_tx_timer = 5;
   3008      1.42   dyoung 		*tsbp = NULL;
   3009      1.42   dyoung 		*tdbp = NULL;
   3010      1.42   dyoung 		return -1;
   3011      1.42   dyoung 	}
   3012      1.42   dyoung 	*tsbp = tsb;
   3013      1.42   dyoung 	*tdbp = tdb;
   3014      1.42   dyoung 	return 0;
   3015      1.42   dyoung }
   3016      1.42   dyoung 
   3017      1.61    perry static inline struct mbuf *
   3018      1.42   dyoung rtw_80211_dequeue(struct rtw_softc *sc, struct ifqueue *ifq, int pri,
   3019      1.42   dyoung     struct rtw_txsoft_blk **tsbp, struct rtw_txdesc_blk **tdbp,
   3020      1.42   dyoung     struct ieee80211_node **nip, short *if_flagsp)
   3021      1.42   dyoung {
   3022      1.42   dyoung 	struct mbuf *m;
   3023      1.42   dyoung 
   3024      1.42   dyoung 	if (IF_IS_EMPTY(ifq))
   3025      1.42   dyoung 		return NULL;
   3026      1.42   dyoung 	if (rtw_txring_choose(sc, tsbp, tdbp, pri) == -1) {
   3027      1.58   dyoung 		DPRINTF(sc, RTW_DEBUG_XMIT_RSRC, ("%s: no ring %d descriptor\n",
   3028      1.58   dyoung 		    __func__, pri));
   3029      1.42   dyoung 		*if_flagsp |= IFF_OACTIVE;
   3030      1.58   dyoung 		sc->sc_if.if_timer = 1;
   3031      1.42   dyoung 		return NULL;
   3032      1.42   dyoung 	}
   3033      1.42   dyoung 	IF_DEQUEUE(ifq, m);
   3034      1.42   dyoung 	*nip = (struct ieee80211_node *)m->m_pkthdr.rcvif;
   3035      1.42   dyoung 	m->m_pkthdr.rcvif = NULL;
   3036      1.48   dyoung 	KASSERT(*nip != NULL);
   3037      1.42   dyoung 	return m;
   3038      1.42   dyoung }
   3039      1.42   dyoung 
   3040      1.34   dyoung /* Point *mp at the next 802.11 frame to transmit.  Point *tsbp
   3041       1.1   dyoung  * at the driver's selection of transmit control block for the packet.
   3042       1.1   dyoung  */
   3043      1.61    perry static inline int
   3044      1.34   dyoung rtw_dequeue(struct ifnet *ifp, struct rtw_txsoft_blk **tsbp,
   3045      1.34   dyoung     struct rtw_txdesc_blk **tdbp, struct mbuf **mp,
   3046       1.1   dyoung     struct ieee80211_node **nip)
   3047       1.1   dyoung {
   3048      1.48   dyoung 	int pri;
   3049      1.48   dyoung 	struct ether_header *eh;
   3050       1.1   dyoung 	struct mbuf *m0;
   3051       1.1   dyoung 	struct rtw_softc *sc;
   3052      1.42   dyoung 	short *if_flagsp;
   3053       1.1   dyoung 
   3054       1.1   dyoung 	sc = (struct rtw_softc *)ifp->if_softc;
   3055       1.1   dyoung 
   3056      1.21   dyoung 	DPRINTF(sc, RTW_DEBUG_XMIT,
   3057      1.21   dyoung 	    ("%s: enter %s\n", sc->sc_dev.dv_xname, __func__));
   3058       1.1   dyoung 
   3059      1.42   dyoung 	if_flagsp = &ifp->if_flags;
   3060       1.5   dyoung 
   3061      1.42   dyoung 	if (sc->sc_ic.ic_state == IEEE80211_S_RUN &&
   3062      1.42   dyoung 	    (*mp = rtw_80211_dequeue(sc, &sc->sc_beaconq, RTW_TXPRIBCN, tsbp,
   3063      1.42   dyoung 		                     tdbp, nip, if_flagsp)) != NULL) {
   3064      1.42   dyoung 		DPRINTF(sc, RTW_DEBUG_XMIT, ("%s: dequeue beacon frame\n",
   3065      1.42   dyoung 		    __func__));
   3066       1.5   dyoung 		return 0;
   3067       1.5   dyoung 	}
   3068       1.5   dyoung 
   3069      1.42   dyoung 	if ((*mp = rtw_80211_dequeue(sc, &sc->sc_ic.ic_mgtq, RTW_TXPRIMD, tsbp,
   3070      1.42   dyoung 		                     tdbp, nip, if_flagsp)) != NULL) {
   3071      1.42   dyoung 		DPRINTF(sc, RTW_DEBUG_XMIT, ("%s: dequeue mgt frame\n",
   3072      1.42   dyoung 		    __func__));
   3073      1.42   dyoung 		return 0;
   3074      1.42   dyoung 	}
   3075       1.5   dyoung 
   3076      1.42   dyoung 	if (sc->sc_ic.ic_state != IEEE80211_S_RUN) {
   3077      1.21   dyoung 		DPRINTF(sc, RTW_DEBUG_XMIT, ("%s: not running\n", __func__));
   3078       1.1   dyoung 		return 0;
   3079      1.42   dyoung 	}
   3080      1.42   dyoung 
   3081      1.48   dyoung 	*mp = NULL;
   3082      1.48   dyoung 
   3083      1.48   dyoung 	IFQ_POLL(&ifp->if_snd, m0);
   3084      1.48   dyoung 	if (m0 == NULL) {
   3085      1.48   dyoung 		DPRINTF(sc, RTW_DEBUG_XMIT, ("%s: no frame ready\n",
   3086      1.42   dyoung 		    __func__));
   3087      1.42   dyoung 		return 0;
   3088      1.42   dyoung 	}
   3089      1.42   dyoung 
   3090      1.48   dyoung 	pri = ((m0->m_flags & M_PWR_SAV) != 0) ? RTW_TXPRIHI : RTW_TXPRIMD;
   3091      1.48   dyoung 
   3092      1.48   dyoung 	if (rtw_txring_choose(sc, tsbp, tdbp, pri) == -1) {
   3093      1.58   dyoung 		DPRINTF(sc, RTW_DEBUG_XMIT_RSRC, ("%s: no ring %d descriptor\n",
   3094      1.58   dyoung 		    __func__, pri));
   3095      1.42   dyoung 		*if_flagsp |= IFF_OACTIVE;
   3096      1.58   dyoung 		sc->sc_if.if_timer = 1;
   3097      1.42   dyoung 		return 0;
   3098      1.42   dyoung 	}
   3099      1.42   dyoung 
   3100      1.42   dyoung 	IFQ_DEQUEUE(&ifp->if_snd, m0);
   3101      1.42   dyoung 	if (m0 == NULL) {
   3102      1.48   dyoung 		DPRINTF(sc, RTW_DEBUG_XMIT, ("%s: no frame ready\n",
   3103      1.42   dyoung 		    __func__));
   3104      1.42   dyoung 		return 0;
   3105      1.42   dyoung 	}
   3106      1.42   dyoung 	DPRINTF(sc, RTW_DEBUG_XMIT, ("%s: dequeue data frame\n", __func__));
   3107      1.42   dyoung 	ifp->if_opackets++;
   3108       1.1   dyoung #if NBPFILTER > 0
   3109      1.42   dyoung 	if (ifp->if_bpf)
   3110      1.42   dyoung 		bpf_mtap(ifp->if_bpf, m0);
   3111       1.1   dyoung #endif
   3112      1.48   dyoung 	eh = mtod(m0, struct ether_header *);
   3113      1.48   dyoung 	*nip = ieee80211_find_txnode(&sc->sc_ic, eh->ether_dhost);
   3114      1.48   dyoung 	if (*nip == NULL) {
   3115      1.48   dyoung 		/* NB: ieee80211_find_txnode does stat+msg */
   3116      1.48   dyoung 		m_freem(m0);
   3117      1.48   dyoung 		return -1;
   3118      1.48   dyoung 	}
   3119      1.48   dyoung 	if ((m0 = ieee80211_encap(&sc->sc_ic, m0, *nip)) == NULL) {
   3120      1.48   dyoung 		DPRINTF(sc, RTW_DEBUG_XMIT, ("%s: encap error\n", __func__));
   3121      1.42   dyoung 		ifp->if_oerrors++;
   3122      1.42   dyoung 		return -1;
   3123       1.1   dyoung 	}
   3124      1.21   dyoung 	DPRINTF(sc, RTW_DEBUG_XMIT, ("%s: leave\n", __func__));
   3125       1.1   dyoung 	*mp = m0;
   3126       1.1   dyoung 	return 0;
   3127       1.1   dyoung }
   3128       1.1   dyoung 
   3129      1.21   dyoung static int
   3130      1.21   dyoung rtw_seg_too_short(bus_dmamap_t dmamap)
   3131      1.21   dyoung {
   3132      1.21   dyoung 	int i;
   3133      1.21   dyoung 	for (i = 0; i < dmamap->dm_nsegs; i++) {
   3134      1.21   dyoung 		if (dmamap->dm_segs[i].ds_len < 4) {
   3135      1.21   dyoung 			printf("%s: segment too short\n", __func__);
   3136      1.21   dyoung 			return 1;
   3137      1.21   dyoung 		}
   3138      1.21   dyoung 	}
   3139      1.21   dyoung 	return 0;
   3140      1.21   dyoung }
   3141      1.21   dyoung 
   3142       1.5   dyoung /* TBD factor with atw_start */
   3143       1.5   dyoung static struct mbuf *
   3144       1.5   dyoung rtw_dmamap_load_txbuf(bus_dma_tag_t dmat, bus_dmamap_t dmam, struct mbuf *chain,
   3145       1.5   dyoung     u_int ndescfree, short *ifflagsp, const char *dvname)
   3146       1.5   dyoung {
   3147       1.5   dyoung 	int first, rc;
   3148       1.5   dyoung 	struct mbuf *m, *m0;
   3149       1.5   dyoung 
   3150       1.5   dyoung 	m0 = chain;
   3151       1.5   dyoung 
   3152       1.5   dyoung 	/*
   3153       1.5   dyoung 	 * Load the DMA map.  Copy and try (once) again if the packet
   3154       1.5   dyoung 	 * didn't fit in the alloted number of segments.
   3155       1.5   dyoung 	 */
   3156       1.5   dyoung 	for (first = 1;
   3157       1.5   dyoung 	     ((rc = bus_dmamap_load_mbuf(dmat, dmam, m0,
   3158       1.5   dyoung 			  BUS_DMA_WRITE|BUS_DMA_NOWAIT)) != 0 ||
   3159      1.21   dyoung 	      dmam->dm_nsegs > ndescfree || rtw_seg_too_short(dmam)) && first;
   3160       1.5   dyoung 	     first = 0) {
   3161       1.5   dyoung 		if (rc == 0)
   3162       1.5   dyoung 			bus_dmamap_unload(dmat, dmam);
   3163       1.5   dyoung 		MGETHDR(m, M_DONTWAIT, MT_DATA);
   3164       1.5   dyoung 		if (m == NULL) {
   3165       1.5   dyoung 			printf("%s: unable to allocate Tx mbuf\n",
   3166       1.5   dyoung 			    dvname);
   3167       1.5   dyoung 			break;
   3168       1.5   dyoung 		}
   3169       1.5   dyoung 		if (m0->m_pkthdr.len > MHLEN) {
   3170       1.5   dyoung 			MCLGET(m, M_DONTWAIT);
   3171       1.5   dyoung 			if ((m->m_flags & M_EXT) == 0) {
   3172       1.5   dyoung 				printf("%s: cannot allocate Tx cluster\n",
   3173       1.5   dyoung 				    dvname);
   3174       1.5   dyoung 				m_freem(m);
   3175       1.5   dyoung 				break;
   3176       1.5   dyoung 			}
   3177       1.5   dyoung 		}
   3178       1.5   dyoung 		m_copydata(m0, 0, m0->m_pkthdr.len, mtod(m, caddr_t));
   3179       1.5   dyoung 		m->m_pkthdr.len = m->m_len = m0->m_pkthdr.len;
   3180       1.5   dyoung 		m_freem(m0);
   3181       1.5   dyoung 		m0 = m;
   3182       1.5   dyoung 		m = NULL;
   3183       1.5   dyoung 	}
   3184       1.5   dyoung 	if (rc != 0) {
   3185       1.5   dyoung 		printf("%s: cannot load Tx buffer, rc = %d\n", dvname, rc);
   3186       1.5   dyoung 		m_freem(m0);
   3187       1.5   dyoung 		return NULL;
   3188      1.21   dyoung 	} else if (rtw_seg_too_short(dmam)) {
   3189      1.21   dyoung 		printf("%s: cannot load Tx buffer, segment too short\n",
   3190      1.21   dyoung 		    dvname);
   3191      1.21   dyoung 		bus_dmamap_unload(dmat, dmam);
   3192      1.21   dyoung 		m_freem(m0);
   3193      1.21   dyoung 		return NULL;
   3194       1.5   dyoung 	} else if (dmam->dm_nsegs > ndescfree) {
   3195      1.49   dyoung 		printf("%s: too many tx segments\n", dvname);
   3196       1.5   dyoung 		bus_dmamap_unload(dmat, dmam);
   3197       1.5   dyoung 		m_freem(m0);
   3198       1.5   dyoung 		return NULL;
   3199       1.5   dyoung 	}
   3200       1.5   dyoung 	return m0;
   3201       1.5   dyoung }
   3202       1.5   dyoung 
   3203      1.21   dyoung #ifdef RTW_DEBUG
   3204       1.1   dyoung static void
   3205      1.16   dyoung rtw_print_txdesc(struct rtw_softc *sc, const char *action,
   3206      1.34   dyoung     struct rtw_txsoft *ts, struct rtw_txdesc_blk *tdb, int desc)
   3207      1.16   dyoung {
   3208      1.34   dyoung 	struct rtw_txdesc *td = &tdb->tdb_desc[desc];
   3209      1.58   dyoung 	DPRINTF(sc, RTW_DEBUG_XMIT_DESC, ("%s: %p %s txdesc[%d] next %#08x "
   3210      1.58   dyoung 	    "buf %#08x ctl0 %#08x ctl1 %#08x len %#08x\n",
   3211      1.34   dyoung 	    sc->sc_dev.dv_xname, ts, action, desc,
   3212      1.58   dyoung 	    le32toh(td->td_buf), le32toh(td->td_next),
   3213      1.58   dyoung 	    le32toh(td->td_ctl0), le32toh(td->td_ctl1),
   3214      1.34   dyoung 	    le32toh(td->td_len)));
   3215      1.16   dyoung }
   3216      1.21   dyoung #endif /* RTW_DEBUG */
   3217      1.16   dyoung 
   3218      1.16   dyoung static void
   3219       1.1   dyoung rtw_start(struct ifnet *ifp)
   3220       1.1   dyoung {
   3221      1.10   dyoung 	uint8_t tppoll;
   3222       1.5   dyoung 	int desc, i, lastdesc, npkt, rate;
   3223      1.14   dyoung 	uint32_t proto_ctl0, ctl0, ctl1;
   3224       1.5   dyoung 	bus_dmamap_t		dmamap;
   3225       1.5   dyoung 	struct ieee80211com	*ic;
   3226       1.5   dyoung 	struct ieee80211_duration *d0;
   3227      1.49   dyoung 	struct ieee80211_frame_min	*wh;
   3228       1.5   dyoung 	struct ieee80211_node	*ni;
   3229       1.5   dyoung 	struct mbuf		*m0;
   3230       1.5   dyoung 	struct rtw_softc	*sc;
   3231      1.34   dyoung 	struct rtw_txsoft_blk	*tsb;
   3232      1.34   dyoung 	struct rtw_txdesc_blk	*tdb;
   3233      1.34   dyoung 	struct rtw_txsoft	*ts;
   3234      1.34   dyoung 	struct rtw_txdesc	*td;
   3235      1.49   dyoung 	struct ieee80211_key	*k;
   3236       1.1   dyoung 
   3237       1.1   dyoung 	sc = (struct rtw_softc *)ifp->if_softc;
   3238       1.5   dyoung 	ic = &sc->sc_ic;
   3239       1.1   dyoung 
   3240      1.21   dyoung 	DPRINTF(sc, RTW_DEBUG_XMIT,
   3241      1.21   dyoung 	    ("%s: enter %s\n", sc->sc_dev.dv_xname, __func__));
   3242       1.5   dyoung 
   3243      1.31   dyoung 	if ((ifp->if_flags & (IFF_RUNNING|IFF_OACTIVE)) != IFF_RUNNING)
   3244      1.31   dyoung 		goto out;
   3245      1.31   dyoung 
   3246       1.5   dyoung 	/* XXX do real rate control */
   3247      1.14   dyoung 	proto_ctl0 = RTW_TXCTL0_RTSRATE_1MBPS;
   3248       1.5   dyoung 
   3249       1.5   dyoung 	if ((ic->ic_flags & IEEE80211_F_SHPREAMBLE) != 0)
   3250      1.14   dyoung 		proto_ctl0 |= RTW_TXCTL0_SPLCP;
   3251       1.5   dyoung 
   3252       1.5   dyoung 	for (;;) {
   3253      1.34   dyoung 		if (rtw_dequeue(ifp, &tsb, &tdb, &m0, &ni) == -1)
   3254       1.1   dyoung 			continue;
   3255       1.1   dyoung 		if (m0 == NULL)
   3256       1.1   dyoung 			break;
   3257      1.49   dyoung 
   3258      1.49   dyoung 		wh = mtod(m0, struct ieee80211_frame_min *);
   3259      1.49   dyoung 
   3260      1.49   dyoung 		if ((wh->i_fc[1] & IEEE80211_FC1_WEP) != 0 &&
   3261      1.49   dyoung 		    (k = ieee80211_crypto_encap(ic, ni, m0)) == NULL) {
   3262      1.51   dyoung 			m_freem(m0);
   3263      1.49   dyoung 			break;
   3264      1.49   dyoung 		} else
   3265      1.49   dyoung 			k = NULL;
   3266      1.49   dyoung 
   3267      1.34   dyoung 		ts = SIMPLEQ_FIRST(&tsb->tsb_freeq);
   3268       1.5   dyoung 
   3269      1.34   dyoung 		dmamap = ts->ts_dmamap;
   3270       1.5   dyoung 
   3271       1.5   dyoung 		m0 = rtw_dmamap_load_txbuf(sc->sc_dmat, dmamap, m0,
   3272      1.34   dyoung 		    tdb->tdb_nfree, &ifp->if_flags, sc->sc_dev.dv_xname);
   3273       1.5   dyoung 
   3274       1.5   dyoung 		if (m0 == NULL || dmamap->dm_nsegs == 0) {
   3275      1.21   dyoung 			DPRINTF(sc, RTW_DEBUG_XMIT,
   3276      1.21   dyoung 			    ("%s: fail dmamap load\n", __func__));
   3277       1.5   dyoung 			goto post_dequeue_err;
   3278       1.5   dyoung 		}
   3279       1.5   dyoung 
   3280      1.49   dyoung 		/* Note well: rtw_dmamap_load_txbuf may have created
   3281      1.49   dyoung 		 * a new chain, so we must find the header once
   3282      1.49   dyoung 		 * more.
   3283      1.49   dyoung 		 */
   3284      1.49   dyoung 		wh = mtod(m0, struct ieee80211_frame_min *);
   3285      1.45   dyoung 
   3286      1.45   dyoung 		/* XXX do real rate control */
   3287      1.45   dyoung 		if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) ==
   3288      1.45   dyoung 		    IEEE80211_FC0_TYPE_MGT)
   3289      1.45   dyoung 			rate = 2;
   3290      1.45   dyoung 		else
   3291      1.45   dyoung 			rate = MAX(2, ieee80211_get_rate(ic));
   3292      1.45   dyoung 
   3293      1.16   dyoung #ifdef RTW_DEBUG
   3294      1.48   dyoung 		if ((ifp->if_flags & (IFF_DEBUG|IFF_LINK2)) ==
   3295      1.16   dyoung 		    (IFF_DEBUG|IFF_LINK2)) {
   3296      1.16   dyoung 			ieee80211_dump_pkt(mtod(m0, uint8_t *),
   3297      1.16   dyoung 			    (dmamap->dm_nsegs == 1) ? m0->m_pkthdr.len
   3298      1.16   dyoung 			                            : sizeof(wh),
   3299      1.16   dyoung 			    rate, 0);
   3300      1.16   dyoung 		}
   3301      1.16   dyoung #endif /* RTW_DEBUG */
   3302      1.14   dyoung 		ctl0 = proto_ctl0 |
   3303       1.5   dyoung 		    LSHIFT(m0->m_pkthdr.len, RTW_TXCTL0_TPKTSIZE_MASK);
   3304       1.5   dyoung 
   3305      1.45   dyoung 		switch (rate) {
   3306      1.42   dyoung 		default:
   3307      1.42   dyoung 		case 2:
   3308      1.42   dyoung 			ctl0 |= RTW_TXCTL0_RATE_1MBPS;
   3309      1.42   dyoung 			break;
   3310      1.42   dyoung 		case 4:
   3311      1.42   dyoung 			ctl0 |= RTW_TXCTL0_RATE_2MBPS;
   3312      1.42   dyoung 			break;
   3313      1.42   dyoung 		case 11:
   3314      1.42   dyoung 			ctl0 |= RTW_TXCTL0_RATE_5MBPS;
   3315      1.42   dyoung 			break;
   3316      1.42   dyoung 		case 22:
   3317      1.42   dyoung 			ctl0 |= RTW_TXCTL0_RATE_11MBPS;
   3318      1.42   dyoung 			break;
   3319      1.42   dyoung 		}
   3320      1.45   dyoung 		/* XXX >= ? Compare after fragmentation? */
   3321      1.45   dyoung 		if (m0->m_pkthdr.len > ic->ic_rtsthreshold)
   3322      1.45   dyoung 			ctl0 |= RTW_TXCTL0_RTSEN;
   3323      1.45   dyoung 
   3324      1.49   dyoung 		if (k != NULL) {
   3325      1.49   dyoung 			ctl0 |= LSHIFT(k->wk_keyix, RTW_TXCTL0_KEYID_MASK) &
   3326      1.49   dyoung 			    RTW_TXCTL0_KEYID_MASK;
   3327      1.49   dyoung 		}
   3328      1.42   dyoung 
   3329      1.45   dyoung 		if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) ==
   3330      1.45   dyoung 		    IEEE80211_FC0_TYPE_MGT) {
   3331      1.45   dyoung 			ctl0 &= ~(RTW_TXCTL0_SPLCP | RTW_TXCTL0_RTSEN);
   3332      1.45   dyoung 			if ((wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) ==
   3333      1.45   dyoung 			    IEEE80211_FC0_SUBTYPE_BEACON)
   3334      1.45   dyoung 				ctl0 |= RTW_TXCTL0_BEACON;
   3335      1.45   dyoung 		}
   3336      1.45   dyoung 
   3337      1.62   dyoung 		if (ieee80211_compute_duration(wh, k, m0->m_pkthdr.len,
   3338       1.5   dyoung 		    ic->ic_flags, ic->ic_fragthreshold,
   3339      1.34   dyoung 		    rate, &ts->ts_d0, &ts->ts_dn, &npkt,
   3340      1.48   dyoung 		    (ifp->if_flags & (IFF_DEBUG|IFF_LINK2)) ==
   3341      1.19   dyoung 		    (IFF_DEBUG|IFF_LINK2)) == -1) {
   3342      1.21   dyoung 			DPRINTF(sc, RTW_DEBUG_XMIT,
   3343      1.21   dyoung 			    ("%s: fail compute duration\n", __func__));
   3344       1.5   dyoung 			goto post_load_err;
   3345       1.5   dyoung 		}
   3346       1.5   dyoung 
   3347      1.34   dyoung 		d0 = &ts->ts_d0;
   3348       1.5   dyoung 
   3349      1.20   dyoung 		*(uint16_t*)wh->i_dur = htole16(d0->d_data_dur);
   3350      1.20   dyoung 
   3351      1.14   dyoung 		ctl1 = LSHIFT(d0->d_plcp_len, RTW_TXCTL1_LENGTH_MASK) |
   3352       1.5   dyoung 		    LSHIFT(d0->d_rts_dur, RTW_TXCTL1_RTSDUR_MASK);
   3353       1.5   dyoung 
   3354      1.25  mycroft 		if (d0->d_residue)
   3355      1.14   dyoung 			ctl1 |= RTW_TXCTL1_LENGEXT;
   3356       1.5   dyoung 
   3357       1.5   dyoung 		/* TBD fragmentation */
   3358       1.5   dyoung 
   3359      1.34   dyoung 		ts->ts_first = tdb->tdb_next;
   3360       1.5   dyoung 
   3361      1.34   dyoung 		rtw_txdescs_sync(tdb, ts->ts_first, dmamap->dm_nsegs,
   3362       1.5   dyoung 		    BUS_DMASYNC_PREWRITE);
   3363       1.5   dyoung 
   3364      1.34   dyoung 		KASSERT(ts->ts_first < tdb->tdb_ndesc);
   3365      1.21   dyoung 
   3366      1.32   dyoung #if NBPFILTER > 0
   3367      1.32   dyoung 		if (ic->ic_rawbpf != NULL)
   3368      1.32   dyoung 			bpf_mtap((caddr_t)ic->ic_rawbpf, m0);
   3369      1.32   dyoung 
   3370      1.32   dyoung 		if (sc->sc_radiobpf != NULL) {
   3371      1.32   dyoung 			struct rtw_tx_radiotap_header *rt = &sc->sc_txtap;
   3372      1.32   dyoung 
   3373      1.32   dyoung 			rt->rt_flags = 0;
   3374      1.32   dyoung 			rt->rt_rate = rate;
   3375      1.57    skrll 			rt->rt_chan_freq = htole16(ic->ic_curchan->ic_freq);
   3376      1.57    skrll 			rt->rt_chan_flags = htole16(ic->ic_curchan->ic_flags);
   3377      1.32   dyoung 
   3378      1.32   dyoung 			bpf_mtap2(sc->sc_radiobpf, (caddr_t)rt,
   3379      1.32   dyoung 			    sizeof(sc->sc_txtapu), m0);
   3380      1.32   dyoung 		}
   3381      1.32   dyoung #endif /* NPBFILTER > 0 */
   3382      1.32   dyoung 
   3383      1.34   dyoung 		for (i = 0, lastdesc = desc = ts->ts_first;
   3384       1.5   dyoung 		     i < dmamap->dm_nsegs;
   3385      1.34   dyoung 		     i++, desc = RTW_NEXT_IDX(tdb, desc)) {
   3386       1.5   dyoung 			if (dmamap->dm_segs[i].ds_len > RTW_TXLEN_LENGTH_MASK) {
   3387      1.21   dyoung 				DPRINTF(sc, RTW_DEBUG_XMIT_DESC,
   3388      1.21   dyoung 				    ("%s: seg too long\n", __func__));
   3389       1.5   dyoung 				goto post_load_err;
   3390       1.5   dyoung 			}
   3391      1.34   dyoung 			td = &tdb->tdb_desc[desc];
   3392      1.34   dyoung 			td->td_ctl0 = htole32(ctl0);
   3393       1.5   dyoung 			if (i != 0)
   3394      1.34   dyoung 				td->td_ctl0 |= htole32(RTW_TXCTL0_OWN);
   3395      1.34   dyoung 			td->td_ctl1 = htole32(ctl1);
   3396      1.34   dyoung 			td->td_buf = htole32(dmamap->dm_segs[i].ds_addr);
   3397      1.34   dyoung 			td->td_len = htole32(dmamap->dm_segs[i].ds_len);
   3398       1.5   dyoung 			lastdesc = desc;
   3399      1.16   dyoung #ifdef RTW_DEBUG
   3400      1.34   dyoung 			rtw_print_txdesc(sc, "load", ts, tdb, desc);
   3401      1.16   dyoung #endif /* RTW_DEBUG */
   3402       1.5   dyoung 		}
   3403       1.5   dyoung 
   3404      1.34   dyoung 		KASSERT(desc < tdb->tdb_ndesc);
   3405      1.21   dyoung 
   3406      1.34   dyoung 		ts->ts_ni = ni;
   3407      1.48   dyoung 		KASSERT(ni != NULL);
   3408      1.34   dyoung 		ts->ts_mbuf = m0;
   3409      1.34   dyoung 		ts->ts_last = lastdesc;
   3410      1.34   dyoung 		tdb->tdb_desc[ts->ts_last].td_ctl0 |= htole32(RTW_TXCTL0_LS);
   3411      1.34   dyoung 		tdb->tdb_desc[ts->ts_first].td_ctl0 |=
   3412       1.5   dyoung 		   htole32(RTW_TXCTL0_FS);
   3413       1.5   dyoung 
   3414      1.16   dyoung #ifdef RTW_DEBUG
   3415      1.34   dyoung 		rtw_print_txdesc(sc, "FS on", ts, tdb, ts->ts_first);
   3416      1.34   dyoung 		rtw_print_txdesc(sc, "LS on", ts, tdb, ts->ts_last);
   3417      1.16   dyoung #endif /* RTW_DEBUG */
   3418       1.5   dyoung 
   3419      1.34   dyoung 		tdb->tdb_nfree -= dmamap->dm_nsegs;
   3420      1.34   dyoung 		tdb->tdb_next = desc;
   3421       1.5   dyoung 
   3422      1.34   dyoung 		rtw_txdescs_sync(tdb, ts->ts_first, dmamap->dm_nsegs,
   3423       1.5   dyoung 		    BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
   3424       1.5   dyoung 
   3425      1.34   dyoung 		tdb->tdb_desc[ts->ts_first].td_ctl0 |=
   3426       1.5   dyoung 		    htole32(RTW_TXCTL0_OWN);
   3427       1.5   dyoung 
   3428      1.16   dyoung #ifdef RTW_DEBUG
   3429      1.34   dyoung 		rtw_print_txdesc(sc, "OWN on", ts, tdb, ts->ts_first);
   3430      1.16   dyoung #endif /* RTW_DEBUG */
   3431       1.5   dyoung 
   3432      1.34   dyoung 		rtw_txdescs_sync(tdb, ts->ts_first, 1,
   3433       1.5   dyoung 		    BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
   3434       1.5   dyoung 
   3435      1.34   dyoung 		SIMPLEQ_REMOVE_HEAD(&tsb->tsb_freeq, ts_q);
   3436      1.34   dyoung 		SIMPLEQ_INSERT_TAIL(&tsb->tsb_dirtyq, ts, ts_q);
   3437       1.5   dyoung 
   3438      1.58   dyoung 		if (tsb != &sc->sc_txsoft_blk[RTW_TXPRIBCN])
   3439      1.42   dyoung 			sc->sc_led_state.ls_event |= RTW_LED_S_TX;
   3440      1.58   dyoung 		tsb->tsb_tx_timer = 5;
   3441      1.58   dyoung 		ifp->if_timer = 1;
   3442      1.10   dyoung 		tppoll = RTW_READ8(&sc->sc_regs, RTW_TPPOLL);
   3443      1.45   dyoung 		tppoll &= ~RTW_TPPOLL_SALL;
   3444      1.45   dyoung 		tppoll |= tsb->tsb_poll & RTW_TPPOLL_ALL;
   3445      1.45   dyoung 		RTW_WRITE8(&sc->sc_regs, RTW_TPPOLL, tppoll);
   3446       1.9   dyoung 		RTW_SYNC(&sc->sc_regs, RTW_TPPOLL, RTW_TPPOLL);
   3447       1.1   dyoung 	}
   3448      1.31   dyoung out:
   3449      1.21   dyoung 	DPRINTF(sc, RTW_DEBUG_XMIT, ("%s: leave\n", __func__));
   3450       1.5   dyoung 	return;
   3451       1.5   dyoung post_load_err:
   3452       1.5   dyoung 	bus_dmamap_unload(sc->sc_dmat, dmamap);
   3453       1.5   dyoung 	m_freem(m0);
   3454       1.5   dyoung post_dequeue_err:
   3455      1.48   dyoung 	ieee80211_free_node(ni);
   3456       1.1   dyoung 	return;
   3457       1.1   dyoung }
   3458       1.1   dyoung 
   3459       1.1   dyoung static void
   3460      1.58   dyoung rtw_idle(struct rtw_regs *regs)
   3461      1.58   dyoung {
   3462      1.58   dyoung 	int active;
   3463      1.58   dyoung 
   3464      1.58   dyoung 	/* request stop DMA; wait for packets to stop transmitting. */
   3465      1.58   dyoung 
   3466      1.58   dyoung 	RTW_WRITE8(regs, RTW_TPPOLL, RTW_TPPOLL_SALL);
   3467      1.58   dyoung 	RTW_WBR(regs, RTW_TPPOLL, RTW_TPPOLL);
   3468      1.58   dyoung 
   3469      1.58   dyoung 	for (active = 0; active < 300 &&
   3470      1.58   dyoung 	     (RTW_READ8(regs, RTW_TPPOLL) & RTW_TPPOLL_ACTIVE) != 0; active++)
   3471      1.58   dyoung 		DELAY(10);
   3472      1.58   dyoung 	printf("%s: transmit DMA idle in %dus\n", __func__, active * 10);
   3473      1.58   dyoung }
   3474      1.58   dyoung 
   3475      1.58   dyoung static void
   3476       1.1   dyoung rtw_watchdog(struct ifnet *ifp)
   3477       1.1   dyoung {
   3478      1.58   dyoung 	int pri, tx_timeouts = 0;
   3479       1.5   dyoung 	struct rtw_softc *sc;
   3480      1.34   dyoung 	struct rtw_txsoft_blk *tsb;
   3481       1.5   dyoung 
   3482       1.5   dyoung 	sc = ifp->if_softc;
   3483       1.5   dyoung 
   3484       1.5   dyoung 	ifp->if_timer = 0;
   3485       1.5   dyoung 
   3486       1.5   dyoung 	if ((sc->sc_flags & RTW_F_ENABLED) == 0)
   3487       1.5   dyoung 		return;
   3488       1.5   dyoung 
   3489       1.5   dyoung 	for (pri = 0; pri < RTW_NTXPRI; pri++) {
   3490      1.34   dyoung 		tsb = &sc->sc_txsoft_blk[pri];
   3491       1.5   dyoung 
   3492      1.34   dyoung 		if (tsb->tsb_tx_timer == 0)
   3493       1.5   dyoung 			continue;
   3494      1.58   dyoung 		else if (--tsb->tsb_tx_timer == 0) {
   3495      1.34   dyoung 			if (SIMPLEQ_EMPTY(&tsb->tsb_dirtyq))
   3496       1.5   dyoung 				continue;
   3497       1.5   dyoung 			printf("%s: transmit timeout, priority %d\n",
   3498       1.5   dyoung 			    ifp->if_xname, pri);
   3499       1.5   dyoung 			ifp->if_oerrors++;
   3500      1.58   dyoung 			tx_timeouts++;
   3501       1.5   dyoung 		} else
   3502       1.5   dyoung 			ifp->if_timer = 1;
   3503       1.5   dyoung 	}
   3504      1.58   dyoung 
   3505      1.58   dyoung 	if (tx_timeouts > 0) {
   3506      1.58   dyoung 		/* Stop Tx DMA, disable xmtr, flush Tx rings, enable xmtr,
   3507      1.58   dyoung 		 * reset s/w tx-ring pointers, and start transmission.
   3508      1.58   dyoung 		 *
   3509      1.58   dyoung 		 * TBD Stop/restart just the broken rings?
   3510      1.58   dyoung 		 */
   3511      1.58   dyoung 		rtw_idle(&sc->sc_regs);
   3512      1.58   dyoung 		rtw_io_enable(&sc->sc_regs, RTW_CR_TE, 0);
   3513      1.58   dyoung 		rtw_txdescs_reset(sc);
   3514      1.58   dyoung 		rtw_io_enable(&sc->sc_regs, RTW_CR_TE, 1);
   3515      1.58   dyoung 		rtw_txring_fixup(sc);
   3516      1.58   dyoung 		rtw_start(ifp);
   3517      1.58   dyoung 	}
   3518      1.48   dyoung 	ieee80211_watchdog(&sc->sc_ic);
   3519       1.1   dyoung 	return;
   3520       1.1   dyoung }
   3521       1.1   dyoung 
   3522       1.1   dyoung static void
   3523       1.1   dyoung rtw_next_scan(void *arg)
   3524       1.1   dyoung {
   3525       1.1   dyoung 	struct ieee80211com *ic = arg;
   3526       1.1   dyoung 	int s;
   3527       1.1   dyoung 
   3528       1.1   dyoung 	/* don't call rtw_start w/o network interrupts blocked */
   3529       1.1   dyoung 	s = splnet();
   3530       1.1   dyoung 	if (ic->ic_state == IEEE80211_S_SCAN)
   3531       1.1   dyoung 		ieee80211_next_scan(ic);
   3532       1.1   dyoung 	splx(s);
   3533       1.1   dyoung }
   3534       1.1   dyoung 
   3535      1.10   dyoung static void
   3536      1.45   dyoung rtw_join_bss(struct rtw_softc *sc, uint8_t *bssid, uint16_t intval0)
   3537      1.10   dyoung {
   3538      1.58   dyoung 	uint16_t bcnitv, bintritv, intval;
   3539      1.10   dyoung 	int i;
   3540      1.10   dyoung 	struct rtw_regs *regs = &sc->sc_regs;
   3541      1.10   dyoung 
   3542      1.10   dyoung 	for (i = 0; i < IEEE80211_ADDR_LEN; i++)
   3543      1.10   dyoung 		RTW_WRITE8(regs, RTW_BSSID + i, bssid[i]);
   3544      1.10   dyoung 
   3545      1.10   dyoung 	RTW_SYNC(regs, RTW_BSSID16, RTW_BSSID32);
   3546      1.10   dyoung 
   3547      1.42   dyoung 	rtw_set_access(regs, RTW_ACCESS_CONFIG);
   3548      1.10   dyoung 
   3549      1.10   dyoung 	intval = MIN(intval0, PRESHIFT(RTW_BCNITV_BCNITV_MASK));
   3550      1.10   dyoung 
   3551      1.10   dyoung 	bcnitv = RTW_READ16(regs, RTW_BCNITV) & ~RTW_BCNITV_BCNITV_MASK;
   3552      1.10   dyoung 	bcnitv |= LSHIFT(intval, RTW_BCNITV_BCNITV_MASK);
   3553      1.10   dyoung 	RTW_WRITE16(regs, RTW_BCNITV, bcnitv);
   3554      1.58   dyoung 	/* interrupt host 1ms before the TBTT */
   3555      1.58   dyoung 	bintritv = RTW_READ16(regs, RTW_BINTRITV) & ~RTW_BINTRITV_BINTRITV;
   3556      1.58   dyoung 	bintritv |= LSHIFT(1000, RTW_BINTRITV_BINTRITV);
   3557      1.58   dyoung 	RTW_WRITE16(regs, RTW_BINTRITV, bintritv);
   3558      1.10   dyoung 	/* magic from Linux */
   3559      1.10   dyoung 	RTW_WRITE16(regs, RTW_ATIMWND, LSHIFT(1, RTW_ATIMWND_ATIMWND));
   3560      1.10   dyoung 	RTW_WRITE16(regs, RTW_ATIMTRITV, LSHIFT(2, RTW_ATIMTRITV_ATIMTRITV));
   3561      1.42   dyoung 	rtw_set_access(regs, RTW_ACCESS_NONE);
   3562      1.10   dyoung 
   3563      1.10   dyoung 	rtw_io_enable(regs, RTW_CR_RE | RTW_CR_TE, 1);
   3564      1.10   dyoung }
   3565      1.10   dyoung 
   3566       1.1   dyoung /* Synchronize the hardware state with the software state. */
   3567       1.1   dyoung static int
   3568       1.1   dyoung rtw_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg)
   3569       1.1   dyoung {
   3570      1.48   dyoung 	struct ifnet *ifp = ic->ic_ifp;
   3571      1.48   dyoung 	struct rtw_softc *sc = (struct rtw_softc *)ifp->if_softc;
   3572       1.1   dyoung 	enum ieee80211_state ostate;
   3573       1.1   dyoung 	int error;
   3574       1.1   dyoung 
   3575       1.1   dyoung 	ostate = ic->ic_state;
   3576       1.1   dyoung 
   3577      1.42   dyoung 	rtw_led_newstate(sc, nstate);
   3578      1.42   dyoung 
   3579       1.1   dyoung 	if (nstate == IEEE80211_S_INIT) {
   3580       1.1   dyoung 		callout_stop(&sc->sc_scan_ch);
   3581       1.1   dyoung 		sc->sc_cur_chan = IEEE80211_CHAN_ANY;
   3582       1.1   dyoung 		return (*sc->sc_mtbl.mt_newstate)(ic, nstate, arg);
   3583       1.1   dyoung 	}
   3584       1.1   dyoung 
   3585       1.1   dyoung 	if (ostate == IEEE80211_S_INIT && nstate != IEEE80211_S_INIT)
   3586       1.1   dyoung 		rtw_pwrstate(sc, RTW_ON);
   3587       1.1   dyoung 
   3588       1.1   dyoung 	if ((error = rtw_tune(sc)) != 0)
   3589       1.1   dyoung 		return error;
   3590       1.1   dyoung 
   3591       1.1   dyoung 	switch (nstate) {
   3592       1.1   dyoung 	case IEEE80211_S_INIT:
   3593       1.1   dyoung 		panic("%s: unexpected state IEEE80211_S_INIT\n", __func__);
   3594       1.1   dyoung 		break;
   3595       1.1   dyoung 	case IEEE80211_S_SCAN:
   3596      1.21   dyoung 		if (ostate != IEEE80211_S_SCAN) {
   3597      1.21   dyoung 			(void)memset(ic->ic_bss->ni_bssid, 0,
   3598      1.21   dyoung 			    IEEE80211_ADDR_LEN);
   3599      1.45   dyoung 			rtw_set_nettype(sc, IEEE80211_M_MONITOR);
   3600      1.21   dyoung 		}
   3601       1.1   dyoung 
   3602       1.1   dyoung 		callout_reset(&sc->sc_scan_ch, rtw_dwelltime * hz / 1000,
   3603       1.1   dyoung 		    rtw_next_scan, ic);
   3604       1.1   dyoung 
   3605       1.1   dyoung 		break;
   3606       1.1   dyoung 	case IEEE80211_S_RUN:
   3607      1.38   dyoung 		switch (ic->ic_opmode) {
   3608      1.38   dyoung 		case IEEE80211_M_HOSTAP:
   3609      1.38   dyoung 		case IEEE80211_M_IBSS:
   3610      1.45   dyoung 			rtw_set_nettype(sc, IEEE80211_M_MONITOR);
   3611      1.42   dyoung 			/*FALLTHROUGH*/
   3612      1.42   dyoung 		case IEEE80211_M_AHDEMO:
   3613      1.45   dyoung 		case IEEE80211_M_STA:
   3614      1.45   dyoung 			rtw_join_bss(sc, ic->ic_bss->ni_bssid,
   3615      1.38   dyoung 			    ic->ic_bss->ni_intval);
   3616       1.1   dyoung 			break;
   3617      1.38   dyoung 		case IEEE80211_M_MONITOR:
   3618      1.38   dyoung 			break;
   3619      1.38   dyoung 		}
   3620      1.45   dyoung 		rtw_set_nettype(sc, ic->ic_opmode);
   3621      1.38   dyoung 		break;
   3622      1.45   dyoung 	case IEEE80211_S_ASSOC:
   3623       1.1   dyoung 	case IEEE80211_S_AUTH:
   3624       1.1   dyoung 		break;
   3625       1.1   dyoung 	}
   3626       1.1   dyoung 
   3627       1.1   dyoung 	if (nstate != IEEE80211_S_SCAN)
   3628       1.1   dyoung 		callout_stop(&sc->sc_scan_ch);
   3629       1.1   dyoung 
   3630       1.1   dyoung 	return (*sc->sc_mtbl.mt_newstate)(ic, nstate, arg);
   3631       1.1   dyoung }
   3632       1.1   dyoung 
   3633      1.40   dyoung /* Extend a 32-bit TSF timestamp to a 64-bit timestamp. */
   3634      1.40   dyoung static uint64_t
   3635      1.40   dyoung rtw_tsf_extend(struct rtw_regs *regs, uint32_t rstamp)
   3636      1.40   dyoung {
   3637      1.40   dyoung 	uint32_t tsftl, tsfth;
   3638      1.40   dyoung 
   3639      1.40   dyoung 	tsfth = RTW_READ(regs, RTW_TSFTRH);
   3640      1.40   dyoung 	tsftl = RTW_READ(regs, RTW_TSFTRL);
   3641      1.40   dyoung 	if (tsftl < rstamp)	/* Compensate for rollover. */
   3642      1.40   dyoung 		tsfth--;
   3643      1.40   dyoung 	return ((uint64_t)tsfth << 32) | rstamp;
   3644      1.40   dyoung }
   3645      1.40   dyoung 
   3646       1.1   dyoung static void
   3647       1.1   dyoung rtw_recv_mgmt(struct ieee80211com *ic, struct mbuf *m,
   3648      1.37   dyoung     struct ieee80211_node *ni, int subtype, int rssi, uint32_t rstamp)
   3649       1.1   dyoung {
   3650      1.48   dyoung 	struct ifnet *ifp = ic->ic_ifp;
   3651      1.48   dyoung 	struct rtw_softc *sc = (struct rtw_softc *)ifp->if_softc;
   3652       1.1   dyoung 
   3653      1.40   dyoung 	(*sc->sc_mtbl.mt_recv_mgmt)(ic, m, ni, subtype, rssi, rstamp);
   3654      1.40   dyoung 
   3655       1.1   dyoung 	switch (subtype) {
   3656       1.1   dyoung 	case IEEE80211_FC0_SUBTYPE_PROBE_RESP:
   3657       1.1   dyoung 	case IEEE80211_FC0_SUBTYPE_BEACON:
   3658      1.63   dyoung 		if (ic->ic_opmode == IEEE80211_M_IBSS &&
   3659      1.63   dyoung 		    ic->ic_state == IEEE80211_S_RUN) {
   3660      1.63   dyoung 			uint64_t tsf = rtw_tsf_extend(&sc->sc_regs, rstamp);
   3661      1.63   dyoung 			if (le64toh(ni->ni_tstamp.tsf) >= tsf)
   3662      1.63   dyoung 				(void)ieee80211_ibss_merge(ni);
   3663      1.63   dyoung 		}
   3664       1.1   dyoung 		break;
   3665       1.1   dyoung 	default:
   3666       1.1   dyoung 		break;
   3667       1.1   dyoung 	}
   3668       1.1   dyoung 	return;
   3669       1.1   dyoung }
   3670       1.1   dyoung 
   3671       1.1   dyoung static struct ieee80211_node *
   3672      1.48   dyoung rtw_node_alloc(struct ieee80211_node_table *nt)
   3673       1.1   dyoung {
   3674      1.48   dyoung 	struct ifnet *ifp = nt->nt_ic->ic_ifp;
   3675      1.48   dyoung 	struct rtw_softc *sc = (struct rtw_softc *)ifp->if_softc;
   3676      1.48   dyoung 	struct ieee80211_node *ni = (*sc->sc_mtbl.mt_node_alloc)(nt);
   3677       1.1   dyoung 
   3678      1.21   dyoung 	DPRINTF(sc, RTW_DEBUG_NODE,
   3679      1.21   dyoung 	    ("%s: alloc node %p\n", sc->sc_dev.dv_xname, ni));
   3680       1.1   dyoung 	return ni;
   3681       1.1   dyoung }
   3682       1.1   dyoung 
   3683       1.1   dyoung static void
   3684      1.48   dyoung rtw_node_free(struct ieee80211_node *ni)
   3685       1.1   dyoung {
   3686      1.48   dyoung 	struct ieee80211com *ic = ni->ni_ic;
   3687      1.48   dyoung 	struct ifnet *ifp = ic->ic_ifp;
   3688      1.48   dyoung 	struct rtw_softc *sc = (struct rtw_softc *)ifp->if_softc;
   3689       1.1   dyoung 
   3690      1.21   dyoung 	DPRINTF(sc, RTW_DEBUG_NODE,
   3691      1.21   dyoung 	    ("%s: freeing node %p %s\n", sc->sc_dev.dv_xname, ni,
   3692       1.1   dyoung 	    ether_sprintf(ni->ni_bssid)));
   3693      1.48   dyoung 	(*sc->sc_mtbl.mt_node_free)(ni);
   3694       1.1   dyoung }
   3695       1.1   dyoung 
   3696       1.1   dyoung static int
   3697       1.1   dyoung rtw_media_change(struct ifnet *ifp)
   3698       1.1   dyoung {
   3699       1.1   dyoung 	int error;
   3700       1.1   dyoung 
   3701       1.1   dyoung 	error = ieee80211_media_change(ifp);
   3702       1.1   dyoung 	if (error == ENETRESET) {
   3703       1.1   dyoung 		if ((ifp->if_flags & (IFF_RUNNING|IFF_UP)) ==
   3704       1.1   dyoung 		    (IFF_RUNNING|IFF_UP))
   3705       1.1   dyoung 			rtw_init(ifp);		/* XXX lose error */
   3706       1.1   dyoung 		error = 0;
   3707       1.1   dyoung 	}
   3708       1.1   dyoung 	return error;
   3709       1.1   dyoung }
   3710       1.1   dyoung 
   3711       1.1   dyoung static void
   3712       1.1   dyoung rtw_media_status(struct ifnet *ifp, struct ifmediareq *imr)
   3713       1.1   dyoung {
   3714       1.1   dyoung 	struct rtw_softc *sc = ifp->if_softc;
   3715       1.1   dyoung 
   3716       1.1   dyoung 	if ((sc->sc_flags & RTW_F_ENABLED) == 0) {
   3717       1.1   dyoung 		imr->ifm_active = IFM_IEEE80211 | IFM_NONE;
   3718       1.1   dyoung 		imr->ifm_status = 0;
   3719       1.1   dyoung 		return;
   3720       1.1   dyoung 	}
   3721       1.1   dyoung 	ieee80211_media_status(ifp, imr);
   3722       1.1   dyoung }
   3723       1.1   dyoung 
   3724       1.1   dyoung void
   3725       1.1   dyoung rtw_power(int why, void *arg)
   3726       1.1   dyoung {
   3727       1.1   dyoung 	struct rtw_softc *sc = arg;
   3728      1.48   dyoung 	struct ifnet *ifp = &sc->sc_if;
   3729       1.1   dyoung 	int s;
   3730       1.1   dyoung 
   3731      1.21   dyoung 	DPRINTF(sc, RTW_DEBUG_PWR,
   3732      1.21   dyoung 	    ("%s: rtw_power(%d,)\n", sc->sc_dev.dv_xname, why));
   3733       1.1   dyoung 
   3734       1.1   dyoung 	s = splnet();
   3735       1.1   dyoung 	switch (why) {
   3736       1.1   dyoung 	case PWR_STANDBY:
   3737       1.1   dyoung 		/* XXX do nothing. */
   3738       1.1   dyoung 		break;
   3739       1.1   dyoung 	case PWR_SUSPEND:
   3740       1.1   dyoung 		rtw_stop(ifp, 0);
   3741       1.1   dyoung 		if (sc->sc_power != NULL)
   3742       1.1   dyoung 			(*sc->sc_power)(sc, why);
   3743       1.1   dyoung 		break;
   3744       1.1   dyoung 	case PWR_RESUME:
   3745       1.1   dyoung 		if (ifp->if_flags & IFF_UP) {
   3746       1.1   dyoung 			if (sc->sc_power != NULL)
   3747       1.1   dyoung 				(*sc->sc_power)(sc, why);
   3748       1.1   dyoung 			rtw_init(ifp);
   3749       1.1   dyoung 		}
   3750       1.1   dyoung 		break;
   3751       1.1   dyoung 	case PWR_SOFTSUSPEND:
   3752       1.1   dyoung 	case PWR_SOFTSTANDBY:
   3753       1.1   dyoung 	case PWR_SOFTRESUME:
   3754       1.1   dyoung 		break;
   3755       1.1   dyoung 	}
   3756       1.1   dyoung 	splx(s);
   3757       1.1   dyoung }
   3758       1.1   dyoung 
   3759       1.1   dyoung /* rtw_shutdown: make sure the interface is stopped at reboot time. */
   3760       1.1   dyoung void
   3761       1.1   dyoung rtw_shutdown(void *arg)
   3762       1.1   dyoung {
   3763       1.1   dyoung 	struct rtw_softc *sc = arg;
   3764       1.1   dyoung 
   3765      1.48   dyoung 	rtw_stop(&sc->sc_if, 1);
   3766       1.1   dyoung }
   3767       1.1   dyoung 
   3768      1.61    perry static inline void
   3769       1.7   dyoung rtw_setifprops(struct ifnet *ifp, const char *dvname, void *softc)
   3770       1.1   dyoung {
   3771       1.7   dyoung 	(void)memcpy(ifp->if_xname, dvname, IFNAMSIZ);
   3772       1.1   dyoung 	ifp->if_softc = softc;
   3773       1.1   dyoung 	ifp->if_flags = IFF_SIMPLEX | IFF_BROADCAST | IFF_MULTICAST |
   3774       1.1   dyoung 	    IFF_NOTRAILERS;
   3775       1.1   dyoung 	ifp->if_ioctl = rtw_ioctl;
   3776       1.1   dyoung 	ifp->if_start = rtw_start;
   3777       1.1   dyoung 	ifp->if_watchdog = rtw_watchdog;
   3778       1.1   dyoung 	ifp->if_init = rtw_init;
   3779       1.1   dyoung 	ifp->if_stop = rtw_stop;
   3780       1.1   dyoung }
   3781       1.1   dyoung 
   3782      1.61    perry static inline void
   3783       1.1   dyoung rtw_set80211props(struct ieee80211com *ic)
   3784       1.1   dyoung {
   3785       1.1   dyoung 	int nrate;
   3786       1.1   dyoung 	ic->ic_phytype = IEEE80211_T_DS;
   3787       1.1   dyoung 	ic->ic_opmode = IEEE80211_M_STA;
   3788       1.1   dyoung 	ic->ic_caps = IEEE80211_C_PMGT | IEEE80211_C_IBSS |
   3789      1.49   dyoung 	    IEEE80211_C_HOSTAP | IEEE80211_C_MONITOR;
   3790       1.1   dyoung 
   3791       1.1   dyoung 	nrate = 0;
   3792      1.12   dyoung 	ic->ic_sup_rates[IEEE80211_MODE_11B].rs_rates[nrate++] =
   3793      1.12   dyoung 	    IEEE80211_RATE_BASIC | 2;
   3794      1.12   dyoung 	ic->ic_sup_rates[IEEE80211_MODE_11B].rs_rates[nrate++] =
   3795      1.12   dyoung 	    IEEE80211_RATE_BASIC | 4;
   3796       1.1   dyoung 	ic->ic_sup_rates[IEEE80211_MODE_11B].rs_rates[nrate++] = 11;
   3797       1.1   dyoung 	ic->ic_sup_rates[IEEE80211_MODE_11B].rs_rates[nrate++] = 22;
   3798       1.1   dyoung 	ic->ic_sup_rates[IEEE80211_MODE_11B].rs_nrates = nrate;
   3799       1.1   dyoung }
   3800       1.1   dyoung 
   3801      1.61    perry static inline void
   3802       1.1   dyoung rtw_set80211methods(struct rtw_mtbl *mtbl, struct ieee80211com *ic)
   3803       1.1   dyoung {
   3804       1.1   dyoung 	mtbl->mt_newstate = ic->ic_newstate;
   3805       1.1   dyoung 	ic->ic_newstate = rtw_newstate;
   3806       1.1   dyoung 
   3807       1.1   dyoung 	mtbl->mt_recv_mgmt = ic->ic_recv_mgmt;
   3808       1.1   dyoung 	ic->ic_recv_mgmt = rtw_recv_mgmt;
   3809       1.1   dyoung 
   3810       1.1   dyoung 	mtbl->mt_node_free = ic->ic_node_free;
   3811       1.1   dyoung 	ic->ic_node_free = rtw_node_free;
   3812       1.1   dyoung 
   3813       1.1   dyoung 	mtbl->mt_node_alloc = ic->ic_node_alloc;
   3814       1.1   dyoung 	ic->ic_node_alloc = rtw_node_alloc;
   3815      1.49   dyoung 
   3816      1.49   dyoung 	ic->ic_crypto.cs_key_delete = rtw_key_delete;
   3817      1.49   dyoung 	ic->ic_crypto.cs_key_set = rtw_key_set;
   3818      1.49   dyoung 	ic->ic_crypto.cs_key_update_begin = rtw_key_update_begin;
   3819      1.49   dyoung 	ic->ic_crypto.cs_key_update_end = rtw_key_update_end;
   3820       1.1   dyoung }
   3821       1.1   dyoung 
   3822      1.61    perry static inline void
   3823       1.7   dyoung rtw_establish_hooks(struct rtw_hooks *hooks, const char *dvname,
   3824       1.1   dyoung     void *arg)
   3825       1.1   dyoung {
   3826       1.1   dyoung 	/*
   3827       1.1   dyoung 	 * Make sure the interface is shutdown during reboot.
   3828       1.1   dyoung 	 */
   3829       1.1   dyoung 	hooks->rh_shutdown = shutdownhook_establish(rtw_shutdown, arg);
   3830       1.1   dyoung 	if (hooks->rh_shutdown == NULL)
   3831       1.1   dyoung 		printf("%s: WARNING: unable to establish shutdown hook\n",
   3832       1.7   dyoung 		    dvname);
   3833       1.1   dyoung 
   3834       1.1   dyoung 	/*
   3835       1.1   dyoung 	 * Add a suspend hook to make sure we come back up after a
   3836       1.1   dyoung 	 * resume.
   3837       1.1   dyoung 	 */
   3838       1.1   dyoung 	hooks->rh_power = powerhook_establish(rtw_power, arg);
   3839       1.1   dyoung 	if (hooks->rh_power == NULL)
   3840       1.1   dyoung 		printf("%s: WARNING: unable to establish power hook\n",
   3841       1.7   dyoung 		    dvname);
   3842       1.1   dyoung }
   3843       1.1   dyoung 
   3844      1.61    perry static inline void
   3845       1.7   dyoung rtw_disestablish_hooks(struct rtw_hooks *hooks, const char *dvname,
   3846       1.1   dyoung     void *arg)
   3847       1.1   dyoung {
   3848       1.1   dyoung 	if (hooks->rh_shutdown != NULL)
   3849       1.1   dyoung 		shutdownhook_disestablish(hooks->rh_shutdown);
   3850       1.1   dyoung 
   3851       1.1   dyoung 	if (hooks->rh_power != NULL)
   3852       1.1   dyoung 		powerhook_disestablish(hooks->rh_power);
   3853       1.1   dyoung }
   3854       1.1   dyoung 
   3855      1.61    perry static inline void
   3856       1.1   dyoung rtw_init_radiotap(struct rtw_softc *sc)
   3857       1.1   dyoung {
   3858       1.1   dyoung 	memset(&sc->sc_rxtapu, 0, sizeof(sc->sc_rxtapu));
   3859      1.32   dyoung 	sc->sc_rxtap.rr_ihdr.it_len = htole16(sizeof(sc->sc_rxtapu));
   3860      1.32   dyoung 	sc->sc_rxtap.rr_ihdr.it_present = htole32(RTW_RX_RADIOTAP_PRESENT);
   3861       1.1   dyoung 
   3862       1.1   dyoung 	memset(&sc->sc_txtapu, 0, sizeof(sc->sc_txtapu));
   3863      1.32   dyoung 	sc->sc_txtap.rt_ihdr.it_len = htole16(sizeof(sc->sc_txtapu));
   3864      1.32   dyoung 	sc->sc_txtap.rt_ihdr.it_present = htole32(RTW_TX_RADIOTAP_PRESENT);
   3865       1.1   dyoung }
   3866       1.1   dyoung 
   3867       1.1   dyoung static int
   3868      1.34   dyoung rtw_txsoft_blk_setup(struct rtw_txsoft_blk *tsb, u_int qlen)
   3869       1.1   dyoung {
   3870      1.34   dyoung 	SIMPLEQ_INIT(&tsb->tsb_dirtyq);
   3871      1.34   dyoung 	SIMPLEQ_INIT(&tsb->tsb_freeq);
   3872      1.34   dyoung 	tsb->tsb_ndesc = qlen;
   3873      1.34   dyoung 	tsb->tsb_desc = malloc(qlen * sizeof(*tsb->tsb_desc), M_DEVBUF,
   3874       1.1   dyoung 	    M_NOWAIT);
   3875      1.34   dyoung 	if (tsb->tsb_desc == NULL)
   3876       1.1   dyoung 		return ENOMEM;
   3877       1.1   dyoung 	return 0;
   3878       1.1   dyoung }
   3879       1.1   dyoung 
   3880       1.1   dyoung static void
   3881      1.34   dyoung rtw_txsoft_blk_cleanup_all(struct rtw_softc *sc)
   3882       1.1   dyoung {
   3883      1.21   dyoung 	int pri;
   3884      1.34   dyoung 	struct rtw_txsoft_blk *tsb;
   3885       1.1   dyoung 
   3886      1.21   dyoung 	for (pri = 0; pri < RTW_NTXPRI; pri++) {
   3887      1.34   dyoung 		tsb = &sc->sc_txsoft_blk[pri];
   3888      1.34   dyoung 		free(tsb->tsb_desc, M_DEVBUF);
   3889      1.34   dyoung 		tsb->tsb_desc = NULL;
   3890       1.1   dyoung 	}
   3891       1.1   dyoung }
   3892       1.1   dyoung 
   3893       1.1   dyoung static int
   3894      1.34   dyoung rtw_txsoft_blk_setup_all(struct rtw_softc *sc)
   3895       1.1   dyoung {
   3896       1.1   dyoung 	int pri, rc = 0;
   3897       1.1   dyoung 	int qlen[RTW_NTXPRI] =
   3898       1.1   dyoung 	     {RTW_TXQLENLO, RTW_TXQLENMD, RTW_TXQLENHI, RTW_TXQLENBCN};
   3899      1.42   dyoung 	struct rtw_txsoft_blk *tsbs;
   3900      1.42   dyoung 
   3901      1.42   dyoung 	tsbs = sc->sc_txsoft_blk;
   3902       1.1   dyoung 
   3903      1.21   dyoung 	for (pri = 0; pri < RTW_NTXPRI; pri++) {
   3904      1.42   dyoung 		rc = rtw_txsoft_blk_setup(&tsbs[pri], qlen[pri]);
   3905       1.1   dyoung 		if (rc != 0)
   3906       1.1   dyoung 			break;
   3907       1.1   dyoung 	}
   3908      1.42   dyoung 	tsbs[RTW_TXPRILO].tsb_poll = RTW_TPPOLL_LPQ | RTW_TPPOLL_SLPQ;
   3909      1.42   dyoung 	tsbs[RTW_TXPRIMD].tsb_poll = RTW_TPPOLL_NPQ | RTW_TPPOLL_SNPQ;
   3910      1.42   dyoung 	tsbs[RTW_TXPRIHI].tsb_poll = RTW_TPPOLL_HPQ | RTW_TPPOLL_SHPQ;
   3911      1.42   dyoung 	tsbs[RTW_TXPRIBCN].tsb_poll = RTW_TPPOLL_BQ | RTW_TPPOLL_SBQ;
   3912       1.1   dyoung 	return rc;
   3913       1.1   dyoung }
   3914       1.1   dyoung 
   3915       1.1   dyoung static void
   3916      1.34   dyoung rtw_txdesc_blk_setup(struct rtw_txdesc_blk *tdb, struct rtw_txdesc *desc,
   3917       1.1   dyoung     u_int ndesc, bus_addr_t ofs, bus_addr_t physbase)
   3918       1.1   dyoung {
   3919      1.34   dyoung 	tdb->tdb_ndesc = ndesc;
   3920      1.34   dyoung 	tdb->tdb_desc = desc;
   3921      1.34   dyoung 	tdb->tdb_physbase = physbase;
   3922      1.34   dyoung 	tdb->tdb_ofs = ofs;
   3923       1.1   dyoung 
   3924      1.34   dyoung 	(void)memset(tdb->tdb_desc, 0,
   3925      1.34   dyoung 	    sizeof(tdb->tdb_desc[0]) * tdb->tdb_ndesc);
   3926       1.1   dyoung 
   3927      1.58   dyoung 	rtw_txdesc_blk_init(tdb);
   3928      1.58   dyoung 	tdb->tdb_next = 0;
   3929       1.1   dyoung }
   3930       1.1   dyoung 
   3931       1.1   dyoung static void
   3932       1.1   dyoung rtw_txdesc_blk_setup_all(struct rtw_softc *sc)
   3933       1.1   dyoung {
   3934       1.1   dyoung 	rtw_txdesc_blk_setup(&sc->sc_txdesc_blk[RTW_TXPRILO],
   3935       1.1   dyoung 	    &sc->sc_descs->hd_txlo[0], RTW_NTXDESCLO,
   3936       1.1   dyoung 	    RTW_RING_OFFSET(hd_txlo), RTW_RING_BASE(sc, hd_txlo));
   3937       1.1   dyoung 
   3938       1.1   dyoung 	rtw_txdesc_blk_setup(&sc->sc_txdesc_blk[RTW_TXPRIMD],
   3939       1.1   dyoung 	    &sc->sc_descs->hd_txmd[0], RTW_NTXDESCMD,
   3940       1.1   dyoung 	    RTW_RING_OFFSET(hd_txmd), RTW_RING_BASE(sc, hd_txmd));
   3941       1.1   dyoung 
   3942       1.1   dyoung 	rtw_txdesc_blk_setup(&sc->sc_txdesc_blk[RTW_TXPRIHI],
   3943       1.1   dyoung 	    &sc->sc_descs->hd_txhi[0], RTW_NTXDESCHI,
   3944       1.1   dyoung 	    RTW_RING_OFFSET(hd_txhi), RTW_RING_BASE(sc, hd_txhi));
   3945       1.1   dyoung 
   3946       1.1   dyoung 	rtw_txdesc_blk_setup(&sc->sc_txdesc_blk[RTW_TXPRIBCN],
   3947       1.1   dyoung 	    &sc->sc_descs->hd_bcn[0], RTW_NTXDESCBCN,
   3948       1.1   dyoung 	    RTW_RING_OFFSET(hd_bcn), RTW_RING_BASE(sc, hd_bcn));
   3949       1.1   dyoung }
   3950       1.1   dyoung 
   3951       1.1   dyoung static struct rtw_rf *
   3952      1.42   dyoung rtw_rf_attach(struct rtw_softc *sc, enum rtw_rfchipid rfchipid, int digphy)
   3953       1.1   dyoung {
   3954      1.42   dyoung 	rtw_rf_write_t rf_write;
   3955       1.1   dyoung 	struct rtw_rf *rf;
   3956       1.1   dyoung 
   3957       1.1   dyoung 	switch (rfchipid) {
   3958      1.42   dyoung 	default:
   3959      1.42   dyoung 		rf_write = rtw_rf_hostwrite;
   3960      1.42   dyoung 		break;
   3961      1.42   dyoung 	case RTW_RFCHIPID_INTERSIL:
   3962      1.42   dyoung 	case RTW_RFCHIPID_PHILIPS:
   3963      1.42   dyoung 	case RTW_RFCHIPID_GCT:	/* XXX a guess */
   3964      1.42   dyoung 	case RTW_RFCHIPID_RFMD:
   3965      1.42   dyoung 		rf_write = (rtw_host_rfio) ? rtw_rf_hostwrite : rtw_rf_macwrite;
   3966      1.42   dyoung 		break;
   3967      1.42   dyoung 	}
   3968      1.42   dyoung 
   3969      1.42   dyoung 	switch (rfchipid) {
   3970      1.64   dyoung 	case RTW_RFCHIPID_GCT:
   3971      1.64   dyoung 		rf = rtw_grf5101_create(&sc->sc_regs, rf_write, 0);
   3972      1.64   dyoung 		sc->sc_pwrstate_cb = rtw_maxim_pwrstate;
   3973      1.64   dyoung 		break;
   3974       1.1   dyoung 	case RTW_RFCHIPID_MAXIM:
   3975       1.1   dyoung 		rf = rtw_max2820_create(&sc->sc_regs, rf_write, 0);
   3976       1.1   dyoung 		sc->sc_pwrstate_cb = rtw_maxim_pwrstate;
   3977       1.1   dyoung 		break;
   3978       1.1   dyoung 	case RTW_RFCHIPID_PHILIPS:
   3979       1.1   dyoung 		rf = rtw_sa2400_create(&sc->sc_regs, rf_write, digphy);
   3980       1.1   dyoung 		sc->sc_pwrstate_cb = rtw_philips_pwrstate;
   3981       1.1   dyoung 		break;
   3982      1.10   dyoung 	case RTW_RFCHIPID_RFMD:
   3983      1.10   dyoung 		/* XXX RFMD has no RF constructor */
   3984      1.10   dyoung 		sc->sc_pwrstate_cb = rtw_rfmd_pwrstate;
   3985      1.10   dyoung 		/*FALLTHROUGH*/
   3986       1.1   dyoung 	default:
   3987       1.1   dyoung 		return NULL;
   3988       1.1   dyoung 	}
   3989       1.1   dyoung 	rf->rf_continuous_tx_cb =
   3990       1.1   dyoung 	    (rtw_continuous_tx_cb_t)rtw_continuous_tx_enable;
   3991       1.1   dyoung 	rf->rf_continuous_tx_arg = (void *)sc;
   3992       1.1   dyoung 	return rf;
   3993       1.1   dyoung }
   3994       1.1   dyoung 
   3995       1.1   dyoung /* Revision C and later use a different PHY delay setting than
   3996       1.1   dyoung  * revisions A and B.
   3997       1.1   dyoung  */
   3998      1.37   dyoung static uint8_t
   3999      1.46   dyoung rtw_check_phydelay(struct rtw_regs *regs, uint32_t old_rcr)
   4000       1.1   dyoung {
   4001       1.1   dyoung #define REVAB (RTW_RCR_MXDMA_UNLIMITED | RTW_RCR_AICV)
   4002       1.1   dyoung #define REVC (REVAB | RTW_RCR_RXFTH_WHOLE)
   4003       1.1   dyoung 
   4004      1.37   dyoung 	uint8_t phydelay = LSHIFT(0x6, RTW_PHYDELAY_PHYDELAY);
   4005       1.1   dyoung 
   4006       1.1   dyoung 	RTW_WRITE(regs, RTW_RCR, REVAB);
   4007       1.8   dyoung 	RTW_WBW(regs, RTW_RCR, RTW_RCR);
   4008       1.1   dyoung 	RTW_WRITE(regs, RTW_RCR, REVC);
   4009       1.1   dyoung 
   4010       1.1   dyoung 	RTW_WBR(regs, RTW_RCR, RTW_RCR);
   4011       1.1   dyoung 	if ((RTW_READ(regs, RTW_RCR) & REVC) == REVC)
   4012       1.1   dyoung 		phydelay |= RTW_PHYDELAY_REVC_MAGIC;
   4013       1.1   dyoung 
   4014      1.46   dyoung 	RTW_WRITE(regs, RTW_RCR, old_rcr);	/* restore RCR */
   4015       1.8   dyoung 	RTW_SYNC(regs, RTW_RCR, RTW_RCR);
   4016       1.1   dyoung 
   4017       1.1   dyoung 	return phydelay;
   4018       1.1   dyoung #undef REVC
   4019       1.1   dyoung }
   4020       1.1   dyoung 
   4021       1.1   dyoung void
   4022       1.1   dyoung rtw_attach(struct rtw_softc *sc)
   4023       1.1   dyoung {
   4024      1.48   dyoung 	struct ifnet *ifp = &sc->sc_if;
   4025      1.53   dyoung 	struct ieee80211com *ic = &sc->sc_ic;
   4026      1.34   dyoung 	struct rtw_txsoft_blk *tsb;
   4027      1.42   dyoung 	int pri, rc;
   4028       1.1   dyoung 
   4029      1.58   dyoung 	rtw_cipher_wep = ieee80211_cipher_wep;
   4030      1.58   dyoung 	rtw_cipher_wep.ic_decap = rtw_wep_decap;
   4031      1.58   dyoung 
   4032       1.1   dyoung 	NEXT_ATTACH_STATE(sc, DETACHED);
   4033       1.1   dyoung 
   4034       1.1   dyoung 	switch (RTW_READ(&sc->sc_regs, RTW_TCR) & RTW_TCR_HWVERID_MASK) {
   4035       1.1   dyoung 	case RTW_TCR_HWVERID_F:
   4036      1.42   dyoung 		sc->sc_hwverid = 'F';
   4037       1.1   dyoung 		break;
   4038       1.1   dyoung 	case RTW_TCR_HWVERID_D:
   4039      1.42   dyoung 		sc->sc_hwverid = 'D';
   4040       1.1   dyoung 		break;
   4041       1.1   dyoung 	default:
   4042      1.42   dyoung 		sc->sc_hwverid = '?';
   4043       1.1   dyoung 		break;
   4044       1.1   dyoung 	}
   4045      1.42   dyoung 	printf("%s: hardware version %c\n", sc->sc_dev.dv_xname,
   4046      1.42   dyoung 	    sc->sc_hwverid);
   4047       1.1   dyoung 
   4048       1.1   dyoung 	rc = bus_dmamem_alloc(sc->sc_dmat, sizeof(struct rtw_descs),
   4049       1.1   dyoung 	    RTW_DESC_ALIGNMENT, 0, &sc->sc_desc_segs, 1, &sc->sc_desc_nsegs,
   4050       1.1   dyoung 	    0);
   4051       1.1   dyoung 
   4052       1.1   dyoung 	if (rc != 0) {
   4053       1.1   dyoung 		printf("%s: could not allocate hw descriptors, error %d\n",
   4054       1.1   dyoung 		     sc->sc_dev.dv_xname, rc);
   4055       1.1   dyoung 		goto err;
   4056       1.1   dyoung 	}
   4057       1.1   dyoung 
   4058       1.1   dyoung 	NEXT_ATTACH_STATE(sc, FINISH_DESC_ALLOC);
   4059       1.1   dyoung 
   4060       1.1   dyoung 	rc = bus_dmamem_map(sc->sc_dmat, &sc->sc_desc_segs,
   4061       1.1   dyoung 	    sc->sc_desc_nsegs, sizeof(struct rtw_descs),
   4062       1.1   dyoung 	    (caddr_t*)&sc->sc_descs, BUS_DMA_COHERENT);
   4063       1.1   dyoung 
   4064       1.1   dyoung 	if (rc != 0) {
   4065       1.1   dyoung 		printf("%s: could not map hw descriptors, error %d\n",
   4066       1.1   dyoung 		    sc->sc_dev.dv_xname, rc);
   4067       1.1   dyoung 		goto err;
   4068       1.1   dyoung 	}
   4069       1.1   dyoung 	NEXT_ATTACH_STATE(sc, FINISH_DESC_MAP);
   4070       1.1   dyoung 
   4071       1.1   dyoung 	rc = bus_dmamap_create(sc->sc_dmat, sizeof(struct rtw_descs), 1,
   4072       1.1   dyoung 	    sizeof(struct rtw_descs), 0, 0, &sc->sc_desc_dmamap);
   4073       1.1   dyoung 
   4074       1.1   dyoung 	if (rc != 0) {
   4075       1.1   dyoung 		printf("%s: could not create DMA map for hw descriptors, "
   4076       1.1   dyoung 		    "error %d\n", sc->sc_dev.dv_xname, rc);
   4077       1.1   dyoung 		goto err;
   4078       1.1   dyoung 	}
   4079       1.1   dyoung 	NEXT_ATTACH_STATE(sc, FINISH_DESCMAP_CREATE);
   4080       1.1   dyoung 
   4081      1.34   dyoung 	sc->sc_rxdesc_blk.rdb_dmat = sc->sc_dmat;
   4082      1.34   dyoung 	sc->sc_rxdesc_blk.rdb_dmamap = sc->sc_desc_dmamap;
   4083      1.33   dyoung 
   4084      1.33   dyoung 	for (pri = 0; pri < RTW_NTXPRI; pri++) {
   4085      1.34   dyoung 		sc->sc_txdesc_blk[pri].tdb_dmat = sc->sc_dmat;
   4086      1.34   dyoung 		sc->sc_txdesc_blk[pri].tdb_dmamap = sc->sc_desc_dmamap;
   4087      1.33   dyoung 	}
   4088      1.33   dyoung 
   4089       1.1   dyoung 	rc = bus_dmamap_load(sc->sc_dmat, sc->sc_desc_dmamap, sc->sc_descs,
   4090       1.1   dyoung 	    sizeof(struct rtw_descs), NULL, 0);
   4091       1.1   dyoung 
   4092       1.1   dyoung 	if (rc != 0) {
   4093       1.1   dyoung 		printf("%s: could not load DMA map for hw descriptors, "
   4094       1.1   dyoung 		    "error %d\n", sc->sc_dev.dv_xname, rc);
   4095       1.1   dyoung 		goto err;
   4096       1.1   dyoung 	}
   4097       1.1   dyoung 	NEXT_ATTACH_STATE(sc, FINISH_DESCMAP_LOAD);
   4098       1.1   dyoung 
   4099      1.34   dyoung 	if (rtw_txsoft_blk_setup_all(sc) != 0)
   4100       1.1   dyoung 		goto err;
   4101       1.1   dyoung 	NEXT_ATTACH_STATE(sc, FINISH_TXCTLBLK_SETUP);
   4102       1.1   dyoung 
   4103       1.1   dyoung 	rtw_txdesc_blk_setup_all(sc);
   4104       1.1   dyoung 
   4105       1.1   dyoung 	NEXT_ATTACH_STATE(sc, FINISH_TXDESCBLK_SETUP);
   4106       1.1   dyoung 
   4107      1.34   dyoung 	sc->sc_rxdesc_blk.rdb_desc = &sc->sc_descs->hd_rx[0];
   4108       1.1   dyoung 
   4109       1.1   dyoung 	for (pri = 0; pri < RTW_NTXPRI; pri++) {
   4110      1.34   dyoung 		tsb = &sc->sc_txsoft_blk[pri];
   4111       1.1   dyoung 
   4112       1.1   dyoung 		if ((rc = rtw_txdesc_dmamaps_create(sc->sc_dmat,
   4113      1.34   dyoung 		    &tsb->tsb_desc[0], tsb->tsb_ndesc)) != 0) {
   4114       1.1   dyoung 			printf("%s: could not load DMA map for "
   4115       1.1   dyoung 			    "hw tx descriptors, error %d\n",
   4116       1.1   dyoung 			    sc->sc_dev.dv_xname, rc);
   4117       1.1   dyoung 			goto err;
   4118       1.1   dyoung 		}
   4119       1.1   dyoung 	}
   4120       1.1   dyoung 
   4121       1.1   dyoung 	NEXT_ATTACH_STATE(sc, FINISH_TXMAPS_CREATE);
   4122      1.34   dyoung 	if ((rc = rtw_rxdesc_dmamaps_create(sc->sc_dmat, &sc->sc_rxsoft[0],
   4123       1.1   dyoung 	                                    RTW_RXQLEN)) != 0) {
   4124       1.1   dyoung 		printf("%s: could not load DMA map for hw rx descriptors, "
   4125       1.1   dyoung 		    "error %d\n", sc->sc_dev.dv_xname, rc);
   4126       1.1   dyoung 		goto err;
   4127       1.1   dyoung 	}
   4128       1.1   dyoung 	NEXT_ATTACH_STATE(sc, FINISH_RXMAPS_CREATE);
   4129       1.1   dyoung 
   4130       1.1   dyoung 	/* Reset the chip to a known state. */
   4131       1.1   dyoung 	if (rtw_reset(sc) != 0)
   4132       1.1   dyoung 		goto err;
   4133       1.1   dyoung 	NEXT_ATTACH_STATE(sc, FINISH_RESET);
   4134       1.1   dyoung 
   4135       1.1   dyoung 	sc->sc_rcr = RTW_READ(&sc->sc_regs, RTW_RCR);
   4136       1.1   dyoung 
   4137       1.1   dyoung 	if ((sc->sc_rcr & RTW_RCR_9356SEL) != 0)
   4138       1.1   dyoung 		sc->sc_flags |= RTW_F_9356SROM;
   4139       1.1   dyoung 
   4140       1.1   dyoung 	if (rtw_srom_read(&sc->sc_regs, sc->sc_flags, &sc->sc_srom,
   4141       1.7   dyoung 	    sc->sc_dev.dv_xname) != 0)
   4142       1.1   dyoung 		goto err;
   4143       1.1   dyoung 
   4144       1.1   dyoung 	NEXT_ATTACH_STATE(sc, FINISH_READ_SROM);
   4145       1.1   dyoung 
   4146       1.1   dyoung 	if (rtw_srom_parse(&sc->sc_srom, &sc->sc_flags, &sc->sc_csthr,
   4147       1.1   dyoung 	    &sc->sc_rfchipid, &sc->sc_rcr, &sc->sc_locale,
   4148       1.7   dyoung 	    sc->sc_dev.dv_xname) != 0) {
   4149       1.1   dyoung 		printf("%s: attach failed, malformed serial ROM\n",
   4150       1.1   dyoung 		    sc->sc_dev.dv_xname);
   4151       1.1   dyoung 		goto err;
   4152       1.1   dyoung 	}
   4153       1.1   dyoung 
   4154      1.10   dyoung 	printf("%s: %s PHY\n", sc->sc_dev.dv_xname,
   4155      1.10   dyoung 	    ((sc->sc_flags & RTW_F_DIGPHY) != 0) ? "digital" : "analog");
   4156      1.10   dyoung 
   4157      1.10   dyoung 	printf("%s: CS threshold %u\n", sc->sc_dev.dv_xname, sc->sc_csthr);
   4158       1.1   dyoung 
   4159       1.1   dyoung 	NEXT_ATTACH_STATE(sc, FINISH_PARSE_SROM);
   4160       1.1   dyoung 
   4161      1.42   dyoung 	sc->sc_rf = rtw_rf_attach(sc, sc->sc_rfchipid,
   4162       1.1   dyoung 	    sc->sc_flags & RTW_F_DIGPHY);
   4163       1.1   dyoung 
   4164       1.1   dyoung 	if (sc->sc_rf == NULL) {
   4165       1.1   dyoung 		printf("%s: attach failed, could not attach RF\n",
   4166       1.1   dyoung 		    sc->sc_dev.dv_xname);
   4167       1.1   dyoung 		goto err;
   4168       1.1   dyoung 	}
   4169       1.1   dyoung 
   4170       1.1   dyoung 	NEXT_ATTACH_STATE(sc, FINISH_RF_ATTACH);
   4171       1.1   dyoung 
   4172       1.1   dyoung 	sc->sc_phydelay = rtw_check_phydelay(&sc->sc_regs, sc->sc_rcr);
   4173       1.1   dyoung 
   4174      1.21   dyoung 	RTW_DPRINTF(RTW_DEBUG_ATTACH,
   4175      1.21   dyoung 	    ("%s: PHY delay %d\n", sc->sc_dev.dv_xname, sc->sc_phydelay));
   4176       1.1   dyoung 
   4177       1.1   dyoung 	if (sc->sc_locale == RTW_LOCALE_UNKNOWN)
   4178      1.58   dyoung 		rtw_identify_country(&sc->sc_regs, &sc->sc_locale);
   4179       1.1   dyoung 
   4180       1.1   dyoung 	rtw_init_channels(sc->sc_locale, &sc->sc_ic.ic_channels,
   4181       1.7   dyoung 	    sc->sc_dev.dv_xname);
   4182       1.1   dyoung 
   4183       1.1   dyoung 	if (rtw_identify_sta(&sc->sc_regs, &sc->sc_ic.ic_myaddr,
   4184       1.7   dyoung 	    sc->sc_dev.dv_xname) != 0)
   4185       1.1   dyoung 		goto err;
   4186       1.1   dyoung 	NEXT_ATTACH_STATE(sc, FINISH_ID_STA);
   4187       1.1   dyoung 
   4188      1.48   dyoung 	rtw_setifprops(ifp, sc->sc_dev.dv_xname, (void*)sc);
   4189       1.1   dyoung 
   4190      1.56      gdt 	IFQ_SET_READY(&ifp->if_snd);
   4191       1.1   dyoung 
   4192      1.48   dyoung 	sc->sc_ic.ic_ifp = ifp;
   4193       1.1   dyoung 	rtw_set80211props(&sc->sc_ic);
   4194       1.1   dyoung 
   4195      1.45   dyoung 	rtw_led_attach(&sc->sc_led_state, (void *)sc);
   4196      1.42   dyoung 
   4197       1.1   dyoung 	/*
   4198       1.1   dyoung 	 * Call MI attach routines.
   4199       1.1   dyoung 	 */
   4200      1.48   dyoung 	if_attach(ifp);
   4201      1.48   dyoung 	ieee80211_ifattach(&sc->sc_ic);
   4202       1.1   dyoung 
   4203       1.1   dyoung 	rtw_set80211methods(&sc->sc_mtbl, &sc->sc_ic);
   4204       1.1   dyoung 
   4205       1.1   dyoung 	/* possibly we should fill in our own sc_send_prresp, since
   4206       1.1   dyoung 	 * the RTL8180 is probably sending probe responses in ad hoc
   4207       1.1   dyoung 	 * mode.
   4208       1.1   dyoung 	 */
   4209       1.1   dyoung 
   4210       1.1   dyoung 	/* complete initialization */
   4211      1.48   dyoung 	ieee80211_media_init(&sc->sc_ic, rtw_media_change, rtw_media_status);
   4212       1.1   dyoung 	callout_init(&sc->sc_scan_ch);
   4213       1.1   dyoung 
   4214      1.32   dyoung 	rtw_init_radiotap(sc);
   4215      1.32   dyoung 
   4216       1.1   dyoung #if NBPFILTER > 0
   4217      1.48   dyoung 	bpfattach2(ifp, DLT_IEEE802_11_RADIO,
   4218       1.1   dyoung 	    sizeof(struct ieee80211_frame) + 64, &sc->sc_radiobpf);
   4219       1.1   dyoung #endif
   4220       1.1   dyoung 
   4221       1.7   dyoung 	rtw_establish_hooks(&sc->sc_hooks, sc->sc_dev.dv_xname, (void*)sc);
   4222       1.1   dyoung 
   4223       1.1   dyoung 	NEXT_ATTACH_STATE(sc, FINISHED);
   4224       1.1   dyoung 
   4225      1.52   dyoung 	ieee80211_announce(ic);
   4226       1.1   dyoung 	return;
   4227       1.1   dyoung err:
   4228       1.1   dyoung 	rtw_detach(sc);
   4229       1.1   dyoung 	return;
   4230       1.1   dyoung }
   4231       1.1   dyoung 
   4232       1.1   dyoung int
   4233       1.1   dyoung rtw_detach(struct rtw_softc *sc)
   4234       1.1   dyoung {
   4235      1.48   dyoung 	struct ifnet *ifp = &sc->sc_if;
   4236       1.1   dyoung 	int pri;
   4237       1.1   dyoung 
   4238      1.36   dyoung 	sc->sc_flags |= RTW_F_INVALID;
   4239      1.36   dyoung 
   4240       1.1   dyoung 	switch (sc->sc_attach_state) {
   4241       1.1   dyoung 	case FINISHED:
   4242      1.48   dyoung 		rtw_stop(ifp, 1);
   4243       1.3   dyoung 
   4244       1.7   dyoung 		rtw_disestablish_hooks(&sc->sc_hooks, sc->sc_dev.dv_xname,
   4245       1.1   dyoung 		    (void*)sc);
   4246       1.1   dyoung 		callout_stop(&sc->sc_scan_ch);
   4247      1.48   dyoung 		ieee80211_ifdetach(&sc->sc_ic);
   4248      1.48   dyoung 		if_detach(ifp);
   4249       1.1   dyoung 		break;
   4250       1.1   dyoung 	case FINISH_ID_STA:
   4251       1.1   dyoung 	case FINISH_RF_ATTACH:
   4252       1.1   dyoung 		rtw_rf_destroy(sc->sc_rf);
   4253       1.1   dyoung 		sc->sc_rf = NULL;
   4254       1.1   dyoung 		/*FALLTHROUGH*/
   4255       1.1   dyoung 	case FINISH_PARSE_SROM:
   4256       1.1   dyoung 	case FINISH_READ_SROM:
   4257       1.1   dyoung 		rtw_srom_free(&sc->sc_srom);
   4258       1.1   dyoung 		/*FALLTHROUGH*/
   4259       1.1   dyoung 	case FINISH_RESET:
   4260       1.1   dyoung 	case FINISH_RXMAPS_CREATE:
   4261      1.34   dyoung 		rtw_rxdesc_dmamaps_destroy(sc->sc_dmat, &sc->sc_rxsoft[0],
   4262       1.1   dyoung 		    RTW_RXQLEN);
   4263       1.1   dyoung 		/*FALLTHROUGH*/
   4264       1.1   dyoung 	case FINISH_TXMAPS_CREATE:
   4265       1.1   dyoung 		for (pri = 0; pri < RTW_NTXPRI; pri++) {
   4266       1.1   dyoung 			rtw_txdesc_dmamaps_destroy(sc->sc_dmat,
   4267      1.34   dyoung 			    sc->sc_txsoft_blk[pri].tsb_desc,
   4268      1.34   dyoung 			    sc->sc_txsoft_blk[pri].tsb_ndesc);
   4269       1.1   dyoung 		}
   4270       1.1   dyoung 		/*FALLTHROUGH*/
   4271       1.1   dyoung 	case FINISH_TXDESCBLK_SETUP:
   4272       1.1   dyoung 	case FINISH_TXCTLBLK_SETUP:
   4273      1.34   dyoung 		rtw_txsoft_blk_cleanup_all(sc);
   4274       1.1   dyoung 		/*FALLTHROUGH*/
   4275       1.1   dyoung 	case FINISH_DESCMAP_LOAD:
   4276       1.1   dyoung 		bus_dmamap_unload(sc->sc_dmat, sc->sc_desc_dmamap);
   4277       1.1   dyoung 		/*FALLTHROUGH*/
   4278       1.1   dyoung 	case FINISH_DESCMAP_CREATE:
   4279       1.1   dyoung 		bus_dmamap_destroy(sc->sc_dmat, sc->sc_desc_dmamap);
   4280       1.1   dyoung 		/*FALLTHROUGH*/
   4281       1.1   dyoung 	case FINISH_DESC_MAP:
   4282       1.1   dyoung 		bus_dmamem_unmap(sc->sc_dmat, (caddr_t)sc->sc_descs,
   4283       1.1   dyoung 		    sizeof(struct rtw_descs));
   4284       1.1   dyoung 		/*FALLTHROUGH*/
   4285       1.1   dyoung 	case FINISH_DESC_ALLOC:
   4286       1.1   dyoung 		bus_dmamem_free(sc->sc_dmat, &sc->sc_desc_segs,
   4287       1.1   dyoung 		    sc->sc_desc_nsegs);
   4288       1.1   dyoung 		/*FALLTHROUGH*/
   4289       1.1   dyoung 	case DETACHED:
   4290       1.1   dyoung 		NEXT_ATTACH_STATE(sc, DETACHED);
   4291       1.1   dyoung 		break;
   4292       1.1   dyoung 	}
   4293       1.1   dyoung 	return 0;
   4294       1.1   dyoung }
   4295       1.1   dyoung 
   4296       1.1   dyoung int
   4297       1.1   dyoung rtw_activate(struct device *self, enum devact act)
   4298       1.1   dyoung {
   4299       1.1   dyoung 	struct rtw_softc *sc = (struct rtw_softc *)self;
   4300       1.1   dyoung 	int rc = 0, s;
   4301       1.1   dyoung 
   4302       1.1   dyoung 	s = splnet();
   4303       1.1   dyoung 	switch (act) {
   4304       1.1   dyoung 	case DVACT_ACTIVATE:
   4305       1.1   dyoung 		rc = EOPNOTSUPP;
   4306       1.1   dyoung 		break;
   4307       1.1   dyoung 
   4308       1.1   dyoung 	case DVACT_DEACTIVATE:
   4309      1.48   dyoung 		if_deactivate(&sc->sc_if);
   4310       1.1   dyoung 		break;
   4311       1.1   dyoung 	}
   4312       1.1   dyoung 	splx(s);
   4313       1.1   dyoung 	return rc;
   4314       1.1   dyoung }
   4315