rtnetlink: check DO_SETLINK_NOTIFY correctly in do_setlink
[linux/fpc-iii.git] / arch / powerpc / kernel / pci_of_scan.c
blob0d790f8432d27b6293c647176984d45f792c72c6
1 /*
2 * Helper routines to scan the device tree for PCI devices and busses
4 * Migrated out of PowerPC architecture pci_64.c file by Grant Likely
5 * <grant.likely@secretlab.ca> so that these routines are available for
6 * 32 bit also.
8 * Copyright (C) 2003 Anton Blanchard <anton@au.ibm.com>, IBM
9 * Rework, based on alpha PCI code.
10 * Copyright (c) 2009 Secret Lab Technologies Ltd.
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 * version 2 as published by the Free Software Foundation.
17 #include <linux/pci.h>
18 #include <linux/export.h>
19 #include <asm/pci-bridge.h>
20 #include <asm/prom.h>
22 /**
23 * get_int_prop - Decode a u32 from a device tree property
25 static u32 get_int_prop(struct device_node *np, const char *name, u32 def)
27 const __be32 *prop;
28 int len;
30 prop = of_get_property(np, name, &len);
31 if (prop && len >= 4)
32 return of_read_number(prop, 1);
33 return def;
36 /**
37 * pci_parse_of_flags - Parse the flags cell of a device tree PCI address
38 * @addr0: value of 1st cell of a device tree PCI address.
39 * @bridge: Set this flag if the address is from a bridge 'ranges' property
41 static unsigned int pci_parse_of_flags(u32 addr0, int bridge)
43 unsigned int flags = 0;
45 if (addr0 & 0x02000000) {
46 flags = IORESOURCE_MEM | PCI_BASE_ADDRESS_SPACE_MEMORY;
47 flags |= (addr0 >> 22) & PCI_BASE_ADDRESS_MEM_TYPE_64;
48 flags |= (addr0 >> 28) & PCI_BASE_ADDRESS_MEM_TYPE_1M;
49 if (addr0 & 0x40000000)
50 flags |= IORESOURCE_PREFETCH
51 | PCI_BASE_ADDRESS_MEM_PREFETCH;
52 /* Note: We don't know whether the ROM has been left enabled
53 * by the firmware or not. We mark it as disabled (ie, we do
54 * not set the IORESOURCE_ROM_ENABLE flag) for now rather than
55 * do a config space read, it will be force-enabled if needed
57 if (!bridge && (addr0 & 0xff) == 0x30)
58 flags |= IORESOURCE_READONLY;
59 } else if (addr0 & 0x01000000)
60 flags = IORESOURCE_IO | PCI_BASE_ADDRESS_SPACE_IO;
61 if (flags)
62 flags |= IORESOURCE_SIZEALIGN;
63 return flags;
66 /**
67 * of_pci_parse_addrs - Parse PCI addresses assigned in the device tree node
68 * @node: device tree node for the PCI device
69 * @dev: pci_dev structure for the device
71 * This function parses the 'assigned-addresses' property of a PCI devices'
72 * device tree node and writes them into the associated pci_dev structure.
74 static void of_pci_parse_addrs(struct device_node *node, struct pci_dev *dev)
76 u64 base, size;
77 unsigned int flags;
78 struct pci_bus_region region;
79 struct resource *res;
80 const __be32 *addrs;
81 u32 i;
82 int proplen;
84 addrs = of_get_property(node, "assigned-addresses", &proplen);
85 if (!addrs)
86 return;
87 pr_debug(" parse addresses (%d bytes) @ %p\n", proplen, addrs);
88 for (; proplen >= 20; proplen -= 20, addrs += 5) {
89 flags = pci_parse_of_flags(of_read_number(addrs, 1), 0);
90 if (!flags)
91 continue;
92 base = of_read_number(&addrs[1], 2);
93 size = of_read_number(&addrs[3], 2);
94 if (!size)
95 continue;
96 i = of_read_number(addrs, 1) & 0xff;
97 pr_debug(" base: %llx, size: %llx, i: %x\n",
98 (unsigned long long)base,
99 (unsigned long long)size, i);
101 if (PCI_BASE_ADDRESS_0 <= i && i <= PCI_BASE_ADDRESS_5) {
102 res = &dev->resource[(i - PCI_BASE_ADDRESS_0) >> 2];
103 } else if (i == dev->rom_base_reg) {
104 res = &dev->resource[PCI_ROM_RESOURCE];
105 flags |= IORESOURCE_READONLY;
106 } else {
107 printk(KERN_ERR "PCI: bad cfg reg num 0x%x\n", i);
108 continue;
110 res->flags = flags;
111 res->name = pci_name(dev);
112 region.start = base;
113 region.end = base + size - 1;
114 pcibios_bus_to_resource(dev->bus, res, &region);
119 * of_create_pci_dev - Given a device tree node on a pci bus, create a pci_dev
120 * @node: device tree node pointer
121 * @bus: bus the device is sitting on
122 * @devfn: PCI function number, extracted from device tree by caller.
124 struct pci_dev *of_create_pci_dev(struct device_node *node,
125 struct pci_bus *bus, int devfn)
127 struct pci_dev *dev;
128 const char *type;
130 dev = pci_alloc_dev(bus);
131 if (!dev)
132 return NULL;
133 type = of_get_property(node, "device_type", NULL);
134 if (type == NULL)
135 type = "";
137 pr_debug(" create device, devfn: %x, type: %s\n", devfn, type);
139 dev->dev.of_node = of_node_get(node);
140 dev->dev.parent = bus->bridge;
141 dev->dev.bus = &pci_bus_type;
142 dev->devfn = devfn;
143 dev->multifunction = 0; /* maybe a lie? */
144 dev->needs_freset = 0; /* pcie fundamental reset required */
145 set_pcie_port_type(dev);
147 pci_dev_assign_slot(dev);
148 dev->vendor = get_int_prop(node, "vendor-id", 0xffff);
149 dev->device = get_int_prop(node, "device-id", 0xffff);
150 dev->subsystem_vendor = get_int_prop(node, "subsystem-vendor-id", 0);
151 dev->subsystem_device = get_int_prop(node, "subsystem-id", 0);
153 dev->cfg_size = pci_cfg_space_size(dev);
155 dev_set_name(&dev->dev, "%04x:%02x:%02x.%d", pci_domain_nr(bus),
156 dev->bus->number, PCI_SLOT(devfn), PCI_FUNC(devfn));
157 dev->class = get_int_prop(node, "class-code", 0);
158 dev->revision = get_int_prop(node, "revision-id", 0);
160 pr_debug(" class: 0x%x\n", dev->class);
161 pr_debug(" revision: 0x%x\n", dev->revision);
163 dev->current_state = PCI_UNKNOWN; /* unknown power state */
164 dev->error_state = pci_channel_io_normal;
165 dev->dma_mask = 0xffffffff;
167 /* Early fixups, before probing the BARs */
168 pci_fixup_device(pci_fixup_early, dev);
170 if (!strcmp(type, "pci") || !strcmp(type, "pciex")) {
171 /* a PCI-PCI bridge */
172 dev->hdr_type = PCI_HEADER_TYPE_BRIDGE;
173 dev->rom_base_reg = PCI_ROM_ADDRESS1;
174 set_pcie_hotplug_bridge(dev);
175 } else if (!strcmp(type, "cardbus")) {
176 dev->hdr_type = PCI_HEADER_TYPE_CARDBUS;
177 } else {
178 dev->hdr_type = PCI_HEADER_TYPE_NORMAL;
179 dev->rom_base_reg = PCI_ROM_ADDRESS;
180 /* Maybe do a default OF mapping here */
181 dev->irq = 0;
184 of_pci_parse_addrs(node, dev);
186 pr_debug(" adding to system ...\n");
188 pci_device_add(dev, bus);
190 return dev;
192 EXPORT_SYMBOL(of_create_pci_dev);
195 * of_scan_pci_bridge - Set up a PCI bridge and scan for child nodes
196 * @dev: pci_dev structure for the bridge
198 * of_scan_bus() calls this routine for each PCI bridge that it finds, and
199 * this routine in turn call of_scan_bus() recusively to scan for more child
200 * devices.
202 void of_scan_pci_bridge(struct pci_dev *dev)
204 struct device_node *node = dev->dev.of_node;
205 struct pci_bus *bus;
206 struct pci_controller *phb;
207 const __be32 *busrange, *ranges;
208 int len, i, mode;
209 struct pci_bus_region region;
210 struct resource *res;
211 unsigned int flags;
212 u64 size;
214 pr_debug("of_scan_pci_bridge(%pOF)\n", node);
216 /* parse bus-range property */
217 busrange = of_get_property(node, "bus-range", &len);
218 if (busrange == NULL || len != 8) {
219 printk(KERN_DEBUG "Can't get bus-range for PCI-PCI bridge %pOF\n",
220 node);
221 return;
223 ranges = of_get_property(node, "ranges", &len);
224 if (ranges == NULL) {
225 printk(KERN_DEBUG "Can't get ranges for PCI-PCI bridge %pOF\n",
226 node);
227 return;
230 bus = pci_find_bus(pci_domain_nr(dev->bus),
231 of_read_number(busrange, 1));
232 if (!bus) {
233 bus = pci_add_new_bus(dev->bus, dev,
234 of_read_number(busrange, 1));
235 if (!bus) {
236 printk(KERN_ERR "Failed to create pci bus for %pOF\n",
237 node);
238 return;
242 bus->primary = dev->bus->number;
243 pci_bus_insert_busn_res(bus, of_read_number(busrange, 1),
244 of_read_number(busrange+1, 1));
245 bus->bridge_ctl = 0;
247 /* parse ranges property */
248 /* PCI #address-cells == 3 and #size-cells == 2 always */
249 res = &dev->resource[PCI_BRIDGE_RESOURCES];
250 for (i = 0; i < PCI_NUM_RESOURCES - PCI_BRIDGE_RESOURCES; ++i) {
251 res->flags = 0;
252 bus->resource[i] = res;
253 ++res;
255 i = 1;
256 for (; len >= 32; len -= 32, ranges += 8) {
257 flags = pci_parse_of_flags(of_read_number(ranges, 1), 1);
258 size = of_read_number(&ranges[6], 2);
259 if (flags == 0 || size == 0)
260 continue;
261 if (flags & IORESOURCE_IO) {
262 res = bus->resource[0];
263 if (res->flags) {
264 printk(KERN_ERR "PCI: ignoring extra I/O range"
265 " for bridge %pOF\n", node);
266 continue;
268 } else {
269 if (i >= PCI_NUM_RESOURCES - PCI_BRIDGE_RESOURCES) {
270 printk(KERN_ERR "PCI: too many memory ranges"
271 " for bridge %pOF\n", node);
272 continue;
274 res = bus->resource[i];
275 ++i;
277 res->flags = flags;
278 region.start = of_read_number(&ranges[1], 2);
279 region.end = region.start + size - 1;
280 pcibios_bus_to_resource(dev->bus, res, &region);
282 sprintf(bus->name, "PCI Bus %04x:%02x", pci_domain_nr(bus),
283 bus->number);
284 pr_debug(" bus name: %s\n", bus->name);
286 phb = pci_bus_to_host(bus);
288 mode = PCI_PROBE_NORMAL;
289 if (phb->controller_ops.probe_mode)
290 mode = phb->controller_ops.probe_mode(bus);
291 pr_debug(" probe mode: %d\n", mode);
293 if (mode == PCI_PROBE_DEVTREE)
294 of_scan_bus(node, bus);
295 else if (mode == PCI_PROBE_NORMAL)
296 pci_scan_child_bus(bus);
298 EXPORT_SYMBOL(of_scan_pci_bridge);
300 static struct pci_dev *of_scan_pci_dev(struct pci_bus *bus,
301 struct device_node *dn)
303 struct pci_dev *dev = NULL;
304 const __be32 *reg;
305 int reglen, devfn;
306 #ifdef CONFIG_EEH
307 struct eeh_dev *edev = pdn_to_eeh_dev(PCI_DN(dn));
308 #endif
310 pr_debug(" * %pOF\n", dn);
311 if (!of_device_is_available(dn))
312 return NULL;
314 reg = of_get_property(dn, "reg", &reglen);
315 if (reg == NULL || reglen < 20)
316 return NULL;
317 devfn = (of_read_number(reg, 1) >> 8) & 0xff;
319 /* Check if the PCI device is already there */
320 dev = pci_get_slot(bus, devfn);
321 if (dev) {
322 pci_dev_put(dev);
323 return dev;
326 /* Device removed permanently ? */
327 #ifdef CONFIG_EEH
328 if (edev && (edev->mode & EEH_DEV_REMOVED))
329 return NULL;
330 #endif
332 /* create a new pci_dev for this device */
333 dev = of_create_pci_dev(dn, bus, devfn);
334 if (!dev)
335 return NULL;
337 pr_debug(" dev header type: %x\n", dev->hdr_type);
338 return dev;
342 * __of_scan_bus - given a PCI bus node, setup bus and scan for child devices
343 * @node: device tree node for the PCI bus
344 * @bus: pci_bus structure for the PCI bus
345 * @rescan_existing: Flag indicating bus has already been set up
347 static void __of_scan_bus(struct device_node *node, struct pci_bus *bus,
348 int rescan_existing)
350 struct device_node *child;
351 struct pci_dev *dev;
353 pr_debug("of_scan_bus(%pOF) bus no %d...\n",
354 node, bus->number);
356 /* Scan direct children */
357 for_each_child_of_node(node, child) {
358 dev = of_scan_pci_dev(bus, child);
359 if (!dev)
360 continue;
361 pr_debug(" dev header type: %x\n", dev->hdr_type);
364 /* Apply all fixups necessary. We don't fixup the bus "self"
365 * for an existing bridge that is being rescanned
367 if (!rescan_existing)
368 pcibios_setup_bus_self(bus);
369 pcibios_setup_bus_devices(bus);
371 /* Now scan child busses */
372 list_for_each_entry(dev, &bus->devices, bus_list) {
373 if (pci_is_bridge(dev)) {
374 of_scan_pci_bridge(dev);
380 * of_scan_bus - given a PCI bus node, setup bus and scan for child devices
381 * @node: device tree node for the PCI bus
382 * @bus: pci_bus structure for the PCI bus
384 void of_scan_bus(struct device_node *node, struct pci_bus *bus)
386 __of_scan_bus(node, bus, 0);
388 EXPORT_SYMBOL_GPL(of_scan_bus);
391 * of_rescan_bus - given a PCI bus node, scan for child devices
392 * @node: device tree node for the PCI bus
393 * @bus: pci_bus structure for the PCI bus
395 * Same as of_scan_bus, but for a pci_bus structure that has already been
396 * setup.
398 void of_rescan_bus(struct device_node *node, struct pci_bus *bus)
400 __of_scan_bus(node, bus, 1);
402 EXPORT_SYMBOL_GPL(of_rescan_bus);