GNU Linux-libre 4.9.287-gnu1
[releases.git] / drivers / net / wireless / ath / ath10k / txrx.c
1 /*
2  * Copyright (c) 2005-2011 Atheros Communications Inc.
3  * Copyright (c) 2011-2013 Qualcomm Atheros, Inc.
4  *
5  * Permission to use, copy, modify, and/or distribute this software for any
6  * purpose with or without fee is hereby granted, provided that the above
7  * copyright notice and this permission notice appear in all copies.
8  *
9  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
10  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
11  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
12  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
13  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
14  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
15  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
16  */
17
18 #include "core.h"
19 #include "txrx.h"
20 #include "htt.h"
21 #include "mac.h"
22 #include "debug.h"
23
24 static void ath10k_report_offchan_tx(struct ath10k *ar, struct sk_buff *skb)
25 {
26         struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
27
28         if (likely(!(info->flags & IEEE80211_TX_CTL_TX_OFFCHAN)))
29                 return;
30
31         if (ath10k_mac_tx_frm_has_freq(ar))
32                 return;
33
34         /* If the original wait_for_completion() timed out before
35          * {data,mgmt}_tx_completed() was called then we could complete
36          * offchan_tx_completed for a different skb. Prevent this by using
37          * offchan_tx_skb. */
38         spin_lock_bh(&ar->data_lock);
39         if (ar->offchan_tx_skb != skb) {
40                 ath10k_warn(ar, "completed old offchannel frame\n");
41                 goto out;
42         }
43
44         complete(&ar->offchan_tx_completed);
45         ar->offchan_tx_skb = NULL; /* just for sanity */
46
47         ath10k_dbg(ar, ATH10K_DBG_HTT, "completed offchannel skb %pK\n", skb);
48 out:
49         spin_unlock_bh(&ar->data_lock);
50 }
51
52 int ath10k_txrx_tx_unref(struct ath10k_htt *htt,
53                          const struct htt_tx_done *tx_done)
54 {
55         struct ath10k *ar = htt->ar;
56         struct device *dev = ar->dev;
57         struct ieee80211_tx_info *info;
58         struct ieee80211_txq *txq;
59         struct ath10k_skb_cb *skb_cb;
60         struct ath10k_txq *artxq;
61         struct sk_buff *msdu;
62
63         ath10k_dbg(ar, ATH10K_DBG_HTT,
64                    "htt tx completion msdu_id %u status %d\n",
65                    tx_done->msdu_id, tx_done->status);
66
67         if (tx_done->msdu_id >= htt->max_num_pending_tx) {
68                 ath10k_warn(ar, "warning: msdu_id %d too big, ignoring\n",
69                             tx_done->msdu_id);
70                 return -EINVAL;
71         }
72
73         spin_lock_bh(&htt->tx_lock);
74         msdu = idr_find(&htt->pending_tx, tx_done->msdu_id);
75         if (!msdu) {
76                 ath10k_warn(ar, "received tx completion for invalid msdu_id: %d\n",
77                             tx_done->msdu_id);
78                 spin_unlock_bh(&htt->tx_lock);
79                 return -ENOENT;
80         }
81
82         skb_cb = ATH10K_SKB_CB(msdu);
83         txq = skb_cb->txq;
84
85         if (txq) {
86                 artxq = (void *)txq->drv_priv;
87                 artxq->num_fw_queued--;
88         }
89
90         ath10k_htt_tx_free_msdu_id(htt, tx_done->msdu_id);
91         ath10k_htt_tx_dec_pending(htt);
92         if (htt->num_pending_tx == 0)
93                 wake_up(&htt->empty_tx_wq);
94         spin_unlock_bh(&htt->tx_lock);
95
96         dma_unmap_single(dev, skb_cb->paddr, msdu->len, DMA_TO_DEVICE);
97
98         ath10k_report_offchan_tx(htt->ar, msdu);
99
100         info = IEEE80211_SKB_CB(msdu);
101         memset(&info->status, 0, sizeof(info->status));
102         info->status.rates[0].idx = -1;
103
104         trace_ath10k_txrx_tx_unref(ar, tx_done->msdu_id);
105
106         if (tx_done->status == HTT_TX_COMPL_STATE_DISCARD) {
107                 ieee80211_free_txskb(htt->ar->hw, msdu);
108                 return 0;
109         }
110
111         if (!(info->flags & IEEE80211_TX_CTL_NO_ACK))
112                 info->flags |= IEEE80211_TX_STAT_ACK;
113
114         if (tx_done->status == HTT_TX_COMPL_STATE_NOACK)
115                 info->flags &= ~IEEE80211_TX_STAT_ACK;
116
117         if ((tx_done->status == HTT_TX_COMPL_STATE_ACK) &&
118             (info->flags & IEEE80211_TX_CTL_NO_ACK))
119                 info->flags |= IEEE80211_TX_STAT_NOACK_TRANSMITTED;
120
121         ieee80211_tx_status(htt->ar->hw, msdu);
122         /* we do not own the msdu anymore */
123
124         return 0;
125 }
126
127 struct ath10k_peer *ath10k_peer_find(struct ath10k *ar, int vdev_id,
128                                      const u8 *addr)
129 {
130         struct ath10k_peer *peer;
131
132         lockdep_assert_held(&ar->data_lock);
133
134         list_for_each_entry(peer, &ar->peers, list) {
135                 if (peer->vdev_id != vdev_id)
136                         continue;
137                 if (!ether_addr_equal(peer->addr, addr))
138                         continue;
139
140                 return peer;
141         }
142
143         return NULL;
144 }
145
146 struct ath10k_peer *ath10k_peer_find_by_id(struct ath10k *ar, int peer_id)
147 {
148         struct ath10k_peer *peer;
149
150         lockdep_assert_held(&ar->data_lock);
151
152         list_for_each_entry(peer, &ar->peers, list)
153                 if (test_bit(peer_id, peer->peer_ids))
154                         return peer;
155
156         return NULL;
157 }
158
159 static int ath10k_wait_for_peer_common(struct ath10k *ar, int vdev_id,
160                                        const u8 *addr, bool expect_mapped)
161 {
162         long time_left;
163
164         time_left = wait_event_timeout(ar->peer_mapping_wq, ({
165                         bool mapped;
166
167                         spin_lock_bh(&ar->data_lock);
168                         mapped = !!ath10k_peer_find(ar, vdev_id, addr);
169                         spin_unlock_bh(&ar->data_lock);
170
171                         (mapped == expect_mapped ||
172                          test_bit(ATH10K_FLAG_CRASH_FLUSH, &ar->dev_flags));
173                 }), 3 * HZ);
174
175         if (time_left == 0)
176                 return -ETIMEDOUT;
177
178         return 0;
179 }
180
181 int ath10k_wait_for_peer_created(struct ath10k *ar, int vdev_id, const u8 *addr)
182 {
183         return ath10k_wait_for_peer_common(ar, vdev_id, addr, true);
184 }
185
186 int ath10k_wait_for_peer_deleted(struct ath10k *ar, int vdev_id, const u8 *addr)
187 {
188         return ath10k_wait_for_peer_common(ar, vdev_id, addr, false);
189 }
190
191 void ath10k_peer_map_event(struct ath10k_htt *htt,
192                            struct htt_peer_map_event *ev)
193 {
194         struct ath10k *ar = htt->ar;
195         struct ath10k_peer *peer;
196
197         if (ev->peer_id >= ATH10K_MAX_NUM_PEER_IDS) {
198                 ath10k_warn(ar,
199                             "received htt peer map event with idx out of bounds: %hu\n",
200                             ev->peer_id);
201                 return;
202         }
203
204         spin_lock_bh(&ar->data_lock);
205         peer = ath10k_peer_find(ar, ev->vdev_id, ev->addr);
206         if (!peer) {
207                 peer = kzalloc(sizeof(*peer), GFP_ATOMIC);
208                 if (!peer)
209                         goto exit;
210
211                 peer->vdev_id = ev->vdev_id;
212                 ether_addr_copy(peer->addr, ev->addr);
213                 list_add(&peer->list, &ar->peers);
214                 wake_up(&ar->peer_mapping_wq);
215         }
216
217         ath10k_dbg(ar, ATH10K_DBG_HTT, "htt peer map vdev %d peer %pM id %d\n",
218                    ev->vdev_id, ev->addr, ev->peer_id);
219
220         WARN_ON(ar->peer_map[ev->peer_id] && (ar->peer_map[ev->peer_id] != peer));
221         ar->peer_map[ev->peer_id] = peer;
222         set_bit(ev->peer_id, peer->peer_ids);
223 exit:
224         spin_unlock_bh(&ar->data_lock);
225 }
226
227 void ath10k_peer_unmap_event(struct ath10k_htt *htt,
228                              struct htt_peer_unmap_event *ev)
229 {
230         struct ath10k *ar = htt->ar;
231         struct ath10k_peer *peer;
232
233         if (ev->peer_id >= ATH10K_MAX_NUM_PEER_IDS) {
234                 ath10k_warn(ar,
235                             "received htt peer unmap event with idx out of bounds: %hu\n",
236                             ev->peer_id);
237                 return;
238         }
239
240         spin_lock_bh(&ar->data_lock);
241         peer = ath10k_peer_find_by_id(ar, ev->peer_id);
242         if (!peer) {
243                 ath10k_warn(ar, "peer-unmap-event: unknown peer id %d\n",
244                             ev->peer_id);
245                 goto exit;
246         }
247
248         ath10k_dbg(ar, ATH10K_DBG_HTT, "htt peer unmap vdev %d peer %pM id %d\n",
249                    peer->vdev_id, peer->addr, ev->peer_id);
250
251         ar->peer_map[ev->peer_id] = NULL;
252         clear_bit(ev->peer_id, peer->peer_ids);
253
254         if (bitmap_empty(peer->peer_ids, ATH10K_MAX_NUM_PEER_IDS)) {
255                 list_del(&peer->list);
256                 kfree(peer);
257                 wake_up(&ar->peer_mapping_wq);
258         }
259
260 exit:
261         spin_unlock_bh(&ar->data_lock);
262 }