1 /*-
2 * SPDX-License-Identifier: BSD-2-Clause
3 *
4 * Copyright (c) 2007-2009 Sam Leffler, Errno Consulting
5 * Copyright (c) 2007-2008 Marvell Semiconductor, Inc.
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer,
13 * without modification.
14 * 2. Redistributions in binary form must reproduce at minimum a disclaimer
15 * similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
16 * redistribution must be conditioned upon including a substantially
17 * similar Disclaimer requirement for further binary redistribution.
18 *
19 * NO WARRANTY
20 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
21 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
22 * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
23 * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
24 * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
25 * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
26 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
27 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
28 * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
29 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
30 * THE POSSIBILITY OF SUCH DAMAGES.
31 */
32
33 #include <sys/cdefs.h>
34 /*
35 * Driver for the Marvell 88W8363 Wireless LAN controller.
36 */
37
38 #include "opt_inet.h"
39 #include "opt_mwl.h"
40 #include "opt_wlan.h"
41
42 #include <sys/param.h>
43 #include <sys/systm.h>
44 #include <sys/sysctl.h>
45 #include <sys/mbuf.h>
46 #include <sys/malloc.h>
47 #include <sys/lock.h>
48 #include <sys/mutex.h>
49 #include <sys/kernel.h>
50 #include <sys/socket.h>
51 #include <sys/sockio.h>
52 #include <sys/errno.h>
53 #include <sys/callout.h>
54 #include <sys/bus.h>
55 #include <sys/endian.h>
56 #include <sys/kthread.h>
57 #include <sys/taskqueue.h>
58
59 #include <machine/bus.h>
60
61 #include <net/if.h>
62 #include <net/if_var.h>
63 #include <net/if_dl.h>
64 #include <net/if_media.h>
65 #include <net/if_types.h>
66 #include <net/if_arp.h>
67 #include <net/ethernet.h>
68 #include <net/if_llc.h>
69
70 #include <net/bpf.h>
71
72 #include <net80211/ieee80211_var.h>
73 #include <net80211/ieee80211_input.h>
74 #include <net80211/ieee80211_regdomain.h>
75
76 #ifdef INET
77 #include <netinet/in.h>
78 #include <netinet/if_ether.h>
79 #endif /* INET */
80
81 #include <dev/mwl/if_mwlvar.h>
82 #include <dev/mwl/mwldiag.h>
83
84 static struct ieee80211vap *mwl_vap_create(struct ieee80211com *,
85 const char [IFNAMSIZ], int, enum ieee80211_opmode, int,
86 const uint8_t [IEEE80211_ADDR_LEN],
87 const uint8_t [IEEE80211_ADDR_LEN]);
88 static void mwl_vap_delete(struct ieee80211vap *);
89 static int mwl_setupdma(struct mwl_softc *);
90 static int mwl_hal_reset(struct mwl_softc *sc);
91 static int mwl_init(struct mwl_softc *);
92 static void mwl_parent(struct ieee80211com *);
93 static int mwl_reset(struct ieee80211vap *, u_long);
94 static void mwl_stop(struct mwl_softc *);
95 static void mwl_start(struct mwl_softc *);
96 static int mwl_transmit(struct ieee80211com *, struct mbuf *);
97 static int mwl_raw_xmit(struct ieee80211_node *, struct mbuf *,
98 const struct ieee80211_bpf_params *);
99 static int mwl_media_change(struct ifnet *);
100 static void mwl_watchdog(void *);
101 static int mwl_ioctl(struct ieee80211com *, u_long, void *);
102 static void mwl_radar_proc(void *, int);
103 static void mwl_chanswitch_proc(void *, int);
104 static void mwl_bawatchdog_proc(void *, int);
105 static int mwl_key_alloc(struct ieee80211vap *,
106 struct ieee80211_key *,
107 ieee80211_keyix *, ieee80211_keyix *);
108 static int mwl_key_delete(struct ieee80211vap *,
109 const struct ieee80211_key *);
110 static int mwl_key_set(struct ieee80211vap *,
111 const struct ieee80211_key *);
112 static int _mwl_key_set(struct ieee80211vap *,
113 const struct ieee80211_key *,
114 const uint8_t mac[IEEE80211_ADDR_LEN]);
115 static int mwl_mode_init(struct mwl_softc *);
116 static void mwl_update_mcast(struct ieee80211com *);
117 static void mwl_update_promisc(struct ieee80211com *);
118 static void mwl_updateslot(struct ieee80211com *);
119 static int mwl_beacon_setup(struct ieee80211vap *);
120 static void mwl_beacon_update(struct ieee80211vap *, int);
121 #ifdef MWL_HOST_PS_SUPPORT
122 static void mwl_update_ps(struct ieee80211vap *, int);
123 static int mwl_set_tim(struct ieee80211_node *, int);
124 #endif
125 static int mwl_dma_setup(struct mwl_softc *);
126 static void mwl_dma_cleanup(struct mwl_softc *);
127 static struct ieee80211_node *mwl_node_alloc(struct ieee80211vap *,
128 const uint8_t [IEEE80211_ADDR_LEN]);
129 static void mwl_node_cleanup(struct ieee80211_node *);
130 static void mwl_node_drain(struct ieee80211_node *);
131 static void mwl_node_getsignal(const struct ieee80211_node *,
132 int8_t *, int8_t *);
133 static void mwl_node_getmimoinfo(const struct ieee80211_node *,
134 struct ieee80211_mimo_info *);
135 static int mwl_rxbuf_init(struct mwl_softc *, struct mwl_rxbuf *);
136 static void mwl_rx_proc(void *, int);
137 static void mwl_txq_init(struct mwl_softc *sc, struct mwl_txq *, int);
138 static int mwl_tx_setup(struct mwl_softc *, int, int);
139 static int mwl_wme_update(struct ieee80211com *);
140 static void mwl_tx_cleanupq(struct mwl_softc *, struct mwl_txq *);
141 static void mwl_tx_cleanup(struct mwl_softc *);
142 static uint16_t mwl_calcformat(uint8_t rate, const struct ieee80211_node *);
143 static int mwl_tx_start(struct mwl_softc *, struct ieee80211_node *,
144 struct mwl_txbuf *, struct mbuf *);
145 static void mwl_tx_proc(void *, int);
146 static int mwl_chan_set(struct mwl_softc *, struct ieee80211_channel *);
147 static void mwl_draintxq(struct mwl_softc *);
148 static void mwl_cleartxq(struct mwl_softc *, struct ieee80211vap *);
149 static int mwl_recv_action(struct ieee80211_node *,
150 const struct ieee80211_frame *,
151 const uint8_t *, const uint8_t *);
152 static int mwl_addba_request(struct ieee80211_node *,
153 struct ieee80211_tx_ampdu *, int dialogtoken,
154 int baparamset, int batimeout);
155 static int mwl_addba_response(struct ieee80211_node *,
156 struct ieee80211_tx_ampdu *, int status,
157 int baparamset, int batimeout);
158 static void mwl_addba_stop(struct ieee80211_node *,
159 struct ieee80211_tx_ampdu *);
160 static int mwl_startrecv(struct mwl_softc *);
161 static MWL_HAL_APMODE mwl_getapmode(const struct ieee80211vap *,
162 struct ieee80211_channel *);
163 static int mwl_setapmode(struct ieee80211vap *, struct ieee80211_channel*);
164 static void mwl_scan_start(struct ieee80211com *);
165 static void mwl_scan_end(struct ieee80211com *);
166 static void mwl_set_channel(struct ieee80211com *);
167 static int mwl_peerstadb(struct ieee80211_node *,
168 int aid, int staid, MWL_HAL_PEERINFO *pi);
169 static int mwl_localstadb(struct ieee80211vap *);
170 static int mwl_newstate(struct ieee80211vap *, enum ieee80211_state, int);
171 static int allocstaid(struct mwl_softc *sc, int aid);
172 static void delstaid(struct mwl_softc *sc, int staid);
173 static void mwl_newassoc(struct ieee80211_node *, int);
174 static void mwl_agestations(void *);
175 static int mwl_setregdomain(struct ieee80211com *,
176 struct ieee80211_regdomain *, int,
177 struct ieee80211_channel []);
178 static void mwl_getradiocaps(struct ieee80211com *, int, int *,
179 struct ieee80211_channel []);
180 static int mwl_getchannels(struct mwl_softc *);
181
182 static void mwl_sysctlattach(struct mwl_softc *);
183 static void mwl_announce(struct mwl_softc *);
184
185 SYSCTL_NODE(_hw, OID_AUTO, mwl, CTLFLAG_RD | CTLFLAG_MPSAFE, 0,
186 "Marvell driver parameters");
187
188 static int mwl_rxdesc = MWL_RXDESC; /* # rx desc's to allocate */
189 SYSCTL_INT(_hw_mwl, OID_AUTO, rxdesc, CTLFLAG_RW, &mwl_rxdesc,
190 0, "rx descriptors allocated");
191 static int mwl_rxbuf = MWL_RXBUF; /* # rx buffers to allocate */
192 SYSCTL_INT(_hw_mwl, OID_AUTO, rxbuf, CTLFLAG_RWTUN, &mwl_rxbuf,
193 0, "rx buffers allocated");
194 static int mwl_txbuf = MWL_TXBUF; /* # tx buffers to allocate */
195 SYSCTL_INT(_hw_mwl, OID_AUTO, txbuf, CTLFLAG_RWTUN, &mwl_txbuf,
196 0, "tx buffers allocated");
197 static int mwl_txcoalesce = 8; /* # tx packets to q before poking f/w*/
198 SYSCTL_INT(_hw_mwl, OID_AUTO, txcoalesce, CTLFLAG_RWTUN, &mwl_txcoalesce,
199 0, "tx buffers to send at once");
200 static int mwl_rxquota = MWL_RXBUF; /* # max buffers to process */
201 SYSCTL_INT(_hw_mwl, OID_AUTO, rxquota, CTLFLAG_RWTUN, &mwl_rxquota,
202 0, "max rx buffers to process per interrupt");
203 static int mwl_rxdmalow = 3; /* # min buffers for wakeup */
204 SYSCTL_INT(_hw_mwl, OID_AUTO, rxdmalow, CTLFLAG_RWTUN, &mwl_rxdmalow,
205 0, "min free rx buffers before restarting traffic");
206
207 #ifdef MWL_DEBUG
208 static int mwl_debug = 0;
209 SYSCTL_INT(_hw_mwl, OID_AUTO, debug, CTLFLAG_RWTUN, &mwl_debug,
210 0, "control debugging printfs");
211 enum {
212 MWL_DEBUG_XMIT = 0x00000001, /* basic xmit operation */
213 MWL_DEBUG_XMIT_DESC = 0x00000002, /* xmit descriptors */
214 MWL_DEBUG_RECV = 0x00000004, /* basic recv operation */
215 MWL_DEBUG_RECV_DESC = 0x00000008, /* recv descriptors */
216 MWL_DEBUG_RESET = 0x00000010, /* reset processing */
217 MWL_DEBUG_BEACON = 0x00000020, /* beacon handling */
218 MWL_DEBUG_INTR = 0x00000040, /* ISR */
219 MWL_DEBUG_TX_PROC = 0x00000080, /* tx ISR proc */
220 MWL_DEBUG_RX_PROC = 0x00000100, /* rx ISR proc */
221 MWL_DEBUG_KEYCACHE = 0x00000200, /* key cache management */
222 MWL_DEBUG_STATE = 0x00000400, /* 802.11 state transitions */
223 MWL_DEBUG_NODE = 0x00000800, /* node management */
224 MWL_DEBUG_RECV_ALL = 0x00001000, /* trace all frames (beacons) */
225 MWL_DEBUG_TSO = 0x00002000, /* TSO processing */
226 MWL_DEBUG_AMPDU = 0x00004000, /* BA stream handling */
227 MWL_DEBUG_ANY = 0xffffffff
228 };
229 #define IS_BEACON(wh) \
230 ((wh->i_fc[0] & (IEEE80211_FC0_TYPE_MASK|IEEE80211_FC0_SUBTYPE_MASK)) == \
231 (IEEE80211_FC0_TYPE_MGT|IEEE80211_FC0_SUBTYPE_BEACON))
232 #define IFF_DUMPPKTS_RECV(sc, wh) \
233 ((sc->sc_debug & MWL_DEBUG_RECV) && \
234 ((sc->sc_debug & MWL_DEBUG_RECV_ALL) || !IS_BEACON(wh)))
235 #define IFF_DUMPPKTS_XMIT(sc) \
236 (sc->sc_debug & MWL_DEBUG_XMIT)
237
238 #define DPRINTF(sc, m, fmt, ...) do { \
239 if (sc->sc_debug & (m)) \
240 printf(fmt, __VA_ARGS__); \
241 } while (0)
242 #define KEYPRINTF(sc, hk, mac) do { \
243 if (sc->sc_debug & MWL_DEBUG_KEYCACHE) \
244 mwl_keyprint(sc, __func__, hk, mac); \
245 } while (0)
246 static void mwl_printrxbuf(const struct mwl_rxbuf *bf, u_int ix);
247 static void mwl_printtxbuf(const struct mwl_txbuf *bf, u_int qnum, u_int ix);
248 #else
249 #define IFF_DUMPPKTS_RECV(sc, wh) 0
250 #define IFF_DUMPPKTS_XMIT(sc) 0
251 #define DPRINTF(sc, m, fmt, ...) do { (void )sc; } while (0)
252 #define KEYPRINTF(sc, k, mac) do { (void )sc; } while (0)
253 #endif
254
255 static MALLOC_DEFINE(M_MWLDEV, "mwldev", "mwl driver dma buffers");
256
257 /*
258 * Each packet has fixed front matter: a 2-byte length
259 * of the payload, followed by a 4-address 802.11 header
260 * (regardless of the actual header and always w/o any
261 * QoS header). The payload then follows.
262 */
263 struct mwltxrec {
264 uint16_t fwlen;
265 struct ieee80211_frame_addr4 wh;
266 } __packed;
267
268 /*
269 * Read/Write shorthands for accesses to BAR 0. Note
270 * that all BAR 1 operations are done in the "hal" and
271 * there should be no reference to them here.
272 */
273 #ifdef MWL_DEBUG
274 static __inline uint32_t
RD4(struct mwl_softc * sc,bus_size_t off)275 RD4(struct mwl_softc *sc, bus_size_t off)
276 {
277 return bus_space_read_4(sc->sc_io0t, sc->sc_io0h, off);
278 }
279 #endif
280
281 static __inline void
WR4(struct mwl_softc * sc,bus_size_t off,uint32_t val)282 WR4(struct mwl_softc *sc, bus_size_t off, uint32_t val)
283 {
284 bus_space_write_4(sc->sc_io0t, sc->sc_io0h, off, val);
285 }
286
287 int
mwl_attach(uint16_t devid,struct mwl_softc * sc)288 mwl_attach(uint16_t devid, struct mwl_softc *sc)
289 {
290 struct ieee80211com *ic = &sc->sc_ic;
291 struct mwl_hal *mh;
292 int error = 0;
293
294 DPRINTF(sc, MWL_DEBUG_ANY, "%s: devid 0x%x\n", __func__, devid);
295
296 /*
297 * Setup the RX free list lock early, so it can be consistently
298 * removed.
299 */
300 MWL_RXFREE_INIT(sc);
301
302 mh = mwl_hal_attach(sc->sc_dev, devid,
303 sc->sc_io1h, sc->sc_io1t, sc->sc_dmat);
304 if (mh == NULL) {
305 device_printf(sc->sc_dev, "unable to attach HAL\n");
306 error = EIO;
307 goto bad;
308 }
309 sc->sc_mh = mh;
310 /*
311 * Load firmware so we can get setup. We arbitrarily
312 * pick station firmware; we'll re-load firmware as
313 * needed so setting up the wrong mode isn't a big deal.
314 */
315 if (mwl_hal_fwload(mh, NULL) != 0) {
316 device_printf(sc->sc_dev, "unable to setup builtin firmware\n");
317 error = EIO;
318 goto bad1;
319 }
320 if (mwl_hal_gethwspecs(mh, &sc->sc_hwspecs) != 0) {
321 device_printf(sc->sc_dev, "unable to fetch h/w specs\n");
322 error = EIO;
323 goto bad1;
324 }
325 error = mwl_getchannels(sc);
326 if (error != 0)
327 goto bad1;
328
329 sc->sc_txantenna = 0; /* h/w default */
330 sc->sc_rxantenna = 0; /* h/w default */
331 sc->sc_invalid = 0; /* ready to go, enable int handling */
332 sc->sc_ageinterval = MWL_AGEINTERVAL;
333
334 /*
335 * Allocate tx+rx descriptors and populate the lists.
336 * We immediately push the information to the firmware
337 * as otherwise it gets upset.
338 */
339 error = mwl_dma_setup(sc);
340 if (error != 0) {
341 device_printf(sc->sc_dev, "failed to setup descriptors: %d\n",
342 error);
343 goto bad1;
344 }
345 error = mwl_setupdma(sc); /* push to firmware */
346 if (error != 0) /* NB: mwl_setupdma prints msg */
347 goto bad1;
348
349 callout_init(&sc->sc_timer, 1);
350 callout_init_mtx(&sc->sc_watchdog, &sc->sc_mtx, 0);
351 mbufq_init(&sc->sc_snd, ifqmaxlen);
352
353 sc->sc_tq = taskqueue_create("mwl_taskq", M_NOWAIT,
354 taskqueue_thread_enqueue, &sc->sc_tq);
355 taskqueue_start_threads(&sc->sc_tq, 1, PI_NET,
356 "%s taskq", device_get_nameunit(sc->sc_dev));
357
358 NET_TASK_INIT(&sc->sc_rxtask, 0, mwl_rx_proc, sc);
359 TASK_INIT(&sc->sc_radartask, 0, mwl_radar_proc, sc);
360 TASK_INIT(&sc->sc_chanswitchtask, 0, mwl_chanswitch_proc, sc);
361 TASK_INIT(&sc->sc_bawatchdogtask, 0, mwl_bawatchdog_proc, sc);
362
363 /* NB: insure BK queue is the lowest priority h/w queue */
364 if (!mwl_tx_setup(sc, WME_AC_BK, MWL_WME_AC_BK)) {
365 device_printf(sc->sc_dev,
366 "unable to setup xmit queue for %s traffic!\n",
367 ieee80211_wme_acnames[WME_AC_BK]);
368 error = EIO;
369 goto bad2;
370 }
371 if (!mwl_tx_setup(sc, WME_AC_BE, MWL_WME_AC_BE) ||
372 !mwl_tx_setup(sc, WME_AC_VI, MWL_WME_AC_VI) ||
373 !mwl_tx_setup(sc, WME_AC_VO, MWL_WME_AC_VO)) {
374 /*
375 * Not enough hardware tx queues to properly do WME;
376 * just punt and assign them all to the same h/w queue.
377 * We could do a better job of this if, for example,
378 * we allocate queues when we switch from station to
379 * AP mode.
380 */
381 if (sc->sc_ac2q[WME_AC_VI] != NULL)
382 mwl_tx_cleanupq(sc, sc->sc_ac2q[WME_AC_VI]);
383 if (sc->sc_ac2q[WME_AC_BE] != NULL)
384 mwl_tx_cleanupq(sc, sc->sc_ac2q[WME_AC_BE]);
385 sc->sc_ac2q[WME_AC_BE] = sc->sc_ac2q[WME_AC_BK];
386 sc->sc_ac2q[WME_AC_VI] = sc->sc_ac2q[WME_AC_BK];
387 sc->sc_ac2q[WME_AC_VO] = sc->sc_ac2q[WME_AC_BK];
388 }
389 TASK_INIT(&sc->sc_txtask, 0, mwl_tx_proc, sc);
390
391 ic->ic_softc = sc;
392 ic->ic_name = device_get_nameunit(sc->sc_dev);
393 /* XXX not right but it's not used anywhere important */
394 ic->ic_phytype = IEEE80211_T_OFDM;
395 ic->ic_opmode = IEEE80211_M_STA;
396 ic->ic_caps =
397 IEEE80211_C_STA /* station mode supported */
398 | IEEE80211_C_HOSTAP /* hostap mode */
399 | IEEE80211_C_MONITOR /* monitor mode */
400 #if 0
401 | IEEE80211_C_IBSS /* ibss, nee adhoc, mode */
402 | IEEE80211_C_AHDEMO /* adhoc demo mode */
403 #endif
404 | IEEE80211_C_MBSS /* mesh point link mode */
405 | IEEE80211_C_WDS /* WDS supported */
406 | IEEE80211_C_SHPREAMBLE /* short preamble supported */
407 | IEEE80211_C_SHSLOT /* short slot time supported */
408 | IEEE80211_C_WME /* WME/WMM supported */
409 | IEEE80211_C_BURST /* xmit bursting supported */
410 | IEEE80211_C_WPA /* capable of WPA1+WPA2 */
411 | IEEE80211_C_BGSCAN /* capable of bg scanning */
412 | IEEE80211_C_TXFRAG /* handle tx frags */
413 | IEEE80211_C_TXPMGT /* capable of txpow mgt */
414 | IEEE80211_C_DFS /* DFS supported */
415 ;
416
417 ic->ic_htcaps =
418 IEEE80211_HTCAP_SMPS_ENA /* SM PS mode enabled */
419 | IEEE80211_HTCAP_CHWIDTH40 /* 40MHz channel width */
420 | IEEE80211_HTCAP_SHORTGI20 /* short GI in 20MHz */
421 | IEEE80211_HTCAP_SHORTGI40 /* short GI in 40MHz */
422 | IEEE80211_HTCAP_RXSTBC_2STREAM/* 1-2 spatial streams */
423 #if MWL_AGGR_SIZE == 7935
424 | IEEE80211_HTCAP_MAXAMSDU_7935 /* max A-MSDU length */
425 #else
426 | IEEE80211_HTCAP_MAXAMSDU_3839 /* max A-MSDU length */
427 #endif
428 #if 0
429 | IEEE80211_HTCAP_PSMP /* PSMP supported */
430 | IEEE80211_HTCAP_40INTOLERANT /* 40MHz intolerant */
431 #endif
432 /* s/w capabilities */
433 | IEEE80211_HTC_HT /* HT operation */
434 | IEEE80211_HTC_AMPDU /* tx A-MPDU */
435 | IEEE80211_HTC_AMSDU /* tx A-MSDU */
436 | IEEE80211_HTC_SMPS /* SMPS available */
437 ;
438
439 /*
440 * Mark h/w crypto support.
441 * XXX no way to query h/w support.
442 */
443 ic->ic_cryptocaps |= IEEE80211_CRYPTO_WEP
444 | IEEE80211_CRYPTO_AES_CCM
445 | IEEE80211_CRYPTO_TKIP
446 | IEEE80211_CRYPTO_TKIPMIC
447 ;
448 /*
449 * Transmit requires space in the packet for a special
450 * format transmit record and optional padding between
451 * this record and the payload. Ask the net80211 layer
452 * to arrange this when encapsulating packets so we can
453 * add it efficiently.
454 */
455 ic->ic_headroom = sizeof(struct mwltxrec) -
456 sizeof(struct ieee80211_frame);
457
458 IEEE80211_ADDR_COPY(ic->ic_macaddr, sc->sc_hwspecs.macAddr);
459
460 /* call MI attach routine. */
461 ieee80211_ifattach(ic);
462 ic->ic_setregdomain = mwl_setregdomain;
463 ic->ic_getradiocaps = mwl_getradiocaps;
464 /* override default methods */
465 ic->ic_raw_xmit = mwl_raw_xmit;
466 ic->ic_newassoc = mwl_newassoc;
467 ic->ic_updateslot = mwl_updateslot;
468 ic->ic_update_mcast = mwl_update_mcast;
469 ic->ic_update_promisc = mwl_update_promisc;
470 ic->ic_wme.wme_update = mwl_wme_update;
471 ic->ic_transmit = mwl_transmit;
472 ic->ic_ioctl = mwl_ioctl;
473 ic->ic_parent = mwl_parent;
474
475 ic->ic_node_alloc = mwl_node_alloc;
476 sc->sc_node_cleanup = ic->ic_node_cleanup;
477 ic->ic_node_cleanup = mwl_node_cleanup;
478 sc->sc_node_drain = ic->ic_node_drain;
479 ic->ic_node_drain = mwl_node_drain;
480 ic->ic_node_getsignal = mwl_node_getsignal;
481 ic->ic_node_getmimoinfo = mwl_node_getmimoinfo;
482
483 ic->ic_scan_start = mwl_scan_start;
484 ic->ic_scan_end = mwl_scan_end;
485 ic->ic_set_channel = mwl_set_channel;
486
487 sc->sc_recv_action = ic->ic_recv_action;
488 ic->ic_recv_action = mwl_recv_action;
489 sc->sc_addba_request = ic->ic_addba_request;
490 ic->ic_addba_request = mwl_addba_request;
491 sc->sc_addba_response = ic->ic_addba_response;
492 ic->ic_addba_response = mwl_addba_response;
493 sc->sc_addba_stop = ic->ic_addba_stop;
494 ic->ic_addba_stop = mwl_addba_stop;
495
496 ic->ic_vap_create = mwl_vap_create;
497 ic->ic_vap_delete = mwl_vap_delete;
498
499 ieee80211_radiotap_attach(ic,
500 &sc->sc_tx_th.wt_ihdr, sizeof(sc->sc_tx_th),
501 MWL_TX_RADIOTAP_PRESENT,
502 &sc->sc_rx_th.wr_ihdr, sizeof(sc->sc_rx_th),
503 MWL_RX_RADIOTAP_PRESENT);
504 /*
505 * Setup dynamic sysctl's now that country code and
506 * regdomain are available from the hal.
507 */
508 mwl_sysctlattach(sc);
509
510 if (bootverbose)
511 ieee80211_announce(ic);
512 mwl_announce(sc);
513 return 0;
514 bad2:
515 mwl_dma_cleanup(sc);
516 bad1:
517 mwl_hal_detach(mh);
518 bad:
519 MWL_RXFREE_DESTROY(sc);
520 sc->sc_invalid = 1;
521 return error;
522 }
523
524 int
mwl_detach(struct mwl_softc * sc)525 mwl_detach(struct mwl_softc *sc)
526 {
527 struct ieee80211com *ic = &sc->sc_ic;
528
529 MWL_LOCK(sc);
530 mwl_stop(sc);
531 MWL_UNLOCK(sc);
532 /*
533 * NB: the order of these is important:
534 * o call the 802.11 layer before detaching the hal to
535 * insure callbacks into the driver to delete global
536 * key cache entries can be handled
537 * o reclaim the tx queue data structures after calling
538 * the 802.11 layer as we'll get called back to reclaim
539 * node state and potentially want to use them
540 * o to cleanup the tx queues the hal is called, so detach
541 * it last
542 * Other than that, it's straightforward...
543 */
544 ieee80211_ifdetach(ic);
545 callout_drain(&sc->sc_watchdog);
546 mwl_dma_cleanup(sc);
547 MWL_RXFREE_DESTROY(sc);
548 mwl_tx_cleanup(sc);
549 mwl_hal_detach(sc->sc_mh);
550 mbufq_drain(&sc->sc_snd);
551
552 return 0;
553 }
554
555 /*
556 * MAC address handling for multiple BSS on the same radio.
557 * The first vap uses the MAC address from the EEPROM. For
558 * subsequent vap's we set the U/L bit (bit 1) in the MAC
559 * address and use the next six bits as an index.
560 */
561 static void
assign_address(struct mwl_softc * sc,uint8_t mac[IEEE80211_ADDR_LEN],int clone)562 assign_address(struct mwl_softc *sc, uint8_t mac[IEEE80211_ADDR_LEN], int clone)
563 {
564 int i;
565
566 if (clone && mwl_hal_ismbsscapable(sc->sc_mh)) {
567 /* NB: we only do this if h/w supports multiple bssid */
568 for (i = 0; i < 32; i++)
569 if ((sc->sc_bssidmask & (1<<i)) == 0)
570 break;
571 if (i != 0)
572 mac[0] |= (i << 2)|0x2;
573 } else
574 i = 0;
575 sc->sc_bssidmask |= 1<<i;
576 if (i == 0)
577 sc->sc_nbssid0++;
578 }
579
580 static void
reclaim_address(struct mwl_softc * sc,const uint8_t mac[IEEE80211_ADDR_LEN])581 reclaim_address(struct mwl_softc *sc, const uint8_t mac[IEEE80211_ADDR_LEN])
582 {
583 int i = mac[0] >> 2;
584 if (i != 0 || --sc->sc_nbssid0 == 0)
585 sc->sc_bssidmask &= ~(1<<i);
586 }
587
588 static struct ieee80211vap *
mwl_vap_create(struct ieee80211com * ic,const char name[IFNAMSIZ],int unit,enum ieee80211_opmode opmode,int flags,const uint8_t bssid[IEEE80211_ADDR_LEN],const uint8_t mac0[IEEE80211_ADDR_LEN])589 mwl_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit,
590 enum ieee80211_opmode opmode, int flags,
591 const uint8_t bssid[IEEE80211_ADDR_LEN],
592 const uint8_t mac0[IEEE80211_ADDR_LEN])
593 {
594 struct mwl_softc *sc = ic->ic_softc;
595 struct mwl_hal *mh = sc->sc_mh;
596 struct ieee80211vap *vap, *apvap;
597 struct mwl_hal_vap *hvap;
598 struct mwl_vap *mvp;
599 uint8_t mac[IEEE80211_ADDR_LEN];
600
601 IEEE80211_ADDR_COPY(mac, mac0);
602 switch (opmode) {
603 case IEEE80211_M_HOSTAP:
604 case IEEE80211_M_MBSS:
605 if ((flags & IEEE80211_CLONE_MACADDR) == 0)
606 assign_address(sc, mac, flags & IEEE80211_CLONE_BSSID);
607 hvap = mwl_hal_newvap(mh, MWL_HAL_AP, mac);
608 if (hvap == NULL) {
609 if ((flags & IEEE80211_CLONE_MACADDR) == 0)
610 reclaim_address(sc, mac);
611 return NULL;
612 }
613 break;
614 case IEEE80211_M_STA:
615 if ((flags & IEEE80211_CLONE_MACADDR) == 0)
616 assign_address(sc, mac, flags & IEEE80211_CLONE_BSSID);
617 hvap = mwl_hal_newvap(mh, MWL_HAL_STA, mac);
618 if (hvap == NULL) {
619 if ((flags & IEEE80211_CLONE_MACADDR) == 0)
620 reclaim_address(sc, mac);
621 return NULL;
622 }
623 /* no h/w beacon miss support; always use s/w */
624 flags |= IEEE80211_CLONE_NOBEACONS;
625 break;
626 case IEEE80211_M_WDS:
627 hvap = NULL; /* NB: we use associated AP vap */
628 if (sc->sc_napvaps == 0)
629 return NULL; /* no existing AP vap */
630 break;
631 case IEEE80211_M_MONITOR:
632 hvap = NULL;
633 break;
634 case IEEE80211_M_IBSS:
635 case IEEE80211_M_AHDEMO:
636 default:
637 return NULL;
638 }
639
640 mvp = malloc(sizeof(struct mwl_vap), M_80211_VAP, M_WAITOK | M_ZERO);
641 mvp->mv_hvap = hvap;
642 if (opmode == IEEE80211_M_WDS) {
643 /*
644 * WDS vaps must have an associated AP vap; find one.
645 * XXX not right.
646 */
647 TAILQ_FOREACH(apvap, &ic->ic_vaps, iv_next)
648 if (apvap->iv_opmode == IEEE80211_M_HOSTAP) {
649 mvp->mv_ap_hvap = MWL_VAP(apvap)->mv_hvap;
650 break;
651 }
652 KASSERT(mvp->mv_ap_hvap != NULL, ("no ap vap"));
653 }
654 vap = &mvp->mv_vap;
655 ieee80211_vap_setup(ic, vap, name, unit, opmode, flags, bssid);
656 /* override with driver methods */
657 mvp->mv_newstate = vap->iv_newstate;
658 vap->iv_newstate = mwl_newstate;
659 vap->iv_max_keyix = 0; /* XXX */
660 vap->iv_key_alloc = mwl_key_alloc;
661 vap->iv_key_delete = mwl_key_delete;
662 vap->iv_key_set = mwl_key_set;
663 #ifdef MWL_HOST_PS_SUPPORT
664 if (opmode == IEEE80211_M_HOSTAP || opmode == IEEE80211_M_MBSS) {
665 vap->iv_update_ps = mwl_update_ps;
666 mvp->mv_set_tim = vap->iv_set_tim;
667 vap->iv_set_tim = mwl_set_tim;
668 }
669 #endif
670 vap->iv_reset = mwl_reset;
671 vap->iv_update_beacon = mwl_beacon_update;
672
673 /* override max aid so sta's cannot assoc when we're out of sta id's */
674 vap->iv_max_aid = MWL_MAXSTAID;
675 /* override default A-MPDU rx parameters */
676 vap->iv_ampdu_rxmax = IEEE80211_HTCAP_MAXRXAMPDU_64K;
677 vap->iv_ampdu_density = IEEE80211_HTCAP_MPDUDENSITY_4;
678
679 /* complete setup */
680 ieee80211_vap_attach(vap, mwl_media_change, ieee80211_media_status,
681 mac);
682
683 switch (vap->iv_opmode) {
684 case IEEE80211_M_HOSTAP:
685 case IEEE80211_M_MBSS:
686 case IEEE80211_M_STA:
687 /*
688 * Setup sta db entry for local address.
689 */
690 mwl_localstadb(vap);
691 if (vap->iv_opmode == IEEE80211_M_HOSTAP ||
692 vap->iv_opmode == IEEE80211_M_MBSS)
693 sc->sc_napvaps++;
694 else
695 sc->sc_nstavaps++;
696 break;
697 case IEEE80211_M_WDS:
698 sc->sc_nwdsvaps++;
699 break;
700 default:
701 break;
702 }
703 /*
704 * Setup overall operating mode.
705 */
706 if (sc->sc_napvaps)
707 ic->ic_opmode = IEEE80211_M_HOSTAP;
708 else if (sc->sc_nstavaps)
709 ic->ic_opmode = IEEE80211_M_STA;
710 else
711 ic->ic_opmode = opmode;
712
713 return vap;
714 }
715
716 static void
mwl_vap_delete(struct ieee80211vap * vap)717 mwl_vap_delete(struct ieee80211vap *vap)
718 {
719 struct mwl_vap *mvp = MWL_VAP(vap);
720 struct mwl_softc *sc = vap->iv_ic->ic_softc;
721 struct mwl_hal *mh = sc->sc_mh;
722 struct mwl_hal_vap *hvap = mvp->mv_hvap;
723 enum ieee80211_opmode opmode = vap->iv_opmode;
724
725 /* XXX disallow ap vap delete if WDS still present */
726 if (sc->sc_running) {
727 /* quiesce h/w while we remove the vap */
728 mwl_hal_intrset(mh, 0); /* disable interrupts */
729 }
730 ieee80211_vap_detach(vap);
731 switch (opmode) {
732 case IEEE80211_M_HOSTAP:
733 case IEEE80211_M_MBSS:
734 case IEEE80211_M_STA:
735 KASSERT(hvap != NULL, ("no hal vap handle"));
736 (void) mwl_hal_delstation(hvap, vap->iv_myaddr);
737 mwl_hal_delvap(hvap);
738 if (opmode == IEEE80211_M_HOSTAP || opmode == IEEE80211_M_MBSS)
739 sc->sc_napvaps--;
740 else
741 sc->sc_nstavaps--;
742 /* XXX don't do it for IEEE80211_CLONE_MACADDR */
743 reclaim_address(sc, vap->iv_myaddr);
744 break;
745 case IEEE80211_M_WDS:
746 sc->sc_nwdsvaps--;
747 break;
748 default:
749 break;
750 }
751 mwl_cleartxq(sc, vap);
752 free(mvp, M_80211_VAP);
753 if (sc->sc_running)
754 mwl_hal_intrset(mh, sc->sc_imask);
755 }
756
757 void
mwl_suspend(struct mwl_softc * sc)758 mwl_suspend(struct mwl_softc *sc)
759 {
760
761 MWL_LOCK(sc);
762 mwl_stop(sc);
763 MWL_UNLOCK(sc);
764 }
765
766 void
mwl_resume(struct mwl_softc * sc)767 mwl_resume(struct mwl_softc *sc)
768 {
769 int error = EDOOFUS;
770
771 MWL_LOCK(sc);
772 if (sc->sc_ic.ic_nrunning > 0)
773 error = mwl_init(sc);
774 MWL_UNLOCK(sc);
775
776 if (error == 0)
777 ieee80211_start_all(&sc->sc_ic); /* start all vap's */
778 }
779
780 void
mwl_shutdown(void * arg)781 mwl_shutdown(void *arg)
782 {
783 struct mwl_softc *sc = arg;
784
785 MWL_LOCK(sc);
786 mwl_stop(sc);
787 MWL_UNLOCK(sc);
788 }
789
790 /*
791 * Interrupt handler. Most of the actual processing is deferred.
792 */
793 void
mwl_intr(void * arg)794 mwl_intr(void *arg)
795 {
796 struct mwl_softc *sc = arg;
797 struct mwl_hal *mh = sc->sc_mh;
798 uint32_t status;
799
800 if (sc->sc_invalid) {
801 /*
802 * The hardware is not ready/present, don't touch anything.
803 * Note this can happen early on if the IRQ is shared.
804 */
805 DPRINTF(sc, MWL_DEBUG_ANY, "%s: invalid; ignored\n", __func__);
806 return;
807 }
808 /*
809 * Figure out the reason(s) for the interrupt.
810 */
811 mwl_hal_getisr(mh, &status); /* NB: clears ISR too */
812 if (status == 0) /* must be a shared irq */
813 return;
814
815 DPRINTF(sc, MWL_DEBUG_INTR, "%s: status 0x%x imask 0x%x\n",
816 __func__, status, sc->sc_imask);
817 if (status & MACREG_A2HRIC_BIT_RX_RDY)
818 taskqueue_enqueue(sc->sc_tq, &sc->sc_rxtask);
819 if (status & MACREG_A2HRIC_BIT_TX_DONE)
820 taskqueue_enqueue(sc->sc_tq, &sc->sc_txtask);
821 if (status & MACREG_A2HRIC_BIT_BA_WATCHDOG)
822 taskqueue_enqueue(sc->sc_tq, &sc->sc_bawatchdogtask);
823 if (status & MACREG_A2HRIC_BIT_OPC_DONE)
824 mwl_hal_cmddone(mh);
825 if (status & MACREG_A2HRIC_BIT_MAC_EVENT) {
826 ;
827 }
828 if (status & MACREG_A2HRIC_BIT_ICV_ERROR) {
829 /* TKIP ICV error */
830 sc->sc_stats.mst_rx_badtkipicv++;
831 }
832 if (status & MACREG_A2HRIC_BIT_QUEUE_EMPTY) {
833 /* 11n aggregation queue is empty, re-fill */
834 ;
835 }
836 if (status & MACREG_A2HRIC_BIT_QUEUE_FULL) {
837 ;
838 }
839 if (status & MACREG_A2HRIC_BIT_RADAR_DETECT) {
840 /* radar detected, process event */
841 taskqueue_enqueue(sc->sc_tq, &sc->sc_radartask);
842 }
843 if (status & MACREG_A2HRIC_BIT_CHAN_SWITCH) {
844 /* DFS channel switch */
845 taskqueue_enqueue(sc->sc_tq, &sc->sc_chanswitchtask);
846 }
847 }
848
849 static void
mwl_radar_proc(void * arg,int pending)850 mwl_radar_proc(void *arg, int pending)
851 {
852 struct mwl_softc *sc = arg;
853 struct ieee80211com *ic = &sc->sc_ic;
854
855 DPRINTF(sc, MWL_DEBUG_ANY, "%s: radar detected, pending %u\n",
856 __func__, pending);
857
858 sc->sc_stats.mst_radardetect++;
859 /* XXX stop h/w BA streams? */
860
861 IEEE80211_LOCK(ic);
862 ieee80211_dfs_notify_radar(ic, ic->ic_curchan);
863 IEEE80211_UNLOCK(ic);
864 }
865
866 static void
mwl_chanswitch_proc(void * arg,int pending)867 mwl_chanswitch_proc(void *arg, int pending)
868 {
869 struct mwl_softc *sc = arg;
870 struct ieee80211com *ic = &sc->sc_ic;
871
872 DPRINTF(sc, MWL_DEBUG_ANY, "%s: channel switch notice, pending %u\n",
873 __func__, pending);
874
875 IEEE80211_LOCK(ic);
876 sc->sc_csapending = 0;
877 ieee80211_csa_completeswitch(ic);
878 IEEE80211_UNLOCK(ic);
879 }
880
881 static void
mwl_bawatchdog(const MWL_HAL_BASTREAM * sp)882 mwl_bawatchdog(const MWL_HAL_BASTREAM *sp)
883 {
884 struct ieee80211_node *ni = sp->data[0];
885
886 /* send DELBA and drop the stream */
887 ieee80211_ampdu_stop(ni, sp->data[1], IEEE80211_REASON_UNSPECIFIED);
888 }
889
890 static void
mwl_bawatchdog_proc(void * arg,int pending)891 mwl_bawatchdog_proc(void *arg, int pending)
892 {
893 struct mwl_softc *sc = arg;
894 struct mwl_hal *mh = sc->sc_mh;
895 const MWL_HAL_BASTREAM *sp;
896 uint8_t bitmap, n;
897
898 sc->sc_stats.mst_bawatchdog++;
899
900 if (mwl_hal_getwatchdogbitmap(mh, &bitmap) != 0) {
901 DPRINTF(sc, MWL_DEBUG_AMPDU,
902 "%s: could not get bitmap\n", __func__);
903 sc->sc_stats.mst_bawatchdog_failed++;
904 return;
905 }
906 DPRINTF(sc, MWL_DEBUG_AMPDU, "%s: bitmap 0x%x\n", __func__, bitmap);
907 if (bitmap == 0xff) {
908 n = 0;
909 /* disable all ba streams */
910 for (bitmap = 0; bitmap < 8; bitmap++) {
911 sp = mwl_hal_bastream_lookup(mh, bitmap);
912 if (sp != NULL) {
913 mwl_bawatchdog(sp);
914 n++;
915 }
916 }
917 if (n == 0) {
918 DPRINTF(sc, MWL_DEBUG_AMPDU,
919 "%s: no BA streams found\n", __func__);
920 sc->sc_stats.mst_bawatchdog_empty++;
921 }
922 } else if (bitmap != 0xaa) {
923 /* disable a single ba stream */
924 sp = mwl_hal_bastream_lookup(mh, bitmap);
925 if (sp != NULL) {
926 mwl_bawatchdog(sp);
927 } else {
928 DPRINTF(sc, MWL_DEBUG_AMPDU,
929 "%s: no BA stream %d\n", __func__, bitmap);
930 sc->sc_stats.mst_bawatchdog_notfound++;
931 }
932 }
933 }
934
935 /*
936 * Convert net80211 channel to a HAL channel.
937 */
938 static void
mwl_mapchan(MWL_HAL_CHANNEL * hc,const struct ieee80211_channel * chan)939 mwl_mapchan(MWL_HAL_CHANNEL *hc, const struct ieee80211_channel *chan)
940 {
941 hc->channel = chan->ic_ieee;
942
943 *(uint32_t *)&hc->channelFlags = 0;
944 if (IEEE80211_IS_CHAN_2GHZ(chan))
945 hc->channelFlags.FreqBand = MWL_FREQ_BAND_2DOT4GHZ;
946 else if (IEEE80211_IS_CHAN_5GHZ(chan))
947 hc->channelFlags.FreqBand = MWL_FREQ_BAND_5GHZ;
948 if (IEEE80211_IS_CHAN_HT40(chan)) {
949 hc->channelFlags.ChnlWidth = MWL_CH_40_MHz_WIDTH;
950 if (IEEE80211_IS_CHAN_HT40U(chan))
951 hc->channelFlags.ExtChnlOffset = MWL_EXT_CH_ABOVE_CTRL_CH;
952 else
953 hc->channelFlags.ExtChnlOffset = MWL_EXT_CH_BELOW_CTRL_CH;
954 } else
955 hc->channelFlags.ChnlWidth = MWL_CH_20_MHz_WIDTH;
956 /* XXX 10MHz channels */
957 }
958
959 /*
960 * Inform firmware of our tx/rx dma setup. The BAR 0
961 * writes below are for compatibility with older firmware.
962 * For current firmware we send this information with a
963 * cmd block via mwl_hal_sethwdma.
964 */
965 static int
mwl_setupdma(struct mwl_softc * sc)966 mwl_setupdma(struct mwl_softc *sc)
967 {
968 int error, i;
969
970 sc->sc_hwdma.rxDescRead = sc->sc_rxdma.dd_desc_paddr;
971 WR4(sc, sc->sc_hwspecs.rxDescRead, sc->sc_hwdma.rxDescRead);
972 WR4(sc, sc->sc_hwspecs.rxDescWrite, sc->sc_hwdma.rxDescRead);
973
974 for (i = 0; i < MWL_NUM_TX_QUEUES-MWL_NUM_ACK_QUEUES; i++) {
975 struct mwl_txq *txq = &sc->sc_txq[i];
976 sc->sc_hwdma.wcbBase[i] = txq->dma.dd_desc_paddr;
977 WR4(sc, sc->sc_hwspecs.wcbBase[i], sc->sc_hwdma.wcbBase[i]);
978 }
979 sc->sc_hwdma.maxNumTxWcb = mwl_txbuf;
980 sc->sc_hwdma.maxNumWCB = MWL_NUM_TX_QUEUES-MWL_NUM_ACK_QUEUES;
981
982 error = mwl_hal_sethwdma(sc->sc_mh, &sc->sc_hwdma);
983 if (error != 0) {
984 device_printf(sc->sc_dev,
985 "unable to setup tx/rx dma; hal status %u\n", error);
986 /* XXX */
987 }
988 return error;
989 }
990
991 /*
992 * Inform firmware of tx rate parameters.
993 * Called after a channel change.
994 */
995 static int
mwl_setcurchanrates(struct mwl_softc * sc)996 mwl_setcurchanrates(struct mwl_softc *sc)
997 {
998 struct ieee80211com *ic = &sc->sc_ic;
999 const struct ieee80211_rateset *rs;
1000 MWL_HAL_TXRATE rates;
1001
1002 memset(&rates, 0, sizeof(rates));
1003 rs = ieee80211_get_suprates(ic, ic->ic_curchan);
1004 /* rate used to send management frames */
1005 rates.MgtRate = rs->rs_rates[0] & IEEE80211_RATE_VAL;
1006 /* rate used to send multicast frames */
1007 rates.McastRate = rates.MgtRate;
1008
1009 return mwl_hal_settxrate_auto(sc->sc_mh, &rates);
1010 }
1011
1012 /*
1013 * Inform firmware of tx rate parameters. Called whenever
1014 * user-settable params change and after a channel change.
1015 */
1016 static int
mwl_setrates(struct ieee80211vap * vap)1017 mwl_setrates(struct ieee80211vap *vap)
1018 {
1019 struct mwl_vap *mvp = MWL_VAP(vap);
1020 struct ieee80211_node *ni = vap->iv_bss;
1021 const struct ieee80211_txparam *tp = ni->ni_txparms;
1022 MWL_HAL_TXRATE rates;
1023
1024 KASSERT(vap->iv_state == IEEE80211_S_RUN, ("state %d", vap->iv_state));
1025
1026 /*
1027 * Update the h/w rate map.
1028 * NB: 0x80 for MCS is passed through unchanged
1029 */
1030 memset(&rates, 0, sizeof(rates));
1031 /* rate used to send management frames */
1032 rates.MgtRate = tp->mgmtrate;
1033 /* rate used to send multicast frames */
1034 rates.McastRate = tp->mcastrate;
1035
1036 /* while here calculate EAPOL fixed rate cookie */
1037 mvp->mv_eapolformat = htole16(mwl_calcformat(rates.MgtRate, ni));
1038
1039 return mwl_hal_settxrate(mvp->mv_hvap,
1040 tp->ucastrate != IEEE80211_FIXED_RATE_NONE ?
1041 RATE_FIXED : RATE_AUTO, &rates);
1042 }
1043
1044 /*
1045 * Setup a fixed xmit rate cookie for EAPOL frames.
1046 */
1047 static void
mwl_seteapolformat(struct ieee80211vap * vap)1048 mwl_seteapolformat(struct ieee80211vap *vap)
1049 {
1050 struct mwl_vap *mvp = MWL_VAP(vap);
1051 struct ieee80211_node *ni = vap->iv_bss;
1052 enum ieee80211_phymode mode;
1053 uint8_t rate;
1054
1055 KASSERT(vap->iv_state == IEEE80211_S_RUN, ("state %d", vap->iv_state));
1056
1057 mode = ieee80211_chan2mode(ni->ni_chan);
1058 /*
1059 * Use legacy rates when operating a mixed HT+non-HT bss.
1060 * NB: this may violate POLA for sta and wds vap's.
1061 */
1062 if (mode == IEEE80211_MODE_11NA &&
1063 (vap->iv_flags_ht & IEEE80211_FHT_PUREN) == 0)
1064 rate = vap->iv_txparms[IEEE80211_MODE_11A].mgmtrate;
1065 else if (mode == IEEE80211_MODE_11NG &&
1066 (vap->iv_flags_ht & IEEE80211_FHT_PUREN) == 0)
1067 rate = vap->iv_txparms[IEEE80211_MODE_11G].mgmtrate;
1068 else
1069 rate = vap->iv_txparms[mode].mgmtrate;
1070
1071 mvp->mv_eapolformat = htole16(mwl_calcformat(rate, ni));
1072 }
1073
1074 /*
1075 * Map SKU+country code to region code for radar bin'ing.
1076 */
1077 static int
mwl_map2regioncode(const struct ieee80211_regdomain * rd)1078 mwl_map2regioncode(const struct ieee80211_regdomain *rd)
1079 {
1080 switch (rd->regdomain) {
1081 case SKU_FCC:
1082 case SKU_FCC3:
1083 return DOMAIN_CODE_FCC;
1084 case SKU_CA:
1085 return DOMAIN_CODE_IC;
1086 case SKU_ETSI:
1087 case SKU_ETSI2:
1088 case SKU_ETSI3:
1089 if (rd->country == CTRY_SPAIN)
1090 return DOMAIN_CODE_SPAIN;
1091 if (rd->country == CTRY_FRANCE || rd->country == CTRY_FRANCE2)
1092 return DOMAIN_CODE_FRANCE;
1093 /* XXX force 1.3.1 radar type */
1094 return DOMAIN_CODE_ETSI_131;
1095 case SKU_JAPAN:
1096 return DOMAIN_CODE_MKK;
1097 case SKU_ROW:
1098 return DOMAIN_CODE_DGT; /* Taiwan */
1099 case SKU_APAC:
1100 case SKU_APAC2:
1101 case SKU_APAC3:
1102 return DOMAIN_CODE_AUS; /* Australia */
1103 }
1104 /* XXX KOREA? */
1105 return DOMAIN_CODE_FCC; /* XXX? */
1106 }
1107
1108 static int
mwl_hal_reset(struct mwl_softc * sc)1109 mwl_hal_reset(struct mwl_softc *sc)
1110 {
1111 struct ieee80211com *ic = &sc->sc_ic;
1112 struct mwl_hal *mh = sc->sc_mh;
1113
1114 mwl_hal_setantenna(mh, WL_ANTENNATYPE_RX, sc->sc_rxantenna);
1115 mwl_hal_setantenna(mh, WL_ANTENNATYPE_TX, sc->sc_txantenna);
1116 mwl_hal_setradio(mh, 1, WL_AUTO_PREAMBLE);
1117 mwl_hal_setwmm(sc->sc_mh, (ic->ic_flags & IEEE80211_F_WME) != 0);
1118 mwl_chan_set(sc, ic->ic_curchan);
1119 /* NB: RF/RA performance tuned for indoor mode */
1120 mwl_hal_setrateadaptmode(mh, 0);
1121 mwl_hal_setoptimizationlevel(mh,
1122 (ic->ic_flags & IEEE80211_F_BURST) != 0);
1123
1124 mwl_hal_setregioncode(mh, mwl_map2regioncode(&ic->ic_regdomain));
1125
1126 mwl_hal_setaggampduratemode(mh, 1, 80); /* XXX */
1127 mwl_hal_setcfend(mh, 0); /* XXX */
1128
1129 return 1;
1130 }
1131
1132 static int
mwl_init(struct mwl_softc * sc)1133 mwl_init(struct mwl_softc *sc)
1134 {
1135 struct mwl_hal *mh = sc->sc_mh;
1136 int error = 0;
1137
1138 MWL_LOCK_ASSERT(sc);
1139
1140 /*
1141 * Stop anything previously setup. This is safe
1142 * whether this is the first time through or not.
1143 */
1144 mwl_stop(sc);
1145
1146 /*
1147 * Push vap-independent state to the firmware.
1148 */
1149 if (!mwl_hal_reset(sc)) {
1150 device_printf(sc->sc_dev, "unable to reset hardware\n");
1151 return EIO;
1152 }
1153
1154 /*
1155 * Setup recv (once); transmit is already good to go.
1156 */
1157 error = mwl_startrecv(sc);
1158 if (error != 0) {
1159 device_printf(sc->sc_dev, "unable to start recv logic\n");
1160 return error;
1161 }
1162
1163 /*
1164 * Enable interrupts.
1165 */
1166 sc->sc_imask = MACREG_A2HRIC_BIT_RX_RDY
1167 | MACREG_A2HRIC_BIT_TX_DONE
1168 | MACREG_A2HRIC_BIT_OPC_DONE
1169 #if 0
1170 | MACREG_A2HRIC_BIT_MAC_EVENT
1171 #endif
1172 | MACREG_A2HRIC_BIT_ICV_ERROR
1173 | MACREG_A2HRIC_BIT_RADAR_DETECT
1174 | MACREG_A2HRIC_BIT_CHAN_SWITCH
1175 #if 0
1176 | MACREG_A2HRIC_BIT_QUEUE_EMPTY
1177 #endif
1178 | MACREG_A2HRIC_BIT_BA_WATCHDOG
1179 | MACREQ_A2HRIC_BIT_TX_ACK
1180 ;
1181
1182 sc->sc_running = 1;
1183 mwl_hal_intrset(mh, sc->sc_imask);
1184 callout_reset(&sc->sc_watchdog, hz, mwl_watchdog, sc);
1185
1186 return 0;
1187 }
1188
1189 static void
mwl_stop(struct mwl_softc * sc)1190 mwl_stop(struct mwl_softc *sc)
1191 {
1192
1193 MWL_LOCK_ASSERT(sc);
1194 if (sc->sc_running) {
1195 /*
1196 * Shutdown the hardware and driver.
1197 */
1198 sc->sc_running = 0;
1199 callout_stop(&sc->sc_watchdog);
1200 sc->sc_tx_timer = 0;
1201 mwl_draintxq(sc);
1202 }
1203 }
1204
1205 static int
mwl_reset_vap(struct ieee80211vap * vap,int state)1206 mwl_reset_vap(struct ieee80211vap *vap, int state)
1207 {
1208 struct mwl_hal_vap *hvap = MWL_VAP(vap)->mv_hvap;
1209 struct ieee80211com *ic = vap->iv_ic;
1210
1211 if (state == IEEE80211_S_RUN)
1212 mwl_setrates(vap);
1213 /* XXX off by 1? */
1214 mwl_hal_setrtsthreshold(hvap, vap->iv_rtsthreshold);
1215 /* XXX auto? 20/40 split? */
1216 mwl_hal_sethtgi(hvap, (vap->iv_flags_ht &
1217 (IEEE80211_FHT_SHORTGI20|IEEE80211_FHT_SHORTGI40)) ? 1 : 0);
1218 mwl_hal_setnprot(hvap, ic->ic_htprotmode == IEEE80211_PROT_NONE ?
1219 HTPROTECT_NONE : HTPROTECT_AUTO);
1220 /* XXX txpower cap */
1221
1222 /* re-setup beacons */
1223 if (state == IEEE80211_S_RUN &&
1224 (vap->iv_opmode == IEEE80211_M_HOSTAP ||
1225 vap->iv_opmode == IEEE80211_M_MBSS ||
1226 vap->iv_opmode == IEEE80211_M_IBSS)) {
1227 mwl_setapmode(vap, vap->iv_bss->ni_chan);
1228 mwl_hal_setnprotmode(hvap, _IEEE80211_MASKSHIFT(
1229 ic->ic_curhtprotmode, IEEE80211_HTINFO_OPMODE));
1230 return mwl_beacon_setup(vap);
1231 }
1232 return 0;
1233 }
1234
1235 /*
1236 * Reset the hardware w/o losing operational state.
1237 * Used to reset or reload hardware state for a vap.
1238 */
1239 static int
mwl_reset(struct ieee80211vap * vap,u_long cmd)1240 mwl_reset(struct ieee80211vap *vap, u_long cmd)
1241 {
1242 struct mwl_hal_vap *hvap = MWL_VAP(vap)->mv_hvap;
1243 int error = 0;
1244
1245 if (hvap != NULL) { /* WDS, MONITOR, etc. */
1246 struct ieee80211com *ic = vap->iv_ic;
1247 struct mwl_softc *sc = ic->ic_softc;
1248 struct mwl_hal *mh = sc->sc_mh;
1249
1250 /* XXX handle DWDS sta vap change */
1251 /* XXX do we need to disable interrupts? */
1252 mwl_hal_intrset(mh, 0); /* disable interrupts */
1253 error = mwl_reset_vap(vap, vap->iv_state);
1254 mwl_hal_intrset(mh, sc->sc_imask);
1255 }
1256 return error;
1257 }
1258
1259 /*
1260 * Allocate a tx buffer for sending a frame. The
1261 * packet is assumed to have the WME AC stored so
1262 * we can use it to select the appropriate h/w queue.
1263 */
1264 static struct mwl_txbuf *
mwl_gettxbuf(struct mwl_softc * sc,struct mwl_txq * txq)1265 mwl_gettxbuf(struct mwl_softc *sc, struct mwl_txq *txq)
1266 {
1267 struct mwl_txbuf *bf;
1268
1269 /*
1270 * Grab a TX buffer and associated resources.
1271 */
1272 MWL_TXQ_LOCK(txq);
1273 bf = STAILQ_FIRST(&txq->free);
1274 if (bf != NULL) {
1275 STAILQ_REMOVE_HEAD(&txq->free, bf_list);
1276 txq->nfree--;
1277 }
1278 MWL_TXQ_UNLOCK(txq);
1279 if (bf == NULL)
1280 DPRINTF(sc, MWL_DEBUG_XMIT,
1281 "%s: out of xmit buffers on q %d\n", __func__, txq->qnum);
1282 return bf;
1283 }
1284
1285 /*
1286 * Return a tx buffer to the queue it came from. Note there
1287 * are two cases because we must preserve the order of buffers
1288 * as it reflects the fixed order of descriptors in memory
1289 * (the firmware pre-fetches descriptors so we cannot reorder).
1290 */
1291 static void
mwl_puttxbuf_head(struct mwl_txq * txq,struct mwl_txbuf * bf)1292 mwl_puttxbuf_head(struct mwl_txq *txq, struct mwl_txbuf *bf)
1293 {
1294 bf->bf_m = NULL;
1295 bf->bf_node = NULL;
1296 MWL_TXQ_LOCK(txq);
1297 STAILQ_INSERT_HEAD(&txq->free, bf, bf_list);
1298 txq->nfree++;
1299 MWL_TXQ_UNLOCK(txq);
1300 }
1301
1302 static void
mwl_puttxbuf_tail(struct mwl_txq * txq,struct mwl_txbuf * bf)1303 mwl_puttxbuf_tail(struct mwl_txq *txq, struct mwl_txbuf *bf)
1304 {
1305 bf->bf_m = NULL;
1306 bf->bf_node = NULL;
1307 MWL_TXQ_LOCK(txq);
1308 STAILQ_INSERT_TAIL(&txq->free, bf, bf_list);
1309 txq->nfree++;
1310 MWL_TXQ_UNLOCK(txq);
1311 }
1312
1313 static int
mwl_transmit(struct ieee80211com * ic,struct mbuf * m)1314 mwl_transmit(struct ieee80211com *ic, struct mbuf *m)
1315 {
1316 struct mwl_softc *sc = ic->ic_softc;
1317 int error;
1318
1319 MWL_LOCK(sc);
1320 if (!sc->sc_running) {
1321 MWL_UNLOCK(sc);
1322 return (ENXIO);
1323 }
1324 error = mbufq_enqueue(&sc->sc_snd, m);
1325 if (error) {
1326 MWL_UNLOCK(sc);
1327 return (error);
1328 }
1329 mwl_start(sc);
1330 MWL_UNLOCK(sc);
1331 return (0);
1332 }
1333
1334 static void
mwl_start(struct mwl_softc * sc)1335 mwl_start(struct mwl_softc *sc)
1336 {
1337 struct ieee80211_node *ni;
1338 struct mwl_txbuf *bf;
1339 struct mbuf *m;
1340 struct mwl_txq *txq = NULL; /* XXX silence gcc */
1341 int nqueued;
1342
1343 MWL_LOCK_ASSERT(sc);
1344 if (!sc->sc_running || sc->sc_invalid)
1345 return;
1346 nqueued = 0;
1347 while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) {
1348 /*
1349 * Grab the node for the destination.
1350 */
1351 ni = (struct ieee80211_node *) m->m_pkthdr.rcvif;
1352 KASSERT(ni != NULL, ("no node"));
1353 m->m_pkthdr.rcvif = NULL; /* committed, clear ref */
1354 /*
1355 * Grab a TX buffer and associated resources.
1356 * We honor the classification by the 802.11 layer.
1357 */
1358 txq = sc->sc_ac2q[M_WME_GETAC(m)];
1359 bf = mwl_gettxbuf(sc, txq);
1360 if (bf == NULL) {
1361 m_freem(m);
1362 ieee80211_free_node(ni);
1363 #ifdef MWL_TX_NODROP
1364 sc->sc_stats.mst_tx_qstop++;
1365 break;
1366 #else
1367 DPRINTF(sc, MWL_DEBUG_XMIT,
1368 "%s: tail drop on q %d\n", __func__, txq->qnum);
1369 sc->sc_stats.mst_tx_qdrop++;
1370 continue;
1371 #endif /* MWL_TX_NODROP */
1372 }
1373
1374 /*
1375 * Pass the frame to the h/w for transmission.
1376 */
1377 if (mwl_tx_start(sc, ni, bf, m)) {
1378 if_inc_counter(ni->ni_vap->iv_ifp,
1379 IFCOUNTER_OERRORS, 1);
1380 mwl_puttxbuf_head(txq, bf);
1381 ieee80211_free_node(ni);
1382 continue;
1383 }
1384 nqueued++;
1385 if (nqueued >= mwl_txcoalesce) {
1386 /*
1387 * Poke the firmware to process queued frames;
1388 * see below about (lack of) locking.
1389 */
1390 nqueued = 0;
1391 mwl_hal_txstart(sc->sc_mh, 0/*XXX*/);
1392 }
1393 }
1394 if (nqueued) {
1395 /*
1396 * NB: We don't need to lock against tx done because
1397 * this just prods the firmware to check the transmit
1398 * descriptors. The firmware will also start fetching
1399 * descriptors by itself if it notices new ones are
1400 * present when it goes to deliver a tx done interrupt
1401 * to the host. So if we race with tx done processing
1402 * it's ok. Delivering the kick here rather than in
1403 * mwl_tx_start is an optimization to avoid poking the
1404 * firmware for each packet.
1405 *
1406 * NB: the queue id isn't used so 0 is ok.
1407 */
1408 mwl_hal_txstart(sc->sc_mh, 0/*XXX*/);
1409 }
1410 }
1411
1412 static int
mwl_raw_xmit(struct ieee80211_node * ni,struct mbuf * m,const struct ieee80211_bpf_params * params)1413 mwl_raw_xmit(struct ieee80211_node *ni, struct mbuf *m,
1414 const struct ieee80211_bpf_params *params)
1415 {
1416 struct ieee80211com *ic = ni->ni_ic;
1417 struct mwl_softc *sc = ic->ic_softc;
1418 struct mwl_txbuf *bf;
1419 struct mwl_txq *txq;
1420
1421 if (!sc->sc_running || sc->sc_invalid) {
1422 m_freem(m);
1423 return ENETDOWN;
1424 }
1425 /*
1426 * Grab a TX buffer and associated resources.
1427 * Note that we depend on the classification
1428 * by the 802.11 layer to get to the right h/w
1429 * queue. Management frames must ALWAYS go on
1430 * queue 1 but we cannot just force that here
1431 * because we may receive non-mgt frames.
1432 */
1433 txq = sc->sc_ac2q[M_WME_GETAC(m)];
1434 bf = mwl_gettxbuf(sc, txq);
1435 if (bf == NULL) {
1436 sc->sc_stats.mst_tx_qstop++;
1437 m_freem(m);
1438 return ENOBUFS;
1439 }
1440 /*
1441 * Pass the frame to the h/w for transmission.
1442 */
1443 if (mwl_tx_start(sc, ni, bf, m)) {
1444 mwl_puttxbuf_head(txq, bf);
1445
1446 return EIO; /* XXX */
1447 }
1448 /*
1449 * NB: We don't need to lock against tx done because
1450 * this just prods the firmware to check the transmit
1451 * descriptors. The firmware will also start fetching
1452 * descriptors by itself if it notices new ones are
1453 * present when it goes to deliver a tx done interrupt
1454 * to the host. So if we race with tx done processing
1455 * it's ok. Delivering the kick here rather than in
1456 * mwl_tx_start is an optimization to avoid poking the
1457 * firmware for each packet.
1458 *
1459 * NB: the queue id isn't used so 0 is ok.
1460 */
1461 mwl_hal_txstart(sc->sc_mh, 0/*XXX*/);
1462 return 0;
1463 }
1464
1465 static int
mwl_media_change(struct ifnet * ifp)1466 mwl_media_change(struct ifnet *ifp)
1467 {
1468 struct ieee80211vap *vap;
1469 int error;
1470
1471 /* NB: only the fixed rate can change and that doesn't need a reset */
1472 error = ieee80211_media_change(ifp);
1473 if (error != 0)
1474 return (error);
1475
1476 vap = ifp->if_softc;
1477 mwl_setrates(vap);
1478 return (0);
1479 }
1480
1481 #ifdef MWL_DEBUG
1482 static void
mwl_keyprint(struct mwl_softc * sc,const char * tag,const MWL_HAL_KEYVAL * hk,const uint8_t mac[IEEE80211_ADDR_LEN])1483 mwl_keyprint(struct mwl_softc *sc, const char *tag,
1484 const MWL_HAL_KEYVAL *hk, const uint8_t mac[IEEE80211_ADDR_LEN])
1485 {
1486 static const char *ciphers[] = {
1487 "WEP",
1488 "TKIP",
1489 "AES-CCM",
1490 };
1491 int i, n;
1492
1493 printf("%s: [%u] %-7s", tag, hk->keyIndex, ciphers[hk->keyTypeId]);
1494 for (i = 0, n = hk->keyLen; i < n; i++)
1495 printf(" %02x", hk->key.aes[i]);
1496 printf(" mac %s", ether_sprintf(mac));
1497 if (hk->keyTypeId == KEY_TYPE_ID_TKIP) {
1498 printf(" %s", "rxmic");
1499 for (i = 0; i < sizeof(hk->key.tkip.rxMic); i++)
1500 printf(" %02x", hk->key.tkip.rxMic[i]);
1501 printf(" txmic");
1502 for (i = 0; i < sizeof(hk->key.tkip.txMic); i++)
1503 printf(" %02x", hk->key.tkip.txMic[i]);
1504 }
1505 printf(" flags 0x%x\n", hk->keyFlags);
1506 }
1507 #endif
1508
1509 /*
1510 * Allocate a key cache slot for a unicast key. The
1511 * firmware handles key allocation and every station is
1512 * guaranteed key space so we are always successful.
1513 */
1514 static int
mwl_key_alloc(struct ieee80211vap * vap,struct ieee80211_key * k,ieee80211_keyix * keyix,ieee80211_keyix * rxkeyix)1515 mwl_key_alloc(struct ieee80211vap *vap, struct ieee80211_key *k,
1516 ieee80211_keyix *keyix, ieee80211_keyix *rxkeyix)
1517 {
1518 struct mwl_softc *sc = vap->iv_ic->ic_softc;
1519
1520 if (k->wk_keyix != IEEE80211_KEYIX_NONE ||
1521 (k->wk_flags & IEEE80211_KEY_GROUP)) {
1522 if (!(&vap->iv_nw_keys[0] <= k &&
1523 k < &vap->iv_nw_keys[IEEE80211_WEP_NKID])) {
1524 /* should not happen */
1525 DPRINTF(sc, MWL_DEBUG_KEYCACHE,
1526 "%s: bogus group key\n", __func__);
1527 return 0;
1528 }
1529 /* give the caller what they requested */
1530 *keyix = *rxkeyix = ieee80211_crypto_get_key_wepidx(vap, k);
1531 } else {
1532 /*
1533 * Firmware handles key allocation.
1534 */
1535 *keyix = *rxkeyix = 0;
1536 }
1537 return 1;
1538 }
1539
1540 /*
1541 * Delete a key entry allocated by mwl_key_alloc.
1542 */
1543 static int
mwl_key_delete(struct ieee80211vap * vap,const struct ieee80211_key * k)1544 mwl_key_delete(struct ieee80211vap *vap, const struct ieee80211_key *k)
1545 {
1546 struct mwl_softc *sc = vap->iv_ic->ic_softc;
1547 struct mwl_hal_vap *hvap = MWL_VAP(vap)->mv_hvap;
1548 MWL_HAL_KEYVAL hk;
1549 const uint8_t bcastaddr[IEEE80211_ADDR_LEN] =
1550 { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
1551
1552 if (hvap == NULL) {
1553 if (vap->iv_opmode != IEEE80211_M_WDS) {
1554 /* XXX monitor mode? */
1555 DPRINTF(sc, MWL_DEBUG_KEYCACHE,
1556 "%s: no hvap for opmode %d\n", __func__,
1557 vap->iv_opmode);
1558 return 0;
1559 }
1560 hvap = MWL_VAP(vap)->mv_ap_hvap;
1561 }
1562
1563 DPRINTF(sc, MWL_DEBUG_KEYCACHE, "%s: delete key %u\n",
1564 __func__, k->wk_keyix);
1565
1566 memset(&hk, 0, sizeof(hk));
1567 hk.keyIndex = k->wk_keyix;
1568 switch (k->wk_cipher->ic_cipher) {
1569 case IEEE80211_CIPHER_WEP:
1570 hk.keyTypeId = KEY_TYPE_ID_WEP;
1571 break;
1572 case IEEE80211_CIPHER_TKIP:
1573 hk.keyTypeId = KEY_TYPE_ID_TKIP;
1574 break;
1575 case IEEE80211_CIPHER_AES_CCM:
1576 hk.keyTypeId = KEY_TYPE_ID_AES;
1577 break;
1578 default:
1579 /* XXX should not happen */
1580 DPRINTF(sc, MWL_DEBUG_KEYCACHE, "%s: unknown cipher %d\n",
1581 __func__, k->wk_cipher->ic_cipher);
1582 return 0;
1583 }
1584 return (mwl_hal_keyreset(hvap, &hk, bcastaddr) == 0); /*XXX*/
1585 }
1586
1587 static __inline int
addgroupflags(MWL_HAL_KEYVAL * hk,const struct ieee80211_key * k)1588 addgroupflags(MWL_HAL_KEYVAL *hk, const struct ieee80211_key *k)
1589 {
1590 if (k->wk_flags & IEEE80211_KEY_GROUP) {
1591 if (k->wk_flags & IEEE80211_KEY_XMIT)
1592 hk->keyFlags |= KEY_FLAG_TXGROUPKEY;
1593 if (k->wk_flags & IEEE80211_KEY_RECV)
1594 hk->keyFlags |= KEY_FLAG_RXGROUPKEY;
1595 return 1;
1596 } else
1597 return 0;
1598 }
1599
1600 /*
1601 * Set the key cache contents for the specified key. Key cache
1602 * slot(s) must already have been allocated by mwl_key_alloc.
1603 */
1604 static int
mwl_key_set(struct ieee80211vap * vap,const struct ieee80211_key * k)1605 mwl_key_set(struct ieee80211vap *vap, const struct ieee80211_key *k)
1606 {
1607 return (_mwl_key_set(vap, k, k->wk_macaddr));
1608 }
1609
1610 static int
_mwl_key_set(struct ieee80211vap * vap,const struct ieee80211_key * k,const uint8_t mac[IEEE80211_ADDR_LEN])1611 _mwl_key_set(struct ieee80211vap *vap, const struct ieee80211_key *k,
1612 const uint8_t mac[IEEE80211_ADDR_LEN])
1613 {
1614 #define GRPXMIT (IEEE80211_KEY_XMIT | IEEE80211_KEY_GROUP)
1615 /* NB: static wep keys are marked GROUP+tx/rx; GTK will be tx or rx */
1616 #define IEEE80211_IS_STATICKEY(k) \
1617 (((k)->wk_flags & (GRPXMIT|IEEE80211_KEY_RECV)) == \
1618 (GRPXMIT|IEEE80211_KEY_RECV))
1619 struct mwl_softc *sc = vap->iv_ic->ic_softc;
1620 struct mwl_hal_vap *hvap = MWL_VAP(vap)->mv_hvap;
1621 const struct ieee80211_cipher *cip = k->wk_cipher;
1622 const uint8_t *macaddr;
1623 MWL_HAL_KEYVAL hk;
1624
1625 KASSERT((k->wk_flags & IEEE80211_KEY_SWCRYPT) == 0,
1626 ("s/w crypto set?"));
1627
1628 if (hvap == NULL) {
1629 if (vap->iv_opmode != IEEE80211_M_WDS) {
1630 /* XXX monitor mode? */
1631 DPRINTF(sc, MWL_DEBUG_KEYCACHE,
1632 "%s: no hvap for opmode %d\n", __func__,
1633 vap->iv_opmode);
1634 return 0;
1635 }
1636 hvap = MWL_VAP(vap)->mv_ap_hvap;
1637 }
1638 memset(&hk, 0, sizeof(hk));
1639 hk.keyIndex = k->wk_keyix;
1640 switch (cip->ic_cipher) {
1641 case IEEE80211_CIPHER_WEP:
1642 hk.keyTypeId = KEY_TYPE_ID_WEP;
1643 hk.keyLen = k->wk_keylen;
1644 if (k->wk_keyix == vap->iv_def_txkey)
1645 hk.keyFlags = KEY_FLAG_WEP_TXKEY;
1646 if (!IEEE80211_IS_STATICKEY(k)) {
1647 /* NB: WEP is never used for the PTK */
1648 (void) addgroupflags(&hk, k);
1649 }
1650 break;
1651 case IEEE80211_CIPHER_TKIP:
1652 hk.keyTypeId = KEY_TYPE_ID_TKIP;
1653 hk.key.tkip.tsc.high = (uint32_t)(k->wk_keytsc >> 16);
1654 hk.key.tkip.tsc.low = (uint16_t)k->wk_keytsc;
1655 hk.keyFlags = KEY_FLAG_TSC_VALID | KEY_FLAG_MICKEY_VALID;
1656 hk.keyLen = k->wk_keylen + IEEE80211_MICBUF_SIZE;
1657 if (!addgroupflags(&hk, k))
1658 hk.keyFlags |= KEY_FLAG_PAIRWISE;
1659 break;
1660 case IEEE80211_CIPHER_AES_CCM:
1661 hk.keyTypeId = KEY_TYPE_ID_AES;
1662 hk.keyLen = k->wk_keylen;
1663 if (!addgroupflags(&hk, k))
1664 hk.keyFlags |= KEY_FLAG_PAIRWISE;
1665 break;
1666 default:
1667 /* XXX should not happen */
1668 DPRINTF(sc, MWL_DEBUG_KEYCACHE, "%s: unknown cipher %d\n",
1669 __func__, k->wk_cipher->ic_cipher);
1670 return 0;
1671 }
1672 /*
1673 * NB: tkip mic keys get copied here too; the layout
1674 * just happens to match that in ieee80211_key.
1675 */
1676 memcpy(hk.key.aes, k->wk_key, hk.keyLen);
1677
1678 /*
1679 * Locate address of sta db entry for writing key;
1680 * the convention unfortunately is somewhat different
1681 * than how net80211, hostapd, and wpa_supplicant think.
1682 */
1683 if (vap->iv_opmode == IEEE80211_M_STA) {
1684 /*
1685 * NB: keys plumbed before the sta reaches AUTH state
1686 * will be discarded or written to the wrong sta db
1687 * entry because iv_bss is meaningless. This is ok
1688 * (right now) because we handle deferred plumbing of
1689 * WEP keys when the sta reaches AUTH state.
1690 */
1691 macaddr = vap->iv_bss->ni_bssid;
1692 if ((k->wk_flags & IEEE80211_KEY_GROUP) == 0) {
1693 /* XXX plumb to local sta db too for static key wep */
1694 mwl_hal_keyset(hvap, &hk, vap->iv_myaddr);
1695 }
1696 } else if (vap->iv_opmode == IEEE80211_M_WDS &&
1697 vap->iv_state != IEEE80211_S_RUN) {
1698 /*
1699 * Prior to RUN state a WDS vap will not it's BSS node
1700 * setup so we will plumb the key to the wrong mac
1701 * address (it'll be our local address). Workaround
1702 * this for the moment by grabbing the correct address.
1703 */
1704 macaddr = vap->iv_des_bssid;
1705 } else if ((k->wk_flags & GRPXMIT) == GRPXMIT)
1706 macaddr = vap->iv_myaddr;
1707 else
1708 macaddr = mac;
1709 KEYPRINTF(sc, &hk, macaddr);
1710 return (mwl_hal_keyset(hvap, &hk, macaddr) == 0);
1711 #undef IEEE80211_IS_STATICKEY
1712 #undef GRPXMIT
1713 }
1714
1715 /*
1716 * Set the multicast filter contents into the hardware.
1717 * XXX f/w has no support; just defer to the os.
1718 */
1719 static void
mwl_setmcastfilter(struct mwl_softc * sc)1720 mwl_setmcastfilter(struct mwl_softc *sc)
1721 {
1722 #if 0
1723 struct ether_multi *enm;
1724 struct ether_multistep estep;
1725 uint8_t macs[IEEE80211_ADDR_LEN*MWL_HAL_MCAST_MAX];/* XXX stack use */
1726 uint8_t *mp;
1727 int nmc;
1728
1729 mp = macs;
1730 nmc = 0;
1731 ETHER_FIRST_MULTI(estep, &sc->sc_ec, enm);
1732 while (enm != NULL) {
1733 /* XXX Punt on ranges. */
1734 if (nmc == MWL_HAL_MCAST_MAX ||
1735 !IEEE80211_ADDR_EQ(enm->enm_addrlo, enm->enm_addrhi)) {
1736 ifp->if_flags |= IFF_ALLMULTI;
1737 return;
1738 }
1739 IEEE80211_ADDR_COPY(mp, enm->enm_addrlo);
1740 mp += IEEE80211_ADDR_LEN, nmc++;
1741 ETHER_NEXT_MULTI(estep, enm);
1742 }
1743 ifp->if_flags &= ~IFF_ALLMULTI;
1744 mwl_hal_setmcast(sc->sc_mh, nmc, macs);
1745 #endif
1746 }
1747
1748 static int
mwl_mode_init(struct mwl_softc * sc)1749 mwl_mode_init(struct mwl_softc *sc)
1750 {
1751 struct ieee80211com *ic = &sc->sc_ic;
1752 struct mwl_hal *mh = sc->sc_mh;
1753
1754 mwl_hal_setpromisc(mh, ic->ic_promisc > 0);
1755 mwl_setmcastfilter(sc);
1756
1757 return 0;
1758 }
1759
1760 /*
1761 * Callback from the 802.11 layer after a multicast state change.
1762 */
1763 static void
mwl_update_mcast(struct ieee80211com * ic)1764 mwl_update_mcast(struct ieee80211com *ic)
1765 {
1766 struct mwl_softc *sc = ic->ic_softc;
1767
1768 mwl_setmcastfilter(sc);
1769 }
1770
1771 /*
1772 * Callback from the 802.11 layer after a promiscuous mode change.
1773 * Note this interface does not check the operating mode as this
1774 * is an internal callback and we are expected to honor the current
1775 * state (e.g. this is used for setting the interface in promiscuous
1776 * mode when operating in hostap mode to do ACS).
1777 */
1778 static void
mwl_update_promisc(struct ieee80211com * ic)1779 mwl_update_promisc(struct ieee80211com *ic)
1780 {
1781 struct mwl_softc *sc = ic->ic_softc;
1782
1783 mwl_hal_setpromisc(sc->sc_mh, ic->ic_promisc > 0);
1784 }
1785
1786 /*
1787 * Callback from the 802.11 layer to update the slot time
1788 * based on the current setting. We use it to notify the
1789 * firmware of ERP changes and the f/w takes care of things
1790 * like slot time and preamble.
1791 */
1792 static void
mwl_updateslot(struct ieee80211com * ic)1793 mwl_updateslot(struct ieee80211com *ic)
1794 {
1795 struct mwl_softc *sc = ic->ic_softc;
1796 struct mwl_hal *mh = sc->sc_mh;
1797 int prot;
1798
1799 /* NB: can be called early; suppress needless cmds */
1800 if (!sc->sc_running)
1801 return;
1802
1803 /*
1804 * Calculate the ERP flags. The firwmare will use
1805 * this to carry out the appropriate measures.
1806 */
1807 prot = 0;
1808 if (IEEE80211_IS_CHAN_ANYG(ic->ic_curchan)) {
1809 if ((ic->ic_flags & IEEE80211_F_SHSLOT) == 0)
1810 prot |= IEEE80211_ERP_NON_ERP_PRESENT;
1811 if (ic->ic_flags & IEEE80211_F_USEPROT)
1812 prot |= IEEE80211_ERP_USE_PROTECTION;
1813 if (ic->ic_flags & IEEE80211_F_USEBARKER)
1814 prot |= IEEE80211_ERP_LONG_PREAMBLE;
1815 }
1816
1817 DPRINTF(sc, MWL_DEBUG_RESET,
1818 "%s: chan %u MHz/flags 0x%x %s slot, (prot 0x%x ic_flags 0x%x)\n",
1819 __func__, ic->ic_curchan->ic_freq, ic->ic_curchan->ic_flags,
1820 ic->ic_flags & IEEE80211_F_SHSLOT ? "short" : "long", prot,
1821 ic->ic_flags);
1822
1823 mwl_hal_setgprot(mh, prot);
1824 }
1825
1826 /*
1827 * Setup the beacon frame.
1828 */
1829 static int
mwl_beacon_setup(struct ieee80211vap * vap)1830 mwl_beacon_setup(struct ieee80211vap *vap)
1831 {
1832 struct mwl_hal_vap *hvap = MWL_VAP(vap)->mv_hvap;
1833 struct ieee80211_node *ni = vap->iv_bss;
1834 struct mbuf *m;
1835
1836 m = ieee80211_beacon_alloc(ni);
1837 if (m == NULL)
1838 return ENOBUFS;
1839 mwl_hal_setbeacon(hvap, mtod(m, const void *), m->m_len);
1840 m_free(m);
1841
1842 return 0;
1843 }
1844
1845 /*
1846 * Update the beacon frame in response to a change.
1847 */
1848 static void
mwl_beacon_update(struct ieee80211vap * vap,int item)1849 mwl_beacon_update(struct ieee80211vap *vap, int item)
1850 {
1851 struct mwl_hal_vap *hvap = MWL_VAP(vap)->mv_hvap;
1852 struct ieee80211com *ic = vap->iv_ic;
1853
1854 KASSERT(hvap != NULL, ("no beacon"));
1855 switch (item) {
1856 case IEEE80211_BEACON_ERP:
1857 mwl_updateslot(ic);
1858 break;
1859 case IEEE80211_BEACON_HTINFO:
1860 mwl_hal_setnprotmode(hvap, _IEEE80211_MASKSHIFT(
1861 ic->ic_curhtprotmode, IEEE80211_HTINFO_OPMODE));
1862 break;
1863 case IEEE80211_BEACON_CAPS:
1864 case IEEE80211_BEACON_WME:
1865 case IEEE80211_BEACON_APPIE:
1866 case IEEE80211_BEACON_CSA:
1867 break;
1868 case IEEE80211_BEACON_TIM:
1869 /* NB: firmware always forms TIM */
1870 return;
1871 }
1872 /* XXX retain beacon frame and update */
1873 mwl_beacon_setup(vap);
1874 }
1875
1876 static void
mwl_load_cb(void * arg,bus_dma_segment_t * segs,int nsegs,int error)1877 mwl_load_cb(void *arg, bus_dma_segment_t *segs, int nsegs, int error)
1878 {
1879 bus_addr_t *paddr = (bus_addr_t*) arg;
1880 KASSERT(error == 0, ("error %u on bus_dma callback", error));
1881 *paddr = segs->ds_addr;
1882 }
1883
1884 #ifdef MWL_HOST_PS_SUPPORT
1885 /*
1886 * Handle power save station occupancy changes.
1887 */
1888 static void
mwl_update_ps(struct ieee80211vap * vap,int nsta)1889 mwl_update_ps(struct ieee80211vap *vap, int nsta)
1890 {
1891 struct mwl_vap *mvp = MWL_VAP(vap);
1892
1893 if (nsta == 0 || mvp->mv_last_ps_sta == 0)
1894 mwl_hal_setpowersave_bss(mvp->mv_hvap, nsta);
1895 mvp->mv_last_ps_sta = nsta;
1896 }
1897
1898 /*
1899 * Handle associated station power save state changes.
1900 */
1901 static int
mwl_set_tim(struct ieee80211_node * ni,int set)1902 mwl_set_tim(struct ieee80211_node *ni, int set)
1903 {
1904 struct ieee80211vap *vap = ni->ni_vap;
1905 struct mwl_vap *mvp = MWL_VAP(vap);
1906
1907 if (mvp->mv_set_tim(ni, set)) { /* NB: state change */
1908 mwl_hal_setpowersave_sta(mvp->mv_hvap,
1909 IEEE80211_AID(ni->ni_associd), set);
1910 return 1;
1911 } else
1912 return 0;
1913 }
1914 #endif /* MWL_HOST_PS_SUPPORT */
1915
1916 static int
mwl_desc_setup(struct mwl_softc * sc,const char * name,struct mwl_descdma * dd,int nbuf,size_t bufsize,int ndesc,size_t descsize)1917 mwl_desc_setup(struct mwl_softc *sc, const char *name,
1918 struct mwl_descdma *dd,
1919 int nbuf, size_t bufsize, int ndesc, size_t descsize)
1920 {
1921 uint8_t *ds;
1922 int error;
1923
1924 DPRINTF(sc, MWL_DEBUG_RESET,
1925 "%s: %s DMA: %u bufs (%ju) %u desc/buf (%ju)\n",
1926 __func__, name, nbuf, (uintmax_t) bufsize,
1927 ndesc, (uintmax_t) descsize);
1928
1929 dd->dd_name = name;
1930 dd->dd_desc_len = nbuf * ndesc * descsize;
1931
1932 /*
1933 * Setup DMA descriptor area.
1934 */
1935 error = bus_dma_tag_create(bus_get_dma_tag(sc->sc_dev), /* parent */
1936 PAGE_SIZE, 0, /* alignment, bounds */
1937 BUS_SPACE_MAXADDR_32BIT, /* lowaddr */
1938 BUS_SPACE_MAXADDR, /* highaddr */
1939 NULL, NULL, /* filter, filterarg */
1940 dd->dd_desc_len, /* maxsize */
1941 1, /* nsegments */
1942 dd->dd_desc_len, /* maxsegsize */
1943 BUS_DMA_ALLOCNOW, /* flags */
1944 NULL, /* lockfunc */
1945 NULL, /* lockarg */
1946 &dd->dd_dmat);
1947 if (error != 0) {
1948 device_printf(sc->sc_dev, "cannot allocate %s DMA tag\n", dd->dd_name);
1949 return error;
1950 }
1951
1952 /* allocate descriptors */
1953 error = bus_dmamem_alloc(dd->dd_dmat, (void**) &dd->dd_desc,
1954 BUS_DMA_NOWAIT | BUS_DMA_COHERENT,
1955 &dd->dd_dmamap);
1956 if (error != 0) {
1957 device_printf(sc->sc_dev, "unable to alloc memory for %u %s descriptors, "
1958 "error %u\n", nbuf * ndesc, dd->dd_name, error);
1959 goto fail1;
1960 }
1961
1962 error = bus_dmamap_load(dd->dd_dmat, dd->dd_dmamap,
1963 dd->dd_desc, dd->dd_desc_len,
1964 mwl_load_cb, &dd->dd_desc_paddr,
1965 BUS_DMA_NOWAIT);
1966 if (error != 0) {
1967 device_printf(sc->sc_dev, "unable to map %s descriptors, error %u\n",
1968 dd->dd_name, error);
1969 goto fail2;
1970 }
1971
1972 ds = dd->dd_desc;
1973 memset(ds, 0, dd->dd_desc_len);
1974 DPRINTF(sc, MWL_DEBUG_RESET,
1975 "%s: %s DMA map: %p (%lu) -> 0x%jx (%lu)\n",
1976 __func__, dd->dd_name, ds, (u_long) dd->dd_desc_len,
1977 (uintmax_t) dd->dd_desc_paddr, /*XXX*/ (u_long) dd->dd_desc_len);
1978
1979 return 0;
1980 fail2:
1981 bus_dmamem_free(dd->dd_dmat, dd->dd_desc, dd->dd_dmamap);
1982 fail1:
1983 bus_dma_tag_destroy(dd->dd_dmat);
1984 memset(dd, 0, sizeof(*dd));
1985 return error;
1986 #undef DS2PHYS
1987 }
1988
1989 static void
mwl_desc_cleanup(struct mwl_softc * sc,struct mwl_descdma * dd)1990 mwl_desc_cleanup(struct mwl_softc *sc, struct mwl_descdma *dd)
1991 {
1992 bus_dmamap_unload(dd->dd_dmat, dd->dd_dmamap);
1993 bus_dmamem_free(dd->dd_dmat, dd->dd_desc, dd->dd_dmamap);
1994 bus_dma_tag_destroy(dd->dd_dmat);
1995
1996 memset(dd, 0, sizeof(*dd));
1997 }
1998
1999 /*
2000 * Construct a tx q's free list. The order of entries on
2001 * the list must reflect the physical layout of tx descriptors
2002 * because the firmware pre-fetches descriptors.
2003 *
2004 * XXX might be better to use indices into the buffer array.
2005 */
2006 static void
mwl_txq_reset(struct mwl_softc * sc,struct mwl_txq * txq)2007 mwl_txq_reset(struct mwl_softc *sc, struct mwl_txq *txq)
2008 {
2009 struct mwl_txbuf *bf;
2010 int i;
2011
2012 bf = txq->dma.dd_bufptr;
2013 STAILQ_INIT(&txq->free);
2014 for (i = 0; i < mwl_txbuf; i++, bf++)
2015 STAILQ_INSERT_TAIL(&txq->free, bf, bf_list);
2016 txq->nfree = i;
2017 }
2018
2019 #define DS2PHYS(_dd, _ds) \
2020 ((_dd)->dd_desc_paddr + ((caddr_t)(_ds) - (caddr_t)(_dd)->dd_desc))
2021
2022 static int
mwl_txdma_setup(struct mwl_softc * sc,struct mwl_txq * txq)2023 mwl_txdma_setup(struct mwl_softc *sc, struct mwl_txq *txq)
2024 {
2025 int error, bsize, i;
2026 struct mwl_txbuf *bf;
2027 struct mwl_txdesc *ds;
2028
2029 error = mwl_desc_setup(sc, "tx", &txq->dma,
2030 mwl_txbuf, sizeof(struct mwl_txbuf),
2031 MWL_TXDESC, sizeof(struct mwl_txdesc));
2032 if (error != 0)
2033 return error;
2034
2035 /* allocate and setup tx buffers */
2036 bsize = mwl_txbuf * sizeof(struct mwl_txbuf);
2037 bf = malloc(bsize, M_MWLDEV, M_NOWAIT | M_ZERO);
2038 if (bf == NULL) {
2039 device_printf(sc->sc_dev, "malloc of %u tx buffers failed\n",
2040 mwl_txbuf);
2041 return ENOMEM;
2042 }
2043 txq->dma.dd_bufptr = bf;
2044
2045 ds = txq->dma.dd_desc;
2046 for (i = 0; i < mwl_txbuf; i++, bf++, ds += MWL_TXDESC) {
2047 bf->bf_desc = ds;
2048 bf->bf_daddr = DS2PHYS(&txq->dma, ds);
2049 error = bus_dmamap_create(sc->sc_dmat, BUS_DMA_NOWAIT,
2050 &bf->bf_dmamap);
2051 if (error != 0) {
2052 device_printf(sc->sc_dev, "unable to create dmamap for tx "
2053 "buffer %u, error %u\n", i, error);
2054 return error;
2055 }
2056 }
2057 mwl_txq_reset(sc, txq);
2058 return 0;
2059 }
2060
2061 static void
mwl_txdma_cleanup(struct mwl_softc * sc,struct mwl_txq * txq)2062 mwl_txdma_cleanup(struct mwl_softc *sc, struct mwl_txq *txq)
2063 {
2064 struct mwl_txbuf *bf;
2065 int i;
2066
2067 bf = txq->dma.dd_bufptr;
2068 for (i = 0; i < mwl_txbuf; i++, bf++) {
2069 KASSERT(bf->bf_m == NULL, ("mbuf on free list"));
2070 KASSERT(bf->bf_node == NULL, ("node on free list"));
2071 if (bf->bf_dmamap != NULL)
2072 bus_dmamap_destroy(sc->sc_dmat, bf->bf_dmamap);
2073 }
2074 STAILQ_INIT(&txq->free);
2075 txq->nfree = 0;
2076 if (txq->dma.dd_bufptr != NULL) {
2077 free(txq->dma.dd_bufptr, M_MWLDEV);
2078 txq->dma.dd_bufptr = NULL;
2079 }
2080 if (txq->dma.dd_desc_len != 0)
2081 mwl_desc_cleanup(sc, &txq->dma);
2082 }
2083
2084 static int
mwl_rxdma_setup(struct mwl_softc * sc)2085 mwl_rxdma_setup(struct mwl_softc *sc)
2086 {
2087 int error, jumbosize, bsize, i;
2088 struct mwl_rxbuf *bf;
2089 struct mwl_jumbo *rbuf;
2090 struct mwl_rxdesc *ds;
2091 caddr_t data;
2092
2093 error = mwl_desc_setup(sc, "rx", &sc->sc_rxdma,
2094 mwl_rxdesc, sizeof(struct mwl_rxbuf),
2095 1, sizeof(struct mwl_rxdesc));
2096 if (error != 0)
2097 return error;
2098
2099 /*
2100 * Receive is done to a private pool of jumbo buffers.
2101 * This allows us to attach to mbuf's and avoid re-mapping
2102 * memory on each rx we post. We allocate a large chunk
2103 * of memory and manage it in the driver. The mbuf free
2104 * callback method is used to reclaim frames after sending
2105 * them up the stack. By default we allocate 2x the number of
2106 * rx descriptors configured so we have some slop to hold
2107 * us while frames are processed.
2108 */
2109 if (mwl_rxbuf < 2*mwl_rxdesc) {
2110 device_printf(sc->sc_dev,
2111 "too few rx dma buffers (%d); increasing to %d\n",
2112 mwl_rxbuf, 2*mwl_rxdesc);
2113 mwl_rxbuf = 2*mwl_rxdesc;
2114 }
2115 jumbosize = roundup(MWL_AGGR_SIZE, PAGE_SIZE);
2116 sc->sc_rxmemsize = mwl_rxbuf*jumbosize;
2117
2118 error = bus_dma_tag_create(sc->sc_dmat, /* parent */
2119 PAGE_SIZE, 0, /* alignment, bounds */
2120 BUS_SPACE_MAXADDR_32BIT, /* lowaddr */
2121 BUS_SPACE_MAXADDR, /* highaddr */
2122 NULL, NULL, /* filter, filterarg */
2123 sc->sc_rxmemsize, /* maxsize */
2124 1, /* nsegments */
2125 sc->sc_rxmemsize, /* maxsegsize */
2126 BUS_DMA_ALLOCNOW, /* flags */
2127 NULL, /* lockfunc */
2128 NULL, /* lockarg */
2129 &sc->sc_rxdmat);
2130 if (error != 0) {
2131 device_printf(sc->sc_dev, "could not create rx DMA tag\n");
2132 return error;
2133 }
2134
2135 error = bus_dmamem_alloc(sc->sc_rxdmat, (void**) &sc->sc_rxmem,
2136 BUS_DMA_NOWAIT | BUS_DMA_COHERENT,
2137 &sc->sc_rxmap);
2138 if (error != 0) {
2139 device_printf(sc->sc_dev, "could not alloc %ju bytes of rx DMA memory\n",
2140 (uintmax_t) sc->sc_rxmemsize);
2141 return error;
2142 }
2143
2144 error = bus_dmamap_load(sc->sc_rxdmat, sc->sc_rxmap,
2145 sc->sc_rxmem, sc->sc_rxmemsize,
2146 mwl_load_cb, &sc->sc_rxmem_paddr,
2147 BUS_DMA_NOWAIT);
2148 if (error != 0) {
2149 device_printf(sc->sc_dev, "could not load rx DMA map\n");
2150 return error;
2151 }
2152
2153 /*
2154 * Allocate rx buffers and set them up.
2155 */
2156 bsize = mwl_rxdesc * sizeof(struct mwl_rxbuf);
2157 bf = malloc(bsize, M_MWLDEV, M_NOWAIT | M_ZERO);
2158 if (bf == NULL) {
2159 device_printf(sc->sc_dev, "malloc of %u rx buffers failed\n", bsize);
2160 return error;
2161 }
2162 sc->sc_rxdma.dd_bufptr = bf;
2163
2164 STAILQ_INIT(&sc->sc_rxbuf);
2165 ds = sc->sc_rxdma.dd_desc;
2166 for (i = 0; i < mwl_rxdesc; i++, bf++, ds++) {
2167 bf->bf_desc = ds;
2168 bf->bf_daddr = DS2PHYS(&sc->sc_rxdma, ds);
2169 /* pre-assign dma buffer */
2170 bf->bf_data = ((uint8_t *)sc->sc_rxmem) + (i*jumbosize);
2171 /* NB: tail is intentional to preserve descriptor order */
2172 STAILQ_INSERT_TAIL(&sc->sc_rxbuf, bf, bf_list);
2173 }
2174
2175 /*
2176 * Place remainder of dma memory buffers on the free list.
2177 */
2178 SLIST_INIT(&sc->sc_rxfree);
2179 for (; i < mwl_rxbuf; i++) {
2180 data = ((uint8_t *)sc->sc_rxmem) + (i*jumbosize);
2181 rbuf = MWL_JUMBO_DATA2BUF(data);
2182 SLIST_INSERT_HEAD(&sc->sc_rxfree, rbuf, next);
2183 sc->sc_nrxfree++;
2184 }
2185 return 0;
2186 }
2187 #undef DS2PHYS
2188
2189 static void
mwl_rxdma_cleanup(struct mwl_softc * sc)2190 mwl_rxdma_cleanup(struct mwl_softc *sc)
2191 {
2192 if (sc->sc_rxmem_paddr != 0) {
2193 bus_dmamap_unload(sc->sc_rxdmat, sc->sc_rxmap);
2194 sc->sc_rxmem_paddr = 0;
2195 }
2196 if (sc->sc_rxmem != NULL) {
2197 bus_dmamem_free(sc->sc_rxdmat, sc->sc_rxmem, sc->sc_rxmap);
2198 sc->sc_rxmem = NULL;
2199 }
2200 if (sc->sc_rxdma.dd_bufptr != NULL) {
2201 free(sc->sc_rxdma.dd_bufptr, M_MWLDEV);
2202 sc->sc_rxdma.dd_bufptr = NULL;
2203 }
2204 if (sc->sc_rxdma.dd_desc_len != 0)
2205 mwl_desc_cleanup(sc, &sc->sc_rxdma);
2206 }
2207
2208 static int
mwl_dma_setup(struct mwl_softc * sc)2209 mwl_dma_setup(struct mwl_softc *sc)
2210 {
2211 int error, i;
2212
2213 error = mwl_rxdma_setup(sc);
2214 if (error != 0) {
2215 mwl_rxdma_cleanup(sc);
2216 return error;
2217 }
2218
2219 for (i = 0; i < MWL_NUM_TX_QUEUES; i++) {
2220 error = mwl_txdma_setup(sc, &sc->sc_txq[i]);
2221 if (error != 0) {
2222 mwl_dma_cleanup(sc);
2223 return error;
2224 }
2225 }
2226 return 0;
2227 }
2228
2229 static void
mwl_dma_cleanup(struct mwl_softc * sc)2230 mwl_dma_cleanup(struct mwl_softc *sc)
2231 {
2232 int i;
2233
2234 for (i = 0; i < MWL_NUM_TX_QUEUES; i++)
2235 mwl_txdma_cleanup(sc, &sc->sc_txq[i]);
2236 mwl_rxdma_cleanup(sc);
2237 }
2238
2239 static struct ieee80211_node *
mwl_node_alloc(struct ieee80211vap * vap,const uint8_t mac[IEEE80211_ADDR_LEN])2240 mwl_node_alloc(struct ieee80211vap *vap, const uint8_t mac[IEEE80211_ADDR_LEN])
2241 {
2242 struct ieee80211com *ic = vap->iv_ic;
2243 struct mwl_softc *sc = ic->ic_softc;
2244 const size_t space = sizeof(struct mwl_node);
2245 struct mwl_node *mn;
2246
2247 mn = malloc(space, M_80211_NODE, M_NOWAIT|M_ZERO);
2248 if (mn == NULL) {
2249 /* XXX stat+msg */
2250 return NULL;
2251 }
2252 DPRINTF(sc, MWL_DEBUG_NODE, "%s: mn %p\n", __func__, mn);
2253 return &mn->mn_node;
2254 }
2255
2256 static void
mwl_node_cleanup(struct ieee80211_node * ni)2257 mwl_node_cleanup(struct ieee80211_node *ni)
2258 {
2259 struct ieee80211com *ic = ni->ni_ic;
2260 struct mwl_softc *sc = ic->ic_softc;
2261 struct mwl_node *mn = MWL_NODE(ni);
2262
2263 DPRINTF(sc, MWL_DEBUG_NODE, "%s: ni %p ic %p staid %d\n",
2264 __func__, ni, ni->ni_ic, mn->mn_staid);
2265
2266 if (mn->mn_staid != 0) {
2267 struct ieee80211vap *vap = ni->ni_vap;
2268
2269 if (mn->mn_hvap != NULL) {
2270 if (vap->iv_opmode == IEEE80211_M_STA)
2271 mwl_hal_delstation(mn->mn_hvap, vap->iv_myaddr);
2272 else
2273 mwl_hal_delstation(mn->mn_hvap, ni->ni_macaddr);
2274 }
2275 /*
2276 * NB: legacy WDS peer sta db entry is installed using
2277 * the associate ap's hvap; use it again to delete it.
2278 * XXX can vap be NULL?
2279 */
2280 else if (vap->iv_opmode == IEEE80211_M_WDS &&
2281 MWL_VAP(vap)->mv_ap_hvap != NULL)
2282 mwl_hal_delstation(MWL_VAP(vap)->mv_ap_hvap,
2283 ni->ni_macaddr);
2284 delstaid(sc, mn->mn_staid);
2285 mn->mn_staid = 0;
2286 }
2287 sc->sc_node_cleanup(ni);
2288 }
2289
2290 /*
2291 * Reclaim rx dma buffers from packets sitting on the ampdu
2292 * reorder queue for a station. We replace buffers with a
2293 * system cluster (if available).
2294 */
2295 static void
mwl_ampdu_rxdma_reclaim(struct ieee80211_rx_ampdu * rap)2296 mwl_ampdu_rxdma_reclaim(struct ieee80211_rx_ampdu *rap)
2297 {
2298 #if 0
2299 int i, n, off;
2300 struct mbuf *m;
2301 void *cl;
2302
2303 n = rap->rxa_qframes;
2304 for (i = 0; i < rap->rxa_wnd && n > 0; i++) {
2305 m = rap->rxa_m[i];
2306 if (m == NULL)
2307 continue;
2308 n--;
2309 /* our dma buffers have a well-known free routine */
2310 if ((m->m_flags & M_EXT) == 0 ||
2311 m->m_ext.ext_free != mwl_ext_free)
2312 continue;
2313 /*
2314 * Try to allocate a cluster and move the data.
2315 */
2316 off = m->m_data - m->m_ext.ext_buf;
2317 if (off + m->m_pkthdr.len > MCLBYTES) {
2318 /* XXX no AMSDU for now */
2319 continue;
2320 }
2321 cl = pool_cache_get_paddr(&mclpool_cache, 0,
2322 &m->m_ext.ext_paddr);
2323 if (cl != NULL) {
2324 /*
2325 * Copy the existing data to the cluster, remove
2326 * the rx dma buffer, and attach the cluster in
2327 * its place. Note we preserve the offset to the
2328 * data so frames being bridged can still prepend
2329 * their headers without adding another mbuf.
2330 */
2331 memcpy((caddr_t) cl + off, m->m_data, m->m_pkthdr.len);
2332 MEXTREMOVE(m);
2333 MEXTADD(m, cl, MCLBYTES, 0, NULL, &mclpool_cache);
2334 /* setup mbuf like _MCLGET does */
2335 m->m_flags |= M_CLUSTER | M_EXT_RW;
2336 _MOWNERREF(m, M_EXT | M_CLUSTER);
2337 /* NB: m_data is clobbered by MEXTADDR, adjust */
2338 m->m_data += off;
2339 }
2340 }
2341 #endif
2342 }
2343
2344 /*
2345 * Callback to reclaim resources. We first let the
2346 * net80211 layer do it's thing, then if we are still
2347 * blocked by a lack of rx dma buffers we walk the ampdu
2348 * reorder q's to reclaim buffers by copying to a system
2349 * cluster.
2350 */
2351 static void
mwl_node_drain(struct ieee80211_node * ni)2352 mwl_node_drain(struct ieee80211_node *ni)
2353 {
2354 struct ieee80211com *ic = ni->ni_ic;
2355 struct mwl_softc *sc = ic->ic_softc;
2356 struct mwl_node *mn = MWL_NODE(ni);
2357
2358 DPRINTF(sc, MWL_DEBUG_NODE, "%s: ni %p vap %p staid %d\n",
2359 __func__, ni, ni->ni_vap, mn->mn_staid);
2360
2361 /* NB: call up first to age out ampdu q's */
2362 sc->sc_node_drain(ni);
2363
2364 /* XXX better to not check low water mark? */
2365 if (sc->sc_rxblocked && mn->mn_staid != 0 &&
2366 (ni->ni_flags & IEEE80211_NODE_HT)) {
2367 uint8_t tid;
2368 /*
2369 * Walk the reorder q and reclaim rx dma buffers by copying
2370 * the packet contents into clusters.
2371 */
2372 for (tid = 0; tid < WME_NUM_TID; tid++) {
2373 struct ieee80211_rx_ampdu *rap;
2374
2375 rap = &ni->ni_rx_ampdu[tid];
2376 if ((rap->rxa_flags & IEEE80211_AGGR_XCHGPEND) == 0)
2377 continue;
2378 if (rap->rxa_qframes)
2379 mwl_ampdu_rxdma_reclaim(rap);
2380 }
2381 }
2382 }
2383
2384 static void
mwl_node_getsignal(const struct ieee80211_node * ni,int8_t * rssi,int8_t * noise)2385 mwl_node_getsignal(const struct ieee80211_node *ni, int8_t *rssi, int8_t *noise)
2386 {
2387 *rssi = ni->ni_ic->ic_node_getrssi(ni);
2388 #ifdef MWL_ANT_INFO_SUPPORT
2389 #if 0
2390 /* XXX need to smooth data */
2391 *noise = -MWL_NODE_CONST(ni)->mn_ai.nf;
2392 #else
2393 *noise = -95; /* XXX */
2394 #endif
2395 #else
2396 *noise = -95; /* XXX */
2397 #endif
2398 }
2399
2400 /*
2401 * Convert Hardware per-antenna rssi info to common format:
2402 * Let a1, a2, a3 represent the amplitudes per chain
2403 * Let amax represent max[a1, a2, a3]
2404 * Rssi1_dBm = RSSI_dBm + 20*log10(a1/amax)
2405 * Rssi1_dBm = RSSI_dBm + 20*log10(a1) - 20*log10(amax)
2406 * We store a table that is 4*20*log10(idx) - the extra 4 is to store or
2407 * maintain some extra precision.
2408 *
2409 * Values are stored in .5 db format capped at 127.
2410 */
2411 static void
mwl_node_getmimoinfo(const struct ieee80211_node * ni,struct ieee80211_mimo_info * mi)2412 mwl_node_getmimoinfo(const struct ieee80211_node *ni,
2413 struct ieee80211_mimo_info *mi)
2414 {
2415 #define CVT(_dst, _src) do { \
2416 (_dst) = rssi + ((logdbtbl[_src] - logdbtbl[rssi_max]) >> 2); \
2417 (_dst) = (_dst) > 64 ? 127 : ((_dst) << 1); \
2418 } while (0)
2419 static const int8_t logdbtbl[32] = {
2420 0, 0, 24, 38, 48, 56, 62, 68,
2421 72, 76, 80, 83, 86, 89, 92, 94,
2422 96, 98, 100, 102, 104, 106, 107, 109,
2423 110, 112, 113, 115, 116, 117, 118, 119
2424 };
2425 const struct mwl_node *mn = MWL_NODE_CONST(ni);
2426 uint8_t rssi = mn->mn_ai.rsvd1/2; /* XXX */
2427 uint32_t rssi_max;
2428
2429 rssi_max = mn->mn_ai.rssi_a;
2430 if (mn->mn_ai.rssi_b > rssi_max)
2431 rssi_max = mn->mn_ai.rssi_b;
2432 if (mn->mn_ai.rssi_c > rssi_max)
2433 rssi_max = mn->mn_ai.rssi_c;
2434
2435 CVT(mi->ch[0].rssi[0], mn->mn_ai.rssi_a);
2436 CVT(mi->ch[1].rssi[0], mn->mn_ai.rssi_b);
2437 CVT(mi->ch[2].rssi[0], mn->mn_ai.rssi_c);
2438
2439 mi->ch[0].noise[0] = mn->mn_ai.nf_a;
2440 mi->ch[1].noise[0] = mn->mn_ai.nf_b;
2441 mi->ch[2].noise[0] = mn->mn_ai.nf_c;
2442 #undef CVT
2443 }
2444
2445 static __inline void *
mwl_getrxdma(struct mwl_softc * sc)2446 mwl_getrxdma(struct mwl_softc *sc)
2447 {
2448 struct mwl_jumbo *buf;
2449 void *data;
2450
2451 /*
2452 * Allocate from jumbo pool.
2453 */
2454 MWL_RXFREE_LOCK(sc);
2455 buf = SLIST_FIRST(&sc->sc_rxfree);
2456 if (buf == NULL) {
2457 DPRINTF(sc, MWL_DEBUG_ANY,
2458 "%s: out of rx dma buffers\n", __func__);
2459 sc->sc_stats.mst_rx_nodmabuf++;
2460 data = NULL;
2461 } else {
2462 SLIST_REMOVE_HEAD(&sc->sc_rxfree, next);
2463 sc->sc_nrxfree--;
2464 data = MWL_JUMBO_BUF2DATA(buf);
2465 }
2466 MWL_RXFREE_UNLOCK(sc);
2467 return data;
2468 }
2469
2470 static __inline void
mwl_putrxdma(struct mwl_softc * sc,void * data)2471 mwl_putrxdma(struct mwl_softc *sc, void *data)
2472 {
2473 struct mwl_jumbo *buf;
2474
2475 /* XXX bounds check data */
2476 MWL_RXFREE_LOCK(sc);
2477 buf = MWL_JUMBO_DATA2BUF(data);
2478 SLIST_INSERT_HEAD(&sc->sc_rxfree, buf, next);
2479 sc->sc_nrxfree++;
2480 MWL_RXFREE_UNLOCK(sc);
2481 }
2482
2483 static int
mwl_rxbuf_init(struct mwl_softc * sc,struct mwl_rxbuf * bf)2484 mwl_rxbuf_init(struct mwl_softc *sc, struct mwl_rxbuf *bf)
2485 {
2486 struct mwl_rxdesc *ds;
2487
2488 ds = bf->bf_desc;
2489 if (bf->bf_data == NULL) {
2490 bf->bf_data = mwl_getrxdma(sc);
2491 if (bf->bf_data == NULL) {
2492 /* mark descriptor to be skipped */
2493 ds->RxControl = EAGLE_RXD_CTRL_OS_OWN;
2494 /* NB: don't need PREREAD */
2495 MWL_RXDESC_SYNC(sc, ds, BUS_DMASYNC_PREWRITE);
2496 sc->sc_stats.mst_rxbuf_failed++;
2497 return ENOMEM;
2498 }
2499 }
2500 /*
2501 * NB: DMA buffer contents is known to be unmodified
2502 * so there's no need to flush the data cache.
2503 */
2504
2505 /*
2506 * Setup descriptor.
2507 */
2508 ds->QosCtrl = 0;
2509 ds->RSSI = 0;
2510 ds->Status = EAGLE_RXD_STATUS_IDLE;
2511 ds->Channel = 0;
2512 ds->PktLen = htole16(MWL_AGGR_SIZE);
2513 ds->SQ2 = 0;
2514 ds->pPhysBuffData = htole32(MWL_JUMBO_DMA_ADDR(sc, bf->bf_data));
2515 /* NB: don't touch pPhysNext, set once */
2516 ds->RxControl = EAGLE_RXD_CTRL_DRIVER_OWN;
2517 MWL_RXDESC_SYNC(sc, ds, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
2518
2519 return 0;
2520 }
2521
2522 static void
mwl_ext_free(struct mbuf * m)2523 mwl_ext_free(struct mbuf *m)
2524 {
2525 struct mwl_softc *sc = m->m_ext.ext_arg1;
2526
2527 /* XXX bounds check data */
2528 mwl_putrxdma(sc, m->m_ext.ext_buf);
2529 /*
2530 * If we were previously blocked by a lack of rx dma buffers
2531 * check if we now have enough to restart rx interrupt handling.
2532 * NB: we know we are called at splvm which is above splnet.
2533 */
2534 if (sc->sc_rxblocked && sc->sc_nrxfree > mwl_rxdmalow) {
2535 sc->sc_rxblocked = 0;
2536 mwl_hal_intrset(sc->sc_mh, sc->sc_imask);
2537 }
2538 }
2539
2540 struct mwl_frame_bar {
2541 u_int8_t i_fc[2];
2542 u_int8_t i_dur[2];
2543 u_int8_t i_ra[IEEE80211_ADDR_LEN];
2544 u_int8_t i_ta[IEEE80211_ADDR_LEN];
2545 /* ctl, seq, FCS */
2546 } __packed;
2547
2548 /*
2549 * Like ieee80211_anyhdrsize, but handles BAR frames
2550 * specially so the logic below to piece the 802.11
2551 * header together works.
2552 */
2553 static __inline int
mwl_anyhdrsize(const void * data)2554 mwl_anyhdrsize(const void *data)
2555 {
2556 const struct ieee80211_frame *wh = data;
2557
2558 if ((wh->i_fc[0]&IEEE80211_FC0_TYPE_MASK) == IEEE80211_FC0_TYPE_CTL) {
2559 switch (wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) {
2560 case IEEE80211_FC0_SUBTYPE_CTS:
2561 case IEEE80211_FC0_SUBTYPE_ACK:
2562 return sizeof(struct ieee80211_frame_ack);
2563 case IEEE80211_FC0_SUBTYPE_BAR:
2564 return sizeof(struct mwl_frame_bar);
2565 }
2566 return sizeof(struct ieee80211_frame_min);
2567 } else
2568 return ieee80211_hdrsize(data);
2569 }
2570
2571 static void
mwl_handlemicerror(struct ieee80211com * ic,const uint8_t * data)2572 mwl_handlemicerror(struct ieee80211com *ic, const uint8_t *data)
2573 {
2574 const struct ieee80211_frame *wh;
2575 struct ieee80211_node *ni;
2576
2577 wh = (const struct ieee80211_frame *)(data + sizeof(uint16_t));
2578 ni = ieee80211_find_rxnode(ic, (const struct ieee80211_frame_min *) wh);
2579 if (ni != NULL) {
2580 ieee80211_notify_michael_failure(ni->ni_vap, wh, 0);
2581 ieee80211_free_node(ni);
2582 }
2583 }
2584
2585 /*
2586 * Convert hardware signal strength to rssi. The value
2587 * provided by the device has the noise floor added in;
2588 * we need to compensate for this but we don't have that
2589 * so we use a fixed value.
2590 *
2591 * The offset of 8 is good for both 2.4 and 5GHz. The LNA
2592 * offset is already set as part of the initial gain. This
2593 * will give at least +/- 3dB for 2.4GHz and +/- 5dB for 5GHz.
2594 */
2595 static __inline int
cvtrssi(uint8_t ssi)2596 cvtrssi(uint8_t ssi)
2597 {
2598 int rssi = (int) ssi + 8;
2599 /* XXX hack guess until we have a real noise floor */
2600 rssi = 2*(87 - rssi); /* NB: .5 dBm units */
2601 return (rssi < 0 ? 0 : rssi > 127 ? 127 : rssi);
2602 }
2603
2604 static void
mwl_rx_proc(void * arg,int npending)2605 mwl_rx_proc(void *arg, int npending)
2606 {
2607 struct mwl_softc *sc = arg;
2608 struct ieee80211com *ic = &sc->sc_ic;
2609 struct mwl_rxbuf *bf;
2610 struct mwl_rxdesc *ds;
2611 struct mbuf *m;
2612 struct ieee80211_qosframe *wh;
2613 struct ieee80211_node *ni;
2614 struct mwl_node *mn;
2615 int off, len, hdrlen, pktlen, rssi, ntodo;
2616 uint8_t *data, status;
2617 void *newdata;
2618 int16_t nf;
2619
2620 DPRINTF(sc, MWL_DEBUG_RX_PROC, "%s: pending %u rdptr 0x%x wrptr 0x%x\n",
2621 __func__, npending, RD4(sc, sc->sc_hwspecs.rxDescRead),
2622 RD4(sc, sc->sc_hwspecs.rxDescWrite));
2623 nf = -96; /* XXX */
2624 bf = sc->sc_rxnext;
2625 for (ntodo = mwl_rxquota; ntodo > 0; ntodo--) {
2626 if (bf == NULL)
2627 bf = STAILQ_FIRST(&sc->sc_rxbuf);
2628 ds = bf->bf_desc;
2629 data = bf->bf_data;
2630 if (data == NULL) {
2631 /*
2632 * If data allocation failed previously there
2633 * will be no buffer; try again to re-populate it.
2634 * Note the firmware will not advance to the next
2635 * descriptor with a dma buffer so we must mimic
2636 * this or we'll get out of sync.
2637 */
2638 DPRINTF(sc, MWL_DEBUG_ANY,
2639 "%s: rx buf w/o dma memory\n", __func__);
2640 (void) mwl_rxbuf_init(sc, bf);
2641 sc->sc_stats.mst_rx_dmabufmissing++;
2642 break;
2643 }
2644 MWL_RXDESC_SYNC(sc, ds,
2645 BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
2646 if (ds->RxControl != EAGLE_RXD_CTRL_DMA_OWN)
2647 break;
2648 #ifdef MWL_DEBUG
2649 if (sc->sc_debug & MWL_DEBUG_RECV_DESC)
2650 mwl_printrxbuf(bf, 0);
2651 #endif
2652 status = ds->Status;
2653 if (status & EAGLE_RXD_STATUS_DECRYPT_ERR_MASK) {
2654 counter_u64_add(ic->ic_ierrors, 1);
2655 sc->sc_stats.mst_rx_crypto++;
2656 /*
2657 * NB: Check EAGLE_RXD_STATUS_GENERAL_DECRYPT_ERR
2658 * for backwards compatibility.
2659 */
2660 if (status != EAGLE_RXD_STATUS_GENERAL_DECRYPT_ERR &&
2661 (status & EAGLE_RXD_STATUS_TKIP_MIC_DECRYPT_ERR)) {
2662 /*
2663 * MIC error, notify upper layers.
2664 */
2665 bus_dmamap_sync(sc->sc_rxdmat, sc->sc_rxmap,
2666 BUS_DMASYNC_POSTREAD);
2667 mwl_handlemicerror(ic, data);
2668 sc->sc_stats.mst_rx_tkipmic++;
2669 }
2670 /* XXX too painful to tap packets */
2671 goto rx_next;
2672 }
2673 /*
2674 * Sync the data buffer.
2675 */
2676 len = le16toh(ds->PktLen);
2677 bus_dmamap_sync(sc->sc_rxdmat, sc->sc_rxmap, BUS_DMASYNC_POSTREAD);
2678 /*
2679 * The 802.11 header is provided all or in part at the front;
2680 * use it to calculate the true size of the header that we'll
2681 * construct below. We use this to figure out where to copy
2682 * payload prior to constructing the header.
2683 */
2684 hdrlen = mwl_anyhdrsize(data + sizeof(uint16_t));
2685 off = sizeof(uint16_t) + sizeof(struct ieee80211_frame_addr4);
2686
2687 /* calculate rssi early so we can re-use for each aggregate */
2688 rssi = cvtrssi(ds->RSSI);
2689
2690 pktlen = hdrlen + (len - off);
2691 /*
2692 * NB: we know our frame is at least as large as
2693 * IEEE80211_MIN_LEN because there is a 4-address
2694 * frame at the front. Hence there's no need to
2695 * vet the packet length. If the frame in fact
2696 * is too small it should be discarded at the
2697 * net80211 layer.
2698 */
2699
2700 /*
2701 * Attach dma buffer to an mbuf. We tried
2702 * doing this based on the packet size (i.e.
2703 * copying small packets) but it turns out to
2704 * be a net loss. The tradeoff might be system
2705 * dependent (cache architecture is important).
2706 */
2707 MGETHDR(m, M_NOWAIT, MT_DATA);
2708 if (m == NULL) {
2709 DPRINTF(sc, MWL_DEBUG_ANY,
2710 "%s: no rx mbuf\n", __func__);
2711 sc->sc_stats.mst_rx_nombuf++;
2712 goto rx_next;
2713 }
2714 /*
2715 * Acquire the replacement dma buffer before
2716 * processing the frame. If we're out of dma
2717 * buffers we disable rx interrupts and wait
2718 * for the free pool to reach mlw_rxdmalow buffers
2719 * before starting to do work again. If the firmware
2720 * runs out of descriptors then it will toss frames
2721 * which is better than our doing it as that can
2722 * starve our processing. It is also important that
2723 * we always process rx'd frames in case they are
2724 * A-MPDU as otherwise the host's view of the BA
2725 * window may get out of sync with the firmware.
2726 */
2727 newdata = mwl_getrxdma(sc);
2728 if (newdata == NULL) {
2729 /* NB: stat+msg in mwl_getrxdma */
2730 m_free(m);
2731 /* disable RX interrupt and mark state */
2732 mwl_hal_intrset(sc->sc_mh,
2733 sc->sc_imask &~ MACREG_A2HRIC_BIT_RX_RDY);
2734 sc->sc_rxblocked = 1;
2735 ieee80211_drain(ic);
2736 /* XXX check rxblocked and immediately start again? */
2737 goto rx_stop;
2738 }
2739 bf->bf_data = newdata;
2740 /*
2741 * Attach the dma buffer to the mbuf;
2742 * mwl_rxbuf_init will re-setup the rx
2743 * descriptor using the replacement dma
2744 * buffer we just installed above.
2745 */
2746 m_extadd(m, data, MWL_AGGR_SIZE, mwl_ext_free, sc, NULL, 0,
2747 EXT_NET_DRV);
2748 m->m_data += off - hdrlen;
2749 m->m_pkthdr.len = m->m_len = pktlen;
2750 /* NB: dma buffer assumed read-only */
2751
2752 /*
2753 * Piece 802.11 header together.
2754 */
2755 wh = mtod(m, struct ieee80211_qosframe *);
2756 /* NB: don't need to do this sometimes but ... */
2757 /* XXX special case so we can memcpy after m_devget? */
2758 ovbcopy(data + sizeof(uint16_t), wh, hdrlen);
2759 if (IEEE80211_QOS_HAS_SEQ(wh))
2760 *(uint16_t *)ieee80211_getqos(wh) = ds->QosCtrl;
2761 /*
2762 * The f/w strips WEP header but doesn't clear
2763 * the WEP bit; mark the packet with M_WEP so
2764 * net80211 will treat the data as decrypted.
2765 * While here also clear the PWR_MGT bit since
2766 * power save is handled by the firmware and
2767 * passing this up will potentially cause the
2768 * upper layer to put a station in power save
2769 * (except when configured with MWL_HOST_PS_SUPPORT).
2770 */
2771 if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED)
2772 m->m_flags |= M_WEP;
2773 #ifdef MWL_HOST_PS_SUPPORT
2774 wh->i_fc[1] &= ~IEEE80211_FC1_PROTECTED;
2775 #else
2776 wh->i_fc[1] &= ~(IEEE80211_FC1_PROTECTED |
2777 IEEE80211_FC1_PWR_MGT);
2778 #endif
2779
2780 if (ieee80211_radiotap_active(ic)) {
2781 struct mwl_rx_radiotap_header *tap = &sc->sc_rx_th;
2782
2783 tap->wr_flags = 0;
2784 tap->wr_rate = ds->Rate;
2785 tap->wr_antsignal = rssi + nf;
2786 tap->wr_antnoise = nf;
2787 }
2788 if (IFF_DUMPPKTS_RECV(sc, wh)) {
2789 ieee80211_dump_pkt(ic, mtod(m, caddr_t),
2790 len, ds->Rate, rssi);
2791 }
2792 /* dispatch */
2793 ni = ieee80211_find_rxnode(ic,
2794 (const struct ieee80211_frame_min *) wh);
2795 if (ni != NULL) {
2796 mn = MWL_NODE(ni);
2797 #ifdef MWL_ANT_INFO_SUPPORT
2798 mn->mn_ai.rssi_a = ds->ai.rssi_a;
2799 mn->mn_ai.rssi_b = ds->ai.rssi_b;
2800 mn->mn_ai.rssi_c = ds->ai.rssi_c;
2801 mn->mn_ai.rsvd1 = rssi;
2802 #endif
2803 /* tag AMPDU aggregates for reorder processing */
2804 if (ni->ni_flags & IEEE80211_NODE_HT)
2805 m->m_flags |= M_AMPDU;
2806 (void) ieee80211_input(ni, m, rssi, nf);
2807 ieee80211_free_node(ni);
2808 } else
2809 (void) ieee80211_input_all(ic, m, rssi, nf);
2810 rx_next:
2811 /* NB: ignore ENOMEM so we process more descriptors */
2812 (void) mwl_rxbuf_init(sc, bf);
2813 bf = STAILQ_NEXT(bf, bf_list);
2814 }
2815 rx_stop:
2816 sc->sc_rxnext = bf;
2817
2818 if (mbufq_first(&sc->sc_snd) != NULL) {
2819 /* NB: kick fw; the tx thread may have been preempted */
2820 mwl_hal_txstart(sc->sc_mh, 0);
2821 mwl_start(sc);
2822 }
2823 }
2824
2825 static void
mwl_txq_init(struct mwl_softc * sc,struct mwl_txq * txq,int qnum)2826 mwl_txq_init(struct mwl_softc *sc, struct mwl_txq *txq, int qnum)
2827 {
2828 struct mwl_txbuf *bf, *bn;
2829 struct mwl_txdesc *ds;
2830
2831 MWL_TXQ_LOCK_INIT(sc, txq);
2832 txq->qnum = qnum;
2833 txq->txpri = 0; /* XXX */
2834 #if 0
2835 /* NB: q setup by mwl_txdma_setup XXX */
2836 STAILQ_INIT(&txq->free);
2837 #endif
2838 STAILQ_FOREACH(bf, &txq->free, bf_list) {
2839 bf->bf_txq = txq;
2840
2841 ds = bf->bf_desc;
2842 bn = STAILQ_NEXT(bf, bf_list);
2843 if (bn == NULL)
2844 bn = STAILQ_FIRST(&txq->free);
2845 ds->pPhysNext = htole32(bn->bf_daddr);
2846 }
2847 STAILQ_INIT(&txq->active);
2848 }
2849
2850 /*
2851 * Setup a hardware data transmit queue for the specified
2852 * access control. We record the mapping from ac's
2853 * to h/w queues for use by mwl_tx_start.
2854 */
2855 static int
mwl_tx_setup(struct mwl_softc * sc,int ac,int mvtype)2856 mwl_tx_setup(struct mwl_softc *sc, int ac, int mvtype)
2857 {
2858 struct mwl_txq *txq;
2859
2860 if (ac >= nitems(sc->sc_ac2q)) {
2861 device_printf(sc->sc_dev, "AC %u out of range, max %zu!\n",
2862 ac, nitems(sc->sc_ac2q));
2863 return 0;
2864 }
2865 if (mvtype >= MWL_NUM_TX_QUEUES) {
2866 device_printf(sc->sc_dev, "mvtype %u out of range, max %u!\n",
2867 mvtype, MWL_NUM_TX_QUEUES);
2868 return 0;
2869 }
2870 txq = &sc->sc_txq[mvtype];
2871 mwl_txq_init(sc, txq, mvtype);
2872 sc->sc_ac2q[ac] = txq;
2873 return 1;
2874 }
2875
2876 /*
2877 * Update WME parameters for a transmit queue.
2878 */
2879 static int
mwl_txq_update(struct mwl_softc * sc,int ac)2880 mwl_txq_update(struct mwl_softc *sc, int ac)
2881 {
2882 #define MWL_EXPONENT_TO_VALUE(v) ((1<<v)-1)
2883 struct ieee80211com *ic = &sc->sc_ic;
2884 struct chanAccParams chp;
2885 struct mwl_txq *txq = sc->sc_ac2q[ac];
2886 struct wmeParams *wmep;
2887 struct mwl_hal *mh = sc->sc_mh;
2888 int aifs, cwmin, cwmax, txoplim;
2889
2890 ieee80211_wme_ic_getparams(ic, &chp);
2891 wmep = &chp.cap_wmeParams[ac];
2892
2893 aifs = wmep->wmep_aifsn;
2894 /* XXX in sta mode need to pass log values for cwmin/max */
2895 cwmin = MWL_EXPONENT_TO_VALUE(wmep->wmep_logcwmin);
2896 cwmax = MWL_EXPONENT_TO_VALUE(wmep->wmep_logcwmax);
2897 txoplim = wmep->wmep_txopLimit; /* NB: units of 32us */
2898
2899 if (mwl_hal_setedcaparams(mh, txq->qnum, cwmin, cwmax, aifs, txoplim)) {
2900 device_printf(sc->sc_dev, "unable to update hardware queue "
2901 "parameters for %s traffic!\n",
2902 ieee80211_wme_acnames[ac]);
2903 return 0;
2904 }
2905 return 1;
2906 #undef MWL_EXPONENT_TO_VALUE
2907 }
2908
2909 /*
2910 * Callback from the 802.11 layer to update WME parameters.
2911 */
2912 static int
mwl_wme_update(struct ieee80211com * ic)2913 mwl_wme_update(struct ieee80211com *ic)
2914 {
2915 struct mwl_softc *sc = ic->ic_softc;
2916
2917 return !mwl_txq_update(sc, WME_AC_BE) ||
2918 !mwl_txq_update(sc, WME_AC_BK) ||
2919 !mwl_txq_update(sc, WME_AC_VI) ||
2920 !mwl_txq_update(sc, WME_AC_VO) ? EIO : 0;
2921 }
2922
2923 /*
2924 * Reclaim resources for a setup queue.
2925 */
2926 static void
mwl_tx_cleanupq(struct mwl_softc * sc,struct mwl_txq * txq)2927 mwl_tx_cleanupq(struct mwl_softc *sc, struct mwl_txq *txq)
2928 {
2929 /* XXX hal work? */
2930 MWL_TXQ_LOCK_DESTROY(txq);
2931 }
2932
2933 /*
2934 * Reclaim all tx queue resources.
2935 */
2936 static void
mwl_tx_cleanup(struct mwl_softc * sc)2937 mwl_tx_cleanup(struct mwl_softc *sc)
2938 {
2939 int i;
2940
2941 for (i = 0; i < MWL_NUM_TX_QUEUES; i++)
2942 mwl_tx_cleanupq(sc, &sc->sc_txq[i]);
2943 }
2944
2945 static int
mwl_tx_dmasetup(struct mwl_softc * sc,struct mwl_txbuf * bf,struct mbuf * m0)2946 mwl_tx_dmasetup(struct mwl_softc *sc, struct mwl_txbuf *bf, struct mbuf *m0)
2947 {
2948 struct mbuf *m;
2949 int error;
2950
2951 /*
2952 * Load the DMA map so any coalescing is done. This
2953 * also calculates the number of descriptors we need.
2954 */
2955 error = bus_dmamap_load_mbuf_sg(sc->sc_dmat, bf->bf_dmamap, m0,
2956 bf->bf_segs, &bf->bf_nseg,
2957 BUS_DMA_NOWAIT);
2958 if (error == EFBIG) {
2959 /* XXX packet requires too many descriptors */
2960 bf->bf_nseg = MWL_TXDESC+1;
2961 } else if (error != 0) {
2962 sc->sc_stats.mst_tx_busdma++;
2963 m_freem(m0);
2964 return error;
2965 }
2966 /*
2967 * Discard null packets and check for packets that
2968 * require too many TX descriptors. We try to convert
2969 * the latter to a cluster.
2970 */
2971 if (error == EFBIG) { /* too many desc's, linearize */
2972 sc->sc_stats.mst_tx_linear++;
2973 #if MWL_TXDESC > 1
2974 m = m_collapse(m0, M_NOWAIT, MWL_TXDESC);
2975 #else
2976 m = m_defrag(m0, M_NOWAIT);
2977 #endif
2978 if (m == NULL) {
2979 m_freem(m0);
2980 sc->sc_stats.mst_tx_nombuf++;
2981 return ENOMEM;
2982 }
2983 m0 = m;
2984 error = bus_dmamap_load_mbuf_sg(sc->sc_dmat, bf->bf_dmamap, m0,
2985 bf->bf_segs, &bf->bf_nseg,
2986 BUS_DMA_NOWAIT);
2987 if (error != 0) {
2988 sc->sc_stats.mst_tx_busdma++;
2989 m_freem(m0);
2990 return error;
2991 }
2992 KASSERT(bf->bf_nseg <= MWL_TXDESC,
2993 ("too many segments after defrag; nseg %u", bf->bf_nseg));
2994 } else if (bf->bf_nseg == 0) { /* null packet, discard */
2995 sc->sc_stats.mst_tx_nodata++;
2996 m_freem(m0);
2997 return EIO;
2998 }
2999 DPRINTF(sc, MWL_DEBUG_XMIT, "%s: m %p len %u\n",
3000 __func__, m0, m0->m_pkthdr.len);
3001 bus_dmamap_sync(sc->sc_dmat, bf->bf_dmamap, BUS_DMASYNC_PREWRITE);
3002 bf->bf_m = m0;
3003
3004 return 0;
3005 }
3006
3007 static __inline int
mwl_cvtlegacyrate(int rate)3008 mwl_cvtlegacyrate(int rate)
3009 {
3010 switch (rate) {
3011 case 2: return 0;
3012 case 4: return 1;
3013 case 11: return 2;
3014 case 22: return 3;
3015 case 44: return 4;
3016 case 12: return 5;
3017 case 18: return 6;
3018 case 24: return 7;
3019 case 36: return 8;
3020 case 48: return 9;
3021 case 72: return 10;
3022 case 96: return 11;
3023 case 108:return 12;
3024 }
3025 return 0;
3026 }
3027
3028 /*
3029 * Calculate fixed tx rate information per client state;
3030 * this value is suitable for writing to the Format field
3031 * of a tx descriptor.
3032 */
3033 static uint16_t
mwl_calcformat(uint8_t rate,const struct ieee80211_node * ni)3034 mwl_calcformat(uint8_t rate, const struct ieee80211_node *ni)
3035 {
3036 uint16_t fmt;
3037
3038 fmt = _IEEE80211_SHIFTMASK(3, EAGLE_TXD_ANTENNA)
3039 | (IEEE80211_IS_CHAN_HT40D(ni->ni_chan) ?
3040 EAGLE_TXD_EXTCHAN_LO : EAGLE_TXD_EXTCHAN_HI);
3041 if (rate & IEEE80211_RATE_MCS) { /* HT MCS */
3042 fmt |= EAGLE_TXD_FORMAT_HT
3043 /* NB: 0x80 implicitly stripped from ucastrate */
3044 | _IEEE80211_SHIFTMASK(rate, EAGLE_TXD_RATE);
3045 /* XXX short/long GI may be wrong; re-check */
3046 if (IEEE80211_IS_CHAN_HT40(ni->ni_chan)) {
3047 fmt |= EAGLE_TXD_CHW_40
3048 | (ni->ni_htcap & IEEE80211_HTCAP_SHORTGI40 ?
3049 EAGLE_TXD_GI_SHORT : EAGLE_TXD_GI_LONG);
3050 } else {
3051 fmt |= EAGLE_TXD_CHW_20
3052 | (ni->ni_htcap & IEEE80211_HTCAP_SHORTGI20 ?
3053 EAGLE_TXD_GI_SHORT : EAGLE_TXD_GI_LONG);
3054 }
3055 } else { /* legacy rate */
3056 fmt |= EAGLE_TXD_FORMAT_LEGACY
3057 | _IEEE80211_SHIFTMASK(mwl_cvtlegacyrate(rate),
3058 EAGLE_TXD_RATE)
3059 | EAGLE_TXD_CHW_20
3060 /* XXX iv_flags & IEEE80211_F_SHPREAMBLE? */
3061 | (ni->ni_capinfo & IEEE80211_CAPINFO_SHORT_PREAMBLE ?
3062 EAGLE_TXD_PREAMBLE_SHORT : EAGLE_TXD_PREAMBLE_LONG);
3063 }
3064 return fmt;
3065 }
3066
3067 static int
mwl_tx_start(struct mwl_softc * sc,struct ieee80211_node * ni,struct mwl_txbuf * bf,struct mbuf * m0)3068 mwl_tx_start(struct mwl_softc *sc, struct ieee80211_node *ni, struct mwl_txbuf *bf,
3069 struct mbuf *m0)
3070 {
3071 struct ieee80211com *ic = &sc->sc_ic;
3072 struct ieee80211vap *vap = ni->ni_vap;
3073 int error, iswep, ismcast;
3074 int hdrlen, copyhdrlen, pktlen;
3075 struct mwl_txdesc *ds;
3076 struct mwl_txq *txq;
3077 struct ieee80211_frame *wh;
3078 struct mwltxrec *tr;
3079 struct mwl_node *mn;
3080 uint16_t qos;
3081 #if MWL_TXDESC > 1
3082 int i;
3083 #endif
3084
3085 wh = mtod(m0, struct ieee80211_frame *);
3086 iswep = wh->i_fc[1] & IEEE80211_FC1_PROTECTED;
3087 ismcast = IEEE80211_IS_MULTICAST(wh->i_addr1);
3088 hdrlen = ieee80211_anyhdrsize(wh);
3089 copyhdrlen = hdrlen;
3090 pktlen = m0->m_pkthdr.len;
3091 if (IEEE80211_QOS_HAS_SEQ(wh)) {
3092 qos = *(uint16_t *)ieee80211_getqos(wh);
3093 if (IEEE80211_IS_DSTODS(wh))
3094 copyhdrlen -= sizeof(qos);
3095 } else
3096 qos = 0;
3097
3098 if (iswep) {
3099 const struct ieee80211_cipher *cip;
3100 struct ieee80211_key *k;
3101
3102 /*
3103 * Construct the 802.11 header+trailer for an encrypted
3104 * frame. The only reason this can fail is because of an
3105 * unknown or unsupported cipher/key type.
3106 *
3107 * NB: we do this even though the firmware will ignore
3108 * what we've done for WEP and TKIP as we need the
3109 * ExtIV filled in for CCMP and this also adjusts
3110 * the headers which simplifies our work below.
3111 */
3112 k = ieee80211_crypto_encap(ni, m0);
3113 if (k == NULL) {
3114 /*
3115 * This can happen when the key is yanked after the
3116 * frame was queued. Just discard the frame; the
3117 * 802.11 layer counts failures and provides
3118 * debugging/diagnostics.
3119 */
3120 m_freem(m0);
3121 return EIO;
3122 }
3123 /*
3124 * Adjust the packet length for the crypto additions
3125 * done during encap and any other bits that the f/w
3126 * will add later on.
3127 */
3128 cip = k->wk_cipher;
3129 pktlen += cip->ic_header + cip->ic_miclen + cip->ic_trailer;
3130
3131 /* packet header may have moved, reset our local pointer */
3132 wh = mtod(m0, struct ieee80211_frame *);
3133 }
3134
3135 if (ieee80211_radiotap_active_vap(vap)) {
3136 sc->sc_tx_th.wt_flags = 0; /* XXX */
3137 if (iswep)
3138 sc->sc_tx_th.wt_flags |= IEEE80211_RADIOTAP_F_WEP;
3139 #if 0
3140 sc->sc_tx_th.wt_rate = ds->DataRate;
3141 #endif
3142 sc->sc_tx_th.wt_txpower = ni->ni_txpower;
3143 sc->sc_tx_th.wt_antenna = sc->sc_txantenna;
3144
3145 ieee80211_radiotap_tx(vap, m0);
3146 }
3147 /*
3148 * Copy up/down the 802.11 header; the firmware requires
3149 * we present a 2-byte payload length followed by a
3150 * 4-address header (w/o QoS), followed (optionally) by
3151 * any WEP/ExtIV header (but only filled in for CCMP).
3152 * We are assured the mbuf has sufficient headroom to
3153 * prepend in-place by the setup of ic_headroom in
3154 * mwl_attach.
3155 */
3156 if (hdrlen < sizeof(struct mwltxrec)) {
3157 const int space = sizeof(struct mwltxrec) - hdrlen;
3158 if (M_LEADINGSPACE(m0) < space) {
3159 /* NB: should never happen */
3160 device_printf(sc->sc_dev,
3161 "not enough headroom, need %d found %zd, "
3162 "m_flags 0x%x m_len %d\n",
3163 space, M_LEADINGSPACE(m0), m0->m_flags, m0->m_len);
3164 ieee80211_dump_pkt(ic,
3165 mtod(m0, const uint8_t *), m0->m_len, 0, -1);
3166 m_freem(m0);
3167 sc->sc_stats.mst_tx_noheadroom++;
3168 return EIO;
3169 }
3170 M_PREPEND(m0, space, M_NOWAIT);
3171 }
3172 tr = mtod(m0, struct mwltxrec *);
3173 if (wh != (struct ieee80211_frame *) &tr->wh)
3174 ovbcopy(wh, &tr->wh, hdrlen);
3175 /*
3176 * Note: the "firmware length" is actually the length
3177 * of the fully formed "802.11 payload". That is, it's
3178 * everything except for the 802.11 header. In particular
3179 * this includes all crypto material including the MIC!
3180 */
3181 tr->fwlen = htole16(pktlen - hdrlen);
3182
3183 /*
3184 * Load the DMA map so any coalescing is done. This
3185 * also calculates the number of descriptors we need.
3186 */
3187 error = mwl_tx_dmasetup(sc, bf, m0);
3188 if (error != 0) {
3189 /* NB: stat collected in mwl_tx_dmasetup */
3190 DPRINTF(sc, MWL_DEBUG_XMIT,
3191 "%s: unable to setup dma\n", __func__);
3192 return error;
3193 }
3194 bf->bf_node = ni; /* NB: held reference */
3195 m0 = bf->bf_m; /* NB: may have changed */
3196 tr = mtod(m0, struct mwltxrec *);
3197 wh = (struct ieee80211_frame *)&tr->wh;
3198
3199 /*
3200 * Formulate tx descriptor.
3201 */
3202 ds = bf->bf_desc;
3203 txq = bf->bf_txq;
3204
3205 ds->QosCtrl = qos; /* NB: already little-endian */
3206 #if MWL_TXDESC == 1
3207 /*
3208 * NB: multiframes should be zero because the descriptors
3209 * are initialized to zero. This should handle the case
3210 * where the driver is built with MWL_TXDESC=1 but we are
3211 * using firmware with multi-segment support.
3212 */
3213 ds->PktPtr = htole32(bf->bf_segs[0].ds_addr);
3214 ds->PktLen = htole16(bf->bf_segs[0].ds_len);
3215 #else
3216 ds->multiframes = htole32(bf->bf_nseg);
3217 ds->PktLen = htole16(m0->m_pkthdr.len);
3218 for (i = 0; i < bf->bf_nseg; i++) {
3219 ds->PktPtrArray[i] = htole32(bf->bf_segs[i].ds_addr);
3220 ds->PktLenArray[i] = htole16(bf->bf_segs[i].ds_len);
3221 }
3222 #endif
3223 /* NB: pPhysNext, DataRate, and SapPktInfo setup once, don't touch */
3224 ds->Format = 0;
3225 ds->pad = 0;
3226 ds->ack_wcb_addr = 0;
3227
3228 mn = MWL_NODE(ni);
3229 /*
3230 * Select transmit rate.
3231 */
3232 switch (wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) {
3233 case IEEE80211_FC0_TYPE_MGT:
3234 sc->sc_stats.mst_tx_mgmt++;
3235 /* fall thru... */
3236 case IEEE80211_FC0_TYPE_CTL:
3237 /* NB: assign to BE q to avoid bursting */
3238 ds->TxPriority = MWL_WME_AC_BE;
3239 break;
3240 case IEEE80211_FC0_TYPE_DATA:
3241 if (!ismcast) {
3242 const struct ieee80211_txparam *tp = ni->ni_txparms;
3243 /*
3244 * EAPOL frames get forced to a fixed rate and w/o
3245 * aggregation; otherwise check for any fixed rate
3246 * for the client (may depend on association state).
3247 */
3248 if (m0->m_flags & M_EAPOL) {
3249 const struct mwl_vap *mvp = MWL_VAP_CONST(vap);
3250 ds->Format = mvp->mv_eapolformat;
3251 ds->pad = htole16(
3252 EAGLE_TXD_FIXED_RATE | EAGLE_TXD_DONT_AGGR);
3253 } else if (tp->ucastrate != IEEE80211_FIXED_RATE_NONE) {
3254 /* XXX pre-calculate per node */
3255 ds->Format = htole16(
3256 mwl_calcformat(tp->ucastrate, ni));
3257 ds->pad = htole16(EAGLE_TXD_FIXED_RATE);
3258 }
3259 /* NB: EAPOL frames will never have qos set */
3260 if (qos == 0)
3261 ds->TxPriority = txq->qnum;
3262 #if MWL_MAXBA > 3
3263 else if (mwl_bastream_match(&mn->mn_ba[3], qos))
3264 ds->TxPriority = mn->mn_ba[3].txq;
3265 #endif
3266 #if MWL_MAXBA > 2
3267 else if (mwl_bastream_match(&mn->mn_ba[2], qos))
3268 ds->TxPriority = mn->mn_ba[2].txq;
3269 #endif
3270 #if MWL_MAXBA > 1
3271 else if (mwl_bastream_match(&mn->mn_ba[1], qos))
3272 ds->TxPriority = mn->mn_ba[1].txq;
3273 #endif
3274 #if MWL_MAXBA > 0
3275 else if (mwl_bastream_match(&mn->mn_ba[0], qos))
3276 ds->TxPriority = mn->mn_ba[0].txq;
3277 #endif
3278 else
3279 ds->TxPriority = txq->qnum;
3280 } else
3281 ds->TxPriority = txq->qnum;
3282 break;
3283 default:
3284 device_printf(sc->sc_dev, "bogus frame type 0x%x (%s)\n",
3285 wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK, __func__);
3286 sc->sc_stats.mst_tx_badframetype++;
3287 m_freem(m0);
3288 return EIO;
3289 }
3290
3291 if (IFF_DUMPPKTS_XMIT(sc))
3292 ieee80211_dump_pkt(ic,
3293 mtod(m0, const uint8_t *)+sizeof(uint16_t),
3294 m0->m_len - sizeof(uint16_t), ds->DataRate, -1);
3295
3296 MWL_TXQ_LOCK(txq);
3297 ds->Status = htole32(EAGLE_TXD_STATUS_FW_OWNED);
3298 STAILQ_INSERT_TAIL(&txq->active, bf, bf_list);
3299 MWL_TXDESC_SYNC(txq, ds, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
3300
3301 sc->sc_tx_timer = 5;
3302 MWL_TXQ_UNLOCK(txq);
3303
3304 return 0;
3305 }
3306
3307 static __inline int
mwl_cvtlegacyrix(int rix)3308 mwl_cvtlegacyrix(int rix)
3309 {
3310 static const int ieeerates[] =
3311 { 2, 4, 11, 22, 44, 12, 18, 24, 36, 48, 72, 96, 108 };
3312 return (rix < nitems(ieeerates) ? ieeerates[rix] : 0);
3313 }
3314
3315 /*
3316 * Process completed xmit descriptors from the specified queue.
3317 */
3318 static int
mwl_tx_processq(struct mwl_softc * sc,struct mwl_txq * txq)3319 mwl_tx_processq(struct mwl_softc *sc, struct mwl_txq *txq)
3320 {
3321 #define EAGLE_TXD_STATUS_MCAST \
3322 (EAGLE_TXD_STATUS_MULTICAST_TX | EAGLE_TXD_STATUS_BROADCAST_TX)
3323 struct ieee80211com *ic = &sc->sc_ic;
3324 struct mwl_txbuf *bf;
3325 struct mwl_txdesc *ds;
3326 struct ieee80211_node *ni;
3327 struct mwl_node *an;
3328 int nreaped;
3329 uint32_t status;
3330
3331 DPRINTF(sc, MWL_DEBUG_TX_PROC, "%s: tx queue %u\n", __func__, txq->qnum);
3332 for (nreaped = 0;; nreaped++) {
3333 MWL_TXQ_LOCK(txq);
3334 bf = STAILQ_FIRST(&txq->active);
3335 if (bf == NULL) {
3336 MWL_TXQ_UNLOCK(txq);
3337 break;
3338 }
3339 ds = bf->bf_desc;
3340 MWL_TXDESC_SYNC(txq, ds,
3341 BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
3342 if (ds->Status & htole32(EAGLE_TXD_STATUS_FW_OWNED)) {
3343 MWL_TXQ_UNLOCK(txq);
3344 break;
3345 }
3346 STAILQ_REMOVE_HEAD(&txq->active, bf_list);
3347 MWL_TXQ_UNLOCK(txq);
3348
3349 #ifdef MWL_DEBUG
3350 if (sc->sc_debug & MWL_DEBUG_XMIT_DESC)
3351 mwl_printtxbuf(bf, txq->qnum, nreaped);
3352 #endif
3353 ni = bf->bf_node;
3354 if (ni != NULL) {
3355 an = MWL_NODE(ni);
3356 status = le32toh(ds->Status);
3357 if (status & EAGLE_TXD_STATUS_OK) {
3358 uint16_t Format = le16toh(ds->Format);
3359 uint8_t txant = _IEEE80211_MASKSHIFT(Format,
3360 EAGLE_TXD_ANTENNA);
3361
3362 sc->sc_stats.mst_ant_tx[txant]++;
3363 if (status & EAGLE_TXD_STATUS_OK_RETRY)
3364 sc->sc_stats.mst_tx_retries++;
3365 if (status & EAGLE_TXD_STATUS_OK_MORE_RETRY)
3366 sc->sc_stats.mst_tx_mretries++;
3367 if (txq->qnum >= MWL_WME_AC_VO)
3368 ic->ic_wme.wme_hipri_traffic++;
3369 ni->ni_txrate = _IEEE80211_MASKSHIFT(Format,
3370 EAGLE_TXD_RATE);
3371 if ((Format & EAGLE_TXD_FORMAT_HT) == 0) {
3372 ni->ni_txrate = mwl_cvtlegacyrix(
3373 ni->ni_txrate);
3374 } else
3375 ni->ni_txrate |= IEEE80211_RATE_MCS;
3376 sc->sc_stats.mst_tx_rate = ni->ni_txrate;
3377 } else {
3378 if (status & EAGLE_TXD_STATUS_FAILED_LINK_ERROR)
3379 sc->sc_stats.mst_tx_linkerror++;
3380 if (status & EAGLE_TXD_STATUS_FAILED_XRETRY)
3381 sc->sc_stats.mst_tx_xretries++;
3382 if (status & EAGLE_TXD_STATUS_FAILED_AGING)
3383 sc->sc_stats.mst_tx_aging++;
3384 if (bf->bf_m->m_flags & M_FF)
3385 sc->sc_stats.mst_ff_txerr++;
3386 }
3387 if (bf->bf_m->m_flags & M_TXCB)
3388 /* XXX strip fw len in case header inspected */
3389 m_adj(bf->bf_m, sizeof(uint16_t));
3390 ieee80211_tx_complete(ni, bf->bf_m,
3391 (status & EAGLE_TXD_STATUS_OK) == 0);
3392 } else
3393 m_freem(bf->bf_m);
3394 ds->Status = htole32(EAGLE_TXD_STATUS_IDLE);
3395
3396 bus_dmamap_sync(sc->sc_dmat, bf->bf_dmamap,
3397 BUS_DMASYNC_POSTWRITE);
3398 bus_dmamap_unload(sc->sc_dmat, bf->bf_dmamap);
3399
3400 mwl_puttxbuf_tail(txq, bf);
3401 }
3402 return nreaped;
3403 #undef EAGLE_TXD_STATUS_MCAST
3404 }
3405
3406 /*
3407 * Deferred processing of transmit interrupt; special-cased
3408 * for four hardware queues, 0-3.
3409 */
3410 static void
mwl_tx_proc(void * arg,int npending)3411 mwl_tx_proc(void *arg, int npending)
3412 {
3413 struct mwl_softc *sc = arg;
3414 int nreaped;
3415
3416 /*
3417 * Process each active queue.
3418 */
3419 nreaped = 0;
3420 if (!STAILQ_EMPTY(&sc->sc_txq[0].active))
3421 nreaped += mwl_tx_processq(sc, &sc->sc_txq[0]);
3422 if (!STAILQ_EMPTY(&sc->sc_txq[1].active))
3423 nreaped += mwl_tx_processq(sc, &sc->sc_txq[1]);
3424 if (!STAILQ_EMPTY(&sc->sc_txq[2].active))
3425 nreaped += mwl_tx_processq(sc, &sc->sc_txq[2]);
3426 if (!STAILQ_EMPTY(&sc->sc_txq[3].active))
3427 nreaped += mwl_tx_processq(sc, &sc->sc_txq[3]);
3428
3429 if (nreaped != 0) {
3430 sc->sc_tx_timer = 0;
3431 if (mbufq_first(&sc->sc_snd) != NULL) {
3432 /* NB: kick fw; the tx thread may have been preempted */
3433 mwl_hal_txstart(sc->sc_mh, 0);
3434 mwl_start(sc);
3435 }
3436 }
3437 }
3438
3439 static void
mwl_tx_draintxq(struct mwl_softc * sc,struct mwl_txq * txq)3440 mwl_tx_draintxq(struct mwl_softc *sc, struct mwl_txq *txq)
3441 {
3442 struct ieee80211_node *ni;
3443 struct mwl_txbuf *bf;
3444 u_int ix __unused;
3445
3446 /*
3447 * NB: this assumes output has been stopped and
3448 * we do not need to block mwl_tx_tasklet
3449 */
3450 for (ix = 0;; ix++) {
3451 MWL_TXQ_LOCK(txq);
3452 bf = STAILQ_FIRST(&txq->active);
3453 if (bf == NULL) {
3454 MWL_TXQ_UNLOCK(txq);
3455 break;
3456 }
3457 STAILQ_REMOVE_HEAD(&txq->active, bf_list);
3458 MWL_TXQ_UNLOCK(txq);
3459 #ifdef MWL_DEBUG
3460 if (sc->sc_debug & MWL_DEBUG_RESET) {
3461 struct ieee80211com *ic = &sc->sc_ic;
3462 const struct mwltxrec *tr =
3463 mtod(bf->bf_m, const struct mwltxrec *);
3464 mwl_printtxbuf(bf, txq->qnum, ix);
3465 ieee80211_dump_pkt(ic, (const uint8_t *)&tr->wh,
3466 bf->bf_m->m_len - sizeof(tr->fwlen), 0, -1);
3467 }
3468 #endif /* MWL_DEBUG */
3469 bus_dmamap_unload(sc->sc_dmat, bf->bf_dmamap);
3470 ni = bf->bf_node;
3471 if (ni != NULL) {
3472 /*
3473 * Reclaim node reference.
3474 */
3475 ieee80211_free_node(ni);
3476 }
3477 m_freem(bf->bf_m);
3478
3479 mwl_puttxbuf_tail(txq, bf);
3480 }
3481 }
3482
3483 /*
3484 * Drain the transmit queues and reclaim resources.
3485 */
3486 static void
mwl_draintxq(struct mwl_softc * sc)3487 mwl_draintxq(struct mwl_softc *sc)
3488 {
3489 int i;
3490
3491 for (i = 0; i < MWL_NUM_TX_QUEUES; i++)
3492 mwl_tx_draintxq(sc, &sc->sc_txq[i]);
3493 sc->sc_tx_timer = 0;
3494 }
3495
3496 #ifdef MWL_DIAGAPI
3497 /*
3498 * Reset the transmit queues to a pristine state after a fw download.
3499 */
3500 static void
mwl_resettxq(struct mwl_softc * sc)3501 mwl_resettxq(struct mwl_softc *sc)
3502 {
3503 int i;
3504
3505 for (i = 0; i < MWL_NUM_TX_QUEUES; i++)
3506 mwl_txq_reset(sc, &sc->sc_txq[i]);
3507 }
3508 #endif /* MWL_DIAGAPI */
3509
3510 /*
3511 * Clear the transmit queues of any frames submitted for the
3512 * specified vap. This is done when the vap is deleted so we
3513 * don't potentially reference the vap after it is gone.
3514 * Note we cannot remove the frames; we only reclaim the node
3515 * reference.
3516 */
3517 static void
mwl_cleartxq(struct mwl_softc * sc,struct ieee80211vap * vap)3518 mwl_cleartxq(struct mwl_softc *sc, struct ieee80211vap *vap)
3519 {
3520 struct mwl_txq *txq;
3521 struct mwl_txbuf *bf;
3522 int i;
3523
3524 for (i = 0; i < MWL_NUM_TX_QUEUES; i++) {
3525 txq = &sc->sc_txq[i];
3526 MWL_TXQ_LOCK(txq);
3527 STAILQ_FOREACH(bf, &txq->active, bf_list) {
3528 struct ieee80211_node *ni = bf->bf_node;
3529 if (ni != NULL && ni->ni_vap == vap) {
3530 bf->bf_node = NULL;
3531 ieee80211_free_node(ni);
3532 }
3533 }
3534 MWL_TXQ_UNLOCK(txq);
3535 }
3536 }
3537
3538 static int
mwl_recv_action(struct ieee80211_node * ni,const struct ieee80211_frame * wh,const uint8_t * frm,const uint8_t * efrm)3539 mwl_recv_action(struct ieee80211_node *ni, const struct ieee80211_frame *wh,
3540 const uint8_t *frm, const uint8_t *efrm)
3541 {
3542 struct mwl_softc *sc = ni->ni_ic->ic_softc;
3543 const struct ieee80211_action *ia;
3544
3545 ia = (const struct ieee80211_action *) frm;
3546 if (ia->ia_category == IEEE80211_ACTION_CAT_HT &&
3547 ia->ia_action == IEEE80211_ACTION_HT_MIMOPWRSAVE) {
3548 const struct ieee80211_action_ht_mimopowersave *mps =
3549 (const struct ieee80211_action_ht_mimopowersave *) ia;
3550
3551 mwl_hal_setmimops(sc->sc_mh, ni->ni_macaddr,
3552 mps->am_control & IEEE80211_A_HT_MIMOPWRSAVE_ENA,
3553 _IEEE80211_MASKSHIFT(mps->am_control,
3554 IEEE80211_A_HT_MIMOPWRSAVE_MODE));
3555 return 0;
3556 } else
3557 return sc->sc_recv_action(ni, wh, frm, efrm);
3558 }
3559
3560 static int
mwl_addba_request(struct ieee80211_node * ni,struct ieee80211_tx_ampdu * tap,int dialogtoken,int baparamset,int batimeout)3561 mwl_addba_request(struct ieee80211_node *ni, struct ieee80211_tx_ampdu *tap,
3562 int dialogtoken, int baparamset, int batimeout)
3563 {
3564 struct mwl_softc *sc = ni->ni_ic->ic_softc;
3565 struct ieee80211vap *vap = ni->ni_vap;
3566 struct mwl_node *mn = MWL_NODE(ni);
3567 struct mwl_bastate *bas;
3568
3569 bas = tap->txa_private;
3570 if (bas == NULL) {
3571 const MWL_HAL_BASTREAM *sp;
3572 /*
3573 * Check for a free BA stream slot.
3574 */
3575 #if MWL_MAXBA > 3
3576 if (mn->mn_ba[3].bastream == NULL)
3577 bas = &mn->mn_ba[3];
3578 else
3579 #endif
3580 #if MWL_MAXBA > 2
3581 if (mn->mn_ba[2].bastream == NULL)
3582 bas = &mn->mn_ba[2];
3583 else
3584 #endif
3585 #if MWL_MAXBA > 1
3586 if (mn->mn_ba[1].bastream == NULL)
3587 bas = &mn->mn_ba[1];
3588 else
3589 #endif
3590 #if MWL_MAXBA > 0
3591 if (mn->mn_ba[0].bastream == NULL)
3592 bas = &mn->mn_ba[0];
3593 else
3594 #endif
3595 {
3596 /* sta already has max BA streams */
3597 /* XXX assign BA stream to highest priority tid */
3598 DPRINTF(sc, MWL_DEBUG_AMPDU,
3599 "%s: already has max bastreams\n", __func__);
3600 sc->sc_stats.mst_ampdu_reject++;
3601 return 0;
3602 }
3603 /* NB: no held reference to ni */
3604 sp = mwl_hal_bastream_alloc(MWL_VAP(vap)->mv_hvap,
3605 (baparamset & IEEE80211_BAPS_POLICY_IMMEDIATE) != 0,
3606 ni->ni_macaddr, tap->txa_tid, ni->ni_htparam,
3607 ni, tap);
3608 if (sp == NULL) {
3609 /*
3610 * No available stream, return 0 so no
3611 * a-mpdu aggregation will be done.
3612 */
3613 DPRINTF(sc, MWL_DEBUG_AMPDU,
3614 "%s: no bastream available\n", __func__);
3615 sc->sc_stats.mst_ampdu_nostream++;
3616 return 0;
3617 }
3618 DPRINTF(sc, MWL_DEBUG_AMPDU, "%s: alloc bastream %p\n",
3619 __func__, sp);
3620 /* NB: qos is left zero so we won't match in mwl_tx_start */
3621 bas->bastream = sp;
3622 tap->txa_private = bas;
3623 }
3624 /* fetch current seq# from the firmware; if available */
3625 if (mwl_hal_bastream_get_seqno(sc->sc_mh, bas->bastream,
3626 vap->iv_opmode == IEEE80211_M_STA ? vap->iv_myaddr : ni->ni_macaddr,
3627 &tap->txa_start) != 0)
3628 tap->txa_start = 0;
3629 return sc->sc_addba_request(ni, tap, dialogtoken, baparamset, batimeout);
3630 }
3631
3632 static int
mwl_addba_response(struct ieee80211_node * ni,struct ieee80211_tx_ampdu * tap,int code,int baparamset,int batimeout)3633 mwl_addba_response(struct ieee80211_node *ni, struct ieee80211_tx_ampdu *tap,
3634 int code, int baparamset, int batimeout)
3635 {
3636 struct mwl_softc *sc = ni->ni_ic->ic_softc;
3637 struct mwl_bastate *bas;
3638
3639 bas = tap->txa_private;
3640 if (bas == NULL) {
3641 /* XXX should not happen */
3642 DPRINTF(sc, MWL_DEBUG_AMPDU,
3643 "%s: no BA stream allocated, TID %d\n",
3644 __func__, tap->txa_tid);
3645 sc->sc_stats.mst_addba_nostream++;
3646 return 0;
3647 }
3648 if (code == IEEE80211_STATUS_SUCCESS) {
3649 struct ieee80211vap *vap = ni->ni_vap;
3650 int bufsiz, error;
3651
3652 /*
3653 * Tell the firmware to setup the BA stream;
3654 * we know resources are available because we
3655 * pre-allocated one before forming the request.
3656 */
3657 bufsiz = _IEEE80211_MASKSHIFT(baparamset, IEEE80211_BAPS_BUFSIZ);
3658 if (bufsiz == 0)
3659 bufsiz = IEEE80211_AGGR_BAWMAX;
3660 error = mwl_hal_bastream_create(MWL_VAP(vap)->mv_hvap,
3661 bas->bastream, bufsiz, bufsiz, tap->txa_start);
3662 if (error != 0) {
3663 /*
3664 * Setup failed, return immediately so no a-mpdu
3665 * aggregation will be done.
3666 */
3667 mwl_hal_bastream_destroy(sc->sc_mh, bas->bastream);
3668 mwl_bastream_free(bas);
3669 tap->txa_private = NULL;
3670
3671 DPRINTF(sc, MWL_DEBUG_AMPDU,
3672 "%s: create failed, error %d, bufsiz %d TID %d "
3673 "htparam 0x%x\n", __func__, error, bufsiz,
3674 tap->txa_tid, ni->ni_htparam);
3675 sc->sc_stats.mst_bacreate_failed++;
3676 return 0;
3677 }
3678 /* NB: cache txq to avoid ptr indirect */
3679 mwl_bastream_setup(bas, tap->txa_tid, bas->bastream->txq);
3680 DPRINTF(sc, MWL_DEBUG_AMPDU,
3681 "%s: bastream %p assigned to txq %d TID %d bufsiz %d "
3682 "htparam 0x%x\n", __func__, bas->bastream,
3683 bas->txq, tap->txa_tid, bufsiz, ni->ni_htparam);
3684 } else {
3685 /*
3686 * Other side NAK'd us; return the resources.
3687 */
3688 DPRINTF(sc, MWL_DEBUG_AMPDU,
3689 "%s: request failed with code %d, destroy bastream %p\n",
3690 __func__, code, bas->bastream);
3691 mwl_hal_bastream_destroy(sc->sc_mh, bas->bastream);
3692 mwl_bastream_free(bas);
3693 tap->txa_private = NULL;
3694 }
3695 /* NB: firmware sends BAR so we don't need to */
3696 return sc->sc_addba_response(ni, tap, code, baparamset, batimeout);
3697 }
3698
3699 static void
mwl_addba_stop(struct ieee80211_node * ni,struct ieee80211_tx_ampdu * tap)3700 mwl_addba_stop(struct ieee80211_node *ni, struct ieee80211_tx_ampdu *tap)
3701 {
3702 struct mwl_softc *sc = ni->ni_ic->ic_softc;
3703 struct mwl_bastate *bas;
3704
3705 bas = tap->txa_private;
3706 if (bas != NULL) {
3707 DPRINTF(sc, MWL_DEBUG_AMPDU, "%s: destroy bastream %p\n",
3708 __func__, bas->bastream);
3709 mwl_hal_bastream_destroy(sc->sc_mh, bas->bastream);
3710 mwl_bastream_free(bas);
3711 tap->txa_private = NULL;
3712 }
3713 sc->sc_addba_stop(ni, tap);
3714 }
3715
3716 /*
3717 * Setup the rx data structures. This should only be
3718 * done once or we may get out of sync with the firmware.
3719 */
3720 static int
mwl_startrecv(struct mwl_softc * sc)3721 mwl_startrecv(struct mwl_softc *sc)
3722 {
3723 if (!sc->sc_recvsetup) {
3724 struct mwl_rxbuf *bf, *prev;
3725 struct mwl_rxdesc *ds;
3726
3727 prev = NULL;
3728 STAILQ_FOREACH(bf, &sc->sc_rxbuf, bf_list) {
3729 int error = mwl_rxbuf_init(sc, bf);
3730 if (error != 0) {
3731 DPRINTF(sc, MWL_DEBUG_RECV,
3732 "%s: mwl_rxbuf_init failed %d\n",
3733 __func__, error);
3734 return error;
3735 }
3736 if (prev != NULL) {
3737 ds = prev->bf_desc;
3738 ds->pPhysNext = htole32(bf->bf_daddr);
3739 }
3740 prev = bf;
3741 }
3742 if (prev != NULL) {
3743 ds = prev->bf_desc;
3744 ds->pPhysNext =
3745 htole32(STAILQ_FIRST(&sc->sc_rxbuf)->bf_daddr);
3746 }
3747 sc->sc_recvsetup = 1;
3748 }
3749 mwl_mode_init(sc); /* set filters, etc. */
3750 return 0;
3751 }
3752
3753 static MWL_HAL_APMODE
mwl_getapmode(const struct ieee80211vap * vap,struct ieee80211_channel * chan)3754 mwl_getapmode(const struct ieee80211vap *vap, struct ieee80211_channel *chan)
3755 {
3756 MWL_HAL_APMODE mode;
3757
3758 if (IEEE80211_IS_CHAN_HT(chan)) {
3759 if (vap->iv_flags_ht & IEEE80211_FHT_PUREN)
3760 mode = AP_MODE_N_ONLY;
3761 else if (IEEE80211_IS_CHAN_5GHZ(chan))
3762 mode = AP_MODE_AandN;
3763 else if (vap->iv_flags & IEEE80211_F_PUREG)
3764 mode = AP_MODE_GandN;
3765 else
3766 mode = AP_MODE_BandGandN;
3767 } else if (IEEE80211_IS_CHAN_ANYG(chan)) {
3768 if (vap->iv_flags & IEEE80211_F_PUREG)
3769 mode = AP_MODE_G_ONLY;
3770 else
3771 mode = AP_MODE_MIXED;
3772 } else if (IEEE80211_IS_CHAN_B(chan))
3773 mode = AP_MODE_B_ONLY;
3774 else if (IEEE80211_IS_CHAN_A(chan))
3775 mode = AP_MODE_A_ONLY;
3776 else
3777 mode = AP_MODE_MIXED; /* XXX should not happen? */
3778 return mode;
3779 }
3780
3781 static int
mwl_setapmode(struct ieee80211vap * vap,struct ieee80211_channel * chan)3782 mwl_setapmode(struct ieee80211vap *vap, struct ieee80211_channel *chan)
3783 {
3784 struct mwl_hal_vap *hvap = MWL_VAP(vap)->mv_hvap;
3785 return mwl_hal_setapmode(hvap, mwl_getapmode(vap, chan));
3786 }
3787
3788 /*
3789 * Set/change channels.
3790 */
3791 static int
mwl_chan_set(struct mwl_softc * sc,struct ieee80211_channel * chan)3792 mwl_chan_set(struct mwl_softc *sc, struct ieee80211_channel *chan)
3793 {
3794 struct mwl_hal *mh = sc->sc_mh;
3795 struct ieee80211com *ic = &sc->sc_ic;
3796 MWL_HAL_CHANNEL hchan;
3797 int maxtxpow;
3798
3799 DPRINTF(sc, MWL_DEBUG_RESET, "%s: chan %u MHz/flags 0x%x\n",
3800 __func__, chan->ic_freq, chan->ic_flags);
3801
3802 /*
3803 * Convert to a HAL channel description with
3804 * the flags constrained to reflect the current
3805 * operating mode.
3806 */
3807 mwl_mapchan(&hchan, chan);
3808 mwl_hal_intrset(mh, 0); /* disable interrupts */
3809 #if 0
3810 mwl_draintxq(sc); /* clear pending tx frames */
3811 #endif
3812 mwl_hal_setchannel(mh, &hchan);
3813 /*
3814 * Tx power is cap'd by the regulatory setting and
3815 * possibly a user-set limit. We pass the min of
3816 * these to the hal to apply them to the cal data
3817 * for this channel.
3818 * XXX min bound?
3819 */
3820 maxtxpow = 2*chan->ic_maxregpower;
3821 if (maxtxpow > ic->ic_txpowlimit)
3822 maxtxpow = ic->ic_txpowlimit;
3823 mwl_hal_settxpower(mh, &hchan, maxtxpow / 2);
3824 /* NB: potentially change mcast/mgt rates */
3825 mwl_setcurchanrates(sc);
3826
3827 /*
3828 * Update internal state.
3829 */
3830 sc->sc_tx_th.wt_chan_freq = htole16(chan->ic_freq);
3831 sc->sc_rx_th.wr_chan_freq = htole16(chan->ic_freq);
3832 if (IEEE80211_IS_CHAN_A(chan)) {
3833 sc->sc_tx_th.wt_chan_flags = htole16(IEEE80211_CHAN_A);
3834 sc->sc_rx_th.wr_chan_flags = htole16(IEEE80211_CHAN_A);
3835 } else if (IEEE80211_IS_CHAN_ANYG(chan)) {
3836 sc->sc_tx_th.wt_chan_flags = htole16(IEEE80211_CHAN_G);
3837 sc->sc_rx_th.wr_chan_flags = htole16(IEEE80211_CHAN_G);
3838 } else {
3839 sc->sc_tx_th.wt_chan_flags = htole16(IEEE80211_CHAN_B);
3840 sc->sc_rx_th.wr_chan_flags = htole16(IEEE80211_CHAN_B);
3841 }
3842 sc->sc_curchan = hchan;
3843 mwl_hal_intrset(mh, sc->sc_imask);
3844
3845 return 0;
3846 }
3847
3848 static void
mwl_scan_start(struct ieee80211com * ic)3849 mwl_scan_start(struct ieee80211com *ic)
3850 {
3851 struct mwl_softc *sc = ic->ic_softc;
3852
3853 DPRINTF(sc, MWL_DEBUG_STATE, "%s\n", __func__);
3854 }
3855
3856 static void
mwl_scan_end(struct ieee80211com * ic)3857 mwl_scan_end(struct ieee80211com *ic)
3858 {
3859 struct mwl_softc *sc = ic->ic_softc;
3860
3861 DPRINTF(sc, MWL_DEBUG_STATE, "%s\n", __func__);
3862 }
3863
3864 static void
mwl_set_channel(struct ieee80211com * ic)3865 mwl_set_channel(struct ieee80211com *ic)
3866 {
3867 struct mwl_softc *sc = ic->ic_softc;
3868
3869 (void) mwl_chan_set(sc, ic->ic_curchan);
3870 }
3871
3872 /*
3873 * Handle a channel switch request. We inform the firmware
3874 * and mark the global state to suppress various actions.
3875 * NB: we issue only one request to the fw; we may be called
3876 * multiple times if there are multiple vap's.
3877 */
3878 static void
mwl_startcsa(struct ieee80211vap * vap)3879 mwl_startcsa(struct ieee80211vap *vap)
3880 {
3881 struct ieee80211com *ic = vap->iv_ic;
3882 struct mwl_softc *sc = ic->ic_softc;
3883 MWL_HAL_CHANNEL hchan;
3884
3885 if (sc->sc_csapending)
3886 return;
3887
3888 mwl_mapchan(&hchan, ic->ic_csa_newchan);
3889 /* 1 =>'s quiet channel */
3890 mwl_hal_setchannelswitchie(sc->sc_mh, &hchan, 1, ic->ic_csa_count);
3891 sc->sc_csapending = 1;
3892 }
3893
3894 /*
3895 * Plumb any static WEP key for the station. This is
3896 * necessary as we must propagate the key from the
3897 * global key table of the vap to each sta db entry.
3898 */
3899 static void
mwl_setanywepkey(struct ieee80211vap * vap,const uint8_t mac[IEEE80211_ADDR_LEN])3900 mwl_setanywepkey(struct ieee80211vap *vap, const uint8_t mac[IEEE80211_ADDR_LEN])
3901 {
3902 if ((vap->iv_flags & (IEEE80211_F_PRIVACY|IEEE80211_F_WPA)) ==
3903 IEEE80211_F_PRIVACY &&
3904 vap->iv_def_txkey != IEEE80211_KEYIX_NONE &&
3905 vap->iv_nw_keys[vap->iv_def_txkey].wk_keyix != IEEE80211_KEYIX_NONE)
3906 (void) _mwl_key_set(vap, &vap->iv_nw_keys[vap->iv_def_txkey],
3907 mac);
3908 }
3909
3910 static int
mwl_peerstadb(struct ieee80211_node * ni,int aid,int staid,MWL_HAL_PEERINFO * pi)3911 mwl_peerstadb(struct ieee80211_node *ni, int aid, int staid, MWL_HAL_PEERINFO *pi)
3912 {
3913 #define WME(ie) ((const struct ieee80211_wme_info *) ie)
3914 struct ieee80211vap *vap = ni->ni_vap;
3915 struct mwl_hal_vap *hvap;
3916 int error;
3917
3918 if (vap->iv_opmode == IEEE80211_M_WDS) {
3919 /*
3920 * WDS vap's do not have a f/w vap; instead they piggyback
3921 * on an AP vap and we must install the sta db entry and
3922 * crypto state using that AP's handle (the WDS vap has none).
3923 */
3924 hvap = MWL_VAP(vap)->mv_ap_hvap;
3925 } else
3926 hvap = MWL_VAP(vap)->mv_hvap;
3927 error = mwl_hal_newstation(hvap, ni->ni_macaddr,
3928 aid, staid, pi,
3929 ni->ni_flags & (IEEE80211_NODE_QOS | IEEE80211_NODE_HT),
3930 ni->ni_ies.wme_ie != NULL ? WME(ni->ni_ies.wme_ie)->wme_info : 0);
3931 if (error == 0) {
3932 /*
3933 * Setup security for this station. For sta mode this is
3934 * needed even though do the same thing on transition to
3935 * AUTH state because the call to mwl_hal_newstation
3936 * clobbers the crypto state we setup.
3937 */
3938 mwl_setanywepkey(vap, ni->ni_macaddr);
3939 }
3940 return error;
3941 #undef WME
3942 }
3943
3944 static void
mwl_setglobalkeys(struct ieee80211vap * vap)3945 mwl_setglobalkeys(struct ieee80211vap *vap)
3946 {
3947 struct ieee80211_key *wk;
3948
3949 wk = &vap->iv_nw_keys[0];
3950 for (; wk < &vap->iv_nw_keys[IEEE80211_WEP_NKID]; wk++)
3951 if (wk->wk_keyix != IEEE80211_KEYIX_NONE)
3952 (void) _mwl_key_set(vap, wk, vap->iv_myaddr);
3953 }
3954
3955 /*
3956 * Convert a legacy rate set to a firmware bitmask.
3957 */
3958 static uint32_t
get_rate_bitmap(const struct ieee80211_rateset * rs)3959 get_rate_bitmap(const struct ieee80211_rateset *rs)
3960 {
3961 uint32_t rates;
3962 int i;
3963
3964 rates = 0;
3965 for (i = 0; i < rs->rs_nrates; i++)
3966 switch (rs->rs_rates[i] & IEEE80211_RATE_VAL) {
3967 case 2: rates |= 0x001; break;
3968 case 4: rates |= 0x002; break;
3969 case 11: rates |= 0x004; break;
3970 case 22: rates |= 0x008; break;
3971 case 44: rates |= 0x010; break;
3972 case 12: rates |= 0x020; break;
3973 case 18: rates |= 0x040; break;
3974 case 24: rates |= 0x080; break;
3975 case 36: rates |= 0x100; break;
3976 case 48: rates |= 0x200; break;
3977 case 72: rates |= 0x400; break;
3978 case 96: rates |= 0x800; break;
3979 case 108: rates |= 0x1000; break;
3980 }
3981 return rates;
3982 }
3983
3984 /*
3985 * Construct an HT firmware bitmask from an HT rate set.
3986 */
3987 static uint32_t
get_htrate_bitmap(const struct ieee80211_htrateset * rs)3988 get_htrate_bitmap(const struct ieee80211_htrateset *rs)
3989 {
3990 uint32_t rates;
3991 int i;
3992
3993 rates = 0;
3994 for (i = 0; i < rs->rs_nrates; i++) {
3995 if (rs->rs_rates[i] < 16)
3996 rates |= 1<<rs->rs_rates[i];
3997 }
3998 return rates;
3999 }
4000
4001 /*
4002 * Craft station database entry for station.
4003 * NB: use host byte order here, the hal handles byte swapping.
4004 */
4005 static MWL_HAL_PEERINFO *
mkpeerinfo(MWL_HAL_PEERINFO * pi,const struct ieee80211_node * ni)4006 mkpeerinfo(MWL_HAL_PEERINFO *pi, const struct ieee80211_node *ni)
4007 {
4008 const struct ieee80211vap *vap = ni->ni_vap;
4009
4010 memset(pi, 0, sizeof(*pi));
4011 pi->LegacyRateBitMap = get_rate_bitmap(&ni->ni_rates);
4012 pi->CapInfo = ni->ni_capinfo;
4013 if (ni->ni_flags & IEEE80211_NODE_HT) {
4014 /* HT capabilities, etc */
4015 pi->HTCapabilitiesInfo = ni->ni_htcap;
4016 /* XXX pi.HTCapabilitiesInfo */
4017 pi->MacHTParamInfo = ni->ni_htparam;
4018 pi->HTRateBitMap = get_htrate_bitmap(&ni->ni_htrates);
4019 pi->AddHtInfo.ControlChan = ni->ni_htctlchan;
4020 pi->AddHtInfo.AddChan = ni->ni_ht2ndchan;
4021 pi->AddHtInfo.OpMode = ni->ni_htopmode;
4022 pi->AddHtInfo.stbc = ni->ni_htstbc;
4023
4024 /* constrain according to local configuration */
4025 if ((vap->iv_flags_ht & IEEE80211_FHT_SHORTGI40) == 0)
4026 pi->HTCapabilitiesInfo &= ~IEEE80211_HTCAP_SHORTGI40;
4027 if ((vap->iv_flags_ht & IEEE80211_FHT_SHORTGI20) == 0)
4028 pi->HTCapabilitiesInfo &= ~IEEE80211_HTCAP_SHORTGI20;
4029 if (ni->ni_chw != 40)
4030 pi->HTCapabilitiesInfo &= ~IEEE80211_HTCAP_CHWIDTH40;
4031 }
4032 return pi;
4033 }
4034
4035 /*
4036 * Re-create the local sta db entry for a vap to ensure
4037 * up to date WME state is pushed to the firmware. Because
4038 * this resets crypto state this must be followed by a
4039 * reload of any keys in the global key table.
4040 */
4041 static int
mwl_localstadb(struct ieee80211vap * vap)4042 mwl_localstadb(struct ieee80211vap *vap)
4043 {
4044 #define WME(ie) ((const struct ieee80211_wme_info *) ie)
4045 struct mwl_hal_vap *hvap = MWL_VAP(vap)->mv_hvap;
4046 struct ieee80211_node *bss;
4047 MWL_HAL_PEERINFO pi;
4048 int error;
4049
4050 switch (vap->iv_opmode) {
4051 case IEEE80211_M_STA:
4052 bss = vap->iv_bss;
4053 error = mwl_hal_newstation(hvap, vap->iv_myaddr, 0, 0,
4054 vap->iv_state == IEEE80211_S_RUN ?
4055 mkpeerinfo(&pi, bss) : NULL,
4056 (bss->ni_flags & (IEEE80211_NODE_QOS | IEEE80211_NODE_HT)),
4057 bss->ni_ies.wme_ie != NULL ?
4058 WME(bss->ni_ies.wme_ie)->wme_info : 0);
4059 if (error == 0)
4060 mwl_setglobalkeys(vap);
4061 break;
4062 case IEEE80211_M_HOSTAP:
4063 case IEEE80211_M_MBSS:
4064 error = mwl_hal_newstation(hvap, vap->iv_myaddr,
4065 0, 0, NULL, vap->iv_flags & IEEE80211_F_WME, 0);
4066 if (error == 0)
4067 mwl_setglobalkeys(vap);
4068 break;
4069 default:
4070 error = 0;
4071 break;
4072 }
4073 return error;
4074 #undef WME
4075 }
4076
4077 static int
mwl_newstate(struct ieee80211vap * vap,enum ieee80211_state nstate,int arg)4078 mwl_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg)
4079 {
4080 struct mwl_vap *mvp = MWL_VAP(vap);
4081 struct mwl_hal_vap *hvap = mvp->mv_hvap;
4082 struct ieee80211com *ic = vap->iv_ic;
4083 struct ieee80211_node *ni = NULL;
4084 struct mwl_softc *sc = ic->ic_softc;
4085 struct mwl_hal *mh = sc->sc_mh;
4086 enum ieee80211_state ostate = vap->iv_state;
4087 int error;
4088
4089 DPRINTF(sc, MWL_DEBUG_STATE, "%s: %s: %s -> %s\n",
4090 vap->iv_ifp->if_xname, __func__,
4091 ieee80211_state_name[ostate], ieee80211_state_name[nstate]);
4092
4093 callout_stop(&sc->sc_timer);
4094 /*
4095 * Clear current radar detection state.
4096 */
4097 if (ostate == IEEE80211_S_CAC) {
4098 /* stop quiet mode radar detection */
4099 mwl_hal_setradardetection(mh, DR_CHK_CHANNEL_AVAILABLE_STOP);
4100 } else if (sc->sc_radarena) {
4101 /* stop in-service radar detection */
4102 mwl_hal_setradardetection(mh, DR_DFS_DISABLE);
4103 sc->sc_radarena = 0;
4104 }
4105 /*
4106 * Carry out per-state actions before doing net80211 work.
4107 */
4108 if (nstate == IEEE80211_S_INIT) {
4109 /* NB: only ap+sta vap's have a fw entity */
4110 if (hvap != NULL)
4111 mwl_hal_stop(hvap);
4112 } else if (nstate == IEEE80211_S_SCAN) {
4113 mwl_hal_start(hvap);
4114 /* NB: this disables beacon frames */
4115 mwl_hal_setinframode(hvap);
4116 } else if (nstate == IEEE80211_S_AUTH) {
4117 /*
4118 * Must create a sta db entry in case a WEP key needs to
4119 * be plumbed. This entry will be overwritten if we
4120 * associate; otherwise it will be reclaimed on node free.
4121 */
4122 ni = vap->iv_bss;
4123 MWL_NODE(ni)->mn_hvap = hvap;
4124 (void) mwl_peerstadb(ni, 0, 0, NULL);
4125 } else if (nstate == IEEE80211_S_CSA) {
4126 /* XXX move to below? */
4127 if (vap->iv_opmode == IEEE80211_M_HOSTAP ||
4128 vap->iv_opmode == IEEE80211_M_MBSS)
4129 mwl_startcsa(vap);
4130 } else if (nstate == IEEE80211_S_CAC) {
4131 /* XXX move to below? */
4132 /* stop ap xmit and enable quiet mode radar detection */
4133 mwl_hal_setradardetection(mh, DR_CHK_CHANNEL_AVAILABLE_START);
4134 }
4135
4136 /*
4137 * Invoke the parent method to do net80211 work.
4138 */
4139 error = mvp->mv_newstate(vap, nstate, arg);
4140
4141 /*
4142 * Carry out work that must be done after net80211 runs;
4143 * this work requires up to date state (e.g. iv_bss).
4144 */
4145 if (error == 0 && nstate == IEEE80211_S_RUN) {
4146 /* NB: collect bss node again, it may have changed */
4147 ni = vap->iv_bss;
4148
4149 DPRINTF(sc, MWL_DEBUG_STATE,
4150 "%s: %s(RUN): iv_flags 0x%08x bintvl %d bssid %s "
4151 "capinfo 0x%04x chan %d\n",
4152 vap->iv_ifp->if_xname, __func__, vap->iv_flags,
4153 ni->ni_intval, ether_sprintf(ni->ni_bssid), ni->ni_capinfo,
4154 ieee80211_chan2ieee(ic, ic->ic_curchan));
4155
4156 /*
4157 * Recreate local sta db entry to update WME/HT state.
4158 */
4159 mwl_localstadb(vap);
4160 switch (vap->iv_opmode) {
4161 case IEEE80211_M_HOSTAP:
4162 case IEEE80211_M_MBSS:
4163 if (ostate == IEEE80211_S_CAC) {
4164 /* enable in-service radar detection */
4165 mwl_hal_setradardetection(mh,
4166 DR_IN_SERVICE_MONITOR_START);
4167 sc->sc_radarena = 1;
4168 }
4169 /*
4170 * Allocate and setup the beacon frame
4171 * (and related state).
4172 */
4173 error = mwl_reset_vap(vap, IEEE80211_S_RUN);
4174 if (error != 0) {
4175 DPRINTF(sc, MWL_DEBUG_STATE,
4176 "%s: beacon setup failed, error %d\n",
4177 __func__, error);
4178 goto bad;
4179 }
4180 /* NB: must be after setting up beacon */
4181 mwl_hal_start(hvap);
4182 break;
4183 case IEEE80211_M_STA:
4184 DPRINTF(sc, MWL_DEBUG_STATE, "%s: %s: aid 0x%x\n",
4185 vap->iv_ifp->if_xname, __func__, ni->ni_associd);
4186 /*
4187 * Set state now that we're associated.
4188 */
4189 mwl_hal_setassocid(hvap, ni->ni_bssid, ni->ni_associd);
4190 mwl_setrates(vap);
4191 mwl_hal_setrtsthreshold(hvap, vap->iv_rtsthreshold);
4192 if ((vap->iv_flags & IEEE80211_F_DWDS) &&
4193 sc->sc_ndwdsvaps++ == 0)
4194 mwl_hal_setdwds(mh, 1);
4195 break;
4196 case IEEE80211_M_WDS:
4197 DPRINTF(sc, MWL_DEBUG_STATE, "%s: %s: bssid %s\n",
4198 vap->iv_ifp->if_xname, __func__,
4199 ether_sprintf(ni->ni_bssid));
4200 mwl_seteapolformat(vap);
4201 break;
4202 default:
4203 break;
4204 }
4205 /*
4206 * Set CS mode according to operating channel;
4207 * this mostly an optimization for 5GHz.
4208 *
4209 * NB: must follow mwl_hal_start which resets csmode
4210 */
4211 if (IEEE80211_IS_CHAN_5GHZ(ic->ic_bsschan))
4212 mwl_hal_setcsmode(mh, CSMODE_AGGRESSIVE);
4213 else
4214 mwl_hal_setcsmode(mh, CSMODE_AUTO_ENA);
4215 /*
4216 * Start timer to prod firmware.
4217 */
4218 if (sc->sc_ageinterval != 0)
4219 callout_reset(&sc->sc_timer, sc->sc_ageinterval*hz,
4220 mwl_agestations, sc);
4221 } else if (nstate == IEEE80211_S_SLEEP) {
4222 /* XXX set chip in power save */
4223 } else if ((vap->iv_flags & IEEE80211_F_DWDS) &&
4224 --sc->sc_ndwdsvaps == 0)
4225 mwl_hal_setdwds(mh, 0);
4226 bad:
4227 return error;
4228 }
4229
4230 /*
4231 * Manage station id's; these are separate from AID's
4232 * as AID's may have values out of the range of possible
4233 * station id's acceptable to the firmware.
4234 */
4235 static int
allocstaid(struct mwl_softc * sc,int aid)4236 allocstaid(struct mwl_softc *sc, int aid)
4237 {
4238 int staid;
4239
4240 if (!(0 < aid && aid < MWL_MAXSTAID) || isset(sc->sc_staid, aid)) {
4241 /* NB: don't use 0 */
4242 for (staid = 1; staid < MWL_MAXSTAID; staid++)
4243 if (isclr(sc->sc_staid, staid))
4244 break;
4245 } else
4246 staid = aid;
4247 setbit(sc->sc_staid, staid);
4248 return staid;
4249 }
4250
4251 static void
delstaid(struct mwl_softc * sc,int staid)4252 delstaid(struct mwl_softc *sc, int staid)
4253 {
4254 clrbit(sc->sc_staid, staid);
4255 }
4256
4257 /*
4258 * Setup driver-specific state for a newly associated node.
4259 * Note that we're called also on a re-associate, the isnew
4260 * param tells us if this is the first time or not.
4261 */
4262 static void
mwl_newassoc(struct ieee80211_node * ni,int isnew)4263 mwl_newassoc(struct ieee80211_node *ni, int isnew)
4264 {
4265 struct ieee80211vap *vap = ni->ni_vap;
4266 struct mwl_softc *sc = vap->iv_ic->ic_softc;
4267 struct mwl_node *mn = MWL_NODE(ni);
4268 MWL_HAL_PEERINFO pi;
4269 uint16_t aid;
4270 int error;
4271
4272 aid = IEEE80211_AID(ni->ni_associd);
4273 if (isnew) {
4274 mn->mn_staid = allocstaid(sc, aid);
4275 mn->mn_hvap = MWL_VAP(vap)->mv_hvap;
4276 } else {
4277 mn = MWL_NODE(ni);
4278 /* XXX reset BA stream? */
4279 }
4280 DPRINTF(sc, MWL_DEBUG_NODE, "%s: mac %s isnew %d aid %d staid %d\n",
4281 __func__, ether_sprintf(ni->ni_macaddr), isnew, aid, mn->mn_staid);
4282 error = mwl_peerstadb(ni, aid, mn->mn_staid, mkpeerinfo(&pi, ni));
4283 if (error != 0) {
4284 DPRINTF(sc, MWL_DEBUG_NODE,
4285 "%s: error %d creating sta db entry\n",
4286 __func__, error);
4287 /* XXX how to deal with error? */
4288 }
4289 }
4290
4291 /*
4292 * Periodically poke the firmware to age out station state
4293 * (power save queues, pending tx aggregates).
4294 */
4295 static void
mwl_agestations(void * arg)4296 mwl_agestations(void *arg)
4297 {
4298 struct mwl_softc *sc = arg;
4299
4300 mwl_hal_setkeepalive(sc->sc_mh);
4301 if (sc->sc_ageinterval != 0) /* NB: catch dynamic changes */
4302 callout_schedule(&sc->sc_timer, sc->sc_ageinterval*hz);
4303 }
4304
4305 static const struct mwl_hal_channel *
findhalchannel(const MWL_HAL_CHANNELINFO * ci,int ieee)4306 findhalchannel(const MWL_HAL_CHANNELINFO *ci, int ieee)
4307 {
4308 int i;
4309
4310 for (i = 0; i < ci->nchannels; i++) {
4311 const struct mwl_hal_channel *hc = &ci->channels[i];
4312 if (hc->ieee == ieee)
4313 return hc;
4314 }
4315 return NULL;
4316 }
4317
4318 static int
mwl_setregdomain(struct ieee80211com * ic,struct ieee80211_regdomain * rd,int nchan,struct ieee80211_channel chans[])4319 mwl_setregdomain(struct ieee80211com *ic, struct ieee80211_regdomain *rd,
4320 int nchan, struct ieee80211_channel chans[])
4321 {
4322 struct mwl_softc *sc = ic->ic_softc;
4323 struct mwl_hal *mh = sc->sc_mh;
4324 const MWL_HAL_CHANNELINFO *ci;
4325 int i;
4326
4327 for (i = 0; i < nchan; i++) {
4328 struct ieee80211_channel *c = &chans[i];
4329 const struct mwl_hal_channel *hc;
4330
4331 if (IEEE80211_IS_CHAN_2GHZ(c)) {
4332 mwl_hal_getchannelinfo(mh, MWL_FREQ_BAND_2DOT4GHZ,
4333 IEEE80211_IS_CHAN_HT40(c) ?
4334 MWL_CH_40_MHz_WIDTH : MWL_CH_20_MHz_WIDTH, &ci);
4335 } else if (IEEE80211_IS_CHAN_5GHZ(c)) {
4336 mwl_hal_getchannelinfo(mh, MWL_FREQ_BAND_5GHZ,
4337 IEEE80211_IS_CHAN_HT40(c) ?
4338 MWL_CH_40_MHz_WIDTH : MWL_CH_20_MHz_WIDTH, &ci);
4339 } else {
4340 device_printf(sc->sc_dev,
4341 "%s: channel %u freq %u/0x%x not 2.4/5GHz\n",
4342 __func__, c->ic_ieee, c->ic_freq, c->ic_flags);
4343 return EINVAL;
4344 }
4345 /*
4346 * Verify channel has cal data and cap tx power.
4347 */
4348 hc = findhalchannel(ci, c->ic_ieee);
4349 if (hc != NULL) {
4350 if (c->ic_maxpower > 2*hc->maxTxPow)
4351 c->ic_maxpower = 2*hc->maxTxPow;
4352 goto next;
4353 }
4354 if (IEEE80211_IS_CHAN_HT40(c)) {
4355 /*
4356 * Look for the extension channel since the
4357 * hal table only has the primary channel.
4358 */
4359 hc = findhalchannel(ci, c->ic_extieee);
4360 if (hc != NULL) {
4361 if (c->ic_maxpower > 2*hc->maxTxPow)
4362 c->ic_maxpower = 2*hc->maxTxPow;
4363 goto next;
4364 }
4365 }
4366 device_printf(sc->sc_dev,
4367 "%s: no cal data for channel %u ext %u freq %u/0x%x\n",
4368 __func__, c->ic_ieee, c->ic_extieee,
4369 c->ic_freq, c->ic_flags);
4370 return EINVAL;
4371 next:
4372 ;
4373 }
4374 return 0;
4375 }
4376
4377 #define IEEE80211_CHAN_HTG (IEEE80211_CHAN_HT|IEEE80211_CHAN_G)
4378 #define IEEE80211_CHAN_HTA (IEEE80211_CHAN_HT|IEEE80211_CHAN_A)
4379
4380 static void
addht40channels(struct ieee80211_channel chans[],int maxchans,int * nchans,const MWL_HAL_CHANNELINFO * ci,int flags)4381 addht40channels(struct ieee80211_channel chans[], int maxchans, int *nchans,
4382 const MWL_HAL_CHANNELINFO *ci, int flags)
4383 {
4384 int i, error;
4385
4386 for (i = 0; i < ci->nchannels; i++) {
4387 const struct mwl_hal_channel *hc = &ci->channels[i];
4388
4389 error = ieee80211_add_channel_ht40(chans, maxchans, nchans,
4390 hc->ieee, hc->maxTxPow, flags);
4391 if (error != 0 && error != ENOENT)
4392 break;
4393 }
4394 }
4395
4396 static void
addchannels(struct ieee80211_channel chans[],int maxchans,int * nchans,const MWL_HAL_CHANNELINFO * ci,const uint8_t bands[])4397 addchannels(struct ieee80211_channel chans[], int maxchans, int *nchans,
4398 const MWL_HAL_CHANNELINFO *ci, const uint8_t bands[])
4399 {
4400 int i, error;
4401
4402 error = 0;
4403 for (i = 0; i < ci->nchannels && error == 0; i++) {
4404 const struct mwl_hal_channel *hc = &ci->channels[i];
4405
4406 error = ieee80211_add_channel(chans, maxchans, nchans,
4407 hc->ieee, hc->freq, hc->maxTxPow, 0, bands);
4408 }
4409 }
4410
4411 static void
getchannels(struct mwl_softc * sc,int maxchans,int * nchans,struct ieee80211_channel chans[])4412 getchannels(struct mwl_softc *sc, int maxchans, int *nchans,
4413 struct ieee80211_channel chans[])
4414 {
4415 const MWL_HAL_CHANNELINFO *ci;
4416 uint8_t bands[IEEE80211_MODE_BYTES];
4417
4418 /*
4419 * Use the channel info from the hal to craft the
4420 * channel list. Note that we pass back an unsorted
4421 * list; the caller is required to sort it for us
4422 * (if desired).
4423 */
4424 *nchans = 0;
4425 if (mwl_hal_getchannelinfo(sc->sc_mh,
4426 MWL_FREQ_BAND_2DOT4GHZ, MWL_CH_20_MHz_WIDTH, &ci) == 0) {
4427 memset(bands, 0, sizeof(bands));
4428 setbit(bands, IEEE80211_MODE_11B);
4429 setbit(bands, IEEE80211_MODE_11G);
4430 setbit(bands, IEEE80211_MODE_11NG);
4431 addchannels(chans, maxchans, nchans, ci, bands);
4432 }
4433 if (mwl_hal_getchannelinfo(sc->sc_mh,
4434 MWL_FREQ_BAND_5GHZ, MWL_CH_20_MHz_WIDTH, &ci) == 0) {
4435 memset(bands, 0, sizeof(bands));
4436 setbit(bands, IEEE80211_MODE_11A);
4437 setbit(bands, IEEE80211_MODE_11NA);
4438 addchannels(chans, maxchans, nchans, ci, bands);
4439 }
4440 if (mwl_hal_getchannelinfo(sc->sc_mh,
4441 MWL_FREQ_BAND_2DOT4GHZ, MWL_CH_40_MHz_WIDTH, &ci) == 0)
4442 addht40channels(chans, maxchans, nchans, ci, IEEE80211_CHAN_HTG);
4443 if (mwl_hal_getchannelinfo(sc->sc_mh,
4444 MWL_FREQ_BAND_5GHZ, MWL_CH_40_MHz_WIDTH, &ci) == 0)
4445 addht40channels(chans, maxchans, nchans, ci, IEEE80211_CHAN_HTA);
4446 }
4447
4448 static void
mwl_getradiocaps(struct ieee80211com * ic,int maxchans,int * nchans,struct ieee80211_channel chans[])4449 mwl_getradiocaps(struct ieee80211com *ic,
4450 int maxchans, int *nchans, struct ieee80211_channel chans[])
4451 {
4452 struct mwl_softc *sc = ic->ic_softc;
4453
4454 getchannels(sc, maxchans, nchans, chans);
4455 }
4456
4457 static int
mwl_getchannels(struct mwl_softc * sc)4458 mwl_getchannels(struct mwl_softc *sc)
4459 {
4460 struct ieee80211com *ic = &sc->sc_ic;
4461
4462 /*
4463 * Use the channel info from the hal to craft the
4464 * channel list for net80211. Note that we pass up
4465 * an unsorted list; net80211 will sort it for us.
4466 */
4467 memset(ic->ic_channels, 0, sizeof(ic->ic_channels));
4468 ic->ic_nchans = 0;
4469 getchannels(sc, IEEE80211_CHAN_MAX, &ic->ic_nchans, ic->ic_channels);
4470
4471 ic->ic_regdomain.regdomain = SKU_DEBUG;
4472 ic->ic_regdomain.country = CTRY_DEFAULT;
4473 ic->ic_regdomain.location = 'I';
4474 ic->ic_regdomain.isocc[0] = ' '; /* XXX? */
4475 ic->ic_regdomain.isocc[1] = ' ';
4476 return (ic->ic_nchans == 0 ? EIO : 0);
4477 }
4478 #undef IEEE80211_CHAN_HTA
4479 #undef IEEE80211_CHAN_HTG
4480
4481 #ifdef MWL_DEBUG
4482 static void
mwl_printrxbuf(const struct mwl_rxbuf * bf,u_int ix)4483 mwl_printrxbuf(const struct mwl_rxbuf *bf, u_int ix)
4484 {
4485 const struct mwl_rxdesc *ds = bf->bf_desc;
4486 uint32_t status = le32toh(ds->Status);
4487
4488 printf("R[%2u] (DS.V:%p DS.P:0x%jx) NEXT:%08x DATA:%08x RC:%02x%s\n"
4489 " STAT:%02x LEN:%04x RSSI:%02x CHAN:%02x RATE:%02x QOS:%04x HT:%04x\n",
4490 ix, ds, (uintmax_t)bf->bf_daddr, le32toh(ds->pPhysNext),
4491 le32toh(ds->pPhysBuffData), ds->RxControl,
4492 ds->RxControl != EAGLE_RXD_CTRL_DRIVER_OWN ?
4493 "" : (status & EAGLE_RXD_STATUS_OK) ? " *" : " !",
4494 ds->Status, le16toh(ds->PktLen), ds->RSSI, ds->Channel,
4495 ds->Rate, le16toh(ds->QosCtrl), le16toh(ds->HtSig2));
4496 }
4497
4498 static void
mwl_printtxbuf(const struct mwl_txbuf * bf,u_int qnum,u_int ix)4499 mwl_printtxbuf(const struct mwl_txbuf *bf, u_int qnum, u_int ix)
4500 {
4501 const struct mwl_txdesc *ds = bf->bf_desc;
4502 uint32_t status = le32toh(ds->Status);
4503
4504 printf("Q%u[%3u]", qnum, ix);
4505 printf(" (DS.V:%p DS.P:0x%jx)\n", ds, (uintmax_t)bf->bf_daddr);
4506 printf(" NEXT:%08x DATA:%08x LEN:%04x STAT:%08x%s\n",
4507 le32toh(ds->pPhysNext),
4508 le32toh(ds->PktPtr), le16toh(ds->PktLen), status,
4509 status & EAGLE_TXD_STATUS_USED ?
4510 "" : (status & 3) != 0 ? " *" : " !");
4511 printf(" RATE:%02x PRI:%x QOS:%04x SAP:%08x FORMAT:%04x\n",
4512 ds->DataRate, ds->TxPriority, le16toh(ds->QosCtrl),
4513 le32toh(ds->SapPktInfo), le16toh(ds->Format));
4514 #if MWL_TXDESC > 1
4515 printf(" MULTIFRAMES:%u LEN:%04x %04x %04x %04x %04x %04x\n"
4516 , le32toh(ds->multiframes)
4517 , le16toh(ds->PktLenArray[0]), le16toh(ds->PktLenArray[1])
4518 , le16toh(ds->PktLenArray[2]), le16toh(ds->PktLenArray[3])
4519 , le16toh(ds->PktLenArray[4]), le16toh(ds->PktLenArray[5])
4520 );
4521 printf(" DATA:%08x %08x %08x %08x %08x %08x\n"
4522 , le32toh(ds->PktPtrArray[0]), le32toh(ds->PktPtrArray[1])
4523 , le32toh(ds->PktPtrArray[2]), le32toh(ds->PktPtrArray[3])
4524 , le32toh(ds->PktPtrArray[4]), le32toh(ds->PktPtrArray[5])
4525 );
4526 #endif
4527 #if 0
4528 { const uint8_t *cp = (const uint8_t *) ds;
4529 int i;
4530 for (i = 0; i < sizeof(struct mwl_txdesc); i++) {
4531 printf("%02x ", cp[i]);
4532 if (((i+1) % 16) == 0)
4533 printf("\n");
4534 }
4535 printf("\n");
4536 }
4537 #endif
4538 }
4539 #endif /* MWL_DEBUG */
4540
4541 #if 0
4542 static void
4543 mwl_txq_dump(struct mwl_txq *txq)
4544 {
4545 struct mwl_txbuf *bf;
4546 int i = 0;
4547
4548 MWL_TXQ_LOCK(txq);
4549 STAILQ_FOREACH(bf, &txq->active, bf_list) {
4550 struct mwl_txdesc *ds = bf->bf_desc;
4551 MWL_TXDESC_SYNC(txq, ds,
4552 BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
4553 #ifdef MWL_DEBUG
4554 mwl_printtxbuf(bf, txq->qnum, i);
4555 #endif
4556 i++;
4557 }
4558 MWL_TXQ_UNLOCK(txq);
4559 }
4560 #endif
4561
4562 static void
mwl_watchdog(void * arg)4563 mwl_watchdog(void *arg)
4564 {
4565 struct mwl_softc *sc = arg;
4566
4567 callout_reset(&sc->sc_watchdog, hz, mwl_watchdog, sc);
4568 if (sc->sc_tx_timer == 0 || --sc->sc_tx_timer > 0)
4569 return;
4570
4571 if (sc->sc_running && !sc->sc_invalid) {
4572 if (mwl_hal_setkeepalive(sc->sc_mh))
4573 device_printf(sc->sc_dev,
4574 "transmit timeout (firmware hung?)\n");
4575 else
4576 device_printf(sc->sc_dev,
4577 "transmit timeout\n");
4578 #if 0
4579 mwl_reset(sc);
4580 mwl_txq_dump(&sc->sc_txq[0]);/*XXX*/
4581 #endif
4582 counter_u64_add(sc->sc_ic.ic_oerrors, 1);
4583 sc->sc_stats.mst_watchdog++;
4584 }
4585 }
4586
4587 #ifdef MWL_DIAGAPI
4588 /*
4589 * Diagnostic interface to the HAL. This is used by various
4590 * tools to do things like retrieve register contents for
4591 * debugging. The mechanism is intentionally opaque so that
4592 * it can change frequently w/o concern for compatibility.
4593 */
4594 static int
mwl_ioctl_diag(struct mwl_softc * sc,struct mwl_diag * md)4595 mwl_ioctl_diag(struct mwl_softc *sc, struct mwl_diag *md)
4596 {
4597 struct mwl_hal *mh = sc->sc_mh;
4598 u_int id = md->md_id & MWL_DIAG_ID;
4599 void *indata = NULL;
4600 void *outdata = NULL;
4601 u_int32_t insize = md->md_in_size;
4602 u_int32_t outsize = md->md_out_size;
4603 int error = 0;
4604
4605 if (md->md_id & MWL_DIAG_IN) {
4606 /*
4607 * Copy in data.
4608 */
4609 indata = malloc(insize, M_TEMP, M_NOWAIT);
4610 if (indata == NULL) {
4611 error = ENOMEM;
4612 goto bad;
4613 }
4614 error = copyin(md->md_in_data, indata, insize);
4615 if (error)
4616 goto bad;
4617 }
4618 if (md->md_id & MWL_DIAG_DYN) {
4619 /*
4620 * Allocate a buffer for the results (otherwise the HAL
4621 * returns a pointer to a buffer where we can read the
4622 * results). Note that we depend on the HAL leaving this
4623 * pointer for us to use below in reclaiming the buffer;
4624 * may want to be more defensive.
4625 */
4626 outdata = malloc(outsize, M_TEMP, M_NOWAIT);
4627 if (outdata == NULL) {
4628 error = ENOMEM;
4629 goto bad;
4630 }
4631 }
4632 if (mwl_hal_getdiagstate(mh, id, indata, insize, &outdata, &outsize)) {
4633 if (outsize < md->md_out_size)
4634 md->md_out_size = outsize;
4635 if (outdata != NULL)
4636 error = copyout(outdata, md->md_out_data,
4637 md->md_out_size);
4638 } else {
4639 error = EINVAL;
4640 }
4641 bad:
4642 if ((md->md_id & MWL_DIAG_IN) && indata != NULL)
4643 free(indata, M_TEMP);
4644 if ((md->md_id & MWL_DIAG_DYN) && outdata != NULL)
4645 free(outdata, M_TEMP);
4646 return error;
4647 }
4648
4649 static int
mwl_ioctl_reset(struct mwl_softc * sc,struct mwl_diag * md)4650 mwl_ioctl_reset(struct mwl_softc *sc, struct mwl_diag *md)
4651 {
4652 struct mwl_hal *mh = sc->sc_mh;
4653 int error;
4654
4655 MWL_LOCK_ASSERT(sc);
4656
4657 if (md->md_id == 0 && mwl_hal_fwload(mh, NULL) != 0) {
4658 device_printf(sc->sc_dev, "unable to load firmware\n");
4659 return EIO;
4660 }
4661 if (mwl_hal_gethwspecs(mh, &sc->sc_hwspecs) != 0) {
4662 device_printf(sc->sc_dev, "unable to fetch h/w specs\n");
4663 return EIO;
4664 }
4665 error = mwl_setupdma(sc);
4666 if (error != 0) {
4667 /* NB: mwl_setupdma prints a msg */
4668 return error;
4669 }
4670 /*
4671 * Reset tx/rx data structures; after reload we must
4672 * re-start the driver's notion of the next xmit/recv.
4673 */
4674 mwl_draintxq(sc); /* clear pending frames */
4675 mwl_resettxq(sc); /* rebuild tx q lists */
4676 sc->sc_rxnext = NULL; /* force rx to start at the list head */
4677 return 0;
4678 }
4679 #endif /* MWL_DIAGAPI */
4680
4681 static void
mwl_parent(struct ieee80211com * ic)4682 mwl_parent(struct ieee80211com *ic)
4683 {
4684 struct mwl_softc *sc = ic->ic_softc;
4685 int startall = 0;
4686
4687 MWL_LOCK(sc);
4688 if (ic->ic_nrunning > 0) {
4689 if (sc->sc_running) {
4690 /*
4691 * To avoid rescanning another access point,
4692 * do not call mwl_init() here. Instead,
4693 * only reflect promisc mode settings.
4694 */
4695 mwl_mode_init(sc);
4696 } else {
4697 /*
4698 * Beware of being called during attach/detach
4699 * to reset promiscuous mode. In that case we
4700 * will still be marked UP but not RUNNING.
4701 * However trying to re-init the interface
4702 * is the wrong thing to do as we've already
4703 * torn down much of our state. There's
4704 * probably a better way to deal with this.
4705 */
4706 if (!sc->sc_invalid) {
4707 mwl_init(sc); /* XXX lose error */
4708 startall = 1;
4709 }
4710 }
4711 } else
4712 mwl_stop(sc);
4713 MWL_UNLOCK(sc);
4714 if (startall)
4715 ieee80211_start_all(ic);
4716 }
4717
4718 static int
mwl_ioctl(struct ieee80211com * ic,u_long cmd,void * data)4719 mwl_ioctl(struct ieee80211com *ic, u_long cmd, void *data)
4720 {
4721 struct mwl_softc *sc = ic->ic_softc;
4722 struct ifreq *ifr = data;
4723 int error = 0;
4724
4725 switch (cmd) {
4726 case SIOCGMVSTATS:
4727 mwl_hal_gethwstats(sc->sc_mh, &sc->sc_stats.hw_stats);
4728 #if 0
4729 /* NB: embed these numbers to get a consistent view */
4730 sc->sc_stats.mst_tx_packets =
4731 ifp->if_get_counter(ifp, IFCOUNTER_OPACKETS);
4732 sc->sc_stats.mst_rx_packets =
4733 ifp->if_get_counter(ifp, IFCOUNTER_IPACKETS);
4734 #endif
4735 /*
4736 * NB: Drop the softc lock in case of a page fault;
4737 * we'll accept any potential inconsisentcy in the
4738 * statistics. The alternative is to copy the data
4739 * to a local structure.
4740 */
4741 return (copyout(&sc->sc_stats, ifr_data_get_ptr(ifr),
4742 sizeof (sc->sc_stats)));
4743 #ifdef MWL_DIAGAPI
4744 case SIOCGMVDIAG:
4745 /* XXX check privs */
4746 return mwl_ioctl_diag(sc, (struct mwl_diag *) ifr);
4747 case SIOCGMVRESET:
4748 /* XXX check privs */
4749 MWL_LOCK(sc);
4750 error = mwl_ioctl_reset(sc,(struct mwl_diag *) ifr);
4751 MWL_UNLOCK(sc);
4752 break;
4753 #endif /* MWL_DIAGAPI */
4754 default:
4755 error = ENOTTY;
4756 break;
4757 }
4758 return (error);
4759 }
4760
4761 #ifdef MWL_DEBUG
4762 static int
mwl_sysctl_debug(SYSCTL_HANDLER_ARGS)4763 mwl_sysctl_debug(SYSCTL_HANDLER_ARGS)
4764 {
4765 struct mwl_softc *sc = arg1;
4766 int debug, error;
4767
4768 debug = sc->sc_debug | (mwl_hal_getdebug(sc->sc_mh) << 24);
4769 error = sysctl_handle_int(oidp, &debug, 0, req);
4770 if (error || !req->newptr)
4771 return error;
4772 mwl_hal_setdebug(sc->sc_mh, debug >> 24);
4773 sc->sc_debug = debug & 0x00ffffff;
4774 return 0;
4775 }
4776 #endif /* MWL_DEBUG */
4777
4778 static void
mwl_sysctlattach(struct mwl_softc * sc)4779 mwl_sysctlattach(struct mwl_softc *sc)
4780 {
4781 #ifdef MWL_DEBUG
4782 struct sysctl_ctx_list *ctx = device_get_sysctl_ctx(sc->sc_dev);
4783 struct sysctl_oid *tree = device_get_sysctl_tree(sc->sc_dev);
4784
4785 sc->sc_debug = mwl_debug;
4786 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(tree), OID_AUTO, "debug",
4787 CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_NEEDGIANT, sc, 0,
4788 mwl_sysctl_debug, "I", "control debugging printfs");
4789 #endif
4790 }
4791
4792 /*
4793 * Announce various information on device/driver attach.
4794 */
4795 static void
mwl_announce(struct mwl_softc * sc)4796 mwl_announce(struct mwl_softc *sc)
4797 {
4798
4799 device_printf(sc->sc_dev, "Rev A%d hardware, v%d.%d.%d.%d firmware (regioncode %d)\n",
4800 sc->sc_hwspecs.hwVersion,
4801 (sc->sc_hwspecs.fwReleaseNumber>>24) & 0xff,
4802 (sc->sc_hwspecs.fwReleaseNumber>>16) & 0xff,
4803 (sc->sc_hwspecs.fwReleaseNumber>>8) & 0xff,
4804 (sc->sc_hwspecs.fwReleaseNumber>>0) & 0xff,
4805 sc->sc_hwspecs.regionCode);
4806 sc->sc_fwrelease = sc->sc_hwspecs.fwReleaseNumber;
4807
4808 if (bootverbose) {
4809 int i;
4810 for (i = 0; i <= WME_AC_VO; i++) {
4811 struct mwl_txq *txq = sc->sc_ac2q[i];
4812 device_printf(sc->sc_dev, "Use hw queue %u for %s traffic\n",
4813 txq->qnum, ieee80211_wme_acnames[i]);
4814 }
4815 }
4816 if (bootverbose || mwl_rxdesc != MWL_RXDESC)
4817 device_printf(sc->sc_dev, "using %u rx descriptors\n", mwl_rxdesc);
4818 if (bootverbose || mwl_rxbuf != MWL_RXBUF)
4819 device_printf(sc->sc_dev, "using %u rx buffers\n", mwl_rxbuf);
4820 if (bootverbose || mwl_txbuf != MWL_TXBUF)
4821 device_printf(sc->sc_dev, "using %u tx buffers\n", mwl_txbuf);
4822 if (bootverbose && mwl_hal_ismbsscapable(sc->sc_mh))
4823 device_printf(sc->sc_dev, "multi-bss support\n");
4824 #ifdef MWL_TX_NODROP
4825 if (bootverbose)
4826 device_printf(sc->sc_dev, "no tx drop\n");
4827 #endif
4828 }
4829