Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 1 | /* |
Sujith | cee075a | 2009-03-13 09:07:23 +0530 | [diff] [blame] | 2 | * Copyright (c) 2008-2009 Atheros Communications Inc. |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 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 | |
Sujith | 394cf0a | 2009-02-09 13:26:54 +0530 | [diff] [blame] | 17 | #include "ath9k.h" |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 18 | |
Jouni Malinen | bce048d | 2009-03-03 19:23:28 +0200 | [diff] [blame] | 19 | static struct ieee80211_hw * ath_get_virt_hw(struct ath_softc *sc, |
| 20 | struct ieee80211_hdr *hdr) |
| 21 | { |
Jouni Malinen | c52f33d | 2009-03-03 19:23:29 +0200 | [diff] [blame] | 22 | struct ieee80211_hw *hw = sc->pri_wiphy->hw; |
| 23 | int i; |
| 24 | |
| 25 | spin_lock_bh(&sc->wiphy_lock); |
| 26 | for (i = 0; i < sc->num_sec_wiphy; i++) { |
| 27 | struct ath_wiphy *aphy = sc->sec_wiphy[i]; |
| 28 | if (aphy == NULL) |
| 29 | continue; |
| 30 | if (compare_ether_addr(hdr->addr1, aphy->hw->wiphy->perm_addr) |
| 31 | == 0) { |
| 32 | hw = aphy->hw; |
| 33 | break; |
| 34 | } |
| 35 | } |
| 36 | spin_unlock_bh(&sc->wiphy_lock); |
| 37 | return hw; |
Jouni Malinen | bce048d | 2009-03-03 19:23:28 +0200 | [diff] [blame] | 38 | } |
| 39 | |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 40 | /* |
| 41 | * Setup and link descriptors. |
| 42 | * |
| 43 | * 11N: we can no longer afford to self link the last descriptor. |
| 44 | * MAC acknowledges BA status as long as it copies frames to host |
| 45 | * buffer (or rx fifo). This can incorrectly acknowledge packets |
| 46 | * to a sender if last desc is self-linked. |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 47 | */ |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 48 | static void ath_rx_buf_link(struct ath_softc *sc, struct ath_buf *bf) |
| 49 | { |
Sujith | cbe61d8 | 2009-02-09 13:27:12 +0530 | [diff] [blame] | 50 | struct ath_hw *ah = sc->sc_ah; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 51 | struct ath_desc *ds; |
| 52 | struct sk_buff *skb; |
| 53 | |
| 54 | ATH_RXBUF_RESET(bf); |
| 55 | |
| 56 | ds = bf->bf_desc; |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 57 | ds->ds_link = 0; /* link to null */ |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 58 | ds->ds_data = bf->bf_buf_addr; |
| 59 | |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 60 | /* virtual addr of the beginning of the buffer. */ |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 61 | skb = bf->bf_mpdu; |
| 62 | ASSERT(skb != NULL); |
| 63 | ds->ds_vdata = skb->data; |
| 64 | |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 65 | /* setup rx descriptors. The rx.bufsize here tells the harware |
Luis R. Rodriguez | b4b6cda | 2008-11-20 17:15:13 -0800 | [diff] [blame] | 66 | * how much data it can DMA to us and that we are prepared |
| 67 | * to process */ |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 68 | ath9k_hw_setuprxdesc(ah, ds, |
| 69 | sc->rx.bufsize, |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 70 | 0); |
| 71 | |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 72 | if (sc->rx.rxlink == NULL) |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 73 | ath9k_hw_putrxbuf(ah, bf->bf_daddr); |
| 74 | else |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 75 | *sc->rx.rxlink = bf->bf_daddr; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 76 | |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 77 | sc->rx.rxlink = &ds->ds_link; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 78 | ath9k_hw_rxena(ah); |
| 79 | } |
| 80 | |
Sujith | ff37e33 | 2008-11-24 12:07:55 +0530 | [diff] [blame] | 81 | static void ath_setdefantenna(struct ath_softc *sc, u32 antenna) |
| 82 | { |
| 83 | /* XXX block beacon interrupts */ |
| 84 | ath9k_hw_setantenna(sc->sc_ah, antenna); |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 85 | sc->rx.defant = antenna; |
| 86 | sc->rx.rxotherant = 0; |
Sujith | ff37e33 | 2008-11-24 12:07:55 +0530 | [diff] [blame] | 87 | } |
| 88 | |
| 89 | /* |
| 90 | * Extend 15-bit time stamp from rx descriptor to |
| 91 | * a full 64-bit TSF using the current h/w TSF. |
| 92 | */ |
| 93 | static u64 ath_extend_tsf(struct ath_softc *sc, u32 rstamp) |
| 94 | { |
| 95 | u64 tsf; |
| 96 | |
| 97 | tsf = ath9k_hw_gettsf64(sc->sc_ah); |
| 98 | if ((tsf & 0x7fff) < rstamp) |
| 99 | tsf -= 0x8000; |
| 100 | return (tsf & ~0x7fff) | rstamp; |
| 101 | } |
| 102 | |
Senthil Balasubramanian | f0e6ce1 | 2009-03-06 11:24:08 +0530 | [diff] [blame] | 103 | static struct sk_buff *ath_rxbuf_alloc(struct ath_softc *sc, u32 len, gfp_t gfp_mask) |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 104 | { |
| 105 | struct sk_buff *skb; |
| 106 | u32 off; |
| 107 | |
| 108 | /* |
| 109 | * Cache-line-align. This is important (for the |
| 110 | * 5210 at least) as not doing so causes bogus data |
| 111 | * in rx'd frames. |
| 112 | */ |
| 113 | |
Luis R. Rodriguez | b4b6cda | 2008-11-20 17:15:13 -0800 | [diff] [blame] | 114 | /* Note: the kernel can allocate a value greater than |
| 115 | * what we ask it to give us. We really only need 4 KB as that |
| 116 | * is this hardware supports and in fact we need at least 3849 |
| 117 | * as that is the MAX AMSDU size this hardware supports. |
| 118 | * Unfortunately this means we may get 8 KB here from the |
| 119 | * kernel... and that is actually what is observed on some |
| 120 | * systems :( */ |
Senthil Balasubramanian | f0e6ce1 | 2009-03-06 11:24:08 +0530 | [diff] [blame] | 121 | skb = __dev_alloc_skb(len + sc->cachelsz - 1, gfp_mask); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 122 | if (skb != NULL) { |
Sujith | 17d7904 | 2009-02-09 13:27:03 +0530 | [diff] [blame] | 123 | off = ((unsigned long) skb->data) % sc->cachelsz; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 124 | if (off != 0) |
Sujith | 17d7904 | 2009-02-09 13:27:03 +0530 | [diff] [blame] | 125 | skb_reserve(skb, sc->cachelsz - off); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 126 | } else { |
| 127 | DPRINTF(sc, ATH_DBG_FATAL, |
Sujith | 04bd4638 | 2008-11-28 22:18:05 +0530 | [diff] [blame] | 128 | "skbuff alloc of size %u failed\n", len); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 129 | return NULL; |
| 130 | } |
| 131 | |
| 132 | return skb; |
| 133 | } |
| 134 | |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 135 | /* |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 136 | * For Decrypt or Demic errors, we only mark packet status here and always push |
| 137 | * up the frame up to let mac80211 handle the actual error case, be it no |
| 138 | * decryption key or real decryption error. This let us keep statistics there. |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 139 | */ |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 140 | static int ath_rx_prepare(struct sk_buff *skb, struct ath_desc *ds, |
| 141 | struct ieee80211_rx_status *rx_status, bool *decrypt_error, |
| 142 | struct ath_softc *sc) |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 143 | { |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 144 | struct ieee80211_hdr *hdr; |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 145 | u8 ratecode; |
| 146 | __le16 fc; |
Jouni Malinen | bce048d | 2009-03-03 19:23:28 +0200 | [diff] [blame] | 147 | struct ieee80211_hw *hw; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 148 | |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 149 | hdr = (struct ieee80211_hdr *)skb->data; |
| 150 | fc = hdr->frame_control; |
| 151 | memset(rx_status, 0, sizeof(struct ieee80211_rx_status)); |
Jouni Malinen | bce048d | 2009-03-03 19:23:28 +0200 | [diff] [blame] | 152 | hw = ath_get_virt_hw(sc, hdr); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 153 | |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 154 | if (ds->ds_rxstat.rs_more) { |
| 155 | /* |
| 156 | * Frame spans multiple descriptors; this cannot happen yet |
| 157 | * as we don't support jumbograms. If not in monitor mode, |
| 158 | * discard the frame. Enable this if you want to see |
| 159 | * error frames in Monitor mode. |
| 160 | */ |
Sujith | 2660b81 | 2009-02-09 13:27:26 +0530 | [diff] [blame] | 161 | if (sc->sc_ah->opmode != NL80211_IFTYPE_MONITOR) |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 162 | goto rx_next; |
| 163 | } else if (ds->ds_rxstat.rs_status != 0) { |
| 164 | if (ds->ds_rxstat.rs_status & ATH9K_RXERR_CRC) |
| 165 | rx_status->flag |= RX_FLAG_FAILED_FCS_CRC; |
| 166 | if (ds->ds_rxstat.rs_status & ATH9K_RXERR_PHY) |
| 167 | goto rx_next; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 168 | |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 169 | if (ds->ds_rxstat.rs_status & ATH9K_RXERR_DECRYPT) { |
| 170 | *decrypt_error = true; |
| 171 | } else if (ds->ds_rxstat.rs_status & ATH9K_RXERR_MIC) { |
| 172 | if (ieee80211_is_ctl(fc)) |
| 173 | /* |
| 174 | * Sometimes, we get invalid |
| 175 | * MIC failures on valid control frames. |
| 176 | * Remove these mic errors. |
| 177 | */ |
| 178 | ds->ds_rxstat.rs_status &= ~ATH9K_RXERR_MIC; |
| 179 | else |
| 180 | rx_status->flag |= RX_FLAG_MMIC_ERROR; |
| 181 | } |
| 182 | /* |
| 183 | * Reject error frames with the exception of |
| 184 | * decryption and MIC failures. For monitor mode, |
| 185 | * we also ignore the CRC error. |
| 186 | */ |
Sujith | 2660b81 | 2009-02-09 13:27:26 +0530 | [diff] [blame] | 187 | if (sc->sc_ah->opmode == NL80211_IFTYPE_MONITOR) { |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 188 | if (ds->ds_rxstat.rs_status & |
| 189 | ~(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC | |
| 190 | ATH9K_RXERR_CRC)) |
| 191 | goto rx_next; |
| 192 | } else { |
| 193 | if (ds->ds_rxstat.rs_status & |
| 194 | ~(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC)) { |
| 195 | goto rx_next; |
| 196 | } |
| 197 | } |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 198 | } |
| 199 | |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 200 | ratecode = ds->ds_rxstat.rs_rate; |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 201 | |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 202 | if (ratecode & 0x80) { |
Jouni Malinen | baad1d9 | 2008-12-12 14:38:34 +0200 | [diff] [blame] | 203 | /* HT rate */ |
| 204 | rx_status->flag |= RX_FLAG_HT; |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 205 | if (ds->ds_rxstat.rs_flags & ATH9K_RX_2040) |
Jouni Malinen | baad1d9 | 2008-12-12 14:38:34 +0200 | [diff] [blame] | 206 | rx_status->flag |= RX_FLAG_40MHZ; |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 207 | if (ds->ds_rxstat.rs_flags & ATH9K_RX_GI) |
Jouni Malinen | baad1d9 | 2008-12-12 14:38:34 +0200 | [diff] [blame] | 208 | rx_status->flag |= RX_FLAG_SHORT_GI; |
| 209 | rx_status->rate_idx = ratecode & 0x7f; |
| 210 | } else { |
| 211 | int i = 0, cur_band, n_rates; |
Jouni Malinen | baad1d9 | 2008-12-12 14:38:34 +0200 | [diff] [blame] | 212 | |
| 213 | cur_band = hw->conf.channel->band; |
| 214 | n_rates = sc->sbands[cur_band].n_bitrates; |
| 215 | |
| 216 | for (i = 0; i < n_rates; i++) { |
| 217 | if (sc->sbands[cur_band].bitrates[i].hw_value == |
| 218 | ratecode) { |
| 219 | rx_status->rate_idx = i; |
| 220 | break; |
| 221 | } |
| 222 | |
| 223 | if (sc->sbands[cur_band].bitrates[i].hw_value_short == |
| 224 | ratecode) { |
| 225 | rx_status->rate_idx = i; |
| 226 | rx_status->flag |= RX_FLAG_SHORTPRE; |
| 227 | break; |
| 228 | } |
| 229 | } |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 230 | } |
| 231 | |
| 232 | rx_status->mactime = ath_extend_tsf(sc, ds->ds_rxstat.rs_tstamp); |
Jouni Malinen | bce048d | 2009-03-03 19:23:28 +0200 | [diff] [blame] | 233 | rx_status->band = hw->conf.channel->band; |
| 234 | rx_status->freq = hw->conf.channel->center_freq; |
Sujith | 17d7904 | 2009-02-09 13:27:03 +0530 | [diff] [blame] | 235 | rx_status->noise = sc->ani.noise_floor; |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 236 | rx_status->signal = rx_status->noise + ds->ds_rxstat.rs_rssi; |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 237 | rx_status->antenna = ds->ds_rxstat.rs_antenna; |
| 238 | |
| 239 | /* at 45 you will be able to use MCS 15 reliably. A more elaborate |
| 240 | * scheme can be used here but it requires tables of SNR/throughput for |
| 241 | * each possible mode used. */ |
| 242 | rx_status->qual = ds->ds_rxstat.rs_rssi * 100 / 45; |
| 243 | |
| 244 | /* rssi can be more than 45 though, anything above that |
| 245 | * should be considered at 100% */ |
| 246 | if (rx_status->qual > 100) |
| 247 | rx_status->qual = 100; |
| 248 | |
| 249 | rx_status->flag |= RX_FLAG_TSFT; |
| 250 | |
| 251 | return 1; |
| 252 | rx_next: |
| 253 | return 0; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 254 | } |
| 255 | |
| 256 | static void ath_opmode_init(struct ath_softc *sc) |
| 257 | { |
Sujith | cbe61d8 | 2009-02-09 13:27:12 +0530 | [diff] [blame] | 258 | struct ath_hw *ah = sc->sc_ah; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 259 | u32 rfilt, mfilt[2]; |
| 260 | |
| 261 | /* configure rx filter */ |
| 262 | rfilt = ath_calcrxfilter(sc); |
| 263 | ath9k_hw_setrxfilter(ah, rfilt); |
| 264 | |
| 265 | /* configure bssid mask */ |
Sujith | 2660b81 | 2009-02-09 13:27:26 +0530 | [diff] [blame] | 266 | if (ah->caps.hw_caps & ATH9K_HW_CAP_BSSIDMASK) |
Sujith | ba52da5 | 2009-02-09 13:27:10 +0530 | [diff] [blame] | 267 | ath9k_hw_setbssidmask(sc); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 268 | |
| 269 | /* configure operational mode */ |
| 270 | ath9k_hw_setopmode(ah); |
| 271 | |
| 272 | /* Handle any link-level address change. */ |
Sujith | ba52da5 | 2009-02-09 13:27:10 +0530 | [diff] [blame] | 273 | ath9k_hw_setmac(ah, sc->sc_ah->macaddr); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 274 | |
| 275 | /* calculate and install multicast filter */ |
| 276 | mfilt[0] = mfilt[1] = ~0; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 277 | ath9k_hw_setmcastfilter(ah, mfilt[0], mfilt[1]); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 278 | } |
| 279 | |
| 280 | int ath_rx_init(struct ath_softc *sc, int nbufs) |
| 281 | { |
| 282 | struct sk_buff *skb; |
| 283 | struct ath_buf *bf; |
| 284 | int error = 0; |
| 285 | |
| 286 | do { |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 287 | spin_lock_init(&sc->rx.rxflushlock); |
Sujith | 98deeea | 2008-08-11 14:05:46 +0530 | [diff] [blame] | 288 | sc->sc_flags &= ~SC_OP_RXFLUSH; |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 289 | spin_lock_init(&sc->rx.rxbuflock); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 290 | |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 291 | sc->rx.bufsize = roundup(IEEE80211_MAX_MPDU_LEN, |
Sujith | 17d7904 | 2009-02-09 13:27:03 +0530 | [diff] [blame] | 292 | min(sc->cachelsz, |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 293 | (u16)64)); |
| 294 | |
Sujith | 04bd4638 | 2008-11-28 22:18:05 +0530 | [diff] [blame] | 295 | DPRINTF(sc, ATH_DBG_CONFIG, "cachelsz %u rxbufsize %u\n", |
Sujith | 17d7904 | 2009-02-09 13:27:03 +0530 | [diff] [blame] | 296 | sc->cachelsz, sc->rx.bufsize); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 297 | |
| 298 | /* Initialize rx descriptors */ |
| 299 | |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 300 | error = ath_descdma_setup(sc, &sc->rx.rxdma, &sc->rx.rxbuf, |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 301 | "rx", nbufs, 1); |
| 302 | if (error != 0) { |
| 303 | DPRINTF(sc, ATH_DBG_FATAL, |
Sujith | 04bd4638 | 2008-11-28 22:18:05 +0530 | [diff] [blame] | 304 | "failed to allocate rx descriptors: %d\n", error); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 305 | break; |
| 306 | } |
| 307 | |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 308 | list_for_each_entry(bf, &sc->rx.rxbuf, list) { |
Senthil Balasubramanian | f0e6ce1 | 2009-03-06 11:24:08 +0530 | [diff] [blame] | 309 | skb = ath_rxbuf_alloc(sc, sc->rx.bufsize, GFP_KERNEL); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 310 | if (skb == NULL) { |
| 311 | error = -ENOMEM; |
| 312 | break; |
| 313 | } |
| 314 | |
| 315 | bf->bf_mpdu = skb; |
Gabor Juhos | 7da3c55 | 2009-01-14 20:17:03 +0100 | [diff] [blame] | 316 | bf->bf_buf_addr = dma_map_single(sc->dev, skb->data, |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 317 | sc->rx.bufsize, |
Gabor Juhos | 7da3c55 | 2009-01-14 20:17:03 +0100 | [diff] [blame] | 318 | DMA_FROM_DEVICE); |
| 319 | if (unlikely(dma_mapping_error(sc->dev, |
Luis R. Rodriguez | f8316df | 2008-12-03 03:35:29 -0800 | [diff] [blame] | 320 | bf->bf_buf_addr))) { |
| 321 | dev_kfree_skb_any(skb); |
| 322 | bf->bf_mpdu = NULL; |
| 323 | DPRINTF(sc, ATH_DBG_CONFIG, |
Gabor Juhos | 7da3c55 | 2009-01-14 20:17:03 +0100 | [diff] [blame] | 324 | "dma_mapping_error() on RX init\n"); |
Luis R. Rodriguez | f8316df | 2008-12-03 03:35:29 -0800 | [diff] [blame] | 325 | error = -ENOMEM; |
| 326 | break; |
| 327 | } |
Sujith | 927e70e | 2008-08-14 13:26:34 +0530 | [diff] [blame] | 328 | bf->bf_dmacontext = bf->bf_buf_addr; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 329 | } |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 330 | sc->rx.rxlink = NULL; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 331 | |
| 332 | } while (0); |
| 333 | |
| 334 | if (error) |
| 335 | ath_rx_cleanup(sc); |
| 336 | |
| 337 | return error; |
| 338 | } |
| 339 | |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 340 | void ath_rx_cleanup(struct ath_softc *sc) |
| 341 | { |
| 342 | struct sk_buff *skb; |
| 343 | struct ath_buf *bf; |
| 344 | |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 345 | list_for_each_entry(bf, &sc->rx.rxbuf, list) { |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 346 | skb = bf->bf_mpdu; |
Luis R. Rodriguez | 051b919 | 2009-03-23 18:25:01 -0400 | [diff] [blame] | 347 | if (skb) { |
| 348 | dma_unmap_single(sc->dev, |
| 349 | bf->bf_buf_addr, |
| 350 | sc->rx.bufsize, |
| 351 | DMA_FROM_DEVICE); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 352 | dev_kfree_skb(skb); |
Luis R. Rodriguez | 051b919 | 2009-03-23 18:25:01 -0400 | [diff] [blame] | 353 | } |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 354 | } |
| 355 | |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 356 | if (sc->rx.rxdma.dd_desc_len != 0) |
| 357 | ath_descdma_cleanup(sc, &sc->rx.rxdma, &sc->rx.rxbuf); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 358 | } |
| 359 | |
| 360 | /* |
| 361 | * Calculate the receive filter according to the |
| 362 | * operating mode and state: |
| 363 | * |
| 364 | * o always accept unicast, broadcast, and multicast traffic |
| 365 | * o maintain current state of phy error reception (the hal |
| 366 | * may enable phy error frames for noise immunity work) |
| 367 | * o probe request frames are accepted only when operating in |
| 368 | * hostap, adhoc, or monitor modes |
| 369 | * o enable promiscuous mode according to the interface state |
| 370 | * o accept beacons: |
| 371 | * - when operating in adhoc mode so the 802.11 layer creates |
| 372 | * node table entries for peers, |
| 373 | * - when operating in station mode for collecting rssi data when |
| 374 | * the station is otherwise quiet, or |
| 375 | * - when operating as a repeater so we see repeater-sta beacons |
| 376 | * - when scanning |
| 377 | */ |
| 378 | |
| 379 | u32 ath_calcrxfilter(struct ath_softc *sc) |
| 380 | { |
| 381 | #define RX_FILTER_PRESERVE (ATH9K_RX_FILTER_PHYERR | ATH9K_RX_FILTER_PHYRADAR) |
Sujith | 7dcfdcd | 2008-08-11 14:03:13 +0530 | [diff] [blame] | 382 | |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 383 | u32 rfilt; |
| 384 | |
| 385 | rfilt = (ath9k_hw_getrxfilter(sc->sc_ah) & RX_FILTER_PRESERVE) |
| 386 | | ATH9K_RX_FILTER_UCAST | ATH9K_RX_FILTER_BCAST |
| 387 | | ATH9K_RX_FILTER_MCAST; |
| 388 | |
| 389 | /* If not a STA, enable processing of Probe Requests */ |
Sujith | 2660b81 | 2009-02-09 13:27:26 +0530 | [diff] [blame] | 390 | if (sc->sc_ah->opmode != NL80211_IFTYPE_STATION) |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 391 | rfilt |= ATH9K_RX_FILTER_PROBEREQ; |
| 392 | |
Jouni Malinen | 217ba9d | 2009-03-10 10:55:50 +0200 | [diff] [blame] | 393 | /* |
| 394 | * Set promiscuous mode when FIF_PROMISC_IN_BSS is enabled for station |
| 395 | * mode interface or when in monitor mode. AP mode does not need this |
| 396 | * since it receives all in-BSS frames anyway. |
| 397 | */ |
Sujith | 2660b81 | 2009-02-09 13:27:26 +0530 | [diff] [blame] | 398 | if (((sc->sc_ah->opmode != NL80211_IFTYPE_AP) && |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 399 | (sc->rx.rxfilter & FIF_PROMISC_IN_BSS)) || |
Jouni Malinen | 217ba9d | 2009-03-10 10:55:50 +0200 | [diff] [blame] | 400 | (sc->sc_ah->opmode == NL80211_IFTYPE_MONITOR)) |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 401 | rfilt |= ATH9K_RX_FILTER_PROM; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 402 | |
Sujith | d42c6b7 | 2009-02-04 08:10:22 +0530 | [diff] [blame] | 403 | if (sc->rx.rxfilter & FIF_CONTROL) |
| 404 | rfilt |= ATH9K_RX_FILTER_CONTROL; |
| 405 | |
Vasanthakumar Thiagarajan | dbaaa14 | 2009-02-19 15:41:52 +0530 | [diff] [blame] | 406 | if ((sc->sc_ah->opmode == NL80211_IFTYPE_STATION) && |
| 407 | !(sc->rx.rxfilter & FIF_BCN_PRBRESP_PROMISC)) |
| 408 | rfilt |= ATH9K_RX_FILTER_MYBEACON; |
| 409 | else |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 410 | rfilt |= ATH9K_RX_FILTER_BEACON; |
| 411 | |
Vasanthakumar Thiagarajan | dbaaa14 | 2009-02-19 15:41:52 +0530 | [diff] [blame] | 412 | /* If in HOSTAP mode, want to enable reception of PSPOLL frames */ |
Sujith | 2660b81 | 2009-02-09 13:27:26 +0530 | [diff] [blame] | 413 | if (sc->sc_ah->opmode == NL80211_IFTYPE_AP) |
Vasanthakumar Thiagarajan | dbaaa14 | 2009-02-19 15:41:52 +0530 | [diff] [blame] | 414 | rfilt |= ATH9K_RX_FILTER_PSPOLL; |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 415 | |
Jouni Malinen | b93bce2 | 2009-03-03 19:23:30 +0200 | [diff] [blame] | 416 | if (sc->sec_wiphy) { |
| 417 | /* TODO: only needed if more than one BSSID is in use in |
| 418 | * station/adhoc mode */ |
| 419 | /* TODO: for older chips, may need to add ATH9K_RX_FILTER_PROM |
| 420 | */ |
| 421 | rfilt |= ATH9K_RX_FILTER_MCAST_BCAST_ALL; |
| 422 | } |
| 423 | |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 424 | return rfilt; |
Sujith | 7dcfdcd | 2008-08-11 14:03:13 +0530 | [diff] [blame] | 425 | |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 426 | #undef RX_FILTER_PRESERVE |
| 427 | } |
| 428 | |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 429 | int ath_startrecv(struct ath_softc *sc) |
| 430 | { |
Sujith | cbe61d8 | 2009-02-09 13:27:12 +0530 | [diff] [blame] | 431 | struct ath_hw *ah = sc->sc_ah; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 432 | struct ath_buf *bf, *tbf; |
| 433 | |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 434 | spin_lock_bh(&sc->rx.rxbuflock); |
| 435 | if (list_empty(&sc->rx.rxbuf)) |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 436 | goto start_recv; |
| 437 | |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 438 | sc->rx.rxlink = NULL; |
| 439 | list_for_each_entry_safe(bf, tbf, &sc->rx.rxbuf, list) { |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 440 | ath_rx_buf_link(sc, bf); |
| 441 | } |
| 442 | |
| 443 | /* We could have deleted elements so the list may be empty now */ |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 444 | if (list_empty(&sc->rx.rxbuf)) |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 445 | goto start_recv; |
| 446 | |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 447 | bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 448 | ath9k_hw_putrxbuf(ah, bf->bf_daddr); |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 449 | ath9k_hw_rxena(ah); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 450 | |
| 451 | start_recv: |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 452 | spin_unlock_bh(&sc->rx.rxbuflock); |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 453 | ath_opmode_init(sc); |
| 454 | ath9k_hw_startpcureceive(ah); |
| 455 | |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 456 | return 0; |
| 457 | } |
| 458 | |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 459 | bool ath_stoprecv(struct ath_softc *sc) |
| 460 | { |
Sujith | cbe61d8 | 2009-02-09 13:27:12 +0530 | [diff] [blame] | 461 | struct ath_hw *ah = sc->sc_ah; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 462 | bool stopped; |
| 463 | |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 464 | ath9k_hw_stoppcurecv(ah); |
| 465 | ath9k_hw_setrxfilter(ah, 0); |
| 466 | stopped = ath9k_hw_stopdmarecv(ah); |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 467 | sc->rx.rxlink = NULL; |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 468 | |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 469 | return stopped; |
| 470 | } |
| 471 | |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 472 | void ath_flushrecv(struct ath_softc *sc) |
| 473 | { |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 474 | spin_lock_bh(&sc->rx.rxflushlock); |
Sujith | 98deeea | 2008-08-11 14:05:46 +0530 | [diff] [blame] | 475 | sc->sc_flags |= SC_OP_RXFLUSH; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 476 | ath_rx_tasklet(sc, 1); |
Sujith | 98deeea | 2008-08-11 14:05:46 +0530 | [diff] [blame] | 477 | sc->sc_flags &= ~SC_OP_RXFLUSH; |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 478 | spin_unlock_bh(&sc->rx.rxflushlock); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 479 | } |
| 480 | |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 481 | int ath_rx_tasklet(struct ath_softc *sc, int flush) |
| 482 | { |
| 483 | #define PA2DESC(_sc, _pa) \ |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 484 | ((struct ath_desc *)((caddr_t)(_sc)->rx.rxdma.dd_desc + \ |
| 485 | ((_pa) - (_sc)->rx.rxdma.dd_desc_paddr))) |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 486 | |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 487 | struct ath_buf *bf; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 488 | struct ath_desc *ds; |
Luis R. Rodriguez | cb71d9b | 2008-11-21 17:41:33 -0800 | [diff] [blame] | 489 | struct sk_buff *skb = NULL, *requeue_skb; |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 490 | struct ieee80211_rx_status rx_status; |
Sujith | cbe61d8 | 2009-02-09 13:27:12 +0530 | [diff] [blame] | 491 | struct ath_hw *ah = sc->sc_ah; |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 492 | struct ieee80211_hdr *hdr; |
| 493 | int hdrlen, padsize, retval; |
| 494 | bool decrypt_error = false; |
| 495 | u8 keyix; |
Pavel Roskin | 853da11 | 2009-04-03 20:10:26 -0400 | [diff] [blame^] | 496 | __le16 fc; |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 497 | |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 498 | spin_lock_bh(&sc->rx.rxbuflock); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 499 | |
| 500 | do { |
| 501 | /* If handling rx interrupt and flush is in progress => exit */ |
Sujith | 98deeea | 2008-08-11 14:05:46 +0530 | [diff] [blame] | 502 | if ((sc->sc_flags & SC_OP_RXFLUSH) && (flush == 0)) |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 503 | break; |
| 504 | |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 505 | if (list_empty(&sc->rx.rxbuf)) { |
| 506 | sc->rx.rxlink = NULL; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 507 | break; |
| 508 | } |
| 509 | |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 510 | bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 511 | ds = bf->bf_desc; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 512 | |
| 513 | /* |
| 514 | * Must provide the virtual address of the current |
| 515 | * descriptor, the physical address, and the virtual |
| 516 | * address of the next descriptor in the h/w chain. |
| 517 | * This allows the HAL to look ahead to see if the |
| 518 | * hardware is done with a descriptor by checking the |
| 519 | * done bit in the following descriptor and the address |
| 520 | * of the current descriptor the DMA engine is working |
| 521 | * on. All this is necessary because of our use of |
| 522 | * a self-linked list to avoid rx overruns. |
| 523 | */ |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 524 | retval = ath9k_hw_rxprocdesc(ah, ds, |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 525 | bf->bf_daddr, |
| 526 | PA2DESC(sc, ds->ds_link), |
| 527 | 0); |
| 528 | if (retval == -EINPROGRESS) { |
| 529 | struct ath_buf *tbf; |
| 530 | struct ath_desc *tds; |
| 531 | |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 532 | if (list_is_last(&bf->list, &sc->rx.rxbuf)) { |
| 533 | sc->rx.rxlink = NULL; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 534 | break; |
| 535 | } |
| 536 | |
| 537 | tbf = list_entry(bf->list.next, struct ath_buf, list); |
| 538 | |
| 539 | /* |
| 540 | * On some hardware the descriptor status words could |
| 541 | * get corrupted, including the done bit. Because of |
| 542 | * this, check if the next descriptor's done bit is |
| 543 | * set or not. |
| 544 | * |
| 545 | * If the next descriptor's done bit is set, the current |
| 546 | * descriptor has been corrupted. Force s/w to discard |
| 547 | * this descriptor and continue... |
| 548 | */ |
| 549 | |
| 550 | tds = tbf->bf_desc; |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 551 | retval = ath9k_hw_rxprocdesc(ah, tds, tbf->bf_daddr, |
| 552 | PA2DESC(sc, tds->ds_link), 0); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 553 | if (retval == -EINPROGRESS) { |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 554 | break; |
| 555 | } |
| 556 | } |
| 557 | |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 558 | skb = bf->bf_mpdu; |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 559 | if (!skb) |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 560 | continue; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 561 | |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 562 | /* |
Vasanthakumar Thiagarajan | 9bf9fca | 2008-12-15 20:40:46 +0530 | [diff] [blame] | 563 | * Synchronize the DMA transfer with CPU before |
| 564 | * 1. accessing the frame |
| 565 | * 2. requeueing the same buffer to h/w |
| 566 | */ |
Gabor Juhos | 7da3c55 | 2009-01-14 20:17:03 +0100 | [diff] [blame] | 567 | dma_sync_single_for_cpu(sc->dev, bf->bf_buf_addr, |
Vasanthakumar Thiagarajan | 9bf9fca | 2008-12-15 20:40:46 +0530 | [diff] [blame] | 568 | sc->rx.bufsize, |
Gabor Juhos | 7da3c55 | 2009-01-14 20:17:03 +0100 | [diff] [blame] | 569 | DMA_FROM_DEVICE); |
Vasanthakumar Thiagarajan | 9bf9fca | 2008-12-15 20:40:46 +0530 | [diff] [blame] | 570 | |
| 571 | /* |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 572 | * If we're asked to flush receive queue, directly |
| 573 | * chain it back at the queue without processing it. |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 574 | */ |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 575 | if (flush) |
Luis R. Rodriguez | cb71d9b | 2008-11-21 17:41:33 -0800 | [diff] [blame] | 576 | goto requeue; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 577 | |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 578 | if (!ds->ds_rxstat.rs_datalen) |
Luis R. Rodriguez | cb71d9b | 2008-11-21 17:41:33 -0800 | [diff] [blame] | 579 | goto requeue; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 580 | |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 581 | /* The status portion of the descriptor could get corrupted. */ |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 582 | if (sc->rx.bufsize < ds->ds_rxstat.rs_datalen) |
Luis R. Rodriguez | cb71d9b | 2008-11-21 17:41:33 -0800 | [diff] [blame] | 583 | goto requeue; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 584 | |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 585 | if (!ath_rx_prepare(skb, ds, &rx_status, &decrypt_error, sc)) |
Luis R. Rodriguez | cb71d9b | 2008-11-21 17:41:33 -0800 | [diff] [blame] | 586 | goto requeue; |
| 587 | |
| 588 | /* Ensure we always have an skb to requeue once we are done |
| 589 | * processing the current buffer's skb */ |
Senthil Balasubramanian | f0e6ce1 | 2009-03-06 11:24:08 +0530 | [diff] [blame] | 590 | requeue_skb = ath_rxbuf_alloc(sc, sc->rx.bufsize, GFP_ATOMIC); |
Luis R. Rodriguez | cb71d9b | 2008-11-21 17:41:33 -0800 | [diff] [blame] | 591 | |
| 592 | /* If there is no memory we ignore the current RX'd frame, |
| 593 | * tell hardware it can give us a new frame using the old |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 594 | * skb and put it at the tail of the sc->rx.rxbuf list for |
Luis R. Rodriguez | cb71d9b | 2008-11-21 17:41:33 -0800 | [diff] [blame] | 595 | * processing. */ |
| 596 | if (!requeue_skb) |
| 597 | goto requeue; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 598 | |
Vasanthakumar Thiagarajan | 9bf9fca | 2008-12-15 20:40:46 +0530 | [diff] [blame] | 599 | /* Unmap the frame */ |
Gabor Juhos | 7da3c55 | 2009-01-14 20:17:03 +0100 | [diff] [blame] | 600 | dma_unmap_single(sc->dev, bf->bf_buf_addr, |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 601 | sc->rx.bufsize, |
Gabor Juhos | 7da3c55 | 2009-01-14 20:17:03 +0100 | [diff] [blame] | 602 | DMA_FROM_DEVICE); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 603 | |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 604 | skb_put(skb, ds->ds_rxstat.rs_datalen); |
| 605 | skb->protocol = cpu_to_be16(ETH_P_CONTROL); |
| 606 | |
| 607 | /* see if any padding is done by the hw and remove it */ |
| 608 | hdr = (struct ieee80211_hdr *)skb->data; |
| 609 | hdrlen = ieee80211_get_hdrlen_from_skb(skb); |
Pavel Roskin | 853da11 | 2009-04-03 20:10:26 -0400 | [diff] [blame^] | 610 | fc = hdr->frame_control; |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 611 | |
Jouni Malinen | 9c5f89b | 2008-12-11 18:22:13 +0200 | [diff] [blame] | 612 | /* The MAC header is padded to have 32-bit boundary if the |
| 613 | * packet payload is non-zero. The general calculation for |
| 614 | * padsize would take into account odd header lengths: |
| 615 | * padsize = (4 - hdrlen % 4) % 4; However, since only |
| 616 | * even-length headers are used, padding can only be 0 or 2 |
| 617 | * bytes and we can optimize this a bit. In addition, we must |
| 618 | * not try to remove padding from short control frames that do |
| 619 | * not have payload. */ |
| 620 | padsize = hdrlen & 3; |
| 621 | if (padsize && hdrlen >= 24) { |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 622 | memmove(skb->data + padsize, skb->data, hdrlen); |
| 623 | skb_pull(skb, padsize); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 624 | } |
| 625 | |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 626 | keyix = ds->ds_rxstat.rs_keyix; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 627 | |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 628 | if (!(keyix == ATH9K_RXKEYIX_INVALID) && !decrypt_error) { |
| 629 | rx_status.flag |= RX_FLAG_DECRYPTED; |
| 630 | } else if ((le16_to_cpu(hdr->frame_control) & IEEE80211_FCTL_PROTECTED) |
| 631 | && !decrypt_error && skb->len >= hdrlen + 4) { |
| 632 | keyix = skb->data[hdrlen + 3] >> 6; |
| 633 | |
Sujith | 17d7904 | 2009-02-09 13:27:03 +0530 | [diff] [blame] | 634 | if (test_bit(keyix, sc->keymap)) |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 635 | rx_status.flag |= RX_FLAG_DECRYPTED; |
| 636 | } |
Jouni Malinen | 0ced0e1 | 2009-01-08 13:32:13 +0200 | [diff] [blame] | 637 | if (ah->sw_mgmt_crypto && |
| 638 | (rx_status.flag & RX_FLAG_DECRYPTED) && |
| 639 | ieee80211_is_mgmt(hdr->frame_control)) { |
| 640 | /* Use software decrypt for management frames. */ |
| 641 | rx_status.flag &= ~RX_FLAG_DECRYPTED; |
| 642 | } |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 643 | |
| 644 | /* Send the frame to mac80211 */ |
Jouni Malinen | c52f33d | 2009-03-03 19:23:29 +0200 | [diff] [blame] | 645 | if (hdr->addr1[5] & 0x01) { |
| 646 | int i; |
| 647 | /* |
| 648 | * Deliver broadcast/multicast frames to all suitable |
| 649 | * virtual wiphys. |
| 650 | */ |
| 651 | /* TODO: filter based on channel configuration */ |
| 652 | for (i = 0; i < sc->num_sec_wiphy; i++) { |
| 653 | struct ath_wiphy *aphy = sc->sec_wiphy[i]; |
| 654 | struct sk_buff *nskb; |
| 655 | if (aphy == NULL) |
| 656 | continue; |
| 657 | nskb = skb_copy(skb, GFP_ATOMIC); |
| 658 | if (nskb) |
| 659 | __ieee80211_rx(aphy->hw, nskb, |
| 660 | &rx_status); |
| 661 | } |
| 662 | __ieee80211_rx(sc->hw, skb, &rx_status); |
| 663 | } else { |
| 664 | /* Deliver unicast frames based on receiver address */ |
| 665 | __ieee80211_rx(ath_get_virt_hw(sc, hdr), skb, |
| 666 | &rx_status); |
| 667 | } |
Luis R. Rodriguez | cb71d9b | 2008-11-21 17:41:33 -0800 | [diff] [blame] | 668 | |
| 669 | /* We will now give hardware our shiny new allocated skb */ |
| 670 | bf->bf_mpdu = requeue_skb; |
Gabor Juhos | 7da3c55 | 2009-01-14 20:17:03 +0100 | [diff] [blame] | 671 | bf->bf_buf_addr = dma_map_single(sc->dev, requeue_skb->data, |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 672 | sc->rx.bufsize, |
Gabor Juhos | 7da3c55 | 2009-01-14 20:17:03 +0100 | [diff] [blame] | 673 | DMA_FROM_DEVICE); |
| 674 | if (unlikely(dma_mapping_error(sc->dev, |
Luis R. Rodriguez | f8316df | 2008-12-03 03:35:29 -0800 | [diff] [blame] | 675 | bf->bf_buf_addr))) { |
| 676 | dev_kfree_skb_any(requeue_skb); |
| 677 | bf->bf_mpdu = NULL; |
| 678 | DPRINTF(sc, ATH_DBG_CONFIG, |
Gabor Juhos | 7da3c55 | 2009-01-14 20:17:03 +0100 | [diff] [blame] | 679 | "dma_mapping_error() on RX\n"); |
Luis R. Rodriguez | f8316df | 2008-12-03 03:35:29 -0800 | [diff] [blame] | 680 | break; |
| 681 | } |
Luis R. Rodriguez | cb71d9b | 2008-11-21 17:41:33 -0800 | [diff] [blame] | 682 | bf->bf_dmacontext = bf->bf_buf_addr; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 683 | |
| 684 | /* |
| 685 | * change the default rx antenna if rx diversity chooses the |
| 686 | * other antenna 3 times in a row. |
| 687 | */ |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 688 | if (sc->rx.defant != ds->ds_rxstat.rs_antenna) { |
| 689 | if (++sc->rx.rxotherant >= 3) |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 690 | ath_setdefantenna(sc, ds->ds_rxstat.rs_antenna); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 691 | } else { |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 692 | sc->rx.rxotherant = 0; |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 693 | } |
Vivek Natarajan | 3cbb5dd | 2009-01-20 11:17:08 +0530 | [diff] [blame] | 694 | |
Pavel Roskin | 853da11 | 2009-04-03 20:10:26 -0400 | [diff] [blame^] | 695 | if (ieee80211_is_beacon(fc) && |
Vivek Natarajan | 3cbb5dd | 2009-01-20 11:17:08 +0530 | [diff] [blame] | 696 | (sc->sc_flags & SC_OP_WAIT_FOR_BEACON)) { |
| 697 | sc->sc_flags &= ~SC_OP_WAIT_FOR_BEACON; |
| 698 | ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_NETWORK_SLEEP); |
| 699 | } |
Luis R. Rodriguez | cb71d9b | 2008-11-21 17:41:33 -0800 | [diff] [blame] | 700 | requeue: |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 701 | list_move_tail(&bf->list, &sc->rx.rxbuf); |
Luis R. Rodriguez | cb71d9b | 2008-11-21 17:41:33 -0800 | [diff] [blame] | 702 | ath_rx_buf_link(sc, bf); |
Sujith | be0418a | 2008-11-18 09:05:55 +0530 | [diff] [blame] | 703 | } while (1); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 704 | |
Sujith | b77f483 | 2008-12-07 21:44:03 +0530 | [diff] [blame] | 705 | spin_unlock_bh(&sc->rx.rxbuflock); |
Luis R. Rodriguez | f078f20 | 2008-08-04 00:16:41 -0700 | [diff] [blame] | 706 | |
| 707 | return 0; |
| 708 | #undef PA2DESC |
| 709 | } |