Bluetooth: btmrvl: separate write-to-clear function from interrupt handler
This patch improves readability and makes future changes easier. Signed-off-by: Bing Zhao <bzhao@marvell.com> Signed-off-by: Marcel Holtmann <marcel@holtmann.org>
This commit is contained in:
committed by
Marcel Holtmann
parent
8002d77ca9
commit
8af4840a36
@@ -667,6 +667,36 @@ static int btmrvl_sdio_process_int_status(struct btmrvl_private *priv)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int btmrvl_sdio_write_to_clear(struct btmrvl_sdio_card *card, u8 *ireg)
|
||||||
|
{
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
*ireg = sdio_readb(card->func, card->reg->host_intstatus, &ret);
|
||||||
|
if (ret) {
|
||||||
|
BT_ERR("sdio_readb: read int status failed: %d", ret);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (*ireg) {
|
||||||
|
/*
|
||||||
|
* DN_LD_HOST_INT_STATUS and/or UP_LD_HOST_INT_STATUS
|
||||||
|
* Clear the interrupt status register and re-enable the
|
||||||
|
* interrupt.
|
||||||
|
*/
|
||||||
|
BT_DBG("int_status = 0x%x", *ireg);
|
||||||
|
|
||||||
|
sdio_writeb(card->func, ~(*ireg) & (DN_LD_HOST_INT_STATUS |
|
||||||
|
UP_LD_HOST_INT_STATUS),
|
||||||
|
card->reg->host_intstatus, &ret);
|
||||||
|
if (ret) {
|
||||||
|
BT_ERR("sdio_writeb: clear int status failed: %d", ret);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
static void btmrvl_sdio_interrupt(struct sdio_func *func)
|
static void btmrvl_sdio_interrupt(struct sdio_func *func)
|
||||||
{
|
{
|
||||||
struct btmrvl_private *priv;
|
struct btmrvl_private *priv;
|
||||||
@@ -684,28 +714,9 @@ static void btmrvl_sdio_interrupt(struct sdio_func *func)
|
|||||||
|
|
||||||
priv = card->priv;
|
priv = card->priv;
|
||||||
|
|
||||||
ireg = sdio_readb(card->func, card->reg->host_intstatus, &ret);
|
ret = btmrvl_sdio_write_to_clear(card, &ireg);
|
||||||
if (ret) {
|
if (ret)
|
||||||
BT_ERR("sdio_readb: read int status register failed");
|
|
||||||
return;
|
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),
|
|
||||||
card->reg->host_intstatus, &ret);
|
|
||||||
if (ret) {
|
|
||||||
BT_ERR("sdio_writeb: clear int status register failed");
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
spin_lock_irqsave(&priv->driver_lock, flags);
|
spin_lock_irqsave(&priv->driver_lock, flags);
|
||||||
sdio_ireg |= ireg;
|
sdio_ireg |= ireg;
|
||||||
|
|||||||
Reference in New Issue
Block a user