1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/pci.h>
15#include <linux/export.h>
16#include <asm/pci-bridge.h>
17#include <asm/prom.h>
18
19
20
21
22static u32 get_int_prop(struct device_node *np, const char *name, u32 def)
23{
24 const __be32 *prop;
25 int len;
26
27 prop = of_get_property(np, name, &len);
28 if (prop && len >= 4)
29 return of_read_number(prop, 1);
30 return def;
31}
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61#define OF_PCI_ADDR0_SPACE(ss) (((ss)&3)<<24)
62#define OF_PCI_ADDR0_SPACE_CFG OF_PCI_ADDR0_SPACE(0)
63#define OF_PCI_ADDR0_SPACE_IO OF_PCI_ADDR0_SPACE(1)
64#define OF_PCI_ADDR0_SPACE_MMIO32 OF_PCI_ADDR0_SPACE(2)
65#define OF_PCI_ADDR0_SPACE_MMIO64 OF_PCI_ADDR0_SPACE(3)
66#define OF_PCI_ADDR0_SPACE_MASK OF_PCI_ADDR0_SPACE(3)
67#define OF_PCI_ADDR0_RELOC (1UL<<31)
68#define OF_PCI_ADDR0_PREFETCH (1UL<<30)
69#define OF_PCI_ADDR0_ALIAS (1UL<<29)
70#define OF_PCI_ADDR0_BUS 0x00FF0000UL
71#define OF_PCI_ADDR0_DEV 0x0000F800UL
72#define OF_PCI_ADDR0_FN 0x00000700UL
73#define OF_PCI_ADDR0_BARREG 0x000000FFUL
74
75unsigned int pci_parse_of_flags(u32 addr0, int bridge)
76{
77 unsigned int flags = 0, as = addr0 & OF_PCI_ADDR0_SPACE_MASK;
78
79 if (as == OF_PCI_ADDR0_SPACE_MMIO32 || as == OF_PCI_ADDR0_SPACE_MMIO64) {
80 flags = IORESOURCE_MEM | PCI_BASE_ADDRESS_SPACE_MEMORY;
81
82 if (as == OF_PCI_ADDR0_SPACE_MMIO64)
83 flags |= PCI_BASE_ADDRESS_MEM_TYPE_64 | IORESOURCE_MEM_64;
84
85 if (addr0 & OF_PCI_ADDR0_ALIAS)
86 flags |= PCI_BASE_ADDRESS_MEM_TYPE_1M;
87
88 if (addr0 & OF_PCI_ADDR0_PREFETCH)
89 flags |= IORESOURCE_PREFETCH |
90 PCI_BASE_ADDRESS_MEM_PREFETCH;
91
92
93
94
95
96
97 if (!bridge && (addr0 & OF_PCI_ADDR0_BARREG) == PCI_ROM_ADDRESS)
98 flags |= IORESOURCE_READONLY;
99
100 } else if (as == OF_PCI_ADDR0_SPACE_IO)
101 flags = IORESOURCE_IO | PCI_BASE_ADDRESS_SPACE_IO;
102
103 if (flags)
104 flags |= IORESOURCE_SIZEALIGN;
105
106 return flags;
107}
108
109
110
111
112
113
114
115
116
117static void of_pci_parse_addrs(struct device_node *node, struct pci_dev *dev)
118{
119 u64 base, size;
120 unsigned int flags;
121 struct pci_bus_region region;
122 struct resource *res;
123 const __be32 *addrs;
124 u32 i;
125 int proplen;
126 bool mark_unset = false;
127
128 addrs = of_get_property(node, "assigned-addresses", &proplen);
129 if (!addrs || !proplen) {
130 addrs = of_get_property(node, "reg", &proplen);
131 if (!addrs || !proplen)
132 return;
133 mark_unset = true;
134 }
135
136 pr_debug(" parse addresses (%d bytes) @ %p\n", proplen, addrs);
137 for (; proplen >= 20; proplen -= 20, addrs += 5) {
138 flags = pci_parse_of_flags(of_read_number(addrs, 1), 0);
139 if (!flags)
140 continue;
141 base = of_read_number(&addrs[1], 2);
142 size = of_read_number(&addrs[3], 2);
143 if (!size)
144 continue;
145 i = of_read_number(addrs, 1) & 0xff;
146 pr_debug(" base: %llx, size: %llx, i: %x\n",
147 (unsigned long long)base,
148 (unsigned long long)size, i);
149
150 if (PCI_BASE_ADDRESS_0 <= i && i <= PCI_BASE_ADDRESS_5) {
151 res = &dev->resource[(i - PCI_BASE_ADDRESS_0) >> 2];
152 } else if (i == dev->rom_base_reg) {
153 res = &dev->resource[PCI_ROM_RESOURCE];
154 flags |= IORESOURCE_READONLY;
155 } else {
156 printk(KERN_ERR "PCI: bad cfg reg num 0x%x\n", i);
157 continue;
158 }
159 res->flags = flags;
160 if (mark_unset)
161 res->flags |= IORESOURCE_UNSET;
162 res->name = pci_name(dev);
163 region.start = base;
164 region.end = base + size - 1;
165 pcibios_bus_to_resource(dev->bus, res, ®ion);
166 }
167}
168
169
170
171
172
173
174
175struct pci_dev *of_create_pci_dev(struct device_node *node,
176 struct pci_bus *bus, int devfn)
177{
178 struct pci_dev *dev;
179
180 dev = pci_alloc_dev(bus);
181 if (!dev)
182 return NULL;
183
184 pr_debug(" create device, devfn: %x, type: %s\n", devfn,
185 of_node_get_device_type(node));
186
187 dev->dev.of_node = of_node_get(node);
188 dev->dev.parent = bus->bridge;
189 dev->dev.bus = &pci_bus_type;
190 dev->devfn = devfn;
191 dev->multifunction = 0;
192 dev->needs_freset = 0;
193 set_pcie_port_type(dev);
194
195 pci_dev_assign_slot(dev);
196 dev->vendor = get_int_prop(node, "vendor-id", 0xffff);
197 dev->device = get_int_prop(node, "device-id", 0xffff);
198 dev->subsystem_vendor = get_int_prop(node, "subsystem-vendor-id", 0);
199 dev->subsystem_device = get_int_prop(node, "subsystem-id", 0);
200
201 dev->cfg_size = pci_cfg_space_size(dev);
202
203 dev_set_name(&dev->dev, "%04x:%02x:%02x.%d", pci_domain_nr(bus),
204 dev->bus->number, PCI_SLOT(devfn), PCI_FUNC(devfn));
205 dev->class = get_int_prop(node, "class-code", 0);
206 dev->revision = get_int_prop(node, "revision-id", 0);
207
208 pr_debug(" class: 0x%x\n", dev->class);
209 pr_debug(" revision: 0x%x\n", dev->revision);
210
211 dev->current_state = PCI_UNKNOWN;
212 dev->error_state = pci_channel_io_normal;
213 dev->dma_mask = 0xffffffff;
214
215
216 pci_fixup_device(pci_fixup_early, dev);
217
218 if (of_node_is_type(node, "pci") || of_node_is_type(node, "pciex")) {
219
220 dev->hdr_type = PCI_HEADER_TYPE_BRIDGE;
221 dev->rom_base_reg = PCI_ROM_ADDRESS1;
222 set_pcie_hotplug_bridge(dev);
223 } else if (of_node_is_type(node, "cardbus")) {
224 dev->hdr_type = PCI_HEADER_TYPE_CARDBUS;
225 } else {
226 dev->hdr_type = PCI_HEADER_TYPE_NORMAL;
227 dev->rom_base_reg = PCI_ROM_ADDRESS;
228
229 dev->irq = 0;
230 }
231
232 of_pci_parse_addrs(node, dev);
233
234 pr_debug(" adding to system ...\n");
235
236 pci_device_add(dev, bus);
237
238 return dev;
239}
240EXPORT_SYMBOL(of_create_pci_dev);
241
242
243
244
245
246
247
248
249
250void of_scan_pci_bridge(struct pci_dev *dev)
251{
252 struct device_node *node = dev->dev.of_node;
253 struct pci_bus *bus;
254 struct pci_controller *phb;
255 const __be32 *busrange, *ranges;
256 int len, i, mode;
257 struct pci_bus_region region;
258 struct resource *res;
259 unsigned int flags;
260 u64 size;
261
262 pr_debug("of_scan_pci_bridge(%pOF)\n", node);
263
264
265 busrange = of_get_property(node, "bus-range", &len);
266 if (busrange == NULL || len != 8) {
267 printk(KERN_DEBUG "Can't get bus-range for PCI-PCI bridge %pOF\n",
268 node);
269 return;
270 }
271 ranges = of_get_property(node, "ranges", &len);
272 if (ranges == NULL) {
273 printk(KERN_DEBUG "Can't get ranges for PCI-PCI bridge %pOF\n",
274 node);
275 return;
276 }
277
278 bus = pci_find_bus(pci_domain_nr(dev->bus),
279 of_read_number(busrange, 1));
280 if (!bus) {
281 bus = pci_add_new_bus(dev->bus, dev,
282 of_read_number(busrange, 1));
283 if (!bus) {
284 printk(KERN_ERR "Failed to create pci bus for %pOF\n",
285 node);
286 return;
287 }
288 }
289
290 bus->primary = dev->bus->number;
291 pci_bus_insert_busn_res(bus, of_read_number(busrange, 1),
292 of_read_number(busrange+1, 1));
293 bus->bridge_ctl = 0;
294
295
296
297 res = &dev->resource[PCI_BRIDGE_RESOURCES];
298 for (i = 0; i < PCI_NUM_RESOURCES - PCI_BRIDGE_RESOURCES; ++i) {
299 res->flags = 0;
300 bus->resource[i] = res;
301 ++res;
302 }
303 i = 1;
304 for (; len >= 32; len -= 32, ranges += 8) {
305 flags = pci_parse_of_flags(of_read_number(ranges, 1), 1);
306 size = of_read_number(&ranges[6], 2);
307 if (flags == 0 || size == 0)
308 continue;
309 if (flags & IORESOURCE_IO) {
310 res = bus->resource[0];
311 if (res->flags) {
312 printk(KERN_ERR "PCI: ignoring extra I/O range"
313 " for bridge %pOF\n", node);
314 continue;
315 }
316 } else {
317 if (i >= PCI_NUM_RESOURCES - PCI_BRIDGE_RESOURCES) {
318 printk(KERN_ERR "PCI: too many memory ranges"
319 " for bridge %pOF\n", node);
320 continue;
321 }
322 res = bus->resource[i];
323 ++i;
324 }
325 res->flags = flags;
326 region.start = of_read_number(&ranges[1], 2);
327 region.end = region.start + size - 1;
328 pcibios_bus_to_resource(dev->bus, res, ®ion);
329 }
330 sprintf(bus->name, "PCI Bus %04x:%02x", pci_domain_nr(bus),
331 bus->number);
332 pr_debug(" bus name: %s\n", bus->name);
333
334 phb = pci_bus_to_host(bus);
335
336 mode = PCI_PROBE_NORMAL;
337 if (phb->controller_ops.probe_mode)
338 mode = phb->controller_ops.probe_mode(bus);
339 pr_debug(" probe mode: %d\n", mode);
340
341 if (mode == PCI_PROBE_DEVTREE)
342 of_scan_bus(node, bus);
343 else if (mode == PCI_PROBE_NORMAL)
344 pci_scan_child_bus(bus);
345}
346EXPORT_SYMBOL(of_scan_pci_bridge);
347
348static struct pci_dev *of_scan_pci_dev(struct pci_bus *bus,
349 struct device_node *dn)
350{
351 struct pci_dev *dev = NULL;
352 const __be32 *reg;
353 int reglen, devfn;
354#ifdef CONFIG_EEH
355 struct eeh_dev *edev = pdn_to_eeh_dev(PCI_DN(dn));
356#endif
357
358 pr_debug(" * %pOF\n", dn);
359 if (!of_device_is_available(dn))
360 return NULL;
361
362 reg = of_get_property(dn, "reg", ®len);
363 if (reg == NULL || reglen < 20)
364 return NULL;
365 devfn = (of_read_number(reg, 1) >> 8) & 0xff;
366
367
368 dev = pci_get_slot(bus, devfn);
369 if (dev) {
370 pci_dev_put(dev);
371 return dev;
372 }
373
374
375#ifdef CONFIG_EEH
376 if (edev && (edev->mode & EEH_DEV_REMOVED))
377 return NULL;
378#endif
379
380
381 dev = of_create_pci_dev(dn, bus, devfn);
382 if (!dev)
383 return NULL;
384
385 pr_debug(" dev header type: %x\n", dev->hdr_type);
386 return dev;
387}
388
389
390
391
392
393
394
395static void __of_scan_bus(struct device_node *node, struct pci_bus *bus,
396 int rescan_existing)
397{
398 struct device_node *child;
399 struct pci_dev *dev;
400
401 pr_debug("of_scan_bus(%pOF) bus no %d...\n",
402 node, bus->number);
403
404
405 for_each_child_of_node(node, child) {
406 dev = of_scan_pci_dev(bus, child);
407 if (!dev)
408 continue;
409 pr_debug(" dev header type: %x\n", dev->hdr_type);
410 }
411
412
413
414
415 if (!rescan_existing)
416 pcibios_setup_bus_self(bus);
417 pcibios_setup_bus_devices(bus);
418
419
420 for_each_pci_bridge(dev, bus)
421 of_scan_pci_bridge(dev);
422}
423
424
425
426
427
428
429void of_scan_bus(struct device_node *node, struct pci_bus *bus)
430{
431 __of_scan_bus(node, bus, 0);
432}
433EXPORT_SYMBOL_GPL(of_scan_bus);
434
435
436
437
438
439
440
441
442
443void of_rescan_bus(struct device_node *node, struct pci_bus *bus)
444{
445 __of_scan_bus(node, bus, 1);
446}
447EXPORT_SYMBOL_GPL(of_rescan_bus);
448
449