treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / arch / powerpc / sysdev / tsi108_dev.c
blob0baec82510b96f31279f96603c105e55e17d8127
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * tsi108/109 device setup code
5 * Maintained by Roy Zang < tie-fei.zang@freescale.com >
6 */
8 #include <linux/stddef.h>
9 #include <linux/kernel.h>
10 #include <linux/init.h>
11 #include <linux/errno.h>
12 #include <linux/major.h>
13 #include <linux/delay.h>
14 #include <linux/irq.h>
15 #include <linux/export.h>
16 #include <linux/device.h>
17 #include <linux/etherdevice.h>
18 #include <linux/platform_device.h>
19 #include <linux/of_net.h>
20 #include <asm/tsi108.h>
22 #include <linux/atomic.h>
23 #include <asm/io.h>
24 #include <asm/irq.h>
25 #include <asm/prom.h>
26 #include <mm/mmu_decl.h>
28 #undef DEBUG
30 #ifdef DEBUG
31 #define DBG(fmt...) do { printk(fmt); } while(0)
32 #else
33 #define DBG(fmt...) do { } while(0)
34 #endif
36 static phys_addr_t tsi108_csr_base = -1;
38 phys_addr_t get_csrbase(void)
40 struct device_node *tsi;
42 if (tsi108_csr_base != -1)
43 return tsi108_csr_base;
45 tsi = of_find_node_by_type(NULL, "tsi-bridge");
46 if (tsi) {
47 unsigned int size;
48 const void *prop = of_get_property(tsi, "reg", &size);
49 tsi108_csr_base = of_translate_address(tsi, prop);
50 of_node_put(tsi);
52 return tsi108_csr_base;
55 u32 get_vir_csrbase(void)
57 return (u32) (ioremap(get_csrbase(), 0x10000));
60 EXPORT_SYMBOL(get_csrbase);
61 EXPORT_SYMBOL(get_vir_csrbase);
63 static int __init tsi108_eth_of_init(void)
65 struct device_node *np;
66 unsigned int i = 0;
67 struct platform_device *tsi_eth_dev;
68 struct resource res;
69 int ret;
71 for_each_compatible_node(np, "network", "tsi108-ethernet") {
72 struct resource r[2];
73 struct device_node *phy, *mdio;
74 hw_info tsi_eth_data;
75 const unsigned int *phy_id;
76 const void *mac_addr;
77 const phandle *ph;
79 memset(r, 0, sizeof(r));
80 memset(&tsi_eth_data, 0, sizeof(tsi_eth_data));
82 ret = of_address_to_resource(np, 0, &r[0]);
83 DBG("%s: name:start->end = %s:%pR\n",
84 __func__, r[0].name, &r[0]);
85 if (ret)
86 goto err;
88 r[1].name = "tx";
89 r[1].start = irq_of_parse_and_map(np, 0);
90 r[1].end = irq_of_parse_and_map(np, 0);
91 r[1].flags = IORESOURCE_IRQ;
92 DBG("%s: name:start->end = %s:%pR\n",
93 __func__, r[1].name, &r[1]);
95 tsi_eth_dev =
96 platform_device_register_simple("tsi-ethernet", i++, &r[0],
97 1);
99 if (IS_ERR(tsi_eth_dev)) {
100 ret = PTR_ERR(tsi_eth_dev);
101 goto err;
104 mac_addr = of_get_mac_address(np);
105 if (!IS_ERR(mac_addr))
106 ether_addr_copy(tsi_eth_data.mac_addr, mac_addr);
108 ph = of_get_property(np, "mdio-handle", NULL);
109 mdio = of_find_node_by_phandle(*ph);
110 ret = of_address_to_resource(mdio, 0, &res);
111 of_node_put(mdio);
112 if (ret)
113 goto unreg;
115 ph = of_get_property(np, "phy-handle", NULL);
116 phy = of_find_node_by_phandle(*ph);
118 if (phy == NULL) {
119 ret = -ENODEV;
120 goto unreg;
123 phy_id = of_get_property(phy, "reg", NULL);
125 tsi_eth_data.regs = r[0].start;
126 tsi_eth_data.phyregs = res.start;
127 tsi_eth_data.phy = *phy_id;
128 tsi_eth_data.irq_num = irq_of_parse_and_map(np, 0);
130 /* Some boards with the TSI108 bridge (e.g. Holly)
131 * have a miswiring of the ethernet PHYs which
132 * requires a workaround. The special
133 * "txc-rxc-delay-disable" property enables this
134 * workaround. FIXME: Need to port the tsi108_eth
135 * driver itself to phylib and use a non-misleading
136 * name for the workaround flag - it's not actually to
137 * do with the model of PHY in use */
138 if (of_get_property(phy, "txc-rxc-delay-disable", NULL))
139 tsi_eth_data.phy_type = TSI108_PHY_BCM54XX;
140 of_node_put(phy);
142 ret =
143 platform_device_add_data(tsi_eth_dev, &tsi_eth_data,
144 sizeof(hw_info));
145 if (ret)
146 goto unreg;
148 return 0;
149 unreg:
150 platform_device_unregister(tsi_eth_dev);
151 err:
152 of_node_put(np);
153 return ret;
156 arch_initcall(tsi108_eth_of_init);