During system resume, translate tier2 SC7 wake sources back into
irqs and do generic_handle_irq() to invoke the interrupt handlers
for edge triggered wake events such as sw-wake.
Signed-off-by: Prathamesh Shete <[email protected]>
Signed-off-by: Petlozu Pravareshwar <[email protected]>
---
drivers/soc/tegra/pmc.c | 42 +++++++++++++++++++++++++++++++++++++++++
1 file changed, 42 insertions(+)
diff --git a/drivers/soc/tegra/pmc.c b/drivers/soc/tegra/pmc.c
index 66f94c011528..d166048de83c 100644
--- a/drivers/soc/tegra/pmc.c
+++ b/drivers/soc/tegra/pmc.c
@@ -23,6 +23,7 @@
#include <linux/err.h>
#include <linux/export.h>
#include <linux/init.h>
+#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/iopoll.h>
#include <linux/irqdomain.h>
@@ -3151,6 +3152,46 @@ static void wke_clear_wake_status(void)
}
}
+/* translate sc7 wake sources back into irqs to catch edge triggered wakeups */
+static void process_wake_event(unsigned int index, unsigned long status)
+{
+ unsigned int irq, wake;
+ irq_hw_number_t hwirq;
+ struct irq_desc *desc;
+
+ dev_dbg(pmc->dev, "Wake[%d:%d] status=0x%x\n", (index * 32) + 31,
+ index * 32, (u32)status);
+
+ for_each_set_bit(wake, &status, 32) {
+ hwirq = wake + 32 * index;
+
+ irq = irq_find_mapping(pmc->domain, hwirq);
+
+ desc = irq_to_desc(irq);
+ if (!desc || !desc->action || !desc->action->name) {
+ dev_dbg(pmc->dev, "Resume caused by WAKE%d, irq %d\n",
+ (wake + 32 * index), irq);
+ continue;
+ }
+ dev_dbg(pmc->dev, "Resume caused by WAKE%d, %s\n",
+ (wake + 32 * index), desc->action->name);
+ generic_handle_irq(irq);
+ }
+}
+
+static void tegra186_pmc_wake_syscore_resume(void)
+{
+ unsigned int i;
+ u32 status;
+
+ for (i = 0; i < pmc->soc->max_wake_vectors; i++) {
+ status = readl(pmc->wake + WAKE_AOWAKE_STATUS_R(i));
+ status = status & readl(pmc->wake +
+ WAKE_AOWAKE_TIER2_ROUTING(i));
+ process_wake_event(i, status);
+ }
+}
+
static int tegra186_pmc_wake_syscore_suspend(void)
{
wke_read_sw_wake_status();
@@ -3828,6 +3869,7 @@ static const struct tegra_pmc_regs tegra186_pmc_regs = {
static struct syscore_ops tegra186_pmc_wake_syscore_ops = {
.suspend = tegra186_pmc_wake_syscore_suspend,
+ .resume = tegra186_pmc_wake_syscore_resume,
};
static void tegra186_pmc_init(struct tegra_pmc *pmc)
--
2.17.1