diff options
Diffstat (limited to 'arch/ppc64/kernel/pci_dn.c')
-rw-r--r-- | arch/ppc64/kernel/pci_dn.c | 47 |
1 files changed, 33 insertions, 14 deletions
diff --git a/arch/ppc64/kernel/pci_dn.c b/arch/ppc64/kernel/pci_dn.c index ec345462afc3..a86389d07d57 100644 --- a/arch/ppc64/kernel/pci_dn.c +++ b/arch/ppc64/kernel/pci_dn.c | |||
@@ -23,6 +23,8 @@ | |||
23 | #include <linux/pci.h> | 23 | #include <linux/pci.h> |
24 | #include <linux/string.h> | 24 | #include <linux/string.h> |
25 | #include <linux/init.h> | 25 | #include <linux/init.h> |
26 | #include <linux/slab.h> | ||
27 | #include <linux/bootmem.h> | ||
26 | 28 | ||
27 | #include <asm/io.h> | 29 | #include <asm/io.h> |
28 | #include <asm/prom.h> | 30 | #include <asm/prom.h> |
@@ -40,16 +42,26 @@ static void * __devinit update_dn_pci_info(struct device_node *dn, void *data) | |||
40 | struct pci_controller *phb = data; | 42 | struct pci_controller *phb = data; |
41 | int *type = (int *)get_property(dn, "ibm,pci-config-space-type", NULL); | 43 | int *type = (int *)get_property(dn, "ibm,pci-config-space-type", NULL); |
42 | u32 *regs; | 44 | u32 *regs; |
43 | 45 | struct pci_dn *pdn; | |
44 | dn->phb = phb; | 46 | |
47 | if (phb->is_dynamic) | ||
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; | ||
45 | regs = (u32 *)get_property(dn, "reg", NULL); | 57 | regs = (u32 *)get_property(dn, "reg", NULL); |
46 | if (regs) { | 58 | if (regs) { |
47 | /* First register entry is addr (00BBSS00) */ | 59 | /* First register entry is addr (00BBSS00) */ |
48 | dn->busno = (regs[0] >> 16) & 0xff; | 60 | pdn->busno = (regs[0] >> 16) & 0xff; |
49 | dn->devfn = (regs[0] >> 8) & 0xff; | 61 | pdn->devfn = (regs[0] >> 8) & 0xff; |
50 | } | 62 | } |
51 | 63 | ||
52 | dn->pci_ext_config_space = (type && *type == 1); | 64 | pdn->pci_ext_config_space = (type && *type == 1); |
53 | return NULL; | 65 | return NULL; |
54 | } | 66 | } |
55 | 67 | ||
@@ -112,10 +124,15 @@ void *traverse_pci_devices(struct device_node *start, traverse_func pre, | |||
112 | void __devinit pci_devs_phb_init_dynamic(struct pci_controller *phb) | 124 | void __devinit pci_devs_phb_init_dynamic(struct pci_controller *phb) |
113 | { | 125 | { |
114 | struct device_node * dn = (struct device_node *) phb->arch_data; | 126 | struct device_node * dn = (struct device_node *) phb->arch_data; |
127 | struct pci_dn *pdn; | ||
115 | 128 | ||
116 | /* PHB nodes themselves must not match */ | 129 | /* PHB nodes themselves must not match */ |
117 | dn->devfn = dn->busno = -1; | 130 | update_dn_pci_info(dn, phb); |
118 | dn->phb = phb; | 131 | pdn = dn->data; |
132 | if (pdn) { | ||
133 | pdn->devfn = pdn->busno = -1; | ||
134 | pdn->phb = phb; | ||
135 | } | ||
119 | 136 | ||
120 | /* Update dn->phb ptrs for new phb and children devices */ | 137 | /* Update dn->phb ptrs for new phb and children devices */ |
121 | traverse_pci_devices(dn, update_dn_pci_info, phb); | 138 | traverse_pci_devices(dn, update_dn_pci_info, phb); |
@@ -123,14 +140,17 @@ void __devinit pci_devs_phb_init_dynamic(struct pci_controller *phb) | |||
123 | 140 | ||
124 | /* | 141 | /* |
125 | * Traversal func that looks for a <busno,devfcn> value. | 142 | * Traversal func that looks for a <busno,devfcn> value. |
126 | * If found, the device_node is returned (thus terminating the traversal). | 143 | * If found, the pci_dn is returned (thus terminating the traversal). |
127 | */ | 144 | */ |
128 | static void *is_devfn_node(struct device_node *dn, void *data) | 145 | static void *is_devfn_node(struct device_node *dn, void *data) |
129 | { | 146 | { |
130 | int busno = ((unsigned long)data >> 8) & 0xff; | 147 | int busno = ((unsigned long)data >> 8) & 0xff; |
131 | int devfn = ((unsigned long)data) & 0xff; | 148 | int devfn = ((unsigned long)data) & 0xff; |
149 | struct pci_dn *pci = dn->data; | ||
132 | 150 | ||
133 | return ((devfn == dn->devfn) && (busno == dn->busno)) ? dn : NULL; | 151 | if (pci && (devfn == pci->devfn) && (busno == pci->busno)) |
152 | return dn; | ||
153 | return NULL; | ||
134 | } | 154 | } |
135 | 155 | ||
136 | /* | 156 | /* |
@@ -149,13 +169,10 @@ static void *is_devfn_node(struct device_node *dn, void *data) | |||
149 | struct device_node *fetch_dev_dn(struct pci_dev *dev) | 169 | struct device_node *fetch_dev_dn(struct pci_dev *dev) |
150 | { | 170 | { |
151 | struct device_node *orig_dn = dev->sysdata; | 171 | struct device_node *orig_dn = dev->sysdata; |
152 | struct pci_controller *phb = orig_dn->phb; /* assume same phb as orig_dn */ | ||
153 | struct device_node *phb_dn; | ||
154 | struct device_node *dn; | 172 | struct device_node *dn; |
155 | unsigned long searchval = (dev->bus->number << 8) | dev->devfn; | 173 | unsigned long searchval = (dev->bus->number << 8) | dev->devfn; |
156 | 174 | ||
157 | phb_dn = phb->arch_data; | 175 | dn = traverse_pci_devices(orig_dn, is_devfn_node, (void *)searchval); |
158 | dn = traverse_pci_devices(phb_dn, is_devfn_node, (void *)searchval); | ||
159 | if (dn) | 176 | if (dn) |
160 | dev->sysdata = dn; | 177 | dev->sysdata = dn; |
161 | return dn; | 178 | return dn; |
@@ -165,11 +182,13 @@ EXPORT_SYMBOL(fetch_dev_dn); | |||
165 | static int pci_dn_reconfig_notifier(struct notifier_block *nb, unsigned long action, void *node) | 182 | static int pci_dn_reconfig_notifier(struct notifier_block *nb, unsigned long action, void *node) |
166 | { | 183 | { |
167 | struct device_node *np = node; | 184 | struct device_node *np = node; |
185 | struct pci_dn *pci; | ||
168 | int err = NOTIFY_OK; | 186 | int err = NOTIFY_OK; |
169 | 187 | ||
170 | switch (action) { | 188 | switch (action) { |
171 | case PSERIES_RECONFIG_ADD: | 189 | case PSERIES_RECONFIG_ADD: |
172 | update_dn_pci_info(np, np->parent->phb); | 190 | pci = np->parent->data; |
191 | update_dn_pci_info(np, pci->phb); | ||
173 | break; | 192 | break; |
174 | default: | 193 | default: |
175 | err = NOTIFY_DONE; | 194 | err = NOTIFY_DONE; |