1/**
  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
 22static 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
 37static 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
 46		if (coex_q == RSI_COEX_Q_BT) {
 47			skb = skb_dequeue(&coex_cb->coex_tx_qs[RSI_COEX_Q_BT]);
 48			rsi_send_bt_pkt(coex_cb->priv, skb);
 49		}
 50	} while (coex_q != RSI_COEX_Q_INVALID);
 51}
 52
 53static 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
 66	complete_and_exit(&coex_cb->coex_tx_thread.completion, 0);
 67}
 68
 69int 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");
 76		rsi_handle_card_ready(common, msg);
 77		break;
 78	case SLEEP_NOTIFY_IND:
 79		rsi_dbg(INFO_ZONE, "sleep notify received\n");
 80		rsi_mgmt_pkt_recv(common, msg);
 81		break;
 82	}
 83
 84	return 0;
 85}
 86
 87static inline int rsi_map_coex_q(u8 hal_queue)
 88{
 89	switch (hal_queue) {
 90	case RSI_COEX_Q:
 91		return RSI_COEX_Q_COMMON;
 92	case RSI_WLAN_Q:
 93		return RSI_COEX_Q_WLAN;
 94	case RSI_BT_Q:
 95		return RSI_COEX_Q_BT;
 96	}
 97	return RSI_COEX_Q_INVALID;
 98}
 99
100int rsi_coex_send_pkt(void *priv, struct sk_buff *skb, u8 hal_queue)
101{
102	struct rsi_common *common = (struct rsi_common *)priv;
103	struct rsi_coex_ctrl_block *coex_cb =
104		(struct rsi_coex_ctrl_block *)common->coex_cb;
105	struct skb_info *tx_params = NULL;
106	enum rsi_coex_queues coex_q;
107	int status;
108
109	coex_q = rsi_map_coex_q(hal_queue);
110	if (coex_q == RSI_COEX_Q_INVALID) {
111		rsi_dbg(ERR_ZONE, "Invalid coex queue\n");
112		return -EINVAL;
113	}
114	if (coex_q != RSI_COEX_Q_COMMON &&
115	    coex_q != RSI_COEX_Q_WLAN) {
116		skb_queue_tail(&coex_cb->coex_tx_qs[coex_q], skb);
117		rsi_set_event(&coex_cb->coex_tx_thread.event);
118		return 0;
119	}
120	if (common->iface_down) {
121		tx_params =
122			(struct skb_info *)&IEEE80211_SKB_CB(skb)->driver_data;
123
124		if (!(tx_params->flags & INTERNAL_MGMT_PKT)) {
125			rsi_indicate_tx_status(common->priv, skb, -EINVAL);
126			return 0;
127		}
128	}
129
130	/* Send packet to hal */
131	if (skb->priority == MGMT_SOFT_Q)
132		status = rsi_send_mgmt_pkt(common, skb);
133	else
134		status = rsi_send_data_pkt(common, skb);
135
136	return status;
137}
138
139int rsi_coex_attach(struct rsi_common *common)
140{
141	struct rsi_coex_ctrl_block *coex_cb;
142	int cnt;
143
144	coex_cb = kzalloc(sizeof(*coex_cb), GFP_KERNEL);
145	if (!coex_cb)
146		return -ENOMEM;
147
148	common->coex_cb = (void *)coex_cb;
149	coex_cb->priv = common;
150
151	/* Initialize co-ex queues */
152	for (cnt = 0; cnt < NUM_COEX_TX_QUEUES; cnt++)
153		skb_queue_head_init(&coex_cb->coex_tx_qs[cnt]);
154	rsi_init_event(&coex_cb->coex_tx_thread.event);
155
156	/* Initialize co-ex thread */
157	if (rsi_create_kthread(common,
158			       &coex_cb->coex_tx_thread,
159			       rsi_coex_scheduler_thread,
160			       "Coex-Tx-Thread")) {
161		rsi_dbg(ERR_ZONE, "%s: Unable to init tx thrd\n", __func__);
162		return -EINVAL;
163	}
164	return 0;
165}
166
167void rsi_coex_detach(struct rsi_common *common)
168{
169	struct rsi_coex_ctrl_block *coex_cb =
170		(struct rsi_coex_ctrl_block *)common->coex_cb;
171	int cnt;
172
173	rsi_kill_thread(&coex_cb->coex_tx_thread);
174
175	for (cnt = 0; cnt < NUM_COEX_TX_QUEUES; cnt++)
176		skb_queue_purge(&coex_cb->coex_tx_qs[cnt]);
177
178	kfree(coex_cb);
179}