1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30#include <linux/module.h>
31#include <linux/moduleparam.h>
32#include <linux/kernel.h>
33#include <linux/types.h>
34#include <linux/pci.h>
35#include "pciehp.h"
36#include <linux/interrupt.h>
37#include <linux/time.h>
38
39
40int pciehp_debug;
41int pciehp_poll_mode;
42int pciehp_poll_time;
43int pciehp_force;
44struct workqueue_struct *pciehp_wq;
45
46#define DRIVER_VERSION "0.4"
47#define DRIVER_AUTHOR "Dan Zink <dan.zink@compaq.com>, Greg Kroah-Hartman <greg@kroah.com>, Dely Sy <dely.l.sy@intel.com>"
48#define DRIVER_DESC "PCI Express Hot Plug Controller Driver"
49
50MODULE_AUTHOR(DRIVER_AUTHOR);
51MODULE_DESCRIPTION(DRIVER_DESC);
52MODULE_LICENSE("GPL");
53
54module_param(pciehp_debug, bool, 0644);
55module_param(pciehp_poll_mode, bool, 0644);
56module_param(pciehp_poll_time, int, 0644);
57module_param(pciehp_force, bool, 0644);
58MODULE_PARM_DESC(pciehp_debug, "Debugging mode enabled or not");
59MODULE_PARM_DESC(pciehp_poll_mode, "Using polling mechanism for hot-plug events or not");
60MODULE_PARM_DESC(pciehp_poll_time, "Polling mechanism frequency, in seconds");
61MODULE_PARM_DESC(pciehp_force, "Force pciehp, even if _OSC and OSHP are missing");
62
63#define PCIE_MODULE_NAME "pciehp"
64
65static int set_attention_status (struct hotplug_slot *slot, u8 value);
66static int enable_slot (struct hotplug_slot *slot);
67static int disable_slot (struct hotplug_slot *slot);
68static int get_power_status (struct hotplug_slot *slot, u8 *value);
69static int get_attention_status (struct hotplug_slot *slot, u8 *value);
70static int get_latch_status (struct hotplug_slot *slot, u8 *value);
71static int get_adapter_status (struct hotplug_slot *slot, u8 *value);
72static int get_max_bus_speed (struct hotplug_slot *slot, enum pci_bus_speed *value);
73static int get_cur_bus_speed (struct hotplug_slot *slot, enum pci_bus_speed *value);
74
75static struct hotplug_slot_ops pciehp_hotplug_slot_ops = {
76 .set_attention_status = set_attention_status,
77 .enable_slot = enable_slot,
78 .disable_slot = disable_slot,
79 .get_power_status = get_power_status,
80 .get_attention_status = get_attention_status,
81 .get_latch_status = get_latch_status,
82 .get_adapter_status = get_adapter_status,
83 .get_max_bus_speed = get_max_bus_speed,
84 .get_cur_bus_speed = get_cur_bus_speed,
85};
86
87
88
89
90
91static void release_slot(struct hotplug_slot *hotplug_slot)
92{
93 struct slot *slot = hotplug_slot->private;
94
95 ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
96 __func__, hotplug_slot_name(hotplug_slot));
97
98 kfree(hotplug_slot->info);
99 kfree(hotplug_slot);
100}
101
102static int init_slot(struct controller *ctrl)
103{
104 struct slot *slot = ctrl->slot;
105 struct hotplug_slot *hotplug = NULL;
106 struct hotplug_slot_info *info = NULL;
107 char name[SLOT_NAME_SIZE];
108 int retval = -ENOMEM;
109
110 hotplug = kzalloc(sizeof(*hotplug), GFP_KERNEL);
111 if (!hotplug)
112 goto out;
113
114 info = kzalloc(sizeof(*info), GFP_KERNEL);
115 if (!info)
116 goto out;
117
118
119 hotplug->info = info;
120 hotplug->private = slot;
121 hotplug->release = &release_slot;
122 hotplug->ops = &pciehp_hotplug_slot_ops;
123 slot->hotplug_slot = hotplug;
124 snprintf(name, SLOT_NAME_SIZE, "%u", PSN(ctrl));
125
126 ctrl_dbg(ctrl, "Registering domain:bus:dev=%04x:%02x:00 sun=%x\n",
127 pci_domain_nr(ctrl->pcie->port->subordinate),
128 ctrl->pcie->port->subordinate->number, PSN(ctrl));
129 retval = pci_hp_register(hotplug,
130 ctrl->pcie->port->subordinate, 0, name);
131 if (retval) {
132 ctrl_err(ctrl,
133 "pci_hp_register failed with error %d\n", retval);
134 goto out;
135 }
136 get_power_status(hotplug, &info->power_status);
137 get_attention_status(hotplug, &info->attention_status);
138 get_latch_status(hotplug, &info->latch_status);
139 get_adapter_status(hotplug, &info->adapter_status);
140out:
141 if (retval) {
142 kfree(info);
143 kfree(hotplug);
144 }
145 return retval;
146}
147
148static void cleanup_slot(struct controller *ctrl)
149{
150 pci_hp_deregister(ctrl->slot->hotplug_slot);
151}
152
153
154
155
156static int set_attention_status(struct hotplug_slot *hotplug_slot, u8 status)
157{
158 struct slot *slot = hotplug_slot->private;
159
160 ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
161 __func__, slot_name(slot));
162
163 hotplug_slot->info->attention_status = status;
164
165 if (ATTN_LED(slot->ctrl))
166 pciehp_set_attention_status(slot, status);
167
168 return 0;
169}
170
171
172static int enable_slot(struct hotplug_slot *hotplug_slot)
173{
174 struct slot *slot = hotplug_slot->private;
175
176 ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
177 __func__, slot_name(slot));
178
179 return pciehp_sysfs_enable_slot(slot);
180}
181
182
183static int disable_slot(struct hotplug_slot *hotplug_slot)
184{
185 struct slot *slot = hotplug_slot->private;
186
187 ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
188 __func__, slot_name(slot));
189
190 return pciehp_sysfs_disable_slot(slot);
191}
192
193static int get_power_status(struct hotplug_slot *hotplug_slot, u8 *value)
194{
195 struct slot *slot = hotplug_slot->private;
196 int retval;
197
198 ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
199 __func__, slot_name(slot));
200
201 retval = pciehp_get_power_status(slot, value);
202 if (retval < 0)
203 *value = hotplug_slot->info->power_status;
204
205 return 0;
206}
207
208static int get_attention_status(struct hotplug_slot *hotplug_slot, u8 *value)
209{
210 struct slot *slot = hotplug_slot->private;
211 int retval;
212
213 ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
214 __func__, slot_name(slot));
215
216 retval = pciehp_get_attention_status(slot, value);
217 if (retval < 0)
218 *value = hotplug_slot->info->attention_status;
219
220 return 0;
221}
222
223static int get_latch_status(struct hotplug_slot *hotplug_slot, u8 *value)
224{
225 struct slot *slot = hotplug_slot->private;
226 int retval;
227
228 ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
229 __func__, slot_name(slot));
230
231 retval = pciehp_get_latch_status(slot, value);
232 if (retval < 0)
233 *value = hotplug_slot->info->latch_status;
234
235 return 0;
236}
237
238static int get_adapter_status(struct hotplug_slot *hotplug_slot, u8 *value)
239{
240 struct slot *slot = hotplug_slot->private;
241 int retval;
242
243 ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
244 __func__, slot_name(slot));
245
246 retval = pciehp_get_adapter_status(slot, value);
247 if (retval < 0)
248 *value = hotplug_slot->info->adapter_status;
249
250 return 0;
251}
252
253static int get_max_bus_speed(struct hotplug_slot *hotplug_slot,
254 enum pci_bus_speed *value)
255{
256 struct slot *slot = hotplug_slot->private;
257 int retval;
258
259 ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
260 __func__, slot_name(slot));
261
262 retval = pciehp_get_max_link_speed(slot, value);
263 if (retval < 0)
264 *value = PCI_SPEED_UNKNOWN;
265
266 return 0;
267}
268
269static int get_cur_bus_speed(struct hotplug_slot *hotplug_slot, enum pci_bus_speed *value)
270{
271 struct slot *slot = hotplug_slot->private;
272 int retval;
273
274 ctrl_dbg(slot->ctrl, "%s: physical_slot = %s\n",
275 __func__, slot_name(slot));
276
277 retval = pciehp_get_cur_link_speed(slot, value);
278 if (retval < 0)
279 *value = PCI_SPEED_UNKNOWN;
280
281 return 0;
282}
283
284static int pciehp_probe(struct pcie_device *dev)
285{
286 int rc;
287 struct controller *ctrl;
288 struct slot *slot;
289 u8 value;
290 struct pci_dev *pdev = dev->port;
291
292 if (pciehp_force)
293 dev_info(&dev->device,
294 "Bypassing BIOS check for pciehp use on %s\n",
295 pci_name(pdev));
296 else if (pciehp_get_hp_hw_control_from_firmware(pdev))
297 goto err_out_none;
298
299 ctrl = pcie_init(dev);
300 if (!ctrl) {
301 dev_err(&dev->device, "Controller initialization failed\n");
302 goto err_out_none;
303 }
304 set_service_data(dev, ctrl);
305
306
307 rc = init_slot(ctrl);
308 if (rc) {
309 if (rc == -EBUSY)
310 ctrl_warn(ctrl, "Slot already registered by another "
311 "hotplug driver\n");
312 else
313 ctrl_err(ctrl, "Slot initialization failed\n");
314 goto err_out_release_ctlr;
315 }
316
317
318 rc = pcie_init_notification(ctrl);
319 if (rc) {
320 ctrl_err(ctrl, "Notification initialization failed\n");
321 goto err_out_release_ctlr;
322 }
323
324
325 slot = ctrl->slot;
326 pciehp_get_adapter_status(slot, &value);
327 if (value) {
328 if (pciehp_force)
329 pciehp_enable_slot(slot);
330 } else {
331
332 if (POWER_CTRL(ctrl)) {
333 rc = pciehp_power_off_slot(slot);
334 if (rc)
335 goto err_out_free_ctrl_slot;
336 }
337 }
338
339 return 0;
340
341err_out_free_ctrl_slot:
342 cleanup_slot(ctrl);
343err_out_release_ctlr:
344 pciehp_release_ctrl(ctrl);
345err_out_none:
346 return -ENODEV;
347}
348
349static void pciehp_remove(struct pcie_device *dev)
350{
351 struct controller *ctrl = get_service_data(dev);
352
353 cleanup_slot(ctrl);
354 pciehp_release_ctrl(ctrl);
355}
356
357#ifdef CONFIG_PM
358static int pciehp_suspend (struct pcie_device *dev)
359{
360 dev_info(&dev->device, "%s ENTRY\n", __func__);
361 return 0;
362}
363
364static int pciehp_resume (struct pcie_device *dev)
365{
366 dev_info(&dev->device, "%s ENTRY\n", __func__);
367 if (pciehp_force) {
368 struct controller *ctrl = get_service_data(dev);
369 struct slot *slot;
370 u8 status;
371
372
373 pcie_enable_notification(ctrl);
374
375 slot = ctrl->slot;
376
377
378 pciehp_get_adapter_status(slot, &status);
379 if (status)
380 pciehp_enable_slot(slot);
381 else
382 pciehp_disable_slot(slot);
383 }
384 return 0;
385}
386#endif
387
388static struct pcie_port_service_driver hpdriver_portdrv = {
389 .name = PCIE_MODULE_NAME,
390 .port_type = PCIE_ANY_PORT,
391 .service = PCIE_PORT_SERVICE_HP,
392
393 .probe = pciehp_probe,
394 .remove = pciehp_remove,
395
396#ifdef CONFIG_PM
397 .suspend = pciehp_suspend,
398 .resume = pciehp_resume,
399#endif
400};
401
402static int __init pcied_init(void)
403{
404 int retval = 0;
405
406 pciehp_firmware_init();
407 retval = pcie_port_service_register(&hpdriver_portdrv);
408 dbg("pcie_port_service_register = %d\n", retval);
409 info(DRIVER_DESC " version: " DRIVER_VERSION "\n");
410 if (retval)
411 dbg("Failure to register service\n");
412 return retval;
413}
414
415static void __exit pcied_cleanup(void)
416{
417 dbg("unload_pciehpd()\n");
418 pcie_port_service_unregister(&hpdriver_portdrv);
419 info(DRIVER_DESC " version: " DRIVER_VERSION " unloaded\n");
420}
421
422module_init(pcied_init);
423module_exit(pcied_cleanup);
424