xref: /rk3399_rockchip-uboot/common/spl/spl_fit.c (revision 8ec8d58eeb2a43c1d2630d9ef41fac2a7c482082)
1 /*
2  * Copyright (C) 2016 Google, Inc
3  * Written by Simon Glass <sjg@chromium.org>
4  *
5  * SPDX-License-Identifier:	GPL-2.0+
6  */
7 
8 #include <common.h>
9 #include <boot_rkimg.h>
10 #include <errno.h>
11 #include <image.h>
12 #include <linux/libfdt.h>
13 #include <spl.h>
14 #include <malloc.h>
15 
16 #ifndef CONFIG_SYS_BOOTM_LEN
17 #define CONFIG_SYS_BOOTM_LEN	(64 << 20)
18 #endif
19 
20 /**
21  * spl_fit_get_image_name(): By using the matching configuration subnode,
22  * retrieve the name of an image, specified by a property name and an index
23  * into that.
24  * @fit:	Pointer to the FDT blob.
25  * @images:	Offset of the /images subnode.
26  * @type:	Name of the property within the configuration subnode.
27  * @index:	Index into the list of strings in this property.
28  * @outname:	Name of the image
29  *
30  * Return:	0 on success, or a negative error number
31  */
32 static int spl_fit_get_image_name(const void *fit, int images,
33 				  const char *type, int index,
34 				  char **outname)
35 {
36 	const char *name, *str;
37 	__maybe_unused int node;
38 	int conf_node;
39 	int len, i;
40 
41 	conf_node = fit_find_config_node(fit);
42 	if (conf_node < 0) {
43 #ifdef CONFIG_SPL_LIBCOMMON_SUPPORT
44 		printf("No matching DT out of these options:\n");
45 		for (node = fdt_first_subnode(fit, conf_node);
46 		     node >= 0;
47 		     node = fdt_next_subnode(fit, node)) {
48 			name = fdt_getprop(fit, node, "description", &len);
49 			printf("   %s\n", name);
50 		}
51 #endif
52 		return conf_node;
53 	}
54 
55 	name = fdt_getprop(fit, conf_node, type, &len);
56 	if (!name) {
57 		debug("cannot find property '%s': %d\n", type, len);
58 		return -EINVAL;
59 	}
60 
61 	str = name;
62 	for (i = 0; i < index; i++) {
63 		str = strchr(str, '\0') + 1;
64 		if (!str || (str - name >= len)) {
65 			debug("no string for index %d\n", index);
66 			return -E2BIG;
67 		}
68 	}
69 
70 	*outname = (char *)str;
71 	return 0;
72 }
73 
74 /**
75  * spl_fit_get_image_node(): By using the matching configuration subnode,
76  * retrieve the name of an image, specified by a property name and an index
77  * into that.
78  * @fit:	Pointer to the FDT blob.
79  * @images:	Offset of the /images subnode.
80  * @type:	Name of the property within the configuration subnode.
81  * @index:	Index into the list of strings in this property.
82  *
83  * Return:	the node offset of the respective image node or a negative
84  *		error number.
85  */
86 static int spl_fit_get_image_node(const void *fit, int images,
87 				  const char *type, int index)
88 {
89 	char *str;
90 	int err;
91 	int node;
92 
93 	err = spl_fit_get_image_name(fit, images, type, index, &str);
94 	if (err)
95 		return err;
96 
97 	debug("%s: '%s'\n", type, str);
98 
99 	node = fdt_subnode_offset(fit, images, str);
100 	if (node < 0) {
101 		debug("cannot find image node '%s': %d\n", str, node);
102 		return -EINVAL;
103 	}
104 
105 	return node;
106 }
107 
108 static int get_aligned_image_offset(struct spl_load_info *info, int offset)
109 {
110 	/*
111 	 * If it is a FS read, get the first address before offset which is
112 	 * aligned to ARCH_DMA_MINALIGN. If it is raw read return the
113 	 * block number to which offset belongs.
114 	 */
115 	if (info->filename)
116 		return offset & ~(ARCH_DMA_MINALIGN - 1);
117 
118 	return offset / info->bl_len;
119 }
120 
121 static int get_aligned_image_overhead(struct spl_load_info *info, int offset)
122 {
123 	/*
124 	 * If it is a FS read, get the difference between the offset and
125 	 * the first address before offset which is aligned to
126 	 * ARCH_DMA_MINALIGN. If it is raw read return the offset within the
127 	 * block.
128 	 */
129 	if (info->filename)
130 		return offset & (ARCH_DMA_MINALIGN - 1);
131 
132 	return offset % info->bl_len;
133 }
134 
135 static int get_aligned_image_size(struct spl_load_info *info, int data_size,
136 				  int offset)
137 {
138 	data_size = data_size + get_aligned_image_overhead(info, offset);
139 
140 	if (info->filename)
141 		return data_size;
142 
143 	return (data_size + info->bl_len - 1) / info->bl_len;
144 }
145 
146 /**
147  * spl_load_fit_image(): load the image described in a certain FIT node
148  * @info:	points to information about the device to load data from
149  * @sector:	the start sector of the FIT image on the device
150  * @fit:	points to the flattened device tree blob describing the FIT
151  *		image
152  * @base_offset: the beginning of the data area containing the actual
153  *		image data, relative to the beginning of the FIT
154  * @node:	offset of the DT node describing the image to load (relative
155  *		to @fit)
156  * @image_info:	will be filled with information about the loaded image
157  *		If the FIT node does not contain a "load" (address) property,
158  *		the image gets loaded to the address pointed to by the
159  *		load_addr member in this struct.
160  *
161  * Return:	0 on success or a negative error number.
162  */
163 static int spl_load_fit_image(struct spl_load_info *info, ulong sector,
164 			      void *fit, ulong base_offset, int node,
165 			      struct spl_image_info *image_info)
166 {
167 	int offset;
168 	size_t length;
169 	int len;
170 	ulong size;
171 	ulong comp_addr, load_addr, load_ptr;
172 	void *src;
173 	ulong overhead;
174 	int nr_sectors;
175 	int align_len = ARCH_DMA_MINALIGN - 1;
176 	uint8_t image_comp = -1, type = -1;
177 	const void *data;
178 	bool external_data = false;
179 
180 	if (IS_ENABLED(CONFIG_SPL_OS_BOOT) && IS_ENABLED(CONFIG_SPL_GZIP)) {
181 		if (fit_image_get_comp(fit, node, &image_comp))
182 			puts("Cannot get image compression format.\n");
183 		else
184 			debug("%s ", genimg_get_comp_name(image_comp));
185 
186 		if (fit_image_get_type(fit, node, &type))
187 			puts("Cannot get image type.\n");
188 		else
189 			debug("%s ", genimg_get_type_name(type));
190 	} else {
191 		fit_image_get_comp(fit, node, &image_comp);
192 	}
193 
194 	if (fit_image_get_load(fit, node, &load_addr))
195 		load_addr = image_info->load_addr;
196 
197 	if (image_comp != IH_COMP_NONE && image_comp != IH_COMP_ZIMAGE) {
198 		/* Empirically, 1MB is enough for U-Boot, tee and atf */
199 		if (fit_image_get_comp_addr(fit, node, &comp_addr))
200 			comp_addr = load_addr + SZ_1M;
201 	} else {
202 		comp_addr = load_addr;
203 	}
204 
205 	if (!fit_image_get_data_position(fit, node, &offset)) {
206 		external_data = true;
207 	} else if (!fit_image_get_data_offset(fit, node, &offset)) {
208 		offset += base_offset;
209 		external_data = true;
210 	}
211 
212 	if (external_data) {
213 		/* External data */
214 		if (fit_image_get_data_size(fit, node, &len))
215 			return -ENOENT;
216 
217 		load_ptr = (comp_addr + align_len) & ~align_len;
218 #if  defined(CONFIG_ARCH_ROCKCHIP)
219 		if ((load_ptr < CONFIG_SYS_SDRAM_BASE) ||
220 		     (load_ptr >= CONFIG_SYS_SDRAM_BASE + SDRAM_MAX_SIZE))
221 			load_ptr = (ulong)memalign(ARCH_DMA_MINALIGN, len);
222 #endif
223 		length = len;
224 
225 		overhead = get_aligned_image_overhead(info, offset);
226 		nr_sectors = get_aligned_image_size(info, length, offset);
227 
228 		if (info->read(info,
229 			       sector + get_aligned_image_offset(info, offset),
230 			       nr_sectors, (void *)load_ptr) != nr_sectors)
231 			return -EIO;
232 
233 		debug("External data: dst=%lx, offset=%x, size=%lx\n",
234 		      load_ptr, offset, (unsigned long)length);
235 		src = (void *)load_ptr + overhead;
236 	} else {
237 		/* Embedded data */
238 		if (fit_image_get_data(fit, node, &data, &length)) {
239 			puts("Cannot get image data/size\n");
240 			return -ENOENT;
241 		}
242 		debug("Embedded data: dst=%lx, size=%lx\n", load_addr,
243 		      (unsigned long)length);
244 		src = (void *)data;
245 	}
246 
247 	/* Check hashes and signature */
248 	if (image_comp != IH_COMP_NONE && image_comp != IH_COMP_ZIMAGE)
249 		printf("## Checking %s 0x%08lx (%s @0x%08lx) ... ",
250 		       fit_get_name(fit, node, NULL), load_addr,
251 		       (char *)fdt_getprop(fit, node, FIT_COMP_PROP, NULL),
252 		       (long)src);
253 	else
254 		printf("## Checking %s 0x%08lx ... ",
255 		       fit_get_name(fit, node, NULL), load_addr);
256 
257 #ifdef CONFIG_FIT_SPL_PRINT
258 	printf("\n");
259 	fit_image_print(fit, node, "");
260 #endif
261 	if (!fit_image_verify_with_data(fit, node,
262 					 src, length))
263 		return -EPERM;
264 
265 #ifdef CONFIG_SPL_FIT_IMAGE_POST_PROCESS
266 	board_fit_image_post_process(fit, node, (ulong *)&load_addr,
267 				     (ulong **)&src, &length);
268 #endif
269 	puts("OK\n");
270 
271 	if (IS_ENABLED(CONFIG_SPL_OS_BOOT)	&&
272 	    IS_ENABLED(CONFIG_SPL_GZIP)		&&
273 	    image_comp == IH_COMP_GZIP		&&
274 	    type == IH_TYPE_KERNEL) {
275 		size = length;
276 		if (gunzip((void *)load_addr, CONFIG_SYS_BOOTM_LEN,
277 			   src, &size)) {
278 			puts("Uncompressing error\n");
279 			return -EIO;
280 		}
281 		length = size;
282 	} else {
283 		memcpy((void *)load_addr, src, length);
284 	}
285 
286 	if (image_info) {
287 		image_info->load_addr = load_addr;
288 		image_info->size = length;
289 		image_info->entry_point = fdt_getprop_u32(fit, node, "entry");
290 	}
291 
292 	return 0;
293 }
294 
295 static int spl_fit_append_fdt(struct spl_image_info *spl_image,
296 			      struct spl_load_info *info, ulong sector,
297 			      void *fit, int images, ulong base_offset)
298 {
299 	struct spl_image_info image_info;
300 	int node, ret;
301 
302 	/* Figure out which device tree the board wants to use */
303 	node = spl_fit_get_image_node(fit, images, FIT_FDT_PROP, 0);
304 	if (node < 0) {
305 		debug("%s: cannot find FDT node\n", __func__);
306 		return node;
307 	}
308 
309 	/*
310 	 * Read the device tree and place it after the image.
311 	 * Align the destination address to ARCH_DMA_MINALIGN.
312 	 */
313 	image_info.load_addr = spl_image->load_addr + spl_image->size;
314 	ret = spl_load_fit_image(info, sector, fit, base_offset, node,
315 				 &image_info);
316 
317 	if (ret < 0)
318 		return ret;
319 
320 	/* Make the load-address of the FDT available for the SPL framework */
321 	spl_image->fdt_addr = (void *)image_info.load_addr;
322 #if !CONFIG_IS_ENABLED(FIT_IMAGE_TINY)
323 	/* Try to make space, so we can inject details on the loadables */
324 	ret = fdt_shrink_to_minimum(spl_image->fdt_addr, 8192);
325 #endif
326 
327 	/*
328 	 * If need, load kernel FDT right after U-Boot FDT.
329 	 *
330 	 * kernel FDT is for U-Boot if there is not valid one
331 	 * from images, ie: resource.img, boot.img or recovery.img.
332 	 */
333 	node = fdt_subnode_offset(fit, images, FIT_KERNEL_FDT_PROP);
334 	if (node < 0)
335 		return ret;
336 
337 	image_info.load_addr =
338 		(ulong)spl_image->fdt_addr + fdt_totalsize(spl_image->fdt_addr);
339 	ret = spl_load_fit_image(info, sector, fit, base_offset, node,
340 				 &image_info);
341 
342 	return ret;
343 }
344 
345 static int spl_fit_record_loadable(const void *fit, int images, int index,
346 				   void *blob, struct spl_image_info *image)
347 {
348 	int ret = 0;
349 #if !CONFIG_IS_ENABLED(FIT_IMAGE_TINY)
350 	char *name;
351 	int node;
352 
353 	ret = spl_fit_get_image_name(fit, images, "loadables",
354 				     index, &name);
355 	if (ret < 0)
356 		return ret;
357 
358 	node = spl_fit_get_image_node(fit, images, "loadables", index);
359 
360 	ret = fdt_record_loadable(blob, index, name, image->load_addr,
361 				  image->size, image->entry_point,
362 				  fdt_getprop(fit, node, "type", NULL),
363 				  fdt_getprop(fit, node, "os", NULL));
364 #endif
365 	return ret;
366 }
367 
368 static int spl_fit_image_get_os(const void *fit, int noffset, uint8_t *os)
369 {
370 #if CONFIG_IS_ENABLED(FIT_IMAGE_TINY)
371 	return -ENOTSUPP;
372 #else
373 	return fit_image_get_os(fit, noffset, os);
374 #endif
375 }
376 
377 __weak int spl_fit_standalone_release(uintptr_t entry_point)
378 {
379 	return 0;
380 }
381 
382 static void *spl_fit_load_blob(struct spl_load_info *info,
383 			       ulong sector, void *fit_header,
384 			       int *base_offset)
385 {
386 	int align_len = ARCH_DMA_MINALIGN - 1;
387 	ulong count;
388 	ulong size;
389 	int sectors;
390 	void *fit;
391 
392 	/*
393 	 * For FIT with external data, figure out where the external images
394 	 * start. This is the base for the data-offset properties in each
395 	 * image.
396 	 */
397 	size = fdt_totalsize(fit_header);
398 	size = FIT_ALIGN(size);
399 	*base_offset = FIT_ALIGN(size);
400 
401 	/*
402 	 * So far we only have one block of data from the FIT. Read the entire
403 	 * thing, including that first block, placing it so it finishes before
404 	 * where we will load the image.
405 	 *
406 	 * Note that we will load the image such that its first byte will be
407 	 * at the load address. Since that byte may be part-way through a
408 	 * block, we may load the image up to one block before the load
409 	 * address. So take account of that here by subtracting an addition
410 	 * block length from the FIT start position.
411 	 *
412 	 * In fact the FIT has its own load address, but we assume it cannot
413 	 * be before CONFIG_SYS_TEXT_BASE.
414 	 *
415 	 * For FIT with data embedded, data is loaded as part of FIT image.
416 	 * For FIT with external data, data is not loaded in this step.
417 	 */
418 	fit = (void *)((CONFIG_SYS_TEXT_BASE - size - info->bl_len -
419 			align_len) & ~align_len);
420 	sectors = get_aligned_image_size(info, size, 0);
421 	count = info->read(info, sector, sectors, fit);
422 	debug("fit read sector %lx, sectors=%d, dst=%p, count=%lu\n",
423 	      sector, sectors, fit, count);
424 	if (count == 0)
425 		return NULL;
426 
427 	return fit;
428 }
429 
430 #ifdef CONFIG_SPL_KERNEL_BOOT
431 #ifdef CONFIG_SPL_LIBDISK_SUPPORT
432 __weak const char *spl_kernel_partition(struct spl_image_info *spl,
433 					struct spl_load_info *info)
434 {
435 	return PART_BOOT;
436 }
437 #endif
438 
439 static int spl_load_kernel_fit(struct spl_image_info *spl_image,
440 			       struct spl_load_info *info)
441 {
442 	/*
443 	 * Never change the image order.
444 	 *
445 	 * Considering thunder-boot feature, there maybe asynchronous
446 	 * loading operation of these images and ramdisk is usually to
447 	 * be the last one.
448 	 *
449 	 * The .its content rule of kernel fit image follows U-Boot proper.
450 	 */
451 	const char *images[] = { FIT_FDT_PROP, FIT_KERNEL_PROP, FIT_RAMDISK_PROP, };
452 	struct spl_image_info image_info;
453 	char fit_header[info->bl_len];
454 	int images_noffset;
455 	int base_offset;
456 	int sector;
457 	int node, ret, i;
458 	void *fit;
459 
460 	if (spl_image->next_stage != SPL_NEXT_STAGE_KERNEL)
461 		return 0;
462 
463 #ifdef CONFIG_SPL_LIBDISK_SUPPORT
464 	const char *part_name = PART_BOOT;
465 	disk_partition_t part_info;
466 
467 	part_name = spl_kernel_partition(spl_image, info);
468 	if (part_get_info_by_name(info->dev, part_name, &part_info) <= 0) {
469 		printf("%s: no partition\n", __func__);
470 		return -EINVAL;
471 	}
472 	sector = part_info.start;
473 #else
474 	sector = CONFIG_SPL_KERNEL_BOOT_SECTOR;
475 #endif
476 	if (info->read(info, sector, 1, &fit_header) != 1) {
477 		debug("%s: Failed to read header\n", __func__);
478 		return -EIO;
479 	}
480 
481 	if (image_get_magic((void *)&fit_header) != FDT_MAGIC) {
482 		printf("%s: Not fit magic\n", __func__);
483 		return -EINVAL;
484 	}
485 
486 	fit = spl_fit_load_blob(info, sector, fit_header, &base_offset);
487 	if (!fit) {
488 		debug("%s: Cannot load blob\n", __func__);
489 		return -ENODEV;
490 	}
491 
492 	/* verify the configure node by keys, if required */
493 #ifdef CONFIG_SPL_FIT_SIGNATURE
494 	int conf_noffset;
495 
496 	conf_noffset = fit_conf_get_node(fit, NULL);
497 	if (conf_noffset <= 0) {
498 		printf("No default config node\n");
499 		return -EINVAL;
500 	}
501 
502 	ret = fit_config_verify(fit, conf_noffset);
503 	if (ret) {
504 		printf("fit verify configure failed, ret=%d\n", ret);
505 		return ret;
506 	}
507 	printf("\n");
508 #endif
509 	images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
510 	if (images_noffset < 0) {
511 		debug("%s: Cannot find /images node: %d\n",
512 		      __func__, images_noffset);
513 		return images_noffset;
514 	}
515 
516 	for (i = 0; i < ARRAY_SIZE(images); i++) {
517 		node = spl_fit_get_image_node(fit, images_noffset,
518 					      images[i], 0);
519 		if (node < 0) {
520 			debug("No image: %s\n", images[i]);
521 			continue;
522 		}
523 
524 		ret = spl_load_fit_image(info, sector, fit, base_offset,
525 					 node, &image_info);
526 		if (ret)
527 			return ret;
528 
529 		/* initial addr or entry point */
530 		if (!strcmp(images[i], FIT_FDT_PROP))
531 			spl_image->fdt_addr = (void *)image_info.load_addr;
532 		else if (!strcmp(images[i], FIT_KERNEL_PROP))
533 #if CONFIG_IS_ENABLED(OPTEE)
534 			spl_image->entry_point_os = image_info.load_addr;
535 #endif
536 #if CONFIG_IS_ENABLED(ATF)
537 			spl_image->entry_point_bl33 = image_info.load_addr;
538 #endif
539 	}
540 
541 	debug("fdt_addr=0x%08lx, entry_point=0x%08lx, entry_point_os=0x%08lx\n",
542 	      (ulong)spl_image->fdt_addr,
543 	      spl_image->entry_point,
544 #if CONFIG_IS_ENABLED(OPTEE)
545 	      spl_image->entry_point_os);
546 #endif
547 #if CONFIG_IS_ENABLED(ATF)
548 	      spl_image->entry_point_bl33);
549 #endif
550 
551 	return 0;
552 }
553 #endif
554 
555 static int spl_internal_load_simple_fit(struct spl_image_info *spl_image,
556 					struct spl_load_info *info,
557 					ulong sector, void *fit_header)
558 {
559 	struct spl_image_info image_info;
560 	int base_offset;
561 	int images, ret;
562 	int index = 0;
563 	int node = -1;
564 	void *fit;
565 
566 	fit = spl_fit_load_blob(info, sector, fit_header, &base_offset);
567 	if (!fit) {
568 		debug("%s: Cannot load blob\n", __func__);
569 		return -1;
570 	}
571 
572 	/* find the node holding the images information */
573 	images = fdt_path_offset(fit, FIT_IMAGES_PATH);
574 	if (images < 0) {
575 		debug("%s: Cannot find /images node: %d\n", __func__, images);
576 		return -1;
577 	}
578 
579 	/* if board sigs verify required, check self */
580 	if (fit_board_verify_required_sigs() &&
581 	    !IS_ENABLED(CONFIG_SPL_FIT_SIGNATURE)) {
582 		printf("Verified-boot requires CONFIG_SPL_FIT_SIGNATURE enabled\n");
583 		hang();
584 	}
585 
586 	/* verify the configure node by keys, if required */
587 #ifdef CONFIG_SPL_FIT_SIGNATURE
588 	int conf_noffset;
589 
590 	conf_noffset = fit_conf_get_node(fit, NULL);
591 	if (conf_noffset <= 0) {
592 		printf("No default config node\n");
593 		return -EINVAL;
594 	}
595 
596 	ret = fit_config_verify(fit, conf_noffset);
597 	if (ret) {
598 		printf("fit verify configure failed, ret=%d\n", ret);
599 		return ret;
600 	}
601 	printf("\n");
602 
603 #ifdef CONFIG_SPL_FIT_ROLLBACK_PROTECT
604 	uint32_t this_index, min_index;
605 
606 	ret = fit_rollback_index_verify(fit, FIT_ROLLBACK_INDEX_SPL,
607 					&this_index, &min_index);
608 	if (ret) {
609 		printf("fit failed to get rollback index, ret=%d\n", ret);
610 		return ret;
611 	} else if (this_index < min_index) {
612 		printf("fit reject rollback: %d < %d(min)\n",
613 		       this_index, min_index);
614 		return -EINVAL;
615 	}
616 
617 	printf("rollback index: %d >= %d(min), OK\n", this_index, min_index);
618 #endif
619 #endif
620 
621 	/*
622 	 * If required to start the other core before load "loadables"
623 	 * firmwares, use the config "standalone" to load the other core's
624 	 * firmware, then start it.
625 	 * Normally, different cores' firmware is attach to the config
626 	 * "loadables" and load them together.
627 	 */
628 	if (node < 0)
629 		node = spl_fit_get_image_node(fit, images, FIT_STANDALONE_PROP,
630 					      0);
631 	if (node > 0) {
632 		/* Load the image and set up the spl_image structure */
633 		ret = spl_load_fit_image(info, sector, fit, base_offset, node,
634 					 &image_info);
635 		if (!ret) {
636 			if (image_info.entry_point == FDT_ERROR)
637 				image_info.entry_point = image_info.load_addr;
638 
639 			ret = spl_fit_standalone_release(image_info.entry_point);
640 			if (ret)
641 				printf("Start standalone fail, ret = %d\n",
642 				       ret);
643 		}
644 
645 		/* standalone is special one, continue to find others */
646 		node = -1;
647 	}
648 
649 	/*
650 	 * Find the U-Boot image using the following search order:
651 	 *   - start at 'firmware' (e.g. an ARM Trusted Firmware)
652 	 *   - fall back 'kernel' (e.g. a Falcon-mode OS boot
653 	 *   - fall back to using the first 'loadables' entry
654 	 */
655 	if (node < 0)
656 		node = spl_fit_get_image_node(fit, images, FIT_FIRMWARE_PROP,
657 					      0);
658 #ifdef CONFIG_SPL_OS_BOOT
659 	if (node < 0)
660 		node = spl_fit_get_image_node(fit, images, FIT_KERNEL_PROP, 0);
661 #endif
662 	if (node < 0) {
663 		debug("could not find firmware image, trying loadables...\n");
664 		node = spl_fit_get_image_node(fit, images, "loadables", 0);
665 		/*
666 		 * If we pick the U-Boot image from "loadables", start at
667 		 * the second image when later loading additional images.
668 		 */
669 		index = 1;
670 	}
671 	if (node < 0) {
672 		debug("%s: Cannot find u-boot image node: %d\n",
673 		      __func__, node);
674 		return -1;
675 	}
676 
677 	/* Load the image and set up the spl_image structure */
678 	ret = spl_load_fit_image(info, sector, fit, base_offset, node,
679 				 spl_image);
680 	if (ret)
681 		return ret;
682 
683 	/*
684 	 * For backward compatibility, we treat the first node that is
685 	 * as a U-Boot image, if no OS-type has been declared.
686 	 */
687 	if (!spl_fit_image_get_os(fit, node, &spl_image->os))
688 		debug("Image OS is %s\n", genimg_get_os_name(spl_image->os));
689 #if !defined(CONFIG_SPL_OS_BOOT)
690 	else
691 		spl_image->os = IH_OS_U_BOOT;
692 #endif
693 
694 	/*
695 	 * Booting a next-stage U-Boot may require us to append the FDT.
696 	 * We allow this to fail, as the U-Boot image might embed its FDT.
697 	 */
698 	if (spl_image->os == IH_OS_U_BOOT)
699 		spl_fit_append_fdt(spl_image, info, sector, fit,
700 				   images, base_offset);
701 
702 	/* Now check if there are more images for us to load */
703 	for (; ; index++) {
704 		uint8_t os_type = IH_OS_INVALID;
705 
706 		node = spl_fit_get_image_node(fit, images, "loadables", index);
707 		if (node < 0)
708 			break;
709 
710 		if (!spl_fit_image_get_os(fit, node, &os_type))
711 			debug("Loadable is %s\n", genimg_get_os_name(os_type));
712 
713 		/* skip U-Boot ? */
714 		if (spl_image->next_stage == SPL_NEXT_STAGE_KERNEL &&
715 		    os_type == IH_OS_U_BOOT)
716 		    continue;
717 
718 		ret = spl_load_fit_image(info, sector, fit, base_offset, node,
719 					 &image_info);
720 		if (ret < 0)
721 			continue;
722 
723 		if (os_type == IH_OS_U_BOOT) {
724 			spl_fit_append_fdt(&image_info, info, sector,
725 					   fit, images, base_offset);
726 			spl_image->fdt_addr = image_info.fdt_addr;
727 		}
728 
729 		/*
730 		 * If the "firmware" image did not provide an entry point,
731 		 * use the first valid entry point from the loadables.
732 		 */
733 		if (spl_image->entry_point == FDT_ERROR &&
734 		    image_info.entry_point != FDT_ERROR)
735 			spl_image->entry_point = image_info.entry_point;
736 
737 		/* Record our loadables into the FDT */
738 		if (spl_image->fdt_addr)
739 			spl_fit_record_loadable(fit, images, index,
740 						spl_image->fdt_addr,
741 						&image_info);
742 	}
743 
744 	/*
745 	 * If a platform does not provide CONFIG_SYS_UBOOT_START, U-Boot's
746 	 * Makefile will set it to 0 and it will end up as the entry point
747 	 * here. What it actually means is: use the load address.
748 	 */
749 	if (spl_image->entry_point == FDT_ERROR || spl_image->entry_point == 0)
750 		spl_image->entry_point = spl_image->load_addr;
751 
752 	return 0;
753 }
754 
755 int spl_load_simple_fit(struct spl_image_info *spl_image,
756 			struct spl_load_info *info, ulong sector, void *fit)
757 {
758 	ulong sector_offs = sector;
759 	int ret = -EINVAL;
760 	int i;
761 
762 	for (i = 0; i < CONFIG_SPL_FIT_IMAGE_MULTIPLE; i++) {
763 		if (i > 0) {
764 			sector_offs +=
765 			   i * ((CONFIG_SPL_FIT_IMAGE_KB << 10) / info->bl_len);
766 			printf("Trying fit image at 0x%lx sector\n", sector_offs);
767 			if (info->read(info, sector_offs, 1, fit) != 1) {
768 				printf("IO error\n");
769 				continue;
770 			}
771 		}
772 
773 		if (image_get_magic(fit) != FDT_MAGIC) {
774 			printf("Not fit magic\n");
775 			continue;
776 		}
777 
778 		ret = spl_internal_load_simple_fit(spl_image, info,
779 						   sector_offs, fit);
780 		if (!ret) {
781 #ifdef CONFIG_SPL_KERNEL_BOOT
782 			ret = spl_load_kernel_fit(spl_image, info);
783 #endif
784 			return ret;
785 		}
786 	}
787 
788 	return ret;
789 }
790 
791