[deliverable/linux.git] / arch / sparc / kernel / of_device.c

#include <linux/string.h>
#include <linux/kernel.h>
#include <linux/of.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/mod_devicetable.h>
#include <linux/slab.h>

#include <asm/errno.h>
#include <asm/of_device.h>

static int of_platform_bus_match(struct device *dev, struct device_driver *drv)
{
	struct of_device * of_dev = to_of_device(dev);
	struct of_platform_driver * of_drv = to_of_platform_driver(drv);
	const struct of_device_id * matches = of_drv->match_table;

	if (!matches)
		return 0;

	return of_match_device(matches, of_dev) != NULL;
}

static int of_platform_device_probe(struct device *dev)
{
	int error = -ENODEV;
	struct of_platform_driver *drv;
	struct of_device *of_dev;
	const struct of_device_id *match;

	drv = to_of_platform_driver(dev->driver);
	of_dev = to_of_device(dev);

	if (!drv->probe)
		return error;

	of_dev_get(of_dev);

	match = of_match_device(drv->match_table, of_dev);
	if (match)
		error = drv->probe(of_dev, match);
	if (error)
		of_dev_put(of_dev);

	return error;
}

static int of_platform_device_remove(struct device *dev)
{
	struct of_device * of_dev = to_of_device(dev);
	struct of_platform_driver * drv = to_of_platform_driver(dev->driver);

	if (dev->driver && drv->remove)
		drv->remove(of_dev);
	return 0;
}

static int of_platform_device_suspend(struct device *dev, pm_message_t state)
{
	struct of_device * of_dev = to_of_device(dev);
	struct of_platform_driver * drv = to_of_platform_driver(dev->driver);
	int error = 0;

	if (dev->driver && drv->suspend)
		error = drv->suspend(of_dev, state);
	return error;
}

static int of_platform_device_resume(struct device * dev)
{
	struct of_device * of_dev = to_of_device(dev);
	struct of_platform_driver * drv = to_of_platform_driver(dev->driver);
	int error = 0;

	if (dev->driver && drv->resume)
		error = drv->resume(of_dev);
	return error;
}

static int node_match(struct device *dev, void *data)
{
	struct of_device *op = to_of_device(dev);
	struct device_node *dp = data;

	return (op->node == dp);
}

struct of_device *of_find_device_by_node(struct device_node *dp)
{
	struct device *dev = bus_find_device(&of_platform_bus_type, NULL,
					     dp, node_match);

	if (dev)
		return to_of_device(dev);

	return NULL;
}
EXPORT_SYMBOL(of_find_device_by_node);

#ifdef CONFIG_PCI
struct bus_type ebus_bus_type = {
       .name	= "ebus",
       .match	= of_platform_bus_match,
       .probe	= of_platform_device_probe,
       .remove	= of_platform_device_remove,
       .suspend	= of_platform_device_suspend,
       .resume	= of_platform_device_resume,
};
EXPORT_SYMBOL(ebus_bus_type);
#endif

#ifdef CONFIG_SBUS
struct bus_type sbus_bus_type = {
       .name	= "sbus",
       .match	= of_platform_bus_match,
       .probe	= of_platform_device_probe,
       .remove	= of_platform_device_remove,
       .suspend	= of_platform_device_suspend,
       .resume	= of_platform_device_resume,
};
EXPORT_SYMBOL(sbus_bus_type);
#endif

struct bus_type of_platform_bus_type = {
       .name	= "of",
       .match	= of_platform_bus_match,
       .probe	= of_platform_device_probe,
       .remove	= of_platform_device_remove,
       .suspend	= of_platform_device_suspend,
       .resume	= of_platform_device_resume,
};
EXPORT_SYMBOL(of_platform_bus_type);

static inline u64 of_read_addr(const u32 *cell, int size)
{
	u64 r = 0;
	while (size--)
		r = (r << 32) | *(cell++);
	return r;
}

static void __init get_cells(struct device_node *dp,
			     int *addrc, int *sizec)
{
	if (addrc)
		*addrc = of_n_addr_cells(dp);
	if (sizec)
		*sizec = of_n_size_cells(dp);
}

/* Max address size we deal with */
#define OF_MAX_ADDR_CELLS	4

struct of_bus {
	const char	*name;
	const char	*addr_prop_name;
	int		(*match)(struct device_node *parent);
	void		(*count_cells)(struct device_node *child,
				       int *addrc, int *sizec);
	int		(*map)(u32 *addr, const u32 *range,
			       int na, int ns, int pna);
	unsigned int	(*get_flags)(const u32 *addr);
};

/*
 * Default translator (generic bus)
 */

static void of_bus_default_count_cells(struct device_node *dev,
				       int *addrc, int *sizec)
{
	get_cells(dev, addrc, sizec);
}

/* Make sure the least significant 64-bits are in-range.  Even
 * for 3 or 4 cell values it is a good enough approximation.
 */
static int of_out_of_range(const u32 *addr, const u32 *base,
			   const u32 *size, int na, int ns)
{
	u64 a = of_read_addr(addr, na);
	u64 b = of_read_addr(base, na);

	if (a < b)
		return 1;

	b += of_read_addr(size, ns);
	if (a >= b)
		return 1;

	return 0;
}

static int of_bus_default_map(u32 *addr, const u32 *range,
			      int na, int ns, int pna)
{
	u32 result[OF_MAX_ADDR_CELLS];
	int i;

	if (ns > 2) {
		printk("of_device: Cannot handle size cells (%d) > 2.", ns);
		return -EINVAL;
	}

	if (of_out_of_range(addr, range, range + na + pna, na, ns))
		return -EINVAL;

	/* Start with the parent range base.  */
	memcpy(result, range + na, pna * 4);

	/* Add in the child address offset.  */
	for (i = 0; i < na; i++)
		result[pna - 1 - i] +=
			(addr[na - 1 - i] -
			 range[na - 1 - i]);

	memcpy(addr, result, pna * 4);

	return 0;
}

static unsigned int of_bus_default_get_flags(const u32 *addr)
{
	return IORESOURCE_MEM;
}

/*
 * PCI bus specific translator
 */

static int of_bus_pci_match(struct device_node *np)
{
	if (!strcmp(np->type, "pci") || !strcmp(np->type, "pciex")) {
		/* Do not do PCI specific frobbing if the
		 * PCI bridge lacks a ranges property.  We
		 * want to pass it through up to the next
		 * parent as-is, not with the PCI translate
		 * method which chops off the top address cell.
		 */
		if (!of_find_property(np, "ranges", NULL))
			return 0;

		return 1;
	}

	return 0;
}

static void of_bus_pci_count_cells(struct device_node *np,
				   int *addrc, int *sizec)
{
	if (addrc)
		*addrc = 3;
	if (sizec)
		*sizec = 2;
}

static int of_bus_pci_map(u32 *addr, const u32 *range,
			  int na, int ns, int pna)
{
	u32 result[OF_MAX_ADDR_CELLS];
	int i;

	/* Check address type match */
	if ((addr[0] ^ range[0]) & 0x03000000)
		return -EINVAL;

	if (of_out_of_range(addr + 1, range + 1, range + na + pna,
			    na - 1, ns))
		return -EINVAL;

	/* Start with the parent range base.  */
	memcpy(result, range + na, pna * 4);

	/* Add in the child address offset, skipping high cell.  */
	for (i = 0; i < na - 1; i++)
		result[pna - 1 - i] +=
			(addr[na - 1 - i] -
			 range[na - 1 - i]);

	memcpy(addr, result, pna * 4);

	return 0;
}

static unsigned int of_bus_pci_get_flags(const u32 *addr)
{
	unsigned int flags = 0;
	u32 w = addr[0];

	switch((w >> 24) & 0x03) {
	case 0x01:
		flags |= IORESOURCE_IO;
	case 0x02: /* 32 bits */
	case 0x03: /* 64 bits */
		flags |= IORESOURCE_MEM;
	}
	if (w & 0x40000000)
		flags |= IORESOURCE_PREFETCH;
	return flags;
}

/*
 * SBUS bus specific translator
 */

static int of_bus_sbus_match(struct device_node *np)
{
	return !strcmp(np->name, "sbus") ||
		!strcmp(np->name, "sbi");
}

static void of_bus_sbus_count_cells(struct device_node *child,
				   int *addrc, int *sizec)
{
	if (addrc)
		*addrc = 2;
	if (sizec)
		*sizec = 1;
}

static int of_bus_sbus_map(u32 *addr, const u32 *range, int na, int ns, int pna)
{
	return of_bus_default_map(addr, range, na, ns, pna);
}

static unsigned int of_bus_sbus_get_flags(const u32 *addr)
{
	return IORESOURCE_MEM;
}


/*
 * Array of bus specific translators
 */

static struct of_bus of_busses[] = {
	/* PCI */
	{
		.name = "pci",
		.addr_prop_name = "assigned-addresses",
		.match = of_bus_pci_match,
		.count_cells = of_bus_pci_count_cells,
		.map = of_bus_pci_map,
		.get_flags = of_bus_pci_get_flags,
	},
	/* SBUS */
	{
		.name = "sbus",
		.addr_prop_name = "reg",
		.match = of_bus_sbus_match,
		.count_cells = of_bus_sbus_count_cells,
		.map = of_bus_sbus_map,
		.get_flags = of_bus_sbus_get_flags,
	},
	/* Default */
	{
		.name = "default",
		.addr_prop_name = "reg",
		.match = NULL,
		.count_cells = of_bus_default_count_cells,
		.map = of_bus_default_map,
		.get_flags = of_bus_default_get_flags,
	},
};

static struct of_bus *of_match_bus(struct device_node *np)
{
	int i;

	for (i = 0; i < ARRAY_SIZE(of_busses); i ++)
		if (!of_busses[i].match || of_busses[i].match(np))
			return &of_busses[i];
	BUG();
	return NULL;
}

static int __init build_one_resource(struct device_node *parent,
				     struct of_bus *bus,
				     struct of_bus *pbus,
				     u32 *addr,
				     int na, int ns, int pna)
{
	const u32 *ranges;
	unsigned int rlen;
	int rone;

	ranges = of_get_property(parent, "ranges", &rlen);
	if (ranges == NULL || rlen == 0) {
		u32 result[OF_MAX_ADDR_CELLS];
		int i;

		memset(result, 0, pna * 4);
		for (i = 0; i < na; i++)
			result[pna - 1 - i] =
				addr[na - 1 - i];

		memcpy(addr, result, pna * 4);
		return 0;
	}

	/* Now walk through the ranges */
	rlen /= 4;
	rone = na + pna + ns;
	for (; rlen >= rone; rlen -= rone, ranges += rone) {
		if (!bus->map(addr, ranges, na, ns, pna))
			return 0;
	}

	return 1;
}

static int of_resource_verbose;

static void __init build_device_resources(struct of_device *op,
					  struct device *parent)
{
	struct of_device *p_op;
	struct of_bus *bus;
	int na, ns;
	int index, num_reg;
	const void *preg;

	if (!parent)
		return;

	p_op = to_of_device(parent);
	bus = of_match_bus(p_op->node);
	bus->count_cells(op->node, &na, &ns);

	preg = of_get_property(op->node, bus->addr_prop_name, &num_reg);
	if (!preg || num_reg == 0)
		return;

	/* Convert to num-cells.  */
	num_reg /= 4;

	/* Conver to num-entries.  */
	num_reg /= na + ns;

	for (index = 0; index < num_reg; index++) {
		struct resource *r = &op->resource[index];
		u32 addr[OF_MAX_ADDR_CELLS];
		const u32 *reg = (preg + (index * ((na + ns) * 4)));
		struct device_node *dp = op->node;
		struct device_node *pp = p_op->node;
		struct of_bus *pbus, *dbus;
		u64 size, result = OF_BAD_ADDR;
		unsigned long flags;
		int dna, dns;
		int pna, pns;

		size = of_read_addr(reg + na, ns);
		flags = bus->get_flags(reg);

		memcpy(addr, reg, na * 4);

		/* If the immediate parent has no ranges property to apply,
		 * just use a 1<->1 mapping.
		 */
		if (of_find_property(pp, "ranges", NULL) == NULL) {
			result = of_read_addr(addr, na);
			goto build_res;
		}

		dna = na;
		dns = ns;
		dbus = bus;

		while (1) {
			dp = pp;
			pp = dp->parent;
			if (!pp) {
				result = of_read_addr(addr, dna);
				break;
			}

			pbus = of_match_bus(pp);
			pbus->count_cells(dp, &pna, &pns);

			if (build_one_resource(dp, dbus, pbus, addr,
					       dna, dns, pna))
				break;

			dna = pna;
			dns = pns;
			dbus = pbus;
		}

	build_res:
		memset(r, 0, sizeof(*r));

		if (of_resource_verbose)
			printk("%s reg[%d] -> %llx\n",
			       op->node->full_name, index,
			       result);

		if (result != OF_BAD_ADDR) {
			r->start = result & 0xffffffff;
			r->end = result + size - 1;
			r->flags = flags | ((result >> 32ULL) & 0xffUL);
		}
		r->name = op->node->name;
	}
}

static struct of_device * __init scan_one_device(struct device_node *dp,
						 struct device *parent)
{
	struct of_device *op = kzalloc(sizeof(*op), GFP_KERNEL);
	const struct linux_prom_irqs *intr;
	int len, i;

	if (!op)
		return NULL;

	op->node = dp;

	op->clock_freq = of_getintprop_default(dp, "clock-frequency",
					       (25*1000*1000));
	op->portid = of_getintprop_default(dp, "upa-portid", -1);
	if (op->portid == -1)
		op->portid = of_getintprop_default(dp, "portid", -1);

	intr = of_get_property(dp, "intr", &len);
	if (intr) {
		op->num_irqs = len / sizeof(struct linux_prom_irqs);
		for (i = 0; i < op->num_irqs; i++)
			op->irqs[i] = intr[i].pri;
	} else {
		const unsigned int *irq =
			of_get_property(dp, "interrupts", &len);

		if (irq) {
			op->num_irqs = len / sizeof(unsigned int);
			for (i = 0; i < op->num_irqs; i++)
				op->irqs[i] = irq[i];
		} else {
			op->num_irqs = 0;
		}
	}
	if (sparc_cpu_model == sun4d) {
		static int pil_to_sbus[] = {
			0, 0, 1, 2, 0, 3, 0, 4, 0, 5, 0, 6, 0, 7, 0, 0,
		};
		struct device_node *io_unit, *sbi = dp->parent;
		const struct linux_prom_registers *regs;
		int board, slot;

		while (sbi) {
			if (!strcmp(sbi->name, "sbi"))
				break;

			sbi = sbi->parent;
		}
		if (!sbi)
			goto build_resources;

		regs = of_get_property(dp, "reg", NULL);
		if (!regs)
			goto build_resources;

		slot = regs->which_io;

		/* If SBI's parent is not io-unit or the io-unit lacks
		 * a "board#" property, something is very wrong.
		 */
		if (!sbi->parent || strcmp(sbi->parent->name, "io-unit")) {
			printk("%s: Error, parent is not io-unit.\n",
			       sbi->full_name);
			goto build_resources;
		}
		io_unit = sbi->parent;
		board = of_getintprop_default(io_unit, "board#", -1);
		if (board == -1) {
			printk("%s: Error, lacks board# property.\n",
			       io_unit->full_name);
			goto build_resources;
		}

		for (i = 0; i < op->num_irqs; i++) {
			int this_irq = op->irqs[i];
			int sbusl = pil_to_sbus[this_irq];

			if (sbusl)
				this_irq = (((board + 1) << 5) +
					    (sbusl << 2) +
					    slot);

			op->irqs[i] = this_irq;
		}
	}

build_resources:
	build_device_resources(op, parent);

	op->dev.parent = parent;
	op->dev.bus = &of_platform_bus_type;
	if (!parent)
		strcpy(op->dev.bus_id, "root");
	else
		sprintf(op->dev.bus_id, "%08x", dp->node);

	if (of_device_register(op)) {
		printk("%s: Could not register of device.\n",
		       dp->full_name);
		kfree(op);
		op = NULL;
	}

	return op;
}

static void __init scan_tree(struct device_node *dp, struct device *parent)
{
	while (dp) {
		struct of_device *op = scan_one_device(dp, parent);

		if (op)
			scan_tree(dp->child, &op->dev);

		dp = dp->sibling;
	}
}

static void __init scan_of_devices(void)
{
	struct device_node *root = of_find_node_by_path("/");
	struct of_device *parent;

	parent = scan_one_device(root, NULL);
	if (!parent)
		return;

	scan_tree(root->child, &parent->dev);
}

static int __init of_bus_driver_init(void)
{
	int err;

	err = bus_register(&of_platform_bus_type);
#ifdef CONFIG_PCI
	if (!err)
		err = bus_register(&ebus_bus_type);
#endif
#ifdef CONFIG_SBUS
	if (!err)
		err = bus_register(&sbus_bus_type);
#endif

	if (!err)
		scan_of_devices();

	return err;
}

postcore_initcall(of_bus_driver_init);

static int __init of_debug(char *str)
{
	int val = 0;

	get_option(&str, &val);
	if (val & 1)
		of_resource_verbose = 1;
	return 1;
}

__setup("of_debug=", of_debug);

int of_register_driver(struct of_platform_driver *drv, struct bus_type *bus)
{
	/* initialize common driver fields */
	drv->driver.name = drv->name;
	drv->driver.bus = bus;

	/* register with core */
	return driver_register(&drv->driver);
}

void of_unregister_driver(struct of_platform_driver *drv)
{
	driver_unregister(&drv->driver);
}

struct of_device* of_platform_device_create(struct device_node *np,
					    const char *bus_id,
					    struct device *parent,
					    struct bus_type *bus)
{
	struct of_device *dev;

	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
	if (!dev)
		return NULL;

	dev->dev.parent = parent;
	dev->dev.bus = bus;
	dev->dev.release = of_release_dev;

	strlcpy(dev->dev.bus_id, bus_id, BUS_ID_SIZE);

	if (of_device_register(dev) != 0) {
		kfree(dev);
		return NULL;
	}

	return dev;
}

EXPORT_SYMBOL(of_register_driver);
EXPORT_SYMBOL(of_unregister_driver);
EXPORT_SYMBOL(of_platform_device_create);
Commit	Line	Data
fd531431 DM	1	#include <linux/string.h>
fd531431 DM	2	#include <linux/kernel.h>
f85ff305	3	#include <linux/of.h>
fd531431 DM	4	#include <linux/init.h>
	5	#include <linux/module.h>
	6	#include <linux/mod_devicetable.h>
	7	#include <linux/slab.h>
	8
	9	#include <asm/errno.h>
	10	#include <asm/of_device.h>
	11
fd531431 DM	12	static int of_platform_bus_match(struct device dev, struct device_driver drv)
	13	{
	14	struct of_device * of_dev = to_of_device(dev);
	15	struct of_platform_driver * of_drv = to_of_platform_driver(drv);
	16	const struct of_device_id * matches = of_drv->match_table;
	17
	18	if (!matches)
	19	return 0;
	20
	21	return of_match_device(matches, of_dev) != NULL;
	22	}
	23
37b7754a	24	static int of_platform_device_probe(struct device *dev)
fd531431 DM	25	{
	26	int error = -ENODEV;
	27	struct of_platform_driver *drv;
	28	struct of_device *of_dev;
	29	const struct of_device_id *match;
	30
	31	drv = to_of_platform_driver(dev->driver);
	32	of_dev = to_of_device(dev);
	33
	34	if (!drv->probe)
	35	return error;
	36
	37	of_dev_get(of_dev);
	38
	39	match = of_match_device(drv->match_table, of_dev);
	40	if (match)
	41	error = drv->probe(of_dev, match);
	42	if (error)
	43	of_dev_put(of_dev);
	44
	45	return error;
	46	}
	47
37b7754a	48	static int of_platform_device_remove(struct device *dev)
fd531431 DM	49	{
	50	struct of_device * of_dev = to_of_device(dev);
	51	struct of_platform_driver * drv = to_of_platform_driver(dev->driver);
	52
	53	if (dev->driver && drv->remove)
	54	drv->remove(of_dev);
	55	return 0;
	56	}
	57
37b7754a	58	static int of_platform_device_suspend(struct device *dev, pm_message_t state)
fd531431 DM	59	{
	60	struct of_device * of_dev = to_of_device(dev);
	61	struct of_platform_driver * drv = to_of_platform_driver(dev->driver);
	62	int error = 0;
	63
	64	if (dev->driver && drv->suspend)
	65	error = drv->suspend(of_dev, state);
	66	return error;
	67	}
	68
37b7754a	69	static int of_platform_device_resume(struct device * dev)
fd531431 DM	70	{
	71	struct of_device * of_dev = to_of_device(dev);
	72	struct of_platform_driver * drv = to_of_platform_driver(dev->driver);
	73	int error = 0;
	74
	75	if (dev->driver && drv->resume)
	76	error = drv->resume(of_dev);
	77	return error;
	78	}
	79
8f96cd1a DM	80	static int node_match(struct device dev, void data)
	81	{
	82	struct of_device *op = to_of_device(dev);
	83	struct device_node *dp = data;
	84
	85	return (op->node == dp);
	86	}
	87
	88	struct of_device of_find_device_by_node(struct device_node dp)
	89	{
37b7754a	90	struct device *dev = bus_find_device(&of_platform_bus_type, NULL,
8f96cd1a DM	91	dp, node_match);
	92
	93	if (dev)
	94	return to_of_device(dev);
	95
	96	return NULL;
	97	}
	98	EXPORT_SYMBOL(of_find_device_by_node);
	99
fd531431 DM	100	#ifdef CONFIG_PCI
	101	struct bus_type ebus_bus_type = {
	102	.name = "ebus",
	103	.match = of_platform_bus_match,
37b7754a SR	104	.probe = of_platform_device_probe,
	105	.remove = of_platform_device_remove,
	106	.suspend = of_platform_device_suspend,
	107	.resume = of_platform_device_resume,
fd531431	108	};
69853918	109	EXPORT_SYMBOL(ebus_bus_type);
fd531431 DM	110	#endif
	111
	112	#ifdef CONFIG_SBUS
	113	struct bus_type sbus_bus_type = {
	114	.name = "sbus",
	115	.match = of_platform_bus_match,
37b7754a SR	116	.probe = of_platform_device_probe,
	117	.remove = of_platform_device_remove,
	118	.suspend = of_platform_device_suspend,
	119	.resume = of_platform_device_resume,
fd531431	120	};
69853918	121	EXPORT_SYMBOL(sbus_bus_type);
fd531431 DM	122	#endif
fd531431 DM	123
37b7754a	124	struct bus_type of_platform_bus_type = {
cf44bbc2 DM	125	.name = "of",
cf44bbc2 DM	126	.match = of_platform_bus_match,
37b7754a SR	127	.probe = of_platform_device_probe,
	128	.remove = of_platform_device_remove,
	129	.suspend = of_platform_device_suspend,
	130	.resume = of_platform_device_resume,
cf44bbc2	131	};
37b7754a	132	EXPORT_SYMBOL(of_platform_bus_type);
cf44bbc2	133
a83f9823	134	static inline u64 of_read_addr(const u32 *cell, int size)
cf44bbc2 DM	135	{
	136	u64 r = 0;
	137	while (size--)
	138	r = (r << 32) \| *(cell++);
	139	return r;
	140	}
	141
	142	static void __init get_cells(struct device_node *dp,
	143	int addrc, int sizec)
	144	{
	145	if (addrc)
	146	*addrc = of_n_addr_cells(dp);
	147	if (sizec)
	148	*sizec = of_n_size_cells(dp);
	149	}
	150
	151	/* Max address size we deal with */
	152	#define OF_MAX_ADDR_CELLS 4
	153
	154	struct of_bus {
	155	const char *name;
	156	const char *addr_prop_name;
	157	int (match)(struct device_node parent);
	158	void (count_cells)(struct device_node child,
	159	int addrc, int sizec);
a83f9823 DM	160	int (map)(u32 addr, const u32 *range,
a83f9823 DM	161	int na, int ns, int pna);
8271f042	162	unsigned int (get_flags)(const u32 addr);
cf44bbc2 DM	163	};
	164
	165	/*
	166	* Default translator (generic bus)
	167	*/
	168
	169	static void of_bus_default_count_cells(struct device_node *dev,
	170	int addrc, int sizec)
	171	{
	172	get_cells(dev, addrc, sizec);
	173	}
	174
a83f9823 DM	175	/* Make sure the least significant 64-bits are in-range. Even
	176	* for 3 or 4 cell values it is a good enough approximation.
	177	*/
	178	static int of_out_of_range(const u32 addr, const u32 base,
	179	const u32 *size, int na, int ns)
cf44bbc2	180	{
a83f9823 DM	181	u64 a = of_read_addr(addr, na);
	182	u64 b = of_read_addr(base, na);
	183
	184	if (a < b)
	185	return 1;
cf44bbc2	186
a83f9823 DM	187	b += of_read_addr(size, ns);
	188	if (a >= b)
	189	return 1;
cf44bbc2	190
a83f9823	191	return 0;
cf44bbc2 DM	192	}
cf44bbc2 DM	193
a83f9823 DM	194	static int of_bus_default_map(u32 addr, const u32 range,
a83f9823 DM	195	int na, int ns, int pna)
cf44bbc2	196	{
a83f9823 DM	197	u32 result[OF_MAX_ADDR_CELLS];
	198	int i;
	199
	200	if (ns > 2) {
	201	printk("of_device: Cannot handle size cells (%d) > 2.", ns);
	202	return -EINVAL;
	203	}
	204
	205	if (of_out_of_range(addr, range, range + na + pna, na, ns))
	206	return -EINVAL;
	207
	208	/* Start with the parent range base. */
	209	memcpy(result, range + na, pna * 4);
	210
	211	/* Add in the child address offset. */
	212	for (i = 0; i < na; i++)
	213	result[pna - 1 - i] +=
	214	(addr[na - 1 - i] -
	215	range[na - 1 - i]);
	216
	217	memcpy(addr, result, pna * 4);
cf44bbc2 DM	218
	219	return 0;
	220	}
	221
8271f042	222	static unsigned int of_bus_default_get_flags(const u32 *addr)
cf44bbc2 DM	223	{
	224	return IORESOURCE_MEM;
	225	}
	226
cf44bbc2 DM	227	/*
	228	* PCI bus specific translator
	229	*/
	230
	231	static int of_bus_pci_match(struct device_node *np)
	232	{
a83f9823 DM	233	if (!strcmp(np->type, "pci") \|\| !strcmp(np->type, "pciex")) {
	234	/* Do not do PCI specific frobbing if the
	235	* PCI bridge lacks a ranges property. We
	236	* want to pass it through up to the next
	237	* parent as-is, not with the PCI translate
	238	* method which chops off the top address cell.
	239	*/
	240	if (!of_find_property(np, "ranges", NULL))
	241	return 0;
	242
	243	return 1;
	244	}
	245
	246	return 0;
cf44bbc2 DM	247	}
	248
	249	static void of_bus_pci_count_cells(struct device_node *np,
	250	int addrc, int sizec)
	251	{
	252	if (addrc)
	253	*addrc = 3;
	254	if (sizec)
	255	*sizec = 2;
	256	}
	257
a83f9823 DM	258	static int of_bus_pci_map(u32 addr, const u32 range,
a83f9823 DM	259	int na, int ns, int pna)
cf44bbc2	260	{
a83f9823 DM	261	u32 result[OF_MAX_ADDR_CELLS];
a83f9823 DM	262	int i;
cf44bbc2 DM	263
	264	/* Check address type match */
	265	if ((addr[0] ^ range[0]) & 0x03000000)
a83f9823	266	return -EINVAL;
cf44bbc2	267
a83f9823 DM	268	if (of_out_of_range(addr + 1, range + 1, range + na + pna,
	269	na - 1, ns))
	270	return -EINVAL;
cf44bbc2	271
a83f9823 DM	272	/* Start with the parent range base. */
a83f9823 DM	273	memcpy(result, range + na, pna * 4);
cf44bbc2	274
a83f9823 DM	275	/* Add in the child address offset, skipping high cell. */
	276	for (i = 0; i < na - 1; i++)
	277	result[pna - 1 - i] +=
	278	(addr[na - 1 - i] -
	279	range[na - 1 - i]);
	280
	281	memcpy(addr, result, pna * 4);
	282
	283	return 0;
cf44bbc2 DM	284	}
cf44bbc2 DM	285
8271f042	286	static unsigned int of_bus_pci_get_flags(const u32 *addr)
cf44bbc2 DM	287	{
	288	unsigned int flags = 0;
	289	u32 w = addr[0];
	290
	291	switch((w >> 24) & 0x03) {
	292	case 0x01:
	293	flags \|= IORESOURCE_IO;
	294	case 0x02: /* 32 bits */
	295	case 0x03: /* 64 bits */
	296	flags \|= IORESOURCE_MEM;
	297	}
	298	if (w & 0x40000000)
	299	flags \|= IORESOURCE_PREFETCH;
	300	return flags;
	301	}
	302
	303	/*
	304	* SBUS bus specific translator
	305	*/
	306
	307	static int of_bus_sbus_match(struct device_node *np)
	308	{
	309	return !strcmp(np->name, "sbus") \|\|
	310	!strcmp(np->name, "sbi");
	311	}
	312
	313	static void of_bus_sbus_count_cells(struct device_node *child,
	314	int addrc, int sizec)
	315	{
	316	if (addrc)
	317	*addrc = 2;
	318	if (sizec)
	319	*sizec = 1;
	320	}
	321
a83f9823	322	static int of_bus_sbus_map(u32 addr, const u32 range, int na, int ns, int pna)
cf44bbc2 DM	323	{
	324	return of_bus_default_map(addr, range, na, ns, pna);
	325	}
	326
8271f042	327	static unsigned int of_bus_sbus_get_flags(const u32 *addr)
cf44bbc2 DM	328	{
	329	return IORESOURCE_MEM;
	330	}
	331
	332
	333	/*
	334	* Array of bus specific translators
	335	*/
	336
	337	static struct of_bus of_busses[] = {
	338	/* PCI */
	339	{
	340	.name = "pci",
	341	.addr_prop_name = "assigned-addresses",
	342	.match = of_bus_pci_match,
	343	.count_cells = of_bus_pci_count_cells,
	344	.map = of_bus_pci_map,
cf44bbc2 DM	345	.get_flags = of_bus_pci_get_flags,
	346	},
	347	/* SBUS */
	348	{
	349	.name = "sbus",
	350	.addr_prop_name = "reg",
	351	.match = of_bus_sbus_match,
	352	.count_cells = of_bus_sbus_count_cells,
	353	.map = of_bus_sbus_map,
cf44bbc2 DM	354	.get_flags = of_bus_sbus_get_flags,
	355	},
	356	/* Default */
	357	{
	358	.name = "default",
	359	.addr_prop_name = "reg",
	360	.match = NULL,
	361	.count_cells = of_bus_default_count_cells,
	362	.map = of_bus_default_map,
cf44bbc2 DM	363	.get_flags = of_bus_default_get_flags,
	364	},
	365	};
	366
	367	static struct of_bus of_match_bus(struct device_node np)
	368	{
	369	int i;
	370
	371	for (i = 0; i < ARRAY_SIZE(of_busses); i ++)
	372	if (!of_busses[i].match \|\| of_busses[i].match(np))
	373	return &of_busses[i];
	374	BUG();
	375	return NULL;
	376	}
	377
	378	static int __init build_one_resource(struct device_node *parent,
	379	struct of_bus *bus,
	380	struct of_bus *pbus,
	381	u32 *addr,
	382	int na, int ns, int pna)
	383	{
8271f042	384	const u32 *ranges;
cf44bbc2 DM	385	unsigned int rlen;
cf44bbc2 DM	386	int rone;
cf44bbc2 DM	387
	388	ranges = of_get_property(parent, "ranges", &rlen);
	389	if (ranges == NULL \|\| rlen == 0) {
a83f9823 DM	390	u32 result[OF_MAX_ADDR_CELLS];
	391	int i;
	392
	393	memset(result, 0, pna * 4);
	394	for (i = 0; i < na; i++)
	395	result[pna - 1 - i] =
	396	addr[na - 1 - i];
	397
	398	memcpy(addr, result, pna * 4);
	399	return 0;
cf44bbc2 DM	400	}
	401
	402	/* Now walk through the ranges */
	403	rlen /= 4;
	404	rone = na + pna + ns;
	405	for (; rlen >= rone; rlen -= rone, ranges += rone) {
a83f9823 DM	406	if (!bus->map(addr, ranges, na, ns, pna))
a83f9823 DM	407	return 0;
cf44bbc2	408	}
cf44bbc2	409
a83f9823	410	return 1;
cf44bbc2 DM	411	}
cf44bbc2 DM	412
a83f9823 DM	413	static int of_resource_verbose;
a83f9823 DM	414
cf44bbc2 DM	415	static void __init build_device_resources(struct of_device *op,
	416	struct device *parent)
	417	{
	418	struct of_device *p_op;
	419	struct of_bus *bus;
	420	int na, ns;
	421	int index, num_reg;
8271f042	422	const void *preg;
cf44bbc2 DM	423
	424	if (!parent)
	425	return;
	426
	427	p_op = to_of_device(parent);
	428	bus = of_match_bus(p_op->node);
	429	bus->count_cells(op->node, &na, &ns);
	430
	431	preg = of_get_property(op->node, bus->addr_prop_name, &num_reg);
	432	if (!preg \|\| num_reg == 0)
	433	return;
	434
	435	/* Convert to num-cells. */
	436	num_reg /= 4;
	437
	438	/* Conver to num-entries. */
	439	num_reg /= na + ns;
	440
	441	for (index = 0; index < num_reg; index++) {
	442	struct resource *r = &op->resource[index];
	443	u32 addr[OF_MAX_ADDR_CELLS];
8271f042	444	const u32 reg = (preg + (index ((na + ns) * 4)));
cf44bbc2 DM	445	struct device_node *dp = op->node;
cf44bbc2 DM	446	struct device_node *pp = p_op->node;
b85cdd49	447	struct of_bus pbus, dbus;
cf44bbc2 DM	448	u64 size, result = OF_BAD_ADDR;
	449	unsigned long flags;
	450	int dna, dns;
	451	int pna, pns;
	452
	453	size = of_read_addr(reg + na, ns);
	454	flags = bus->get_flags(reg);
	455
	456	memcpy(addr, reg, na * 4);
	457
	458	/* If the immediate parent has no ranges property to apply,
	459	* just use a 1<->1 mapping.
	460	*/
	461	if (of_find_property(pp, "ranges", NULL) == NULL) {
	462	result = of_read_addr(addr, na);
	463	goto build_res;
	464	}
	465
	466	dna = na;
	467	dns = ns;
b85cdd49	468	dbus = bus;
cf44bbc2 DM	469
	470	while (1) {
	471	dp = pp;
	472	pp = dp->parent;
	473	if (!pp) {
	474	result = of_read_addr(addr, dna);
	475	break;
	476	}
	477
	478	pbus = of_match_bus(pp);
	479	pbus->count_cells(dp, &pna, &pns);
	480
b85cdd49	481	if (build_one_resource(dp, dbus, pbus, addr,
a83f9823	482	dna, dns, pna))
cf44bbc2 DM	483	break;
	484
	485	dna = pna;
	486	dns = pns;
b85cdd49	487	dbus = pbus;
cf44bbc2 DM	488	}
	489
	490	build_res:
	491	memset(r, 0, sizeof(*r));
a83f9823 DM	492
	493	if (of_resource_verbose)
	494	printk("%s reg[%d] -> %llx\n",
	495	op->node->full_name, index,
	496	result);
	497
cf44bbc2	498	if (result != OF_BAD_ADDR) {
95714e12	499	r->start = result & 0xffffffff;
cf44bbc2	500	r->end = result + size - 1;
95714e12	501	r->flags = flags \| ((result >> 32ULL) & 0xffUL);
cf44bbc2 DM	502	}
	503	r->name = op->node->name;
	504	}
	505	}
	506
	507	static struct of_device * __init scan_one_device(struct device_node *dp,
	508	struct device *parent)
	509	{
	510	struct of_device op = kzalloc(sizeof(op), GFP_KERNEL);
8271f042	511	const struct linux_prom_irqs *intr;
8f96cd1a	512	int len, i;
cf44bbc2 DM	513
	514	if (!op)
	515	return NULL;
	516
	517	op->node = dp;
	518
	519	op->clock_freq = of_getintprop_default(dp, "clock-frequency",
	520	(2510001000));
	521	op->portid = of_getintprop_default(dp, "upa-portid", -1);
	522	if (op->portid == -1)
	523	op->portid = of_getintprop_default(dp, "portid", -1);
	524
8f96cd1a DM	525	intr = of_get_property(dp, "intr", &len);
	526	if (intr) {
	527	op->num_irqs = len / sizeof(struct linux_prom_irqs);
	528	for (i = 0; i < op->num_irqs; i++)
	529	op->irqs[i] = intr[i].pri;
	530	} else {
8271f042 SR	531	const unsigned int *irq =
8271f042 SR	532	of_get_property(dp, "interrupts", &len);
8f96cd1a DM	533
	534	if (irq) {
	535	op->num_irqs = len / sizeof(unsigned int);
	536	for (i = 0; i < op->num_irqs; i++)
	537	op->irqs[i] = irq[i];
	538	} else {
	539	op->num_irqs = 0;
	540	}
	541	}
	542	if (sparc_cpu_model == sun4d) {
	543	static int pil_to_sbus[] = {
	544	0, 0, 1, 2, 0, 3, 0, 4, 0, 5, 0, 6, 0, 7, 0, 0,
	545	};
9d7ab1f4	546	struct device_node io_unit, sbi = dp->parent;
8271f042	547	const struct linux_prom_registers *regs;
9d7ab1f4 DM	548	int board, slot;
	549
	550	while (sbi) {
	551	if (!strcmp(sbi->name, "sbi"))
	552	break;
	553
	554	sbi = sbi->parent;
	555	}
	556	if (!sbi)
	557	goto build_resources;
8f96cd1a DM	558
8f96cd1a DM	559	regs = of_get_property(dp, "reg", NULL);
9d7ab1f4 DM	560	if (!regs)
	561	goto build_resources;
	562
8f96cd1a DM	563	slot = regs->which_io;
8f96cd1a DM	564
9d7ab1f4 DM	565	/* If SBI's parent is not io-unit or the io-unit lacks
	566	* a "board#" property, something is very wrong.
	567	*/
	568	if (!sbi->parent \|\| strcmp(sbi->parent->name, "io-unit")) {
	569	printk("%s: Error, parent is not io-unit.\n",
	570	sbi->full_name);
	571	goto build_resources;
	572	}
	573	io_unit = sbi->parent;
	574	board = of_getintprop_default(io_unit, "board#", -1);
	575	if (board == -1) {
	576	printk("%s: Error, lacks board# property.\n",
	577	io_unit->full_name);
	578	goto build_resources;
	579	}
	580
8f96cd1a DM	581	for (i = 0; i < op->num_irqs; i++) {
	582	int this_irq = op->irqs[i];
	583	int sbusl = pil_to_sbus[this_irq];
	584
	585	if (sbusl)
	586	this_irq = (((board + 1) << 5) +
	587	(sbusl << 2) +
	588	slot);
	589
	590	op->irqs[i] = this_irq;
	591	}
	592	}
cf44bbc2	593
9d7ab1f4	594	build_resources:
cf44bbc2 DM	595	build_device_resources(op, parent);
	596
	597	op->dev.parent = parent;
37b7754a	598	op->dev.bus = &of_platform_bus_type;
cf44bbc2 DM	599	if (!parent)
	600	strcpy(op->dev.bus_id, "root");
	601	else
f5ef9d11	602	sprintf(op->dev.bus_id, "%08x", dp->node);
cf44bbc2 DM	603
	604	if (of_device_register(op)) {
	605	printk("%s: Could not register of device.\n",
	606	dp->full_name);
	607	kfree(op);
	608	op = NULL;
	609	}
	610
	611	return op;
	612	}
	613
	614	static void __init scan_tree(struct device_node dp, struct device parent)
	615	{
	616	while (dp) {
	617	struct of_device *op = scan_one_device(dp, parent);
	618
	619	if (op)
	620	scan_tree(dp->child, &op->dev);
	621
	622	dp = dp->sibling;
	623	}
	624	}
	625
	626	static void __init scan_of_devices(void)
	627	{
	628	struct device_node *root = of_find_node_by_path("/");
	629	struct of_device *parent;
	630
	631	parent = scan_one_device(root, NULL);
	632	if (!parent)
	633	return;
	634
	635	scan_tree(root->child, &parent->dev);
	636	}
	637
fd531431 DM	638	static int __init of_bus_driver_init(void)
fd531431 DM	639	{
cf44bbc2	640	int err;
fd531431	641
37b7754a	642	err = bus_register(&of_platform_bus_type);
fd531431 DM	643	#ifdef CONFIG_PCI
	644	if (!err)
	645	err = bus_register(&ebus_bus_type);
	646	#endif
	647	#ifdef CONFIG_SBUS
	648	if (!err)
	649	err = bus_register(&sbus_bus_type);
	650	#endif
cf44bbc2 DM	651
	652	if (!err)
	653	scan_of_devices();
	654
	655	return err;
fd531431 DM	656	}
	657
	658	postcore_initcall(of_bus_driver_init);
	659
a83f9823 DM	660	static int __init of_debug(char *str)
	661	{
	662	int val = 0;
	663
	664	get_option(&str, &val);
	665	if (val & 1)
	666	of_resource_verbose = 1;
	667	return 1;
	668	}
	669
	670	__setup("of_debug=", of_debug);
	671
fd531431 DM	672	int of_register_driver(struct of_platform_driver drv, struct bus_type bus)
	673	{
	674	/* initialize common driver fields */
	675	drv->driver.name = drv->name;
	676	drv->driver.bus = bus;
	677
	678	/* register with core */
	679	return driver_register(&drv->driver);
	680	}
	681
	682	void of_unregister_driver(struct of_platform_driver *drv)
	683	{
	684	driver_unregister(&drv->driver);
	685	}
	686
fd531431 DM	687	struct of_device* of_platform_device_create(struct device_node *np,
	688	const char *bus_id,
	689	struct device *parent,
	690	struct bus_type *bus)
	691	{
	692	struct of_device *dev;
	693
c80892d1	694	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
fd531431 DM	695	if (!dev)
fd531431 DM	696	return NULL;
fd531431 DM	697
	698	dev->dev.parent = parent;
	699	dev->dev.bus = bus;
	700	dev->dev.release = of_release_dev;
	701
	702	strlcpy(dev->dev.bus_id, bus_id, BUS_ID_SIZE);
	703
	704	if (of_device_register(dev) != 0) {
	705	kfree(dev);
	706	return NULL;
	707	}
	708
	709	return dev;
	710	}
	711
fd531431 DM	712	EXPORT_SYMBOL(of_register_driver);
fd531431 DM	713	EXPORT_SYMBOL(of_unregister_driver);
fd531431	714	EXPORT_SYMBOL(of_platform_device_create);