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 }