[PATCH] PCI Hotplug: PCI panic on dlpar add (add pci slot to running partition)
[linux-2.6] / drivers / pci / hotplug / rpadlpar_core.c
1 /*
2  * Interface for Dynamic Logical Partitioning of I/O Slots on
3  * RPA-compliant PPC64 platform.
4  *
5  * John Rose <johnrose@austin.ibm.com>
6  * Linda Xie <lxie@us.ibm.com>
7  *
8  * October 2003
9  *
10  * Copyright (C) 2003 IBM.
11  *
12  *      This program is free software; you can redistribute it and/or
13  *      modify it under the terms of the GNU General Public License
14  *      as published by the Free Software Foundation; either version
15  *      2 of the License, or (at your option) any later version.
16  */
17 #include <linux/init.h>
18 #include <linux/pci.h>
19 #include <linux/string.h>
20
21 #include <asm/pci-bridge.h>
22 #include <asm/semaphore.h>
23 #include <asm/rtas.h>
24 #include <asm/vio.h>
25
26 #include "../pci.h"
27 #include "rpaphp.h"
28 #include "rpadlpar.h"
29
30 static DECLARE_MUTEX(rpadlpar_sem);
31
32 #define DLPAR_MODULE_NAME "rpadlpar_io"
33
34 #define NODE_TYPE_VIO  1
35 #define NODE_TYPE_SLOT 2
36 #define NODE_TYPE_PHB  3
37
38 static struct device_node *find_vio_slot_node(char *drc_name)
39 {
40         struct device_node *parent = of_find_node_by_name(NULL, "vdevice");
41         struct device_node *dn = NULL;
42         char *name;
43         int rc;
44
45         if (!parent)
46                 return NULL;
47
48         while ((dn = of_get_next_child(parent, dn))) {
49                 rc = rpaphp_get_drc_props(dn, NULL, &name, NULL, NULL);
50                 if ((rc == 0) && (!strcmp(drc_name, name)))
51                         break;
52         }
53
54         return dn;
55 }
56
57 /* Find dlpar-capable pci node that contains the specified name and type */
58 static struct device_node *find_php_slot_pci_node(char *drc_name,
59                                                   char *drc_type)
60 {
61         struct device_node *np = NULL;
62         char *name;
63         char *type;
64         int rc;
65
66         while ((np = of_find_node_by_type(np, "pci"))) {
67                 rc = rpaphp_get_drc_props(np, NULL, &name, &type, NULL);
68                 if (rc == 0)
69                         if (!strcmp(drc_name, name) && !strcmp(drc_type, type))
70                                 break;
71         }
72
73         return np;
74 }
75
76 static struct device_node *find_dlpar_node(char *drc_name, int *node_type)
77 {
78         struct device_node *dn;
79
80         dn = find_php_slot_pci_node(drc_name, "SLOT");
81         if (dn) {
82                 *node_type = NODE_TYPE_SLOT;
83                 return dn;
84         }
85
86         dn = find_php_slot_pci_node(drc_name, "PHB");
87         if (dn) {
88                 *node_type = NODE_TYPE_PHB;
89                 return dn;
90         }
91
92         dn = find_vio_slot_node(drc_name);
93         if (dn) {
94                 *node_type = NODE_TYPE_VIO;
95                 return dn;
96         }
97
98         return NULL;
99 }
100
101 static struct slot *find_slot(struct device_node *dn)
102 {
103         struct list_head *tmp, *n;
104         struct slot *slot;
105
106         list_for_each_safe(tmp, n, &rpaphp_slot_head) {
107                 slot = list_entry(tmp, struct slot, rpaphp_slot_list);
108                 if (slot->dn == dn)
109                         return slot;
110         }
111
112         return NULL;
113 }
114
115 static struct pci_dev *dlpar_find_new_dev(struct pci_bus *parent,
116                                         struct device_node *dev_dn)
117 {
118         struct pci_dev *tmp = NULL;
119         struct device_node *child_dn;
120
121         list_for_each_entry(tmp, &parent->devices, bus_list) {
122                 child_dn = pci_device_to_OF_node(tmp);
123                 if (child_dn == dev_dn)
124                         return tmp;
125         }
126         return NULL;
127 }
128
129 static struct pci_dev *dlpar_pci_add_bus(struct device_node *dn)
130 {
131         struct pci_dn *pdn = dn->data;
132         struct pci_controller *phb = pdn->phb;
133         struct pci_dev *dev = NULL;
134
135         eeh_add_device_tree_early(dn);
136
137         /* Add EADS device to PHB bus, adding new entry to bus->devices */
138         dev = of_create_pci_dev(dn, phb->bus, pdn->devfn);
139         if (!dev) {
140                 printk(KERN_ERR "%s: failed to create pci dev for %s\n",
141                                 __FUNCTION__, dn->full_name);
142                 return NULL;
143         }
144
145         if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE ||
146             dev->hdr_type == PCI_HEADER_TYPE_CARDBUS)
147                 of_scan_pci_bridge(dn, dev);
148
149         rpaphp_init_new_devs(dev->subordinate);
150
151         /* Claim new bus resources */
152         pcibios_claim_one_bus(dev->bus);
153
154         /* ioremap() for child bus, which may or may not succeed */
155         remap_bus_range(dev->subordinate);
156
157         /* Add new devices to global lists.  Register in proc, sysfs. */
158         pci_bus_add_devices(phb->bus);
159
160         /* Confirm new bridge dev was created */
161         dev = dlpar_find_new_dev(phb->bus, dn);
162         if (dev) {
163                 if (dev->hdr_type != PCI_HEADER_TYPE_BRIDGE) {
164                         printk(KERN_ERR "%s: unexpected header type %d\n",
165                                 __FUNCTION__, dev->hdr_type);
166                         return NULL;
167                 }
168         }
169
170         return dev;
171 }
172
173 static int dlpar_add_pci_slot(char *drc_name, struct device_node *dn)
174 {
175         struct pci_dev *dev;
176
177         if (rpaphp_find_pci_bus(dn))
178                 return -EINVAL;
179
180         /* Add pci bus */
181         dev = dlpar_pci_add_bus(dn);
182         if (!dev) {
183                 printk(KERN_ERR "%s: unable to add bus %s\n", __FUNCTION__,
184                         drc_name);
185                 return -EIO;
186         }
187
188         /* Add hotplug slot */
189         if (rpaphp_add_slot(dn)) {
190                 printk(KERN_ERR "%s: unable to add hotplug slot %s\n",
191                         __FUNCTION__, drc_name);
192                 return -EIO;
193         }
194         return 0;
195 }
196
197 static int dlpar_remove_root_bus(struct pci_controller *phb)
198 {
199         struct pci_bus *phb_bus;
200         int rc;
201
202         phb_bus = phb->bus;
203         if (!(list_empty(&phb_bus->children) &&
204               list_empty(&phb_bus->devices))) {
205                 return -EBUSY;
206         }
207
208         rc = pcibios_remove_root_bus(phb);
209         if (rc)
210                 return -EIO;
211
212         device_unregister(phb_bus->bridge);
213         pci_remove_bus(phb_bus);
214
215         return 0;
216 }
217
218 static int dlpar_remove_phb(char *drc_name, struct device_node *dn)
219 {
220         struct slot *slot;
221         struct pci_dn *pdn;
222         int rc = 0;
223
224         if (!rpaphp_find_pci_bus(dn))
225                 return -EINVAL;
226
227         slot = find_slot(dn);
228         if (slot) {
229                 /* Remove hotplug slot */
230                 if (rpaphp_remove_slot(slot)) {
231                         printk(KERN_ERR
232                                 "%s: unable to remove hotplug slot %s\n",
233                                 __FUNCTION__, drc_name);
234                         return -EIO;
235                 }
236         }
237
238         pdn = dn->data;
239         BUG_ON(!pdn || !pdn->phb);
240         rc = dlpar_remove_root_bus(pdn->phb);
241         if (rc < 0)
242                 return rc;
243
244         pdn->phb = NULL;
245
246         return 0;
247 }
248
249 static int dlpar_add_phb(char *drc_name, struct device_node *dn)
250 {
251         struct pci_controller *phb;
252
253         if (PCI_DN(dn) && PCI_DN(dn)->phb) {
254                 /* PHB already exists */
255                 return -EINVAL;
256         }
257
258         phb = init_phb_dynamic(dn);
259         if (!phb)
260                 return -EIO;
261
262         if (rpaphp_add_slot(dn)) {
263                 printk(KERN_ERR "%s: unable to add hotplug slot %s\n",
264                         __FUNCTION__, drc_name);
265                 return -EIO;
266         }
267         return 0;
268 }
269
270 static int dlpar_add_vio_slot(char *drc_name, struct device_node *dn)
271 {
272         if (vio_find_node(dn))
273                 return -EINVAL;
274
275         if (!vio_register_device_node(dn)) {
276                 printk(KERN_ERR
277                         "%s: failed to register vio node %s\n",
278                         __FUNCTION__, drc_name);
279                 return -EIO;
280         }
281         return 0;
282 }
283
284 /**
285  * dlpar_add_slot - DLPAR add an I/O Slot
286  * @drc_name: drc-name of newly added slot
287  *
288  * Make the hotplug module and the kernel aware
289  * of a newly added I/O Slot.
290  * Return Codes -
291  * 0                    Success
292  * -ENODEV              Not a valid drc_name
293  * -EINVAL              Slot already added
294  * -ERESTARTSYS         Signalled before obtaining lock
295  * -EIO                 Internal PCI Error
296  */
297 int dlpar_add_slot(char *drc_name)
298 {
299         struct device_node *dn = NULL;
300         int node_type;
301         int rc = -EIO;
302
303         if (down_interruptible(&rpadlpar_sem))
304                 return -ERESTARTSYS;
305
306         /* Find newly added node */
307         dn = find_dlpar_node(drc_name, &node_type);
308         if (!dn) {
309                 rc = -ENODEV;
310                 goto exit;
311         }
312
313         switch (node_type) {
314                 case NODE_TYPE_VIO:
315                         rc = dlpar_add_vio_slot(drc_name, dn);
316                         break;
317                 case NODE_TYPE_SLOT:
318                         rc = dlpar_add_pci_slot(drc_name, dn);
319                         break;
320                 case NODE_TYPE_PHB:
321                         rc = dlpar_add_phb(drc_name, dn);
322                         break;
323         }
324
325         printk(KERN_INFO "%s: slot %s added\n", DLPAR_MODULE_NAME, drc_name);
326 exit:
327         up(&rpadlpar_sem);
328         return rc;
329 }
330
331 /**
332  * dlpar_remove_vio_slot - DLPAR remove a virtual I/O Slot
333  * @drc_name: drc-name of newly added slot
334  *
335  * Remove the kernel and hotplug representations
336  * of an I/O Slot.
337  * Return Codes:
338  * 0                    Success
339  * -EINVAL              Vio dev doesn't exist
340  */
341 static int dlpar_remove_vio_slot(char *drc_name, struct device_node *dn)
342 {
343         struct vio_dev *vio_dev;
344
345         vio_dev = vio_find_node(dn);
346         if (!vio_dev)
347                 return -EINVAL;
348
349         vio_unregister_device(vio_dev);
350         return 0;
351 }
352
353 /**
354  * dlpar_remove_slot - DLPAR remove a PCI I/O Slot
355  * @drc_name: drc-name of newly added slot
356  *
357  * Remove the kernel and hotplug representations
358  * of a PCI I/O Slot.
359  * Return Codes:
360  * 0                    Success
361  * -ENODEV              Not a valid drc_name
362  * -EIO                 Internal PCI Error
363  */
364 int dlpar_remove_pci_slot(char *drc_name, struct device_node *dn)
365 {
366         struct pci_bus *bus;
367         struct slot *slot;
368
369         bus = rpaphp_find_pci_bus(dn);
370         if (!bus)
371                 return -EINVAL;
372
373         slot = find_slot(dn);
374         if (slot) {
375                 /* Remove hotplug slot */
376                 if (rpaphp_remove_slot(slot)) {
377                         printk(KERN_ERR
378                                 "%s: unable to remove hotplug slot %s\n",
379                                 __FUNCTION__, drc_name);
380                         return -EIO;
381                 }
382         } else {
383                 rpaphp_unconfig_pci_adapter(bus);
384         }
385
386         if (unmap_bus_range(bus)) {
387                 printk(KERN_ERR "%s: failed to unmap bus range\n",
388                         __FUNCTION__);
389                 return -ERANGE;
390         }
391
392         BUG_ON(!bus->self);
393         pci_remove_bus_device(bus->self);
394         return 0;
395 }
396
397 /**
398  * dlpar_remove_slot - DLPAR remove an I/O Slot
399  * @drc_name: drc-name of newly added slot
400  *
401  * Remove the kernel and hotplug representations
402  * of an I/O Slot.
403  * Return Codes:
404  * 0                    Success
405  * -ENODEV              Not a valid drc_name
406  * -EINVAL              Slot already removed
407  * -ERESTARTSYS         Signalled before obtaining lock
408  * -EIO                 Internal Error
409  */
410 int dlpar_remove_slot(char *drc_name)
411 {
412         struct device_node *dn;
413         int node_type;
414         int rc = 0;
415
416         if (down_interruptible(&rpadlpar_sem))
417                 return -ERESTARTSYS;
418
419         dn = find_dlpar_node(drc_name, &node_type);
420         if (!dn) {
421                 rc = -ENODEV;
422                 goto exit;
423         }
424
425         switch (node_type) {
426                 case NODE_TYPE_VIO:
427                         rc = dlpar_remove_vio_slot(drc_name, dn);
428                         break;
429                 case NODE_TYPE_PHB:
430                         rc = dlpar_remove_phb(drc_name, dn);
431                         break;
432                 case NODE_TYPE_SLOT:
433                         rc = dlpar_remove_pci_slot(drc_name, dn);
434                         break;
435         }
436         printk(KERN_INFO "%s: slot %s removed\n", DLPAR_MODULE_NAME, drc_name);
437 exit:
438         up(&rpadlpar_sem);
439         return rc;
440 }
441
442 static inline int is_dlpar_capable(void)
443 {
444         int rc = rtas_token("ibm,configure-connector");
445
446         return (int) (rc != RTAS_UNKNOWN_SERVICE);
447 }
448
449 int __init rpadlpar_io_init(void)
450 {
451         int rc = 0;
452
453         if (!is_dlpar_capable()) {
454                 printk(KERN_WARNING "%s: partition not DLPAR capable\n",
455                         __FUNCTION__);
456                 return -EPERM;
457         }
458
459         rc = dlpar_sysfs_init();
460         return rc;
461 }
462
463 void rpadlpar_io_exit(void)
464 {
465         dlpar_sysfs_exit();
466         return;
467 }
468
469 module_init(rpadlpar_io_init);
470 module_exit(rpadlpar_io_exit);
471 MODULE_LICENSE("GPL");