Luis R. Rodriguez | db86f07 | 2009-11-05 08:44:39 -0800 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2009 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 | /* |
| 18 | * Module for common driver code between ath9k and ath9k_htc |
| 19 | */ |
| 20 | |
| 21 | #include <linux/kernel.h> |
| 22 | #include <linux/module.h> |
| 23 | |
| 24 | #include "common.h" |
| 25 | |
| 26 | MODULE_AUTHOR("Atheros Communications"); |
| 27 | MODULE_DESCRIPTION("Shared library for Atheros wireless 802.11n LAN cards."); |
| 28 | MODULE_LICENSE("Dual BSD/GPL"); |
| 29 | |
| 30 | /* Common RX processing */ |
| 31 | |
| 32 | /* Assumes you've already done the endian to CPU conversion */ |
| 33 | static bool ath9k_rx_accept(struct ath_common *common, |
| 34 | struct sk_buff *skb, |
| 35 | struct ieee80211_rx_status *rxs, |
| 36 | struct ath_rx_status *rx_stats, |
| 37 | bool *decrypt_error) |
| 38 | { |
| 39 | struct ath_hw *ah = common->ah; |
| 40 | struct ieee80211_hdr *hdr; |
| 41 | __le16 fc; |
| 42 | |
| 43 | hdr = (struct ieee80211_hdr *) skb->data; |
| 44 | fc = hdr->frame_control; |
| 45 | |
| 46 | if (!rx_stats->rs_datalen) |
| 47 | return false; |
| 48 | /* |
| 49 | * rs_status follows rs_datalen so if rs_datalen is too large |
| 50 | * we can take a hint that hardware corrupted it, so ignore |
| 51 | * those frames. |
| 52 | */ |
| 53 | if (rx_stats->rs_datalen > common->rx_bufsize) |
| 54 | return false; |
| 55 | |
Luis R. Rodriguez | 748d451 | 2009-11-05 14:10:07 -0800 | [diff] [blame] | 56 | /* |
| 57 | * rs_more indicates chained descriptors which can be used |
| 58 | * to link buffers together for a sort of scatter-gather |
| 59 | * operation. |
| 60 | * |
| 61 | * The rx_stats->rs_status will not be set until the end of the |
| 62 | * chained descriptors so it can be ignored if rs_more is set. The |
| 63 | * rs_more will be false at the last element of the chained |
| 64 | * descriptors. |
| 65 | */ |
| 66 | if (!rx_stats->rs_more && rx_stats->rs_status != 0) { |
Luis R. Rodriguez | db86f07 | 2009-11-05 08:44:39 -0800 | [diff] [blame] | 67 | if (rx_stats->rs_status & ATH9K_RXERR_CRC) |
| 68 | rxs->flag |= RX_FLAG_FAILED_FCS_CRC; |
| 69 | if (rx_stats->rs_status & ATH9K_RXERR_PHY) |
| 70 | return false; |
| 71 | |
| 72 | if (rx_stats->rs_status & ATH9K_RXERR_DECRYPT) { |
| 73 | *decrypt_error = true; |
| 74 | } else if (rx_stats->rs_status & ATH9K_RXERR_MIC) { |
| 75 | if (ieee80211_is_ctl(fc)) |
| 76 | /* |
| 77 | * Sometimes, we get invalid |
| 78 | * MIC failures on valid control frames. |
| 79 | * Remove these mic errors. |
| 80 | */ |
| 81 | rx_stats->rs_status &= ~ATH9K_RXERR_MIC; |
| 82 | else |
| 83 | rxs->flag |= RX_FLAG_MMIC_ERROR; |
| 84 | } |
| 85 | /* |
| 86 | * Reject error frames with the exception of |
| 87 | * decryption and MIC failures. For monitor mode, |
| 88 | * we also ignore the CRC error. |
| 89 | */ |
| 90 | if (ah->opmode == NL80211_IFTYPE_MONITOR) { |
| 91 | if (rx_stats->rs_status & |
| 92 | ~(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC | |
| 93 | ATH9K_RXERR_CRC)) |
| 94 | return false; |
| 95 | } else { |
| 96 | if (rx_stats->rs_status & |
| 97 | ~(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC)) { |
| 98 | return false; |
| 99 | } |
| 100 | } |
| 101 | } |
| 102 | return true; |
| 103 | } |
| 104 | |
| 105 | static u8 ath9k_process_rate(struct ath_common *common, |
| 106 | struct ieee80211_hw *hw, |
| 107 | struct ath_rx_status *rx_stats, |
| 108 | struct ieee80211_rx_status *rxs, |
| 109 | struct sk_buff *skb) |
| 110 | { |
| 111 | struct ieee80211_supported_band *sband; |
| 112 | enum ieee80211_band band; |
| 113 | unsigned int i = 0; |
| 114 | |
| 115 | band = hw->conf.channel->band; |
| 116 | sband = hw->wiphy->bands[band]; |
| 117 | |
| 118 | if (rx_stats->rs_rate & 0x80) { |
| 119 | /* HT rate */ |
| 120 | rxs->flag |= RX_FLAG_HT; |
| 121 | if (rx_stats->rs_flags & ATH9K_RX_2040) |
| 122 | rxs->flag |= RX_FLAG_40MHZ; |
| 123 | if (rx_stats->rs_flags & ATH9K_RX_GI) |
| 124 | rxs->flag |= RX_FLAG_SHORT_GI; |
| 125 | return rx_stats->rs_rate & 0x7f; |
| 126 | } |
| 127 | |
| 128 | for (i = 0; i < sband->n_bitrates; i++) { |
| 129 | if (sband->bitrates[i].hw_value == rx_stats->rs_rate) |
| 130 | return i; |
| 131 | if (sband->bitrates[i].hw_value_short == rx_stats->rs_rate) { |
| 132 | rxs->flag |= RX_FLAG_SHORTPRE; |
| 133 | return i; |
| 134 | } |
| 135 | } |
| 136 | |
| 137 | /* No valid hardware bitrate found -- we should not get here */ |
| 138 | ath_print(common, ATH_DBG_XMIT, "unsupported hw bitrate detected " |
| 139 | "0x%02x using 1 Mbit\n", rx_stats->rs_rate); |
| 140 | if ((common->debug_mask & ATH_DBG_XMIT)) |
| 141 | print_hex_dump_bytes("", DUMP_PREFIX_NONE, skb->data, skb->len); |
| 142 | |
| 143 | return 0; |
| 144 | } |
| 145 | |
Luis R. Rodriguez | db86f07 | 2009-11-05 08:44:39 -0800 | [diff] [blame] | 146 | static void ath9k_process_rssi(struct ath_common *common, |
| 147 | struct ieee80211_hw *hw, |
| 148 | struct sk_buff *skb, |
| 149 | struct ath_rx_status *rx_stats) |
| 150 | { |
| 151 | struct ath_hw *ah = common->ah; |
| 152 | struct ieee80211_sta *sta; |
| 153 | struct ieee80211_hdr *hdr; |
| 154 | struct ath_node *an; |
| 155 | int last_rssi = ATH_RSSI_DUMMY_MARKER; |
| 156 | __le16 fc; |
| 157 | |
| 158 | hdr = (struct ieee80211_hdr *)skb->data; |
| 159 | fc = hdr->frame_control; |
| 160 | |
| 161 | rcu_read_lock(); |
| 162 | /* |
| 163 | * XXX: use ieee80211_find_sta! This requires quite a bit of work |
| 164 | * under the current ath9k virtual wiphy implementation as we have |
| 165 | * no way of tying a vif to wiphy. Typically vifs are attached to |
| 166 | * at least one sdata of a wiphy on mac80211 but with ath9k virtual |
| 167 | * wiphy you'd have to iterate over every wiphy and each sdata. |
| 168 | */ |
| 169 | sta = ieee80211_find_sta_by_hw(hw, hdr->addr2); |
| 170 | if (sta) { |
| 171 | an = (struct ath_node *) sta->drv_priv; |
| 172 | if (rx_stats->rs_rssi != ATH9K_RSSI_BAD && |
| 173 | !rx_stats->rs_moreaggr) |
| 174 | ATH_RSSI_LPF(an->last_rssi, rx_stats->rs_rssi); |
| 175 | last_rssi = an->last_rssi; |
| 176 | } |
| 177 | rcu_read_unlock(); |
| 178 | |
| 179 | if (likely(last_rssi != ATH_RSSI_DUMMY_MARKER)) |
| 180 | rx_stats->rs_rssi = ATH_EP_RND(last_rssi, |
| 181 | ATH_RSSI_EP_MULTIPLIER); |
| 182 | if (rx_stats->rs_rssi < 0) |
| 183 | rx_stats->rs_rssi = 0; |
Luis R. Rodriguez | db86f07 | 2009-11-05 08:44:39 -0800 | [diff] [blame] | 184 | |
| 185 | /* Update Beacon RSSI, this is used by ANI. */ |
| 186 | if (ieee80211_is_beacon(fc)) |
| 187 | ah->stats.avgbrssi = rx_stats->rs_rssi; |
| 188 | } |
| 189 | |
| 190 | /* |
| 191 | * For Decrypt or Demic errors, we only mark packet status here and always push |
| 192 | * up the frame up to let mac80211 handle the actual error case, be it no |
| 193 | * decryption key or real decryption error. This let us keep statistics there. |
| 194 | */ |
| 195 | int ath9k_cmn_rx_skb_preprocess(struct ath_common *common, |
| 196 | struct ieee80211_hw *hw, |
| 197 | struct sk_buff *skb, |
| 198 | struct ath_rx_status *rx_stats, |
| 199 | struct ieee80211_rx_status *rx_status, |
| 200 | bool *decrypt_error) |
| 201 | { |
| 202 | struct ath_hw *ah = common->ah; |
| 203 | |
Felix Fietkau | dd6ae4f | 2009-11-15 22:27:17 +0100 | [diff] [blame] | 204 | memset(rx_status, 0, sizeof(struct ieee80211_rx_status)); |
Luis R. Rodriguez | db86f07 | 2009-11-05 08:44:39 -0800 | [diff] [blame] | 205 | if (!ath9k_rx_accept(common, skb, rx_status, rx_stats, decrypt_error)) |
| 206 | return -EINVAL; |
| 207 | |
| 208 | ath9k_process_rssi(common, hw, skb, rx_stats); |
| 209 | |
| 210 | rx_status->rate_idx = ath9k_process_rate(common, hw, |
| 211 | rx_stats, rx_status, skb); |
| 212 | rx_status->mactime = ath9k_hw_extend_tsf(ah, rx_stats->rs_tstamp); |
| 213 | rx_status->band = hw->conf.channel->band; |
| 214 | rx_status->freq = hw->conf.channel->center_freq; |
| 215 | rx_status->noise = common->ani.noise_floor; |
| 216 | rx_status->signal = ATH_DEFAULT_NOISE_FLOOR + rx_stats->rs_rssi; |
| 217 | rx_status->antenna = rx_stats->rs_antenna; |
Luis R. Rodriguez | db86f07 | 2009-11-05 08:44:39 -0800 | [diff] [blame] | 218 | rx_status->flag |= RX_FLAG_TSFT; |
| 219 | |
| 220 | return 0; |
| 221 | } |
| 222 | EXPORT_SYMBOL(ath9k_cmn_rx_skb_preprocess); |
| 223 | |
| 224 | void ath9k_cmn_rx_skb_postprocess(struct ath_common *common, |
| 225 | struct sk_buff *skb, |
| 226 | struct ath_rx_status *rx_stats, |
| 227 | struct ieee80211_rx_status *rxs, |
| 228 | bool decrypt_error) |
| 229 | { |
| 230 | struct ath_hw *ah = common->ah; |
| 231 | struct ieee80211_hdr *hdr; |
Benoit PAPILLAULT | 8c35024 | 2009-11-19 22:19:26 +0100 | [diff] [blame] | 232 | int hdrlen, padpos, padsize; |
Luis R. Rodriguez | db86f07 | 2009-11-05 08:44:39 -0800 | [diff] [blame] | 233 | u8 keyix; |
| 234 | __le16 fc; |
| 235 | |
| 236 | /* see if any padding is done by the hw and remove it */ |
| 237 | hdr = (struct ieee80211_hdr *) skb->data; |
| 238 | hdrlen = ieee80211_get_hdrlen_from_skb(skb); |
| 239 | fc = hdr->frame_control; |
Benoit Papillault | 1bc1488 | 2009-11-24 15:49:18 +0100 | [diff] [blame] | 240 | padpos = ath9k_cmn_padpos(hdr->frame_control); |
Luis R. Rodriguez | db86f07 | 2009-11-05 08:44:39 -0800 | [diff] [blame] | 241 | |
| 242 | /* The MAC header is padded to have 32-bit boundary if the |
| 243 | * packet payload is non-zero. The general calculation for |
| 244 | * padsize would take into account odd header lengths: |
Benoit PAPILLAULT | 8c35024 | 2009-11-19 22:19:26 +0100 | [diff] [blame] | 245 | * padsize = (4 - padpos % 4) % 4; However, since only |
Luis R. Rodriguez | db86f07 | 2009-11-05 08:44:39 -0800 | [diff] [blame] | 246 | * even-length headers are used, padding can only be 0 or 2 |
| 247 | * bytes and we can optimize this a bit. In addition, we must |
| 248 | * not try to remove padding from short control frames that do |
| 249 | * not have payload. */ |
Benoit PAPILLAULT | 8c35024 | 2009-11-19 22:19:26 +0100 | [diff] [blame] | 250 | padsize = padpos & 3; |
| 251 | if (padsize && skb->len>=padpos+padsize+FCS_LEN) { |
| 252 | memmove(skb->data + padsize, skb->data, padpos); |
Luis R. Rodriguez | db86f07 | 2009-11-05 08:44:39 -0800 | [diff] [blame] | 253 | skb_pull(skb, padsize); |
| 254 | } |
| 255 | |
| 256 | keyix = rx_stats->rs_keyix; |
| 257 | |
| 258 | if (!(keyix == ATH9K_RXKEYIX_INVALID) && !decrypt_error) { |
| 259 | rxs->flag |= RX_FLAG_DECRYPTED; |
| 260 | } else if (ieee80211_has_protected(fc) |
| 261 | && !decrypt_error && skb->len >= hdrlen + 4) { |
| 262 | keyix = skb->data[hdrlen + 3] >> 6; |
| 263 | |
| 264 | if (test_bit(keyix, common->keymap)) |
| 265 | rxs->flag |= RX_FLAG_DECRYPTED; |
| 266 | } |
| 267 | if (ah->sw_mgmt_crypto && |
| 268 | (rxs->flag & RX_FLAG_DECRYPTED) && |
| 269 | ieee80211_is_mgmt(fc)) |
| 270 | /* Use software decrypt for management frames. */ |
| 271 | rxs->flag &= ~RX_FLAG_DECRYPTED; |
| 272 | } |
| 273 | EXPORT_SYMBOL(ath9k_cmn_rx_skb_postprocess); |
| 274 | |
Benoit Papillault | 1bc1488 | 2009-11-24 15:49:18 +0100 | [diff] [blame] | 275 | int ath9k_cmn_padpos(__le16 frame_control) |
| 276 | { |
| 277 | int padpos = 24; |
| 278 | if (ieee80211_has_a4(frame_control)) { |
| 279 | padpos += ETH_ALEN; |
| 280 | } |
| 281 | if (ieee80211_is_data_qos(frame_control)) { |
| 282 | padpos += IEEE80211_QOS_CTL_LEN; |
| 283 | } |
| 284 | |
| 285 | return padpos; |
| 286 | } |
| 287 | EXPORT_SYMBOL(ath9k_cmn_padpos); |
| 288 | |
Sujith | fb9987d | 2010-03-17 14:25:25 +0530 | [diff] [blame^] | 289 | int ath9k_cmn_get_hw_crypto_keytype(struct sk_buff *skb) |
| 290 | { |
| 291 | struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb); |
| 292 | |
| 293 | if (tx_info->control.hw_key) { |
| 294 | if (tx_info->control.hw_key->alg == ALG_WEP) |
| 295 | return ATH9K_KEY_TYPE_WEP; |
| 296 | else if (tx_info->control.hw_key->alg == ALG_TKIP) |
| 297 | return ATH9K_KEY_TYPE_TKIP; |
| 298 | else if (tx_info->control.hw_key->alg == ALG_CCMP) |
| 299 | return ATH9K_KEY_TYPE_AES; |
| 300 | } |
| 301 | |
| 302 | return ATH9K_KEY_TYPE_CLEAR; |
| 303 | } |
| 304 | EXPORT_SYMBOL(ath9k_cmn_get_hw_crypto_keytype); |
| 305 | |
| 306 | /* |
| 307 | * Calculate the RX filter to be set in the HW. |
| 308 | */ |
| 309 | u32 ath9k_cmn_calcrxfilter(struct ieee80211_hw *hw, struct ath_hw *ah, |
| 310 | unsigned int rxfilter) |
| 311 | { |
| 312 | #define RX_FILTER_PRESERVE (ATH9K_RX_FILTER_PHYERR | ATH9K_RX_FILTER_PHYRADAR) |
| 313 | |
| 314 | u32 rfilt; |
| 315 | |
| 316 | rfilt = (ath9k_hw_getrxfilter(ah) & RX_FILTER_PRESERVE) |
| 317 | | ATH9K_RX_FILTER_UCAST | ATH9K_RX_FILTER_BCAST |
| 318 | | ATH9K_RX_FILTER_MCAST; |
| 319 | |
| 320 | /* If not a STA, enable processing of Probe Requests */ |
| 321 | if (ah->opmode != NL80211_IFTYPE_STATION) |
| 322 | rfilt |= ATH9K_RX_FILTER_PROBEREQ; |
| 323 | |
| 324 | /* |
| 325 | * Set promiscuous mode when FIF_PROMISC_IN_BSS is enabled for station |
| 326 | * mode interface or when in monitor mode. AP mode does not need this |
| 327 | * since it receives all in-BSS frames anyway. |
| 328 | */ |
| 329 | if (((ah->opmode != NL80211_IFTYPE_AP) && |
| 330 | (rxfilter & FIF_PROMISC_IN_BSS)) || |
| 331 | (ah->opmode == NL80211_IFTYPE_MONITOR)) |
| 332 | rfilt |= ATH9K_RX_FILTER_PROM; |
| 333 | |
| 334 | if (rxfilter & FIF_CONTROL) |
| 335 | rfilt |= ATH9K_RX_FILTER_CONTROL; |
| 336 | |
| 337 | if ((ah->opmode == NL80211_IFTYPE_STATION) && |
| 338 | !(rxfilter & FIF_BCN_PRBRESP_PROMISC)) |
| 339 | rfilt |= ATH9K_RX_FILTER_MYBEACON; |
| 340 | else |
| 341 | rfilt |= ATH9K_RX_FILTER_BEACON; |
| 342 | |
| 343 | if ((AR_SREV_9280_10_OR_LATER(ah) || |
| 344 | AR_SREV_9285_10_OR_LATER(ah)) && |
| 345 | (ah->opmode == NL80211_IFTYPE_AP) && |
| 346 | (rxfilter & FIF_PSPOLL)) |
| 347 | rfilt |= ATH9K_RX_FILTER_PSPOLL; |
| 348 | |
| 349 | if (conf_is_ht(&hw->conf)) |
| 350 | rfilt |= ATH9K_RX_FILTER_COMP_BAR; |
| 351 | |
| 352 | return rfilt; |
| 353 | |
| 354 | #undef RX_FILTER_PRESERVE |
| 355 | } |
| 356 | EXPORT_SYMBOL(ath9k_cmn_calcrxfilter); |
| 357 | |
| 358 | /* |
| 359 | * Recv initialization for opmode change. |
| 360 | */ |
| 361 | void ath9k_cmn_opmode_init(struct ieee80211_hw *hw, struct ath_hw *ah, |
| 362 | unsigned int rxfilter) |
| 363 | { |
| 364 | struct ath_common *common = ath9k_hw_common(ah); |
| 365 | |
| 366 | u32 rfilt, mfilt[2]; |
| 367 | |
| 368 | /* configure rx filter */ |
| 369 | rfilt = ath9k_cmn_calcrxfilter(hw, ah, rxfilter); |
| 370 | ath9k_hw_setrxfilter(ah, rfilt); |
| 371 | |
| 372 | /* configure bssid mask */ |
| 373 | if (ah->caps.hw_caps & ATH9K_HW_CAP_BSSIDMASK) |
| 374 | ath_hw_setbssidmask(common); |
| 375 | |
| 376 | /* configure operational mode */ |
| 377 | ath9k_hw_setopmode(ah); |
| 378 | |
| 379 | /* Handle any link-level address change. */ |
| 380 | ath9k_hw_setmac(ah, common->macaddr); |
| 381 | |
| 382 | /* calculate and install multicast filter */ |
| 383 | mfilt[0] = mfilt[1] = ~0; |
| 384 | ath9k_hw_setmcastfilter(ah, mfilt[0], mfilt[1]); |
| 385 | } |
| 386 | EXPORT_SYMBOL(ath9k_cmn_opmode_init); |
| 387 | |
| 388 | static u32 ath9k_get_extchanmode(struct ieee80211_channel *chan, |
| 389 | enum nl80211_channel_type channel_type) |
| 390 | { |
| 391 | u32 chanmode = 0; |
| 392 | |
| 393 | switch (chan->band) { |
| 394 | case IEEE80211_BAND_2GHZ: |
| 395 | switch (channel_type) { |
| 396 | case NL80211_CHAN_NO_HT: |
| 397 | case NL80211_CHAN_HT20: |
| 398 | chanmode = CHANNEL_G_HT20; |
| 399 | break; |
| 400 | case NL80211_CHAN_HT40PLUS: |
| 401 | chanmode = CHANNEL_G_HT40PLUS; |
| 402 | break; |
| 403 | case NL80211_CHAN_HT40MINUS: |
| 404 | chanmode = CHANNEL_G_HT40MINUS; |
| 405 | break; |
| 406 | } |
| 407 | break; |
| 408 | case IEEE80211_BAND_5GHZ: |
| 409 | switch (channel_type) { |
| 410 | case NL80211_CHAN_NO_HT: |
| 411 | case NL80211_CHAN_HT20: |
| 412 | chanmode = CHANNEL_A_HT20; |
| 413 | break; |
| 414 | case NL80211_CHAN_HT40PLUS: |
| 415 | chanmode = CHANNEL_A_HT40PLUS; |
| 416 | break; |
| 417 | case NL80211_CHAN_HT40MINUS: |
| 418 | chanmode = CHANNEL_A_HT40MINUS; |
| 419 | break; |
| 420 | } |
| 421 | break; |
| 422 | default: |
| 423 | break; |
| 424 | } |
| 425 | |
| 426 | return chanmode; |
| 427 | } |
| 428 | |
| 429 | /* |
| 430 | * Update internal channel flags. |
| 431 | */ |
| 432 | void ath9k_cmn_update_ichannel(struct ieee80211_hw *hw, |
| 433 | struct ath9k_channel *ichan) |
| 434 | { |
| 435 | struct ieee80211_channel *chan = hw->conf.channel; |
| 436 | struct ieee80211_conf *conf = &hw->conf; |
| 437 | |
| 438 | ichan->channel = chan->center_freq; |
| 439 | ichan->chan = chan; |
| 440 | |
| 441 | if (chan->band == IEEE80211_BAND_2GHZ) { |
| 442 | ichan->chanmode = CHANNEL_G; |
| 443 | ichan->channelFlags = CHANNEL_2GHZ | CHANNEL_OFDM | CHANNEL_G; |
| 444 | } else { |
| 445 | ichan->chanmode = CHANNEL_A; |
| 446 | ichan->channelFlags = CHANNEL_5GHZ | CHANNEL_OFDM; |
| 447 | } |
| 448 | |
| 449 | if (conf_is_ht(conf)) |
| 450 | ichan->chanmode = ath9k_get_extchanmode(chan, |
| 451 | conf->channel_type); |
| 452 | } |
| 453 | EXPORT_SYMBOL(ath9k_cmn_update_ichannel); |
| 454 | |
| 455 | /* |
| 456 | * Get the internal channel reference. |
| 457 | */ |
| 458 | struct ath9k_channel *ath9k_cmn_get_curchannel(struct ieee80211_hw *hw, |
| 459 | struct ath_hw *ah) |
| 460 | { |
| 461 | struct ieee80211_channel *curchan = hw->conf.channel; |
| 462 | struct ath9k_channel *channel; |
| 463 | u8 chan_idx; |
| 464 | |
| 465 | chan_idx = curchan->hw_value; |
| 466 | channel = &ah->channels[chan_idx]; |
| 467 | ath9k_cmn_update_ichannel(hw, channel); |
| 468 | |
| 469 | return channel; |
| 470 | } |
| 471 | EXPORT_SYMBOL(ath9k_cmn_get_curchannel); |
| 472 | |
| 473 | static int ath_setkey_tkip(struct ath_common *common, u16 keyix, const u8 *key, |
| 474 | struct ath9k_keyval *hk, const u8 *addr, |
| 475 | bool authenticator) |
| 476 | { |
| 477 | struct ath_hw *ah = common->ah; |
| 478 | const u8 *key_rxmic; |
| 479 | const u8 *key_txmic; |
| 480 | |
| 481 | key_txmic = key + NL80211_TKIP_DATA_OFFSET_TX_MIC_KEY; |
| 482 | key_rxmic = key + NL80211_TKIP_DATA_OFFSET_RX_MIC_KEY; |
| 483 | |
| 484 | if (addr == NULL) { |
| 485 | /* |
| 486 | * Group key installation - only two key cache entries are used |
| 487 | * regardless of splitmic capability since group key is only |
| 488 | * used either for TX or RX. |
| 489 | */ |
| 490 | if (authenticator) { |
| 491 | memcpy(hk->kv_mic, key_txmic, sizeof(hk->kv_mic)); |
| 492 | memcpy(hk->kv_txmic, key_txmic, sizeof(hk->kv_mic)); |
| 493 | } else { |
| 494 | memcpy(hk->kv_mic, key_rxmic, sizeof(hk->kv_mic)); |
| 495 | memcpy(hk->kv_txmic, key_rxmic, sizeof(hk->kv_mic)); |
| 496 | } |
| 497 | return ath9k_hw_set_keycache_entry(ah, keyix, hk, addr); |
| 498 | } |
| 499 | if (!common->splitmic) { |
| 500 | /* TX and RX keys share the same key cache entry. */ |
| 501 | memcpy(hk->kv_mic, key_rxmic, sizeof(hk->kv_mic)); |
| 502 | memcpy(hk->kv_txmic, key_txmic, sizeof(hk->kv_txmic)); |
| 503 | return ath9k_hw_set_keycache_entry(ah, keyix, hk, addr); |
| 504 | } |
| 505 | |
| 506 | /* Separate key cache entries for TX and RX */ |
| 507 | |
| 508 | /* TX key goes at first index, RX key at +32. */ |
| 509 | memcpy(hk->kv_mic, key_txmic, sizeof(hk->kv_mic)); |
| 510 | if (!ath9k_hw_set_keycache_entry(ah, keyix, hk, NULL)) { |
| 511 | /* TX MIC entry failed. No need to proceed further */ |
| 512 | ath_print(common, ATH_DBG_FATAL, |
| 513 | "Setting TX MIC Key Failed\n"); |
| 514 | return 0; |
| 515 | } |
| 516 | |
| 517 | memcpy(hk->kv_mic, key_rxmic, sizeof(hk->kv_mic)); |
| 518 | /* XXX delete tx key on failure? */ |
| 519 | return ath9k_hw_set_keycache_entry(ah, keyix + 32, hk, addr); |
| 520 | } |
| 521 | |
| 522 | static int ath_reserve_key_cache_slot_tkip(struct ath_common *common) |
| 523 | { |
| 524 | int i; |
| 525 | |
| 526 | for (i = IEEE80211_WEP_NKID; i < common->keymax / 2; i++) { |
| 527 | if (test_bit(i, common->keymap) || |
| 528 | test_bit(i + 64, common->keymap)) |
| 529 | continue; /* At least one part of TKIP key allocated */ |
| 530 | if (common->splitmic && |
| 531 | (test_bit(i + 32, common->keymap) || |
| 532 | test_bit(i + 64 + 32, common->keymap))) |
| 533 | continue; /* At least one part of TKIP key allocated */ |
| 534 | |
| 535 | /* Found a free slot for a TKIP key */ |
| 536 | return i; |
| 537 | } |
| 538 | return -1; |
| 539 | } |
| 540 | |
| 541 | static int ath_reserve_key_cache_slot(struct ath_common *common) |
| 542 | { |
| 543 | int i; |
| 544 | |
| 545 | /* First, try to find slots that would not be available for TKIP. */ |
| 546 | if (common->splitmic) { |
| 547 | for (i = IEEE80211_WEP_NKID; i < common->keymax / 4; i++) { |
| 548 | if (!test_bit(i, common->keymap) && |
| 549 | (test_bit(i + 32, common->keymap) || |
| 550 | test_bit(i + 64, common->keymap) || |
| 551 | test_bit(i + 64 + 32, common->keymap))) |
| 552 | return i; |
| 553 | if (!test_bit(i + 32, common->keymap) && |
| 554 | (test_bit(i, common->keymap) || |
| 555 | test_bit(i + 64, common->keymap) || |
| 556 | test_bit(i + 64 + 32, common->keymap))) |
| 557 | return i + 32; |
| 558 | if (!test_bit(i + 64, common->keymap) && |
| 559 | (test_bit(i , common->keymap) || |
| 560 | test_bit(i + 32, common->keymap) || |
| 561 | test_bit(i + 64 + 32, common->keymap))) |
| 562 | return i + 64; |
| 563 | if (!test_bit(i + 64 + 32, common->keymap) && |
| 564 | (test_bit(i, common->keymap) || |
| 565 | test_bit(i + 32, common->keymap) || |
| 566 | test_bit(i + 64, common->keymap))) |
| 567 | return i + 64 + 32; |
| 568 | } |
| 569 | } else { |
| 570 | for (i = IEEE80211_WEP_NKID; i < common->keymax / 2; i++) { |
| 571 | if (!test_bit(i, common->keymap) && |
| 572 | test_bit(i + 64, common->keymap)) |
| 573 | return i; |
| 574 | if (test_bit(i, common->keymap) && |
| 575 | !test_bit(i + 64, common->keymap)) |
| 576 | return i + 64; |
| 577 | } |
| 578 | } |
| 579 | |
| 580 | /* No partially used TKIP slots, pick any available slot */ |
| 581 | for (i = IEEE80211_WEP_NKID; i < common->keymax; i++) { |
| 582 | /* Do not allow slots that could be needed for TKIP group keys |
| 583 | * to be used. This limitation could be removed if we know that |
| 584 | * TKIP will not be used. */ |
| 585 | if (i >= 64 && i < 64 + IEEE80211_WEP_NKID) |
| 586 | continue; |
| 587 | if (common->splitmic) { |
| 588 | if (i >= 32 && i < 32 + IEEE80211_WEP_NKID) |
| 589 | continue; |
| 590 | if (i >= 64 + 32 && i < 64 + 32 + IEEE80211_WEP_NKID) |
| 591 | continue; |
| 592 | } |
| 593 | |
| 594 | if (!test_bit(i, common->keymap)) |
| 595 | return i; /* Found a free slot for a key */ |
| 596 | } |
| 597 | |
| 598 | /* No free slot found */ |
| 599 | return -1; |
| 600 | } |
| 601 | |
| 602 | /* |
| 603 | * Configure encryption in the HW. |
| 604 | */ |
| 605 | int ath9k_cmn_key_config(struct ath_common *common, |
| 606 | struct ieee80211_vif *vif, |
| 607 | struct ieee80211_sta *sta, |
| 608 | struct ieee80211_key_conf *key) |
| 609 | { |
| 610 | struct ath_hw *ah = common->ah; |
| 611 | struct ath9k_keyval hk; |
| 612 | const u8 *mac = NULL; |
| 613 | int ret = 0; |
| 614 | int idx; |
| 615 | |
| 616 | memset(&hk, 0, sizeof(hk)); |
| 617 | |
| 618 | switch (key->alg) { |
| 619 | case ALG_WEP: |
| 620 | hk.kv_type = ATH9K_CIPHER_WEP; |
| 621 | break; |
| 622 | case ALG_TKIP: |
| 623 | hk.kv_type = ATH9K_CIPHER_TKIP; |
| 624 | break; |
| 625 | case ALG_CCMP: |
| 626 | hk.kv_type = ATH9K_CIPHER_AES_CCM; |
| 627 | break; |
| 628 | default: |
| 629 | return -EOPNOTSUPP; |
| 630 | } |
| 631 | |
| 632 | hk.kv_len = key->keylen; |
| 633 | memcpy(hk.kv_val, key->key, key->keylen); |
| 634 | |
| 635 | if (!(key->flags & IEEE80211_KEY_FLAG_PAIRWISE)) { |
| 636 | /* For now, use the default keys for broadcast keys. This may |
| 637 | * need to change with virtual interfaces. */ |
| 638 | idx = key->keyidx; |
| 639 | } else if (key->keyidx) { |
| 640 | if (WARN_ON(!sta)) |
| 641 | return -EOPNOTSUPP; |
| 642 | mac = sta->addr; |
| 643 | |
| 644 | if (vif->type != NL80211_IFTYPE_AP) { |
| 645 | /* Only keyidx 0 should be used with unicast key, but |
| 646 | * allow this for client mode for now. */ |
| 647 | idx = key->keyidx; |
| 648 | } else |
| 649 | return -EIO; |
| 650 | } else { |
| 651 | if (WARN_ON(!sta)) |
| 652 | return -EOPNOTSUPP; |
| 653 | mac = sta->addr; |
| 654 | |
| 655 | if (key->alg == ALG_TKIP) |
| 656 | idx = ath_reserve_key_cache_slot_tkip(common); |
| 657 | else |
| 658 | idx = ath_reserve_key_cache_slot(common); |
| 659 | if (idx < 0) |
| 660 | return -ENOSPC; /* no free key cache entries */ |
| 661 | } |
| 662 | |
| 663 | if (key->alg == ALG_TKIP) |
| 664 | ret = ath_setkey_tkip(common, idx, key->key, &hk, mac, |
| 665 | vif->type == NL80211_IFTYPE_AP); |
| 666 | else |
| 667 | ret = ath9k_hw_set_keycache_entry(ah, idx, &hk, mac); |
| 668 | |
| 669 | if (!ret) |
| 670 | return -EIO; |
| 671 | |
| 672 | set_bit(idx, common->keymap); |
| 673 | if (key->alg == ALG_TKIP) { |
| 674 | set_bit(idx + 64, common->keymap); |
| 675 | if (common->splitmic) { |
| 676 | set_bit(idx + 32, common->keymap); |
| 677 | set_bit(idx + 64 + 32, common->keymap); |
| 678 | } |
| 679 | } |
| 680 | |
| 681 | return idx; |
| 682 | } |
| 683 | EXPORT_SYMBOL(ath9k_cmn_key_config); |
| 684 | |
| 685 | /* |
| 686 | * Delete Key. |
| 687 | */ |
| 688 | void ath9k_cmn_key_delete(struct ath_common *common, |
| 689 | struct ieee80211_key_conf *key) |
| 690 | { |
| 691 | struct ath_hw *ah = common->ah; |
| 692 | |
| 693 | ath9k_hw_keyreset(ah, key->hw_key_idx); |
| 694 | if (key->hw_key_idx < IEEE80211_WEP_NKID) |
| 695 | return; |
| 696 | |
| 697 | clear_bit(key->hw_key_idx, common->keymap); |
| 698 | if (key->alg != ALG_TKIP) |
| 699 | return; |
| 700 | |
| 701 | clear_bit(key->hw_key_idx + 64, common->keymap); |
| 702 | if (common->splitmic) { |
| 703 | ath9k_hw_keyreset(ah, key->hw_key_idx + 32); |
| 704 | clear_bit(key->hw_key_idx + 32, common->keymap); |
| 705 | clear_bit(key->hw_key_idx + 64 + 32, common->keymap); |
| 706 | } |
| 707 | } |
| 708 | EXPORT_SYMBOL(ath9k_cmn_key_delete); |
| 709 | |
Luis R. Rodriguez | db86f07 | 2009-11-05 08:44:39 -0800 | [diff] [blame] | 710 | static int __init ath9k_cmn_init(void) |
| 711 | { |
| 712 | return 0; |
| 713 | } |
| 714 | module_init(ath9k_cmn_init); |
| 715 | |
| 716 | static void __exit ath9k_cmn_exit(void) |
| 717 | { |
| 718 | return; |
| 719 | } |
| 720 | module_exit(ath9k_cmn_exit); |