In suspend interrupts are disabled from 0 to NR_IRQ, in resume interrupts should be enabled in reverse order. Enabling parent or summary interrupts before enabling child interrupts causes the handler of the child interrupt to run even before it is enabled. Usually the genirq handler does the correct thing of masking the interrupt and additionally marking the interrupt IRQ_PENDING if its an edge triggered interrupt. However the nested handler (handle_nested_irq()) simply ignores the interrupt causing a loss of it. Not calling the action of an interrupt, especially if it marked wakeup, causes the system to incorrectly go back to suspend immediately. Change-Id: Ica30c10a975a4a7b41b97b4f21250dac80335b2b Signed-off-by: Abhijeet Dharmapurikar <adharmap@codeaurora.org> (cherry picked from commit 6dfcdc120d05d041e38668d15fd041fb7803986d)
126 lines
2.9 KiB
C
126 lines
2.9 KiB
C
/*
|
|
* linux/kernel/irq/pm.c
|
|
*
|
|
* Copyright (C) 2009 Rafael J. Wysocki <rjw@sisk.pl>, Novell Inc.
|
|
*
|
|
* This file contains power management functions related to interrupts.
|
|
*/
|
|
|
|
#include <linux/irq.h>
|
|
#include <linux/module.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/syscore_ops.h>
|
|
|
|
#include "internals.h"
|
|
|
|
/**
|
|
* suspend_device_irqs - disable all currently enabled interrupt lines
|
|
*
|
|
* During system-wide suspend or hibernation device drivers need to be prevented
|
|
* from receiving interrupts and this function is provided for this purpose.
|
|
* It marks all interrupt lines in use, except for the timer ones, as disabled
|
|
* and sets the IRQS_SUSPENDED flag for each of them.
|
|
*/
|
|
void suspend_device_irqs(void)
|
|
{
|
|
struct irq_desc *desc;
|
|
int irq;
|
|
|
|
for_each_irq_desc(irq, desc) {
|
|
unsigned long flags;
|
|
|
|
raw_spin_lock_irqsave(&desc->lock, flags);
|
|
__disable_irq(desc, irq, true);
|
|
raw_spin_unlock_irqrestore(&desc->lock, flags);
|
|
}
|
|
|
|
for_each_irq_desc(irq, desc)
|
|
if (desc->istate & IRQS_SUSPENDED)
|
|
synchronize_irq(irq);
|
|
}
|
|
EXPORT_SYMBOL_GPL(suspend_device_irqs);
|
|
|
|
static void resume_irqs(bool want_early)
|
|
{
|
|
struct irq_desc *desc;
|
|
int irq;
|
|
|
|
for_each_irq_desc_reverse(irq, desc) {
|
|
unsigned long flags;
|
|
bool is_early = desc->action &&
|
|
desc->action->flags & IRQF_EARLY_RESUME;
|
|
|
|
if (is_early != want_early)
|
|
continue;
|
|
|
|
raw_spin_lock_irqsave(&desc->lock, flags);
|
|
__enable_irq(desc, irq, true);
|
|
raw_spin_unlock_irqrestore(&desc->lock, flags);
|
|
}
|
|
}
|
|
|
|
/**
|
|
* irq_pm_syscore_ops - enable interrupt lines early
|
|
*
|
|
* Enable all interrupt lines with %IRQF_EARLY_RESUME set.
|
|
*/
|
|
static void irq_pm_syscore_resume(void)
|
|
{
|
|
resume_irqs(true);
|
|
}
|
|
|
|
static struct syscore_ops irq_pm_syscore_ops = {
|
|
.resume = irq_pm_syscore_resume,
|
|
};
|
|
|
|
static int __init irq_pm_init_ops(void)
|
|
{
|
|
register_syscore_ops(&irq_pm_syscore_ops);
|
|
return 0;
|
|
}
|
|
|
|
device_initcall(irq_pm_init_ops);
|
|
|
|
/**
|
|
* resume_device_irqs - enable interrupt lines disabled by suspend_device_irqs()
|
|
*
|
|
* Enable all non-%IRQF_EARLY_RESUME interrupt lines previously
|
|
* disabled by suspend_device_irqs() that have the IRQS_SUSPENDED flag
|
|
* set as well as those with %IRQF_FORCE_RESUME.
|
|
*/
|
|
void resume_device_irqs(void)
|
|
{
|
|
resume_irqs(false);
|
|
}
|
|
EXPORT_SYMBOL_GPL(resume_device_irqs);
|
|
|
|
/**
|
|
* check_wakeup_irqs - check if any wake-up interrupts are pending
|
|
*/
|
|
int check_wakeup_irqs(void)
|
|
{
|
|
struct irq_desc *desc;
|
|
int irq;
|
|
|
|
for_each_irq_desc(irq, desc) {
|
|
if (irqd_is_wakeup_set(&desc->irq_data)) {
|
|
if (desc->istate & IRQS_PENDING)
|
|
return -EBUSY;
|
|
continue;
|
|
}
|
|
/*
|
|
* Check the non wakeup interrupts whether they need
|
|
* to be masked before finally going into suspend
|
|
* state. That's for hardware which has no wakeup
|
|
* source configuration facility. The chip
|
|
* implementation indicates that with
|
|
* IRQCHIP_MASK_ON_SUSPEND.
|
|
*/
|
|
if (desc->istate & IRQS_SUSPENDED &&
|
|
irq_desc_get_chip(desc)->flags & IRQCHIP_MASK_ON_SUSPEND)
|
|
mask_irq(desc);
|
|
}
|
|
|
|
return 0;
|
|
}
|