|
@@ -162,6 +162,20 @@ static inline int setup_affinity(unsigned int irq, struct irq_desc *desc)
|
|
|
}
|
|
|
#endif
|
|
|
|
|
|
+void __disable_irq(struct irq_desc *desc, unsigned int irq, bool suspend)
|
|
|
+{
|
|
|
+ if (suspend) {
|
|
|
+ if (!desc->action || (desc->action->flags & IRQF_TIMER))
|
|
|
+ return;
|
|
|
+ desc->status |= IRQ_SUSPENDED;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (!desc->depth++) {
|
|
|
+ desc->status |= IRQ_DISABLED;
|
|
|
+ desc->chip->disable(irq);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
/**
|
|
|
* disable_irq_nosync - disable an irq without waiting
|
|
|
* @irq: Interrupt to disable
|
|
@@ -182,10 +196,7 @@ void disable_irq_nosync(unsigned int irq)
|
|
|
return;
|
|
|
|
|
|
spin_lock_irqsave(&desc->lock, flags);
|
|
|
- if (!desc->depth++) {
|
|
|
- desc->status |= IRQ_DISABLED;
|
|
|
- desc->chip->disable(irq);
|
|
|
- }
|
|
|
+ __disable_irq(desc, irq, false);
|
|
|
spin_unlock_irqrestore(&desc->lock, flags);
|
|
|
}
|
|
|
EXPORT_SYMBOL(disable_irq_nosync);
|
|
@@ -215,15 +226,21 @@ void disable_irq(unsigned int irq)
|
|
|
}
|
|
|
EXPORT_SYMBOL(disable_irq);
|
|
|
|
|
|
-static void __enable_irq(struct irq_desc *desc, unsigned int irq)
|
|
|
+void __enable_irq(struct irq_desc *desc, unsigned int irq, bool resume)
|
|
|
{
|
|
|
+ if (resume)
|
|
|
+ desc->status &= ~IRQ_SUSPENDED;
|
|
|
+
|
|
|
switch (desc->depth) {
|
|
|
case 0:
|
|
|
+ err_out:
|
|
|
WARN(1, KERN_WARNING "Unbalanced enable for IRQ %d\n", irq);
|
|
|
break;
|
|
|
case 1: {
|
|
|
unsigned int status = desc->status & ~IRQ_DISABLED;
|
|
|
|
|
|
+ if (desc->status & IRQ_SUSPENDED)
|
|
|
+ goto err_out;
|
|
|
/* Prevent probing on this irq: */
|
|
|
desc->status = status | IRQ_NOPROBE;
|
|
|
check_irq_resend(desc, irq);
|
|
@@ -253,7 +270,7 @@ void enable_irq(unsigned int irq)
|
|
|
return;
|
|
|
|
|
|
spin_lock_irqsave(&desc->lock, flags);
|
|
|
- __enable_irq(desc, irq);
|
|
|
+ __enable_irq(desc, irq, false);
|
|
|
spin_unlock_irqrestore(&desc->lock, flags);
|
|
|
}
|
|
|
EXPORT_SYMBOL(enable_irq);
|
|
@@ -511,7 +528,7 @@ __setup_irq(unsigned int irq, struct irq_desc *desc, struct irqaction *new)
|
|
|
*/
|
|
|
if (shared && (desc->status & IRQ_SPURIOUS_DISABLED)) {
|
|
|
desc->status &= ~IRQ_SPURIOUS_DISABLED;
|
|
|
- __enable_irq(desc, irq);
|
|
|
+ __enable_irq(desc, irq, false);
|
|
|
}
|
|
|
|
|
|
spin_unlock_irqrestore(&desc->lock, flags);
|