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
ath10k_report_offchan_tx(struct ath10k * ar,struct sk_buff * skb)14 static 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);
39 out:
40 spin_unlock_bh(&ar->data_lock);
41 }
42
ath10k_txrx_tx_unref(struct ath10k_htt * htt,const struct htt_tx_done * tx_done)43 int 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 else
122 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
ath10k_peer_find(struct ath10k * ar,int vdev_id,const u8 * addr)150 struct 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
ath10k_peer_find_by_id(struct ath10k * ar,int peer_id)169 struct 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
ath10k_wait_for_peer_common(struct ath10k * ar,int vdev_id,const u8 * addr,bool expect_mapped)185 static 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
ath10k_wait_for_peer_created(struct ath10k * ar,int vdev_id,const u8 * addr)207 int 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
ath10k_wait_for_peer_deleted(struct ath10k * ar,int vdev_id,const u8 * addr)212 int 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
ath10k_peer_map_event(struct ath10k_htt * htt,struct htt_peer_map_event * ev)217 void 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);
249 exit:
250 spin_unlock_bh(&ar->data_lock);
251 }
252
ath10k_peer_unmap_event(struct ath10k_htt * htt,struct htt_peer_unmap_event * ev)253 void 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
286 exit:
287 spin_unlock_bh(&ar->data_lock);
288 }
289