1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Copyright (C) 2009 Rafael J. Wysocki <rjw@sisk.pl>, Novell Inc. 4 * 5 * This file contains power management functions related to interrupts. 6 */ 7 8 #include <linux/irq.h> 9 #include <linux/module.h> 10 #include <linux/interrupt.h> 11 #include <linux/suspend.h> 12 #include <linux/syscore_ops.h> 13 14 #include "internals.h" 15 16 bool irq_pm_check_wakeup(struct irq_desc *desc) 17 { 18 if (irqd_is_wakeup_armed(&desc->irq_data)) { 19 irqd_clear(&desc->irq_data, IRQD_WAKEUP_ARMED); 20 desc->istate |= IRQS_SUSPENDED | IRQS_PENDING; 21 desc->depth++; 22 irq_disable(desc); 23 pm_system_irq_wakeup(irq_desc_get_irq(desc)); 24 return true; 25 } 26 return false; 27 } 28 29 /* 30 * Called from __setup_irq() with desc->lock held after @action has 31 * been installed in the action chain. 32 */ 33 void irq_pm_install_action(struct irq_desc *desc, struct irqaction *action) 34 { 35 desc->nr_actions++; 36 37 if (action->flags & IRQF_FORCE_RESUME) 38 desc->force_resume_depth++; 39 40 WARN_ON_ONCE(desc->force_resume_depth && 41 desc->force_resume_depth != desc->nr_actions); 42 43 if (action->flags & IRQF_NO_SUSPEND) 44 desc->no_suspend_depth++; 45 else if (action->flags & IRQF_COND_SUSPEND) 46 desc->cond_suspend_depth++; 47 48 WARN_ON_ONCE(desc->no_suspend_depth && 49 (desc->no_suspend_depth + 50 desc->cond_suspend_depth) != desc->nr_actions); 51 } 52 53 /* 54 * Called from __free_irq() with desc->lock held after @action has 55 * been removed from the action chain. 56 */ 57 void irq_pm_remove_action(struct irq_desc *desc, struct irqaction *action) 58 { 59 desc->nr_actions--; 60 61 if (action->flags & IRQF_FORCE_RESUME) 62 desc->force_resume_depth--; 63 64 if (action->flags & IRQF_NO_SUSPEND) 65 desc->no_suspend_depth--; 66 else if (action->flags & IRQF_COND_SUSPEND) 67 desc->cond_suspend_depth--; 68 } 69 70 static bool suspend_device_irq(struct irq_desc *desc) 71 { 72 unsigned long chipflags = irq_desc_get_chip(desc)->flags; 73 struct irq_data *irqd = &desc->irq_data; 74 75 if (!desc->action || irq_desc_is_chained(desc) || 76 desc->no_suspend_depth) 77 return false; 78 79 if (irqd_is_wakeup_set(irqd)) { 80 irqd_set(irqd, IRQD_WAKEUP_ARMED); 81 82 if ((chipflags & IRQCHIP_ENABLE_WAKEUP_ON_SUSPEND) && 83 irqd_irq_disabled(irqd)) { 84 /* 85 * Interrupt marked for wakeup is in disabled state. 86 * Enable interrupt here to unmask/enable in irqchip 87 * to be able to resume with such interrupts. 88 */ 89 __enable_irq(desc); 90 irqd_set(irqd, IRQD_IRQ_ENABLED_ON_SUSPEND); 91 } 92 /* 93 * We return true here to force the caller to issue 94 * synchronize_irq(). We need to make sure that the 95 * IRQD_WAKEUP_ARMED is visible before we return from 96 * suspend_device_irqs(). 97 */ 98 return true; 99 } 100 101 desc->istate |= IRQS_SUSPENDED; 102 __disable_irq(desc); 103 104 /* 105 * Hardware which has no wakeup source configuration facility 106 * requires that the non wakeup interrupts are masked at the 107 * chip level. The chip implementation indicates that with 108 * IRQCHIP_MASK_ON_SUSPEND. 109 */ 110 if (chipflags & IRQCHIP_MASK_ON_SUSPEND) 111 mask_irq(desc); 112 return true; 113 } 114 115 /** 116 * suspend_device_irqs - disable all currently enabled interrupt lines 117 * 118 * During system-wide suspend or hibernation device drivers need to be 119 * prevented from receiving interrupts and this function is provided 120 * for this purpose. 121 * 122 * So we disable all interrupts and mark them IRQS_SUSPENDED except 123 * for those which are unused, those which are marked as not 124 * suspendable via an interrupt request with the flag IRQF_NO_SUSPEND 125 * set and those which are marked as active wakeup sources. 126 * 127 * The active wakeup sources are handled by the flow handler entry 128 * code which checks for the IRQD_WAKEUP_ARMED flag, suspends the 129 * interrupt and notifies the pm core about the wakeup. 130 */ 131 void suspend_device_irqs(void) 132 { 133 struct irq_desc *desc; 134 int irq; 135 136 for_each_irq_desc(irq, desc) { 137 unsigned long flags; 138 bool sync; 139 140 if (irq_settings_is_nested_thread(desc)) 141 continue; 142 raw_spin_lock_irqsave(&desc->lock, flags); 143 sync = suspend_device_irq(desc); 144 raw_spin_unlock_irqrestore(&desc->lock, flags); 145 146 if (sync) 147 synchronize_irq(irq); 148 } 149 } 150 EXPORT_SYMBOL_GPL(suspend_device_irqs); 151 152 static void resume_irq(struct irq_desc *desc) 153 { 154 struct irq_data *irqd = &desc->irq_data; 155 156 irqd_clear(irqd, IRQD_WAKEUP_ARMED); 157 158 if (irqd_is_enabled_on_suspend(irqd)) { 159 /* 160 * Interrupt marked for wakeup was enabled during suspend 161 * entry. Disable such interrupts to restore them back to 162 * original state. 163 */ 164 __disable_irq(desc); 165 irqd_clear(irqd, IRQD_IRQ_ENABLED_ON_SUSPEND); 166 } 167 168 if (desc->istate & IRQS_SUSPENDED) 169 goto resume; 170 171 /* Force resume the interrupt? */ 172 if (!desc->force_resume_depth) 173 return; 174 175 /* Pretend that it got disabled ! */ 176 desc->depth++; 177 irq_state_set_disabled(desc); 178 irq_state_set_masked(desc); 179 resume: 180 desc->istate &= ~IRQS_SUSPENDED; 181 __enable_irq(desc); 182 } 183 184 static void resume_irqs(bool want_early) 185 { 186 struct irq_desc *desc; 187 int irq; 188 189 for_each_irq_desc(irq, desc) { 190 unsigned long flags; 191 bool is_early = desc->action && 192 desc->action->flags & IRQF_EARLY_RESUME; 193 194 if (!is_early && want_early) 195 continue; 196 if (irq_settings_is_nested_thread(desc)) 197 continue; 198 199 raw_spin_lock_irqsave(&desc->lock, flags); 200 resume_irq(desc); 201 raw_spin_unlock_irqrestore(&desc->lock, flags); 202 } 203 } 204 205 /** 206 * rearm_wake_irq - rearm a wakeup interrupt line after signaling wakeup 207 * @irq: Interrupt to rearm 208 */ 209 void rearm_wake_irq(unsigned int irq) 210 { 211 unsigned long flags; 212 struct irq_desc *desc = irq_get_desc_buslock(irq, &flags, IRQ_GET_DESC_CHECK_GLOBAL); 213 214 if (!desc) 215 return; 216 217 if (!(desc->istate & IRQS_SUSPENDED) || 218 !irqd_is_wakeup_set(&desc->irq_data)) 219 goto unlock; 220 221 desc->istate &= ~IRQS_SUSPENDED; 222 irqd_set(&desc->irq_data, IRQD_WAKEUP_ARMED); 223 __enable_irq(desc); 224 225 unlock: 226 irq_put_desc_busunlock(desc, flags); 227 } 228 229 /** 230 * irq_pm_syscore_resume - enable interrupt lines early 231 * 232 * Enable all interrupt lines with %IRQF_EARLY_RESUME set. 233 */ 234 static void irq_pm_syscore_resume(void) 235 { 236 resume_irqs(true); 237 } 238 239 static struct syscore_ops irq_pm_syscore_ops = { 240 .resume = irq_pm_syscore_resume, 241 }; 242 243 static int __init irq_pm_init_ops(void) 244 { 245 register_syscore_ops(&irq_pm_syscore_ops); 246 return 0; 247 } 248 249 device_initcall(irq_pm_init_ops); 250 251 /** 252 * resume_device_irqs - enable interrupt lines disabled by suspend_device_irqs() 253 * 254 * Enable all non-%IRQF_EARLY_RESUME interrupt lines previously 255 * disabled by suspend_device_irqs() that have the IRQS_SUSPENDED flag 256 * set as well as those with %IRQF_FORCE_RESUME. 257 */ 258 void resume_device_irqs(void) 259 { 260 resume_irqs(false); 261 } 262 EXPORT_SYMBOL_GPL(resume_device_irqs); 263