Merge git://git.kernel.org/pub/scm/linux/kernel/git/hskinnemoen/avr32-2.6
[linux-2.6] / drivers / net / wireless / ath9k / core.c
1 /*
2  * Copyright (c) 2008, Atheros Communications Inc.
3  *
4  * Permission to use, copy, modify, and/or distribute this software for any
5  * purpose with or without fee is hereby granted, provided that the above
6  * copyright notice and this permission notice appear in all copies.
7  *
8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15  */
16
17  /* Implementation of the main "ATH" layer. */
18
19 #include "core.h"
20 #include "regd.h"
21
22 static int ath_outdoor;         /* enable outdoor use */
23
24 static const u8 ath_bcast_mac[ETH_ALEN] =
25     { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
26
27 static u32 ath_chainmask_sel_up_rssi_thres =
28         ATH_CHAINMASK_SEL_UP_RSSI_THRES;
29 static u32 ath_chainmask_sel_down_rssi_thres =
30         ATH_CHAINMASK_SEL_DOWN_RSSI_THRES;
31 static u32 ath_chainmask_sel_period =
32         ATH_CHAINMASK_SEL_TIMEOUT;
33
34 /* return bus cachesize in 4B word units */
35
36 static void bus_read_cachesize(struct ath_softc *sc, int *csz)
37 {
38         u8 u8tmp;
39
40         pci_read_config_byte(sc->pdev, PCI_CACHE_LINE_SIZE, (u8 *)&u8tmp);
41         *csz = (int)u8tmp;
42
43         /*
44          * This check was put in to avoid "unplesant" consequences if
45          * the bootrom has not fully initialized all PCI devices.
46          * Sometimes the cache line size register is not set
47          */
48
49         if (*csz == 0)
50                 *csz = DEFAULT_CACHELINE >> 2;   /* Use the default size */
51 }
52
53 /*
54  *  Set current operating mode
55  *
56  *  This function initializes and fills the rate table in the ATH object based
57  *  on the operating mode.  The blink rates are also set up here, although
58  *  they have been superceeded by the ath_led module.
59 */
60
61 static void ath_setcurmode(struct ath_softc *sc, enum wireless_mode mode)
62 {
63         const struct ath9k_rate_table *rt;
64         int i;
65
66         memset(sc->sc_rixmap, 0xff, sizeof(sc->sc_rixmap));
67         rt = ath9k_hw_getratetable(sc->sc_ah, mode);
68         BUG_ON(!rt);
69
70         for (i = 0; i < rt->rateCount; i++)
71                 sc->sc_rixmap[rt->info[i].rateCode] = (u8) i;
72
73         memzero(sc->sc_hwmap, sizeof(sc->sc_hwmap));
74         for (i = 0; i < 256; i++) {
75                 u8 ix = rt->rateCodeToIndex[i];
76
77                 if (ix == 0xff)
78                         continue;
79
80                 sc->sc_hwmap[i].ieeerate =
81                     rt->info[ix].dot11Rate & IEEE80211_RATE_VAL;
82                 sc->sc_hwmap[i].rateKbps = rt->info[ix].rateKbps;
83
84                 if (rt->info[ix].shortPreamble ||
85                     rt->info[ix].phy == PHY_OFDM) {
86                         /* XXX: Handle this */
87                 }
88
89                 /* NB: this uses the last entry if the rate isn't found */
90                 /* XXX beware of overlow */
91         }
92         sc->sc_currates = rt;
93         sc->sc_curmode = mode;
94         /*
95          * All protection frames are transmited at 2Mb/s for
96          * 11g, otherwise at 1Mb/s.
97          * XXX select protection rate index from rate table.
98          */
99         sc->sc_protrix = (mode == ATH9K_MODE_11G ? 1 : 0);
100 }
101
102 /*
103  * Set up rate table (legacy rates)
104  */
105 static void ath_setup_rates(struct ath_softc *sc, enum ieee80211_band band)
106 {
107         struct ath_hal *ah = sc->sc_ah;
108         const struct ath9k_rate_table *rt = NULL;
109         struct ieee80211_supported_band *sband;
110         struct ieee80211_rate *rate;
111         int i, maxrates;
112
113         switch (band) {
114         case IEEE80211_BAND_2GHZ:
115                 rt = ath9k_hw_getratetable(ah, ATH9K_MODE_11G);
116                 break;
117         case IEEE80211_BAND_5GHZ:
118                 rt = ath9k_hw_getratetable(ah, ATH9K_MODE_11A);
119                 break;
120         default:
121                 break;
122         }
123
124         if (rt == NULL)
125                 return;
126
127         sband = &sc->sbands[band];
128         rate = sc->rates[band];
129
130         if (rt->rateCount > ATH_RATE_MAX)
131                 maxrates = ATH_RATE_MAX;
132         else
133                 maxrates = rt->rateCount;
134
135         for (i = 0; i < maxrates; i++) {
136                 rate[i].bitrate = rt->info[i].rateKbps / 100;
137                 rate[i].hw_value = rt->info[i].rateCode;
138                 sband->n_bitrates++;
139                 DPRINTF(sc, ATH_DBG_CONFIG,
140                         "%s: Rate: %2dMbps, ratecode: %2d\n",
141                         __func__,
142                         rate[i].bitrate / 10,
143                         rate[i].hw_value);
144         }
145 }
146
147 /*
148  *  Set up channel list
149  */
150 static int ath_setup_channels(struct ath_softc *sc)
151 {
152         struct ath_hal *ah = sc->sc_ah;
153         int nchan, i, a = 0, b = 0;
154         u8 regclassids[ATH_REGCLASSIDS_MAX];
155         u32 nregclass = 0;
156         struct ieee80211_supported_band *band_2ghz;
157         struct ieee80211_supported_band *band_5ghz;
158         struct ieee80211_channel *chan_2ghz;
159         struct ieee80211_channel *chan_5ghz;
160         struct ath9k_channel *c;
161
162         /* Fill in ah->ah_channels */
163         if (!ath9k_regd_init_channels(ah,
164                                       ATH_CHAN_MAX,
165                                       (u32 *)&nchan,
166                                       regclassids,
167                                       ATH_REGCLASSIDS_MAX,
168                                       &nregclass,
169                                       CTRY_DEFAULT,
170                                       false,
171                                       1)) {
172                 u32 rd = ah->ah_currentRD;
173
174                 DPRINTF(sc, ATH_DBG_FATAL,
175                         "%s: unable to collect channel list; "
176                         "regdomain likely %u country code %u\n",
177                         __func__, rd, CTRY_DEFAULT);
178                 return -EINVAL;
179         }
180
181         band_2ghz = &sc->sbands[IEEE80211_BAND_2GHZ];
182         band_5ghz = &sc->sbands[IEEE80211_BAND_5GHZ];
183         chan_2ghz = sc->channels[IEEE80211_BAND_2GHZ];
184         chan_5ghz = sc->channels[IEEE80211_BAND_5GHZ];
185
186         for (i = 0; i < nchan; i++) {
187                 c = &ah->ah_channels[i];
188                 if (IS_CHAN_2GHZ(c)) {
189                         chan_2ghz[a].band = IEEE80211_BAND_2GHZ;
190                         chan_2ghz[a].center_freq = c->channel;
191                         chan_2ghz[a].max_power = c->maxTxPower;
192
193                         if (c->privFlags & CHANNEL_DISALLOW_ADHOC)
194                                 chan_2ghz[a].flags |=
195                                         IEEE80211_CHAN_NO_IBSS;
196                         if (c->channelFlags & CHANNEL_PASSIVE)
197                                 chan_2ghz[a].flags |=
198                                         IEEE80211_CHAN_PASSIVE_SCAN;
199
200                         band_2ghz->n_channels = ++a;
201
202                         DPRINTF(sc, ATH_DBG_CONFIG,
203                                 "%s: 2MHz channel: %d, "
204                                 "channelFlags: 0x%x\n",
205                                 __func__,
206                                 c->channel,
207                                 c->channelFlags);
208                 } else if (IS_CHAN_5GHZ(c)) {
209                         chan_5ghz[b].band = IEEE80211_BAND_5GHZ;
210                         chan_5ghz[b].center_freq = c->channel;
211                         chan_5ghz[b].max_power = c->maxTxPower;
212
213                         if (c->privFlags & CHANNEL_DISALLOW_ADHOC)
214                                 chan_5ghz[b].flags |=
215                                         IEEE80211_CHAN_NO_IBSS;
216                         if (c->channelFlags & CHANNEL_PASSIVE)
217                                 chan_5ghz[b].flags |=
218                                         IEEE80211_CHAN_PASSIVE_SCAN;
219
220                         band_5ghz->n_channels = ++b;
221
222                         DPRINTF(sc, ATH_DBG_CONFIG,
223                                 "%s: 5MHz channel: %d, "
224                                 "channelFlags: 0x%x\n",
225                                 __func__,
226                                 c->channel,
227                                 c->channelFlags);
228                 }
229         }
230
231         return 0;
232 }
233
234 /*
235  *  Determine mode from channel flags
236  *
237  *  This routine will provide the enumerated WIRELESSS_MODE value based
238  *  on the settings of the channel flags.  If ho valid set of flags
239  *  exist, the lowest mode (11b) is selected.
240 */
241
242 static enum wireless_mode ath_chan2mode(struct ath9k_channel *chan)
243 {
244         if (chan->chanmode == CHANNEL_A)
245                 return ATH9K_MODE_11A;
246         else if (chan->chanmode == CHANNEL_G)
247                 return ATH9K_MODE_11G;
248         else if (chan->chanmode == CHANNEL_B)
249                 return ATH9K_MODE_11B;
250         else if (chan->chanmode == CHANNEL_A_HT20)
251                 return ATH9K_MODE_11NA_HT20;
252         else if (chan->chanmode == CHANNEL_G_HT20)
253                 return ATH9K_MODE_11NG_HT20;
254         else if (chan->chanmode == CHANNEL_A_HT40PLUS)
255                 return ATH9K_MODE_11NA_HT40PLUS;
256         else if (chan->chanmode == CHANNEL_A_HT40MINUS)
257                 return ATH9K_MODE_11NA_HT40MINUS;
258         else if (chan->chanmode == CHANNEL_G_HT40PLUS)
259                 return ATH9K_MODE_11NG_HT40PLUS;
260         else if (chan->chanmode == CHANNEL_G_HT40MINUS)
261                 return ATH9K_MODE_11NG_HT40MINUS;
262
263         /* NB: should not get here */
264         return ATH9K_MODE_11B;
265 }
266
267 /*
268  * Stop the device, grabbing the top-level lock to protect
269  * against concurrent entry through ath_init (which can happen
270  * if another thread does a system call and the thread doing the
271  * stop is preempted).
272  */
273
274 static int ath_stop(struct ath_softc *sc)
275 {
276         struct ath_hal *ah = sc->sc_ah;
277
278         DPRINTF(sc, ATH_DBG_CONFIG, "%s: invalid %u\n",
279                 __func__, sc->sc_invalid);
280
281         /*
282          * Shutdown the hardware and driver:
283          *    stop output from above
284          *    reset 802.11 state machine
285          *      (sends station deassoc/deauth frames)
286          *    turn off timers
287          *    disable interrupts
288          *    clear transmit machinery
289          *    clear receive machinery
290          *    turn off the radio
291          *    reclaim beacon resources
292          *
293          * Note that some of this work is not possible if the
294          * hardware is gone (invalid).
295          */
296
297         if (!sc->sc_invalid)
298                 ath9k_hw_set_interrupts(ah, 0);
299         ath_draintxq(sc, false);
300         if (!sc->sc_invalid) {
301                 ath_stoprecv(sc);
302                 ath9k_hw_phy_disable(ah);
303         } else
304                 sc->sc_rxlink = NULL;
305
306         return 0;
307 }
308
309 /*
310  *  Start Scan
311  *
312  *  This function is called when starting a channel scan.  It will perform
313  *  power save wakeup processing, set the filter for the scan, and get the
314  *  chip ready to send broadcast packets out during the scan.
315 */
316
317 void ath_scan_start(struct ath_softc *sc)
318 {
319         struct ath_hal *ah = sc->sc_ah;
320         u32 rfilt;
321         u32 now = (u32) jiffies_to_msecs(get_timestamp());
322
323         sc->sc_scanning = 1;
324         rfilt = ath_calcrxfilter(sc);
325         ath9k_hw_setrxfilter(ah, rfilt);
326         ath9k_hw_write_associd(ah, ath_bcast_mac, 0);
327
328         /* Restore previous power management state. */
329
330         DPRINTF(sc, ATH_DBG_CONFIG, "%d.%03d | %s: RX filter 0x%x aid 0\n",
331                 now / 1000, now % 1000, __func__, rfilt);
332 }
333
334 /*
335  *  Scan End
336  *
337  *  This routine is called by the upper layer when the scan is completed.  This
338  *  will set the filters back to normal operating mode, set the BSSID to the
339  *  correct value, and restore the power save state.
340 */
341
342 void ath_scan_end(struct ath_softc *sc)
343 {
344         struct ath_hal *ah = sc->sc_ah;
345         u32 rfilt;
346         u32 now = (u32) jiffies_to_msecs(get_timestamp());
347
348         sc->sc_scanning = 0;
349         /* Request for a full reset due to rx packet filter changes */
350         sc->sc_full_reset = 1;
351         rfilt = ath_calcrxfilter(sc);
352         ath9k_hw_setrxfilter(ah, rfilt);
353         ath9k_hw_write_associd(ah, sc->sc_curbssid, sc->sc_curaid);
354
355         DPRINTF(sc, ATH_DBG_CONFIG, "%d.%03d | %s: RX filter 0x%x aid 0x%x\n",
356                 now / 1000, now % 1000, __func__, rfilt, sc->sc_curaid);
357 }
358
359 /*
360  * Set the current channel
361  *
362  * Set/change channels.  If the channel is really being changed, it's done
363  * by reseting the chip.  To accomplish this we must first cleanup any pending
364  * DMA, then restart stuff after a la ath_init.
365 */
366 int ath_set_channel(struct ath_softc *sc, struct ath9k_channel *hchan)
367 {
368         struct ath_hal *ah = sc->sc_ah;
369         bool fastcc = true, stopped;
370         enum ath9k_ht_macmode ht_macmode;
371
372         if (sc->sc_invalid)     /* if the device is invalid or removed */
373                 return -EIO;
374
375         DPRINTF(sc, ATH_DBG_CONFIG,
376                 "%s: %u (%u MHz) -> %u (%u MHz), cflags:%x\n",
377                 __func__,
378                 ath9k_hw_mhz2ieee(ah, sc->sc_curchan.channel,
379                                   sc->sc_curchan.channelFlags),
380                 sc->sc_curchan.channel,
381                 ath9k_hw_mhz2ieee(ah, hchan->channel, hchan->channelFlags),
382                 hchan->channel, hchan->channelFlags);
383
384         ht_macmode = ath_cwm_macmode(sc);
385
386         if (hchan->channel != sc->sc_curchan.channel ||
387             hchan->channelFlags != sc->sc_curchan.channelFlags ||
388             sc->sc_update_chainmask || sc->sc_full_reset) {
389                 int status;
390                 /*
391                  * This is only performed if the channel settings have
392                  * actually changed.
393                  *
394                  * To switch channels clear any pending DMA operations;
395                  * wait long enough for the RX fifo to drain, reset the
396                  * hardware at the new frequency, and then re-enable
397                  * the relevant bits of the h/w.
398                  */
399                 ath9k_hw_set_interrupts(ah, 0); /* disable interrupts */
400                 ath_draintxq(sc, false);        /* clear pending tx frames */
401                 stopped = ath_stoprecv(sc);     /* turn off frame recv */
402
403                 /* XXX: do not flush receive queue here. We don't want
404                  * to flush data frames already in queue because of
405                  * changing channel. */
406
407                 if (!stopped || sc->sc_full_reset)
408                         fastcc = false;
409
410                 spin_lock_bh(&sc->sc_resetlock);
411                 if (!ath9k_hw_reset(ah, sc->sc_opmode, hchan,
412                                         ht_macmode, sc->sc_tx_chainmask,
413                                         sc->sc_rx_chainmask,
414                                         sc->sc_ht_extprotspacing,
415                                         fastcc, &status)) {
416                         DPRINTF(sc, ATH_DBG_FATAL,
417                                 "%s: unable to reset channel %u (%uMhz) "
418                                 "flags 0x%x hal status %u\n", __func__,
419                                 ath9k_hw_mhz2ieee(ah, hchan->channel,
420                                                   hchan->channelFlags),
421                                 hchan->channel, hchan->channelFlags, status);
422                         spin_unlock_bh(&sc->sc_resetlock);
423                         return -EIO;
424                 }
425                 spin_unlock_bh(&sc->sc_resetlock);
426
427                 sc->sc_curchan = *hchan;
428                 sc->sc_update_chainmask = 0;
429                 sc->sc_full_reset = 0;
430
431                 /* Re-enable rx framework */
432                 if (ath_startrecv(sc) != 0) {
433                         DPRINTF(sc, ATH_DBG_FATAL,
434                                 "%s: unable to restart recv logic\n", __func__);
435                         return -EIO;
436                 }
437                 /*
438                  * Change channels and update the h/w rate map
439                  * if we're switching; e.g. 11a to 11b/g.
440                  */
441                 ath_setcurmode(sc, ath_chan2mode(hchan));
442
443                 ath_update_txpow(sc);   /* update tx power state */
444                 /*
445                  * Re-enable interrupts.
446                  */
447                 ath9k_hw_set_interrupts(ah, sc->sc_imask);
448         }
449         return 0;
450 }
451
452 /**********************/
453 /* Chainmask Handling */
454 /**********************/
455
456 static void ath_chainmask_sel_timertimeout(unsigned long data)
457 {
458         struct ath_chainmask_sel *cm = (struct ath_chainmask_sel *)data;
459         cm->switch_allowed = 1;
460 }
461
462 /* Start chainmask select timer */
463 static void ath_chainmask_sel_timerstart(struct ath_chainmask_sel *cm)
464 {
465         cm->switch_allowed = 0;
466         mod_timer(&cm->timer, ath_chainmask_sel_period);
467 }
468
469 /* Stop chainmask select timer */
470 static void ath_chainmask_sel_timerstop(struct ath_chainmask_sel *cm)
471 {
472         cm->switch_allowed = 0;
473         del_timer_sync(&cm->timer);
474 }
475
476 static void ath_chainmask_sel_init(struct ath_softc *sc, struct ath_node *an)
477 {
478         struct ath_chainmask_sel *cm = &an->an_chainmask_sel;
479
480         memzero(cm, sizeof(struct ath_chainmask_sel));
481
482         cm->cur_tx_mask = sc->sc_tx_chainmask;
483         cm->cur_rx_mask = sc->sc_rx_chainmask;
484         cm->tx_avgrssi = ATH_RSSI_DUMMY_MARKER;
485         setup_timer(&cm->timer,
486                 ath_chainmask_sel_timertimeout, (unsigned long) cm);
487 }
488
489 int ath_chainmask_sel_logic(struct ath_softc *sc, struct ath_node *an)
490 {
491         struct ath_chainmask_sel *cm = &an->an_chainmask_sel;
492
493         /*
494          * Disable auto-swtiching in one of the following if conditions.
495          * sc_chainmask_auto_sel is used for internal global auto-switching
496          * enabled/disabled setting
497          */
498         if (sc->sc_ah->ah_caps.tx_chainmask != ATH_CHAINMASK_SEL_3X3) {
499                 cm->cur_tx_mask = sc->sc_tx_chainmask;
500                 return cm->cur_tx_mask;
501         }
502
503         if (cm->tx_avgrssi == ATH_RSSI_DUMMY_MARKER)
504                 return cm->cur_tx_mask;
505
506         if (cm->switch_allowed) {
507                 /* Switch down from tx 3 to tx 2. */
508                 if (cm->cur_tx_mask == ATH_CHAINMASK_SEL_3X3 &&
509                     ATH_RSSI_OUT(cm->tx_avgrssi) >=
510                     ath_chainmask_sel_down_rssi_thres) {
511                         cm->cur_tx_mask = sc->sc_tx_chainmask;
512
513                         /* Don't let another switch happen until
514                          * this timer expires */
515                         ath_chainmask_sel_timerstart(cm);
516                 }
517                 /* Switch up from tx 2 to 3. */
518                 else if (cm->cur_tx_mask == sc->sc_tx_chainmask &&
519                          ATH_RSSI_OUT(cm->tx_avgrssi) <=
520                          ath_chainmask_sel_up_rssi_thres) {
521                         cm->cur_tx_mask = ATH_CHAINMASK_SEL_3X3;
522
523                         /* Don't let another switch happen
524                          * until this timer expires */
525                         ath_chainmask_sel_timerstart(cm);
526                 }
527         }
528
529         return cm->cur_tx_mask;
530 }
531
532 /*
533  * Update tx/rx chainmask. For legacy association,
534  * hard code chainmask to 1x1, for 11n association, use
535  * the chainmask configuration.
536  */
537
538 void ath_update_chainmask(struct ath_softc *sc, int is_ht)
539 {
540         sc->sc_update_chainmask = 1;
541         if (is_ht) {
542                 sc->sc_tx_chainmask = sc->sc_ah->ah_caps.tx_chainmask;
543                 sc->sc_rx_chainmask = sc->sc_ah->ah_caps.rx_chainmask;
544         } else {
545                 sc->sc_tx_chainmask = 1;
546                 sc->sc_rx_chainmask = 1;
547         }
548
549         DPRINTF(sc, ATH_DBG_CONFIG, "%s: tx chmask: %d, rx chmask: %d\n",
550                 __func__, sc->sc_tx_chainmask, sc->sc_rx_chainmask);
551 }
552
553 /******************/
554 /* VAP management */
555 /******************/
556
557 /*
558  *  VAP in Listen mode
559  *
560  *  This routine brings the VAP out of the down state into a "listen" state
561  *  where it waits for association requests.  This is used in AP and AdHoc
562  *  modes.
563 */
564
565 int ath_vap_listen(struct ath_softc *sc, int if_id)
566 {
567         struct ath_hal *ah = sc->sc_ah;
568         struct ath_vap *avp;
569         u32 rfilt = 0;
570         DECLARE_MAC_BUF(mac);
571
572         avp = sc->sc_vaps[if_id];
573         if (avp == NULL) {
574                 DPRINTF(sc, ATH_DBG_FATAL, "%s: invalid interface id %u\n",
575                         __func__, if_id);
576                 return -EINVAL;
577         }
578
579 #ifdef CONFIG_SLOW_ANT_DIV
580         ath_slow_ant_div_stop(&sc->sc_antdiv);
581 #endif
582
583         /* update ratectrl about the new state */
584         ath_rate_newstate(sc, avp);
585
586         rfilt = ath_calcrxfilter(sc);
587         ath9k_hw_setrxfilter(ah, rfilt);
588
589         if (sc->sc_opmode == ATH9K_M_STA || sc->sc_opmode == ATH9K_M_IBSS) {
590                 memcpy(sc->sc_curbssid, ath_bcast_mac, ETH_ALEN);
591                 ath9k_hw_write_associd(ah, sc->sc_curbssid, sc->sc_curaid);
592         } else
593                 sc->sc_curaid = 0;
594
595         DPRINTF(sc, ATH_DBG_CONFIG,
596                 "%s: RX filter 0x%x bssid %s aid 0x%x\n",
597                 __func__, rfilt, print_mac(mac,
598                         sc->sc_curbssid), sc->sc_curaid);
599
600         /*
601          * XXXX
602          * Disable BMISS interrupt when we're not associated
603          */
604         ath9k_hw_set_interrupts(ah,
605                 sc->sc_imask & ~(ATH9K_INT_SWBA | ATH9K_INT_BMISS));
606         sc->sc_imask &= ~(ATH9K_INT_SWBA | ATH9K_INT_BMISS);
607         /* need to reconfigure the beacons when it moves to RUN */
608         sc->sc_beacons = 0;
609
610         return 0;
611 }
612
613 int ath_vap_attach(struct ath_softc *sc,
614                    int if_id,
615                    struct ieee80211_vif *if_data,
616                    enum ath9k_opmode opmode)
617 {
618         struct ath_vap *avp;
619
620         if (if_id >= ATH_BCBUF || sc->sc_vaps[if_id] != NULL) {
621                 DPRINTF(sc, ATH_DBG_FATAL,
622                         "%s: Invalid interface id = %u\n", __func__, if_id);
623                 return -EINVAL;
624         }
625
626         switch (opmode) {
627         case ATH9K_M_STA:
628         case ATH9K_M_IBSS:
629         case ATH9K_M_MONITOR:
630                 break;
631         case ATH9K_M_HOSTAP:
632                 /* XXX not right, beacon buffer is allocated on RUN trans */
633                 if (list_empty(&sc->sc_bbuf))
634                         return -ENOMEM;
635                 break;
636         default:
637                 return -EINVAL;
638         }
639
640         /* create ath_vap */
641         avp = kmalloc(sizeof(struct ath_vap), GFP_KERNEL);
642         if (avp == NULL)
643                 return -ENOMEM;
644
645         memzero(avp, sizeof(struct ath_vap));
646         avp->av_if_data = if_data;
647         /* Set the VAP opmode */
648         avp->av_opmode = opmode;
649         avp->av_bslot = -1;
650         INIT_LIST_HEAD(&avp->av_mcastq.axq_q);
651         INIT_LIST_HEAD(&avp->av_mcastq.axq_acq);
652         spin_lock_init(&avp->av_mcastq.axq_lock);
653
654         ath9k_hw_set_tsfadjust(sc->sc_ah, 1);
655
656         sc->sc_vaps[if_id] = avp;
657         sc->sc_nvaps++;
658         /* Set the device opmode */
659         sc->sc_opmode = opmode;
660
661         /* default VAP configuration */
662         avp->av_config.av_fixed_rateset = IEEE80211_FIXED_RATE_NONE;
663         avp->av_config.av_fixed_retryset = 0x03030303;
664
665         return 0;
666 }
667
668 int ath_vap_detach(struct ath_softc *sc, int if_id)
669 {
670         struct ath_hal *ah = sc->sc_ah;
671         struct ath_vap *avp;
672
673         avp = sc->sc_vaps[if_id];
674         if (avp == NULL) {
675                 DPRINTF(sc, ATH_DBG_FATAL, "%s: invalid interface id %u\n",
676                         __func__, if_id);
677                 return -EINVAL;
678         }
679
680         /*
681          * Quiesce the hardware while we remove the vap.  In
682          * particular we need to reclaim all references to the
683          * vap state by any frames pending on the tx queues.
684          *
685          * XXX can we do this w/o affecting other vap's?
686          */
687         ath9k_hw_set_interrupts(ah, 0); /* disable interrupts */
688         ath_draintxq(sc, false);        /* stop xmit side */
689         ath_stoprecv(sc);       /* stop recv side */
690         ath_flushrecv(sc);      /* flush recv queue */
691
692         /* Reclaim any pending mcast bufs on the vap. */
693         ath_tx_draintxq(sc, &avp->av_mcastq, false);
694
695         kfree(avp);
696         sc->sc_vaps[if_id] = NULL;
697         sc->sc_nvaps--;
698
699         return 0;
700 }
701
702 int ath_vap_config(struct ath_softc *sc,
703         int if_id, struct ath_vap_config *if_config)
704 {
705         struct ath_vap *avp;
706
707         if (if_id >= ATH_BCBUF) {
708                 DPRINTF(sc, ATH_DBG_FATAL,
709                         "%s: Invalid interface id = %u\n", __func__, if_id);
710                 return -EINVAL;
711         }
712
713         avp = sc->sc_vaps[if_id];
714         ASSERT(avp != NULL);
715
716         if (avp)
717                 memcpy(&avp->av_config, if_config, sizeof(avp->av_config));
718
719         return 0;
720 }
721
722 /********/
723 /* Core */
724 /********/
725
726 int ath_open(struct ath_softc *sc, struct ath9k_channel *initial_chan)
727 {
728         struct ath_hal *ah = sc->sc_ah;
729         int status;
730         int error = 0;
731         enum ath9k_ht_macmode ht_macmode = ath_cwm_macmode(sc);
732
733         DPRINTF(sc, ATH_DBG_CONFIG, "%s: mode %d\n", __func__, sc->sc_opmode);
734
735         /*
736          * Stop anything previously setup.  This is safe
737          * whether this is the first time through or not.
738          */
739         ath_stop(sc);
740
741         /* Initialize chanmask selection */
742         sc->sc_tx_chainmask = ah->ah_caps.tx_chainmask;
743         sc->sc_rx_chainmask = ah->ah_caps.rx_chainmask;
744
745         /* Reset SERDES registers */
746         ath9k_hw_configpcipowersave(ah, 0);
747
748         /*
749          * The basic interface to setting the hardware in a good
750          * state is ``reset''.  On return the hardware is known to
751          * be powered up and with interrupts disabled.  This must
752          * be followed by initialization of the appropriate bits
753          * and then setup of the interrupt mask.
754          */
755         sc->sc_curchan = *initial_chan;
756
757         spin_lock_bh(&sc->sc_resetlock);
758         if (!ath9k_hw_reset(ah, sc->sc_opmode, &sc->sc_curchan, ht_macmode,
759                            sc->sc_tx_chainmask, sc->sc_rx_chainmask,
760                            sc->sc_ht_extprotspacing, false, &status)) {
761                 DPRINTF(sc, ATH_DBG_FATAL,
762                         "%s: unable to reset hardware; hal status %u "
763                         "(freq %u flags 0x%x)\n", __func__, status,
764                         sc->sc_curchan.channel, sc->sc_curchan.channelFlags);
765                 error = -EIO;
766                 spin_unlock_bh(&sc->sc_resetlock);
767                 goto done;
768         }
769         spin_unlock_bh(&sc->sc_resetlock);
770         /*
771          * This is needed only to setup initial state
772          * but it's best done after a reset.
773          */
774         ath_update_txpow(sc);
775
776         /*
777          * Setup the hardware after reset:
778          * The receive engine is set going.
779          * Frame transmit is handled entirely
780          * in the frame output path; there's nothing to do
781          * here except setup the interrupt mask.
782          */
783         if (ath_startrecv(sc) != 0) {
784                 DPRINTF(sc, ATH_DBG_FATAL,
785                         "%s: unable to start recv logic\n", __func__);
786                 error = -EIO;
787                 goto done;
788         }
789         /* Setup our intr mask. */
790         sc->sc_imask = ATH9K_INT_RX | ATH9K_INT_TX
791                 | ATH9K_INT_RXEOL | ATH9K_INT_RXORN
792                 | ATH9K_INT_FATAL | ATH9K_INT_GLOBAL;
793
794         if (ah->ah_caps.hw_caps & ATH9K_HW_CAP_GTT)
795                 sc->sc_imask |= ATH9K_INT_GTT;
796
797         if (ah->ah_caps.hw_caps & ATH9K_HW_CAP_HT)
798                 sc->sc_imask |= ATH9K_INT_CST;
799
800         /*
801          * Enable MIB interrupts when there are hardware phy counters.
802          * Note we only do this (at the moment) for station mode.
803          */
804         if (ath9k_hw_phycounters(ah) &&
805             ((sc->sc_opmode == ATH9K_M_STA) || (sc->sc_opmode == ATH9K_M_IBSS)))
806                 sc->sc_imask |= ATH9K_INT_MIB;
807         /*
808          * Some hardware processes the TIM IE and fires an
809          * interrupt when the TIM bit is set.  For hardware
810          * that does, if not overridden by configuration,
811          * enable the TIM interrupt when operating as station.
812          */
813         if ((ah->ah_caps.hw_caps & ATH9K_HW_CAP_ENHANCEDPM) &&
814             (sc->sc_opmode == ATH9K_M_STA) &&
815             !sc->sc_config.swBeaconProcess)
816                 sc->sc_imask |= ATH9K_INT_TIM;
817         /*
818          *  Don't enable interrupts here as we've not yet built our
819          *  vap and node data structures, which will be needed as soon
820          *  as we start receiving.
821          */
822         ath_setcurmode(sc, ath_chan2mode(initial_chan));
823
824         /* XXX: we must make sure h/w is ready and clear invalid flag
825          * before turning on interrupt. */
826         sc->sc_invalid = 0;
827 done:
828         return error;
829 }
830
831 /*
832  * Reset the hardware w/o losing operational state.  This is
833  * basically a more efficient way of doing ath_stop, ath_init,
834  * followed by state transitions to the current 802.11
835  * operational state.  Used to recover from errors rx overrun
836  * and to reset the hardware when rf gain settings must be reset.
837  */
838
839 static int ath_reset_start(struct ath_softc *sc, u32 flag)
840 {
841         struct ath_hal *ah = sc->sc_ah;
842
843         ath9k_hw_set_interrupts(ah, 0); /* disable interrupts */
844         ath_draintxq(sc, flag & RESET_RETRY_TXQ);       /* stop xmit side */
845         ath_stoprecv(sc);       /* stop recv side */
846         ath_flushrecv(sc);      /* flush recv queue */
847
848         return 0;
849 }
850
851 static int ath_reset_end(struct ath_softc *sc, u32 flag)
852 {
853         struct ath_hal *ah = sc->sc_ah;
854
855         if (ath_startrecv(sc) != 0)     /* restart recv */
856                 DPRINTF(sc, ATH_DBG_FATAL,
857                         "%s: unable to start recv logic\n", __func__);
858
859         /*
860          * We may be doing a reset in response to a request
861          * that changes the channel so update any state that
862          * might change as a result.
863          */
864         ath_setcurmode(sc, ath_chan2mode(&sc->sc_curchan));
865
866         ath_update_txpow(sc);   /* update tx power state */
867
868         if (sc->sc_beacons)
869                 ath_beacon_config(sc, ATH_IF_ID_ANY);   /* restart beacons */
870         ath9k_hw_set_interrupts(ah, sc->sc_imask);
871
872         /* Restart the txq */
873         if (flag & RESET_RETRY_TXQ) {
874                 int i;
875                 for (i = 0; i < ATH9K_NUM_TX_QUEUES; i++) {
876                         if (ATH_TXQ_SETUP(sc, i)) {
877                                 spin_lock_bh(&sc->sc_txq[i].axq_lock);
878                                 ath_txq_schedule(sc, &sc->sc_txq[i]);
879                                 spin_unlock_bh(&sc->sc_txq[i].axq_lock);
880                         }
881                 }
882         }
883         return 0;
884 }
885
886 int ath_reset(struct ath_softc *sc)
887 {
888         struct ath_hal *ah = sc->sc_ah;
889         int status;
890         int error = 0;
891         enum ath9k_ht_macmode ht_macmode = ath_cwm_macmode(sc);
892
893         /* NB: indicate channel change so we do a full reset */
894         spin_lock_bh(&sc->sc_resetlock);
895         if (!ath9k_hw_reset(ah, sc->sc_opmode, &sc->sc_curchan,
896                            ht_macmode,
897                            sc->sc_tx_chainmask, sc->sc_rx_chainmask,
898                            sc->sc_ht_extprotspacing, false, &status)) {
899                 DPRINTF(sc, ATH_DBG_FATAL,
900                         "%s: unable to reset hardware; hal status %u\n",
901                         __func__, status);
902                 error = -EIO;
903         }
904         spin_unlock_bh(&sc->sc_resetlock);
905
906         return error;
907 }
908
909 int ath_suspend(struct ath_softc *sc)
910 {
911         struct ath_hal *ah = sc->sc_ah;
912
913         /* No I/O if device has been surprise removed */
914         if (sc->sc_invalid)
915                 return -EIO;
916
917         /* Shut off the interrupt before setting sc->sc_invalid to '1' */
918         ath9k_hw_set_interrupts(ah, 0);
919
920         /* XXX: we must make sure h/w will not generate any interrupt
921          * before setting the invalid flag. */
922         sc->sc_invalid = 1;
923
924         /* disable HAL and put h/w to sleep */
925         ath9k_hw_disable(sc->sc_ah);
926
927         ath9k_hw_configpcipowersave(sc->sc_ah, 1);
928
929         return 0;
930 }
931
932 /* Interrupt handler.  Most of the actual processing is deferred.
933  * It's the caller's responsibility to ensure the chip is awake. */
934
935 irqreturn_t ath_isr(int irq, void *dev)
936 {
937         struct ath_softc *sc = dev;
938         struct ath_hal *ah = sc->sc_ah;
939         enum ath9k_int status;
940         bool sched = false;
941
942         do {
943                 if (sc->sc_invalid) {
944                         /*
945                          * The hardware is not ready/present, don't
946                          * touch anything. Note this can happen early
947                          * on if the IRQ is shared.
948                          */
949                         return IRQ_NONE;
950                 }
951                 if (!ath9k_hw_intrpend(ah)) {   /* shared irq, not for us */
952                         return IRQ_NONE;
953                 }
954
955                 /*
956                  * Figure out the reason(s) for the interrupt.  Note
957                  * that the hal returns a pseudo-ISR that may include
958                  * bits we haven't explicitly enabled so we mask the
959                  * value to insure we only process bits we requested.
960                  */
961                 ath9k_hw_getisr(ah, &status);   /* NB: clears ISR too */
962
963                 status &= sc->sc_imask; /* discard unasked-for bits */
964
965                 /*
966                  * If there are no status bits set, then this interrupt was not
967                  * for me (should have been caught above).
968                  */
969
970                 if (!status)
971                         return IRQ_NONE;
972
973                 sc->sc_intrstatus = status;
974
975                 if (status & ATH9K_INT_FATAL) {
976                         /* need a chip reset */
977                         sched = true;
978                 } else if (status & ATH9K_INT_RXORN) {
979                         /* need a chip reset */
980                         sched = true;
981                 } else {
982                         if (status & ATH9K_INT_SWBA) {
983                                 /* schedule a tasklet for beacon handling */
984                                 tasklet_schedule(&sc->bcon_tasklet);
985                         }
986                         if (status & ATH9K_INT_RXEOL) {
987                                 /*
988                                  * NB: the hardware should re-read the link when
989                                  *     RXE bit is written, but it doesn't work
990                                  *     at least on older hardware revs.
991                                  */
992                                 sched = true;
993                         }
994
995                         if (status & ATH9K_INT_TXURN)
996                                 /* bump tx trigger level */
997                                 ath9k_hw_updatetxtriglevel(ah, true);
998                         /* XXX: optimize this */
999                         if (status & ATH9K_INT_RX)
1000                                 sched = true;
1001                         if (status & ATH9K_INT_TX)
1002                                 sched = true;
1003                         if (status & ATH9K_INT_BMISS)
1004                                 sched = true;
1005                         /* carrier sense timeout */
1006                         if (status & ATH9K_INT_CST)
1007                                 sched = true;
1008                         if (status & ATH9K_INT_MIB) {
1009                                 /*
1010                                  * Disable interrupts until we service the MIB
1011                                  * interrupt; otherwise it will continue to
1012                                  * fire.
1013                                  */
1014                                 ath9k_hw_set_interrupts(ah, 0);
1015                                 /*
1016                                  * Let the hal handle the event. We assume
1017                                  * it will clear whatever condition caused
1018                                  * the interrupt.
1019                                  */
1020                                 ath9k_hw_procmibevent(ah, &sc->sc_halstats);
1021                                 ath9k_hw_set_interrupts(ah, sc->sc_imask);
1022                         }
1023                         if (status & ATH9K_INT_TIM_TIMER) {
1024                                 if (!(ah->ah_caps.hw_caps &
1025                                       ATH9K_HW_CAP_AUTOSLEEP)) {
1026                                         /* Clear RxAbort bit so that we can
1027                                          * receive frames */
1028                                         ath9k_hw_setrxabort(ah, 0);
1029                                         sched = true;
1030                                 }
1031                         }
1032                 }
1033         } while (0);
1034
1035         if (sched) {
1036                 /* turn off every interrupt except SWBA */
1037                 ath9k_hw_set_interrupts(ah, (sc->sc_imask & ATH9K_INT_SWBA));
1038                 tasklet_schedule(&sc->intr_tq);
1039         }
1040
1041         return IRQ_HANDLED;
1042 }
1043
1044 /* Deferred interrupt processing  */
1045
1046 static void ath9k_tasklet(unsigned long data)
1047 {
1048         struct ath_softc *sc = (struct ath_softc *)data;
1049         u32 status = sc->sc_intrstatus;
1050
1051         if (status & ATH9K_INT_FATAL) {
1052                 /* need a chip reset */
1053                 ath_internal_reset(sc);
1054                 return;
1055         } else {
1056
1057                 if (status &
1058                     (ATH9K_INT_RX | ATH9K_INT_RXEOL | ATH9K_INT_RXORN)) {
1059                         /* XXX: fill me in */
1060                         /*
1061                         if (status & ATH9K_INT_RXORN) {
1062                         }
1063                         if (status & ATH9K_INT_RXEOL) {
1064                         }
1065                         */
1066                         spin_lock_bh(&sc->sc_rxflushlock);
1067                         ath_rx_tasklet(sc, 0);
1068                         spin_unlock_bh(&sc->sc_rxflushlock);
1069                 }
1070                 /* XXX: optimize this */
1071                 if (status & ATH9K_INT_TX)
1072                         ath_tx_tasklet(sc);
1073                 /* XXX: fill me in */
1074                 /*
1075                 if (status & ATH9K_INT_BMISS) {
1076                 }
1077                 if (status & (ATH9K_INT_TIM | ATH9K_INT_DTIMSYNC)) {
1078                         if (status & ATH9K_INT_TIM) {
1079                         }
1080                         if (status & ATH9K_INT_DTIMSYNC) {
1081                         }
1082                 }
1083                 */
1084         }
1085
1086         /* re-enable hardware interrupt */
1087         ath9k_hw_set_interrupts(sc->sc_ah, sc->sc_imask);
1088 }
1089
1090 int ath_init(u16 devid, struct ath_softc *sc)
1091 {
1092         struct ath_hal *ah = NULL;
1093         int status;
1094         int error = 0, i;
1095         int csz = 0;
1096         u32 rd;
1097
1098         /* XXX: hardware will not be ready until ath_open() being called */
1099         sc->sc_invalid = 1;
1100
1101         sc->sc_debug = DBG_DEFAULT;
1102         DPRINTF(sc, ATH_DBG_CONFIG, "%s: devid 0x%x\n", __func__, devid);
1103
1104         /* Initialize tasklet */
1105         tasklet_init(&sc->intr_tq, ath9k_tasklet, (unsigned long)sc);
1106         tasklet_init(&sc->bcon_tasklet, ath9k_beacon_tasklet,
1107                      (unsigned long)sc);
1108
1109         /*
1110          * Cache line size is used to size and align various
1111          * structures used to communicate with the hardware.
1112          */
1113         bus_read_cachesize(sc, &csz);
1114         /* XXX assert csz is non-zero */
1115         sc->sc_cachelsz = csz << 2;     /* convert to bytes */
1116
1117         spin_lock_init(&sc->sc_resetlock);
1118
1119         ah = ath9k_hw_attach(devid, sc, sc->mem, &status);
1120         if (ah == NULL) {
1121                 DPRINTF(sc, ATH_DBG_FATAL,
1122                         "%s: unable to attach hardware; HAL status %u\n",
1123                         __func__, status);
1124                 error = -ENXIO;
1125                 goto bad;
1126         }
1127         sc->sc_ah = ah;
1128
1129         /* Get the chipset-specific aggr limit. */
1130         sc->sc_rtsaggrlimit = ah->ah_caps.rts_aggr_limit;
1131
1132         /* Get the hardware key cache size. */
1133         sc->sc_keymax = ah->ah_caps.keycache_size;
1134         if (sc->sc_keymax > ATH_KEYMAX) {
1135                 DPRINTF(sc, ATH_DBG_KEYCACHE,
1136                         "%s: Warning, using only %u entries in %u key cache\n",
1137                         __func__, ATH_KEYMAX, sc->sc_keymax);
1138                 sc->sc_keymax = ATH_KEYMAX;
1139         }
1140
1141         /*
1142          * Reset the key cache since some parts do not
1143          * reset the contents on initial power up.
1144          */
1145         for (i = 0; i < sc->sc_keymax; i++)
1146                 ath9k_hw_keyreset(ah, (u16) i);
1147         /*
1148          * Mark key cache slots associated with global keys
1149          * as in use.  If we knew TKIP was not to be used we
1150          * could leave the +32, +64, and +32+64 slots free.
1151          * XXX only for splitmic.
1152          */
1153         for (i = 0; i < IEEE80211_WEP_NKID; i++) {
1154                 set_bit(i, sc->sc_keymap);
1155                 set_bit(i + 32, sc->sc_keymap);
1156                 set_bit(i + 64, sc->sc_keymap);
1157                 set_bit(i + 32 + 64, sc->sc_keymap);
1158         }
1159         /*
1160          * Collect the channel list using the default country
1161          * code and including outdoor channels.  The 802.11 layer
1162          * is resposible for filtering this list based on settings
1163          * like the phy mode.
1164          */
1165         rd = ah->ah_currentRD;
1166
1167         error = ath_setup_channels(sc);
1168         if (error)
1169                 goto bad;
1170
1171         /* default to STA mode */
1172         sc->sc_opmode = ATH9K_M_MONITOR;
1173
1174         /* Setup rate tables */
1175
1176         ath_setup_rates(sc, IEEE80211_BAND_2GHZ);
1177         ath_setup_rates(sc, IEEE80211_BAND_5GHZ);
1178
1179         /* NB: setup here so ath_rate_update is happy */
1180         ath_setcurmode(sc, ATH9K_MODE_11A);
1181
1182         /*
1183          * Allocate hardware transmit queues: one queue for
1184          * beacon frames and one data queue for each QoS
1185          * priority.  Note that the hal handles reseting
1186          * these queues at the needed time.
1187          */
1188         sc->sc_bhalq = ath_beaconq_setup(ah);
1189         if (sc->sc_bhalq == -1) {
1190                 DPRINTF(sc, ATH_DBG_FATAL,
1191                         "%s: unable to setup a beacon xmit queue\n", __func__);
1192                 error = -EIO;
1193                 goto bad2;
1194         }
1195         sc->sc_cabq = ath_txq_setup(sc, ATH9K_TX_QUEUE_CAB, 0);
1196         if (sc->sc_cabq == NULL) {
1197                 DPRINTF(sc, ATH_DBG_FATAL,
1198                         "%s: unable to setup CAB xmit queue\n", __func__);
1199                 error = -EIO;
1200                 goto bad2;
1201         }
1202
1203         sc->sc_config.cabqReadytime = ATH_CABQ_READY_TIME;
1204         ath_cabq_update(sc);
1205
1206         for (i = 0; i < ARRAY_SIZE(sc->sc_haltype2q); i++)
1207                 sc->sc_haltype2q[i] = -1;
1208
1209         /* Setup data queues */
1210         /* NB: ensure BK queue is the lowest priority h/w queue */
1211         if (!ath_tx_setup(sc, ATH9K_WME_AC_BK)) {
1212                 DPRINTF(sc, ATH_DBG_FATAL,
1213                         "%s: unable to setup xmit queue for BK traffic\n",
1214                         __func__);
1215                 error = -EIO;
1216                 goto bad2;
1217         }
1218
1219         if (!ath_tx_setup(sc, ATH9K_WME_AC_BE)) {
1220                 DPRINTF(sc, ATH_DBG_FATAL,
1221                         "%s: unable to setup xmit queue for BE traffic\n",
1222                         __func__);
1223                 error = -EIO;
1224                 goto bad2;
1225         }
1226         if (!ath_tx_setup(sc, ATH9K_WME_AC_VI)) {
1227                 DPRINTF(sc, ATH_DBG_FATAL,
1228                         "%s: unable to setup xmit queue for VI traffic\n",
1229                         __func__);
1230                 error = -EIO;
1231                 goto bad2;
1232         }
1233         if (!ath_tx_setup(sc, ATH9K_WME_AC_VO)) {
1234                 DPRINTF(sc, ATH_DBG_FATAL,
1235                         "%s: unable to setup xmit queue for VO traffic\n",
1236                         __func__);
1237                 error = -EIO;
1238                 goto bad2;
1239         }
1240
1241         sc->sc_rc = ath_rate_attach(ah);
1242         if (sc->sc_rc == NULL) {
1243                 error = EIO;
1244                 goto bad2;
1245         }
1246
1247         if (ath9k_hw_getcapability(ah, ATH9K_CAP_CIPHER,
1248                                    ATH9K_CIPHER_TKIP, NULL)) {
1249                 /*
1250                  * Whether we should enable h/w TKIP MIC.
1251                  * XXX: if we don't support WME TKIP MIC, then we wouldn't
1252                  * report WMM capable, so it's always safe to turn on
1253                  * TKIP MIC in this case.
1254                  */
1255                 ath9k_hw_setcapability(sc->sc_ah, ATH9K_CAP_TKIP_MIC,
1256                                        0, 1, NULL);
1257         }
1258
1259         /*
1260          * Check whether the separate key cache entries
1261          * are required to handle both tx+rx MIC keys.
1262          * With split mic keys the number of stations is limited
1263          * to 27 otherwise 59.
1264          */
1265         if (ath9k_hw_getcapability(ah, ATH9K_CAP_CIPHER,
1266                                    ATH9K_CIPHER_TKIP, NULL)
1267             && ath9k_hw_getcapability(ah, ATH9K_CAP_CIPHER,
1268                                       ATH9K_CIPHER_MIC, NULL)
1269             && ath9k_hw_getcapability(ah, ATH9K_CAP_TKIP_SPLIT,
1270                                       0, NULL))
1271                 sc->sc_splitmic = 1;
1272
1273         /* turn on mcast key search if possible */
1274         if (!ath9k_hw_getcapability(ah, ATH9K_CAP_MCAST_KEYSRCH, 0, NULL))
1275                 (void)ath9k_hw_setcapability(ah, ATH9K_CAP_MCAST_KEYSRCH, 1,
1276                                              1, NULL);
1277
1278         sc->sc_config.txpowlimit = ATH_TXPOWER_MAX;
1279         sc->sc_config.txpowlimit_override = 0;
1280
1281         /* 11n Capabilities */
1282         if (ah->ah_caps.hw_caps & ATH9K_HW_CAP_HT) {
1283                 sc->sc_txaggr = 1;
1284                 sc->sc_rxaggr = 1;
1285         }
1286
1287         sc->sc_tx_chainmask = ah->ah_caps.tx_chainmask;
1288         sc->sc_rx_chainmask = ah->ah_caps.rx_chainmask;
1289
1290         /* Configuration for rx chain detection */
1291         sc->sc_rxchaindetect_ref = 0;
1292         sc->sc_rxchaindetect_thresh5GHz = 35;
1293         sc->sc_rxchaindetect_thresh2GHz = 35;
1294         sc->sc_rxchaindetect_delta5GHz = 30;
1295         sc->sc_rxchaindetect_delta2GHz = 30;
1296
1297         ath9k_hw_setcapability(ah, ATH9K_CAP_DIVERSITY, 1, true, NULL);
1298         sc->sc_defant = ath9k_hw_getdefantenna(ah);
1299
1300         ath9k_hw_getmac(ah, sc->sc_myaddr);
1301         if (ah->ah_caps.hw_caps & ATH9K_HW_CAP_BSSIDMASK) {
1302                 ath9k_hw_getbssidmask(ah, sc->sc_bssidmask);
1303                 ATH_SET_VAP_BSSID_MASK(sc->sc_bssidmask);
1304                 ath9k_hw_setbssidmask(ah, sc->sc_bssidmask);
1305         }
1306         sc->sc_slottime = ATH9K_SLOT_TIME_9;    /* default to short slot time */
1307
1308         /* initialize beacon slots */
1309         for (i = 0; i < ARRAY_SIZE(sc->sc_bslot); i++)
1310                 sc->sc_bslot[i] = ATH_IF_ID_ANY;
1311
1312         /* save MISC configurations */
1313         sc->sc_config.swBeaconProcess = 1;
1314
1315 #ifdef CONFIG_SLOW_ANT_DIV
1316         /* range is 40 - 255, we use something in the middle */
1317         ath_slow_ant_div_init(&sc->sc_antdiv, sc, 0x127);
1318 #endif
1319
1320         return 0;
1321 bad2:
1322         /* cleanup tx queues */
1323         for (i = 0; i < ATH9K_NUM_TX_QUEUES; i++)
1324                 if (ATH_TXQ_SETUP(sc, i))
1325                         ath_tx_cleanupq(sc, &sc->sc_txq[i]);
1326 bad:
1327         if (ah)
1328                 ath9k_hw_detach(ah);
1329         return error;
1330 }
1331
1332 void ath_deinit(struct ath_softc *sc)
1333 {
1334         struct ath_hal *ah = sc->sc_ah;
1335         int i;
1336
1337         DPRINTF(sc, ATH_DBG_CONFIG, "%s\n", __func__);
1338
1339         ath_stop(sc);
1340         if (!sc->sc_invalid)
1341                 ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_AWAKE);
1342         ath_rate_detach(sc->sc_rc);
1343         /* cleanup tx queues */
1344         for (i = 0; i < ATH9K_NUM_TX_QUEUES; i++)
1345                 if (ATH_TXQ_SETUP(sc, i))
1346                         ath_tx_cleanupq(sc, &sc->sc_txq[i]);
1347         ath9k_hw_detach(ah);
1348 }
1349
1350 /*******************/
1351 /* Node Management */
1352 /*******************/
1353
1354 struct ath_node *ath_node_attach(struct ath_softc *sc, u8 *addr, int if_id)
1355 {
1356         struct ath_vap *avp;
1357         struct ath_node *an;
1358         DECLARE_MAC_BUF(mac);
1359
1360         avp = sc->sc_vaps[if_id];
1361         ASSERT(avp != NULL);
1362
1363         /* mac80211 sta_notify callback is from an IRQ context, so no sleep */
1364         an = kmalloc(sizeof(struct ath_node), GFP_ATOMIC);
1365         if (an == NULL)
1366                 return NULL;
1367         memzero(an, sizeof(*an));
1368
1369         an->an_sc = sc;
1370         memcpy(an->an_addr, addr, ETH_ALEN);
1371         atomic_set(&an->an_refcnt, 1);
1372
1373         /* set up per-node tx/rx state */
1374         ath_tx_node_init(sc, an);
1375         ath_rx_node_init(sc, an);
1376
1377         ath_chainmask_sel_init(sc, an);
1378         ath_chainmask_sel_timerstart(&an->an_chainmask_sel);
1379         list_add(&an->list, &sc->node_list);
1380
1381         return an;
1382 }
1383
1384 void ath_node_detach(struct ath_softc *sc, struct ath_node *an, bool bh_flag)
1385 {
1386         unsigned long flags;
1387
1388         DECLARE_MAC_BUF(mac);
1389
1390         ath_chainmask_sel_timerstop(&an->an_chainmask_sel);
1391         an->an_flags |= ATH_NODE_CLEAN;
1392         ath_tx_node_cleanup(sc, an, bh_flag);
1393         ath_rx_node_cleanup(sc, an);
1394
1395         ath_tx_node_free(sc, an);
1396         ath_rx_node_free(sc, an);
1397
1398         spin_lock_irqsave(&sc->node_lock, flags);
1399
1400         list_del(&an->list);
1401
1402         spin_unlock_irqrestore(&sc->node_lock, flags);
1403
1404         kfree(an);
1405 }
1406
1407 /* Finds a node and increases the refcnt if found */
1408
1409 struct ath_node *ath_node_get(struct ath_softc *sc, u8 *addr)
1410 {
1411         struct ath_node *an = NULL, *an_found = NULL;
1412
1413         if (list_empty(&sc->node_list)) /* FIXME */
1414                 goto out;
1415         list_for_each_entry(an, &sc->node_list, list) {
1416                 if (!compare_ether_addr(an->an_addr, addr)) {
1417                         atomic_inc(&an->an_refcnt);
1418                         an_found = an;
1419                         break;
1420                 }
1421         }
1422 out:
1423         return an_found;
1424 }
1425
1426 /* Decrements the refcnt and if it drops to zero, detach the node */
1427
1428 void ath_node_put(struct ath_softc *sc, struct ath_node *an, bool bh_flag)
1429 {
1430         if (atomic_dec_and_test(&an->an_refcnt))
1431                 ath_node_detach(sc, an, bh_flag);
1432 }
1433
1434 /* Finds a node, doesn't increment refcnt. Caller must hold sc->node_lock */
1435 struct ath_node *ath_node_find(struct ath_softc *sc, u8 *addr)
1436 {
1437         struct ath_node *an = NULL, *an_found = NULL;
1438
1439         if (list_empty(&sc->node_list))
1440                 return NULL;
1441
1442         list_for_each_entry(an, &sc->node_list, list)
1443                 if (!compare_ether_addr(an->an_addr, addr)) {
1444                         an_found = an;
1445                         break;
1446                 }
1447
1448         return an_found;
1449 }
1450
1451 /*
1452  * Set up New Node
1453  *
1454  * Setup driver-specific state for a newly associated node.  This routine
1455  * really only applies if compression or XR are enabled, there is no code
1456  * covering any other cases.
1457 */
1458
1459 void ath_newassoc(struct ath_softc *sc,
1460         struct ath_node *an, int isnew, int isuapsd)
1461 {
1462         int tidno;
1463
1464         /* if station reassociates, tear down the aggregation state. */
1465         if (!isnew) {
1466                 for (tidno = 0; tidno < WME_NUM_TID; tidno++) {
1467                         if (sc->sc_txaggr)
1468                                 ath_tx_aggr_teardown(sc, an, tidno);
1469                         if (sc->sc_rxaggr)
1470                                 ath_rx_aggr_teardown(sc, an, tidno);
1471                 }
1472         }
1473         an->an_flags = 0;
1474 }
1475
1476 /**************/
1477 /* Encryption */
1478 /**************/
1479
1480 void ath_key_reset(struct ath_softc *sc, u16 keyix, int freeslot)
1481 {
1482         ath9k_hw_keyreset(sc->sc_ah, keyix);
1483         if (freeslot)
1484                 clear_bit(keyix, sc->sc_keymap);
1485 }
1486
1487 int ath_keyset(struct ath_softc *sc,
1488                u16 keyix,
1489                struct ath9k_keyval *hk,
1490                const u8 mac[ETH_ALEN])
1491 {
1492         bool status;
1493
1494         status = ath9k_hw_set_keycache_entry(sc->sc_ah,
1495                 keyix, hk, mac, false);
1496
1497         return status != false;
1498 }
1499
1500 /***********************/
1501 /* TX Power/Regulatory */
1502 /***********************/
1503
1504 /*
1505  *  Set Transmit power in HAL
1506  *
1507  *  This routine makes the actual HAL calls to set the new transmit power
1508  *  limit.
1509 */
1510
1511 void ath_update_txpow(struct ath_softc *sc)
1512 {
1513         struct ath_hal *ah = sc->sc_ah;
1514         u32 txpow;
1515
1516         if (sc->sc_curtxpow != sc->sc_config.txpowlimit) {
1517                 ath9k_hw_set_txpowerlimit(ah, sc->sc_config.txpowlimit);
1518                 /* read back in case value is clamped */
1519                 ath9k_hw_getcapability(ah, ATH9K_CAP_TXPOW, 1, &txpow);
1520                 sc->sc_curtxpow = txpow;
1521         }
1522 }
1523
1524 /* Return the current country and domain information */
1525 void ath_get_currentCountry(struct ath_softc *sc,
1526         struct ath9k_country_entry *ctry)
1527 {
1528         ath9k_regd_get_current_country(sc->sc_ah, ctry);
1529
1530         /* If HAL not specific yet, since it is band dependent,
1531          * use the one we passed in. */
1532         if (ctry->countryCode == CTRY_DEFAULT) {
1533                 ctry->iso[0] = 0;
1534                 ctry->iso[1] = 0;
1535         } else if (ctry->iso[0] && ctry->iso[1]) {
1536                 if (!ctry->iso[2]) {
1537                         if (ath_outdoor)
1538                                 ctry->iso[2] = 'O';
1539                         else
1540                                 ctry->iso[2] = 'I';
1541                 }
1542         }
1543 }
1544
1545 /**************************/
1546 /* Slow Antenna Diversity */
1547 /**************************/
1548
1549 void ath_slow_ant_div_init(struct ath_antdiv *antdiv,
1550                            struct ath_softc *sc,
1551                            int32_t rssitrig)
1552 {
1553         int trig;
1554
1555         /* antdivf_rssitrig can range from 40 - 0xff */
1556         trig = (rssitrig > 0xff) ? 0xff : rssitrig;
1557         trig = (rssitrig < 40) ? 40 : rssitrig;
1558
1559         antdiv->antdiv_sc = sc;
1560         antdiv->antdivf_rssitrig = trig;
1561 }
1562
1563 void ath_slow_ant_div_start(struct ath_antdiv *antdiv,
1564                             u8 num_antcfg,
1565                             const u8 *bssid)
1566 {
1567         antdiv->antdiv_num_antcfg =
1568                 num_antcfg < ATH_ANT_DIV_MAX_CFG ?
1569                 num_antcfg : ATH_ANT_DIV_MAX_CFG;
1570         antdiv->antdiv_state = ATH_ANT_DIV_IDLE;
1571         antdiv->antdiv_curcfg = 0;
1572         antdiv->antdiv_bestcfg = 0;
1573         antdiv->antdiv_laststatetsf = 0;
1574
1575         memcpy(antdiv->antdiv_bssid, bssid, sizeof(antdiv->antdiv_bssid));
1576
1577         antdiv->antdiv_start = 1;
1578 }
1579
1580 void ath_slow_ant_div_stop(struct ath_antdiv *antdiv)
1581 {
1582         antdiv->antdiv_start = 0;
1583 }
1584
1585 static int32_t ath_find_max_val(int32_t *val,
1586         u8 num_val, u8 *max_index)
1587 {
1588         u32 MaxVal = *val++;
1589         u32 cur_index = 0;
1590
1591         *max_index = 0;
1592         while (++cur_index < num_val) {
1593                 if (*val > MaxVal) {
1594                         MaxVal = *val;
1595                         *max_index = cur_index;
1596                 }
1597
1598                 val++;
1599         }
1600
1601         return MaxVal;
1602 }
1603
1604 void ath_slow_ant_div(struct ath_antdiv *antdiv,
1605                       struct ieee80211_hdr *hdr,
1606                       struct ath_rx_status *rx_stats)
1607 {
1608         struct ath_softc *sc = antdiv->antdiv_sc;
1609         struct ath_hal *ah = sc->sc_ah;
1610         u64 curtsf = 0;
1611         u8 bestcfg, curcfg = antdiv->antdiv_curcfg;
1612         __le16 fc = hdr->frame_control;
1613
1614         if (antdiv->antdiv_start && ieee80211_is_beacon(fc)
1615             && !compare_ether_addr(hdr->addr3, antdiv->antdiv_bssid)) {
1616                 antdiv->antdiv_lastbrssi[curcfg] = rx_stats->rs_rssi;
1617                 antdiv->antdiv_lastbtsf[curcfg] = ath9k_hw_gettsf64(sc->sc_ah);
1618                 curtsf = antdiv->antdiv_lastbtsf[curcfg];
1619         } else {
1620                 return;
1621         }
1622
1623         switch (antdiv->antdiv_state) {
1624         case ATH_ANT_DIV_IDLE:
1625                 if ((antdiv->antdiv_lastbrssi[curcfg] <
1626                      antdiv->antdivf_rssitrig)
1627                     && ((curtsf - antdiv->antdiv_laststatetsf) >
1628                         ATH_ANT_DIV_MIN_IDLE_US)) {
1629
1630                         curcfg++;
1631                         if (curcfg == antdiv->antdiv_num_antcfg)
1632                                 curcfg = 0;
1633
1634                         if (!ath9k_hw_select_antconfig(ah, curcfg)) {
1635                                 antdiv->antdiv_bestcfg = antdiv->antdiv_curcfg;
1636                                 antdiv->antdiv_curcfg = curcfg;
1637                                 antdiv->antdiv_laststatetsf = curtsf;
1638                                 antdiv->antdiv_state = ATH_ANT_DIV_SCAN;
1639                         }
1640                 }
1641                 break;
1642
1643         case ATH_ANT_DIV_SCAN:
1644                 if ((curtsf - antdiv->antdiv_laststatetsf) <
1645                     ATH_ANT_DIV_MIN_SCAN_US)
1646                         break;
1647
1648                 curcfg++;
1649                 if (curcfg == antdiv->antdiv_num_antcfg)
1650                         curcfg = 0;
1651
1652                 if (curcfg == antdiv->antdiv_bestcfg) {
1653                         ath_find_max_val(antdiv->antdiv_lastbrssi,
1654                                    antdiv->antdiv_num_antcfg, &bestcfg);
1655                         if (!ath9k_hw_select_antconfig(ah, bestcfg)) {
1656                                 antdiv->antdiv_bestcfg = bestcfg;
1657                                 antdiv->antdiv_curcfg = bestcfg;
1658                                 antdiv->antdiv_laststatetsf = curtsf;
1659                                 antdiv->antdiv_state = ATH_ANT_DIV_IDLE;
1660                         }
1661                 } else {
1662                         if (!ath9k_hw_select_antconfig(ah, curcfg)) {
1663                                 antdiv->antdiv_curcfg = curcfg;
1664                                 antdiv->antdiv_laststatetsf = curtsf;
1665                                 antdiv->antdiv_state = ATH_ANT_DIV_SCAN;
1666                         }
1667                 }
1668
1669                 break;
1670         }
1671 }
1672
1673 /***********************/
1674 /* Descriptor Handling */
1675 /***********************/
1676
1677 /*
1678  *  Set up DMA descriptors
1679  *
1680  *  This function will allocate both the DMA descriptor structure, and the
1681  *  buffers it contains.  These are used to contain the descriptors used
1682  *  by the system.
1683 */
1684
1685 int ath_descdma_setup(struct ath_softc *sc,
1686                       struct ath_descdma *dd,
1687                       struct list_head *head,
1688                       const char *name,
1689                       int nbuf,
1690                       int ndesc)
1691 {
1692 #define DS2PHYS(_dd, _ds)                                               \
1693         ((_dd)->dd_desc_paddr + ((caddr_t)(_ds) - (caddr_t)(_dd)->dd_desc))
1694 #define ATH_DESC_4KB_BOUND_CHECK(_daddr) ((((_daddr) & 0xFFF) > 0xF7F) ? 1 : 0)
1695 #define ATH_DESC_4KB_BOUND_NUM_SKIPPED(_len) ((_len) / 4096)
1696
1697         struct ath_desc *ds;
1698         struct ath_buf *bf;
1699         int i, bsize, error;
1700
1701         DPRINTF(sc, ATH_DBG_CONFIG, "%s: %s DMA: %u buffers %u desc/buf\n",
1702                 __func__, name, nbuf, ndesc);
1703
1704         /* ath_desc must be a multiple of DWORDs */
1705         if ((sizeof(struct ath_desc) % 4) != 0) {
1706                 DPRINTF(sc, ATH_DBG_FATAL, "%s: ath_desc not DWORD aligned\n",
1707                         __func__);
1708                 ASSERT((sizeof(struct ath_desc) % 4) == 0);
1709                 error = -ENOMEM;
1710                 goto fail;
1711         }
1712
1713         dd->dd_name = name;
1714         dd->dd_desc_len = sizeof(struct ath_desc) * nbuf * ndesc;
1715
1716         /*
1717          * Need additional DMA memory because we can't use
1718          * descriptors that cross the 4K page boundary. Assume
1719          * one skipped descriptor per 4K page.
1720          */
1721         if (!(sc->sc_ah->ah_caps.hw_caps & ATH9K_HW_CAP_4KB_SPLITTRANS)) {
1722                 u32 ndesc_skipped =
1723                         ATH_DESC_4KB_BOUND_NUM_SKIPPED(dd->dd_desc_len);
1724                 u32 dma_len;
1725
1726                 while (ndesc_skipped) {
1727                         dma_len = ndesc_skipped * sizeof(struct ath_desc);
1728                         dd->dd_desc_len += dma_len;
1729
1730                         ndesc_skipped = ATH_DESC_4KB_BOUND_NUM_SKIPPED(dma_len);
1731                 };
1732         }
1733
1734         /* allocate descriptors */
1735         dd->dd_desc = pci_alloc_consistent(sc->pdev,
1736                               dd->dd_desc_len,
1737                               &dd->dd_desc_paddr);
1738         if (dd->dd_desc == NULL) {
1739                 error = -ENOMEM;
1740                 goto fail;
1741         }
1742         ds = dd->dd_desc;
1743         DPRINTF(sc, ATH_DBG_CONFIG, "%s: %s DMA map: %p (%u) -> %llx (%u)\n",
1744                 __func__, dd->dd_name, ds, (u32) dd->dd_desc_len,
1745                 ito64(dd->dd_desc_paddr), /*XXX*/(u32) dd->dd_desc_len);
1746
1747         /* allocate buffers */
1748         bsize = sizeof(struct ath_buf) * nbuf;
1749         bf = kmalloc(bsize, GFP_KERNEL);
1750         if (bf == NULL) {
1751                 error = -ENOMEM;
1752                 goto fail2;
1753         }
1754         memzero(bf, bsize);
1755         dd->dd_bufptr = bf;
1756
1757         INIT_LIST_HEAD(head);
1758         for (i = 0; i < nbuf; i++, bf++, ds += ndesc) {
1759                 bf->bf_desc = ds;
1760                 bf->bf_daddr = DS2PHYS(dd, ds);
1761
1762                 if (!(sc->sc_ah->ah_caps.hw_caps &
1763                       ATH9K_HW_CAP_4KB_SPLITTRANS)) {
1764                         /*
1765                          * Skip descriptor addresses which can cause 4KB
1766                          * boundary crossing (addr + length) with a 32 dword
1767                          * descriptor fetch.
1768                          */
1769                         while (ATH_DESC_4KB_BOUND_CHECK(bf->bf_daddr)) {
1770                                 ASSERT((caddr_t) bf->bf_desc <
1771                                        ((caddr_t) dd->dd_desc +
1772                                         dd->dd_desc_len));
1773
1774                                 ds += ndesc;
1775                                 bf->bf_desc = ds;
1776                                 bf->bf_daddr = DS2PHYS(dd, ds);
1777                         }
1778                 }
1779                 list_add_tail(&bf->list, head);
1780         }
1781         return 0;
1782 fail2:
1783         pci_free_consistent(sc->pdev,
1784                 dd->dd_desc_len, dd->dd_desc, dd->dd_desc_paddr);
1785 fail:
1786         memzero(dd, sizeof(*dd));
1787         return error;
1788 #undef ATH_DESC_4KB_BOUND_CHECK
1789 #undef ATH_DESC_4KB_BOUND_NUM_SKIPPED
1790 #undef DS2PHYS
1791 }
1792
1793 /*
1794  *  Cleanup DMA descriptors
1795  *
1796  *  This function will free the DMA block that was allocated for the descriptor
1797  *  pool.  Since this was allocated as one "chunk", it is freed in the same
1798  *  manner.
1799 */
1800
1801 void ath_descdma_cleanup(struct ath_softc *sc,
1802                          struct ath_descdma *dd,
1803                          struct list_head *head)
1804 {
1805         /* Free memory associated with descriptors */
1806         pci_free_consistent(sc->pdev,
1807                 dd->dd_desc_len, dd->dd_desc, dd->dd_desc_paddr);
1808
1809         INIT_LIST_HEAD(head);
1810         kfree(dd->dd_bufptr);
1811         memzero(dd, sizeof(*dd));
1812 }
1813
1814 /*************/
1815 /* Utilities */
1816 /*************/
1817
1818 void ath_internal_reset(struct ath_softc *sc)
1819 {
1820         ath_reset_start(sc, 0);
1821         ath_reset(sc);
1822         ath_reset_end(sc, 0);
1823 }
1824
1825 int ath_get_hal_qnum(u16 queue, struct ath_softc *sc)
1826 {
1827         int qnum;
1828
1829         switch (queue) {
1830         case 0:
1831                 qnum = sc->sc_haltype2q[ATH9K_WME_AC_VO];
1832                 break;
1833         case 1:
1834                 qnum = sc->sc_haltype2q[ATH9K_WME_AC_VI];
1835                 break;
1836         case 2:
1837                 qnum = sc->sc_haltype2q[ATH9K_WME_AC_BE];
1838                 break;
1839         case 3:
1840                 qnum = sc->sc_haltype2q[ATH9K_WME_AC_BK];
1841                 break;
1842         default:
1843                 qnum = sc->sc_haltype2q[ATH9K_WME_AC_BE];
1844                 break;
1845         }
1846
1847         return qnum;
1848 }
1849
1850 int ath_get_mac80211_qnum(u32 queue, struct ath_softc *sc)
1851 {
1852         int qnum;
1853
1854         switch (queue) {
1855         case ATH9K_WME_AC_VO:
1856                 qnum = 0;
1857                 break;
1858         case ATH9K_WME_AC_VI:
1859                 qnum = 1;
1860                 break;
1861         case ATH9K_WME_AC_BE:
1862                 qnum = 2;
1863                 break;
1864         case ATH9K_WME_AC_BK:
1865                 qnum = 3;
1866                 break;
1867         default:
1868                 qnum = -1;
1869                 break;
1870         }
1871
1872         return qnum;
1873 }
1874
1875
1876 /*
1877  *  Expand time stamp to TSF
1878  *
1879  *  Extend 15-bit time stamp from rx descriptor to
1880  *  a full 64-bit TSF using the current h/w TSF.
1881 */
1882
1883 u64 ath_extend_tsf(struct ath_softc *sc, u32 rstamp)
1884 {
1885         u64 tsf;
1886
1887         tsf = ath9k_hw_gettsf64(sc->sc_ah);
1888         if ((tsf & 0x7fff) < rstamp)
1889                 tsf -= 0x8000;
1890         return (tsf & ~0x7fff) | rstamp;
1891 }
1892
1893 /*
1894  *  Set Default Antenna
1895  *
1896  *  Call into the HAL to set the default antenna to use.  Not really valid for
1897  *  MIMO technology.
1898 */
1899
1900 void ath_setdefantenna(void *context, u32 antenna)
1901 {
1902         struct ath_softc *sc = (struct ath_softc *)context;
1903         struct ath_hal *ah = sc->sc_ah;
1904
1905         /* XXX block beacon interrupts */
1906         ath9k_hw_setantenna(ah, antenna);
1907         sc->sc_defant = antenna;
1908         sc->sc_rxotherant = 0;
1909 }
1910
1911 /*
1912  * Set Slot Time
1913  *
1914  * This will wake up the chip if required, and set the slot time for the
1915  * frame (maximum transmit time).  Slot time is assumed to be already set
1916  * in the ATH object member sc_slottime
1917 */
1918
1919 void ath_setslottime(struct ath_softc *sc)
1920 {
1921         ath9k_hw_setslottime(sc->sc_ah, sc->sc_slottime);
1922         sc->sc_updateslot = OK;
1923 }