[linux-2.6] / arch / powerpc / sysdev / tsi108_dev.c

/*
 * tsi108/109 device setup code
 *
 * Maintained by Roy Zang < tie-fei.zang@freescale.com >
 *
 * This program is free software; you can redistribute  it and/or modify it
 * under  the terms of  the GNU General  Public License as published by the
 * Free Software Foundation;  either version 2 of the  License, or (at your
 * option) any later version.
 */

#include <linux/stddef.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/errno.h>
#include <linux/major.h>
#include <linux/delay.h>
#include <linux/irq.h>
#include <linux/module.h>
#include <linux/device.h>
#include <linux/platform_device.h>
#include <asm/tsi108.h>

#include <asm/system.h>
#include <asm/atomic.h>
#include <asm/io.h>
#include <asm/irq.h>
#include <asm/prom.h>
#include <mm/mmu_decl.h>

#undef DEBUG

#ifdef DEBUG
#define DBG(fmt...) do { printk(fmt); } while(0)
#else
#define DBG(fmt...) do { } while(0)
#endif

static phys_addr_t tsi108_csr_base = -1;

phys_addr_t get_csrbase(void)
{
	struct device_node *tsi;

	if (tsi108_csr_base != -1)
		return tsi108_csr_base;

	tsi = of_find_node_by_type(NULL, "tsi-bridge");
	if (tsi) {
		unsigned int size;
		const void *prop = of_get_property(tsi, "reg", &size);
		tsi108_csr_base = of_translate_address(tsi, prop);
		of_node_put(tsi);
	};
	return tsi108_csr_base;
}

u32 get_vir_csrbase(void)
{
	return (u32) (ioremap(get_csrbase(), 0x10000));
}

EXPORT_SYMBOL(get_csrbase);
EXPORT_SYMBOL(get_vir_csrbase);

static int __init tsi108_eth_of_init(void)
{
	struct device_node *np;
	unsigned int i = 0;
	struct platform_device *tsi_eth_dev;
	struct resource res;
	int ret;

	for_each_compatible_node(np, "network", "tsi108-ethernet") {
		struct resource r[2];
		struct device_node *phy, *mdio;
		hw_info tsi_eth_data;
		const unsigned int *phy_id;
		const void *mac_addr;
		const phandle *ph;

		memset(r, 0, sizeof(r));
		memset(&tsi_eth_data, 0, sizeof(tsi_eth_data));

		ret = of_address_to_resource(np, 0, &r[0]);
		DBG("%s: name:start->end = %s:0x%lx-> 0x%lx\n",
			__func__,r[0].name, r[0].start, r[0].end);
		if (ret)
			goto err;

		r[1].name = "tx";
		r[1].start = irq_of_parse_and_map(np, 0);
		r[1].end = irq_of_parse_and_map(np, 0);
		r[1].flags = IORESOURCE_IRQ;
		DBG("%s: name:start->end = %s:0x%lx-> 0x%lx\n",
			__func__,r[1].name, r[1].start, r[1].end);

		tsi_eth_dev =
		    platform_device_register_simple("tsi-ethernet", i++, &r[0],
						    1);

		if (IS_ERR(tsi_eth_dev)) {
			ret = PTR_ERR(tsi_eth_dev);
			goto err;
		}

		mac_addr = of_get_mac_address(np);
		if (mac_addr)
			memcpy(tsi_eth_data.mac_addr, mac_addr, 6);

		ph = of_get_property(np, "mdio-handle", NULL);
		mdio = of_find_node_by_phandle(*ph);
		ret = of_address_to_resource(mdio, 0, &res);
		of_node_put(mdio);
		if (ret)
			goto unreg;

		ph = of_get_property(np, "phy-handle", NULL);
		phy = of_find_node_by_phandle(*ph);

		if (phy == NULL) {
			ret = -ENODEV;
			goto unreg;
		}

		phy_id = of_get_property(phy, "reg", NULL);

		tsi_eth_data.regs = r[0].start;
		tsi_eth_data.phyregs = res.start;
		tsi_eth_data.phy = *phy_id;
		tsi_eth_data.irq_num = irq_of_parse_and_map(np, 0);

		/* Some boards with the TSI108 bridge (e.g. Holly)
		 * have a miswiring of the ethernet PHYs which
		 * requires a workaround.  The special
		 * "txc-rxc-delay-disable" property enables this
		 * workaround.  FIXME: Need to port the tsi108_eth
		 * driver itself to phylib and use a non-misleading
		 * name for the workaround flag - it's not actually to
		 * do with the model of PHY in use */
		if (of_get_property(phy, "txc-rxc-delay-disable", NULL))
			tsi_eth_data.phy_type = TSI108_PHY_BCM54XX;
		of_node_put(phy);

		ret =
		    platform_device_add_data(tsi_eth_dev, &tsi_eth_data,
					     sizeof(hw_info));
		if (ret)
			goto unreg;
	}
	return 0;
unreg:
	platform_device_unregister(tsi_eth_dev);
err:
	of_node_put(np);
	return ret;
}

arch_initcall(tsi108_eth_of_init);
Commit	Line	Data
2b9d7467 ZR	1	/*
	2	* tsi108/109 device setup code
	3	*
	4	* Maintained by Roy Zang < tie-fei.zang@freescale.com >
	5	*
	6	* This program is free software; you can redistribute it and/or modify it
	7	* under the terms of the GNU General Public License as published by the
	8	* Free Software Foundation; either version 2 of the License, or (at your
	9	* option) any later version.
	10	*/
	11
2b9d7467 ZR	12	#include <linux/stddef.h>
	13	#include <linux/kernel.h>
	14	#include <linux/init.h>
	15	#include <linux/errno.h>
	16	#include <linux/major.h>
	17	#include <linux/delay.h>
	18	#include <linux/irq.h>
	19	#include <linux/module.h>
	20	#include <linux/device.h>
	21	#include <linux/platform_device.h>
	22	#include <asm/tsi108.h>
	23
	24	#include <asm/system.h>
	25	#include <asm/atomic.h>
	26	#include <asm/io.h>
	27	#include <asm/irq.h>
	28	#include <asm/prom.h>
	29	#include <mm/mmu_decl.h>
	30
	31	#undef DEBUG
	32
	33	#ifdef DEBUG
	34	#define DBG(fmt...) do { printk(fmt); } while(0)
	35	#else
	36	#define DBG(fmt...) do { } while(0)
	37	#endif
	38
	39	static phys_addr_t tsi108_csr_base = -1;
	40
	41	phys_addr_t get_csrbase(void)
	42	{
	43	struct device_node *tsi;
	44
	45	if (tsi108_csr_base != -1)
	46	return tsi108_csr_base;
	47
	48	tsi = of_find_node_by_type(NULL, "tsi-bridge");
	49	if (tsi) {
	50	unsigned int size;
e2eb6392	51	const void *prop = of_get_property(tsi, "reg", &size);
2b9d7467 ZR	52	tsi108_csr_base = of_translate_address(tsi, prop);
	53	of_node_put(tsi);
	54	};
	55	return tsi108_csr_base;
	56	}
	57
	58	u32 get_vir_csrbase(void)
	59	{
	60	return (u32) (ioremap(get_csrbase(), 0x10000));
	61	}
	62
	63	EXPORT_SYMBOL(get_csrbase);
	64	EXPORT_SYMBOL(get_vir_csrbase);
	65
	66	static int __init tsi108_eth_of_init(void)
	67	{
	68	struct device_node *np;
26cb7d8b	69	unsigned int i = 0;
2b9d7467 ZR	70	struct platform_device *tsi_eth_dev;
	71	struct resource res;
	72	int ret;
	73
26cb7d8b	74	for_each_compatible_node(np, "network", "tsi108-ethernet") {
2b9d7467	75	struct resource r[2];
e58ca3de	76	struct device_node phy, mdio;
2b9d7467	77	hw_info tsi_eth_data;
e2eb6392	78	const unsigned int *phy_id;
c3386e40	79	const void *mac_addr;
e2eb6392	80	const phandle *ph;
2b9d7467 ZR	81
	82	memset(r, 0, sizeof(r));
	83	memset(&tsi_eth_data, 0, sizeof(tsi_eth_data));
	84
	85	ret = of_address_to_resource(np, 0, &r[0]);
	86	DBG("%s: name:start->end = %s:0x%lx-> 0x%lx\n",
e48b1b45	87	__func__,r[0].name, r[0].start, r[0].end);
2b9d7467 ZR	88	if (ret)
	89	goto err;
	90
	91	r[1].name = "tx";
c4342ff9 ZR	92	r[1].start = irq_of_parse_and_map(np, 0);
c4342ff9 ZR	93	r[1].end = irq_of_parse_and_map(np, 0);
2b9d7467	94	r[1].flags = IORESOURCE_IRQ;
c4342ff9	95	DBG("%s: name:start->end = %s:0x%lx-> 0x%lx\n",
e48b1b45	96	__func__,r[1].name, r[1].start, r[1].end);
2b9d7467 ZR	97
2b9d7467 ZR	98	tsi_eth_dev =
26cb7d8b	99	platform_device_register_simple("tsi-ethernet", i++, &r[0],
c4342ff9	100	1);
2b9d7467 ZR	101
	102	if (IS_ERR(tsi_eth_dev)) {
	103	ret = PTR_ERR(tsi_eth_dev);
	104	goto err;
	105	}
	106
c1b78d05 JB	107	mac_addr = of_get_mac_address(np);
	108	if (mac_addr)
	109	memcpy(tsi_eth_data.mac_addr, mac_addr, 6);
2b9d7467	110
e58ca3de DG	111	ph = of_get_property(np, "mdio-handle", NULL);
	112	mdio = of_find_node_by_phandle(*ph);
	113	ret = of_address_to_resource(mdio, 0, &res);
	114	of_node_put(mdio);
	115	if (ret)
	116	goto unreg;
	117
e2eb6392	118	ph = of_get_property(np, "phy-handle", NULL);
2b9d7467 ZR	119	phy = of_find_node_by_phandle(*ph);
	120
	121	if (phy == NULL) {
	122	ret = -ENODEV;
	123	goto unreg;
	124	}
	125
e58ca3de DG	126	phy_id = of_get_property(phy, "reg", NULL);
e58ca3de DG	127
2b9d7467 ZR	128	tsi_eth_data.regs = r[0].start;
	129	tsi_eth_data.phyregs = res.start;
	130	tsi_eth_data.phy = *phy_id;
c4342ff9	131	tsi_eth_data.irq_num = irq_of_parse_and_map(np, 0);
e58ca3de DG	132
	133	/* Some boards with the TSI108 bridge (e.g. Holly)
	134	* have a miswiring of the ethernet PHYs which
	135	* requires a workaround. The special
	136	* "txc-rxc-delay-disable" property enables this
	137	* workaround. FIXME: Need to port the tsi108_eth
	138	* driver itself to phylib and use a non-misleading
	139	* name for the workaround flag - it's not actually to
	140	* do with the model of PHY in use */
	141	if (of_get_property(phy, "txc-rxc-delay-disable", NULL))
c1b78d05	142	tsi_eth_data.phy_type = TSI108_PHY_BCM54XX;
2b9d7467	143	of_node_put(phy);
e58ca3de	144
2b9d7467 ZR	145	ret =
	146	platform_device_add_data(tsi_eth_dev, &tsi_eth_data,
	147	sizeof(hw_info));
	148	if (ret)
	149	goto unreg;
	150	}
	151	return 0;
	152	unreg:
	153	platform_device_unregister(tsi_eth_dev);
	154	err:
26cb7d8b	155	of_node_put(np);
2b9d7467 ZR	156	return ret;
	157	}
	158
	159	arch_initcall(tsi108_eth_of_init);