ath9k: Remove duplicate variables
[safe/jmp/linux-2.6] / drivers / net / wireless / ath9k / recv.c
index 20f8377..c51c085 100644 (file)
@@ -14,7 +14,7 @@
  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  */
 
-#include "core.h"
+#include "ath9k.h"
 
 /*
  * Setup and link descriptors.
@@ -41,20 +41,44 @@ static void ath_rx_buf_link(struct ath_softc *sc, struct ath_buf *bf)
        ASSERT(skb != NULL);
        ds->ds_vdata = skb->data;
 
-       /* setup rx descriptors */
+       /* setup rx descriptors. The rx.bufsize here tells the harware
+        * how much data it can DMA to us and that we are prepared
+        * to process */
        ath9k_hw_setuprxdesc(ah, ds,
-                            skb_tailroom(skb), /* buffer size */
+                            sc->rx.bufsize,
                             0);
 
-       if (sc->sc_rxlink == NULL)
+       if (sc->rx.rxlink == NULL)
                ath9k_hw_putrxbuf(ah, bf->bf_daddr);
        else
-               *sc->sc_rxlink = bf->bf_daddr;
+               *sc->rx.rxlink = bf->bf_daddr;
 
-       sc->sc_rxlink = &ds->ds_link;
+       sc->rx.rxlink = &ds->ds_link;
        ath9k_hw_rxena(ah);
 }
 
+static void ath_setdefantenna(struct ath_softc *sc, u32 antenna)
+{
+       /* XXX block beacon interrupts */
+       ath9k_hw_setantenna(sc->sc_ah, antenna);
+       sc->rx.defant = antenna;
+       sc->rx.rxotherant = 0;
+}
+
+/*
+ *  Extend 15-bit time stamp from rx descriptor to
+ *  a full 64-bit TSF using the current h/w TSF.
+*/
+static u64 ath_extend_tsf(struct ath_softc *sc, u32 rstamp)
+{
+       u64 tsf;
+
+       tsf = ath9k_hw_gettsf64(sc->sc_ah);
+       if ((tsf & 0x7fff) < rstamp)
+               tsf -= 0x8000;
+       return (tsf & ~0x7fff) | rstamp;
+}
+
 static struct sk_buff *ath_rxbuf_alloc(struct ath_softc *sc, u32 len)
 {
        struct sk_buff *skb;
@@ -66,71 +90,27 @@ static struct sk_buff *ath_rxbuf_alloc(struct ath_softc *sc, u32 len)
         * in rx'd frames.
         */
 
-       skb = dev_alloc_skb(len + sc->sc_cachelsz - 1);
+       /* Note: the kernel can allocate a value greater than
+        * what we ask it to give us. We really only need 4 KB as that
+        * is this hardware supports and in fact we need at least 3849
+        * as that is the MAX AMSDU size this hardware supports.
+        * Unfortunately this means we may get 8 KB here from the
+        * kernel... and that is actually what is observed on some
+        * systems :( */
+       skb = dev_alloc_skb(len + sc->cachelsz - 1);
        if (skb != NULL) {
-               off = ((unsigned long) skb->data) % sc->sc_cachelsz;
+               off = ((unsigned long) skb->data) % sc->cachelsz;
                if (off != 0)
-                       skb_reserve(skb, sc->sc_cachelsz - off);
+                       skb_reserve(skb, sc->cachelsz - off);
        } else {
                DPRINTF(sc, ATH_DBG_FATAL,
-                       "%s: skbuff alloc of size %u failed\n",
-                       __func__, len);
+                       "skbuff alloc of size %u failed\n", len);
                return NULL;
        }
 
        return skb;
 }
 
-static void ath_rx_requeue(struct ath_softc *sc, struct ath_buf *bf)
-{
-       struct sk_buff *skb;
-
-       ASSERT(bf != NULL);
-
-       if (bf->bf_mpdu == NULL) {
-               skb = ath_rxbuf_alloc(sc, sc->sc_rxbufsize);
-               if (skb != NULL) {
-                       bf->bf_mpdu = skb;
-                       bf->bf_buf_addr = pci_map_single(sc->pdev, skb->data,
-                                                skb_end_pointer(skb) - skb->head,
-                                                PCI_DMA_FROMDEVICE);
-                       bf->bf_dmacontext = bf->bf_buf_addr;
-
-               }
-       }
-
-       list_move_tail(&bf->list, &sc->sc_rxbuf);
-       ath_rx_buf_link(sc, bf);
-}
-
-
-static int ath_rate2idx(struct ath_softc *sc, int rate)
-{
-       int i = 0, cur_band, n_rates;
-       struct ieee80211_hw *hw = sc->hw;
-
-       cur_band = hw->conf.channel->band;
-       n_rates = sc->sbands[cur_band].n_bitrates;
-
-       for (i = 0; i < n_rates; i++) {
-               if (sc->sbands[cur_band].bitrates[i].bitrate == rate)
-                       break;
-       }
-
-       /*
-        * NB:mac80211 validates rx rate index against the supported legacy rate
-        * index only (should be done against ht rates also), return the highest
-        * legacy rate index for rx rate which does not match any one of the
-        * supported basic and extended rates to make mac80211 happy.
-        * The following hack will be cleaned up once the issue with
-        * the rx rate index validation in mac80211 is fixed.
-        */
-       if (i == n_rates)
-               return n_rates - 1;
-
-       return i;
-}
-
 /*
  * For Decrypt or Demic errors, we only mark packet status here and always push
  * up the frame up to let mac80211 handle the actual error case, be it no
@@ -140,9 +120,7 @@ static int ath_rx_prepare(struct sk_buff *skb, struct ath_desc *ds,
                          struct ieee80211_rx_status *rx_status, bool *decrypt_error,
                          struct ath_softc *sc)
 {
-       struct ath_rate_table *rate_table = sc->hw_rate_table[sc->sc_curmode];
        struct ieee80211_hdr *hdr;
-       int ratekbps, rix;
        u8 ratecode;
        __le16 fc;
 
@@ -157,7 +135,7 @@ static int ath_rx_prepare(struct sk_buff *skb, struct ath_desc *ds,
                 * discard the frame. Enable this if you want to see
                 * error frames in Monitor mode.
                 */
-               if (sc->sc_ah->ah_opmode != ATH9K_M_MONITOR)
+               if (sc->sc_ah->ah_opmode != NL80211_IFTYPE_MONITOR)
                        goto rx_next;
        } else if (ds->ds_rxstat.rs_status != 0) {
                if (ds->ds_rxstat.rs_status & ATH9K_RXERR_CRC)
@@ -183,7 +161,7 @@ static int ath_rx_prepare(struct sk_buff *skb, struct ath_desc *ds,
                 * decryption and MIC failures. For monitor mode,
                 * we also ignore the CRC error.
                 */
-               if (sc->sc_ah->ah_opmode == ATH9K_M_MONITOR) {
+               if (sc->sc_ah->ah_opmode == NL80211_IFTYPE_MONITOR) {
                        if (ds->ds_rxstat.rs_status &
                            ~(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC |
                              ATH9K_RXERR_CRC))
@@ -197,23 +175,43 @@ static int ath_rx_prepare(struct sk_buff *skb, struct ath_desc *ds,
        }
 
        ratecode = ds->ds_rxstat.rs_rate;
-       rix = rate_table->rateCodeToIndex[ratecode];
-       ratekbps = rate_table->info[rix].ratekbps;
 
-       /* HT rate */
        if (ratecode & 0x80) {
+               /* HT rate */
+               rx_status->flag |= RX_FLAG_HT;
                if (ds->ds_rxstat.rs_flags & ATH9K_RX_2040)
-                       ratekbps = (ratekbps * 27) / 13;
+                       rx_status->flag |= RX_FLAG_40MHZ;
                if (ds->ds_rxstat.rs_flags & ATH9K_RX_GI)
-                       ratekbps = (ratekbps * 10) / 9;
+                       rx_status->flag |= RX_FLAG_SHORT_GI;
+               rx_status->rate_idx = ratecode & 0x7f;
+       } else {
+               int i = 0, cur_band, n_rates;
+               struct ieee80211_hw *hw = sc->hw;
+
+               cur_band = hw->conf.channel->band;
+               n_rates = sc->sbands[cur_band].n_bitrates;
+
+               for (i = 0; i < n_rates; i++) {
+                       if (sc->sbands[cur_band].bitrates[i].hw_value ==
+                           ratecode) {
+                               rx_status->rate_idx = i;
+                               break;
+                       }
+
+                       if (sc->sbands[cur_band].bitrates[i].hw_value_short ==
+                           ratecode) {
+                               rx_status->rate_idx = i;
+                               rx_status->flag |= RX_FLAG_SHORTPRE;
+                               break;
+                       }
+               }
        }
 
        rx_status->mactime = ath_extend_tsf(sc, ds->ds_rxstat.rs_tstamp);
        rx_status->band = sc->hw->conf.channel->band;
        rx_status->freq =  sc->hw->conf.channel->center_freq;
-       rx_status->noise = sc->sc_ani.sc_noise_floor;
+       rx_status->noise = sc->ani.noise_floor;
        rx_status->signal = rx_status->noise + ds->ds_rxstat.rs_rssi;
-       rx_status->rate_idx = ath_rate2idx(sc, (ratekbps / 100));
        rx_status->antenna = ds->ds_rxstat.rs_antenna;
 
        /* at 45 you will be able to use MCS 15 reliably. A more elaborate
@@ -244,21 +242,17 @@ static void ath_opmode_init(struct ath_softc *sc)
 
        /* configure bssid mask */
        if (ah->ah_caps.hw_caps & ATH9K_HW_CAP_BSSIDMASK)
-               ath9k_hw_setbssidmask(ah, sc->sc_bssidmask);
+               ath9k_hw_setbssidmask(sc);
 
        /* configure operational mode */
        ath9k_hw_setopmode(ah);
 
        /* Handle any link-level address change. */
-       ath9k_hw_setmac(ah, sc->sc_myaddr);
+       ath9k_hw_setmac(ah, sc->sc_ah->macaddr);
 
        /* calculate and install multicast filter */
        mfilt[0] = mfilt[1] = ~0;
-
        ath9k_hw_setmcastfilter(ah, mfilt[0], mfilt[1]);
-       DPRINTF(sc, ATH_DBG_CONFIG ,
-               "%s: RX filter 0x%x, MC filter %08x:%08x\n",
-               __func__, rfilt, mfilt[0], mfilt[1]);
 }
 
 int ath_rx_init(struct ath_softc *sc, int nbufs)
@@ -268,42 +262,50 @@ int ath_rx_init(struct ath_softc *sc, int nbufs)
        int error = 0;
 
        do {
-               spin_lock_init(&sc->sc_rxflushlock);
+               spin_lock_init(&sc->rx.rxflushlock);
                sc->sc_flags &= ~SC_OP_RXFLUSH;
-               spin_lock_init(&sc->sc_rxbuflock);
+               spin_lock_init(&sc->rx.rxbuflock);
 
-               sc->sc_rxbufsize = roundup(IEEE80211_MAX_MPDU_LEN,
-                                          min(sc->sc_cachelsz,
+               sc->rx.bufsize = roundup(IEEE80211_MAX_MPDU_LEN,
+                                          min(sc->cachelsz,
                                               (u16)64));
 
-               DPRINTF(sc, ATH_DBG_CONFIG, "%s: cachelsz %u rxbufsize %u\n",
-                       __func__, sc->sc_cachelsz, sc->sc_rxbufsize);
+               DPRINTF(sc, ATH_DBG_CONFIG, "cachelsz %u rxbufsize %u\n",
+                       sc->cachelsz, sc->rx.bufsize);
 
                /* Initialize rx descriptors */
 
-               error = ath_descdma_setup(sc, &sc->sc_rxdma, &sc->sc_rxbuf,
+               error = ath_descdma_setup(sc, &sc->rx.rxdma, &sc->rx.rxbuf,
                                          "rx", nbufs, 1);
                if (error != 0) {
                        DPRINTF(sc, ATH_DBG_FATAL,
-                               "%s: failed to allocate rx descriptors: %d\n",
-                               __func__, error);
+                               "failed to allocate rx descriptors: %d\n", error);
                        break;
                }
 
-               list_for_each_entry(bf, &sc->sc_rxbuf, list) {
-                       skb = ath_rxbuf_alloc(sc, sc->sc_rxbufsize);
+               list_for_each_entry(bf, &sc->rx.rxbuf, list) {
+                       skb = ath_rxbuf_alloc(sc, sc->rx.bufsize);
                        if (skb == NULL) {
                                error = -ENOMEM;
                                break;
                        }
 
                        bf->bf_mpdu = skb;
-                       bf->bf_buf_addr = pci_map_single(sc->pdev, skb->data,
-                                        skb_end_pointer(skb) - skb->head,
-                                        PCI_DMA_FROMDEVICE);
+                       bf->bf_buf_addr = dma_map_single(sc->dev, skb->data,
+                                                        sc->rx.bufsize,
+                                                        DMA_FROM_DEVICE);
+                       if (unlikely(dma_mapping_error(sc->dev,
+                                 bf->bf_buf_addr))) {
+                               dev_kfree_skb_any(skb);
+                               bf->bf_mpdu = NULL;
+                               DPRINTF(sc, ATH_DBG_CONFIG,
+                                       "dma_mapping_error() on RX init\n");
+                               error = -ENOMEM;
+                               break;
+                       }
                        bf->bf_dmacontext = bf->bf_buf_addr;
                }
-               sc->sc_rxlink = NULL;
+               sc->rx.rxlink = NULL;
 
        } while (0);
 
@@ -318,14 +320,14 @@ void ath_rx_cleanup(struct ath_softc *sc)
        struct sk_buff *skb;
        struct ath_buf *bf;
 
-       list_for_each_entry(bf, &sc->sc_rxbuf, list) {
+       list_for_each_entry(bf, &sc->rx.rxbuf, list) {
                skb = bf->bf_mpdu;
                if (skb)
                        dev_kfree_skb(skb);
        }
 
-       if (sc->sc_rxdma.dd_desc_len != 0)
-               ath_descdma_cleanup(sc, &sc->sc_rxdma, &sc->sc_rxbuf);
+       if (sc->rx.rxdma.dd_desc_len != 0)
+               ath_descdma_cleanup(sc, &sc->rx.rxdma, &sc->rx.rxbuf);
 }
 
 /*
@@ -358,25 +360,28 @@ u32 ath_calcrxfilter(struct ath_softc *sc)
                | ATH9K_RX_FILTER_MCAST;
 
        /* If not a STA, enable processing of Probe Requests */
-       if (sc->sc_ah->ah_opmode != ATH9K_M_STA)
+       if (sc->sc_ah->ah_opmode != NL80211_IFTYPE_STATION)
                rfilt |= ATH9K_RX_FILTER_PROBEREQ;
 
        /* Can't set HOSTAP into promiscous mode */
-       if (((sc->sc_ah->ah_opmode != ATH9K_M_HOSTAP) &&
-            (sc->rx_filter & FIF_PROMISC_IN_BSS)) ||
-           (sc->sc_ah->ah_opmode == ATH9K_M_MONITOR)) {
+       if (((sc->sc_ah->ah_opmode != NL80211_IFTYPE_AP) &&
+            (sc->rx.rxfilter & FIF_PROMISC_IN_BSS)) ||
+           (sc->sc_ah->ah_opmode == NL80211_IFTYPE_MONITOR)) {
                rfilt |= ATH9K_RX_FILTER_PROM;
                /* ??? To prevent from sending ACK */
                rfilt &= ~ATH9K_RX_FILTER_UCAST;
        }
 
-       if (sc->sc_ah->ah_opmode == ATH9K_M_STA ||
-           sc->sc_ah->ah_opmode == ATH9K_M_IBSS)
+       if (sc->rx.rxfilter & FIF_CONTROL)
+               rfilt |= ATH9K_RX_FILTER_CONTROL;
+
+       if (sc->sc_ah->ah_opmode == NL80211_IFTYPE_STATION ||
+           sc->sc_ah->ah_opmode == NL80211_IFTYPE_ADHOC)
                rfilt |= ATH9K_RX_FILTER_BEACON;
 
        /* If in HOSTAP mode, want to enable reception of PSPOLL frames
           & beacon frames */
-       if (sc->sc_ah->ah_opmode == ATH9K_M_HOSTAP)
+       if (sc->sc_ah->ah_opmode == NL80211_IFTYPE_AP)
                rfilt |= (ATH9K_RX_FILTER_BEACON | ATH9K_RX_FILTER_PSPOLL);
 
        return rfilt;
@@ -389,25 +394,25 @@ int ath_startrecv(struct ath_softc *sc)
        struct ath_hal *ah = sc->sc_ah;
        struct ath_buf *bf, *tbf;
 
-       spin_lock_bh(&sc->sc_rxbuflock);
-       if (list_empty(&sc->sc_rxbuf))
+       spin_lock_bh(&sc->rx.rxbuflock);
+       if (list_empty(&sc->rx.rxbuf))
                goto start_recv;
 
-       sc->sc_rxlink = NULL;
-       list_for_each_entry_safe(bf, tbf, &sc->sc_rxbuf, list) {
+       sc->rx.rxlink = NULL;
+       list_for_each_entry_safe(bf, tbf, &sc->rx.rxbuf, list) {
                ath_rx_buf_link(sc, bf);
        }
 
        /* We could have deleted elements so the list may be empty now */
-       if (list_empty(&sc->sc_rxbuf))
+       if (list_empty(&sc->rx.rxbuf))
                goto start_recv;
 
-       bf = list_first_entry(&sc->sc_rxbuf, struct ath_buf, list);
+       bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list);
        ath9k_hw_putrxbuf(ah, bf->bf_daddr);
        ath9k_hw_rxena(ah);
 
 start_recv:
-       spin_unlock_bh(&sc->sc_rxbuflock);
+       spin_unlock_bh(&sc->rx.rxbuflock);
        ath_opmode_init(sc);
        ath9k_hw_startpcureceive(ah);
 
@@ -423,29 +428,29 @@ bool ath_stoprecv(struct ath_softc *sc)
        ath9k_hw_setrxfilter(ah, 0);
        stopped = ath9k_hw_stopdmarecv(ah);
        mdelay(3); /* 3ms is long enough for 1 frame */
-       sc->sc_rxlink = NULL;
+       sc->rx.rxlink = NULL;
 
        return stopped;
 }
 
 void ath_flushrecv(struct ath_softc *sc)
 {
-       spin_lock_bh(&sc->sc_rxflushlock);
+       spin_lock_bh(&sc->rx.rxflushlock);
        sc->sc_flags |= SC_OP_RXFLUSH;
        ath_rx_tasklet(sc, 1);
        sc->sc_flags &= ~SC_OP_RXFLUSH;
-       spin_unlock_bh(&sc->sc_rxflushlock);
+       spin_unlock_bh(&sc->rx.rxflushlock);
 }
 
 int ath_rx_tasklet(struct ath_softc *sc, int flush)
 {
 #define PA2DESC(_sc, _pa)                                               \
-       ((struct ath_desc *)((caddr_t)(_sc)->sc_rxdma.dd_desc +         \
-                            ((_pa) - (_sc)->sc_rxdma.dd_desc_paddr)))
+       ((struct ath_desc *)((caddr_t)(_sc)->rx.rxdma.dd_desc +         \
+                            ((_pa) - (_sc)->rx.rxdma.dd_desc_paddr)))
 
        struct ath_buf *bf;
        struct ath_desc *ds;
-       struct sk_buff *skb = NULL;
+       struct sk_buff *skb = NULL, *requeue_skb;
        struct ieee80211_rx_status rx_status;
        struct ath_hal *ah = sc->sc_ah;
        struct ieee80211_hdr *hdr;
@@ -453,19 +458,19 @@ int ath_rx_tasklet(struct ath_softc *sc, int flush)
        bool decrypt_error = false;
        u8 keyix;
 
-       spin_lock_bh(&sc->sc_rxbuflock);
+       spin_lock_bh(&sc->rx.rxbuflock);
 
        do {
                /* If handling rx interrupt and flush is in progress => exit */
                if ((sc->sc_flags & SC_OP_RXFLUSH) && (flush == 0))
                        break;
 
-               if (list_empty(&sc->sc_rxbuf)) {
-                       sc->sc_rxlink = NULL;
+               if (list_empty(&sc->rx.rxbuf)) {
+                       sc->rx.rxlink = NULL;
                        break;
                }
 
-               bf = list_first_entry(&sc->sc_rxbuf, struct ath_buf, list);
+               bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list);
                ds = bf->bf_desc;
 
                /*
@@ -487,8 +492,8 @@ int ath_rx_tasklet(struct ath_softc *sc, int flush)
                        struct ath_buf *tbf;
                        struct ath_desc *tds;
 
-                       if (list_is_last(&bf->list, &sc->sc_rxbuf)) {
-                               sc->sc_rxlink = NULL;
+                       if (list_is_last(&bf->list, &sc->rx.rxbuf)) {
+                               sc->rx.rxlink = NULL;
                                break;
                        }
 
@@ -518,29 +523,46 @@ int ath_rx_tasklet(struct ath_softc *sc, int flush)
                        continue;
 
                /*
+                * Synchronize the DMA transfer with CPU before
+                * 1. accessing the frame
+                * 2. requeueing the same buffer to h/w
+                */
+               dma_sync_single_for_cpu(sc->dev, bf->bf_buf_addr,
+                               sc->rx.bufsize,
+                               DMA_FROM_DEVICE);
+
+               /*
                 * If we're asked to flush receive queue, directly
                 * chain it back at the queue without processing it.
                 */
                if (flush)
-                       goto rx_next;
+                       goto requeue;
 
                if (!ds->ds_rxstat.rs_datalen)
-                       goto rx_next;
+                       goto requeue;
 
                /* The status portion of the descriptor could get corrupted. */
-               if (sc->sc_rxbufsize < ds->ds_rxstat.rs_datalen)
-                       goto rx_next;
+               if (sc->rx.bufsize < ds->ds_rxstat.rs_datalen)
+                       goto requeue;
 
                if (!ath_rx_prepare(skb, ds, &rx_status, &decrypt_error, sc))
-                       goto rx_next;
+                       goto requeue;
+
+               /* Ensure we always have an skb to requeue once we are done
+                * processing the current buffer's skb */
+               requeue_skb = ath_rxbuf_alloc(sc, sc->rx.bufsize);
 
-               /* Sync and unmap the frame */
-               pci_dma_sync_single_for_cpu(sc->pdev, bf->bf_buf_addr,
-                                           skb_tailroom(skb),
-                                           PCI_DMA_FROMDEVICE);
-               pci_unmap_single(sc->pdev, bf->bf_buf_addr,
-                                sc->sc_rxbufsize,
-                                PCI_DMA_FROMDEVICE);
+               /* If there is no memory we ignore the current RX'd frame,
+                * tell hardware it can give us a new frame using the old
+                * skb and put it at the tail of the sc->rx.rxbuf list for
+                * processing. */
+               if (!requeue_skb)
+                       goto requeue;
+
+               /* Unmap the frame */
+               dma_unmap_single(sc->dev, bf->bf_buf_addr,
+                                sc->rx.bufsize,
+                                DMA_FROM_DEVICE);
 
                skb_put(skb, ds->ds_rxstat.rs_datalen);
                skb->protocol = cpu_to_be16(ETH_P_CONTROL);
@@ -549,8 +571,16 @@ int ath_rx_tasklet(struct ath_softc *sc, int flush)
                hdr = (struct ieee80211_hdr *)skb->data;
                hdrlen = ieee80211_get_hdrlen_from_skb(skb);
 
-               if (hdrlen & 3) {
-                       padsize = hdrlen % 4;
+               /* The MAC header is padded to have 32-bit boundary if the
+                * packet payload is non-zero. The general calculation for
+                * padsize would take into account odd header lengths:
+                * padsize = (4 - hdrlen % 4) % 4; However, since only
+                * even-length headers are used, padding can only be 0 or 2
+                * bytes and we can optimize this a bit. In addition, we must
+                * not try to remove padding from short control frames that do
+                * not have payload. */
+               padsize = hdrlen & 3;
+               if (padsize && hdrlen >= 24) {
                        memmove(skb->data + padsize, skb->data, hdrlen);
                        skb_pull(skb, padsize);
                }
@@ -563,29 +593,56 @@ int ath_rx_tasklet(struct ath_softc *sc, int flush)
                           && !decrypt_error && skb->len >= hdrlen + 4) {
                        keyix = skb->data[hdrlen + 3] >> 6;
 
-                       if (test_bit(keyix, sc->sc_keymap))
+                       if (test_bit(keyix, sc->keymap))
                                rx_status.flag |= RX_FLAG_DECRYPTED;
                }
+               if (ah->sw_mgmt_crypto &&
+                   (rx_status.flag & RX_FLAG_DECRYPTED) &&
+                   ieee80211_is_mgmt(hdr->frame_control)) {
+                       /* Use software decrypt for management frames. */
+                       rx_status.flag &= ~RX_FLAG_DECRYPTED;
+               }
 
                /* Send the frame to mac80211 */
                __ieee80211_rx(sc->hw, skb, &rx_status);
-               bf->bf_mpdu = NULL;
+
+               /* We will now give hardware our shiny new allocated skb */
+               bf->bf_mpdu = requeue_skb;
+               bf->bf_buf_addr = dma_map_single(sc->dev, requeue_skb->data,
+                                        sc->rx.bufsize,
+                                        DMA_FROM_DEVICE);
+               if (unlikely(dma_mapping_error(sc->dev,
+                         bf->bf_buf_addr))) {
+                       dev_kfree_skb_any(requeue_skb);
+                       bf->bf_mpdu = NULL;
+                       DPRINTF(sc, ATH_DBG_CONFIG,
+                               "dma_mapping_error() on RX\n");
+                       break;
+               }
+               bf->bf_dmacontext = bf->bf_buf_addr;
 
                /*
                 * change the default rx antenna if rx diversity chooses the
                 * other antenna 3 times in a row.
                 */
-               if (sc->sc_defant != ds->ds_rxstat.rs_antenna) {
-                       if (++sc->sc_rxotherant >= 3)
+               if (sc->rx.defant != ds->ds_rxstat.rs_antenna) {
+                       if (++sc->rx.rxotherant >= 3)
                                ath_setdefantenna(sc, ds->ds_rxstat.rs_antenna);
                } else {
-                       sc->sc_rxotherant = 0;
+                       sc->rx.rxotherant = 0;
                }
-rx_next:
-               ath_rx_requeue(sc, bf);
+
+               if (ieee80211_is_beacon(hdr->frame_control) &&
+                               (sc->sc_flags & SC_OP_WAIT_FOR_BEACON)) {
+                       sc->sc_flags &= ~SC_OP_WAIT_FOR_BEACON;
+                       ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_NETWORK_SLEEP);
+               }
+requeue:
+               list_move_tail(&bf->list, &sc->rx.rxbuf);
+               ath_rx_buf_link(sc, bf);
        } while (1);
 
-       spin_unlock_bh(&sc->sc_rxbuflock);
+       spin_unlock_bh(&sc->rx.rxbuflock);
 
        return 0;
 #undef PA2DESC