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 
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 
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 
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 
66 	complete_and_exit(&coex_cb->coex_tx_thread.completion, 0);
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");
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 
87 static 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 
100 int 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 
139 int 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 
167 void 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 }
180