pm.c 3.7 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11
/*
 * 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>
12
#include <linux/syscore_ops.h>
13 14 15

#include "internals.h"

16 17 18 19 20 21 22 23 24
static void suspend_device_irq(struct irq_desc *desc, int irq)
{
	if (!desc->action || (desc->action->flags & IRQF_NO_SUSPEND))
		return;

	desc->istate |= IRQS_SUSPENDED;
	__disable_irq(desc, irq);
}

25 26 27
/**
 * suspend_device_irqs - disable all currently enabled interrupt lines
 *
28 29 30 31 32 33 34 35
 * During system-wide suspend or hibernation device drivers need to be
 * prevented from receiving interrupts and this function is provided
 * for this purpose.
 *
 * So we disable all interrupts and mark them IRQS_SUSPENDED except
 * for those which are unused and those which are marked as not
 * suspendable via an interrupt request with the flag IRQF_NO_SUSPEND
 * set.
36 37 38 39 40 41 42 43 44
 */
void suspend_device_irqs(void)
{
	struct irq_desc *desc;
	int irq;

	for_each_irq_desc(irq, desc) {
		unsigned long flags;

45
		raw_spin_lock_irqsave(&desc->lock, flags);
46
		suspend_device_irq(desc, irq);
47
		raw_spin_unlock_irqrestore(&desc->lock, flags);
48 49 50
	}

	for_each_irq_desc(irq, desc)
51
		if (desc->istate & IRQS_SUSPENDED)
52 53 54 55
			synchronize_irq(irq);
}
EXPORT_SYMBOL_GPL(suspend_device_irqs);

56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74
static void resume_irq(struct irq_desc *desc, int irq)
{
	if (desc->istate & IRQS_SUSPENDED)
		goto resume;

	if (!desc->action)
		return;

	/* Interrupts marked with that flag are force reenabled */
	if (!(desc->action->flags & IRQF_FORCE_RESUME))
		return;

	/* Pretend that it got disabled ! */
	desc->depth++;
resume:
	desc->istate &= ~IRQS_SUSPENDED;
	__enable_irq(desc, irq);
}

75
static void resume_irqs(bool want_early)
76 77 78 79 80 81
{
	struct irq_desc *desc;
	int irq;

	for_each_irq_desc(irq, desc) {
		unsigned long flags;
82 83 84
		bool is_early = desc->action &&
			desc->action->flags & IRQF_EARLY_RESUME;

85
		if (!is_early && want_early)
86
			continue;
87

88
		raw_spin_lock_irqsave(&desc->lock, flags);
89
		resume_irq(desc, irq);
90
		raw_spin_unlock_irqrestore(&desc->lock, flags);
91 92
	}
}
93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126

/**
 * 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);
}
127 128 129 130 131 132 133 134 135 136
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;

137
	for_each_irq_desc(irq, desc) {
138 139 140 141 142
		/*
		 * Only interrupts which are marked as wakeup source
		 * and have not been disabled before the suspend check
		 * can abort suspend.
		 */
143
		if (irqd_is_wakeup_set(&desc->irq_data)) {
144
			if (desc->depth == 1 && desc->istate & IRQS_PENDING)
145 146 147 148 149 150 151 152 153 154 155 156 157 158 159
				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);
	}
160 161 162

	return 0;
}