1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Device addresses
4 *
5 * Copyright (c) 2017 Google, Inc
6 *
7 * (C) Copyright 2012
8 * Pavel Herrmann <morpheus.ibis@gmail.com>
9 */
10
11 #include <common.h>
12 #include <dm.h>
13 #include <fdt_support.h>
14 #include <asm/io.h>
15 #include <dm/device-internal.h>
16
17 DECLARE_GLOBAL_DATA_PTR;
18
devfdt_get_addr_index(struct udevice * dev,int index)19 fdt_addr_t devfdt_get_addr_index(struct udevice *dev, int index)
20 {
21 #if CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA)
22 fdt_addr_t addr;
23
24 if (CONFIG_IS_ENABLED(OF_TRANSLATE)) {
25 const fdt32_t *reg;
26 int len = 0;
27 int na, ns;
28
29 na = fdt_address_cells(gd->fdt_blob,
30 dev_of_offset(dev->parent));
31 if (na < 1) {
32 debug("bad #address-cells\n");
33 return FDT_ADDR_T_NONE;
34 }
35
36 ns = fdt_size_cells(gd->fdt_blob, dev_of_offset(dev->parent));
37 if (ns < 0) {
38 debug("bad #size-cells\n");
39 return FDT_ADDR_T_NONE;
40 }
41
42 reg = fdt_getprop(gd->fdt_blob, dev_of_offset(dev), "reg",
43 &len);
44 if (!reg || (len <= (index * sizeof(fdt32_t) * (na + ns)))) {
45 debug("Req index out of range\n");
46 return FDT_ADDR_T_NONE;
47 }
48
49 reg += index * (na + ns);
50
51 if (ns) {
52 /*
53 * Use the full-fledged translate function for complex
54 * bus setups.
55 */
56 addr = fdt_translate_address((void *)gd->fdt_blob,
57 dev_of_offset(dev), reg);
58 } else {
59 /* Non translatable if #size-cells == 0 */
60 addr = fdt_read_number(reg, na);
61 }
62 } else {
63 /*
64 * Use the "simple" translate function for less complex
65 * bus setups.
66 */
67 addr = fdtdec_get_addr_size_auto_parent(gd->fdt_blob,
68 dev_of_offset(dev->parent), dev_of_offset(dev),
69 "reg", index, NULL, false);
70 if (CONFIG_IS_ENABLED(SIMPLE_BUS) && addr != FDT_ADDR_T_NONE) {
71 if (device_get_uclass_id(dev->parent) ==
72 UCLASS_SIMPLE_BUS)
73 addr = simple_bus_translate(dev->parent, addr);
74 }
75 }
76
77 /*
78 * Some platforms need a special address translation. Those
79 * platforms (e.g. mvebu in SPL) can configure a translation
80 * offset in the DM by calling dm_set_translation_offset() that
81 * will get added to all addresses returned by devfdt_get_addr().
82 */
83 addr += dm_get_translation_offset();
84
85 return addr;
86 #else
87 return FDT_ADDR_T_NONE;
88 #endif
89 }
90
devfdt_get_addr_size_index(struct udevice * dev,int index,fdt_size_t * size)91 fdt_addr_t devfdt_get_addr_size_index(struct udevice *dev, int index,
92 fdt_size_t *size)
93 {
94 #if CONFIG_IS_ENABLED(OF_CONTROL)
95 /*
96 * Only get the size in this first call. We'll get the addr in the
97 * next call to the exisiting dev_get_xxx function which handles
98 * all config options.
99 */
100 fdtdec_get_addr_size_auto_noparent(gd->fdt_blob, dev_of_offset(dev),
101 "reg", index, size, false);
102
103 /*
104 * Get the base address via the existing function which handles
105 * all Kconfig cases
106 */
107 return devfdt_get_addr_index(dev, index);
108 #else
109 return FDT_ADDR_T_NONE;
110 #endif
111 }
112
devfdt_get_addr_name(struct udevice * dev,const char * name)113 fdt_addr_t devfdt_get_addr_name(struct udevice *dev, const char *name)
114 {
115 #if CONFIG_IS_ENABLED(OF_CONTROL)
116 int index;
117
118 index = fdt_stringlist_search(gd->fdt_blob, dev_of_offset(dev),
119 "reg-names", name);
120 if (index < 0)
121 return index;
122
123 return devfdt_get_addr_index(dev, index);
124 #else
125 return FDT_ADDR_T_NONE;
126 #endif
127 }
128
devfdt_get_addr(struct udevice * dev)129 fdt_addr_t devfdt_get_addr(struct udevice *dev)
130 {
131 return devfdt_get_addr_index(dev, 0);
132 }
133
devfdt_get_addr_ptr(struct udevice * dev)134 void *devfdt_get_addr_ptr(struct udevice *dev)
135 {
136 return (void *)(uintptr_t)devfdt_get_addr_index(dev, 0);
137 }
138
devfdt_remap_addr_index(struct udevice * dev,int index)139 void *devfdt_remap_addr_index(struct udevice *dev, int index)
140 {
141 fdt_addr_t addr = devfdt_get_addr_index(dev, index);
142
143 if (addr == FDT_ADDR_T_NONE)
144 return NULL;
145
146 return map_physmem(addr, 0, MAP_NOCACHE);
147 }
148
devfdt_remap_addr_name(struct udevice * dev,const char * name)149 void *devfdt_remap_addr_name(struct udevice *dev, const char *name)
150 {
151 fdt_addr_t addr = devfdt_get_addr_name(dev, name);
152
153 if (addr == FDT_ADDR_T_NONE)
154 return NULL;
155
156 return map_physmem(addr, 0, MAP_NOCACHE);
157 }
158
devfdt_remap_addr(struct udevice * dev)159 void *devfdt_remap_addr(struct udevice *dev)
160 {
161 return devfdt_remap_addr_index(dev, 0);
162 }
163
devfdt_map_physmem(struct udevice * dev,unsigned long size)164 void *devfdt_map_physmem(struct udevice *dev, unsigned long size)
165 {
166 fdt_addr_t addr = devfdt_get_addr(dev);
167
168 if (addr == FDT_ADDR_T_NONE)
169 return NULL;
170
171 return map_physmem(addr, size, MAP_NOCACHE);
172 }
173