1
2
3
4
5
6
7
8
9
10#include <linux/pci.h>
11#include <linux/kernel.h>
12#include <linux/errno.h>
13#include <linux/pm.h>
14#include <linux/pm_runtime.h>
15#include <linux/init.h>
16#include <linux/aer.h>
17#include <linux/dmi.h>
18
19#include "../pci.h"
20#include "portdrv.h"
21
22
23bool pcie_ports_disabled;
24
25
26
27
28
29
30bool pcie_ports_native;
31
32
33
34
35
36bool pcie_ports_dpc_native;
37
38static int __init pcie_port_setup(char *str)
39{
40 if (!strncmp(str, "compat", 6))
41 pcie_ports_disabled = true;
42 else if (!strncmp(str, "native", 6))
43 pcie_ports_native = true;
44 else if (!strncmp(str, "dpc-native", 10))
45 pcie_ports_dpc_native = true;
46
47 return 1;
48}
49__setup("pcie_ports=", pcie_port_setup);
50
51
52
53#ifdef CONFIG_PM
54static int pcie_port_runtime_suspend(struct device *dev)
55{
56 if (!to_pci_dev(dev)->bridge_d3)
57 return -EBUSY;
58
59 return pcie_port_device_runtime_suspend(dev);
60}
61
62static int pcie_port_runtime_idle(struct device *dev)
63{
64
65
66
67
68
69 return to_pci_dev(dev)->bridge_d3 ? 0 : -EBUSY;
70}
71
72static const struct dev_pm_ops pcie_portdrv_pm_ops = {
73 .suspend = pcie_port_device_suspend,
74 .resume_noirq = pcie_port_device_resume_noirq,
75 .resume = pcie_port_device_resume,
76 .freeze = pcie_port_device_suspend,
77 .thaw = pcie_port_device_resume,
78 .poweroff = pcie_port_device_suspend,
79 .restore_noirq = pcie_port_device_resume_noirq,
80 .restore = pcie_port_device_resume,
81 .runtime_suspend = pcie_port_runtime_suspend,
82 .runtime_resume = pcie_port_device_runtime_resume,
83 .runtime_idle = pcie_port_runtime_idle,
84};
85
86#define PCIE_PORTDRV_PM_OPS (&pcie_portdrv_pm_ops)
87
88#else
89
90#define PCIE_PORTDRV_PM_OPS NULL
91#endif
92
93
94
95
96
97
98
99
100
101static int pcie_portdrv_probe(struct pci_dev *dev,
102 const struct pci_device_id *id)
103{
104 int type = pci_pcie_type(dev);
105 int status;
106
107 if (!pci_is_pcie(dev) ||
108 ((type != PCI_EXP_TYPE_ROOT_PORT) &&
109 (type != PCI_EXP_TYPE_UPSTREAM) &&
110 (type != PCI_EXP_TYPE_DOWNSTREAM) &&
111 (type != PCI_EXP_TYPE_RC_EC)))
112 return -ENODEV;
113
114 if (type == PCI_EXP_TYPE_RC_EC)
115 pcie_link_rcec(dev);
116
117 status = pcie_port_device_register(dev);
118 if (status)
119 return status;
120
121 pci_save_state(dev);
122
123 dev_pm_set_driver_flags(&dev->dev, DPM_FLAG_NO_DIRECT_COMPLETE |
124 DPM_FLAG_SMART_SUSPEND);
125
126 if (pci_bridge_d3_possible(dev)) {
127
128
129
130
131
132 pm_runtime_set_autosuspend_delay(&dev->dev, 100);
133 pm_runtime_use_autosuspend(&dev->dev);
134 pm_runtime_mark_last_busy(&dev->dev);
135 pm_runtime_put_autosuspend(&dev->dev);
136 pm_runtime_allow(&dev->dev);
137 }
138
139 return 0;
140}
141
142static void pcie_portdrv_remove(struct pci_dev *dev)
143{
144 if (pci_bridge_d3_possible(dev)) {
145 pm_runtime_forbid(&dev->dev);
146 pm_runtime_get_noresume(&dev->dev);
147 pm_runtime_dont_use_autosuspend(&dev->dev);
148 }
149
150 pcie_port_device_remove(dev);
151}
152
153static pci_ers_result_t pcie_portdrv_error_detected(struct pci_dev *dev,
154 pci_channel_state_t error)
155{
156 if (error == pci_channel_io_frozen)
157 return PCI_ERS_RESULT_NEED_RESET;
158 return PCI_ERS_RESULT_CAN_RECOVER;
159}
160
161static pci_ers_result_t pcie_portdrv_slot_reset(struct pci_dev *dev)
162{
163 size_t off = offsetof(struct pcie_port_service_driver, slot_reset);
164 device_for_each_child(&dev->dev, &off, pcie_port_device_iter);
165
166 pci_restore_state(dev);
167 pci_save_state(dev);
168 return PCI_ERS_RESULT_RECOVERED;
169}
170
171static pci_ers_result_t pcie_portdrv_mmio_enabled(struct pci_dev *dev)
172{
173 return PCI_ERS_RESULT_RECOVERED;
174}
175
176
177
178
179static const struct pci_device_id port_pci_ids[] = {
180
181 { PCI_DEVICE_CLASS(PCI_CLASS_BRIDGE_PCI_NORMAL, ~0) },
182
183 { PCI_DEVICE_CLASS(PCI_CLASS_BRIDGE_PCI_SUBTRACTIVE, ~0) },
184
185 { PCI_DEVICE_CLASS(((PCI_CLASS_SYSTEM_RCEC << 8) | 0x00), ~0) },
186 { },
187};
188
189static const struct pci_error_handlers pcie_portdrv_err_handler = {
190 .error_detected = pcie_portdrv_error_detected,
191 .slot_reset = pcie_portdrv_slot_reset,
192 .mmio_enabled = pcie_portdrv_mmio_enabled,
193};
194
195static struct pci_driver pcie_portdriver = {
196 .name = "pcieport",
197 .id_table = &port_pci_ids[0],
198
199 .probe = pcie_portdrv_probe,
200 .remove = pcie_portdrv_remove,
201 .shutdown = pcie_portdrv_remove,
202
203 .err_handler = &pcie_portdrv_err_handler,
204
205 .driver_managed_dma = true,
206
207 .driver.pm = PCIE_PORTDRV_PM_OPS,
208};
209
210static int __init dmi_pcie_pme_disable_msi(const struct dmi_system_id *d)
211{
212 pr_notice("%s detected: will not use MSI for PCIe PME signaling\n",
213 d->ident);
214 pcie_pme_disable_msi();
215 return 0;
216}
217
218static const struct dmi_system_id pcie_portdrv_dmi_table[] __initconst = {
219
220
221
222 {
223 .callback = dmi_pcie_pme_disable_msi,
224 .ident = "MSI Wind U-100",
225 .matches = {
226 DMI_MATCH(DMI_SYS_VENDOR,
227 "MICRO-STAR INTERNATIONAL CO., LTD"),
228 DMI_MATCH(DMI_PRODUCT_NAME, "U-100"),
229 },
230 },
231 {}
232};
233
234static void __init pcie_init_services(void)
235{
236 pcie_aer_init();
237 pcie_pme_init();
238 pcie_dpc_init();
239 pcie_hp_init();
240}
241
242static int __init pcie_portdrv_init(void)
243{
244 if (pcie_ports_disabled)
245 return -EACCES;
246
247 pcie_init_services();
248 dmi_check_system(pcie_portdrv_dmi_table);
249
250 return pci_register_driver(&pcie_portdriver);
251}
252device_initcall(pcie_portdrv_init);
253