2 * Copyright (C) 2006 Benjamin Herrenschmidt, IBM Corp.
3 * <benh@kernel.crashing.org>
4 * and Arnd Bergmann, IBM Corp.
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version
9 * 2 of the License, or (at your option) any later version.
15 #include <linux/string.h>
16 #include <linux/kernel.h>
17 #include <linux/init.h>
18 #include <linux/module.h>
19 #include <linux/mod_devicetable.h>
20 #include <linux/slab.h>
21 #include <linux/pci.h>
23 #include <asm/errno.h>
25 #include <asm/of_device.h>
26 #include <asm/of_platform.h>
27 #include <asm/topology.h>
28 #include <asm/pci-bridge.h>
29 #include <asm/ppc-pci.h>
30 #include <asm/atomic.h>
34 * The list of OF IDs below is used for matching bus types in the
35 * system whose devices are to be exposed as of_platform_devices.
37 * This is the default list valid for most platforms. This file provides
38 * functions who can take an explicit list if necessary though
40 * The search is always performed recursively looking for children of
41 * the provided device_node and recursively if such a children matches
42 * a bus type in the list
45 static struct of_device_id of_default_bus_ids
[] = {
47 { .compatible
= "soc", },
48 { .type
= "spider", },
57 static atomic_t bus_no_reg_magic
;
61 * OF platform device type definition & base infrastructure
65 static int of_platform_bus_match(struct device
*dev
, struct device_driver
*drv
)
67 struct of_device
* of_dev
= to_of_device(dev
);
68 struct of_platform_driver
* of_drv
= to_of_platform_driver(drv
);
69 const struct of_device_id
* matches
= of_drv
->match_table
;
74 return of_match_device(matches
, of_dev
) != NULL
;
77 static int of_platform_device_probe(struct device
*dev
)
80 struct of_platform_driver
*drv
;
81 struct of_device
*of_dev
;
82 const struct of_device_id
*match
;
84 drv
= to_of_platform_driver(dev
->driver
);
85 of_dev
= to_of_device(dev
);
92 match
= of_match_device(drv
->match_table
, of_dev
);
94 error
= drv
->probe(of_dev
, match
);
101 static int of_platform_device_remove(struct device
*dev
)
103 struct of_device
* of_dev
= to_of_device(dev
);
104 struct of_platform_driver
* drv
= to_of_platform_driver(dev
->driver
);
106 if (dev
->driver
&& drv
->remove
)
111 static int of_platform_device_suspend(struct device
*dev
, pm_message_t state
)
113 struct of_device
* of_dev
= to_of_device(dev
);
114 struct of_platform_driver
* drv
= to_of_platform_driver(dev
->driver
);
117 if (dev
->driver
&& drv
->suspend
)
118 error
= drv
->suspend(of_dev
, state
);
122 static int of_platform_device_resume(struct device
* dev
)
124 struct of_device
* of_dev
= to_of_device(dev
);
125 struct of_platform_driver
* drv
= to_of_platform_driver(dev
->driver
);
128 if (dev
->driver
&& drv
->resume
)
129 error
= drv
->resume(of_dev
);
133 struct bus_type of_platform_bus_type
= {
134 .name
= "of_platform",
135 .match
= of_platform_bus_match
,
136 .probe
= of_platform_device_probe
,
137 .remove
= of_platform_device_remove
,
138 .suspend
= of_platform_device_suspend
,
139 .resume
= of_platform_device_resume
,
141 EXPORT_SYMBOL(of_platform_bus_type
);
143 static int __init
of_bus_driver_init(void)
145 return bus_register(&of_platform_bus_type
);
148 postcore_initcall(of_bus_driver_init
);
150 int of_register_platform_driver(struct of_platform_driver
*drv
)
152 /* initialize common driver fields */
153 drv
->driver
.name
= drv
->name
;
154 drv
->driver
.bus
= &of_platform_bus_type
;
156 /* register with core */
157 return driver_register(&drv
->driver
);
159 EXPORT_SYMBOL(of_register_platform_driver
);
161 void of_unregister_platform_driver(struct of_platform_driver
*drv
)
163 driver_unregister(&drv
->driver
);
165 EXPORT_SYMBOL(of_unregister_platform_driver
);
167 static void of_platform_make_bus_id(struct of_device
*dev
)
169 struct device_node
*node
= dev
->node
;
170 char *name
= dev
->dev
.bus_id
;
176 * If it's a DCR based device, use 'd' for native DCRs
177 * and 'D' for MMIO DCRs.
179 #ifdef CONFIG_PPC_DCR
180 reg
= get_property(node
, "dcr-reg", NULL
);
182 #ifdef CONFIG_PPC_DCR_NATIVE
183 snprintf(name
, BUS_ID_SIZE
, "d%x.%s",
185 #else /* CONFIG_PPC_DCR_NATIVE */
186 addr
= of_translate_dcr_address(node
, *reg
, NULL
);
187 if (addr
!= OF_BAD_ADDR
) {
188 snprintf(name
, BUS_ID_SIZE
,
189 "D%llx.%s", (unsigned long long)addr
,
193 #endif /* !CONFIG_PPC_DCR_NATIVE */
195 #endif /* CONFIG_PPC_DCR */
198 * For MMIO, get the physical address
200 reg
= get_property(node
, "reg", NULL
);
202 addr
= of_translate_address(node
, reg
);
203 if (addr
!= OF_BAD_ADDR
) {
204 snprintf(name
, BUS_ID_SIZE
,
205 "%llx.%s", (unsigned long long)addr
,
212 * No BusID, use the node name and add a globally incremented
213 * counter (and pray...)
215 magic
= atomic_add_return(1, &bus_no_reg_magic
);
216 snprintf(name
, BUS_ID_SIZE
, "%s.%d", node
->name
, magic
- 1);
219 struct of_device
* of_platform_device_create(struct device_node
*np
,
221 struct device
*parent
)
223 struct of_device
*dev
;
225 dev
= kmalloc(sizeof(*dev
), GFP_KERNEL
);
228 memset(dev
, 0, sizeof(*dev
));
230 dev
->node
= of_node_get(np
);
231 dev
->dma_mask
= 0xffffffffUL
;
232 dev
->dev
.dma_mask
= &dev
->dma_mask
;
233 dev
->dev
.parent
= parent
;
234 dev
->dev
.bus
= &of_platform_bus_type
;
235 dev
->dev
.release
= of_release_dev
;
236 dev
->dev
.archdata
.of_node
= np
;
237 dev
->dev
.archdata
.numa_node
= of_node_to_nid(np
);
239 /* We do not fill the DMA ops for platform devices by default.
240 * This is currently the responsibility of the platform code
241 * to do such, possibly using a device notifier
245 strlcpy(dev
->dev
.bus_id
, bus_id
, BUS_ID_SIZE
);
247 of_platform_make_bus_id(dev
);
249 if (of_device_register(dev
) != 0) {
256 EXPORT_SYMBOL(of_platform_device_create
);
261 * of_platform_bus_create - Create an OF device for a bus node and all its
262 * children. Optionally recursively instanciate matching busses.
263 * @bus: device node of the bus to instanciate
264 * @matches: match table, NULL to use the default, OF_NO_DEEP_PROBE to
265 * disallow recursive creation of child busses
267 static int of_platform_bus_create(struct device_node
*bus
,
268 struct of_device_id
*matches
,
269 struct device
*parent
)
271 struct device_node
*child
;
272 struct of_device
*dev
;
275 for (child
= NULL
; (child
= of_get_next_child(bus
, child
)); ) {
276 pr_debug(" create child: %s\n", child
->full_name
);
277 dev
= of_platform_device_create(child
, NULL
, parent
);
280 else if (!of_match_node(matches
, child
))
283 pr_debug(" and sub busses\n");
284 rc
= of_platform_bus_create(child
, matches
, &dev
->dev
);
294 * of_platform_bus_probe - Probe the device-tree for platform busses
295 * @root: parent of the first level to probe or NULL for the root of the tree
296 * @matches: match table, NULL to use the default
297 * @parent: parent to hook devices from, NULL for toplevel
299 * Note that children of the provided root are not instanciated as devices
300 * unless the specified root itself matches the bus list and is not NULL.
303 int of_platform_bus_probe(struct device_node
*root
,
304 struct of_device_id
*matches
,
305 struct device
*parent
)
307 struct device_node
*child
;
308 struct of_device
*dev
;
312 matches
= of_default_bus_ids
;
313 if (matches
== OF_NO_DEEP_PROBE
)
316 root
= of_find_node_by_path("/");
320 pr_debug("of_platform_bus_probe()\n");
321 pr_debug(" starting at: %s\n", root
->full_name
);
323 /* Do a self check of bus type, if there's a match, create
326 if (of_match_node(matches
, root
)) {
327 pr_debug(" root match, create all sub devices\n");
328 dev
= of_platform_device_create(root
, NULL
, parent
);
333 pr_debug(" create all sub busses\n");
334 rc
= of_platform_bus_create(root
, matches
, &dev
->dev
);
337 for (child
= NULL
; (child
= of_get_next_child(root
, child
)); ) {
338 if (!of_match_node(matches
, child
))
341 pr_debug(" match: %s\n", child
->full_name
);
342 dev
= of_platform_device_create(child
, NULL
, parent
);
346 rc
= of_platform_bus_create(child
, matches
, &dev
->dev
);
356 EXPORT_SYMBOL(of_platform_bus_probe
);
358 static int of_dev_node_match(struct device
*dev
, void *data
)
360 return to_of_device(dev
)->node
== data
;
363 struct of_device
*of_find_device_by_node(struct device_node
*np
)
367 dev
= bus_find_device(&of_platform_bus_type
,
368 NULL
, np
, of_dev_node_match
);
370 return to_of_device(dev
);
373 EXPORT_SYMBOL(of_find_device_by_node
);
375 static int of_dev_phandle_match(struct device
*dev
, void *data
)
378 return to_of_device(dev
)->node
->linux_phandle
== *ph
;
381 struct of_device
*of_find_device_by_phandle(phandle ph
)
385 dev
= bus_find_device(&of_platform_bus_type
,
386 NULL
, &ph
, of_dev_phandle_match
);
388 return to_of_device(dev
);
391 EXPORT_SYMBOL(of_find_device_by_phandle
);
394 #ifdef CONFIG_PPC_OF_PLATFORM_PCI
396 /* The probing of PCI controllers from of_platform is currently
397 * 64 bits only, mostly due to gratuitous differences between
398 * the 32 and 64 bits PCI code on PowerPC and the 32 bits one
399 * lacking some bits needed here.
402 static int __devinit
of_pci_phb_probe(struct of_device
*dev
,
403 const struct of_device_id
*match
)
405 struct pci_controller
*phb
;
407 /* Check if we can do that ... */
408 if (ppc_md
.pci_setup_phb
== NULL
)
411 printk(KERN_INFO
"Setting up PCI bus %s\n", dev
->node
->full_name
);
413 /* Alloc and setup PHB data structure */
414 phb
= pcibios_alloc_controller(dev
->node
);
418 /* Setup parent in sysfs */
419 phb
->parent
= &dev
->dev
;
421 /* Setup the PHB using arch provided callback */
422 if (ppc_md
.pci_setup_phb(phb
)) {
423 pcibios_free_controller(phb
);
427 /* Process "ranges" property */
428 pci_process_bridge_OF_ranges(phb
, dev
->node
, 0);
431 * This will not work properly for ISA IOs, something needs to be done
432 * about it if we ever generalize that way of probing PCI brigdes
434 pci_setup_phb_io_dynamic(phb
, 0);
436 /* Init pci_dn data structures */
437 pci_devs_phb_init_dynamic(phb
);
439 /* Register devices with EEH */
441 if (dev
->node
->child
)
442 eeh_add_device_tree_early(dev
->node
);
443 #endif /* CONFIG_EEH */
448 /* Claim resources. This might need some rework as well depending
449 * wether we are doing probe-only or not, like assigning unassigned
452 pcibios_claim_one_bus(phb
->bus
);
454 /* Finish EEH setup */
456 eeh_add_device_tree_late(phb
->bus
);
459 /* Add probed PCI devices to the device model */
460 pci_bus_add_devices(phb
->bus
);
465 static struct of_device_id of_pci_phb_ids
[] = {
469 { .type
= "pciex", },
474 static struct of_platform_driver of_pci_phb_driver
= {
476 .match_table
= of_pci_phb_ids
,
477 .probe
= of_pci_phb_probe
,
480 static __init
int of_pci_phb_init(void)
482 return of_register_platform_driver(&of_pci_phb_driver
);
485 device_initcall(of_pci_phb_init
);
487 #endif /* CONFIG_PPC_OF_PLATFORM_PCI */