xref: /openbmc/u-boot/lib/fdtdec.c (revision 683b09d7)
1 /*
2  * Copyright (c) 2011 The Chromium OS Authors.
3  * SPDX-License-Identifier:	GPL-2.0+
4  */
5 
6 #ifndef USE_HOSTCC
7 #include <common.h>
8 #include <errno.h>
9 #include <serial.h>
10 #include <libfdt.h>
11 #include <fdtdec.h>
12 #include <asm/sections.h>
13 #include <linux/ctype.h>
14 
15 DECLARE_GLOBAL_DATA_PTR;
16 
17 /*
18  * Here are the type we know about. One day we might allow drivers to
19  * register. For now we just put them here. The COMPAT macro allows us to
20  * turn this into a sparse list later, and keeps the ID with the name.
21  */
22 #define COMPAT(id, name) name
23 static const char * const compat_names[COMPAT_COUNT] = {
24 	COMPAT(UNKNOWN, "<none>"),
25 	COMPAT(NVIDIA_TEGRA20_USB, "nvidia,tegra20-ehci"),
26 	COMPAT(NVIDIA_TEGRA30_USB, "nvidia,tegra30-ehci"),
27 	COMPAT(NVIDIA_TEGRA114_USB, "nvidia,tegra114-ehci"),
28 	COMPAT(NVIDIA_TEGRA20_EMC, "nvidia,tegra20-emc"),
29 	COMPAT(NVIDIA_TEGRA20_EMC_TABLE, "nvidia,tegra20-emc-table"),
30 	COMPAT(NVIDIA_TEGRA20_KBC, "nvidia,tegra20-kbc"),
31 	COMPAT(NVIDIA_TEGRA20_NAND, "nvidia,tegra20-nand"),
32 	COMPAT(NVIDIA_TEGRA20_PWM, "nvidia,tegra20-pwm"),
33 	COMPAT(NVIDIA_TEGRA124_DC, "nvidia,tegra124-dc"),
34 	COMPAT(NVIDIA_TEGRA124_SOR, "nvidia,tegra124-sor"),
35 	COMPAT(NVIDIA_TEGRA124_PMC, "nvidia,tegra124-pmc"),
36 	COMPAT(NVIDIA_TEGRA20_DC, "nvidia,tegra20-dc"),
37 	COMPAT(NVIDIA_TEGRA124_SDMMC, "nvidia,tegra124-sdhci"),
38 	COMPAT(NVIDIA_TEGRA30_SDMMC, "nvidia,tegra30-sdhci"),
39 	COMPAT(NVIDIA_TEGRA20_SDMMC, "nvidia,tegra20-sdhci"),
40 	COMPAT(NVIDIA_TEGRA124_PCIE, "nvidia,tegra124-pcie"),
41 	COMPAT(NVIDIA_TEGRA30_PCIE, "nvidia,tegra30-pcie"),
42 	COMPAT(NVIDIA_TEGRA20_PCIE, "nvidia,tegra20-pcie"),
43 	COMPAT(NVIDIA_TEGRA124_XUSB_PADCTL, "nvidia,tegra124-xusb-padctl"),
44 	COMPAT(SMSC_LAN9215, "smsc,lan9215"),
45 	COMPAT(SAMSUNG_EXYNOS5_SROMC, "samsung,exynos-sromc"),
46 	COMPAT(SAMSUNG_S3C2440_I2C, "samsung,s3c2440-i2c"),
47 	COMPAT(SAMSUNG_EXYNOS5_SOUND, "samsung,exynos-sound"),
48 	COMPAT(WOLFSON_WM8994_CODEC, "wolfson,wm8994-codec"),
49 	COMPAT(GOOGLE_CROS_EC_KEYB, "google,cros-ec-keyb"),
50 	COMPAT(SAMSUNG_EXYNOS_USB_PHY, "samsung,exynos-usb-phy"),
51 	COMPAT(SAMSUNG_EXYNOS5_USB3_PHY, "samsung,exynos5250-usb3-phy"),
52 	COMPAT(SAMSUNG_EXYNOS_TMU, "samsung,exynos-tmu"),
53 	COMPAT(SAMSUNG_EXYNOS_FIMD, "samsung,exynos-fimd"),
54 	COMPAT(SAMSUNG_EXYNOS_MIPI_DSI, "samsung,exynos-mipi-dsi"),
55 	COMPAT(SAMSUNG_EXYNOS5_DP, "samsung,exynos5-dp"),
56 	COMPAT(SAMSUNG_EXYNOS_DWMMC, "samsung,exynos-dwmmc"),
57 	COMPAT(SAMSUNG_EXYNOS_MMC, "samsung,exynos-mmc"),
58 	COMPAT(SAMSUNG_EXYNOS_SERIAL, "samsung,exynos4210-uart"),
59 	COMPAT(MAXIM_MAX77686_PMIC, "maxim,max77686"),
60 	COMPAT(GENERIC_SPI_FLASH, "spi-flash"),
61 	COMPAT(MAXIM_98095_CODEC, "maxim,max98095-codec"),
62 	COMPAT(INFINEON_SLB9635_TPM, "infineon,slb9635-tpm"),
63 	COMPAT(INFINEON_SLB9645_TPM, "infineon,slb9645tt"),
64 	COMPAT(SAMSUNG_EXYNOS5_I2C, "samsung,exynos5-hsi2c"),
65 	COMPAT(SANDBOX_LCD_SDL, "sandbox,lcd-sdl"),
66 	COMPAT(TI_TPS65090, "ti,tps65090"),
67 	COMPAT(COMPAT_NXP_PTN3460, "nxp,ptn3460"),
68 	COMPAT(SAMSUNG_EXYNOS_SYSMMU, "samsung,sysmmu-v3.3"),
69 	COMPAT(PARADE_PS8625, "parade,ps8625"),
70 	COMPAT(INTEL_MICROCODE, "intel,microcode"),
71 	COMPAT(MEMORY_SPD, "memory-spd"),
72 	COMPAT(INTEL_PANTHERPOINT_AHCI, "intel,pantherpoint-ahci"),
73 	COMPAT(INTEL_MODEL_206AX, "intel,model-206ax"),
74 	COMPAT(INTEL_GMA, "intel,gma"),
75 	COMPAT(AMS_AS3722, "ams,as3722"),
76 	COMPAT(INTEL_ICH_SPI, "intel,ich-spi"),
77 	COMPAT(INTEL_QRK_MRC, "intel,quark-mrc"),
78 	COMPAT(SOCIONEXT_XHCI, "socionext,uniphier-xhci"),
79 	COMPAT(COMPAT_INTEL_PCH, "intel,bd82x6x"),
80 	COMPAT(COMPAT_INTEL_IRQ_ROUTER, "intel,irq-router"),
81 };
82 
83 const char *fdtdec_get_compatible(enum fdt_compat_id id)
84 {
85 	/* We allow reading of the 'unknown' ID for testing purposes */
86 	assert(id >= 0 && id < COMPAT_COUNT);
87 	return compat_names[id];
88 }
89 
90 fdt_addr_t fdtdec_get_addr_size(const void *blob, int node,
91 		const char *prop_name, fdt_size_t *sizep)
92 {
93 	const fdt_addr_t *cell;
94 	int len;
95 
96 	debug("%s: %s: ", __func__, prop_name);
97 	cell = fdt_getprop(blob, node, prop_name, &len);
98 	if (cell && ((!sizep && len == sizeof(fdt_addr_t)) ||
99 		     len == sizeof(fdt_addr_t) * 2)) {
100 		fdt_addr_t addr = fdt_addr_to_cpu(*cell);
101 		if (sizep) {
102 			const fdt_size_t *size;
103 
104 			size = (fdt_size_t *)((char *)cell +
105 					sizeof(fdt_addr_t));
106 			*sizep = fdt_size_to_cpu(*size);
107 			debug("addr=%08lx, size=%08x\n",
108 			      (ulong)addr, *sizep);
109 		} else {
110 			debug("%08lx\n", (ulong)addr);
111 		}
112 		return addr;
113 	}
114 	debug("(not found)\n");
115 	return FDT_ADDR_T_NONE;
116 }
117 
118 fdt_addr_t fdtdec_get_addr(const void *blob, int node,
119 		const char *prop_name)
120 {
121 	return fdtdec_get_addr_size(blob, node, prop_name, NULL);
122 }
123 
124 #ifdef CONFIG_PCI
125 int fdtdec_get_pci_addr(const void *blob, int node, enum fdt_pci_space type,
126 		const char *prop_name, struct fdt_pci_addr *addr)
127 {
128 	const u32 *cell;
129 	int len;
130 	int ret = -ENOENT;
131 
132 	debug("%s: %s: ", __func__, prop_name);
133 
134 	/*
135 	 * If we follow the pci bus bindings strictly, we should check
136 	 * the value of the node's parent node's #address-cells and
137 	 * #size-cells. They need to be 3 and 2 accordingly. However,
138 	 * for simplicity we skip the check here.
139 	 */
140 	cell = fdt_getprop(blob, node, prop_name, &len);
141 	if (!cell)
142 		goto fail;
143 
144 	if ((len % FDT_PCI_REG_SIZE) == 0) {
145 		int num = len / FDT_PCI_REG_SIZE;
146 		int i;
147 
148 		for (i = 0; i < num; i++) {
149 			debug("pci address #%d: %08lx %08lx %08lx\n", i,
150 			      (ulong)fdt_addr_to_cpu(cell[0]),
151 			      (ulong)fdt_addr_to_cpu(cell[1]),
152 			      (ulong)fdt_addr_to_cpu(cell[2]));
153 			if ((fdt_addr_to_cpu(*cell) & type) == type) {
154 				addr->phys_hi = fdt_addr_to_cpu(cell[0]);
155 				addr->phys_mid = fdt_addr_to_cpu(cell[1]);
156 				addr->phys_lo = fdt_addr_to_cpu(cell[2]);
157 				break;
158 			} else {
159 				cell += (FDT_PCI_ADDR_CELLS +
160 					 FDT_PCI_SIZE_CELLS);
161 			}
162 		}
163 
164 		if (i == num) {
165 			ret = -ENXIO;
166 			goto fail;
167 		}
168 
169 		return 0;
170 	} else {
171 		ret = -EINVAL;
172 	}
173 
174 fail:
175 	debug("(not found)\n");
176 	return ret;
177 }
178 
179 int fdtdec_get_pci_vendev(const void *blob, int node, u16 *vendor, u16 *device)
180 {
181 	const char *list, *end;
182 	int len;
183 
184 	list = fdt_getprop(blob, node, "compatible", &len);
185 	if (!list)
186 		return -ENOENT;
187 
188 	end = list + len;
189 	while (list < end) {
190 		char *s;
191 
192 		len = strlen(list);
193 		if (len >= strlen("pciVVVV,DDDD")) {
194 			s = strstr(list, "pci");
195 
196 			/*
197 			 * check if the string is something like pciVVVV,DDDD.RR
198 			 * or just pciVVVV,DDDD
199 			 */
200 			if (s && s[7] == ',' &&
201 			    (s[12] == '.' || s[12] == 0)) {
202 				s += 3;
203 				*vendor = simple_strtol(s, NULL, 16);
204 
205 				s += 5;
206 				*device = simple_strtol(s, NULL, 16);
207 
208 				return 0;
209 			}
210 		} else {
211 			list += (len + 1);
212 		}
213 	}
214 
215 	return -ENOENT;
216 }
217 
218 int fdtdec_get_pci_bdf(const void *blob, int node,
219 		struct fdt_pci_addr *addr, pci_dev_t *bdf)
220 {
221 	u16 dt_vendor, dt_device, vendor, device;
222 	int ret;
223 
224 	/* get vendor id & device id from the compatible string */
225 	ret = fdtdec_get_pci_vendev(blob, node, &dt_vendor, &dt_device);
226 	if (ret)
227 		return ret;
228 
229 	/* extract the bdf from fdt_pci_addr */
230 	*bdf = addr->phys_hi & 0xffff00;
231 
232 	/* read vendor id & device id based on bdf */
233 	pci_read_config_word(*bdf, PCI_VENDOR_ID, &vendor);
234 	pci_read_config_word(*bdf, PCI_DEVICE_ID, &device);
235 
236 	/*
237 	 * Note there are two places in the device tree to fully describe
238 	 * a pci device: one is via compatible string with a format of
239 	 * "pciVVVV,DDDD" and the other one is the bdf numbers encoded in
240 	 * the device node's reg address property. We read the vendor id
241 	 * and device id based on bdf and compare the values with the
242 	 * "VVVV,DDDD". If they are the same, then we are good to use bdf
243 	 * to read device's bar. But if they are different, we have to rely
244 	 * on the vendor id and device id extracted from the compatible
245 	 * string and locate the real bdf by pci_find_device(). This is
246 	 * because normally we may only know device's device number and
247 	 * function number when writing device tree. The bus number is
248 	 * dynamically assigned during the pci enumeration process.
249 	 */
250 	if ((dt_vendor != vendor) || (dt_device != device)) {
251 		*bdf = pci_find_device(dt_vendor, dt_device, 0);
252 		if (*bdf == -1)
253 			return -ENODEV;
254 	}
255 
256 	return 0;
257 }
258 
259 int fdtdec_get_pci_bar32(const void *blob, int node,
260 		struct fdt_pci_addr *addr, u32 *bar)
261 {
262 	pci_dev_t bdf;
263 	int barnum;
264 	int ret;
265 
266 	/* get pci devices's bdf */
267 	ret = fdtdec_get_pci_bdf(blob, node, addr, &bdf);
268 	if (ret)
269 		return ret;
270 
271 	/* extract the bar number from fdt_pci_addr */
272 	barnum = addr->phys_hi & 0xff;
273 	if ((barnum < PCI_BASE_ADDRESS_0) || (barnum > PCI_CARDBUS_CIS))
274 		return -EINVAL;
275 
276 	barnum = (barnum - PCI_BASE_ADDRESS_0) / 4;
277 	*bar = pci_read_bar32(pci_bus_to_hose(PCI_BUS(bdf)), bdf, barnum);
278 
279 	return 0;
280 }
281 #endif
282 
283 uint64_t fdtdec_get_uint64(const void *blob, int node, const char *prop_name,
284 		uint64_t default_val)
285 {
286 	const uint64_t *cell64;
287 	int length;
288 
289 	cell64 = fdt_getprop(blob, node, prop_name, &length);
290 	if (!cell64 || length < sizeof(*cell64))
291 		return default_val;
292 
293 	return fdt64_to_cpu(*cell64);
294 }
295 
296 int fdtdec_get_is_enabled(const void *blob, int node)
297 {
298 	const char *cell;
299 
300 	/*
301 	 * It should say "okay", so only allow that. Some fdts use "ok" but
302 	 * this is a bug. Please fix your device tree source file. See here
303 	 * for discussion:
304 	 *
305 	 * http://www.mail-archive.com/u-boot@lists.denx.de/msg71598.html
306 	 */
307 	cell = fdt_getprop(blob, node, "status", NULL);
308 	if (cell)
309 		return 0 == strcmp(cell, "okay");
310 	return 1;
311 }
312 
313 enum fdt_compat_id fdtdec_lookup(const void *blob, int node)
314 {
315 	enum fdt_compat_id id;
316 
317 	/* Search our drivers */
318 	for (id = COMPAT_UNKNOWN; id < COMPAT_COUNT; id++)
319 		if (0 == fdt_node_check_compatible(blob, node,
320 				compat_names[id]))
321 			return id;
322 	return COMPAT_UNKNOWN;
323 }
324 
325 int fdtdec_next_compatible(const void *blob, int node,
326 		enum fdt_compat_id id)
327 {
328 	return fdt_node_offset_by_compatible(blob, node, compat_names[id]);
329 }
330 
331 int fdtdec_next_compatible_subnode(const void *blob, int node,
332 		enum fdt_compat_id id, int *depthp)
333 {
334 	do {
335 		node = fdt_next_node(blob, node, depthp);
336 	} while (*depthp > 1);
337 
338 	/* If this is a direct subnode, and compatible, return it */
339 	if (*depthp == 1 && 0 == fdt_node_check_compatible(
340 						blob, node, compat_names[id]))
341 		return node;
342 
343 	return -FDT_ERR_NOTFOUND;
344 }
345 
346 int fdtdec_next_alias(const void *blob, const char *name,
347 		enum fdt_compat_id id, int *upto)
348 {
349 #define MAX_STR_LEN 20
350 	char str[MAX_STR_LEN + 20];
351 	int node, err;
352 
353 	/* snprintf() is not available */
354 	assert(strlen(name) < MAX_STR_LEN);
355 	sprintf(str, "%.*s%d", MAX_STR_LEN, name, *upto);
356 	node = fdt_path_offset(blob, str);
357 	if (node < 0)
358 		return node;
359 	err = fdt_node_check_compatible(blob, node, compat_names[id]);
360 	if (err < 0)
361 		return err;
362 	if (err)
363 		return -FDT_ERR_NOTFOUND;
364 	(*upto)++;
365 	return node;
366 }
367 
368 int fdtdec_find_aliases_for_id(const void *blob, const char *name,
369 			enum fdt_compat_id id, int *node_list, int maxcount)
370 {
371 	memset(node_list, '\0', sizeof(*node_list) * maxcount);
372 
373 	return fdtdec_add_aliases_for_id(blob, name, id, node_list, maxcount);
374 }
375 
376 /* TODO: Can we tighten this code up a little? */
377 int fdtdec_add_aliases_for_id(const void *blob, const char *name,
378 			enum fdt_compat_id id, int *node_list, int maxcount)
379 {
380 	int name_len = strlen(name);
381 	int nodes[maxcount];
382 	int num_found = 0;
383 	int offset, node;
384 	int alias_node;
385 	int count;
386 	int i, j;
387 
388 	/* find the alias node if present */
389 	alias_node = fdt_path_offset(blob, "/aliases");
390 
391 	/*
392 	 * start with nothing, and we can assume that the root node can't
393 	 * match
394 	 */
395 	memset(nodes, '\0', sizeof(nodes));
396 
397 	/* First find all the compatible nodes */
398 	for (node = count = 0; node >= 0 && count < maxcount;) {
399 		node = fdtdec_next_compatible(blob, node, id);
400 		if (node >= 0)
401 			nodes[count++] = node;
402 	}
403 	if (node >= 0)
404 		debug("%s: warning: maxcount exceeded with alias '%s'\n",
405 		       __func__, name);
406 
407 	/* Now find all the aliases */
408 	for (offset = fdt_first_property_offset(blob, alias_node);
409 			offset > 0;
410 			offset = fdt_next_property_offset(blob, offset)) {
411 		const struct fdt_property *prop;
412 		const char *path;
413 		int number;
414 		int found;
415 
416 		node = 0;
417 		prop = fdt_get_property_by_offset(blob, offset, NULL);
418 		path = fdt_string(blob, fdt32_to_cpu(prop->nameoff));
419 		if (prop->len && 0 == strncmp(path, name, name_len))
420 			node = fdt_path_offset(blob, prop->data);
421 		if (node <= 0)
422 			continue;
423 
424 		/* Get the alias number */
425 		number = simple_strtoul(path + name_len, NULL, 10);
426 		if (number < 0 || number >= maxcount) {
427 			debug("%s: warning: alias '%s' is out of range\n",
428 			       __func__, path);
429 			continue;
430 		}
431 
432 		/* Make sure the node we found is actually in our list! */
433 		found = -1;
434 		for (j = 0; j < count; j++)
435 			if (nodes[j] == node) {
436 				found = j;
437 				break;
438 			}
439 
440 		if (found == -1) {
441 			debug("%s: warning: alias '%s' points to a node "
442 				"'%s' that is missing or is not compatible "
443 				" with '%s'\n", __func__, path,
444 				fdt_get_name(blob, node, NULL),
445 			       compat_names[id]);
446 			continue;
447 		}
448 
449 		/*
450 		 * Add this node to our list in the right place, and mark
451 		 * it as done.
452 		 */
453 		if (fdtdec_get_is_enabled(blob, node)) {
454 			if (node_list[number]) {
455 				debug("%s: warning: alias '%s' requires that "
456 				      "a node be placed in the list in a "
457 				      "position which is already filled by "
458 				      "node '%s'\n", __func__, path,
459 				      fdt_get_name(blob, node, NULL));
460 				continue;
461 			}
462 			node_list[number] = node;
463 			if (number >= num_found)
464 				num_found = number + 1;
465 		}
466 		nodes[found] = 0;
467 	}
468 
469 	/* Add any nodes not mentioned by an alias */
470 	for (i = j = 0; i < maxcount; i++) {
471 		if (!node_list[i]) {
472 			for (; j < maxcount; j++)
473 				if (nodes[j] &&
474 					fdtdec_get_is_enabled(blob, nodes[j]))
475 					break;
476 
477 			/* Have we run out of nodes to add? */
478 			if (j == maxcount)
479 				break;
480 
481 			assert(!node_list[i]);
482 			node_list[i] = nodes[j++];
483 			if (i >= num_found)
484 				num_found = i + 1;
485 		}
486 	}
487 
488 	return num_found;
489 }
490 
491 int fdtdec_get_alias_seq(const void *blob, const char *base, int offset,
492 			 int *seqp)
493 {
494 	int base_len = strlen(base);
495 	const char *find_name;
496 	int find_namelen;
497 	int prop_offset;
498 	int aliases;
499 
500 	find_name = fdt_get_name(blob, offset, &find_namelen);
501 	debug("Looking for '%s' at %d, name %s\n", base, offset, find_name);
502 
503 	aliases = fdt_path_offset(blob, "/aliases");
504 	for (prop_offset = fdt_first_property_offset(blob, aliases);
505 	     prop_offset > 0;
506 	     prop_offset = fdt_next_property_offset(blob, prop_offset)) {
507 		const char *prop;
508 		const char *name;
509 		const char *slash;
510 		const char *p;
511 		int len;
512 
513 		prop = fdt_getprop_by_offset(blob, prop_offset, &name, &len);
514 		debug("   - %s, %s\n", name, prop);
515 		if (len < find_namelen || *prop != '/' || prop[len - 1] ||
516 		    strncmp(name, base, base_len))
517 			continue;
518 
519 		slash = strrchr(prop, '/');
520 		if (strcmp(slash + 1, find_name))
521 			continue;
522 		for (p = name + strlen(name) - 1; p > name; p--) {
523 			if (!isdigit(*p)) {
524 				*seqp = simple_strtoul(p + 1, NULL, 10);
525 				debug("Found seq %d\n", *seqp);
526 				return 0;
527 			}
528 		}
529 	}
530 
531 	debug("Not found\n");
532 	return -ENOENT;
533 }
534 
535 int fdtdec_get_chosen_node(const void *blob, const char *name)
536 {
537 	const char *prop;
538 	int chosen_node;
539 	int len;
540 
541 	if (!blob)
542 		return -FDT_ERR_NOTFOUND;
543 	chosen_node = fdt_path_offset(blob, "/chosen");
544 	prop = fdt_getprop(blob, chosen_node, name, &len);
545 	if (!prop)
546 		return -FDT_ERR_NOTFOUND;
547 	return fdt_path_offset(blob, prop);
548 }
549 
550 int fdtdec_check_fdt(void)
551 {
552 	/*
553 	 * We must have an FDT, but we cannot panic() yet since the console
554 	 * is not ready. So for now, just assert(). Boards which need an early
555 	 * FDT (prior to console ready) will need to make their own
556 	 * arrangements and do their own checks.
557 	 */
558 	assert(!fdtdec_prepare_fdt());
559 	return 0;
560 }
561 
562 /*
563  * This function is a little odd in that it accesses global data. At some
564  * point if the architecture board.c files merge this will make more sense.
565  * Even now, it is common code.
566  */
567 int fdtdec_prepare_fdt(void)
568 {
569 	if (!gd->fdt_blob || ((uintptr_t)gd->fdt_blob & 3) ||
570 	    fdt_check_header(gd->fdt_blob)) {
571 #ifdef CONFIG_SPL_BUILD
572 		puts("Missing DTB\n");
573 #else
574 		puts("No valid device tree binary found - please append one to U-Boot binary, use u-boot-dtb.bin or define CONFIG_OF_EMBED. For sandbox, use -d <file.dtb>\n");
575 #endif
576 		return -1;
577 	}
578 	return 0;
579 }
580 
581 int fdtdec_lookup_phandle(const void *blob, int node, const char *prop_name)
582 {
583 	const u32 *phandle;
584 	int lookup;
585 
586 	debug("%s: %s\n", __func__, prop_name);
587 	phandle = fdt_getprop(blob, node, prop_name, NULL);
588 	if (!phandle)
589 		return -FDT_ERR_NOTFOUND;
590 
591 	lookup = fdt_node_offset_by_phandle(blob, fdt32_to_cpu(*phandle));
592 	return lookup;
593 }
594 
595 /**
596  * Look up a property in a node and check that it has a minimum length.
597  *
598  * @param blob		FDT blob
599  * @param node		node to examine
600  * @param prop_name	name of property to find
601  * @param min_len	minimum property length in bytes
602  * @param err		0 if ok, or -FDT_ERR_NOTFOUND if the property is not
603 			found, or -FDT_ERR_BADLAYOUT if not enough data
604  * @return pointer to cell, which is only valid if err == 0
605  */
606 static const void *get_prop_check_min_len(const void *blob, int node,
607 		const char *prop_name, int min_len, int *err)
608 {
609 	const void *cell;
610 	int len;
611 
612 	debug("%s: %s\n", __func__, prop_name);
613 	cell = fdt_getprop(blob, node, prop_name, &len);
614 	if (!cell)
615 		*err = -FDT_ERR_NOTFOUND;
616 	else if (len < min_len)
617 		*err = -FDT_ERR_BADLAYOUT;
618 	else
619 		*err = 0;
620 	return cell;
621 }
622 
623 int fdtdec_get_int_array(const void *blob, int node, const char *prop_name,
624 		u32 *array, int count)
625 {
626 	const u32 *cell;
627 	int i, err = 0;
628 
629 	debug("%s: %s\n", __func__, prop_name);
630 	cell = get_prop_check_min_len(blob, node, prop_name,
631 				      sizeof(u32) * count, &err);
632 	if (!err) {
633 		for (i = 0; i < count; i++)
634 			array[i] = fdt32_to_cpu(cell[i]);
635 	}
636 	return err;
637 }
638 
639 int fdtdec_get_int_array_count(const void *blob, int node,
640 			       const char *prop_name, u32 *array, int count)
641 {
642 	const u32 *cell;
643 	int len, elems;
644 	int i;
645 
646 	debug("%s: %s\n", __func__, prop_name);
647 	cell = fdt_getprop(blob, node, prop_name, &len);
648 	if (!cell)
649 		return -FDT_ERR_NOTFOUND;
650 	elems = len / sizeof(u32);
651 	if (count > elems)
652 		count = elems;
653 	for (i = 0; i < count; i++)
654 		array[i] = fdt32_to_cpu(cell[i]);
655 
656 	return count;
657 }
658 
659 const u32 *fdtdec_locate_array(const void *blob, int node,
660 			       const char *prop_name, int count)
661 {
662 	const u32 *cell;
663 	int err;
664 
665 	cell = get_prop_check_min_len(blob, node, prop_name,
666 				      sizeof(u32) * count, &err);
667 	return err ? NULL : cell;
668 }
669 
670 int fdtdec_get_bool(const void *blob, int node, const char *prop_name)
671 {
672 	const s32 *cell;
673 	int len;
674 
675 	debug("%s: %s\n", __func__, prop_name);
676 	cell = fdt_getprop(blob, node, prop_name, &len);
677 	return cell != NULL;
678 }
679 
680 int fdtdec_parse_phandle_with_args(const void *blob, int src_node,
681 				   const char *list_name,
682 				   const char *cells_name,
683 				   int cell_count, int index,
684 				   struct fdtdec_phandle_args *out_args)
685 {
686 	const __be32 *list, *list_end;
687 	int rc = 0, size, cur_index = 0;
688 	uint32_t count = 0;
689 	int node = -1;
690 	int phandle;
691 
692 	/* Retrieve the phandle list property */
693 	list = fdt_getprop(blob, src_node, list_name, &size);
694 	if (!list)
695 		return -ENOENT;
696 	list_end = list + size / sizeof(*list);
697 
698 	/* Loop over the phandles until all the requested entry is found */
699 	while (list < list_end) {
700 		rc = -EINVAL;
701 		count = 0;
702 
703 		/*
704 		 * If phandle is 0, then it is an empty entry with no
705 		 * arguments.  Skip forward to the next entry.
706 		 */
707 		phandle = be32_to_cpup(list++);
708 		if (phandle) {
709 			/*
710 			 * Find the provider node and parse the #*-cells
711 			 * property to determine the argument length.
712 			 *
713 			 * This is not needed if the cell count is hard-coded
714 			 * (i.e. cells_name not set, but cell_count is set),
715 			 * except when we're going to return the found node
716 			 * below.
717 			 */
718 			if (cells_name || cur_index == index) {
719 				node = fdt_node_offset_by_phandle(blob,
720 								  phandle);
721 				if (!node) {
722 					debug("%s: could not find phandle\n",
723 					      fdt_get_name(blob, src_node,
724 							   NULL));
725 					goto err;
726 				}
727 			}
728 
729 			if (cells_name) {
730 				count = fdtdec_get_int(blob, node, cells_name,
731 						       -1);
732 				if (count == -1) {
733 					debug("%s: could not get %s for %s\n",
734 					      fdt_get_name(blob, src_node,
735 							   NULL),
736 					      cells_name,
737 					      fdt_get_name(blob, node,
738 							   NULL));
739 					goto err;
740 				}
741 			} else {
742 				count = cell_count;
743 			}
744 
745 			/*
746 			 * Make sure that the arguments actually fit in the
747 			 * remaining property data length
748 			 */
749 			if (list + count > list_end) {
750 				debug("%s: arguments longer than property\n",
751 				      fdt_get_name(blob, src_node, NULL));
752 				goto err;
753 			}
754 		}
755 
756 		/*
757 		 * All of the error cases above bail out of the loop, so at
758 		 * this point, the parsing is successful. If the requested
759 		 * index matches, then fill the out_args structure and return,
760 		 * or return -ENOENT for an empty entry.
761 		 */
762 		rc = -ENOENT;
763 		if (cur_index == index) {
764 			if (!phandle)
765 				goto err;
766 
767 			if (out_args) {
768 				int i;
769 
770 				if (count > MAX_PHANDLE_ARGS) {
771 					debug("%s: too many arguments %d\n",
772 					      fdt_get_name(blob, src_node,
773 							   NULL), count);
774 					count = MAX_PHANDLE_ARGS;
775 				}
776 				out_args->node = node;
777 				out_args->args_count = count;
778 				for (i = 0; i < count; i++) {
779 					out_args->args[i] =
780 							be32_to_cpup(list++);
781 				}
782 			}
783 
784 			/* Found it! return success */
785 			return 0;
786 		}
787 
788 		node = -1;
789 		list += count;
790 		cur_index++;
791 	}
792 
793 	/*
794 	 * Result will be one of:
795 	 * -ENOENT : index is for empty phandle
796 	 * -EINVAL : parsing error on data
797 	 * [1..n]  : Number of phandle (count mode; when index = -1)
798 	 */
799 	rc = index < 0 ? cur_index : -ENOENT;
800  err:
801 	return rc;
802 }
803 
804 int fdtdec_get_byte_array(const void *blob, int node, const char *prop_name,
805 		u8 *array, int count)
806 {
807 	const u8 *cell;
808 	int err;
809 
810 	cell = get_prop_check_min_len(blob, node, prop_name, count, &err);
811 	if (!err)
812 		memcpy(array, cell, count);
813 	return err;
814 }
815 
816 const u8 *fdtdec_locate_byte_array(const void *blob, int node,
817 			     const char *prop_name, int count)
818 {
819 	const u8 *cell;
820 	int err;
821 
822 	cell = get_prop_check_min_len(blob, node, prop_name, count, &err);
823 	if (err)
824 		return NULL;
825 	return cell;
826 }
827 
828 int fdtdec_get_config_int(const void *blob, const char *prop_name,
829 		int default_val)
830 {
831 	int config_node;
832 
833 	debug("%s: %s\n", __func__, prop_name);
834 	config_node = fdt_path_offset(blob, "/config");
835 	if (config_node < 0)
836 		return default_val;
837 	return fdtdec_get_int(blob, config_node, prop_name, default_val);
838 }
839 
840 int fdtdec_get_config_bool(const void *blob, const char *prop_name)
841 {
842 	int config_node;
843 	const void *prop;
844 
845 	debug("%s: %s\n", __func__, prop_name);
846 	config_node = fdt_path_offset(blob, "/config");
847 	if (config_node < 0)
848 		return 0;
849 	prop = fdt_get_property(blob, config_node, prop_name, NULL);
850 
851 	return prop != NULL;
852 }
853 
854 char *fdtdec_get_config_string(const void *blob, const char *prop_name)
855 {
856 	const char *nodep;
857 	int nodeoffset;
858 	int len;
859 
860 	debug("%s: %s\n", __func__, prop_name);
861 	nodeoffset = fdt_path_offset(blob, "/config");
862 	if (nodeoffset < 0)
863 		return NULL;
864 
865 	nodep = fdt_getprop(blob, nodeoffset, prop_name, &len);
866 	if (!nodep)
867 		return NULL;
868 
869 	return (char *)nodep;
870 }
871 
872 int fdtdec_decode_region(const void *blob, int node, const char *prop_name,
873 			 fdt_addr_t *basep, fdt_size_t *sizep)
874 {
875 	const fdt_addr_t *cell;
876 	int len;
877 
878 	debug("%s: %s: %s\n", __func__, fdt_get_name(blob, node, NULL),
879 	      prop_name);
880 	cell = fdt_getprop(blob, node, prop_name, &len);
881 	if (!cell || (len < sizeof(fdt_addr_t) * 2)) {
882 		debug("cell=%p, len=%d\n", cell, len);
883 		return -1;
884 	}
885 
886 	*basep = fdt_addr_to_cpu(*cell);
887 	*sizep = fdt_size_to_cpu(cell[1]);
888 	debug("%s: base=%08lx, size=%lx\n", __func__, (ulong)*basep,
889 	      (ulong)*sizep);
890 
891 	return 0;
892 }
893 
894 /**
895  * Read a flash entry from the fdt
896  *
897  * @param blob		FDT blob
898  * @param node		Offset of node to read
899  * @param name		Name of node being read
900  * @param entry		Place to put offset and size of this node
901  * @return 0 if ok, -ve on error
902  */
903 int fdtdec_read_fmap_entry(const void *blob, int node, const char *name,
904 			   struct fmap_entry *entry)
905 {
906 	const char *prop;
907 	u32 reg[2];
908 
909 	if (fdtdec_get_int_array(blob, node, "reg", reg, 2)) {
910 		debug("Node '%s' has bad/missing 'reg' property\n", name);
911 		return -FDT_ERR_NOTFOUND;
912 	}
913 	entry->offset = reg[0];
914 	entry->length = reg[1];
915 	entry->used = fdtdec_get_int(blob, node, "used", entry->length);
916 	prop = fdt_getprop(blob, node, "compress", NULL);
917 	entry->compress_algo = prop && !strcmp(prop, "lzo") ?
918 		FMAP_COMPRESS_LZO : FMAP_COMPRESS_NONE;
919 	prop = fdt_getprop(blob, node, "hash", &entry->hash_size);
920 	entry->hash_algo = prop ? FMAP_HASH_SHA256 : FMAP_HASH_NONE;
921 	entry->hash = (uint8_t *)prop;
922 
923 	return 0;
924 }
925 
926 u64 fdtdec_get_number(const fdt32_t *ptr, unsigned int cells)
927 {
928 	u64 number = 0;
929 
930 	while (cells--)
931 		number = (number << 32) | fdt32_to_cpu(*ptr++);
932 
933 	return number;
934 }
935 
936 int fdt_get_resource(const void *fdt, int node, const char *property,
937 		     unsigned int index, struct fdt_resource *res)
938 {
939 	const fdt32_t *ptr, *end;
940 	int na, ns, len, parent;
941 	unsigned int i = 0;
942 
943 	parent = fdt_parent_offset(fdt, node);
944 	if (parent < 0)
945 		return parent;
946 
947 	na = fdt_address_cells(fdt, parent);
948 	ns = fdt_size_cells(fdt, parent);
949 
950 	ptr = fdt_getprop(fdt, node, property, &len);
951 	if (!ptr)
952 		return len;
953 
954 	end = ptr + len / sizeof(*ptr);
955 
956 	while (ptr + na + ns <= end) {
957 		if (i == index) {
958 			res->start = res->end = fdtdec_get_number(ptr, na);
959 			res->end += fdtdec_get_number(&ptr[na], ns) - 1;
960 			return 0;
961 		}
962 
963 		ptr += na + ns;
964 		i++;
965 	}
966 
967 	return -FDT_ERR_NOTFOUND;
968 }
969 
970 int fdt_get_named_resource(const void *fdt, int node, const char *property,
971 			   const char *prop_names, const char *name,
972 			   struct fdt_resource *res)
973 {
974 	int index;
975 
976 	index = fdt_find_string(fdt, node, prop_names, name);
977 	if (index < 0)
978 		return index;
979 
980 	return fdt_get_resource(fdt, node, property, index, res);
981 }
982 
983 int fdtdec_decode_memory_region(const void *blob, int config_node,
984 				const char *mem_type, const char *suffix,
985 				fdt_addr_t *basep, fdt_size_t *sizep)
986 {
987 	char prop_name[50];
988 	const char *mem;
989 	fdt_size_t size, offset_size;
990 	fdt_addr_t base, offset;
991 	int node;
992 
993 	if (config_node == -1) {
994 		config_node = fdt_path_offset(blob, "/config");
995 		if (config_node < 0) {
996 			debug("%s: Cannot find /config node\n", __func__);
997 			return -ENOENT;
998 		}
999 	}
1000 	if (!suffix)
1001 		suffix = "";
1002 
1003 	snprintf(prop_name, sizeof(prop_name), "%s-memory%s", mem_type,
1004 		 suffix);
1005 	mem = fdt_getprop(blob, config_node, prop_name, NULL);
1006 	if (!mem) {
1007 		debug("%s: No memory type for '%s', using /memory\n", __func__,
1008 		      prop_name);
1009 		mem = "/memory";
1010 	}
1011 
1012 	node = fdt_path_offset(blob, mem);
1013 	if (node < 0) {
1014 		debug("%s: Failed to find node '%s': %s\n", __func__, mem,
1015 		      fdt_strerror(node));
1016 		return -ENOENT;
1017 	}
1018 
1019 	/*
1020 	 * Not strictly correct - the memory may have multiple banks. We just
1021 	 * use the first
1022 	 */
1023 	if (fdtdec_decode_region(blob, node, "reg", &base, &size)) {
1024 		debug("%s: Failed to decode memory region %s\n", __func__,
1025 		      mem);
1026 		return -EINVAL;
1027 	}
1028 
1029 	snprintf(prop_name, sizeof(prop_name), "%s-offset%s", mem_type,
1030 		 suffix);
1031 	if (fdtdec_decode_region(blob, config_node, prop_name, &offset,
1032 				 &offset_size)) {
1033 		debug("%s: Failed to decode memory region '%s'\n", __func__,
1034 		      prop_name);
1035 		return -EINVAL;
1036 	}
1037 
1038 	*basep = base + offset;
1039 	*sizep = offset_size;
1040 
1041 	return 0;
1042 }
1043 
1044 static int decode_timing_property(const void *blob, int node, const char *name,
1045 				  struct timing_entry *result)
1046 {
1047 	int length, ret = 0;
1048 	const u32 *prop;
1049 
1050 	prop = fdt_getprop(blob, node, name, &length);
1051 	if (!prop) {
1052 		debug("%s: could not find property %s\n",
1053 		      fdt_get_name(blob, node, NULL), name);
1054 		return length;
1055 	}
1056 
1057 	if (length == sizeof(u32)) {
1058 		result->typ = fdtdec_get_int(blob, node, name, 0);
1059 		result->min = result->typ;
1060 		result->max = result->typ;
1061 	} else {
1062 		ret = fdtdec_get_int_array(blob, node, name, &result->min, 3);
1063 	}
1064 
1065 	return ret;
1066 }
1067 
1068 int fdtdec_decode_display_timing(const void *blob, int parent, int index,
1069 				 struct display_timing *dt)
1070 {
1071 	int i, node, timings_node;
1072 	u32 val = 0;
1073 	int ret = 0;
1074 
1075 	timings_node = fdt_subnode_offset(blob, parent, "display-timings");
1076 	if (timings_node < 0)
1077 		return timings_node;
1078 
1079 	for (i = 0, node = fdt_first_subnode(blob, timings_node);
1080 	     node > 0 && i != index;
1081 	     node = fdt_next_subnode(blob, node))
1082 		i++;
1083 
1084 	if (node < 0)
1085 		return node;
1086 
1087 	memset(dt, 0, sizeof(*dt));
1088 
1089 	ret |= decode_timing_property(blob, node, "hback-porch",
1090 				      &dt->hback_porch);
1091 	ret |= decode_timing_property(blob, node, "hfront-porch",
1092 				      &dt->hfront_porch);
1093 	ret |= decode_timing_property(blob, node, "hactive", &dt->hactive);
1094 	ret |= decode_timing_property(blob, node, "hsync-len", &dt->hsync_len);
1095 	ret |= decode_timing_property(blob, node, "vback-porch",
1096 				      &dt->vback_porch);
1097 	ret |= decode_timing_property(blob, node, "vfront-porch",
1098 				      &dt->vfront_porch);
1099 	ret |= decode_timing_property(blob, node, "vactive", &dt->vactive);
1100 	ret |= decode_timing_property(blob, node, "vsync-len", &dt->vsync_len);
1101 	ret |= decode_timing_property(blob, node, "clock-frequency",
1102 				      &dt->pixelclock);
1103 
1104 	dt->flags = 0;
1105 	val = fdtdec_get_int(blob, node, "vsync-active", -1);
1106 	if (val != -1) {
1107 		dt->flags |= val ? DISPLAY_FLAGS_VSYNC_HIGH :
1108 				DISPLAY_FLAGS_VSYNC_LOW;
1109 	}
1110 	val = fdtdec_get_int(blob, node, "hsync-active", -1);
1111 	if (val != -1) {
1112 		dt->flags |= val ? DISPLAY_FLAGS_HSYNC_HIGH :
1113 				DISPLAY_FLAGS_HSYNC_LOW;
1114 	}
1115 	val = fdtdec_get_int(blob, node, "de-active", -1);
1116 	if (val != -1) {
1117 		dt->flags |= val ? DISPLAY_FLAGS_DE_HIGH :
1118 				DISPLAY_FLAGS_DE_LOW;
1119 	}
1120 	val = fdtdec_get_int(blob, node, "pixelclk-active", -1);
1121 	if (val != -1) {
1122 		dt->flags |= val ? DISPLAY_FLAGS_PIXDATA_POSEDGE :
1123 				DISPLAY_FLAGS_PIXDATA_NEGEDGE;
1124 	}
1125 
1126 	if (fdtdec_get_bool(blob, node, "interlaced"))
1127 		dt->flags |= DISPLAY_FLAGS_INTERLACED;
1128 	if (fdtdec_get_bool(blob, node, "doublescan"))
1129 		dt->flags |= DISPLAY_FLAGS_DOUBLESCAN;
1130 	if (fdtdec_get_bool(blob, node, "doubleclk"))
1131 		dt->flags |= DISPLAY_FLAGS_DOUBLECLK;
1132 
1133 	return 0;
1134 }
1135 
1136 int fdtdec_setup(void)
1137 {
1138 #ifdef CONFIG_OF_CONTROL
1139 # ifdef CONFIG_OF_EMBED
1140 	/* Get a pointer to the FDT */
1141 	gd->fdt_blob = __dtb_dt_begin;
1142 # elif defined CONFIG_OF_SEPARATE
1143 #  ifdef CONFIG_SPL_BUILD
1144 	/* FDT is at end of BSS */
1145 	gd->fdt_blob = (ulong *)&__bss_end;
1146 #  else
1147 	/* FDT is at end of image */
1148 	gd->fdt_blob = (ulong *)&_end;
1149 #endif
1150 # elif defined(CONFIG_OF_HOSTFILE)
1151 	if (sandbox_read_fdt_from_file()) {
1152 		puts("Failed to read control FDT\n");
1153 		return -1;
1154 	}
1155 # endif
1156 # ifndef CONFIG_SPL_BUILD
1157 	/* Allow the early environment to override the fdt address */
1158 	gd->fdt_blob = (void *)getenv_ulong("fdtcontroladdr", 16,
1159 						(uintptr_t)gd->fdt_blob);
1160 # endif
1161 #endif
1162 	return fdtdec_prepare_fdt();
1163 }
1164 
1165 #endif /* !USE_HOSTCC */
1166