160 lines · 3.8 KB · C
RawDownload
/* * 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/export.h>#include <linux/device.h>#include <linux/platform_device.h>#include <linux/of_net.h>#include <asm/tsi108.h> #include <asm/system.h>#include <linux/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:%pR\n",		    __func__, r[0].name, &r[0]);		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:%pR\n",			__func__, r[1].name, &r[1]); 		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);