net: Don't use IF_{EN,DE}QUEUE on ifnet.if_snd
[dragonfly.git] / sys / dev / netif / ath / ath / if_ath.c
1 /*-
2  * Copyright (c) 2002-2009 Sam Leffler, Errno Consulting
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer,
10  *    without modification.
11  * 2. Redistributions in binary form must reproduce at minimum a disclaimer
12  *    similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
13  *    redistribution must be conditioned upon including a substantially
14  *    similar Disclaimer requirement for further binary redistribution.
15  *
16  * NO WARRANTY
17  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
18  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
19  * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
20  * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
21  * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
22  * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
23  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
24  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
25  * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
26  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
27  * THE POSSIBILITY OF SUCH DAMAGES.
28  *
29  * $FreeBSD: head/sys/dev/ath/if_ath.c 203751 2010-02-10 11:12:39Z rpaulo $");
30  */
31
32 /*
33  * Driver for the Atheros Wireless LAN controller.
34  *
35  * This software is derived from work of Atsushi Onoe; his contribution
36  * is greatly appreciated.
37  */
38
39 #include "opt_inet.h"
40 #include "opt_ath.h"
41 #include "opt_wlan.h"
42
43 #include <sys/param.h>
44 #include <sys/systm.h> 
45 #include <sys/sysctl.h>
46 #include <sys/mbuf.h>   
47 #include <sys/malloc.h>
48 #include <sys/lock.h>
49 #include <sys/mutex.h>
50 #include <sys/kernel.h>
51 #include <sys/socket.h>
52 #include <sys/sockio.h>
53 #include <sys/errno.h>
54 #include <sys/callout.h>
55 #include <sys/bus.h>
56 #include <sys/endian.h>
57 #include <sys/kthread.h>
58 #include <sys/taskqueue.h>
59 #include <sys/priv.h>
60
61 #include <net/if.h>
62 #include <net/if_dl.h>
63 #include <net/if_media.h>
64 #include <net/if_types.h>
65 #include <net/if_arp.h>
66 #include <net/if_llc.h>
67 #include <net/ifq_var.h>
68
69 #include <netproto/802_11/ieee80211_var.h>
70 #include <netproto/802_11/ieee80211_regdomain.h>
71 #ifdef IEEE80211_SUPPORT_SUPERG
72 #include <netproto/802_11/ieee80211_superg.h>
73 #endif
74 #ifdef IEEE80211_SUPPORT_TDMA
75 #include <netproto/802_11/ieee80211_tdma.h>
76 #endif
77
78 #include <net/bpf.h>
79
80 #ifdef INET
81 #include <netinet/in.h> 
82 #include <netinet/if_ether.h>
83 #endif
84
85 #include <dev/netif/ath/ath/if_athvar.h>
86 #include <dev/netif/ath/hal/ath_hal/ah_devid.h>         /* XXX for softled */
87
88 #ifdef ATH_TX99_DIAG
89 #include <dev/netif/ath_tx99/ath_tx99.h>
90 #endif
91
92 /*
93  * ATH_BCBUF determines the number of vap's that can transmit
94  * beacons and also (currently) the number of vap's that can
95  * have unique mac addresses/bssid.  When staggering beacons
96  * 4 is probably a good max as otherwise the beacons become
97  * very closely spaced and there is limited time for cab q traffic
98  * to go out.  You can burst beacons instead but that is not good
99  * for stations in power save and at some point you really want
100  * another radio (and channel).
101  *
102  * The limit on the number of mac addresses is tied to our use of
103  * the U/L bit and tracking addresses in a byte; it would be
104  * worthwhile to allow more for applications like proxy sta.
105  */
106 CTASSERT(ATH_BCBUF <= 8);
107
108 /* unaligned little endian access */
109 #define LE_READ_2(p)                                                    \
110         ((u_int16_t)                                                    \
111          ((((u_int8_t *)(p))[0]      ) | (((u_int8_t *)(p))[1] <<  8)))
112 #define LE_READ_4(p)                                                    \
113         ((u_int32_t)                                                    \
114          ((((u_int8_t *)(p))[0]      ) | (((u_int8_t *)(p))[1] <<  8) | \
115           (((u_int8_t *)(p))[2] << 16) | (((u_int8_t *)(p))[3] << 24)))
116
117 static struct ieee80211vap *ath_vap_create(struct ieee80211com *,
118                     const char name[IFNAMSIZ], int unit, int opmode,
119                     int flags, const uint8_t bssid[IEEE80211_ADDR_LEN],
120                     const uint8_t mac[IEEE80211_ADDR_LEN]);
121 static void     ath_vap_delete(struct ieee80211vap *);
122 static void     ath_init(void *);
123 static void     ath_stop_locked(struct ifnet *);
124 static void     ath_stop(struct ifnet *);
125 static void     ath_start(struct ifnet *);
126 static int      ath_reset(struct ifnet *);
127 static int      ath_reset_vap(struct ieee80211vap *, u_long);
128 static int      ath_media_change(struct ifnet *);
129 static void     ath_watchdog_callout(void *);
130 static int      ath_ioctl(struct ifnet *, u_long, caddr_t, struct ucred *);
131 static void     ath_fatal_proc(void *, int);
132 static void     ath_bmiss_vap(struct ieee80211vap *);
133 static void     ath_bmiss_task(void *, int);
134 static int      ath_keyset(struct ath_softc *, const struct ieee80211_key *,
135                         struct ieee80211_node *);
136 static int      ath_key_alloc(struct ieee80211vap *,
137                         struct ieee80211_key *,
138                         ieee80211_keyix *, ieee80211_keyix *);
139 static int      ath_key_delete(struct ieee80211vap *,
140                         const struct ieee80211_key *);
141 static int      ath_key_set(struct ieee80211vap *, const struct ieee80211_key *,
142                         const u_int8_t mac[IEEE80211_ADDR_LEN]);
143 static void     ath_key_update_begin(struct ieee80211vap *);
144 static void     ath_key_update_end(struct ieee80211vap *);
145 static void     ath_update_mcast(struct ifnet *);
146 static void     ath_update_promisc(struct ifnet *);
147 static void     ath_mode_init(struct ath_softc *);
148 static void     ath_setslottime(struct ath_softc *);
149 static void     ath_updateslot(struct ifnet *);
150 static int      ath_beaconq_setup(struct ath_hal *);
151 static int      ath_beacon_alloc(struct ath_softc *, struct ieee80211_node *);
152 static void     ath_beacon_update(struct ieee80211vap *, int item);
153 static void     ath_beacon_setup(struct ath_softc *, struct ath_buf *);
154 static void     ath_beacon_proc(void *, int);
155 static struct ath_buf *ath_beacon_generate(struct ath_softc *,
156                         struct ieee80211vap *);
157 static void     ath_bstuck_task(void *, int);
158 static void     ath_beacon_return(struct ath_softc *, struct ath_buf *);
159 static void     ath_beacon_free(struct ath_softc *);
160 static void     ath_beacon_config(struct ath_softc *, struct ieee80211vap *);
161 static void     ath_descdma_cleanup(struct ath_softc *sc,
162                         struct ath_descdma *, ath_bufhead *);
163 static int      ath_desc_alloc(struct ath_softc *);
164 static void     ath_desc_free(struct ath_softc *);
165 static struct ieee80211_node *ath_node_alloc(struct ieee80211vap *,
166                         const uint8_t [IEEE80211_ADDR_LEN]);
167 static void     ath_node_free(struct ieee80211_node *);
168 static void     ath_node_getsignal(const struct ieee80211_node *,
169                         int8_t *, int8_t *);
170 static int      ath_rxbuf_init(struct ath_softc *, struct ath_buf *);
171 static void     ath_recv_mgmt(struct ieee80211_node *ni, struct mbuf *m,
172                         int subtype, int rssi, int nf);
173 static void     ath_setdefantenna(struct ath_softc *, u_int);
174 static void     ath_rx_task(void *, int);
175 static void     ath_txq_init(struct ath_softc *sc, struct ath_txq *, int);
176 static struct ath_txq *ath_txq_setup(struct ath_softc*, int qtype, int subtype);
177 static int      ath_tx_setup(struct ath_softc *, int, int);
178 static int      ath_wme_update(struct ieee80211com *);
179 static void     ath_tx_cleanupq(struct ath_softc *, struct ath_txq *);
180 static void     ath_tx_cleanup(struct ath_softc *);
181 static void     ath_freetx(struct mbuf *);
182 static int      ath_tx_start(struct ath_softc *, struct ieee80211_node *,
183                              struct ath_buf *, struct mbuf *);
184 static void     ath_tx_task_q0(void *, int);
185 static void     ath_tx_task_q0123(void *, int);
186 static void     ath_tx_task(void *, int);
187 static void     ath_tx_draintxq(struct ath_softc *, struct ath_txq *);
188 static int      ath_chan_set(struct ath_softc *, struct ieee80211_channel *);
189 static void     ath_draintxq(struct ath_softc *);
190 static void     ath_stoprecv(struct ath_softc *);
191 static int      ath_startrecv(struct ath_softc *);
192 static void     ath_chan_change(struct ath_softc *, struct ieee80211_channel *);
193 static void     ath_scan_start(struct ieee80211com *);
194 static void     ath_scan_end(struct ieee80211com *);
195 static void     ath_set_channel(struct ieee80211com *);
196 static void     ath_calibrate_callout(void *);
197 static int      ath_newstate(struct ieee80211vap *, enum ieee80211_state, int);
198 static void     ath_setup_stationkey(struct ieee80211_node *);
199 static void     ath_newassoc(struct ieee80211_node *, int);
200 static int      ath_setregdomain(struct ieee80211com *,
201                     struct ieee80211_regdomain *, int,
202                     struct ieee80211_channel []);
203 static void     ath_getradiocaps(struct ieee80211com *, int, int *,
204                     struct ieee80211_channel []);
205 static int      ath_getchannels(struct ath_softc *);
206 static void     ath_led_event(struct ath_softc *, int);
207
208 static int      ath_rate_setup(struct ath_softc *, u_int mode);
209 static void     ath_setcurmode(struct ath_softc *, enum ieee80211_phymode);
210
211 static void     ath_sysctlattach(struct ath_softc *);
212 static int      ath_raw_xmit(struct ieee80211_node *,
213                         struct mbuf *, const struct ieee80211_bpf_params *);
214 static void     ath_announce(struct ath_softc *);
215 static void     ath_sysctl_stats_attach(struct ath_softc *sc);
216
217 #ifdef IEEE80211_SUPPORT_TDMA
218 static void     ath_tdma_settimers(struct ath_softc *sc, u_int32_t nexttbtt,
219                     u_int32_t bintval);
220 static void     ath_tdma_bintvalsetup(struct ath_softc *sc,
221                     const struct ieee80211_tdma_state *tdma);
222 static void     ath_tdma_config(struct ath_softc *sc, struct ieee80211vap *vap);
223 static void     ath_tdma_update(struct ieee80211_node *ni,
224                     const struct ieee80211_tdma_param *tdma, int);
225 static void     ath_tdma_beacon_send(struct ath_softc *sc,
226                     struct ieee80211vap *vap);
227
228 static __inline void
229 ath_hal_setcca(struct ath_hal *ah, int ena)
230 {
231         /*
232          * NB: fill me in; this is not provided by default because disabling
233          *     CCA in most locales violates regulatory.
234          */
235 }
236
237 static __inline int
238 ath_hal_getcca(struct ath_hal *ah)
239 {
240         u_int32_t diag;
241         if (ath_hal_getcapability(ah, HAL_CAP_DIAG, 0, &diag) != HAL_OK)
242                 return 1;
243         return ((diag & 0x500000) == 0);
244 }
245
246 #define TDMA_EP_MULTIPLIER      (1<<10) /* pow2 to optimize out * and / */
247 #define TDMA_LPF_LEN            6
248 #define TDMA_DUMMY_MARKER       0x127
249 #define TDMA_EP_MUL(x, mul)     ((x) * (mul))
250 #define TDMA_IN(x)              (TDMA_EP_MUL((x), TDMA_EP_MULTIPLIER))
251 #define TDMA_LPF(x, y, len) \
252     ((x != TDMA_DUMMY_MARKER) ? (((x) * ((len)-1) + (y)) / (len)) : (y))
253 #define TDMA_SAMPLE(x, y) do {                                  \
254         x = TDMA_LPF((x), TDMA_IN(y), TDMA_LPF_LEN);            \
255 } while (0)
256 #define TDMA_EP_RND(x,mul) \
257         ((((x)%(mul)) >= ((mul)/2)) ? ((x) + ((mul) - 1)) / (mul) : (x)/(mul))
258 #define TDMA_AVG(x)             TDMA_EP_RND(x, TDMA_EP_MULTIPLIER)
259 #endif /* IEEE80211_SUPPORT_TDMA */
260
261 SYSCTL_DECL(_hw_ath);
262
263 /* XXX validate sysctl values */
264 static  int ath_longcalinterval = 30;           /* long cals every 30 secs */
265 SYSCTL_INT(_hw_ath, OID_AUTO, longcal, CTLFLAG_RW, &ath_longcalinterval,
266             0, "long chip calibration interval (secs)");
267 static  int ath_shortcalinterval = 100;         /* short cals every 100 ms */
268 SYSCTL_INT(_hw_ath, OID_AUTO, shortcal, CTLFLAG_RW, &ath_shortcalinterval,
269             0, "short chip calibration interval (msecs)");
270 static  int ath_resetcalinterval = 20*60;       /* reset cal state 20 mins */
271 SYSCTL_INT(_hw_ath, OID_AUTO, resetcal, CTLFLAG_RW, &ath_resetcalinterval,
272             0, "reset chip calibration results (secs)");
273
274 static  int ath_rxbuf = ATH_RXBUF;              /* # rx buffers to allocate */
275 SYSCTL_INT(_hw_ath, OID_AUTO, rxbuf, CTLFLAG_RW, &ath_rxbuf,
276             0, "rx buffers allocated");
277 TUNABLE_INT("hw.ath.rxbuf", &ath_rxbuf);
278 static  int ath_txbuf = ATH_TXBUF;              /* # tx buffers to allocate */
279 SYSCTL_INT(_hw_ath, OID_AUTO, txbuf, CTLFLAG_RW, &ath_txbuf,
280             0, "tx buffers allocated");
281 TUNABLE_INT("hw.ath.txbuf", &ath_txbuf);
282
283 static  int ath_bstuck_threshold = 4;           /* max missed beacons */
284 SYSCTL_INT(_hw_ath, OID_AUTO, bstuck, CTLFLAG_RW, &ath_bstuck_threshold,
285             0, "max missed beacon xmits before chip reset");
286
287 #ifdef ATH_DEBUG
288 enum {
289         ATH_DEBUG_XMIT          = 0x00000001,   /* basic xmit operation */
290         ATH_DEBUG_XMIT_DESC     = 0x00000002,   /* xmit descriptors */
291         ATH_DEBUG_RECV          = 0x00000004,   /* basic recv operation */
292         ATH_DEBUG_RECV_DESC     = 0x00000008,   /* recv descriptors */
293         ATH_DEBUG_RATE          = 0x00000010,   /* rate control */
294         ATH_DEBUG_RESET         = 0x00000020,   /* reset processing */
295         ATH_DEBUG_MODE          = 0x00000040,   /* mode init/setup */
296         ATH_DEBUG_BEACON        = 0x00000080,   /* beacon handling */
297         ATH_DEBUG_WATCHDOG      = 0x00000100,   /* watchdog timeout */
298         ATH_DEBUG_INTR          = 0x00001000,   /* ISR */
299         ATH_DEBUG_TX_PROC       = 0x00002000,   /* tx ISR proc */
300         ATH_DEBUG_RX_PROC       = 0x00004000,   /* rx ISR proc */
301         ATH_DEBUG_BEACON_PROC   = 0x00008000,   /* beacon ISR proc */
302         ATH_DEBUG_CALIBRATE     = 0x00010000,   /* periodic calibration */
303         ATH_DEBUG_KEYCACHE      = 0x00020000,   /* key cache management */
304         ATH_DEBUG_STATE         = 0x00040000,   /* 802.11 state transitions */
305         ATH_DEBUG_NODE          = 0x00080000,   /* node management */
306         ATH_DEBUG_LED           = 0x00100000,   /* led management */
307         ATH_DEBUG_FF            = 0x00200000,   /* fast frames */
308         ATH_DEBUG_DFS           = 0x00400000,   /* DFS processing */
309         ATH_DEBUG_TDMA          = 0x00800000,   /* TDMA processing */
310         ATH_DEBUG_TDMA_TIMER    = 0x01000000,   /* TDMA timer processing */
311         ATH_DEBUG_REGDOMAIN     = 0x02000000,   /* regulatory processing */
312         ATH_DEBUG_FATAL         = 0x80000000,   /* fatal errors */
313         ATH_DEBUG_ANY           = 0xffffffff
314 };
315 static  int ath_debug = 0;
316 SYSCTL_INT(_hw_ath, OID_AUTO, debug, CTLFLAG_RW, &ath_debug,
317             0, "control debugging printfs");
318 TUNABLE_INT("hw.ath.debug", &ath_debug);
319
320 #define IFF_DUMPPKTS(sc, m) \
321         ((sc->sc_debug & (m)) || \
322             (sc->sc_ifp->if_flags & (IFF_DEBUG|IFF_LINK2)) == (IFF_DEBUG|IFF_LINK2))
323 #define DPRINTF(sc, m, fmt, ...) do {                           \
324         if (sc->sc_debug & (m))                                 \
325                 kprintf(fmt, __VA_ARGS__);                      \
326 } while (0)
327 #define KEYPRINTF(sc, ix, hk, mac) do {                         \
328         if (sc->sc_debug & ATH_DEBUG_KEYCACHE)                  \
329                 ath_keyprint(sc, __func__, ix, hk, mac);        \
330 } while (0)
331 static  void ath_printrxbuf(struct ath_softc *, const struct ath_buf *bf,
332         u_int ix, int);
333 static  void ath_printtxbuf(struct ath_softc *, const struct ath_buf *bf,
334         u_int qnum, u_int ix, int done);
335 #else
336 #define IFF_DUMPPKTS(sc, m) \
337         ((sc->sc_ifp->if_flags & (IFF_DEBUG|IFF_LINK2)) == (IFF_DEBUG|IFF_LINK2))
338 #define DPRINTF(sc, m, fmt, ...) do {                           \
339         (void) sc;                                              \
340 } while (0)
341 #define KEYPRINTF(sc, k, ix, mac) do {                          \
342         (void) sc;                                              \
343 } while (0)
344 #endif
345
346 MALLOC_DEFINE(M_ATHDEV, "athdev", "ath driver dma buffers");
347
348 int
349 ath_attach(u_int16_t devid, struct ath_softc *sc)
350 {
351         struct ifnet *ifp;
352         struct ieee80211com *ic;
353         struct ath_hal *ah = NULL;
354         HAL_STATUS status;
355         int error = 0, i;
356         u_int wmodes;
357         uint8_t macaddr[IEEE80211_ADDR_LEN];
358
359         DPRINTF(sc, ATH_DEBUG_ANY, "%s: devid 0x%x\n", __func__, devid);
360
361         ifp = sc->sc_ifp = if_alloc(IFT_IEEE80211);
362         if (ifp == NULL) {
363                 device_printf(sc->sc_dev, "can not if_alloc()\n");
364                 error = ENOSPC;
365                 goto bad;
366         }
367         ic = ifp->if_l2com;
368
369         /* set these up early for if_printf use */
370         if_initname(ifp, device_get_name(sc->sc_dev),
371                 device_get_unit(sc->sc_dev));
372
373         /* prepare sysctl tree for use in sub modules */
374         sysctl_ctx_init(&sc->sc_sysctl_ctx);
375         sc->sc_sysctl_tree = SYSCTL_ADD_NODE(&sc->sc_sysctl_ctx,
376                 SYSCTL_STATIC_CHILDREN(_hw),
377                 OID_AUTO,
378                 device_get_nameunit(sc->sc_dev),
379                 CTLFLAG_RD, 0, "");
380
381         ah = ath_hal_attach(devid, sc, sc->sc_st, sc->sc_sh, &status);
382         if (ah == NULL) {
383                 if_printf(ifp, "unable to attach hardware; HAL status %u\n",
384                         status);
385                 error = ENXIO;
386                 goto bad;
387         }
388         sc->sc_ah = ah;
389         sc->sc_invalid = 0;     /* ready to go, enable interrupt handling */
390 #ifdef  ATH_DEBUG
391         sc->sc_debug = ath_debug;
392 #endif
393
394         /*
395          * Check if the MAC has multi-rate retry support.
396          * We do this by trying to setup a fake extended
397          * descriptor.  MAC's that don't have support will
398          * return false w/o doing anything.  MAC's that do
399          * support it will return true w/o doing anything.
400          */
401         sc->sc_mrretry = ath_hal_setupxtxdesc(ah, NULL, 0,0, 0,0, 0,0);
402
403         /*
404          * Check if the device has hardware counters for PHY
405          * errors.  If so we need to enable the MIB interrupt
406          * so we can act on stat triggers.
407          */
408         if (ath_hal_hwphycounters(ah))
409                 sc->sc_needmib = 1;
410
411         /*
412          * Get the hardware key cache size.
413          */
414         sc->sc_keymax = ath_hal_keycachesize(ah);
415         if (sc->sc_keymax > ATH_KEYMAX) {
416                 if_printf(ifp, "Warning, using only %u of %u key cache slots\n",
417                         ATH_KEYMAX, sc->sc_keymax);
418                 sc->sc_keymax = ATH_KEYMAX;
419         }
420         /*
421          * Reset the key cache since some parts do not
422          * reset the contents on initial power up.
423          */
424         for (i = 0; i < sc->sc_keymax; i++)
425                 ath_hal_keyreset(ah, i);
426
427         /*
428          * Collect the default channel list.
429          */
430         error = ath_getchannels(sc);
431         if (error != 0)
432                 goto bad;
433
434         /*
435          * Setup rate tables for all potential media types.
436          */
437         ath_rate_setup(sc, IEEE80211_MODE_11A);
438         ath_rate_setup(sc, IEEE80211_MODE_11B);
439         ath_rate_setup(sc, IEEE80211_MODE_11G);
440         ath_rate_setup(sc, IEEE80211_MODE_TURBO_A);
441         ath_rate_setup(sc, IEEE80211_MODE_TURBO_G);
442         ath_rate_setup(sc, IEEE80211_MODE_STURBO_A);
443         ath_rate_setup(sc, IEEE80211_MODE_11NA);
444         ath_rate_setup(sc, IEEE80211_MODE_11NG);
445         ath_rate_setup(sc, IEEE80211_MODE_HALF);
446         ath_rate_setup(sc, IEEE80211_MODE_QUARTER);
447
448         /* NB: setup here so ath_rate_update is happy */
449         ath_setcurmode(sc, IEEE80211_MODE_11A);
450
451         /*
452          * Allocate tx+rx descriptors and populate the lists.
453          */
454         wlan_assert_serialized();
455         wlan_serialize_exit();
456         error = ath_desc_alloc(sc);
457         wlan_serialize_enter();
458         if (error != 0) {
459                 if_printf(ifp, "failed to allocate descriptors: %d\n", error);
460                 goto bad;
461         }
462         callout_init(&sc->sc_cal_ch);
463         callout_init(&sc->sc_wd_ch);
464
465         sc->sc_tq = taskqueue_create("ath_taskq", M_INTWAIT,
466                 taskqueue_thread_enqueue, &sc->sc_tq);
467         taskqueue_start_threads(&sc->sc_tq, 1, TDPRI_KERN_DAEMON, -1,
468                 "%s taskq", ifp->if_xname);
469
470         TASK_INIT(&sc->sc_rxtask, 0, ath_rx_task, sc);
471         TASK_INIT(&sc->sc_bmisstask, 0, ath_bmiss_task, sc);
472         TASK_INIT(&sc->sc_bstucktask,0, ath_bstuck_task, sc);
473
474         /*
475          * Allocate hardware transmit queues: one queue for
476          * beacon frames and one data queue for each QoS
477          * priority.  Note that the hal handles reseting
478          * these queues at the needed time.
479          *
480          * XXX PS-Poll
481          */
482         sc->sc_bhalq = ath_beaconq_setup(ah);
483         if (sc->sc_bhalq == (u_int) -1) {
484                 if_printf(ifp, "unable to setup a beacon xmit queue!\n");
485                 error = EIO;
486                 goto bad2;
487         }
488         sc->sc_cabq = ath_txq_setup(sc, HAL_TX_QUEUE_CAB, 0);
489         if (sc->sc_cabq == NULL) {
490                 if_printf(ifp, "unable to setup CAB xmit queue!\n");
491                 error = EIO;
492                 goto bad2;
493         }
494         /* NB: insure BK queue is the lowest priority h/w queue */
495         if (!ath_tx_setup(sc, WME_AC_BK, HAL_WME_AC_BK)) {
496                 if_printf(ifp, "unable to setup xmit queue for %s traffic!\n",
497                         ieee80211_wme_acnames[WME_AC_BK]);
498                 error = EIO;
499                 goto bad2;
500         }
501         if (!ath_tx_setup(sc, WME_AC_BE, HAL_WME_AC_BE) ||
502             !ath_tx_setup(sc, WME_AC_VI, HAL_WME_AC_VI) ||
503             !ath_tx_setup(sc, WME_AC_VO, HAL_WME_AC_VO)) {
504                 /*
505                  * Not enough hardware tx queues to properly do WME;
506                  * just punt and assign them all to the same h/w queue.
507                  * We could do a better job of this if, for example,
508                  * we allocate queues when we switch from station to
509                  * AP mode.
510                  */
511                 if (sc->sc_ac2q[WME_AC_VI] != NULL)
512                         ath_tx_cleanupq(sc, sc->sc_ac2q[WME_AC_VI]);
513                 if (sc->sc_ac2q[WME_AC_BE] != NULL)
514                         ath_tx_cleanupq(sc, sc->sc_ac2q[WME_AC_BE]);
515                 sc->sc_ac2q[WME_AC_BE] = sc->sc_ac2q[WME_AC_BK];
516                 sc->sc_ac2q[WME_AC_VI] = sc->sc_ac2q[WME_AC_BK];
517                 sc->sc_ac2q[WME_AC_VO] = sc->sc_ac2q[WME_AC_BK];
518         }
519
520         /*
521          * Special case certain configurations.  Note the
522          * CAB queue is handled by these specially so don't
523          * include them when checking the txq setup mask.
524          */
525         switch (sc->sc_txqsetup &~ (1<<sc->sc_cabq->axq_qnum)) {
526         case 0x01:
527                 TASK_INIT(&sc->sc_txtask, 0, ath_tx_task_q0, sc);
528                 break;
529         case 0x0f:
530                 TASK_INIT(&sc->sc_txtask, 0, ath_tx_task_q0123, sc);
531                 break;
532         default:
533                 TASK_INIT(&sc->sc_txtask, 0, ath_tx_task, sc);
534                 break;
535         }
536
537         /*
538          * Setup rate control.  Some rate control modules
539          * call back to change the anntena state so expose
540          * the necessary entry points.
541          * XXX maybe belongs in struct ath_ratectrl?
542          */
543         sc->sc_setdefantenna = ath_setdefantenna;
544         sc->sc_rc = ath_rate_attach(sc);
545         if (sc->sc_rc == NULL) {
546                 error = EIO;
547                 goto bad2;
548         }
549
550         sc->sc_blinking = 0;
551         sc->sc_ledstate = 1;
552         sc->sc_ledon = 0;                       /* low true */
553         sc->sc_ledidle = (2700*hz)/1000;        /* 2.7sec */
554         callout_init_mp(&sc->sc_ledtimer);
555         /*
556          * Auto-enable soft led processing for IBM cards and for
557          * 5211 minipci cards.  Users can also manually enable/disable
558          * support with a sysctl.
559          */
560         sc->sc_softled = (devid == AR5212_DEVID_IBM || devid == AR5211_DEVID);
561         if (sc->sc_softled) {
562                 ath_hal_gpioCfgOutput(ah, sc->sc_ledpin,
563                     HAL_GPIO_MUX_MAC_NETWORK_LED);
564                 ath_hal_gpioset(ah, sc->sc_ledpin, !sc->sc_ledon);
565         }
566
567         ifp->if_softc = sc;
568         ifp->if_flags = IFF_SIMPLEX | IFF_BROADCAST | IFF_MULTICAST;
569         ifp->if_start = ath_start;
570         ifp->if_ioctl = ath_ioctl;
571         ifp->if_init = ath_init;
572         ifq_set_maxlen(&ifp->if_snd, IFQ_MAXLEN);
573         ifq_set_ready(&ifp->if_snd);
574
575         ic->ic_ifp = ifp;
576         /* XXX not right but it's not used anywhere important */
577         ic->ic_phytype = IEEE80211_T_OFDM;
578         ic->ic_opmode = IEEE80211_M_STA;
579         ic->ic_caps =
580                   IEEE80211_C_STA               /* station mode */
581                 | IEEE80211_C_IBSS              /* ibss, nee adhoc, mode */
582                 | IEEE80211_C_HOSTAP            /* hostap mode */
583                 | IEEE80211_C_MONITOR           /* monitor mode */
584                 | IEEE80211_C_AHDEMO            /* adhoc demo mode */
585                 | IEEE80211_C_WDS               /* 4-address traffic works */
586                 | IEEE80211_C_MBSS              /* mesh point link mode */
587                 | IEEE80211_C_SHPREAMBLE        /* short preamble supported */
588                 | IEEE80211_C_SHSLOT            /* short slot time supported */
589                 | IEEE80211_C_WPA               /* capable of WPA1+WPA2 */
590                 | IEEE80211_C_BGSCAN            /* capable of bg scanning */
591                 | IEEE80211_C_TXFRAG            /* handle tx frags */
592                 ;
593         /*
594          * Query the hal to figure out h/w crypto support.
595          */
596         if (ath_hal_ciphersupported(ah, HAL_CIPHER_WEP))
597                 ic->ic_cryptocaps |= IEEE80211_CRYPTO_WEP;
598         if (ath_hal_ciphersupported(ah, HAL_CIPHER_AES_OCB))
599                 ic->ic_cryptocaps |= IEEE80211_CRYPTO_AES_OCB;
600         if (ath_hal_ciphersupported(ah, HAL_CIPHER_AES_CCM))
601                 ic->ic_cryptocaps |= IEEE80211_CRYPTO_AES_CCM;
602         if (ath_hal_ciphersupported(ah, HAL_CIPHER_CKIP))
603                 ic->ic_cryptocaps |= IEEE80211_CRYPTO_CKIP;
604         if (ath_hal_ciphersupported(ah, HAL_CIPHER_TKIP)) {
605                 ic->ic_cryptocaps |= IEEE80211_CRYPTO_TKIP;
606                 /*
607                  * Check if h/w does the MIC and/or whether the
608                  * separate key cache entries are required to
609                  * handle both tx+rx MIC keys.
610                  */
611                 if (ath_hal_ciphersupported(ah, HAL_CIPHER_MIC))
612                         ic->ic_cryptocaps |= IEEE80211_CRYPTO_TKIPMIC;
613                 /*
614                  * If the h/w supports storing tx+rx MIC keys
615                  * in one cache slot automatically enable use.
616                  */
617                 if (ath_hal_hastkipsplit(ah) ||
618                     !ath_hal_settkipsplit(ah, AH_FALSE))
619                         sc->sc_splitmic = 1;
620                 /*
621                  * If the h/w can do TKIP MIC together with WME then
622                  * we use it; otherwise we force the MIC to be done
623                  * in software by the net80211 layer.
624                  */
625                 if (ath_hal_haswmetkipmic(ah))
626                         sc->sc_wmetkipmic = 1;
627         }
628         sc->sc_hasclrkey = ath_hal_ciphersupported(ah, HAL_CIPHER_CLR);
629         /*
630          * Check for multicast key search support.
631          */
632         if (ath_hal_hasmcastkeysearch(sc->sc_ah) &&
633             !ath_hal_getmcastkeysearch(sc->sc_ah)) {
634                 ath_hal_setmcastkeysearch(sc->sc_ah, 1);
635         }
636         sc->sc_mcastkey = ath_hal_getmcastkeysearch(ah);
637         /*
638          * Mark key cache slots associated with global keys
639          * as in use.  If we knew TKIP was not to be used we
640          * could leave the +32, +64, and +32+64 slots free.
641          */
642         for (i = 0; i < IEEE80211_WEP_NKID; i++) {
643                 setbit(sc->sc_keymap, i);
644                 setbit(sc->sc_keymap, i+64);
645                 if (sc->sc_splitmic) {
646                         setbit(sc->sc_keymap, i+32);
647                         setbit(sc->sc_keymap, i+32+64);
648                 }
649         }
650         /*
651          * TPC support can be done either with a global cap or
652          * per-packet support.  The latter is not available on
653          * all parts.  We're a bit pedantic here as all parts
654          * support a global cap.
655          */
656         if (ath_hal_hastpc(ah) || ath_hal_hastxpowlimit(ah))
657                 ic->ic_caps |= IEEE80211_C_TXPMGT;
658
659         /*
660          * Mark WME capability only if we have sufficient
661          * hardware queues to do proper priority scheduling.
662          */
663         if (sc->sc_ac2q[WME_AC_BE] != sc->sc_ac2q[WME_AC_BK])
664                 ic->ic_caps |= IEEE80211_C_WME;
665         /*
666          * Check for misc other capabilities.
667          */
668         if (ath_hal_hasbursting(ah))
669                 ic->ic_caps |= IEEE80211_C_BURST;
670         sc->sc_hasbmask = ath_hal_hasbssidmask(ah);
671         sc->sc_hasbmatch = ath_hal_hasbssidmatch(ah);
672         sc->sc_hastsfadd = ath_hal_hastsfadjust(ah);
673         if (ath_hal_hasfastframes(ah))
674                 ic->ic_caps |= IEEE80211_C_FF;
675         wmodes = ath_hal_getwirelessmodes(ah);
676         if (wmodes & (HAL_MODE_108G|HAL_MODE_TURBO))
677                 ic->ic_caps |= IEEE80211_C_TURBOP;
678 #ifdef IEEE80211_SUPPORT_TDMA
679         if (ath_hal_macversion(ah) > 0x78) {
680                 ic->ic_caps |= IEEE80211_C_TDMA; /* capable of TDMA */
681                 ic->ic_tdma_update = ath_tdma_update;
682         }
683 #endif
684         /*
685          * Indicate we need the 802.11 header padded to a
686          * 32-bit boundary for 4-address and QoS frames.
687          */
688         ic->ic_flags |= IEEE80211_F_DATAPAD;
689
690         /*
691          * Query the hal about antenna support.
692          */
693         sc->sc_defant = ath_hal_getdefantenna(ah);
694
695         /*
696          * Not all chips have the VEOL support we want to
697          * use with IBSS beacons; check here for it.
698          */
699         sc->sc_hasveol = ath_hal_hasveol(ah);
700
701         /* get mac address from hardware */
702         ath_hal_getmac(ah, macaddr);
703         if (sc->sc_hasbmask)
704                 ath_hal_getbssidmask(ah, sc->sc_hwbssidmask);
705
706         /* NB: used to size node table key mapping array */
707         ic->ic_max_keyix = sc->sc_keymax;
708         /* call MI attach routine. */
709         ieee80211_ifattach(ic, macaddr);
710         ic->ic_setregdomain = ath_setregdomain;
711         ic->ic_getradiocaps = ath_getradiocaps;
712         sc->sc_opmode = HAL_M_STA;
713
714         /* override default methods */
715         ic->ic_newassoc = ath_newassoc;
716         ic->ic_updateslot = ath_updateslot;
717         ic->ic_wme.wme_update = ath_wme_update;
718         ic->ic_vap_create = ath_vap_create;
719         ic->ic_vap_delete = ath_vap_delete;
720         ic->ic_raw_xmit = ath_raw_xmit;
721         ic->ic_update_mcast = ath_update_mcast;
722         ic->ic_update_promisc = ath_update_promisc;
723         ic->ic_node_alloc = ath_node_alloc;
724         sc->sc_node_free = ic->ic_node_free;
725         ic->ic_node_free = ath_node_free;
726         ic->ic_node_getsignal = ath_node_getsignal;
727         ic->ic_scan_start = ath_scan_start;
728         ic->ic_scan_end = ath_scan_end;
729         ic->ic_set_channel = ath_set_channel;
730
731         ieee80211_radiotap_attach(ic,
732             &sc->sc_tx_th.wt_ihdr, sizeof(sc->sc_tx_th),
733                 ATH_TX_RADIOTAP_PRESENT,
734             &sc->sc_rx_th.wr_ihdr, sizeof(sc->sc_rx_th),
735                 ATH_RX_RADIOTAP_PRESENT);
736
737         /*
738          * Setup dynamic sysctl's now that country code and
739          * regdomain are available from the hal.
740          */
741         ath_sysctlattach(sc);
742         ath_sysctl_stats_attach(sc);
743
744         if (bootverbose)
745                 ieee80211_announce(ic);
746         ath_announce(sc);
747         return 0;
748 bad2:
749         ath_tx_cleanup(sc);
750         ath_desc_free(sc);
751 bad:
752         if (ah)
753                 ath_hal_detach(ah);
754         if (ifp != NULL)
755                 if_free(ifp);
756         sc->sc_invalid = 1;
757         return error;
758 }
759
760 int
761 ath_detach(struct ath_softc *sc)
762 {
763         struct ifnet *ifp = sc->sc_ifp;
764
765         DPRINTF(sc, ATH_DEBUG_ANY, "%s: if_flags %x\n",
766                 __func__, ifp->if_flags);
767
768         /* 
769          * NB: the order of these is important:
770          * o stop the chip so no more interrupts will fire
771          * o call the 802.11 layer before detaching the hal to
772          *   insure callbacks into the driver to delete global
773          *   key cache entries can be handled
774          * o free the taskqueue which drains any pending tasks
775          * o reclaim the tx queue data structures after calling
776          *   the 802.11 layer as we'll get called back to reclaim
777          *   node state and potentially want to use them
778          * o to cleanup the tx queues the hal is called, so detach
779          *   it last
780          * Other than that, it's straightforward...
781          */
782         ath_stop(ifp);
783         ieee80211_ifdetach(ifp->if_l2com);
784         taskqueue_free(sc->sc_tq);
785 #ifdef ATH_TX99_DIAG
786         if (sc->sc_tx99 != NULL)
787                 sc->sc_tx99->detach(sc->sc_tx99);
788 #endif
789         ath_rate_detach(sc->sc_rc);
790         ath_desc_free(sc);
791         ath_tx_cleanup(sc);
792         ath_hal_detach(sc->sc_ah);      /* NB: sets chip in full sleep */
793         if (sc->sc_sysctl_tree) {
794                 sysctl_ctx_free(&sc->sc_sysctl_ctx);
795                 sc->sc_sysctl_tree = NULL;
796         }
797         if_free(ifp);
798
799         return 0;
800 }
801
802 /*
803  * MAC address handling for multiple BSS on the same radio.
804  * The first vap uses the MAC address from the EEPROM.  For
805  * subsequent vap's we set the U/L bit (bit 1) in the MAC
806  * address and use the next six bits as an index.
807  */
808 static void
809 assign_address(struct ath_softc *sc, uint8_t mac[IEEE80211_ADDR_LEN], int clone)
810 {
811         int i;
812
813         if (clone && sc->sc_hasbmask) {
814                 /* NB: we only do this if h/w supports multiple bssid */
815                 for (i = 0; i < 8; i++)
816                         if ((sc->sc_bssidmask & (1<<i)) == 0)
817                                 break;
818                 if (i != 0)
819                         mac[0] |= (i << 2)|0x2;
820         } else
821                 i = 0;
822         sc->sc_bssidmask |= 1<<i;
823         sc->sc_hwbssidmask[0] &= ~mac[0];
824         if (i == 0)
825                 sc->sc_nbssid0++;
826 }
827
828 static void
829 reclaim_address(struct ath_softc *sc, const uint8_t mac[IEEE80211_ADDR_LEN])
830 {
831         int i = mac[0] >> 2;
832         uint8_t mask;
833
834         if (i != 0 || --sc->sc_nbssid0 == 0) {
835                 sc->sc_bssidmask &= ~(1<<i);
836                 /* recalculate bssid mask from remaining addresses */
837                 mask = 0xff;
838                 for (i = 1; i < 8; i++)
839                         if (sc->sc_bssidmask & (1<<i))
840                                 mask &= ~((i<<2)|0x2);
841                 sc->sc_hwbssidmask[0] |= mask;
842         }
843 }
844
845 /*
846  * Assign a beacon xmit slot.  We try to space out
847  * assignments so when beacons are staggered the
848  * traffic coming out of the cab q has maximal time
849  * to go out before the next beacon is scheduled.
850  */
851 static int
852 assign_bslot(struct ath_softc *sc)
853 {
854         u_int slot, free;
855
856         free = 0;
857         for (slot = 0; slot < ATH_BCBUF; slot++)
858                 if (sc->sc_bslot[slot] == NULL) {
859                         if (sc->sc_bslot[(slot+1)%ATH_BCBUF] == NULL &&
860                             sc->sc_bslot[(slot-1)%ATH_BCBUF] == NULL)
861                                 return slot;
862                         free = slot;
863                         /* NB: keep looking for a double slot */
864                 }
865         return free;
866 }
867
868 static struct ieee80211vap *
869 ath_vap_create(struct ieee80211com *ic,
870         const char name[IFNAMSIZ], int unit, int opmode, int flags,
871         const uint8_t bssid[IEEE80211_ADDR_LEN],
872         const uint8_t mac0[IEEE80211_ADDR_LEN])
873 {
874         struct ath_softc *sc = ic->ic_ifp->if_softc;
875         struct ath_vap *avp;
876         struct ieee80211vap *vap;
877         uint8_t mac[IEEE80211_ADDR_LEN];
878         int ic_opmode, needbeacon, error;
879
880         avp = (struct ath_vap *) kmalloc(sizeof(struct ath_vap),
881             M_80211_VAP, M_WAITOK | M_ZERO);
882         needbeacon = 0;
883         IEEE80211_ADDR_COPY(mac, mac0);
884
885         ic_opmode = opmode;             /* default to opmode of new vap */
886         switch (opmode) {
887         case IEEE80211_M_STA:
888                 if (sc->sc_nstavaps != 0) {     /* XXX only 1 for now */
889                         device_printf(sc->sc_dev, "only 1 sta vap supported\n");
890                         goto bad;
891                 }
892                 if (sc->sc_nvaps) {
893                         /*
894                          * With multiple vaps we must fall back
895                          * to s/w beacon miss handling.
896                          */
897                         flags |= IEEE80211_CLONE_NOBEACONS;
898                 }
899                 if (flags & IEEE80211_CLONE_NOBEACONS) {
900                         /*
901                          * Station mode w/o beacons are implemented w/ AP mode.
902                          */
903                         ic_opmode = IEEE80211_M_HOSTAP;
904                 }
905                 break;
906         case IEEE80211_M_IBSS:
907                 if (sc->sc_nvaps != 0) {        /* XXX only 1 for now */
908                         device_printf(sc->sc_dev,
909                             "only 1 ibss vap supported\n");
910                         goto bad;
911                 }
912                 needbeacon = 1;
913                 break;
914         case IEEE80211_M_AHDEMO:
915 #ifdef IEEE80211_SUPPORT_TDMA
916                 if (flags & IEEE80211_CLONE_TDMA) {
917                         if (sc->sc_nvaps != 0) {
918                                 device_printf(sc->sc_dev,
919                                     "only 1 tdma vap supported\n");
920                                 goto bad;
921                         }
922                         needbeacon = 1;
923                         flags |= IEEE80211_CLONE_NOBEACONS;
924                 }
925                 /* fall thru... */
926 #endif
927         case IEEE80211_M_MONITOR:
928                 if (sc->sc_nvaps != 0 && ic->ic_opmode != opmode) {
929                         /*
930                          * Adopt existing mode.  Adding a monitor or ahdemo
931                          * vap to an existing configuration is of dubious
932                          * value but should be ok.
933                          */
934                         /* XXX not right for monitor mode */
935                         ic_opmode = ic->ic_opmode;
936                 }
937                 break;
938         case IEEE80211_M_HOSTAP:
939         case IEEE80211_M_MBSS:
940                 needbeacon = 1;
941                 break;
942         case IEEE80211_M_WDS:
943                 if (sc->sc_nvaps != 0 && ic->ic_opmode == IEEE80211_M_STA) {
944                         device_printf(sc->sc_dev,
945                             "wds not supported in sta mode\n");
946                         goto bad;
947                 }
948                 /*
949                  * Silently remove any request for a unique
950                  * bssid; WDS vap's always share the local
951                  * mac address.
952                  */
953                 flags &= ~IEEE80211_CLONE_BSSID;
954                 if (sc->sc_nvaps == 0)
955                         ic_opmode = IEEE80211_M_HOSTAP;
956                 else
957                         ic_opmode = ic->ic_opmode;
958                 break;
959         default:
960                 device_printf(sc->sc_dev, "unknown opmode %d\n", opmode);
961                 goto bad;
962         }
963         /*
964          * Check that a beacon buffer is available; the code below assumes it.
965          */
966         if (needbeacon & STAILQ_EMPTY(&sc->sc_bbuf)) {
967                 device_printf(sc->sc_dev, "no beacon buffer available\n");
968                 goto bad;
969         }
970
971         /* STA, AHDEMO? */
972         if (opmode == IEEE80211_M_HOSTAP || opmode == IEEE80211_M_MBSS) {
973                 assign_address(sc, mac, flags & IEEE80211_CLONE_BSSID);
974                 ath_hal_setbssidmask(sc->sc_ah, sc->sc_hwbssidmask);
975         }
976
977         vap = &avp->av_vap;
978         /* XXX can't hold mutex across if_alloc */
979         error = ieee80211_vap_setup(ic, vap, name, unit, opmode, flags,
980             bssid, mac);
981         if (error != 0) {
982                 device_printf(sc->sc_dev, "%s: error %d creating vap\n",
983                     __func__, error);
984                 goto bad2;
985         }
986
987         /* h/w crypto support */
988         vap->iv_key_alloc = ath_key_alloc;
989         vap->iv_key_delete = ath_key_delete;
990         vap->iv_key_set = ath_key_set;
991         vap->iv_key_update_begin = ath_key_update_begin;
992         vap->iv_key_update_end = ath_key_update_end;
993
994         /* override various methods */
995         avp->av_recv_mgmt = vap->iv_recv_mgmt;
996         vap->iv_recv_mgmt = ath_recv_mgmt;
997         vap->iv_reset = ath_reset_vap;
998         vap->iv_update_beacon = ath_beacon_update;
999         avp->av_newstate = vap->iv_newstate;
1000         vap->iv_newstate = ath_newstate;
1001         avp->av_bmiss = vap->iv_bmiss;
1002         vap->iv_bmiss = ath_bmiss_vap;
1003
1004         avp->av_bslot = -1;
1005         if (needbeacon) {
1006                 /*
1007                  * Allocate beacon state and setup the q for buffered
1008                  * multicast frames.  We know a beacon buffer is
1009                  * available because we checked above.
1010                  */
1011                 avp->av_bcbuf = STAILQ_FIRST(&sc->sc_bbuf);
1012                 STAILQ_REMOVE_HEAD(&sc->sc_bbuf, bf_list);
1013                 if (opmode != IEEE80211_M_IBSS || !sc->sc_hasveol) {
1014                         /*
1015                          * Assign the vap to a beacon xmit slot.  As above
1016                          * this cannot fail to find a free one.
1017                          */
1018                         avp->av_bslot = assign_bslot(sc);
1019                         KASSERT(sc->sc_bslot[avp->av_bslot] == NULL,
1020                             ("beacon slot %u not empty", avp->av_bslot));
1021                         sc->sc_bslot[avp->av_bslot] = vap;
1022                         sc->sc_nbcnvaps++;
1023                 }
1024                 if (sc->sc_hastsfadd && sc->sc_nbcnvaps > 0) {
1025                         /*
1026                          * Multple vaps are to transmit beacons and we
1027                          * have h/w support for TSF adjusting; enable
1028                          * use of staggered beacons.
1029                          */
1030                         sc->sc_stagbeacons = 1;
1031                 }
1032                 ath_txq_init(sc, &avp->av_mcastq, ATH_TXQ_SWQ);
1033         }
1034
1035         ic->ic_opmode = ic_opmode;
1036         if (opmode != IEEE80211_M_WDS) {
1037                 sc->sc_nvaps++;
1038                 if (opmode == IEEE80211_M_STA)
1039                         sc->sc_nstavaps++;
1040                 if (opmode == IEEE80211_M_MBSS)
1041                         sc->sc_nmeshvaps++;
1042         }
1043         switch (ic_opmode) {
1044         case IEEE80211_M_IBSS:
1045                 sc->sc_opmode = HAL_M_IBSS;
1046                 break;
1047         case IEEE80211_M_STA:
1048                 sc->sc_opmode = HAL_M_STA;
1049                 break;
1050         case IEEE80211_M_AHDEMO:
1051 #ifdef IEEE80211_SUPPORT_TDMA
1052                 if (vap->iv_caps & IEEE80211_C_TDMA) {
1053                         sc->sc_tdma = 1;
1054                         /* NB: disable tsf adjust */
1055                         sc->sc_stagbeacons = 0;
1056                 }
1057                 /*
1058                  * NB: adhoc demo mode is a pseudo mode; to the hal it's
1059                  * just ap mode.
1060                  */
1061                 /* fall thru... */
1062 #endif
1063         case IEEE80211_M_HOSTAP:
1064         case IEEE80211_M_MBSS:
1065                 sc->sc_opmode = HAL_M_HOSTAP;
1066                 break;
1067         case IEEE80211_M_MONITOR:
1068                 sc->sc_opmode = HAL_M_MONITOR;
1069                 break;
1070         default:
1071                 /* XXX should not happen */
1072                 break;
1073         }
1074         if (sc->sc_hastsfadd) {
1075                 /*
1076                  * Configure whether or not TSF adjust should be done.
1077                  */
1078                 ath_hal_settsfadjust(sc->sc_ah, sc->sc_stagbeacons);
1079         }
1080         if (flags & IEEE80211_CLONE_NOBEACONS) {
1081                 /*
1082                  * Enable s/w beacon miss handling.
1083                  */
1084                 sc->sc_swbmiss = 1;
1085         }
1086
1087         /* complete setup */
1088         ieee80211_vap_attach(vap, ath_media_change, ieee80211_media_status);
1089         return vap;
1090 bad2:
1091         reclaim_address(sc, mac);
1092         ath_hal_setbssidmask(sc->sc_ah, sc->sc_hwbssidmask);
1093 bad:
1094         kfree(avp, M_80211_VAP);
1095         return NULL;
1096 }
1097
1098 static void
1099 ath_vap_delete(struct ieee80211vap *vap)
1100 {
1101         struct ieee80211com *ic = vap->iv_ic;
1102         struct ifnet *ifp = ic->ic_ifp;
1103         struct ath_softc *sc = ifp->if_softc;
1104         struct ath_hal *ah = sc->sc_ah;
1105         struct ath_vap *avp = ATH_VAP(vap);
1106
1107         if (ifp->if_flags & IFF_RUNNING) {
1108                 /*
1109                  * Quiesce the hardware while we remove the vap.  In
1110                  * particular we need to reclaim all references to
1111                  * the vap state by any frames pending on the tx queues.
1112                  */
1113                 ath_hal_intrset(ah, 0);         /* disable interrupts */
1114                 ath_draintxq(sc);               /* stop xmit side */
1115                 ath_stoprecv(sc);               /* stop recv side */
1116         }
1117
1118         ieee80211_vap_detach(vap);
1119         /*
1120          * Reclaim beacon state.  Note this must be done before
1121          * the vap instance is reclaimed as we may have a reference
1122          * to it in the buffer for the beacon frame.
1123          */
1124         if (avp->av_bcbuf != NULL) {
1125                 if (avp->av_bslot != -1) {
1126                         sc->sc_bslot[avp->av_bslot] = NULL;
1127                         sc->sc_nbcnvaps--;
1128                 }
1129                 ath_beacon_return(sc, avp->av_bcbuf);
1130                 avp->av_bcbuf = NULL;
1131                 if (sc->sc_nbcnvaps == 0) {
1132                         sc->sc_stagbeacons = 0;
1133                         if (sc->sc_hastsfadd)
1134                                 ath_hal_settsfadjust(sc->sc_ah, 0);
1135                 }
1136                 /*
1137                  * Reclaim any pending mcast frames for the vap.
1138                  */
1139                 ath_tx_draintxq(sc, &avp->av_mcastq);
1140         }
1141         /*
1142          * Update bookkeeping.
1143          */
1144         if (vap->iv_opmode == IEEE80211_M_STA) {
1145                 sc->sc_nstavaps--;
1146                 if (sc->sc_nstavaps == 0 && sc->sc_swbmiss)
1147                         sc->sc_swbmiss = 0;
1148         } else if (vap->iv_opmode == IEEE80211_M_HOSTAP ||
1149             vap->iv_opmode == IEEE80211_M_MBSS) {
1150                 reclaim_address(sc, vap->iv_myaddr);
1151                 ath_hal_setbssidmask(ah, sc->sc_hwbssidmask);
1152                 if (vap->iv_opmode == IEEE80211_M_MBSS)
1153                         sc->sc_nmeshvaps--;
1154         }
1155         if (vap->iv_opmode != IEEE80211_M_WDS)
1156                 sc->sc_nvaps--;
1157 #ifdef IEEE80211_SUPPORT_TDMA
1158         /* TDMA operation ceases when the last vap is destroyed */
1159         if (sc->sc_tdma && sc->sc_nvaps == 0) {
1160                 sc->sc_tdma = 0;
1161                 sc->sc_swbmiss = 0;
1162         }
1163 #endif
1164         kfree(avp, M_80211_VAP);
1165
1166         if (ifp->if_flags & IFF_RUNNING) {
1167                 /*
1168                  * Restart rx+tx machines if still running (RUNNING will
1169                  * be reset if we just destroyed the last vap).
1170                  */
1171                 if (ath_startrecv(sc) != 0)
1172                         if_printf(ifp, "%s: unable to restart recv logic\n",
1173                             __func__);
1174                 if (sc->sc_beacons) {           /* restart beacons */
1175 #ifdef IEEE80211_SUPPORT_TDMA
1176                         if (sc->sc_tdma)
1177                                 ath_tdma_config(sc, NULL);
1178                         else
1179 #endif
1180                                 ath_beacon_config(sc, NULL);
1181                 }
1182                 ath_hal_intrset(ah, sc->sc_imask);
1183         }
1184 }
1185
1186 void
1187 ath_suspend(struct ath_softc *sc)
1188 {
1189         struct ifnet *ifp = sc->sc_ifp;
1190         struct ieee80211com *ic = ifp->if_l2com;
1191
1192         DPRINTF(sc, ATH_DEBUG_ANY, "%s: if_flags %x\n",
1193                 __func__, ifp->if_flags);
1194
1195         sc->sc_resume_up = (ifp->if_flags & IFF_UP) != 0;
1196         if (ic->ic_opmode == IEEE80211_M_STA)
1197                 ath_stop(ifp);
1198         else
1199                 ieee80211_suspend_all(ic);
1200         /*
1201          * NB: don't worry about putting the chip in low power
1202          * mode; pci will power off our socket on suspend and
1203          * CardBus detaches the device.
1204          */
1205 }
1206
1207 /*
1208  * Reset the key cache since some parts do not reset the
1209  * contents on resume.  First we clear all entries, then
1210  * re-load keys that the 802.11 layer assumes are setup
1211  * in h/w.
1212  */
1213 static void
1214 ath_reset_keycache(struct ath_softc *sc)
1215 {
1216         struct ifnet *ifp = sc->sc_ifp;
1217         struct ieee80211com *ic = ifp->if_l2com;
1218         struct ath_hal *ah = sc->sc_ah;
1219         int i;
1220
1221         for (i = 0; i < sc->sc_keymax; i++)
1222                 ath_hal_keyreset(ah, i);
1223         ieee80211_crypto_reload_keys(ic);
1224 }
1225
1226 void
1227 ath_resume(struct ath_softc *sc)
1228 {
1229         struct ifnet *ifp = sc->sc_ifp;
1230         struct ieee80211com *ic = ifp->if_l2com;
1231         struct ath_hal *ah = sc->sc_ah;
1232         HAL_STATUS status;
1233
1234         DPRINTF(sc, ATH_DEBUG_ANY, "%s: if_flags %x\n",
1235                 __func__, ifp->if_flags);
1236
1237         /*
1238          * Must reset the chip before we reload the
1239          * keycache as we were powered down on suspend.
1240          */
1241         ath_hal_reset(ah, sc->sc_opmode,
1242             sc->sc_curchan != NULL ? sc->sc_curchan : ic->ic_curchan,
1243             AH_FALSE, &status);
1244         ath_reset_keycache(sc);
1245         if (sc->sc_resume_up) {
1246                 if (ic->ic_opmode == IEEE80211_M_STA) {
1247                         ath_init(sc);
1248                         /*
1249                          * Program the beacon registers using the last rx'd
1250                          * beacon frame and enable sync on the next beacon
1251                          * we see.  This should handle the case where we
1252                          * wakeup and find the same AP and also the case where
1253                          * we wakeup and need to roam.  For the latter we
1254                          * should get bmiss events that trigger a roam.
1255                          */
1256                         ath_beacon_config(sc, NULL);
1257                         sc->sc_syncbeacon = 1;
1258                 } else
1259                         ieee80211_resume_all(ic);
1260         }
1261         if (sc->sc_softled) {
1262                 ath_hal_gpioCfgOutput(ah, sc->sc_ledpin,
1263                     HAL_GPIO_MUX_MAC_NETWORK_LED);
1264                 ath_hal_gpioset(ah, sc->sc_ledpin, !sc->sc_ledon);
1265         }
1266 }
1267
1268 void
1269 ath_shutdown(struct ath_softc *sc)
1270 {
1271         struct ifnet *ifp = sc->sc_ifp;
1272
1273         DPRINTF(sc, ATH_DEBUG_ANY, "%s: if_flags %x\n",
1274                 __func__, ifp->if_flags);
1275
1276         ath_stop(ifp);
1277         /* NB: no point powering down chip as we're about to reboot */
1278 }
1279
1280 /*
1281  * Interrupt handler.  Most of the actual processing is deferred.
1282  */
1283 void
1284 ath_intr(void *arg)
1285 {
1286         struct ath_softc *sc = arg;
1287         struct ifnet *ifp = sc->sc_ifp;
1288         struct ath_hal *ah = sc->sc_ah;
1289         HAL_INT status;
1290         HAL_INT ostatus;
1291
1292         if (sc->sc_invalid) {
1293                 /*
1294                  * The hardware is not ready/present, don't touch anything.
1295                  * Note this can happen early on if the IRQ is shared.
1296                  */
1297                 DPRINTF(sc, ATH_DEBUG_ANY, "%s: invalid; ignored\n", __func__);
1298                 return;
1299         }
1300
1301         if (!ath_hal_intrpend(ah))              /* shared irq, not for us */
1302                 return;
1303         if ((ifp->if_flags & IFF_UP) == 0 ||
1304             (ifp->if_flags & IFF_RUNNING) == 0) {
1305                 HAL_INT status;
1306
1307                 DPRINTF(sc, ATH_DEBUG_ANY, "%s: if_flags 0x%x\n",
1308                         __func__, ifp->if_flags);
1309                 ath_hal_getisr(ah, &status);    /* clear ISR */
1310                 ath_hal_intrset(ah, 0);         /* disable further intr's */
1311                 return;
1312         }
1313         /*
1314          * Figure out the reason(s) for the interrupt.  Note
1315          * that the hal returns a pseudo-ISR that may include
1316          * bits we haven't explicitly enabled so we mask the
1317          * value to insure we only process bits we requested.
1318          */
1319         ath_hal_getisr(ah, &ostatus);           /* NB: clears ISR too */
1320         DPRINTF(sc, ATH_DEBUG_INTR, "%s: status 0x%x\n", __func__, ostatus);
1321         status = ostatus & sc->sc_imask;        /* discard unasked for bits */
1322         if (status & HAL_INT_FATAL) {
1323                 sc->sc_stats.ast_hardware++;
1324                 ath_hal_intrset(ah, 0);         /* disable intr's until reset */
1325                 ath_fatal_proc(sc, 0);
1326         } else {
1327                 if (status & HAL_INT_SWBA) {
1328                         /*
1329                          * Software beacon alert--time to send a beacon.
1330                          * Handle beacon transmission directly; deferring
1331                          * this is too slow to meet timing constraints
1332                          * under load.
1333                          */
1334 #ifdef IEEE80211_SUPPORT_TDMA
1335                         if (sc->sc_tdma) {
1336                                 if (sc->sc_tdmaswba == 0) {
1337                                         struct ieee80211com *ic = ifp->if_l2com;
1338                                         struct ieee80211vap *vap =
1339                                             TAILQ_FIRST(&ic->ic_vaps);
1340                                         ath_tdma_beacon_send(sc, vap);
1341                                         sc->sc_tdmaswba =
1342                                             vap->iv_tdma->tdma_bintval;
1343                                 } else
1344                                         sc->sc_tdmaswba--;
1345                         } else
1346 #endif
1347                         {
1348                                 ath_beacon_proc(sc, 0);
1349 #ifdef IEEE80211_SUPPORT_SUPERG
1350                                 /*
1351                                  * Schedule the rx taskq in case there's no
1352                                  * traffic so any frames held on the staging
1353                                  * queue are aged and potentially flushed.
1354                                  */
1355                                 taskqueue_enqueue(sc->sc_tq, &sc->sc_rxtask);
1356 #endif
1357                         }
1358                 }
1359
1360                 /*
1361                  * NB: The hardware should re-read the link when the RXE
1362                  *     bit is written, but it doesn't work at least on
1363                  *     older chipsets.
1364                  */
1365                 if (status & HAL_INT_RXEOL) {
1366                         sc->sc_stats.ast_rxeol++;
1367                         sc->sc_rxlink = NULL;
1368                 }
1369
1370                 if (status & HAL_INT_TXURN) {
1371                         sc->sc_stats.ast_txurn++;
1372                         /* bump tx trigger level */
1373                         ath_hal_updatetxtriglevel(ah, AH_TRUE);
1374                 }
1375
1376                 if (status & HAL_INT_RX)
1377                         taskqueue_enqueue(sc->sc_tq, &sc->sc_rxtask);
1378
1379                 if (status & HAL_INT_TX)
1380                         taskqueue_enqueue(sc->sc_tq, &sc->sc_txtask);
1381
1382                 if (status & HAL_INT_BMISS) {
1383                         sc->sc_stats.ast_bmiss++;
1384                         taskqueue_enqueue(sc->sc_tq, &sc->sc_bmisstask);
1385                 }
1386
1387                 if (status & HAL_INT_MIB) {
1388                         sc->sc_stats.ast_mib++;
1389                         /*
1390                          * Disable interrupts until we service the MIB
1391                          * interrupt; otherwise it will continue to fire.
1392                          */
1393                         ath_hal_intrset(ah, 0);
1394                         /*
1395                          * Let the hal handle the event.  We assume it will
1396                          * clear whatever condition caused the interrupt.
1397                          */
1398                         ath_hal_mibevent(ah, &sc->sc_halstats);
1399                         ath_hal_intrset(ah, sc->sc_imask);
1400                 }
1401
1402                 if (status & HAL_INT_RXORN) {
1403                         /* NB: hal marks HAL_INT_FATAL when RXORN is fatal */
1404                         sc->sc_stats.ast_rxorn++;
1405                 }
1406         }
1407 }
1408
1409 static void
1410 ath_fatal_proc(void *arg, int pending)
1411 {
1412         struct ath_softc *sc = arg;
1413         struct ifnet *ifp = sc->sc_ifp;
1414         u_int32_t *state;
1415         u_int32_t len;
1416         void *sp;
1417
1418         if_printf(ifp, "hardware error; resetting\n");
1419         /*
1420          * Fatal errors are unrecoverable.  Typically these
1421          * are caused by DMA errors.  Collect h/w state from
1422          * the hal so we can diagnose what's going on.
1423          */
1424         if (ath_hal_getfatalstate(sc->sc_ah, &sp, &len)) {
1425                 KASSERT(len >= 6*sizeof(u_int32_t), ("len %u bytes", len));
1426                 state = sp;
1427                 if_printf(ifp, "0x%08x 0x%08x 0x%08x, 0x%08x 0x%08x 0x%08x\n",
1428                     state[0], state[1] , state[2], state[3],
1429                     state[4], state[5]);
1430         }
1431         ath_reset(ifp);
1432 }
1433
1434 static void
1435 ath_bmiss_vap(struct ieee80211vap *vap)
1436 {
1437         /*
1438          * Workaround phantom bmiss interrupts by sanity-checking
1439          * the time of our last rx'd frame.  If it is within the
1440          * beacon miss interval then ignore the interrupt.  If it's
1441          * truly a bmiss we'll get another interrupt soon and that'll
1442          * be dispatched up for processing.  Note this applies only
1443          * for h/w beacon miss events.
1444          */
1445         if ((vap->iv_flags_ext & IEEE80211_FEXT_SWBMISS) == 0) {
1446                 struct ifnet *ifp = vap->iv_ic->ic_ifp;
1447                 struct ath_softc *sc = ifp->if_softc;
1448                 u_int64_t lastrx = sc->sc_lastrx;
1449                 u_int64_t tsf = ath_hal_gettsf64(sc->sc_ah);
1450                 u_int bmisstimeout =
1451                         vap->iv_bmissthreshold * vap->iv_bss->ni_intval * 1024;
1452
1453                 DPRINTF(sc, ATH_DEBUG_BEACON,
1454                     "%s: tsf %llu lastrx %lld (%llu) bmiss %u\n",
1455                     __func__, (unsigned long long) tsf,
1456                     (unsigned long long)(tsf - lastrx),
1457                     (unsigned long long) lastrx, bmisstimeout);
1458
1459                 if (tsf - lastrx <= bmisstimeout) {
1460                         sc->sc_stats.ast_bmiss_phantom++;
1461                         return;
1462                 }
1463         }
1464         ATH_VAP(vap)->av_bmiss(vap);
1465 }
1466
1467 static int
1468 ath_hal_gethangstate(struct ath_hal *ah, uint32_t mask, uint32_t *hangs)
1469 {
1470         uint32_t rsize;
1471         void *sp;
1472
1473         if (!ath_hal_getdiagstate(ah, 32, &mask, sizeof(mask), &sp, &rsize))
1474                 return 0;
1475         KASSERT(rsize == sizeof(uint32_t), ("resultsize %u", rsize));
1476         *hangs = *(uint32_t *)sp;
1477         return 1;
1478 }
1479
1480 static void
1481 ath_bmiss_task(void *arg, int pending)
1482 {
1483         struct ath_softc *sc = arg;
1484         struct ifnet *ifp = sc->sc_ifp;
1485         uint32_t hangs;
1486
1487         wlan_serialize_enter();
1488         DPRINTF(sc, ATH_DEBUG_ANY, "%s: pending %u\n", __func__, pending);
1489
1490         if (ath_hal_gethangstate(sc->sc_ah, 0xff, &hangs) && hangs != 0) {
1491                 if_printf(ifp, "bb hang detected (0x%x), reseting\n", hangs); 
1492                 ath_reset(ifp);
1493         } else {
1494                 ieee80211_beacon_miss(ifp->if_l2com);
1495         }
1496         wlan_serialize_exit();
1497 }
1498
1499 /*
1500  * Handle TKIP MIC setup to deal hardware that doesn't do MIC
1501  * calcs together with WME.  If necessary disable the crypto
1502  * hardware and mark the 802.11 state so keys will be setup
1503  * with the MIC work done in software.
1504  */
1505 static void
1506 ath_settkipmic(struct ath_softc *sc)
1507 {
1508         struct ifnet *ifp = sc->sc_ifp;
1509         struct ieee80211com *ic = ifp->if_l2com;
1510
1511         if ((ic->ic_cryptocaps & IEEE80211_CRYPTO_TKIP) && !sc->sc_wmetkipmic) {
1512                 if (ic->ic_flags & IEEE80211_F_WME) {
1513                         ath_hal_settkipmic(sc->sc_ah, AH_FALSE);
1514                         ic->ic_cryptocaps &= ~IEEE80211_CRYPTO_TKIPMIC;
1515                 } else {
1516                         ath_hal_settkipmic(sc->sc_ah, AH_TRUE);
1517                         ic->ic_cryptocaps |= IEEE80211_CRYPTO_TKIPMIC;
1518                 }
1519         }
1520 }
1521
1522 static void
1523 ath_init(void *arg)
1524 {
1525         struct ath_softc *sc = (struct ath_softc *) arg;
1526         struct ifnet *ifp = sc->sc_ifp;
1527         struct ieee80211com *ic = ifp->if_l2com;
1528         struct ath_hal *ah = sc->sc_ah;
1529         HAL_STATUS status;
1530
1531         DPRINTF(sc, ATH_DEBUG_ANY, "%s: if_flags 0x%x\n",
1532                 __func__, ifp->if_flags);
1533
1534         /*
1535          * Stop anything previously setup.  This is safe
1536          * whether this is the first time through or not.
1537          */
1538         ath_stop_locked(ifp);
1539
1540         /*
1541          * The basic interface to setting the hardware in a good
1542          * state is ``reset''.  On return the hardware is known to
1543          * be powered up and with interrupts disabled.  This must
1544          * be followed by initialization of the appropriate bits
1545          * and then setup of the interrupt mask.
1546          */
1547         ath_settkipmic(sc);
1548         if (!ath_hal_reset(ah, sc->sc_opmode, ic->ic_curchan, AH_FALSE, &status)) {
1549                 if_printf(ifp, "unable to reset hardware; hal status %u\n",
1550                         status);
1551                 return;
1552         }
1553         ath_chan_change(sc, ic->ic_curchan);
1554
1555         /*
1556          * Likewise this is set during reset so update
1557          * state cached in the driver.
1558          */
1559         sc->sc_diversity = ath_hal_getdiversity(ah);
1560         sc->sc_lastlongcal = 0;
1561         sc->sc_resetcal = 1;
1562         sc->sc_lastcalreset = 0;
1563
1564         /*
1565          * Setup the hardware after reset: the key cache
1566          * is filled as needed and the receive engine is
1567          * set going.  Frame transmit is handled entirely
1568          * in the frame output path; there's nothing to do
1569          * here except setup the interrupt mask.
1570          */
1571         if (ath_startrecv(sc) != 0) {
1572                 if_printf(ifp, "unable to start recv logic\n");
1573                 return;
1574         }
1575
1576         /*
1577          * Enable interrupts.
1578          */
1579         sc->sc_imask = HAL_INT_RX | HAL_INT_TX
1580                   | HAL_INT_RXEOL | HAL_INT_RXORN
1581                   | HAL_INT_FATAL | HAL_INT_GLOBAL;
1582         /*
1583          * Enable MIB interrupts when there are hardware phy counters.
1584          * Note we only do this (at the moment) for station mode.
1585          */
1586         if (sc->sc_needmib && ic->ic_opmode == IEEE80211_M_STA)
1587                 sc->sc_imask |= HAL_INT_MIB;
1588
1589         ifp->if_flags |= IFF_RUNNING;
1590         callout_reset(&sc->sc_wd_ch, hz, ath_watchdog_callout, sc);
1591         ath_hal_intrset(ah, sc->sc_imask);
1592
1593
1594 #ifdef ATH_TX99_DIAG
1595         if (sc->sc_tx99 != NULL)
1596                 sc->sc_tx99->start(sc->sc_tx99);
1597         else
1598 #endif
1599         ieee80211_start_all(ic);                /* start all vap's */
1600 }
1601
1602 static void
1603 ath_stop_locked(struct ifnet *ifp)
1604 {
1605         struct ath_softc *sc = ifp->if_softc;
1606         struct ath_hal *ah = sc->sc_ah;
1607
1608         DPRINTF(sc, ATH_DEBUG_ANY, "%s: invalid %u if_flags 0x%x\n",
1609                 __func__, sc->sc_invalid, ifp->if_flags);
1610
1611         if (ifp->if_flags & IFF_RUNNING) {
1612                 /*
1613                  * Shutdown the hardware and driver:
1614                  *    reset 802.11 state machine
1615                  *    turn off timers
1616                  *    disable interrupts
1617                  *    turn off the radio
1618                  *    clear transmit machinery
1619                  *    clear receive machinery
1620                  *    drain and release tx queues
1621                  *    reclaim beacon resources
1622                  *    power down hardware
1623                  *
1624                  * Note that some of this work is not possible if the
1625                  * hardware is gone (invalid).
1626                  */
1627 #ifdef ATH_TX99_DIAG
1628                 if (sc->sc_tx99 != NULL)
1629                         sc->sc_tx99->stop(sc->sc_tx99);
1630 #endif
1631                 callout_stop(&sc->sc_wd_ch);
1632                 sc->sc_wd_timer = 0;
1633                 ifp->if_flags &= ~IFF_RUNNING;
1634                 if (!sc->sc_invalid) {
1635                         if (sc->sc_softled) {
1636                                 callout_stop(&sc->sc_ledtimer);
1637                                 ath_hal_gpioset(ah, sc->sc_ledpin,
1638                                         !sc->sc_ledon);
1639                                 sc->sc_blinking = 0;
1640                         }
1641                         ath_hal_intrset(ah, 0);
1642                 }
1643                 ath_draintxq(sc);
1644                 if (!sc->sc_invalid) {
1645                         ath_stoprecv(sc);
1646                         ath_hal_phydisable(ah);
1647                 } else
1648                         sc->sc_rxlink = NULL;
1649                 ath_beacon_free(sc);    /* XXX not needed */
1650         }
1651 }
1652
1653 static void
1654 ath_stop(struct ifnet *ifp)
1655 {
1656         struct ath_softc *sc __unused = ifp->if_softc;
1657
1658         ath_stop_locked(ifp);
1659 }
1660
1661 /*
1662  * Reset the hardware w/o losing operational state.  This is
1663  * basically a more efficient way of doing ath_stop, ath_init,
1664  * followed by state transitions to the current 802.11
1665  * operational state.  Used to recover from various errors and
1666  * to reset or reload hardware state.
1667  */
1668 static int
1669 ath_reset(struct ifnet *ifp)
1670 {
1671         struct ath_softc *sc = ifp->if_softc;
1672         struct ieee80211com *ic = ifp->if_l2com;
1673         struct ath_hal *ah = sc->sc_ah;
1674         HAL_STATUS status;
1675
1676         ath_hal_intrset(ah, 0);         /* disable interrupts */
1677         ath_draintxq(sc);               /* stop xmit side */
1678         ath_stoprecv(sc);               /* stop recv side */
1679         ath_settkipmic(sc);             /* configure TKIP MIC handling */
1680         /* NB: indicate channel change so we do a full reset */
1681         if (!ath_hal_reset(ah, sc->sc_opmode, ic->ic_curchan, AH_TRUE, &status))
1682                 if_printf(ifp, "%s: unable to reset hardware; hal status %u\n",
1683                         __func__, status);
1684         sc->sc_diversity = ath_hal_getdiversity(ah);
1685         if (ath_startrecv(sc) != 0)     /* restart recv */
1686                 if_printf(ifp, "%s: unable to start recv logic\n", __func__);
1687         /*
1688          * We may be doing a reset in response to an ioctl
1689          * that changes the channel so update any state that
1690          * might change as a result.
1691          */
1692         ath_chan_change(sc, ic->ic_curchan);
1693         if (sc->sc_beacons) {           /* restart beacons */
1694 #ifdef IEEE80211_SUPPORT_TDMA
1695                 if (sc->sc_tdma)
1696                         ath_tdma_config(sc, NULL);
1697                 else
1698 #endif
1699                         ath_beacon_config(sc, NULL);
1700         }
1701         ath_hal_intrset(ah, sc->sc_imask);
1702
1703         ath_start(ifp);                 /* restart xmit */
1704         return 0;
1705 }
1706
1707 static int
1708 ath_reset_vap(struct ieee80211vap *vap, u_long cmd)
1709 {
1710         struct ieee80211com *ic = vap->iv_ic;
1711         struct ifnet *ifp = ic->ic_ifp;
1712         struct ath_softc *sc = ifp->if_softc;
1713         struct ath_hal *ah = sc->sc_ah;
1714
1715         switch (cmd) {
1716         case IEEE80211_IOC_TXPOWER:
1717                 /*
1718                  * If per-packet TPC is enabled, then we have nothing
1719                  * to do; otherwise we need to force the global limit.
1720                  * All this can happen directly; no need to reset.
1721                  */
1722                 if (!ath_hal_gettpc(ah))
1723                         ath_hal_settxpowlimit(ah, ic->ic_txpowlimit);
1724                 return 0;
1725         }
1726         return ath_reset(ifp);
1727 }
1728
1729 static struct ath_buf *
1730 _ath_getbuf_locked(struct ath_softc *sc)
1731 {
1732         struct ath_buf *bf;
1733
1734         bf = STAILQ_FIRST(&sc->sc_txbuf);
1735         if (bf != NULL && (bf->bf_flags & ATH_BUF_BUSY) == 0)
1736                 STAILQ_REMOVE_HEAD(&sc->sc_txbuf, bf_list);
1737         else
1738                 bf = NULL;
1739         if (bf == NULL) {
1740                 kprintf("ath: ran out of descriptors\n");
1741                 DPRINTF(sc, ATH_DEBUG_XMIT, "%s: %s\n", __func__,
1742                     STAILQ_FIRST(&sc->sc_txbuf) == NULL ?
1743                         "out of xmit buffers" : "xmit buffer busy");
1744         }
1745         return bf;
1746 }
1747
1748 static struct ath_buf *
1749 ath_getbuf(struct ath_softc *sc)
1750 {
1751         struct ath_buf *bf;
1752
1753         bf = _ath_getbuf_locked(sc);
1754         if (bf == NULL) {
1755                 struct ifnet *ifp = sc->sc_ifp;
1756
1757                 DPRINTF(sc, ATH_DEBUG_XMIT, "%s: stop queue\n", __func__);
1758                 sc->sc_stats.ast_tx_qstop++;
1759                 ifq_set_oactive(&ifp->if_snd);
1760         }
1761         return bf;
1762 }
1763
1764 /*
1765  * Cleanup driver resources when we run out of buffers
1766  * while processing fragments; return the tx buffers
1767  * allocated and drop node references.
1768  */
1769 static void
1770 ath_txfrag_cleanup(struct ath_softc *sc,
1771         ath_bufhead *frags, struct ieee80211_node *ni)
1772 {
1773         struct ath_buf *bf, *next;
1774
1775         STAILQ_FOREACH_MUTABLE(bf, frags, bf_list, next) {
1776                 /* NB: bf assumed clean */
1777                 STAILQ_REMOVE_HEAD(frags, bf_list);
1778                 STAILQ_INSERT_HEAD(&sc->sc_txbuf, bf, bf_list);
1779                 ieee80211_node_decref(ni);
1780         }
1781 }
1782
1783 /*
1784  * Setup xmit of a fragmented frame.  Allocate a buffer
1785  * for each frag and bump the node reference count to
1786  * reflect the held reference to be setup by ath_tx_start.
1787  */
1788 static int
1789 ath_txfrag_setup(struct ath_softc *sc, ath_bufhead *frags,
1790         struct mbuf *m0, struct ieee80211_node *ni)
1791 {
1792         struct mbuf *m;
1793         struct ath_buf *bf;
1794
1795         for (m = m0->m_nextpkt; m != NULL; m = m->m_nextpkt) {
1796                 bf = _ath_getbuf_locked(sc);
1797                 if (bf == NULL) {       /* out of buffers, cleanup */
1798                         ath_txfrag_cleanup(sc, frags, ni);
1799                         break;
1800                 }
1801                 ieee80211_node_incref(ni);
1802                 STAILQ_INSERT_TAIL(frags, bf, bf_list);
1803         }
1804
1805         return !STAILQ_EMPTY(frags);
1806 }
1807
1808 static void
1809 ath_start(struct ifnet *ifp)
1810 {
1811         struct ath_softc *sc = ifp->if_softc;
1812         struct ieee80211_node *ni;
1813         struct ath_buf *bf;
1814         struct mbuf *m, *next;
1815         ath_bufhead frags;
1816
1817         if ((ifp->if_flags & IFF_RUNNING) == 0 || sc->sc_invalid) {
1818                 ifq_purge(&ifp->if_snd);
1819                 return;
1820         }
1821         for (;;) {
1822                 /*
1823                  * Grab a TX buffer and associated resources.
1824                  */
1825                 bf = ath_getbuf(sc);
1826                 if (bf == NULL)
1827                         break;
1828
1829                 m = ifq_dequeue(&ifp->if_snd, NULL);
1830                 if (m == NULL) {
1831                         STAILQ_INSERT_HEAD(&sc->sc_txbuf, bf, bf_list);
1832                         break;
1833                 }
1834                 ni = (struct ieee80211_node *) m->m_pkthdr.rcvif;
1835                 /*
1836                  * Check for fragmentation.  If this frame
1837                  * has been broken up verify we have enough
1838                  * buffers to send all the fragments so all
1839                  * go out or none...
1840                  */
1841                 STAILQ_INIT(&frags);
1842                 if ((m->m_flags & M_FRAG) && 
1843                     !ath_txfrag_setup(sc, &frags, m, ni)) {
1844                         DPRINTF(sc, ATH_DEBUG_XMIT,
1845                             "%s: out of txfrag buffers\n", __func__);
1846                         sc->sc_stats.ast_tx_nofrag++;
1847                         ifp->if_oerrors++;
1848                         ath_freetx(m);
1849                         goto bad;
1850                 }
1851                 ifp->if_opackets++;
1852         nextfrag:
1853                 /*
1854                  * Pass the frame to the h/w for transmission.
1855                  * Fragmented frames have each frag chained together
1856                  * with m_nextpkt.  We know there are sufficient ath_buf's
1857                  * to send all the frags because of work done by
1858                  * ath_txfrag_setup.  We leave m_nextpkt set while
1859                  * calling ath_tx_start so it can use it to extend the
1860                  * the tx duration to cover the subsequent frag and
1861                  * so it can reclaim all the mbufs in case of an error;
1862                  * ath_tx_start clears m_nextpkt once it commits to
1863                  * handing the frame to the hardware.
1864                  */
1865                 next = m->m_nextpkt;
1866                 if (ath_tx_start(sc, ni, bf, m)) {
1867         bad:
1868                         ifp->if_oerrors++;
1869         reclaim:
1870                         bf->bf_m = NULL;
1871                         bf->bf_node = NULL;
1872                         STAILQ_INSERT_HEAD(&sc->sc_txbuf, bf, bf_list);
1873                         ath_txfrag_cleanup(sc, &frags, ni);
1874                         if (ni != NULL)
1875                                 ieee80211_free_node(ni);
1876                         continue;
1877                 }
1878                 if (next != NULL) {
1879                         /*
1880                          * Beware of state changing between frags.
1881                          * XXX check sta power-save state?
1882                          */
1883                         if (ni->ni_vap->iv_state != IEEE80211_S_RUN) {
1884                                 DPRINTF(sc, ATH_DEBUG_XMIT,
1885                                     "%s: flush fragmented packet, state %s\n",
1886                                     __func__,
1887                                     ieee80211_state_name[ni->ni_vap->iv_state]);
1888                                 ath_freetx(next);
1889                                 goto reclaim;
1890                         }
1891                         m = next;
1892                         bf = STAILQ_FIRST(&frags);
1893                         KASSERT(bf != NULL, ("no buf for txfrag"));
1894                         STAILQ_REMOVE_HEAD(&frags, bf_list);
1895                         goto nextfrag;
1896                 }
1897
1898                 sc->sc_wd_timer = 5;
1899         }
1900 }
1901
1902 static int
1903 ath_media_change(struct ifnet *ifp)
1904 {
1905         int error = ieee80211_media_change(ifp);
1906         /* NB: only the fixed rate can change and that doesn't need a reset */
1907         return (error == ENETRESET ? 0 : error);
1908 }
1909
1910 #ifdef ATH_DEBUG
1911 static void
1912 ath_keyprint(struct ath_softc *sc, const char *tag, u_int ix,
1913         const HAL_KEYVAL *hk, const u_int8_t mac[IEEE80211_ADDR_LEN])
1914 {
1915         static const char *ciphers[] = {
1916                 "WEP",
1917                 "AES-OCB",
1918                 "AES-CCM",
1919                 "CKIP",
1920                 "TKIP",
1921                 "CLR",
1922         };
1923         int i, n;
1924
1925         kprintf("%s: [%02u] %-7s ", tag, ix, ciphers[hk->kv_type]);
1926         for (i = 0, n = hk->kv_len; i < n; i++)
1927                 kprintf("%02x", hk->kv_val[i]);
1928         kprintf(" mac %6D", mac, ":");
1929         if (hk->kv_type == HAL_CIPHER_TKIP) {
1930                 kprintf(" %s ", sc->sc_splitmic ? "mic" : "rxmic");
1931                 for (i = 0; i < sizeof(hk->kv_mic); i++)
1932                         kprintf("%02x", hk->kv_mic[i]);
1933                 if (!sc->sc_splitmic) {
1934                         kprintf(" txmic ");
1935                         for (i = 0; i < sizeof(hk->kv_txmic); i++)
1936                                 kprintf("%02x", hk->kv_txmic[i]);
1937                 }
1938         }
1939         kprintf("\n");
1940 }
1941 #endif
1942
1943 /*
1944  * Set a TKIP key into the hardware.  This handles the
1945  * potential distribution of key state to multiple key
1946  * cache slots for TKIP.
1947  */
1948 static int
1949 ath_keyset_tkip(struct ath_softc *sc, const struct ieee80211_key *k,
1950         HAL_KEYVAL *hk, const u_int8_t mac[IEEE80211_ADDR_LEN])
1951 {
1952 #define IEEE80211_KEY_XR        (IEEE80211_KEY_XMIT | IEEE80211_KEY_RECV)
1953         static const u_int8_t zerobssid[IEEE80211_ADDR_LEN];
1954         struct ath_hal *ah = sc->sc_ah;
1955
1956         KASSERT(k->wk_cipher->ic_cipher == IEEE80211_CIPHER_TKIP,
1957                 ("got a non-TKIP key, cipher %u", k->wk_cipher->ic_cipher));
1958         if ((k->wk_flags & IEEE80211_KEY_XR) == IEEE80211_KEY_XR) {
1959                 if (sc->sc_splitmic) {
1960                         /*
1961                          * TX key goes at first index, RX key at the rx index.
1962                          * The hal handles the MIC keys at index+64.
1963                          */
1964                         memcpy(hk->kv_mic, k->wk_txmic, sizeof(hk->kv_mic));
1965                         KEYPRINTF(sc, k->wk_keyix, hk, zerobssid);
1966                         if (!ath_hal_keyset(ah, k->wk_keyix, hk, zerobssid))
1967                                 return 0;
1968
1969                         memcpy(hk->kv_mic, k->wk_rxmic, sizeof(hk->kv_mic));
1970                         KEYPRINTF(sc, k->wk_keyix+32, hk, mac);
1971                         /* XXX delete tx key on failure? */
1972                         return ath_hal_keyset(ah, k->wk_keyix+32, hk, mac);
1973                 } else {
1974                         /*
1975                          * Room for both TX+RX MIC keys in one key cache
1976                          * slot, just set key at the first index; the hal
1977                          * will handle the rest.
1978                          */
1979                         memcpy(hk->kv_mic, k->wk_rxmic, sizeof(hk->kv_mic));
1980                         memcpy(hk->kv_txmic, k->wk_txmic, sizeof(hk->kv_txmic));
1981                         KEYPRINTF(sc, k->wk_keyix, hk, mac);
1982                         return ath_hal_keyset(ah, k->wk_keyix, hk, mac);
1983                 }
1984         } else if (k->wk_flags & IEEE80211_KEY_XMIT) {
1985                 if (sc->sc_splitmic) {
1986                         /*
1987                          * NB: must pass MIC key in expected location when
1988                          * the keycache only holds one MIC key per entry.
1989                          */
1990                         memcpy(hk->kv_mic, k->wk_txmic, sizeof(hk->kv_txmic));
1991                 } else
1992                         memcpy(hk->kv_txmic, k->wk_txmic, sizeof(hk->kv_txmic));
1993                 KEYPRINTF(sc, k->wk_keyix, hk, mac);
1994                 return ath_hal_keyset(ah, k->wk_keyix, hk, mac);
1995         } else if (k->wk_flags & IEEE80211_KEY_RECV) {
1996                 memcpy(hk->kv_mic, k->wk_rxmic, sizeof(hk->kv_mic));
1997                 KEYPRINTF(sc, k->wk_keyix, hk, mac);
1998                 return ath_hal_keyset(ah, k->wk_keyix, hk, mac);
1999         }
2000         return 0;
2001 #undef IEEE80211_KEY_XR
2002 }
2003
2004 /*
2005  * Set a net80211 key into the hardware.  This handles the
2006  * potential distribution of key state to multiple key
2007  * cache slots for TKIP with hardware MIC support.
2008  */
2009 static int
2010 ath_keyset(struct ath_softc *sc, const struct ieee80211_key *k,
2011         struct ieee80211_node *bss)
2012 {
2013         static const u_int8_t ciphermap[] = {
2014                 HAL_CIPHER_WEP,         /* IEEE80211_CIPHER_WEP */
2015                 HAL_CIPHER_TKIP,        /* IEEE80211_CIPHER_TKIP */
2016                 HAL_CIPHER_AES_OCB,     /* IEEE80211_CIPHER_AES_OCB */
2017                 HAL_CIPHER_AES_CCM,     /* IEEE80211_CIPHER_AES_CCM */
2018                 (u_int8_t) -1,          /* 4 is not allocated */
2019                 HAL_CIPHER_CKIP,        /* IEEE80211_CIPHER_CKIP */
2020                 HAL_CIPHER_CLR,         /* IEEE80211_CIPHER_NONE */
2021         };
2022         struct ath_hal *ah = sc->sc_ah;
2023         const struct ieee80211_cipher *cip = k->wk_cipher;
2024         u_int8_t gmac[IEEE80211_ADDR_LEN];
2025         const u_int8_t *mac;
2026         HAL_KEYVAL hk;
2027
2028         memset(&hk, 0, sizeof(hk));
2029         /*
2030          * Software crypto uses a "clear key" so non-crypto
2031          * state kept in the key cache are maintained and
2032          * so that rx frames have an entry to match.
2033          */
2034         if ((k->wk_flags & IEEE80211_KEY_SWCRYPT) == 0) {
2035                 KASSERT(cip->ic_cipher < NELEM(ciphermap),
2036                         ("invalid cipher type %u", cip->ic_cipher));
2037                 hk.kv_type = ciphermap[cip->ic_cipher];
2038                 hk.kv_len = k->wk_keylen;
2039                 memcpy(hk.kv_val, k->wk_key, k->wk_keylen);
2040         } else
2041                 hk.kv_type = HAL_CIPHER_CLR;
2042
2043         if ((k->wk_flags & IEEE80211_KEY_GROUP) && sc->sc_mcastkey) {
2044                 /*
2045                  * Group keys on hardware that supports multicast frame
2046                  * key search use a MAC that is the sender's address with
2047                  * the high bit set instead of the app-specified address.
2048                  */
2049                 IEEE80211_ADDR_COPY(gmac, bss->ni_macaddr);
2050                 gmac[0] |= 0x80;
2051                 mac = gmac;
2052         } else
2053                 mac = k->wk_macaddr;
2054
2055         if (hk.kv_type == HAL_CIPHER_TKIP &&
2056             (k->wk_flags & IEEE80211_KEY_SWMIC) == 0) {
2057                 return ath_keyset_tkip(sc, k, &hk, mac);
2058         } else {
2059                 KEYPRINTF(sc, k->wk_keyix, &hk, mac);
2060                 return ath_hal_keyset(ah, k->wk_keyix, &hk, mac);
2061         }
2062 }
2063
2064 /*
2065  * Allocate tx/rx key slots for TKIP.  We allocate two slots for
2066  * each key, one for decrypt/encrypt and the other for the MIC.
2067  */
2068 static u_int16_t
2069 key_alloc_2pair(struct ath_softc *sc,
2070         ieee80211_keyix *txkeyix, ieee80211_keyix *rxkeyix)
2071 {
2072         u_int i, keyix;
2073
2074         KASSERT(sc->sc_splitmic, ("key cache !split"));
2075         /* XXX could optimize */
2076         for (i = 0; i < NELEM(sc->sc_keymap)/4; i++) {
2077                 u_int8_t b = sc->sc_keymap[i];
2078                 if (b != 0xff) {
2079                         /*
2080                          * One or more slots in this byte are free.
2081                          */
2082                         keyix = i*NBBY;
2083                         while (b & 1) {
2084                 again:
2085                                 keyix++;
2086                                 b >>= 1;
2087                         }
2088                         /* XXX IEEE80211_KEY_XMIT | IEEE80211_KEY_RECV */
2089                         if (isset(sc->sc_keymap, keyix+32) ||
2090                             isset(sc->sc_keymap, keyix+64) ||
2091                             isset(sc->sc_keymap, keyix+32+64)) {
2092                                 /* full pair unavailable */
2093                                 /* XXX statistic */
2094                                 if (keyix == (i+1)*NBBY) {
2095                                         /* no slots were appropriate, advance */
2096                                         continue;
2097                                 }
2098                                 goto again;
2099                         }
2100                         setbit(sc->sc_keymap, keyix);
2101                         setbit(sc->sc_keymap, keyix+64);
2102                         setbit(sc->sc_keymap, keyix+32);
2103                         setbit(sc->sc_keymap, keyix+32+64);
2104                         DPRINTF(sc, ATH_DEBUG_KEYCACHE,
2105                                 "%s: key pair %u,%u %u,%u\n",
2106                                 __func__, keyix, keyix+64,
2107                                 keyix+32, keyix+32+64);
2108                         *txkeyix = keyix;
2109                         *rxkeyix = keyix+32;
2110                         return 1;
2111                 }
2112         }
2113         DPRINTF(sc, ATH_DEBUG_KEYCACHE, "%s: out of pair space\n", __func__);
2114         return 0;
2115 }
2116
2117 /*
2118  * Allocate tx/rx key slots for TKIP.  We allocate two slots for
2119  * each key, one for decrypt/encrypt and the other for the MIC.
2120  */
2121 static u_int16_t
2122 key_alloc_pair(struct ath_softc *sc,
2123         ieee80211_keyix *txkeyix, ieee80211_keyix *rxkeyix)
2124 {
2125         u_int i, keyix;
2126
2127         KASSERT(!sc->sc_splitmic, ("key cache split"));
2128         /* XXX could optimize */
2129         for (i = 0; i < NELEM(sc->sc_keymap)/4; i++) {
2130                 u_int8_t b = sc->sc_keymap[i];
2131                 if (b != 0xff) {
2132                         /*
2133                          * One or more slots in this byte are free.
2134                          */
2135                         keyix = i*NBBY;
2136                         while (b & 1) {
2137                 again:
2138                                 keyix++;
2139                                 b >>= 1;
2140                         }
2141                         if (isset(sc->sc_keymap, keyix+64)) {
2142                                 /* full pair unavailable */
2143                                 /* XXX statistic */
2144                                 if (keyix == (i+1)*NBBY) {
2145                                         /* no slots were appropriate, advance */
2146                                         continue;
2147                                 }
2148                                 goto again;
2149                         }
2150                         setbit(sc->sc_keymap, keyix);
2151                         setbit(sc->sc_keymap, keyix+64);
2152                         DPRINTF(sc, ATH_DEBUG_KEYCACHE,
2153                                 "%s: key pair %u,%u\n",
2154                                 __func__, keyix, keyix+64);
2155                         *txkeyix = *rxkeyix = keyix;
2156                         return 1;
2157                 }
2158         }
2159         DPRINTF(sc, ATH_DEBUG_KEYCACHE, "%s: out of pair space\n", __func__);
2160         return 0;
2161 }
2162
2163 /*
2164  * Allocate a single key cache slot.
2165  */
2166 static int
2167 key_alloc_single(struct ath_softc *sc,
2168         ieee80211_keyix *txkeyix, ieee80211_keyix *rxkeyix)
2169 {
2170         u_int i, keyix;
2171
2172         /* XXX try i,i+32,i+64,i+32+64 to minimize key pair conflicts */
2173         for (i = 0; i < NELEM(sc->sc_keymap); i++) {
2174                 u_int8_t b = sc->sc_keymap[i];
2175                 if (b != 0xff) {
2176                         /*
2177                          * One or more slots are free.
2178                          */
2179                         keyix = i*NBBY;
2180                         while (b & 1)
2181                                 keyix++, b >>= 1;
2182                         setbit(sc->sc_keymap, keyix);
2183                         DPRINTF(sc, ATH_DEBUG_KEYCACHE, "%s: key %u\n",
2184                                 __func__, keyix);
2185                         *txkeyix = *rxkeyix = keyix;
2186                         return 1;
2187                 }
2188         }
2189         DPRINTF(sc, ATH_DEBUG_KEYCACHE, "%s: out of space\n", __func__);
2190         return 0;
2191 }
2192
2193 /*
2194  * Allocate one or more key cache slots for a uniacst key.  The
2195  * key itself is needed only to identify the cipher.  For hardware
2196  * TKIP with split cipher+MIC keys we allocate two key cache slot
2197  * pairs so that we can setup separate TX and RX MIC keys.  Note
2198  * that the MIC key for a TKIP key at slot i is assumed by the
2199  * hardware to be at slot i+64.  This limits TKIP keys to the first
2200  * 64 entries.
2201  */
2202 static int
2203 ath_key_alloc(struct ieee80211vap *vap, struct ieee80211_key *k,
2204         ieee80211_keyix *keyix, ieee80211_keyix *rxkeyix)
2205 {
2206         struct ath_softc *sc = vap->iv_ic->ic_ifp->if_softc;
2207
2208         /*
2209          * Group key allocation must be handled specially for
2210          * parts that do not support multicast key cache search
2211          * functionality.  For those parts the key id must match
2212          * the h/w key index so lookups find the right key.  On
2213          * parts w/ the key search facility we install the sender's
2214          * mac address (with the high bit set) and let the hardware
2215          * find the key w/o using the key id.  This is preferred as
2216          * it permits us to support multiple users for adhoc and/or
2217          * multi-station operation.
2218          */
2219         if (k->wk_keyix != IEEE80211_KEYIX_NONE) {
2220                 /*
2221                  * Only global keys should have key index assigned.
2222                  */
2223                 if (!(&vap->iv_nw_keys[0] <= k &&
2224                       k < &vap->iv_nw_keys[IEEE80211_WEP_NKID])) {
2225                         /* should not happen */
2226                         DPRINTF(sc, ATH_DEBUG_KEYCACHE,
2227                                 "%s: bogus group key\n", __func__);
2228                         return 0;
2229                 }
2230                 if (vap->iv_opmode != IEEE80211_M_HOSTAP ||
2231                     !(k->wk_flags & IEEE80211_KEY_GROUP) ||
2232                     !sc->sc_mcastkey) {
2233                         /*
2234                          * XXX we pre-allocate the global keys so
2235                          * have no way to check if they've already
2236                          * been allocated.
2237                          */
2238                         *keyix = *rxkeyix = k - vap->iv_nw_keys;
2239                         return 1;
2240                 }
2241                 /*
2242                  * Group key and device supports multicast key search.
2243                  */
2244                 k->wk_keyix = IEEE80211_KEYIX_NONE;
2245         }
2246
2247         /*
2248          * We allocate two pair for TKIP when using the h/w to do
2249          * the MIC.  For everything else, including software crypto,
2250          * we allocate a single entry.  Note that s/w crypto requires
2251          * a pass-through slot on the 5211 and 5212.  The 5210 does
2252          * not support pass-through cache entries and we map all
2253          * those requests to slot 0.
2254          */
2255         if (k->wk_flags & IEEE80211_KEY_SWCRYPT) {
2256                 return key_alloc_single(sc, keyix, rxkeyix);
2257         } else if (k->wk_cipher->ic_cipher == IEEE80211_CIPHER_TKIP &&
2258             (k->wk_flags & IEEE80211_KEY_SWMIC) == 0) {
2259                 if (sc->sc_splitmic)
2260                         return key_alloc_2pair(sc, keyix, rxkeyix);
2261                 else
2262                         return key_alloc_pair(sc, keyix, rxkeyix);
2263         } else {
2264                 return key_alloc_single(sc, keyix, rxkeyix);
2265         }
2266 }
2267
2268 /*
2269  * Delete an entry in the key cache allocated by ath_key_alloc.
2270  */
2271 static int
2272 ath_key_delete(struct ieee80211vap *vap, const struct ieee80211_key *k)
2273 {
2274         struct ath_softc *sc = vap->iv_ic->ic_ifp->if_softc;
2275         struct ath_hal *ah = sc->sc_ah;
2276         const struct ieee80211_cipher *cip = k->wk_cipher;
2277         u_int keyix = k->wk_keyix;
2278
2279         DPRINTF(sc, ATH_DEBUG_KEYCACHE, "%s: delete key %u\n", __func__, keyix);
2280
2281         ath_hal_keyreset(ah, keyix);
2282         /*
2283          * Handle split tx/rx keying required for TKIP with h/w MIC.
2284          */
2285         if (cip->ic_cipher == IEEE80211_CIPHER_TKIP &&
2286             (k->wk_flags & IEEE80211_KEY_SWMIC) == 0 && sc->sc_splitmic)
2287                 ath_hal_keyreset(ah, keyix+32);         /* RX key */
2288         if (keyix >= IEEE80211_WEP_NKID) {
2289                 /*
2290                  * Don't touch keymap entries for global keys so
2291                  * they are never considered for dynamic allocation.
2292                  */
2293                 clrbit(sc->sc_keymap, keyix);
2294                 if (cip->ic_cipher == IEEE80211_CIPHER_TKIP &&
2295                     (k->wk_flags & IEEE80211_KEY_SWMIC) == 0) {
2296                         clrbit(sc->sc_keymap, keyix+64);        /* TX key MIC */
2297                         if (sc->sc_splitmic) {
2298                                 /* +32 for RX key, +32+64 for RX key MIC */
2299                                 clrbit(sc->sc_keymap, keyix+32);
2300                                 clrbit(sc->sc_keymap, keyix+32+64);
2301                         }
2302                 }
2303         }
2304         return 1;
2305 }
2306
2307 /*
2308  * Set the key cache contents for the specified key.  Key cache
2309  * slot(s) must already have been allocated by ath_key_alloc.
2310  */
2311 static int
2312 ath_key_set(struct ieee80211vap *vap, const struct ieee80211_key *k,
2313         const u_int8_t mac[IEEE80211_ADDR_LEN])
2314 {
2315         struct ath_softc *sc = vap->iv_ic->ic_ifp->if_softc;
2316
2317         return ath_keyset(sc, k, vap->iv_bss);
2318 }
2319
2320 /*
2321  * Block/unblock tx+rx processing while a key change is done.
2322  * We assume the caller serializes key management operations
2323  * so we only need to worry about synchronization with other
2324  * uses that originate in the driver.
2325  */
2326 static void
2327 ath_key_update_begin(struct ieee80211vap *vap)
2328 {
2329         struct ifnet *ifp = vap->iv_ic->ic_ifp;
2330         struct ath_softc *sc = ifp->if_softc;
2331
2332         DPRINTF(sc, ATH_DEBUG_KEYCACHE, "%s:\n", __func__);
2333         taskqueue_block(sc->sc_tq);
2334 }
2335
2336 static void
2337 ath_key_update_end(struct ieee80211vap *vap)
2338 {
2339         struct ifnet *ifp = vap->iv_ic->ic_ifp;
2340         struct ath_softc *sc = ifp->if_softc;
2341
2342         DPRINTF(sc, ATH_DEBUG_KEYCACHE, "%s:\n", __func__);
2343         taskqueue_unblock(sc->sc_tq);
2344 }
2345
2346 /*
2347  * Calculate the receive filter according to the
2348  * operating mode and state:
2349  *
2350  * o always accept unicast, broadcast, and multicast traffic
2351  * o accept PHY error frames when hardware doesn't have MIB support
2352  *   to count and we need them for ANI (sta mode only until recently)
2353  *   and we are not scanning (ANI is disabled)
2354  *   NB: older hal's add rx filter bits out of sight and we need to
2355  *       blindly preserve them
2356  * o probe request frames are accepted only when operating in
2357  *   hostap, adhoc, mesh, or monitor modes
2358  * o enable promiscuous mode
2359  *   - when in monitor mode
2360  *   - if interface marked PROMISC (assumes bridge setting is filtered)
2361  * o accept beacons:
2362  *   - when operating in station mode for collecting rssi data when
2363  *     the station is otherwise quiet, or
2364  *   - when operating in adhoc mode so the 802.11 layer creates
2365  *     node table entries for peers,
2366  *   - when scanning
2367  *   - when doing s/w beacon miss (e.g. for ap+sta)
2368  *   - when operating in ap mode in 11g to detect overlapping bss that
2369  *     require protection
2370  *   - when operating in mesh mode to detect neighbors
2371  * o accept control frames:
2372  *   - when in monitor mode
2373  * XXX BAR frames for 11n
2374  * XXX HT protection for 11n
2375  */
2376 static u_int32_t
2377 ath_calcrxfilter(struct ath_softc *sc)
2378 {
2379         struct ifnet *ifp = sc->sc_ifp;
2380         struct ieee80211com *ic = ifp->if_l2com;
2381         u_int32_t rfilt;
2382
2383         rfilt = HAL_RX_FILTER_UCAST | HAL_RX_FILTER_BCAST | HAL_RX_FILTER_MCAST;
2384         if (!sc->sc_needmib && !sc->sc_scanning)
2385                 rfilt |= HAL_RX_FILTER_PHYERR;
2386         if (ic->ic_opmode != IEEE80211_M_STA)
2387                 rfilt |= HAL_RX_FILTER_PROBEREQ;
2388         /* XXX ic->ic_monvaps != 0? */
2389         if (ic->ic_opmode == IEEE80211_M_MONITOR || (ifp->if_flags & IFF_PROMISC))
2390                 rfilt |= HAL_RX_FILTER_PROM;
2391         if (ic->ic_opmode == IEEE80211_M_STA ||
2392             ic->ic_opmode == IEEE80211_M_IBSS ||
2393             sc->sc_swbmiss || sc->sc_scanning)
2394                 rfilt |= HAL_RX_FILTER_BEACON;
2395         /*
2396          * NB: We don't recalculate the rx filter when
2397          * ic_protmode changes; otherwise we could do
2398          * this only when ic_protmode != NONE.
2399          */
2400         if (ic->ic_opmode == IEEE80211_M_HOSTAP &&
2401             IEEE80211_IS_CHAN_ANYG(ic->ic_curchan))
2402                 rfilt |= HAL_RX_FILTER_BEACON;
2403         if (sc->sc_nmeshvaps) {
2404                 rfilt |= HAL_RX_FILTER_BEACON;
2405                 if (sc->sc_hasbmatch)
2406                         rfilt |= HAL_RX_FILTER_BSSID;
2407                 else
2408                         rfilt |= HAL_RX_FILTER_PROM;
2409         }
2410         if (ic->ic_opmode == IEEE80211_M_MONITOR)
2411                 rfilt |= HAL_RX_FILTER_CONTROL;
2412         DPRINTF(sc, ATH_DEBUG_MODE, "%s: RX filter 0x%x, %s if_flags 0x%x\n",
2413             __func__, rfilt, ieee80211_opmode_name[ic->ic_opmode], ifp->if_flags);
2414         return rfilt;
2415 }
2416
2417 static void
2418 ath_update_promisc(struct ifnet *ifp)
2419 {
2420         struct ath_softc *sc = ifp->if_softc;
2421         u_int32_t rfilt;
2422
2423         /* configure rx filter */
2424         rfilt = ath_calcrxfilter(sc);
2425         ath_hal_setrxfilter(sc->sc_ah, rfilt);
2426
2427         DPRINTF(sc, ATH_DEBUG_MODE, "%s: RX filter 0x%x\n", __func__, rfilt);
2428 }
2429
2430 static void
2431 ath_update_mcast(struct ifnet *ifp)
2432 {
2433         struct ath_softc *sc = ifp->if_softc;
2434         u_int32_t mfilt[2];
2435
2436         /* calculate and install multicast filter */
2437         if ((ifp->if_flags & IFF_ALLMULTI) == 0) {
2438                 struct ifmultiaddr *ifma;
2439                 /*
2440                  * Merge multicast addresses to form the hardware filter.
2441                  */
2442                 mfilt[0] = mfilt[1] = 0;
2443 #ifdef __FreeBSD__
2444                 if_maddr_rlock(ifp);    /* XXX need some fiddling to remove? */
2445 #endif
2446                 TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
2447                         caddr_t dl;
2448                         u_int32_t val;
2449                         u_int8_t pos;
2450
2451                         /* calculate XOR of eight 6bit values */
2452                         dl = LLADDR((struct sockaddr_dl *) ifma->ifma_addr);
2453                         val = LE_READ_4(dl + 0);
2454                         pos = (val >> 18) ^ (val >> 12) ^ (val >> 6) ^ val;
2455                         val = LE_READ_4(dl + 3);
2456                         pos ^= (val >> 18) ^ (val >> 12) ^ (val >> 6) ^ val;
2457                         pos &= 0x3f;
2458                         mfilt[pos / 32] |= (1 << (pos % 32));
2459                 }
2460 #ifdef __FreeBSD__
2461                 if_maddr_runlock(ifp);
2462 #endif
2463         } else
2464                 mfilt[0] = mfilt[1] = ~0;
2465         ath_hal_setmcastfilter(sc->sc_ah, mfilt[0], mfilt[1]);
2466         DPRINTF(sc, ATH_DEBUG_MODE, "%s: MC filter %08x:%08x\n",
2467                 __func__, mfilt[0], mfilt[1]);
2468 }
2469
2470 static void
2471 ath_mode_init(struct ath_softc *sc)
2472 {
2473         struct ifnet *ifp = sc->sc_ifp;
2474         struct ath_hal *ah = sc->sc_ah;
2475         u_int32_t rfilt;
2476
2477         /* configure rx filter */
2478         rfilt = ath_calcrxfilter(sc);
2479         ath_hal_setrxfilter(ah, rfilt);
2480
2481         /* configure operational mode */
2482         ath_hal_setopmode(ah);
2483
2484         /* handle any link-level address change */
2485         ath_hal_setmac(ah, IF_LLADDR(ifp));
2486
2487         /* calculate and install multicast filter */
2488         ath_update_mcast(ifp);
2489 }
2490
2491 /*
2492  * Set the slot time based on the current setting.
2493  */
2494 static void
2495 ath_setslottime(struct ath_softc *sc)
2496 {
2497         struct ieee80211com *ic = sc->sc_ifp->if_l2com;
2498         struct ath_hal *ah = sc->sc_ah;
2499         u_int usec;
2500
2501         if (IEEE80211_IS_CHAN_HALF(ic->ic_curchan))
2502                 usec = 13;
2503         else if (IEEE80211_IS_CHAN_QUARTER(ic->ic_curchan))
2504                 usec = 21;
2505         else if (IEEE80211_IS_CHAN_ANYG(ic->ic_curchan)) {
2506                 /* honor short/long slot time only in 11g */
2507                 /* XXX shouldn't honor on pure g or turbo g channel */
2508                 if (ic->ic_flags & IEEE80211_F_SHSLOT)
2509                         usec = HAL_SLOT_TIME_9;
2510                 else
2511                         usec = HAL_SLOT_TIME_20;
2512         } else
2513                 usec = HAL_SLOT_TIME_9;
2514
2515         DPRINTF(sc, ATH_DEBUG_RESET,
2516             "%s: chan %u MHz flags 0x%x %s slot, %u usec\n",
2517             __func__, ic->ic_curchan->ic_freq, ic->ic_curchan->ic_flags,
2518             ic->ic_flags & IEEE80211_F_SHSLOT ? "short" : "long", usec);
2519
2520         ath_hal_setslottime(ah, usec);
2521         sc->sc_updateslot = OK;
2522 }
2523
2524 /*
2525  * Callback from the 802.11 layer to update the
2526  * slot time based on the current setting.
2527  */
2528 static void
2529 ath_updateslot(struct ifnet *ifp)
2530 {
2531         struct ath_softc *sc = ifp->if_softc;
2532         struct ieee80211com *ic = ifp->if_l2com;
2533
2534         /*
2535          * When not coordinating the BSS, change the hardware
2536          * immediately.  For other operation we defer the change
2537          * until beacon updates have propagated to the stations.
2538          */
2539         if (ic->ic_opmode == IEEE80211_M_HOSTAP ||
2540             ic->ic_opmode == IEEE80211_M_MBSS)
2541                 sc->sc_updateslot = UPDATE;
2542         else
2543                 ath_setslottime(sc);
2544 }
2545
2546 /*
2547  * Setup a h/w transmit queue for beacons.
2548  */
2549 static int
2550 ath_beaconq_setup(struct ath_hal *ah)
2551 {
2552         HAL_TXQ_INFO qi;
2553
2554         memset(&qi, 0, sizeof(qi));
2555         qi.tqi_aifs = HAL_TXQ_USEDEFAULT;
2556         qi.tqi_cwmin = HAL_TXQ_USEDEFAULT;
2557         qi.tqi_cwmax = HAL_TXQ_USEDEFAULT;
2558         /* NB: for dynamic turbo, don't enable any other interrupts */
2559         qi.tqi_qflags = HAL_TXQ_TXDESCINT_ENABLE;
2560         return ath_hal_setuptxqueue(ah, HAL_TX_QUEUE_BEACON, &qi);
2561 }
2562
2563 /*
2564  * Setup the transmit queue parameters for the beacon queue.
2565  */
2566 static int
2567 ath_beaconq_config(struct ath_softc *sc)
2568 {
2569 #define ATH_EXPONENT_TO_VALUE(v)        ((1<<(v))-1)
2570         struct ieee80211com *ic = sc->sc_ifp->if_l2com;
2571         struct ath_hal *ah = sc->sc_ah;
2572         HAL_TXQ_INFO qi;
2573
2574         ath_hal_gettxqueueprops(ah, sc->sc_bhalq, &qi);
2575         if (ic->ic_opmode == IEEE80211_M_HOSTAP ||
2576             ic->ic_opmode == IEEE80211_M_MBSS) {
2577                 /*
2578                  * Always burst out beacon and CAB traffic.
2579                  */
2580                 qi.tqi_aifs = ATH_BEACON_AIFS_DEFAULT;
2581                 qi.tqi_cwmin = ATH_BEACON_CWMIN_DEFAULT;
2582                 qi.tqi_cwmax = ATH_BEACON_CWMAX_DEFAULT;
2583         } else {
2584                 struct wmeParams *wmep =
2585                         &ic->ic_wme.wme_chanParams.cap_wmeParams[WME_AC_BE];
2586                 /*
2587                  * Adhoc mode; important thing is to use 2x cwmin.
2588                  */
2589                 qi.tqi_aifs = wmep->wmep_aifsn;
2590                 qi.tqi_cwmin = 2*ATH_EXPONENT_TO_VALUE(wmep->wmep_logcwmin);
2591                 qi.tqi_cwmax = ATH_EXPONENT_TO_VALUE(wmep->wmep_logcwmax);
2592         }
2593
2594         if (!ath_hal_settxqueueprops(ah, sc->sc_bhalq, &qi)) {
2595                 device_printf(sc->sc_dev, "unable to update parameters for "
2596                         "beacon hardware queue!\n");
2597                 return 0;
2598         } else {
2599                 ath_hal_resettxqueue(ah, sc->sc_bhalq); /* push to h/w */
2600                 return 1;
2601         }
2602 #undef ATH_EXPONENT_TO_VALUE
2603 }
2604
2605 /*
2606  * Allocate and setup an initial beacon frame.
2607  */
2608 static int
2609 ath_beacon_alloc(struct ath_softc *sc, struct ieee80211_node *ni)
2610 {
2611         struct ieee80211vap *vap = ni->ni_vap;
2612         struct ath_vap *avp = ATH_VAP(vap);
2613         struct ath_buf *bf;
2614         struct mbuf *m;
2615         int error;
2616
2617         bf = avp->av_bcbuf;
2618         if (bf->bf_m != NULL) {
2619                 bus_dmamap_unload(sc->sc_dmat, bf->bf_dmamap);
2620                 m_freem(bf->bf_m);
2621                 bf->bf_m = NULL;
2622         }
2623         if (bf->bf_node != NULL) {
2624                 ieee80211_free_node(bf->bf_node);
2625                 bf->bf_node = NULL;
2626         }
2627
2628         /*
2629          * NB: the beacon data buffer must be 32-bit aligned;
2630          * we assume the mbuf routines will return us something
2631          * with this alignment (perhaps should assert).
2632          */
2633         m = ieee80211_beacon_alloc(ni, &avp->av_boff);
2634         if (m == NULL) {
2635                 device_printf(sc->sc_dev, "%s: cannot get mbuf\n", __func__);
2636                 sc->sc_stats.ast_be_nombuf++;
2637                 return ENOMEM;
2638         }
2639         error = bus_dmamap_load_mbuf_segment(sc->sc_dmat, bf->bf_dmamap, m,
2640                                      bf->bf_segs, 1, &bf->bf_nseg,
2641                                      BUS_DMA_NOWAIT);
2642         if (error != 0) {
2643                 device_printf(sc->sc_dev,
2644                     "%s: cannot map mbuf, bus_dmamap_load_mbuf_segment returns %d\n",
2645                     __func__, error);
2646                 m_freem(m);
2647                 return error;
2648         }
2649
2650         /*
2651          * Calculate a TSF adjustment factor required for staggered
2652          * beacons.  Note that we assume the format of the beacon
2653          * frame leaves the tstamp field immediately following the
2654          * header.
2655          */
2656         if (sc->sc_stagbeacons && avp->av_bslot > 0) {
2657                 uint64_t tsfadjust;
2658                 struct ieee80211_frame *wh;
2659
2660                 /*
2661                  * The beacon interval is in TU's; the TSF is in usecs.
2662                  * We figure out how many TU's to add to align the timestamp
2663                  * then convert to TSF units and handle byte swapping before
2664                  * inserting it in the frame.  The hardware will then add this
2665                  * each time a beacon frame is sent.  Note that we align vap's
2666                  * 1..N and leave vap 0 untouched.  This means vap 0 has a
2667                  * timestamp in one beacon interval while the others get a
2668                  * timstamp aligned to the next interval.
2669                  */
2670                 tsfadjust = ni->ni_intval *
2671                     (ATH_BCBUF - avp->av_bslot) / ATH_BCBUF;
2672                 tsfadjust = htole64(tsfadjust << 10);   /* TU -> TSF */
2673
2674                 DPRINTF(sc, ATH_DEBUG_BEACON,
2675                     "%s: %s beacons bslot %d intval %u tsfadjust %llu\n",
2676                     __func__, sc->sc_stagbeacons ? "stagger" : "burst",
2677                     avp->av_bslot, ni->ni_intval,
2678                     (long long unsigned) le64toh(tsfadjust));
2679
2680                 wh = mtod(m, struct ieee80211_frame *);
2681                 memcpy(&wh[1], &tsfadjust, sizeof(tsfadjust));
2682         }
2683         bf->bf_m = m;
2684         bf->bf_node = ieee80211_ref_node(ni);
2685
2686         return 0;
2687 }
2688
2689 /*
2690  * Setup the beacon frame for transmit.
2691  */
2692 static void
2693 ath_beacon_setup(struct ath_softc *sc, struct ath_buf *bf)
2694 {
2695 #define USE_SHPREAMBLE(_ic) \
2696         (((_ic)->ic_flags & (IEEE80211_F_SHPREAMBLE | IEEE80211_F_USEBARKER))\
2697                 == IEEE80211_F_SHPREAMBLE)
2698         struct ieee80211_node *ni = bf->bf_node;
2699         struct ieee80211com *ic = ni->ni_ic;
2700         struct mbuf *m = bf->bf_m;
2701         struct ath_hal *ah = sc->sc_ah;
2702         struct ath_desc *ds;
2703         int flags, antenna;
2704         const HAL_RATE_TABLE *rt;
2705         u_int8_t rix, rate;
2706
2707         DPRINTF(sc, ATH_DEBUG_BEACON_PROC, "%s: m %p len %u\n",
2708                 __func__, m, m->m_len);
2709
2710         /* setup descriptors */
2711         ds = bf->bf_desc;
2712
2713         flags = HAL_TXDESC_NOACK;
2714         if (ic->ic_opmode == IEEE80211_M_IBSS && sc->sc_hasveol) {
2715                 ds->ds_link = bf->bf_daddr;     /* self-linked */
2716                 flags |= HAL_TXDESC_VEOL;
2717                 /*
2718                  * Let hardware handle antenna switching.
2719                  */
2720                 antenna = sc->sc_txantenna;
2721         } else {
2722                 ds->ds_link = 0;
2723                 /*
2724                  * Switch antenna every 4 beacons.
2725                  * XXX assumes two antenna
2726                  */
2727                 if (sc->sc_txantenna != 0)
2728                         antenna = sc->sc_txantenna;
2729                 else if (sc->sc_stagbeacons && sc->sc_nbcnvaps != 0)
2730                         antenna = ((sc->sc_stats.ast_be_xmit / sc->sc_nbcnvaps) & 4 ? 2 : 1);
2731                 else
2732                         antenna = (sc->sc_stats.ast_be_xmit & 4 ? 2 : 1);
2733         }
2734
2735         KASSERT(bf->bf_nseg == 1,
2736                 ("multi-segment beacon frame; nseg %u", bf->bf_nseg));
2737         ds->ds_data = bf->bf_segs[0].ds_addr;
2738         /*
2739          * Calculate rate code.
2740          * XXX everything at min xmit rate
2741          */
2742         rix = 0;
2743         rt = sc->sc_currates;
2744         rate = rt->info[rix].rateCode;
2745         if (USE_SHPREAMBLE(ic))
2746                 rate |= rt->info[rix].shortPreamble;
2747         ath_hal_setuptxdesc(ah, ds
2748                 , m->m_len + IEEE80211_CRC_LEN  /* frame length */
2749                 , sizeof(struct ieee80211_frame)/* header length */
2750                 , HAL_PKT_TYPE_BEACON           /* Atheros packet type */
2751                 , ni->ni_txpower                /* txpower XXX */
2752                 , rate, 1                       /* series 0 rate/tries */
2753                 , HAL_TXKEYIX_INVALID           /* no encryption */
2754                 , antenna                       /* antenna mode */
2755                 , flags                         /* no ack, veol for beacons */
2756                 , 0                             /* rts/cts rate */
2757                 , 0                             /* rts/cts duration */
2758         );
2759         /* NB: beacon's BufLen must be a multiple of 4 bytes */
2760         ath_hal_filltxdesc(ah, ds
2761                 , roundup(m->m_len, 4)          /* buffer length */
2762                 , AH_TRUE                       /* first segment */
2763                 , AH_TRUE                       /* last segment */
2764                 , ds                            /* first descriptor */
2765         );
2766 #if 0
2767         ath_desc_swap(ds);
2768 #endif
2769 #undef USE_SHPREAMBLE
2770 }
2771
2772 static void
2773 ath_beacon_update(struct ieee80211vap *vap, int item)
2774 {
2775         struct ieee80211_beacon_offsets *bo = &ATH_VAP(vap)->av_boff;
2776
2777         setbit(bo->bo_flags, item);
2778 }
2779
2780 /*
2781  * Append the contents of src to dst; both queues
2782  * are assumed to be locked.
2783  */
2784 static void
2785 ath_txqmove(struct ath_txq *dst, struct ath_txq *src)
2786 {
2787         STAILQ_CONCAT(&dst->axq_q, &src->axq_q);
2788         if (src->axq_depth)
2789                 dst->axq_link = src->axq_link;
2790         src->axq_link = NULL;
2791         dst->axq_depth += src->axq_depth;
2792         src->axq_depth = 0;
2793 }
2794
2795 /*
2796  * Transmit a beacon frame at SWBA.  Dynamic updates to the
2797  * frame contents are done as needed and the slot time is
2798  * also adjusted based on current state.
2799  */
2800 static void
2801 ath_beacon_proc(void *arg, int pending)
2802 {
2803         struct ath_softc *sc = arg;
2804         struct ath_hal *ah = sc->sc_ah;
2805         struct ieee80211vap *vap;
2806         struct ath_buf *bf;
2807         int slot, otherant;
2808         uint32_t bfaddr;
2809
2810         DPRINTF(sc, ATH_DEBUG_BEACON_PROC, "%s: pending %u\n",
2811                 __func__, pending);
2812         /*
2813          * Check if the previous beacon has gone out.  If
2814          * not don't try to post another, skip this period
2815          * and wait for the next.  Missed beacons indicate
2816          * a problem and should not occur.  If we miss too
2817          * many consecutive beacons reset the device.
2818          */
2819         if (ath_hal_numtxpending(ah, sc->sc_bhalq) != 0) {
2820                 sc->sc_bmisscount++;
2821                 DPRINTF(sc, ATH_DEBUG_BEACON,
2822                         "%s: missed %u consecutive beacons\n",
2823                         __func__, sc->sc_bmisscount);
2824                 if (sc->sc_bmisscount >= ath_bstuck_threshold)
2825                         taskqueue_enqueue(sc->sc_tq, &sc->sc_bstucktask);
2826                 return;
2827         }
2828         if (sc->sc_bmisscount != 0) {
2829                 DPRINTF(sc, ATH_DEBUG_BEACON,
2830                         "%s: resume beacon xmit after %u misses\n",
2831                         __func__, sc->sc_bmisscount);
2832                 sc->sc_bmisscount = 0;
2833         }
2834
2835         /*
2836          * Stop any current dma before messing with the beacon linkages.
2837          */
2838         if (!ath_hal_stoptxdma(ah, sc->sc_bhalq)) {
2839                 DPRINTF(sc, ATH_DEBUG_ANY,
2840                         "%s: beacon queue %u did not stop?\n",
2841                         __func__, sc->sc_bhalq);
2842         }
2843
2844         if (sc->sc_stagbeacons) {                       /* staggered beacons */
2845                 struct ieee80211com *ic = sc->sc_ifp->if_l2com;
2846                 uint32_t tsftu;
2847
2848                 tsftu = ath_hal_gettsf32(ah) >> 10;
2849                 /* XXX lintval */
2850                 slot = ((tsftu % ic->ic_lintval) * ATH_BCBUF) / ic->ic_lintval;
2851                 vap = sc->sc_bslot[(slot+1) % ATH_BCBUF];
2852                 bfaddr = 0;
2853                 if (vap != NULL && vap->iv_state >= IEEE80211_S_RUN) {
2854                         bf = ath_beacon_generate(sc, vap);
2855                         if (bf != NULL)
2856                                 bfaddr = bf->bf_daddr;
2857                 }
2858         } else {                                        /* burst'd beacons */
2859                 uint32_t *bflink = &bfaddr;
2860
2861                 for (slot = 0; slot < ATH_BCBUF; slot++) {
2862                         vap = sc->sc_bslot[slot];
2863                         if (vap != NULL && vap->iv_state >= IEEE80211_S_RUN) {
2864                                 bf = ath_beacon_generate(sc, vap);
2865                                 if (bf != NULL) {
2866                                         *bflink = bf->bf_daddr;
2867                                         bflink = &bf->bf_desc->ds_link;
2868                                 }
2869                         }
2870                 }
2871                 *bflink = 0;                            /* terminate list */
2872         }
2873
2874         /*
2875          * Handle slot time change when a non-ERP station joins/leaves
2876          * an 11g network.  The 802.11 layer notifies us via callback,
2877          * we mark updateslot, then wait one beacon before effecting
2878          * the change.  This gives associated stations at least one
2879          * beacon interval to note the state change.
2880          */
2881         /* XXX locking */
2882         if (sc->sc_updateslot == UPDATE) {
2883                 sc->sc_updateslot = COMMIT;     /* commit next beacon */
2884                 sc->sc_slotupdate = slot;
2885         } else if (sc->sc_updateslot == COMMIT && sc->sc_slotupdate == slot)
2886                 ath_setslottime(sc);            /* commit change to h/w */
2887
2888         /*
2889          * Check recent per-antenna transmit statistics and flip
2890          * the default antenna if noticeably more frames went out
2891          * on the non-default antenna.
2892          * XXX assumes 2 anntenae
2893          */
2894         if (!sc->sc_diversity && (!sc->sc_stagbeacons || slot == 0)) {
2895                 otherant = sc->sc_defant & 1 ? 2 : 1;
2896                 if (sc->sc_ant_tx[otherant] > sc->sc_ant_tx[sc->sc_defant] + 2)
2897                         ath_setdefantenna(sc, otherant);
2898                 sc->sc_ant_tx[1] = sc->sc_ant_tx[2] = 0;
2899         }
2900
2901         if (bfaddr != 0) {
2902                 /* NB: cabq traffic should already be queued and primed */
2903                 ath_hal_puttxbuf(ah, sc->sc_bhalq, bfaddr);
2904                 sc->sc_stats.ast_be_xmit++;
2905                 ath_hal_txstart(ah, sc->sc_bhalq);
2906         }
2907         /* else no beacon will be generated */
2908 }
2909
2910 static struct ath_buf *
2911 ath_beacon_generate(struct ath_softc *sc, struct ieee80211vap *vap)
2912 {
2913         struct ath_vap *avp = ATH_VAP(vap);
2914         struct ath_txq *cabq = sc->sc_cabq;
2915         struct ath_buf *bf;
2916         struct mbuf *m;
2917         int nmcastq, error;
2918
2919         KASSERT(vap->iv_state >= IEEE80211_S_RUN,
2920             ("not running, state %d", vap->iv_state));
2921         KASSERT(avp->av_bcbuf != NULL, ("no beacon buffer"));
2922
2923         /*
2924          * Update dynamic beacon contents.  If this returns
2925          * non-zero then we need to remap the memory because
2926          * the beacon frame changed size (probably because
2927          * of the TIM bitmap).
2928          */
2929         bf = avp->av_bcbuf;
2930         m = bf->bf_m;
2931         nmcastq = avp->av_mcastq.axq_depth;
2932         if (ieee80211_beacon_update(bf->bf_node, &avp->av_boff, m, nmcastq)) {
2933                 /* XXX too conservative? */
2934                 bus_dmamap_unload(sc->sc_dmat, bf->bf_dmamap);
2935                 error = bus_dmamap_load_mbuf_segment(sc->sc_dmat, bf->bf_dmamap, m,
2936                                              bf->bf_segs, 1, &bf->bf_nseg,
2937                                              BUS_DMA_NOWAIT);
2938                 if (error != 0) {
2939                         if_printf(vap->iv_ifp,
2940                             "%s: bus_dmamap_load_mbuf_segment failed, error %u\n",
2941                             __func__, error);
2942                         return NULL;
2943                 }
2944         }
2945         if ((avp->av_boff.bo_tim[4] & 1) && cabq->axq_depth) {
2946                 DPRINTF(sc, ATH_DEBUG_BEACON,
2947                     "%s: cabq did not drain, mcastq %u cabq %u\n",
2948                     __func__, nmcastq, cabq->axq_depth);
2949                 sc->sc_stats.ast_cabq_busy++;
2950                 if (sc->sc_nvaps > 1 && sc->sc_stagbeacons) {
2951                         /*
2952                          * CABQ traffic from a previous vap is still pending.
2953                          * We must drain the q before this beacon frame goes
2954                          * out as otherwise this vap's stations will get cab
2955                          * frames from a different vap.
2956                          * XXX could be slow causing us to miss DBA
2957                          */
2958                         ath_tx_draintxq(sc, cabq);
2959                 }
2960         }
2961         ath_beacon_setup(sc, bf);
2962         bus_dmamap_sync(sc->sc_dmat, bf->bf_dmamap, BUS_DMASYNC_PREWRITE);
2963
2964         /*
2965          * Enable the CAB queue before the beacon queue to
2966          * insure cab frames are triggered by this beacon.
2967          */
2968         if (avp->av_boff.bo_tim[4] & 1) {
2969                 struct ath_hal *ah = sc->sc_ah;
2970
2971                 /* NB: only at DTIM */
2972                 if (nmcastq) {
2973                         struct ath_buf *bfm;
2974                         int qbusy;
2975
2976                         /*
2977                          * Move frames from the s/w mcast q to the h/w cab q.
2978                          * XXX MORE_DATA bit
2979                          */
2980                         bfm = STAILQ_FIRST(&avp->av_mcastq.axq_q);
2981                         qbusy = ath_hal_txqenabled(ah, cabq->axq_qnum);
2982                         if (qbusy == 0) {
2983                                 if (cabq->axq_link != NULL) {
2984                                         cpu_sfence();
2985                                         *cabq->axq_link = bfm->bf_daddr;
2986                                         cabq->axq_flags |= ATH_TXQ_PUTPENDING;
2987                                 } else {
2988                                         cpu_sfence();
2989                                         ath_hal_puttxbuf(ah, cabq->axq_qnum,
2990                                                 bfm->bf_daddr);
2991                                 }
2992                         } else {
2993                                 if (cabq->axq_link != NULL) {
2994                                         cpu_sfence();
2995                                         *cabq->axq_link = bfm->bf_daddr;
2996                                 }
2997                                 cabq->axq_flags |= ATH_TXQ_PUTPENDING;
2998                         }
2999                         ath_txqmove(cabq, &avp->av_mcastq);
3000
3001                         sc->sc_stats.ast_cabq_xmit += nmcastq;
3002                 }
3003                 /* NB: gated by beacon so safe to start here */
3004                 ath_hal_txstart(ah, cabq->axq_qnum);
3005         }
3006         return bf;
3007 }
3008
3009 static void
3010 ath_beacon_start_adhoc(struct ath_softc *sc, struct ieee80211vap *vap)
3011 {
3012         struct ath_vap *avp = ATH_VAP(vap);
3013         struct ath_hal *ah = sc->sc_ah;
3014         struct ath_buf *bf;
3015         struct mbuf *m;
3016         int error;
3017
3018         KASSERT(avp->av_bcbuf != NULL, ("no beacon buffer"));
3019
3020         /*
3021          * Update dynamic beacon contents.  If this returns
3022          * non-zero then we need to remap the memory because
3023          * the beacon frame changed size (probably because
3024          * of the TIM bitmap).
3025          */
3026         bf = avp->av_bcbuf;
3027         m = bf->bf_m;
3028         if (ieee80211_beacon_update(bf->bf_node, &avp->av_boff, m, 0)) {
3029                 /* XXX too conservative? */
3030                 bus_dmamap_unload(sc->sc_dmat, bf->bf_dmamap);
3031                 error = bus_dmamap_load_mbuf_segment(sc->sc_dmat, bf->bf_dmamap, m,
3032                                              bf->bf_segs, 1, &bf->bf_nseg,
3033                                              BUS_DMA_NOWAIT);
3034                 if (error != 0) {
3035                         if_printf(vap->iv_ifp,
3036                             "%s: bus_dmamap_load_mbuf_segment failed, error %u\n",
3037                             __func__, error);
3038                         return;
3039                 }
3040         }
3041         ath_beacon_setup(sc, bf);
3042         bus_dmamap_sync(sc->sc_dmat, bf->bf_dmamap, BUS_DMASYNC_PREWRITE);
3043
3044         /* NB: caller is known to have already stopped tx dma */
3045         ath_hal_puttxbuf(ah, sc->sc_bhalq, bf->bf_daddr);
3046         ath_hal_txstart(ah, sc->sc_bhalq);
3047 }
3048
3049 /*
3050  * Reset the hardware after detecting beacons have stopped.
3051  */
3052 static void
3053 ath_bstuck_task(void *arg, int pending)
3054 {
3055         struct ath_softc *sc = arg;
3056         struct ifnet *ifp = sc->sc_ifp;
3057
3058         wlan_serialize_enter();
3059         if_printf(ifp, "stuck beacon; resetting (bmiss count %u)\n",
3060                   sc->sc_bmisscount);
3061         sc->sc_stats.ast_bstuck++;
3062         ath_reset(ifp);
3063         wlan_serialize_exit();
3064 }
3065
3066 /*
3067  * Reclaim beacon resources and return buffer to the pool.
3068  */
3069 static void
3070 ath_beacon_return(struct ath_softc *sc, struct ath_buf *bf)
3071 {
3072
3073         if (bf->bf_m != NULL) {
3074                 bus_dmamap_unload(sc->sc_dmat, bf->bf_dmamap);
3075                 m_freem(bf->bf_m);
3076                 bf->bf_m = NULL;
3077         }
3078         if (bf->bf_node != NULL) {
3079                 ieee80211_free_node(bf->bf_node);
3080                 bf->bf_node = NULL;
3081         }
3082         STAILQ_INSERT_TAIL(&sc->sc_bbuf, bf, bf_list);
3083 }
3084
3085 /*
3086  * Reclaim beacon resources.
3087  */
3088 static void
3089 ath_beacon_free(struct ath_softc *sc)
3090 {
3091         struct ath_buf *bf;
3092
3093         STAILQ_FOREACH(bf, &sc->sc_bbuf, bf_list) {
3094                 if (bf->bf_m != NULL) {
3095                         bus_dmamap_unload(sc->sc_dmat, bf->bf_dmamap);
3096                         m_freem(bf->bf_m);
3097                         bf->bf_m = NULL;
3098                 }
3099                 if (bf->bf_node != NULL) {
3100                         ieee80211_free_node(bf->bf_node);
3101                         bf->bf_node = NULL;
3102                 }
3103         }
3104 }
3105
3106 /*
3107  * Configure the beacon and sleep timers.
3108  *
3109  * When operating as an AP this resets the TSF and sets
3110  * up the hardware to notify us when we need to issue beacons.
3111  *
3112  * When operating in station mode this sets up the beacon
3113  * timers according to the timestamp of the last received
3114  * beacon and the current TSF, configures PCF and DTIM
3115  * handling, programs the sleep registers so the hardware
3116  * will wakeup in time to receive beacons, and configures
3117  * the beacon miss handling so we'll receive a BMISS
3118  * interrupt when we stop seeing beacons from the AP
3119  * we've associated with.
3120  */
3121 static void
3122 ath_beacon_config(struct ath_softc *sc, struct ieee80211vap *vap)
3123 {
3124 #define TSF_TO_TU(_h,_l) \
3125         ((((u_int32_t)(_h)) << 22) | (((u_int32_t)(_l)) >> 10))
3126 #define FUDGE   2
3127         struct ath_hal *ah = sc->sc_ah;
3128         struct ieee80211com *ic = sc->sc_ifp->if_l2com;
3129         struct ieee80211_node *ni;
3130         u_int32_t nexttbtt, intval, tsftu;
3131         u_int64_t tsf;
3132
3133         if (vap == NULL)
3134                 vap = TAILQ_FIRST(&ic->ic_vaps);        /* XXX */
3135         ni = vap->iv_bss;
3136
3137         /* extract tstamp from last beacon and convert to TU */
3138         nexttbtt = TSF_TO_TU(LE_READ_4(ni->ni_tstamp.data + 4),
3139                              LE_READ_4(ni->ni_tstamp.data));
3140         if (ic->ic_opmode == IEEE80211_M_HOSTAP ||
3141             ic->ic_opmode == IEEE80211_M_MBSS) {
3142                 /*
3143                  * For multi-bss ap/mesh support beacons are either staggered
3144                  * evenly over N slots or burst together.  For the former
3145                  * arrange for the SWBA to be delivered for each slot.
3146                  * Slots that are not occupied will generate nothing.
3147                  */
3148                 /* NB: the beacon interval is kept internally in TU's */
3149                 intval = ni->ni_intval & HAL_BEACON_PERIOD;
3150                 if (sc->sc_stagbeacons)
3151                         intval /= ATH_BCBUF;
3152         } else {
3153                 /* NB: the beacon interval is kept internally in TU's */
3154                 intval = ni->ni_intval & HAL_BEACON_PERIOD;
3155         }
3156         if (nexttbtt == 0)              /* e.g. for ap mode */
3157                 nexttbtt = intval;
3158         else if (intval)                /* NB: can be 0 for monitor mode */
3159                 nexttbtt = roundup(nexttbtt, intval);
3160         DPRINTF(sc, ATH_DEBUG_BEACON, "%s: nexttbtt %u intval %u (%u)\n",
3161                 __func__, nexttbtt, intval, ni->ni_intval);
3162         if (ic->ic_opmode == IEEE80211_M_STA && !sc->sc_swbmiss) {
3163                 HAL_BEACON_STATE bs;
3164                 int dtimperiod, dtimcount;
3165                 int cfpperiod, cfpcount;
3166
3167                 /*
3168                  * Setup dtim and cfp parameters according to
3169                  * last beacon we received (which may be none).
3170                  */
3171                 dtimperiod = ni->ni_dtim_period;
3172                 if (dtimperiod <= 0)            /* NB: 0 if not known */
3173                         dtimperiod = 1;
3174                 dtimcount = ni->ni_dtim_count;
3175                 if (dtimcount >= dtimperiod)    /* NB: sanity check */
3176                         dtimcount = 0;          /* XXX? */
3177                 cfpperiod = 1;                  /* NB: no PCF support yet */
3178                 cfpcount = 0;
3179                 /*
3180                  * Pull nexttbtt forward to reflect the current
3181                  * TSF and calculate dtim+cfp state for the result.
3182                  */
3183                 tsf = ath_hal_gettsf64(ah);
3184                 tsftu = TSF_TO_TU(tsf>>32, tsf) + FUDGE;
3185                 do {
3186                         nexttbtt += intval;
3187                         if (--dtimcount < 0) {
3188                                 dtimcount = dtimperiod - 1;
3189                                 if (--cfpcount < 0)
3190                                         cfpcount = cfpperiod - 1;
3191                         }
3192                 } while (nexttbtt < tsftu);
3193                 memset(&bs, 0, sizeof(bs));
3194                 bs.bs_intval = intval;
3195                 bs.bs_nexttbtt = nexttbtt;
3196                 bs.bs_dtimperiod = dtimperiod*intval;
3197                 bs.bs_nextdtim = bs.bs_nexttbtt + dtimcount*intval;
3198                 bs.bs_cfpperiod = cfpperiod*bs.bs_dtimperiod;
3199                 bs.bs_cfpnext = bs.bs_nextdtim + cfpcount*bs.bs_dtimperiod;
3200                 bs.bs_cfpmaxduration = 0;
3201 #if 0
3202                 /*
3203                  * The 802.11 layer records the offset to the DTIM
3204                  * bitmap while receiving beacons; use it here to
3205                  * enable h/w detection of our AID being marked in
3206                  * the bitmap vector (to indicate frames for us are
3207                  * pending at the AP).
3208                  * XXX do DTIM handling in s/w to WAR old h/w bugs
3209                  * XXX enable based on h/w rev for newer chips
3210                  */
3211                 bs.bs_timoffset = ni->ni_timoff;
3212 #endif
3213                 /*
3214                  * Calculate the number of consecutive beacons to miss
3215                  * before taking a BMISS interrupt.
3216                  * Note that we clamp the result to at most 10 beacons.
3217                  */
3218                 bs.bs_bmissthreshold = vap->iv_bmissthreshold;
3219                 if (bs.bs_bmissthreshold > 10)
3220                         bs.bs_bmissthreshold = 10;
3221                 else if (bs.bs_bmissthreshold <= 0)
3222                         bs.bs_bmissthreshold = 1;
3223
3224                 /*
3225                  * Calculate sleep duration.  The configuration is
3226                  * given in ms.  We insure a multiple of the beacon
3227                  * period is used.  Also, if the sleep duration is
3228                  * greater than the DTIM period then it makes senses
3229                  * to make it a multiple of that.
3230                  *
3231                  * XXX fixed at 100ms
3232                  */
3233                 bs.bs_sleepduration =
3234                         roundup(IEEE80211_MS_TO_TU(100), bs.bs_intval);
3235                 if (bs.bs_sleepduration > bs.bs_dtimperiod)
3236                         bs.bs_sleepduration = roundup(bs.bs_sleepduration, bs.bs_dtimperiod);
3237
3238                 DPRINTF(sc, ATH_DEBUG_BEACON,
3239                         "%s: tsf %ju tsf:tu %u intval %u nexttbtt %u dtim %u nextdtim %u bmiss %u sleep %u cfp:period %u maxdur %u next %u timoffset %u\n"
3240                         , __func__
3241                         , tsf, tsftu
3242                         , bs.bs_intval
3243                         , bs.bs_nexttbtt
3244                         , bs.bs_dtimperiod
3245                         , bs.bs_nextdtim
3246                         , bs.bs_bmissthreshold
3247                         , bs.bs_sleepduration
3248                         , bs.bs_cfpperiod
3249                         , bs.bs_cfpmaxduration
3250                         , bs.bs_cfpnext
3251                         , bs.bs_timoffset
3252                 );
3253                 ath_hal_intrset(ah, 0);
3254                 ath_hal_beacontimers(ah, &bs);
3255                 sc->sc_imask |= HAL_INT_BMISS;
3256                 ath_hal_intrset(ah, sc->sc_imask);
3257         } else {
3258                 ath_hal_intrset(ah, 0);
3259                 if (nexttbtt == intval)
3260                         intval |= HAL_BEACON_RESET_TSF;
3261                 if (ic->ic_opmode == IEEE80211_M_IBSS) {
3262                         /*
3263                          * In IBSS mode enable the beacon timers but only
3264                          * enable SWBA interrupts if we need to manually
3265                          * prepare beacon frames.  Otherwise we use a
3266                          * self-linked tx descriptor and let the hardware
3267                          * deal with things.
3268                          */
3269                         intval |= HAL_BEACON_ENA;
3270                         if (!sc->sc_hasveol)
3271                                 sc->sc_imask |= HAL_INT_SWBA;
3272                         if ((intval & HAL_BEACON_RESET_TSF) == 0) {
3273                                 /*
3274                                  * Pull nexttbtt forward to reflect
3275                                  * the current TSF.
3276                                  */
3277                                 tsf = ath_hal_gettsf64(ah);
3278                                 tsftu = TSF_TO_TU(tsf>>32, tsf) + FUDGE;
3279                                 do {
3280                                         nexttbtt += intval;
3281                                 } while (nexttbtt < tsftu);
3282                         }
3283                         ath_beaconq_config(sc);
3284                 } else if (ic->ic_opmode == IEEE80211_M_HOSTAP ||
3285                     ic->ic_opmode == IEEE80211_M_MBSS) {
3286                         /*
3287                          * In AP/mesh mode we enable the beacon timers
3288                          * and SWBA interrupts to prepare beacon frames.
3289                          */
3290                         intval |= HAL_BEACON_ENA;
3291                         sc->sc_imask |= HAL_INT_SWBA;   /* beacon prepare */
3292                         ath_beaconq_config(sc);
3293                 }
3294                 ath_hal_beaconinit(ah, nexttbtt, intval);
3295                 sc->sc_bmisscount = 0;
3296                 ath_hal_intrset(ah, sc->sc_imask);
3297                 /*
3298                  * When using a self-linked beacon descriptor in
3299                  * ibss mode load it once here.
3300                  */
3301                 if (ic->ic_opmode == IEEE80211_M_IBSS && sc->sc_hasveol)
3302                         ath_beacon_start_adhoc(sc, vap);
3303         }
3304         sc->sc_syncbeacon = 0;
3305 #undef FUDGE
3306 #undef TSF_TO_TU
3307 }
3308
3309 static void
3310 ath_load_cb(void *arg, bus_dma_segment_t *segs, int nsegs, int error)
3311 {
3312         bus_addr_t *paddr = (bus_addr_t*) arg;
3313         KASSERT(error == 0, ("error %u on bus_dma callback", error));
3314         *paddr = segs->ds_addr;
3315 }
3316
3317 static int
3318 ath_descdma_setup(struct ath_softc *sc,
3319         struct ath_descdma *dd, ath_bufhead *head,
3320         const char *name, int nbuf, int ndesc)
3321 {
3322 #define DS2PHYS(_dd, _ds) \
3323         ((_dd)->dd_desc_paddr + ((caddr_t)(_ds) - (caddr_t)(_dd)->dd_desc))
3324         struct ifnet *ifp = sc->sc_ifp;
3325         struct ath_desc *ds;
3326         struct ath_buf *bf;
3327         int i, bsize, error;
3328
3329         DPRINTF(sc, ATH_DEBUG_RESET, "%s: %s DMA: %u buffers %u desc/buf\n",
3330             __func__, name, nbuf, ndesc);
3331
3332         dd->dd_name = name;
3333         dd->dd_desc_len = sizeof(struct ath_desc) * nbuf * ndesc;
3334
3335         /*
3336          * Setup DMA descriptor area.
3337          */
3338         error = bus_dma_tag_create(dd->dd_dmat, /* parent */
3339                        PAGE_SIZE, 0,            /* alignment, bounds */
3340                        BUS_SPACE_MAXADDR_32BIT, /* lowaddr */
3341                        BUS_SPACE_MAXADDR,       /* highaddr */
3342                        NULL, NULL,              /* filter, filterarg */
3343                        dd->dd_desc_len,         /* maxsize */
3344                        1,                       /* nsegments */
3345                        dd->dd_desc_len,         /* maxsegsize */
3346                        BUS_DMA_ALLOCNOW,        /* flags */
3347                        &dd->dd_dmat);
3348         if (error != 0) {
3349                 if_printf(ifp, "cannot allocate %s DMA tag\n", dd->dd_name);
3350                 return error;
3351         }
3352
3353         /* allocate descriptors */
3354         error = bus_dmamap_create(dd->dd_dmat, BUS_DMA_NOWAIT, &dd->dd_dmamap);
3355         if (error != 0) {
3356                 if_printf(ifp, "unable to create dmamap for %s descriptors, "
3357                         "error %u\n", dd->dd_name, error);
3358                 goto fail0;
3359         }
3360
3361         error = bus_dmamem_alloc(dd->dd_dmat, (void**) &dd->dd_desc,
3362                                  BUS_DMA_NOWAIT | BUS_DMA_COHERENT, 
3363                                  &dd->dd_dmamap);
3364         if (error != 0) {
3365                 if_printf(ifp, "unable to alloc memory for %u %s descriptors, "
3366                         "error %u\n", nbuf * ndesc, dd->dd_name, error);
3367                 goto fail1;
3368         }
3369
3370         error = bus_dmamap_load(dd->dd_dmat, dd->dd_dmamap,
3371                                 dd->dd_desc, dd->dd_desc_len,
3372                                 ath_load_cb, &dd->dd_desc_paddr,
3373                                 BUS_DMA_NOWAIT);
3374         if (error != 0) {
3375                 if_printf(ifp, "unable to map %s descriptors, error %u\n",
3376                         dd->dd_name, error);
3377                 goto fail2;
3378         }
3379
3380         ds = dd->dd_desc;
3381         DPRINTF(sc, ATH_DEBUG_RESET, "%s: %s DMA map: %p (%lu) -> %p (%lu)\n",
3382             __func__, dd->dd_name, ds, (u_long) dd->dd_desc_len,
3383             (caddr_t) dd->dd_desc_paddr, /*XXX*/ (u_long) dd->dd_desc_len);
3384
3385         /* allocate rx buffers */
3386         bsize = sizeof(struct ath_buf) * nbuf;
3387         bf = kmalloc(bsize, M_ATHDEV, M_INTWAIT | M_ZERO);
3388         dd->dd_bufptr = bf;
3389
3390         STAILQ_INIT(head);
3391         for (i = 0; i < nbuf; i++, bf++, ds += ndesc) {
3392                 bf->bf_desc = ds;
3393                 bf->bf_daddr = DS2PHYS(dd, ds);
3394                 error = bus_dmamap_create(sc->sc_dmat, BUS_DMA_NOWAIT,
3395                                 &bf->bf_dmamap);
3396                 if (error != 0) {
3397                         if_printf(ifp, "unable to create dmamap for %s "
3398                                 "buffer %u, error %u\n", dd->dd_name, i, error);
3399                         ath_descdma_cleanup(sc, dd, head);
3400                         return error;
3401                 }
3402                 STAILQ_INSERT_TAIL(head, bf, bf_list);
3403         }
3404         return 0;
3405 fail2:
3406         bus_dmamem_free(dd->dd_dmat, dd->dd_desc, dd->dd_dmamap);
3407 fail1:
3408         bus_dmamap_destroy(dd->dd_dmat, dd->dd_dmamap);
3409 fail0:
3410         bus_dma_tag_destroy(dd->dd_dmat);
3411         memset(dd, 0, sizeof(*dd));
3412         return error;
3413 #undef DS2PHYS
3414 }
3415
3416 static void
3417 ath_descdma_cleanup(struct ath_softc *sc,
3418         struct ath_descdma *dd, ath_bufhead *head)
3419 {
3420         struct ath_buf *bf;
3421         struct ieee80211_node *ni;
3422
3423         bus_dmamap_unload(dd->dd_dmat, dd->dd_dmamap);
3424         bus_dmamem_free(dd->dd_dmat, dd->dd_desc, dd->dd_dmamap);
3425         bus_dmamap_destroy(dd->dd_dmat, dd->dd_dmamap);
3426         bus_dma_tag_destroy(dd->dd_dmat);
3427
3428         STAILQ_FOREACH(bf, head, bf_list) {
3429                 if (bf->bf_m) {
3430                         m_freem(bf->bf_m);
3431                         bf->bf_m = NULL;
3432                 }
3433                 if (bf->bf_dmamap != NULL) {
3434                         bus_dmamap_destroy(sc->sc_dmat, bf->bf_dmamap);
3435                         bf->bf_dmamap = NULL;
3436                 }
3437                 ni = bf->bf_node;
3438                 bf->bf_node = NULL;
3439                 if (ni != NULL) {
3440                         /*
3441                          * Reclaim node reference.
3442                          */
3443                         ieee80211_free_node(ni);
3444                 }
3445         }
3446
3447         STAILQ_INIT(head);
3448         kfree(dd->dd_bufptr, M_ATHDEV);
3449         memset(dd, 0, sizeof(*dd));
3450 }
3451
3452 static int
3453 ath_desc_alloc(struct ath_softc *sc)
3454 {
3455         int error;
3456
3457         error = ath_descdma_setup(sc, &sc->sc_rxdma, &sc->sc_rxbuf,
3458                         "rx", ath_rxbuf, 1);
3459         if (error != 0)
3460                 return error;
3461
3462         error = ath_descdma_setup(sc, &sc->sc_txdma, &sc->sc_txbuf,
3463                         "tx", ath_txbuf, ATH_TXDESC);
3464         if (error != 0) {
3465                 ath_descdma_cleanup(sc, &sc->sc_rxdma, &sc->sc_rxbuf);
3466                 return error;
3467         }
3468
3469         error = ath_descdma_setup(sc, &sc->sc_bdma, &sc->sc_bbuf,
3470                         "beacon", ATH_BCBUF, 1);
3471         if (error != 0) {
3472                 ath_descdma_cleanup(sc, &sc->sc_txdma, &sc->sc_txbuf);
3473                 ath_descdma_cleanup(sc, &sc->sc_rxdma, &sc->sc_rxbuf);
3474                 return error;
3475         }
3476         return 0;
3477 }
3478
3479 static void
3480 ath_desc_free(struct ath_softc *sc)
3481 {
3482
3483         if (sc->sc_bdma.dd_desc_len != 0)
3484                 ath_descdma_cleanup(sc, &sc->sc_bdma, &sc->sc_bbuf);
3485         if (sc->sc_txdma.dd_desc_len != 0)
3486                 ath_descdma_cleanup(sc, &sc->sc_txdma, &sc->sc_txbuf);
3487         if (sc->sc_rxdma.dd_desc_len != 0)
3488                 ath_descdma_cleanup(sc, &sc->sc_rxdma, &sc->sc_rxbuf);
3489 }
3490
3491 static struct ieee80211_node *
3492 ath_node_alloc(struct ieee80211vap *vap, const uint8_t mac[IEEE80211_ADDR_LEN])
3493 {
3494         struct ieee80211com *ic = vap->iv_ic;
3495         struct ath_softc *sc = ic->ic_ifp->if_softc;
3496         const size_t space = sizeof(struct ath_node) + sc->sc_rc->arc_space;
3497         struct ath_node *an;
3498
3499         an = kmalloc(space, M_80211_NODE, M_INTWAIT|M_ZERO);
3500         ath_rate_node_init(sc, an);
3501
3502         DPRINTF(sc, ATH_DEBUG_NODE, "%s: an %p\n", __func__, an);
3503         return &an->an_node;
3504 }
3505
3506 static void
3507 ath_node_free(struct ieee80211_node *ni)
3508 {
3509         struct ieee80211com *ic = ni->ni_ic;
3510         struct ath_softc *sc = ic->ic_ifp->if_softc;
3511
3512         DPRINTF(sc, ATH_DEBUG_NODE, "%s: ni %p\n", __func__, ni);
3513
3514         ath_rate_node_cleanup(sc, ATH_NODE(ni));
3515         sc->sc_node_free(ni);
3516 }
3517
3518 static void
3519 ath_node_getsignal(const struct ieee80211_node *ni, int8_t *rssi, int8_t *noise)
3520 {
3521         struct ieee80211com *ic = ni->ni_ic;
3522         struct ath_softc *sc = ic->ic_ifp->if_softc;
3523         struct ath_hal *ah = sc->sc_ah;
3524
3525         *rssi = ic->ic_node_getrssi(ni);
3526         if (ni->ni_chan != IEEE80211_CHAN_ANYC)
3527                 *noise = ath_hal_getchannoise(ah, ni->ni_chan);
3528         else
3529                 *noise = -95;           /* nominally correct */
3530 }
3531
3532 static int
3533 ath_rxbuf_init(struct ath_softc *sc, struct ath_buf *bf)
3534 {
3535         struct ath_hal *ah = sc->sc_ah;
3536         int error;
3537         struct mbuf *m;
3538         struct ath_desc *ds;
3539
3540         m = bf->bf_m;
3541         if (m == NULL) {
3542                 /*
3543                  * NB: by assigning a page to the rx dma buffer we
3544                  * implicitly satisfy the Atheros requirement that
3545                  * this buffer be cache-line-aligned and sized to be
3546                  * multiple of the cache line size.  Not doing this
3547                  * causes weird stuff to happen (for the 5210 at least).
3548                  */
3549                 m = m_getcl(MB_WAIT, MT_DATA, M_PKTHDR);
3550                 if (m == NULL) {
3551                         kprintf("ath_rxbuf_init: no mbuf\n");
3552                         DPRINTF(sc, ATH_DEBUG_ANY,
3553                                 "%s: no mbuf/cluster\n", __func__);
3554                         sc->sc_stats.ast_rx_nombuf++;
3555                         return ENOMEM;
3556                 }
3557                 m->m_pkthdr.len = m->m_len = m->m_ext.ext_size;
3558
3559                 error = bus_dmamap_load_mbuf_segment(sc->sc_dmat,
3560                                              bf->bf_dmamap, m,
3561                                              bf->bf_segs, 1, &bf->bf_nseg,
3562                                              BUS_DMA_NOWAIT);
3563                 if (error != 0) {
3564                         DPRINTF(sc, ATH_DEBUG_ANY,
3565                             "%s: bus_dmamap_load_mbuf_segment failed; error %d\n",
3566                             __func__, error);
3567                         sc->sc_stats.ast_rx_busdma++;
3568                         m_freem(m);
3569                         return error;
3570                 }
3571                 KASSERT(bf->bf_nseg == 1,
3572                         ("multi-segment packet; nseg %u", bf->bf_nseg));
3573                 bf->bf_m = m;
3574         }
3575         bus_dmamap_sync(sc->sc_dmat, bf->bf_dmamap, BUS_DMASYNC_PREREAD);
3576
3577         /*
3578          * Setup descriptors.  For receive we always terminate
3579          * the descriptor list with a self-linked entry so we'll
3580          * not get overrun under high load (as can happen with a
3581          * 5212 when ANI processing enables PHY error frames).
3582          *
3583          * To insure the last descriptor is self-linked we create
3584          * each descriptor as self-linked and add it to the end.  As
3585          * each additional descriptor is added the previous self-linked
3586          * entry is ``fixed'' naturally.  This should be safe even
3587          * if DMA is happening.  When processing RX interrupts we
3588          * never remove/process the last, self-linked, entry on the
3589          * descriptor list.  This insures the hardware always has
3590          * someplace to write a new frame.
3591          */
3592         ds = bf->bf_desc;
3593         ds->ds_link = bf->bf_daddr;     /* link to self */
3594         ds->ds_data = bf->bf_segs[0].ds_addr;
3595         ath_hal_setuprxdesc(ah, ds
3596                 , m->m_len              /* buffer size */
3597                 , 0
3598         );
3599
3600         if (sc->sc_rxlink != NULL)
3601                 *sc->sc_rxlink = bf->bf_daddr;
3602         sc->sc_rxlink = &ds->ds_link;
3603         return 0;
3604 }
3605
3606 /*
3607  * Extend 15-bit time stamp from rx descriptor to
3608  * a full 64-bit TSF using the specified TSF.
3609  */
3610 static __inline u_int64_t
3611 ath_extend_tsf(u_int32_t rstamp, u_int64_t tsf)
3612 {
3613         if ((tsf & 0x7fff) < rstamp)
3614                 tsf -= 0x8000;
3615         return ((tsf &~ 0x7fff) | rstamp);
3616 }
3617
3618 /*
3619  * Intercept management frames to collect beacon rssi data
3620  * and to do ibss merges.
3621  */
3622 static void
3623 ath_recv_mgmt(struct ieee80211_node *ni, struct mbuf *m,
3624         int subtype, int rssi, int nf)
3625 {
3626         struct ieee80211vap *vap = ni->ni_vap;
3627         struct ath_softc *sc = vap->iv_ic->ic_ifp->if_softc;
3628
3629         /*
3630          * Call up first so subsequent work can use information
3631          * potentially stored in the node (e.g. for ibss merge).
3632          */
3633         ATH_VAP(vap)->av_recv_mgmt(ni, m, subtype, rssi, nf);
3634         switch (subtype) {
3635         case IEEE80211_FC0_SUBTYPE_BEACON:
3636                 /* update rssi statistics for use by the hal */
3637                 ATH_RSSI_LPF(sc->sc_halstats.ns_avgbrssi, rssi);
3638                 if (sc->sc_syncbeacon &&
3639                     ni == vap->iv_bss && vap->iv_state == IEEE80211_S_RUN) {
3640                         /*
3641                          * Resync beacon timers using the tsf of the beacon
3642                          * frame we just received.
3643                          */
3644                         ath_beacon_config(sc, vap);
3645                 }