[PATCH] cpu hotplug: revert init patch submitted for 2.6.17
[linux-2.6] / arch / powerpc / kernel / pci_dn.c
1 /*
2  * pci_dn.c
3  *
4  * Copyright (C) 2001 Todd Inglett, IBM Corporation
5  *
6  * PCI manipulation via device_nodes.
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License as published by
10  * the Free Software Foundation; either version 2 of the License, or
11  * (at your option) any later version.
12  *    
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  * GNU General Public License for more details.
17  * 
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
21  */
22 #include <linux/kernel.h>
23 #include <linux/pci.h>
24 #include <linux/string.h>
25 #include <linux/init.h>
26 #include <linux/slab.h>
27 #include <linux/bootmem.h>
28
29 #include <asm/io.h>
30 #include <asm/prom.h>
31 #include <asm/pci-bridge.h>
32 #include <asm/pSeries_reconfig.h>
33 #include <asm/ppc-pci.h>
34 #include <asm/firmware.h>
35
36 /*
37  * Traverse_func that inits the PCI fields of the device node.
38  * NOTE: this *must* be done before read/write config to the device.
39  */
40 static void * __devinit update_dn_pci_info(struct device_node *dn, void *data)
41 {
42         struct pci_controller *phb = data;
43         int *type = (int *)get_property(dn, "ibm,pci-config-space-type", NULL);
44         u32 *regs;
45         struct pci_dn *pdn;
46
47         if (mem_init_done)
48                 pdn = kmalloc(sizeof(*pdn), GFP_KERNEL);
49         else
50                 pdn = alloc_bootmem(sizeof(*pdn));
51         if (pdn == NULL)
52                 return NULL;
53         memset(pdn, 0, sizeof(*pdn));
54         dn->data = pdn;
55         pdn->node = dn;
56         pdn->phb = phb;
57         regs = (u32 *)get_property(dn, "reg", NULL);
58         if (regs) {
59                 /* First register entry is addr (00BBSS00)  */
60                 pdn->busno = (regs[0] >> 16) & 0xff;
61                 pdn->devfn = (regs[0] >> 8) & 0xff;
62         }
63         if (firmware_has_feature(FW_FEATURE_ISERIES)) {
64                 u32 *busp = (u32 *)get_property(dn, "linux,subbus", NULL);
65                 if (busp)
66                         pdn->bussubno = *busp;
67         }
68
69         pdn->pci_ext_config_space = (type && *type == 1);
70         return NULL;
71 }
72
73 /*
74  * Traverse a device tree stopping each PCI device in the tree.
75  * This is done depth first.  As each node is processed, a "pre"
76  * function is called and the children are processed recursively.
77  *
78  * The "pre" func returns a value.  If non-zero is returned from
79  * the "pre" func, the traversal stops and this value is returned.
80  * This return value is useful when using traverse as a method of
81  * finding a device.
82  *
83  * NOTE: we do not run the func for devices that do not appear to
84  * be PCI except for the start node which we assume (this is good
85  * because the start node is often a phb which may be missing PCI
86  * properties).
87  * We use the class-code as an indicator. If we run into
88  * one of these nodes we also assume its siblings are non-pci for
89  * performance.
90  */
91 void *traverse_pci_devices(struct device_node *start, traverse_func pre,
92                 void *data)
93 {
94         struct device_node *dn, *nextdn;
95         void *ret;
96
97         /* We started with a phb, iterate all childs */
98         for (dn = start->child; dn; dn = nextdn) {
99                 u32 *classp, class;
100
101                 nextdn = NULL;
102                 classp = (u32 *)get_property(dn, "class-code", NULL);
103                 class = classp ? *classp : 0;
104
105                 if (pre && ((ret = pre(dn, data)) != NULL))
106                         return ret;
107
108                 /* If we are a PCI bridge, go down */
109                 if (dn->child && ((class >> 8) == PCI_CLASS_BRIDGE_PCI ||
110                                   (class >> 8) == PCI_CLASS_BRIDGE_CARDBUS))
111                         /* Depth first...do children */
112                         nextdn = dn->child;
113                 else if (dn->sibling)
114                         /* ok, try next sibling instead. */
115                         nextdn = dn->sibling;
116                 if (!nextdn) {
117                         /* Walk up to next valid sibling. */
118                         do {
119                                 dn = dn->parent;
120                                 if (dn == start)
121                                         return NULL;
122                         } while (dn->sibling == NULL);
123                         nextdn = dn->sibling;
124                 }
125         }
126         return NULL;
127 }
128
129 /** 
130  * pci_devs_phb_init_dynamic - setup pci devices under this PHB
131  * phb: pci-to-host bridge (top-level bridge connecting to cpu)
132  *
133  * This routine is called both during boot, (before the memory
134  * subsystem is set up, before kmalloc is valid) and during the 
135  * dynamic lpar operation of adding a PHB to a running system.
136  */
137 void __devinit pci_devs_phb_init_dynamic(struct pci_controller *phb)
138 {
139         struct device_node * dn = (struct device_node *) phb->arch_data;
140         struct pci_dn *pdn;
141
142         /* PHB nodes themselves must not match */
143         update_dn_pci_info(dn, phb);
144         pdn = dn->data;
145         if (pdn) {
146                 pdn->devfn = pdn->busno = -1;
147                 pdn->phb = phb;
148         }
149
150         /* Update dn->phb ptrs for new phb and children devices */
151         traverse_pci_devices(dn, update_dn_pci_info, phb);
152 }
153
154 /*
155  * Traversal func that looks for a <busno,devfcn> value.
156  * If found, the pci_dn is returned (thus terminating the traversal).
157  */
158 static void *is_devfn_node(struct device_node *dn, void *data)
159 {
160         int busno = ((unsigned long)data >> 8) & 0xff;
161         int devfn = ((unsigned long)data) & 0xff;
162         struct pci_dn *pci = dn->data;
163
164         if (pci && (devfn == pci->devfn) && (busno == pci->busno))
165                 return dn;
166         return NULL;
167 }
168
169 /*
170  * This is the "slow" path for looking up a device_node from a
171  * pci_dev.  It will hunt for the device under its parent's
172  * phb and then update sysdata for a future fastpath.
173  *
174  * It may also do fixups on the actual device since this happens
175  * on the first read/write.
176  *
177  * Note that it also must deal with devices that don't exist.
178  * In this case it may probe for real hardware ("just in case")
179  * and add a device_node to the device tree if necessary.
180  *
181  */
182 struct device_node *fetch_dev_dn(struct pci_dev *dev)
183 {
184         struct device_node *orig_dn = dev->sysdata;
185         struct device_node *dn;
186         unsigned long searchval = (dev->bus->number << 8) | dev->devfn;
187
188         dn = traverse_pci_devices(orig_dn, is_devfn_node, (void *)searchval);
189         if (dn)
190                 dev->sysdata = dn;
191         return dn;
192 }
193 EXPORT_SYMBOL(fetch_dev_dn);
194
195 static int pci_dn_reconfig_notifier(struct notifier_block *nb, unsigned long action, void *node)
196 {
197         struct device_node *np = node;
198         struct pci_dn *pci = NULL;
199         int err = NOTIFY_OK;
200
201         switch (action) {
202         case PSERIES_RECONFIG_ADD:
203                 pci = np->parent->data;
204                 if (pci)
205                         update_dn_pci_info(np, pci->phb);
206                 break;
207         default:
208                 err = NOTIFY_DONE;
209                 break;
210         }
211         return err;
212 }
213
214 static struct notifier_block pci_dn_reconfig_nb = {
215         .notifier_call = pci_dn_reconfig_notifier,
216 };
217
218 /** 
219  * pci_devs_phb_init - Initialize phbs and pci devs under them.
220  * 
221  * This routine walks over all phb's (pci-host bridges) on the
222  * system, and sets up assorted pci-related structures 
223  * (including pci info in the device node structs) for each
224  * pci device found underneath.  This routine runs once,
225  * early in the boot sequence.
226  */
227 void __init pci_devs_phb_init(void)
228 {
229         struct pci_controller *phb, *tmp;
230
231         /* This must be done first so the device nodes have valid pci info! */
232         list_for_each_entry_safe(phb, tmp, &hose_list, list_node)
233                 pci_devs_phb_init_dynamic(phb);
234
235         pSeries_reconfig_notifier_register(&pci_dn_reconfig_nb);
236 }