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