soc/tegra: pmc: Process wake events during resume
PATCH v2 1/1 soc/tegra: pmc: Process wake events during resume
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(+)
drivers/soc/tegra/pmc.c +42 -0
@@ -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)
Signature · 1 line
2.17.1