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		common->hibernate_resume = false;
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
88static 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
101int 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
140int 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__);
163		kfree(coex_cb);
164		return -EINVAL;
165	}
166	return 0;
167}
168
169void 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}
182