f3038461d4c0566f162ecacba1ccff41ebd5515b
[linux-3.10.git] / arch / powerpc / sysdev / tsi108_dev.c
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);