if_mwl.c revision 243857
1193240Ssam/*- 2193240Ssam * Copyright (c) 2007-2009 Sam Leffler, Errno Consulting 3193240Ssam * Copyright (c) 2007-2008 Marvell Semiconductor, Inc. 4193240Ssam * All rights reserved. 5193240Ssam * 6193240Ssam * Redistribution and use in source and binary forms, with or without 7193240Ssam * modification, are permitted provided that the following conditions 8193240Ssam * are met: 9193240Ssam * 1. Redistributions of source code must retain the above copyright 10193240Ssam * notice, this list of conditions and the following disclaimer, 11193240Ssam * without modification. 12193240Ssam * 2. Redistributions in binary form must reproduce at minimum a disclaimer 13193240Ssam * similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any 14193240Ssam * redistribution must be conditioned upon including a substantially 15193240Ssam * similar Disclaimer requirement for further binary redistribution. 16193240Ssam * 17193240Ssam * NO WARRANTY 18193240Ssam * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 19193240Ssam * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 20193240Ssam * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY 21193240Ssam * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL 22193240Ssam * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, 23193240Ssam * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 24193240Ssam * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 25193240Ssam * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER 26193240Ssam * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 27193240Ssam * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF 28193240Ssam * THE POSSIBILITY OF SUCH DAMAGES. 29193240Ssam */ 30193240Ssam 31193240Ssam#include <sys/cdefs.h> 32193240Ssam__FBSDID("$FreeBSD: head/sys/dev/mwl/if_mwl.c 243857 2012-12-04 09:32:43Z glebius $"); 33193240Ssam 34193240Ssam/* 35193240Ssam * Driver for the Marvell 88W8363 Wireless LAN controller. 36193240Ssam */ 37193240Ssam 38193240Ssam#include "opt_inet.h" 39193240Ssam#include "opt_mwl.h" 40234367Sadrian#include "opt_wlan.h" 41193240Ssam 42193240Ssam#include <sys/param.h> 43193240Ssam#include <sys/systm.h> 44193240Ssam#include <sys/sysctl.h> 45193240Ssam#include <sys/mbuf.h> 46193240Ssam#include <sys/malloc.h> 47193240Ssam#include <sys/lock.h> 48193240Ssam#include <sys/mutex.h> 49193240Ssam#include <sys/kernel.h> 50193240Ssam#include <sys/socket.h> 51193240Ssam#include <sys/sockio.h> 52193240Ssam#include <sys/errno.h> 53193240Ssam#include <sys/callout.h> 54193240Ssam#include <sys/bus.h> 55193240Ssam#include <sys/endian.h> 56193240Ssam#include <sys/kthread.h> 57193240Ssam#include <sys/taskqueue.h> 58193240Ssam 59193240Ssam#include <machine/bus.h> 60193240Ssam 61193240Ssam#include <net/if.h> 62193240Ssam#include <net/if_dl.h> 63193240Ssam#include <net/if_media.h> 64193240Ssam#include <net/if_types.h> 65193240Ssam#include <net/if_arp.h> 66193240Ssam#include <net/ethernet.h> 67193240Ssam#include <net/if_llc.h> 68193240Ssam 69193240Ssam#include <net/bpf.h> 70193240Ssam 71193240Ssam#include <net80211/ieee80211_var.h> 72193240Ssam#include <net80211/ieee80211_regdomain.h> 73193240Ssam 74193240Ssam#ifdef INET 75193240Ssam#include <netinet/in.h> 76193240Ssam#include <netinet/if_ether.h> 77193240Ssam#endif /* INET */ 78193240Ssam 79193240Ssam#include <dev/mwl/if_mwlvar.h> 80193240Ssam#include <dev/mwl/mwldiag.h> 81193240Ssam 82193240Ssam/* idiomatic shorthands: MS = mask+shift, SM = shift+mask */ 83193240Ssam#define MS(v,x) (((v) & x) >> x##_S) 84193240Ssam#define SM(v,x) (((v) << x##_S) & x) 85193240Ssam 86193240Ssamstatic struct ieee80211vap *mwl_vap_create(struct ieee80211com *, 87228621Sbschmidt const char [IFNAMSIZ], int, enum ieee80211_opmode, int, 88228621Sbschmidt const uint8_t [IEEE80211_ADDR_LEN], 89228621Sbschmidt const uint8_t [IEEE80211_ADDR_LEN]); 90193240Ssamstatic void mwl_vap_delete(struct ieee80211vap *); 91193240Ssamstatic int mwl_setupdma(struct mwl_softc *); 92193240Ssamstatic int mwl_hal_reset(struct mwl_softc *sc); 93193240Ssamstatic int mwl_init_locked(struct mwl_softc *); 94193240Ssamstatic void mwl_init(void *); 95193240Ssamstatic void mwl_stop_locked(struct ifnet *, int); 96193240Ssamstatic int mwl_reset(struct ieee80211vap *, u_long); 97193240Ssamstatic void mwl_stop(struct ifnet *, int); 98193240Ssamstatic void mwl_start(struct ifnet *); 99193240Ssamstatic int mwl_raw_xmit(struct ieee80211_node *, struct mbuf *, 100193240Ssam const struct ieee80211_bpf_params *); 101193240Ssamstatic int mwl_media_change(struct ifnet *); 102199559Sjhbstatic void mwl_watchdog(void *); 103193240Ssamstatic int mwl_ioctl(struct ifnet *, u_long, caddr_t); 104193240Ssamstatic void mwl_radar_proc(void *, int); 105193240Ssamstatic void mwl_chanswitch_proc(void *, int); 106193240Ssamstatic void mwl_bawatchdog_proc(void *, int); 107193240Ssamstatic int mwl_key_alloc(struct ieee80211vap *, 108193240Ssam struct ieee80211_key *, 109193240Ssam ieee80211_keyix *, ieee80211_keyix *); 110193240Ssamstatic int mwl_key_delete(struct ieee80211vap *, 111193240Ssam const struct ieee80211_key *); 112193240Ssamstatic int mwl_key_set(struct ieee80211vap *, const struct ieee80211_key *, 113193240Ssam const uint8_t mac[IEEE80211_ADDR_LEN]); 114193240Ssamstatic int mwl_mode_init(struct mwl_softc *); 115193240Ssamstatic void mwl_update_mcast(struct ifnet *); 116193240Ssamstatic void mwl_update_promisc(struct ifnet *); 117193240Ssamstatic void mwl_updateslot(struct ifnet *); 118193240Ssamstatic int mwl_beacon_setup(struct ieee80211vap *); 119193240Ssamstatic void mwl_beacon_update(struct ieee80211vap *, int); 120193240Ssam#ifdef MWL_HOST_PS_SUPPORT 121193240Ssamstatic void mwl_update_ps(struct ieee80211vap *, int); 122193240Ssamstatic int mwl_set_tim(struct ieee80211_node *, int); 123193240Ssam#endif 124193240Ssamstatic int mwl_dma_setup(struct mwl_softc *); 125193240Ssamstatic void mwl_dma_cleanup(struct mwl_softc *); 126193240Ssamstatic struct ieee80211_node *mwl_node_alloc(struct ieee80211vap *, 127193240Ssam const uint8_t [IEEE80211_ADDR_LEN]); 128193240Ssamstatic void mwl_node_cleanup(struct ieee80211_node *); 129193240Ssamstatic void mwl_node_drain(struct ieee80211_node *); 130193240Ssamstatic void mwl_node_getsignal(const struct ieee80211_node *, 131193240Ssam int8_t *, int8_t *); 132193240Ssamstatic void mwl_node_getmimoinfo(const struct ieee80211_node *, 133193240Ssam struct ieee80211_mimo_info *); 134193240Ssamstatic int mwl_rxbuf_init(struct mwl_softc *, struct mwl_rxbuf *); 135193240Ssamstatic void mwl_rx_proc(void *, int); 136193240Ssamstatic void mwl_txq_init(struct mwl_softc *sc, struct mwl_txq *, int); 137193240Ssamstatic int mwl_tx_setup(struct mwl_softc *, int, int); 138193240Ssamstatic int mwl_wme_update(struct ieee80211com *); 139193240Ssamstatic void mwl_tx_cleanupq(struct mwl_softc *, struct mwl_txq *); 140193240Ssamstatic void mwl_tx_cleanup(struct mwl_softc *); 141193240Ssamstatic uint16_t mwl_calcformat(uint8_t rate, const struct ieee80211_node *); 142193240Ssamstatic int mwl_tx_start(struct mwl_softc *, struct ieee80211_node *, 143193240Ssam struct mwl_txbuf *, struct mbuf *); 144193240Ssamstatic void mwl_tx_proc(void *, int); 145193240Ssamstatic int mwl_chan_set(struct mwl_softc *, struct ieee80211_channel *); 146193240Ssamstatic void mwl_draintxq(struct mwl_softc *); 147193240Ssamstatic void mwl_cleartxq(struct mwl_softc *, struct ieee80211vap *); 148195377Ssamstatic int mwl_recv_action(struct ieee80211_node *, 149195377Ssam const struct ieee80211_frame *, 150193240Ssam const uint8_t *, const uint8_t *); 151193240Ssamstatic int mwl_addba_request(struct ieee80211_node *, 152193240Ssam struct ieee80211_tx_ampdu *, int dialogtoken, 153193240Ssam int baparamset, int batimeout); 154193240Ssamstatic int mwl_addba_response(struct ieee80211_node *, 155193240Ssam struct ieee80211_tx_ampdu *, int status, 156193240Ssam int baparamset, int batimeout); 157193240Ssamstatic void mwl_addba_stop(struct ieee80211_node *, 158193240Ssam struct ieee80211_tx_ampdu *); 159193240Ssamstatic int mwl_startrecv(struct mwl_softc *); 160193240Ssamstatic MWL_HAL_APMODE mwl_getapmode(const struct ieee80211vap *, 161193240Ssam struct ieee80211_channel *); 162193240Ssamstatic int mwl_setapmode(struct ieee80211vap *, struct ieee80211_channel*); 163193240Ssamstatic void mwl_scan_start(struct ieee80211com *); 164193240Ssamstatic void mwl_scan_end(struct ieee80211com *); 165193240Ssamstatic void mwl_set_channel(struct ieee80211com *); 166193240Ssamstatic int mwl_peerstadb(struct ieee80211_node *, 167193240Ssam int aid, int staid, MWL_HAL_PEERINFO *pi); 168193240Ssamstatic int mwl_localstadb(struct ieee80211vap *); 169193240Ssamstatic int mwl_newstate(struct ieee80211vap *, enum ieee80211_state, int); 170193240Ssamstatic int allocstaid(struct mwl_softc *sc, int aid); 171193240Ssamstatic void delstaid(struct mwl_softc *sc, int staid); 172193240Ssamstatic void mwl_newassoc(struct ieee80211_node *, int); 173193240Ssamstatic void mwl_agestations(void *); 174193240Ssamstatic int mwl_setregdomain(struct ieee80211com *, 175193240Ssam struct ieee80211_regdomain *, int, 176193240Ssam struct ieee80211_channel []); 177193240Ssamstatic void mwl_getradiocaps(struct ieee80211com *, int, int *, 178193240Ssam struct ieee80211_channel []); 179193240Ssamstatic int mwl_getchannels(struct mwl_softc *); 180193240Ssam 181193240Ssamstatic void mwl_sysctlattach(struct mwl_softc *); 182193240Ssamstatic void mwl_announce(struct mwl_softc *); 183193240Ssam 184193240SsamSYSCTL_NODE(_hw, OID_AUTO, mwl, CTLFLAG_RD, 0, "Marvell driver parameters"); 185193240Ssam 186193240Ssamstatic int mwl_rxdesc = MWL_RXDESC; /* # rx desc's to allocate */ 187193240SsamSYSCTL_INT(_hw_mwl, OID_AUTO, rxdesc, CTLFLAG_RW, &mwl_rxdesc, 188193240Ssam 0, "rx descriptors allocated"); 189193240Ssamstatic int mwl_rxbuf = MWL_RXBUF; /* # rx buffers to allocate */ 190193240SsamSYSCTL_INT(_hw_mwl, OID_AUTO, rxbuf, CTLFLAG_RW, &mwl_rxbuf, 191193240Ssam 0, "rx buffers allocated"); 192193240SsamTUNABLE_INT("hw.mwl.rxbuf", &mwl_rxbuf); 193193240Ssamstatic int mwl_txbuf = MWL_TXBUF; /* # tx buffers to allocate */ 194193240SsamSYSCTL_INT(_hw_mwl, OID_AUTO, txbuf, CTLFLAG_RW, &mwl_txbuf, 195193240Ssam 0, "tx buffers allocated"); 196193240SsamTUNABLE_INT("hw.mwl.txbuf", &mwl_txbuf); 197193240Ssamstatic int mwl_txcoalesce = 8; /* # tx packets to q before poking f/w*/ 198193240SsamSYSCTL_INT(_hw_mwl, OID_AUTO, txcoalesce, CTLFLAG_RW, &mwl_txcoalesce, 199193240Ssam 0, "tx buffers to send at once"); 200193240SsamTUNABLE_INT("hw.mwl.txcoalesce", &mwl_txcoalesce); 201193240Ssamstatic int mwl_rxquota = MWL_RXBUF; /* # max buffers to process */ 202193240SsamSYSCTL_INT(_hw_mwl, OID_AUTO, rxquota, CTLFLAG_RW, &mwl_rxquota, 203193240Ssam 0, "max rx buffers to process per interrupt"); 204193240SsamTUNABLE_INT("hw.mwl.rxquota", &mwl_rxquota); 205193240Ssamstatic int mwl_rxdmalow = 3; /* # min buffers for wakeup */ 206193240SsamSYSCTL_INT(_hw_mwl, OID_AUTO, rxdmalow, CTLFLAG_RW, &mwl_rxdmalow, 207193240Ssam 0, "min free rx buffers before restarting traffic"); 208193240SsamTUNABLE_INT("hw.mwl.rxdmalow", &mwl_rxdmalow); 209193240Ssam 210193240Ssam#ifdef MWL_DEBUG 211193240Ssamstatic int mwl_debug = 0; 212193240SsamSYSCTL_INT(_hw_mwl, OID_AUTO, debug, CTLFLAG_RW, &mwl_debug, 213193240Ssam 0, "control debugging printfs"); 214193240SsamTUNABLE_INT("hw.mwl.debug", &mwl_debug); 215193240Ssamenum { 216193240Ssam MWL_DEBUG_XMIT = 0x00000001, /* basic xmit operation */ 217193240Ssam MWL_DEBUG_XMIT_DESC = 0x00000002, /* xmit descriptors */ 218193240Ssam MWL_DEBUG_RECV = 0x00000004, /* basic recv operation */ 219193240Ssam MWL_DEBUG_RECV_DESC = 0x00000008, /* recv descriptors */ 220193240Ssam MWL_DEBUG_RESET = 0x00000010, /* reset processing */ 221193240Ssam MWL_DEBUG_BEACON = 0x00000020, /* beacon handling */ 222193240Ssam MWL_DEBUG_INTR = 0x00000040, /* ISR */ 223193240Ssam MWL_DEBUG_TX_PROC = 0x00000080, /* tx ISR proc */ 224193240Ssam MWL_DEBUG_RX_PROC = 0x00000100, /* rx ISR proc */ 225193240Ssam MWL_DEBUG_KEYCACHE = 0x00000200, /* key cache management */ 226193240Ssam MWL_DEBUG_STATE = 0x00000400, /* 802.11 state transitions */ 227193240Ssam MWL_DEBUG_NODE = 0x00000800, /* node management */ 228193240Ssam MWL_DEBUG_RECV_ALL = 0x00001000, /* trace all frames (beacons) */ 229193240Ssam MWL_DEBUG_TSO = 0x00002000, /* TSO processing */ 230193240Ssam MWL_DEBUG_AMPDU = 0x00004000, /* BA stream handling */ 231193240Ssam MWL_DEBUG_ANY = 0xffffffff 232193240Ssam}; 233193240Ssam#define IS_BEACON(wh) \ 234193240Ssam ((wh->i_fc[0] & (IEEE80211_FC0_TYPE_MASK|IEEE80211_FC0_SUBTYPE_MASK)) == \ 235193240Ssam (IEEE80211_FC0_TYPE_MGT|IEEE80211_FC0_SUBTYPE_BEACON)) 236193240Ssam#define IFF_DUMPPKTS_RECV(sc, wh) \ 237193240Ssam (((sc->sc_debug & MWL_DEBUG_RECV) && \ 238193240Ssam ((sc->sc_debug & MWL_DEBUG_RECV_ALL) || !IS_BEACON(wh))) || \ 239193240Ssam (sc->sc_ifp->if_flags & (IFF_DEBUG|IFF_LINK2)) == (IFF_DEBUG|IFF_LINK2)) 240193240Ssam#define IFF_DUMPPKTS_XMIT(sc) \ 241193240Ssam ((sc->sc_debug & MWL_DEBUG_XMIT) || \ 242193240Ssam (sc->sc_ifp->if_flags & (IFF_DEBUG|IFF_LINK2)) == (IFF_DEBUG|IFF_LINK2)) 243193240Ssam#define DPRINTF(sc, m, fmt, ...) do { \ 244193240Ssam if (sc->sc_debug & (m)) \ 245193240Ssam printf(fmt, __VA_ARGS__); \ 246193240Ssam} while (0) 247193240Ssam#define KEYPRINTF(sc, hk, mac) do { \ 248193240Ssam if (sc->sc_debug & MWL_DEBUG_KEYCACHE) \ 249193240Ssam mwl_keyprint(sc, __func__, hk, mac); \ 250193240Ssam} while (0) 251193240Ssamstatic void mwl_printrxbuf(const struct mwl_rxbuf *bf, u_int ix); 252193240Ssamstatic void mwl_printtxbuf(const struct mwl_txbuf *bf, u_int qnum, u_int ix); 253193240Ssam#else 254193240Ssam#define IFF_DUMPPKTS_RECV(sc, wh) \ 255193240Ssam ((sc->sc_ifp->if_flags & (IFF_DEBUG|IFF_LINK2)) == (IFF_DEBUG|IFF_LINK2)) 256193240Ssam#define IFF_DUMPPKTS_XMIT(sc) \ 257193240Ssam ((sc->sc_ifp->if_flags & (IFF_DEBUG|IFF_LINK2)) == (IFF_DEBUG|IFF_LINK2)) 258193240Ssam#define DPRINTF(sc, m, fmt, ...) do { \ 259193240Ssam (void) sc; \ 260193240Ssam} while (0) 261193240Ssam#define KEYPRINTF(sc, k, mac) do { \ 262193240Ssam (void) sc; \ 263193240Ssam} while (0) 264193240Ssam#endif 265193240Ssam 266227293Sedstatic MALLOC_DEFINE(M_MWLDEV, "mwldev", "mwl driver dma buffers"); 267193240Ssam 268193240Ssam/* 269193240Ssam * Each packet has fixed front matter: a 2-byte length 270193240Ssam * of the payload, followed by a 4-address 802.11 header 271193240Ssam * (regardless of the actual header and always w/o any 272193240Ssam * QoS header). The payload then follows. 273193240Ssam */ 274193240Ssamstruct mwltxrec { 275193240Ssam uint16_t fwlen; 276193240Ssam struct ieee80211_frame_addr4 wh; 277193240Ssam} __packed; 278193240Ssam 279193240Ssam/* 280193240Ssam * Read/Write shorthands for accesses to BAR 0. Note 281193240Ssam * that all BAR 1 operations are done in the "hal" and 282193240Ssam * there should be no reference to them here. 283193240Ssam */ 284193240Ssamstatic __inline uint32_t 285193240SsamRD4(struct mwl_softc *sc, bus_size_t off) 286193240Ssam{ 287193240Ssam return bus_space_read_4(sc->sc_io0t, sc->sc_io0h, off); 288193240Ssam} 289193240Ssam 290193240Ssamstatic __inline void 291193240SsamWR4(struct mwl_softc *sc, bus_size_t off, uint32_t val) 292193240Ssam{ 293193240Ssam bus_space_write_4(sc->sc_io0t, sc->sc_io0h, off, val); 294193240Ssam} 295193240Ssam 296193240Ssamint 297193240Ssammwl_attach(uint16_t devid, struct mwl_softc *sc) 298193240Ssam{ 299193240Ssam struct ifnet *ifp; 300193240Ssam struct ieee80211com *ic; 301193240Ssam struct mwl_hal *mh; 302193240Ssam int error = 0; 303193240Ssam 304193240Ssam DPRINTF(sc, MWL_DEBUG_ANY, "%s: devid 0x%x\n", __func__, devid); 305193240Ssam 306193240Ssam ifp = sc->sc_ifp = if_alloc(IFT_IEEE80211); 307193240Ssam if (ifp == NULL) { 308197441Srpaulo device_printf(sc->sc_dev, "cannot if_alloc()\n"); 309193240Ssam return ENOSPC; 310193240Ssam } 311193240Ssam ic = ifp->if_l2com; 312193240Ssam 313234368Sadrian /* 314234368Sadrian * Setup the RX free list lock early, so it can be consistently 315234368Sadrian * removed. 316234368Sadrian */ 317234368Sadrian MWL_RXFREE_INIT(sc); 318234368Sadrian 319193240Ssam /* set these up early for if_printf use */ 320193240Ssam if_initname(ifp, device_get_name(sc->sc_dev), 321193240Ssam device_get_unit(sc->sc_dev)); 322193240Ssam 323193240Ssam mh = mwl_hal_attach(sc->sc_dev, devid, 324193240Ssam sc->sc_io1h, sc->sc_io1t, sc->sc_dmat); 325193240Ssam if (mh == NULL) { 326193240Ssam if_printf(ifp, "unable to attach HAL\n"); 327193240Ssam error = EIO; 328193240Ssam goto bad; 329193240Ssam } 330193240Ssam sc->sc_mh = mh; 331193240Ssam /* 332193240Ssam * Load firmware so we can get setup. We arbitrarily 333193240Ssam * pick station firmware; we'll re-load firmware as 334193240Ssam * needed so setting up the wrong mode isn't a big deal. 335193240Ssam */ 336193240Ssam if (mwl_hal_fwload(mh, NULL) != 0) { 337193240Ssam if_printf(ifp, "unable to setup builtin firmware\n"); 338193240Ssam error = EIO; 339193240Ssam goto bad1; 340193240Ssam } 341193240Ssam if (mwl_hal_gethwspecs(mh, &sc->sc_hwspecs) != 0) { 342193240Ssam if_printf(ifp, "unable to fetch h/w specs\n"); 343193240Ssam error = EIO; 344193240Ssam goto bad1; 345193240Ssam } 346193240Ssam error = mwl_getchannels(sc); 347193240Ssam if (error != 0) 348193240Ssam goto bad1; 349193240Ssam 350193240Ssam sc->sc_txantenna = 0; /* h/w default */ 351193240Ssam sc->sc_rxantenna = 0; /* h/w default */ 352193240Ssam sc->sc_invalid = 0; /* ready to go, enable int handling */ 353193240Ssam sc->sc_ageinterval = MWL_AGEINTERVAL; 354193240Ssam 355193240Ssam /* 356193240Ssam * Allocate tx+rx descriptors and populate the lists. 357193240Ssam * We immediately push the information to the firmware 358193240Ssam * as otherwise it gets upset. 359193240Ssam */ 360193240Ssam error = mwl_dma_setup(sc); 361193240Ssam if (error != 0) { 362193240Ssam if_printf(ifp, "failed to setup descriptors: %d\n", error); 363193240Ssam goto bad1; 364193240Ssam } 365193240Ssam error = mwl_setupdma(sc); /* push to firmware */ 366193240Ssam if (error != 0) /* NB: mwl_setupdma prints msg */ 367193240Ssam goto bad1; 368193240Ssam 369193240Ssam callout_init(&sc->sc_timer, CALLOUT_MPSAFE); 370199559Sjhb callout_init_mtx(&sc->sc_watchdog, &sc->sc_mtx, 0); 371193240Ssam 372193240Ssam sc->sc_tq = taskqueue_create("mwl_taskq", M_NOWAIT, 373193240Ssam taskqueue_thread_enqueue, &sc->sc_tq); 374193240Ssam taskqueue_start_threads(&sc->sc_tq, 1, PI_NET, 375193240Ssam "%s taskq", ifp->if_xname); 376193240Ssam 377193240Ssam TASK_INIT(&sc->sc_rxtask, 0, mwl_rx_proc, sc); 378193240Ssam TASK_INIT(&sc->sc_radartask, 0, mwl_radar_proc, sc); 379193240Ssam TASK_INIT(&sc->sc_chanswitchtask, 0, mwl_chanswitch_proc, sc); 380193240Ssam TASK_INIT(&sc->sc_bawatchdogtask, 0, mwl_bawatchdog_proc, sc); 381193240Ssam 382193240Ssam /* NB: insure BK queue is the lowest priority h/w queue */ 383193240Ssam if (!mwl_tx_setup(sc, WME_AC_BK, MWL_WME_AC_BK)) { 384193240Ssam if_printf(ifp, "unable to setup xmit queue for %s traffic!\n", 385193240Ssam ieee80211_wme_acnames[WME_AC_BK]); 386193240Ssam error = EIO; 387193240Ssam goto bad2; 388193240Ssam } 389193240Ssam if (!mwl_tx_setup(sc, WME_AC_BE, MWL_WME_AC_BE) || 390193240Ssam !mwl_tx_setup(sc, WME_AC_VI, MWL_WME_AC_VI) || 391193240Ssam !mwl_tx_setup(sc, WME_AC_VO, MWL_WME_AC_VO)) { 392193240Ssam /* 393193240Ssam * Not enough hardware tx queues to properly do WME; 394193240Ssam * just punt and assign them all to the same h/w queue. 395193240Ssam * We could do a better job of this if, for example, 396193240Ssam * we allocate queues when we switch from station to 397193240Ssam * AP mode. 398193240Ssam */ 399193240Ssam if (sc->sc_ac2q[WME_AC_VI] != NULL) 400193240Ssam mwl_tx_cleanupq(sc, sc->sc_ac2q[WME_AC_VI]); 401193240Ssam if (sc->sc_ac2q[WME_AC_BE] != NULL) 402193240Ssam mwl_tx_cleanupq(sc, sc->sc_ac2q[WME_AC_BE]); 403193240Ssam sc->sc_ac2q[WME_AC_BE] = sc->sc_ac2q[WME_AC_BK]; 404193240Ssam sc->sc_ac2q[WME_AC_VI] = sc->sc_ac2q[WME_AC_BK]; 405193240Ssam sc->sc_ac2q[WME_AC_VO] = sc->sc_ac2q[WME_AC_BK]; 406193240Ssam } 407193240Ssam TASK_INIT(&sc->sc_txtask, 0, mwl_tx_proc, sc); 408193240Ssam 409193240Ssam ifp->if_softc = sc; 410193240Ssam ifp->if_flags = IFF_SIMPLEX | IFF_BROADCAST | IFF_MULTICAST; 411193240Ssam ifp->if_start = mwl_start; 412193240Ssam ifp->if_ioctl = mwl_ioctl; 413193240Ssam ifp->if_init = mwl_init; 414207554Ssobomax IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen); 415207554Ssobomax ifp->if_snd.ifq_drv_maxlen = ifqmaxlen; 416193240Ssam IFQ_SET_READY(&ifp->if_snd); 417193240Ssam 418193240Ssam ic->ic_ifp = ifp; 419193240Ssam /* XXX not right but it's not used anywhere important */ 420193240Ssam ic->ic_phytype = IEEE80211_T_OFDM; 421193240Ssam ic->ic_opmode = IEEE80211_M_STA; 422193240Ssam ic->ic_caps = 423193240Ssam IEEE80211_C_STA /* station mode supported */ 424193240Ssam | IEEE80211_C_HOSTAP /* hostap mode */ 425193240Ssam | IEEE80211_C_MONITOR /* monitor mode */ 426193240Ssam#if 0 427193240Ssam | IEEE80211_C_IBSS /* ibss, nee adhoc, mode */ 428193240Ssam | IEEE80211_C_AHDEMO /* adhoc demo mode */ 429193240Ssam#endif 430195618Srpaulo | IEEE80211_C_MBSS /* mesh point link mode */ 431193240Ssam | IEEE80211_C_WDS /* WDS supported */ 432193240Ssam | IEEE80211_C_SHPREAMBLE /* short preamble supported */ 433193240Ssam | IEEE80211_C_SHSLOT /* short slot time supported */ 434193240Ssam | IEEE80211_C_WME /* WME/WMM supported */ 435193240Ssam | IEEE80211_C_BURST /* xmit bursting supported */ 436193240Ssam | IEEE80211_C_WPA /* capable of WPA1+WPA2 */ 437193240Ssam | IEEE80211_C_BGSCAN /* capable of bg scanning */ 438193240Ssam | IEEE80211_C_TXFRAG /* handle tx frags */ 439193240Ssam | IEEE80211_C_TXPMGT /* capable of txpow mgt */ 440193240Ssam | IEEE80211_C_DFS /* DFS supported */ 441193240Ssam ; 442193240Ssam 443193240Ssam ic->ic_htcaps = 444193240Ssam IEEE80211_HTCAP_SMPS_ENA /* SM PS mode enabled */ 445193240Ssam | IEEE80211_HTCAP_CHWIDTH40 /* 40MHz channel width */ 446193240Ssam | IEEE80211_HTCAP_SHORTGI20 /* short GI in 20MHz */ 447193240Ssam | IEEE80211_HTCAP_SHORTGI40 /* short GI in 40MHz */ 448193240Ssam | IEEE80211_HTCAP_RXSTBC_2STREAM/* 1-2 spatial streams */ 449193240Ssam#if MWL_AGGR_SIZE == 7935 450193240Ssam | IEEE80211_HTCAP_MAXAMSDU_7935 /* max A-MSDU length */ 451193240Ssam#else 452193240Ssam | IEEE80211_HTCAP_MAXAMSDU_3839 /* max A-MSDU length */ 453193240Ssam#endif 454193240Ssam#if 0 455193240Ssam | IEEE80211_HTCAP_PSMP /* PSMP supported */ 456193240Ssam | IEEE80211_HTCAP_40INTOLERANT /* 40MHz intolerant */ 457193240Ssam#endif 458193240Ssam /* s/w capabilities */ 459193240Ssam | IEEE80211_HTC_HT /* HT operation */ 460193240Ssam | IEEE80211_HTC_AMPDU /* tx A-MPDU */ 461193240Ssam | IEEE80211_HTC_AMSDU /* tx A-MSDU */ 462193240Ssam | IEEE80211_HTC_SMPS /* SMPS available */ 463193240Ssam ; 464193240Ssam 465193240Ssam /* 466193240Ssam * Mark h/w crypto support. 467193240Ssam * XXX no way to query h/w support. 468193240Ssam */ 469193240Ssam ic->ic_cryptocaps |= IEEE80211_CRYPTO_WEP 470193240Ssam | IEEE80211_CRYPTO_AES_CCM 471193240Ssam | IEEE80211_CRYPTO_TKIP 472193240Ssam | IEEE80211_CRYPTO_TKIPMIC 473193240Ssam ; 474193240Ssam /* 475193240Ssam * Transmit requires space in the packet for a special 476193240Ssam * format transmit record and optional padding between 477193240Ssam * this record and the payload. Ask the net80211 layer 478193240Ssam * to arrange this when encapsulating packets so we can 479193240Ssam * add it efficiently. 480193240Ssam */ 481193240Ssam ic->ic_headroom = sizeof(struct mwltxrec) - 482193240Ssam sizeof(struct ieee80211_frame); 483193240Ssam 484193240Ssam /* call MI attach routine. */ 485193240Ssam ieee80211_ifattach(ic, sc->sc_hwspecs.macAddr); 486193240Ssam ic->ic_setregdomain = mwl_setregdomain; 487193240Ssam ic->ic_getradiocaps = mwl_getradiocaps; 488193240Ssam /* override default methods */ 489193240Ssam ic->ic_raw_xmit = mwl_raw_xmit; 490193240Ssam ic->ic_newassoc = mwl_newassoc; 491193240Ssam ic->ic_updateslot = mwl_updateslot; 492193240Ssam ic->ic_update_mcast = mwl_update_mcast; 493193240Ssam ic->ic_update_promisc = mwl_update_promisc; 494193240Ssam ic->ic_wme.wme_update = mwl_wme_update; 495193240Ssam 496193240Ssam ic->ic_node_alloc = mwl_node_alloc; 497193240Ssam sc->sc_node_cleanup = ic->ic_node_cleanup; 498193240Ssam ic->ic_node_cleanup = mwl_node_cleanup; 499193240Ssam sc->sc_node_drain = ic->ic_node_drain; 500193240Ssam ic->ic_node_drain = mwl_node_drain; 501193240Ssam ic->ic_node_getsignal = mwl_node_getsignal; 502193240Ssam ic->ic_node_getmimoinfo = mwl_node_getmimoinfo; 503193240Ssam 504193240Ssam ic->ic_scan_start = mwl_scan_start; 505193240Ssam ic->ic_scan_end = mwl_scan_end; 506193240Ssam ic->ic_set_channel = mwl_set_channel; 507193240Ssam 508193240Ssam sc->sc_recv_action = ic->ic_recv_action; 509193240Ssam ic->ic_recv_action = mwl_recv_action; 510193240Ssam sc->sc_addba_request = ic->ic_addba_request; 511193240Ssam ic->ic_addba_request = mwl_addba_request; 512193240Ssam sc->sc_addba_response = ic->ic_addba_response; 513193240Ssam ic->ic_addba_response = mwl_addba_response; 514193240Ssam sc->sc_addba_stop = ic->ic_addba_stop; 515193240Ssam ic->ic_addba_stop = mwl_addba_stop; 516193240Ssam 517193240Ssam ic->ic_vap_create = mwl_vap_create; 518193240Ssam ic->ic_vap_delete = mwl_vap_delete; 519193240Ssam 520193240Ssam ieee80211_radiotap_attach(ic, 521193240Ssam &sc->sc_tx_th.wt_ihdr, sizeof(sc->sc_tx_th), 522193240Ssam MWL_TX_RADIOTAP_PRESENT, 523193240Ssam &sc->sc_rx_th.wr_ihdr, sizeof(sc->sc_rx_th), 524193240Ssam MWL_RX_RADIOTAP_PRESENT); 525193240Ssam /* 526193240Ssam * Setup dynamic sysctl's now that country code and 527193240Ssam * regdomain are available from the hal. 528193240Ssam */ 529193240Ssam mwl_sysctlattach(sc); 530193240Ssam 531193240Ssam if (bootverbose) 532193240Ssam ieee80211_announce(ic); 533193240Ssam mwl_announce(sc); 534193240Ssam return 0; 535193240Ssambad2: 536193240Ssam mwl_dma_cleanup(sc); 537193240Ssambad1: 538193240Ssam mwl_hal_detach(mh); 539193240Ssambad: 540234368Sadrian MWL_RXFREE_DESTROY(sc); 541193240Ssam if_free(ifp); 542193240Ssam sc->sc_invalid = 1; 543193240Ssam return error; 544193240Ssam} 545193240Ssam 546193240Ssamint 547193240Ssammwl_detach(struct mwl_softc *sc) 548193240Ssam{ 549193240Ssam struct ifnet *ifp = sc->sc_ifp; 550193240Ssam struct ieee80211com *ic = ifp->if_l2com; 551193240Ssam 552193240Ssam DPRINTF(sc, MWL_DEBUG_ANY, "%s: if_flags %x\n", 553193240Ssam __func__, ifp->if_flags); 554193240Ssam 555193240Ssam mwl_stop(ifp, 1); 556193240Ssam /* 557193240Ssam * NB: the order of these is important: 558193240Ssam * o call the 802.11 layer before detaching the hal to 559193240Ssam * insure callbacks into the driver to delete global 560193240Ssam * key cache entries can be handled 561193240Ssam * o reclaim the tx queue data structures after calling 562193240Ssam * the 802.11 layer as we'll get called back to reclaim 563193240Ssam * node state and potentially want to use them 564193240Ssam * o to cleanup the tx queues the hal is called, so detach 565193240Ssam * it last 566193240Ssam * Other than that, it's straightforward... 567193240Ssam */ 568193240Ssam ieee80211_ifdetach(ic); 569199559Sjhb callout_drain(&sc->sc_watchdog); 570193240Ssam mwl_dma_cleanup(sc); 571234368Sadrian MWL_RXFREE_DESTROY(sc); 572193240Ssam mwl_tx_cleanup(sc); 573193240Ssam mwl_hal_detach(sc->sc_mh); 574193240Ssam if_free(ifp); 575193240Ssam 576193240Ssam return 0; 577193240Ssam} 578193240Ssam 579193240Ssam/* 580193240Ssam * MAC address handling for multiple BSS on the same radio. 581193240Ssam * The first vap uses the MAC address from the EEPROM. For 582193240Ssam * subsequent vap's we set the U/L bit (bit 1) in the MAC 583193240Ssam * address and use the next six bits as an index. 584193240Ssam */ 585193240Ssamstatic void 586193240Ssamassign_address(struct mwl_softc *sc, uint8_t mac[IEEE80211_ADDR_LEN], int clone) 587193240Ssam{ 588193240Ssam int i; 589193240Ssam 590193240Ssam if (clone && mwl_hal_ismbsscapable(sc->sc_mh)) { 591193240Ssam /* NB: we only do this if h/w supports multiple bssid */ 592193240Ssam for (i = 0; i < 32; i++) 593193240Ssam if ((sc->sc_bssidmask & (1<<i)) == 0) 594193240Ssam break; 595193240Ssam if (i != 0) 596193240Ssam mac[0] |= (i << 2)|0x2; 597193240Ssam } else 598193240Ssam i = 0; 599193240Ssam sc->sc_bssidmask |= 1<<i; 600193240Ssam if (i == 0) 601193240Ssam sc->sc_nbssid0++; 602193240Ssam} 603193240Ssam 604193240Ssamstatic void 605193240Ssamreclaim_address(struct mwl_softc *sc, uint8_t mac[IEEE80211_ADDR_LEN]) 606193240Ssam{ 607193240Ssam int i = mac[0] >> 2; 608193240Ssam if (i != 0 || --sc->sc_nbssid0 == 0) 609193240Ssam sc->sc_bssidmask &= ~(1<<i); 610193240Ssam} 611193240Ssam 612193240Ssamstatic struct ieee80211vap * 613228621Sbschmidtmwl_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit, 614228621Sbschmidt enum ieee80211_opmode opmode, int flags, 615228621Sbschmidt const uint8_t bssid[IEEE80211_ADDR_LEN], 616228621Sbschmidt const uint8_t mac0[IEEE80211_ADDR_LEN]) 617193240Ssam{ 618193240Ssam struct ifnet *ifp = ic->ic_ifp; 619193240Ssam struct mwl_softc *sc = ifp->if_softc; 620193240Ssam struct mwl_hal *mh = sc->sc_mh; 621193240Ssam struct ieee80211vap *vap, *apvap; 622193240Ssam struct mwl_hal_vap *hvap; 623193240Ssam struct mwl_vap *mvp; 624193240Ssam uint8_t mac[IEEE80211_ADDR_LEN]; 625193240Ssam 626193240Ssam IEEE80211_ADDR_COPY(mac, mac0); 627193240Ssam switch (opmode) { 628193240Ssam case IEEE80211_M_HOSTAP: 629195618Srpaulo case IEEE80211_M_MBSS: 630193240Ssam if ((flags & IEEE80211_CLONE_MACADDR) == 0) 631193240Ssam assign_address(sc, mac, flags & IEEE80211_CLONE_BSSID); 632193240Ssam hvap = mwl_hal_newvap(mh, MWL_HAL_AP, mac); 633193240Ssam if (hvap == NULL) { 634193240Ssam if ((flags & IEEE80211_CLONE_MACADDR) == 0) 635193240Ssam reclaim_address(sc, mac); 636193240Ssam return NULL; 637193240Ssam } 638193240Ssam break; 639193240Ssam case IEEE80211_M_STA: 640193240Ssam if ((flags & IEEE80211_CLONE_MACADDR) == 0) 641193240Ssam assign_address(sc, mac, flags & IEEE80211_CLONE_BSSID); 642193240Ssam hvap = mwl_hal_newvap(mh, MWL_HAL_STA, mac); 643193240Ssam if (hvap == NULL) { 644193240Ssam if ((flags & IEEE80211_CLONE_MACADDR) == 0) 645193240Ssam reclaim_address(sc, mac); 646193240Ssam return NULL; 647193240Ssam } 648193240Ssam /* no h/w beacon miss support; always use s/w */ 649193240Ssam flags |= IEEE80211_CLONE_NOBEACONS; 650193240Ssam break; 651193240Ssam case IEEE80211_M_WDS: 652193240Ssam hvap = NULL; /* NB: we use associated AP vap */ 653193240Ssam if (sc->sc_napvaps == 0) 654193240Ssam return NULL; /* no existing AP vap */ 655193240Ssam break; 656193240Ssam case IEEE80211_M_MONITOR: 657193240Ssam hvap = NULL; 658193240Ssam break; 659193240Ssam case IEEE80211_M_IBSS: 660193240Ssam case IEEE80211_M_AHDEMO: 661193240Ssam default: 662193240Ssam return NULL; 663193240Ssam } 664193240Ssam 665193240Ssam mvp = (struct mwl_vap *) malloc(sizeof(struct mwl_vap), 666193240Ssam M_80211_VAP, M_NOWAIT | M_ZERO); 667193240Ssam if (mvp == NULL) { 668193240Ssam if (hvap != NULL) { 669193240Ssam mwl_hal_delvap(hvap); 670193240Ssam if ((flags & IEEE80211_CLONE_MACADDR) == 0) 671193240Ssam reclaim_address(sc, mac); 672193240Ssam } 673193240Ssam /* XXX msg */ 674193240Ssam return NULL; 675193240Ssam } 676193240Ssam mvp->mv_hvap = hvap; 677193240Ssam if (opmode == IEEE80211_M_WDS) { 678193240Ssam /* 679193240Ssam * WDS vaps must have an associated AP vap; find one. 680193240Ssam * XXX not right. 681193240Ssam */ 682193240Ssam TAILQ_FOREACH(apvap, &ic->ic_vaps, iv_next) 683193240Ssam if (apvap->iv_opmode == IEEE80211_M_HOSTAP) { 684193240Ssam mvp->mv_ap_hvap = MWL_VAP(apvap)->mv_hvap; 685193240Ssam break; 686193240Ssam } 687193240Ssam KASSERT(mvp->mv_ap_hvap != NULL, ("no ap vap")); 688193240Ssam } 689193240Ssam vap = &mvp->mv_vap; 690193240Ssam ieee80211_vap_setup(ic, vap, name, unit, opmode, flags, bssid, mac); 691193240Ssam if (hvap != NULL) 692193240Ssam IEEE80211_ADDR_COPY(vap->iv_myaddr, mac); 693193240Ssam /* override with driver methods */ 694193240Ssam mvp->mv_newstate = vap->iv_newstate; 695193240Ssam vap->iv_newstate = mwl_newstate; 696193240Ssam vap->iv_max_keyix = 0; /* XXX */ 697193240Ssam vap->iv_key_alloc = mwl_key_alloc; 698193240Ssam vap->iv_key_delete = mwl_key_delete; 699193240Ssam vap->iv_key_set = mwl_key_set; 700193240Ssam#ifdef MWL_HOST_PS_SUPPORT 701195618Srpaulo if (opmode == IEEE80211_M_HOSTAP || opmode == IEEE80211_M_MBSS) { 702193240Ssam vap->iv_update_ps = mwl_update_ps; 703193240Ssam mvp->mv_set_tim = vap->iv_set_tim; 704193240Ssam vap->iv_set_tim = mwl_set_tim; 705193240Ssam } 706193240Ssam#endif 707193240Ssam vap->iv_reset = mwl_reset; 708193240Ssam vap->iv_update_beacon = mwl_beacon_update; 709193240Ssam 710193240Ssam /* override max aid so sta's cannot assoc when we're out of sta id's */ 711193240Ssam vap->iv_max_aid = MWL_MAXSTAID; 712193240Ssam /* override default A-MPDU rx parameters */ 713193240Ssam vap->iv_ampdu_rxmax = IEEE80211_HTCAP_MAXRXAMPDU_64K; 714193240Ssam vap->iv_ampdu_density = IEEE80211_HTCAP_MPDUDENSITY_4; 715193240Ssam 716193240Ssam /* complete setup */ 717193240Ssam ieee80211_vap_attach(vap, mwl_media_change, ieee80211_media_status); 718193240Ssam 719193240Ssam switch (vap->iv_opmode) { 720193240Ssam case IEEE80211_M_HOSTAP: 721195618Srpaulo case IEEE80211_M_MBSS: 722193240Ssam case IEEE80211_M_STA: 723193240Ssam /* 724193240Ssam * Setup sta db entry for local address. 725193240Ssam */ 726193240Ssam mwl_localstadb(vap); 727195618Srpaulo if (vap->iv_opmode == IEEE80211_M_HOSTAP || 728195618Srpaulo vap->iv_opmode == IEEE80211_M_MBSS) 729193240Ssam sc->sc_napvaps++; 730193240Ssam else 731193240Ssam sc->sc_nstavaps++; 732193240Ssam break; 733193240Ssam case IEEE80211_M_WDS: 734193240Ssam sc->sc_nwdsvaps++; 735193240Ssam break; 736193240Ssam default: 737193240Ssam break; 738193240Ssam } 739193240Ssam /* 740193240Ssam * Setup overall operating mode. 741193240Ssam */ 742193240Ssam if (sc->sc_napvaps) 743193240Ssam ic->ic_opmode = IEEE80211_M_HOSTAP; 744193240Ssam else if (sc->sc_nstavaps) 745193240Ssam ic->ic_opmode = IEEE80211_M_STA; 746193240Ssam else 747193240Ssam ic->ic_opmode = opmode; 748193240Ssam 749193240Ssam return vap; 750193240Ssam} 751193240Ssam 752193240Ssamstatic void 753193240Ssammwl_vap_delete(struct ieee80211vap *vap) 754193240Ssam{ 755193240Ssam struct mwl_vap *mvp = MWL_VAP(vap); 756193240Ssam struct ifnet *parent = vap->iv_ic->ic_ifp; 757193240Ssam struct mwl_softc *sc = parent->if_softc; 758193240Ssam struct mwl_hal *mh = sc->sc_mh; 759193240Ssam struct mwl_hal_vap *hvap = mvp->mv_hvap; 760193240Ssam enum ieee80211_opmode opmode = vap->iv_opmode; 761193240Ssam 762193240Ssam /* XXX disallow ap vap delete if WDS still present */ 763193240Ssam if (parent->if_drv_flags & IFF_DRV_RUNNING) { 764193240Ssam /* quiesce h/w while we remove the vap */ 765193240Ssam mwl_hal_intrset(mh, 0); /* disable interrupts */ 766193240Ssam } 767193240Ssam ieee80211_vap_detach(vap); 768193240Ssam switch (opmode) { 769193240Ssam case IEEE80211_M_HOSTAP: 770195618Srpaulo case IEEE80211_M_MBSS: 771193240Ssam case IEEE80211_M_STA: 772193240Ssam KASSERT(hvap != NULL, ("no hal vap handle")); 773193240Ssam (void) mwl_hal_delstation(hvap, vap->iv_myaddr); 774193240Ssam mwl_hal_delvap(hvap); 775195618Srpaulo if (opmode == IEEE80211_M_HOSTAP || opmode == IEEE80211_M_MBSS) 776193240Ssam sc->sc_napvaps--; 777193240Ssam else 778193240Ssam sc->sc_nstavaps--; 779193240Ssam /* XXX don't do it for IEEE80211_CLONE_MACADDR */ 780193240Ssam reclaim_address(sc, vap->iv_myaddr); 781193240Ssam break; 782193240Ssam case IEEE80211_M_WDS: 783193240Ssam sc->sc_nwdsvaps--; 784193240Ssam break; 785193240Ssam default: 786193240Ssam break; 787193240Ssam } 788193240Ssam mwl_cleartxq(sc, vap); 789193240Ssam free(mvp, M_80211_VAP); 790193240Ssam if (parent->if_drv_flags & IFF_DRV_RUNNING) 791193240Ssam mwl_hal_intrset(mh, sc->sc_imask); 792193240Ssam} 793193240Ssam 794193240Ssamvoid 795193240Ssammwl_suspend(struct mwl_softc *sc) 796193240Ssam{ 797193240Ssam struct ifnet *ifp = sc->sc_ifp; 798193240Ssam 799193240Ssam DPRINTF(sc, MWL_DEBUG_ANY, "%s: if_flags %x\n", 800193240Ssam __func__, ifp->if_flags); 801193240Ssam 802193240Ssam mwl_stop(ifp, 1); 803193240Ssam} 804193240Ssam 805193240Ssamvoid 806193240Ssammwl_resume(struct mwl_softc *sc) 807193240Ssam{ 808193240Ssam struct ifnet *ifp = sc->sc_ifp; 809193240Ssam 810193240Ssam DPRINTF(sc, MWL_DEBUG_ANY, "%s: if_flags %x\n", 811193240Ssam __func__, ifp->if_flags); 812193240Ssam 813193240Ssam if (ifp->if_flags & IFF_UP) 814193240Ssam mwl_init(sc); 815193240Ssam} 816193240Ssam 817193240Ssamvoid 818193240Ssammwl_shutdown(void *arg) 819193240Ssam{ 820193240Ssam struct mwl_softc *sc = arg; 821193240Ssam 822193240Ssam mwl_stop(sc->sc_ifp, 1); 823193240Ssam} 824193240Ssam 825193240Ssam/* 826193240Ssam * Interrupt handler. Most of the actual processing is deferred. 827193240Ssam */ 828193240Ssamvoid 829193240Ssammwl_intr(void *arg) 830193240Ssam{ 831193240Ssam struct mwl_softc *sc = arg; 832193240Ssam struct mwl_hal *mh = sc->sc_mh; 833193240Ssam uint32_t status; 834193240Ssam 835193240Ssam if (sc->sc_invalid) { 836193240Ssam /* 837193240Ssam * The hardware is not ready/present, don't touch anything. 838193240Ssam * Note this can happen early on if the IRQ is shared. 839193240Ssam */ 840193240Ssam DPRINTF(sc, MWL_DEBUG_ANY, "%s: invalid; ignored\n", __func__); 841193240Ssam return; 842193240Ssam } 843193240Ssam /* 844193240Ssam * Figure out the reason(s) for the interrupt. 845193240Ssam */ 846193240Ssam mwl_hal_getisr(mh, &status); /* NB: clears ISR too */ 847193240Ssam if (status == 0) /* must be a shared irq */ 848193240Ssam return; 849193240Ssam 850193240Ssam DPRINTF(sc, MWL_DEBUG_INTR, "%s: status 0x%x imask 0x%x\n", 851193240Ssam __func__, status, sc->sc_imask); 852193240Ssam if (status & MACREG_A2HRIC_BIT_RX_RDY) 853193240Ssam taskqueue_enqueue(sc->sc_tq, &sc->sc_rxtask); 854193240Ssam if (status & MACREG_A2HRIC_BIT_TX_DONE) 855193240Ssam taskqueue_enqueue(sc->sc_tq, &sc->sc_txtask); 856193240Ssam if (status & MACREG_A2HRIC_BIT_BA_WATCHDOG) 857193240Ssam taskqueue_enqueue(sc->sc_tq, &sc->sc_bawatchdogtask); 858193240Ssam if (status & MACREG_A2HRIC_BIT_OPC_DONE) 859193240Ssam mwl_hal_cmddone(mh); 860193240Ssam if (status & MACREG_A2HRIC_BIT_MAC_EVENT) { 861193240Ssam ; 862193240Ssam } 863193240Ssam if (status & MACREG_A2HRIC_BIT_ICV_ERROR) { 864193240Ssam /* TKIP ICV error */ 865193240Ssam sc->sc_stats.mst_rx_badtkipicv++; 866193240Ssam } 867193240Ssam if (status & MACREG_A2HRIC_BIT_QUEUE_EMPTY) { 868193240Ssam /* 11n aggregation queue is empty, re-fill */ 869193240Ssam ; 870193240Ssam } 871193240Ssam if (status & MACREG_A2HRIC_BIT_QUEUE_FULL) { 872193240Ssam ; 873193240Ssam } 874193240Ssam if (status & MACREG_A2HRIC_BIT_RADAR_DETECT) { 875193240Ssam /* radar detected, process event */ 876193240Ssam taskqueue_enqueue(sc->sc_tq, &sc->sc_radartask); 877193240Ssam } 878193240Ssam if (status & MACREG_A2HRIC_BIT_CHAN_SWITCH) { 879193240Ssam /* DFS channel switch */ 880193240Ssam taskqueue_enqueue(sc->sc_tq, &sc->sc_chanswitchtask); 881193240Ssam } 882193240Ssam} 883193240Ssam 884193240Ssamstatic void 885193240Ssammwl_radar_proc(void *arg, int pending) 886193240Ssam{ 887193240Ssam struct mwl_softc *sc = arg; 888193240Ssam struct ifnet *ifp = sc->sc_ifp; 889193240Ssam struct ieee80211com *ic = ifp->if_l2com; 890193240Ssam 891193240Ssam DPRINTF(sc, MWL_DEBUG_ANY, "%s: radar detected, pending %u\n", 892193240Ssam __func__, pending); 893193240Ssam 894193240Ssam sc->sc_stats.mst_radardetect++; 895195171Ssam /* XXX stop h/w BA streams? */ 896193240Ssam 897193240Ssam IEEE80211_LOCK(ic); 898193240Ssam ieee80211_dfs_notify_radar(ic, ic->ic_curchan); 899193240Ssam IEEE80211_UNLOCK(ic); 900193240Ssam} 901193240Ssam 902193240Ssamstatic void 903193240Ssammwl_chanswitch_proc(void *arg, int pending) 904193240Ssam{ 905193240Ssam struct mwl_softc *sc = arg; 906193240Ssam struct ifnet *ifp = sc->sc_ifp; 907193240Ssam struct ieee80211com *ic = ifp->if_l2com; 908193240Ssam 909193240Ssam DPRINTF(sc, MWL_DEBUG_ANY, "%s: channel switch notice, pending %u\n", 910193240Ssam __func__, pending); 911193240Ssam 912193240Ssam IEEE80211_LOCK(ic); 913193240Ssam sc->sc_csapending = 0; 914193240Ssam ieee80211_csa_completeswitch(ic); 915193240Ssam IEEE80211_UNLOCK(ic); 916193240Ssam} 917193240Ssam 918193240Ssamstatic void 919193240Ssammwl_bawatchdog(const MWL_HAL_BASTREAM *sp) 920193240Ssam{ 921193240Ssam struct ieee80211_node *ni = sp->data[0]; 922193240Ssam 923193240Ssam /* send DELBA and drop the stream */ 924193240Ssam ieee80211_ampdu_stop(ni, sp->data[1], IEEE80211_REASON_UNSPECIFIED); 925193240Ssam} 926193240Ssam 927193240Ssamstatic void 928193240Ssammwl_bawatchdog_proc(void *arg, int pending) 929193240Ssam{ 930193240Ssam struct mwl_softc *sc = arg; 931193240Ssam struct mwl_hal *mh = sc->sc_mh; 932193240Ssam const MWL_HAL_BASTREAM *sp; 933193240Ssam uint8_t bitmap, n; 934193240Ssam 935193240Ssam sc->sc_stats.mst_bawatchdog++; 936193240Ssam 937193240Ssam if (mwl_hal_getwatchdogbitmap(mh, &bitmap) != 0) { 938193240Ssam DPRINTF(sc, MWL_DEBUG_AMPDU, 939193240Ssam "%s: could not get bitmap\n", __func__); 940193240Ssam sc->sc_stats.mst_bawatchdog_failed++; 941193240Ssam return; 942193240Ssam } 943193240Ssam DPRINTF(sc, MWL_DEBUG_AMPDU, "%s: bitmap 0x%x\n", __func__, bitmap); 944193240Ssam if (bitmap == 0xff) { 945193240Ssam n = 0; 946193240Ssam /* disable all ba streams */ 947193240Ssam for (bitmap = 0; bitmap < 8; bitmap++) { 948193240Ssam sp = mwl_hal_bastream_lookup(mh, bitmap); 949193240Ssam if (sp != NULL) { 950193240Ssam mwl_bawatchdog(sp); 951193240Ssam n++; 952193240Ssam } 953193240Ssam } 954193240Ssam if (n == 0) { 955193240Ssam DPRINTF(sc, MWL_DEBUG_AMPDU, 956193240Ssam "%s: no BA streams found\n", __func__); 957193240Ssam sc->sc_stats.mst_bawatchdog_empty++; 958193240Ssam } 959193240Ssam } else if (bitmap != 0xaa) { 960193240Ssam /* disable a single ba stream */ 961193240Ssam sp = mwl_hal_bastream_lookup(mh, bitmap); 962193240Ssam if (sp != NULL) { 963193240Ssam mwl_bawatchdog(sp); 964193240Ssam } else { 965193240Ssam DPRINTF(sc, MWL_DEBUG_AMPDU, 966193240Ssam "%s: no BA stream %d\n", __func__, bitmap); 967193240Ssam sc->sc_stats.mst_bawatchdog_notfound++; 968193240Ssam } 969193240Ssam } 970193240Ssam} 971193240Ssam 972193240Ssam/* 973193240Ssam * Convert net80211 channel to a HAL channel. 974193240Ssam */ 975193240Ssamstatic void 976193240Ssammwl_mapchan(MWL_HAL_CHANNEL *hc, const struct ieee80211_channel *chan) 977193240Ssam{ 978193240Ssam hc->channel = chan->ic_ieee; 979193240Ssam 980193240Ssam *(uint32_t *)&hc->channelFlags = 0; 981193240Ssam if (IEEE80211_IS_CHAN_2GHZ(chan)) 982193240Ssam hc->channelFlags.FreqBand = MWL_FREQ_BAND_2DOT4GHZ; 983193240Ssam else if (IEEE80211_IS_CHAN_5GHZ(chan)) 984193240Ssam hc->channelFlags.FreqBand = MWL_FREQ_BAND_5GHZ; 985193240Ssam if (IEEE80211_IS_CHAN_HT40(chan)) { 986193240Ssam hc->channelFlags.ChnlWidth = MWL_CH_40_MHz_WIDTH; 987193240Ssam if (IEEE80211_IS_CHAN_HT40U(chan)) 988193240Ssam hc->channelFlags.ExtChnlOffset = MWL_EXT_CH_ABOVE_CTRL_CH; 989193240Ssam else 990193240Ssam hc->channelFlags.ExtChnlOffset = MWL_EXT_CH_BELOW_CTRL_CH; 991193240Ssam } else 992193240Ssam hc->channelFlags.ChnlWidth = MWL_CH_20_MHz_WIDTH; 993193240Ssam /* XXX 10MHz channels */ 994193240Ssam} 995193240Ssam 996193240Ssam/* 997193240Ssam * Inform firmware of our tx/rx dma setup. The BAR 0 998193240Ssam * writes below are for compatibility with older firmware. 999193240Ssam * For current firmware we send this information with a 1000193240Ssam * cmd block via mwl_hal_sethwdma. 1001193240Ssam */ 1002193240Ssamstatic int 1003193240Ssammwl_setupdma(struct mwl_softc *sc) 1004193240Ssam{ 1005193240Ssam int error, i; 1006193240Ssam 1007193240Ssam sc->sc_hwdma.rxDescRead = sc->sc_rxdma.dd_desc_paddr; 1008193240Ssam WR4(sc, sc->sc_hwspecs.rxDescRead, sc->sc_hwdma.rxDescRead); 1009193240Ssam WR4(sc, sc->sc_hwspecs.rxDescWrite, sc->sc_hwdma.rxDescRead); 1010193240Ssam 1011195171Ssam for (i = 0; i < MWL_NUM_TX_QUEUES-MWL_NUM_ACK_QUEUES; i++) { 1012193240Ssam struct mwl_txq *txq = &sc->sc_txq[i]; 1013193240Ssam sc->sc_hwdma.wcbBase[i] = txq->dma.dd_desc_paddr; 1014193240Ssam WR4(sc, sc->sc_hwspecs.wcbBase[i], sc->sc_hwdma.wcbBase[i]); 1015193240Ssam } 1016193240Ssam sc->sc_hwdma.maxNumTxWcb = mwl_txbuf; 1017195171Ssam sc->sc_hwdma.maxNumWCB = MWL_NUM_TX_QUEUES-MWL_NUM_ACK_QUEUES; 1018193240Ssam 1019193240Ssam error = mwl_hal_sethwdma(sc->sc_mh, &sc->sc_hwdma); 1020193240Ssam if (error != 0) { 1021193240Ssam device_printf(sc->sc_dev, 1022193240Ssam "unable to setup tx/rx dma; hal status %u\n", error); 1023193240Ssam /* XXX */ 1024193240Ssam } 1025193240Ssam return error; 1026193240Ssam} 1027193240Ssam 1028193240Ssam/* 1029193240Ssam * Inform firmware of tx rate parameters. 1030193240Ssam * Called after a channel change. 1031193240Ssam */ 1032193240Ssamstatic int 1033193240Ssammwl_setcurchanrates(struct mwl_softc *sc) 1034193240Ssam{ 1035193240Ssam struct ifnet *ifp = sc->sc_ifp; 1036193240Ssam struct ieee80211com *ic = ifp->if_l2com; 1037193240Ssam const struct ieee80211_rateset *rs; 1038193240Ssam MWL_HAL_TXRATE rates; 1039193240Ssam 1040193240Ssam memset(&rates, 0, sizeof(rates)); 1041193240Ssam rs = ieee80211_get_suprates(ic, ic->ic_curchan); 1042193240Ssam /* rate used to send management frames */ 1043193240Ssam rates.MgtRate = rs->rs_rates[0] & IEEE80211_RATE_VAL; 1044193240Ssam /* rate used to send multicast frames */ 1045193240Ssam rates.McastRate = rates.MgtRate; 1046193240Ssam 1047193240Ssam return mwl_hal_settxrate_auto(sc->sc_mh, &rates); 1048193240Ssam} 1049193240Ssam 1050193240Ssam/* 1051193240Ssam * Inform firmware of tx rate parameters. Called whenever 1052193240Ssam * user-settable params change and after a channel change. 1053193240Ssam */ 1054193240Ssamstatic int 1055193240Ssammwl_setrates(struct ieee80211vap *vap) 1056193240Ssam{ 1057193240Ssam struct mwl_vap *mvp = MWL_VAP(vap); 1058193240Ssam struct ieee80211_node *ni = vap->iv_bss; 1059193240Ssam const struct ieee80211_txparam *tp = ni->ni_txparms; 1060193240Ssam MWL_HAL_TXRATE rates; 1061193240Ssam 1062193240Ssam KASSERT(vap->iv_state == IEEE80211_S_RUN, ("state %d", vap->iv_state)); 1063193240Ssam 1064193240Ssam /* 1065193240Ssam * Update the h/w rate map. 1066193240Ssam * NB: 0x80 for MCS is passed through unchanged 1067193240Ssam */ 1068193240Ssam memset(&rates, 0, sizeof(rates)); 1069193240Ssam /* rate used to send management frames */ 1070193240Ssam rates.MgtRate = tp->mgmtrate; 1071193240Ssam /* rate used to send multicast frames */ 1072193240Ssam rates.McastRate = tp->mcastrate; 1073193240Ssam 1074193240Ssam /* while here calculate EAPOL fixed rate cookie */ 1075193240Ssam mvp->mv_eapolformat = htole16(mwl_calcformat(rates.MgtRate, ni)); 1076193240Ssam 1077195171Ssam return mwl_hal_settxrate(mvp->mv_hvap, 1078195171Ssam tp->ucastrate != IEEE80211_FIXED_RATE_NONE ? 1079195171Ssam RATE_FIXED : RATE_AUTO, &rates); 1080193240Ssam} 1081193240Ssam 1082193240Ssam/* 1083193240Ssam * Setup a fixed xmit rate cookie for EAPOL frames. 1084193240Ssam */ 1085193240Ssamstatic void 1086193240Ssammwl_seteapolformat(struct ieee80211vap *vap) 1087193240Ssam{ 1088193240Ssam struct mwl_vap *mvp = MWL_VAP(vap); 1089193240Ssam struct ieee80211_node *ni = vap->iv_bss; 1090193240Ssam enum ieee80211_phymode mode; 1091193240Ssam uint8_t rate; 1092193240Ssam 1093193240Ssam KASSERT(vap->iv_state == IEEE80211_S_RUN, ("state %d", vap->iv_state)); 1094193240Ssam 1095193240Ssam mode = ieee80211_chan2mode(ni->ni_chan); 1096193240Ssam /* 1097193240Ssam * Use legacy rates when operating a mixed HT+non-HT bss. 1098193240Ssam * NB: this may violate POLA for sta and wds vap's. 1099193240Ssam */ 1100193240Ssam if (mode == IEEE80211_MODE_11NA && 1101193656Ssam (vap->iv_flags_ht & IEEE80211_FHT_PUREN) == 0) 1102193240Ssam rate = vap->iv_txparms[IEEE80211_MODE_11A].mgmtrate; 1103193240Ssam else if (mode == IEEE80211_MODE_11NG && 1104193656Ssam (vap->iv_flags_ht & IEEE80211_FHT_PUREN) == 0) 1105193240Ssam rate = vap->iv_txparms[IEEE80211_MODE_11G].mgmtrate; 1106193240Ssam else 1107193240Ssam rate = vap->iv_txparms[mode].mgmtrate; 1108193240Ssam 1109193240Ssam mvp->mv_eapolformat = htole16(mwl_calcformat(rate, ni)); 1110193240Ssam} 1111193240Ssam 1112193240Ssam/* 1113193240Ssam * Map SKU+country code to region code for radar bin'ing. 1114193240Ssam */ 1115193240Ssamstatic int 1116193240Ssammwl_map2regioncode(const struct ieee80211_regdomain *rd) 1117193240Ssam{ 1118193240Ssam switch (rd->regdomain) { 1119193240Ssam case SKU_FCC: 1120193240Ssam case SKU_FCC3: 1121193240Ssam return DOMAIN_CODE_FCC; 1122193240Ssam case SKU_CA: 1123193240Ssam return DOMAIN_CODE_IC; 1124193240Ssam case SKU_ETSI: 1125193240Ssam case SKU_ETSI2: 1126193240Ssam case SKU_ETSI3: 1127193240Ssam if (rd->country == CTRY_SPAIN) 1128193240Ssam return DOMAIN_CODE_SPAIN; 1129193240Ssam if (rd->country == CTRY_FRANCE || rd->country == CTRY_FRANCE2) 1130193240Ssam return DOMAIN_CODE_FRANCE; 1131193240Ssam /* XXX force 1.3.1 radar type */ 1132193240Ssam return DOMAIN_CODE_ETSI_131; 1133193240Ssam case SKU_JAPAN: 1134193240Ssam return DOMAIN_CODE_MKK; 1135193240Ssam case SKU_ROW: 1136193240Ssam return DOMAIN_CODE_DGT; /* Taiwan */ 1137193240Ssam case SKU_APAC: 1138193240Ssam case SKU_APAC2: 1139193240Ssam case SKU_APAC3: 1140193240Ssam return DOMAIN_CODE_AUS; /* Australia */ 1141193240Ssam } 1142193240Ssam /* XXX KOREA? */ 1143193240Ssam return DOMAIN_CODE_FCC; /* XXX? */ 1144193240Ssam} 1145193240Ssam 1146193240Ssamstatic int 1147193240Ssammwl_hal_reset(struct mwl_softc *sc) 1148193240Ssam{ 1149193240Ssam struct ifnet *ifp = sc->sc_ifp; 1150193240Ssam struct ieee80211com *ic = ifp->if_l2com; 1151193240Ssam struct mwl_hal *mh = sc->sc_mh; 1152193240Ssam 1153193240Ssam mwl_hal_setantenna(mh, WL_ANTENNATYPE_RX, sc->sc_rxantenna); 1154193240Ssam mwl_hal_setantenna(mh, WL_ANTENNATYPE_TX, sc->sc_txantenna); 1155193240Ssam mwl_hal_setradio(mh, 1, WL_AUTO_PREAMBLE); 1156193240Ssam mwl_hal_setwmm(sc->sc_mh, (ic->ic_flags & IEEE80211_F_WME) != 0); 1157193240Ssam mwl_chan_set(sc, ic->ic_curchan); 1158195171Ssam /* NB: RF/RA performance tuned for indoor mode */ 1159195171Ssam mwl_hal_setrateadaptmode(mh, 0); 1160193240Ssam mwl_hal_setoptimizationlevel(mh, 1161193240Ssam (ic->ic_flags & IEEE80211_F_BURST) != 0); 1162193240Ssam 1163193240Ssam mwl_hal_setregioncode(mh, mwl_map2regioncode(&ic->ic_regdomain)); 1164193240Ssam 1165195171Ssam mwl_hal_setaggampduratemode(mh, 1, 80); /* XXX */ 1166195171Ssam mwl_hal_setcfend(mh, 0); /* XXX */ 1167195171Ssam 1168193240Ssam return 1; 1169193240Ssam} 1170193240Ssam 1171193240Ssamstatic int 1172193240Ssammwl_init_locked(struct mwl_softc *sc) 1173193240Ssam{ 1174193240Ssam struct ifnet *ifp = sc->sc_ifp; 1175193240Ssam struct mwl_hal *mh = sc->sc_mh; 1176193240Ssam int error = 0; 1177193240Ssam 1178193240Ssam DPRINTF(sc, MWL_DEBUG_ANY, "%s: if_flags 0x%x\n", 1179193240Ssam __func__, ifp->if_flags); 1180193240Ssam 1181193240Ssam MWL_LOCK_ASSERT(sc); 1182193240Ssam 1183193240Ssam /* 1184193240Ssam * Stop anything previously setup. This is safe 1185193240Ssam * whether this is the first time through or not. 1186193240Ssam */ 1187193240Ssam mwl_stop_locked(ifp, 0); 1188193240Ssam 1189193240Ssam /* 1190193240Ssam * Push vap-independent state to the firmware. 1191193240Ssam */ 1192193240Ssam if (!mwl_hal_reset(sc)) { 1193193240Ssam if_printf(ifp, "unable to reset hardware\n"); 1194193240Ssam return EIO; 1195193240Ssam } 1196193240Ssam 1197193240Ssam /* 1198193240Ssam * Setup recv (once); transmit is already good to go. 1199193240Ssam */ 1200193240Ssam error = mwl_startrecv(sc); 1201193240Ssam if (error != 0) { 1202193240Ssam if_printf(ifp, "unable to start recv logic\n"); 1203193240Ssam return error; 1204193240Ssam } 1205193240Ssam 1206193240Ssam /* 1207193240Ssam * Enable interrupts. 1208193240Ssam */ 1209193240Ssam sc->sc_imask = MACREG_A2HRIC_BIT_RX_RDY 1210193240Ssam | MACREG_A2HRIC_BIT_TX_DONE 1211193240Ssam | MACREG_A2HRIC_BIT_OPC_DONE 1212193240Ssam#if 0 1213193240Ssam | MACREG_A2HRIC_BIT_MAC_EVENT 1214193240Ssam#endif 1215193240Ssam | MACREG_A2HRIC_BIT_ICV_ERROR 1216193240Ssam | MACREG_A2HRIC_BIT_RADAR_DETECT 1217193240Ssam | MACREG_A2HRIC_BIT_CHAN_SWITCH 1218193240Ssam#if 0 1219193240Ssam | MACREG_A2HRIC_BIT_QUEUE_EMPTY 1220193240Ssam#endif 1221193240Ssam | MACREG_A2HRIC_BIT_BA_WATCHDOG 1222195171Ssam | MACREQ_A2HRIC_BIT_TX_ACK 1223193240Ssam ; 1224193240Ssam 1225193240Ssam ifp->if_drv_flags |= IFF_DRV_RUNNING; 1226193240Ssam mwl_hal_intrset(mh, sc->sc_imask); 1227199559Sjhb callout_reset(&sc->sc_watchdog, hz, mwl_watchdog, sc); 1228193240Ssam 1229193240Ssam return 0; 1230193240Ssam} 1231193240Ssam 1232193240Ssamstatic void 1233193240Ssammwl_init(void *arg) 1234193240Ssam{ 1235193240Ssam struct mwl_softc *sc = arg; 1236193240Ssam struct ifnet *ifp = sc->sc_ifp; 1237193240Ssam struct ieee80211com *ic = ifp->if_l2com; 1238193240Ssam int error = 0; 1239193240Ssam 1240193240Ssam DPRINTF(sc, MWL_DEBUG_ANY, "%s: if_flags 0x%x\n", 1241193240Ssam __func__, ifp->if_flags); 1242193240Ssam 1243193240Ssam MWL_LOCK(sc); 1244193240Ssam error = mwl_init_locked(sc); 1245193240Ssam MWL_UNLOCK(sc); 1246193240Ssam 1247193240Ssam if (error == 0) 1248193240Ssam ieee80211_start_all(ic); /* start all vap's */ 1249193240Ssam} 1250193240Ssam 1251193240Ssamstatic void 1252193240Ssammwl_stop_locked(struct ifnet *ifp, int disable) 1253193240Ssam{ 1254193240Ssam struct mwl_softc *sc = ifp->if_softc; 1255193240Ssam 1256193240Ssam DPRINTF(sc, MWL_DEBUG_ANY, "%s: invalid %u if_flags 0x%x\n", 1257193240Ssam __func__, sc->sc_invalid, ifp->if_flags); 1258193240Ssam 1259193240Ssam MWL_LOCK_ASSERT(sc); 1260193240Ssam if (ifp->if_drv_flags & IFF_DRV_RUNNING) { 1261193240Ssam /* 1262193240Ssam * Shutdown the hardware and driver. 1263193240Ssam */ 1264193240Ssam ifp->if_drv_flags &= ~IFF_DRV_RUNNING; 1265199559Sjhb callout_stop(&sc->sc_watchdog); 1266199559Sjhb sc->sc_tx_timer = 0; 1267193240Ssam mwl_draintxq(sc); 1268193240Ssam } 1269193240Ssam} 1270193240Ssam 1271193240Ssamstatic void 1272193240Ssammwl_stop(struct ifnet *ifp, int disable) 1273193240Ssam{ 1274193240Ssam struct mwl_softc *sc = ifp->if_softc; 1275193240Ssam 1276193240Ssam MWL_LOCK(sc); 1277193240Ssam mwl_stop_locked(ifp, disable); 1278193240Ssam MWL_UNLOCK(sc); 1279193240Ssam} 1280193240Ssam 1281193240Ssamstatic int 1282193240Ssammwl_reset_vap(struct ieee80211vap *vap, int state) 1283193240Ssam{ 1284193240Ssam struct mwl_hal_vap *hvap = MWL_VAP(vap)->mv_hvap; 1285193240Ssam struct ieee80211com *ic = vap->iv_ic; 1286193240Ssam 1287193240Ssam if (state == IEEE80211_S_RUN) 1288193240Ssam mwl_setrates(vap); 1289193240Ssam /* XXX off by 1? */ 1290193240Ssam mwl_hal_setrtsthreshold(hvap, vap->iv_rtsthreshold); 1291193240Ssam /* XXX auto? 20/40 split? */ 1292193656Ssam mwl_hal_sethtgi(hvap, (vap->iv_flags_ht & 1293193656Ssam (IEEE80211_FHT_SHORTGI20|IEEE80211_FHT_SHORTGI40)) ? 1 : 0); 1294193240Ssam mwl_hal_setnprot(hvap, ic->ic_htprotmode == IEEE80211_PROT_NONE ? 1295193240Ssam HTPROTECT_NONE : HTPROTECT_AUTO); 1296193240Ssam /* XXX txpower cap */ 1297193240Ssam 1298193240Ssam /* re-setup beacons */ 1299193240Ssam if (state == IEEE80211_S_RUN && 1300193240Ssam (vap->iv_opmode == IEEE80211_M_HOSTAP || 1301195618Srpaulo vap->iv_opmode == IEEE80211_M_MBSS || 1302193240Ssam vap->iv_opmode == IEEE80211_M_IBSS)) { 1303193240Ssam mwl_setapmode(vap, vap->iv_bss->ni_chan); 1304193240Ssam mwl_hal_setnprotmode(hvap, 1305193240Ssam MS(ic->ic_curhtprotmode, IEEE80211_HTINFO_OPMODE)); 1306193240Ssam return mwl_beacon_setup(vap); 1307193240Ssam } 1308193240Ssam return 0; 1309193240Ssam} 1310193240Ssam 1311193240Ssam/* 1312193240Ssam * Reset the hardware w/o losing operational state. 1313193240Ssam * Used to to reset or reload hardware state for a vap. 1314193240Ssam */ 1315193240Ssamstatic int 1316193240Ssammwl_reset(struct ieee80211vap *vap, u_long cmd) 1317193240Ssam{ 1318193240Ssam struct mwl_hal_vap *hvap = MWL_VAP(vap)->mv_hvap; 1319193240Ssam int error = 0; 1320193240Ssam 1321193240Ssam if (hvap != NULL) { /* WDS, MONITOR, etc. */ 1322193240Ssam struct ieee80211com *ic = vap->iv_ic; 1323193240Ssam struct ifnet *ifp = ic->ic_ifp; 1324193240Ssam struct mwl_softc *sc = ifp->if_softc; 1325193240Ssam struct mwl_hal *mh = sc->sc_mh; 1326193240Ssam 1327195171Ssam /* XXX handle DWDS sta vap change */ 1328193240Ssam /* XXX do we need to disable interrupts? */ 1329193240Ssam mwl_hal_intrset(mh, 0); /* disable interrupts */ 1330193240Ssam error = mwl_reset_vap(vap, vap->iv_state); 1331193240Ssam mwl_hal_intrset(mh, sc->sc_imask); 1332193240Ssam } 1333193240Ssam return error; 1334193240Ssam} 1335193240Ssam 1336193240Ssam/* 1337193240Ssam * Allocate a tx buffer for sending a frame. The 1338193240Ssam * packet is assumed to have the WME AC stored so 1339193240Ssam * we can use it to select the appropriate h/w queue. 1340193240Ssam */ 1341193240Ssamstatic struct mwl_txbuf * 1342193240Ssammwl_gettxbuf(struct mwl_softc *sc, struct mwl_txq *txq) 1343193240Ssam{ 1344193240Ssam struct mwl_txbuf *bf; 1345193240Ssam 1346193240Ssam /* 1347193240Ssam * Grab a TX buffer and associated resources. 1348193240Ssam */ 1349193240Ssam MWL_TXQ_LOCK(txq); 1350193240Ssam bf = STAILQ_FIRST(&txq->free); 1351193240Ssam if (bf != NULL) { 1352193240Ssam STAILQ_REMOVE_HEAD(&txq->free, bf_list); 1353193240Ssam txq->nfree--; 1354193240Ssam } 1355193240Ssam MWL_TXQ_UNLOCK(txq); 1356193240Ssam if (bf == NULL) 1357193240Ssam DPRINTF(sc, MWL_DEBUG_XMIT, 1358193240Ssam "%s: out of xmit buffers on q %d\n", __func__, txq->qnum); 1359193240Ssam return bf; 1360193240Ssam} 1361193240Ssam 1362193240Ssam/* 1363193240Ssam * Return a tx buffer to the queue it came from. Note there 1364193240Ssam * are two cases because we must preserve the order of buffers 1365193240Ssam * as it reflects the fixed order of descriptors in memory 1366193240Ssam * (the firmware pre-fetches descriptors so we cannot reorder). 1367193240Ssam */ 1368193240Ssamstatic void 1369193240Ssammwl_puttxbuf_head(struct mwl_txq *txq, struct mwl_txbuf *bf) 1370193240Ssam{ 1371193240Ssam bf->bf_m = NULL; 1372193240Ssam bf->bf_node = NULL; 1373193240Ssam MWL_TXQ_LOCK(txq); 1374193240Ssam STAILQ_INSERT_HEAD(&txq->free, bf, bf_list); 1375193240Ssam txq->nfree++; 1376193240Ssam MWL_TXQ_UNLOCK(txq); 1377193240Ssam} 1378193240Ssam 1379193240Ssamstatic void 1380193240Ssammwl_puttxbuf_tail(struct mwl_txq *txq, struct mwl_txbuf *bf) 1381193240Ssam{ 1382193240Ssam bf->bf_m = NULL; 1383193240Ssam bf->bf_node = NULL; 1384193240Ssam MWL_TXQ_LOCK(txq); 1385193240Ssam STAILQ_INSERT_TAIL(&txq->free, bf, bf_list); 1386193240Ssam txq->nfree++; 1387193240Ssam MWL_TXQ_UNLOCK(txq); 1388193240Ssam} 1389193240Ssam 1390193240Ssamstatic void 1391193240Ssammwl_start(struct ifnet *ifp) 1392193240Ssam{ 1393193240Ssam struct mwl_softc *sc = ifp->if_softc; 1394193240Ssam struct ieee80211_node *ni; 1395193240Ssam struct mwl_txbuf *bf; 1396193240Ssam struct mbuf *m; 1397193240Ssam struct mwl_txq *txq = NULL; /* XXX silence gcc */ 1398193240Ssam int nqueued; 1399193240Ssam 1400193240Ssam if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0 || sc->sc_invalid) 1401193240Ssam return; 1402193240Ssam nqueued = 0; 1403193240Ssam for (;;) { 1404193240Ssam bf = NULL; 1405193240Ssam IFQ_DEQUEUE(&ifp->if_snd, m); 1406193240Ssam if (m == NULL) 1407193240Ssam break; 1408193240Ssam /* 1409193240Ssam * Grab the node for the destination. 1410193240Ssam */ 1411193240Ssam ni = (struct ieee80211_node *) m->m_pkthdr.rcvif; 1412193240Ssam KASSERT(ni != NULL, ("no node")); 1413193240Ssam m->m_pkthdr.rcvif = NULL; /* committed, clear ref */ 1414193240Ssam /* 1415193240Ssam * Grab a TX buffer and associated resources. 1416193240Ssam * We honor the classification by the 802.11 layer. 1417193240Ssam */ 1418193240Ssam txq = sc->sc_ac2q[M_WME_GETAC(m)]; 1419193240Ssam bf = mwl_gettxbuf(sc, txq); 1420193240Ssam if (bf == NULL) { 1421193240Ssam m_freem(m); 1422193240Ssam ieee80211_free_node(ni); 1423193240Ssam#ifdef MWL_TX_NODROP 1424193240Ssam sc->sc_stats.mst_tx_qstop++; 1425193240Ssam /* XXX blocks other traffic */ 1426193240Ssam ifp->if_drv_flags |= IFF_DRV_OACTIVE; 1427193240Ssam break; 1428193240Ssam#else 1429193240Ssam DPRINTF(sc, MWL_DEBUG_XMIT, 1430193240Ssam "%s: tail drop on q %d\n", __func__, txq->qnum); 1431193240Ssam sc->sc_stats.mst_tx_qdrop++; 1432193240Ssam continue; 1433193240Ssam#endif /* MWL_TX_NODROP */ 1434193240Ssam } 1435193240Ssam 1436193240Ssam /* 1437193240Ssam * Pass the frame to the h/w for transmission. 1438193240Ssam */ 1439193240Ssam if (mwl_tx_start(sc, ni, bf, m)) { 1440193240Ssam ifp->if_oerrors++; 1441193240Ssam mwl_puttxbuf_head(txq, bf); 1442193240Ssam ieee80211_free_node(ni); 1443193240Ssam continue; 1444193240Ssam } 1445193240Ssam nqueued++; 1446193240Ssam if (nqueued >= mwl_txcoalesce) { 1447193240Ssam /* 1448193240Ssam * Poke the firmware to process queued frames; 1449193240Ssam * see below about (lack of) locking. 1450193240Ssam */ 1451193240Ssam nqueued = 0; 1452193240Ssam mwl_hal_txstart(sc->sc_mh, 0/*XXX*/); 1453193240Ssam } 1454193240Ssam } 1455193240Ssam if (nqueued) { 1456193240Ssam /* 1457193240Ssam * NB: We don't need to lock against tx done because 1458193240Ssam * this just prods the firmware to check the transmit 1459193240Ssam * descriptors. The firmware will also start fetching 1460193240Ssam * descriptors by itself if it notices new ones are 1461193240Ssam * present when it goes to deliver a tx done interrupt 1462193240Ssam * to the host. So if we race with tx done processing 1463193240Ssam * it's ok. Delivering the kick here rather than in 1464193240Ssam * mwl_tx_start is an optimization to avoid poking the 1465193240Ssam * firmware for each packet. 1466193240Ssam * 1467193240Ssam * NB: the queue id isn't used so 0 is ok. 1468193240Ssam */ 1469193240Ssam mwl_hal_txstart(sc->sc_mh, 0/*XXX*/); 1470193240Ssam } 1471193240Ssam} 1472193240Ssam 1473193240Ssamstatic int 1474193240Ssammwl_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 1475193240Ssam const struct ieee80211_bpf_params *params) 1476193240Ssam{ 1477193240Ssam struct ieee80211com *ic = ni->ni_ic; 1478193240Ssam struct ifnet *ifp = ic->ic_ifp; 1479193240Ssam struct mwl_softc *sc = ifp->if_softc; 1480193240Ssam struct mwl_txbuf *bf; 1481193240Ssam struct mwl_txq *txq; 1482193240Ssam 1483193240Ssam if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0 || sc->sc_invalid) { 1484193240Ssam ieee80211_free_node(ni); 1485193240Ssam m_freem(m); 1486193240Ssam return ENETDOWN; 1487193240Ssam } 1488193240Ssam /* 1489193240Ssam * Grab a TX buffer and associated resources. 1490193240Ssam * Note that we depend on the classification 1491193240Ssam * by the 802.11 layer to get to the right h/w 1492193240Ssam * queue. Management frames must ALWAYS go on 1493193240Ssam * queue 1 but we cannot just force that here 1494193240Ssam * because we may receive non-mgt frames. 1495193240Ssam */ 1496193240Ssam txq = sc->sc_ac2q[M_WME_GETAC(m)]; 1497193240Ssam bf = mwl_gettxbuf(sc, txq); 1498193240Ssam if (bf == NULL) { 1499193240Ssam sc->sc_stats.mst_tx_qstop++; 1500193240Ssam /* XXX blocks other traffic */ 1501193240Ssam ifp->if_drv_flags |= IFF_DRV_OACTIVE; 1502193240Ssam ieee80211_free_node(ni); 1503193240Ssam m_freem(m); 1504193240Ssam return ENOBUFS; 1505193240Ssam } 1506193240Ssam /* 1507193240Ssam * Pass the frame to the h/w for transmission. 1508193240Ssam */ 1509193240Ssam if (mwl_tx_start(sc, ni, bf, m)) { 1510193240Ssam ifp->if_oerrors++; 1511193240Ssam mwl_puttxbuf_head(txq, bf); 1512193240Ssam 1513193240Ssam ieee80211_free_node(ni); 1514193240Ssam return EIO; /* XXX */ 1515193240Ssam } 1516193240Ssam /* 1517193240Ssam * NB: We don't need to lock against tx done because 1518193240Ssam * this just prods the firmware to check the transmit 1519193240Ssam * descriptors. The firmware will also start fetching 1520193240Ssam * descriptors by itself if it notices new ones are 1521193240Ssam * present when it goes to deliver a tx done interrupt 1522193240Ssam * to the host. So if we race with tx done processing 1523193240Ssam * it's ok. Delivering the kick here rather than in 1524193240Ssam * mwl_tx_start is an optimization to avoid poking the 1525193240Ssam * firmware for each packet. 1526193240Ssam * 1527193240Ssam * NB: the queue id isn't used so 0 is ok. 1528193240Ssam */ 1529193240Ssam mwl_hal_txstart(sc->sc_mh, 0/*XXX*/); 1530193240Ssam return 0; 1531193240Ssam} 1532193240Ssam 1533193240Ssamstatic int 1534193240Ssammwl_media_change(struct ifnet *ifp) 1535193240Ssam{ 1536193240Ssam struct ieee80211vap *vap = ifp->if_softc; 1537193240Ssam int error; 1538193240Ssam 1539193240Ssam error = ieee80211_media_change(ifp); 1540193240Ssam /* NB: only the fixed rate can change and that doesn't need a reset */ 1541193240Ssam if (error == ENETRESET) { 1542193240Ssam mwl_setrates(vap); 1543193240Ssam error = 0; 1544193240Ssam } 1545193240Ssam return error; 1546193240Ssam} 1547193240Ssam 1548193240Ssam#ifdef MWL_DEBUG 1549193240Ssamstatic void 1550193240Ssammwl_keyprint(struct mwl_softc *sc, const char *tag, 1551193240Ssam const MWL_HAL_KEYVAL *hk, const uint8_t mac[IEEE80211_ADDR_LEN]) 1552193240Ssam{ 1553193240Ssam static const char *ciphers[] = { 1554193240Ssam "WEP", 1555193240Ssam "TKIP", 1556193240Ssam "AES-CCM", 1557193240Ssam }; 1558193240Ssam int i, n; 1559193240Ssam 1560193240Ssam printf("%s: [%u] %-7s", tag, hk->keyIndex, ciphers[hk->keyTypeId]); 1561193240Ssam for (i = 0, n = hk->keyLen; i < n; i++) 1562193240Ssam printf(" %02x", hk->key.aes[i]); 1563193240Ssam printf(" mac %s", ether_sprintf(mac)); 1564193240Ssam if (hk->keyTypeId == KEY_TYPE_ID_TKIP) { 1565193240Ssam printf(" %s", "rxmic"); 1566193240Ssam for (i = 0; i < sizeof(hk->key.tkip.rxMic); i++) 1567193240Ssam printf(" %02x", hk->key.tkip.rxMic[i]); 1568193240Ssam printf(" txmic"); 1569193240Ssam for (i = 0; i < sizeof(hk->key.tkip.txMic); i++) 1570193240Ssam printf(" %02x", hk->key.tkip.txMic[i]); 1571193240Ssam } 1572193240Ssam printf(" flags 0x%x\n", hk->keyFlags); 1573193240Ssam} 1574193240Ssam#endif 1575193240Ssam 1576193240Ssam/* 1577193240Ssam * Allocate a key cache slot for a unicast key. The 1578193240Ssam * firmware handles key allocation and every station is 1579193240Ssam * guaranteed key space so we are always successful. 1580193240Ssam */ 1581193240Ssamstatic int 1582193240Ssammwl_key_alloc(struct ieee80211vap *vap, struct ieee80211_key *k, 1583193240Ssam ieee80211_keyix *keyix, ieee80211_keyix *rxkeyix) 1584193240Ssam{ 1585193240Ssam struct mwl_softc *sc = vap->iv_ic->ic_ifp->if_softc; 1586193240Ssam 1587193240Ssam if (k->wk_keyix != IEEE80211_KEYIX_NONE || 1588193240Ssam (k->wk_flags & IEEE80211_KEY_GROUP)) { 1589193240Ssam if (!(&vap->iv_nw_keys[0] <= k && 1590193240Ssam k < &vap->iv_nw_keys[IEEE80211_WEP_NKID])) { 1591193240Ssam /* should not happen */ 1592193240Ssam DPRINTF(sc, MWL_DEBUG_KEYCACHE, 1593193240Ssam "%s: bogus group key\n", __func__); 1594193240Ssam return 0; 1595193240Ssam } 1596193240Ssam /* give the caller what they requested */ 1597193240Ssam *keyix = *rxkeyix = k - vap->iv_nw_keys; 1598193240Ssam } else { 1599193240Ssam /* 1600193240Ssam * Firmware handles key allocation. 1601193240Ssam */ 1602193240Ssam *keyix = *rxkeyix = 0; 1603193240Ssam } 1604193240Ssam return 1; 1605193240Ssam} 1606193240Ssam 1607193240Ssam/* 1608193240Ssam * Delete a key entry allocated by mwl_key_alloc. 1609193240Ssam */ 1610193240Ssamstatic int 1611193240Ssammwl_key_delete(struct ieee80211vap *vap, const struct ieee80211_key *k) 1612193240Ssam{ 1613193240Ssam struct mwl_softc *sc = vap->iv_ic->ic_ifp->if_softc; 1614193240Ssam struct mwl_hal_vap *hvap = MWL_VAP(vap)->mv_hvap; 1615193240Ssam MWL_HAL_KEYVAL hk; 1616193240Ssam const uint8_t bcastaddr[IEEE80211_ADDR_LEN] = 1617193240Ssam { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 1618193240Ssam 1619193240Ssam if (hvap == NULL) { 1620193240Ssam if (vap->iv_opmode != IEEE80211_M_WDS) { 1621193240Ssam /* XXX monitor mode? */ 1622193240Ssam DPRINTF(sc, MWL_DEBUG_KEYCACHE, 1623193240Ssam "%s: no hvap for opmode %d\n", __func__, 1624193240Ssam vap->iv_opmode); 1625193240Ssam return 0; 1626193240Ssam } 1627193240Ssam hvap = MWL_VAP(vap)->mv_ap_hvap; 1628193240Ssam } 1629193240Ssam 1630193240Ssam DPRINTF(sc, MWL_DEBUG_KEYCACHE, "%s: delete key %u\n", 1631193240Ssam __func__, k->wk_keyix); 1632193240Ssam 1633193240Ssam memset(&hk, 0, sizeof(hk)); 1634193240Ssam hk.keyIndex = k->wk_keyix; 1635193240Ssam switch (k->wk_cipher->ic_cipher) { 1636193240Ssam case IEEE80211_CIPHER_WEP: 1637193240Ssam hk.keyTypeId = KEY_TYPE_ID_WEP; 1638193240Ssam break; 1639193240Ssam case IEEE80211_CIPHER_TKIP: 1640193240Ssam hk.keyTypeId = KEY_TYPE_ID_TKIP; 1641193240Ssam break; 1642193240Ssam case IEEE80211_CIPHER_AES_CCM: 1643193240Ssam hk.keyTypeId = KEY_TYPE_ID_AES; 1644193240Ssam break; 1645193240Ssam default: 1646193240Ssam /* XXX should not happen */ 1647193240Ssam DPRINTF(sc, MWL_DEBUG_KEYCACHE, "%s: unknown cipher %d\n", 1648193240Ssam __func__, k->wk_cipher->ic_cipher); 1649193240Ssam return 0; 1650193240Ssam } 1651193240Ssam return (mwl_hal_keyreset(hvap, &hk, bcastaddr) == 0); /*XXX*/ 1652193240Ssam} 1653193240Ssam 1654193240Ssamstatic __inline int 1655193240Ssamaddgroupflags(MWL_HAL_KEYVAL *hk, const struct ieee80211_key *k) 1656193240Ssam{ 1657193240Ssam if (k->wk_flags & IEEE80211_KEY_GROUP) { 1658193240Ssam if (k->wk_flags & IEEE80211_KEY_XMIT) 1659193240Ssam hk->keyFlags |= KEY_FLAG_TXGROUPKEY; 1660193240Ssam if (k->wk_flags & IEEE80211_KEY_RECV) 1661193240Ssam hk->keyFlags |= KEY_FLAG_RXGROUPKEY; 1662193240Ssam return 1; 1663193240Ssam } else 1664193240Ssam return 0; 1665193240Ssam} 1666193240Ssam 1667193240Ssam/* 1668193240Ssam * Set the key cache contents for the specified key. Key cache 1669193240Ssam * slot(s) must already have been allocated by mwl_key_alloc. 1670193240Ssam */ 1671193240Ssamstatic int 1672193240Ssammwl_key_set(struct ieee80211vap *vap, const struct ieee80211_key *k, 1673193240Ssam const uint8_t mac[IEEE80211_ADDR_LEN]) 1674193240Ssam{ 1675193240Ssam#define GRPXMIT (IEEE80211_KEY_XMIT | IEEE80211_KEY_GROUP) 1676193240Ssam/* NB: static wep keys are marked GROUP+tx/rx; GTK will be tx or rx */ 1677193240Ssam#define IEEE80211_IS_STATICKEY(k) \ 1678193240Ssam (((k)->wk_flags & (GRPXMIT|IEEE80211_KEY_RECV)) == \ 1679193240Ssam (GRPXMIT|IEEE80211_KEY_RECV)) 1680193240Ssam struct mwl_softc *sc = vap->iv_ic->ic_ifp->if_softc; 1681193240Ssam struct mwl_hal_vap *hvap = MWL_VAP(vap)->mv_hvap; 1682193240Ssam const struct ieee80211_cipher *cip = k->wk_cipher; 1683193240Ssam const uint8_t *macaddr; 1684193240Ssam MWL_HAL_KEYVAL hk; 1685193240Ssam 1686193240Ssam KASSERT((k->wk_flags & IEEE80211_KEY_SWCRYPT) == 0, 1687193240Ssam ("s/w crypto set?")); 1688193240Ssam 1689193240Ssam if (hvap == NULL) { 1690193240Ssam if (vap->iv_opmode != IEEE80211_M_WDS) { 1691193240Ssam /* XXX monitor mode? */ 1692193240Ssam DPRINTF(sc, MWL_DEBUG_KEYCACHE, 1693193240Ssam "%s: no hvap for opmode %d\n", __func__, 1694193240Ssam vap->iv_opmode); 1695193240Ssam return 0; 1696193240Ssam } 1697193240Ssam hvap = MWL_VAP(vap)->mv_ap_hvap; 1698193240Ssam } 1699193240Ssam memset(&hk, 0, sizeof(hk)); 1700193240Ssam hk.keyIndex = k->wk_keyix; 1701193240Ssam switch (cip->ic_cipher) { 1702193240Ssam case IEEE80211_CIPHER_WEP: 1703193240Ssam hk.keyTypeId = KEY_TYPE_ID_WEP; 1704193240Ssam hk.keyLen = k->wk_keylen; 1705193240Ssam if (k->wk_keyix == vap->iv_def_txkey) 1706193240Ssam hk.keyFlags = KEY_FLAG_WEP_TXKEY; 1707193240Ssam if (!IEEE80211_IS_STATICKEY(k)) { 1708193240Ssam /* NB: WEP is never used for the PTK */ 1709193240Ssam (void) addgroupflags(&hk, k); 1710193240Ssam } 1711193240Ssam break; 1712193240Ssam case IEEE80211_CIPHER_TKIP: 1713193240Ssam hk.keyTypeId = KEY_TYPE_ID_TKIP; 1714193240Ssam hk.key.tkip.tsc.high = (uint32_t)(k->wk_keytsc >> 16); 1715193240Ssam hk.key.tkip.tsc.low = (uint16_t)k->wk_keytsc; 1716193240Ssam hk.keyFlags = KEY_FLAG_TSC_VALID | KEY_FLAG_MICKEY_VALID; 1717193240Ssam hk.keyLen = k->wk_keylen + IEEE80211_MICBUF_SIZE; 1718193240Ssam if (!addgroupflags(&hk, k)) 1719193240Ssam hk.keyFlags |= KEY_FLAG_PAIRWISE; 1720193240Ssam break; 1721193240Ssam case IEEE80211_CIPHER_AES_CCM: 1722193240Ssam hk.keyTypeId = KEY_TYPE_ID_AES; 1723193240Ssam hk.keyLen = k->wk_keylen; 1724193240Ssam if (!addgroupflags(&hk, k)) 1725193240Ssam hk.keyFlags |= KEY_FLAG_PAIRWISE; 1726193240Ssam break; 1727193240Ssam default: 1728193240Ssam /* XXX should not happen */ 1729193240Ssam DPRINTF(sc, MWL_DEBUG_KEYCACHE, "%s: unknown cipher %d\n", 1730193240Ssam __func__, k->wk_cipher->ic_cipher); 1731193240Ssam return 0; 1732193240Ssam } 1733193240Ssam /* 1734193240Ssam * NB: tkip mic keys get copied here too; the layout 1735193240Ssam * just happens to match that in ieee80211_key. 1736193240Ssam */ 1737193240Ssam memcpy(hk.key.aes, k->wk_key, hk.keyLen); 1738193240Ssam 1739193240Ssam /* 1740193240Ssam * Locate address of sta db entry for writing key; 1741193240Ssam * the convention unfortunately is somewhat different 1742193240Ssam * than how net80211, hostapd, and wpa_supplicant think. 1743193240Ssam */ 1744193240Ssam if (vap->iv_opmode == IEEE80211_M_STA) { 1745193240Ssam /* 1746193240Ssam * NB: keys plumbed before the sta reaches AUTH state 1747193240Ssam * will be discarded or written to the wrong sta db 1748193240Ssam * entry because iv_bss is meaningless. This is ok 1749193240Ssam * (right now) because we handle deferred plumbing of 1750193240Ssam * WEP keys when the sta reaches AUTH state. 1751193240Ssam */ 1752193240Ssam macaddr = vap->iv_bss->ni_bssid; 1753196842Ssam if ((k->wk_flags & IEEE80211_KEY_GROUP) == 0) { 1754196842Ssam /* XXX plumb to local sta db too for static key wep */ 1755196842Ssam mwl_hal_keyset(hvap, &hk, vap->iv_myaddr); 1756196842Ssam } 1757193240Ssam } else if (vap->iv_opmode == IEEE80211_M_WDS && 1758193240Ssam vap->iv_state != IEEE80211_S_RUN) { 1759193240Ssam /* 1760193240Ssam * Prior to RUN state a WDS vap will not it's BSS node 1761193240Ssam * setup so we will plumb the key to the wrong mac 1762193240Ssam * address (it'll be our local address). Workaround 1763193240Ssam * this for the moment by grabbing the correct address. 1764193240Ssam */ 1765193240Ssam macaddr = vap->iv_des_bssid; 1766193240Ssam } else if ((k->wk_flags & GRPXMIT) == GRPXMIT) 1767193240Ssam macaddr = vap->iv_myaddr; 1768193240Ssam else 1769193240Ssam macaddr = mac; 1770193240Ssam KEYPRINTF(sc, &hk, macaddr); 1771193240Ssam return (mwl_hal_keyset(hvap, &hk, macaddr) == 0); 1772193240Ssam#undef IEEE80211_IS_STATICKEY 1773193240Ssam#undef GRPXMIT 1774193240Ssam} 1775193240Ssam 1776193240Ssam/* unaligned little endian access */ 1777193240Ssam#define LE_READ_2(p) \ 1778193240Ssam ((uint16_t) \ 1779193240Ssam ((((const uint8_t *)(p))[0] ) | \ 1780193240Ssam (((const uint8_t *)(p))[1] << 8))) 1781193240Ssam#define LE_READ_4(p) \ 1782193240Ssam ((uint32_t) \ 1783193240Ssam ((((const uint8_t *)(p))[0] ) | \ 1784193240Ssam (((const uint8_t *)(p))[1] << 8) | \ 1785193240Ssam (((const uint8_t *)(p))[2] << 16) | \ 1786193240Ssam (((const uint8_t *)(p))[3] << 24))) 1787193240Ssam 1788193240Ssam/* 1789193240Ssam * Set the multicast filter contents into the hardware. 1790193240Ssam * XXX f/w has no support; just defer to the os. 1791193240Ssam */ 1792193240Ssamstatic void 1793193240Ssammwl_setmcastfilter(struct mwl_softc *sc) 1794193240Ssam{ 1795193240Ssam struct ifnet *ifp = sc->sc_ifp; 1796193240Ssam#if 0 1797193240Ssam struct ether_multi *enm; 1798193240Ssam struct ether_multistep estep; 1799193240Ssam uint8_t macs[IEEE80211_ADDR_LEN*MWL_HAL_MCAST_MAX];/* XXX stack use */ 1800193240Ssam uint8_t *mp; 1801193240Ssam int nmc; 1802193240Ssam 1803193240Ssam mp = macs; 1804193240Ssam nmc = 0; 1805193240Ssam ETHER_FIRST_MULTI(estep, &sc->sc_ec, enm); 1806193240Ssam while (enm != NULL) { 1807193240Ssam /* XXX Punt on ranges. */ 1808193240Ssam if (nmc == MWL_HAL_MCAST_MAX || 1809193240Ssam !IEEE80211_ADDR_EQ(enm->enm_addrlo, enm->enm_addrhi)) { 1810193240Ssam ifp->if_flags |= IFF_ALLMULTI; 1811193240Ssam return; 1812193240Ssam } 1813193240Ssam IEEE80211_ADDR_COPY(mp, enm->enm_addrlo); 1814193240Ssam mp += IEEE80211_ADDR_LEN, nmc++; 1815193240Ssam ETHER_NEXT_MULTI(estep, enm); 1816193240Ssam } 1817193240Ssam ifp->if_flags &= ~IFF_ALLMULTI; 1818193240Ssam mwl_hal_setmcast(sc->sc_mh, nmc, macs); 1819193240Ssam#else 1820193240Ssam /* XXX no mcast filter support; we get everything */ 1821193240Ssam ifp->if_flags |= IFF_ALLMULTI; 1822193240Ssam#endif 1823193240Ssam} 1824193240Ssam 1825193240Ssamstatic int 1826193240Ssammwl_mode_init(struct mwl_softc *sc) 1827193240Ssam{ 1828193240Ssam struct ifnet *ifp = sc->sc_ifp; 1829193240Ssam struct ieee80211com *ic = ifp->if_l2com; 1830193240Ssam struct mwl_hal *mh = sc->sc_mh; 1831193240Ssam 1832193240Ssam /* 1833193240Ssam * NB: Ignore promisc in hostap mode; it's set by the 1834193240Ssam * bridge. This is wrong but we have no way to 1835193240Ssam * identify internal requests (from the bridge) 1836193240Ssam * versus external requests such as for tcpdump. 1837193240Ssam */ 1838193240Ssam mwl_hal_setpromisc(mh, (ifp->if_flags & IFF_PROMISC) && 1839193240Ssam ic->ic_opmode != IEEE80211_M_HOSTAP); 1840193240Ssam mwl_setmcastfilter(sc); 1841193240Ssam 1842193240Ssam return 0; 1843193240Ssam} 1844193240Ssam 1845193240Ssam/* 1846193240Ssam * Callback from the 802.11 layer after a multicast state change. 1847193240Ssam */ 1848193240Ssamstatic void 1849193240Ssammwl_update_mcast(struct ifnet *ifp) 1850193240Ssam{ 1851193240Ssam struct mwl_softc *sc = ifp->if_softc; 1852193240Ssam 1853193240Ssam mwl_setmcastfilter(sc); 1854193240Ssam} 1855193240Ssam 1856193240Ssam/* 1857193240Ssam * Callback from the 802.11 layer after a promiscuous mode change. 1858193240Ssam * Note this interface does not check the operating mode as this 1859193240Ssam * is an internal callback and we are expected to honor the current 1860193240Ssam * state (e.g. this is used for setting the interface in promiscuous 1861193240Ssam * mode when operating in hostap mode to do ACS). 1862193240Ssam */ 1863193240Ssamstatic void 1864193240Ssammwl_update_promisc(struct ifnet *ifp) 1865193240Ssam{ 1866193240Ssam struct mwl_softc *sc = ifp->if_softc; 1867193240Ssam 1868193240Ssam mwl_hal_setpromisc(sc->sc_mh, (ifp->if_flags & IFF_PROMISC) != 0); 1869193240Ssam} 1870193240Ssam 1871193240Ssam/* 1872193240Ssam * Callback from the 802.11 layer to update the slot time 1873193240Ssam * based on the current setting. We use it to notify the 1874193240Ssam * firmware of ERP changes and the f/w takes care of things 1875193240Ssam * like slot time and preamble. 1876193240Ssam */ 1877193240Ssamstatic void 1878193240Ssammwl_updateslot(struct ifnet *ifp) 1879193240Ssam{ 1880193240Ssam struct mwl_softc *sc = ifp->if_softc; 1881193240Ssam struct ieee80211com *ic = ifp->if_l2com; 1882193240Ssam struct mwl_hal *mh = sc->sc_mh; 1883193240Ssam int prot; 1884193240Ssam 1885193240Ssam /* NB: can be called early; suppress needless cmds */ 1886193240Ssam if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0) 1887193240Ssam return; 1888193240Ssam 1889193240Ssam /* 1890193240Ssam * Calculate the ERP flags. The firwmare will use 1891193240Ssam * this to carry out the appropriate measures. 1892193240Ssam */ 1893193240Ssam prot = 0; 1894193240Ssam if (IEEE80211_IS_CHAN_ANYG(ic->ic_curchan)) { 1895193240Ssam if ((ic->ic_flags & IEEE80211_F_SHSLOT) == 0) 1896193240Ssam prot |= IEEE80211_ERP_NON_ERP_PRESENT; 1897193240Ssam if (ic->ic_flags & IEEE80211_F_USEPROT) 1898193240Ssam prot |= IEEE80211_ERP_USE_PROTECTION; 1899193240Ssam if (ic->ic_flags & IEEE80211_F_USEBARKER) 1900193240Ssam prot |= IEEE80211_ERP_LONG_PREAMBLE; 1901193240Ssam } 1902193240Ssam 1903193240Ssam DPRINTF(sc, MWL_DEBUG_RESET, 1904193240Ssam "%s: chan %u MHz/flags 0x%x %s slot, (prot 0x%x ic_flags 0x%x)\n", 1905193240Ssam __func__, ic->ic_curchan->ic_freq, ic->ic_curchan->ic_flags, 1906193240Ssam ic->ic_flags & IEEE80211_F_SHSLOT ? "short" : "long", prot, 1907193240Ssam ic->ic_flags); 1908193240Ssam 1909193240Ssam mwl_hal_setgprot(mh, prot); 1910193240Ssam} 1911193240Ssam 1912193240Ssam/* 1913193240Ssam * Setup the beacon frame. 1914193240Ssam */ 1915193240Ssamstatic int 1916193240Ssammwl_beacon_setup(struct ieee80211vap *vap) 1917193240Ssam{ 1918193240Ssam struct mwl_hal_vap *hvap = MWL_VAP(vap)->mv_hvap; 1919193240Ssam struct ieee80211_node *ni = vap->iv_bss; 1920193240Ssam struct ieee80211_beacon_offsets bo; 1921193240Ssam struct mbuf *m; 1922193240Ssam 1923193240Ssam m = ieee80211_beacon_alloc(ni, &bo); 1924193240Ssam if (m == NULL) 1925193240Ssam return ENOBUFS; 1926193240Ssam mwl_hal_setbeacon(hvap, mtod(m, const void *), m->m_len); 1927193240Ssam m_free(m); 1928193240Ssam 1929193240Ssam return 0; 1930193240Ssam} 1931193240Ssam 1932193240Ssam/* 1933193240Ssam * Update the beacon frame in response to a change. 1934193240Ssam */ 1935193240Ssamstatic void 1936193240Ssammwl_beacon_update(struct ieee80211vap *vap, int item) 1937193240Ssam{ 1938193240Ssam struct mwl_hal_vap *hvap = MWL_VAP(vap)->mv_hvap; 1939193240Ssam struct ieee80211com *ic = vap->iv_ic; 1940193240Ssam 1941193240Ssam KASSERT(hvap != NULL, ("no beacon")); 1942193240Ssam switch (item) { 1943193240Ssam case IEEE80211_BEACON_ERP: 1944193240Ssam mwl_updateslot(ic->ic_ifp); 1945193240Ssam break; 1946193240Ssam case IEEE80211_BEACON_HTINFO: 1947193240Ssam mwl_hal_setnprotmode(hvap, 1948193240Ssam MS(ic->ic_curhtprotmode, IEEE80211_HTINFO_OPMODE)); 1949193240Ssam break; 1950193240Ssam case IEEE80211_BEACON_CAPS: 1951193240Ssam case IEEE80211_BEACON_WME: 1952193240Ssam case IEEE80211_BEACON_APPIE: 1953193240Ssam case IEEE80211_BEACON_CSA: 1954193240Ssam break; 1955193240Ssam case IEEE80211_BEACON_TIM: 1956193240Ssam /* NB: firmware always forms TIM */ 1957193240Ssam return; 1958193240Ssam } 1959193240Ssam /* XXX retain beacon frame and update */ 1960193240Ssam mwl_beacon_setup(vap); 1961193240Ssam} 1962193240Ssam 1963193240Ssamstatic void 1964193240Ssammwl_load_cb(void *arg, bus_dma_segment_t *segs, int nsegs, int error) 1965193240Ssam{ 1966193240Ssam bus_addr_t *paddr = (bus_addr_t*) arg; 1967193240Ssam KASSERT(error == 0, ("error %u on bus_dma callback", error)); 1968193240Ssam *paddr = segs->ds_addr; 1969193240Ssam} 1970193240Ssam 1971193240Ssam#ifdef MWL_HOST_PS_SUPPORT 1972193240Ssam/* 1973193240Ssam * Handle power save station occupancy changes. 1974193240Ssam */ 1975193240Ssamstatic void 1976193240Ssammwl_update_ps(struct ieee80211vap *vap, int nsta) 1977193240Ssam{ 1978193240Ssam struct mwl_vap *mvp = MWL_VAP(vap); 1979193240Ssam 1980193240Ssam if (nsta == 0 || mvp->mv_last_ps_sta == 0) 1981193240Ssam mwl_hal_setpowersave_bss(mvp->mv_hvap, nsta); 1982193240Ssam mvp->mv_last_ps_sta = nsta; 1983193240Ssam} 1984193240Ssam 1985193240Ssam/* 1986193240Ssam * Handle associated station power save state changes. 1987193240Ssam */ 1988193240Ssamstatic int 1989193240Ssammwl_set_tim(struct ieee80211_node *ni, int set) 1990193240Ssam{ 1991193240Ssam struct ieee80211vap *vap = ni->ni_vap; 1992193240Ssam struct mwl_vap *mvp = MWL_VAP(vap); 1993193240Ssam 1994193240Ssam if (mvp->mv_set_tim(ni, set)) { /* NB: state change */ 1995193240Ssam mwl_hal_setpowersave_sta(mvp->mv_hvap, 1996193240Ssam IEEE80211_AID(ni->ni_associd), set); 1997193240Ssam return 1; 1998193240Ssam } else 1999193240Ssam return 0; 2000193240Ssam} 2001193240Ssam#endif /* MWL_HOST_PS_SUPPORT */ 2002193240Ssam 2003193240Ssamstatic int 2004193240Ssammwl_desc_setup(struct mwl_softc *sc, const char *name, 2005193240Ssam struct mwl_descdma *dd, 2006193240Ssam int nbuf, size_t bufsize, int ndesc, size_t descsize) 2007193240Ssam{ 2008193240Ssam struct ifnet *ifp = sc->sc_ifp; 2009193240Ssam uint8_t *ds; 2010193240Ssam int error; 2011193240Ssam 2012193240Ssam DPRINTF(sc, MWL_DEBUG_RESET, 2013193240Ssam "%s: %s DMA: %u bufs (%ju) %u desc/buf (%ju)\n", 2014193240Ssam __func__, name, nbuf, (uintmax_t) bufsize, 2015193240Ssam ndesc, (uintmax_t) descsize); 2016193240Ssam 2017193240Ssam dd->dd_name = name; 2018193240Ssam dd->dd_desc_len = nbuf * ndesc * descsize; 2019193240Ssam 2020193240Ssam /* 2021193240Ssam * Setup DMA descriptor area. 2022193240Ssam */ 2023193240Ssam error = bus_dma_tag_create(bus_get_dma_tag(sc->sc_dev), /* parent */ 2024193240Ssam PAGE_SIZE, 0, /* alignment, bounds */ 2025193240Ssam BUS_SPACE_MAXADDR_32BIT, /* lowaddr */ 2026193240Ssam BUS_SPACE_MAXADDR, /* highaddr */ 2027193240Ssam NULL, NULL, /* filter, filterarg */ 2028193240Ssam dd->dd_desc_len, /* maxsize */ 2029193240Ssam 1, /* nsegments */ 2030193240Ssam dd->dd_desc_len, /* maxsegsize */ 2031193240Ssam BUS_DMA_ALLOCNOW, /* flags */ 2032193240Ssam NULL, /* lockfunc */ 2033193240Ssam NULL, /* lockarg */ 2034193240Ssam &dd->dd_dmat); 2035193240Ssam if (error != 0) { 2036193240Ssam if_printf(ifp, "cannot allocate %s DMA tag\n", dd->dd_name); 2037193240Ssam return error; 2038193240Ssam } 2039193240Ssam 2040193240Ssam /* allocate descriptors */ 2041193240Ssam error = bus_dmamap_create(dd->dd_dmat, BUS_DMA_NOWAIT, &dd->dd_dmamap); 2042193240Ssam if (error != 0) { 2043193240Ssam if_printf(ifp, "unable to create dmamap for %s descriptors, " 2044193240Ssam "error %u\n", dd->dd_name, error); 2045193240Ssam goto fail0; 2046193240Ssam } 2047193240Ssam 2048193240Ssam error = bus_dmamem_alloc(dd->dd_dmat, (void**) &dd->dd_desc, 2049193240Ssam BUS_DMA_NOWAIT | BUS_DMA_COHERENT, 2050193240Ssam &dd->dd_dmamap); 2051193240Ssam if (error != 0) { 2052193240Ssam if_printf(ifp, "unable to alloc memory for %u %s descriptors, " 2053193240Ssam "error %u\n", nbuf * ndesc, dd->dd_name, error); 2054193240Ssam goto fail1; 2055193240Ssam } 2056193240Ssam 2057193240Ssam error = bus_dmamap_load(dd->dd_dmat, dd->dd_dmamap, 2058193240Ssam dd->dd_desc, dd->dd_desc_len, 2059193240Ssam mwl_load_cb, &dd->dd_desc_paddr, 2060193240Ssam BUS_DMA_NOWAIT); 2061193240Ssam if (error != 0) { 2062193240Ssam if_printf(ifp, "unable to map %s descriptors, error %u\n", 2063193240Ssam dd->dd_name, error); 2064193240Ssam goto fail2; 2065193240Ssam } 2066193240Ssam 2067193240Ssam ds = dd->dd_desc; 2068193240Ssam memset(ds, 0, dd->dd_desc_len); 2069193240Ssam DPRINTF(sc, MWL_DEBUG_RESET, "%s: %s DMA map: %p (%lu) -> %p (%lu)\n", 2070193240Ssam __func__, dd->dd_name, ds, (u_long) dd->dd_desc_len, 2071193240Ssam (caddr_t) dd->dd_desc_paddr, /*XXX*/ (u_long) dd->dd_desc_len); 2072193240Ssam 2073193240Ssam return 0; 2074193240Ssamfail2: 2075193240Ssam bus_dmamem_free(dd->dd_dmat, dd->dd_desc, dd->dd_dmamap); 2076193240Ssamfail1: 2077193240Ssam bus_dmamap_destroy(dd->dd_dmat, dd->dd_dmamap); 2078193240Ssamfail0: 2079193240Ssam bus_dma_tag_destroy(dd->dd_dmat); 2080193240Ssam memset(dd, 0, sizeof(*dd)); 2081193240Ssam return error; 2082193240Ssam#undef DS2PHYS 2083193240Ssam} 2084193240Ssam 2085193240Ssamstatic void 2086193240Ssammwl_desc_cleanup(struct mwl_softc *sc, struct mwl_descdma *dd) 2087193240Ssam{ 2088193240Ssam bus_dmamap_unload(dd->dd_dmat, dd->dd_dmamap); 2089193240Ssam bus_dmamem_free(dd->dd_dmat, dd->dd_desc, dd->dd_dmamap); 2090193240Ssam bus_dmamap_destroy(dd->dd_dmat, dd->dd_dmamap); 2091193240Ssam bus_dma_tag_destroy(dd->dd_dmat); 2092193240Ssam 2093193240Ssam memset(dd, 0, sizeof(*dd)); 2094193240Ssam} 2095193240Ssam 2096193240Ssam/* 2097193240Ssam * Construct a tx q's free list. The order of entries on 2098193240Ssam * the list must reflect the physical layout of tx descriptors 2099193240Ssam * because the firmware pre-fetches descriptors. 2100193240Ssam * 2101193240Ssam * XXX might be better to use indices into the buffer array. 2102193240Ssam */ 2103193240Ssamstatic void 2104193240Ssammwl_txq_reset(struct mwl_softc *sc, struct mwl_txq *txq) 2105193240Ssam{ 2106193240Ssam struct mwl_txbuf *bf; 2107193240Ssam int i; 2108193240Ssam 2109193240Ssam bf = txq->dma.dd_bufptr; 2110193240Ssam STAILQ_INIT(&txq->free); 2111193240Ssam for (i = 0; i < mwl_txbuf; i++, bf++) 2112193240Ssam STAILQ_INSERT_TAIL(&txq->free, bf, bf_list); 2113193240Ssam txq->nfree = i; 2114193240Ssam} 2115193240Ssam 2116193240Ssam#define DS2PHYS(_dd, _ds) \ 2117193240Ssam ((_dd)->dd_desc_paddr + ((caddr_t)(_ds) - (caddr_t)(_dd)->dd_desc)) 2118193240Ssam 2119193240Ssamstatic int 2120193240Ssammwl_txdma_setup(struct mwl_softc *sc, struct mwl_txq *txq) 2121193240Ssam{ 2122193240Ssam struct ifnet *ifp = sc->sc_ifp; 2123193240Ssam int error, bsize, i; 2124193240Ssam struct mwl_txbuf *bf; 2125193240Ssam struct mwl_txdesc *ds; 2126193240Ssam 2127193240Ssam error = mwl_desc_setup(sc, "tx", &txq->dma, 2128193240Ssam mwl_txbuf, sizeof(struct mwl_txbuf), 2129193240Ssam MWL_TXDESC, sizeof(struct mwl_txdesc)); 2130193240Ssam if (error != 0) 2131193240Ssam return error; 2132193240Ssam 2133193240Ssam /* allocate and setup tx buffers */ 2134193240Ssam bsize = mwl_txbuf * sizeof(struct mwl_txbuf); 2135193240Ssam bf = malloc(bsize, M_MWLDEV, M_NOWAIT | M_ZERO); 2136193240Ssam if (bf == NULL) { 2137193240Ssam if_printf(ifp, "malloc of %u tx buffers failed\n", 2138193240Ssam mwl_txbuf); 2139193240Ssam return ENOMEM; 2140193240Ssam } 2141193240Ssam txq->dma.dd_bufptr = bf; 2142193240Ssam 2143193240Ssam ds = txq->dma.dd_desc; 2144193240Ssam for (i = 0; i < mwl_txbuf; i++, bf++, ds += MWL_TXDESC) { 2145193240Ssam bf->bf_desc = ds; 2146193240Ssam bf->bf_daddr = DS2PHYS(&txq->dma, ds); 2147193240Ssam error = bus_dmamap_create(sc->sc_dmat, BUS_DMA_NOWAIT, 2148193240Ssam &bf->bf_dmamap); 2149193240Ssam if (error != 0) { 2150193240Ssam if_printf(ifp, "unable to create dmamap for tx " 2151193240Ssam "buffer %u, error %u\n", i, error); 2152193240Ssam return error; 2153193240Ssam } 2154193240Ssam } 2155193240Ssam mwl_txq_reset(sc, txq); 2156193240Ssam return 0; 2157193240Ssam} 2158193240Ssam 2159193240Ssamstatic void 2160193240Ssammwl_txdma_cleanup(struct mwl_softc *sc, struct mwl_txq *txq) 2161193240Ssam{ 2162193240Ssam struct mwl_txbuf *bf; 2163193240Ssam int i; 2164193240Ssam 2165193240Ssam bf = txq->dma.dd_bufptr; 2166193240Ssam for (i = 0; i < mwl_txbuf; i++, bf++) { 2167193240Ssam KASSERT(bf->bf_m == NULL, ("mbuf on free list")); 2168193240Ssam KASSERT(bf->bf_node == NULL, ("node on free list")); 2169193240Ssam if (bf->bf_dmamap != NULL) 2170193240Ssam bus_dmamap_destroy(sc->sc_dmat, bf->bf_dmamap); 2171193240Ssam } 2172193240Ssam STAILQ_INIT(&txq->free); 2173193240Ssam txq->nfree = 0; 2174193240Ssam if (txq->dma.dd_bufptr != NULL) { 2175193240Ssam free(txq->dma.dd_bufptr, M_MWLDEV); 2176193240Ssam txq->dma.dd_bufptr = NULL; 2177193240Ssam } 2178193240Ssam if (txq->dma.dd_desc_len != 0) 2179193240Ssam mwl_desc_cleanup(sc, &txq->dma); 2180193240Ssam} 2181193240Ssam 2182193240Ssamstatic int 2183193240Ssammwl_rxdma_setup(struct mwl_softc *sc) 2184193240Ssam{ 2185193240Ssam struct ifnet *ifp = sc->sc_ifp; 2186193240Ssam int error, jumbosize, bsize, i; 2187193240Ssam struct mwl_rxbuf *bf; 2188193240Ssam struct mwl_jumbo *rbuf; 2189193240Ssam struct mwl_rxdesc *ds; 2190193240Ssam caddr_t data; 2191193240Ssam 2192193240Ssam error = mwl_desc_setup(sc, "rx", &sc->sc_rxdma, 2193193240Ssam mwl_rxdesc, sizeof(struct mwl_rxbuf), 2194193240Ssam 1, sizeof(struct mwl_rxdesc)); 2195193240Ssam if (error != 0) 2196193240Ssam return error; 2197193240Ssam 2198193240Ssam /* 2199193240Ssam * Receive is done to a private pool of jumbo buffers. 2200193240Ssam * This allows us to attach to mbuf's and avoid re-mapping 2201193240Ssam * memory on each rx we post. We allocate a large chunk 2202193240Ssam * of memory and manage it in the driver. The mbuf free 2203193240Ssam * callback method is used to reclaim frames after sending 2204193240Ssam * them up the stack. By default we allocate 2x the number of 2205193240Ssam * rx descriptors configured so we have some slop to hold 2206193240Ssam * us while frames are processed. 2207193240Ssam */ 2208193240Ssam if (mwl_rxbuf < 2*mwl_rxdesc) { 2209193240Ssam if_printf(ifp, 2210193240Ssam "too few rx dma buffers (%d); increasing to %d\n", 2211193240Ssam mwl_rxbuf, 2*mwl_rxdesc); 2212193240Ssam mwl_rxbuf = 2*mwl_rxdesc; 2213193240Ssam } 2214193240Ssam jumbosize = roundup(MWL_AGGR_SIZE, PAGE_SIZE); 2215193240Ssam sc->sc_rxmemsize = mwl_rxbuf*jumbosize; 2216193240Ssam 2217193240Ssam error = bus_dma_tag_create(sc->sc_dmat, /* parent */ 2218193240Ssam PAGE_SIZE, 0, /* alignment, bounds */ 2219193240Ssam BUS_SPACE_MAXADDR_32BIT, /* lowaddr */ 2220193240Ssam BUS_SPACE_MAXADDR, /* highaddr */ 2221193240Ssam NULL, NULL, /* filter, filterarg */ 2222193240Ssam sc->sc_rxmemsize, /* maxsize */ 2223193240Ssam 1, /* nsegments */ 2224193240Ssam sc->sc_rxmemsize, /* maxsegsize */ 2225193240Ssam BUS_DMA_ALLOCNOW, /* flags */ 2226193240Ssam NULL, /* lockfunc */ 2227193240Ssam NULL, /* lockarg */ 2228193240Ssam &sc->sc_rxdmat); 2229193240Ssam error = bus_dmamap_create(sc->sc_rxdmat, BUS_DMA_NOWAIT, &sc->sc_rxmap); 2230193240Ssam if (error != 0) { 2231193240Ssam if_printf(ifp, "could not create rx DMA map\n"); 2232193240Ssam return error; 2233193240Ssam } 2234193240Ssam 2235193240Ssam error = bus_dmamem_alloc(sc->sc_rxdmat, (void**) &sc->sc_rxmem, 2236193240Ssam BUS_DMA_NOWAIT | BUS_DMA_COHERENT, 2237193240Ssam &sc->sc_rxmap); 2238193240Ssam if (error != 0) { 2239193240Ssam if_printf(ifp, "could not alloc %ju bytes of rx DMA memory\n", 2240193240Ssam (uintmax_t) sc->sc_rxmemsize); 2241193240Ssam return error; 2242193240Ssam } 2243193240Ssam 2244193240Ssam error = bus_dmamap_load(sc->sc_rxdmat, sc->sc_rxmap, 2245193240Ssam sc->sc_rxmem, sc->sc_rxmemsize, 2246193240Ssam mwl_load_cb, &sc->sc_rxmem_paddr, 2247193240Ssam BUS_DMA_NOWAIT); 2248193240Ssam if (error != 0) { 2249193240Ssam if_printf(ifp, "could not load rx DMA map\n"); 2250193240Ssam return error; 2251193240Ssam } 2252193240Ssam 2253193240Ssam /* 2254193240Ssam * Allocate rx buffers and set them up. 2255193240Ssam */ 2256193240Ssam bsize = mwl_rxdesc * sizeof(struct mwl_rxbuf); 2257193240Ssam bf = malloc(bsize, M_MWLDEV, M_NOWAIT | M_ZERO); 2258193240Ssam if (bf == NULL) { 2259193240Ssam if_printf(ifp, "malloc of %u rx buffers failed\n", bsize); 2260193240Ssam return error; 2261193240Ssam } 2262193240Ssam sc->sc_rxdma.dd_bufptr = bf; 2263193240Ssam 2264193240Ssam STAILQ_INIT(&sc->sc_rxbuf); 2265193240Ssam ds = sc->sc_rxdma.dd_desc; 2266193240Ssam for (i = 0; i < mwl_rxdesc; i++, bf++, ds++) { 2267193240Ssam bf->bf_desc = ds; 2268193240Ssam bf->bf_daddr = DS2PHYS(&sc->sc_rxdma, ds); 2269193240Ssam /* pre-assign dma buffer */ 2270193240Ssam bf->bf_data = ((uint8_t *)sc->sc_rxmem) + (i*jumbosize); 2271193240Ssam /* NB: tail is intentional to preserve descriptor order */ 2272193240Ssam STAILQ_INSERT_TAIL(&sc->sc_rxbuf, bf, bf_list); 2273193240Ssam } 2274193240Ssam 2275193240Ssam /* 2276193240Ssam * Place remainder of dma memory buffers on the free list. 2277193240Ssam */ 2278193240Ssam SLIST_INIT(&sc->sc_rxfree); 2279193240Ssam for (; i < mwl_rxbuf; i++) { 2280193240Ssam data = ((uint8_t *)sc->sc_rxmem) + (i*jumbosize); 2281193240Ssam rbuf = MWL_JUMBO_DATA2BUF(data); 2282193240Ssam SLIST_INSERT_HEAD(&sc->sc_rxfree, rbuf, next); 2283193240Ssam sc->sc_nrxfree++; 2284193240Ssam } 2285193240Ssam return 0; 2286193240Ssam} 2287193240Ssam#undef DS2PHYS 2288193240Ssam 2289193240Ssamstatic void 2290193240Ssammwl_rxdma_cleanup(struct mwl_softc *sc) 2291193240Ssam{ 2292193240Ssam if (sc->sc_rxmap != NULL) 2293193240Ssam bus_dmamap_unload(sc->sc_rxdmat, sc->sc_rxmap); 2294193240Ssam if (sc->sc_rxmem != NULL) { 2295193240Ssam bus_dmamem_free(sc->sc_rxdmat, sc->sc_rxmem, sc->sc_rxmap); 2296193240Ssam sc->sc_rxmem = NULL; 2297193240Ssam } 2298193240Ssam if (sc->sc_rxmap != NULL) { 2299193240Ssam bus_dmamap_destroy(sc->sc_rxdmat, sc->sc_rxmap); 2300193240Ssam sc->sc_rxmap = NULL; 2301193240Ssam } 2302193240Ssam if (sc->sc_rxdma.dd_bufptr != NULL) { 2303193240Ssam free(sc->sc_rxdma.dd_bufptr, M_MWLDEV); 2304193240Ssam sc->sc_rxdma.dd_bufptr = NULL; 2305193240Ssam } 2306193240Ssam if (sc->sc_rxdma.dd_desc_len != 0) 2307193240Ssam mwl_desc_cleanup(sc, &sc->sc_rxdma); 2308193240Ssam} 2309193240Ssam 2310193240Ssamstatic int 2311193240Ssammwl_dma_setup(struct mwl_softc *sc) 2312193240Ssam{ 2313193240Ssam int error, i; 2314193240Ssam 2315193240Ssam error = mwl_rxdma_setup(sc); 2316197307Srpaulo if (error != 0) { 2317197307Srpaulo mwl_rxdma_cleanup(sc); 2318193240Ssam return error; 2319197307Srpaulo } 2320193240Ssam 2321193240Ssam for (i = 0; i < MWL_NUM_TX_QUEUES; i++) { 2322193240Ssam error = mwl_txdma_setup(sc, &sc->sc_txq[i]); 2323193240Ssam if (error != 0) { 2324193240Ssam mwl_dma_cleanup(sc); 2325193240Ssam return error; 2326193240Ssam } 2327193240Ssam } 2328193240Ssam return 0; 2329193240Ssam} 2330193240Ssam 2331193240Ssamstatic void 2332193240Ssammwl_dma_cleanup(struct mwl_softc *sc) 2333193240Ssam{ 2334193240Ssam int i; 2335193240Ssam 2336193240Ssam for (i = 0; i < MWL_NUM_TX_QUEUES; i++) 2337193240Ssam mwl_txdma_cleanup(sc, &sc->sc_txq[i]); 2338193240Ssam mwl_rxdma_cleanup(sc); 2339193240Ssam} 2340193240Ssam 2341193240Ssamstatic struct ieee80211_node * 2342193240Ssammwl_node_alloc(struct ieee80211vap *vap, const uint8_t mac[IEEE80211_ADDR_LEN]) 2343193240Ssam{ 2344193240Ssam struct ieee80211com *ic = vap->iv_ic; 2345193240Ssam struct mwl_softc *sc = ic->ic_ifp->if_softc; 2346193240Ssam const size_t space = sizeof(struct mwl_node); 2347193240Ssam struct mwl_node *mn; 2348193240Ssam 2349193240Ssam mn = malloc(space, M_80211_NODE, M_NOWAIT|M_ZERO); 2350193240Ssam if (mn == NULL) { 2351193240Ssam /* XXX stat+msg */ 2352193240Ssam return NULL; 2353193240Ssam } 2354193240Ssam DPRINTF(sc, MWL_DEBUG_NODE, "%s: mn %p\n", __func__, mn); 2355193240Ssam return &mn->mn_node; 2356193240Ssam} 2357193240Ssam 2358193240Ssamstatic void 2359193240Ssammwl_node_cleanup(struct ieee80211_node *ni) 2360193240Ssam{ 2361193240Ssam struct ieee80211com *ic = ni->ni_ic; 2362193240Ssam struct mwl_softc *sc = ic->ic_ifp->if_softc; 2363193240Ssam struct mwl_node *mn = MWL_NODE(ni); 2364193240Ssam 2365193240Ssam DPRINTF(sc, MWL_DEBUG_NODE, "%s: ni %p ic %p staid %d\n", 2366193240Ssam __func__, ni, ni->ni_ic, mn->mn_staid); 2367193240Ssam 2368193240Ssam if (mn->mn_staid != 0) { 2369193240Ssam struct ieee80211vap *vap = ni->ni_vap; 2370193240Ssam 2371193240Ssam if (mn->mn_hvap != NULL) { 2372193240Ssam if (vap->iv_opmode == IEEE80211_M_STA) 2373193240Ssam mwl_hal_delstation(mn->mn_hvap, vap->iv_myaddr); 2374193240Ssam else 2375193240Ssam mwl_hal_delstation(mn->mn_hvap, ni->ni_macaddr); 2376193240Ssam } 2377193240Ssam /* 2378193240Ssam * NB: legacy WDS peer sta db entry is installed using 2379193240Ssam * the associate ap's hvap; use it again to delete it. 2380193240Ssam * XXX can vap be NULL? 2381193240Ssam */ 2382193240Ssam else if (vap->iv_opmode == IEEE80211_M_WDS && 2383193240Ssam MWL_VAP(vap)->mv_ap_hvap != NULL) 2384193240Ssam mwl_hal_delstation(MWL_VAP(vap)->mv_ap_hvap, 2385193240Ssam ni->ni_macaddr); 2386193240Ssam delstaid(sc, mn->mn_staid); 2387193240Ssam mn->mn_staid = 0; 2388193240Ssam } 2389193240Ssam sc->sc_node_cleanup(ni); 2390193240Ssam} 2391193240Ssam 2392193240Ssam/* 2393193240Ssam * Reclaim rx dma buffers from packets sitting on the ampdu 2394193240Ssam * reorder queue for a station. We replace buffers with a 2395193240Ssam * system cluster (if available). 2396193240Ssam */ 2397193240Ssamstatic void 2398193240Ssammwl_ampdu_rxdma_reclaim(struct ieee80211_rx_ampdu *rap) 2399193240Ssam{ 2400193240Ssam#if 0 2401193240Ssam int i, n, off; 2402193240Ssam struct mbuf *m; 2403193240Ssam void *cl; 2404193240Ssam 2405193240Ssam n = rap->rxa_qframes; 2406193240Ssam for (i = 0; i < rap->rxa_wnd && n > 0; i++) { 2407193240Ssam m = rap->rxa_m[i]; 2408193240Ssam if (m == NULL) 2409193240Ssam continue; 2410193240Ssam n--; 2411193240Ssam /* our dma buffers have a well-known free routine */ 2412193240Ssam if ((m->m_flags & M_EXT) == 0 || 2413193240Ssam m->m_ext.ext_free != mwl_ext_free) 2414193240Ssam continue; 2415193240Ssam /* 2416193240Ssam * Try to allocate a cluster and move the data. 2417193240Ssam */ 2418193240Ssam off = m->m_data - m->m_ext.ext_buf; 2419193240Ssam if (off + m->m_pkthdr.len > MCLBYTES) { 2420193240Ssam /* XXX no AMSDU for now */ 2421193240Ssam continue; 2422193240Ssam } 2423193240Ssam cl = pool_cache_get_paddr(&mclpool_cache, 0, 2424193240Ssam &m->m_ext.ext_paddr); 2425193240Ssam if (cl != NULL) { 2426193240Ssam /* 2427193240Ssam * Copy the existing data to the cluster, remove 2428193240Ssam * the rx dma buffer, and attach the cluster in 2429193240Ssam * its place. Note we preserve the offset to the 2430193240Ssam * data so frames being bridged can still prepend 2431193240Ssam * their headers without adding another mbuf. 2432193240Ssam */ 2433193240Ssam memcpy((caddr_t) cl + off, m->m_data, m->m_pkthdr.len); 2434193240Ssam MEXTREMOVE(m); 2435193240Ssam MEXTADD(m, cl, MCLBYTES, 0, NULL, &mclpool_cache); 2436193240Ssam /* setup mbuf like _MCLGET does */ 2437193240Ssam m->m_flags |= M_CLUSTER | M_EXT_RW; 2438193240Ssam _MOWNERREF(m, M_EXT | M_CLUSTER); 2439193240Ssam /* NB: m_data is clobbered by MEXTADDR, adjust */ 2440193240Ssam m->m_data += off; 2441193240Ssam } 2442193240Ssam } 2443193240Ssam#endif 2444193240Ssam} 2445193240Ssam 2446193240Ssam/* 2447193240Ssam * Callback to reclaim resources. We first let the 2448193240Ssam * net80211 layer do it's thing, then if we are still 2449193240Ssam * blocked by a lack of rx dma buffers we walk the ampdu 2450193240Ssam * reorder q's to reclaim buffers by copying to a system 2451193240Ssam * cluster. 2452193240Ssam */ 2453193240Ssamstatic void 2454193240Ssammwl_node_drain(struct ieee80211_node *ni) 2455193240Ssam{ 2456193240Ssam struct ieee80211com *ic = ni->ni_ic; 2457193240Ssam struct mwl_softc *sc = ic->ic_ifp->if_softc; 2458193240Ssam struct mwl_node *mn = MWL_NODE(ni); 2459193240Ssam 2460193240Ssam DPRINTF(sc, MWL_DEBUG_NODE, "%s: ni %p vap %p staid %d\n", 2461193240Ssam __func__, ni, ni->ni_vap, mn->mn_staid); 2462193240Ssam 2463193240Ssam /* NB: call up first to age out ampdu q's */ 2464193240Ssam sc->sc_node_drain(ni); 2465193240Ssam 2466193240Ssam /* XXX better to not check low water mark? */ 2467193240Ssam if (sc->sc_rxblocked && mn->mn_staid != 0 && 2468193240Ssam (ni->ni_flags & IEEE80211_NODE_HT)) { 2469193240Ssam uint8_t tid; 2470193240Ssam /* 2471193240Ssam * Walk the reorder q and reclaim rx dma buffers by copying 2472193240Ssam * the packet contents into clusters. 2473193240Ssam */ 2474193240Ssam for (tid = 0; tid < WME_NUM_TID; tid++) { 2475193240Ssam struct ieee80211_rx_ampdu *rap; 2476193240Ssam 2477193240Ssam rap = &ni->ni_rx_ampdu[tid]; 2478193240Ssam if ((rap->rxa_flags & IEEE80211_AGGR_XCHGPEND) == 0) 2479193240Ssam continue; 2480193240Ssam if (rap->rxa_qframes) 2481193240Ssam mwl_ampdu_rxdma_reclaim(rap); 2482193240Ssam } 2483193240Ssam } 2484193240Ssam} 2485193240Ssam 2486193240Ssamstatic void 2487193240Ssammwl_node_getsignal(const struct ieee80211_node *ni, int8_t *rssi, int8_t *noise) 2488193240Ssam{ 2489193240Ssam *rssi = ni->ni_ic->ic_node_getrssi(ni); 2490193240Ssam#ifdef MWL_ANT_INFO_SUPPORT 2491193240Ssam#if 0 2492193240Ssam /* XXX need to smooth data */ 2493193240Ssam *noise = -MWL_NODE_CONST(ni)->mn_ai.nf; 2494193240Ssam#else 2495193240Ssam *noise = -95; /* XXX */ 2496193240Ssam#endif 2497193240Ssam#else 2498193240Ssam *noise = -95; /* XXX */ 2499193240Ssam#endif 2500193240Ssam} 2501193240Ssam 2502193240Ssam/* 2503193240Ssam * Convert Hardware per-antenna rssi info to common format: 2504193240Ssam * Let a1, a2, a3 represent the amplitudes per chain 2505193240Ssam * Let amax represent max[a1, a2, a3] 2506193240Ssam * Rssi1_dBm = RSSI_dBm + 20*log10(a1/amax) 2507193240Ssam * Rssi1_dBm = RSSI_dBm + 20*log10(a1) - 20*log10(amax) 2508193240Ssam * We store a table that is 4*20*log10(idx) - the extra 4 is to store or 2509193240Ssam * maintain some extra precision. 2510193240Ssam * 2511193240Ssam * Values are stored in .5 db format capped at 127. 2512193240Ssam */ 2513193240Ssamstatic void 2514193240Ssammwl_node_getmimoinfo(const struct ieee80211_node *ni, 2515193240Ssam struct ieee80211_mimo_info *mi) 2516193240Ssam{ 2517193240Ssam#define CVT(_dst, _src) do { \ 2518193240Ssam (_dst) = rssi + ((logdbtbl[_src] - logdbtbl[rssi_max]) >> 2); \ 2519193240Ssam (_dst) = (_dst) > 64 ? 127 : ((_dst) << 1); \ 2520193240Ssam} while (0) 2521193240Ssam static const int8_t logdbtbl[32] = { 2522193240Ssam 0, 0, 24, 38, 48, 56, 62, 68, 2523193240Ssam 72, 76, 80, 83, 86, 89, 92, 94, 2524193240Ssam 96, 98, 100, 102, 104, 106, 107, 109, 2525193240Ssam 110, 112, 113, 115, 116, 117, 118, 119 2526193240Ssam }; 2527193240Ssam const struct mwl_node *mn = MWL_NODE_CONST(ni); 2528193240Ssam uint8_t rssi = mn->mn_ai.rsvd1/2; /* XXX */ 2529193240Ssam uint32_t rssi_max; 2530193240Ssam 2531193240Ssam rssi_max = mn->mn_ai.rssi_a; 2532193240Ssam if (mn->mn_ai.rssi_b > rssi_max) 2533193240Ssam rssi_max = mn->mn_ai.rssi_b; 2534193240Ssam if (mn->mn_ai.rssi_c > rssi_max) 2535193240Ssam rssi_max = mn->mn_ai.rssi_c; 2536193240Ssam 2537220935Sadrian CVT(mi->rssi[0], mn->mn_ai.rssi_a); 2538220935Sadrian CVT(mi->rssi[1], mn->mn_ai.rssi_b); 2539220935Sadrian CVT(mi->rssi[2], mn->mn_ai.rssi_c); 2540193240Ssam 2541220935Sadrian mi->noise[0] = mn->mn_ai.nf_a; 2542220935Sadrian mi->noise[1] = mn->mn_ai.nf_b; 2543220935Sadrian mi->noise[2] = mn->mn_ai.nf_c; 2544193240Ssam#undef CVT 2545193240Ssam} 2546193240Ssam 2547193240Ssamstatic __inline void * 2548193240Ssammwl_getrxdma(struct mwl_softc *sc) 2549193240Ssam{ 2550193240Ssam struct mwl_jumbo *buf; 2551193240Ssam void *data; 2552193240Ssam 2553193240Ssam /* 2554193240Ssam * Allocate from jumbo pool. 2555193240Ssam */ 2556193240Ssam MWL_RXFREE_LOCK(sc); 2557193240Ssam buf = SLIST_FIRST(&sc->sc_rxfree); 2558193240Ssam if (buf == NULL) { 2559193240Ssam DPRINTF(sc, MWL_DEBUG_ANY, 2560193240Ssam "%s: out of rx dma buffers\n", __func__); 2561193240Ssam sc->sc_stats.mst_rx_nodmabuf++; 2562193240Ssam data = NULL; 2563193240Ssam } else { 2564193240Ssam SLIST_REMOVE_HEAD(&sc->sc_rxfree, next); 2565193240Ssam sc->sc_nrxfree--; 2566193240Ssam data = MWL_JUMBO_BUF2DATA(buf); 2567193240Ssam } 2568193240Ssam MWL_RXFREE_UNLOCK(sc); 2569193240Ssam return data; 2570193240Ssam} 2571193240Ssam 2572193240Ssamstatic __inline void 2573193240Ssammwl_putrxdma(struct mwl_softc *sc, void *data) 2574193240Ssam{ 2575193240Ssam struct mwl_jumbo *buf; 2576193240Ssam 2577193240Ssam /* XXX bounds check data */ 2578193240Ssam MWL_RXFREE_LOCK(sc); 2579193240Ssam buf = MWL_JUMBO_DATA2BUF(data); 2580193240Ssam SLIST_INSERT_HEAD(&sc->sc_rxfree, buf, next); 2581193240Ssam sc->sc_nrxfree++; 2582193240Ssam MWL_RXFREE_UNLOCK(sc); 2583193240Ssam} 2584193240Ssam 2585193240Ssamstatic int 2586193240Ssammwl_rxbuf_init(struct mwl_softc *sc, struct mwl_rxbuf *bf) 2587193240Ssam{ 2588193240Ssam struct mwl_rxdesc *ds; 2589193240Ssam 2590193240Ssam ds = bf->bf_desc; 2591193240Ssam if (bf->bf_data == NULL) { 2592193240Ssam bf->bf_data = mwl_getrxdma(sc); 2593193240Ssam if (bf->bf_data == NULL) { 2594193240Ssam /* mark descriptor to be skipped */ 2595193240Ssam ds->RxControl = EAGLE_RXD_CTRL_OS_OWN; 2596193240Ssam /* NB: don't need PREREAD */ 2597193240Ssam MWL_RXDESC_SYNC(sc, ds, BUS_DMASYNC_PREWRITE); 2598193240Ssam sc->sc_stats.mst_rxbuf_failed++; 2599193240Ssam return ENOMEM; 2600193240Ssam } 2601193240Ssam } 2602193240Ssam /* 2603193240Ssam * NB: DMA buffer contents is known to be unmodified 2604193240Ssam * so there's no need to flush the data cache. 2605193240Ssam */ 2606193240Ssam 2607193240Ssam /* 2608193240Ssam * Setup descriptor. 2609193240Ssam */ 2610193240Ssam ds->QosCtrl = 0; 2611193240Ssam ds->RSSI = 0; 2612193240Ssam ds->Status = EAGLE_RXD_STATUS_IDLE; 2613193240Ssam ds->Channel = 0; 2614193240Ssam ds->PktLen = htole16(MWL_AGGR_SIZE); 2615193240Ssam ds->SQ2 = 0; 2616193240Ssam ds->pPhysBuffData = htole32(MWL_JUMBO_DMA_ADDR(sc, bf->bf_data)); 2617193240Ssam /* NB: don't touch pPhysNext, set once */ 2618193240Ssam ds->RxControl = EAGLE_RXD_CTRL_DRIVER_OWN; 2619193240Ssam MWL_RXDESC_SYNC(sc, ds, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 2620193240Ssam 2621193240Ssam return 0; 2622193240Ssam} 2623193240Ssam 2624193240Ssamstatic void 2625193240Ssammwl_ext_free(void *data, void *arg) 2626193240Ssam{ 2627193240Ssam struct mwl_softc *sc = arg; 2628193240Ssam 2629193240Ssam /* XXX bounds check data */ 2630193240Ssam mwl_putrxdma(sc, data); 2631193240Ssam /* 2632193240Ssam * If we were previously blocked by a lack of rx dma buffers 2633193240Ssam * check if we now have enough to restart rx interrupt handling. 2634193240Ssam * NB: we know we are called at splvm which is above splnet. 2635193240Ssam */ 2636193240Ssam if (sc->sc_rxblocked && sc->sc_nrxfree > mwl_rxdmalow) { 2637193240Ssam sc->sc_rxblocked = 0; 2638193240Ssam mwl_hal_intrset(sc->sc_mh, sc->sc_imask); 2639193240Ssam } 2640193240Ssam} 2641193240Ssam 2642193240Ssamstruct mwl_frame_bar { 2643193240Ssam u_int8_t i_fc[2]; 2644193240Ssam u_int8_t i_dur[2]; 2645193240Ssam u_int8_t i_ra[IEEE80211_ADDR_LEN]; 2646193240Ssam u_int8_t i_ta[IEEE80211_ADDR_LEN]; 2647193240Ssam /* ctl, seq, FCS */ 2648193240Ssam} __packed; 2649193240Ssam 2650193240Ssam/* 2651193240Ssam * Like ieee80211_anyhdrsize, but handles BAR frames 2652193240Ssam * specially so the logic below to piece the 802.11 2653193240Ssam * header together works. 2654193240Ssam */ 2655193240Ssamstatic __inline int 2656193240Ssammwl_anyhdrsize(const void *data) 2657193240Ssam{ 2658193240Ssam const struct ieee80211_frame *wh = data; 2659193240Ssam 2660193240Ssam if ((wh->i_fc[0]&IEEE80211_FC0_TYPE_MASK) == IEEE80211_FC0_TYPE_CTL) { 2661193240Ssam switch (wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) { 2662193240Ssam case IEEE80211_FC0_SUBTYPE_CTS: 2663193240Ssam case IEEE80211_FC0_SUBTYPE_ACK: 2664193240Ssam return sizeof(struct ieee80211_frame_ack); 2665193240Ssam case IEEE80211_FC0_SUBTYPE_BAR: 2666193240Ssam return sizeof(struct mwl_frame_bar); 2667193240Ssam } 2668193240Ssam return sizeof(struct ieee80211_frame_min); 2669193240Ssam } else 2670193240Ssam return ieee80211_hdrsize(data); 2671193240Ssam} 2672193240Ssam 2673193240Ssamstatic void 2674193240Ssammwl_handlemicerror(struct ieee80211com *ic, const uint8_t *data) 2675193240Ssam{ 2676193240Ssam const struct ieee80211_frame *wh; 2677193240Ssam struct ieee80211_node *ni; 2678193240Ssam 2679193240Ssam wh = (const struct ieee80211_frame *)(data + sizeof(uint16_t)); 2680193240Ssam ni = ieee80211_find_rxnode(ic, (const struct ieee80211_frame_min *) wh); 2681193240Ssam if (ni != NULL) { 2682193240Ssam ieee80211_notify_michael_failure(ni->ni_vap, wh, 0); 2683193240Ssam ieee80211_free_node(ni); 2684193240Ssam } 2685193240Ssam} 2686193240Ssam 2687193240Ssam/* 2688193240Ssam * Convert hardware signal strength to rssi. The value 2689193240Ssam * provided by the device has the noise floor added in; 2690193240Ssam * we need to compensate for this but we don't have that 2691193240Ssam * so we use a fixed value. 2692193240Ssam * 2693193240Ssam * The offset of 8 is good for both 2.4 and 5GHz. The LNA 2694193240Ssam * offset is already set as part of the initial gain. This 2695193240Ssam * will give at least +/- 3dB for 2.4GHz and +/- 5dB for 5GHz. 2696193240Ssam */ 2697193240Ssamstatic __inline int 2698193240Ssamcvtrssi(uint8_t ssi) 2699193240Ssam{ 2700193240Ssam int rssi = (int) ssi + 8; 2701193240Ssam /* XXX hack guess until we have a real noise floor */ 2702193240Ssam rssi = 2*(87 - rssi); /* NB: .5 dBm units */ 2703193240Ssam return (rssi < 0 ? 0 : rssi > 127 ? 127 : rssi); 2704193240Ssam} 2705193240Ssam 2706193240Ssamstatic void 2707193240Ssammwl_rx_proc(void *arg, int npending) 2708193240Ssam{ 2709193240Ssam#define IEEE80211_DIR_DSTODS(wh) \ 2710193240Ssam ((((const struct ieee80211_frame *)wh)->i_fc[1] & IEEE80211_FC1_DIR_MASK) == IEEE80211_FC1_DIR_DSTODS) 2711193240Ssam struct mwl_softc *sc = arg; 2712193240Ssam struct ifnet *ifp = sc->sc_ifp; 2713193240Ssam struct ieee80211com *ic = ifp->if_l2com; 2714193240Ssam struct mwl_rxbuf *bf; 2715193240Ssam struct mwl_rxdesc *ds; 2716193240Ssam struct mbuf *m; 2717193240Ssam struct ieee80211_qosframe *wh; 2718193240Ssam struct ieee80211_qosframe_addr4 *wh4; 2719193240Ssam struct ieee80211_node *ni; 2720193240Ssam struct mwl_node *mn; 2721193240Ssam int off, len, hdrlen, pktlen, rssi, ntodo; 2722193240Ssam uint8_t *data, status; 2723193240Ssam void *newdata; 2724193240Ssam int16_t nf; 2725193240Ssam 2726193240Ssam DPRINTF(sc, MWL_DEBUG_RX_PROC, "%s: pending %u rdptr 0x%x wrptr 0x%x\n", 2727193240Ssam __func__, npending, RD4(sc, sc->sc_hwspecs.rxDescRead), 2728193240Ssam RD4(sc, sc->sc_hwspecs.rxDescWrite)); 2729193240Ssam nf = -96; /* XXX */ 2730193240Ssam bf = sc->sc_rxnext; 2731193240Ssam for (ntodo = mwl_rxquota; ntodo > 0; ntodo--) { 2732193240Ssam if (bf == NULL) 2733193240Ssam bf = STAILQ_FIRST(&sc->sc_rxbuf); 2734193240Ssam ds = bf->bf_desc; 2735193240Ssam data = bf->bf_data; 2736193240Ssam if (data == NULL) { 2737193240Ssam /* 2738193240Ssam * If data allocation failed previously there 2739193240Ssam * will be no buffer; try again to re-populate it. 2740193240Ssam * Note the firmware will not advance to the next 2741193240Ssam * descriptor with a dma buffer so we must mimic 2742193240Ssam * this or we'll get out of sync. 2743193240Ssam */ 2744193240Ssam DPRINTF(sc, MWL_DEBUG_ANY, 2745193240Ssam "%s: rx buf w/o dma memory\n", __func__); 2746193240Ssam (void) mwl_rxbuf_init(sc, bf); 2747193240Ssam sc->sc_stats.mst_rx_dmabufmissing++; 2748193240Ssam break; 2749193240Ssam } 2750193240Ssam MWL_RXDESC_SYNC(sc, ds, 2751193240Ssam BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE); 2752193240Ssam if (ds->RxControl != EAGLE_RXD_CTRL_DMA_OWN) 2753193240Ssam break; 2754193240Ssam#ifdef MWL_DEBUG 2755193240Ssam if (sc->sc_debug & MWL_DEBUG_RECV_DESC) 2756193240Ssam mwl_printrxbuf(bf, 0); 2757193240Ssam#endif 2758193240Ssam status = ds->Status; 2759193240Ssam if (status & EAGLE_RXD_STATUS_DECRYPT_ERR_MASK) { 2760193240Ssam ifp->if_ierrors++; 2761193240Ssam sc->sc_stats.mst_rx_crypto++; 2762193240Ssam /* 2763193240Ssam * NB: Check EAGLE_RXD_STATUS_GENERAL_DECRYPT_ERR 2764193240Ssam * for backwards compatibility. 2765193240Ssam */ 2766193240Ssam if (status != EAGLE_RXD_STATUS_GENERAL_DECRYPT_ERR && 2767193240Ssam (status & EAGLE_RXD_STATUS_TKIP_MIC_DECRYPT_ERR)) { 2768193240Ssam /* 2769193240Ssam * MIC error, notify upper layers. 2770193240Ssam */ 2771193240Ssam bus_dmamap_sync(sc->sc_rxdmat, sc->sc_rxmap, 2772193240Ssam BUS_DMASYNC_POSTREAD); 2773193240Ssam mwl_handlemicerror(ic, data); 2774193240Ssam sc->sc_stats.mst_rx_tkipmic++; 2775193240Ssam } 2776193240Ssam /* XXX too painful to tap packets */ 2777193240Ssam goto rx_next; 2778193240Ssam } 2779193240Ssam /* 2780193240Ssam * Sync the data buffer. 2781193240Ssam */ 2782193240Ssam len = le16toh(ds->PktLen); 2783193240Ssam bus_dmamap_sync(sc->sc_rxdmat, sc->sc_rxmap, BUS_DMASYNC_POSTREAD); 2784193240Ssam /* 2785193240Ssam * The 802.11 header is provided all or in part at the front; 2786193240Ssam * use it to calculate the true size of the header that we'll 2787193240Ssam * construct below. We use this to figure out where to copy 2788193240Ssam * payload prior to constructing the header. 2789193240Ssam */ 2790193240Ssam hdrlen = mwl_anyhdrsize(data + sizeof(uint16_t)); 2791193240Ssam off = sizeof(uint16_t) + sizeof(struct ieee80211_frame_addr4); 2792193240Ssam 2793193240Ssam /* calculate rssi early so we can re-use for each aggregate */ 2794193240Ssam rssi = cvtrssi(ds->RSSI); 2795193240Ssam 2796193240Ssam pktlen = hdrlen + (len - off); 2797193240Ssam /* 2798193240Ssam * NB: we know our frame is at least as large as 2799193240Ssam * IEEE80211_MIN_LEN because there is a 4-address 2800193240Ssam * frame at the front. Hence there's no need to 2801193240Ssam * vet the packet length. If the frame in fact 2802193240Ssam * is too small it should be discarded at the 2803193240Ssam * net80211 layer. 2804193240Ssam */ 2805193240Ssam 2806193240Ssam /* 2807193240Ssam * Attach dma buffer to an mbuf. We tried 2808193240Ssam * doing this based on the packet size (i.e. 2809193240Ssam * copying small packets) but it turns out to 2810193240Ssam * be a net loss. The tradeoff might be system 2811193240Ssam * dependent (cache architecture is important). 2812193240Ssam */ 2813243857Sglebius MGETHDR(m, M_NOWAIT, MT_DATA); 2814193240Ssam if (m == NULL) { 2815193240Ssam DPRINTF(sc, MWL_DEBUG_ANY, 2816193240Ssam "%s: no rx mbuf\n", __func__); 2817193240Ssam sc->sc_stats.mst_rx_nombuf++; 2818193240Ssam goto rx_next; 2819193240Ssam } 2820193240Ssam /* 2821193240Ssam * Acquire the replacement dma buffer before 2822193240Ssam * processing the frame. If we're out of dma 2823193240Ssam * buffers we disable rx interrupts and wait 2824193240Ssam * for the free pool to reach mlw_rxdmalow buffers 2825193240Ssam * before starting to do work again. If the firmware 2826193240Ssam * runs out of descriptors then it will toss frames 2827193240Ssam * which is better than our doing it as that can 2828193240Ssam * starve our processing. It is also important that 2829193240Ssam * we always process rx'd frames in case they are 2830193240Ssam * A-MPDU as otherwise the host's view of the BA 2831193240Ssam * window may get out of sync with the firmware. 2832193240Ssam */ 2833193240Ssam newdata = mwl_getrxdma(sc); 2834193240Ssam if (newdata == NULL) { 2835193240Ssam /* NB: stat+msg in mwl_getrxdma */ 2836193240Ssam m_free(m); 2837193240Ssam /* disable RX interrupt and mark state */ 2838193240Ssam mwl_hal_intrset(sc->sc_mh, 2839193240Ssam sc->sc_imask &~ MACREG_A2HRIC_BIT_RX_RDY); 2840193240Ssam sc->sc_rxblocked = 1; 2841193240Ssam ieee80211_drain(ic); 2842193240Ssam /* XXX check rxblocked and immediately start again? */ 2843193240Ssam goto rx_stop; 2844193240Ssam } 2845193240Ssam bf->bf_data = newdata; 2846193240Ssam /* 2847193240Ssam * Attach the dma buffer to the mbuf; 2848193240Ssam * mwl_rxbuf_init will re-setup the rx 2849193240Ssam * descriptor using the replacement dma 2850193240Ssam * buffer we just installed above. 2851193240Ssam */ 2852193240Ssam MEXTADD(m, data, MWL_AGGR_SIZE, mwl_ext_free, 2853193240Ssam data, sc, 0, EXT_NET_DRV); 2854193240Ssam m->m_data += off - hdrlen; 2855193240Ssam m->m_pkthdr.len = m->m_len = pktlen; 2856193240Ssam m->m_pkthdr.rcvif = ifp; 2857193240Ssam /* NB: dma buffer assumed read-only */ 2858193240Ssam 2859193240Ssam /* 2860193240Ssam * Piece 802.11 header together. 2861193240Ssam */ 2862193240Ssam wh = mtod(m, struct ieee80211_qosframe *); 2863193240Ssam /* NB: don't need to do this sometimes but ... */ 2864193240Ssam /* XXX special case so we can memcpy after m_devget? */ 2865193240Ssam ovbcopy(data + sizeof(uint16_t), wh, hdrlen); 2866193240Ssam if (IEEE80211_QOS_HAS_SEQ(wh)) { 2867193240Ssam if (IEEE80211_DIR_DSTODS(wh)) { 2868193240Ssam wh4 = mtod(m, 2869193240Ssam struct ieee80211_qosframe_addr4*); 2870193240Ssam *(uint16_t *)wh4->i_qos = ds->QosCtrl; 2871193240Ssam } else { 2872193240Ssam *(uint16_t *)wh->i_qos = ds->QosCtrl; 2873193240Ssam } 2874193240Ssam } 2875193240Ssam /* 2876193240Ssam * The f/w strips WEP header but doesn't clear 2877193240Ssam * the WEP bit; mark the packet with M_WEP so 2878193240Ssam * net80211 will treat the data as decrypted. 2879193240Ssam * While here also clear the PWR_MGT bit since 2880193240Ssam * power save is handled by the firmware and 2881193240Ssam * passing this up will potentially cause the 2882193240Ssam * upper layer to put a station in power save 2883193240Ssam * (except when configured with MWL_HOST_PS_SUPPORT). 2884193240Ssam */ 2885193240Ssam if (wh->i_fc[1] & IEEE80211_FC1_WEP) 2886193240Ssam m->m_flags |= M_WEP; 2887193240Ssam#ifdef MWL_HOST_PS_SUPPORT 2888193240Ssam wh->i_fc[1] &= ~IEEE80211_FC1_WEP; 2889193240Ssam#else 2890193240Ssam wh->i_fc[1] &= ~(IEEE80211_FC1_WEP | IEEE80211_FC1_PWR_MGT); 2891193240Ssam#endif 2892193240Ssam 2893193240Ssam if (ieee80211_radiotap_active(ic)) { 2894193240Ssam struct mwl_rx_radiotap_header *tap = &sc->sc_rx_th; 2895193240Ssam 2896193240Ssam tap->wr_flags = 0; 2897193240Ssam tap->wr_rate = ds->Rate; 2898193240Ssam tap->wr_antsignal = rssi + nf; 2899193240Ssam tap->wr_antnoise = nf; 2900193240Ssam } 2901193240Ssam if (IFF_DUMPPKTS_RECV(sc, wh)) { 2902193240Ssam ieee80211_dump_pkt(ic, mtod(m, caddr_t), 2903193240Ssam len, ds->Rate, rssi); 2904193240Ssam } 2905193240Ssam ifp->if_ipackets++; 2906193240Ssam 2907193240Ssam /* dispatch */ 2908193240Ssam ni = ieee80211_find_rxnode(ic, 2909193240Ssam (const struct ieee80211_frame_min *) wh); 2910193240Ssam if (ni != NULL) { 2911193240Ssam mn = MWL_NODE(ni); 2912193240Ssam#ifdef MWL_ANT_INFO_SUPPORT 2913193240Ssam mn->mn_ai.rssi_a = ds->ai.rssi_a; 2914193240Ssam mn->mn_ai.rssi_b = ds->ai.rssi_b; 2915193240Ssam mn->mn_ai.rssi_c = ds->ai.rssi_c; 2916193240Ssam mn->mn_ai.rsvd1 = rssi; 2917193240Ssam#endif 2918193240Ssam /* tag AMPDU aggregates for reorder processing */ 2919193240Ssam if (ni->ni_flags & IEEE80211_NODE_HT) 2920193240Ssam m->m_flags |= M_AMPDU; 2921193240Ssam (void) ieee80211_input(ni, m, rssi, nf); 2922193240Ssam ieee80211_free_node(ni); 2923193240Ssam } else 2924193240Ssam (void) ieee80211_input_all(ic, m, rssi, nf); 2925193240Ssamrx_next: 2926193240Ssam /* NB: ignore ENOMEM so we process more descriptors */ 2927193240Ssam (void) mwl_rxbuf_init(sc, bf); 2928193240Ssam bf = STAILQ_NEXT(bf, bf_list); 2929193240Ssam } 2930193240Ssamrx_stop: 2931193240Ssam sc->sc_rxnext = bf; 2932193240Ssam 2933193240Ssam if ((ifp->if_drv_flags & IFF_DRV_OACTIVE) == 0 && 2934193240Ssam !IFQ_IS_EMPTY(&ifp->if_snd)) { 2935193240Ssam /* NB: kick fw; the tx thread may have been preempted */ 2936193240Ssam mwl_hal_txstart(sc->sc_mh, 0); 2937193240Ssam mwl_start(ifp); 2938193240Ssam } 2939193240Ssam#undef IEEE80211_DIR_DSTODS 2940193240Ssam} 2941193240Ssam 2942193240Ssamstatic void 2943193240Ssammwl_txq_init(struct mwl_softc *sc, struct mwl_txq *txq, int qnum) 2944193240Ssam{ 2945193240Ssam struct mwl_txbuf *bf, *bn; 2946193240Ssam struct mwl_txdesc *ds; 2947193240Ssam 2948193240Ssam MWL_TXQ_LOCK_INIT(sc, txq); 2949193240Ssam txq->qnum = qnum; 2950193240Ssam txq->txpri = 0; /* XXX */ 2951193240Ssam#if 0 2952193240Ssam /* NB: q setup by mwl_txdma_setup XXX */ 2953193240Ssam STAILQ_INIT(&txq->free); 2954193240Ssam#endif 2955193240Ssam STAILQ_FOREACH(bf, &txq->free, bf_list) { 2956193240Ssam bf->bf_txq = txq; 2957193240Ssam 2958193240Ssam ds = bf->bf_desc; 2959193240Ssam bn = STAILQ_NEXT(bf, bf_list); 2960193240Ssam if (bn == NULL) 2961193240Ssam bn = STAILQ_FIRST(&txq->free); 2962193240Ssam ds->pPhysNext = htole32(bn->bf_daddr); 2963193240Ssam } 2964193240Ssam STAILQ_INIT(&txq->active); 2965193240Ssam} 2966193240Ssam 2967193240Ssam/* 2968193240Ssam * Setup a hardware data transmit queue for the specified 2969193240Ssam * access control. We record the mapping from ac's 2970193240Ssam * to h/w queues for use by mwl_tx_start. 2971193240Ssam */ 2972193240Ssamstatic int 2973193240Ssammwl_tx_setup(struct mwl_softc *sc, int ac, int mvtype) 2974193240Ssam{ 2975193240Ssam#define N(a) (sizeof(a)/sizeof(a[0])) 2976193240Ssam struct mwl_txq *txq; 2977193240Ssam 2978193240Ssam if (ac >= N(sc->sc_ac2q)) { 2979193240Ssam device_printf(sc->sc_dev, "AC %u out of range, max %zu!\n", 2980193240Ssam ac, N(sc->sc_ac2q)); 2981193240Ssam return 0; 2982193240Ssam } 2983193240Ssam if (mvtype >= MWL_NUM_TX_QUEUES) { 2984193240Ssam device_printf(sc->sc_dev, "mvtype %u out of range, max %u!\n", 2985193240Ssam mvtype, MWL_NUM_TX_QUEUES); 2986193240Ssam return 0; 2987193240Ssam } 2988193240Ssam txq = &sc->sc_txq[mvtype]; 2989193240Ssam mwl_txq_init(sc, txq, mvtype); 2990193240Ssam sc->sc_ac2q[ac] = txq; 2991193240Ssam return 1; 2992193240Ssam#undef N 2993193240Ssam} 2994193240Ssam 2995193240Ssam/* 2996193240Ssam * Update WME parameters for a transmit queue. 2997193240Ssam */ 2998193240Ssamstatic int 2999193240Ssammwl_txq_update(struct mwl_softc *sc, int ac) 3000193240Ssam{ 3001193240Ssam#define MWL_EXPONENT_TO_VALUE(v) ((1<<v)-1) 3002193240Ssam struct ifnet *ifp = sc->sc_ifp; 3003193240Ssam struct ieee80211com *ic = ifp->if_l2com; 3004193240Ssam struct mwl_txq *txq = sc->sc_ac2q[ac]; 3005193240Ssam struct wmeParams *wmep = &ic->ic_wme.wme_chanParams.cap_wmeParams[ac]; 3006193240Ssam struct mwl_hal *mh = sc->sc_mh; 3007193240Ssam int aifs, cwmin, cwmax, txoplim; 3008193240Ssam 3009193240Ssam aifs = wmep->wmep_aifsn; 3010193240Ssam /* XXX in sta mode need to pass log values for cwmin/max */ 3011193240Ssam cwmin = MWL_EXPONENT_TO_VALUE(wmep->wmep_logcwmin); 3012193240Ssam cwmax = MWL_EXPONENT_TO_VALUE(wmep->wmep_logcwmax); 3013193240Ssam txoplim = wmep->wmep_txopLimit; /* NB: units of 32us */ 3014193240Ssam 3015193240Ssam if (mwl_hal_setedcaparams(mh, txq->qnum, cwmin, cwmax, aifs, txoplim)) { 3016193240Ssam device_printf(sc->sc_dev, "unable to update hardware queue " 3017193240Ssam "parameters for %s traffic!\n", 3018193240Ssam ieee80211_wme_acnames[ac]); 3019193240Ssam return 0; 3020193240Ssam } 3021193240Ssam return 1; 3022193240Ssam#undef MWL_EXPONENT_TO_VALUE 3023193240Ssam} 3024193240Ssam 3025193240Ssam/* 3026193240Ssam * Callback from the 802.11 layer to update WME parameters. 3027193240Ssam */ 3028193240Ssamstatic int 3029193240Ssammwl_wme_update(struct ieee80211com *ic) 3030193240Ssam{ 3031193240Ssam struct mwl_softc *sc = ic->ic_ifp->if_softc; 3032193240Ssam 3033193240Ssam return !mwl_txq_update(sc, WME_AC_BE) || 3034193240Ssam !mwl_txq_update(sc, WME_AC_BK) || 3035193240Ssam !mwl_txq_update(sc, WME_AC_VI) || 3036193240Ssam !mwl_txq_update(sc, WME_AC_VO) ? EIO : 0; 3037193240Ssam} 3038193240Ssam 3039193240Ssam/* 3040193240Ssam * Reclaim resources for a setup queue. 3041193240Ssam */ 3042193240Ssamstatic void 3043193240Ssammwl_tx_cleanupq(struct mwl_softc *sc, struct mwl_txq *txq) 3044193240Ssam{ 3045193240Ssam /* XXX hal work? */ 3046193240Ssam MWL_TXQ_LOCK_DESTROY(txq); 3047193240Ssam} 3048193240Ssam 3049193240Ssam/* 3050193240Ssam * Reclaim all tx queue resources. 3051193240Ssam */ 3052193240Ssamstatic void 3053193240Ssammwl_tx_cleanup(struct mwl_softc *sc) 3054193240Ssam{ 3055193240Ssam int i; 3056193240Ssam 3057193240Ssam for (i = 0; i < MWL_NUM_TX_QUEUES; i++) 3058193240Ssam mwl_tx_cleanupq(sc, &sc->sc_txq[i]); 3059193240Ssam} 3060193240Ssam 3061193240Ssamstatic int 3062193240Ssammwl_tx_dmasetup(struct mwl_softc *sc, struct mwl_txbuf *bf, struct mbuf *m0) 3063193240Ssam{ 3064193240Ssam struct mbuf *m; 3065193240Ssam int error; 3066193240Ssam 3067193240Ssam /* 3068193240Ssam * Load the DMA map so any coalescing is done. This 3069193240Ssam * also calculates the number of descriptors we need. 3070193240Ssam */ 3071193240Ssam error = bus_dmamap_load_mbuf_sg(sc->sc_dmat, bf->bf_dmamap, m0, 3072193240Ssam bf->bf_segs, &bf->bf_nseg, 3073193240Ssam BUS_DMA_NOWAIT); 3074193240Ssam if (error == EFBIG) { 3075193240Ssam /* XXX packet requires too many descriptors */ 3076193240Ssam bf->bf_nseg = MWL_TXDESC+1; 3077193240Ssam } else if (error != 0) { 3078193240Ssam sc->sc_stats.mst_tx_busdma++; 3079193240Ssam m_freem(m0); 3080193240Ssam return error; 3081193240Ssam } 3082193240Ssam /* 3083193240Ssam * Discard null packets and check for packets that 3084193240Ssam * require too many TX descriptors. We try to convert 3085193240Ssam * the latter to a cluster. 3086193240Ssam */ 3087193240Ssam if (error == EFBIG) { /* too many desc's, linearize */ 3088193240Ssam sc->sc_stats.mst_tx_linear++; 3089193240Ssam#if MWL_TXDESC > 1 3090243857Sglebius m = m_collapse(m0, M_NOWAIT, MWL_TXDESC); 3091193240Ssam#else 3092243857Sglebius m = m_defrag(m0, M_NOWAIT); 3093193240Ssam#endif 3094193240Ssam if (m == NULL) { 3095193240Ssam m_freem(m0); 3096193240Ssam sc->sc_stats.mst_tx_nombuf++; 3097193240Ssam return ENOMEM; 3098193240Ssam } 3099193240Ssam m0 = m; 3100193240Ssam error = bus_dmamap_load_mbuf_sg(sc->sc_dmat, bf->bf_dmamap, m0, 3101193240Ssam bf->bf_segs, &bf->bf_nseg, 3102193240Ssam BUS_DMA_NOWAIT); 3103193240Ssam if (error != 0) { 3104193240Ssam sc->sc_stats.mst_tx_busdma++; 3105193240Ssam m_freem(m0); 3106193240Ssam return error; 3107193240Ssam } 3108193240Ssam KASSERT(bf->bf_nseg <= MWL_TXDESC, 3109193240Ssam ("too many segments after defrag; nseg %u", bf->bf_nseg)); 3110193240Ssam } else if (bf->bf_nseg == 0) { /* null packet, discard */ 3111193240Ssam sc->sc_stats.mst_tx_nodata++; 3112193240Ssam m_freem(m0); 3113193240Ssam return EIO; 3114193240Ssam } 3115193240Ssam DPRINTF(sc, MWL_DEBUG_XMIT, "%s: m %p len %u\n", 3116193240Ssam __func__, m0, m0->m_pkthdr.len); 3117193240Ssam bus_dmamap_sync(sc->sc_dmat, bf->bf_dmamap, BUS_DMASYNC_PREWRITE); 3118193240Ssam bf->bf_m = m0; 3119193240Ssam 3120193240Ssam return 0; 3121193240Ssam} 3122193240Ssam 3123193240Ssamstatic __inline int 3124193240Ssammwl_cvtlegacyrate(int rate) 3125193240Ssam{ 3126193240Ssam switch (rate) { 3127193240Ssam case 2: return 0; 3128193240Ssam case 4: return 1; 3129193240Ssam case 11: return 2; 3130193240Ssam case 22: return 3; 3131193240Ssam case 44: return 4; 3132193240Ssam case 12: return 5; 3133193240Ssam case 18: return 6; 3134193240Ssam case 24: return 7; 3135193240Ssam case 36: return 8; 3136193240Ssam case 48: return 9; 3137193240Ssam case 72: return 10; 3138193240Ssam case 96: return 11; 3139193240Ssam case 108:return 12; 3140193240Ssam } 3141193240Ssam return 0; 3142193240Ssam} 3143193240Ssam 3144193240Ssam/* 3145193240Ssam * Calculate fixed tx rate information per client state; 3146193240Ssam * this value is suitable for writing to the Format field 3147193240Ssam * of a tx descriptor. 3148193240Ssam */ 3149193240Ssamstatic uint16_t 3150193240Ssammwl_calcformat(uint8_t rate, const struct ieee80211_node *ni) 3151193240Ssam{ 3152193240Ssam uint16_t fmt; 3153193240Ssam 3154193240Ssam fmt = SM(3, EAGLE_TXD_ANTENNA) 3155193240Ssam | (IEEE80211_IS_CHAN_HT40D(ni->ni_chan) ? 3156193240Ssam EAGLE_TXD_EXTCHAN_LO : EAGLE_TXD_EXTCHAN_HI); 3157195171Ssam if (rate & IEEE80211_RATE_MCS) { /* HT MCS */ 3158193240Ssam fmt |= EAGLE_TXD_FORMAT_HT 3159193240Ssam /* NB: 0x80 implicitly stripped from ucastrate */ 3160193240Ssam | SM(rate, EAGLE_TXD_RATE); 3161193240Ssam /* XXX short/long GI may be wrong; re-check */ 3162193240Ssam if (IEEE80211_IS_CHAN_HT40(ni->ni_chan)) { 3163193240Ssam fmt |= EAGLE_TXD_CHW_40 3164193240Ssam | (ni->ni_htcap & IEEE80211_HTCAP_SHORTGI40 ? 3165193240Ssam EAGLE_TXD_GI_SHORT : EAGLE_TXD_GI_LONG); 3166193240Ssam } else { 3167193240Ssam fmt |= EAGLE_TXD_CHW_20 3168193240Ssam | (ni->ni_htcap & IEEE80211_HTCAP_SHORTGI20 ? 3169193240Ssam EAGLE_TXD_GI_SHORT : EAGLE_TXD_GI_LONG); 3170193240Ssam } 3171193240Ssam } else { /* legacy rate */ 3172193240Ssam fmt |= EAGLE_TXD_FORMAT_LEGACY 3173193240Ssam | SM(mwl_cvtlegacyrate(rate), EAGLE_TXD_RATE) 3174193240Ssam | EAGLE_TXD_CHW_20 3175193240Ssam /* XXX iv_flags & IEEE80211_F_SHPREAMBLE? */ 3176193240Ssam | (ni->ni_capinfo & IEEE80211_CAPINFO_SHORT_PREAMBLE ? 3177193240Ssam EAGLE_TXD_PREAMBLE_SHORT : EAGLE_TXD_PREAMBLE_LONG); 3178193240Ssam } 3179193240Ssam return fmt; 3180193240Ssam} 3181193240Ssam 3182193240Ssamstatic int 3183193240Ssammwl_tx_start(struct mwl_softc *sc, struct ieee80211_node *ni, struct mwl_txbuf *bf, 3184193240Ssam struct mbuf *m0) 3185193240Ssam{ 3186193240Ssam#define IEEE80211_DIR_DSTODS(wh) \ 3187193240Ssam ((wh->i_fc[1] & IEEE80211_FC1_DIR_MASK) == IEEE80211_FC1_DIR_DSTODS) 3188193240Ssam struct ifnet *ifp = sc->sc_ifp; 3189193240Ssam struct ieee80211com *ic = ifp->if_l2com; 3190193240Ssam struct ieee80211vap *vap = ni->ni_vap; 3191193240Ssam int error, iswep, ismcast; 3192193240Ssam int hdrlen, copyhdrlen, pktlen; 3193193240Ssam struct mwl_txdesc *ds; 3194193240Ssam struct mwl_txq *txq; 3195193240Ssam struct ieee80211_frame *wh; 3196193240Ssam struct mwltxrec *tr; 3197193240Ssam struct mwl_node *mn; 3198193240Ssam uint16_t qos; 3199193240Ssam#if MWL_TXDESC > 1 3200193240Ssam int i; 3201193240Ssam#endif 3202193240Ssam 3203193240Ssam wh = mtod(m0, struct ieee80211_frame *); 3204193240Ssam iswep = wh->i_fc[1] & IEEE80211_FC1_WEP; 3205193240Ssam ismcast = IEEE80211_IS_MULTICAST(wh->i_addr1); 3206193240Ssam hdrlen = ieee80211_anyhdrsize(wh); 3207193240Ssam copyhdrlen = hdrlen; 3208193240Ssam pktlen = m0->m_pkthdr.len; 3209193240Ssam if (IEEE80211_QOS_HAS_SEQ(wh)) { 3210193240Ssam if (IEEE80211_DIR_DSTODS(wh)) { 3211193240Ssam qos = *(uint16_t *) 3212193240Ssam (((struct ieee80211_qosframe_addr4 *) wh)->i_qos); 3213193240Ssam copyhdrlen -= sizeof(qos); 3214193240Ssam } else 3215193240Ssam qos = *(uint16_t *) 3216193240Ssam (((struct ieee80211_qosframe *) wh)->i_qos); 3217193240Ssam } else 3218193240Ssam qos = 0; 3219193240Ssam 3220193240Ssam if (iswep) { 3221193240Ssam const struct ieee80211_cipher *cip; 3222193240Ssam struct ieee80211_key *k; 3223193240Ssam 3224193240Ssam /* 3225193240Ssam * Construct the 802.11 header+trailer for an encrypted 3226193240Ssam * frame. The only reason this can fail is because of an 3227193240Ssam * unknown or unsupported cipher/key type. 3228193240Ssam * 3229193240Ssam * NB: we do this even though the firmware will ignore 3230193240Ssam * what we've done for WEP and TKIP as we need the 3231193240Ssam * ExtIV filled in for CCMP and this also adjusts 3232193240Ssam * the headers which simplifies our work below. 3233193240Ssam */ 3234193240Ssam k = ieee80211_crypto_encap(ni, m0); 3235193240Ssam if (k == NULL) { 3236193240Ssam /* 3237193240Ssam * This can happen when the key is yanked after the 3238193240Ssam * frame was queued. Just discard the frame; the 3239193240Ssam * 802.11 layer counts failures and provides 3240193240Ssam * debugging/diagnostics. 3241193240Ssam */ 3242193240Ssam m_freem(m0); 3243193240Ssam return EIO; 3244193240Ssam } 3245193240Ssam /* 3246193240Ssam * Adjust the packet length for the crypto additions 3247193240Ssam * done during encap and any other bits that the f/w 3248193240Ssam * will add later on. 3249193240Ssam */ 3250193240Ssam cip = k->wk_cipher; 3251193240Ssam pktlen += cip->ic_header + cip->ic_miclen + cip->ic_trailer; 3252193240Ssam 3253193240Ssam /* packet header may have moved, reset our local pointer */ 3254193240Ssam wh = mtod(m0, struct ieee80211_frame *); 3255193240Ssam } 3256193240Ssam 3257193240Ssam if (ieee80211_radiotap_active_vap(vap)) { 3258193240Ssam sc->sc_tx_th.wt_flags = 0; /* XXX */ 3259193240Ssam if (iswep) 3260193240Ssam sc->sc_tx_th.wt_flags |= IEEE80211_RADIOTAP_F_WEP; 3261193240Ssam#if 0 3262193240Ssam sc->sc_tx_th.wt_rate = ds->DataRate; 3263193240Ssam#endif 3264193240Ssam sc->sc_tx_th.wt_txpower = ni->ni_txpower; 3265193240Ssam sc->sc_tx_th.wt_antenna = sc->sc_txantenna; 3266193240Ssam 3267193240Ssam ieee80211_radiotap_tx(vap, m0); 3268193240Ssam } 3269193240Ssam /* 3270193240Ssam * Copy up/down the 802.11 header; the firmware requires 3271193240Ssam * we present a 2-byte payload length followed by a 3272193240Ssam * 4-address header (w/o QoS), followed (optionally) by 3273193240Ssam * any WEP/ExtIV header (but only filled in for CCMP). 3274193240Ssam * We are assured the mbuf has sufficient headroom to 3275193240Ssam * prepend in-place by the setup of ic_headroom in 3276193240Ssam * mwl_attach. 3277193240Ssam */ 3278193240Ssam if (hdrlen < sizeof(struct mwltxrec)) { 3279193240Ssam const int space = sizeof(struct mwltxrec) - hdrlen; 3280193240Ssam if (M_LEADINGSPACE(m0) < space) { 3281193240Ssam /* NB: should never happen */ 3282193240Ssam device_printf(sc->sc_dev, 3283193240Ssam "not enough headroom, need %d found %zd, " 3284193240Ssam "m_flags 0x%x m_len %d\n", 3285193240Ssam space, M_LEADINGSPACE(m0), m0->m_flags, m0->m_len); 3286193240Ssam ieee80211_dump_pkt(ic, 3287193240Ssam mtod(m0, const uint8_t *), m0->m_len, 0, -1); 3288193240Ssam m_freem(m0); 3289193240Ssam sc->sc_stats.mst_tx_noheadroom++; 3290193240Ssam return EIO; 3291193240Ssam } 3292193240Ssam M_PREPEND(m0, space, M_NOWAIT); 3293193240Ssam } 3294193240Ssam tr = mtod(m0, struct mwltxrec *); 3295193240Ssam if (wh != (struct ieee80211_frame *) &tr->wh) 3296193240Ssam ovbcopy(wh, &tr->wh, hdrlen); 3297193240Ssam /* 3298193240Ssam * Note: the "firmware length" is actually the length 3299193240Ssam * of the fully formed "802.11 payload". That is, it's 3300193240Ssam * everything except for the 802.11 header. In particular 3301193240Ssam * this includes all crypto material including the MIC! 3302193240Ssam */ 3303193240Ssam tr->fwlen = htole16(pktlen - hdrlen); 3304193240Ssam 3305193240Ssam /* 3306193240Ssam * Load the DMA map so any coalescing is done. This 3307193240Ssam * also calculates the number of descriptors we need. 3308193240Ssam */ 3309193240Ssam error = mwl_tx_dmasetup(sc, bf, m0); 3310193240Ssam if (error != 0) { 3311193240Ssam /* NB: stat collected in mwl_tx_dmasetup */ 3312193240Ssam DPRINTF(sc, MWL_DEBUG_XMIT, 3313193240Ssam "%s: unable to setup dma\n", __func__); 3314193240Ssam return error; 3315193240Ssam } 3316193240Ssam bf->bf_node = ni; /* NB: held reference */ 3317193240Ssam m0 = bf->bf_m; /* NB: may have changed */ 3318193240Ssam tr = mtod(m0, struct mwltxrec *); 3319193240Ssam wh = (struct ieee80211_frame *)&tr->wh; 3320193240Ssam 3321193240Ssam /* 3322193240Ssam * Formulate tx descriptor. 3323193240Ssam */ 3324193240Ssam ds = bf->bf_desc; 3325193240Ssam txq = bf->bf_txq; 3326193240Ssam 3327193240Ssam ds->QosCtrl = qos; /* NB: already little-endian */ 3328193240Ssam#if MWL_TXDESC == 1 3329193240Ssam /* 3330193240Ssam * NB: multiframes should be zero because the descriptors 3331193240Ssam * are initialized to zero. This should handle the case 3332193240Ssam * where the driver is built with MWL_TXDESC=1 but we are 3333193240Ssam * using firmware with multi-segment support. 3334193240Ssam */ 3335193240Ssam ds->PktPtr = htole32(bf->bf_segs[0].ds_addr); 3336193240Ssam ds->PktLen = htole16(bf->bf_segs[0].ds_len); 3337193240Ssam#else 3338193240Ssam ds->multiframes = htole32(bf->bf_nseg); 3339193240Ssam ds->PktLen = htole16(m0->m_pkthdr.len); 3340193240Ssam for (i = 0; i < bf->bf_nseg; i++) { 3341193240Ssam ds->PktPtrArray[i] = htole32(bf->bf_segs[i].ds_addr); 3342193240Ssam ds->PktLenArray[i] = htole16(bf->bf_segs[i].ds_len); 3343193240Ssam } 3344193240Ssam#endif 3345193240Ssam /* NB: pPhysNext, DataRate, and SapPktInfo setup once, don't touch */ 3346193240Ssam ds->Format = 0; 3347193240Ssam ds->pad = 0; 3348195171Ssam ds->ack_wcb_addr = 0; 3349193240Ssam 3350193240Ssam mn = MWL_NODE(ni); 3351193240Ssam /* 3352193240Ssam * Select transmit rate. 3353193240Ssam */ 3354193240Ssam switch (wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) { 3355193240Ssam case IEEE80211_FC0_TYPE_MGT: 3356193240Ssam sc->sc_stats.mst_tx_mgmt++; 3357193240Ssam /* fall thru... */ 3358193240Ssam case IEEE80211_FC0_TYPE_CTL: 3359193240Ssam /* NB: assign to BE q to avoid bursting */ 3360193240Ssam ds->TxPriority = MWL_WME_AC_BE; 3361193240Ssam break; 3362193240Ssam case IEEE80211_FC0_TYPE_DATA: 3363193240Ssam if (!ismcast) { 3364193240Ssam const struct ieee80211_txparam *tp = ni->ni_txparms; 3365193240Ssam /* 3366193240Ssam * EAPOL frames get forced to a fixed rate and w/o 3367193240Ssam * aggregation; otherwise check for any fixed rate 3368193240Ssam * for the client (may depend on association state). 3369193240Ssam */ 3370193240Ssam if (m0->m_flags & M_EAPOL) { 3371193240Ssam const struct mwl_vap *mvp = MWL_VAP_CONST(vap); 3372193240Ssam ds->Format = mvp->mv_eapolformat; 3373193240Ssam ds->pad = htole16( 3374193240Ssam EAGLE_TXD_FIXED_RATE | EAGLE_TXD_DONT_AGGR); 3375195171Ssam } else if (tp->ucastrate != IEEE80211_FIXED_RATE_NONE) { 3376193240Ssam /* XXX pre-calculate per node */ 3377193240Ssam ds->Format = htole16( 3378193240Ssam mwl_calcformat(tp->ucastrate, ni)); 3379193240Ssam ds->pad = htole16(EAGLE_TXD_FIXED_RATE); 3380193240Ssam } 3381193240Ssam /* NB: EAPOL frames will never have qos set */ 3382193240Ssam if (qos == 0) 3383193240Ssam ds->TxPriority = txq->qnum; 3384193240Ssam#if MWL_MAXBA > 3 3385193240Ssam else if (mwl_bastream_match(&mn->mn_ba[3], qos)) 3386193240Ssam ds->TxPriority = mn->mn_ba[3].txq; 3387193240Ssam#endif 3388193240Ssam#if MWL_MAXBA > 2 3389193240Ssam else if (mwl_bastream_match(&mn->mn_ba[2], qos)) 3390193240Ssam ds->TxPriority = mn->mn_ba[2].txq; 3391193240Ssam#endif 3392193240Ssam#if MWL_MAXBA > 1 3393193240Ssam else if (mwl_bastream_match(&mn->mn_ba[1], qos)) 3394193240Ssam ds->TxPriority = mn->mn_ba[1].txq; 3395193240Ssam#endif 3396193240Ssam#if MWL_MAXBA > 0 3397193240Ssam else if (mwl_bastream_match(&mn->mn_ba[0], qos)) 3398193240Ssam ds->TxPriority = mn->mn_ba[0].txq; 3399193240Ssam#endif 3400193240Ssam else 3401193240Ssam ds->TxPriority = txq->qnum; 3402193240Ssam } else 3403193240Ssam ds->TxPriority = txq->qnum; 3404193240Ssam break; 3405193240Ssam default: 3406193240Ssam if_printf(ifp, "bogus frame type 0x%x (%s)\n", 3407193240Ssam wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK, __func__); 3408193240Ssam sc->sc_stats.mst_tx_badframetype++; 3409193240Ssam m_freem(m0); 3410193240Ssam return EIO; 3411193240Ssam } 3412193240Ssam 3413193240Ssam if (IFF_DUMPPKTS_XMIT(sc)) 3414193240Ssam ieee80211_dump_pkt(ic, 3415193240Ssam mtod(m0, const uint8_t *)+sizeof(uint16_t), 3416193240Ssam m0->m_len - sizeof(uint16_t), ds->DataRate, -1); 3417193240Ssam 3418193240Ssam MWL_TXQ_LOCK(txq); 3419193240Ssam ds->Status = htole32(EAGLE_TXD_STATUS_FW_OWNED); 3420193240Ssam STAILQ_INSERT_TAIL(&txq->active, bf, bf_list); 3421193240Ssam MWL_TXDESC_SYNC(txq, ds, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 3422193240Ssam 3423193240Ssam ifp->if_opackets++; 3424199559Sjhb sc->sc_tx_timer = 5; 3425193240Ssam MWL_TXQ_UNLOCK(txq); 3426193240Ssam 3427193240Ssam return 0; 3428193240Ssam#undef IEEE80211_DIR_DSTODS 3429193240Ssam} 3430193240Ssam 3431193240Ssamstatic __inline int 3432193240Ssammwl_cvtlegacyrix(int rix) 3433193240Ssam{ 3434193240Ssam#define N(x) (sizeof(x)/sizeof(x[0])) 3435193240Ssam static const int ieeerates[] = 3436193240Ssam { 2, 4, 11, 22, 44, 12, 18, 24, 36, 48, 72, 96, 108 }; 3437193240Ssam return (rix < N(ieeerates) ? ieeerates[rix] : 0); 3438193240Ssam#undef N 3439193240Ssam} 3440193240Ssam 3441193240Ssam/* 3442193240Ssam * Process completed xmit descriptors from the specified queue. 3443193240Ssam */ 3444193240Ssamstatic int 3445193240Ssammwl_tx_processq(struct mwl_softc *sc, struct mwl_txq *txq) 3446193240Ssam{ 3447193240Ssam#define EAGLE_TXD_STATUS_MCAST \ 3448193240Ssam (EAGLE_TXD_STATUS_MULTICAST_TX | EAGLE_TXD_STATUS_BROADCAST_TX) 3449193240Ssam struct ifnet *ifp = sc->sc_ifp; 3450193240Ssam struct ieee80211com *ic = ifp->if_l2com; 3451193240Ssam struct mwl_txbuf *bf; 3452193240Ssam struct mwl_txdesc *ds; 3453193240Ssam struct ieee80211_node *ni; 3454193240Ssam struct mwl_node *an; 3455193240Ssam int nreaped; 3456193240Ssam uint32_t status; 3457193240Ssam 3458193240Ssam DPRINTF(sc, MWL_DEBUG_TX_PROC, "%s: tx queue %u\n", __func__, txq->qnum); 3459193240Ssam for (nreaped = 0;; nreaped++) { 3460193240Ssam MWL_TXQ_LOCK(txq); 3461193240Ssam bf = STAILQ_FIRST(&txq->active); 3462193240Ssam if (bf == NULL) { 3463193240Ssam MWL_TXQ_UNLOCK(txq); 3464193240Ssam break; 3465193240Ssam } 3466193240Ssam ds = bf->bf_desc; 3467193240Ssam MWL_TXDESC_SYNC(txq, ds, 3468193240Ssam BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE); 3469193240Ssam if (ds->Status & htole32(EAGLE_TXD_STATUS_FW_OWNED)) { 3470193240Ssam MWL_TXQ_UNLOCK(txq); 3471193240Ssam break; 3472193240Ssam } 3473193240Ssam STAILQ_REMOVE_HEAD(&txq->active, bf_list); 3474193240Ssam MWL_TXQ_UNLOCK(txq); 3475193240Ssam 3476193240Ssam#ifdef MWL_DEBUG 3477193240Ssam if (sc->sc_debug & MWL_DEBUG_XMIT_DESC) 3478193240Ssam mwl_printtxbuf(bf, txq->qnum, nreaped); 3479193240Ssam#endif 3480193240Ssam ni = bf->bf_node; 3481193240Ssam if (ni != NULL) { 3482193240Ssam an = MWL_NODE(ni); 3483193240Ssam status = le32toh(ds->Status); 3484193240Ssam if (status & EAGLE_TXD_STATUS_OK) { 3485193240Ssam uint16_t Format = le16toh(ds->Format); 3486193240Ssam uint8_t txant = MS(Format, EAGLE_TXD_ANTENNA); 3487193240Ssam 3488193240Ssam sc->sc_stats.mst_ant_tx[txant]++; 3489193240Ssam if (status & EAGLE_TXD_STATUS_OK_RETRY) 3490193240Ssam sc->sc_stats.mst_tx_retries++; 3491193240Ssam if (status & EAGLE_TXD_STATUS_OK_MORE_RETRY) 3492193240Ssam sc->sc_stats.mst_tx_mretries++; 3493193240Ssam if (txq->qnum >= MWL_WME_AC_VO) 3494193240Ssam ic->ic_wme.wme_hipri_traffic++; 3495193240Ssam ni->ni_txrate = MS(Format, EAGLE_TXD_RATE); 3496193240Ssam if ((Format & EAGLE_TXD_FORMAT_HT) == 0) { 3497193240Ssam ni->ni_txrate = mwl_cvtlegacyrix( 3498193240Ssam ni->ni_txrate); 3499193240Ssam } else 3500193240Ssam ni->ni_txrate |= IEEE80211_RATE_MCS; 3501193240Ssam sc->sc_stats.mst_tx_rate = ni->ni_txrate; 3502193240Ssam } else { 3503193240Ssam if (status & EAGLE_TXD_STATUS_FAILED_LINK_ERROR) 3504193240Ssam sc->sc_stats.mst_tx_linkerror++; 3505193240Ssam if (status & EAGLE_TXD_STATUS_FAILED_XRETRY) 3506193240Ssam sc->sc_stats.mst_tx_xretries++; 3507193240Ssam if (status & EAGLE_TXD_STATUS_FAILED_AGING) 3508193240Ssam sc->sc_stats.mst_tx_aging++; 3509193240Ssam if (bf->bf_m->m_flags & M_FF) 3510193240Ssam sc->sc_stats.mst_ff_txerr++; 3511193240Ssam } 3512193240Ssam /* 3513193240Ssam * Do any tx complete callback. Note this must 3514193240Ssam * be done before releasing the node reference. 3515193240Ssam * XXX no way to figure out if frame was ACK'd 3516193240Ssam */ 3517193240Ssam if (bf->bf_m->m_flags & M_TXCB) { 3518193240Ssam /* XXX strip fw len in case header inspected */ 3519193240Ssam m_adj(bf->bf_m, sizeof(uint16_t)); 3520193240Ssam ieee80211_process_callback(ni, bf->bf_m, 3521193240Ssam (status & EAGLE_TXD_STATUS_OK) == 0); 3522193240Ssam } 3523193240Ssam /* 3524193240Ssam * Reclaim reference to node. 3525193240Ssam * 3526193240Ssam * NB: the node may be reclaimed here if, for example 3527193240Ssam * this is a DEAUTH message that was sent and the 3528193240Ssam * node was timed out due to inactivity. 3529193240Ssam */ 3530193240Ssam ieee80211_free_node(ni); 3531193240Ssam } 3532193240Ssam ds->Status = htole32(EAGLE_TXD_STATUS_IDLE); 3533193240Ssam 3534193240Ssam bus_dmamap_sync(sc->sc_dmat, bf->bf_dmamap, 3535193240Ssam BUS_DMASYNC_POSTWRITE); 3536193240Ssam bus_dmamap_unload(sc->sc_dmat, bf->bf_dmamap); 3537193240Ssam m_freem(bf->bf_m); 3538193240Ssam 3539193240Ssam mwl_puttxbuf_tail(txq, bf); 3540193240Ssam } 3541193240Ssam return nreaped; 3542193240Ssam#undef EAGLE_TXD_STATUS_MCAST 3543193240Ssam} 3544193240Ssam 3545193240Ssam/* 3546193240Ssam * Deferred processing of transmit interrupt; special-cased 3547193240Ssam * for four hardware queues, 0-3. 3548193240Ssam */ 3549193240Ssamstatic void 3550193240Ssammwl_tx_proc(void *arg, int npending) 3551193240Ssam{ 3552193240Ssam struct mwl_softc *sc = arg; 3553193240Ssam struct ifnet *ifp = sc->sc_ifp; 3554193240Ssam int nreaped; 3555193240Ssam 3556193240Ssam /* 3557193240Ssam * Process each active queue. 3558193240Ssam */ 3559193240Ssam nreaped = 0; 3560193240Ssam if (!STAILQ_EMPTY(&sc->sc_txq[0].active)) 3561193240Ssam nreaped += mwl_tx_processq(sc, &sc->sc_txq[0]); 3562193240Ssam if (!STAILQ_EMPTY(&sc->sc_txq[1].active)) 3563193240Ssam nreaped += mwl_tx_processq(sc, &sc->sc_txq[1]); 3564193240Ssam if (!STAILQ_EMPTY(&sc->sc_txq[2].active)) 3565193240Ssam nreaped += mwl_tx_processq(sc, &sc->sc_txq[2]); 3566193240Ssam if (!STAILQ_EMPTY(&sc->sc_txq[3].active)) 3567193240Ssam nreaped += mwl_tx_processq(sc, &sc->sc_txq[3]); 3568193240Ssam 3569193240Ssam if (nreaped != 0) { 3570193240Ssam ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 3571199559Sjhb sc->sc_tx_timer = 0; 3572193240Ssam if (!IFQ_IS_EMPTY(&ifp->if_snd)) { 3573193240Ssam /* NB: kick fw; the tx thread may have been preempted */ 3574193240Ssam mwl_hal_txstart(sc->sc_mh, 0); 3575193240Ssam mwl_start(ifp); 3576193240Ssam } 3577193240Ssam } 3578193240Ssam} 3579193240Ssam 3580193240Ssamstatic void 3581193240Ssammwl_tx_draintxq(struct mwl_softc *sc, struct mwl_txq *txq) 3582193240Ssam{ 3583193240Ssam struct ieee80211_node *ni; 3584193240Ssam struct mwl_txbuf *bf; 3585193240Ssam u_int ix; 3586193240Ssam 3587193240Ssam /* 3588193240Ssam * NB: this assumes output has been stopped and 3589193240Ssam * we do not need to block mwl_tx_tasklet 3590193240Ssam */ 3591193240Ssam for (ix = 0;; ix++) { 3592193240Ssam MWL_TXQ_LOCK(txq); 3593193240Ssam bf = STAILQ_FIRST(&txq->active); 3594193240Ssam if (bf == NULL) { 3595193240Ssam MWL_TXQ_UNLOCK(txq); 3596193240Ssam break; 3597193240Ssam } 3598193240Ssam STAILQ_REMOVE_HEAD(&txq->active, bf_list); 3599193240Ssam MWL_TXQ_UNLOCK(txq); 3600193240Ssam#ifdef MWL_DEBUG 3601193240Ssam if (sc->sc_debug & MWL_DEBUG_RESET) { 3602193240Ssam struct ifnet *ifp = sc->sc_ifp; 3603193240Ssam struct ieee80211com *ic = ifp->if_l2com; 3604193240Ssam const struct mwltxrec *tr = 3605193240Ssam mtod(bf->bf_m, const struct mwltxrec *); 3606193240Ssam mwl_printtxbuf(bf, txq->qnum, ix); 3607193240Ssam ieee80211_dump_pkt(ic, (const uint8_t *)&tr->wh, 3608193240Ssam bf->bf_m->m_len - sizeof(tr->fwlen), 0, -1); 3609193240Ssam } 3610193240Ssam#endif /* MWL_DEBUG */ 3611193240Ssam bus_dmamap_unload(sc->sc_dmat, bf->bf_dmamap); 3612193240Ssam ni = bf->bf_node; 3613193240Ssam if (ni != NULL) { 3614193240Ssam /* 3615193240Ssam * Reclaim node reference. 3616193240Ssam */ 3617193240Ssam ieee80211_free_node(ni); 3618193240Ssam } 3619193240Ssam m_freem(bf->bf_m); 3620193240Ssam 3621193240Ssam mwl_puttxbuf_tail(txq, bf); 3622193240Ssam } 3623193240Ssam} 3624193240Ssam 3625193240Ssam/* 3626193240Ssam * Drain the transmit queues and reclaim resources. 3627193240Ssam */ 3628193240Ssamstatic void 3629193240Ssammwl_draintxq(struct mwl_softc *sc) 3630193240Ssam{ 3631193240Ssam struct ifnet *ifp = sc->sc_ifp; 3632193240Ssam int i; 3633193240Ssam 3634193240Ssam for (i = 0; i < MWL_NUM_TX_QUEUES; i++) 3635193240Ssam mwl_tx_draintxq(sc, &sc->sc_txq[i]); 3636193240Ssam ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 3637199559Sjhb sc->sc_tx_timer = 0; 3638193240Ssam} 3639193240Ssam 3640193240Ssam#ifdef MWL_DIAGAPI 3641193240Ssam/* 3642193240Ssam * Reset the transmit queues to a pristine state after a fw download. 3643193240Ssam */ 3644193240Ssamstatic void 3645193240Ssammwl_resettxq(struct mwl_softc *sc) 3646193240Ssam{ 3647193240Ssam int i; 3648193240Ssam 3649193240Ssam for (i = 0; i < MWL_NUM_TX_QUEUES; i++) 3650193240Ssam mwl_txq_reset(sc, &sc->sc_txq[i]); 3651193240Ssam} 3652193240Ssam#endif /* MWL_DIAGAPI */ 3653193240Ssam 3654193240Ssam/* 3655193240Ssam * Clear the transmit queues of any frames submitted for the 3656193240Ssam * specified vap. This is done when the vap is deleted so we 3657193240Ssam * don't potentially reference the vap after it is gone. 3658193240Ssam * Note we cannot remove the frames; we only reclaim the node 3659193240Ssam * reference. 3660193240Ssam */ 3661193240Ssamstatic void 3662193240Ssammwl_cleartxq(struct mwl_softc *sc, struct ieee80211vap *vap) 3663193240Ssam{ 3664193240Ssam struct mwl_txq *txq; 3665193240Ssam struct mwl_txbuf *bf; 3666193240Ssam int i; 3667193240Ssam 3668193240Ssam for (i = 0; i < MWL_NUM_TX_QUEUES; i++) { 3669193240Ssam txq = &sc->sc_txq[i]; 3670193240Ssam MWL_TXQ_LOCK(txq); 3671193240Ssam STAILQ_FOREACH(bf, &txq->active, bf_list) { 3672193240Ssam struct ieee80211_node *ni = bf->bf_node; 3673193240Ssam if (ni != NULL && ni->ni_vap == vap) { 3674193240Ssam bf->bf_node = NULL; 3675193240Ssam ieee80211_free_node(ni); 3676193240Ssam } 3677193240Ssam } 3678193240Ssam MWL_TXQ_UNLOCK(txq); 3679193240Ssam } 3680193240Ssam} 3681193240Ssam 3682195377Ssamstatic int 3683195377Ssammwl_recv_action(struct ieee80211_node *ni, const struct ieee80211_frame *wh, 3684195377Ssam const uint8_t *frm, const uint8_t *efrm) 3685193240Ssam{ 3686193240Ssam struct mwl_softc *sc = ni->ni_ic->ic_ifp->if_softc; 3687193240Ssam const struct ieee80211_action *ia; 3688193240Ssam 3689193240Ssam ia = (const struct ieee80211_action *) frm; 3690193240Ssam if (ia->ia_category == IEEE80211_ACTION_CAT_HT && 3691193240Ssam ia->ia_action == IEEE80211_ACTION_HT_MIMOPWRSAVE) { 3692193240Ssam const struct ieee80211_action_ht_mimopowersave *mps = 3693193240Ssam (const struct ieee80211_action_ht_mimopowersave *) ia; 3694193240Ssam 3695193240Ssam mwl_hal_setmimops(sc->sc_mh, ni->ni_macaddr, 3696193240Ssam mps->am_control & IEEE80211_A_HT_MIMOPWRSAVE_ENA, 3697193240Ssam MS(mps->am_control, IEEE80211_A_HT_MIMOPWRSAVE_MODE)); 3698195377Ssam return 0; 3699193240Ssam } else 3700195377Ssam return sc->sc_recv_action(ni, wh, frm, efrm); 3701193240Ssam} 3702193240Ssam 3703193240Ssamstatic int 3704193240Ssammwl_addba_request(struct ieee80211_node *ni, struct ieee80211_tx_ampdu *tap, 3705193240Ssam int dialogtoken, int baparamset, int batimeout) 3706193240Ssam{ 3707193240Ssam struct mwl_softc *sc = ni->ni_ic->ic_ifp->if_softc; 3708195171Ssam struct ieee80211vap *vap = ni->ni_vap; 3709193240Ssam struct mwl_node *mn = MWL_NODE(ni); 3710193240Ssam struct mwl_bastate *bas; 3711193240Ssam 3712193240Ssam bas = tap->txa_private; 3713193240Ssam if (bas == NULL) { 3714193240Ssam const MWL_HAL_BASTREAM *sp; 3715193240Ssam /* 3716193240Ssam * Check for a free BA stream slot. 3717193240Ssam */ 3718193240Ssam#if MWL_MAXBA > 3 3719193240Ssam if (mn->mn_ba[3].bastream == NULL) 3720193240Ssam bas = &mn->mn_ba[3]; 3721193240Ssam else 3722193240Ssam#endif 3723193240Ssam#if MWL_MAXBA > 2 3724193240Ssam if (mn->mn_ba[2].bastream == NULL) 3725193240Ssam bas = &mn->mn_ba[2]; 3726193240Ssam else 3727193240Ssam#endif 3728193240Ssam#if MWL_MAXBA > 1 3729193240Ssam if (mn->mn_ba[1].bastream == NULL) 3730193240Ssam bas = &mn->mn_ba[1]; 3731193240Ssam else 3732193240Ssam#endif 3733193240Ssam#if MWL_MAXBA > 0 3734193240Ssam if (mn->mn_ba[0].bastream == NULL) 3735193240Ssam bas = &mn->mn_ba[0]; 3736193240Ssam else 3737193240Ssam#endif 3738193240Ssam { 3739193240Ssam /* sta already has max BA streams */ 3740193240Ssam /* XXX assign BA stream to highest priority tid */ 3741193240Ssam DPRINTF(sc, MWL_DEBUG_AMPDU, 3742193240Ssam "%s: already has max bastreams\n", __func__); 3743193240Ssam sc->sc_stats.mst_ampdu_reject++; 3744193240Ssam return 0; 3745193240Ssam } 3746193240Ssam /* NB: no held reference to ni */ 3747195171Ssam sp = mwl_hal_bastream_alloc(MWL_VAP(vap)->mv_hvap, 3748195171Ssam (baparamset & IEEE80211_BAPS_POLICY_IMMEDIATE) != 0, 3749234324Sadrian ni->ni_macaddr, tap->txa_tid, ni->ni_htparam, 3750195171Ssam ni, tap); 3751193240Ssam if (sp == NULL) { 3752193240Ssam /* 3753193240Ssam * No available stream, return 0 so no 3754193240Ssam * a-mpdu aggregation will be done. 3755193240Ssam */ 3756193240Ssam DPRINTF(sc, MWL_DEBUG_AMPDU, 3757193240Ssam "%s: no bastream available\n", __func__); 3758193240Ssam sc->sc_stats.mst_ampdu_nostream++; 3759193240Ssam return 0; 3760193240Ssam } 3761193240Ssam DPRINTF(sc, MWL_DEBUG_AMPDU, "%s: alloc bastream %p\n", 3762193240Ssam __func__, sp); 3763193240Ssam /* NB: qos is left zero so we won't match in mwl_tx_start */ 3764193240Ssam bas->bastream = sp; 3765193240Ssam tap->txa_private = bas; 3766193240Ssam } 3767193240Ssam /* fetch current seq# from the firmware; if available */ 3768193240Ssam if (mwl_hal_bastream_get_seqno(sc->sc_mh, bas->bastream, 3769195171Ssam vap->iv_opmode == IEEE80211_M_STA ? vap->iv_myaddr : ni->ni_macaddr, 3770193240Ssam &tap->txa_start) != 0) 3771193240Ssam tap->txa_start = 0; 3772193240Ssam return sc->sc_addba_request(ni, tap, dialogtoken, baparamset, batimeout); 3773193240Ssam} 3774193240Ssam 3775193240Ssamstatic int 3776193240Ssammwl_addba_response(struct ieee80211_node *ni, struct ieee80211_tx_ampdu *tap, 3777193240Ssam int code, int baparamset, int batimeout) 3778193240Ssam{ 3779193240Ssam struct mwl_softc *sc = ni->ni_ic->ic_ifp->if_softc; 3780193240Ssam struct mwl_bastate *bas; 3781193240Ssam 3782193240Ssam bas = tap->txa_private; 3783193240Ssam if (bas == NULL) { 3784193240Ssam /* XXX should not happen */ 3785193240Ssam DPRINTF(sc, MWL_DEBUG_AMPDU, 3786234324Sadrian "%s: no BA stream allocated, TID %d\n", 3787234324Sadrian __func__, tap->txa_tid); 3788193240Ssam sc->sc_stats.mst_addba_nostream++; 3789193240Ssam return 0; 3790193240Ssam } 3791193240Ssam if (code == IEEE80211_STATUS_SUCCESS) { 3792195171Ssam struct ieee80211vap *vap = ni->ni_vap; 3793193240Ssam int bufsiz, error; 3794193240Ssam 3795193240Ssam /* 3796193240Ssam * Tell the firmware to setup the BA stream; 3797193240Ssam * we know resources are available because we 3798193240Ssam * pre-allocated one before forming the request. 3799193240Ssam */ 3800193240Ssam bufsiz = MS(baparamset, IEEE80211_BAPS_BUFSIZ); 3801193240Ssam if (bufsiz == 0) 3802193240Ssam bufsiz = IEEE80211_AGGR_BAWMAX; 3803195171Ssam error = mwl_hal_bastream_create(MWL_VAP(vap)->mv_hvap, 3804195171Ssam bas->bastream, bufsiz, bufsiz, tap->txa_start); 3805193240Ssam if (error != 0) { 3806193240Ssam /* 3807193240Ssam * Setup failed, return immediately so no a-mpdu 3808193240Ssam * aggregation will be done. 3809193240Ssam */ 3810193240Ssam mwl_hal_bastream_destroy(sc->sc_mh, bas->bastream); 3811193240Ssam mwl_bastream_free(bas); 3812193240Ssam tap->txa_private = NULL; 3813193240Ssam 3814193240Ssam DPRINTF(sc, MWL_DEBUG_AMPDU, 3815234324Sadrian "%s: create failed, error %d, bufsiz %d TID %d " 3816193240Ssam "htparam 0x%x\n", __func__, error, bufsiz, 3817234324Sadrian tap->txa_tid, ni->ni_htparam); 3818193240Ssam sc->sc_stats.mst_bacreate_failed++; 3819193240Ssam return 0; 3820193240Ssam } 3821193240Ssam /* NB: cache txq to avoid ptr indirect */ 3822234324Sadrian mwl_bastream_setup(bas, tap->txa_tid, bas->bastream->txq); 3823193240Ssam DPRINTF(sc, MWL_DEBUG_AMPDU, 3824234324Sadrian "%s: bastream %p assigned to txq %d TID %d bufsiz %d " 3825193240Ssam "htparam 0x%x\n", __func__, bas->bastream, 3826234324Sadrian bas->txq, tap->txa_tid, bufsiz, ni->ni_htparam); 3827193240Ssam } else { 3828193240Ssam /* 3829193240Ssam * Other side NAK'd us; return the resources. 3830193240Ssam */ 3831193240Ssam DPRINTF(sc, MWL_DEBUG_AMPDU, 3832193240Ssam "%s: request failed with code %d, destroy bastream %p\n", 3833193240Ssam __func__, code, bas->bastream); 3834193240Ssam mwl_hal_bastream_destroy(sc->sc_mh, bas->bastream); 3835193240Ssam mwl_bastream_free(bas); 3836193240Ssam tap->txa_private = NULL; 3837193240Ssam } 3838193240Ssam /* NB: firmware sends BAR so we don't need to */ 3839193240Ssam return sc->sc_addba_response(ni, tap, code, baparamset, batimeout); 3840193240Ssam} 3841193240Ssam 3842193240Ssamstatic void 3843193240Ssammwl_addba_stop(struct ieee80211_node *ni, struct ieee80211_tx_ampdu *tap) 3844193240Ssam{ 3845193240Ssam struct mwl_softc *sc = ni->ni_ic->ic_ifp->if_softc; 3846193240Ssam struct mwl_bastate *bas; 3847193240Ssam 3848193240Ssam bas = tap->txa_private; 3849193240Ssam if (bas != NULL) { 3850193240Ssam DPRINTF(sc, MWL_DEBUG_AMPDU, "%s: destroy bastream %p\n", 3851193240Ssam __func__, bas->bastream); 3852193240Ssam mwl_hal_bastream_destroy(sc->sc_mh, bas->bastream); 3853193240Ssam mwl_bastream_free(bas); 3854193240Ssam tap->txa_private = NULL; 3855193240Ssam } 3856193240Ssam sc->sc_addba_stop(ni, tap); 3857193240Ssam} 3858193240Ssam 3859193240Ssam/* 3860193240Ssam * Setup the rx data structures. This should only be 3861193240Ssam * done once or we may get out of sync with the firmware. 3862193240Ssam */ 3863193240Ssamstatic int 3864193240Ssammwl_startrecv(struct mwl_softc *sc) 3865193240Ssam{ 3866193240Ssam if (!sc->sc_recvsetup) { 3867193240Ssam struct mwl_rxbuf *bf, *prev; 3868193240Ssam struct mwl_rxdesc *ds; 3869193240Ssam 3870193240Ssam prev = NULL; 3871193240Ssam STAILQ_FOREACH(bf, &sc->sc_rxbuf, bf_list) { 3872193240Ssam int error = mwl_rxbuf_init(sc, bf); 3873193240Ssam if (error != 0) { 3874193240Ssam DPRINTF(sc, MWL_DEBUG_RECV, 3875193240Ssam "%s: mwl_rxbuf_init failed %d\n", 3876193240Ssam __func__, error); 3877193240Ssam return error; 3878193240Ssam } 3879193240Ssam if (prev != NULL) { 3880193240Ssam ds = prev->bf_desc; 3881193240Ssam ds->pPhysNext = htole32(bf->bf_daddr); 3882193240Ssam } 3883193240Ssam prev = bf; 3884193240Ssam } 3885193240Ssam if (prev != NULL) { 3886193240Ssam ds = prev->bf_desc; 3887193240Ssam ds->pPhysNext = 3888193240Ssam htole32(STAILQ_FIRST(&sc->sc_rxbuf)->bf_daddr); 3889193240Ssam } 3890193240Ssam sc->sc_recvsetup = 1; 3891193240Ssam } 3892193240Ssam mwl_mode_init(sc); /* set filters, etc. */ 3893193240Ssam return 0; 3894193240Ssam} 3895193240Ssam 3896193240Ssamstatic MWL_HAL_APMODE 3897193240Ssammwl_getapmode(const struct ieee80211vap *vap, struct ieee80211_channel *chan) 3898193240Ssam{ 3899193240Ssam MWL_HAL_APMODE mode; 3900193240Ssam 3901193240Ssam if (IEEE80211_IS_CHAN_HT(chan)) { 3902193656Ssam if (vap->iv_flags_ht & IEEE80211_FHT_PUREN) 3903193240Ssam mode = AP_MODE_N_ONLY; 3904193240Ssam else if (IEEE80211_IS_CHAN_5GHZ(chan)) 3905193240Ssam mode = AP_MODE_AandN; 3906193240Ssam else if (vap->iv_flags & IEEE80211_F_PUREG) 3907193240Ssam mode = AP_MODE_GandN; 3908193240Ssam else 3909193240Ssam mode = AP_MODE_BandGandN; 3910193240Ssam } else if (IEEE80211_IS_CHAN_ANYG(chan)) { 3911193240Ssam if (vap->iv_flags & IEEE80211_F_PUREG) 3912193240Ssam mode = AP_MODE_G_ONLY; 3913193240Ssam else 3914193240Ssam mode = AP_MODE_MIXED; 3915193240Ssam } else if (IEEE80211_IS_CHAN_B(chan)) 3916193240Ssam mode = AP_MODE_B_ONLY; 3917193240Ssam else if (IEEE80211_IS_CHAN_A(chan)) 3918193240Ssam mode = AP_MODE_A_ONLY; 3919193240Ssam else 3920193240Ssam mode = AP_MODE_MIXED; /* XXX should not happen? */ 3921193240Ssam return mode; 3922193240Ssam} 3923193240Ssam 3924193240Ssamstatic int 3925193240Ssammwl_setapmode(struct ieee80211vap *vap, struct ieee80211_channel *chan) 3926193240Ssam{ 3927193240Ssam struct mwl_hal_vap *hvap = MWL_VAP(vap)->mv_hvap; 3928193240Ssam return mwl_hal_setapmode(hvap, mwl_getapmode(vap, chan)); 3929193240Ssam} 3930193240Ssam 3931193240Ssam/* 3932193240Ssam * Set/change channels. 3933193240Ssam */ 3934193240Ssamstatic int 3935193240Ssammwl_chan_set(struct mwl_softc *sc, struct ieee80211_channel *chan) 3936193240Ssam{ 3937193240Ssam struct mwl_hal *mh = sc->sc_mh; 3938193240Ssam struct ifnet *ifp = sc->sc_ifp; 3939193240Ssam struct ieee80211com *ic = ifp->if_l2com; 3940193240Ssam MWL_HAL_CHANNEL hchan; 3941193240Ssam int maxtxpow; 3942193240Ssam 3943193240Ssam DPRINTF(sc, MWL_DEBUG_RESET, "%s: chan %u MHz/flags 0x%x\n", 3944193240Ssam __func__, chan->ic_freq, chan->ic_flags); 3945193240Ssam 3946193240Ssam /* 3947193240Ssam * Convert to a HAL channel description with 3948193240Ssam * the flags constrained to reflect the current 3949193240Ssam * operating mode. 3950193240Ssam */ 3951193240Ssam mwl_mapchan(&hchan, chan); 3952193240Ssam mwl_hal_intrset(mh, 0); /* disable interrupts */ 3953193240Ssam#if 0 3954193240Ssam mwl_draintxq(sc); /* clear pending tx frames */ 3955193240Ssam#endif 3956193240Ssam mwl_hal_setchannel(mh, &hchan); 3957193240Ssam /* 3958193240Ssam * Tx power is cap'd by the regulatory setting and 3959193240Ssam * possibly a user-set limit. We pass the min of 3960193240Ssam * these to the hal to apply them to the cal data 3961193240Ssam * for this channel. 3962193240Ssam * XXX min bound? 3963193240Ssam */ 3964193240Ssam maxtxpow = 2*chan->ic_maxregpower; 3965193240Ssam if (maxtxpow > ic->ic_txpowlimit) 3966193240Ssam maxtxpow = ic->ic_txpowlimit; 3967193240Ssam mwl_hal_settxpower(mh, &hchan, maxtxpow / 2); 3968193240Ssam /* NB: potentially change mcast/mgt rates */ 3969193240Ssam mwl_setcurchanrates(sc); 3970193240Ssam 3971193240Ssam /* 3972193240Ssam * Update internal state. 3973193240Ssam */ 3974193240Ssam sc->sc_tx_th.wt_chan_freq = htole16(chan->ic_freq); 3975193240Ssam sc->sc_rx_th.wr_chan_freq = htole16(chan->ic_freq); 3976193240Ssam if (IEEE80211_IS_CHAN_A(chan)) { 3977193240Ssam sc->sc_tx_th.wt_chan_flags = htole16(IEEE80211_CHAN_A); 3978193240Ssam sc->sc_rx_th.wr_chan_flags = htole16(IEEE80211_CHAN_A); 3979193240Ssam } else if (IEEE80211_IS_CHAN_ANYG(chan)) { 3980193240Ssam sc->sc_tx_th.wt_chan_flags = htole16(IEEE80211_CHAN_G); 3981193240Ssam sc->sc_rx_th.wr_chan_flags = htole16(IEEE80211_CHAN_G); 3982193240Ssam } else { 3983193240Ssam sc->sc_tx_th.wt_chan_flags = htole16(IEEE80211_CHAN_B); 3984193240Ssam sc->sc_rx_th.wr_chan_flags = htole16(IEEE80211_CHAN_B); 3985193240Ssam } 3986193240Ssam sc->sc_curchan = hchan; 3987193240Ssam mwl_hal_intrset(mh, sc->sc_imask); 3988193240Ssam 3989193240Ssam return 0; 3990193240Ssam} 3991193240Ssam 3992193240Ssamstatic void 3993193240Ssammwl_scan_start(struct ieee80211com *ic) 3994193240Ssam{ 3995193240Ssam struct ifnet *ifp = ic->ic_ifp; 3996193240Ssam struct mwl_softc *sc = ifp->if_softc; 3997193240Ssam 3998193240Ssam DPRINTF(sc, MWL_DEBUG_STATE, "%s\n", __func__); 3999193240Ssam} 4000193240Ssam 4001193240Ssamstatic void 4002193240Ssammwl_scan_end(struct ieee80211com *ic) 4003193240Ssam{ 4004193240Ssam struct ifnet *ifp = ic->ic_ifp; 4005193240Ssam struct mwl_softc *sc = ifp->if_softc; 4006193240Ssam 4007193240Ssam DPRINTF(sc, MWL_DEBUG_STATE, "%s\n", __func__); 4008193240Ssam} 4009193240Ssam 4010193240Ssamstatic void 4011193240Ssammwl_set_channel(struct ieee80211com *ic) 4012193240Ssam{ 4013193240Ssam struct ifnet *ifp = ic->ic_ifp; 4014193240Ssam struct mwl_softc *sc = ifp->if_softc; 4015193240Ssam 4016193240Ssam (void) mwl_chan_set(sc, ic->ic_curchan); 4017193240Ssam} 4018193240Ssam 4019193240Ssam/* 4020193240Ssam * Handle a channel switch request. We inform the firmware 4021193240Ssam * and mark the global state to suppress various actions. 4022193240Ssam * NB: we issue only one request to the fw; we may be called 4023193240Ssam * multiple times if there are multiple vap's. 4024193240Ssam */ 4025193240Ssamstatic void 4026193240Ssammwl_startcsa(struct ieee80211vap *vap) 4027193240Ssam{ 4028193240Ssam struct ieee80211com *ic = vap->iv_ic; 4029193240Ssam struct mwl_softc *sc = ic->ic_ifp->if_softc; 4030193240Ssam MWL_HAL_CHANNEL hchan; 4031193240Ssam 4032193240Ssam if (sc->sc_csapending) 4033193240Ssam return; 4034193240Ssam 4035193240Ssam mwl_mapchan(&hchan, ic->ic_csa_newchan); 4036193240Ssam /* 1 =>'s quiet channel */ 4037193240Ssam mwl_hal_setchannelswitchie(sc->sc_mh, &hchan, 1, ic->ic_csa_count); 4038193240Ssam sc->sc_csapending = 1; 4039193240Ssam} 4040193240Ssam 4041193240Ssam/* 4042193240Ssam * Plumb any static WEP key for the station. This is 4043193240Ssam * necessary as we must propagate the key from the 4044193240Ssam * global key table of the vap to each sta db entry. 4045193240Ssam */ 4046193240Ssamstatic void 4047193240Ssammwl_setanywepkey(struct ieee80211vap *vap, const uint8_t mac[IEEE80211_ADDR_LEN]) 4048193240Ssam{ 4049193240Ssam if ((vap->iv_flags & (IEEE80211_F_PRIVACY|IEEE80211_F_WPA)) == 4050193240Ssam IEEE80211_F_PRIVACY && 4051193240Ssam vap->iv_def_txkey != IEEE80211_KEYIX_NONE && 4052193240Ssam vap->iv_nw_keys[vap->iv_def_txkey].wk_keyix != IEEE80211_KEYIX_NONE) 4053193240Ssam (void) mwl_key_set(vap, &vap->iv_nw_keys[vap->iv_def_txkey], mac); 4054193240Ssam} 4055193240Ssam 4056193240Ssamstatic int 4057193240Ssammwl_peerstadb(struct ieee80211_node *ni, int aid, int staid, MWL_HAL_PEERINFO *pi) 4058193240Ssam{ 4059193240Ssam#define WME(ie) ((const struct ieee80211_wme_info *) ie) 4060193240Ssam struct ieee80211vap *vap = ni->ni_vap; 4061193240Ssam struct mwl_hal_vap *hvap; 4062193240Ssam int error; 4063193240Ssam 4064193240Ssam if (vap->iv_opmode == IEEE80211_M_WDS) { 4065193240Ssam /* 4066193240Ssam * WDS vap's do not have a f/w vap; instead they piggyback 4067193240Ssam * on an AP vap and we must install the sta db entry and 4068193240Ssam * crypto state using that AP's handle (the WDS vap has none). 4069193240Ssam */ 4070193240Ssam hvap = MWL_VAP(vap)->mv_ap_hvap; 4071193240Ssam } else 4072193240Ssam hvap = MWL_VAP(vap)->mv_hvap; 4073193240Ssam error = mwl_hal_newstation(hvap, ni->ni_macaddr, 4074193240Ssam aid, staid, pi, 4075193240Ssam ni->ni_flags & (IEEE80211_NODE_QOS | IEEE80211_NODE_HT), 4076193240Ssam ni->ni_ies.wme_ie != NULL ? WME(ni->ni_ies.wme_ie)->wme_info : 0); 4077193240Ssam if (error == 0) { 4078193240Ssam /* 4079193240Ssam * Setup security for this station. For sta mode this is 4080193240Ssam * needed even though do the same thing on transition to 4081193240Ssam * AUTH state because the call to mwl_hal_newstation 4082193240Ssam * clobbers the crypto state we setup. 4083193240Ssam */ 4084193240Ssam mwl_setanywepkey(vap, ni->ni_macaddr); 4085193240Ssam } 4086193240Ssam return error; 4087193240Ssam#undef WME 4088193240Ssam} 4089193240Ssam 4090193240Ssamstatic void 4091193240Ssammwl_setglobalkeys(struct ieee80211vap *vap) 4092193240Ssam{ 4093193240Ssam struct ieee80211_key *wk; 4094193240Ssam 4095193240Ssam wk = &vap->iv_nw_keys[0]; 4096193240Ssam for (; wk < &vap->iv_nw_keys[IEEE80211_WEP_NKID]; wk++) 4097193240Ssam if (wk->wk_keyix != IEEE80211_KEYIX_NONE) 4098193240Ssam (void) mwl_key_set(vap, wk, vap->iv_myaddr); 4099193240Ssam} 4100193240Ssam 4101193240Ssam/* 4102195171Ssam * Convert a legacy rate set to a firmware bitmask. 4103195171Ssam */ 4104195171Ssamstatic uint32_t 4105195171Ssamget_rate_bitmap(const struct ieee80211_rateset *rs) 4106195171Ssam{ 4107195171Ssam uint32_t rates; 4108195171Ssam int i; 4109195171Ssam 4110195171Ssam rates = 0; 4111195171Ssam for (i = 0; i < rs->rs_nrates; i++) 4112195171Ssam switch (rs->rs_rates[i] & IEEE80211_RATE_VAL) { 4113195171Ssam case 2: rates |= 0x001; break; 4114195171Ssam case 4: rates |= 0x002; break; 4115195171Ssam case 11: rates |= 0x004; break; 4116195171Ssam case 22: rates |= 0x008; break; 4117195171Ssam case 44: rates |= 0x010; break; 4118195171Ssam case 12: rates |= 0x020; break; 4119195171Ssam case 18: rates |= 0x040; break; 4120195171Ssam case 24: rates |= 0x080; break; 4121195171Ssam case 36: rates |= 0x100; break; 4122195171Ssam case 48: rates |= 0x200; break; 4123195171Ssam case 72: rates |= 0x400; break; 4124195171Ssam case 96: rates |= 0x800; break; 4125195171Ssam case 108: rates |= 0x1000; break; 4126195171Ssam } 4127195171Ssam return rates; 4128195171Ssam} 4129195171Ssam 4130195171Ssam/* 4131195171Ssam * Construct an HT firmware bitmask from an HT rate set. 4132195171Ssam */ 4133195171Ssamstatic uint32_t 4134195171Ssamget_htrate_bitmap(const struct ieee80211_htrateset *rs) 4135195171Ssam{ 4136195171Ssam uint32_t rates; 4137195171Ssam int i; 4138195171Ssam 4139195171Ssam rates = 0; 4140195171Ssam for (i = 0; i < rs->rs_nrates; i++) { 4141195171Ssam if (rs->rs_rates[i] < 16) 4142195171Ssam rates |= 1<<rs->rs_rates[i]; 4143195171Ssam } 4144195171Ssam return rates; 4145195171Ssam} 4146195171Ssam 4147195171Ssam/* 4148195171Ssam * Craft station database entry for station. 4149195171Ssam * NB: use host byte order here, the hal handles byte swapping. 4150195171Ssam */ 4151195171Ssamstatic MWL_HAL_PEERINFO * 4152195171Ssammkpeerinfo(MWL_HAL_PEERINFO *pi, const struct ieee80211_node *ni) 4153195171Ssam{ 4154195171Ssam const struct ieee80211vap *vap = ni->ni_vap; 4155195171Ssam 4156195171Ssam memset(pi, 0, sizeof(*pi)); 4157195171Ssam pi->LegacyRateBitMap = get_rate_bitmap(&ni->ni_rates); 4158195171Ssam pi->CapInfo = ni->ni_capinfo; 4159195171Ssam if (ni->ni_flags & IEEE80211_NODE_HT) { 4160195171Ssam /* HT capabilities, etc */ 4161195171Ssam pi->HTCapabilitiesInfo = ni->ni_htcap; 4162195171Ssam /* XXX pi.HTCapabilitiesInfo */ 4163195171Ssam pi->MacHTParamInfo = ni->ni_htparam; 4164195171Ssam pi->HTRateBitMap = get_htrate_bitmap(&ni->ni_htrates); 4165195171Ssam pi->AddHtInfo.ControlChan = ni->ni_htctlchan; 4166195171Ssam pi->AddHtInfo.AddChan = ni->ni_ht2ndchan; 4167195171Ssam pi->AddHtInfo.OpMode = ni->ni_htopmode; 4168195171Ssam pi->AddHtInfo.stbc = ni->ni_htstbc; 4169195171Ssam 4170195171Ssam /* constrain according to local configuration */ 4171195171Ssam if ((vap->iv_flags_ht & IEEE80211_FHT_SHORTGI40) == 0) 4172195171Ssam pi->HTCapabilitiesInfo &= ~IEEE80211_HTCAP_SHORTGI40; 4173195171Ssam if ((vap->iv_flags_ht & IEEE80211_FHT_SHORTGI20) == 0) 4174195171Ssam pi->HTCapabilitiesInfo &= ~IEEE80211_HTCAP_SHORTGI20; 4175195171Ssam if (ni->ni_chw != 40) 4176195171Ssam pi->HTCapabilitiesInfo &= ~IEEE80211_HTCAP_CHWIDTH40; 4177195171Ssam } 4178195171Ssam return pi; 4179195171Ssam} 4180195171Ssam 4181195171Ssam/* 4182193240Ssam * Re-create the local sta db entry for a vap to ensure 4183193240Ssam * up to date WME state is pushed to the firmware. Because 4184193240Ssam * this resets crypto state this must be followed by a 4185193240Ssam * reload of any keys in the global key table. 4186193240Ssam */ 4187193240Ssamstatic int 4188193240Ssammwl_localstadb(struct ieee80211vap *vap) 4189193240Ssam{ 4190193240Ssam#define WME(ie) ((const struct ieee80211_wme_info *) ie) 4191193240Ssam struct mwl_hal_vap *hvap = MWL_VAP(vap)->mv_hvap; 4192193240Ssam struct ieee80211_node *bss; 4193195171Ssam MWL_HAL_PEERINFO pi; 4194193240Ssam int error; 4195193240Ssam 4196193240Ssam switch (vap->iv_opmode) { 4197193240Ssam case IEEE80211_M_STA: 4198193240Ssam bss = vap->iv_bss; 4199195171Ssam error = mwl_hal_newstation(hvap, vap->iv_myaddr, 0, 0, 4200195171Ssam vap->iv_state == IEEE80211_S_RUN ? 4201195171Ssam mkpeerinfo(&pi, bss) : NULL, 4202195171Ssam (bss->ni_flags & (IEEE80211_NODE_QOS | IEEE80211_NODE_HT)), 4203193240Ssam bss->ni_ies.wme_ie != NULL ? 4204193240Ssam WME(bss->ni_ies.wme_ie)->wme_info : 0); 4205193240Ssam if (error == 0) 4206193240Ssam mwl_setglobalkeys(vap); 4207193240Ssam break; 4208193240Ssam case IEEE80211_M_HOSTAP: 4209195618Srpaulo case IEEE80211_M_MBSS: 4210193240Ssam error = mwl_hal_newstation(hvap, vap->iv_myaddr, 4211193240Ssam 0, 0, NULL, vap->iv_flags & IEEE80211_F_WME, 0); 4212193240Ssam if (error == 0) 4213193240Ssam mwl_setglobalkeys(vap); 4214193240Ssam break; 4215193240Ssam default: 4216193240Ssam error = 0; 4217193240Ssam break; 4218193240Ssam } 4219193240Ssam return error; 4220193240Ssam#undef WME 4221193240Ssam} 4222193240Ssam 4223193240Ssamstatic int 4224193240Ssammwl_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 4225193240Ssam{ 4226193240Ssam struct mwl_vap *mvp = MWL_VAP(vap); 4227193240Ssam struct mwl_hal_vap *hvap = mvp->mv_hvap; 4228193240Ssam struct ieee80211com *ic = vap->iv_ic; 4229193240Ssam struct ieee80211_node *ni = NULL; 4230193240Ssam struct ifnet *ifp = ic->ic_ifp; 4231193240Ssam struct mwl_softc *sc = ifp->if_softc; 4232193240Ssam struct mwl_hal *mh = sc->sc_mh; 4233193240Ssam enum ieee80211_state ostate = vap->iv_state; 4234193240Ssam int error; 4235193240Ssam 4236193240Ssam DPRINTF(sc, MWL_DEBUG_STATE, "%s: %s: %s -> %s\n", 4237193240Ssam vap->iv_ifp->if_xname, __func__, 4238193240Ssam ieee80211_state_name[ostate], ieee80211_state_name[nstate]); 4239193240Ssam 4240193240Ssam callout_stop(&sc->sc_timer); 4241193240Ssam /* 4242193240Ssam * Clear current radar detection state. 4243193240Ssam */ 4244193240Ssam if (ostate == IEEE80211_S_CAC) { 4245193240Ssam /* stop quiet mode radar detection */ 4246193240Ssam mwl_hal_setradardetection(mh, DR_CHK_CHANNEL_AVAILABLE_STOP); 4247193240Ssam } else if (sc->sc_radarena) { 4248193240Ssam /* stop in-service radar detection */ 4249193240Ssam mwl_hal_setradardetection(mh, DR_DFS_DISABLE); 4250193240Ssam sc->sc_radarena = 0; 4251193240Ssam } 4252193240Ssam /* 4253193240Ssam * Carry out per-state actions before doing net80211 work. 4254193240Ssam */ 4255193240Ssam if (nstate == IEEE80211_S_INIT) { 4256193240Ssam /* NB: only ap+sta vap's have a fw entity */ 4257193240Ssam if (hvap != NULL) 4258193240Ssam mwl_hal_stop(hvap); 4259193240Ssam } else if (nstate == IEEE80211_S_SCAN) { 4260193240Ssam mwl_hal_start(hvap); 4261193240Ssam /* NB: this disables beacon frames */ 4262193240Ssam mwl_hal_setinframode(hvap); 4263193240Ssam } else if (nstate == IEEE80211_S_AUTH) { 4264193240Ssam /* 4265193240Ssam * Must create a sta db entry in case a WEP key needs to 4266193240Ssam * be plumbed. This entry will be overwritten if we 4267193240Ssam * associate; otherwise it will be reclaimed on node free. 4268193240Ssam */ 4269193240Ssam ni = vap->iv_bss; 4270193240Ssam MWL_NODE(ni)->mn_hvap = hvap; 4271193240Ssam (void) mwl_peerstadb(ni, 0, 0, NULL); 4272193240Ssam } else if (nstate == IEEE80211_S_CSA) { 4273193240Ssam /* XXX move to below? */ 4274195618Srpaulo if (vap->iv_opmode == IEEE80211_M_HOSTAP || 4275195618Srpaulo vap->iv_opmode == IEEE80211_M_MBSS) 4276193240Ssam mwl_startcsa(vap); 4277193240Ssam } else if (nstate == IEEE80211_S_CAC) { 4278193240Ssam /* XXX move to below? */ 4279193240Ssam /* stop ap xmit and enable quiet mode radar detection */ 4280193240Ssam mwl_hal_setradardetection(mh, DR_CHK_CHANNEL_AVAILABLE_START); 4281193240Ssam } 4282193240Ssam 4283193240Ssam /* 4284193240Ssam * Invoke the parent method to do net80211 work. 4285193240Ssam */ 4286193240Ssam error = mvp->mv_newstate(vap, nstate, arg); 4287193240Ssam 4288193240Ssam /* 4289193240Ssam * Carry out work that must be done after net80211 runs; 4290193240Ssam * this work requires up to date state (e.g. iv_bss). 4291193240Ssam */ 4292193240Ssam if (error == 0 && nstate == IEEE80211_S_RUN) { 4293193240Ssam /* NB: collect bss node again, it may have changed */ 4294193240Ssam ni = vap->iv_bss; 4295193240Ssam 4296193240Ssam DPRINTF(sc, MWL_DEBUG_STATE, 4297193240Ssam "%s: %s(RUN): iv_flags 0x%08x bintvl %d bssid %s " 4298193240Ssam "capinfo 0x%04x chan %d\n", 4299193240Ssam vap->iv_ifp->if_xname, __func__, vap->iv_flags, 4300193240Ssam ni->ni_intval, ether_sprintf(ni->ni_bssid), ni->ni_capinfo, 4301193240Ssam ieee80211_chan2ieee(ic, ic->ic_curchan)); 4302193240Ssam 4303193240Ssam /* 4304195171Ssam * Recreate local sta db entry to update WME/HT state. 4305193240Ssam */ 4306193240Ssam mwl_localstadb(vap); 4307193240Ssam switch (vap->iv_opmode) { 4308193240Ssam case IEEE80211_M_HOSTAP: 4309195618Srpaulo case IEEE80211_M_MBSS: 4310193240Ssam if (ostate == IEEE80211_S_CAC) { 4311193240Ssam /* enable in-service radar detection */ 4312193240Ssam mwl_hal_setradardetection(mh, 4313193240Ssam DR_IN_SERVICE_MONITOR_START); 4314193240Ssam sc->sc_radarena = 1; 4315193240Ssam } 4316193240Ssam /* 4317193240Ssam * Allocate and setup the beacon frame 4318193240Ssam * (and related state). 4319193240Ssam */ 4320193240Ssam error = mwl_reset_vap(vap, IEEE80211_S_RUN); 4321193240Ssam if (error != 0) { 4322193240Ssam DPRINTF(sc, MWL_DEBUG_STATE, 4323193240Ssam "%s: beacon setup failed, error %d\n", 4324193240Ssam __func__, error); 4325193240Ssam goto bad; 4326193240Ssam } 4327193240Ssam /* NB: must be after setting up beacon */ 4328193240Ssam mwl_hal_start(hvap); 4329193240Ssam break; 4330193240Ssam case IEEE80211_M_STA: 4331193240Ssam DPRINTF(sc, MWL_DEBUG_STATE, "%s: %s: aid 0x%x\n", 4332193240Ssam vap->iv_ifp->if_xname, __func__, ni->ni_associd); 4333193240Ssam /* 4334193240Ssam * Set state now that we're associated. 4335193240Ssam */ 4336193240Ssam mwl_hal_setassocid(hvap, ni->ni_bssid, ni->ni_associd); 4337193240Ssam mwl_setrates(vap); 4338193240Ssam mwl_hal_setrtsthreshold(hvap, vap->iv_rtsthreshold); 4339195171Ssam if ((vap->iv_flags & IEEE80211_F_DWDS) && 4340195171Ssam sc->sc_ndwdsvaps++ == 0) 4341195171Ssam mwl_hal_setdwds(mh, 1); 4342193240Ssam break; 4343193240Ssam case IEEE80211_M_WDS: 4344193240Ssam DPRINTF(sc, MWL_DEBUG_STATE, "%s: %s: bssid %s\n", 4345193240Ssam vap->iv_ifp->if_xname, __func__, 4346193240Ssam ether_sprintf(ni->ni_bssid)); 4347193240Ssam mwl_seteapolformat(vap); 4348193240Ssam break; 4349193240Ssam default: 4350193240Ssam break; 4351193240Ssam } 4352193240Ssam /* 4353193240Ssam * Set CS mode according to operating channel; 4354193240Ssam * this mostly an optimization for 5GHz. 4355193240Ssam * 4356193240Ssam * NB: must follow mwl_hal_start which resets csmode 4357193240Ssam */ 4358193240Ssam if (IEEE80211_IS_CHAN_5GHZ(ic->ic_bsschan)) 4359193240Ssam mwl_hal_setcsmode(mh, CSMODE_AGGRESSIVE); 4360193240Ssam else 4361193240Ssam mwl_hal_setcsmode(mh, CSMODE_AUTO_ENA); 4362193240Ssam /* 4363193240Ssam * Start timer to prod firmware. 4364193240Ssam */ 4365193240Ssam if (sc->sc_ageinterval != 0) 4366193240Ssam callout_reset(&sc->sc_timer, sc->sc_ageinterval*hz, 4367193240Ssam mwl_agestations, sc); 4368193240Ssam } else if (nstate == IEEE80211_S_SLEEP) { 4369193240Ssam /* XXX set chip in power save */ 4370195171Ssam } else if ((vap->iv_flags & IEEE80211_F_DWDS) && 4371195171Ssam --sc->sc_ndwdsvaps == 0) 4372195171Ssam mwl_hal_setdwds(mh, 0); 4373193240Ssambad: 4374193240Ssam return error; 4375193240Ssam} 4376193240Ssam 4377193240Ssam/* 4378193240Ssam * Manage station id's; these are separate from AID's 4379193240Ssam * as AID's may have values out of the range of possible 4380193240Ssam * station id's acceptable to the firmware. 4381193240Ssam */ 4382193240Ssamstatic int 4383193240Ssamallocstaid(struct mwl_softc *sc, int aid) 4384193240Ssam{ 4385193240Ssam int staid; 4386193240Ssam 4387193240Ssam if (!(0 < aid && aid < MWL_MAXSTAID) || isset(sc->sc_staid, aid)) { 4388193240Ssam /* NB: don't use 0 */ 4389193240Ssam for (staid = 1; staid < MWL_MAXSTAID; staid++) 4390193240Ssam if (isclr(sc->sc_staid, staid)) 4391193240Ssam break; 4392193240Ssam } else 4393193240Ssam staid = aid; 4394193240Ssam setbit(sc->sc_staid, staid); 4395193240Ssam return staid; 4396193240Ssam} 4397193240Ssam 4398193240Ssamstatic void 4399193240Ssamdelstaid(struct mwl_softc *sc, int staid) 4400193240Ssam{ 4401193240Ssam clrbit(sc->sc_staid, staid); 4402193240Ssam} 4403193240Ssam 4404193240Ssam/* 4405193240Ssam * Setup driver-specific state for a newly associated node. 4406193240Ssam * Note that we're called also on a re-associate, the isnew 4407193240Ssam * param tells us if this is the first time or not. 4408193240Ssam */ 4409193240Ssamstatic void 4410193240Ssammwl_newassoc(struct ieee80211_node *ni, int isnew) 4411193240Ssam{ 4412193240Ssam struct ieee80211vap *vap = ni->ni_vap; 4413193240Ssam struct mwl_softc *sc = vap->iv_ic->ic_ifp->if_softc; 4414193240Ssam struct mwl_node *mn = MWL_NODE(ni); 4415193240Ssam MWL_HAL_PEERINFO pi; 4416193240Ssam uint16_t aid; 4417193240Ssam int error; 4418193240Ssam 4419193240Ssam aid = IEEE80211_AID(ni->ni_associd); 4420193240Ssam if (isnew) { 4421193240Ssam mn->mn_staid = allocstaid(sc, aid); 4422193240Ssam mn->mn_hvap = MWL_VAP(vap)->mv_hvap; 4423193240Ssam } else { 4424193240Ssam mn = MWL_NODE(ni); 4425193240Ssam /* XXX reset BA stream? */ 4426193240Ssam } 4427193240Ssam DPRINTF(sc, MWL_DEBUG_NODE, "%s: mac %s isnew %d aid %d staid %d\n", 4428193240Ssam __func__, ether_sprintf(ni->ni_macaddr), isnew, aid, mn->mn_staid); 4429195171Ssam error = mwl_peerstadb(ni, aid, mn->mn_staid, mkpeerinfo(&pi, ni)); 4430193240Ssam if (error != 0) { 4431193240Ssam DPRINTF(sc, MWL_DEBUG_NODE, 4432193240Ssam "%s: error %d creating sta db entry\n", 4433193240Ssam __func__, error); 4434193240Ssam /* XXX how to deal with error? */ 4435193240Ssam } 4436193240Ssam} 4437193240Ssam 4438193240Ssam/* 4439193240Ssam * Periodically poke the firmware to age out station state 4440193240Ssam * (power save queues, pending tx aggregates). 4441193240Ssam */ 4442193240Ssamstatic void 4443193240Ssammwl_agestations(void *arg) 4444193240Ssam{ 4445193240Ssam struct mwl_softc *sc = arg; 4446193240Ssam 4447193240Ssam mwl_hal_setkeepalive(sc->sc_mh); 4448193240Ssam if (sc->sc_ageinterval != 0) /* NB: catch dynamic changes */ 4449195171Ssam callout_schedule(&sc->sc_timer, sc->sc_ageinterval*hz); 4450193240Ssam} 4451193240Ssam 4452193240Ssamstatic const struct mwl_hal_channel * 4453193240Ssamfindhalchannel(const MWL_HAL_CHANNELINFO *ci, int ieee) 4454193240Ssam{ 4455193240Ssam int i; 4456193240Ssam 4457193240Ssam for (i = 0; i < ci->nchannels; i++) { 4458193240Ssam const struct mwl_hal_channel *hc = &ci->channels[i]; 4459193240Ssam if (hc->ieee == ieee) 4460193240Ssam return hc; 4461193240Ssam } 4462193240Ssam return NULL; 4463193240Ssam} 4464193240Ssam 4465193240Ssamstatic int 4466193240Ssammwl_setregdomain(struct ieee80211com *ic, struct ieee80211_regdomain *rd, 4467193240Ssam int nchan, struct ieee80211_channel chans[]) 4468193240Ssam{ 4469193240Ssam struct mwl_softc *sc = ic->ic_ifp->if_softc; 4470193240Ssam struct mwl_hal *mh = sc->sc_mh; 4471193240Ssam const MWL_HAL_CHANNELINFO *ci; 4472193240Ssam int i; 4473193240Ssam 4474193240Ssam for (i = 0; i < nchan; i++) { 4475193240Ssam struct ieee80211_channel *c = &chans[i]; 4476193240Ssam const struct mwl_hal_channel *hc; 4477193240Ssam 4478193240Ssam if (IEEE80211_IS_CHAN_2GHZ(c)) { 4479193240Ssam mwl_hal_getchannelinfo(mh, MWL_FREQ_BAND_2DOT4GHZ, 4480193240Ssam IEEE80211_IS_CHAN_HT40(c) ? 4481193240Ssam MWL_CH_40_MHz_WIDTH : MWL_CH_20_MHz_WIDTH, &ci); 4482193240Ssam } else if (IEEE80211_IS_CHAN_5GHZ(c)) { 4483193240Ssam mwl_hal_getchannelinfo(mh, MWL_FREQ_BAND_5GHZ, 4484193240Ssam IEEE80211_IS_CHAN_HT40(c) ? 4485193240Ssam MWL_CH_40_MHz_WIDTH : MWL_CH_20_MHz_WIDTH, &ci); 4486193240Ssam } else { 4487193240Ssam if_printf(ic->ic_ifp, 4488193240Ssam "%s: channel %u freq %u/0x%x not 2.4/5GHz\n", 4489193240Ssam __func__, c->ic_ieee, c->ic_freq, c->ic_flags); 4490193240Ssam return EINVAL; 4491193240Ssam } 4492193240Ssam /* 4493193240Ssam * Verify channel has cal data and cap tx power. 4494193240Ssam */ 4495193240Ssam hc = findhalchannel(ci, c->ic_ieee); 4496193240Ssam if (hc != NULL) { 4497193240Ssam if (c->ic_maxpower > 2*hc->maxTxPow) 4498193240Ssam c->ic_maxpower = 2*hc->maxTxPow; 4499193240Ssam goto next; 4500193240Ssam } 4501193240Ssam if (IEEE80211_IS_CHAN_HT40(c)) { 4502193240Ssam /* 4503193240Ssam * Look for the extension channel since the 4504193240Ssam * hal table only has the primary channel. 4505193240Ssam */ 4506193240Ssam hc = findhalchannel(ci, c->ic_extieee); 4507193240Ssam if (hc != NULL) { 4508193240Ssam if (c->ic_maxpower > 2*hc->maxTxPow) 4509193240Ssam c->ic_maxpower = 2*hc->maxTxPow; 4510193240Ssam goto next; 4511193240Ssam } 4512193240Ssam } 4513193240Ssam if_printf(ic->ic_ifp, 4514193240Ssam "%s: no cal data for channel %u ext %u freq %u/0x%x\n", 4515193240Ssam __func__, c->ic_ieee, c->ic_extieee, 4516193240Ssam c->ic_freq, c->ic_flags); 4517193240Ssam return EINVAL; 4518193240Ssam next: 4519193240Ssam ; 4520193240Ssam } 4521193240Ssam return 0; 4522193240Ssam} 4523193240Ssam 4524193240Ssam#define IEEE80211_CHAN_HTG (IEEE80211_CHAN_HT|IEEE80211_CHAN_G) 4525193240Ssam#define IEEE80211_CHAN_HTA (IEEE80211_CHAN_HT|IEEE80211_CHAN_A) 4526193240Ssam 4527193240Ssamstatic void 4528193240Ssamaddchan(struct ieee80211_channel *c, int freq, int flags, int ieee, int txpow) 4529193240Ssam{ 4530193240Ssam c->ic_freq = freq; 4531193240Ssam c->ic_flags = flags; 4532193240Ssam c->ic_ieee = ieee; 4533193240Ssam c->ic_minpower = 0; 4534193240Ssam c->ic_maxpower = 2*txpow; 4535193240Ssam c->ic_maxregpower = txpow; 4536193240Ssam} 4537193240Ssam 4538193240Ssamstatic const struct ieee80211_channel * 4539193240Ssamfindchannel(const struct ieee80211_channel chans[], int nchans, 4540193240Ssam int freq, int flags) 4541193240Ssam{ 4542193240Ssam const struct ieee80211_channel *c; 4543193240Ssam int i; 4544193240Ssam 4545193240Ssam for (i = 0; i < nchans; i++) { 4546193240Ssam c = &chans[i]; 4547193240Ssam if (c->ic_freq == freq && c->ic_flags == flags) 4548193240Ssam return c; 4549193240Ssam } 4550193240Ssam return NULL; 4551193240Ssam} 4552193240Ssam 4553193240Ssamstatic void 4554193240Ssamaddht40channels(struct ieee80211_channel chans[], int maxchans, int *nchans, 4555193240Ssam const MWL_HAL_CHANNELINFO *ci, int flags) 4556193240Ssam{ 4557193240Ssam struct ieee80211_channel *c; 4558193240Ssam const struct ieee80211_channel *extc; 4559193240Ssam const struct mwl_hal_channel *hc; 4560193240Ssam int i; 4561193240Ssam 4562193240Ssam c = &chans[*nchans]; 4563193240Ssam 4564193240Ssam flags &= ~IEEE80211_CHAN_HT; 4565193240Ssam for (i = 0; i < ci->nchannels; i++) { 4566193240Ssam /* 4567193240Ssam * Each entry defines an HT40 channel pair; find the 4568193240Ssam * extension channel above and the insert the pair. 4569193240Ssam */ 4570193240Ssam hc = &ci->channels[i]; 4571193240Ssam extc = findchannel(chans, *nchans, hc->freq+20, 4572193240Ssam flags | IEEE80211_CHAN_HT20); 4573193240Ssam if (extc != NULL) { 4574193240Ssam if (*nchans >= maxchans) 4575193240Ssam break; 4576193240Ssam addchan(c, hc->freq, flags | IEEE80211_CHAN_HT40U, 4577193240Ssam hc->ieee, hc->maxTxPow); 4578193240Ssam c->ic_extieee = extc->ic_ieee; 4579193240Ssam c++, (*nchans)++; 4580193240Ssam if (*nchans >= maxchans) 4581193240Ssam break; 4582193240Ssam addchan(c, extc->ic_freq, flags | IEEE80211_CHAN_HT40D, 4583193240Ssam extc->ic_ieee, hc->maxTxPow); 4584193240Ssam c->ic_extieee = hc->ieee; 4585193240Ssam c++, (*nchans)++; 4586193240Ssam } 4587193240Ssam } 4588193240Ssam} 4589193240Ssam 4590193240Ssamstatic void 4591193240Ssamaddchannels(struct ieee80211_channel chans[], int maxchans, int *nchans, 4592193240Ssam const MWL_HAL_CHANNELINFO *ci, int flags) 4593193240Ssam{ 4594193240Ssam struct ieee80211_channel *c; 4595193240Ssam int i; 4596193240Ssam 4597193240Ssam c = &chans[*nchans]; 4598193240Ssam 4599193240Ssam for (i = 0; i < ci->nchannels; i++) { 4600193240Ssam const struct mwl_hal_channel *hc; 4601193240Ssam 4602193240Ssam hc = &ci->channels[i]; 4603193240Ssam if (*nchans >= maxchans) 4604193240Ssam break; 4605193240Ssam addchan(c, hc->freq, flags, hc->ieee, hc->maxTxPow); 4606193240Ssam c++, (*nchans)++; 4607193240Ssam if (flags == IEEE80211_CHAN_G || flags == IEEE80211_CHAN_HTG) { 4608193240Ssam /* g channel have a separate b-only entry */ 4609193240Ssam if (*nchans >= maxchans) 4610193240Ssam break; 4611193240Ssam c[0] = c[-1]; 4612193240Ssam c[-1].ic_flags = IEEE80211_CHAN_B; 4613193240Ssam c++, (*nchans)++; 4614193240Ssam } 4615193240Ssam if (flags == IEEE80211_CHAN_HTG) { 4616193240Ssam /* HT g channel have a separate g-only entry */ 4617193240Ssam if (*nchans >= maxchans) 4618193240Ssam break; 4619193240Ssam c[-1].ic_flags = IEEE80211_CHAN_G; 4620193240Ssam c[0] = c[-1]; 4621193240Ssam c[0].ic_flags &= ~IEEE80211_CHAN_HT; 4622193240Ssam c[0].ic_flags |= IEEE80211_CHAN_HT20; /* HT20 */ 4623193240Ssam c++, (*nchans)++; 4624193240Ssam } 4625193240Ssam if (flags == IEEE80211_CHAN_HTA) { 4626193240Ssam /* HT a channel have a separate a-only entry */ 4627193240Ssam if (*nchans >= maxchans) 4628193240Ssam break; 4629193240Ssam c[-1].ic_flags = IEEE80211_CHAN_A; 4630193240Ssam c[0] = c[-1]; 4631193240Ssam c[0].ic_flags &= ~IEEE80211_CHAN_HT; 4632193240Ssam c[0].ic_flags |= IEEE80211_CHAN_HT20; /* HT20 */ 4633193240Ssam c++, (*nchans)++; 4634193240Ssam } 4635193240Ssam } 4636193240Ssam} 4637193240Ssam 4638193240Ssamstatic void 4639193240Ssamgetchannels(struct mwl_softc *sc, int maxchans, int *nchans, 4640193240Ssam struct ieee80211_channel chans[]) 4641193240Ssam{ 4642193240Ssam const MWL_HAL_CHANNELINFO *ci; 4643193240Ssam 4644193240Ssam /* 4645193240Ssam * Use the channel info from the hal to craft the 4646193240Ssam * channel list. Note that we pass back an unsorted 4647193240Ssam * list; the caller is required to sort it for us 4648193240Ssam * (if desired). 4649193240Ssam */ 4650193240Ssam *nchans = 0; 4651193240Ssam if (mwl_hal_getchannelinfo(sc->sc_mh, 4652193240Ssam MWL_FREQ_BAND_2DOT4GHZ, MWL_CH_20_MHz_WIDTH, &ci) == 0) 4653193240Ssam addchannels(chans, maxchans, nchans, ci, IEEE80211_CHAN_HTG); 4654193240Ssam if (mwl_hal_getchannelinfo(sc->sc_mh, 4655193240Ssam MWL_FREQ_BAND_5GHZ, MWL_CH_20_MHz_WIDTH, &ci) == 0) 4656193240Ssam addchannels(chans, maxchans, nchans, ci, IEEE80211_CHAN_HTA); 4657193240Ssam if (mwl_hal_getchannelinfo(sc->sc_mh, 4658193240Ssam MWL_FREQ_BAND_2DOT4GHZ, MWL_CH_40_MHz_WIDTH, &ci) == 0) 4659193240Ssam addht40channels(chans, maxchans, nchans, ci, IEEE80211_CHAN_HTG); 4660193240Ssam if (mwl_hal_getchannelinfo(sc->sc_mh, 4661193240Ssam MWL_FREQ_BAND_5GHZ, MWL_CH_40_MHz_WIDTH, &ci) == 0) 4662193240Ssam addht40channels(chans, maxchans, nchans, ci, IEEE80211_CHAN_HTA); 4663193240Ssam} 4664193240Ssam 4665193240Ssamstatic void 4666193240Ssammwl_getradiocaps(struct ieee80211com *ic, 4667193240Ssam int maxchans, int *nchans, struct ieee80211_channel chans[]) 4668193240Ssam{ 4669193240Ssam struct mwl_softc *sc = ic->ic_ifp->if_softc; 4670193240Ssam 4671193240Ssam getchannels(sc, maxchans, nchans, chans); 4672193240Ssam} 4673193240Ssam 4674193240Ssamstatic int 4675193240Ssammwl_getchannels(struct mwl_softc *sc) 4676193240Ssam{ 4677193240Ssam struct ifnet *ifp = sc->sc_ifp; 4678193240Ssam struct ieee80211com *ic = ifp->if_l2com; 4679193240Ssam 4680193240Ssam /* 4681193240Ssam * Use the channel info from the hal to craft the 4682193240Ssam * channel list for net80211. Note that we pass up 4683193240Ssam * an unsorted list; net80211 will sort it for us. 4684193240Ssam */ 4685193240Ssam memset(ic->ic_channels, 0, sizeof(ic->ic_channels)); 4686193240Ssam ic->ic_nchans = 0; 4687193240Ssam getchannels(sc, IEEE80211_CHAN_MAX, &ic->ic_nchans, ic->ic_channels); 4688193240Ssam 4689193240Ssam ic->ic_regdomain.regdomain = SKU_DEBUG; 4690193240Ssam ic->ic_regdomain.country = CTRY_DEFAULT; 4691193240Ssam ic->ic_regdomain.location = 'I'; 4692193240Ssam ic->ic_regdomain.isocc[0] = ' '; /* XXX? */ 4693193240Ssam ic->ic_regdomain.isocc[1] = ' '; 4694193240Ssam return (ic->ic_nchans == 0 ? EIO : 0); 4695193240Ssam} 4696193240Ssam#undef IEEE80211_CHAN_HTA 4697193240Ssam#undef IEEE80211_CHAN_HTG 4698193240Ssam 4699193240Ssam#ifdef MWL_DEBUG 4700193240Ssamstatic void 4701193240Ssammwl_printrxbuf(const struct mwl_rxbuf *bf, u_int ix) 4702193240Ssam{ 4703193240Ssam const struct mwl_rxdesc *ds = bf->bf_desc; 4704193240Ssam uint32_t status = le32toh(ds->Status); 4705193240Ssam 4706193240Ssam printf("R[%2u] (DS.V:%p DS.P:%p) NEXT:%08x DATA:%08x RC:%02x%s\n" 4707193240Ssam " STAT:%02x LEN:%04x RSSI:%02x CHAN:%02x RATE:%02x QOS:%04x HT:%04x\n", 4708193240Ssam ix, ds, (const struct mwl_desc *)bf->bf_daddr, 4709193240Ssam le32toh(ds->pPhysNext), le32toh(ds->pPhysBuffData), 4710193240Ssam ds->RxControl, 4711193240Ssam ds->RxControl != EAGLE_RXD_CTRL_DRIVER_OWN ? 4712193240Ssam "" : (status & EAGLE_RXD_STATUS_OK) ? " *" : " !", 4713193240Ssam ds->Status, le16toh(ds->PktLen), ds->RSSI, ds->Channel, 4714193240Ssam ds->Rate, le16toh(ds->QosCtrl), le16toh(ds->HtSig2)); 4715193240Ssam} 4716193240Ssam 4717193240Ssamstatic void 4718193240Ssammwl_printtxbuf(const struct mwl_txbuf *bf, u_int qnum, u_int ix) 4719193240Ssam{ 4720193240Ssam const struct mwl_txdesc *ds = bf->bf_desc; 4721193240Ssam uint32_t status = le32toh(ds->Status); 4722193240Ssam 4723193240Ssam printf("Q%u[%3u]", qnum, ix); 4724193240Ssam printf(" (DS.V:%p DS.P:%p)\n", 4725193240Ssam ds, (const struct mwl_txdesc *)bf->bf_daddr); 4726193240Ssam printf(" NEXT:%08x DATA:%08x LEN:%04x STAT:%08x%s\n", 4727193240Ssam le32toh(ds->pPhysNext), 4728193240Ssam le32toh(ds->PktPtr), le16toh(ds->PktLen), status, 4729193240Ssam status & EAGLE_TXD_STATUS_USED ? 4730193240Ssam "" : (status & 3) != 0 ? " *" : " !"); 4731193240Ssam printf(" RATE:%02x PRI:%x QOS:%04x SAP:%08x FORMAT:%04x\n", 4732193240Ssam ds->DataRate, ds->TxPriority, le16toh(ds->QosCtrl), 4733193240Ssam le32toh(ds->SapPktInfo), le16toh(ds->Format)); 4734193240Ssam#if MWL_TXDESC > 1 4735193240Ssam printf(" MULTIFRAMES:%u LEN:%04x %04x %04x %04x %04x %04x\n" 4736193240Ssam , le32toh(ds->multiframes) 4737193240Ssam , le16toh(ds->PktLenArray[0]), le16toh(ds->PktLenArray[1]) 4738193240Ssam , le16toh(ds->PktLenArray[2]), le16toh(ds->PktLenArray[3]) 4739193240Ssam , le16toh(ds->PktLenArray[4]), le16toh(ds->PktLenArray[5]) 4740193240Ssam ); 4741193240Ssam printf(" DATA:%08x %08x %08x %08x %08x %08x\n" 4742193240Ssam , le32toh(ds->PktPtrArray[0]), le32toh(ds->PktPtrArray[1]) 4743193240Ssam , le32toh(ds->PktPtrArray[2]), le32toh(ds->PktPtrArray[3]) 4744193240Ssam , le32toh(ds->PktPtrArray[4]), le32toh(ds->PktPtrArray[5]) 4745193240Ssam ); 4746193240Ssam#endif 4747193240Ssam#if 0 4748193240Ssam{ const uint8_t *cp = (const uint8_t *) ds; 4749193240Ssam int i; 4750193240Ssam for (i = 0; i < sizeof(struct mwl_txdesc); i++) { 4751193240Ssam printf("%02x ", cp[i]); 4752193240Ssam if (((i+1) % 16) == 0) 4753193240Ssam printf("\n"); 4754193240Ssam } 4755193240Ssam printf("\n"); 4756193240Ssam} 4757193240Ssam#endif 4758193240Ssam} 4759193240Ssam#endif /* MWL_DEBUG */ 4760193240Ssam 4761193240Ssam#if 0 4762193240Ssamstatic void 4763193240Ssammwl_txq_dump(struct mwl_txq *txq) 4764193240Ssam{ 4765193240Ssam struct mwl_txbuf *bf; 4766193240Ssam int i = 0; 4767193240Ssam 4768193240Ssam MWL_TXQ_LOCK(txq); 4769193240Ssam STAILQ_FOREACH(bf, &txq->active, bf_list) { 4770193240Ssam struct mwl_txdesc *ds = bf->bf_desc; 4771193240Ssam MWL_TXDESC_SYNC(txq, ds, 4772193240Ssam BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE); 4773193240Ssam#ifdef MWL_DEBUG 4774193240Ssam mwl_printtxbuf(bf, txq->qnum, i); 4775193240Ssam#endif 4776193240Ssam i++; 4777193240Ssam } 4778193240Ssam MWL_TXQ_UNLOCK(txq); 4779193240Ssam} 4780193240Ssam#endif 4781193240Ssam 4782193240Ssamstatic void 4783199559Sjhbmwl_watchdog(void *arg) 4784193240Ssam{ 4785199559Sjhb struct mwl_softc *sc; 4786199559Sjhb struct ifnet *ifp; 4787193240Ssam 4788199559Sjhb sc = arg; 4789199559Sjhb callout_reset(&sc->sc_watchdog, hz, mwl_watchdog, sc); 4790199559Sjhb if (sc->sc_tx_timer == 0 || --sc->sc_tx_timer > 0) 4791199559Sjhb return; 4792199559Sjhb 4793199559Sjhb ifp = sc->sc_ifp; 4794193240Ssam if ((ifp->if_drv_flags & IFF_DRV_RUNNING) && !sc->sc_invalid) { 4795193240Ssam if (mwl_hal_setkeepalive(sc->sc_mh)) 4796193240Ssam if_printf(ifp, "transmit timeout (firmware hung?)\n"); 4797193240Ssam else 4798193240Ssam if_printf(ifp, "transmit timeout\n"); 4799193240Ssam#if 0 4800193240Ssam mwl_reset(ifp); 4801193240Ssammwl_txq_dump(&sc->sc_txq[0]);/*XXX*/ 4802193240Ssam#endif 4803193240Ssam ifp->if_oerrors++; 4804193240Ssam sc->sc_stats.mst_watchdog++; 4805193240Ssam } 4806193240Ssam} 4807193240Ssam 4808193240Ssam#ifdef MWL_DIAGAPI 4809193240Ssam/* 4810193240Ssam * Diagnostic interface to the HAL. This is used by various 4811193240Ssam * tools to do things like retrieve register contents for 4812193240Ssam * debugging. The mechanism is intentionally opaque so that 4813193240Ssam * it can change frequently w/o concern for compatiblity. 4814193240Ssam */ 4815193240Ssamstatic int 4816193240Ssammwl_ioctl_diag(struct mwl_softc *sc, struct mwl_diag *md) 4817193240Ssam{ 4818193240Ssam struct mwl_hal *mh = sc->sc_mh; 4819193240Ssam u_int id = md->md_id & MWL_DIAG_ID; 4820193240Ssam void *indata = NULL; 4821193240Ssam void *outdata = NULL; 4822193240Ssam u_int32_t insize = md->md_in_size; 4823193240Ssam u_int32_t outsize = md->md_out_size; 4824193240Ssam int error = 0; 4825193240Ssam 4826193240Ssam if (md->md_id & MWL_DIAG_IN) { 4827193240Ssam /* 4828193240Ssam * Copy in data. 4829193240Ssam */ 4830193240Ssam indata = malloc(insize, M_TEMP, M_NOWAIT); 4831193240Ssam if (indata == NULL) { 4832193240Ssam error = ENOMEM; 4833193240Ssam goto bad; 4834193240Ssam } 4835193240Ssam error = copyin(md->md_in_data, indata, insize); 4836193240Ssam if (error) 4837193240Ssam goto bad; 4838193240Ssam } 4839193240Ssam if (md->md_id & MWL_DIAG_DYN) { 4840193240Ssam /* 4841193240Ssam * Allocate a buffer for the results (otherwise the HAL 4842193240Ssam * returns a pointer to a buffer where we can read the 4843193240Ssam * results). Note that we depend on the HAL leaving this 4844193240Ssam * pointer for us to use below in reclaiming the buffer; 4845193240Ssam * may want to be more defensive. 4846193240Ssam */ 4847193240Ssam outdata = malloc(outsize, M_TEMP, M_NOWAIT); 4848193240Ssam if (outdata == NULL) { 4849193240Ssam error = ENOMEM; 4850193240Ssam goto bad; 4851193240Ssam } 4852193240Ssam } 4853193240Ssam if (mwl_hal_getdiagstate(mh, id, indata, insize, &outdata, &outsize)) { 4854193240Ssam if (outsize < md->md_out_size) 4855193240Ssam md->md_out_size = outsize; 4856193240Ssam if (outdata != NULL) 4857193240Ssam error = copyout(outdata, md->md_out_data, 4858193240Ssam md->md_out_size); 4859193240Ssam } else { 4860193240Ssam error = EINVAL; 4861193240Ssam } 4862193240Ssambad: 4863193240Ssam if ((md->md_id & MWL_DIAG_IN) && indata != NULL) 4864193240Ssam free(indata, M_TEMP); 4865193240Ssam if ((md->md_id & MWL_DIAG_DYN) && outdata != NULL) 4866193240Ssam free(outdata, M_TEMP); 4867193240Ssam return error; 4868193240Ssam} 4869193240Ssam 4870193240Ssamstatic int 4871193240Ssammwl_ioctl_reset(struct mwl_softc *sc, struct mwl_diag *md) 4872193240Ssam{ 4873193240Ssam struct mwl_hal *mh = sc->sc_mh; 4874193240Ssam int error; 4875193240Ssam 4876193240Ssam MWL_LOCK_ASSERT(sc); 4877193240Ssam 4878193240Ssam if (md->md_id == 0 && mwl_hal_fwload(mh, NULL) != 0) { 4879193240Ssam device_printf(sc->sc_dev, "unable to load firmware\n"); 4880193240Ssam return EIO; 4881193240Ssam } 4882193240Ssam if (mwl_hal_gethwspecs(mh, &sc->sc_hwspecs) != 0) { 4883193240Ssam device_printf(sc->sc_dev, "unable to fetch h/w specs\n"); 4884193240Ssam return EIO; 4885193240Ssam } 4886193240Ssam error = mwl_setupdma(sc); 4887193240Ssam if (error != 0) { 4888193240Ssam /* NB: mwl_setupdma prints a msg */ 4889193240Ssam return error; 4890193240Ssam } 4891193240Ssam /* 4892193240Ssam * Reset tx/rx data structures; after reload we must 4893193240Ssam * re-start the driver's notion of the next xmit/recv. 4894193240Ssam */ 4895193240Ssam mwl_draintxq(sc); /* clear pending frames */ 4896193240Ssam mwl_resettxq(sc); /* rebuild tx q lists */ 4897193240Ssam sc->sc_rxnext = NULL; /* force rx to start at the list head */ 4898193240Ssam return 0; 4899193240Ssam} 4900193240Ssam#endif /* MWL_DIAGAPI */ 4901193240Ssam 4902193240Ssamstatic int 4903193240Ssammwl_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 4904193240Ssam{ 4905193240Ssam#define IS_RUNNING(ifp) \ 4906193240Ssam ((ifp->if_flags & IFF_UP) && (ifp->if_drv_flags & IFF_DRV_RUNNING)) 4907193240Ssam struct mwl_softc *sc = ifp->if_softc; 4908193240Ssam struct ieee80211com *ic = ifp->if_l2com; 4909193240Ssam struct ifreq *ifr = (struct ifreq *)data; 4910193240Ssam int error = 0, startall; 4911193240Ssam 4912193240Ssam switch (cmd) { 4913193240Ssam case SIOCSIFFLAGS: 4914193240Ssam MWL_LOCK(sc); 4915193240Ssam startall = 0; 4916193240Ssam if (IS_RUNNING(ifp)) { 4917193240Ssam /* 4918193240Ssam * To avoid rescanning another access point, 4919193240Ssam * do not call mwl_init() here. Instead, 4920193240Ssam * only reflect promisc mode settings. 4921193240Ssam */ 4922193240Ssam mwl_mode_init(sc); 4923193240Ssam } else if (ifp->if_flags & IFF_UP) { 4924193240Ssam /* 4925193240Ssam * Beware of being called during attach/detach 4926193240Ssam * to reset promiscuous mode. In that case we 4927193240Ssam * will still be marked UP but not RUNNING. 4928193240Ssam * However trying to re-init the interface 4929193240Ssam * is the wrong thing to do as we've already 4930193240Ssam * torn down much of our state. There's 4931193240Ssam * probably a better way to deal with this. 4932193240Ssam */ 4933193240Ssam if (!sc->sc_invalid) { 4934193240Ssam mwl_init_locked(sc); /* XXX lose error */ 4935193240Ssam startall = 1; 4936193240Ssam } 4937193240Ssam } else 4938193240Ssam mwl_stop_locked(ifp, 1); 4939193240Ssam MWL_UNLOCK(sc); 4940193240Ssam if (startall) 4941193240Ssam ieee80211_start_all(ic); 4942193240Ssam break; 4943193240Ssam case SIOCGMVSTATS: 4944193240Ssam mwl_hal_gethwstats(sc->sc_mh, &sc->sc_stats.hw_stats); 4945193240Ssam /* NB: embed these numbers to get a consistent view */ 4946193240Ssam sc->sc_stats.mst_tx_packets = ifp->if_opackets; 4947193240Ssam sc->sc_stats.mst_rx_packets = ifp->if_ipackets; 4948193240Ssam /* 4949193240Ssam * NB: Drop the softc lock in case of a page fault; 4950193240Ssam * we'll accept any potential inconsisentcy in the 4951193240Ssam * statistics. The alternative is to copy the data 4952193240Ssam * to a local structure. 4953193240Ssam */ 4954193240Ssam return copyout(&sc->sc_stats, 4955193240Ssam ifr->ifr_data, sizeof (sc->sc_stats)); 4956193240Ssam#ifdef MWL_DIAGAPI 4957193240Ssam case SIOCGMVDIAG: 4958193240Ssam /* XXX check privs */ 4959193240Ssam return mwl_ioctl_diag(sc, (struct mwl_diag *) ifr); 4960193240Ssam case SIOCGMVRESET: 4961193240Ssam /* XXX check privs */ 4962193240Ssam MWL_LOCK(sc); 4963193240Ssam error = mwl_ioctl_reset(sc,(struct mwl_diag *) ifr); 4964193240Ssam MWL_UNLOCK(sc); 4965193240Ssam break; 4966193240Ssam#endif /* MWL_DIAGAPI */ 4967193240Ssam case SIOCGIFMEDIA: 4968193240Ssam error = ifmedia_ioctl(ifp, ifr, &ic->ic_media, cmd); 4969193240Ssam break; 4970193240Ssam case SIOCGIFADDR: 4971193240Ssam error = ether_ioctl(ifp, cmd, data); 4972193240Ssam break; 4973193240Ssam default: 4974193240Ssam error = EINVAL; 4975193240Ssam break; 4976193240Ssam } 4977193240Ssam return error; 4978193240Ssam#undef IS_RUNNING 4979193240Ssam} 4980193240Ssam 4981193240Ssam#ifdef MWL_DEBUG 4982193240Ssamstatic int 4983193240Ssammwl_sysctl_debug(SYSCTL_HANDLER_ARGS) 4984193240Ssam{ 4985193240Ssam struct mwl_softc *sc = arg1; 4986193240Ssam int debug, error; 4987193240Ssam 4988193240Ssam debug = sc->sc_debug | (mwl_hal_getdebug(sc->sc_mh) << 24); 4989193240Ssam error = sysctl_handle_int(oidp, &debug, 0, req); 4990193240Ssam if (error || !req->newptr) 4991193240Ssam return error; 4992193240Ssam mwl_hal_setdebug(sc->sc_mh, debug >> 24); 4993193240Ssam sc->sc_debug = debug & 0x00ffffff; 4994193240Ssam return 0; 4995193240Ssam} 4996193240Ssam#endif /* MWL_DEBUG */ 4997193240Ssam 4998193240Ssamstatic void 4999193240Ssammwl_sysctlattach(struct mwl_softc *sc) 5000193240Ssam{ 5001193240Ssam#ifdef MWL_DEBUG 5002193240Ssam struct sysctl_ctx_list *ctx = device_get_sysctl_ctx(sc->sc_dev); 5003193240Ssam struct sysctl_oid *tree = device_get_sysctl_tree(sc->sc_dev); 5004193240Ssam 5005193240Ssam sc->sc_debug = mwl_debug; 5006193240Ssam SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(tree), OID_AUTO, 5007193240Ssam "debug", CTLTYPE_INT | CTLFLAG_RW, sc, 0, 5008193240Ssam mwl_sysctl_debug, "I", "control debugging printfs"); 5009193240Ssam#endif 5010193240Ssam} 5011193240Ssam 5012193240Ssam/* 5013193240Ssam * Announce various information on device/driver attach. 5014193240Ssam */ 5015193240Ssamstatic void 5016193240Ssammwl_announce(struct mwl_softc *sc) 5017193240Ssam{ 5018193240Ssam struct ifnet *ifp = sc->sc_ifp; 5019193240Ssam 5020193240Ssam if_printf(ifp, "Rev A%d hardware, v%d.%d.%d.%d firmware (regioncode %d)\n", 5021193240Ssam sc->sc_hwspecs.hwVersion, 5022193240Ssam (sc->sc_hwspecs.fwReleaseNumber>>24) & 0xff, 5023193240Ssam (sc->sc_hwspecs.fwReleaseNumber>>16) & 0xff, 5024193240Ssam (sc->sc_hwspecs.fwReleaseNumber>>8) & 0xff, 5025193240Ssam (sc->sc_hwspecs.fwReleaseNumber>>0) & 0xff, 5026193240Ssam sc->sc_hwspecs.regionCode); 5027193240Ssam sc->sc_fwrelease = sc->sc_hwspecs.fwReleaseNumber; 5028193240Ssam 5029193240Ssam if (bootverbose) { 5030193240Ssam int i; 5031193240Ssam for (i = 0; i <= WME_AC_VO; i++) { 5032193240Ssam struct mwl_txq *txq = sc->sc_ac2q[i]; 5033193240Ssam if_printf(ifp, "Use hw queue %u for %s traffic\n", 5034193240Ssam txq->qnum, ieee80211_wme_acnames[i]); 5035193240Ssam } 5036193240Ssam } 5037193240Ssam if (bootverbose || mwl_rxdesc != MWL_RXDESC) 5038193240Ssam if_printf(ifp, "using %u rx descriptors\n", mwl_rxdesc); 5039193240Ssam if (bootverbose || mwl_rxbuf != MWL_RXBUF) 5040193240Ssam if_printf(ifp, "using %u rx buffers\n", mwl_rxbuf); 5041193240Ssam if (bootverbose || mwl_txbuf != MWL_TXBUF) 5042193240Ssam if_printf(ifp, "using %u tx buffers\n", mwl_txbuf); 5043193240Ssam if (bootverbose && mwl_hal_ismbsscapable(sc->sc_mh)) 5044193240Ssam if_printf(ifp, "multi-bss support\n"); 5045193240Ssam#ifdef MWL_TX_NODROP 5046193240Ssam if (bootverbose) 5047193240Ssam if_printf(ifp, "no tx drop\n"); 5048193240Ssam#endif 5049193240Ssam} 5050