[deliverable/linux.git] / drivers / net / wireless / mwifiex / txrx.c

/*
 * Marvell Wireless LAN device driver: generic TX/RX data handling
 *
 * Copyright (C) 2011-2014, Marvell International Ltd.
 *
 * This software file (the "File") is distributed by Marvell International
 * Ltd. under the terms of the GNU General Public License Version 2, June 1991
 * (the "License").  You may use, redistribute and/or modify this File in
 * accordance with the terms and conditions of the License, a copy of which
 * is available by writing to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
 * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
 *
 * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
 * ARE EXPRESSLY DISCLAIMED.  The License provides additional details about
 * this warranty disclaimer.
 */

#include "decl.h"
#include "ioctl.h"
#include "util.h"
#include "fw.h"
#include "main.h"
#include "wmm.h"

/*
 * This function processes the received buffer.
 *
 * Main responsibility of this function is to parse the RxPD to
 * identify the correct interface this packet is headed for and
 * forwarding it to the associated handling function, where the
 * packet will be further processed and sent to kernel/upper layer
 * if required.
 */
int mwifiex_handle_rx_packet(struct mwifiex_adapter *adapter,
			     struct sk_buff *skb)
{
	struct mwifiex_private *priv =
		mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_ANY);
	struct rxpd *local_rx_pd;
	struct mwifiex_rxinfo *rx_info = MWIFIEX_SKB_RXCB(skb);
	int ret;

	local_rx_pd = (struct rxpd *) (skb->data);
	/* Get the BSS number from rxpd, get corresponding priv */
	priv = mwifiex_get_priv_by_id(adapter, local_rx_pd->bss_num &
				      BSS_NUM_MASK, local_rx_pd->bss_type);
	if (!priv)
		priv = mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_ANY);

	if (!priv) {
		dev_err(adapter->dev, "data: priv not found. Drop RX packet\n");
		dev_kfree_skb_any(skb);
		return -1;
	}

	memset(rx_info, 0, sizeof(*rx_info));
	rx_info->bss_num = priv->bss_num;
	rx_info->bss_type = priv->bss_type;

	if (priv->bss_role == MWIFIEX_BSS_ROLE_UAP)
		ret = mwifiex_process_uap_rx_packet(priv, skb);
	else
		ret = mwifiex_process_sta_rx_packet(priv, skb);

	return ret;
}
EXPORT_SYMBOL_GPL(mwifiex_handle_rx_packet);

/*
 * This function sends a packet to device.
 *
 * It processes the packet to add the TxPD, checks condition and
 * sends the processed packet to firmware for transmission.
 *
 * On successful completion, the function calls the completion callback
 * and logs the time.
 */
int mwifiex_process_tx(struct mwifiex_private *priv, struct sk_buff *skb,
		       struct mwifiex_tx_param *tx_param)
{
	int hroom, ret = -1;
	struct mwifiex_adapter *adapter = priv->adapter;
	u8 *head_ptr;
	struct txpd *local_tx_pd = NULL;

	hroom = (adapter->iface_type == MWIFIEX_USB) ? 0 : INTF_HEADER_LEN;

	if (priv->bss_role == MWIFIEX_BSS_ROLE_UAP)
		head_ptr = mwifiex_process_uap_txpd(priv, skb);
	else
		head_ptr = mwifiex_process_sta_txpd(priv, skb);

	if ((adapter->data_sent || adapter->tx_lock_flag) && head_ptr) {
		skb_queue_tail(&adapter->tx_data_q, skb);
		atomic_inc(&adapter->tx_queued);
		return 0;
	}

	if (head_ptr) {
		if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA)
			local_tx_pd = (struct txpd *)(head_ptr + hroom);
		if (adapter->iface_type == MWIFIEX_USB) {
			adapter->data_sent = true;
			ret = adapter->if_ops.host_to_card(adapter,
							   MWIFIEX_USB_EP_DATA,
							   skb, NULL);
		} else {
			ret = adapter->if_ops.host_to_card(adapter,
							   MWIFIEX_TYPE_DATA,
							   skb, tx_param);
		}
	}

	switch (ret) {
	case -ENOSR:
		dev_dbg(adapter->dev, "data: -ENOSR is returned\n");
		break;
	case -EBUSY:
		if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA) &&
		    (adapter->pps_uapsd_mode) && (adapter->tx_lock_flag)) {
				priv->adapter->tx_lock_flag = false;
				if (local_tx_pd)
					local_tx_pd->flags = 0;
		}
		dev_dbg(adapter->dev, "data: -EBUSY is returned\n");
		break;
	case -1:
		if (adapter->iface_type != MWIFIEX_PCIE)
			adapter->data_sent = false;
		dev_err(adapter->dev, "mwifiex_write_data_async failed: 0x%X\n",
			ret);
		adapter->dbg.num_tx_host_to_card_failure++;
		mwifiex_write_data_complete(adapter, skb, 0, ret);
		break;
	case -EINPROGRESS:
		if (adapter->iface_type != MWIFIEX_PCIE)
			adapter->data_sent = false;
		break;
	case 0:
		mwifiex_write_data_complete(adapter, skb, 0, ret);
		break;
	default:
		break;
	}

	return ret;
}

static int mwifiex_host_to_card(struct mwifiex_adapter *adapter,
				struct sk_buff *skb,
				struct mwifiex_tx_param *tx_param)
{
	struct txpd *local_tx_pd = NULL;
	u8 *head_ptr = skb->data;
	int ret = 0;
	struct mwifiex_private *priv;
	struct mwifiex_txinfo *tx_info;

	tx_info = MWIFIEX_SKB_TXCB(skb);
	priv = mwifiex_get_priv_by_id(adapter, tx_info->bss_num,
				      tx_info->bss_type);
	if (!priv) {
		dev_err(adapter->dev, "data: priv not found. Drop TX packet\n");
		adapter->dbg.num_tx_host_to_card_failure++;
		mwifiex_write_data_complete(adapter, skb, 0, 0);
		return ret;
	}
	if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA) {
		if (adapter->iface_type == MWIFIEX_USB)
			local_tx_pd = (struct txpd *)head_ptr;
		else
			local_tx_pd = (struct txpd *) (head_ptr +
				INTF_HEADER_LEN);
	}

	if (adapter->iface_type == MWIFIEX_USB) {
		adapter->data_sent = true;
		ret = adapter->if_ops.host_to_card(adapter,
						   MWIFIEX_USB_EP_DATA,
						   skb, NULL);
	} else {
		ret = adapter->if_ops.host_to_card(adapter,
						   MWIFIEX_TYPE_DATA,
						   skb, tx_param);
	}
	switch (ret) {
	case -ENOSR:
		dev_err(adapter->dev, "data: -ENOSR is returned\n");
		break;
	case -EBUSY:
		if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA) &&
		    (adapter->pps_uapsd_mode) &&
		    (adapter->tx_lock_flag)) {
			priv->adapter->tx_lock_flag = false;
			if (local_tx_pd)
				local_tx_pd->flags = 0;
		}
		skb_queue_head(&adapter->tx_data_q, skb);
		if (tx_info->flags & MWIFIEX_BUF_FLAG_AGGR_PKT)
			atomic_add(tx_info->aggr_num, &adapter->tx_queued);
		else
			atomic_inc(&adapter->tx_queued);
		dev_dbg(adapter->dev, "data: -EBUSY is returned\n");
		break;
	case -1:
		if (adapter->iface_type != MWIFIEX_PCIE)
			adapter->data_sent = false;
		dev_err(adapter->dev, "mwifiex_write_data_async failed: 0x%X\n",
			ret);
		adapter->dbg.num_tx_host_to_card_failure++;
		mwifiex_write_data_complete(adapter, skb, 0, ret);
		break;
	case -EINPROGRESS:
		if (adapter->iface_type != MWIFIEX_PCIE)
			adapter->data_sent = false;
		break;
	case 0:
		mwifiex_write_data_complete(adapter, skb, 0, ret);
		break;
	default:
		break;
	}
	return ret;
}

static int
mwifiex_dequeue_tx_queue(struct mwifiex_adapter *adapter)
{
	struct sk_buff *skb, *skb_next;
	struct mwifiex_txinfo *tx_info;
	struct mwifiex_tx_param tx_param;

	skb = skb_dequeue(&adapter->tx_data_q);
	if (!skb)
		return -1;

	tx_info = MWIFIEX_SKB_TXCB(skb);
	if (tx_info->flags & MWIFIEX_BUF_FLAG_AGGR_PKT)
		atomic_sub(tx_info->aggr_num, &adapter->tx_queued);
	else
		atomic_dec(&adapter->tx_queued);

	if (!skb_queue_empty(&adapter->tx_data_q))
		skb_next = skb_peek(&adapter->tx_data_q);
	else
		skb_next = NULL;
	tx_param.next_pkt_len = ((skb_next) ? skb_next->len : 0);
	if (!tx_param.next_pkt_len) {
		if (!mwifiex_wmm_lists_empty(adapter))
			tx_param.next_pkt_len = 1;
	}
	return mwifiex_host_to_card(adapter, skb, &tx_param);
}

void
mwifiex_process_tx_queue(struct mwifiex_adapter *adapter)
{
	do {
		if (adapter->data_sent || adapter->tx_lock_flag)
			break;
		if (mwifiex_dequeue_tx_queue(adapter))
			break;
	} while (!skb_queue_empty(&adapter->tx_data_q));
}

/*
 * Packet send completion callback handler.
 *
 * It either frees the buffer directly or forwards it to another
 * completion callback which checks conditions, updates statistics,
 * wakes up stalled traffic queue if required, and then frees the buffer.
 */
int mwifiex_write_data_complete(struct mwifiex_adapter *adapter,
				struct sk_buff *skb, int aggr, int status)
{
	struct mwifiex_private *priv;
	struct mwifiex_txinfo *tx_info;
	struct netdev_queue *txq;
	int index;

	if (!skb)
		return 0;

	tx_info = MWIFIEX_SKB_TXCB(skb);
	priv = mwifiex_get_priv_by_id(adapter, tx_info->bss_num,
				      tx_info->bss_type);
	if (!priv)
		goto done;

	if (adapter->iface_type == MWIFIEX_USB)
		adapter->data_sent = false;

	mwifiex_set_trans_start(priv->netdev);
	if (!status) {
		priv->stats.tx_packets++;
		priv->stats.tx_bytes += tx_info->pkt_len;
		if (priv->tx_timeout_cnt)
			priv->tx_timeout_cnt = 0;
	} else {
		priv->stats.tx_errors++;
	}

	if (tx_info->flags & MWIFIEX_BUF_FLAG_BRIDGED_PKT)
		atomic_dec_return(&adapter->pending_bridged_pkts);
		if (tx_info->flags & MWIFIEX_BUF_FLAG_AGGR_PKT)
			goto done;

	if (aggr)
		/* For skb_aggr, do not wake up tx queue */
		goto done;

	atomic_dec(&adapter->tx_pending);

	index = mwifiex_1d_to_wmm_queue[skb->priority];
	if (atomic_dec_return(&priv->wmm_tx_pending[index]) < LOW_TX_PENDING) {
		txq = netdev_get_tx_queue(priv->netdev, index);
		if (netif_tx_queue_stopped(txq)) {
			netif_tx_wake_queue(txq);
			dev_dbg(adapter->dev, "wake queue: %d\n", index);
		}
	}
done:
	dev_kfree_skb_any(skb);

	return 0;
}
EXPORT_SYMBOL_GPL(mwifiex_write_data_complete);

void mwifiex_parse_tx_status_event(struct mwifiex_private *priv,
				   void *event_body)
{
	struct tx_status_event *tx_status = (void *)priv->adapter->event_body;
	struct sk_buff *ack_skb;
	unsigned long flags;
	struct mwifiex_txinfo *tx_info;

	if (!tx_status->tx_token_id)
		return;

	spin_lock_irqsave(&priv->ack_status_lock, flags);
	ack_skb = idr_find(&priv->ack_status_frames, tx_status->tx_token_id);
	if (ack_skb)
		idr_remove(&priv->ack_status_frames, tx_status->tx_token_id);
	spin_unlock_irqrestore(&priv->ack_status_lock, flags);

	if (ack_skb) {
		tx_info = MWIFIEX_SKB_TXCB(ack_skb);

		if (tx_info->flags & MWIFIEX_BUF_FLAG_EAPOL_TX_STATUS) {
			/* consumes ack_skb */
			skb_complete_wifi_ack(ack_skb, !tx_status->status);
		} else {
			cfg80211_mgmt_tx_status(&priv->wdev, tx_info->cookie,
						ack_skb->data, ack_skb->len,
						!tx_status->status, GFP_ATOMIC);
			dev_kfree_skb_any(ack_skb);
		}
	}
}
Commit	Line	Data
5e6e3a92 BZ	1	/*
	2	* Marvell Wireless LAN device driver: generic TX/RX data handling
	3	*
65da33f5	4	* Copyright (C) 2011-2014, Marvell International Ltd.
5e6e3a92 BZ	5	*
	6	* This software file (the "File") is distributed by Marvell International
	7	* Ltd. 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	*/
	36	int mwifiex_handle_rx_packet(struct mwifiex_adapter *adapter,
	37	struct sk_buff *skb)
	38	{
5e6e3a92 BZ	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);
ca8d6dfc	43	int ret;
5e6e3a92 BZ	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
f3b369e4 AP	52	if (!priv) {
	53	dev_err(adapter->dev, "data: priv not found. Drop RX packet\n");
	54	dev_kfree_skb_any(skb);
	55	return -1;
	56	}
	57
701a9e61	58	memset(rx_info, 0, sizeof(*rx_info));
9da9a3b2 YAP	59	rx_info->bss_num = priv->bss_num;
9da9a3b2 YAP	60	rx_info->bss_type = priv->bss_type;
5e6e3a92	61
838e4f44	62	if (priv->bss_role == MWIFIEX_BSS_ROLE_UAP)
ca8d6dfc UR	63	ret = mwifiex_process_uap_rx_packet(priv, skb);
	64	else
	65	ret = mwifiex_process_sta_rx_packet(priv, skb);
838e4f44	66
ca8d6dfc	67	return ret;
5e6e3a92 BZ	68	}
	69	EXPORT_SYMBOL_GPL(mwifiex_handle_rx_packet);
	70
	71	/*
	72	* This function sends a packet to device.
	73	*
	74	* It processes the packet to add the TxPD, checks condition and
	75	* sends the processed packet to firmware for transmission.
	76	*
	77	* On successful completion, the function calls the completion callback
	78	* and logs the time.
	79	*/
	80	int mwifiex_process_tx(struct mwifiex_private priv, struct sk_buff skb,
	81	struct mwifiex_tx_param *tx_param)
	82	{
4ce7bc0a	83	int hroom, ret = -1;
5e6e3a92	84	struct mwifiex_adapter *adapter = priv->adapter;
270e58e8	85	u8 *head_ptr;
5e6e3a92 BZ	86	struct txpd *local_tx_pd = NULL;
5e6e3a92 BZ	87
4ce7bc0a ZL	88	hroom = (adapter->iface_type == MWIFIEX_USB) ? 0 : INTF_HEADER_LEN;
4ce7bc0a ZL	89
4ac8764a AP	90	if (priv->bss_role == MWIFIEX_BSS_ROLE_UAP)
	91	head_ptr = mwifiex_process_uap_txpd(priv, skb);
	92	else
	93	head_ptr = mwifiex_process_sta_txpd(priv, skb);
	94
e35000ea ZL	95	if ((adapter->data_sent \|\| adapter->tx_lock_flag) && head_ptr) {
	96	skb_queue_tail(&adapter->tx_data_q, skb);
	97	atomic_inc(&adapter->tx_queued);
	98	return 0;
	99	}
	100
5e6e3a92 BZ	101	if (head_ptr) {
5e6e3a92 BZ	102	if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA)
4ce7bc0a	103	local_tx_pd = (struct txpd *)(head_ptr + hroom);
4daffe35 AK	104	if (adapter->iface_type == MWIFIEX_USB) {
4daffe35 AK	105	adapter->data_sent = true;
4daffe35 AK	106	ret = adapter->if_ops.host_to_card(adapter,
	107	MWIFIEX_USB_EP_DATA,
	108	skb, NULL);
	109	} else {
	110	ret = adapter->if_ops.host_to_card(adapter,
	111	MWIFIEX_TYPE_DATA,
	112	skb, tx_param);
	113	}
5e6e3a92 BZ	114	}
	115
	116	switch (ret) {
4daffe35	117	case -ENOSR:
bd2a864a	118	dev_dbg(adapter->dev, "data: -ENOSR is returned\n");
4daffe35	119	break;
5e6e3a92 BZ	120	case -EBUSY:
5e6e3a92 BZ	121	if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA) &&
c65a30f3	122	(adapter->pps_uapsd_mode) && (adapter->tx_lock_flag)) {
5e6e3a92	123	priv->adapter->tx_lock_flag = false;
3d82de0f YAP	124	if (local_tx_pd)
3d82de0f YAP	125	local_tx_pd->flags = 0;
5e6e3a92 BZ	126	}
	127	dev_dbg(adapter->dev, "data: -EBUSY is returned\n");
	128	break;
	129	case -1:
e7f767a7 AP	130	if (adapter->iface_type != MWIFIEX_PCIE)
e7f767a7 AP	131	adapter->data_sent = false;
5e6e3a92	132	dev_err(adapter->dev, "mwifiex_write_data_async failed: 0x%X\n",
c65a30f3	133	ret);
5e6e3a92	134	adapter->dbg.num_tx_host_to_card_failure++;
47411a06	135	mwifiex_write_data_complete(adapter, skb, 0, ret);
5e6e3a92 BZ	136	break;
5e6e3a92 BZ	137	case -EINPROGRESS:
e7f767a7 AP	138	if (adapter->iface_type != MWIFIEX_PCIE)
e7f767a7 AP	139	adapter->data_sent = false;
5e6e3a92 BZ	140	break;
5e6e3a92 BZ	141	case 0:
47411a06	142	mwifiex_write_data_complete(adapter, skb, 0, ret);
5e6e3a92 BZ	143	break;
	144	default:
	145	break;
	146	}
	147
	148	return ret;
	149	}
	150
e35000ea ZL	151	static int mwifiex_host_to_card(struct mwifiex_adapter *adapter,
	152	struct sk_buff *skb,
	153	struct mwifiex_tx_param *tx_param)
	154	{
	155	struct txpd *local_tx_pd = NULL;
	156	u8 *head_ptr = skb->data;
	157	int ret = 0;
	158	struct mwifiex_private *priv;
	159	struct mwifiex_txinfo *tx_info;
	160
	161	tx_info = MWIFIEX_SKB_TXCB(skb);
	162	priv = mwifiex_get_priv_by_id(adapter, tx_info->bss_num,
	163	tx_info->bss_type);
	164	if (!priv) {
	165	dev_err(adapter->dev, "data: priv not found. Drop TX packet\n");
	166	adapter->dbg.num_tx_host_to_card_failure++;
	167	mwifiex_write_data_complete(adapter, skb, 0, 0);
	168	return ret;
	169	}
	170	if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA) {
	171	if (adapter->iface_type == MWIFIEX_USB)
	172	local_tx_pd = (struct txpd *)head_ptr;
	173	else
	174	local_tx_pd = (struct txpd *) (head_ptr +
	175	INTF_HEADER_LEN);
	176	}
	177
	178	if (adapter->iface_type == MWIFIEX_USB) {
	179	adapter->data_sent = true;
	180	ret = adapter->if_ops.host_to_card(adapter,
	181	MWIFIEX_USB_EP_DATA,
	182	skb, NULL);
	183	} else {
	184	ret = adapter->if_ops.host_to_card(adapter,
	185	MWIFIEX_TYPE_DATA,
	186	skb, tx_param);
	187	}
	188	switch (ret) {
	189	case -ENOSR:
	190	dev_err(adapter->dev, "data: -ENOSR is returned\n");
	191	break;
	192	case -EBUSY:
	193	if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA) &&
	194	(adapter->pps_uapsd_mode) &&
	195	(adapter->tx_lock_flag)) {
	196	priv->adapter->tx_lock_flag = false;
	197	if (local_tx_pd)
	198	local_tx_pd->flags = 0;
	199	}
	200	skb_queue_head(&adapter->tx_data_q, skb);
	201	if (tx_info->flags & MWIFIEX_BUF_FLAG_AGGR_PKT)
	202	atomic_add(tx_info->aggr_num, &adapter->tx_queued);
	203	else
	204	atomic_inc(&adapter->tx_queued);
	205	dev_dbg(adapter->dev, "data: -EBUSY is returned\n");
	206	break;
	207	case -1:
	208	if (adapter->iface_type != MWIFIEX_PCIE)
	209	adapter->data_sent = false;
	210	dev_err(adapter->dev, "mwifiex_write_data_async failed: 0x%X\n",
	211	ret);
	212	adapter->dbg.num_tx_host_to_card_failure++;
	213	mwifiex_write_data_complete(adapter, skb, 0, ret);
	214	break;
215	case -EINPROGRESS:
216	if (adapter->iface_type != MWIFIEX_PCIE)
217	adapter->data_sent = false;
218	break;
219	case 0:
220	mwifiex_write_data_complete(adapter, skb, 0, ret);
221	break;
222	default:
223	break;
224	}
225	return ret;
226	}
227
228	static int
229	mwifiex_dequeue_tx_queue(struct mwifiex_adapter *adapter)
230	{
231	struct sk_buff skb, skb_next;
232	struct mwifiex_txinfo *tx_info;
233	struct mwifiex_tx_param tx_param;
234
235	skb = skb_dequeue(&adapter->tx_data_q);
236	if (!skb)
237	return -1;
238
239	tx_info = MWIFIEX_SKB_TXCB(skb);
240	if (tx_info->flags & MWIFIEX_BUF_FLAG_AGGR_PKT)
241	atomic_sub(tx_info->aggr_num, &adapter->tx_queued);
242	else
243	atomic_dec(&adapter->tx_queued);
244
245	if (!skb_queue_empty(&adapter->tx_data_q))
246	skb_next = skb_peek(&adapter->tx_data_q);
247	else
248	skb_next = NULL;
249	tx_param.next_pkt_len = ((skb_next) ? skb_next->len : 0);
250	if (!tx_param.next_pkt_len) {
251	if (!mwifiex_wmm_lists_empty(adapter))
252	tx_param.next_pkt_len = 1;
253	}
254	return mwifiex_host_to_card(adapter, skb, &tx_param);
255	}
256
257	void
258	mwifiex_process_tx_queue(struct mwifiex_adapter *adapter)
259	{
260	do {
261	if (adapter->data_sent \|\| adapter->tx_lock_flag)
262	break;
263	if (mwifiex_dequeue_tx_queue(adapter))
264	break;
265	} while (!skb_queue_empty(&adapter->tx_data_q));
266	}
267
5e6e3a92 BZ	268	/*
	269	* Packet send completion callback handler.
	270	*
	271	* It either frees the buffer directly or forwards it to another
	272	* completion callback which checks conditions, updates statistics,
	273	* wakes up stalled traffic queue if required, and then frees the buffer.
	274	*/
	275	int mwifiex_write_data_complete(struct mwifiex_adapter *adapter,
47411a06	276	struct sk_buff *skb, int aggr, int status)
5e6e3a92	277	{
47411a06	278	struct mwifiex_private *priv;
270e58e8	279	struct mwifiex_txinfo *tx_info;
47411a06 AP	280	struct netdev_queue *txq;
47411a06 AP	281	int index;
5e6e3a92 BZ	282
	283	if (!skb)
	284	return 0;
	285
	286	tx_info = MWIFIEX_SKB_TXCB(skb);
9da9a3b2	287	priv = mwifiex_get_priv_by_id(adapter, tx_info->bss_num,
c65a30f3	288	tx_info->bss_type);
5e6e3a92 BZ	289	if (!priv)
	290	goto done;
	291
4daffe35 AK	292	if (adapter->iface_type == MWIFIEX_USB)
	293	adapter->data_sent = false;
	294
bbea3bc4	295	mwifiex_set_trans_start(priv->netdev);
5e6e3a92 BZ	296	if (!status) {
5e6e3a92 BZ	297	priv->stats.tx_packets++;
a1ed4849	298	priv->stats.tx_bytes += tx_info->pkt_len;
8908c7d5 AN	299	if (priv->tx_timeout_cnt)
8908c7d5 AN	300	priv->tx_timeout_cnt = 0;
5e6e3a92 BZ	301	} else {
	302	priv->stats.tx_errors++;
	303	}
62a5b7dc	304
838e4f44 AP	305	if (tx_info->flags & MWIFIEX_BUF_FLAG_BRIDGED_PKT)
838e4f44 AP	306	atomic_dec_return(&adapter->pending_bridged_pkts);
e35000ea ZL	307	if (tx_info->flags & MWIFIEX_BUF_FLAG_AGGR_PKT)
e35000ea ZL	308	goto done;
47411a06 AP	309
	310	if (aggr)
	311	/* For skb_aggr, do not wake up tx queue */
62a5b7dc	312	goto done;
5e6e3a92	313
47411a06	314	atomic_dec(&adapter->tx_pending);
5e6e3a92	315
47411a06 AP	316	index = mwifiex_1d_to_wmm_queue[skb->priority];
	317	if (atomic_dec_return(&priv->wmm_tx_pending[index]) < LOW_TX_PENDING) {
	318	txq = netdev_get_tx_queue(priv->netdev, index);
	319	if (netif_tx_queue_stopped(txq)) {
	320	netif_tx_wake_queue(txq);
	321	dev_dbg(adapter->dev, "wake queue: %d\n", index);
	322	}
5e6e3a92 BZ	323	}
	324	done:
	325	dev_kfree_skb_any(skb);
	326
	327	return 0;
	328	}
4daffe35	329	EXPORT_SYMBOL_GPL(mwifiex_write_data_complete);
5e6e3a92	330
808bbebc AK	331	void mwifiex_parse_tx_status_event(struct mwifiex_private *priv,
	332	void *event_body)
	333	{
	334	struct tx_status_event tx_status = (void )priv->adapter->event_body;
	335	struct sk_buff *ack_skb;
	336	unsigned long flags;
18ca4382	337	struct mwifiex_txinfo *tx_info;
808bbebc AK	338
	339	if (!tx_status->tx_token_id)
	340	return;
	341
	342	spin_lock_irqsave(&priv->ack_status_lock, flags);
	343	ack_skb = idr_find(&priv->ack_status_frames, tx_status->tx_token_id);
	344	if (ack_skb)
	345	idr_remove(&priv->ack_status_frames, tx_status->tx_token_id);
	346	spin_unlock_irqrestore(&priv->ack_status_lock, flags);
	347
18ca4382 AK	348	if (ack_skb) {
	349	tx_info = MWIFIEX_SKB_TXCB(ack_skb);
	350
	351	if (tx_info->flags & MWIFIEX_BUF_FLAG_EAPOL_TX_STATUS) {
	352	/* consumes ack_skb */
	353	skb_complete_wifi_ack(ack_skb, !tx_status->status);
	354	} else {
4facc34a	355	cfg80211_mgmt_tx_status(&priv->wdev, tx_info->cookie,
18ca4382 AK	356	ack_skb->data, ack_skb->len,
	357	!tx_status->status, GFP_ATOMIC);
	358	dev_kfree_skb_any(ack_skb);
	359	}
	360	}
808bbebc	361	}