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