123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417 |
- /*
- * Copyright (c) 2005-2011 Atheros Communications Inc.
- * Copyright (c) 2011-2013 Qualcomm Atheros, Inc.
- *
- * Permission to use, copy, modify, and/or distribute this software for any
- * purpose with or without fee is hereby granted, provided that the above
- * copyright notice and this permission notice appear in all copies.
- *
- * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
- * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
- * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
- * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
- * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
- * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
- * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
- */
- #include "core.h"
- #include "txrx.h"
- #include "htt.h"
- #include "mac.h"
- #include "debug.h"
- static void ath10k_report_offchan_tx(struct ath10k *ar, struct sk_buff *skb)
- {
- if (!ATH10K_SKB_CB(skb)->htt.is_offchan)
- return;
- /* If the original wait_for_completion() timed out before
- * {data,mgmt}_tx_completed() was called then we could complete
- * offchan_tx_completed for a different skb. Prevent this by using
- * offchan_tx_skb. */
- spin_lock_bh(&ar->data_lock);
- if (ar->offchan_tx_skb != skb) {
- ath10k_warn("completed old offchannel frame\n");
- goto out;
- }
- complete(&ar->offchan_tx_completed);
- ar->offchan_tx_skb = NULL; /* just for sanity */
- ath10k_dbg(ATH10K_DBG_HTT, "completed offchannel skb %p\n", skb);
- out:
- spin_unlock_bh(&ar->data_lock);
- }
- void ath10k_txrx_tx_unref(struct ath10k_htt *htt, struct sk_buff *txdesc)
- {
- struct device *dev = htt->ar->dev;
- struct ieee80211_tx_info *info;
- struct sk_buff *txfrag = ATH10K_SKB_CB(txdesc)->htt.txfrag;
- struct sk_buff *msdu = ATH10K_SKB_CB(txdesc)->htt.msdu;
- int ret;
- if (ATH10K_SKB_CB(txdesc)->htt.refcount == 0)
- return;
- ATH10K_SKB_CB(txdesc)->htt.refcount--;
- if (ATH10K_SKB_CB(txdesc)->htt.refcount > 0)
- return;
- if (txfrag) {
- ret = ath10k_skb_unmap(dev, txfrag);
- if (ret)
- ath10k_warn("txfrag unmap failed (%d)\n", ret);
- dev_kfree_skb_any(txfrag);
- }
- ret = ath10k_skb_unmap(dev, msdu);
- if (ret)
- ath10k_warn("data skb unmap failed (%d)\n", ret);
- ath10k_report_offchan_tx(htt->ar, msdu);
- info = IEEE80211_SKB_CB(msdu);
- memset(&info->status, 0, sizeof(info->status));
- if (ATH10K_SKB_CB(txdesc)->htt.discard) {
- ieee80211_free_txskb(htt->ar->hw, msdu);
- goto exit;
- }
- if (!(info->flags & IEEE80211_TX_CTL_NO_ACK))
- info->flags |= IEEE80211_TX_STAT_ACK;
- if (ATH10K_SKB_CB(txdesc)->htt.no_ack)
- info->flags &= ~IEEE80211_TX_STAT_ACK;
- ieee80211_tx_status(htt->ar->hw, msdu);
- /* we do not own the msdu anymore */
- exit:
- spin_lock_bh(&htt->tx_lock);
- htt->pending_tx[ATH10K_SKB_CB(txdesc)->htt.msdu_id] = NULL;
- ath10k_htt_tx_free_msdu_id(htt, ATH10K_SKB_CB(txdesc)->htt.msdu_id);
- __ath10k_htt_tx_dec_pending(htt);
- if (bitmap_empty(htt->used_msdu_ids, htt->max_num_pending_tx))
- wake_up(&htt->empty_tx_wq);
- spin_unlock_bh(&htt->tx_lock);
- dev_kfree_skb_any(txdesc);
- }
- void ath10k_txrx_tx_completed(struct ath10k_htt *htt,
- const struct htt_tx_done *tx_done)
- {
- struct sk_buff *txdesc;
- ath10k_dbg(ATH10K_DBG_HTT, "htt tx completion msdu_id %u discard %d no_ack %d\n",
- tx_done->msdu_id, !!tx_done->discard, !!tx_done->no_ack);
- if (tx_done->msdu_id >= htt->max_num_pending_tx) {
- ath10k_warn("warning: msdu_id %d too big, ignoring\n",
- tx_done->msdu_id);
- return;
- }
- txdesc = htt->pending_tx[tx_done->msdu_id];
- ATH10K_SKB_CB(txdesc)->htt.discard = tx_done->discard;
- ATH10K_SKB_CB(txdesc)->htt.no_ack = tx_done->no_ack;
- ath10k_txrx_tx_unref(htt, txdesc);
- }
- static const u8 rx_legacy_rate_idx[] = {
- 3, /* 0x00 - 11Mbps */
- 2, /* 0x01 - 5.5Mbps */
- 1, /* 0x02 - 2Mbps */
- 0, /* 0x03 - 1Mbps */
- 3, /* 0x04 - 11Mbps */
- 2, /* 0x05 - 5.5Mbps */
- 1, /* 0x06 - 2Mbps */
- 0, /* 0x07 - 1Mbps */
- 10, /* 0x08 - 48Mbps */
- 8, /* 0x09 - 24Mbps */
- 6, /* 0x0A - 12Mbps */
- 4, /* 0x0B - 6Mbps */
- 11, /* 0x0C - 54Mbps */
- 9, /* 0x0D - 36Mbps */
- 7, /* 0x0E - 18Mbps */
- 5, /* 0x0F - 9Mbps */
- };
- static void process_rx_rates(struct ath10k *ar, struct htt_rx_info *info,
- enum ieee80211_band band,
- struct ieee80211_rx_status *status)
- {
- u8 cck, rate, rate_idx, bw, sgi, mcs, nss;
- u8 info0 = info->rate.info0;
- u32 info1 = info->rate.info1;
- u32 info2 = info->rate.info2;
- u8 preamble = 0;
- /* Check if valid fields */
- if (!(info0 & HTT_RX_INDICATION_INFO0_START_VALID))
- return;
- preamble = MS(info1, HTT_RX_INDICATION_INFO1_PREAMBLE_TYPE);
- switch (preamble) {
- case HTT_RX_LEGACY:
- cck = info0 & HTT_RX_INDICATION_INFO0_LEGACY_RATE_CCK;
- rate = MS(info0, HTT_RX_INDICATION_INFO0_LEGACY_RATE);
- rate_idx = 0;
- if (rate < 0x08 || rate > 0x0F)
- break;
- switch (band) {
- case IEEE80211_BAND_2GHZ:
- if (cck)
- rate &= ~BIT(3);
- rate_idx = rx_legacy_rate_idx[rate];
- break;
- case IEEE80211_BAND_5GHZ:
- rate_idx = rx_legacy_rate_idx[rate];
- /* We are using same rate table registering
- HW - ath10k_rates[]. In case of 5GHz skip
- CCK rates, so -4 here */
- rate_idx -= 4;
- break;
- default:
- break;
- }
- status->rate_idx = rate_idx;
- break;
- case HTT_RX_HT:
- case HTT_RX_HT_WITH_TXBF:
- /* HT-SIG - Table 20-11 in info1 and info2 */
- mcs = info1 & 0x1F;
- nss = mcs >> 3;
- bw = (info1 >> 7) & 1;
- sgi = (info2 >> 7) & 1;
- status->rate_idx = mcs;
- status->flag |= RX_FLAG_HT;
- if (sgi)
- status->flag |= RX_FLAG_SHORT_GI;
- if (bw)
- status->flag |= RX_FLAG_40MHZ;
- break;
- case HTT_RX_VHT:
- case HTT_RX_VHT_WITH_TXBF:
- /* VHT-SIG-A1 in info 1, VHT-SIG-A2 in info2
- TODO check this */
- mcs = (info2 >> 4) & 0x0F;
- nss = (info1 >> 10) & 0x07;
- bw = info1 & 3;
- sgi = info2 & 1;
- status->rate_idx = mcs;
- status->vht_nss = nss;
- if (sgi)
- status->flag |= RX_FLAG_SHORT_GI;
- switch (bw) {
- /* 20MHZ */
- case 0:
- break;
- /* 40MHZ */
- case 1:
- status->flag |= RX_FLAG_40MHZ;
- break;
- /* 80MHZ */
- case 2:
- status->flag |= RX_FLAG_80MHZ;
- }
- status->flag |= RX_FLAG_VHT;
- break;
- default:
- break;
- }
- }
- void ath10k_process_rx(struct ath10k *ar, struct htt_rx_info *info)
- {
- struct ieee80211_rx_status *status;
- struct ieee80211_channel *ch;
- struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)info->skb->data;
- status = IEEE80211_SKB_RXCB(info->skb);
- memset(status, 0, sizeof(*status));
- if (info->encrypt_type != HTT_RX_MPDU_ENCRYPT_NONE) {
- status->flag |= RX_FLAG_DECRYPTED | RX_FLAG_IV_STRIPPED |
- RX_FLAG_MMIC_STRIPPED;
- hdr->frame_control = __cpu_to_le16(
- __le16_to_cpu(hdr->frame_control) &
- ~IEEE80211_FCTL_PROTECTED);
- }
- if (info->status == HTT_RX_IND_MPDU_STATUS_TKIP_MIC_ERR)
- status->flag |= RX_FLAG_MMIC_ERROR;
- if (info->fcs_err)
- status->flag |= RX_FLAG_FAILED_FCS_CRC;
- status->signal = info->signal;
- spin_lock_bh(&ar->data_lock);
- ch = ar->scan_channel;
- if (!ch)
- ch = ar->rx_channel;
- spin_unlock_bh(&ar->data_lock);
- if (!ch) {
- ath10k_warn("no channel configured; ignoring frame!\n");
- dev_kfree_skb_any(info->skb);
- return;
- }
- process_rx_rates(ar, info, ch->band, status);
- status->band = ch->band;
- status->freq = ch->center_freq;
- ath10k_dbg(ATH10K_DBG_DATA,
- "rx skb %p len %u %s%s%s%s%s %srate_idx %u vht_nss %u freq %u band %u\n",
- info->skb,
- info->skb->len,
- status->flag == 0 ? "legacy" : "",
- status->flag & RX_FLAG_HT ? "ht" : "",
- status->flag & RX_FLAG_VHT ? "vht" : "",
- status->flag & RX_FLAG_40MHZ ? "40" : "",
- status->flag & RX_FLAG_80MHZ ? "80" : "",
- status->flag & RX_FLAG_SHORT_GI ? "sgi " : "",
- status->rate_idx,
- status->vht_nss,
- status->freq,
- status->band);
- ieee80211_rx(ar->hw, info->skb);
- }
- struct ath10k_peer *ath10k_peer_find(struct ath10k *ar, int vdev_id,
- const u8 *addr)
- {
- struct ath10k_peer *peer;
- lockdep_assert_held(&ar->data_lock);
- list_for_each_entry(peer, &ar->peers, list) {
- if (peer->vdev_id != vdev_id)
- continue;
- if (memcmp(peer->addr, addr, ETH_ALEN))
- continue;
- return peer;
- }
- return NULL;
- }
- static struct ath10k_peer *ath10k_peer_find_by_id(struct ath10k *ar,
- int peer_id)
- {
- struct ath10k_peer *peer;
- lockdep_assert_held(&ar->data_lock);
- list_for_each_entry(peer, &ar->peers, list)
- if (test_bit(peer_id, peer->peer_ids))
- return peer;
- return NULL;
- }
- static int ath10k_wait_for_peer_common(struct ath10k *ar, int vdev_id,
- const u8 *addr, bool expect_mapped)
- {
- int ret;
- ret = wait_event_timeout(ar->peer_mapping_wq, ({
- bool mapped;
- spin_lock_bh(&ar->data_lock);
- mapped = !!ath10k_peer_find(ar, vdev_id, addr);
- spin_unlock_bh(&ar->data_lock);
- mapped == expect_mapped;
- }), 3*HZ);
- if (ret <= 0)
- return -ETIMEDOUT;
- return 0;
- }
- int ath10k_wait_for_peer_created(struct ath10k *ar, int vdev_id, const u8 *addr)
- {
- return ath10k_wait_for_peer_common(ar, vdev_id, addr, true);
- }
- int ath10k_wait_for_peer_deleted(struct ath10k *ar, int vdev_id, const u8 *addr)
- {
- return ath10k_wait_for_peer_common(ar, vdev_id, addr, false);
- }
- void ath10k_peer_map_event(struct ath10k_htt *htt,
- struct htt_peer_map_event *ev)
- {
- struct ath10k *ar = htt->ar;
- struct ath10k_peer *peer;
- spin_lock_bh(&ar->data_lock);
- peer = ath10k_peer_find(ar, ev->vdev_id, ev->addr);
- if (!peer) {
- peer = kzalloc(sizeof(*peer), GFP_ATOMIC);
- if (!peer)
- goto exit;
- peer->vdev_id = ev->vdev_id;
- memcpy(peer->addr, ev->addr, ETH_ALEN);
- list_add(&peer->list, &ar->peers);
- wake_up(&ar->peer_mapping_wq);
- }
- ath10k_dbg(ATH10K_DBG_HTT, "htt peer map vdev %d peer %pM id %d\n",
- ev->vdev_id, ev->addr, ev->peer_id);
- set_bit(ev->peer_id, peer->peer_ids);
- exit:
- spin_unlock_bh(&ar->data_lock);
- }
- void ath10k_peer_unmap_event(struct ath10k_htt *htt,
- struct htt_peer_unmap_event *ev)
- {
- struct ath10k *ar = htt->ar;
- struct ath10k_peer *peer;
- spin_lock_bh(&ar->data_lock);
- peer = ath10k_peer_find_by_id(ar, ev->peer_id);
- if (!peer) {
- ath10k_warn("unknown peer id %d\n", ev->peer_id);
- goto exit;
- }
- ath10k_dbg(ATH10K_DBG_HTT, "htt peer unmap vdev %d peer %pM id %d\n",
- peer->vdev_id, peer->addr, ev->peer_id);
- clear_bit(ev->peer_id, peer->peer_ids);
- if (bitmap_empty(peer->peer_ids, ATH10K_MAX_NUM_PEER_IDS)) {
- list_del(&peer->list);
- kfree(peer);
- wake_up(&ar->peer_mapping_wq);
- }
- exit:
- spin_unlock_bh(&ar->data_lock);
- }
|