160 lines
		
	
	
		
			3.8 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			160 lines
		
	
	
		
			3.8 KiB
		
	
	
	
		
			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);
 |