3 #include <linux/kernel.h>
4 #include <linux/string.h>
5 #include <linux/pci_regs.h>
6 #include <linux/module.h>
7 #include <linux/ioport.h>
9 #include <asm/pci-bridge.h>
12 #define DBG(fmt...) do { printk(fmt); } while(0)
14 #define DBG(fmt...) do { } while(0)
23 /* Max address size we deal with */
24 #define OF_MAX_ADDR_CELLS 4
25 #define OF_CHECK_COUNTS(na, ns) ((na) > 0 && (na) <= OF_MAX_ADDR_CELLS && \
30 static void of_dump_addr(const char *s
, u32
*addr
, int na
)
34 printk(" %08x", *(addr
++));
38 static void of_dump_addr(const char *s
, u32
*addr
, int na
) { }
41 /* Read a big address */
42 static inline u64
of_read_addr(u32
*cell
, int size
)
46 r
= (r
<< 32) | *(cell
++);
50 /* Callbacks for bus specific translators */
53 const char *addresses
;
54 int (*match
)(struct device_node
*parent
);
55 void (*count_cells
)(struct device_node
*child
,
56 int *addrc
, int *sizec
);
57 u64 (*map
)(u32
*addr
, u32
*range
, int na
, int ns
, int pna
);
58 int (*translate
)(u32
*addr
, u64 offset
, int na
);
59 unsigned int (*get_flags
)(u32
*addr
);
64 * Default translator (generic bus)
67 static void of_bus_default_count_cells(struct device_node
*dev
,
68 int *addrc
, int *sizec
)
71 *addrc
= prom_n_addr_cells(dev
);
73 *sizec
= prom_n_size_cells(dev
);
76 static u64
of_bus_default_map(u32
*addr
, u32
*range
, int na
, int ns
, int pna
)
80 cp
= of_read_addr(range
, na
);
81 s
= of_read_addr(range
+ na
+ pna
, ns
);
82 da
= of_read_addr(addr
, na
);
84 DBG("OF: default map, cp="PRu64
", s="PRu64
", da="PRu64
"\n",
87 if (da
< cp
|| da
>= (cp
+ s
))
92 static int of_bus_default_translate(u32
*addr
, u64 offset
, int na
)
94 u64 a
= of_read_addr(addr
, na
);
95 memset(addr
, 0, na
* 4);
98 addr
[na
- 2] = a
>> 32;
99 addr
[na
- 1] = a
& 0xffffffffu
;
104 static unsigned int of_bus_default_get_flags(u32
*addr
)
106 return IORESOURCE_MEM
;
111 * PCI bus specific translator
114 static int of_bus_pci_match(struct device_node
*np
)
116 return !strcmp(np
->type
, "pci");
119 static void of_bus_pci_count_cells(struct device_node
*np
,
120 int *addrc
, int *sizec
)
128 static u64
of_bus_pci_map(u32
*addr
, u32
*range
, int na
, int ns
, int pna
)
132 /* Check address type match */
133 if ((addr
[0] ^ range
[0]) & 0x03000000)
136 /* Read address values, skipping high cell */
137 cp
= of_read_addr(range
+ 1, na
- 1);
138 s
= of_read_addr(range
+ na
+ pna
, ns
);
139 da
= of_read_addr(addr
+ 1, na
- 1);
141 DBG("OF: PCI map, cp="PRu64
", s="PRu64
", da="PRu64
"\n", cp
, s
, da
);
143 if (da
< cp
|| da
>= (cp
+ s
))
148 static int of_bus_pci_translate(u32
*addr
, u64 offset
, int na
)
150 return of_bus_default_translate(addr
+ 1, offset
, na
- 1);
153 static unsigned int of_bus_pci_get_flags(u32
*addr
)
155 unsigned int flags
= 0;
158 switch((w
>> 24) & 0x03) {
160 flags
|= IORESOURCE_IO
;
161 case 0x02: /* 32 bits */
162 case 0x03: /* 64 bits */
163 flags
|= IORESOURCE_MEM
;
166 flags
|= IORESOURCE_PREFETCH
;
171 * ISA bus specific translator
174 static int of_bus_isa_match(struct device_node
*np
)
176 return !strcmp(np
->name
, "isa");
179 static void of_bus_isa_count_cells(struct device_node
*child
,
180 int *addrc
, int *sizec
)
188 static u64
of_bus_isa_map(u32
*addr
, u32
*range
, int na
, int ns
, int pna
)
192 /* Check address type match */
193 if ((addr
[0] ^ range
[0]) & 0x00000001)
196 /* Read address values, skipping high cell */
197 cp
= of_read_addr(range
+ 1, na
- 1);
198 s
= of_read_addr(range
+ na
+ pna
, ns
);
199 da
= of_read_addr(addr
+ 1, na
- 1);
201 DBG("OF: ISA map, cp="PRu64
", s="PRu64
", da="PRu64
"\n", cp
, s
, da
);
203 if (da
< cp
|| da
>= (cp
+ s
))
208 static int of_bus_isa_translate(u32
*addr
, u64 offset
, int na
)
210 return of_bus_default_translate(addr
+ 1, offset
, na
- 1);
213 static unsigned int of_bus_isa_get_flags(u32
*addr
)
215 unsigned int flags
= 0;
219 flags
|= IORESOURCE_IO
;
221 flags
|= IORESOURCE_MEM
;
227 * Array of bus specific translators
230 static struct of_bus of_busses
[] = {
234 .addresses
= "assigned-addresses",
235 .match
= of_bus_pci_match
,
236 .count_cells
= of_bus_pci_count_cells
,
237 .map
= of_bus_pci_map
,
238 .translate
= of_bus_pci_translate
,
239 .get_flags
= of_bus_pci_get_flags
,
245 .match
= of_bus_isa_match
,
246 .count_cells
= of_bus_isa_count_cells
,
247 .map
= of_bus_isa_map
,
248 .translate
= of_bus_isa_translate
,
249 .get_flags
= of_bus_isa_get_flags
,
256 .count_cells
= of_bus_default_count_cells
,
257 .map
= of_bus_default_map
,
258 .translate
= of_bus_default_translate
,
259 .get_flags
= of_bus_default_get_flags
,
263 static struct of_bus
*of_match_bus(struct device_node
*np
)
267 for (i
= 0; i
< ARRAY_SIZE(of_busses
); i
++)
268 if (!of_busses
[i
].match
|| of_busses
[i
].match(np
))
269 return &of_busses
[i
];
274 static int of_translate_one(struct device_node
*parent
, struct of_bus
*bus
,
275 struct of_bus
*pbus
, u32
*addr
,
276 int na
, int ns
, int pna
)
281 u64 offset
= OF_BAD_ADDR
;
283 /* Normally, an absence of a "ranges" property means we are
284 * crossing a non-translatable boundary, and thus the addresses
285 * below the current not cannot be converted to CPU physical ones.
286 * Unfortunately, while this is very clear in the spec, it's not
287 * what Apple understood, and they do have things like /uni-n or
288 * /ht nodes with no "ranges" property and a lot of perfectly
289 * useable mapped devices below them. Thus we treat the absence of
290 * "ranges" as equivalent to an empty "ranges" property which means
291 * a 1:1 translation at that level. It's up to the caller not to try
292 * to translate addresses that aren't supposed to be translated in
293 * the first place. --BenH.
295 ranges
= (u32
*)get_property(parent
, "ranges", &rlen
);
296 if (ranges
== NULL
|| rlen
== 0) {
297 offset
= of_read_addr(addr
, na
);
298 memset(addr
, 0, pna
* 4);
299 DBG("OF: no ranges, 1:1 translation\n");
303 DBG("OF: walking ranges...\n");
305 /* Now walk through the ranges */
307 rone
= na
+ pna
+ ns
;
308 for (; rlen
>= rone
; rlen
-= rone
, ranges
+= rone
) {
309 offset
= bus
->map(addr
, ranges
, na
, ns
, pna
);
310 if (offset
!= OF_BAD_ADDR
)
313 if (offset
== OF_BAD_ADDR
) {
314 DBG("OF: not found !\n");
317 memcpy(addr
, ranges
+ na
, 4 * pna
);
320 of_dump_addr("OF: parent translation for:", addr
, pna
);
321 DBG("OF: with offset: "PRu64
"\n", offset
);
323 /* Translate it into parent bus space */
324 return pbus
->translate(addr
, offset
, pna
);
329 * Translate an address from the device-tree into a CPU physical address,
330 * this walks up the tree and applies the various bus mappings on the
333 * Note: We consider that crossing any level with #size-cells == 0 to mean
334 * that translation is impossible (that is we are not dealing with a value
335 * that can be mapped to a cpu physical address). This is not really specified
336 * that way, but this is traditionally the way IBM at least do things
338 u64
of_translate_address(struct device_node
*dev
, u32
*in_addr
)
340 struct device_node
*parent
= NULL
;
341 struct of_bus
*bus
, *pbus
;
342 u32 addr
[OF_MAX_ADDR_CELLS
];
343 int na
, ns
, pna
, pns
;
344 u64 result
= OF_BAD_ADDR
;
346 DBG("OF: ** translation for device %s **\n", dev
->full_name
);
348 /* Increase refcount at current level */
351 /* Get parent & match bus type */
352 parent
= of_get_parent(dev
);
355 bus
= of_match_bus(parent
);
357 /* Cound address cells & copy address locally */
358 bus
->count_cells(dev
, &na
, &ns
);
359 if (!OF_CHECK_COUNTS(na
, ns
)) {
360 printk(KERN_ERR
"prom_parse: Bad cell count for %s\n",
364 memcpy(addr
, in_addr
, na
* 4);
366 DBG("OF: bus is %s (na=%d, ns=%d) on %s\n",
367 bus
->name
, na
, ns
, parent
->full_name
);
368 of_dump_addr("OF: translating address:", addr
, na
);
372 /* Switch to parent bus */
375 parent
= of_get_parent(dev
);
377 /* If root, we have finished */
378 if (parent
== NULL
) {
379 DBG("OF: reached root node\n");
380 result
= of_read_addr(addr
, na
);
384 /* Get new parent bus and counts */
385 pbus
= of_match_bus(parent
);
386 pbus
->count_cells(dev
, &pna
, &pns
);
387 if (!OF_CHECK_COUNTS(pna
, pns
)) {
388 printk(KERN_ERR
"prom_parse: Bad cell count for %s\n",
393 DBG("OF: parent bus is %s (na=%d, ns=%d) on %s\n",
394 pbus
->name
, pna
, pns
, parent
->full_name
);
396 /* Apply bus translation */
397 if (of_translate_one(dev
, bus
, pbus
, addr
, na
, ns
, pna
))
400 /* Complete the move up one level */
405 of_dump_addr("OF: one level translation:", addr
, na
);
413 EXPORT_SYMBOL(of_translate_address
);
415 u32
*of_get_address(struct device_node
*dev
, int index
, u64
*size
,
420 struct device_node
*parent
;
422 int onesize
, i
, na
, ns
;
424 /* Get parent & match bus type */
425 parent
= of_get_parent(dev
);
428 bus
= of_match_bus(parent
);
429 bus
->count_cells(dev
, &na
, &ns
);
431 if (!OF_CHECK_COUNTS(na
, ns
))
434 /* Get "reg" or "assigned-addresses" property */
435 prop
= (u32
*)get_property(dev
, bus
->addresses
, &psize
);
441 for (i
= 0; psize
>= onesize
; psize
-= onesize
, prop
+= onesize
, i
++)
444 *size
= of_read_addr(prop
+ na
, ns
);
446 *flags
= bus
->get_flags(prop
);
451 EXPORT_SYMBOL(of_get_address
);
453 u32
*of_get_pci_address(struct device_node
*dev
, int bar_no
, u64
*size
,
458 struct device_node
*parent
;
460 int onesize
, i
, na
, ns
;
462 /* Get parent & match bus type */
463 parent
= of_get_parent(dev
);
466 bus
= of_match_bus(parent
);
467 if (strcmp(bus
->name
, "pci"))
469 bus
->count_cells(dev
, &na
, &ns
);
471 if (!OF_CHECK_COUNTS(na
, ns
))
474 /* Get "reg" or "assigned-addresses" property */
475 prop
= (u32
*)get_property(dev
, bus
->addresses
, &psize
);
481 for (i
= 0; psize
>= onesize
; psize
-= onesize
, prop
+= onesize
, i
++)
482 if ((prop
[0] & 0xff) == ((bar_no
* 4) + PCI_BASE_ADDRESS_0
)) {
484 *size
= of_read_addr(prop
+ na
, ns
);
486 *flags
= bus
->get_flags(prop
);
491 EXPORT_SYMBOL(of_get_pci_address
);
493 static int __of_address_to_resource(struct device_node
*dev
, u32
*addrp
,
494 u64 size
, unsigned int flags
,
499 if ((flags
& (IORESOURCE_IO
| IORESOURCE_MEM
)) == 0)
501 taddr
= of_translate_address(dev
, addrp
);
502 if (taddr
== OF_BAD_ADDR
)
504 memset(r
, 0, sizeof(struct resource
));
505 if (flags
& IORESOURCE_IO
) {
507 port
= pci_address_to_pio(taddr
);
508 if (port
== (unsigned long)-1)
511 r
->end
= port
+ size
- 1;
514 r
->end
= taddr
+ size
- 1;
521 int of_address_to_resource(struct device_node
*dev
, int index
,
528 addrp
= of_get_address(dev
, index
, &size
, &flags
);
531 return __of_address_to_resource(dev
, addrp
, size
, flags
, r
);
533 EXPORT_SYMBOL_GPL(of_address_to_resource
);
535 int of_pci_address_to_resource(struct device_node
*dev
, int bar
,
542 addrp
= of_get_pci_address(dev
, bar
, &size
, &flags
);
545 return __of_address_to_resource(dev
, addrp
, size
, flags
, r
);
547 EXPORT_SYMBOL_GPL(of_pci_address_to_resource
);