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 12 #include <linux/config.h> 13 #include <linux/stddef.h> 14 #include <linux/kernel.h> 15 #include <linux/init.h> 16 #include <linux/errno.h> 17 #include <linux/major.h> 18 #include <linux/delay.h> 19 #include <linux/irq.h> 20 #include <linux/module.h> 21 #include <linux/device.h> 22 #include <linux/platform_device.h> 23 #include <asm/tsi108.h> 24 25 #include <asm/system.h> 26 #include <asm/atomic.h> 27 #include <asm/io.h> 28 #include <asm/irq.h> 29 #include <asm/prom.h> 30 #include <mm/mmu_decl.h> 31 32 #undef DEBUG 33 34 #ifdef DEBUG 35 #define DBG(fmt...) do { printk(fmt); } while(0) 36 #else 37 #define DBG(fmt...) do { } while(0) 38 #endif 39 40 static phys_addr_t tsi108_csr_base = -1; 41 42 phys_addr_t get_csrbase(void) 43 { 44 struct device_node *tsi; 45 46 if (tsi108_csr_base != -1) 47 return tsi108_csr_base; 48 49 tsi = of_find_node_by_type(NULL, "tsi-bridge"); 50 if (tsi) { 51 unsigned int size; 52 void *prop = get_property(tsi, "reg", &size); 53 tsi108_csr_base = of_translate_address(tsi, prop); 54 of_node_put(tsi); 55 }; 56 return tsi108_csr_base; 57 } 58 59 u32 get_vir_csrbase(void) 60 { 61 return (u32) (ioremap(get_csrbase(), 0x10000)); 62 } 63 64 EXPORT_SYMBOL(get_csrbase); 65 EXPORT_SYMBOL(get_vir_csrbase); 66 67 static int __init tsi108_eth_of_init(void) 68 { 69 struct device_node *np; 70 unsigned int i; 71 struct platform_device *tsi_eth_dev; 72 struct resource res; 73 int ret; 74 75 for (np = NULL, i = 0; 76 (np = of_find_compatible_node(np, "network", "tsi-ethernet")) != NULL; 77 i++) { 78 struct resource r[2]; 79 struct device_node *phy; 80 hw_info tsi_eth_data; 81 unsigned int *id; 82 unsigned int *phy_id; 83 void *mac_addr; 84 phandle *ph; 85 86 memset(r, 0, sizeof(r)); 87 memset(&tsi_eth_data, 0, sizeof(tsi_eth_data)); 88 89 ret = of_address_to_resource(np, 0, &r[0]); 90 DBG("%s: name:start->end = %s:0x%lx-> 0x%lx\n", 91 __FUNCTION__,r[0].name, r[0].start, r[0].end); 92 if (ret) 93 goto err; 94 95 r[1].name = "tx"; 96 r[1].start = irq_of_parse_and_map(np, 0); 97 r[1].end = irq_of_parse_and_map(np, 0); 98 r[1].flags = IORESOURCE_IRQ; 99 DBG("%s: name:start->end = %s:0x%lx-> 0x%lx\n", 100 __FUNCTION__,r[1].name, r[1].start, r[1].end); 101 102 tsi_eth_dev = 103 platform_device_register_simple("tsi-ethernet", i, &r[0], 104 1); 105 106 if (IS_ERR(tsi_eth_dev)) { 107 ret = PTR_ERR(tsi_eth_dev); 108 goto err; 109 } 110 111 mac_addr = get_property(np, "address", NULL); 112 memcpy(tsi_eth_data.mac_addr, mac_addr, 6); 113 114 ph = (phandle *) get_property(np, "phy-handle", NULL); 115 phy = of_find_node_by_phandle(*ph); 116 117 if (phy == NULL) { 118 ret = -ENODEV; 119 goto unreg; 120 } 121 122 id = (u32 *) get_property(phy, "reg", NULL); 123 phy_id = (u32 *) get_property(phy, "phy-id", NULL); 124 ret = of_address_to_resource(phy, 0, &res); 125 if (ret) { 126 of_node_put(phy); 127 goto unreg; 128 } 129 tsi_eth_data.regs = r[0].start; 130 tsi_eth_data.phyregs = res.start; 131 tsi_eth_data.phy = *phy_id; 132 tsi_eth_data.irq_num = irq_of_parse_and_map(np, 0); 133 of_node_put(phy); 134 ret = 135 platform_device_add_data(tsi_eth_dev, &tsi_eth_data, 136 sizeof(hw_info)); 137 if (ret) 138 goto unreg; 139 } 140 return 0; 141 unreg: 142 platform_device_unregister(tsi_eth_dev); 143 err: 144 return ret; 145 } 146 147 arch_initcall(tsi108_eth_of_init); 148