Merge tag 'xtensa-next-20140721' of git://github.com/czankel/xtensa-linux
[deliverable/linux.git] / arch / sparc / kernel / of_device_32.c
CommitLineData
fd531431
DM
1#include <linux/string.h>
2#include <linux/kernel.h>
f85ff305 3#include <linux/of.h>
fd531431 4#include <linux/init.h>
fd531431
DM
5#include <linux/mod_devicetable.h>
6#include <linux/slab.h>
3f23de10 7#include <linux/errno.h>
c9f5b7e7 8#include <linux/irq.h>
3f23de10
SR
9#include <linux/of_device.h>
10#include <linux/of_platform.h>
e63829de
KE
11#include <asm/leon.h>
12#include <asm/leon_amba.h>
fd531431 13
c9f5b7e7 14#include "of_device_common.h"
1d05995b 15#include "irq.h"
cf44bbc2 16
cf44bbc2
DM
17/*
18 * PCI bus specific translator
19 */
20
21static int of_bus_pci_match(struct device_node *np)
22{
a83f9823
DM
23 if (!strcmp(np->type, "pci") || !strcmp(np->type, "pciex")) {
24 /* Do not do PCI specific frobbing if the
25 * PCI bridge lacks a ranges property. We
26 * want to pass it through up to the next
27 * parent as-is, not with the PCI translate
28 * method which chops off the top address cell.
29 */
30 if (!of_find_property(np, "ranges", NULL))
31 return 0;
32
33 return 1;
34 }
35
36 return 0;
cf44bbc2
DM
37}
38
39static void of_bus_pci_count_cells(struct device_node *np,
40 int *addrc, int *sizec)
41{
42 if (addrc)
43 *addrc = 3;
44 if (sizec)
45 *sizec = 2;
46}
47
a83f9823
DM
48static int of_bus_pci_map(u32 *addr, const u32 *range,
49 int na, int ns, int pna)
cf44bbc2 50{
a83f9823
DM
51 u32 result[OF_MAX_ADDR_CELLS];
52 int i;
cf44bbc2
DM
53
54 /* Check address type match */
55 if ((addr[0] ^ range[0]) & 0x03000000)
a83f9823 56 return -EINVAL;
cf44bbc2 57
a83f9823
DM
58 if (of_out_of_range(addr + 1, range + 1, range + na + pna,
59 na - 1, ns))
60 return -EINVAL;
cf44bbc2 61
a83f9823
DM
62 /* Start with the parent range base. */
63 memcpy(result, range + na, pna * 4);
cf44bbc2 64
a83f9823
DM
65 /* Add in the child address offset, skipping high cell. */
66 for (i = 0; i < na - 1; i++)
67 result[pna - 1 - i] +=
68 (addr[na - 1 - i] -
69 range[na - 1 - i]);
70
71 memcpy(addr, result, pna * 4);
72
73 return 0;
cf44bbc2
DM
74}
75
e3c71a32 76static unsigned long of_bus_pci_get_flags(const u32 *addr, unsigned long flags)
cf44bbc2 77{
cf44bbc2
DM
78 u32 w = addr[0];
79
e3c71a32
DM
80 /* For PCI, we override whatever child busses may have used. */
81 flags = 0;
cf44bbc2
DM
82 switch((w >> 24) & 0x03) {
83 case 0x01:
84 flags |= IORESOURCE_IO;
e3c71a32
DM
85 break;
86
cf44bbc2
DM
87 case 0x02: /* 32 bits */
88 case 0x03: /* 64 bits */
89 flags |= IORESOURCE_MEM;
e3c71a32 90 break;
cf44bbc2
DM
91 }
92 if (w & 0x40000000)
93 flags |= IORESOURCE_PREFETCH;
94 return flags;
95}
96
bdba4d6b 97static unsigned long of_bus_sbus_get_flags(const u32 *addr, unsigned long flags)
cf44bbc2
DM
98{
99 return IORESOURCE_MEM;
100}
101
e63829de
KE
102 /*
103 * AMBAPP bus specific translator
104 */
105
106static int of_bus_ambapp_match(struct device_node *np)
107{
d7ecfb3c 108 return !strcmp(np->type, "ambapp");
e63829de
KE
109}
110
111static void of_bus_ambapp_count_cells(struct device_node *child,
112 int *addrc, int *sizec)
113{
114 if (addrc)
115 *addrc = 1;
116 if (sizec)
117 *sizec = 1;
118}
119
120static int of_bus_ambapp_map(u32 *addr, const u32 *range,
121 int na, int ns, int pna)
122{
123 return of_bus_default_map(addr, range, na, ns, pna);
124}
125
126static unsigned long of_bus_ambapp_get_flags(const u32 *addr,
127 unsigned long flags)
128{
129 return IORESOURCE_MEM;
130}
cf44bbc2
DM
131
132/*
133 * Array of bus specific translators
134 */
135
136static struct of_bus of_busses[] = {
137 /* PCI */
138 {
139 .name = "pci",
140 .addr_prop_name = "assigned-addresses",
141 .match = of_bus_pci_match,
142 .count_cells = of_bus_pci_count_cells,
143 .map = of_bus_pci_map,
cf44bbc2
DM
144 .get_flags = of_bus_pci_get_flags,
145 },
146 /* SBUS */
147 {
148 .name = "sbus",
149 .addr_prop_name = "reg",
150 .match = of_bus_sbus_match,
151 .count_cells = of_bus_sbus_count_cells,
c9f5b7e7 152 .map = of_bus_default_map,
cf44bbc2
DM
153 .get_flags = of_bus_sbus_get_flags,
154 },
e63829de
KE
155 /* AMBA */
156 {
157 .name = "ambapp",
158 .addr_prop_name = "reg",
159 .match = of_bus_ambapp_match,
160 .count_cells = of_bus_ambapp_count_cells,
161 .map = of_bus_ambapp_map,
162 .get_flags = of_bus_ambapp_get_flags,
163 },
cf44bbc2
DM
164 /* Default */
165 {
166 .name = "default",
167 .addr_prop_name = "reg",
168 .match = NULL,
169 .count_cells = of_bus_default_count_cells,
170 .map = of_bus_default_map,
cf44bbc2
DM
171 .get_flags = of_bus_default_get_flags,
172 },
173};
174
175static struct of_bus *of_match_bus(struct device_node *np)
176{
177 int i;
178
179 for (i = 0; i < ARRAY_SIZE(of_busses); i ++)
180 if (!of_busses[i].match || of_busses[i].match(np))
181 return &of_busses[i];
182 BUG();
183 return NULL;
184}
185
186static int __init build_one_resource(struct device_node *parent,
187 struct of_bus *bus,
188 struct of_bus *pbus,
189 u32 *addr,
190 int na, int ns, int pna)
191{
8271f042 192 const u32 *ranges;
cf44bbc2
DM
193 unsigned int rlen;
194 int rone;
cf44bbc2
DM
195
196 ranges = of_get_property(parent, "ranges", &rlen);
197 if (ranges == NULL || rlen == 0) {
a83f9823
DM
198 u32 result[OF_MAX_ADDR_CELLS];
199 int i;
200
201 memset(result, 0, pna * 4);
202 for (i = 0; i < na; i++)
203 result[pna - 1 - i] =
204 addr[na - 1 - i];
205
206 memcpy(addr, result, pna * 4);
207 return 0;
cf44bbc2
DM
208 }
209
210 /* Now walk through the ranges */
211 rlen /= 4;
212 rone = na + pna + ns;
213 for (; rlen >= rone; rlen -= rone, ranges += rone) {
a83f9823
DM
214 if (!bus->map(addr, ranges, na, ns, pna))
215 return 0;
cf44bbc2 216 }
cf44bbc2 217
a83f9823 218 return 1;
cf44bbc2
DM
219}
220
5280267c
DM
221static int __init use_1to1_mapping(struct device_node *pp)
222{
223 /* If we have a ranges property in the parent, use it. */
224 if (of_find_property(pp, "ranges", NULL) != NULL)
225 return 0;
226
227 /* Some SBUS devices use intermediate nodes to express
228 * hierarchy within the device itself. These aren't
229 * real bus nodes, and don't have a 'ranges' property.
230 * But, we should still pass the translation work up
231 * to the SBUS itself.
232 */
233 if (!strcmp(pp->name, "dma") ||
234 !strcmp(pp->name, "espdma") ||
235 !strcmp(pp->name, "ledma") ||
236 !strcmp(pp->name, "lebuffer"))
237 return 0;
238
239 return 1;
240}
241
a83f9823
DM
242static int of_resource_verbose;
243
cd4cd730 244static void __init build_device_resources(struct platform_device *op,
cf44bbc2
DM
245 struct device *parent)
246{
cd4cd730 247 struct platform_device *p_op;
cf44bbc2
DM
248 struct of_bus *bus;
249 int na, ns;
250 int index, num_reg;
8271f042 251 const void *preg;
cf44bbc2
DM
252
253 if (!parent)
254 return;
255
cd4cd730 256 p_op = to_platform_device(parent);
61c7a080
GL
257 bus = of_match_bus(p_op->dev.of_node);
258 bus->count_cells(op->dev.of_node, &na, &ns);
cf44bbc2 259
61c7a080 260 preg = of_get_property(op->dev.of_node, bus->addr_prop_name, &num_reg);
cf44bbc2
DM
261 if (!preg || num_reg == 0)
262 return;
263
264 /* Convert to num-cells. */
265 num_reg /= 4;
266
267 /* Conver to num-entries. */
268 num_reg /= na + ns;
269
1636f8ac
GL
270 op->resource = op->archdata.resource;
271 op->num_resources = num_reg;
cf44bbc2
DM
272 for (index = 0; index < num_reg; index++) {
273 struct resource *r = &op->resource[index];
274 u32 addr[OF_MAX_ADDR_CELLS];
8271f042 275 const u32 *reg = (preg + (index * ((na + ns) * 4)));
61c7a080
GL
276 struct device_node *dp = op->dev.of_node;
277 struct device_node *pp = p_op->dev.of_node;
b85cdd49 278 struct of_bus *pbus, *dbus;
cf44bbc2
DM
279 u64 size, result = OF_BAD_ADDR;
280 unsigned long flags;
281 int dna, dns;
282 int pna, pns;
283
284 size = of_read_addr(reg + na, ns);
cf44bbc2
DM
285
286 memcpy(addr, reg, na * 4);
287
e3c71a32
DM
288 flags = bus->get_flags(reg, 0);
289
5280267c 290 if (use_1to1_mapping(pp)) {
cf44bbc2
DM
291 result = of_read_addr(addr, na);
292 goto build_res;
293 }
294
295 dna = na;
296 dns = ns;
b85cdd49 297 dbus = bus;
cf44bbc2
DM
298
299 while (1) {
300 dp = pp;
301 pp = dp->parent;
302 if (!pp) {
303 result = of_read_addr(addr, dna);
304 break;
305 }
306
307 pbus = of_match_bus(pp);
308 pbus->count_cells(dp, &pna, &pns);
309
b85cdd49 310 if (build_one_resource(dp, dbus, pbus, addr,
a83f9823 311 dna, dns, pna))
cf44bbc2
DM
312 break;
313
e3c71a32
DM
314 flags = pbus->get_flags(addr, flags);
315
cf44bbc2
DM
316 dna = pna;
317 dns = pns;
b85cdd49 318 dbus = pbus;
cf44bbc2
DM
319 }
320
321 build_res:
322 memset(r, 0, sizeof(*r));
a83f9823
DM
323
324 if (of_resource_verbose)
325 printk("%s reg[%d] -> %llx\n",
61c7a080 326 op->dev.of_node->full_name, index,
a83f9823
DM
327 result);
328
cf44bbc2 329 if (result != OF_BAD_ADDR) {
95714e12 330 r->start = result & 0xffffffff;
cf44bbc2 331 r->end = result + size - 1;
95714e12 332 r->flags = flags | ((result >> 32ULL) & 0xffUL);
cf44bbc2 333 }
61c7a080 334 r->name = op->dev.of_node->name;
cf44bbc2
DM
335 }
336}
337
cd4cd730 338static struct platform_device * __init scan_one_device(struct device_node *dp,
cf44bbc2
DM
339 struct device *parent)
340{
cd4cd730 341 struct platform_device *op = kzalloc(sizeof(*op), GFP_KERNEL);
8271f042 342 const struct linux_prom_irqs *intr;
3d6e4702 343 struct dev_archdata *sd;
8f96cd1a 344 int len, i;
cf44bbc2
DM
345
346 if (!op)
347 return NULL;
348
3d6e4702 349 sd = &op->dev.archdata;
3d6e4702
DM
350 sd->op = op;
351
d706c1b0 352 op->dev.of_node = dp;
cf44bbc2 353
8f96cd1a
DM
354 intr = of_get_property(dp, "intr", &len);
355 if (intr) {
1636f8ac
GL
356 op->archdata.num_irqs = len / sizeof(struct linux_prom_irqs);
357 for (i = 0; i < op->archdata.num_irqs; i++)
1d05995b 358 op->archdata.irqs[i] =
472bc4f2 359 sparc_config.build_device_irq(op, intr[i].pri);
8f96cd1a 360 } else {
8271f042
SR
361 const unsigned int *irq =
362 of_get_property(dp, "interrupts", &len);
8f96cd1a
DM
363
364 if (irq) {
1636f8ac
GL
365 op->archdata.num_irqs = len / sizeof(unsigned int);
366 for (i = 0; i < op->archdata.num_irqs; i++)
1d05995b 367 op->archdata.irqs[i] =
472bc4f2 368 sparc_config.build_device_irq(op, irq[i]);
8f96cd1a 369 } else {
1636f8ac 370 op->archdata.num_irqs = 0;
8f96cd1a
DM
371 }
372 }
cf44bbc2
DM
373
374 build_device_resources(op, parent);
375
376 op->dev.parent = parent;
eca39301 377 op->dev.bus = &platform_bus_type;
cf44bbc2 378 if (!parent)
5acdc1fa 379 dev_set_name(&op->dev, "root");
cf44bbc2 380 else
6016a363 381 dev_set_name(&op->dev, "%08x", dp->phandle);
cf44bbc2
DM
382
383 if (of_device_register(op)) {
384 printk("%s: Could not register of device.\n",
385 dp->full_name);
386 kfree(op);
387 op = NULL;
388 }
389
390 return op;
391}
392
393static void __init scan_tree(struct device_node *dp, struct device *parent)
394{
395 while (dp) {
cd4cd730 396 struct platform_device *op = scan_one_device(dp, parent);
cf44bbc2
DM
397
398 if (op)
399 scan_tree(dp->child, &op->dev);
400
401 dp = dp->sibling;
402 }
403}
404
eca39301 405static int __init scan_of_devices(void)
cf44bbc2
DM
406{
407 struct device_node *root = of_find_node_by_path("/");
cd4cd730 408 struct platform_device *parent;
cf44bbc2
DM
409
410 parent = scan_one_device(root, NULL);
411 if (!parent)
eca39301 412 return 0;
cf44bbc2
DM
413
414 scan_tree(root->child, &parent->dev);
eca39301 415 return 0;
cf44bbc2 416}
eca39301 417postcore_initcall(scan_of_devices);
fd531431 418
a83f9823
DM
419static int __init of_debug(char *str)
420{
421 int val = 0;
422
423 get_option(&str, &val);
424 if (val & 1)
425 of_resource_verbose = 1;
426 return 1;
427}
428
429__setup("of_debug=", of_debug);
This page took 1.70501 seconds and 5 git commands to generate.