Bluetooth: Process interrupt in main thread of btmrvl driver as well

When driver is sending a command or data and the firmware is also
sending a sleep event, sometimes it is observed that driver will
continue to send the command/data to firmware right after processing
sleep event. Once sleep event is processed driver is not supposed to
send anything because firmware is in sleep state after that. Previously
interrupt processing was done in SDIO interrupt callback handler.
Now it is done in btmrvl driver main thread to solve the
cross-sending properly.

Signed-off-by: Amitkumar Karwar <akarwar@marvell.com>
Signed-off-by: Bing Zhao <bzhao@marvell.com>
Signed-off-by: Marcel Holtmann <marcel@holtmann.org>

diff --git a/drivers/bluetooth/btmrvl_drv.h b/drivers/bluetooth/btmrvl_drv.h
index bed0ba630235b46fb796b20116f4ea11d414675b..872cb6cfcd0d6ea82306b66c18943fcfa023da55 100644 (file)
--- a/drivers/bluetooth/btmrvl_drv.h
+++ b/drivers/bluetooth/btmrvl_drv.h
@@ -76,6 +76,7 @@ struct btmrvl_private {
        int (*hw_host_to_card) (struct btmrvl_private *priv,
                                u8 *payload, u16 nb);
        int (*hw_wakeup_firmware) (struct btmrvl_private *priv);
+       int (*hw_process_int_status) (struct btmrvl_private *priv);
        spinlock_t driver_lock;         /* spinlock used by driver */
 #ifdef CONFIG_DEBUG_FS
        void *debugfs_data;

diff --git a/drivers/bluetooth/btmrvl_main.c b/drivers/bluetooth/btmrvl_main.c
index ee37ef0caee269c0383fd9336ea9cf0d665ddba0..0d32ec82e9bfa5a72e847e43202830f91b2c26d0 100644 (file)
--- a/drivers/bluetooth/btmrvl_main.c
+++ b/drivers/bluetooth/btmrvl_main.c
@@ -502,14 +502,17 @@ static int btmrvl_service_main_thread(void *data)
                spin_lock_irqsave(&priv->driver_lock, flags);
                if (adapter->int_count) {
                        adapter->int_count = 0;
+                       spin_unlock_irqrestore(&priv->driver_lock, flags);
+                       priv->hw_process_int_status(priv);
                } else if (adapter->ps_state == PS_SLEEP &&
                                        !skb_queue_empty(&adapter->tx_queue)) {
                        spin_unlock_irqrestore(&priv->driver_lock, flags);
                        adapter->wakeup_tries++;
                        priv->hw_wakeup_firmware(priv);
                        continue;
+               } else {
+                       spin_unlock_irqrestore(&priv->driver_lock, flags);
                }
-               spin_unlock_irqrestore(&priv->driver_lock, flags);
 
                if (adapter->ps_state == PS_SLEEP)
                        continue;

diff --git a/drivers/bluetooth/btmrvl_sdio.c b/drivers/bluetooth/btmrvl_sdio.c
index 47f0f917dec915832f13d233247a635211abd477..182e55345d6a28569786b358bfbfdce09cefc681 100644 (file)
--- a/drivers/bluetooth/btmrvl_sdio.c
+++ b/drivers/bluetooth/btmrvl_sdio.c
@@ -47,6 +47,7 @@
  * module_exit function is called.
  */
 static u8 user_rmmod;
+static u8 sdio_ireg;
 
 static const struct btmrvl_sdio_device btmrvl_sdio_sd6888 = {
        .helper         = "sd8688_helper.bin",
@@ -555,78 +556,79 @@ exit:
        return ret;
 }
 
-static int btmrvl_sdio_get_int_status(struct btmrvl_private *priv, u8 * ireg)
+static int btmrvl_sdio_process_int_status(struct btmrvl_private *priv)
 {
-       int ret;
-       u8 sdio_ireg = 0;
+       ulong flags;
+       u8 ireg;
        struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
 
-       *ireg = 0;
-
-       sdio_ireg = sdio_readb(card->func, HOST_INTSTATUS_REG, &ret);
-       if (ret) {
-               BT_ERR("sdio_readb: read int status register failed");
-               ret = -EIO;
-               goto done;
-       }
-
-       if (sdio_ireg != 0) {
-               /*
-                * DN_LD_HOST_INT_STATUS and/or UP_LD_HOST_INT_STATUS
-                * Clear the interrupt status register and re-enable the
-                * interrupt.
-                */
-               BT_DBG("sdio_ireg = 0x%x", sdio_ireg);
-
-               sdio_writeb(card->func, ~(sdio_ireg) & (DN_LD_HOST_INT_STATUS |
-                                                       UP_LD_HOST_INT_STATUS),
-                           HOST_INTSTATUS_REG, &ret);
-               if (ret) {
-                       BT_ERR("sdio_writeb: clear int status register "
-                               "failed");
-                       ret = -EIO;
-                       goto done;
-               }
-       }
+       spin_lock_irqsave(&priv->driver_lock, flags);
+       ireg = sdio_ireg;
+       sdio_ireg = 0;
+       spin_unlock_irqrestore(&priv->driver_lock, flags);
 
-       if (sdio_ireg & DN_LD_HOST_INT_STATUS) {
+       sdio_claim_host(card->func);
+       if (ireg & DN_LD_HOST_INT_STATUS) {
                if (priv->btmrvl_dev.tx_dnld_rdy)
                        BT_DBG("tx_done already received: "
-                               " int_status=0x%x", sdio_ireg);
+                               " int_status=0x%x", ireg);
                else
                        priv->btmrvl_dev.tx_dnld_rdy = true;
        }
 
-       if (sdio_ireg & UP_LD_HOST_INT_STATUS)
+       if (ireg & UP_LD_HOST_INT_STATUS)
                btmrvl_sdio_card_to_host(priv);
 
-       *ireg = sdio_ireg;
-
-       ret = 0;
+       sdio_release_host(card->func);
 
-done:
-       return ret;
+       return 0;
 }
 
 static void btmrvl_sdio_interrupt(struct sdio_func *func)
 {
        struct btmrvl_private *priv;
-       struct hci_dev *hcidev;
        struct btmrvl_sdio_card *card;
+       ulong flags;
        u8 ireg = 0;
+       int ret;
 
        card = sdio_get_drvdata(func);
-       if (card && card->priv) {
-               priv = card->priv;
-               hcidev = priv->btmrvl_dev.hcidev;
+       if (!card || !card->priv) {
+               BT_ERR("sbi_interrupt(%p) card or priv is "
+                               "NULL, card=%p\n", func, card);
+               return;
+       }
 
-               if (btmrvl_sdio_get_int_status(priv, &ireg))
-                       BT_ERR("reading HOST_INT_STATUS_REG failed");
-               else
-                       BT_DBG("HOST_INT_STATUS_REG %#x", ireg);
+       priv = card->priv;
 
-               btmrvl_interrupt(priv);
+       ireg = sdio_readb(card->func, HOST_INTSTATUS_REG, &ret);
+       if (ret) {
+               BT_ERR("sdio_readb: read int status register failed");
+               return;
        }
+
+       if (ireg != 0) {
+               /*
+                * DN_LD_HOST_INT_STATUS and/or UP_LD_HOST_INT_STATUS
+                * Clear the interrupt status register and re-enable the
+                * interrupt.
+                */
+               BT_DBG("ireg = 0x%x", ireg);
+
+               sdio_writeb(card->func, ~(ireg) & (DN_LD_HOST_INT_STATUS |
+                                       UP_LD_HOST_INT_STATUS),
+                               HOST_INTSTATUS_REG, &ret);
+               if (ret) {
+                       BT_ERR("sdio_writeb: clear int status register failed");
+                       return;
+               }
+       }
+
+       spin_lock_irqsave(&priv->driver_lock, flags);
+       sdio_ireg |= ireg;
+       spin_unlock_irqrestore(&priv->driver_lock, flags);
+
+       btmrvl_interrupt(priv);
 }
 
 static int btmrvl_sdio_register_dev(struct btmrvl_sdio_card *card)
@@ -930,6 +932,7 @@ static int btmrvl_sdio_probe(struct sdio_func *func,
        /* Initialize the interface specific function pointers */
        priv->hw_host_to_card = btmrvl_sdio_host_to_card;
        priv->hw_wakeup_firmware = btmrvl_sdio_wakeup_fw;
+       priv->hw_process_int_status = btmrvl_sdio_process_int_status;
 
        if (btmrvl_register_hdev(priv)) {
                BT_ERR("Register hdev failed!");