[linux-block.git] / drivers / net / wireless / rsi / rsi_91x_coex.c

/*
 * Copyright (c) 2018 Redpine Signals Inc.
 *
 * Permission to use, copy, modify, and/or distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

#include "rsi_main.h"
#include "rsi_coex.h"
#include "rsi_mgmt.h"
#include "rsi_hal.h"

static enum rsi_coex_queues rsi_coex_determine_coex_q
			(struct rsi_coex_ctrl_block *coex_cb)
{
	enum rsi_coex_queues q_num = RSI_COEX_Q_INVALID;

	if (skb_queue_len(&coex_cb->coex_tx_qs[RSI_COEX_Q_COMMON]) > 0)
		q_num = RSI_COEX_Q_COMMON;
	if (skb_queue_len(&coex_cb->coex_tx_qs[RSI_COEX_Q_BT]) > 0)
		q_num = RSI_COEX_Q_BT;
	if (skb_queue_len(&coex_cb->coex_tx_qs[RSI_COEX_Q_WLAN]) > 0)
		q_num = RSI_COEX_Q_WLAN;

	return q_num;
}

static void rsi_coex_sched_tx_pkts(struct rsi_coex_ctrl_block *coex_cb)
{
	enum rsi_coex_queues coex_q = RSI_COEX_Q_INVALID;
	struct sk_buff *skb;

	do {
		coex_q = rsi_coex_determine_coex_q(coex_cb);
		rsi_dbg(INFO_ZONE, "queue = %d\n", coex_q);

		if (coex_q == RSI_COEX_Q_BT) {
			skb = skb_dequeue(&coex_cb->coex_tx_qs[RSI_COEX_Q_BT]);
			rsi_send_bt_pkt(coex_cb->priv, skb);
		}
	} while (coex_q != RSI_COEX_Q_INVALID);
}

static void rsi_coex_scheduler_thread(struct rsi_common *common)
{
	struct rsi_coex_ctrl_block *coex_cb =
		(struct rsi_coex_ctrl_block *)common->coex_cb;
	u32 timeout = EVENT_WAIT_FOREVER;

	do {
		rsi_wait_event(&coex_cb->coex_tx_thread.event, timeout);
		rsi_reset_event(&coex_cb->coex_tx_thread.event);

		rsi_coex_sched_tx_pkts(coex_cb);
	} while (atomic_read(&coex_cb->coex_tx_thread.thread_done) == 0);

	kthread_complete_and_exit(&coex_cb->coex_tx_thread.completion, 0);
}

int rsi_coex_recv_pkt(struct rsi_common *common, u8 *msg)
{
	u8 msg_type = msg[RSI_RX_DESC_MSG_TYPE_OFFSET];

	switch (msg_type) {
	case COMMON_CARD_READY_IND:
		rsi_dbg(INFO_ZONE, "common card ready received\n");
		common->hibernate_resume = false;
		rsi_handle_card_ready(common, msg);
		break;
	case SLEEP_NOTIFY_IND:
		rsi_dbg(INFO_ZONE, "sleep notify received\n");
		rsi_mgmt_pkt_recv(common, msg);
		break;
	}

	return 0;
}

static inline int rsi_map_coex_q(u8 hal_queue)
{
	switch (hal_queue) {
	case RSI_COEX_Q:
		return RSI_COEX_Q_COMMON;
	case RSI_WLAN_Q:
		return RSI_COEX_Q_WLAN;
	case RSI_BT_Q:
		return RSI_COEX_Q_BT;
	}
	return RSI_COEX_Q_INVALID;
}

int rsi_coex_send_pkt(void *priv, struct sk_buff *skb, u8 hal_queue)
{
	struct rsi_common *common = (struct rsi_common *)priv;
	struct rsi_coex_ctrl_block *coex_cb =
		(struct rsi_coex_ctrl_block *)common->coex_cb;
	struct skb_info *tx_params = NULL;
	enum rsi_coex_queues coex_q;
	int status;

	coex_q = rsi_map_coex_q(hal_queue);
	if (coex_q == RSI_COEX_Q_INVALID) {
		rsi_dbg(ERR_ZONE, "Invalid coex queue\n");
		return -EINVAL;
	}
	if (coex_q != RSI_COEX_Q_COMMON &&
	    coex_q != RSI_COEX_Q_WLAN) {
		skb_queue_tail(&coex_cb->coex_tx_qs[coex_q], skb);
		rsi_set_event(&coex_cb->coex_tx_thread.event);
		return 0;
	}
	if (common->iface_down) {
		tx_params =
			(struct skb_info *)&IEEE80211_SKB_CB(skb)->driver_data;

		if (!(tx_params->flags & INTERNAL_MGMT_PKT)) {
			rsi_indicate_tx_status(common->priv, skb, -EINVAL);
			return 0;
		}
	}

	/* Send packet to hal */
	if (skb->priority == MGMT_SOFT_Q)
		status = rsi_send_mgmt_pkt(common, skb);
	else
		status = rsi_send_data_pkt(common, skb);

	return status;
}

int rsi_coex_attach(struct rsi_common *common)
{
	struct rsi_coex_ctrl_block *coex_cb;
	int cnt;

	coex_cb = kzalloc(sizeof(*coex_cb), GFP_KERNEL);
	if (!coex_cb)
		return -ENOMEM;

	common->coex_cb = (void *)coex_cb;
	coex_cb->priv = common;

	/* Initialize co-ex queues */
	for (cnt = 0; cnt < NUM_COEX_TX_QUEUES; cnt++)
		skb_queue_head_init(&coex_cb->coex_tx_qs[cnt]);
	rsi_init_event(&coex_cb->coex_tx_thread.event);

	/* Initialize co-ex thread */
	if (rsi_create_kthread(common,
			       &coex_cb->coex_tx_thread,
			       rsi_coex_scheduler_thread,
			       "Coex-Tx-Thread")) {
		rsi_dbg(ERR_ZONE, "%s: Unable to init tx thrd\n", __func__);
		kfree(coex_cb);
		return -EINVAL;
	}
	return 0;
}

void rsi_coex_detach(struct rsi_common *common)
{
	struct rsi_coex_ctrl_block *coex_cb =
		(struct rsi_coex_ctrl_block *)common->coex_cb;
	int cnt;

	rsi_kill_thread(&coex_cb->coex_tx_thread);

	for (cnt = 0; cnt < NUM_COEX_TX_QUEUES; cnt++)
		skb_queue_purge(&coex_cb->coex_tx_qs[cnt]);

	kfree(coex_cb);
}
Commit	Line	Data
7a03124c	1	/*
2108df3c PRG	2	* Copyright (c) 2018 Redpine Signals Inc.
	3	*
	4	* Permission to use, copy, modify, and/or distribute this software for any
	5	* purpose with or without fee is hereby granted, provided that the above
	6	* copyright notice and this permission notice appear in all copies.
	7	*
	8	* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
	9	* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
	10	* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
	11	* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
	12	* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
	13	* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
	14	* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
	15	*/
	16
	17	#include "rsi_main.h"
	18	#include "rsi_coex.h"
	19	#include "rsi_mgmt.h"
	20	#include "rsi_hal.h"
	21
	22	static enum rsi_coex_queues rsi_coex_determine_coex_q
	23	(struct rsi_coex_ctrl_block *coex_cb)
	24	{
	25	enum rsi_coex_queues q_num = RSI_COEX_Q_INVALID;
	26
	27	if (skb_queue_len(&coex_cb->coex_tx_qs[RSI_COEX_Q_COMMON]) > 0)
	28	q_num = RSI_COEX_Q_COMMON;
	29	if (skb_queue_len(&coex_cb->coex_tx_qs[RSI_COEX_Q_BT]) > 0)
	30	q_num = RSI_COEX_Q_BT;
	31	if (skb_queue_len(&coex_cb->coex_tx_qs[RSI_COEX_Q_WLAN]) > 0)
	32	q_num = RSI_COEX_Q_WLAN;
	33
	34	return q_num;
	35	}
	36
	37	static void rsi_coex_sched_tx_pkts(struct rsi_coex_ctrl_block *coex_cb)
	38	{
	39	enum rsi_coex_queues coex_q = RSI_COEX_Q_INVALID;
	40	struct sk_buff *skb;
	41
	42	do {
	43	coex_q = rsi_coex_determine_coex_q(coex_cb);
	44	rsi_dbg(INFO_ZONE, "queue = %d\n", coex_q);
	45
716b840c	46	if (coex_q == RSI_COEX_Q_BT) {
2108df3c	47	skb = skb_dequeue(&coex_cb->coex_tx_qs[RSI_COEX_Q_BT]);
716b840c SR	48	rsi_send_bt_pkt(coex_cb->priv, skb);
716b840c SR	49	}
2108df3c PRG	50	} while (coex_q != RSI_COEX_Q_INVALID);
	51	}
	52
	53	static void rsi_coex_scheduler_thread(struct rsi_common *common)
	54	{
	55	struct rsi_coex_ctrl_block *coex_cb =
	56	(struct rsi_coex_ctrl_block *)common->coex_cb;
	57	u32 timeout = EVENT_WAIT_FOREVER;
	58
	59	do {
	60	rsi_wait_event(&coex_cb->coex_tx_thread.event, timeout);
	61	rsi_reset_event(&coex_cb->coex_tx_thread.event);
	62
	63	rsi_coex_sched_tx_pkts(coex_cb);
	64	} while (atomic_read(&coex_cb->coex_tx_thread.thread_done) == 0);
	65
cead1855	66	kthread_complete_and_exit(&coex_cb->coex_tx_thread.completion, 0);
2108df3c PRG	67	}
	68
	69	int rsi_coex_recv_pkt(struct rsi_common common, u8 msg)
	70	{
	71	u8 msg_type = msg[RSI_RX_DESC_MSG_TYPE_OFFSET];
	72
	73	switch (msg_type) {
	74	case COMMON_CARD_READY_IND:
	75	rsi_dbg(INFO_ZONE, "common card ready received\n");
d76f8513	76	common->hibernate_resume = false;
2108df3c PRG	77	rsi_handle_card_ready(common, msg);
	78	break;
	79	case SLEEP_NOTIFY_IND:
	80	rsi_dbg(INFO_ZONE, "sleep notify received\n");
	81	rsi_mgmt_pkt_recv(common, msg);
	82	break;
	83	}
	84
	85	return 0;
	86	}
	87
	88	static inline int rsi_map_coex_q(u8 hal_queue)
	89	{
	90	switch (hal_queue) {
	91	case RSI_COEX_Q:
	92	return RSI_COEX_Q_COMMON;
	93	case RSI_WLAN_Q:
	94	return RSI_COEX_Q_WLAN;
	95	case RSI_BT_Q:
	96	return RSI_COEX_Q_BT;
	97	}
	98	return RSI_COEX_Q_INVALID;
	99	}
	100
	101	int rsi_coex_send_pkt(void priv, struct sk_buff skb, u8 hal_queue)
	102	{
	103	struct rsi_common common = (struct rsi_common )priv;
	104	struct rsi_coex_ctrl_block *coex_cb =
	105	(struct rsi_coex_ctrl_block *)common->coex_cb;
	106	struct skb_info *tx_params = NULL;
	107	enum rsi_coex_queues coex_q;
	108	int status;
	109
	110	coex_q = rsi_map_coex_q(hal_queue);
	111	if (coex_q == RSI_COEX_Q_INVALID) {
	112	rsi_dbg(ERR_ZONE, "Invalid coex queue\n");
	113	return -EINVAL;
	114	}
	115	if (coex_q != RSI_COEX_Q_COMMON &&
	116	coex_q != RSI_COEX_Q_WLAN) {
	117	skb_queue_tail(&coex_cb->coex_tx_qs[coex_q], skb);
	118	rsi_set_event(&coex_cb->coex_tx_thread.event);
	119	return 0;
	120	}
	121	if (common->iface_down) {
	122	tx_params =
	123	(struct skb_info *)&IEEE80211_SKB_CB(skb)->driver_data;
	124
	125	if (!(tx_params->flags & INTERNAL_MGMT_PKT)) {
	126	rsi_indicate_tx_status(common->priv, skb, -EINVAL);
	127	return 0;
	128	}
	129	}
	130
	131	/* Send packet to hal */
	132	if (skb->priority == MGMT_SOFT_Q)
	133	status = rsi_send_mgmt_pkt(common, skb);
	134	else
	135	status = rsi_send_data_pkt(common, skb);
	136
	137	return status;
	138	}
	139
	140	int rsi_coex_attach(struct rsi_common *common)
141	{
142	struct rsi_coex_ctrl_block *coex_cb;
143	int cnt;
144
145	coex_cb = kzalloc(sizeof(*coex_cb), GFP_KERNEL);
146	if (!coex_cb)
147	return -ENOMEM;
148
149	common->coex_cb = (void *)coex_cb;
150	coex_cb->priv = common;
151
152	/* Initialize co-ex queues */
153	for (cnt = 0; cnt < NUM_COEX_TX_QUEUES; cnt++)
154	skb_queue_head_init(&coex_cb->coex_tx_qs[cnt]);
155	rsi_init_event(&coex_cb->coex_tx_thread.event);
156
157	/* Initialize co-ex thread */
158	if (rsi_create_kthread(common,
159	&coex_cb->coex_tx_thread,
160	rsi_coex_scheduler_thread,
161	"Coex-Tx-Thread")) {
162	rsi_dbg(ERR_ZONE, "%s: Unable to init tx thrd\n", __func__);
956fb851	163	kfree(coex_cb);
2108df3c PRG	164	return -EINVAL;
	165	}
	166	return 0;
	167	}
	168
	169	void rsi_coex_detach(struct rsi_common *common)
	170	{
	171	struct rsi_coex_ctrl_block *coex_cb =
	172	(struct rsi_coex_ctrl_block *)common->coex_cb;
	173	int cnt;
	174
	175	rsi_kill_thread(&coex_cb->coex_tx_thread);
	176
	177	for (cnt = 0; cnt < NUM_COEX_TX_QUEUES; cnt++)
	178	skb_queue_purge(&coex_cb->coex_tx_qs[cnt]);
	179
	180	kfree(coex_cb);
	181	}