|
@@ -2830,20 +2830,25 @@ static irqreturn_t sdhci_thread_irq(int irq, void *dev_id)
|
|
|
*/
|
|
|
static bool sdhci_enable_irq_wakeups(struct sdhci_host *host)
|
|
|
{
|
|
|
+ u8 mask = SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE |
|
|
|
+ SDHCI_WAKE_ON_INT;
|
|
|
+ u32 irq_val = 0;
|
|
|
+ u8 wake_val = 0;
|
|
|
u8 val;
|
|
|
- u8 mask = SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE
|
|
|
- | SDHCI_WAKE_ON_INT;
|
|
|
- u32 irq_val = SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE |
|
|
|
- SDHCI_INT_CARD_INT;
|
|
|
|
|
|
- val = sdhci_readb(host, SDHCI_WAKE_UP_CONTROL);
|
|
|
- val |= mask ;
|
|
|
- /* Avoid fake wake up */
|
|
|
- if (host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION) {
|
|
|
- val &= ~(SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE);
|
|
|
- irq_val &= ~(SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE);
|
|
|
+ if (!(host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION)) {
|
|
|
+ wake_val |= SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE;
|
|
|
+ irq_val |= SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE;
|
|
|
}
|
|
|
+
|
|
|
+ wake_val |= SDHCI_WAKE_ON_INT;
|
|
|
+ irq_val |= SDHCI_INT_CARD_INT;
|
|
|
+
|
|
|
+ val = sdhci_readb(host, SDHCI_WAKE_UP_CONTROL);
|
|
|
+ val &= ~mask;
|
|
|
+ val |= wake_val;
|
|
|
sdhci_writeb(host, val, SDHCI_WAKE_UP_CONTROL);
|
|
|
+
|
|
|
sdhci_writel(host, irq_val, SDHCI_INT_ENABLE);
|
|
|
|
|
|
host->irq_wake_enabled = !enable_irq_wake(host->irq);
|