1 /*
2  * NXP Wireless LAN device driver: generic TX/RX data handling
3  *
4  * Copyright 2011-2020 NXP
5  *
6  * This software file (the "File") is distributed by NXP
7  * under the terms of the GNU General Public License Version 2, June 1991
8  * (the "License").  You may use, redistribute and/or modify this File in
9  * accordance with the terms and conditions of the License, a copy of which
10  * is available by writing to the Free Software Foundation, Inc.,
11  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
12  * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
13  *
14  * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
15  * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
16  * ARE EXPRESSLY DISCLAIMED.  The License provides additional details about
17  * this warranty disclaimer.
18  */
19 
20 #include "decl.h"
21 #include "ioctl.h"
22 #include "util.h"
23 #include "fw.h"
24 #include "main.h"
25 #include "wmm.h"
26 
27 /*
28  * This function processes the received buffer.
29  *
30  * Main responsibility of this function is to parse the RxPD to
31  * identify the correct interface this packet is headed for and
32  * forwarding it to the associated handling function, where the
33  * packet will be further processed and sent to kernel/upper layer
34  * if required.
35  */
mwifiex_handle_rx_packet(struct mwifiex_adapter * adapter,struct sk_buff * skb)36 int mwifiex_handle_rx_packet(struct mwifiex_adapter *adapter,
37 			     struct sk_buff *skb)
38 {
39 	struct mwifiex_private *priv =
40 		mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_ANY);
41 	struct rxpd *local_rx_pd;
42 	struct mwifiex_rxinfo *rx_info = MWIFIEX_SKB_RXCB(skb);
43 	int ret;
44 
45 	local_rx_pd = (struct rxpd *) (skb->data);
46 	/* Get the BSS number from rxpd, get corresponding priv */
47 	priv = mwifiex_get_priv_by_id(adapter, local_rx_pd->bss_num &
48 				      BSS_NUM_MASK, local_rx_pd->bss_type);
49 	if (!priv)
50 		priv = mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_ANY);
51 
52 	if (!priv) {
53 		mwifiex_dbg(adapter, ERROR,
54 			    "data: priv not found. Drop RX packet\n");
55 		dev_kfree_skb_any(skb);
56 		return -1;
57 	}
58 
59 	mwifiex_dbg_dump(adapter, DAT_D, "rx pkt:", skb->data,
60 			 min_t(size_t, skb->len, DEBUG_DUMP_DATA_MAX_LEN));
61 
62 	memset(rx_info, 0, sizeof(*rx_info));
63 	rx_info->bss_num = priv->bss_num;
64 	rx_info->bss_type = priv->bss_type;
65 
66 	if (priv->bss_role == MWIFIEX_BSS_ROLE_UAP)
67 		ret = mwifiex_process_uap_rx_packet(priv, skb);
68 	else
69 		ret = mwifiex_process_sta_rx_packet(priv, skb);
70 
71 	return ret;
72 }
73 EXPORT_SYMBOL_GPL(mwifiex_handle_rx_packet);
74 
75 /*
76  * This function sends a packet to device.
77  *
78  * It processes the packet to add the TxPD, checks condition and
79  * sends the processed packet to firmware for transmission.
80  *
81  * On successful completion, the function calls the completion callback
82  * and logs the time.
83  */
mwifiex_process_tx(struct mwifiex_private * priv,struct sk_buff * skb,struct mwifiex_tx_param * tx_param)84 int mwifiex_process_tx(struct mwifiex_private *priv, struct sk_buff *skb,
85 		       struct mwifiex_tx_param *tx_param)
86 {
87 	int hroom, ret = -1;
88 	struct mwifiex_adapter *adapter = priv->adapter;
89 	u8 *head_ptr;
90 	struct txpd *local_tx_pd = NULL;
91 	struct mwifiex_sta_node *dest_node;
92 	struct ethhdr *hdr = (void *)skb->data;
93 
94 	hroom = adapter->intf_hdr_len;
95 
96 	if (priv->bss_role == MWIFIEX_BSS_ROLE_UAP) {
97 		dest_node = mwifiex_get_sta_entry(priv, hdr->h_dest);
98 		if (dest_node) {
99 			dest_node->stats.tx_bytes += skb->len;
100 			dest_node->stats.tx_packets++;
101 		}
102 
103 		head_ptr = mwifiex_process_uap_txpd(priv, skb);
104 	} else {
105 		head_ptr = mwifiex_process_sta_txpd(priv, skb);
106 	}
107 
108 	if ((adapter->data_sent || adapter->tx_lock_flag) && head_ptr) {
109 		skb_queue_tail(&adapter->tx_data_q, skb);
110 		atomic_inc(&adapter->tx_queued);
111 		return 0;
112 	}
113 
114 	if (head_ptr) {
115 		if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA)
116 			local_tx_pd = (struct txpd *)(head_ptr + hroom);
117 		if (adapter->iface_type == MWIFIEX_USB) {
118 			ret = adapter->if_ops.host_to_card(adapter,
119 							   priv->usb_port,
120 							   skb, tx_param);
121 		} else {
122 			ret = adapter->if_ops.host_to_card(adapter,
123 							   MWIFIEX_TYPE_DATA,
124 							   skb, tx_param);
125 		}
126 	}
127 	mwifiex_dbg_dump(adapter, DAT_D, "tx pkt:", skb->data,
128 			 min_t(size_t, skb->len, DEBUG_DUMP_DATA_MAX_LEN));
129 
130 	switch (ret) {
131 	case -ENOSR:
132 		mwifiex_dbg(adapter, DATA, "data: -ENOSR is returned\n");
133 		break;
134 	case -EBUSY:
135 		if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA) &&
136 		    (adapter->pps_uapsd_mode) && (adapter->tx_lock_flag)) {
137 				priv->adapter->tx_lock_flag = false;
138 				if (local_tx_pd)
139 					local_tx_pd->flags = 0;
140 		}
141 		mwifiex_dbg(adapter, ERROR, "data: -EBUSY is returned\n");
142 		break;
143 	case -1:
144 		mwifiex_dbg(adapter, ERROR,
145 			    "mwifiex_write_data_async failed: 0x%X\n",
146 			    ret);
147 		adapter->dbg.num_tx_host_to_card_failure++;
148 		mwifiex_write_data_complete(adapter, skb, 0, ret);
149 		break;
150 	case -EINPROGRESS:
151 		break;
152 	case 0:
153 		mwifiex_write_data_complete(adapter, skb, 0, ret);
154 		break;
155 	default:
156 		break;
157 	}
158 
159 	return ret;
160 }
161 
mwifiex_host_to_card(struct mwifiex_adapter * adapter,struct sk_buff * skb,struct mwifiex_tx_param * tx_param)162 static int mwifiex_host_to_card(struct mwifiex_adapter *adapter,
163 				struct sk_buff *skb,
164 				struct mwifiex_tx_param *tx_param)
165 {
166 	struct txpd *local_tx_pd = NULL;
167 	u8 *head_ptr = skb->data;
168 	int ret = 0;
169 	struct mwifiex_private *priv;
170 	struct mwifiex_txinfo *tx_info;
171 
172 	tx_info = MWIFIEX_SKB_TXCB(skb);
173 	priv = mwifiex_get_priv_by_id(adapter, tx_info->bss_num,
174 				      tx_info->bss_type);
175 	if (!priv) {
176 		mwifiex_dbg(adapter, ERROR,
177 			    "data: priv not found. Drop TX packet\n");
178 		adapter->dbg.num_tx_host_to_card_failure++;
179 		mwifiex_write_data_complete(adapter, skb, 0, 0);
180 		return ret;
181 	}
182 	if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA)
183 		local_tx_pd = (struct txpd *)(head_ptr + adapter->intf_hdr_len);
184 
185 	if (adapter->iface_type == MWIFIEX_USB) {
186 		ret = adapter->if_ops.host_to_card(adapter,
187 						   priv->usb_port,
188 						   skb, tx_param);
189 	} else {
190 		ret = adapter->if_ops.host_to_card(adapter,
191 						   MWIFIEX_TYPE_DATA,
192 						   skb, tx_param);
193 	}
194 	switch (ret) {
195 	case -ENOSR:
196 		mwifiex_dbg(adapter, ERROR, "data: -ENOSR is returned\n");
197 		break;
198 	case -EBUSY:
199 		if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA) &&
200 		    (adapter->pps_uapsd_mode) &&
201 		    (adapter->tx_lock_flag)) {
202 			priv->adapter->tx_lock_flag = false;
203 			if (local_tx_pd)
204 				local_tx_pd->flags = 0;
205 		}
206 		skb_queue_head(&adapter->tx_data_q, skb);
207 		if (tx_info->flags & MWIFIEX_BUF_FLAG_AGGR_PKT)
208 			atomic_add(tx_info->aggr_num, &adapter->tx_queued);
209 		else
210 			atomic_inc(&adapter->tx_queued);
211 		mwifiex_dbg(adapter, ERROR, "data: -EBUSY is returned\n");
212 		break;
213 	case -1:
214 		mwifiex_dbg(adapter, ERROR,
215 			    "mwifiex_write_data_async failed: 0x%X\n", ret);
216 		adapter->dbg.num_tx_host_to_card_failure++;
217 		mwifiex_write_data_complete(adapter, skb, 0, ret);
218 		break;
219 	case -EINPROGRESS:
220 		break;
221 	case 0:
222 		mwifiex_write_data_complete(adapter, skb, 0, ret);
223 		break;
224 	default:
225 		break;
226 	}
227 	return ret;
228 }
229 
230 static int
mwifiex_dequeue_tx_queue(struct mwifiex_adapter * adapter)231 mwifiex_dequeue_tx_queue(struct mwifiex_adapter *adapter)
232 {
233 	struct sk_buff *skb, *skb_next;
234 	struct mwifiex_txinfo *tx_info;
235 	struct mwifiex_tx_param tx_param;
236 
237 	skb = skb_dequeue(&adapter->tx_data_q);
238 	if (!skb)
239 		return -1;
240 
241 	tx_info = MWIFIEX_SKB_TXCB(skb);
242 	if (tx_info->flags & MWIFIEX_BUF_FLAG_AGGR_PKT)
243 		atomic_sub(tx_info->aggr_num, &adapter->tx_queued);
244 	else
245 		atomic_dec(&adapter->tx_queued);
246 
247 	if (!skb_queue_empty(&adapter->tx_data_q))
248 		skb_next = skb_peek(&adapter->tx_data_q);
249 	else
250 		skb_next = NULL;
251 	tx_param.next_pkt_len = ((skb_next) ? skb_next->len : 0);
252 	if (!tx_param.next_pkt_len) {
253 		if (!mwifiex_wmm_lists_empty(adapter))
254 			tx_param.next_pkt_len = 1;
255 	}
256 	return mwifiex_host_to_card(adapter, skb, &tx_param);
257 }
258 
259 void
mwifiex_process_tx_queue(struct mwifiex_adapter * adapter)260 mwifiex_process_tx_queue(struct mwifiex_adapter *adapter)
261 {
262 	do {
263 		if (adapter->data_sent || adapter->tx_lock_flag)
264 			break;
265 		if (mwifiex_dequeue_tx_queue(adapter))
266 			break;
267 	} while (!skb_queue_empty(&adapter->tx_data_q));
268 }
269 
270 /*
271  * Packet send completion callback handler.
272  *
273  * It either frees the buffer directly or forwards it to another
274  * completion callback which checks conditions, updates statistics,
275  * wakes up stalled traffic queue if required, and then frees the buffer.
276  */
mwifiex_write_data_complete(struct mwifiex_adapter * adapter,struct sk_buff * skb,int aggr,int status)277 int mwifiex_write_data_complete(struct mwifiex_adapter *adapter,
278 				struct sk_buff *skb, int aggr, int status)
279 {
280 	struct mwifiex_private *priv;
281 	struct mwifiex_txinfo *tx_info;
282 	struct netdev_queue *txq;
283 	int index;
284 
285 	if (!skb)
286 		return 0;
287 
288 	tx_info = MWIFIEX_SKB_TXCB(skb);
289 	priv = mwifiex_get_priv_by_id(adapter, tx_info->bss_num,
290 				      tx_info->bss_type);
291 	if (!priv)
292 		goto done;
293 
294 	mwifiex_set_trans_start(priv->netdev);
295 
296 	if (tx_info->flags & MWIFIEX_BUF_FLAG_BRIDGED_PKT)
297 		atomic_dec_return(&adapter->pending_bridged_pkts);
298 
299 	if (tx_info->flags & MWIFIEX_BUF_FLAG_AGGR_PKT)
300 		goto done;
301 
302 	if (!status) {
303 		priv->stats.tx_packets++;
304 		priv->stats.tx_bytes += tx_info->pkt_len;
305 		if (priv->tx_timeout_cnt)
306 			priv->tx_timeout_cnt = 0;
307 	} else {
308 		priv->stats.tx_errors++;
309 	}
310 
311 	if (aggr)
312 		/* For skb_aggr, do not wake up tx queue */
313 		goto done;
314 
315 	atomic_dec(&adapter->tx_pending);
316 
317 	index = mwifiex_1d_to_wmm_queue[skb->priority];
318 	if (atomic_dec_return(&priv->wmm_tx_pending[index]) < LOW_TX_PENDING) {
319 		txq = netdev_get_tx_queue(priv->netdev, index);
320 		if (netif_tx_queue_stopped(txq)) {
321 			netif_tx_wake_queue(txq);
322 			mwifiex_dbg(adapter, DATA, "wake queue: %d\n", index);
323 		}
324 	}
325 done:
326 	dev_kfree_skb_any(skb);
327 
328 	return 0;
329 }
330 EXPORT_SYMBOL_GPL(mwifiex_write_data_complete);
331 
mwifiex_parse_tx_status_event(struct mwifiex_private * priv,void * event_body)332 void mwifiex_parse_tx_status_event(struct mwifiex_private *priv,
333 				   void *event_body)
334 {
335 	struct tx_status_event *tx_status = (void *)priv->adapter->event_body;
336 	struct sk_buff *ack_skb;
337 	struct mwifiex_txinfo *tx_info;
338 
339 	if (!tx_status->tx_token_id)
340 		return;
341 
342 	spin_lock_bh(&priv->ack_status_lock);
343 	ack_skb = idr_remove(&priv->ack_status_frames, tx_status->tx_token_id);
344 	spin_unlock_bh(&priv->ack_status_lock);
345 
346 	if (ack_skb) {
347 		tx_info = MWIFIEX_SKB_TXCB(ack_skb);
348 
349 		if (tx_info->flags & MWIFIEX_BUF_FLAG_EAPOL_TX_STATUS) {
350 			/* consumes ack_skb */
351 			skb_complete_wifi_ack(ack_skb, !tx_status->status);
352 		} else {
353 			/* Remove broadcast address which was added by driver */
354 			memmove(ack_skb->data +
355 				sizeof(struct ieee80211_hdr_3addr) +
356 				MWIFIEX_MGMT_FRAME_HEADER_SIZE + sizeof(u16),
357 				ack_skb->data +
358 				sizeof(struct ieee80211_hdr_3addr) +
359 				MWIFIEX_MGMT_FRAME_HEADER_SIZE + sizeof(u16) +
360 				ETH_ALEN, ack_skb->len -
361 				(sizeof(struct ieee80211_hdr_3addr) +
362 				MWIFIEX_MGMT_FRAME_HEADER_SIZE + sizeof(u16) +
363 				ETH_ALEN));
364 			ack_skb->len = ack_skb->len - ETH_ALEN;
365 			/* Remove driver's proprietary header including 2 bytes
366 			 * of packet length and pass actual management frame buffer
367 			 * to cfg80211.
368 			 */
369 			cfg80211_mgmt_tx_status(&priv->wdev, tx_info->cookie,
370 						ack_skb->data +
371 						MWIFIEX_MGMT_FRAME_HEADER_SIZE +
372 						sizeof(u16), ack_skb->len -
373 						(MWIFIEX_MGMT_FRAME_HEADER_SIZE
374 						 + sizeof(u16)),
375 						!tx_status->status, GFP_ATOMIC);
376 			dev_kfree_skb_any(ack_skb);
377 		}
378 	}
379 }
380