Home | History | Annotate | Line # | Download | only in ic
awi.c revision 1.52.2.5
      1  1.52.2.5     skrll /*	$NetBSD: awi.c,v 1.52.2.5 2004/11/02 07:51:30 skrll Exp $	*/
      2       1.3  sommerfe 
      3      1.19      onoe /*-
      4      1.37      onoe  * Copyright (c) 1999,2000,2001 The NetBSD Foundation, Inc.
      5       1.1  sommerfe  * All rights reserved.
      6       1.1  sommerfe  *
      7       1.1  sommerfe  * This code is derived from software contributed to The NetBSD Foundation
      8      1.19      onoe  * by Bill Sommerfeld
      9       1.1  sommerfe  *
     10       1.1  sommerfe  * Redistribution and use in source and binary forms, with or without
     11       1.1  sommerfe  * modification, are permitted provided that the following conditions
     12       1.1  sommerfe  * are met:
     13       1.1  sommerfe  * 1. Redistributions of source code must retain the above copyright
     14       1.1  sommerfe  *    notice, this list of conditions and the following disclaimer.
     15       1.1  sommerfe  * 2. Redistributions in binary form must reproduce the above copyright
     16       1.1  sommerfe  *    notice, this list of conditions and the following disclaimer in the
     17       1.1  sommerfe  *    documentation and/or other materials provided with the distribution.
     18       1.1  sommerfe  * 3. All advertising materials mentioning features or use of this software
     19       1.1  sommerfe  *    must display the following acknowledgement:
     20      1.19      onoe  *        This product includes software developed by the NetBSD
     21      1.19      onoe  *        Foundation, Inc. and its contributors.
     22       1.1  sommerfe  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23       1.1  sommerfe  *    contributors may be used to endorse or promote products derived
     24       1.1  sommerfe  *    from this software without specific prior written permission.
     25       1.1  sommerfe  *
     26       1.1  sommerfe  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27       1.1  sommerfe  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28       1.1  sommerfe  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29       1.1  sommerfe  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30       1.1  sommerfe  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31       1.1  sommerfe  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32       1.1  sommerfe  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33       1.1  sommerfe  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34       1.1  sommerfe  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35       1.1  sommerfe  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36       1.1  sommerfe  * POSSIBILITY OF SUCH DAMAGE.
     37       1.1  sommerfe  */
     38      1.19      onoe /*
     39      1.19      onoe  * Driver for AMD 802.11 firmware.
     40      1.19      onoe  * Uses am79c930 chip driver to talk to firmware running on the am79c930.
     41      1.19      onoe  *
     42      1.19      onoe  * More-or-less a generic ethernet-like if driver, with 802.11 gorp added.
     43      1.19      onoe  */
     44      1.19      onoe 
     45      1.19      onoe /*
     46      1.19      onoe  * todo:
     47      1.19      onoe  *	- flush tx queue on resynch.
     48      1.19      onoe  *	- clear oactive on "down".
     49      1.19      onoe  *	- rewrite copy-into-mbuf code
     50      1.19      onoe  *	- mgmt state machine gets stuck retransmitting assoc requests.
     51      1.19      onoe  *	- multicast filter.
     52      1.19      onoe  *	- fix device reset so it's more likely to work
     53      1.19      onoe  *	- show status goo through ifmedia.
     54      1.19      onoe  *
     55      1.19      onoe  * more todo:
     56      1.19      onoe  *	- deal with more 802.11 frames.
     57      1.19      onoe  *		- send reassoc request
     58      1.19      onoe  *		- deal with reassoc response
     59      1.19      onoe  *		- send/deal with disassociation
     60      1.19      onoe  *	- deal with "full" access points (no room for me).
     61      1.19      onoe  *	- power save mode
     62      1.19      onoe  *
     63      1.19      onoe  * later:
     64      1.19      onoe  *	- SSID preferences
     65      1.19      onoe  *	- need ioctls for poking at the MIBs
     66      1.19      onoe  *	- implement ad-hoc mode (including bss creation).
     67      1.19      onoe  *	- decide when to do "ad hoc" vs. infrastructure mode (IFF_LINK flags?)
     68      1.19      onoe  *		(focus on inf. mode since that will be needed for ietf)
     69      1.19      onoe  *	- deal with DH vs. FH versions of the card
     70      1.19      onoe  *	- deal with faster cards (2mb/s)
     71      1.19      onoe  *	- ?WEP goo (mmm, rc4) (it looks not particularly useful).
     72      1.19      onoe  *	- ifmedia revision.
     73      1.19      onoe  *	- common 802.11 mibish things.
     74      1.19      onoe  *	- common 802.11 media layer.
     75      1.19      onoe  */
     76      1.10      onoe 
     77       1.1  sommerfe /*
     78      1.10      onoe  * Driver for AMD 802.11 PCnetMobile firmware.
     79       1.1  sommerfe  * Uses am79c930 chip driver to talk to firmware running on the am79c930.
     80       1.1  sommerfe  *
     81      1.10      onoe  * The initial version of the driver was written by
     82  1.52.2.1     skrll  * Bill Sommerfeld <sommerfeld (at) NetBSD.org>.
     83      1.10      onoe  * Then the driver module completely rewritten to support cards with DS phy
     84  1.52.2.1     skrll  * and to support adhoc mode by Atsushi Onoe <onoe (at) NetBSD.org>
     85       1.1  sommerfe  */
     86      1.41     lukem 
     87      1.41     lukem #include <sys/cdefs.h>
     88  1.52.2.1     skrll #ifdef __NetBSD__
     89  1.52.2.5     skrll __KERNEL_RCSID(0, "$NetBSD: awi.c,v 1.52.2.5 2004/11/02 07:51:30 skrll Exp $");
     90  1.52.2.1     skrll #endif
     91  1.52.2.1     skrll #ifdef __FreeBSD__
     92  1.52.2.1     skrll __FBSDID("$FreeBSD: src/sys/dev/awi/awi.c,v 1.30 2004/01/15 13:30:06 onoe Exp $");
     93  1.52.2.1     skrll #endif
     94       1.1  sommerfe 
     95       1.1  sommerfe #include "opt_inet.h"
     96  1.52.2.1     skrll #ifdef __NetBSD__
     97      1.10      onoe #include "bpfilter.h"
     98  1.52.2.1     skrll #endif
     99  1.52.2.1     skrll #ifdef __FreeBSD__
    100  1.52.2.1     skrll #define	NBPFILTER	1
    101  1.52.2.1     skrll #endif
    102       1.1  sommerfe 
    103       1.1  sommerfe #include <sys/param.h>
    104       1.1  sommerfe #include <sys/systm.h>
    105       1.1  sommerfe #include <sys/kernel.h>
    106       1.1  sommerfe #include <sys/mbuf.h>
    107      1.10      onoe #include <sys/malloc.h>
    108      1.10      onoe #include <sys/proc.h>
    109       1.1  sommerfe #include <sys/socket.h>
    110      1.10      onoe #include <sys/sockio.h>
    111       1.1  sommerfe #include <sys/errno.h>
    112  1.52.2.1     skrll #include <sys/endian.h>
    113  1.52.2.1     skrll #ifdef __FreeBSD__
    114  1.52.2.1     skrll #include <sys/bus.h>
    115  1.52.2.1     skrll #endif
    116  1.52.2.1     skrll #ifdef __NetBSD__
    117       1.1  sommerfe #include <sys/device.h>
    118  1.52.2.1     skrll #endif
    119       1.1  sommerfe 
    120       1.1  sommerfe #include <net/if.h>
    121       1.1  sommerfe #include <net/if_dl.h>
    122  1.52.2.1     skrll #ifdef __NetBSD__
    123       1.1  sommerfe #include <net/if_ether.h>
    124  1.52.2.1     skrll #endif
    125  1.52.2.1     skrll #ifdef __FreeBSD__
    126  1.52.2.1     skrll #include <net/ethernet.h>
    127  1.52.2.1     skrll #include <net/if_arp.h>
    128  1.52.2.1     skrll #endif
    129       1.1  sommerfe #include <net/if_media.h>
    130      1.10      onoe #include <net/if_llc.h>
    131       1.1  sommerfe 
    132  1.52.2.1     skrll #include <net80211/ieee80211_var.h>
    133      1.10      onoe #ifdef __NetBSD__
    134  1.52.2.1     skrll #include <net80211/ieee80211_compat.h>
    135       1.1  sommerfe #endif
    136       1.1  sommerfe 
    137       1.1  sommerfe #if NBPFILTER > 0
    138       1.1  sommerfe #include <net/bpf.h>
    139       1.1  sommerfe #endif
    140       1.1  sommerfe 
    141       1.1  sommerfe #include <machine/cpu.h>
    142       1.1  sommerfe #include <machine/bus.h>
    143       1.1  sommerfe 
    144  1.52.2.1     skrll #ifdef __NetBSD__
    145       1.1  sommerfe #include <dev/ic/am79c930reg.h>
    146       1.1  sommerfe #include <dev/ic/am79c930var.h>
    147       1.1  sommerfe #include <dev/ic/awireg.h>
    148       1.1  sommerfe #include <dev/ic/awivar.h>
    149  1.52.2.1     skrll #endif
    150  1.52.2.1     skrll #ifdef __FreeBSD__
    151  1.52.2.1     skrll #include <dev/awi/am79c930reg.h>
    152  1.52.2.1     skrll #include <dev/awi/am79c930var.h>
    153  1.52.2.1     skrll #include <dev/awi/awireg.h>
    154  1.52.2.1     skrll #include <dev/awi/awivar.h>
    155  1.52.2.1     skrll #endif
    156      1.10      onoe 
    157  1.52.2.1     skrll #ifdef __FreeBSD__
    158  1.52.2.1     skrll static void awi_init0(void *);
    159  1.52.2.1     skrll #endif
    160      1.37      onoe static int  awi_init(struct ifnet *);
    161      1.37      onoe static void awi_stop(struct ifnet *, int);
    162      1.37      onoe static void awi_start(struct ifnet *);
    163      1.37      onoe static void awi_watchdog(struct ifnet *);
    164      1.37      onoe static int  awi_ioctl(struct ifnet *, u_long, caddr_t);
    165      1.37      onoe static int  awi_media_change(struct ifnet *);
    166      1.37      onoe static void awi_media_status(struct ifnet *, struct ifmediareq *);
    167      1.37      onoe static int  awi_mode_init(struct awi_softc *);
    168      1.37      onoe static void awi_rx_int(struct awi_softc *);
    169      1.37      onoe static void awi_tx_int(struct awi_softc *);
    170      1.37      onoe static struct mbuf *awi_devget(struct awi_softc *, u_int32_t, u_int16_t);
    171      1.37      onoe static int  awi_hw_init(struct awi_softc *);
    172      1.37      onoe static int  awi_init_mibs(struct awi_softc *);
    173      1.37      onoe static int  awi_mib(struct awi_softc *, u_int8_t, u_int8_t, int);
    174      1.37      onoe static int  awi_cmd(struct awi_softc *, u_int8_t, int);
    175      1.37      onoe static int  awi_cmd_wait(struct awi_softc *);
    176      1.37      onoe static void awi_cmd_done(struct awi_softc *);
    177      1.37      onoe static int  awi_next_txd(struct awi_softc *, int, u_int32_t *, u_int32_t *);
    178      1.37      onoe static int  awi_lock(struct awi_softc *);
    179      1.37      onoe static void awi_unlock(struct awi_softc *);
    180      1.37      onoe static int  awi_intr_lock(struct awi_softc *);
    181      1.37      onoe static void awi_intr_unlock(struct awi_softc *);
    182  1.52.2.1     skrll static int  awi_newstate(struct ieee80211com *, enum ieee80211_state, int);
    183  1.52.2.1     skrll static void awi_recv_mgmt(struct ieee80211com *, struct mbuf *,
    184  1.52.2.1     skrll     struct ieee80211_node *, int, int, u_int32_t);
    185  1.52.2.1     skrll static int  awi_send_mgmt(struct ieee80211com *, struct ieee80211_node *, int,
    186  1.52.2.1     skrll     int);
    187      1.37      onoe static struct mbuf *awi_ether_encap(struct awi_softc *, struct mbuf *);
    188      1.37      onoe static struct mbuf *awi_ether_modcap(struct awi_softc *, struct mbuf *);
    189      1.37      onoe 
    190  1.52.2.1     skrll /* unaligned little endian access */
    191      1.37      onoe #define LE_READ_2(p)							\
    192      1.37      onoe 	((((u_int8_t *)(p))[0]      ) | (((u_int8_t *)(p))[1] <<  8))
    193      1.37      onoe #define LE_READ_4(p)							\
    194      1.37      onoe 	((((u_int8_t *)(p))[0]      ) | (((u_int8_t *)(p))[1] <<  8) |	\
    195      1.37      onoe 	 (((u_int8_t *)(p))[2] << 16) | (((u_int8_t *)(p))[3] << 24))
    196      1.37      onoe #define LE_WRITE_2(p, v)						\
    197      1.37      onoe 	((((u_int8_t *)(p))[0] = (((u_int32_t)(v)      ) & 0xff)),	\
    198      1.37      onoe 	 (((u_int8_t *)(p))[1] = (((u_int32_t)(v) >>  8) & 0xff)))
    199      1.37      onoe #define LE_WRITE_4(p, v)						\
    200      1.37      onoe 	((((u_int8_t *)(p))[0] = (((u_int32_t)(v)      ) & 0xff)),	\
    201      1.37      onoe 	 (((u_int8_t *)(p))[1] = (((u_int32_t)(v) >>  8) & 0xff)),	\
    202      1.37      onoe 	 (((u_int8_t *)(p))[2] = (((u_int32_t)(v) >> 16) & 0xff)),	\
    203      1.37      onoe 	 (((u_int8_t *)(p))[3] = (((u_int32_t)(v) >> 24) & 0xff)))
    204      1.37      onoe 
    205      1.37      onoe struct awi_chanset awi_chanset[] = {
    206      1.37      onoe     /* PHY type        domain            min max def */
    207      1.37      onoe     { AWI_PHY_TYPE_FH, AWI_REG_DOMAIN_JP,  6, 17,  6 },
    208      1.37      onoe     { AWI_PHY_TYPE_FH, AWI_REG_DOMAIN_ES,  0, 26,  1 },
    209      1.37      onoe     { AWI_PHY_TYPE_FH, AWI_REG_DOMAIN_FR,  0, 32,  1 },
    210      1.37      onoe     { AWI_PHY_TYPE_FH, AWI_REG_DOMAIN_US,  0, 77,  1 },
    211      1.37      onoe     { AWI_PHY_TYPE_FH, AWI_REG_DOMAIN_CA,  0, 77,  1 },
    212      1.37      onoe     { AWI_PHY_TYPE_FH, AWI_REG_DOMAIN_EU,  0, 77,  1 },
    213      1.37      onoe     { AWI_PHY_TYPE_DS, AWI_REG_DOMAIN_JP, 14, 14, 14 },
    214      1.37      onoe     { AWI_PHY_TYPE_DS, AWI_REG_DOMAIN_ES, 10, 11, 10 },
    215      1.37      onoe     { AWI_PHY_TYPE_DS, AWI_REG_DOMAIN_FR, 10, 13, 10 },
    216      1.37      onoe     { AWI_PHY_TYPE_DS, AWI_REG_DOMAIN_US,  1, 11,  3 },
    217      1.37      onoe     { AWI_PHY_TYPE_DS, AWI_REG_DOMAIN_CA,  1, 11,  3 },
    218      1.37      onoe     { AWI_PHY_TYPE_DS, AWI_REG_DOMAIN_EU,  1, 13,  3 },
    219      1.37      onoe     { 0, 0 }
    220      1.37      onoe };
    221      1.10      onoe 
    222  1.52.2.1     skrll #ifdef __FreeBSD__
    223  1.52.2.1     skrll devclass_t awi_devclass;
    224  1.52.2.1     skrll 
    225  1.52.2.1     skrll #if __FreeBSD_version < 500043
    226  1.52.2.1     skrll static char *ether_sprintf(u_int8_t *);
    227  1.52.2.1     skrll 
    228  1.52.2.1     skrll static char *
    229  1.52.2.1     skrll ether_sprintf(u_int8_t *enaddr)
    230  1.52.2.1     skrll {
    231  1.52.2.1     skrll 	static char strbuf[18];
    232  1.52.2.1     skrll 
    233  1.52.2.1     skrll 	sprintf(strbuf, "%6D", enaddr, ":");
    234  1.52.2.1     skrll 	return strbuf;
    235  1.52.2.1     skrll }
    236  1.52.2.1     skrll #endif
    237  1.52.2.1     skrll 
    238  1.52.2.1     skrll #define	IFQ_PURGE(ifq)		IF_DRAIN(ifq)
    239  1.52.2.1     skrll #define IF_POLL(ifq, m)		((m) = (ifq)->ifq_head)
    240  1.52.2.1     skrll #define IFQ_POLL(ifq, m)	IF_POLL((ifq), (m))
    241  1.52.2.1     skrll #define IFQ_DEQUEUE(ifq, m)	IF_DEQUEUE((ifq), (m))
    242  1.52.2.1     skrll 
    243  1.52.2.1     skrll #endif
    244  1.52.2.1     skrll 
    245      1.10      onoe #ifdef AWI_DEBUG
    246  1.52.2.1     skrll int awi_debug = 0;
    247       1.1  sommerfe 
    248      1.37      onoe #define	DPRINTF(X)	if (awi_debug) printf X
    249      1.37      onoe #define	DPRINTF2(X)	if (awi_debug > 1) printf X
    250      1.10      onoe #else
    251      1.37      onoe #define	DPRINTF(X)
    252      1.37      onoe #define	DPRINTF2(X)
    253      1.10      onoe #endif
    254       1.1  sommerfe 
    255      1.10      onoe int
    256      1.37      onoe awi_attach(struct awi_softc *sc)
    257       1.1  sommerfe {
    258      1.37      onoe 	struct ieee80211com *ic = &sc->sc_ic;
    259      1.37      onoe 	struct ifnet *ifp = &ic->ic_if;
    260      1.37      onoe 	int s, i, error, nrate;
    261      1.10      onoe 	int mword;
    262  1.52.2.1     skrll 	enum ieee80211_phymode mode;
    263       1.1  sommerfe 
    264      1.10      onoe 	s = splnet();
    265      1.10      onoe 	sc->sc_busy = 1;
    266  1.52.2.1     skrll 	sc->sc_attached = 0;
    267      1.37      onoe 	sc->sc_substate = AWI_ST_NONE;
    268      1.37      onoe 	if ((error = awi_hw_init(sc)) != 0) {
    269      1.10      onoe 		sc->sc_invalid = 1;
    270      1.10      onoe 		splx(s);
    271      1.10      onoe 		return error;
    272      1.10      onoe 	}
    273      1.10      onoe 	error = awi_init_mibs(sc);
    274      1.37      onoe 	if (error != 0) {
    275      1.10      onoe 		sc->sc_invalid = 1;
    276      1.37      onoe 		splx(s);
    277      1.10      onoe 		return error;
    278      1.10      onoe 	}
    279      1.10      onoe 	ifp->if_softc = sc;
    280      1.37      onoe 	ifp->if_flags =
    281  1.52.2.1     skrll #ifdef IFF_NOTRAILERS
    282  1.52.2.1     skrll 	    IFF_NOTRAILERS |
    283  1.52.2.1     skrll #endif
    284  1.52.2.1     skrll 	    IFF_SIMPLEX | IFF_BROADCAST | IFF_MULTICAST;
    285      1.37      onoe 	ifp->if_ioctl = awi_ioctl;
    286      1.10      onoe 	ifp->if_start = awi_start;
    287  1.52.2.1     skrll 	ifp->if_watchdog = awi_watchdog;
    288  1.52.2.1     skrll #ifdef __NetBSD__
    289      1.35      onoe 	ifp->if_init = awi_init;
    290      1.35      onoe 	ifp->if_stop = awi_stop;
    291      1.37      onoe 	IFQ_SET_READY(&ifp->if_snd);
    292      1.10      onoe 	memcpy(ifp->if_xname, sc->sc_dev.dv_xname, IFNAMSIZ);
    293  1.52.2.1     skrll #endif
    294  1.52.2.1     skrll #ifdef __FreeBSD__
    295  1.52.2.1     skrll 	ifp->if_init = awi_init0;
    296  1.52.2.1     skrll 	ifp->if_snd.ifq_maxlen = IFQ_MAXLEN;
    297  1.52.2.1     skrll 	if_initname(ifp, device_get_name(sc->sc_dev),
    298  1.52.2.1     skrll 	    device_get_unit(sc->sc_dev));
    299  1.52.2.1     skrll #endif
    300      1.37      onoe 
    301  1.52.2.1     skrll 	ic->ic_caps = IEEE80211_C_WEP | IEEE80211_C_IBSS | IEEE80211_C_HOSTAP;
    302  1.52.2.1     skrll 	if (sc->sc_mib_phy.IEEE_PHY_Type == AWI_PHY_TYPE_FH) {
    303      1.47      onoe 		ic->ic_phytype = IEEE80211_T_FH;
    304  1.52.2.1     skrll 		mode = IEEE80211_MODE_FH;
    305  1.52.2.1     skrll 	} else {
    306      1.47      onoe 		ic->ic_phytype = IEEE80211_T_DS;
    307  1.52.2.1     skrll 		ic->ic_caps |= IEEE80211_C_AHDEMO;
    308  1.52.2.1     skrll 		mode = IEEE80211_MODE_11B;
    309      1.49      onoe 	}
    310      1.47      onoe 	ic->ic_opmode = IEEE80211_M_STA;
    311      1.37      onoe 	nrate = sc->sc_mib_phy.aSuprt_Data_Rates[1];
    312  1.52.2.1     skrll 	memcpy(ic->ic_sup_rates[mode].rs_rates,
    313  1.52.2.1     skrll 	    sc->sc_mib_phy.aSuprt_Data_Rates + 2, nrate);
    314  1.52.2.1     skrll 	ic->ic_sup_rates[mode].rs_nrates = nrate;
    315      1.47      onoe 	IEEE80211_ADDR_COPY(ic->ic_myaddr, sc->sc_mib_addr.aMAC_Address);
    316       1.1  sommerfe 
    317  1.52.2.1     skrll 	printf("%s: IEEE802.11 %s (firmware %s)\n", ifp->if_xname,
    318  1.52.2.1     skrll 	    (ic->ic_phytype == IEEE80211_T_FH) ? "FH" : "DS", sc->sc_banner);
    319  1.52.2.1     skrll 	printf("%s: 802.11 address: %s\n", ifp->if_xname,
    320      1.37      onoe 	    ether_sprintf(ic->ic_myaddr));
    321      1.37      onoe 
    322  1.52.2.1     skrll #ifdef __NetBSD__
    323      1.10      onoe 	if_attach(ifp);
    324  1.52.2.1     skrll #endif
    325      1.37      onoe 	ieee80211_ifattach(ifp);
    326       1.1  sommerfe 
    327  1.52.2.1     skrll 	sc->sc_newstate = ic->ic_newstate;
    328  1.52.2.1     skrll 	ic->ic_newstate = awi_newstate;
    329  1.52.2.1     skrll 
    330  1.52.2.1     skrll 	sc->sc_recv_mgmt = ic->ic_recv_mgmt;
    331  1.52.2.1     skrll 	ic->ic_recv_mgmt = awi_recv_mgmt;
    332      1.43      onoe 
    333  1.52.2.1     skrll 	sc->sc_send_mgmt = ic->ic_send_mgmt;
    334  1.52.2.1     skrll 	ic->ic_send_mgmt = awi_send_mgmt;
    335  1.52.2.1     skrll 
    336  1.52.2.1     skrll 	ieee80211_media_init(ifp, awi_media_change, awi_media_status);
    337  1.52.2.1     skrll 
    338  1.52.2.1     skrll 	/* Melco compatibility mode. */
    339  1.52.2.1     skrll #define	ADD(s, o)	ifmedia_add(&ic->ic_media, \
    340      1.45      onoe 	IFM_MAKEWORD(IFM_IEEE80211, (s), (o), 0), 0, NULL)
    341  1.52.2.1     skrll 	ADD(IFM_AUTO, IFM_FLAG0);
    342  1.52.2.1     skrll 
    343      1.37      onoe 	for (i = 0; i < nrate; i++) {
    344  1.52.2.1     skrll 		mword = ieee80211_rate2media(ic,
    345  1.52.2.1     skrll 		    ic->ic_sup_rates[mode].rs_rates[i], mode);
    346      1.10      onoe 		if (mword == 0)
    347      1.10      onoe 			continue;
    348      1.45      onoe 		ADD(mword, IFM_FLAG0);
    349       1.1  sommerfe 	}
    350      1.45      onoe #undef	ADD
    351      1.37      onoe 
    352  1.52.2.1     skrll #ifdef __NetBSD__
    353      1.37      onoe 	if ((sc->sc_sdhook = shutdownhook_establish(awi_shutdown, sc)) == NULL)
    354      1.37      onoe 		printf("%s: WARNING: unable to establish shutdown hook\n",
    355  1.52.2.1     skrll 		    ifp->if_xname);
    356      1.37      onoe 	if ((sc->sc_powerhook = powerhook_establish(awi_power, sc)) == NULL)
    357      1.37      onoe 		printf("%s: WARNING: unable to establish power hook\n",
    358  1.52.2.1     skrll 		    ifp->if_xname);
    359  1.52.2.1     skrll #endif
    360      1.37      onoe 	sc->sc_attached = 1;
    361      1.37      onoe 	splx(s);
    362       1.1  sommerfe 
    363      1.10      onoe 	/* ready to accept ioctl */
    364      1.10      onoe 	awi_unlock(sc);
    365      1.17     jhawk 
    366      1.10      onoe 	return 0;
    367       1.1  sommerfe }
    368       1.1  sommerfe 
    369      1.10      onoe int
    370      1.37      onoe awi_detach(struct awi_softc *sc)
    371       1.1  sommerfe {
    372      1.37      onoe 	struct ifnet *ifp = &sc->sc_ic.ic_if;
    373      1.10      onoe 	int s;
    374      1.17     jhawk 
    375      1.17     jhawk 	if (!sc->sc_attached)
    376      1.37      onoe 		return 0;
    377       1.1  sommerfe 
    378      1.10      onoe 	s = splnet();
    379      1.10      onoe 	sc->sc_invalid = 1;
    380      1.35      onoe 	awi_stop(ifp, 1);
    381  1.52.2.1     skrll 
    382      1.10      onoe 	while (sc->sc_sleep_cnt > 0) {
    383      1.10      onoe 		wakeup(sc);
    384      1.10      onoe 		(void)tsleep(sc, PWAIT, "awidet", 1);
    385       1.1  sommerfe 	}
    386  1.52.2.1     skrll 	sc->sc_attached = 0;
    387      1.37      onoe 	ieee80211_ifdetach(ifp);
    388  1.52.2.1     skrll #ifdef __NetBSD__
    389      1.10      onoe 	if_detach(ifp);
    390      1.37      onoe 	shutdownhook_disestablish(sc->sc_sdhook);
    391      1.37      onoe 	powerhook_disestablish(sc->sc_powerhook);
    392  1.52.2.1     skrll #endif
    393      1.10      onoe 	splx(s);
    394      1.10      onoe 	return 0;
    395       1.1  sommerfe }
    396       1.1  sommerfe 
    397  1.52.2.1     skrll #ifdef __NetBSD__
    398       1.1  sommerfe int
    399      1.37      onoe awi_activate(struct device *self, enum devact act)
    400       1.1  sommerfe {
    401      1.10      onoe 	struct awi_softc *sc = (struct awi_softc *)self;
    402      1.37      onoe 	struct ifnet *ifp = &sc->sc_ic.ic_if;
    403      1.10      onoe 	int s, error = 0;
    404      1.10      onoe 
    405      1.10      onoe 	s = splnet();
    406      1.10      onoe 	switch (act) {
    407      1.10      onoe 	case DVACT_ACTIVATE:
    408      1.10      onoe 		error = EOPNOTSUPP;
    409      1.10      onoe 		break;
    410      1.10      onoe 	case DVACT_DEACTIVATE:
    411      1.10      onoe 		sc->sc_invalid = 1;
    412      1.37      onoe 		if_deactivate(ifp);
    413      1.10      onoe 		break;
    414       1.1  sommerfe 	}
    415      1.10      onoe 	splx(s);
    416      1.10      onoe 	return error;
    417       1.1  sommerfe }
    418       1.1  sommerfe 
    419       1.1  sommerfe void
    420      1.37      onoe awi_power(int why, void *arg)
    421       1.1  sommerfe {
    422      1.37      onoe 	struct awi_softc *sc = arg;
    423      1.37      onoe 	struct ifnet *ifp = &sc->sc_ic.ic_if;
    424      1.10      onoe 	int s;
    425      1.18      onoe 	int ocansleep;
    426      1.10      onoe 
    427      1.37      onoe 	DPRINTF(("awi_power: %d\n", why));
    428      1.10      onoe 	s = splnet();
    429      1.18      onoe 	ocansleep = sc->sc_cansleep;
    430      1.18      onoe 	sc->sc_cansleep = 0;
    431      1.28  takemura 	switch (why) {
    432      1.28  takemura 	case PWR_SUSPEND:
    433      1.28  takemura 	case PWR_STANDBY:
    434      1.35      onoe 		awi_stop(ifp, 1);
    435      1.28  takemura 		break;
    436      1.28  takemura 	case PWR_RESUME:
    437      1.35      onoe 		if (ifp->if_flags & IFF_UP) {
    438      1.35      onoe 			awi_init(ifp);
    439      1.37      onoe 			(void)awi_intr(sc);	/* make sure */
    440      1.34      onoe 		}
    441      1.28  takemura 		break;
    442      1.28  takemura 	case PWR_SOFTSUSPEND:
    443      1.28  takemura 	case PWR_SOFTSTANDBY:
    444      1.28  takemura 	case PWR_SOFTRESUME:
    445      1.28  takemura 		break;
    446      1.18      onoe 	}
    447      1.18      onoe 	sc->sc_cansleep = ocansleep;
    448      1.10      onoe 	splx(s);
    449       1.1  sommerfe }
    450  1.52.2.1     skrll #endif /* __NetBSD__ */
    451       1.1  sommerfe 
    452      1.37      onoe void
    453      1.37      onoe awi_shutdown(void *arg)
    454      1.10      onoe {
    455      1.37      onoe 	struct awi_softc *sc = arg;
    456      1.37      onoe 	struct ifnet *ifp = &sc->sc_ic.ic_if;
    457       1.1  sommerfe 
    458      1.37      onoe 	if (sc->sc_attached)
    459      1.37      onoe 		awi_stop(ifp, 1);
    460       1.1  sommerfe }
    461       1.1  sommerfe 
    462       1.1  sommerfe int
    463      1.37      onoe awi_intr(void *arg)
    464       1.1  sommerfe {
    465       1.1  sommerfe 	struct awi_softc *sc = arg;
    466      1.10      onoe 	u_int16_t status;
    467  1.52.2.1     skrll 	int handled = 0, ocansleep;
    468      1.37      onoe #ifdef AWI_DEBUG
    469      1.37      onoe 	static const char *intname[] = {
    470      1.37      onoe 	    "CMD", "RX", "TX", "SCAN_CMPLT",
    471      1.37      onoe 	    "CFP_START", "DTIM", "CFP_ENDING", "GROGGY",
    472      1.37      onoe 	    "TXDATA", "TXBCAST", "TXPS", "TXCF",
    473      1.37      onoe 	    "TXMGT", "#13", "RXDATA", "RXMGT"
    474      1.37      onoe 	};
    475      1.37      onoe #endif
    476       1.1  sommerfe 
    477  1.52.2.1     skrll 	if (!sc->sc_enabled || !sc->sc_enab_intr || sc->sc_invalid) {
    478  1.52.2.1     skrll 		DPRINTF(("awi_intr: stray interrupt: "
    479  1.52.2.1     skrll 		    "enabled %d enab_intr %d invalid %d\n",
    480  1.52.2.1     skrll 		    sc->sc_enabled, sc->sc_enab_intr, sc->sc_invalid));
    481      1.10      onoe 		return 0;
    482  1.52.2.1     skrll 	}
    483       1.1  sommerfe 
    484      1.10      onoe 	am79c930_gcr_setbits(&sc->sc_chip,
    485      1.10      onoe 	    AM79C930_GCR_DISPWDN | AM79C930_GCR_ECINT);
    486       1.1  sommerfe 	awi_write_1(sc, AWI_DIS_PWRDN, 1);
    487      1.10      onoe 	ocansleep = sc->sc_cansleep;
    488      1.10      onoe 	sc->sc_cansleep = 0;
    489      1.10      onoe 
    490       1.1  sommerfe 	for (;;) {
    491  1.52.2.1     skrll 		if (awi_intr_lock(sc) != 0)
    492      1.10      onoe 			break;
    493      1.10      onoe 		status = awi_read_1(sc, AWI_INTSTAT);
    494      1.10      onoe 		awi_write_1(sc, AWI_INTSTAT, 0);
    495      1.10      onoe 		awi_write_1(sc, AWI_INTSTAT, 0);
    496      1.10      onoe 		status |= awi_read_1(sc, AWI_INTSTAT2) << 8;
    497      1.10      onoe 		awi_write_1(sc, AWI_INTSTAT2, 0);
    498      1.10      onoe 		DELAY(10);
    499      1.10      onoe 		awi_intr_unlock(sc);
    500      1.10      onoe 		if (!sc->sc_cmd_inprog)
    501      1.10      onoe 			status &= ~AWI_INT_CMD;	/* make sure */
    502      1.10      onoe 		if (status == 0)
    503       1.1  sommerfe 			break;
    504      1.37      onoe #ifdef AWI_DEBUG
    505      1.37      onoe 		if (awi_debug > 1) {
    506      1.37      onoe 			int i;
    507      1.37      onoe 
    508      1.37      onoe 			printf("awi_intr: status 0x%04x", status);
    509      1.37      onoe 			for (i = 0; i < sizeof(intname)/sizeof(intname[0]);
    510      1.37      onoe 			    i++) {
    511      1.37      onoe 				if (status & (1 << i))
    512      1.37      onoe 					printf(" %s", intname[i]);
    513      1.37      onoe 			}
    514      1.37      onoe 			printf("\n");
    515      1.37      onoe 		}
    516      1.37      onoe #endif
    517       1.1  sommerfe 		handled = 1;
    518      1.10      onoe 		if (status & AWI_INT_RX)
    519      1.37      onoe 			awi_rx_int(sc);
    520      1.10      onoe 		if (status & AWI_INT_TX)
    521      1.37      onoe 			awi_tx_int(sc);
    522      1.10      onoe 		if (status & AWI_INT_CMD)
    523      1.10      onoe 			awi_cmd_done(sc);
    524      1.10      onoe 		if (status & AWI_INT_SCAN_CMPLT) {
    525      1.43      onoe 			if (sc->sc_ic.ic_state == IEEE80211_S_SCAN &&
    526      1.43      onoe 			    sc->sc_substate == AWI_ST_NONE)
    527  1.52.2.1     skrll 				ieee80211_next_scan(&sc->sc_ic);
    528       1.1  sommerfe 		}
    529       1.1  sommerfe 	}
    530      1.10      onoe 	sc->sc_cansleep = ocansleep;
    531       1.1  sommerfe 	am79c930_gcr_clearbits(&sc->sc_chip, AM79C930_GCR_DISPWDN);
    532       1.1  sommerfe 	awi_write_1(sc, AWI_DIS_PWRDN, 0);
    533       1.1  sommerfe 	return handled;
    534       1.1  sommerfe }
    535       1.1  sommerfe 
    536  1.52.2.1     skrll #ifdef __FreeBSD__
    537  1.52.2.1     skrll static void
    538  1.52.2.1     skrll awi_init0(void *arg)
    539  1.52.2.1     skrll {
    540  1.52.2.1     skrll 	struct awi_softc *sc = arg;
    541  1.52.2.1     skrll 
    542  1.52.2.1     skrll 	(void)awi_init(&sc->sc_ic.ic_if);
    543  1.52.2.1     skrll }
    544  1.52.2.1     skrll #endif
    545  1.52.2.1     skrll 
    546      1.37      onoe static int
    547      1.37      onoe awi_init(struct ifnet *ifp)
    548       1.8  sommerfe {
    549      1.35      onoe 	struct awi_softc *sc = ifp->if_softc;
    550      1.37      onoe 	struct ieee80211com *ic = &sc->sc_ic;
    551  1.52.2.1     skrll 	struct ieee80211_node *ni = ic->ic_bss;
    552  1.52.2.1     skrll 	struct ieee80211_rateset *rs;
    553  1.52.2.1     skrll 	int error, rate, i;
    554       1.8  sommerfe 
    555      1.37      onoe 	DPRINTF(("awi_init: enabled=%d\n", sc->sc_enabled));
    556      1.37      onoe 	if (sc->sc_enabled) {
    557      1.37      onoe 		awi_stop(ifp, 0);
    558      1.37      onoe 	} else {
    559      1.37      onoe 		if (sc->sc_enable)
    560      1.37      onoe 			(*sc->sc_enable)(sc);
    561      1.37      onoe 		sc->sc_enabled = 1;
    562      1.37      onoe 		if ((error = awi_hw_init(sc)) != 0) {
    563  1.52.2.1     skrll 			if (sc->sc_disable)
    564  1.52.2.1     skrll 				(*sc->sc_disable)(sc);
    565  1.52.2.1     skrll 			sc->sc_enabled = 0;
    566      1.37      onoe 			return error;
    567      1.37      onoe 		}
    568      1.37      onoe 	}
    569      1.37      onoe 	ic->ic_state = IEEE80211_S_INIT;
    570      1.37      onoe 
    571      1.49      onoe 	ic->ic_flags &= ~IEEE80211_F_IBSSON;
    572      1.49      onoe 	switch (ic->ic_opmode) {
    573      1.49      onoe 	case IEEE80211_M_STA:
    574      1.49      onoe 		sc->sc_mib_local.Network_Mode = 1;
    575      1.49      onoe 		sc->sc_mib_local.Acting_as_AP = 0;
    576      1.49      onoe 		break;
    577      1.49      onoe 	case IEEE80211_M_IBSS:
    578      1.49      onoe 		ic->ic_flags |= IEEE80211_F_IBSSON;
    579  1.52.2.1     skrll 		/* FALLTHRU */
    580      1.49      onoe 	case IEEE80211_M_AHDEMO:
    581      1.49      onoe 		sc->sc_mib_local.Network_Mode = 0;
    582      1.49      onoe 		sc->sc_mib_local.Acting_as_AP = 0;
    583      1.49      onoe 		break;
    584      1.49      onoe 	case IEEE80211_M_HOSTAP:
    585      1.49      onoe 		sc->sc_mib_local.Network_Mode = 1;
    586      1.49      onoe 		sc->sc_mib_local.Acting_as_AP = 1;
    587      1.49      onoe 		break;
    588      1.52    dyoung 	case IEEE80211_M_MONITOR:
    589      1.52    dyoung 		return ENODEV;
    590      1.49      onoe 	}
    591  1.52.2.1     skrll #if 0
    592      1.50      onoe 	IEEE80211_ADDR_COPY(ic->ic_myaddr, LLADDR(ifp->if_sadl));
    593  1.52.2.1     skrll #endif
    594      1.42      onoe 	memset(&sc->sc_mib_mac.aDesired_ESS_ID, 0, AWI_ESS_ID_SIZE);
    595      1.42      onoe 	sc->sc_mib_mac.aDesired_ESS_ID[0] = IEEE80211_ELEMID_SSID;
    596      1.46      onoe 	sc->sc_mib_mac.aDesired_ESS_ID[1] = ic->ic_des_esslen;
    597      1.46      onoe 	memcpy(&sc->sc_mib_mac.aDesired_ESS_ID[2], ic->ic_des_essid,
    598      1.46      onoe 	    ic->ic_des_esslen);
    599      1.37      onoe 
    600  1.52.2.1     skrll 	/* configure basic rate */
    601  1.52.2.1     skrll 	if (ic->ic_phytype == IEEE80211_T_FH)
    602  1.52.2.1     skrll 		rs = &ic->ic_sup_rates[IEEE80211_MODE_FH];
    603  1.52.2.1     skrll 	else
    604  1.52.2.1     skrll 		rs = &ic->ic_sup_rates[IEEE80211_MODE_11B];
    605  1.52.2.1     skrll 	if (ic->ic_fixed_rate != -1) {
    606  1.52.2.1     skrll 		rate = rs->rs_rates[ic->ic_fixed_rate] & IEEE80211_RATE_VAL;
    607  1.52.2.1     skrll 	} else {
    608  1.52.2.1     skrll 		rate = 0;
    609  1.52.2.1     skrll 		for (i = 0; i < rs->rs_nrates; i++) {
    610  1.52.2.1     skrll 			if ((rs->rs_rates[i] & IEEE80211_RATE_BASIC) &&
    611  1.52.2.1     skrll 			    rate < (rs->rs_rates[i] & IEEE80211_RATE_VAL))
    612  1.52.2.1     skrll 				rate = rs->rs_rates[i] & IEEE80211_RATE_VAL;
    613  1.52.2.1     skrll 		}
    614  1.52.2.1     skrll 	}
    615  1.52.2.1     skrll 	rate *= 5;
    616  1.52.2.1     skrll 	LE_WRITE_2(&sc->sc_mib_mac.aStation_Basic_Rate, rate);
    617  1.52.2.1     skrll 
    618      1.37      onoe 	if ((error = awi_mode_init(sc)) != 0) {
    619      1.37      onoe 		DPRINTF(("awi_init: awi_mode_init failed %d\n", error));
    620      1.37      onoe 		awi_stop(ifp, 1);
    621      1.37      onoe 		return error;
    622      1.10      onoe 	}
    623      1.37      onoe 
    624      1.37      onoe 	/* start transmitter */
    625      1.37      onoe 	sc->sc_txdone = sc->sc_txnext = sc->sc_txbase;
    626      1.37      onoe 	awi_write_4(sc, sc->sc_txbase + AWI_TXD_START, 0);
    627      1.37      onoe 	awi_write_4(sc, sc->sc_txbase + AWI_TXD_NEXT, 0);
    628      1.37      onoe 	awi_write_4(sc, sc->sc_txbase + AWI_TXD_LENGTH, 0);
    629      1.37      onoe 	awi_write_1(sc, sc->sc_txbase + AWI_TXD_RATE, 0);
    630      1.37      onoe 	awi_write_4(sc, sc->sc_txbase + AWI_TXD_NDA, 0);
    631      1.37      onoe 	awi_write_4(sc, sc->sc_txbase + AWI_TXD_NRA, 0);
    632      1.37      onoe 	awi_write_1(sc, sc->sc_txbase + AWI_TXD_STATE, 0);
    633      1.37      onoe 	awi_write_4(sc, AWI_CA_TX_DATA, sc->sc_txbase);
    634      1.37      onoe 	awi_write_4(sc, AWI_CA_TX_MGT, 0);
    635      1.37      onoe 	awi_write_4(sc, AWI_CA_TX_BCAST, 0);
    636      1.37      onoe 	awi_write_4(sc, AWI_CA_TX_PS, 0);
    637      1.37      onoe 	awi_write_4(sc, AWI_CA_TX_CF, 0);
    638      1.37      onoe 	if ((error = awi_cmd(sc, AWI_CMD_INIT_TX, AWI_WAIT)) != 0) {
    639      1.37      onoe 		DPRINTF(("awi_init: failed to start transmitter: %d\n", error));
    640      1.37      onoe 		awi_stop(ifp, 1);
    641      1.37      onoe 		return error;
    642      1.10      onoe 	}
    643      1.10      onoe 
    644      1.37      onoe 	/* start receiver */
    645      1.37      onoe 	if ((error = awi_cmd(sc, AWI_CMD_INIT_RX, AWI_WAIT)) != 0) {
    646      1.37      onoe 		DPRINTF(("awi_init: failed to start receiver: %d\n", error));
    647      1.35      onoe 		awi_stop(ifp, 1);
    648      1.10      onoe 		return error;
    649      1.10      onoe 	}
    650      1.37      onoe 	sc->sc_rxdoff = awi_read_4(sc, AWI_CA_IRX_DATA_DESC);
    651      1.37      onoe 	sc->sc_rxmoff = awi_read_4(sc, AWI_CA_IRX_PS_DESC);
    652      1.37      onoe 
    653      1.37      onoe 	ifp->if_flags |= IFF_RUNNING;
    654      1.37      onoe 	ifp->if_flags &= ~IFF_OACTIVE;
    655  1.52.2.1     skrll 	ic->ic_state = IEEE80211_S_INIT;
    656      1.37      onoe 
    657      1.49      onoe 	if (ic->ic_opmode == IEEE80211_M_AHDEMO ||
    658      1.47      onoe 	    ic->ic_opmode == IEEE80211_M_HOSTAP) {
    659      1.47      onoe 		ni->ni_chan = ic->ic_ibss_chan;
    660      1.47      onoe 		ni->ni_intval = ic->ic_lintval;
    661      1.47      onoe 		ni->ni_rssi = 0;
    662      1.47      onoe 		ni->ni_rstamp = 0;
    663      1.47      onoe 		memset(ni->ni_tstamp, 0, sizeof(ni->ni_tstamp));
    664  1.52.2.1     skrll 		ni->ni_rates =
    665  1.52.2.1     skrll 		    ic->ic_sup_rates[ieee80211_chan2mode(ic, ni->ni_chan)];
    666      1.47      onoe 		IEEE80211_ADDR_COPY(ni->ni_macaddr, ic->ic_myaddr);
    667      1.47      onoe 		if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
    668      1.47      onoe 			IEEE80211_ADDR_COPY(ni->ni_bssid, ic->ic_myaddr);
    669      1.47      onoe 			ni->ni_esslen = ic->ic_des_esslen;
    670      1.47      onoe 			memcpy(ni->ni_essid, ic->ic_des_essid, ni->ni_esslen);
    671      1.47      onoe 			ni->ni_capinfo = IEEE80211_CAPINFO_ESS;
    672      1.47      onoe 			if (ic->ic_phytype == IEEE80211_T_FH) {
    673      1.47      onoe 				ni->ni_fhdwell = 200;   /* XXX */
    674      1.47      onoe 				ni->ni_fhindex = 1;
    675      1.45      onoe 			}
    676      1.45      onoe 		} else {
    677      1.47      onoe 			ni->ni_capinfo = IEEE80211_CAPINFO_IBSS;
    678      1.47      onoe 			memset(ni->ni_bssid, 0, IEEE80211_ADDR_LEN);
    679      1.47      onoe 			ni->ni_esslen = 0;
    680      1.45      onoe 		}
    681  1.52.2.1     skrll 		if (ic->ic_flags & IEEE80211_F_PRIVACY)
    682      1.47      onoe 			ni->ni_capinfo |= IEEE80211_CAPINFO_PRIVACY;
    683      1.49      onoe 		if (ic->ic_opmode != IEEE80211_M_AHDEMO)
    684      1.49      onoe 			ic->ic_flags |= IEEE80211_F_SIBSS;
    685      1.37      onoe 		ic->ic_state = IEEE80211_S_SCAN;	/*XXX*/
    686      1.37      onoe 		sc->sc_substate = AWI_ST_NONE;
    687  1.52.2.1     skrll 		ieee80211_new_state(ic, IEEE80211_S_RUN, -1);
    688      1.37      onoe 	} else {
    689  1.52.2.1     skrll 		/* XXX check sc->sc_cur_chan */
    690  1.52.2.1     skrll 		ni->ni_chan = &ic->ic_channels[sc->sc_cur_chan];
    691  1.52.2.1     skrll 		ieee80211_new_state(ic, IEEE80211_S_SCAN, -1);
    692      1.10      onoe 	}
    693      1.37      onoe 	return 0;
    694       1.8  sommerfe }
    695       1.8  sommerfe 
    696      1.37      onoe static void
    697      1.37      onoe awi_stop(struct ifnet *ifp, int disable)
    698       1.1  sommerfe {
    699      1.35      onoe 	struct awi_softc *sc = ifp->if_softc;
    700       1.8  sommerfe 
    701      1.37      onoe 	if (!sc->sc_enabled)
    702      1.37      onoe 		return;
    703      1.37      onoe 
    704      1.37      onoe 	DPRINTF(("awi_stop(%d)\n", disable));
    705      1.37      onoe 
    706  1.52.2.1     skrll 	ieee80211_new_state(&sc->sc_ic, IEEE80211_S_INIT, -1);
    707      1.37      onoe 
    708      1.37      onoe 	if (!sc->sc_invalid) {
    709      1.37      onoe 		if (sc->sc_cmd_inprog)
    710      1.37      onoe 			(void)awi_cmd_wait(sc);
    711      1.37      onoe 		(void)awi_cmd(sc, AWI_CMD_KILL_RX, AWI_WAIT);
    712      1.37      onoe 		sc->sc_cmd_inprog = AWI_CMD_FLUSH_TX;
    713      1.37      onoe 		awi_write_1(sc, AWI_CA_FTX_DATA, 1);
    714      1.37      onoe 		awi_write_1(sc, AWI_CA_FTX_MGT, 0);
    715      1.37      onoe 		awi_write_1(sc, AWI_CA_FTX_BCAST, 0);
    716      1.37      onoe 		awi_write_1(sc, AWI_CA_FTX_PS, 0);
    717      1.37      onoe 		awi_write_1(sc, AWI_CA_FTX_CF, 0);
    718      1.37      onoe 		(void)awi_cmd(sc, AWI_CMD_FLUSH_TX, AWI_WAIT);
    719      1.10      onoe 	}
    720      1.10      onoe 	ifp->if_flags &= ~(IFF_RUNNING|IFF_OACTIVE);
    721       1.1  sommerfe 	ifp->if_timer = 0;
    722      1.37      onoe 	sc->sc_tx_timer = sc->sc_rx_timer = 0;
    723      1.37      onoe 	if (sc->sc_rxpend != NULL) {
    724      1.37      onoe 		m_freem(sc->sc_rxpend);
    725      1.37      onoe 		sc->sc_rxpend = NULL;
    726      1.37      onoe 	}
    727      1.29   thorpej 	IFQ_PURGE(&ifp->if_snd);
    728      1.37      onoe 
    729      1.37      onoe 	if (disable) {
    730  1.52.2.1     skrll 		if (!sc->sc_invalid)
    731  1.52.2.1     skrll 			am79c930_gcr_setbits(&sc->sc_chip,
    732  1.52.2.1     skrll 			    AM79C930_GCR_CORESET);
    733      1.35      onoe 		if (sc->sc_disable)
    734      1.35      onoe 			(*sc->sc_disable)(sc);
    735      1.35      onoe 		sc->sc_enabled = 0;
    736      1.18      onoe 	}
    737       1.1  sommerfe }
    738       1.1  sommerfe 
    739      1.10      onoe static void
    740      1.37      onoe awi_start(struct ifnet *ifp)
    741       1.1  sommerfe {
    742       1.1  sommerfe 	struct awi_softc *sc = ifp->if_softc;
    743      1.37      onoe 	struct ieee80211com *ic = &sc->sc_ic;
    744  1.52.2.1     skrll 	struct ieee80211_node *ni;
    745      1.47      onoe 	struct ieee80211_frame *wh;
    746      1.37      onoe 	struct mbuf *m, *m0;
    747      1.43      onoe 	int len, dowep;
    748      1.37      onoe 	u_int32_t txd, frame, ntxd;
    749      1.37      onoe 	u_int8_t rate;
    750       1.1  sommerfe 
    751      1.37      onoe 	if (!sc->sc_enabled || sc->sc_invalid)
    752       1.1  sommerfe 		return;
    753       1.1  sommerfe 
    754      1.10      onoe 	for (;;) {
    755      1.10      onoe 		txd = sc->sc_txnext;
    756      1.37      onoe 		IF_POLL(&ic->ic_mgtq, m0);
    757      1.43      onoe 		dowep = 0;
    758      1.10      onoe 		if (m0 != NULL) {
    759      1.43      onoe 			len = m0->m_pkthdr.len;
    760      1.43      onoe 			if (awi_next_txd(sc, len, &frame, &ntxd)) {
    761      1.10      onoe 				ifp->if_flags |= IFF_OACTIVE;
    762      1.10      onoe 				break;
    763      1.10      onoe 			}
    764      1.37      onoe 			IF_DEQUEUE(&ic->ic_mgtq, m0);
    765      1.10      onoe 		} else {
    766      1.37      onoe 			if (ic->ic_state != IEEE80211_S_RUN)
    767      1.10      onoe 				break;
    768      1.29   thorpej 			IFQ_POLL(&ifp->if_snd, m0);
    769      1.10      onoe 			if (m0 == NULL)
    770      1.10      onoe 				break;
    771      1.37      onoe 			/*
    772      1.37      onoe 			 * Need to calculate the real length to determine
    773      1.37      onoe 			 * if the transmit buffer has a room for the packet.
    774      1.37      onoe 			 */
    775      1.18      onoe 			len = m0->m_pkthdr.len + sizeof(struct ieee80211_frame);
    776      1.37      onoe 			if (!(ifp->if_flags & IFF_LINK0) && !sc->sc_adhoc_ap)
    777      1.18      onoe 				len += sizeof(struct llc) -
    778      1.18      onoe 				    sizeof(struct ether_header);
    779  1.52.2.1     skrll 			if (ic->ic_flags & IEEE80211_F_PRIVACY) {
    780      1.43      onoe 				dowep = 1;
    781      1.18      onoe 				len += IEEE80211_WEP_IVLEN +
    782      1.18      onoe 				    IEEE80211_WEP_KIDLEN + IEEE80211_WEP_CRCLEN;
    783      1.43      onoe 			}
    784      1.18      onoe 			if (awi_next_txd(sc, len, &frame, &ntxd)) {
    785      1.10      onoe 				ifp->if_flags |= IFF_OACTIVE;
    786       1.1  sommerfe 				break;
    787      1.10      onoe 			}
    788      1.29   thorpej 			IFQ_DEQUEUE(&ifp->if_snd, m0);
    789      1.37      onoe 			ifp->if_opackets++;
    790      1.37      onoe #if NBPFILTER > 0
    791      1.37      onoe 			if (ifp->if_bpf)
    792      1.37      onoe 				bpf_mtap(ifp->if_bpf, m0);
    793      1.33      onoe #endif
    794      1.37      onoe 			if ((ifp->if_flags & IFF_LINK0) || sc->sc_adhoc_ap)
    795      1.37      onoe 				m0 = awi_ether_encap(sc, m0);
    796      1.37      onoe 			else
    797  1.52.2.1     skrll 				m0 = ieee80211_encap(ifp, m0, &ni);
    798      1.10      onoe 			if (m0 == NULL) {
    799      1.10      onoe 				ifp->if_oerrors++;
    800      1.10      onoe 				continue;
    801      1.10      onoe 			}
    802  1.52.2.2     skrll 			if (ni != NULL)
    803  1.52.2.2     skrll 				ieee80211_release_node(ic, ni);
    804      1.47      onoe 			wh = mtod(m0, struct ieee80211_frame *);
    805      1.47      onoe 			if (!IEEE80211_IS_MULTICAST(wh->i_addr1) &&
    806      1.49      onoe 			    (ic->ic_opmode == IEEE80211_M_HOSTAP ||
    807      1.49      onoe 			     ic->ic_opmode == IEEE80211_M_IBSS) &&
    808      1.47      onoe 			    sc->sc_adhoc_ap == 0 &&
    809      1.47      onoe 			    (ifp->if_flags & IFF_LINK0) == 0 &&
    810      1.47      onoe 			    (wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) ==
    811  1.52.2.1     skrll 			    IEEE80211_FC0_TYPE_DATA && ni == NULL) {
    812      1.47      onoe 				m_freem(m0);
    813      1.47      onoe 				ifp->if_oerrors++;
    814      1.47      onoe 				continue;
    815      1.47      onoe 			}
    816      1.43      onoe 		}
    817      1.44      onoe #if NBPFILTER > 0
    818      1.44      onoe 		if (ic->ic_rawbpf)
    819      1.44      onoe 			bpf_mtap(ic->ic_rawbpf, m0);
    820      1.44      onoe #endif
    821      1.43      onoe 		if (dowep) {
    822      1.43      onoe 			if ((m0 = ieee80211_wep_crypt(ifp, m0, 1)) == NULL) {
    823      1.37      onoe 				ifp->if_oerrors++;
    824      1.37      onoe 				continue;
    825      1.37      onoe 			}
    826      1.43      onoe 		}
    827      1.43      onoe #ifdef DIAGNOSTIC
    828      1.43      onoe 		if (m0->m_pkthdr.len != len) {
    829      1.43      onoe 			printf("%s: length %d should be %d\n",
    830  1.52.2.1     skrll 			    ic->ic_if.if_xname, m0->m_pkthdr.len, len);
    831      1.43      onoe 			m_freem(m0);
    832      1.43      onoe 			ifp->if_oerrors++;
    833      1.43      onoe 			continue;
    834      1.43      onoe 		}
    835      1.37      onoe #endif
    836      1.37      onoe 
    837      1.37      onoe 		if ((ifp->if_flags & IFF_DEBUG) && (ifp->if_flags & IFF_LINK2))
    838      1.37      onoe 			ieee80211_dump_pkt(m0->m_data, m0->m_len,
    839  1.52.2.1     skrll 			    ic->ic_bss->ni_rates.
    840  1.52.2.1     skrll 			        rs_rates[ic->ic_bss->ni_txrate] &
    841      1.37      onoe 			    IEEE80211_RATE_VAL, -1);
    842      1.37      onoe 
    843      1.37      onoe 		for (m = m0, len = 0; m != NULL; m = m->m_next) {
    844      1.10      onoe 			awi_write_bytes(sc, frame + len, mtod(m, u_int8_t *),
    845      1.10      onoe 			    m->m_len);
    846      1.10      onoe 			len += m->m_len;
    847       1.4  sommerfe 		}
    848      1.10      onoe 		m_freem(m0);
    849  1.52.2.1     skrll 		rate = (ic->ic_bss->ni_rates.rs_rates[ic->ic_bss->ni_txrate] &
    850      1.37      onoe 		    IEEE80211_RATE_VAL) * 5;
    851      1.10      onoe 		awi_write_1(sc, ntxd + AWI_TXD_STATE, 0);
    852      1.10      onoe 		awi_write_4(sc, txd + AWI_TXD_START, frame);
    853      1.10      onoe 		awi_write_4(sc, txd + AWI_TXD_NEXT, ntxd);
    854      1.10      onoe 		awi_write_4(sc, txd + AWI_TXD_LENGTH, len);
    855      1.10      onoe 		awi_write_1(sc, txd + AWI_TXD_RATE, rate);
    856      1.10      onoe 		awi_write_4(sc, txd + AWI_TXD_NDA, 0);
    857      1.10      onoe 		awi_write_4(sc, txd + AWI_TXD_NRA, 0);
    858      1.10      onoe 		awi_write_1(sc, txd + AWI_TXD_STATE, AWI_TXD_ST_OWN);
    859      1.10      onoe 		sc->sc_txnext = ntxd;
    860      1.37      onoe 
    861      1.37      onoe 		sc->sc_tx_timer = 5;
    862      1.10      onoe 		ifp->if_timer = 1;
    863       1.1  sommerfe 	}
    864       1.1  sommerfe }
    865       1.1  sommerfe 
    866      1.10      onoe static void
    867      1.37      onoe awi_watchdog(struct ifnet *ifp)
    868       1.1  sommerfe {
    869      1.37      onoe 	struct awi_softc *sc = ifp->if_softc;
    870      1.37      onoe 	u_int32_t prevdone;
    871      1.37      onoe 	int ocansleep;
    872      1.37      onoe 
    873      1.37      onoe 	ifp->if_timer = 0;
    874      1.37      onoe 	if (!sc->sc_enabled || sc->sc_invalid)
    875      1.37      onoe 		return;
    876       1.9  sommerfe 
    877      1.37      onoe 	ocansleep = sc->sc_cansleep;
    878      1.37      onoe 	sc->sc_cansleep = 0;
    879      1.37      onoe 	if (sc->sc_tx_timer) {
    880      1.37      onoe 		if (--sc->sc_tx_timer == 0) {
    881      1.37      onoe 			printf("%s: device timeout\n", ifp->if_xname);
    882      1.37      onoe 			prevdone = sc->sc_txdone;
    883      1.37      onoe 			awi_tx_int(sc);
    884      1.37      onoe 			if (sc->sc_txdone == prevdone) {
    885      1.37      onoe 				ifp->if_oerrors++;
    886      1.37      onoe 				awi_init(ifp);
    887      1.37      onoe 				goto out;
    888      1.37      onoe 			}
    889      1.37      onoe 		}
    890      1.37      onoe 		ifp->if_timer = 1;
    891      1.37      onoe 	}
    892      1.37      onoe 	if (sc->sc_rx_timer) {
    893      1.37      onoe 		if (--sc->sc_rx_timer == 0) {
    894      1.37      onoe 			if (sc->sc_ic.ic_state == IEEE80211_S_RUN) {
    895  1.52.2.1     skrll 				ieee80211_new_state(&sc->sc_ic,
    896  1.52.2.1     skrll 				    IEEE80211_S_SCAN, -1);
    897      1.37      onoe 				goto out;
    898      1.37      onoe 			}
    899      1.37      onoe 		} else
    900      1.37      onoe 			ifp->if_timer = 1;
    901      1.10      onoe 	}
    902      1.37      onoe 	/* TODO: rate control */
    903      1.37      onoe 	ieee80211_watchdog(ifp);
    904      1.37      onoe   out:
    905      1.37      onoe 	sc->sc_cansleep = ocansleep;
    906      1.10      onoe }
    907       1.9  sommerfe 
    908      1.37      onoe static int
    909      1.37      onoe awi_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
    910      1.10      onoe {
    911      1.37      onoe 	struct awi_softc *sc = ifp->if_softc;
    912      1.37      onoe 	struct ifreq *ifr = (struct ifreq *)data;
    913      1.37      onoe 	int s, error;
    914      1.10      onoe 
    915      1.37      onoe 	s = splnet();
    916      1.37      onoe 	/* serialize ioctl, since we may sleep */
    917      1.37      onoe 	if ((error = awi_lock(sc)) != 0)
    918      1.37      onoe 		goto cantlock;
    919       1.1  sommerfe 
    920      1.37      onoe 	switch (cmd) {
    921      1.37      onoe 	case SIOCSIFFLAGS:
    922      1.37      onoe 		if (ifp->if_flags & IFF_UP) {
    923      1.37      onoe 			if (sc->sc_enabled) {
    924      1.37      onoe 				/*
    925      1.37      onoe 				 * To avoid rescanning another access point,
    926      1.37      onoe 				 * do not call awi_init() here.  Instead,
    927      1.37      onoe 				 * only reflect promisc mode settings.
    928      1.37      onoe 				 */
    929      1.37      onoe 				error = awi_mode_init(sc);
    930      1.37      onoe 			} else
    931      1.37      onoe 				error = awi_init(ifp);
    932      1.37      onoe 		} else if (sc->sc_enabled)
    933      1.37      onoe 			awi_stop(ifp, 1);
    934      1.37      onoe 		break;
    935      1.37      onoe 	case SIOCSIFMEDIA:
    936      1.37      onoe 	case SIOCGIFMEDIA:
    937  1.52.2.1     skrll 		error = ifmedia_ioctl(ifp, ifr, &sc->sc_ic.ic_media, cmd);
    938      1.37      onoe 		break;
    939      1.37      onoe 	case SIOCADDMULTI:
    940      1.37      onoe 	case SIOCDELMULTI:
    941  1.52.2.1     skrll #ifdef __FreeBSD__
    942  1.52.2.1     skrll 		error = ENETRESET;	/* XXX */
    943  1.52.2.1     skrll #else
    944      1.37      onoe 		error = (cmd == SIOCADDMULTI) ?
    945      1.37      onoe 		    ether_addmulti(ifr, &sc->sc_ic.ic_ec) :
    946      1.37      onoe 		    ether_delmulti(ifr, &sc->sc_ic.ic_ec);
    947  1.52.2.1     skrll #endif
    948      1.37      onoe 		if (error == ENETRESET) {
    949      1.37      onoe 			/* do not rescan */
    950  1.52.2.5     skrll 			if (ifp->if_flags & IFF_RUNNING)
    951      1.37      onoe 				error = awi_mode_init(sc);
    952      1.37      onoe 			else
    953      1.37      onoe 				error = 0;
    954      1.37      onoe 		}
    955      1.37      onoe 		break;
    956      1.37      onoe 	default:
    957      1.37      onoe 		error = ieee80211_ioctl(ifp, cmd, data);
    958      1.37      onoe 		if (error == ENETRESET) {
    959      1.37      onoe 			if (sc->sc_enabled)
    960      1.37      onoe 				error = awi_init(ifp);
    961      1.37      onoe 			else
    962      1.37      onoe 				error = 0;
    963      1.37      onoe 		}
    964      1.37      onoe 		break;
    965       1.1  sommerfe 	}
    966      1.37      onoe 	awi_unlock(sc);
    967      1.37      onoe   cantlock:
    968      1.37      onoe 	splx(s);
    969      1.37      onoe 	return error;
    970      1.10      onoe }
    971       1.9  sommerfe 
    972      1.37      onoe /*
    973      1.37      onoe  * Called from ifmedia_ioctl via awi_ioctl with lock obtained.
    974  1.52.2.1     skrll  *
    975  1.52.2.1     skrll  * TBD factor with ieee80211_media_change
    976      1.37      onoe  */
    977      1.37      onoe static int
    978      1.37      onoe awi_media_change(struct ifnet *ifp)
    979      1.10      onoe {
    980      1.37      onoe 	struct awi_softc *sc = ifp->if_softc;
    981      1.37      onoe 	struct ieee80211com *ic = &sc->sc_ic;
    982      1.37      onoe 	struct ifmedia_entry *ime;
    983      1.49      onoe 	enum ieee80211_opmode newmode;
    984      1.49      onoe 	int i, rate, newadhoc_ap, error = 0;
    985       1.1  sommerfe 
    986  1.52.2.1     skrll 	ime = ic->ic_media.ifm_cur;
    987      1.37      onoe 	if (IFM_SUBTYPE(ime->ifm_media) == IFM_AUTO) {
    988      1.49      onoe 		i = -1;
    989      1.37      onoe 	} else {
    990  1.52.2.1     skrll 		struct ieee80211_rateset *rs =
    991  1.52.2.1     skrll 		    &ic->ic_sup_rates[(ic->ic_phytype == IEEE80211_T_FH)
    992  1.52.2.1     skrll 		    ? IEEE80211_MODE_FH : IEEE80211_MODE_11B];
    993  1.52.2.1     skrll 		rate = ieee80211_media2rate(ime->ifm_media);
    994      1.37      onoe 		if (rate == 0)
    995      1.37      onoe 			return EINVAL;
    996  1.52.2.1     skrll 		for (i = 0; i < rs->rs_nrates; i++) {
    997  1.52.2.1     skrll 			if ((rs->rs_rates[i] & IEEE80211_RATE_VAL) == rate)
    998      1.37      onoe 				break;
    999      1.37      onoe 		}
   1000  1.52.2.1     skrll 		if (i == rs->rs_nrates)
   1001      1.37      onoe 			return EINVAL;
   1002      1.49      onoe 	}
   1003      1.49      onoe 	if (ic->ic_fixed_rate != i) {
   1004      1.37      onoe 		ic->ic_fixed_rate = i;
   1005      1.49      onoe 		error = ENETRESET;
   1006      1.10      onoe 	}
   1007      1.37      onoe 
   1008      1.37      onoe 	/*
   1009      1.47      onoe 	 * combination of mediaopt
   1010      1.47      onoe 	 *
   1011      1.49      onoe 	 * hostap adhoc flag0	opmode  adhoc_ap	comment
   1012      1.49      onoe 	 *   +      -     -	HOSTAP      0		HostAP
   1013      1.49      onoe 	 *   -      +     -	IBSS        0		IBSS
   1014      1.49      onoe 	 *   -      +     +	AHDEMO      0		WaveLAN adhoc
   1015      1.49      onoe 	 *   -      -     +	IBSS        1		Melco old Sta
   1016      1.47      onoe 	 *							also LINK0
   1017      1.49      onoe 	 *   -      -     -	STA         0		Infra Station
   1018      1.37      onoe 	 */
   1019      1.49      onoe 	newadhoc_ap = 0;
   1020      1.49      onoe 	if (ime->ifm_media & IFM_IEEE80211_HOSTAP)
   1021      1.49      onoe 		newmode = IEEE80211_M_HOSTAP;
   1022      1.49      onoe 	else if (ime->ifm_media & IFM_IEEE80211_ADHOC) {
   1023      1.47      onoe 		if (ic->ic_phytype == IEEE80211_T_DS &&
   1024      1.49      onoe 		    (ime->ifm_media & IFM_FLAG0))
   1025      1.49      onoe 			newmode = IEEE80211_M_AHDEMO;
   1026      1.49      onoe 		else
   1027      1.49      onoe 			newmode = IEEE80211_M_IBSS;
   1028      1.45      onoe 	} else if (ime->ifm_media & IFM_FLAG0) {
   1029      1.49      onoe 		newmode = IEEE80211_M_IBSS;
   1030      1.49      onoe 		newadhoc_ap = 1;
   1031      1.49      onoe 	} else
   1032      1.49      onoe 		newmode = IEEE80211_M_STA;
   1033      1.49      onoe 	if (ic->ic_opmode != newmode || sc->sc_adhoc_ap != newadhoc_ap) {
   1034      1.49      onoe 		ic->ic_opmode = newmode;
   1035      1.49      onoe 		sc->sc_adhoc_ap = newadhoc_ap;
   1036      1.49      onoe 		error = ENETRESET;
   1037      1.20      onoe 	}
   1038      1.49      onoe 
   1039      1.37      onoe 	if (error == ENETRESET) {
   1040      1.37      onoe 		if (sc->sc_enabled)
   1041      1.37      onoe 			error = awi_init(ifp);
   1042      1.37      onoe 		else
   1043      1.37      onoe 			error = 0;
   1044      1.37      onoe 	}
   1045      1.37      onoe 	return error;
   1046       1.1  sommerfe }
   1047       1.1  sommerfe 
   1048      1.10      onoe static void
   1049      1.37      onoe awi_media_status(struct ifnet *ifp, struct ifmediareq *imr)
   1050       1.1  sommerfe {
   1051      1.37      onoe 	struct awi_softc *sc = ifp->if_softc;
   1052      1.37      onoe 	struct ieee80211com *ic = &sc->sc_ic;
   1053      1.37      onoe 	int rate;
   1054  1.52.2.1     skrll 	enum ieee80211_phymode mode;
   1055       1.1  sommerfe 
   1056      1.37      onoe 	imr->ifm_status = IFM_AVALID;
   1057      1.37      onoe 	if (ic->ic_state == IEEE80211_S_RUN)
   1058      1.37      onoe 		imr->ifm_status |= IFM_ACTIVE;
   1059      1.37      onoe 	imr->ifm_active = IFM_IEEE80211;
   1060  1.52.2.1     skrll 	if (ic->ic_phytype == IEEE80211_T_FH)
   1061  1.52.2.1     skrll 		mode = IEEE80211_MODE_FH;
   1062  1.52.2.1     skrll 	else
   1063  1.52.2.1     skrll 		mode = IEEE80211_MODE_11B;
   1064  1.52.2.1     skrll 	if (ic->ic_state == IEEE80211_S_RUN) {
   1065  1.52.2.1     skrll 		rate = ic->ic_bss->ni_rates.rs_rates[ic->ic_bss->ni_txrate] &
   1066      1.37      onoe 		    IEEE80211_RATE_VAL;
   1067  1.52.2.1     skrll 	} else {
   1068      1.37      onoe 		if (ic->ic_fixed_rate == -1)
   1069      1.37      onoe 			rate = 0;
   1070      1.37      onoe 		else
   1071  1.52.2.1     skrll 			rate = ic->ic_sup_rates[mode].
   1072  1.52.2.1     skrll 			    rs_rates[ic->ic_fixed_rate] & IEEE80211_RATE_VAL;
   1073      1.10      onoe 	}
   1074  1.52.2.1     skrll 	imr->ifm_active |= ieee80211_rate2media(ic, rate, mode);
   1075      1.47      onoe 	switch (ic->ic_opmode) {
   1076      1.52    dyoung 	case IEEE80211_M_MONITOR: /* we should never reach here */
   1077      1.52    dyoung 		break;
   1078      1.47      onoe 	case IEEE80211_M_STA:
   1079      1.47      onoe 		break;
   1080      1.49      onoe 	case IEEE80211_M_IBSS:
   1081      1.37      onoe 		if (sc->sc_adhoc_ap)
   1082      1.37      onoe 			imr->ifm_active |= IFM_FLAG0;
   1083      1.49      onoe 		else
   1084      1.37      onoe 			imr->ifm_active |= IFM_IEEE80211_ADHOC;
   1085      1.49      onoe 		break;
   1086      1.49      onoe 	case IEEE80211_M_AHDEMO:
   1087      1.49      onoe 		imr->ifm_active |= IFM_IEEE80211_ADHOC | IFM_FLAG0;
   1088      1.47      onoe 		break;
   1089      1.47      onoe 	case IEEE80211_M_HOSTAP:
   1090      1.47      onoe 		imr->ifm_active |= IFM_IEEE80211_HOSTAP;
   1091      1.47      onoe 		break;
   1092      1.18      onoe 	}
   1093      1.37      onoe }
   1094      1.37      onoe 
   1095      1.37      onoe static int
   1096      1.37      onoe awi_mode_init(struct awi_softc *sc)
   1097      1.37      onoe {
   1098      1.37      onoe 	struct ifnet *ifp = &sc->sc_ic.ic_if;
   1099      1.37      onoe 	int n, error;
   1100  1.52.2.1     skrll #ifdef __FreeBSD__
   1101  1.52.2.1     skrll 	struct ifmultiaddr *ifma;
   1102  1.52.2.1     skrll #else
   1103      1.37      onoe 	struct ether_multi *enm;
   1104      1.37      onoe 	struct ether_multistep step;
   1105  1.52.2.1     skrll #endif
   1106      1.37      onoe 
   1107      1.37      onoe 	/* reinitialize muticast filter */
   1108      1.37      onoe 	n = 0;
   1109      1.37      onoe 	sc->sc_mib_local.Accept_All_Multicast_Dis = 0;
   1110      1.47      onoe 	if (sc->sc_ic.ic_opmode != IEEE80211_M_HOSTAP &&
   1111      1.46      onoe 	    (ifp->if_flags & IFF_PROMISC)) {
   1112      1.37      onoe 		sc->sc_mib_mac.aPromiscuous_Enable = 1;
   1113      1.37      onoe 		goto set_mib;
   1114      1.37      onoe 	}
   1115      1.37      onoe 	sc->sc_mib_mac.aPromiscuous_Enable = 0;
   1116  1.52.2.1     skrll #ifdef __FreeBSD__
   1117  1.52.2.1     skrll 	if (ifp->if_amcount != 0)
   1118  1.52.2.1     skrll 		goto set_mib;
   1119  1.52.2.1     skrll 	TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
   1120  1.52.2.1     skrll 		if (ifma->ifma_addr->sa_family != AF_LINK)
   1121  1.52.2.1     skrll 			continue;
   1122  1.52.2.1     skrll 		if (n == AWI_GROUP_ADDR_SIZE)
   1123  1.52.2.1     skrll 			goto set_mib;
   1124  1.52.2.1     skrll 		IEEE80211_ADDR_COPY(sc->sc_mib_addr.aGroup_Addresses[n],
   1125  1.52.2.1     skrll 		    LLADDR((struct sockaddr_dl *)ifma->ifma_addr));
   1126  1.52.2.1     skrll 		n++;
   1127  1.52.2.1     skrll 	}
   1128  1.52.2.1     skrll #else
   1129      1.37      onoe 	ETHER_FIRST_MULTI(step, &sc->sc_ic.ic_ec, enm);
   1130      1.37      onoe 	while (enm != NULL) {
   1131      1.37      onoe 		if (n == AWI_GROUP_ADDR_SIZE ||
   1132      1.47      onoe 		    !IEEE80211_ADDR_EQ(enm->enm_addrlo, enm->enm_addrhi))
   1133      1.37      onoe 			goto set_mib;
   1134      1.47      onoe 		IEEE80211_ADDR_COPY(sc->sc_mib_addr.aGroup_Addresses[n],
   1135      1.47      onoe 		    enm->enm_addrlo);
   1136      1.37      onoe 		n++;
   1137      1.37      onoe 		ETHER_NEXT_MULTI(step, enm);
   1138      1.37      onoe 	}
   1139  1.52.2.1     skrll #endif
   1140      1.37      onoe 	for (; n < AWI_GROUP_ADDR_SIZE; n++)
   1141      1.47      onoe 		memset(sc->sc_mib_addr.aGroup_Addresses[n], 0,
   1142      1.47      onoe 		    IEEE80211_ADDR_LEN);
   1143      1.37      onoe 	sc->sc_mib_local.Accept_All_Multicast_Dis = 1;
   1144      1.37      onoe 
   1145      1.37      onoe   set_mib:
   1146      1.37      onoe 	if (sc->sc_mib_local.Accept_All_Multicast_Dis)
   1147      1.37      onoe 		ifp->if_flags &= ~IFF_ALLMULTI;
   1148      1.37      onoe 	else
   1149      1.37      onoe 		ifp->if_flags |= IFF_ALLMULTI;
   1150      1.37      onoe 	sc->sc_mib_mgt.Wep_Required =
   1151  1.52.2.1     skrll 	    (sc->sc_ic.ic_flags & IEEE80211_F_PRIVACY) ? AWI_WEP_ON : AWI_WEP_OFF;
   1152      1.37      onoe 
   1153      1.37      onoe 	if ((error = awi_mib(sc, AWI_CMD_SET_MIB, AWI_MIB_LOCAL, AWI_WAIT)) ||
   1154      1.37      onoe 	    (error = awi_mib(sc, AWI_CMD_SET_MIB, AWI_MIB_ADDR, AWI_WAIT)) ||
   1155      1.37      onoe 	    (error = awi_mib(sc, AWI_CMD_SET_MIB, AWI_MIB_MAC, AWI_WAIT)) ||
   1156      1.37      onoe 	    (error = awi_mib(sc, AWI_CMD_SET_MIB, AWI_MIB_MGT, AWI_WAIT)) ||
   1157      1.37      onoe 	    (error = awi_mib(sc, AWI_CMD_SET_MIB, AWI_MIB_PHY, AWI_WAIT))) {
   1158      1.37      onoe 		DPRINTF(("awi_mode_init: MIB set failed: %d\n", error));
   1159      1.37      onoe 		return error;
   1160      1.37      onoe 	}
   1161      1.37      onoe 	return 0;
   1162       1.1  sommerfe }
   1163       1.9  sommerfe 
   1164      1.10      onoe static void
   1165      1.37      onoe awi_rx_int(struct awi_softc *sc)
   1166       1.9  sommerfe {
   1167  1.52.2.1     skrll 	struct ieee80211com *ic = &sc->sc_ic;
   1168  1.52.2.1     skrll 	struct ifnet *ifp = &ic->ic_if;
   1169  1.52.2.1     skrll 	struct ieee80211_frame *wh;
   1170  1.52.2.1     skrll 	struct ieee80211_node *ni;
   1171      1.10      onoe 	u_int8_t state, rate, rssi;
   1172      1.10      onoe 	u_int16_t len;
   1173      1.43      onoe 	u_int32_t frame, next, rstamp, rxoff;
   1174      1.10      onoe 	struct mbuf *m;
   1175      1.10      onoe 
   1176      1.10      onoe 	rxoff = sc->sc_rxdoff;
   1177      1.10      onoe 	for (;;) {
   1178      1.10      onoe 		state = awi_read_1(sc, rxoff + AWI_RXD_HOST_DESC_STATE);
   1179      1.10      onoe 		if (state & AWI_RXD_ST_OWN)
   1180      1.10      onoe 			break;
   1181      1.10      onoe 		if (!(state & AWI_RXD_ST_CONSUMED)) {
   1182      1.43      onoe 			if (sc->sc_substate != AWI_ST_NONE)
   1183      1.43      onoe 				goto rx_next;
   1184      1.37      onoe 			if (state & AWI_RXD_ST_RXERROR) {
   1185      1.37      onoe 				ifp->if_ierrors++;
   1186      1.37      onoe 				goto rx_next;
   1187      1.37      onoe 			}
   1188      1.37      onoe 			len    = awi_read_2(sc, rxoff + AWI_RXD_LEN);
   1189      1.37      onoe 			rate   = awi_read_1(sc, rxoff + AWI_RXD_RATE);
   1190      1.37      onoe 			rssi   = awi_read_1(sc, rxoff + AWI_RXD_RSSI);
   1191      1.37      onoe 			frame  = awi_read_4(sc, rxoff + AWI_RXD_START_FRAME) &
   1192      1.37      onoe 			    0x7fff;
   1193      1.43      onoe 			rstamp = awi_read_4(sc, rxoff + AWI_RXD_LOCALTIME);
   1194      1.37      onoe 			m = awi_devget(sc, frame, len);
   1195      1.37      onoe 			if (m == NULL) {
   1196      1.37      onoe 				ifp->if_ierrors++;
   1197      1.37      onoe 				goto rx_next;
   1198      1.37      onoe 			}
   1199      1.37      onoe 			if (state & AWI_RXD_ST_LF) {
   1200      1.37      onoe 				/* TODO check my bss */
   1201      1.37      onoe 				if (!(sc->sc_ic.ic_flags & IEEE80211_F_SIBSS) &&
   1202      1.37      onoe 				    sc->sc_ic.ic_state == IEEE80211_S_RUN) {
   1203      1.37      onoe 					sc->sc_rx_timer = 10;
   1204      1.37      onoe 					ifp->if_timer = 1;
   1205      1.37      onoe 				}
   1206      1.37      onoe 				if ((ifp->if_flags & IFF_DEBUG) &&
   1207      1.37      onoe 				    (ifp->if_flags & IFF_LINK2))
   1208      1.37      onoe 					ieee80211_dump_pkt(m->m_data, m->m_len,
   1209      1.37      onoe 					    rate / 5, rssi);
   1210      1.37      onoe 				if ((ifp->if_flags & IFF_LINK0) ||
   1211      1.37      onoe 				    sc->sc_adhoc_ap)
   1212      1.37      onoe 					m = awi_ether_modcap(sc, m);
   1213  1.52.2.1     skrll 				else
   1214  1.52.2.1     skrll 					m = m_pullup(m, sizeof(*wh));
   1215  1.52.2.1     skrll 				if (m == NULL) {
   1216      1.37      onoe 					ifp->if_ierrors++;
   1217  1.52.2.1     skrll 					goto rx_next;
   1218  1.52.2.1     skrll 				}
   1219  1.52.2.1     skrll 				wh = mtod(m, struct ieee80211_frame *);
   1220  1.52.2.1     skrll 				ni = ieee80211_find_rxnode(ic, wh);
   1221  1.52.2.1     skrll 				ieee80211_input(ifp, m, ni, rssi, rstamp);
   1222  1.52.2.1     skrll 				/*
   1223  1.52.2.1     skrll 				 * The frame may have caused the
   1224  1.52.2.1     skrll 				 * node to be marked for reclamation
   1225  1.52.2.1     skrll 				 * (e.g. in response to a DEAUTH
   1226  1.52.2.2     skrll 				 * message) so use release_node here
   1227  1.52.2.1     skrll 				 * instead of unref_node.
   1228  1.52.2.1     skrll 				 */
   1229  1.52.2.2     skrll 				ieee80211_release_node(ic, ni);
   1230      1.37      onoe 			} else
   1231      1.37      onoe 				sc->sc_rxpend = m;
   1232      1.37      onoe   rx_next:
   1233      1.10      onoe 			state |= AWI_RXD_ST_CONSUMED;
   1234      1.10      onoe 			awi_write_1(sc, rxoff + AWI_RXD_HOST_DESC_STATE, state);
   1235      1.10      onoe 		}
   1236      1.37      onoe 		next = awi_read_4(sc, rxoff + AWI_RXD_NEXT);
   1237      1.10      onoe 		if (next & AWI_RXD_NEXT_LAST)
   1238      1.10      onoe 			break;
   1239      1.37      onoe 		/* make sure the next pointer is correct */
   1240      1.37      onoe 		if (next != awi_read_4(sc, rxoff + AWI_RXD_NEXT))
   1241      1.37      onoe 			break;
   1242      1.37      onoe 		state |= AWI_RXD_ST_OWN;
   1243      1.37      onoe 		awi_write_1(sc, rxoff + AWI_RXD_HOST_DESC_STATE, state);
   1244      1.37      onoe 		rxoff = next & 0x7fff;
   1245      1.37      onoe 	}
   1246      1.37      onoe 	sc->sc_rxdoff = rxoff;
   1247      1.37      onoe }
   1248      1.37      onoe 
   1249      1.37      onoe static void
   1250      1.37      onoe awi_tx_int(struct awi_softc *sc)
   1251      1.37      onoe {
   1252      1.37      onoe 	struct ifnet *ifp = &sc->sc_ic.ic_if;
   1253      1.37      onoe 	u_int8_t flags;
   1254      1.37      onoe 
   1255      1.37      onoe 	while (sc->sc_txdone != sc->sc_txnext) {
   1256      1.37      onoe 		flags = awi_read_1(sc, sc->sc_txdone + AWI_TXD_STATE);
   1257      1.37      onoe 		if ((flags & AWI_TXD_ST_OWN) || !(flags & AWI_TXD_ST_DONE))
   1258      1.10      onoe 			break;
   1259      1.37      onoe 		if (flags & AWI_TXD_ST_ERROR)
   1260      1.37      onoe 			ifp->if_oerrors++;
   1261      1.37      onoe 		sc->sc_txdone = awi_read_4(sc, sc->sc_txdone + AWI_TXD_NEXT) &
   1262      1.37      onoe 		    0x7fff;
   1263      1.10      onoe 	}
   1264      1.37      onoe 	DPRINTF2(("awi_txint: txdone %d txnext %d txbase %d txend %d\n",
   1265      1.37      onoe 	    sc->sc_txdone, sc->sc_txnext, sc->sc_txbase, sc->sc_txend));
   1266      1.37      onoe 	sc->sc_tx_timer = 0;
   1267      1.37      onoe 	ifp->if_flags &= ~IFF_OACTIVE;
   1268      1.37      onoe 	awi_start(ifp);
   1269       1.9  sommerfe }
   1270       1.9  sommerfe 
   1271      1.18      onoe static struct mbuf *
   1272      1.37      onoe awi_devget(struct awi_softc *sc, u_int32_t off, u_int16_t len)
   1273       1.1  sommerfe {
   1274      1.37      onoe 	struct ifnet *ifp = &sc->sc_ic.ic_if;
   1275      1.10      onoe 	struct mbuf *m;
   1276      1.18      onoe 	struct mbuf *top, **mp;
   1277      1.10      onoe 	u_int tlen;
   1278      1.10      onoe 
   1279      1.10      onoe 	top = sc->sc_rxpend;
   1280      1.18      onoe 	mp = &top;
   1281      1.10      onoe 	if (top != NULL) {
   1282      1.10      onoe 		sc->sc_rxpend = NULL;
   1283      1.10      onoe 		top->m_pkthdr.len += len;
   1284      1.20      onoe 		m = top;
   1285      1.18      onoe 		while (*mp != NULL) {
   1286      1.18      onoe 			m = *mp;
   1287      1.10      onoe 			mp = &m->m_next;
   1288      1.18      onoe 		}
   1289      1.10      onoe 		if (m->m_flags & M_EXT)
   1290      1.10      onoe 			tlen = m->m_ext.ext_size;
   1291      1.10      onoe 		else if (m->m_flags & M_PKTHDR)
   1292      1.10      onoe 			tlen = MHLEN;
   1293      1.10      onoe 		else
   1294      1.10      onoe 			tlen = MLEN;
   1295      1.10      onoe 		tlen -= m->m_len;
   1296      1.10      onoe 		if (tlen > len)
   1297      1.10      onoe 			tlen = len;
   1298      1.10      onoe 		awi_read_bytes(sc, off, mtod(m, u_int8_t *) + m->m_len, tlen);
   1299      1.10      onoe 		off += tlen;
   1300      1.10      onoe 		len -= tlen;
   1301      1.10      onoe 	}
   1302      1.10      onoe 
   1303      1.10      onoe 	while (len > 0) {
   1304      1.10      onoe 		if (top == NULL) {
   1305      1.10      onoe 			MGETHDR(m, M_DONTWAIT, MT_DATA);
   1306      1.10      onoe 			if (m == NULL)
   1307      1.10      onoe 				return NULL;
   1308      1.37      onoe 			m->m_pkthdr.rcvif = ifp;
   1309      1.10      onoe 			m->m_pkthdr.len = len;
   1310      1.10      onoe 			m->m_len = MHLEN;
   1311      1.37      onoe 			m->m_flags |= M_HASFCS;
   1312      1.10      onoe 		} else {
   1313      1.10      onoe 			MGET(m, M_DONTWAIT, MT_DATA);
   1314      1.10      onoe 			if (m == NULL) {
   1315      1.10      onoe 				m_freem(top);
   1316      1.10      onoe 				return NULL;
   1317      1.10      onoe 			}
   1318      1.10      onoe 			m->m_len = MLEN;
   1319      1.10      onoe 		}
   1320      1.10      onoe 		if (len >= MINCLSIZE) {
   1321      1.10      onoe 			MCLGET(m, M_DONTWAIT);
   1322      1.10      onoe 			if (m->m_flags & M_EXT)
   1323      1.10      onoe 				m->m_len = m->m_ext.ext_size;
   1324      1.10      onoe 		}
   1325      1.20      onoe 		if (top == NULL) {
   1326      1.20      onoe 			int hdrlen = sizeof(struct ieee80211_frame) +
   1327      1.37      onoe 			    sizeof(struct llc);
   1328      1.20      onoe 			caddr_t newdata = (caddr_t)
   1329      1.20      onoe 			    ALIGN(m->m_data + hdrlen) - hdrlen;
   1330      1.20      onoe 			m->m_len -= newdata - m->m_data;
   1331      1.20      onoe 			m->m_data = newdata;
   1332      1.20      onoe 		}
   1333      1.10      onoe 		if (m->m_len > len)
   1334      1.10      onoe 			m->m_len = len;
   1335      1.10      onoe 		awi_read_bytes(sc, off, mtod(m, u_int8_t *), m->m_len);
   1336      1.10      onoe 		off += m->m_len;
   1337      1.10      onoe 		len -= m->m_len;
   1338      1.10      onoe 		*mp = m;
   1339      1.10      onoe 		mp = &m->m_next;
   1340      1.10      onoe 	}
   1341      1.10      onoe 	return top;
   1342       1.1  sommerfe }
   1343       1.1  sommerfe 
   1344      1.10      onoe /*
   1345      1.10      onoe  * Initialize hardware and start firmware to accept commands.
   1346      1.10      onoe  * Called everytime after power on firmware.
   1347      1.10      onoe  */
   1348      1.10      onoe 
   1349      1.10      onoe static int
   1350      1.37      onoe awi_hw_init(struct awi_softc *sc)
   1351       1.1  sommerfe {
   1352      1.10      onoe 	u_int8_t status;
   1353      1.10      onoe 	u_int16_t intmask;
   1354      1.10      onoe 	int i, error;
   1355       1.1  sommerfe 
   1356      1.15      onoe 	sc->sc_enab_intr = 0;
   1357      1.20      onoe 	sc->sc_invalid = 0;	/* XXX: really? */
   1358      1.10      onoe 	awi_drvstate(sc, AWI_DRV_RESET);
   1359       1.1  sommerfe 
   1360      1.10      onoe 	/* reset firmware */
   1361      1.10      onoe 	am79c930_gcr_setbits(&sc->sc_chip, AM79C930_GCR_CORESET);
   1362      1.10      onoe 	DELAY(100);
   1363      1.10      onoe 	awi_write_1(sc, AWI_SELFTEST, 0);
   1364      1.20      onoe 	awi_write_1(sc, AWI_CMD, 0);
   1365      1.20      onoe 	awi_write_1(sc, AWI_BANNER, 0);
   1366      1.10      onoe 	am79c930_gcr_clearbits(&sc->sc_chip, AM79C930_GCR_CORESET);
   1367      1.10      onoe 	DELAY(100);
   1368      1.10      onoe 
   1369      1.10      onoe 	/* wait for selftest completion */
   1370      1.10      onoe 	for (i = 0; ; i++) {
   1371  1.52.2.1     skrll 		if (sc->sc_invalid)
   1372  1.52.2.1     skrll 			return ENXIO;
   1373      1.10      onoe 		if (i >= AWI_SELFTEST_TIMEOUT*hz/1000) {
   1374      1.10      onoe 			printf("%s: failed to complete selftest (timeout)\n",
   1375  1.52.2.1     skrll 			    sc->sc_ic.ic_if.if_xname);
   1376      1.10      onoe 			return ENXIO;
   1377      1.10      onoe 		}
   1378      1.10      onoe 		status = awi_read_1(sc, AWI_SELFTEST);
   1379      1.10      onoe 		if ((status & 0xf0) == 0xf0)
   1380      1.10      onoe 			break;
   1381      1.10      onoe 		if (sc->sc_cansleep) {
   1382      1.10      onoe 			sc->sc_sleep_cnt++;
   1383      1.10      onoe 			(void)tsleep(sc, PWAIT, "awitst", 1);
   1384      1.10      onoe 			sc->sc_sleep_cnt--;
   1385      1.10      onoe 		} else {
   1386      1.10      onoe 			DELAY(1000*1000/hz);
   1387      1.10      onoe 		}
   1388      1.10      onoe 	}
   1389      1.10      onoe 	if (status != AWI_SELFTEST_PASSED) {
   1390      1.10      onoe 		printf("%s: failed to complete selftest (code %x)\n",
   1391  1.52.2.1     skrll 		    sc->sc_ic.ic_if.if_xname, status);
   1392      1.10      onoe 		return ENXIO;
   1393      1.10      onoe 	}
   1394       1.1  sommerfe 
   1395      1.10      onoe 	/* check banner to confirm firmware write it */
   1396      1.18      onoe 	awi_read_bytes(sc, AWI_BANNER, sc->sc_banner, AWI_BANNER_LEN);
   1397      1.18      onoe 	if (memcmp(sc->sc_banner, "PCnetMobile:", 12) != 0) {
   1398      1.10      onoe 		printf("%s: failed to complete selftest (bad banner)\n",
   1399  1.52.2.1     skrll 		    sc->sc_ic.ic_if.if_xname);
   1400      1.10      onoe 		for (i = 0; i < AWI_BANNER_LEN; i++)
   1401      1.18      onoe 			printf("%s%02x", i ? ":" : "\t", sc->sc_banner[i]);
   1402      1.10      onoe 		printf("\n");
   1403      1.10      onoe 		return ENXIO;
   1404      1.10      onoe 	}
   1405       1.1  sommerfe 
   1406      1.10      onoe 	/* initializing interrupt */
   1407      1.15      onoe 	sc->sc_enab_intr = 1;
   1408      1.10      onoe 	error = awi_intr_lock(sc);
   1409      1.10      onoe 	if (error)
   1410      1.10      onoe 		return error;
   1411      1.10      onoe 	intmask = AWI_INT_GROGGY | AWI_INT_SCAN_CMPLT |
   1412      1.10      onoe 	    AWI_INT_TX | AWI_INT_RX | AWI_INT_CMD;
   1413      1.10      onoe 	awi_write_1(sc, AWI_INTMASK, ~intmask & 0xff);
   1414      1.10      onoe 	awi_write_1(sc, AWI_INTMASK2, 0);
   1415      1.10      onoe 	awi_write_1(sc, AWI_INTSTAT, 0);
   1416      1.10      onoe 	awi_write_1(sc, AWI_INTSTAT2, 0);
   1417      1.10      onoe 	awi_intr_unlock(sc);
   1418      1.10      onoe 	am79c930_gcr_setbits(&sc->sc_chip, AM79C930_GCR_ENECINT);
   1419       1.1  sommerfe 
   1420      1.36       wiz 	/* issuing interface test command */
   1421      1.37      onoe 	error = awi_cmd(sc, AWI_CMD_NOP, AWI_WAIT);
   1422      1.10      onoe 	if (error) {
   1423  1.52.2.1     skrll 		printf("%s: failed to complete selftest",
   1424  1.52.2.1     skrll 		    sc->sc_ic.ic_if.if_xname);
   1425      1.20      onoe 		if (error == ENXIO)
   1426      1.20      onoe 			printf(" (no hardware)\n");
   1427      1.20      onoe 		else if (error != EWOULDBLOCK)
   1428      1.10      onoe 			printf(" (error %d)\n", error);
   1429      1.10      onoe 		else if (sc->sc_cansleep)
   1430      1.10      onoe 			printf(" (lost interrupt)\n");
   1431      1.10      onoe 		else
   1432      1.10      onoe 			printf(" (command timeout)\n");
   1433      1.46      onoe 		return error;
   1434      1.10      onoe 	}
   1435      1.46      onoe 
   1436      1.46      onoe 	/* Initialize VBM */
   1437      1.46      onoe 	awi_write_1(sc, AWI_VBM_OFFSET, 0);
   1438      1.46      onoe 	awi_write_1(sc, AWI_VBM_LENGTH, 1);
   1439      1.46      onoe 	awi_write_1(sc, AWI_VBM_BITMAP, 0);
   1440      1.46      onoe 	return 0;
   1441      1.10      onoe }
   1442       1.1  sommerfe 
   1443      1.10      onoe /*
   1444      1.10      onoe  * Extract the factory default MIB value from firmware and assign the driver
   1445      1.10      onoe  * default value.
   1446      1.10      onoe  * Called once at attaching the interface.
   1447      1.10      onoe  */
   1448       1.1  sommerfe 
   1449      1.37      onoe static int
   1450      1.37      onoe awi_init_mibs(struct awi_softc *sc)
   1451       1.1  sommerfe {
   1452  1.52.2.1     skrll 	int chan, i, error;
   1453  1.52.2.1     skrll 	struct ieee80211com *ic = &sc->sc_ic;
   1454      1.37      onoe 	struct awi_chanset *cs;
   1455       1.1  sommerfe 
   1456      1.37      onoe 	if ((error = awi_mib(sc, AWI_CMD_GET_MIB, AWI_MIB_LOCAL, AWI_WAIT)) ||
   1457      1.37      onoe 	    (error = awi_mib(sc, AWI_CMD_GET_MIB, AWI_MIB_ADDR, AWI_WAIT)) ||
   1458      1.37      onoe 	    (error = awi_mib(sc, AWI_CMD_GET_MIB, AWI_MIB_MAC, AWI_WAIT)) ||
   1459      1.37      onoe 	    (error = awi_mib(sc, AWI_CMD_GET_MIB, AWI_MIB_MGT, AWI_WAIT)) ||
   1460      1.37      onoe 	    (error = awi_mib(sc, AWI_CMD_GET_MIB, AWI_MIB_PHY, AWI_WAIT))) {
   1461      1.37      onoe 		printf("%s: failed to get default mib value (error %d)\n",
   1462  1.52.2.1     skrll 		    ic->ic_if.if_xname, error);
   1463      1.37      onoe 		return error;
   1464      1.37      onoe 	}
   1465      1.10      onoe 
   1466      1.37      onoe 	memset(&sc->sc_ic.ic_chan_avail, 0, sizeof(sc->sc_ic.ic_chan_avail));
   1467      1.37      onoe 	for (cs = awi_chanset; ; cs++) {
   1468      1.37      onoe 		if (cs->cs_type == 0) {
   1469      1.37      onoe 			printf("%s: failed to set available channel\n",
   1470  1.52.2.1     skrll 			    ic->ic_if.if_xname);
   1471      1.37      onoe 			return ENXIO;
   1472      1.37      onoe 		}
   1473      1.37      onoe 		if (cs->cs_type == sc->sc_mib_phy.IEEE_PHY_Type &&
   1474      1.37      onoe 		    cs->cs_region == sc->sc_mib_phy.aCurrent_Reg_Domain)
   1475      1.37      onoe 			break;
   1476      1.37      onoe 	}
   1477      1.39      onoe 	if (sc->sc_mib_phy.IEEE_PHY_Type == AWI_PHY_TYPE_FH) {
   1478      1.39      onoe 		for (i = cs->cs_min; i <= cs->cs_max; i++) {
   1479  1.52.2.1     skrll 			chan = IEEE80211_FH_CHAN(i % 3 + 1, i);
   1480  1.52.2.1     skrll 			setbit(sc->sc_ic.ic_chan_avail, chan);
   1481  1.52.2.1     skrll 			/* XXX for FHSS, does frequency matter? */
   1482  1.52.2.1     skrll 			ic->ic_channels[chan].ic_freq = 0;
   1483  1.52.2.1     skrll 			ic->ic_channels[chan].ic_flags = IEEE80211_CHAN_FHSS;
   1484      1.39      onoe 			/*
   1485      1.39      onoe 			 * According to the IEEE 802.11 specification,
   1486      1.39      onoe 			 * hop pattern parameter for FH phy should be
   1487      1.39      onoe 			 * incremented by 3 for given hop chanset, i.e.,
   1488      1.39      onoe 			 * the chanset parameter is calculated for given
   1489      1.39      onoe 			 * hop patter.  However, BayStack 650 Access Points
   1490      1.39      onoe 			 * apparently use fixed hop chanset parameter value
   1491      1.39      onoe 			 * 1 for any hop pattern.  So we also try this
   1492      1.39      onoe 			 * combination of hop chanset and pattern.
   1493      1.39      onoe 			 */
   1494  1.52.2.1     skrll 			chan = IEEE80211_FH_CHAN(1, i);
   1495  1.52.2.1     skrll 			setbit(sc->sc_ic.ic_chan_avail, chan);
   1496  1.52.2.1     skrll 			ic->ic_channels[chan].ic_freq = 0; /* XXX */
   1497  1.52.2.1     skrll 			ic->ic_channels[chan].ic_flags = IEEE80211_CHAN_FHSS;
   1498      1.39      onoe 		}
   1499      1.39      onoe 	} else {
   1500  1.52.2.1     skrll 		for (i = cs->cs_min; i <= cs->cs_max; i++) {
   1501      1.39      onoe 			setbit(sc->sc_ic.ic_chan_avail, i);
   1502  1.52.2.1     skrll 			ic->ic_channels[i].ic_freq =
   1503  1.52.2.1     skrll 			    ieee80211_ieee2mhz(i, IEEE80211_CHAN_2GHZ);
   1504  1.52.2.1     skrll 			ic->ic_channels[i].ic_flags = IEEE80211_CHAN_B;
   1505  1.52.2.1     skrll 		}
   1506      1.39      onoe 	}
   1507      1.37      onoe 	sc->sc_cur_chan = cs->cs_def;
   1508  1.52.2.1     skrll 	ic->ic_ibss_chan = &ic->ic_channels[cs->cs_def];
   1509       1.1  sommerfe 
   1510      1.37      onoe 	sc->sc_mib_local.Fragmentation_Dis = 1;
   1511      1.46      onoe 	sc->sc_mib_local.Add_PLCP_Dis = 0;
   1512  1.52.2.1     skrll 	sc->sc_mib_local.MAC_Hdr_Prsv = 0;
   1513      1.46      onoe 	sc->sc_mib_local.Rx_Mgmt_Que_En = 0;
   1514      1.46      onoe 	sc->sc_mib_local.Re_Assembly_Dis = 1;
   1515      1.46      onoe 	sc->sc_mib_local.Strip_PLCP_Dis = 0;
   1516      1.46      onoe 	sc->sc_mib_local.Power_Saving_Mode_Dis = 1;
   1517      1.37      onoe 	sc->sc_mib_local.Accept_All_Multicast_Dis = 1;
   1518  1.52.2.1     skrll 	sc->sc_mib_local.Check_Seq_Cntl_Dis = 0;
   1519      1.46      onoe 	sc->sc_mib_local.Flush_CFP_Queue_On_CF_End = 0;
   1520      1.46      onoe 	sc->sc_mib_local.Network_Mode = 1;
   1521      1.46      onoe 	sc->sc_mib_local.PWD_Lvl = 0;
   1522      1.46      onoe 	sc->sc_mib_local.CFP_Mode = 0;
   1523       1.1  sommerfe 
   1524      1.37      onoe 	/* allocate buffers */
   1525      1.37      onoe 	sc->sc_txbase = AWI_BUFFERS;
   1526      1.37      onoe 	sc->sc_txend = sc->sc_txbase +
   1527      1.37      onoe 	    (AWI_TXD_SIZE + sizeof(struct ieee80211_frame) +
   1528      1.37      onoe 	    sizeof(struct ether_header) + ETHERMTU) * AWI_NTXBUFS;
   1529      1.37      onoe 	LE_WRITE_4(&sc->sc_mib_local.Tx_Buffer_Offset, sc->sc_txbase);
   1530      1.37      onoe 	LE_WRITE_4(&sc->sc_mib_local.Tx_Buffer_Size,
   1531      1.37      onoe 	    sc->sc_txend - sc->sc_txbase);
   1532      1.37      onoe 	LE_WRITE_4(&sc->sc_mib_local.Rx_Buffer_Offset, sc->sc_txend);
   1533      1.37      onoe 	LE_WRITE_4(&sc->sc_mib_local.Rx_Buffer_Size,
   1534      1.37      onoe 	    AWI_BUFFERS_END - sc->sc_txend);
   1535      1.37      onoe 	sc->sc_mib_local.Acting_as_AP = 0;
   1536      1.46      onoe 	sc->sc_mib_local.Fill_CFP = 0;
   1537      1.46      onoe 
   1538      1.46      onoe 	memset(&sc->sc_mib_mac.aDesired_ESS_ID, 0, AWI_ESS_ID_SIZE);
   1539      1.46      onoe 	sc->sc_mib_mac.aDesired_ESS_ID[0] = IEEE80211_ELEMID_SSID;
   1540      1.46      onoe 
   1541      1.46      onoe 	sc->sc_mib_mgt.aPower_Mgt_Mode = 0;
   1542      1.46      onoe 	sc->sc_mib_mgt.aDTIM_Period = 1;
   1543      1.46      onoe 	LE_WRITE_2(&sc->sc_mib_mgt.aATIM_Window, 0);
   1544      1.37      onoe 	return 0;
   1545       1.1  sommerfe }
   1546       1.1  sommerfe 
   1547      1.37      onoe static int
   1548      1.37      onoe awi_mib(struct awi_softc *sc, u_int8_t cmd, u_int8_t mib, int wflag)
   1549       1.1  sommerfe {
   1550      1.10      onoe 	int error;
   1551      1.10      onoe 	u_int8_t size, *ptr;
   1552       1.1  sommerfe 
   1553      1.10      onoe 	switch (mib) {
   1554      1.10      onoe 	case AWI_MIB_LOCAL:
   1555      1.10      onoe 		ptr = (u_int8_t *)&sc->sc_mib_local;
   1556      1.10      onoe 		size = sizeof(sc->sc_mib_local);
   1557      1.10      onoe 		break;
   1558      1.10      onoe 	case AWI_MIB_ADDR:
   1559      1.10      onoe 		ptr = (u_int8_t *)&sc->sc_mib_addr;
   1560      1.10      onoe 		size = sizeof(sc->sc_mib_addr);
   1561      1.10      onoe 		break;
   1562      1.10      onoe 	case AWI_MIB_MAC:
   1563      1.10      onoe 		ptr = (u_int8_t *)&sc->sc_mib_mac;
   1564      1.10      onoe 		size = sizeof(sc->sc_mib_mac);
   1565      1.10      onoe 		break;
   1566      1.10      onoe 	case AWI_MIB_STAT:
   1567      1.10      onoe 		ptr = (u_int8_t *)&sc->sc_mib_stat;
   1568      1.10      onoe 		size = sizeof(sc->sc_mib_stat);
   1569      1.10      onoe 		break;
   1570      1.10      onoe 	case AWI_MIB_MGT:
   1571      1.10      onoe 		ptr = (u_int8_t *)&sc->sc_mib_mgt;
   1572      1.10      onoe 		size = sizeof(sc->sc_mib_mgt);
   1573      1.10      onoe 		break;
   1574      1.10      onoe 	case AWI_MIB_PHY:
   1575      1.10      onoe 		ptr = (u_int8_t *)&sc->sc_mib_phy;
   1576      1.10      onoe 		size = sizeof(sc->sc_mib_phy);
   1577      1.10      onoe 		break;
   1578      1.10      onoe 	default:
   1579      1.10      onoe 		return EINVAL;
   1580       1.1  sommerfe 	}
   1581      1.10      onoe 	if (sc->sc_cmd_inprog) {
   1582      1.37      onoe 		if ((error = awi_cmd_wait(sc)) != 0) {
   1583      1.20      onoe 			if (error == EWOULDBLOCK)
   1584      1.37      onoe 				DPRINTF(("awi_mib: cmd %d inprog",
   1585      1.37      onoe 				    sc->sc_cmd_inprog));
   1586      1.10      onoe 			return error;
   1587      1.10      onoe 		}
   1588      1.10      onoe 	}
   1589      1.20      onoe 	sc->sc_cmd_inprog = cmd;
   1590      1.10      onoe 	if (cmd == AWI_CMD_SET_MIB)
   1591      1.37      onoe 		awi_write_bytes(sc, AWI_CA_MIB_DATA, ptr, size);
   1592      1.37      onoe 	awi_write_1(sc, AWI_CA_MIB_TYPE, mib);
   1593      1.37      onoe 	awi_write_1(sc, AWI_CA_MIB_SIZE, size);
   1594      1.37      onoe 	awi_write_1(sc, AWI_CA_MIB_INDEX, 0);
   1595      1.37      onoe 	if ((error = awi_cmd(sc, cmd, wflag)) != 0)
   1596      1.10      onoe 		return error;
   1597      1.10      onoe 	if (cmd == AWI_CMD_GET_MIB) {
   1598      1.37      onoe 		awi_read_bytes(sc, AWI_CA_MIB_DATA, ptr, size);
   1599      1.10      onoe #ifdef AWI_DEBUG
   1600      1.37      onoe 		if (awi_debug) {
   1601      1.10      onoe 			int i;
   1602       1.1  sommerfe 
   1603      1.10      onoe 			printf("awi_mib: #%d:", mib);
   1604      1.10      onoe 			for (i = 0; i < size; i++)
   1605      1.10      onoe 				printf(" %02x", ptr[i]);
   1606      1.10      onoe 			printf("\n");
   1607      1.10      onoe 		}
   1608       1.1  sommerfe #endif
   1609      1.10      onoe 	}
   1610      1.10      onoe 	return 0;
   1611       1.1  sommerfe }
   1612       1.1  sommerfe 
   1613      1.10      onoe static int
   1614      1.37      onoe awi_cmd(struct awi_softc *sc, u_int8_t cmd, int wflag)
   1615       1.1  sommerfe {
   1616      1.10      onoe 	u_int8_t status;
   1617      1.10      onoe 	int error = 0;
   1618      1.37      onoe #ifdef AWI_DEBUG
   1619      1.37      onoe 	static const char *cmdname[] = {
   1620      1.37      onoe 	    "IDLE", "NOP", "SET_MIB", "INIT_TX", "FLUSH_TX", "INIT_RX",
   1621      1.37      onoe 	    "KILL_RX", "SLEEP", "WAKE", "GET_MIB", "SCAN", "SYNC", "RESUME"
   1622      1.37      onoe 	};
   1623      1.37      onoe #endif
   1624      1.10      onoe 
   1625      1.37      onoe #ifdef AWI_DEBUG
   1626      1.37      onoe 	if (awi_debug > 1) {
   1627      1.37      onoe 		if (cmd >= sizeof(cmdname)/sizeof(cmdname[0]))
   1628      1.37      onoe 			printf("awi_cmd: #%d", cmd);
   1629      1.37      onoe 		else
   1630      1.37      onoe 			printf("awi_cmd: %s", cmdname[cmd]);
   1631      1.37      onoe 		printf(" %s\n", wflag == AWI_NOWAIT ? "nowait" : "wait");
   1632      1.37      onoe 	}
   1633      1.37      onoe #endif
   1634      1.20      onoe 	sc->sc_cmd_inprog = cmd;
   1635      1.10      onoe 	awi_write_1(sc, AWI_CMD_STATUS, AWI_STAT_IDLE);
   1636      1.10      onoe 	awi_write_1(sc, AWI_CMD, cmd);
   1637      1.37      onoe 	if (wflag == AWI_NOWAIT)
   1638      1.37      onoe 		return EINPROGRESS;
   1639      1.37      onoe 	if ((error = awi_cmd_wait(sc)) != 0)
   1640      1.10      onoe 		return error;
   1641      1.10      onoe 	status = awi_read_1(sc, AWI_CMD_STATUS);
   1642      1.10      onoe 	awi_write_1(sc, AWI_CMD, 0);
   1643      1.10      onoe 	switch (status) {
   1644      1.10      onoe 	case AWI_STAT_OK:
   1645      1.10      onoe 		break;
   1646      1.10      onoe 	case AWI_STAT_BADPARM:
   1647      1.10      onoe 		return EINVAL;
   1648      1.10      onoe 	default:
   1649      1.10      onoe 		printf("%s: command %d failed %x\n",
   1650  1.52.2.1     skrll 		    sc->sc_ic.ic_if.if_xname, cmd, status);
   1651      1.10      onoe 		return ENXIO;
   1652      1.10      onoe 	}
   1653      1.10      onoe 	return 0;
   1654       1.1  sommerfe }
   1655       1.1  sommerfe 
   1656      1.37      onoe static int
   1657      1.37      onoe awi_cmd_wait(struct awi_softc *sc)
   1658      1.37      onoe {
   1659      1.37      onoe 	int i, error = 0;
   1660      1.37      onoe 
   1661      1.37      onoe 	i = 0;
   1662      1.37      onoe 	while (sc->sc_cmd_inprog) {
   1663      1.37      onoe 		if (sc->sc_invalid)
   1664      1.37      onoe 			return ENXIO;
   1665      1.37      onoe 		if (awi_read_1(sc, AWI_CMD) != sc->sc_cmd_inprog) {
   1666      1.37      onoe 			printf("%s: failed to access hardware\n",
   1667  1.52.2.1     skrll 			    sc->sc_ic.ic_if.if_xname);
   1668      1.37      onoe 			sc->sc_invalid = 1;
   1669      1.37      onoe 			return ENXIO;
   1670      1.37      onoe 		}
   1671      1.37      onoe 		if (sc->sc_cansleep) {
   1672      1.37      onoe 			sc->sc_sleep_cnt++;
   1673      1.37      onoe 			error = tsleep(sc, PWAIT, "awicmd",
   1674      1.37      onoe 			    AWI_CMD_TIMEOUT*hz/1000);
   1675      1.37      onoe 			sc->sc_sleep_cnt--;
   1676      1.37      onoe 		} else {
   1677      1.37      onoe 			if (awi_read_1(sc, AWI_CMD_STATUS) != AWI_STAT_IDLE) {
   1678      1.37      onoe 				awi_cmd_done(sc);
   1679      1.37      onoe 				break;
   1680      1.37      onoe 			}
   1681      1.37      onoe 			if (i++ >= AWI_CMD_TIMEOUT*1000/10)
   1682      1.37      onoe 				error = EWOULDBLOCK;
   1683      1.37      onoe 			else
   1684      1.37      onoe 				DELAY(10);
   1685      1.37      onoe 		}
   1686      1.37      onoe 		if (error)
   1687      1.37      onoe 			break;
   1688      1.37      onoe 	}
   1689      1.37      onoe 	if (error) {
   1690      1.37      onoe 		DPRINTF(("awi_cmd_wait: cmd 0x%x, error %d\n",
   1691      1.37      onoe 		    sc->sc_cmd_inprog, error));
   1692      1.37      onoe 	}
   1693      1.37      onoe 	return error;
   1694      1.37      onoe }
   1695      1.37      onoe 
   1696      1.10      onoe static void
   1697      1.37      onoe awi_cmd_done(struct awi_softc *sc)
   1698       1.1  sommerfe {
   1699      1.10      onoe 	u_int8_t cmd, status;
   1700      1.10      onoe 
   1701      1.10      onoe 	status = awi_read_1(sc, AWI_CMD_STATUS);
   1702      1.10      onoe 	if (status == AWI_STAT_IDLE)
   1703      1.10      onoe 		return;		/* stray interrupt */
   1704      1.10      onoe 
   1705      1.20      onoe 	cmd = sc->sc_cmd_inprog;
   1706      1.10      onoe 	sc->sc_cmd_inprog = 0;
   1707      1.37      onoe 	wakeup(sc);
   1708      1.10      onoe 	awi_write_1(sc, AWI_CMD, 0);
   1709      1.10      onoe 
   1710      1.10      onoe 	if (status != AWI_STAT_OK) {
   1711      1.10      onoe 		printf("%s: command %d failed %x\n",
   1712  1.52.2.1     skrll 		    sc->sc_ic.ic_if.if_xname, cmd, status);
   1713      1.37      onoe 		sc->sc_substate = AWI_ST_NONE;
   1714      1.10      onoe 		return;
   1715      1.10      onoe 	}
   1716      1.37      onoe 	if (sc->sc_substate != AWI_ST_NONE)
   1717  1.52.2.1     skrll 		(void)ieee80211_new_state(&sc->sc_ic, sc->sc_nstate, -1);
   1718       1.1  sommerfe }
   1719       1.1  sommerfe 
   1720      1.10      onoe static int
   1721      1.37      onoe awi_next_txd(struct awi_softc *sc, int len, u_int32_t *framep, u_int32_t *ntxdp)
   1722       1.1  sommerfe {
   1723      1.10      onoe 	u_int32_t txd, ntxd, frame;
   1724       1.1  sommerfe 
   1725      1.10      onoe 	txd = sc->sc_txnext;
   1726      1.10      onoe 	frame = txd + AWI_TXD_SIZE;
   1727      1.10      onoe 	if (frame + len > sc->sc_txend)
   1728      1.10      onoe 		frame = sc->sc_txbase;
   1729      1.10      onoe 	ntxd = frame + len;
   1730      1.10      onoe 	if (ntxd + AWI_TXD_SIZE > sc->sc_txend)
   1731      1.10      onoe 		ntxd = sc->sc_txbase;
   1732      1.10      onoe 	*framep = frame;
   1733      1.10      onoe 	*ntxdp = ntxd;
   1734      1.10      onoe 	/*
   1735      1.10      onoe 	 * Determine if there are any room in ring buffer.
   1736      1.10      onoe 	 *		--- send wait,  === new data,  +++ conflict (ENOBUFS)
   1737      1.10      onoe 	 *   base........................end
   1738      1.10      onoe 	 *	   done----txd=====ntxd		OK
   1739      1.10      onoe 	 *	 --txd=====done++++ntxd--	full
   1740      1.10      onoe 	 *	 --txd=====ntxd    done--	OK
   1741      1.10      onoe 	 *	 ==ntxd    done----txd===	OK
   1742      1.10      onoe 	 *	 ==done++++ntxd----txd===	full
   1743      1.10      onoe 	 *	 ++ntxd    txd=====done++	full
   1744      1.10      onoe 	 */
   1745      1.10      onoe 	if (txd < ntxd) {
   1746      1.10      onoe 		if (txd < sc->sc_txdone && ntxd + AWI_TXD_SIZE > sc->sc_txdone)
   1747      1.10      onoe 			return ENOBUFS;
   1748      1.10      onoe 	} else {
   1749      1.10      onoe 		if (txd < sc->sc_txdone || ntxd + AWI_TXD_SIZE > sc->sc_txdone)
   1750      1.10      onoe 			return ENOBUFS;
   1751       1.1  sommerfe 	}
   1752      1.10      onoe 	return 0;
   1753       1.1  sommerfe }
   1754       1.1  sommerfe 
   1755      1.10      onoe static int
   1756      1.37      onoe awi_lock(struct awi_softc *sc)
   1757       1.1  sommerfe {
   1758      1.10      onoe 	int error = 0;
   1759       1.1  sommerfe 
   1760  1.52.2.1     skrll #ifdef __NetBSD__
   1761  1.52.2.1     skrll 	if (curlwp == NULL)
   1762  1.52.2.1     skrll #else
   1763  1.52.2.1     skrll 	if (curproc == NULL)
   1764  1.52.2.1     skrll #endif
   1765  1.52.2.1     skrll 	{
   1766      1.10      onoe 		/*
   1767      1.10      onoe 		 * XXX
   1768      1.10      onoe 		 * Though driver ioctl should be called with context,
   1769      1.10      onoe 		 * KAME ipv6 stack calls ioctl in interrupt for now.
   1770      1.10      onoe 		 * We simply abort the request if there are other
   1771      1.10      onoe 		 * ioctl requests in progress.
   1772      1.10      onoe 		 */
   1773      1.20      onoe 		if (sc->sc_busy) {
   1774      1.20      onoe 			if (sc->sc_invalid)
   1775      1.20      onoe 				return ENXIO;
   1776  1.52.2.1     skrll 			return EWOULDBLOCK;
   1777      1.20      onoe 		}
   1778      1.10      onoe 		sc->sc_busy = 1;
   1779      1.10      onoe 		sc->sc_cansleep = 0;
   1780      1.10      onoe 		return 0;
   1781       1.1  sommerfe 	}
   1782      1.10      onoe 	while (sc->sc_busy) {
   1783      1.20      onoe 		if (sc->sc_invalid)
   1784      1.20      onoe 			return ENXIO;
   1785      1.10      onoe 		sc->sc_sleep_cnt++;
   1786      1.10      onoe 		error = tsleep(sc, PWAIT | PCATCH, "awilck", 0);
   1787      1.10      onoe 		sc->sc_sleep_cnt--;
   1788      1.10      onoe 		if (error)
   1789      1.10      onoe 			return error;
   1790       1.6  sommerfe 	}
   1791      1.10      onoe 	sc->sc_busy = 1;
   1792      1.10      onoe 	sc->sc_cansleep = 1;
   1793      1.10      onoe 	return 0;
   1794      1.10      onoe }
   1795       1.1  sommerfe 
   1796      1.10      onoe static void
   1797      1.37      onoe awi_unlock(struct awi_softc *sc)
   1798      1.10      onoe {
   1799      1.10      onoe 	sc->sc_busy = 0;
   1800      1.10      onoe 	sc->sc_cansleep = 0;
   1801      1.10      onoe 	if (sc->sc_sleep_cnt)
   1802      1.10      onoe 		wakeup(sc);
   1803       1.1  sommerfe }
   1804       1.1  sommerfe 
   1805      1.10      onoe static int
   1806      1.37      onoe awi_intr_lock(struct awi_softc *sc)
   1807      1.10      onoe {
   1808       1.1  sommerfe 	u_int8_t status;
   1809      1.10      onoe 	int i, retry;
   1810      1.10      onoe 
   1811      1.10      onoe 	status = 1;
   1812      1.10      onoe 	for (retry = 0; retry < 10; retry++) {
   1813      1.10      onoe 		for (i = 0; i < AWI_LOCKOUT_TIMEOUT*1000/5; i++) {
   1814      1.37      onoe 			if ((status = awi_read_1(sc, AWI_LOCKOUT_HOST)) == 0)
   1815      1.10      onoe 				break;
   1816      1.10      onoe 			DELAY(5);
   1817      1.10      onoe 		}
   1818      1.10      onoe 		if (status != 0)
   1819      1.10      onoe 			break;
   1820      1.10      onoe 		awi_write_1(sc, AWI_LOCKOUT_MAC, 1);
   1821      1.37      onoe 		if ((status = awi_read_1(sc, AWI_LOCKOUT_HOST)) == 0)
   1822      1.10      onoe 			break;
   1823      1.10      onoe 		awi_write_1(sc, AWI_LOCKOUT_MAC, 0);
   1824       1.1  sommerfe 	}
   1825      1.10      onoe 	if (status != 0) {
   1826      1.10      onoe 		printf("%s: failed to lock interrupt\n",
   1827  1.52.2.1     skrll 		    sc->sc_ic.ic_if.if_xname);
   1828      1.10      onoe 		return ENXIO;
   1829       1.6  sommerfe 	}
   1830      1.10      onoe 	return 0;
   1831       1.1  sommerfe }
   1832       1.1  sommerfe 
   1833      1.10      onoe static void
   1834      1.37      onoe awi_intr_unlock(struct awi_softc *sc)
   1835       1.1  sommerfe {
   1836       1.1  sommerfe 
   1837      1.10      onoe 	awi_write_1(sc, AWI_LOCKOUT_MAC, 0);
   1838       1.1  sommerfe }
   1839       1.1  sommerfe 
   1840      1.10      onoe static int
   1841  1.52.2.1     skrll awi_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg)
   1842       1.1  sommerfe {
   1843  1.52.2.1     skrll 	struct awi_softc *sc = ic->ic_softc;
   1844      1.47      onoe 	struct ieee80211_node *ni;
   1845      1.37      onoe 	struct ifnet *ifp = &ic->ic_if;
   1846      1.40      onoe 	int error;
   1847      1.37      onoe 	u_int8_t newmode;
   1848      1.37      onoe 	enum ieee80211_state ostate;
   1849      1.37      onoe #ifdef AWI_DEBUG
   1850      1.37      onoe 	static const char *stname[] =
   1851      1.37      onoe 	    { "INIT", "SCAN", "AUTH", "ASSOC", "RUN" };
   1852      1.37      onoe 	static const char *substname[] =
   1853      1.37      onoe 	    { "NONE", "SCAN_INIT", "SCAN_SETMIB", "SCAN_SCCMD",
   1854      1.37      onoe 	      "SUB_INIT", "SUB_SETSS", "SUB_SYNC" };
   1855      1.37      onoe #endif /* AWI_DEBUG */
   1856      1.37      onoe 
   1857      1.37      onoe 	ostate = ic->ic_state;
   1858      1.37      onoe 	DPRINTF(("awi_newstate: %s (%s/%s) -> %s\n", stname[ostate],
   1859      1.37      onoe 	    stname[sc->sc_nstate], substname[sc->sc_substate], stname[nstate]));
   1860      1.37      onoe 
   1861      1.37      onoe 	/* set LED */
   1862      1.37      onoe 	switch (nstate) {
   1863      1.37      onoe 	case IEEE80211_S_INIT:
   1864      1.37      onoe 		awi_drvstate(sc, AWI_DRV_RESET);
   1865      1.37      onoe 		break;
   1866      1.37      onoe 	case IEEE80211_S_SCAN:
   1867      1.49      onoe 		if (ic->ic_opmode == IEEE80211_M_IBSS ||
   1868      1.49      onoe 		    ic->ic_opmode == IEEE80211_M_AHDEMO)
   1869      1.37      onoe 			awi_drvstate(sc, AWI_DRV_ADHSC);
   1870      1.37      onoe 		else
   1871      1.37      onoe 			awi_drvstate(sc, AWI_DRV_INFSY);
   1872      1.37      onoe 		break;
   1873      1.37      onoe 	case IEEE80211_S_AUTH:
   1874      1.37      onoe 		awi_drvstate(sc, AWI_DRV_INFSY);
   1875      1.37      onoe 		break;
   1876      1.37      onoe 	case IEEE80211_S_ASSOC:
   1877      1.37      onoe 		awi_drvstate(sc, AWI_DRV_INFAUTH);
   1878      1.37      onoe 		break;
   1879      1.37      onoe 	case IEEE80211_S_RUN:
   1880      1.49      onoe 		if (ic->ic_opmode == IEEE80211_M_IBSS ||
   1881      1.49      onoe 		    ic->ic_opmode == IEEE80211_M_AHDEMO)
   1882      1.37      onoe 			awi_drvstate(sc, AWI_DRV_ADHSY);
   1883      1.37      onoe 		else
   1884      1.37      onoe 			awi_drvstate(sc, AWI_DRV_INFASSOC);
   1885      1.37      onoe 		break;
   1886      1.37      onoe 	}
   1887      1.37      onoe 
   1888      1.37      onoe 	if (nstate == IEEE80211_S_INIT) {
   1889      1.37      onoe 		sc->sc_substate = AWI_ST_NONE;
   1890      1.37      onoe 		ic->ic_flags &= ~IEEE80211_F_SIBSS;
   1891  1.52.2.1     skrll 		return (*sc->sc_newstate)(ic, nstate, arg);
   1892      1.37      onoe 	}
   1893      1.10      onoe 
   1894      1.37      onoe 	/* state transition */
   1895      1.37      onoe 	if (nstate == IEEE80211_S_SCAN) {
   1896      1.37      onoe 		/* SCAN substate */
   1897      1.37      onoe 		if (sc->sc_substate == AWI_ST_NONE) {
   1898      1.37      onoe 			sc->sc_nstate = nstate;	/* next state in transition */
   1899      1.37      onoe 			sc->sc_substate = AWI_ST_SCAN_INIT;
   1900      1.37      onoe 		}
   1901      1.37      onoe 		switch (sc->sc_substate) {
   1902      1.37      onoe 		case AWI_ST_SCAN_INIT:
   1903      1.37      onoe 			sc->sc_substate = AWI_ST_SCAN_SETMIB;
   1904      1.37      onoe 			switch (ostate) {
   1905      1.37      onoe 			case IEEE80211_S_RUN:
   1906      1.37      onoe 				/* beacon miss */
   1907      1.37      onoe 				if (ifp->if_flags & IFF_DEBUG)
   1908      1.37      onoe 					printf("%s: no recent beacons from %s;"
   1909      1.37      onoe 					    " rescanning\n",
   1910      1.37      onoe 					    ifp->if_xname,
   1911  1.52.2.1     skrll 					    ether_sprintf(ic->ic_bss->ni_bssid));
   1912      1.37      onoe 				/* FALLTHRU */
   1913      1.37      onoe 			case IEEE80211_S_AUTH:
   1914      1.37      onoe 			case IEEE80211_S_ASSOC:
   1915      1.37      onoe 			case IEEE80211_S_INIT:
   1916  1.52.2.1     skrll 				ieee80211_begin_scan(ic);
   1917      1.37      onoe 				/* FALLTHRU */
   1918      1.37      onoe 			case IEEE80211_S_SCAN:
   1919      1.37      onoe 				/* scan next */
   1920      1.37      onoe 				break;
   1921      1.37      onoe 			}
   1922      1.37      onoe 			if (ic->ic_flags & IEEE80211_F_ASCAN)
   1923      1.37      onoe 				newmode = AWI_SCAN_ACTIVE;
   1924      1.37      onoe 			else
   1925      1.37      onoe 				newmode = AWI_SCAN_PASSIVE;
   1926      1.37      onoe 			if (sc->sc_mib_mgt.aScan_Mode != newmode) {
   1927      1.37      onoe 				sc->sc_mib_mgt.aScan_Mode = newmode;
   1928      1.37      onoe 				if ((error = awi_mib(sc, AWI_CMD_SET_MIB,
   1929      1.37      onoe 				    AWI_MIB_MGT, AWI_NOWAIT)) != 0)
   1930      1.37      onoe 					break;
   1931      1.37      onoe 			}
   1932      1.37      onoe 			/* FALLTHRU */
   1933      1.37      onoe 		case AWI_ST_SCAN_SETMIB:
   1934      1.37      onoe 			sc->sc_substate = AWI_ST_SCAN_SCCMD;
   1935      1.37      onoe 			if (sc->sc_cmd_inprog) {
   1936      1.37      onoe 				if ((error = awi_cmd_wait(sc)) != 0)
   1937      1.37      onoe 					break;
   1938      1.37      onoe 			}
   1939      1.37      onoe 			sc->sc_cmd_inprog = AWI_CMD_SCAN;
   1940  1.52.2.1     skrll 			ni = ic->ic_bss;
   1941      1.37      onoe 			awi_write_2(sc, AWI_CA_SCAN_DURATION,
   1942      1.37      onoe 			    (ic->ic_flags & IEEE80211_F_ASCAN) ?
   1943      1.37      onoe 			    AWI_ASCAN_DURATION : AWI_PSCAN_DURATION);
   1944      1.37      onoe 			if (sc->sc_mib_phy.IEEE_PHY_Type == AWI_PHY_TYPE_FH) {
   1945      1.39      onoe 				awi_write_1(sc, AWI_CA_SCAN_SET,
   1946  1.52.2.1     skrll 				    IEEE80211_FH_CHANSET(
   1947  1.52.2.1     skrll 				        ieee80211_chan2ieee(ic, ni->ni_chan)));
   1948      1.37      onoe 				awi_write_1(sc, AWI_CA_SCAN_PATTERN,
   1949  1.52.2.1     skrll 				    IEEE80211_FH_CHANPAT(
   1950  1.52.2.1     skrll 				        ieee80211_chan2ieee(ic, ni->ni_chan)));
   1951      1.37      onoe 				awi_write_1(sc, AWI_CA_SCAN_IDX, 1);
   1952      1.37      onoe 			} else {
   1953  1.52.2.1     skrll 				awi_write_1(sc, AWI_CA_SCAN_SET,
   1954  1.52.2.1     skrll 				    ieee80211_chan2ieee(ic, ni->ni_chan));
   1955      1.37      onoe 				awi_write_1(sc, AWI_CA_SCAN_PATTERN, 0);
   1956      1.37      onoe 				awi_write_1(sc, AWI_CA_SCAN_IDX, 0);
   1957      1.37      onoe 			}
   1958      1.37      onoe 			awi_write_1(sc, AWI_CA_SCAN_SUSP, 0);
   1959  1.52.2.1     skrll 			sc->sc_cur_chan = ieee80211_chan2ieee(ic, ni->ni_chan);
   1960      1.37      onoe 			if ((error = awi_cmd(sc, AWI_CMD_SCAN, AWI_NOWAIT))
   1961      1.37      onoe 			    != 0)
   1962      1.37      onoe 				break;
   1963      1.37      onoe 			/* FALLTHRU */
   1964      1.37      onoe 		case AWI_ST_SCAN_SCCMD:
   1965      1.37      onoe 			ic->ic_state = nstate;
   1966      1.37      onoe 			sc->sc_substate = AWI_ST_NONE;
   1967      1.37      onoe 			error = EINPROGRESS;
   1968      1.37      onoe 			break;
   1969      1.37      onoe 		default:
   1970      1.37      onoe 			DPRINTF(("awi_newstate: unexpected state %s/%s\n",
   1971      1.37      onoe 			    stname[nstate], substname[sc->sc_substate]));
   1972      1.37      onoe 			sc->sc_substate = AWI_ST_NONE;
   1973      1.37      onoe 			error = EIO;
   1974      1.37      onoe 			break;
   1975      1.20      onoe 		}
   1976  1.52.2.1     skrll 		goto out;
   1977      1.37      onoe 	}
   1978      1.37      onoe 
   1979      1.37      onoe 	if (ostate == IEEE80211_S_SCAN) {
   1980      1.37      onoe 		/* set SSID and channel */
   1981      1.37      onoe 		/* substate */
   1982      1.37      onoe 		if (sc->sc_substate == AWI_ST_NONE) {
   1983      1.37      onoe 			sc->sc_nstate = nstate;	/* next state in transition */
   1984      1.37      onoe 			sc->sc_substate = AWI_ST_SUB_INIT;
   1985      1.37      onoe 		}
   1986  1.52.2.1     skrll 		ni = ic->ic_bss;
   1987      1.37      onoe 		switch (sc->sc_substate) {
   1988      1.37      onoe 		case AWI_ST_SUB_INIT:
   1989      1.37      onoe 			sc->sc_substate = AWI_ST_SUB_SETSS;
   1990      1.47      onoe 			IEEE80211_ADDR_COPY(&sc->sc_mib_mgt.aCurrent_BSS_ID,
   1991      1.47      onoe 			    ni->ni_bssid);
   1992      1.37      onoe 			memset(&sc->sc_mib_mgt.aCurrent_ESS_ID, 0,
   1993      1.37      onoe 			    AWI_ESS_ID_SIZE);
   1994      1.37      onoe 			sc->sc_mib_mgt.aCurrent_ESS_ID[0] =
   1995      1.37      onoe 			    IEEE80211_ELEMID_SSID;
   1996      1.47      onoe 			sc->sc_mib_mgt.aCurrent_ESS_ID[1] = ni->ni_esslen;
   1997      1.37      onoe 			memcpy(&sc->sc_mib_mgt.aCurrent_ESS_ID[2],
   1998      1.47      onoe 			    ni->ni_essid, ni->ni_esslen);
   1999      1.37      onoe 			LE_WRITE_2(&sc->sc_mib_mgt.aBeacon_Period,
   2000      1.47      onoe 			    ni->ni_intval);
   2001      1.37      onoe 			if ((error = awi_mib(sc, AWI_CMD_SET_MIB, AWI_MIB_MGT,
   2002      1.37      onoe 			    AWI_NOWAIT)) != 0)
   2003      1.10      onoe 				break;
   2004      1.37      onoe 			/* FALLTHRU */
   2005      1.37      onoe 		case AWI_ST_SUB_SETSS:
   2006      1.37      onoe 			sc->sc_substate = AWI_ST_SUB_SYNC;
   2007      1.37      onoe 			if (sc->sc_cmd_inprog) {
   2008      1.43      onoe 				if ((error = awi_cmd_wait(sc)) != 0)
   2009      1.37      onoe 					break;
   2010      1.10      onoe 			}
   2011      1.37      onoe 			sc->sc_cmd_inprog = AWI_CMD_SYNC;
   2012      1.37      onoe 			if (sc->sc_mib_phy.IEEE_PHY_Type == AWI_PHY_TYPE_FH) {
   2013      1.39      onoe 				awi_write_1(sc, AWI_CA_SYNC_SET,
   2014  1.52.2.1     skrll 				    IEEE80211_FH_CHANSET(
   2015  1.52.2.1     skrll 				        ieee80211_chan2ieee(ic, ni->ni_chan)));
   2016      1.39      onoe 				awi_write_1(sc, AWI_CA_SYNC_PATTERN,
   2017  1.52.2.1     skrll 				    IEEE80211_FH_CHANPAT(
   2018  1.52.2.1     skrll 				        ieee80211_chan2ieee(ic, ni->ni_chan)));
   2019      1.40      onoe 				awi_write_1(sc, AWI_CA_SYNC_IDX,
   2020      1.47      onoe 				    ni->ni_fhindex);
   2021      1.40      onoe 				awi_write_2(sc, AWI_CA_SYNC_DWELL,
   2022      1.47      onoe 				    ni->ni_fhdwell);
   2023      1.37      onoe 			} else {
   2024  1.52.2.1     skrll 				awi_write_1(sc, AWI_CA_SYNC_SET,
   2025  1.52.2.1     skrll 				    ieee80211_chan2ieee(ic, ni->ni_chan));
   2026      1.37      onoe 				awi_write_1(sc, AWI_CA_SYNC_PATTERN, 0);
   2027      1.40      onoe 				awi_write_1(sc, AWI_CA_SYNC_IDX, 0);
   2028      1.40      onoe 				awi_write_2(sc, AWI_CA_SYNC_DWELL, 0);
   2029      1.37      onoe 			}
   2030  1.52.2.1     skrll 			if (ic->ic_flags & IEEE80211_F_SIBSS) {
   2031  1.52.2.1     skrll 				memset(ni->ni_tstamp, 0, sizeof(ni->ni_tstamp));
   2032  1.52.2.1     skrll 				ni->ni_rstamp = 0;
   2033      1.37      onoe 				awi_write_1(sc, AWI_CA_SYNC_STARTBSS, 1);
   2034  1.52.2.1     skrll 			} else
   2035      1.37      onoe 				awi_write_1(sc, AWI_CA_SYNC_STARTBSS, 0);
   2036      1.37      onoe 			awi_write_2(sc, AWI_CA_SYNC_MBZ, 0);
   2037      1.37      onoe 			awi_write_bytes(sc, AWI_CA_SYNC_TIMESTAMP,
   2038      1.47      onoe 			    ni->ni_tstamp, 8);
   2039      1.47      onoe 			awi_write_4(sc, AWI_CA_SYNC_REFTIME, ni->ni_rstamp);
   2040  1.52.2.1     skrll 			sc->sc_cur_chan = ieee80211_chan2ieee(ic, ni->ni_chan);
   2041      1.37      onoe 			if ((error = awi_cmd(sc, AWI_CMD_SYNC, AWI_NOWAIT))
   2042      1.37      onoe 			    != 0)
   2043      1.37      onoe 				break;
   2044      1.37      onoe 			/* FALLTHRU */
   2045      1.37      onoe 		case AWI_ST_SUB_SYNC:
   2046      1.37      onoe 			sc->sc_substate = AWI_ST_NONE;
   2047      1.37      onoe 			if (ic->ic_flags & IEEE80211_F_SIBSS) {
   2048      1.37      onoe 				if ((error = awi_mib(sc, AWI_CMD_GET_MIB,
   2049      1.37      onoe 				    AWI_MIB_MGT, AWI_WAIT)) != 0)
   2050      1.37      onoe 					break;
   2051      1.47      onoe 				IEEE80211_ADDR_COPY(ni->ni_bssid,
   2052      1.47      onoe 				    &sc->sc_mib_mgt.aCurrent_BSS_ID);
   2053      1.37      onoe 			} else {
   2054      1.37      onoe 				if (nstate == IEEE80211_S_RUN) {
   2055      1.37      onoe 					sc->sc_rx_timer = 10;
   2056      1.37      onoe 					ifp->if_timer = 1;
   2057      1.37      onoe 				}
   2058      1.37      onoe 			}
   2059      1.37      onoe 			error = 0;
   2060      1.37      onoe 			break;
   2061      1.37      onoe 		default:
   2062      1.37      onoe 			DPRINTF(("awi_newstate: unexpected state %s/%s\n",
   2063      1.37      onoe 			    stname[nstate], substname[sc->sc_substate]));
   2064      1.37      onoe 			sc->sc_substate = AWI_ST_NONE;
   2065      1.37      onoe 			error = EIO;
   2066      1.37      onoe 			break;
   2067      1.10      onoe 		}
   2068  1.52.2.1     skrll 		goto out;
   2069       1.1  sommerfe 	}
   2070      1.37      onoe 
   2071      1.37      onoe 	sc->sc_substate = AWI_ST_NONE;
   2072      1.37      onoe 
   2073  1.52.2.1     skrll 	return (*sc->sc_newstate)(ic, nstate, arg);
   2074  1.52.2.1     skrll out:
   2075  1.52.2.1     skrll 	if (error != 0) {
   2076  1.52.2.1     skrll 		if (error == EINPROGRESS)
   2077  1.52.2.1     skrll 			error = 0;
   2078  1.52.2.1     skrll 		return error;
   2079  1.52.2.1     skrll 	}
   2080  1.52.2.1     skrll 	return (*sc->sc_newstate)(ic, nstate, arg);
   2081  1.52.2.1     skrll }
   2082  1.52.2.1     skrll 
   2083  1.52.2.1     skrll static void
   2084  1.52.2.1     skrll awi_recv_mgmt(struct ieee80211com *ic, struct mbuf *m0,
   2085  1.52.2.1     skrll 	struct ieee80211_node *ni,
   2086  1.52.2.1     skrll 	int subtype, int rssi, u_int32_t rstamp)
   2087  1.52.2.1     skrll {
   2088  1.52.2.1     skrll 	struct awi_softc *sc = ic->ic_softc;
   2089  1.52.2.1     skrll 
   2090  1.52.2.1     skrll 	/* probe request is handled by hardware */
   2091  1.52.2.1     skrll 	if (subtype == IEEE80211_FC0_SUBTYPE_PROBE_REQ)
   2092  1.52.2.1     skrll 		return;
   2093  1.52.2.1     skrll 	(*sc->sc_recv_mgmt)(ic, m0, ni, subtype, rssi, rstamp);
   2094  1.52.2.1     skrll }
   2095  1.52.2.1     skrll 
   2096  1.52.2.1     skrll static int
   2097  1.52.2.1     skrll awi_send_mgmt(struct ieee80211com *ic, struct ieee80211_node *ni,
   2098  1.52.2.1     skrll 	int type, int arg)
   2099  1.52.2.1     skrll {
   2100  1.52.2.1     skrll 	struct awi_softc *sc = ic->ic_softc;
   2101  1.52.2.1     skrll 
   2102  1.52.2.1     skrll 	/* probe request is handled by hardware */
   2103  1.52.2.1     skrll 	if (type == IEEE80211_FC0_SUBTYPE_PROBE_REQ)
   2104  1.52.2.1     skrll 		return 0;
   2105  1.52.2.1     skrll 	return (*sc->sc_send_mgmt)(ic, ni, type, arg);
   2106       1.1  sommerfe }
   2107       1.1  sommerfe 
   2108      1.37      onoe static struct mbuf *
   2109      1.37      onoe awi_ether_encap(struct awi_softc *sc, struct mbuf *m)
   2110      1.20      onoe {
   2111      1.37      onoe 	struct ieee80211com *ic = &sc->sc_ic;
   2112  1.52.2.1     skrll 	struct ieee80211_node *ni = ic->ic_bss;
   2113      1.37      onoe 	struct ether_header *eh;
   2114      1.37      onoe 	struct ieee80211_frame *wh;
   2115      1.20      onoe 
   2116      1.37      onoe 	if (m->m_len < sizeof(struct ether_header)) {
   2117      1.37      onoe 		m = m_pullup(m, sizeof(struct ether_header));
   2118      1.37      onoe 		if (m == NULL)
   2119      1.37      onoe 			return NULL;
   2120      1.20      onoe 	}
   2121      1.37      onoe 	eh = mtod(m, struct ether_header *);
   2122      1.37      onoe 	M_PREPEND(m, sizeof(struct ieee80211_frame), M_DONTWAIT);
   2123      1.37      onoe 	if (m == NULL)
   2124      1.37      onoe 		return NULL;
   2125      1.37      onoe 	wh = mtod(m, struct ieee80211_frame *);
   2126      1.37      onoe 	wh->i_fc[0] = IEEE80211_FC0_VERSION_0 | IEEE80211_FC0_TYPE_DATA;
   2127      1.37      onoe 	*(u_int16_t *)wh->i_dur = 0;
   2128      1.37      onoe 	*(u_int16_t *)wh->i_seq =
   2129      1.47      onoe 	    htole16(ni->ni_txseq << IEEE80211_SEQ_SEQ_SHIFT);
   2130      1.47      onoe 	ni->ni_txseq++;
   2131      1.49      onoe 	if (ic->ic_opmode == IEEE80211_M_IBSS ||
   2132      1.49      onoe 	    ic->ic_opmode == IEEE80211_M_AHDEMO) {
   2133      1.37      onoe 		wh->i_fc[1] = IEEE80211_FC1_DIR_NODS;
   2134      1.37      onoe 		if (sc->sc_adhoc_ap)
   2135      1.47      onoe 			IEEE80211_ADDR_COPY(wh->i_addr1, ni->ni_macaddr);
   2136      1.37      onoe 		else
   2137      1.47      onoe 			IEEE80211_ADDR_COPY(wh->i_addr1, eh->ether_dhost);
   2138      1.47      onoe 		IEEE80211_ADDR_COPY(wh->i_addr2, eh->ether_shost);
   2139      1.47      onoe 		IEEE80211_ADDR_COPY(wh->i_addr3, ni->ni_bssid);
   2140      1.20      onoe 	} else {
   2141      1.37      onoe 		wh->i_fc[1] = IEEE80211_FC1_DIR_TODS;
   2142      1.47      onoe 		IEEE80211_ADDR_COPY(wh->i_addr1, ni->ni_bssid);
   2143      1.47      onoe 		IEEE80211_ADDR_COPY(wh->i_addr2, eh->ether_shost);
   2144      1.47      onoe 		IEEE80211_ADDR_COPY(wh->i_addr3, eh->ether_dhost);
   2145      1.20      onoe 	}
   2146      1.37      onoe 	return m;
   2147      1.20      onoe }
   2148      1.20      onoe 
   2149      1.37      onoe static struct mbuf *
   2150      1.37      onoe awi_ether_modcap(struct awi_softc *sc, struct mbuf *m)
   2151       1.1  sommerfe {
   2152      1.37      onoe 	struct ieee80211com *ic = &sc->sc_ic;
   2153      1.37      onoe 	struct ether_header eh;
   2154      1.37      onoe 	struct ieee80211_frame wh;
   2155      1.37      onoe 	struct llc *llc;
   2156       1.1  sommerfe 
   2157      1.37      onoe 	if (m->m_len < sizeof(wh) + sizeof(eh)) {
   2158      1.37      onoe 		m = m_pullup(m, sizeof(wh) + sizeof(eh));
   2159      1.37      onoe 		if (m == NULL)
   2160      1.37      onoe 			return NULL;
   2161      1.10      onoe 	}
   2162      1.37      onoe 	memcpy(&wh, mtod(m, caddr_t), sizeof(wh));
   2163      1.37      onoe 	if (wh.i_fc[0] != (IEEE80211_FC0_VERSION_0 | IEEE80211_FC0_TYPE_DATA))
   2164      1.37      onoe 		return m;
   2165      1.37      onoe 	memcpy(&eh, mtod(m, caddr_t) + sizeof(wh), sizeof(eh));
   2166      1.37      onoe 	m_adj(m, sizeof(eh) - sizeof(*llc));
   2167      1.49      onoe 	if (ic->ic_opmode == IEEE80211_M_IBSS ||
   2168      1.49      onoe 	    ic->ic_opmode == IEEE80211_M_AHDEMO)
   2169      1.47      onoe 		IEEE80211_ADDR_COPY(wh.i_addr2, eh.ether_shost);
   2170      1.37      onoe 	memcpy(mtod(m, caddr_t), &wh, sizeof(wh));
   2171      1.37      onoe 	llc = (struct llc *)(mtod(m, caddr_t) + sizeof(wh));
   2172      1.37      onoe 	llc->llc_dsap = llc->llc_ssap = LLC_SNAP_LSAP;
   2173      1.37      onoe 	llc->llc_control = LLC_UI;
   2174      1.37      onoe 	llc->llc_snap.org_code[0] = 0;
   2175      1.37      onoe 	llc->llc_snap.org_code[1] = 0;
   2176      1.37      onoe 	llc->llc_snap.org_code[2] = 0;
   2177      1.37      onoe 	llc->llc_snap.ether_type = eh.ether_type;
   2178      1.37      onoe 	return m;
   2179       1.1  sommerfe }
   2180