1
2
3
4
5
6
7
8
9
10#include <linux/delay.h>
11#include <linux/init.h>
12#include <linux/pci.h>
13#include <linux/module.h>
14#include <linux/pci-aspm.h>
15#include <acpi/acpi.h>
16#include <acpi/acpi_bus.h>
17
18#include <linux/pci-acpi.h>
19#include <linux/pm_runtime.h>
20#include "pci.h"
21
22static DEFINE_MUTEX(pci_acpi_pm_notify_mtx);
23
24
25
26
27
28
29
30static void pci_acpi_wake_bus(acpi_handle handle, u32 event, void *context)
31{
32 struct pci_bus *pci_bus = context;
33
34 if (event == ACPI_NOTIFY_DEVICE_WAKE && pci_bus)
35 pci_pme_wakeup_bus(pci_bus);
36}
37
38
39
40
41
42
43
44static void pci_acpi_wake_dev(acpi_handle handle, u32 event, void *context)
45{
46 struct pci_dev *pci_dev = context;
47
48 if (event == ACPI_NOTIFY_DEVICE_WAKE && pci_dev) {
49 pci_wakeup_event(pci_dev);
50 pci_check_pme_status(pci_dev);
51 pm_runtime_resume(&pci_dev->dev);
52 if (pci_dev->subordinate)
53 pci_pme_wakeup_bus(pci_dev->subordinate);
54 }
55}
56
57
58
59
60
61
62
63
64
65
66
67static acpi_status add_pm_notifier(struct acpi_device *dev,
68 acpi_notify_handler handler,
69 void *context)
70{
71 acpi_status status = AE_ALREADY_EXISTS;
72
73 mutex_lock(&pci_acpi_pm_notify_mtx);
74
75 if (dev->wakeup.flags.notifier_present)
76 goto out;
77
78 status = acpi_install_notify_handler(dev->handle,
79 ACPI_SYSTEM_NOTIFY,
80 handler, context);
81 if (ACPI_FAILURE(status))
82 goto out;
83
84 dev->wakeup.flags.notifier_present = true;
85
86 out:
87 mutex_unlock(&pci_acpi_pm_notify_mtx);
88 return status;
89}
90
91
92
93
94
95static acpi_status remove_pm_notifier(struct acpi_device *dev,
96 acpi_notify_handler handler)
97{
98 acpi_status status = AE_BAD_PARAMETER;
99
100 mutex_lock(&pci_acpi_pm_notify_mtx);
101
102 if (!dev->wakeup.flags.notifier_present)
103 goto out;
104
105 status = acpi_remove_notify_handler(dev->handle,
106 ACPI_SYSTEM_NOTIFY,
107 handler);
108 if (ACPI_FAILURE(status))
109 goto out;
110
111 dev->wakeup.flags.notifier_present = false;
112
113 out:
114 mutex_unlock(&pci_acpi_pm_notify_mtx);
115 return status;
116}
117
118
119
120
121
122
123acpi_status pci_acpi_add_bus_pm_notifier(struct acpi_device *dev,
124 struct pci_bus *pci_bus)
125{
126 return add_pm_notifier(dev, pci_acpi_wake_bus, pci_bus);
127}
128
129
130
131
132
133acpi_status pci_acpi_remove_bus_pm_notifier(struct acpi_device *dev)
134{
135 return remove_pm_notifier(dev, pci_acpi_wake_bus);
136}
137
138
139
140
141
142
143acpi_status pci_acpi_add_pm_notifier(struct acpi_device *dev,
144 struct pci_dev *pci_dev)
145{
146 return add_pm_notifier(dev, pci_acpi_wake_dev, pci_dev);
147}
148
149
150
151
152
153acpi_status pci_acpi_remove_pm_notifier(struct acpi_device *dev)
154{
155 return remove_pm_notifier(dev, pci_acpi_wake_dev);
156}
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181static pci_power_t acpi_pci_choose_state(struct pci_dev *pdev)
182{
183 int acpi_state;
184
185 acpi_state = acpi_pm_device_sleep_state(&pdev->dev, NULL);
186 if (acpi_state < 0)
187 return PCI_POWER_ERROR;
188
189 switch (acpi_state) {
190 case ACPI_STATE_D0:
191 return PCI_D0;
192 case ACPI_STATE_D1:
193 return PCI_D1;
194 case ACPI_STATE_D2:
195 return PCI_D2;
196 case ACPI_STATE_D3:
197 return PCI_D3hot;
198 }
199 return PCI_POWER_ERROR;
200}
201
202static bool acpi_pci_power_manageable(struct pci_dev *dev)
203{
204 acpi_handle handle = DEVICE_ACPI_HANDLE(&dev->dev);
205
206 return handle ? acpi_bus_power_manageable(handle) : false;
207}
208
209static int acpi_pci_set_power_state(struct pci_dev *dev, pci_power_t state)
210{
211 acpi_handle handle = DEVICE_ACPI_HANDLE(&dev->dev);
212 acpi_handle tmp;
213 static const u8 state_conv[] = {
214 [PCI_D0] = ACPI_STATE_D0,
215 [PCI_D1] = ACPI_STATE_D1,
216 [PCI_D2] = ACPI_STATE_D2,
217 [PCI_D3hot] = ACPI_STATE_D3,
218 [PCI_D3cold] = ACPI_STATE_D3
219 };
220 int error = -EINVAL;
221
222
223 if (!handle || ACPI_SUCCESS(acpi_get_handle(handle, "_EJ0", &tmp)))
224 return -ENODEV;
225
226 switch (state) {
227 case PCI_D0:
228 case PCI_D1:
229 case PCI_D2:
230 case PCI_D3hot:
231 case PCI_D3cold:
232 error = acpi_bus_set_power(handle, state_conv[state]);
233 }
234
235 if (!error)
236 dev_printk(KERN_INFO, &dev->dev,
237 "power state changed by ACPI to D%d\n", state);
238
239 return error;
240}
241
242static bool acpi_pci_can_wakeup(struct pci_dev *dev)
243{
244 acpi_handle handle = DEVICE_ACPI_HANDLE(&dev->dev);
245
246 return handle ? acpi_bus_can_wakeup(handle) : false;
247}
248
249static void acpi_pci_propagate_wakeup_enable(struct pci_bus *bus, bool enable)
250{
251 while (bus->parent) {
252 if (!acpi_pm_device_sleep_wake(&bus->self->dev, enable))
253 return;
254 bus = bus->parent;
255 }
256
257
258 if (bus->bridge)
259 acpi_pm_device_sleep_wake(bus->bridge, enable);
260}
261
262static int acpi_pci_sleep_wake(struct pci_dev *dev, bool enable)
263{
264 if (acpi_pci_can_wakeup(dev))
265 return acpi_pm_device_sleep_wake(&dev->dev, enable);
266
267 acpi_pci_propagate_wakeup_enable(dev->bus, enable);
268 return 0;
269}
270
271
272
273
274
275
276
277
278
279static int acpi_dev_run_wake(struct device *phys_dev, bool enable)
280{
281 struct acpi_device *dev;
282 acpi_handle handle;
283 int error = -ENODEV;
284
285 if (!device_run_wake(phys_dev))
286 return -EINVAL;
287
288 handle = DEVICE_ACPI_HANDLE(phys_dev);
289 if (!handle || ACPI_FAILURE(acpi_bus_get_device(handle, &dev))) {
290 dev_dbg(phys_dev, "ACPI handle has no context in %s!\n",
291 __func__);
292 return -ENODEV;
293 }
294
295 if (enable) {
296 if (!dev->wakeup.run_wake_count++) {
297 acpi_enable_wakeup_device_power(dev, ACPI_STATE_S0);
298 acpi_enable_gpe(dev->wakeup.gpe_device,
299 dev->wakeup.gpe_number);
300 }
301 } else if (dev->wakeup.run_wake_count > 0) {
302 if (!--dev->wakeup.run_wake_count) {
303 acpi_disable_gpe(dev->wakeup.gpe_device,
304 dev->wakeup.gpe_number);
305 acpi_disable_wakeup_device_power(dev);
306 }
307 } else {
308 error = -EALREADY;
309 }
310
311 return error;
312}
313
314static void acpi_pci_propagate_run_wake(struct pci_bus *bus, bool enable)
315{
316 while (bus->parent) {
317 struct pci_dev *bridge = bus->self;
318
319 if (bridge->pme_interrupt)
320 return;
321 if (!acpi_dev_run_wake(&bridge->dev, enable))
322 return;
323 bus = bus->parent;
324 }
325
326
327 if (bus->bridge)
328 acpi_dev_run_wake(bus->bridge, enable);
329}
330
331static int acpi_pci_run_wake(struct pci_dev *dev, bool enable)
332{
333 if (dev->pme_interrupt)
334 return 0;
335
336 if (!acpi_dev_run_wake(&dev->dev, enable))
337 return 0;
338
339 acpi_pci_propagate_run_wake(dev->bus, enable);
340 return 0;
341}
342
343static struct pci_platform_pm_ops acpi_pci_platform_pm = {
344 .is_manageable = acpi_pci_power_manageable,
345 .set_state = acpi_pci_set_power_state,
346 .choose_state = acpi_pci_choose_state,
347 .can_wakeup = acpi_pci_can_wakeup,
348 .sleep_wake = acpi_pci_sleep_wake,
349 .run_wake = acpi_pci_run_wake,
350};
351
352
353static int acpi_pci_find_device(struct device *dev, acpi_handle *handle)
354{
355 struct pci_dev * pci_dev;
356 u64 addr;
357
358 pci_dev = to_pci_dev(dev);
359
360 addr = (PCI_SLOT(pci_dev->devfn) << 16) | PCI_FUNC(pci_dev->devfn);
361 *handle = acpi_get_child(DEVICE_ACPI_HANDLE(dev->parent), addr);
362 if (!*handle)
363 return -ENODEV;
364 return 0;
365}
366
367static int acpi_pci_find_root_bridge(struct device *dev, acpi_handle *handle)
368{
369 int num;
370 unsigned int seg, bus;
371
372
373
374
375
376 num = sscanf(dev_name(dev), "pci%04x:%02x", &seg, &bus);
377 if (num != 2)
378 return -ENODEV;
379 *handle = acpi_get_pci_rootbridge_handle(seg, bus);
380 if (!*handle)
381 return -ENODEV;
382 return 0;
383}
384
385static struct acpi_bus_type acpi_pci_bus = {
386 .bus = &pci_bus_type,
387 .find_device = acpi_pci_find_device,
388 .find_bridge = acpi_pci_find_root_bridge,
389};
390
391static int __init acpi_pci_init(void)
392{
393 int ret;
394
395 if (acpi_gbl_FADT.boot_flags & ACPI_FADT_NO_MSI) {
396 printk(KERN_INFO"ACPI FADT declares the system doesn't support MSI, so disable it\n");
397 pci_no_msi();
398 }
399
400 if (acpi_gbl_FADT.boot_flags & ACPI_FADT_NO_ASPM) {
401 printk(KERN_INFO"ACPI FADT declares the system doesn't support PCIe ASPM, so disable it\n");
402 pcie_clear_aspm();
403 pcie_no_aspm();
404 }
405
406 ret = register_acpi_bus_type(&acpi_pci_bus);
407 if (ret)
408 return 0;
409 pci_set_platform_pm(&acpi_pci_platform_pm);
410 return 0;
411}
412arch_initcall(acpi_pci_init);
413