]> Git Repo - J-linux.git/blob - drivers/net/wireless/rsi/rsi_91x_coex.c
Merge tag 'vfs-6.13-rc7.fixes' of git://git.kernel.org/pub/scm/linux/kernel/git/vfs/vfs
[J-linux.git] / drivers / net / wireless / rsi / rsi_91x_coex.c
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 = common->coex_cb;
56         u32 timeout = EVENT_WAIT_FOREVER;
57
58         do {
59                 rsi_wait_event(&coex_cb->coex_tx_thread.event, timeout);
60                 rsi_reset_event(&coex_cb->coex_tx_thread.event);
61
62                 rsi_coex_sched_tx_pkts(coex_cb);
63         } while (atomic_read(&coex_cb->coex_tx_thread.thread_done) == 0);
64
65         kthread_complete_and_exit(&coex_cb->coex_tx_thread.completion, 0);
66 }
67
68 int rsi_coex_recv_pkt(struct rsi_common *common, u8 *msg)
69 {
70         u8 msg_type = msg[RSI_RX_DESC_MSG_TYPE_OFFSET];
71
72         switch (msg_type) {
73         case COMMON_CARD_READY_IND:
74                 rsi_dbg(INFO_ZONE, "common card ready received\n");
75                 common->hibernate_resume = false;
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 = priv;
103         struct rsi_coex_ctrl_block *coex_cb = common->coex_cb;
104         struct skb_info *tx_params = NULL;
105         enum rsi_coex_queues coex_q;
106         int status;
107
108         coex_q = rsi_map_coex_q(hal_queue);
109         if (coex_q == RSI_COEX_Q_INVALID) {
110                 rsi_dbg(ERR_ZONE, "Invalid coex queue\n");
111                 return -EINVAL;
112         }
113         if (coex_q != RSI_COEX_Q_COMMON &&
114             coex_q != RSI_COEX_Q_WLAN) {
115                 skb_queue_tail(&coex_cb->coex_tx_qs[coex_q], skb);
116                 rsi_set_event(&coex_cb->coex_tx_thread.event);
117                 return 0;
118         }
119         if (common->iface_down) {
120                 tx_params =
121                         (struct skb_info *)&IEEE80211_SKB_CB(skb)->driver_data;
122
123                 if (!(tx_params->flags & INTERNAL_MGMT_PKT)) {
124                         rsi_indicate_tx_status(common->priv, skb, -EINVAL);
125                         return 0;
126                 }
127         }
128
129         /* Send packet to hal */
130         if (skb->priority == MGMT_SOFT_Q)
131                 status = rsi_send_mgmt_pkt(common, skb);
132         else
133                 status = rsi_send_data_pkt(common, skb);
134
135         return status;
136 }
137
138 int rsi_coex_attach(struct rsi_common *common)
139 {
140         struct rsi_coex_ctrl_block *coex_cb;
141         int cnt;
142
143         coex_cb = kzalloc(sizeof(*coex_cb), GFP_KERNEL);
144         if (!coex_cb)
145                 return -ENOMEM;
146
147         common->coex_cb = (void *)coex_cb;
148         coex_cb->priv = common;
149
150         /* Initialize co-ex queues */
151         for (cnt = 0; cnt < NUM_COEX_TX_QUEUES; cnt++)
152                 skb_queue_head_init(&coex_cb->coex_tx_qs[cnt]);
153         rsi_init_event(&coex_cb->coex_tx_thread.event);
154
155         /* Initialize co-ex thread */
156         if (rsi_create_kthread(common,
157                                &coex_cb->coex_tx_thread,
158                                rsi_coex_scheduler_thread,
159                                "Coex-Tx-Thread")) {
160                 rsi_dbg(ERR_ZONE, "%s: Unable to init tx thrd\n", __func__);
161                 kfree(coex_cb);
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 = common->coex_cb;
170         int cnt;
171
172         rsi_kill_thread(&coex_cb->coex_tx_thread);
173
174         for (cnt = 0; cnt < NUM_COEX_TX_QUEUES; cnt++)
175                 skb_queue_purge(&coex_cb->coex_tx_qs[cnt]);
176
177         kfree(coex_cb);
178 }
This page took 0.0379080000000001 seconds and 4 git commands to generate.