289 lines · c
1// SPDX-License-Identifier: ISC2/*3 * Copyright (c) 2005-2011 Atheros Communications Inc.4 * Copyright (c) 2011-2016 Qualcomm Atheros, Inc.5 * Copyright (c) 2018, The Linux Foundation. All rights reserved.6 */7 8#include "core.h"9#include "txrx.h"10#include "htt.h"11#include "mac.h"12#include "debug.h"13 14static void ath10k_report_offchan_tx(struct ath10k *ar, struct sk_buff *skb)15{16 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);17 18 if (likely(!(info->flags & IEEE80211_TX_CTL_TX_OFFCHAN)))19 return;20 21 if (ath10k_mac_tx_frm_has_freq(ar))22 return;23 24 /* If the original wait_for_completion() timed out before25 * {data,mgmt}_tx_completed() was called then we could complete26 * offchan_tx_completed for a different skb. Prevent this by using27 * offchan_tx_skb.28 */29 spin_lock_bh(&ar->data_lock);30 if (ar->offchan_tx_skb != skb) {31 ath10k_warn(ar, "completed old offchannel frame\n");32 goto out;33 }34 35 complete(&ar->offchan_tx_completed);36 ar->offchan_tx_skb = NULL; /* just for sanity */37 38 ath10k_dbg(ar, ATH10K_DBG_HTT, "completed offchannel skb %pK\n", skb);39out:40 spin_unlock_bh(&ar->data_lock);41}42 43int ath10k_txrx_tx_unref(struct ath10k_htt *htt,44 const struct htt_tx_done *tx_done)45{46 struct ieee80211_tx_status status;47 struct ath10k *ar = htt->ar;48 struct device *dev = ar->dev;49 struct ieee80211_tx_info *info;50 struct ieee80211_txq *txq;51 struct ath10k_skb_cb *skb_cb;52 struct ath10k_txq *artxq;53 struct sk_buff *msdu;54 u8 flags;55 56 ath10k_dbg(ar, ATH10K_DBG_HTT,57 "htt tx completion msdu_id %u status %d\n",58 tx_done->msdu_id, tx_done->status);59 60 if (tx_done->msdu_id >= htt->max_num_pending_tx) {61 ath10k_warn(ar, "warning: msdu_id %d too big, ignoring\n",62 tx_done->msdu_id);63 return -EINVAL;64 }65 66 spin_lock_bh(&htt->tx_lock);67 msdu = idr_find(&htt->pending_tx, tx_done->msdu_id);68 if (!msdu) {69 ath10k_warn(ar, "received tx completion for invalid msdu_id: %d\n",70 tx_done->msdu_id);71 spin_unlock_bh(&htt->tx_lock);72 return -ENOENT;73 }74 75 skb_cb = ATH10K_SKB_CB(msdu);76 txq = skb_cb->txq;77 78 if (txq) {79 artxq = (void *)txq->drv_priv;80 artxq->num_fw_queued--;81 }82 83 flags = skb_cb->flags;84 ath10k_htt_tx_free_msdu_id(htt, tx_done->msdu_id);85 ath10k_htt_tx_dec_pending(htt);86 spin_unlock_bh(&htt->tx_lock);87 88 rcu_read_lock();89 if (txq && txq->sta && skb_cb->airtime_est)90 ieee80211_sta_register_airtime(txq->sta, txq->tid,91 skb_cb->airtime_est, 0);92 rcu_read_unlock();93 94 if (ar->bus_param.dev_type != ATH10K_DEV_TYPE_HL)95 dma_unmap_single(dev, skb_cb->paddr, msdu->len, DMA_TO_DEVICE);96 97 ath10k_report_offchan_tx(htt->ar, msdu);98 99 info = IEEE80211_SKB_CB(msdu);100 memset(&info->status, 0, sizeof(info->status));101 info->status.rates[0].idx = -1;102 103 trace_ath10k_txrx_tx_unref(ar, tx_done->msdu_id);104 105 if (!(info->flags & IEEE80211_TX_CTL_NO_ACK) &&106 !(flags & ATH10K_SKB_F_NOACK_TID))107 info->flags |= IEEE80211_TX_STAT_ACK;108 109 if (tx_done->status == HTT_TX_COMPL_STATE_NOACK)110 info->flags &= ~IEEE80211_TX_STAT_ACK;111 112 if ((tx_done->status == HTT_TX_COMPL_STATE_ACK) &&113 ((info->flags & IEEE80211_TX_CTL_NO_ACK) ||114 (flags & ATH10K_SKB_F_NOACK_TID)))115 info->flags |= IEEE80211_TX_STAT_NOACK_TRANSMITTED;116 117 if (tx_done->status == HTT_TX_COMPL_STATE_DISCARD) {118 if ((info->flags & IEEE80211_TX_CTL_NO_ACK) ||119 (flags & ATH10K_SKB_F_NOACK_TID))120 info->flags &= ~IEEE80211_TX_STAT_NOACK_TRANSMITTED;121 else122 info->flags &= ~IEEE80211_TX_STAT_ACK;123 }124 125 if (tx_done->status == HTT_TX_COMPL_STATE_ACK &&126 tx_done->ack_rssi != ATH10K_INVALID_RSSI) {127 info->status.ack_signal = ATH10K_DEFAULT_NOISE_FLOOR +128 tx_done->ack_rssi;129 info->status.flags |= IEEE80211_TX_STATUS_ACK_SIGNAL_VALID;130 }131 132 memset(&status, 0, sizeof(status));133 status.skb = msdu;134 status.info = info;135 136 rcu_read_lock();137 138 if (txq)139 status.sta = txq->sta;140 141 ieee80211_tx_status_ext(htt->ar->hw, &status);142 143 rcu_read_unlock();144 145 /* we do not own the msdu anymore */146 147 return 0;148}149 150struct ath10k_peer *ath10k_peer_find(struct ath10k *ar, int vdev_id,151 const u8 *addr)152{153 struct ath10k_peer *peer;154 155 lockdep_assert_held(&ar->data_lock);156 157 list_for_each_entry(peer, &ar->peers, list) {158 if (peer->vdev_id != vdev_id)159 continue;160 if (!ether_addr_equal(peer->addr, addr))161 continue;162 163 return peer;164 }165 166 return NULL;167}168 169struct ath10k_peer *ath10k_peer_find_by_id(struct ath10k *ar, int peer_id)170{171 struct ath10k_peer *peer;172 173 if (peer_id >= BITS_PER_TYPE(peer->peer_ids))174 return NULL;175 176 lockdep_assert_held(&ar->data_lock);177 178 list_for_each_entry(peer, &ar->peers, list)179 if (test_bit(peer_id, peer->peer_ids))180 return peer;181 182 return NULL;183}184 185static int ath10k_wait_for_peer_common(struct ath10k *ar, int vdev_id,186 const u8 *addr, bool expect_mapped)187{188 long time_left;189 190 time_left = wait_event_timeout(ar->peer_mapping_wq, ({191 bool mapped;192 193 spin_lock_bh(&ar->data_lock);194 mapped = !!ath10k_peer_find(ar, vdev_id, addr);195 spin_unlock_bh(&ar->data_lock);196 197 (mapped == expect_mapped ||198 test_bit(ATH10K_FLAG_CRASH_FLUSH, &ar->dev_flags));199 }), 3 * HZ);200 201 if (time_left == 0)202 return -ETIMEDOUT;203 204 return 0;205}206 207int ath10k_wait_for_peer_created(struct ath10k *ar, int vdev_id, const u8 *addr)208{209 return ath10k_wait_for_peer_common(ar, vdev_id, addr, true);210}211 212int ath10k_wait_for_peer_deleted(struct ath10k *ar, int vdev_id, const u8 *addr)213{214 return ath10k_wait_for_peer_common(ar, vdev_id, addr, false);215}216 217void ath10k_peer_map_event(struct ath10k_htt *htt,218 struct htt_peer_map_event *ev)219{220 struct ath10k *ar = htt->ar;221 struct ath10k_peer *peer;222 223 if (ev->peer_id >= ATH10K_MAX_NUM_PEER_IDS) {224 ath10k_warn(ar,225 "received htt peer map event with idx out of bounds: %u\n",226 ev->peer_id);227 return;228 }229 230 spin_lock_bh(&ar->data_lock);231 peer = ath10k_peer_find(ar, ev->vdev_id, ev->addr);232 if (!peer) {233 peer = kzalloc(sizeof(*peer), GFP_ATOMIC);234 if (!peer)235 goto exit;236 237 peer->vdev_id = ev->vdev_id;238 ether_addr_copy(peer->addr, ev->addr);239 list_add(&peer->list, &ar->peers);240 wake_up(&ar->peer_mapping_wq);241 }242 243 ath10k_dbg(ar, ATH10K_DBG_HTT, "htt peer map vdev %d peer %pM id %d\n",244 ev->vdev_id, ev->addr, ev->peer_id);245 246 WARN_ON(ar->peer_map[ev->peer_id] && (ar->peer_map[ev->peer_id] != peer));247 ar->peer_map[ev->peer_id] = peer;248 set_bit(ev->peer_id, peer->peer_ids);249exit:250 spin_unlock_bh(&ar->data_lock);251}252 253void ath10k_peer_unmap_event(struct ath10k_htt *htt,254 struct htt_peer_unmap_event *ev)255{256 struct ath10k *ar = htt->ar;257 struct ath10k_peer *peer;258 259 if (ev->peer_id >= ATH10K_MAX_NUM_PEER_IDS) {260 ath10k_warn(ar,261 "received htt peer unmap event with idx out of bounds: %u\n",262 ev->peer_id);263 return;264 }265 266 spin_lock_bh(&ar->data_lock);267 peer = ath10k_peer_find_by_id(ar, ev->peer_id);268 if (!peer) {269 ath10k_warn(ar, "peer-unmap-event: unknown peer id %d\n",270 ev->peer_id);271 goto exit;272 }273 274 ath10k_dbg(ar, ATH10K_DBG_HTT, "htt peer unmap vdev %d peer %pM id %d\n",275 peer->vdev_id, peer->addr, ev->peer_id);276 277 ar->peer_map[ev->peer_id] = NULL;278 clear_bit(ev->peer_id, peer->peer_ids);279 280 if (bitmap_empty(peer->peer_ids, ATH10K_MAX_NUM_PEER_IDS)) {281 list_del(&peer->list);282 kfree(peer);283 wake_up(&ar->peer_mapping_wq);284 }285 286exit:287 spin_unlock_bh(&ar->data_lock);288}289