3 * Purpose: PCI Express Port Bus Driver
5 * Copyright (C) 2004 Intel
6 * Copyright (C) Tom Long Nguyen (tom.l.nguyen@intel.com)
9 #include <linux/module.h>
10 #include <linux/pci.h>
11 #include <linux/kernel.h>
12 #include <linux/errno.h>
14 #include <linux/init.h>
15 #include <linux/slab.h>
16 #include <linux/pcieport_if.h>
17 #include <linux/aer.h>
20 #include "aer/aerdrv.h"
25 #define DRIVER_VERSION "v1.0"
26 #define DRIVER_AUTHOR "tom.l.nguyen@intel.com"
27 #define DRIVER_DESC "PCIE Port Bus Driver"
28 MODULE_AUTHOR(DRIVER_AUTHOR
);
29 MODULE_DESCRIPTION(DRIVER_DESC
);
30 MODULE_LICENSE("GPL");
33 static const char device_name
[] = "pcieport-driver";
35 static int pcie_portdrv_save_config(struct pci_dev
*dev
)
37 return pci_save_state(dev
);
40 static int pcie_portdrv_restore_config(struct pci_dev
*dev
)
44 retval
= pci_enable_device(dev
);
52 static int pcie_portdrv_suspend(struct pci_dev
*dev
, pm_message_t state
)
54 return pcie_port_device_suspend(dev
, state
);
58 static int pcie_portdrv_resume(struct pci_dev
*dev
)
61 return pcie_port_device_resume(dev
);
64 #define pcie_portdrv_suspend NULL
65 #define pcie_portdrv_resume NULL
69 * pcie_portdrv_probe - Probe PCI-Express port devices
70 * @dev: PCI-Express port device being probed
72 * If detected invokes the pcie_port_device_register() method for
76 static int __devinit
pcie_portdrv_probe (struct pci_dev
*dev
,
77 const struct pci_device_id
*id
)
81 status
= pcie_port_device_probe(dev
);
85 if (pci_enable_device(dev
) < 0)
89 if (!dev
->irq
&& dev
->pin
) {
90 dev_warn(&dev
->dev
, "device [%04x:%04x] has invalid IRQ; "
91 "check vendor BIOS\n", dev
->vendor
, dev
->device
);
93 if (pcie_port_device_register(dev
)) {
94 pci_disable_device(dev
);
98 pcie_portdrv_save_config(dev
);
100 pci_enable_pcie_error_reporting(dev
);
105 static void pcie_portdrv_remove (struct pci_dev
*dev
)
107 pcie_port_device_remove(dev
);
108 kfree(pci_get_drvdata(dev
));
111 static int error_detected_iter(struct device
*device
, void *data
)
113 struct pcie_device
*pcie_device
;
114 struct pcie_port_service_driver
*driver
;
115 struct aer_broadcast_data
*result_data
;
116 pci_ers_result_t status
;
118 result_data
= (struct aer_broadcast_data
*) data
;
120 if (device
->bus
== &pcie_port_bus_type
&& device
->driver
) {
121 driver
= to_service_driver(device
->driver
);
123 !driver
->err_handler
||
124 !driver
->err_handler
->error_detected
)
127 pcie_device
= to_pcie_device(device
);
129 /* Forward error detected message to service drivers */
130 status
= driver
->err_handler
->error_detected(
133 result_data
->result
=
134 merge_result(result_data
->result
, status
);
140 static pci_ers_result_t
pcie_portdrv_error_detected(struct pci_dev
*dev
,
141 enum pci_channel_state error
)
143 struct aer_broadcast_data result_data
=
144 {error
, PCI_ERS_RESULT_CAN_RECOVER
};
148 retval
= device_for_each_child(&dev
->dev
, &result_data
, error_detected_iter
);
150 return result_data
.result
;
153 static int mmio_enabled_iter(struct device
*device
, void *data
)
155 struct pcie_device
*pcie_device
;
156 struct pcie_port_service_driver
*driver
;
157 pci_ers_result_t status
, *result
;
159 result
= (pci_ers_result_t
*) data
;
161 if (device
->bus
== &pcie_port_bus_type
&& device
->driver
) {
162 driver
= to_service_driver(device
->driver
);
164 driver
->err_handler
&&
165 driver
->err_handler
->mmio_enabled
) {
166 pcie_device
= to_pcie_device(device
);
168 /* Forward error message to service drivers */
169 status
= driver
->err_handler
->mmio_enabled(
171 *result
= merge_result(*result
, status
);
178 static pci_ers_result_t
pcie_portdrv_mmio_enabled(struct pci_dev
*dev
)
180 pci_ers_result_t status
= PCI_ERS_RESULT_RECOVERED
;
183 /* get true return value from &status */
184 retval
= device_for_each_child(&dev
->dev
, &status
, mmio_enabled_iter
);
188 static int slot_reset_iter(struct device
*device
, void *data
)
190 struct pcie_device
*pcie_device
;
191 struct pcie_port_service_driver
*driver
;
192 pci_ers_result_t status
, *result
;
194 result
= (pci_ers_result_t
*) data
;
196 if (device
->bus
== &pcie_port_bus_type
&& device
->driver
) {
197 driver
= to_service_driver(device
->driver
);
199 driver
->err_handler
&&
200 driver
->err_handler
->slot_reset
) {
201 pcie_device
= to_pcie_device(device
);
203 /* Forward error message to service drivers */
204 status
= driver
->err_handler
->slot_reset(
206 *result
= merge_result(*result
, status
);
213 static pci_ers_result_t
pcie_portdrv_slot_reset(struct pci_dev
*dev
)
215 pci_ers_result_t status
= PCI_ERS_RESULT_NONE
;
218 /* If fatal, restore cfg space for possible link reset at upstream */
219 if (dev
->error_state
== pci_channel_io_frozen
) {
220 pci_restore_state(dev
);
221 pcie_portdrv_restore_config(dev
);
222 pci_enable_pcie_error_reporting(dev
);
225 /* get true return value from &status */
226 retval
= device_for_each_child(&dev
->dev
, &status
, slot_reset_iter
);
231 static int resume_iter(struct device
*device
, void *data
)
233 struct pcie_device
*pcie_device
;
234 struct pcie_port_service_driver
*driver
;
236 if (device
->bus
== &pcie_port_bus_type
&& device
->driver
) {
237 driver
= to_service_driver(device
->driver
);
239 driver
->err_handler
&&
240 driver
->err_handler
->resume
) {
241 pcie_device
= to_pcie_device(device
);
243 /* Forward error message to service drivers */
244 driver
->err_handler
->resume(pcie_device
->port
);
251 static void pcie_portdrv_err_resume(struct pci_dev
*dev
)
254 /* nothing to do with error value, if it ever happens */
255 retval
= device_for_each_child(&dev
->dev
, NULL
, resume_iter
);
259 * LINUX Device Driver Model
261 static const struct pci_device_id port_pci_ids
[] = { {
262 /* handle any PCI-Express port */
263 PCI_DEVICE_CLASS(((PCI_CLASS_BRIDGE_PCI
<< 8) | 0x00), ~0),
264 }, { /* end: all zeroes */ }
266 MODULE_DEVICE_TABLE(pci
, port_pci_ids
);
268 static struct pci_error_handlers pcie_portdrv_err_handler
= {
269 .error_detected
= pcie_portdrv_error_detected
,
270 .mmio_enabled
= pcie_portdrv_mmio_enabled
,
271 .slot_reset
= pcie_portdrv_slot_reset
,
272 .resume
= pcie_portdrv_err_resume
,
275 static struct pci_driver pcie_portdriver
= {
276 .name
= (char *)device_name
,
277 .id_table
= &port_pci_ids
[0],
279 .probe
= pcie_portdrv_probe
,
280 .remove
= pcie_portdrv_remove
,
282 .suspend
= pcie_portdrv_suspend
,
283 .resume
= pcie_portdrv_resume
,
285 .err_handler
= &pcie_portdrv_err_handler
,
288 static int __init
pcie_portdrv_init(void)
292 retval
= pcie_port_bus_register();
294 printk(KERN_WARNING
"PCIE: bus_register error: %d\n", retval
);
297 retval
= pci_register_driver(&pcie_portdriver
);
299 pcie_port_bus_unregister();
304 static void __exit
pcie_portdrv_exit(void)
306 pci_unregister_driver(&pcie_portdriver
);
307 pcie_port_bus_unregister();
310 module_init(pcie_portdrv_init
);
311 module_exit(pcie_portdrv_exit
);