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