1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright (c) 2017 Google, Inc
4  * Written by Simon Glass <sjg@chromium.org>
5  */
6 
7 #include <common.h>
8 #include <dm.h>
9 #include <dm/of_access.h>
10 #include <mapmem.h>
11 #include <asm/global_data.h>
12 #include <asm/types.h>
13 #include <asm/io.h>
14 #include <linux/ioport.h>
15 
dev_read_u8(const struct udevice * dev,const char * propname,u8 * outp)16 int dev_read_u8(const struct udevice *dev, const char *propname, u8 *outp)
17 {
18 	return ofnode_read_u8(dev_ofnode(dev), propname, outp);
19 }
20 
dev_read_u8_default(const struct udevice * dev,const char * propname,u8 def)21 u8 dev_read_u8_default(const struct udevice *dev, const char *propname, u8 def)
22 {
23 	return ofnode_read_u8_default(dev_ofnode(dev), propname, def);
24 }
25 
dev_read_u16(const struct udevice * dev,const char * propname,u16 * outp)26 int dev_read_u16(const struct udevice *dev, const char *propname, u16 *outp)
27 {
28 	return ofnode_read_u16(dev_ofnode(dev), propname, outp);
29 }
30 
dev_read_u16_default(const struct udevice * dev,const char * propname,u16 def)31 u16 dev_read_u16_default(const struct udevice *dev, const char *propname,
32 			 u16 def)
33 {
34 	return ofnode_read_u16_default(dev_ofnode(dev), propname, def);
35 }
36 
dev_read_u32(const struct udevice * dev,const char * propname,u32 * outp)37 int dev_read_u32(const struct udevice *dev, const char *propname, u32 *outp)
38 {
39 	return ofnode_read_u32(dev_ofnode(dev), propname, outp);
40 }
41 
dev_read_u32_default(const struct udevice * dev,const char * propname,int def)42 int dev_read_u32_default(const struct udevice *dev, const char *propname,
43 			 int def)
44 {
45 	return ofnode_read_u32_default(dev_ofnode(dev), propname, def);
46 }
47 
dev_read_u32_index(struct udevice * dev,const char * propname,int index,u32 * outp)48 int dev_read_u32_index(struct udevice *dev, const char *propname, int index,
49 		       u32 *outp)
50 {
51 	return ofnode_read_u32_index(dev_ofnode(dev), propname, index, outp);
52 }
53 
dev_read_u32_index_default(struct udevice * dev,const char * propname,int index,u32 def)54 u32 dev_read_u32_index_default(struct udevice *dev, const char *propname,
55 			       int index, u32 def)
56 {
57 	return ofnode_read_u32_index_default(dev_ofnode(dev), propname, index,
58 					     def);
59 }
60 
dev_read_s32(const struct udevice * dev,const char * propname,s32 * outp)61 int dev_read_s32(const struct udevice *dev, const char *propname, s32 *outp)
62 {
63 	return ofnode_read_u32(dev_ofnode(dev), propname, (u32 *)outp);
64 }
65 
dev_read_s32_default(const struct udevice * dev,const char * propname,int def)66 int dev_read_s32_default(const struct udevice *dev, const char *propname,
67 			 int def)
68 {
69 	return ofnode_read_u32_default(dev_ofnode(dev), propname, def);
70 }
71 
dev_read_u32u(const struct udevice * dev,const char * propname,uint * outp)72 int dev_read_u32u(const struct udevice *dev, const char *propname, uint *outp)
73 {
74 	u32 val;
75 	int ret;
76 
77 	ret = ofnode_read_u32(dev_ofnode(dev), propname, &val);
78 	if (ret)
79 		return ret;
80 	*outp = val;
81 
82 	return 0;
83 }
84 
dev_read_u64(const struct udevice * dev,const char * propname,u64 * outp)85 int dev_read_u64(const struct udevice *dev, const char *propname, u64 *outp)
86 {
87 	return ofnode_read_u64(dev_ofnode(dev), propname, outp);
88 }
89 
dev_read_u64_default(const struct udevice * dev,const char * propname,u64 def)90 u64 dev_read_u64_default(const struct udevice *dev, const char *propname,
91 			 u64 def)
92 {
93 	return ofnode_read_u64_default(dev_ofnode(dev), propname, def);
94 }
95 
dev_read_string(const struct udevice * dev,const char * propname)96 const char *dev_read_string(const struct udevice *dev, const char *propname)
97 {
98 	return ofnode_read_string(dev_ofnode(dev), propname);
99 }
100 
dev_read_bool(const struct udevice * dev,const char * propname)101 bool dev_read_bool(const struct udevice *dev, const char *propname)
102 {
103 	return ofnode_read_bool(dev_ofnode(dev), propname);
104 }
105 
dev_read_subnode(const struct udevice * dev,const char * subnode_name)106 ofnode dev_read_subnode(const struct udevice *dev, const char *subnode_name)
107 {
108 	return ofnode_find_subnode(dev_ofnode(dev), subnode_name);
109 }
110 
dev_read_first_subnode(const struct udevice * dev)111 ofnode dev_read_first_subnode(const struct udevice *dev)
112 {
113 	return ofnode_first_subnode(dev_ofnode(dev));
114 }
115 
dev_read_next_subnode(ofnode node)116 ofnode dev_read_next_subnode(ofnode node)
117 {
118 	return ofnode_next_subnode(node);
119 }
120 
dev_read_size(const struct udevice * dev,const char * propname)121 int dev_read_size(const struct udevice *dev, const char *propname)
122 {
123 	return ofnode_read_size(dev_ofnode(dev), propname);
124 }
125 
dev_read_addr_index(const struct udevice * dev,int index)126 fdt_addr_t dev_read_addr_index(const struct udevice *dev, int index)
127 {
128 	if (ofnode_is_np(dev_ofnode(dev)))
129 		return ofnode_get_addr_index(dev_ofnode(dev), index);
130 	else
131 		return devfdt_get_addr_index(dev, index);
132 }
133 
dev_read_addr_index_ptr(const struct udevice * dev,int index)134 void *dev_read_addr_index_ptr(const struct udevice *dev, int index)
135 {
136 	fdt_addr_t addr = dev_read_addr_index(dev, index);
137 
138 	if (addr == FDT_ADDR_T_NONE)
139 		return NULL;
140 
141 	return map_sysmem(addr, 0);
142 }
143 
dev_read_addr_size_index(const struct udevice * dev,int index,fdt_size_t * size)144 fdt_addr_t dev_read_addr_size_index(const struct udevice *dev, int index,
145 				    fdt_size_t *size)
146 {
147 	if (ofnode_is_np(dev_ofnode(dev)))
148 		return ofnode_get_addr_size_index(dev_ofnode(dev), index, size);
149 	else
150 		return devfdt_get_addr_size_index(dev, index, size);
151 }
152 
dev_remap_addr_index(const struct udevice * dev,int index)153 void *dev_remap_addr_index(const struct udevice *dev, int index)
154 {
155 	fdt_addr_t addr = dev_read_addr_index(dev, index);
156 
157 	if (addr == FDT_ADDR_T_NONE)
158 		return NULL;
159 
160 	return map_physmem(addr, 0, MAP_NOCACHE);
161 }
162 
dev_read_addr_name(const struct udevice * dev,const char * name)163 fdt_addr_t dev_read_addr_name(const struct udevice *dev, const char *name)
164 {
165 	int index = dev_read_stringlist_search(dev, "reg-names", name);
166 
167 	if (index < 0)
168 		return FDT_ADDR_T_NONE;
169 	else
170 		return dev_read_addr_index(dev, index);
171 }
172 
dev_read_addr_size_name(const struct udevice * dev,const char * name,fdt_size_t * size)173 fdt_addr_t dev_read_addr_size_name(const struct udevice *dev, const char *name,
174 				   fdt_size_t *size)
175 {
176 	int index = dev_read_stringlist_search(dev, "reg-names", name);
177 
178 	if (index < 0)
179 		return FDT_ADDR_T_NONE;
180 	else
181 		return dev_read_addr_size_index(dev, index, size);
182 }
183 
dev_remap_addr_name(const struct udevice * dev,const char * name)184 void *dev_remap_addr_name(const struct udevice *dev, const char *name)
185 {
186 	fdt_addr_t addr = dev_read_addr_name(dev, name);
187 
188 	if (addr == FDT_ADDR_T_NONE)
189 		return NULL;
190 
191 	return map_physmem(addr, 0, MAP_NOCACHE);
192 }
193 
dev_read_addr(const struct udevice * dev)194 fdt_addr_t dev_read_addr(const struct udevice *dev)
195 {
196 	return dev_read_addr_index(dev, 0);
197 }
198 
dev_read_addr_ptr(const struct udevice * dev)199 void *dev_read_addr_ptr(const struct udevice *dev)
200 {
201 	fdt_addr_t addr = dev_read_addr(dev);
202 
203 	if (addr == FDT_ADDR_T_NONE)
204 		return NULL;
205 
206 	return map_sysmem(addr, 0);
207 }
208 
dev_remap_addr(const struct udevice * dev)209 void *dev_remap_addr(const struct udevice *dev)
210 {
211 	return dev_remap_addr_index(dev, 0);
212 }
213 
dev_read_addr_size(const struct udevice * dev,const char * property,fdt_size_t * sizep)214 fdt_addr_t dev_read_addr_size(const struct udevice *dev, const char *property,
215 			      fdt_size_t *sizep)
216 {
217 	return ofnode_get_addr_size(dev_ofnode(dev), property, sizep);
218 }
219 
dev_read_name(const struct udevice * dev)220 const char *dev_read_name(const struct udevice *dev)
221 {
222 	return ofnode_get_name(dev_ofnode(dev));
223 }
224 
dev_read_stringlist_search(const struct udevice * dev,const char * property,const char * string)225 int dev_read_stringlist_search(const struct udevice *dev, const char *property,
226 			       const char *string)
227 {
228 	return ofnode_stringlist_search(dev_ofnode(dev), property, string);
229 }
230 
dev_read_string_index(const struct udevice * dev,const char * propname,int index,const char ** outp)231 int dev_read_string_index(const struct udevice *dev, const char *propname,
232 			  int index, const char **outp)
233 {
234 	return ofnode_read_string_index(dev_ofnode(dev), propname, index, outp);
235 }
236 
dev_read_string_count(const struct udevice * dev,const char * propname)237 int dev_read_string_count(const struct udevice *dev, const char *propname)
238 {
239 	return ofnode_read_string_count(dev_ofnode(dev), propname);
240 }
241 
dev_read_string_list(const struct udevice * dev,const char * propname,const char *** listp)242 int dev_read_string_list(const struct udevice *dev, const char *propname,
243 			 const char ***listp)
244 {
245 	return ofnode_read_string_list(dev_ofnode(dev), propname, listp);
246 }
247 
dev_read_phandle_with_args(const struct udevice * dev,const char * list_name,const char * cells_name,int cell_count,int index,struct ofnode_phandle_args * out_args)248 int dev_read_phandle_with_args(const struct udevice *dev, const char *list_name,
249 			       const char *cells_name, int cell_count,
250 			       int index, struct ofnode_phandle_args *out_args)
251 {
252 	return ofnode_parse_phandle_with_args(dev_ofnode(dev), list_name,
253 					      cells_name, cell_count, index,
254 					      out_args);
255 }
256 
dev_count_phandle_with_args(const struct udevice * dev,const char * list_name,const char * cells_name,int cell_count)257 int dev_count_phandle_with_args(const struct udevice *dev,
258 				const char *list_name, const char *cells_name,
259 				int cell_count)
260 {
261 	return ofnode_count_phandle_with_args(dev_ofnode(dev), list_name,
262 					      cells_name, cell_count);
263 }
264 
dev_read_addr_cells(const struct udevice * dev)265 int dev_read_addr_cells(const struct udevice *dev)
266 {
267 	return ofnode_read_addr_cells(dev_ofnode(dev));
268 }
269 
dev_read_size_cells(const struct udevice * dev)270 int dev_read_size_cells(const struct udevice *dev)
271 {
272 	return ofnode_read_size_cells(dev_ofnode(dev));
273 }
274 
dev_read_simple_addr_cells(const struct udevice * dev)275 int dev_read_simple_addr_cells(const struct udevice *dev)
276 {
277 	return ofnode_read_simple_addr_cells(dev_ofnode(dev));
278 }
279 
dev_read_simple_size_cells(const struct udevice * dev)280 int dev_read_simple_size_cells(const struct udevice *dev)
281 {
282 	return ofnode_read_simple_size_cells(dev_ofnode(dev));
283 }
284 
dev_read_phandle(const struct udevice * dev)285 int dev_read_phandle(const struct udevice *dev)
286 {
287 	ofnode node = dev_ofnode(dev);
288 
289 	if (ofnode_is_np(node))
290 		return ofnode_to_np(node)->phandle;
291 	else
292 		return fdt_get_phandle(gd->fdt_blob, ofnode_to_offset(node));
293 }
294 
dev_read_prop(const struct udevice * dev,const char * propname,int * lenp)295 const void *dev_read_prop(const struct udevice *dev, const char *propname,
296 			  int *lenp)
297 {
298 	return ofnode_get_property(dev_ofnode(dev), propname, lenp);
299 }
300 
dev_read_first_prop(const struct udevice * dev,struct ofprop * prop)301 int dev_read_first_prop(const struct udevice *dev, struct ofprop *prop)
302 {
303 	return ofnode_first_property(dev_ofnode(dev), prop);
304 }
305 
dev_read_next_prop(struct ofprop * prop)306 int dev_read_next_prop(struct ofprop *prop)
307 {
308 	return ofnode_next_property(prop);
309 }
310 
dev_read_prop_by_prop(struct ofprop * prop,const char ** propname,int * lenp)311 const void *dev_read_prop_by_prop(struct ofprop *prop,
312 				  const char **propname, int *lenp)
313 {
314 	return ofprop_get_property(prop, propname, lenp);
315 }
316 
dev_read_alias_seq(const struct udevice * dev,int * devnump)317 int dev_read_alias_seq(const struct udevice *dev, int *devnump)
318 {
319 	ofnode node = dev_ofnode(dev);
320 	const char *uc_name = dev->uclass->uc_drv->name;
321 	int ret = -ENOTSUPP;
322 
323 	if (ofnode_is_np(node)) {
324 		ret = of_alias_get_id(ofnode_to_np(node), uc_name);
325 		if (ret >= 0) {
326 			*devnump = ret;
327 			ret = 0;
328 		}
329 	} else {
330 #if CONFIG_IS_ENABLED(OF_CONTROL)
331 		ret = fdtdec_get_alias_seq(gd->fdt_blob, uc_name,
332 					   ofnode_to_offset(node), devnump);
333 #endif
334 	}
335 
336 	return ret;
337 }
338 
dev_read_u32_array(const struct udevice * dev,const char * propname,u32 * out_values,size_t sz)339 int dev_read_u32_array(const struct udevice *dev, const char *propname,
340 		       u32 *out_values, size_t sz)
341 {
342 	return ofnode_read_u32_array(dev_ofnode(dev), propname, out_values, sz);
343 }
344 
dev_read_u8_array_ptr(const struct udevice * dev,const char * propname,size_t sz)345 const uint8_t *dev_read_u8_array_ptr(const struct udevice *dev,
346 				     const char *propname, size_t sz)
347 {
348 	return ofnode_read_u8_array_ptr(dev_ofnode(dev), propname, sz);
349 }
350 
dev_read_enabled(const struct udevice * dev)351 int dev_read_enabled(const struct udevice *dev)
352 {
353 	ofnode node = dev_ofnode(dev);
354 
355 	if (ofnode_is_np(node))
356 		return of_device_is_available(ofnode_to_np(node));
357 	else
358 		return fdtdec_get_is_enabled(gd->fdt_blob,
359 					     ofnode_to_offset(node));
360 }
361 
dev_read_resource(const struct udevice * dev,uint index,struct resource * res)362 int dev_read_resource(const struct udevice *dev, uint index,
363 		      struct resource *res)
364 {
365 	return ofnode_read_resource(dev_ofnode(dev), index, res);
366 }
367 
dev_read_resource_byname(const struct udevice * dev,const char * name,struct resource * res)368 int dev_read_resource_byname(const struct udevice *dev, const char *name,
369 			     struct resource *res)
370 {
371 	return ofnode_read_resource_byname(dev_ofnode(dev), name, res);
372 }
373 
dev_translate_address(const struct udevice * dev,const fdt32_t * in_addr)374 u64 dev_translate_address(const struct udevice *dev, const fdt32_t *in_addr)
375 {
376 	return ofnode_translate_address(dev_ofnode(dev), in_addr);
377 }
378 
dev_translate_dma_address(const struct udevice * dev,const fdt32_t * in_addr)379 u64 dev_translate_dma_address(const struct udevice *dev, const fdt32_t *in_addr)
380 {
381 	return ofnode_translate_dma_address(dev_ofnode(dev), in_addr);
382 }
383 
dev_get_dma_range(const struct udevice * dev,phys_addr_t * cpu,dma_addr_t * bus,u64 * size)384 int dev_get_dma_range(const struct udevice *dev, phys_addr_t *cpu,
385 		      dma_addr_t *bus, u64 *size)
386 {
387 	return ofnode_get_dma_range(dev_ofnode(dev), cpu, bus, size);
388 }
389 
dev_read_alias_highest_id(const char * stem)390 int dev_read_alias_highest_id(const char *stem)
391 {
392 	if (of_live_active())
393 		return of_alias_get_highest_id(stem);
394 
395 	return fdtdec_get_alias_highest_id(gd->fdt_blob, stem);
396 }
397 
dev_read_addr_pci(const struct udevice * dev)398 fdt_addr_t dev_read_addr_pci(const struct udevice *dev)
399 {
400 	ulong addr;
401 
402 	addr = dev_read_addr(dev);
403 	if (addr == FDT_ADDR_T_NONE && !of_live_active())
404 		addr = devfdt_get_addr_pci(dev);
405 
406 	return addr;
407 }
408 
dev_get_child_count(const struct udevice * dev)409 int dev_get_child_count(const struct udevice *dev)
410 {
411 	return ofnode_get_child_count(dev_ofnode(dev));
412 }
413 
dev_read_pci_bus_range(const struct udevice * dev,struct resource * res)414 int dev_read_pci_bus_range(const struct udevice *dev,
415 			   struct resource *res)
416 {
417 	const u32 *values;
418 	int len;
419 
420 	values = dev_read_prop(dev, "bus-range", &len);
421 	if (!values || len < sizeof(*values) * 2)
422 		return -EINVAL;
423 
424 	res->start = *values++;
425 	res->end = *values;
426 
427 	return 0;
428 }
429 
dev_decode_display_timing(const struct udevice * dev,int index,struct display_timing * config)430 int dev_decode_display_timing(const struct udevice *dev, int index,
431 			      struct display_timing *config)
432 {
433 	return ofnode_decode_display_timing(dev_ofnode(dev), index, config);
434 }
435 
dev_decode_panel_timing(const struct udevice * dev,struct display_timing * config)436 int dev_decode_panel_timing(const struct udevice *dev,
437 			    struct display_timing *config)
438 {
439 	return ofnode_decode_panel_timing(dev_ofnode(dev), config);
440 }
441 
dev_get_phy_node(const struct udevice * dev)442 ofnode dev_get_phy_node(const struct udevice *dev)
443 {
444 	return ofnode_get_phy_node(dev_ofnode(dev));
445 }
446 
dev_read_phy_mode(const struct udevice * dev)447 phy_interface_t dev_read_phy_mode(const struct udevice *dev)
448 {
449 	return ofnode_read_phy_mode(dev_ofnode(dev));
450 }
451