linux/drivers/net/wireless/ath/ath10k/txrx.c
<<
>>
Prefs
   1// SPDX-License-Identifier: ISC
   2/*
   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 before
  25         * {data,mgmt}_tx_completed() was called then we could complete
  26         * offchan_tx_completed for a different skb. Prevent this by using
  27         * 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 ath10k *ar = htt->ar;
  47        struct device *dev = ar->dev;
  48        struct ieee80211_tx_info *info;
  49        struct ieee80211_txq *txq;
  50        struct ath10k_skb_cb *skb_cb;
  51        struct ath10k_txq *artxq;
  52        struct sk_buff *msdu;
  53
  54        ath10k_dbg(ar, ATH10K_DBG_HTT,
  55                   "htt tx completion msdu_id %u status %d\n",
  56                   tx_done->msdu_id, tx_done->status);
  57
  58        if (tx_done->msdu_id >= htt->max_num_pending_tx) {
  59                ath10k_warn(ar, "warning: msdu_id %d too big, ignoring\n",
  60                            tx_done->msdu_id);
  61                return -EINVAL;
  62        }
  63
  64        spin_lock_bh(&htt->tx_lock);
  65        msdu = idr_find(&htt->pending_tx, tx_done->msdu_id);
  66        if (!msdu) {
  67                ath10k_warn(ar, "received tx completion for invalid msdu_id: %d\n",
  68                            tx_done->msdu_id);
  69                spin_unlock_bh(&htt->tx_lock);
  70                return -ENOENT;
  71        }
  72
  73        skb_cb = ATH10K_SKB_CB(msdu);
  74        txq = skb_cb->txq;
  75
  76        if (txq) {
  77                artxq = (void *)txq->drv_priv;
  78                artxq->num_fw_queued--;
  79        }
  80
  81        ath10k_htt_tx_free_msdu_id(htt, tx_done->msdu_id);
  82        ath10k_htt_tx_dec_pending(htt);
  83        if (htt->num_pending_tx == 0)
  84                wake_up(&htt->empty_tx_wq);
  85        spin_unlock_bh(&htt->tx_lock);
  86
  87        rcu_read_lock();
  88        if (txq && txq->sta && skb_cb->airtime_est)
  89                ieee80211_sta_register_airtime(txq->sta, txq->tid,
  90                                               skb_cb->airtime_est, 0);
  91        rcu_read_unlock();
  92
  93        if (ar->bus_param.dev_type != ATH10K_DEV_TYPE_HL)
  94                dma_unmap_single(dev, skb_cb->paddr, msdu->len, DMA_TO_DEVICE);
  95
  96        ath10k_report_offchan_tx(htt->ar, msdu);
  97
  98        info = IEEE80211_SKB_CB(msdu);
  99        memset(&info->status, 0, sizeof(info->status));
 100        info->status.rates[0].idx = -1;
 101
 102        trace_ath10k_txrx_tx_unref(ar, tx_done->msdu_id);
 103
 104        if (!(info->flags & IEEE80211_TX_CTL_NO_ACK))
 105                info->flags |= IEEE80211_TX_STAT_ACK;
 106
 107        if (tx_done->status == HTT_TX_COMPL_STATE_NOACK)
 108                info->flags &= ~IEEE80211_TX_STAT_ACK;
 109
 110        if ((tx_done->status == HTT_TX_COMPL_STATE_ACK) &&
 111            (info->flags & IEEE80211_TX_CTL_NO_ACK))
 112                info->flags |= IEEE80211_TX_STAT_NOACK_TRANSMITTED;
 113
 114        if (tx_done->status == HTT_TX_COMPL_STATE_DISCARD) {
 115                if (info->flags & IEEE80211_TX_CTL_NO_ACK)
 116                        info->flags &= ~IEEE80211_TX_STAT_NOACK_TRANSMITTED;
 117                else
 118                        info->flags &= ~IEEE80211_TX_STAT_ACK;
 119        }
 120
 121        if (tx_done->status == HTT_TX_COMPL_STATE_ACK &&
 122            tx_done->ack_rssi != ATH10K_INVALID_RSSI) {
 123                info->status.ack_signal = ATH10K_DEFAULT_NOISE_FLOOR +
 124                                                tx_done->ack_rssi;
 125                info->status.is_valid_ack_signal = true;
 126        }
 127
 128        ieee80211_tx_status(htt->ar->hw, msdu);
 129        /* we do not own the msdu anymore */
 130
 131        return 0;
 132}
 133
 134struct ath10k_peer *ath10k_peer_find(struct ath10k *ar, int vdev_id,
 135                                     const u8 *addr)
 136{
 137        struct ath10k_peer *peer;
 138
 139        lockdep_assert_held(&ar->data_lock);
 140
 141        list_for_each_entry(peer, &ar->peers, list) {
 142                if (peer->vdev_id != vdev_id)
 143                        continue;
 144                if (!ether_addr_equal(peer->addr, addr))
 145                        continue;
 146
 147                return peer;
 148        }
 149
 150        return NULL;
 151}
 152
 153struct ath10k_peer *ath10k_peer_find_by_id(struct ath10k *ar, int peer_id)
 154{
 155        struct ath10k_peer *peer;
 156
 157        if (peer_id >= BITS_PER_TYPE(peer->peer_ids))
 158                return NULL;
 159
 160        lockdep_assert_held(&ar->data_lock);
 161
 162        list_for_each_entry(peer, &ar->peers, list)
 163                if (test_bit(peer_id, peer->peer_ids))
 164                        return peer;
 165
 166        return NULL;
 167}
 168
 169static int ath10k_wait_for_peer_common(struct ath10k *ar, int vdev_id,
 170                                       const u8 *addr, bool expect_mapped)
 171{
 172        long time_left;
 173
 174        time_left = wait_event_timeout(ar->peer_mapping_wq, ({
 175                        bool mapped;
 176
 177                        spin_lock_bh(&ar->data_lock);
 178                        mapped = !!ath10k_peer_find(ar, vdev_id, addr);
 179                        spin_unlock_bh(&ar->data_lock);
 180
 181                        (mapped == expect_mapped ||
 182                         test_bit(ATH10K_FLAG_CRASH_FLUSH, &ar->dev_flags));
 183                }), 3 * HZ);
 184
 185        if (time_left == 0)
 186                return -ETIMEDOUT;
 187
 188        return 0;
 189}
 190
 191int ath10k_wait_for_peer_created(struct ath10k *ar, int vdev_id, const u8 *addr)
 192{
 193        return ath10k_wait_for_peer_common(ar, vdev_id, addr, true);
 194}
 195
 196int ath10k_wait_for_peer_deleted(struct ath10k *ar, int vdev_id, const u8 *addr)
 197{
 198        return ath10k_wait_for_peer_common(ar, vdev_id, addr, false);
 199}
 200
 201void ath10k_peer_map_event(struct ath10k_htt *htt,
 202                           struct htt_peer_map_event *ev)
 203{
 204        struct ath10k *ar = htt->ar;
 205        struct ath10k_peer *peer;
 206
 207        if (ev->peer_id >= ATH10K_MAX_NUM_PEER_IDS) {
 208                ath10k_warn(ar,
 209                            "received htt peer map event with idx out of bounds: %hu\n",
 210                            ev->peer_id);
 211                return;
 212        }
 213
 214        spin_lock_bh(&ar->data_lock);
 215        peer = ath10k_peer_find(ar, ev->vdev_id, ev->addr);
 216        if (!peer) {
 217                peer = kzalloc(sizeof(*peer), GFP_ATOMIC);
 218                if (!peer)
 219                        goto exit;
 220
 221                peer->vdev_id = ev->vdev_id;
 222                ether_addr_copy(peer->addr, ev->addr);
 223                list_add(&peer->list, &ar->peers);
 224                wake_up(&ar->peer_mapping_wq);
 225        }
 226
 227        ath10k_dbg(ar, ATH10K_DBG_HTT, "htt peer map vdev %d peer %pM id %d\n",
 228                   ev->vdev_id, ev->addr, ev->peer_id);
 229
 230        WARN_ON(ar->peer_map[ev->peer_id] && (ar->peer_map[ev->peer_id] != peer));
 231        ar->peer_map[ev->peer_id] = peer;
 232        set_bit(ev->peer_id, peer->peer_ids);
 233exit:
 234        spin_unlock_bh(&ar->data_lock);
 235}
 236
 237void ath10k_peer_unmap_event(struct ath10k_htt *htt,
 238                             struct htt_peer_unmap_event *ev)
 239{
 240        struct ath10k *ar = htt->ar;
 241        struct ath10k_peer *peer;
 242
 243        if (ev->peer_id >= ATH10K_MAX_NUM_PEER_IDS) {
 244                ath10k_warn(ar,
 245                            "received htt peer unmap event with idx out of bounds: %hu\n",
 246                            ev->peer_id);
 247                return;
 248        }
 249
 250        spin_lock_bh(&ar->data_lock);
 251        peer = ath10k_peer_find_by_id(ar, ev->peer_id);
 252        if (!peer) {
 253                ath10k_warn(ar, "peer-unmap-event: unknown peer id %d\n",
 254                            ev->peer_id);
 255                goto exit;
 256        }
 257
 258        ath10k_dbg(ar, ATH10K_DBG_HTT, "htt peer unmap vdev %d peer %pM id %d\n",
 259                   peer->vdev_id, peer->addr, ev->peer_id);
 260
 261        ar->peer_map[ev->peer_id] = NULL;
 262        clear_bit(ev->peer_id, peer->peer_ids);
 263
 264        if (bitmap_empty(peer->peer_ids, ATH10K_MAX_NUM_PEER_IDS)) {
 265                list_del(&peer->list);
 266                kfree(peer);
 267                wake_up(&ar->peer_mapping_wq);
 268        }
 269
 270exit:
 271        spin_unlock_bh(&ar->data_lock);
 272}
 273