xref: /openbmc/u-boot/common/image-fit.c (revision 03efcb05)
1 /*
2  * Copyright (c) 2013, Google Inc.
3  *
4  * (C) Copyright 2008 Semihalf
5  *
6  * (C) Copyright 2000-2006
7  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
8  *
9  * SPDX-License-Identifier:	GPL-2.0+
10  */
11 
12 #ifdef USE_HOSTCC
13 #include "mkimage.h"
14 #include <image.h>
15 #include <time.h>
16 #else
17 #include <common.h>
18 #include <errno.h>
19 #include <asm/io.h>
20 DECLARE_GLOBAL_DATA_PTR;
21 #endif /* !USE_HOSTCC*/
22 
23 #include <bootstage.h>
24 #include <sha1.h>
25 #include <u-boot/crc.h>
26 #include <u-boot/md5.h>
27 
28 /*****************************************************************************/
29 /* New uImage format routines */
30 /*****************************************************************************/
31 #ifndef USE_HOSTCC
32 static int fit_parse_spec(const char *spec, char sepc, ulong addr_curr,
33 		ulong *addr, const char **name)
34 {
35 	const char *sep;
36 
37 	*addr = addr_curr;
38 	*name = NULL;
39 
40 	sep = strchr(spec, sepc);
41 	if (sep) {
42 		if (sep - spec > 0)
43 			*addr = simple_strtoul(spec, NULL, 16);
44 
45 		*name = sep + 1;
46 		return 1;
47 	}
48 
49 	return 0;
50 }
51 
52 /**
53  * fit_parse_conf - parse FIT configuration spec
54  * @spec: input string, containing configuration spec
55  * @add_curr: current image address (to be used as a possible default)
56  * @addr: pointer to a ulong variable, will hold FIT image address of a given
57  * configuration
58  * @conf_name double pointer to a char, will hold pointer to a configuration
59  * unit name
60  *
61  * fit_parse_conf() expects configuration spec in the for of [<addr>]#<conf>,
62  * where <addr> is a FIT image address that contains configuration
63  * with a <conf> unit name.
64  *
65  * Address part is optional, and if omitted default add_curr will
66  * be used instead.
67  *
68  * returns:
69  *     1 if spec is a valid configuration string,
70  *     addr and conf_name are set accordingly
71  *     0 otherwise
72  */
73 int fit_parse_conf(const char *spec, ulong addr_curr,
74 		ulong *addr, const char **conf_name)
75 {
76 	return fit_parse_spec(spec, '#', addr_curr, addr, conf_name);
77 }
78 
79 /**
80  * fit_parse_subimage - parse FIT subimage spec
81  * @spec: input string, containing subimage spec
82  * @add_curr: current image address (to be used as a possible default)
83  * @addr: pointer to a ulong variable, will hold FIT image address of a given
84  * subimage
85  * @image_name: double pointer to a char, will hold pointer to a subimage name
86  *
87  * fit_parse_subimage() expects subimage spec in the for of
88  * [<addr>]:<subimage>, where <addr> is a FIT image address that contains
89  * subimage with a <subimg> unit name.
90  *
91  * Address part is optional, and if omitted default add_curr will
92  * be used instead.
93  *
94  * returns:
95  *     1 if spec is a valid subimage string,
96  *     addr and image_name are set accordingly
97  *     0 otherwise
98  */
99 int fit_parse_subimage(const char *spec, ulong addr_curr,
100 		ulong *addr, const char **image_name)
101 {
102 	return fit_parse_spec(spec, ':', addr_curr, addr, image_name);
103 }
104 #endif /* !USE_HOSTCC */
105 
106 static void fit_get_debug(const void *fit, int noffset,
107 		char *prop_name, int err)
108 {
109 	debug("Can't get '%s' property from FIT 0x%08lx, node: offset %d, name %s (%s)\n",
110 	      prop_name, (ulong)fit, noffset, fit_get_name(fit, noffset, NULL),
111 	      fdt_strerror(err));
112 }
113 
114 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_FIT_SPL_PRINT)
115 /**
116  * fit_print_contents - prints out the contents of the FIT format image
117  * @fit: pointer to the FIT format image header
118  * @p: pointer to prefix string
119  *
120  * fit_print_contents() formats a multi line FIT image contents description.
121  * The routine prints out FIT image properties (root node level) follwed by
122  * the details of each component image.
123  *
124  * returns:
125  *     no returned results
126  */
127 void fit_print_contents(const void *fit)
128 {
129 	char *desc;
130 	char *uname;
131 	int images_noffset;
132 	int confs_noffset;
133 	int noffset;
134 	int ndepth;
135 	int count = 0;
136 	int ret;
137 	const char *p;
138 	time_t timestamp;
139 
140 	/* Indent string is defined in header image.h */
141 	p = IMAGE_INDENT_STRING;
142 
143 	/* Root node properties */
144 	ret = fit_get_desc(fit, 0, &desc);
145 	printf("%sFIT description: ", p);
146 	if (ret)
147 		printf("unavailable\n");
148 	else
149 		printf("%s\n", desc);
150 
151 	if (IMAGE_ENABLE_TIMESTAMP) {
152 		ret = fit_get_timestamp(fit, 0, &timestamp);
153 		printf("%sCreated:         ", p);
154 		if (ret)
155 			printf("unavailable\n");
156 		else
157 			genimg_print_time(timestamp);
158 	}
159 
160 	/* Find images parent node offset */
161 	images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
162 	if (images_noffset < 0) {
163 		printf("Can't find images parent node '%s' (%s)\n",
164 		       FIT_IMAGES_PATH, fdt_strerror(images_noffset));
165 		return;
166 	}
167 
168 	/* Process its subnodes, print out component images details */
169 	for (ndepth = 0, count = 0,
170 		noffset = fdt_next_node(fit, images_noffset, &ndepth);
171 	     (noffset >= 0) && (ndepth > 0);
172 	     noffset = fdt_next_node(fit, noffset, &ndepth)) {
173 		if (ndepth == 1) {
174 			/*
175 			 * Direct child node of the images parent node,
176 			 * i.e. component image node.
177 			 */
178 			printf("%s Image %u (%s)\n", p, count++,
179 			       fit_get_name(fit, noffset, NULL));
180 
181 			fit_image_print(fit, noffset, p);
182 		}
183 	}
184 
185 	/* Find configurations parent node offset */
186 	confs_noffset = fdt_path_offset(fit, FIT_CONFS_PATH);
187 	if (confs_noffset < 0) {
188 		debug("Can't get configurations parent node '%s' (%s)\n",
189 		      FIT_CONFS_PATH, fdt_strerror(confs_noffset));
190 		return;
191 	}
192 
193 	/* get default configuration unit name from default property */
194 	uname = (char *)fdt_getprop(fit, noffset, FIT_DEFAULT_PROP, NULL);
195 	if (uname)
196 		printf("%s Default Configuration: '%s'\n", p, uname);
197 
198 	/* Process its subnodes, print out configurations details */
199 	for (ndepth = 0, count = 0,
200 		noffset = fdt_next_node(fit, confs_noffset, &ndepth);
201 	     (noffset >= 0) && (ndepth > 0);
202 	     noffset = fdt_next_node(fit, noffset, &ndepth)) {
203 		if (ndepth == 1) {
204 			/*
205 			 * Direct child node of the configurations parent node,
206 			 * i.e. configuration node.
207 			 */
208 			printf("%s Configuration %u (%s)\n", p, count++,
209 			       fit_get_name(fit, noffset, NULL));
210 
211 			fit_conf_print(fit, noffset, p);
212 		}
213 	}
214 }
215 
216 /**
217  * fit_image_print_data() - prints out the hash node details
218  * @fit: pointer to the FIT format image header
219  * @noffset: offset of the hash node
220  * @p: pointer to prefix string
221  * @type: Type of information to print ("hash" or "sign")
222  *
223  * fit_image_print_data() lists properies for the processed hash node
224  *
225  * This function avoid using puts() since it prints a newline on the host
226  * but does not in U-Boot.
227  *
228  * returns:
229  *     no returned results
230  */
231 static void fit_image_print_data(const void *fit, int noffset, const char *p,
232 				 const char *type)
233 {
234 	const char *keyname;
235 	uint8_t *value;
236 	int value_len;
237 	char *algo;
238 	int required;
239 	int ret, i;
240 
241 	debug("%s  %s node:    '%s'\n", p, type,
242 	      fit_get_name(fit, noffset, NULL));
243 	printf("%s  %s algo:    ", p, type);
244 	if (fit_image_hash_get_algo(fit, noffset, &algo)) {
245 		printf("invalid/unsupported\n");
246 		return;
247 	}
248 	printf("%s", algo);
249 	keyname = fdt_getprop(fit, noffset, "key-name-hint", NULL);
250 	required = fdt_getprop(fit, noffset, "required", NULL) != NULL;
251 	if (keyname)
252 		printf(":%s", keyname);
253 	if (required)
254 		printf(" (required)");
255 	printf("\n");
256 
257 	ret = fit_image_hash_get_value(fit, noffset, &value,
258 					&value_len);
259 	printf("%s  %s value:   ", p, type);
260 	if (ret) {
261 		printf("unavailable\n");
262 	} else {
263 		for (i = 0; i < value_len; i++)
264 			printf("%02x", value[i]);
265 		printf("\n");
266 	}
267 
268 	debug("%s  %s len:     %d\n", p, type, value_len);
269 
270 	/* Signatures have a time stamp */
271 	if (IMAGE_ENABLE_TIMESTAMP && keyname) {
272 		time_t timestamp;
273 
274 		printf("%s  Timestamp:    ", p);
275 		if (fit_get_timestamp(fit, noffset, &timestamp))
276 			printf("unavailable\n");
277 		else
278 			genimg_print_time(timestamp);
279 	}
280 }
281 
282 /**
283  * fit_image_print_verification_data() - prints out the hash/signature details
284  * @fit: pointer to the FIT format image header
285  * @noffset: offset of the hash or signature node
286  * @p: pointer to prefix string
287  *
288  * This lists properies for the processed hash node
289  *
290  * returns:
291  *     no returned results
292  */
293 static void fit_image_print_verification_data(const void *fit, int noffset,
294 				       const char *p)
295 {
296 	const char *name;
297 
298 	/*
299 	 * Check subnode name, must be equal to "hash" or "signature".
300 	 * Multiple hash/signature nodes require unique unit node
301 	 * names, e.g. hash@1, hash@2, signature@1, signature@2, etc.
302 	 */
303 	name = fit_get_name(fit, noffset, NULL);
304 	if (!strncmp(name, FIT_HASH_NODENAME, strlen(FIT_HASH_NODENAME))) {
305 		fit_image_print_data(fit, noffset, p, "Hash");
306 	} else if (!strncmp(name, FIT_SIG_NODENAME,
307 				strlen(FIT_SIG_NODENAME))) {
308 		fit_image_print_data(fit, noffset, p, "Sign");
309 	}
310 }
311 
312 /**
313  * fit_image_print - prints out the FIT component image details
314  * @fit: pointer to the FIT format image header
315  * @image_noffset: offset of the component image node
316  * @p: pointer to prefix string
317  *
318  * fit_image_print() lists all mandatory properies for the processed component
319  * image. If present, hash nodes are printed out as well. Load
320  * address for images of type firmware is also printed out. Since the load
321  * address is not mandatory for firmware images, it will be output as
322  * "unavailable" when not present.
323  *
324  * returns:
325  *     no returned results
326  */
327 void fit_image_print(const void *fit, int image_noffset, const char *p)
328 {
329 	char *desc;
330 	uint8_t type, arch, os, comp;
331 	size_t size;
332 	ulong load, entry;
333 	const void *data;
334 	int noffset;
335 	int ndepth;
336 	int ret;
337 
338 	/* Mandatory properties */
339 	ret = fit_get_desc(fit, image_noffset, &desc);
340 	printf("%s  Description:  ", p);
341 	if (ret)
342 		printf("unavailable\n");
343 	else
344 		printf("%s\n", desc);
345 
346 	fit_image_get_type(fit, image_noffset, &type);
347 	printf("%s  Type:         %s\n", p, genimg_get_type_name(type));
348 
349 	fit_image_get_comp(fit, image_noffset, &comp);
350 	printf("%s  Compression:  %s\n", p, genimg_get_comp_name(comp));
351 
352 	ret = fit_image_get_data(fit, image_noffset, &data, &size);
353 
354 #ifndef USE_HOSTCC
355 	printf("%s  Data Start:   ", p);
356 	if (ret) {
357 		printf("unavailable\n");
358 	} else {
359 		void *vdata = (void *)data;
360 
361 		printf("0x%08lx\n", (ulong)map_to_sysmem(vdata));
362 	}
363 #endif
364 
365 	printf("%s  Data Size:    ", p);
366 	if (ret)
367 		printf("unavailable\n");
368 	else
369 		genimg_print_size(size);
370 
371 	/* Remaining, type dependent properties */
372 	if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE) ||
373 	    (type == IH_TYPE_RAMDISK) || (type == IH_TYPE_FIRMWARE) ||
374 	    (type == IH_TYPE_FLATDT)) {
375 		fit_image_get_arch(fit, image_noffset, &arch);
376 		printf("%s  Architecture: %s\n", p, genimg_get_arch_name(arch));
377 	}
378 
379 	if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_RAMDISK)) {
380 		fit_image_get_os(fit, image_noffset, &os);
381 		printf("%s  OS:           %s\n", p, genimg_get_os_name(os));
382 	}
383 
384 	if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE) ||
385 	    (type == IH_TYPE_FIRMWARE) || (type == IH_TYPE_RAMDISK)) {
386 		ret = fit_image_get_load(fit, image_noffset, &load);
387 		printf("%s  Load Address: ", p);
388 		if (ret)
389 			printf("unavailable\n");
390 		else
391 			printf("0x%08lx\n", load);
392 	}
393 
394 	if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE) ||
395 	    (type == IH_TYPE_RAMDISK)) {
396 		fit_image_get_entry(fit, image_noffset, &entry);
397 		printf("%s  Entry Point:  ", p);
398 		if (ret)
399 			printf("unavailable\n");
400 		else
401 			printf("0x%08lx\n", entry);
402 	}
403 
404 	/* Process all hash subnodes of the component image node */
405 	for (ndepth = 0, noffset = fdt_next_node(fit, image_noffset, &ndepth);
406 	     (noffset >= 0) && (ndepth > 0);
407 	     noffset = fdt_next_node(fit, noffset, &ndepth)) {
408 		if (ndepth == 1) {
409 			/* Direct child node of the component image node */
410 			fit_image_print_verification_data(fit, noffset, p);
411 		}
412 	}
413 }
414 #endif
415 
416 /**
417  * fit_get_desc - get node description property
418  * @fit: pointer to the FIT format image header
419  * @noffset: node offset
420  * @desc: double pointer to the char, will hold pointer to the descrption
421  *
422  * fit_get_desc() reads description property from a given node, if
423  * description is found pointer to it is returened in third call argument.
424  *
425  * returns:
426  *     0, on success
427  *     -1, on failure
428  */
429 int fit_get_desc(const void *fit, int noffset, char **desc)
430 {
431 	int len;
432 
433 	*desc = (char *)fdt_getprop(fit, noffset, FIT_DESC_PROP, &len);
434 	if (*desc == NULL) {
435 		fit_get_debug(fit, noffset, FIT_DESC_PROP, len);
436 		return -1;
437 	}
438 
439 	return 0;
440 }
441 
442 /**
443  * fit_get_timestamp - get node timestamp property
444  * @fit: pointer to the FIT format image header
445  * @noffset: node offset
446  * @timestamp: pointer to the time_t, will hold read timestamp
447  *
448  * fit_get_timestamp() reads timestamp poperty from given node, if timestamp
449  * is found and has a correct size its value is retured in third call
450  * argument.
451  *
452  * returns:
453  *     0, on success
454  *     -1, on property read failure
455  *     -2, on wrong timestamp size
456  */
457 int fit_get_timestamp(const void *fit, int noffset, time_t *timestamp)
458 {
459 	int len;
460 	const void *data;
461 
462 	data = fdt_getprop(fit, noffset, FIT_TIMESTAMP_PROP, &len);
463 	if (data == NULL) {
464 		fit_get_debug(fit, noffset, FIT_TIMESTAMP_PROP, len);
465 		return -1;
466 	}
467 	if (len != sizeof(uint32_t)) {
468 		debug("FIT timestamp with incorrect size of (%u)\n", len);
469 		return -2;
470 	}
471 
472 	*timestamp = uimage_to_cpu(*((uint32_t *)data));
473 	return 0;
474 }
475 
476 /**
477  * fit_image_get_node - get node offset for component image of a given unit name
478  * @fit: pointer to the FIT format image header
479  * @image_uname: component image node unit name
480  *
481  * fit_image_get_node() finds a component image (withing the '/images'
482  * node) of a provided unit name. If image is found its node offset is
483  * returned to the caller.
484  *
485  * returns:
486  *     image node offset when found (>=0)
487  *     negative number on failure (FDT_ERR_* code)
488  */
489 int fit_image_get_node(const void *fit, const char *image_uname)
490 {
491 	int noffset, images_noffset;
492 
493 	images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
494 	if (images_noffset < 0) {
495 		debug("Can't find images parent node '%s' (%s)\n",
496 		      FIT_IMAGES_PATH, fdt_strerror(images_noffset));
497 		return images_noffset;
498 	}
499 
500 	noffset = fdt_subnode_offset(fit, images_noffset, image_uname);
501 	if (noffset < 0) {
502 		debug("Can't get node offset for image unit name: '%s' (%s)\n",
503 		      image_uname, fdt_strerror(noffset));
504 	}
505 
506 	return noffset;
507 }
508 
509 /**
510  * fit_image_get_os - get os id for a given component image node
511  * @fit: pointer to the FIT format image header
512  * @noffset: component image node offset
513  * @os: pointer to the uint8_t, will hold os numeric id
514  *
515  * fit_image_get_os() finds os property in a given component image node.
516  * If the property is found, its (string) value is translated to the numeric
517  * id which is returned to the caller.
518  *
519  * returns:
520  *     0, on success
521  *     -1, on failure
522  */
523 int fit_image_get_os(const void *fit, int noffset, uint8_t *os)
524 {
525 	int len;
526 	const void *data;
527 
528 	/* Get OS name from property data */
529 	data = fdt_getprop(fit, noffset, FIT_OS_PROP, &len);
530 	if (data == NULL) {
531 		fit_get_debug(fit, noffset, FIT_OS_PROP, len);
532 		*os = -1;
533 		return -1;
534 	}
535 
536 	/* Translate OS name to id */
537 	*os = genimg_get_os_id(data);
538 	return 0;
539 }
540 
541 /**
542  * fit_image_get_arch - get arch id for a given component image node
543  * @fit: pointer to the FIT format image header
544  * @noffset: component image node offset
545  * @arch: pointer to the uint8_t, will hold arch numeric id
546  *
547  * fit_image_get_arch() finds arch property in a given component image node.
548  * If the property is found, its (string) value is translated to the numeric
549  * id which is returned to the caller.
550  *
551  * returns:
552  *     0, on success
553  *     -1, on failure
554  */
555 int fit_image_get_arch(const void *fit, int noffset, uint8_t *arch)
556 {
557 	int len;
558 	const void *data;
559 
560 	/* Get architecture name from property data */
561 	data = fdt_getprop(fit, noffset, FIT_ARCH_PROP, &len);
562 	if (data == NULL) {
563 		fit_get_debug(fit, noffset, FIT_ARCH_PROP, len);
564 		*arch = -1;
565 		return -1;
566 	}
567 
568 	/* Translate architecture name to id */
569 	*arch = genimg_get_arch_id(data);
570 	return 0;
571 }
572 
573 /**
574  * fit_image_get_type - get type id for a given component image node
575  * @fit: pointer to the FIT format image header
576  * @noffset: component image node offset
577  * @type: pointer to the uint8_t, will hold type numeric id
578  *
579  * fit_image_get_type() finds type property in a given component image node.
580  * If the property is found, its (string) value is translated to the numeric
581  * id which is returned to the caller.
582  *
583  * returns:
584  *     0, on success
585  *     -1, on failure
586  */
587 int fit_image_get_type(const void *fit, int noffset, uint8_t *type)
588 {
589 	int len;
590 	const void *data;
591 
592 	/* Get image type name from property data */
593 	data = fdt_getprop(fit, noffset, FIT_TYPE_PROP, &len);
594 	if (data == NULL) {
595 		fit_get_debug(fit, noffset, FIT_TYPE_PROP, len);
596 		*type = -1;
597 		return -1;
598 	}
599 
600 	/* Translate image type name to id */
601 	*type = genimg_get_type_id(data);
602 	return 0;
603 }
604 
605 /**
606  * fit_image_get_comp - get comp id for a given component image node
607  * @fit: pointer to the FIT format image header
608  * @noffset: component image node offset
609  * @comp: pointer to the uint8_t, will hold comp numeric id
610  *
611  * fit_image_get_comp() finds comp property in a given component image node.
612  * If the property is found, its (string) value is translated to the numeric
613  * id which is returned to the caller.
614  *
615  * returns:
616  *     0, on success
617  *     -1, on failure
618  */
619 int fit_image_get_comp(const void *fit, int noffset, uint8_t *comp)
620 {
621 	int len;
622 	const void *data;
623 
624 	/* Get compression name from property data */
625 	data = fdt_getprop(fit, noffset, FIT_COMP_PROP, &len);
626 	if (data == NULL) {
627 		fit_get_debug(fit, noffset, FIT_COMP_PROP, len);
628 		*comp = -1;
629 		return -1;
630 	}
631 
632 	/* Translate compression name to id */
633 	*comp = genimg_get_comp_id(data);
634 	return 0;
635 }
636 
637 /**
638  * fit_image_get_load() - get load addr property for given component image node
639  * @fit: pointer to the FIT format image header
640  * @noffset: component image node offset
641  * @load: pointer to the uint32_t, will hold load address
642  *
643  * fit_image_get_load() finds load address property in a given component
644  * image node. If the property is found, its value is returned to the caller.
645  *
646  * returns:
647  *     0, on success
648  *     -1, on failure
649  */
650 int fit_image_get_load(const void *fit, int noffset, ulong *load)
651 {
652 	int len;
653 	const uint32_t *data;
654 
655 	data = fdt_getprop(fit, noffset, FIT_LOAD_PROP, &len);
656 	if (data == NULL) {
657 		fit_get_debug(fit, noffset, FIT_LOAD_PROP, len);
658 		return -1;
659 	}
660 
661 	*load = uimage_to_cpu(*data);
662 	return 0;
663 }
664 
665 /**
666  * fit_image_get_entry() - get entry point address property
667  * @fit: pointer to the FIT format image header
668  * @noffset: component image node offset
669  * @entry: pointer to the uint32_t, will hold entry point address
670  *
671  * This gets the entry point address property for a given component image
672  * node.
673  *
674  * fit_image_get_entry() finds entry point address property in a given
675  * component image node.  If the property is found, its value is returned
676  * to the caller.
677  *
678  * returns:
679  *     0, on success
680  *     -1, on failure
681  */
682 int fit_image_get_entry(const void *fit, int noffset, ulong *entry)
683 {
684 	int len;
685 	const uint32_t *data;
686 
687 	data = fdt_getprop(fit, noffset, FIT_ENTRY_PROP, &len);
688 	if (data == NULL) {
689 		fit_get_debug(fit, noffset, FIT_ENTRY_PROP, len);
690 		return -1;
691 	}
692 
693 	*entry = uimage_to_cpu(*data);
694 	return 0;
695 }
696 
697 /**
698  * fit_image_get_data - get data property and its size for a given component image node
699  * @fit: pointer to the FIT format image header
700  * @noffset: component image node offset
701  * @data: double pointer to void, will hold data property's data address
702  * @size: pointer to size_t, will hold data property's data size
703  *
704  * fit_image_get_data() finds data property in a given component image node.
705  * If the property is found its data start address and size are returned to
706  * the caller.
707  *
708  * returns:
709  *     0, on success
710  *     -1, on failure
711  */
712 int fit_image_get_data(const void *fit, int noffset,
713 		const void **data, size_t *size)
714 {
715 	int len;
716 
717 	*data = fdt_getprop(fit, noffset, FIT_DATA_PROP, &len);
718 	if (*data == NULL) {
719 		fit_get_debug(fit, noffset, FIT_DATA_PROP, len);
720 		*size = 0;
721 		return -1;
722 	}
723 
724 	*size = len;
725 	return 0;
726 }
727 
728 /**
729  * fit_image_hash_get_algo - get hash algorithm name
730  * @fit: pointer to the FIT format image header
731  * @noffset: hash node offset
732  * @algo: double pointer to char, will hold pointer to the algorithm name
733  *
734  * fit_image_hash_get_algo() finds hash algorithm property in a given hash node.
735  * If the property is found its data start address is returned to the caller.
736  *
737  * returns:
738  *     0, on success
739  *     -1, on failure
740  */
741 int fit_image_hash_get_algo(const void *fit, int noffset, char **algo)
742 {
743 	int len;
744 
745 	*algo = (char *)fdt_getprop(fit, noffset, FIT_ALGO_PROP, &len);
746 	if (*algo == NULL) {
747 		fit_get_debug(fit, noffset, FIT_ALGO_PROP, len);
748 		return -1;
749 	}
750 
751 	return 0;
752 }
753 
754 /**
755  * fit_image_hash_get_value - get hash value and length
756  * @fit: pointer to the FIT format image header
757  * @noffset: hash node offset
758  * @value: double pointer to uint8_t, will hold address of a hash value data
759  * @value_len: pointer to an int, will hold hash data length
760  *
761  * fit_image_hash_get_value() finds hash value property in a given hash node.
762  * If the property is found its data start address and size are returned to
763  * the caller.
764  *
765  * returns:
766  *     0, on success
767  *     -1, on failure
768  */
769 int fit_image_hash_get_value(const void *fit, int noffset, uint8_t **value,
770 				int *value_len)
771 {
772 	int len;
773 
774 	*value = (uint8_t *)fdt_getprop(fit, noffset, FIT_VALUE_PROP, &len);
775 	if (*value == NULL) {
776 		fit_get_debug(fit, noffset, FIT_VALUE_PROP, len);
777 		*value_len = 0;
778 		return -1;
779 	}
780 
781 	*value_len = len;
782 	return 0;
783 }
784 
785 /**
786  * fit_image_hash_get_ignore - get hash ignore flag
787  * @fit: pointer to the FIT format image header
788  * @noffset: hash node offset
789  * @ignore: pointer to an int, will hold hash ignore flag
790  *
791  * fit_image_hash_get_ignore() finds hash ignore property in a given hash node.
792  * If the property is found and non-zero, the hash algorithm is not verified by
793  * u-boot automatically.
794  *
795  * returns:
796  *     0, on ignore not found
797  *     value, on ignore found
798  */
799 static int fit_image_hash_get_ignore(const void *fit, int noffset, int *ignore)
800 {
801 	int len;
802 	int *value;
803 
804 	value = (int *)fdt_getprop(fit, noffset, FIT_IGNORE_PROP, &len);
805 	if (value == NULL || len != sizeof(int))
806 		*ignore = 0;
807 	else
808 		*ignore = *value;
809 
810 	return 0;
811 }
812 
813 /**
814  * fit_set_timestamp - set node timestamp property
815  * @fit: pointer to the FIT format image header
816  * @noffset: node offset
817  * @timestamp: timestamp value to be set
818  *
819  * fit_set_timestamp() attempts to set timestamp property in the requested
820  * node and returns operation status to the caller.
821  *
822  * returns:
823  *     0, on success
824  *     -1, on property read failure
825  */
826 int fit_set_timestamp(void *fit, int noffset, time_t timestamp)
827 {
828 	uint32_t t;
829 	int ret;
830 
831 	t = cpu_to_uimage(timestamp);
832 	ret = fdt_setprop(fit, noffset, FIT_TIMESTAMP_PROP, &t,
833 				sizeof(uint32_t));
834 	if (ret) {
835 		printf("Can't set '%s' property for '%s' node (%s)\n",
836 		       FIT_TIMESTAMP_PROP, fit_get_name(fit, noffset, NULL),
837 		       fdt_strerror(ret));
838 		return -1;
839 	}
840 
841 	return 0;
842 }
843 
844 /**
845  * calculate_hash - calculate and return hash for provided input data
846  * @data: pointer to the input data
847  * @data_len: data length
848  * @algo: requested hash algorithm
849  * @value: pointer to the char, will hold hash value data (caller must
850  * allocate enough free space)
851  * value_len: length of the calculated hash
852  *
853  * calculate_hash() computes input data hash according to the requested
854  * algorithm.
855  * Resulting hash value is placed in caller provided 'value' buffer, length
856  * of the calculated hash is returned via value_len pointer argument.
857  *
858  * returns:
859  *     0, on success
860  *    -1, when algo is unsupported
861  */
862 int calculate_hash(const void *data, int data_len, const char *algo,
863 			uint8_t *value, int *value_len)
864 {
865 	if (IMAGE_ENABLE_CRC32 && strcmp(algo, "crc32") == 0) {
866 		*((uint32_t *)value) = crc32_wd(0, data, data_len,
867 							CHUNKSZ_CRC32);
868 		*((uint32_t *)value) = cpu_to_uimage(*((uint32_t *)value));
869 		*value_len = 4;
870 	} else if (IMAGE_ENABLE_SHA1 && strcmp(algo, "sha1") == 0) {
871 		sha1_csum_wd((unsigned char *)data, data_len,
872 			     (unsigned char *)value, CHUNKSZ_SHA1);
873 		*value_len = 20;
874 	} else if (IMAGE_ENABLE_MD5 && strcmp(algo, "md5") == 0) {
875 		md5_wd((unsigned char *)data, data_len, value, CHUNKSZ_MD5);
876 		*value_len = 16;
877 	} else {
878 		debug("Unsupported hash alogrithm\n");
879 		return -1;
880 	}
881 	return 0;
882 }
883 
884 static int fit_image_check_hash(const void *fit, int noffset, const void *data,
885 				size_t size, char **err_msgp)
886 {
887 	uint8_t value[FIT_MAX_HASH_LEN];
888 	int value_len;
889 	char *algo;
890 	uint8_t *fit_value;
891 	int fit_value_len;
892 	int ignore;
893 
894 	*err_msgp = NULL;
895 
896 	if (fit_image_hash_get_algo(fit, noffset, &algo)) {
897 		*err_msgp = "Can't get hash algo property";
898 		return -1;
899 	}
900 	printf("%s", algo);
901 
902 	if (IMAGE_ENABLE_IGNORE) {
903 		fit_image_hash_get_ignore(fit, noffset, &ignore);
904 		if (ignore) {
905 			printf("-skipped ");
906 			return 0;
907 		}
908 	}
909 
910 	if (fit_image_hash_get_value(fit, noffset, &fit_value,
911 				     &fit_value_len)) {
912 		*err_msgp = "Can't get hash value property";
913 		return -1;
914 	}
915 
916 	if (calculate_hash(data, size, algo, value, &value_len)) {
917 		*err_msgp = "Unsupported hash algorithm";
918 		return -1;
919 	}
920 
921 	if (value_len != fit_value_len) {
922 		*err_msgp = "Bad hash value len";
923 		return -1;
924 	} else if (memcmp(value, fit_value, value_len) != 0) {
925 		*err_msgp = "Bad hash value";
926 		return -1;
927 	}
928 
929 	return 0;
930 }
931 
932 /**
933  * fit_image_verify - verify data intergity
934  * @fit: pointer to the FIT format image header
935  * @image_noffset: component image node offset
936  *
937  * fit_image_verify() goes over component image hash nodes,
938  * re-calculates each data hash and compares with the value stored in hash
939  * node.
940  *
941  * returns:
942  *     1, if all hashes are valid
943  *     0, otherwise (or on error)
944  */
945 int fit_image_verify(const void *fit, int image_noffset)
946 {
947 	const void	*data;
948 	size_t		size;
949 	int		noffset = 0;
950 	char		*err_msg = "";
951 	int verify_all = 1;
952 	int ret;
953 
954 	/* Get image data and data length */
955 	if (fit_image_get_data(fit, image_noffset, &data, &size)) {
956 		err_msg = "Can't get image data/size";
957 		goto error;
958 	}
959 
960 	/* Verify all required signatures */
961 	if (IMAGE_ENABLE_VERIFY &&
962 	    fit_image_verify_required_sigs(fit, image_noffset, data, size,
963 					   gd_fdt_blob(), &verify_all)) {
964 		err_msg = "Unable to verify required signature";
965 		goto error;
966 	}
967 
968 	/* Process all hash subnodes of the component image node */
969 	for (noffset = fdt_first_subnode(fit, image_noffset);
970 	     noffset >= 0;
971 	     noffset = fdt_next_subnode(fit, noffset)) {
972 		const char *name = fit_get_name(fit, noffset, NULL);
973 
974 		/*
975 		 * Check subnode name, must be equal to "hash".
976 		 * Multiple hash nodes require unique unit node
977 		 * names, e.g. hash@1, hash@2, etc.
978 		 */
979 		if (!strncmp(name, FIT_HASH_NODENAME,
980 			     strlen(FIT_HASH_NODENAME))) {
981 			if (fit_image_check_hash(fit, noffset, data, size,
982 						 &err_msg))
983 				goto error;
984 			puts("+ ");
985 		} else if (IMAGE_ENABLE_VERIFY && verify_all &&
986 				!strncmp(name, FIT_SIG_NODENAME,
987 					strlen(FIT_SIG_NODENAME))) {
988 			ret = fit_image_check_sig(fit, noffset, data,
989 							size, -1, &err_msg);
990 			if (ret)
991 				puts("- ");
992 			else
993 				puts("+ ");
994 		}
995 	}
996 
997 	if (noffset == -FDT_ERR_TRUNCATED || noffset == -FDT_ERR_BADSTRUCTURE) {
998 		err_msg = "Corrupted or truncated tree";
999 		goto error;
1000 	}
1001 
1002 	return 1;
1003 
1004 error:
1005 	printf(" error!\n%s for '%s' hash node in '%s' image node\n",
1006 	       err_msg, fit_get_name(fit, noffset, NULL),
1007 	       fit_get_name(fit, image_noffset, NULL));
1008 	return 0;
1009 }
1010 
1011 /**
1012  * fit_all_image_verify - verify data intergity for all images
1013  * @fit: pointer to the FIT format image header
1014  *
1015  * fit_all_image_verify() goes over all images in the FIT and
1016  * for every images checks if all it's hashes are valid.
1017  *
1018  * returns:
1019  *     1, if all hashes of all images are valid
1020  *     0, otherwise (or on error)
1021  */
1022 int fit_all_image_verify(const void *fit)
1023 {
1024 	int images_noffset;
1025 	int noffset;
1026 	int ndepth;
1027 	int count;
1028 
1029 	/* Find images parent node offset */
1030 	images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
1031 	if (images_noffset < 0) {
1032 		printf("Can't find images parent node '%s' (%s)\n",
1033 		       FIT_IMAGES_PATH, fdt_strerror(images_noffset));
1034 		return 0;
1035 	}
1036 
1037 	/* Process all image subnodes, check hashes for each */
1038 	printf("## Checking hash(es) for FIT Image at %08lx ...\n",
1039 	       (ulong)fit);
1040 	for (ndepth = 0, count = 0,
1041 	     noffset = fdt_next_node(fit, images_noffset, &ndepth);
1042 			(noffset >= 0) && (ndepth > 0);
1043 			noffset = fdt_next_node(fit, noffset, &ndepth)) {
1044 		if (ndepth == 1) {
1045 			/*
1046 			 * Direct child node of the images parent node,
1047 			 * i.e. component image node.
1048 			 */
1049 			printf("   Hash(es) for Image %u (%s): ", count++,
1050 			       fit_get_name(fit, noffset, NULL));
1051 
1052 			if (!fit_image_verify(fit, noffset))
1053 				return 0;
1054 			printf("\n");
1055 		}
1056 	}
1057 	return 1;
1058 }
1059 
1060 /**
1061  * fit_image_check_os - check whether image node is of a given os type
1062  * @fit: pointer to the FIT format image header
1063  * @noffset: component image node offset
1064  * @os: requested image os
1065  *
1066  * fit_image_check_os() reads image os property and compares its numeric
1067  * id with the requested os. Comparison result is returned to the caller.
1068  *
1069  * returns:
1070  *     1 if image is of given os type
1071  *     0 otherwise (or on error)
1072  */
1073 int fit_image_check_os(const void *fit, int noffset, uint8_t os)
1074 {
1075 	uint8_t image_os;
1076 
1077 	if (fit_image_get_os(fit, noffset, &image_os))
1078 		return 0;
1079 	return (os == image_os);
1080 }
1081 
1082 /**
1083  * fit_image_check_arch - check whether image node is of a given arch
1084  * @fit: pointer to the FIT format image header
1085  * @noffset: component image node offset
1086  * @arch: requested imagearch
1087  *
1088  * fit_image_check_arch() reads image arch property and compares its numeric
1089  * id with the requested arch. Comparison result is returned to the caller.
1090  *
1091  * returns:
1092  *     1 if image is of given arch
1093  *     0 otherwise (or on error)
1094  */
1095 int fit_image_check_arch(const void *fit, int noffset, uint8_t arch)
1096 {
1097 	uint8_t image_arch;
1098 
1099 	if (fit_image_get_arch(fit, noffset, &image_arch))
1100 		return 0;
1101 	return (arch == image_arch);
1102 }
1103 
1104 /**
1105  * fit_image_check_type - check whether image node is of a given type
1106  * @fit: pointer to the FIT format image header
1107  * @noffset: component image node offset
1108  * @type: requested image type
1109  *
1110  * fit_image_check_type() reads image type property and compares its numeric
1111  * id with the requested type. Comparison result is returned to the caller.
1112  *
1113  * returns:
1114  *     1 if image is of given type
1115  *     0 otherwise (or on error)
1116  */
1117 int fit_image_check_type(const void *fit, int noffset, uint8_t type)
1118 {
1119 	uint8_t image_type;
1120 
1121 	if (fit_image_get_type(fit, noffset, &image_type))
1122 		return 0;
1123 	return (type == image_type);
1124 }
1125 
1126 /**
1127  * fit_image_check_comp - check whether image node uses given compression
1128  * @fit: pointer to the FIT format image header
1129  * @noffset: component image node offset
1130  * @comp: requested image compression type
1131  *
1132  * fit_image_check_comp() reads image compression property and compares its
1133  * numeric id with the requested compression type. Comparison result is
1134  * returned to the caller.
1135  *
1136  * returns:
1137  *     1 if image uses requested compression
1138  *     0 otherwise (or on error)
1139  */
1140 int fit_image_check_comp(const void *fit, int noffset, uint8_t comp)
1141 {
1142 	uint8_t image_comp;
1143 
1144 	if (fit_image_get_comp(fit, noffset, &image_comp))
1145 		return 0;
1146 	return (comp == image_comp);
1147 }
1148 
1149 /**
1150  * fit_check_format - sanity check FIT image format
1151  * @fit: pointer to the FIT format image header
1152  *
1153  * fit_check_format() runs a basic sanity FIT image verification.
1154  * Routine checks for mandatory properties, nodes, etc.
1155  *
1156  * returns:
1157  *     1, on success
1158  *     0, on failure
1159  */
1160 int fit_check_format(const void *fit)
1161 {
1162 	/* mandatory / node 'description' property */
1163 	if (fdt_getprop(fit, 0, FIT_DESC_PROP, NULL) == NULL) {
1164 		debug("Wrong FIT format: no description\n");
1165 		return 0;
1166 	}
1167 
1168 	if (IMAGE_ENABLE_TIMESTAMP) {
1169 		/* mandatory / node 'timestamp' property */
1170 		if (fdt_getprop(fit, 0, FIT_TIMESTAMP_PROP, NULL) == NULL) {
1171 			debug("Wrong FIT format: no timestamp\n");
1172 			return 0;
1173 		}
1174 	}
1175 
1176 	/* mandatory subimages parent '/images' node */
1177 	if (fdt_path_offset(fit, FIT_IMAGES_PATH) < 0) {
1178 		debug("Wrong FIT format: no images parent node\n");
1179 		return 0;
1180 	}
1181 
1182 	return 1;
1183 }
1184 
1185 
1186 /**
1187  * fit_conf_find_compat
1188  * @fit: pointer to the FIT format image header
1189  * @fdt: pointer to the device tree to compare against
1190  *
1191  * fit_conf_find_compat() attempts to find the configuration whose fdt is the
1192  * most compatible with the passed in device tree.
1193  *
1194  * Example:
1195  *
1196  * / o image-tree
1197  *   |-o images
1198  *   | |-o fdt@1
1199  *   | |-o fdt@2
1200  *   |
1201  *   |-o configurations
1202  *     |-o config@1
1203  *     | |-fdt = fdt@1
1204  *     |
1205  *     |-o config@2
1206  *       |-fdt = fdt@2
1207  *
1208  * / o U-Boot fdt
1209  *   |-compatible = "foo,bar", "bim,bam"
1210  *
1211  * / o kernel fdt1
1212  *   |-compatible = "foo,bar",
1213  *
1214  * / o kernel fdt2
1215  *   |-compatible = "bim,bam", "baz,biz"
1216  *
1217  * Configuration 1 would be picked because the first string in U-Boot's
1218  * compatible list, "foo,bar", matches a compatible string in the root of fdt1.
1219  * "bim,bam" in fdt2 matches the second string which isn't as good as fdt1.
1220  *
1221  * returns:
1222  *     offset to the configuration to use if one was found
1223  *     -1 otherwise
1224  */
1225 int fit_conf_find_compat(const void *fit, const void *fdt)
1226 {
1227 	int ndepth = 0;
1228 	int noffset, confs_noffset, images_noffset;
1229 	const void *fdt_compat;
1230 	int fdt_compat_len;
1231 	int best_match_offset = 0;
1232 	int best_match_pos = 0;
1233 
1234 	confs_noffset = fdt_path_offset(fit, FIT_CONFS_PATH);
1235 	images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
1236 	if (confs_noffset < 0 || images_noffset < 0) {
1237 		debug("Can't find configurations or images nodes.\n");
1238 		return -1;
1239 	}
1240 
1241 	fdt_compat = fdt_getprop(fdt, 0, "compatible", &fdt_compat_len);
1242 	if (!fdt_compat) {
1243 		debug("Fdt for comparison has no \"compatible\" property.\n");
1244 		return -1;
1245 	}
1246 
1247 	/*
1248 	 * Loop over the configurations in the FIT image.
1249 	 */
1250 	for (noffset = fdt_next_node(fit, confs_noffset, &ndepth);
1251 			(noffset >= 0) && (ndepth > 0);
1252 			noffset = fdt_next_node(fit, noffset, &ndepth)) {
1253 		const void *kfdt;
1254 		const char *kfdt_name;
1255 		int kfdt_noffset;
1256 		const char *cur_fdt_compat;
1257 		int len;
1258 		size_t size;
1259 		int i;
1260 
1261 		if (ndepth > 1)
1262 			continue;
1263 
1264 		kfdt_name = fdt_getprop(fit, noffset, "fdt", &len);
1265 		if (!kfdt_name) {
1266 			debug("No fdt property found.\n");
1267 			continue;
1268 		}
1269 		kfdt_noffset = fdt_subnode_offset(fit, images_noffset,
1270 						  kfdt_name);
1271 		if (kfdt_noffset < 0) {
1272 			debug("No image node named \"%s\" found.\n",
1273 			      kfdt_name);
1274 			continue;
1275 		}
1276 		/*
1277 		 * Get a pointer to this configuration's fdt.
1278 		 */
1279 		if (fit_image_get_data(fit, kfdt_noffset, &kfdt, &size)) {
1280 			debug("Failed to get fdt \"%s\".\n", kfdt_name);
1281 			continue;
1282 		}
1283 
1284 		len = fdt_compat_len;
1285 		cur_fdt_compat = fdt_compat;
1286 		/*
1287 		 * Look for a match for each U-Boot compatibility string in
1288 		 * turn in this configuration's fdt.
1289 		 */
1290 		for (i = 0; len > 0 &&
1291 		     (!best_match_offset || best_match_pos > i); i++) {
1292 			int cur_len = strlen(cur_fdt_compat) + 1;
1293 
1294 			if (!fdt_node_check_compatible(kfdt, 0,
1295 						       cur_fdt_compat)) {
1296 				best_match_offset = noffset;
1297 				best_match_pos = i;
1298 				break;
1299 			}
1300 			len -= cur_len;
1301 			cur_fdt_compat += cur_len;
1302 		}
1303 	}
1304 	if (!best_match_offset) {
1305 		debug("No match found.\n");
1306 		return -1;
1307 	}
1308 
1309 	return best_match_offset;
1310 }
1311 
1312 /**
1313  * fit_conf_get_node - get node offset for configuration of a given unit name
1314  * @fit: pointer to the FIT format image header
1315  * @conf_uname: configuration node unit name
1316  *
1317  * fit_conf_get_node() finds a configuration (withing the '/configurations'
1318  * parant node) of a provided unit name. If configuration is found its node
1319  * offset is returned to the caller.
1320  *
1321  * When NULL is provided in second argument fit_conf_get_node() will search
1322  * for a default configuration node instead. Default configuration node unit
1323  * name is retrived from FIT_DEFAULT_PROP property of the '/configurations'
1324  * node.
1325  *
1326  * returns:
1327  *     configuration node offset when found (>=0)
1328  *     negative number on failure (FDT_ERR_* code)
1329  */
1330 int fit_conf_get_node(const void *fit, const char *conf_uname)
1331 {
1332 	int noffset, confs_noffset;
1333 	int len;
1334 
1335 	confs_noffset = fdt_path_offset(fit, FIT_CONFS_PATH);
1336 	if (confs_noffset < 0) {
1337 		debug("Can't find configurations parent node '%s' (%s)\n",
1338 		      FIT_CONFS_PATH, fdt_strerror(confs_noffset));
1339 		return confs_noffset;
1340 	}
1341 
1342 	if (conf_uname == NULL) {
1343 		/* get configuration unit name from the default property */
1344 		debug("No configuration specified, trying default...\n");
1345 		conf_uname = (char *)fdt_getprop(fit, confs_noffset,
1346 						 FIT_DEFAULT_PROP, &len);
1347 		if (conf_uname == NULL) {
1348 			fit_get_debug(fit, confs_noffset, FIT_DEFAULT_PROP,
1349 				      len);
1350 			return len;
1351 		}
1352 		debug("Found default configuration: '%s'\n", conf_uname);
1353 	}
1354 
1355 	noffset = fdt_subnode_offset(fit, confs_noffset, conf_uname);
1356 	if (noffset < 0) {
1357 		debug("Can't get node offset for configuration unit name: '%s' (%s)\n",
1358 		      conf_uname, fdt_strerror(noffset));
1359 	}
1360 
1361 	return noffset;
1362 }
1363 
1364 int fit_conf_get_prop_node(const void *fit, int noffset,
1365 		const char *prop_name)
1366 {
1367 	char *uname;
1368 	int len;
1369 
1370 	/* get kernel image unit name from configuration kernel property */
1371 	uname = (char *)fdt_getprop(fit, noffset, prop_name, &len);
1372 	if (uname == NULL)
1373 		return len;
1374 
1375 	return fit_image_get_node(fit, uname);
1376 }
1377 
1378 /**
1379  * fit_conf_print - prints out the FIT configuration details
1380  * @fit: pointer to the FIT format image header
1381  * @noffset: offset of the configuration node
1382  * @p: pointer to prefix string
1383  *
1384  * fit_conf_print() lists all mandatory properies for the processed
1385  * configuration node.
1386  *
1387  * returns:
1388  *     no returned results
1389  */
1390 void fit_conf_print(const void *fit, int noffset, const char *p)
1391 {
1392 	char *desc;
1393 	char *uname;
1394 	int ret;
1395 
1396 	/* Mandatory properties */
1397 	ret = fit_get_desc(fit, noffset, &desc);
1398 	printf("%s  Description:  ", p);
1399 	if (ret)
1400 		printf("unavailable\n");
1401 	else
1402 		printf("%s\n", desc);
1403 
1404 	uname = (char *)fdt_getprop(fit, noffset, FIT_KERNEL_PROP, NULL);
1405 	printf("%s  Kernel:       ", p);
1406 	if (uname == NULL)
1407 		printf("unavailable\n");
1408 	else
1409 		printf("%s\n", uname);
1410 
1411 	/* Optional properties */
1412 	uname = (char *)fdt_getprop(fit, noffset, FIT_RAMDISK_PROP, NULL);
1413 	if (uname)
1414 		printf("%s  Init Ramdisk: %s\n", p, uname);
1415 
1416 	uname = (char *)fdt_getprop(fit, noffset, FIT_FDT_PROP, NULL);
1417 	if (uname)
1418 		printf("%s  FDT:          %s\n", p, uname);
1419 }
1420 
1421 int fit_image_select(const void *fit, int rd_noffset, int verify)
1422 {
1423 	fit_image_print(fit, rd_noffset, "   ");
1424 
1425 	if (verify) {
1426 		puts("   Verifying Hash Integrity ... ");
1427 		if (!fit_image_verify(fit, rd_noffset)) {
1428 			puts("Bad Data Hash\n");
1429 			return -EACCES;
1430 		}
1431 		puts("OK\n");
1432 	}
1433 
1434 	return 0;
1435 }
1436 
1437 int fit_get_node_from_config(bootm_headers_t *images, const char *prop_name,
1438 			ulong addr)
1439 {
1440 	int cfg_noffset;
1441 	void *fit_hdr;
1442 	int noffset;
1443 
1444 	debug("*  %s: using config '%s' from image at 0x%08lx\n",
1445 	      prop_name, images->fit_uname_cfg, addr);
1446 
1447 	/* Check whether configuration has this property defined */
1448 	fit_hdr = map_sysmem(addr, 0);
1449 	cfg_noffset = fit_conf_get_node(fit_hdr, images->fit_uname_cfg);
1450 	if (cfg_noffset < 0) {
1451 		debug("*  %s: no such config\n", prop_name);
1452 		return -ENOENT;
1453 	}
1454 
1455 	noffset = fit_conf_get_prop_node(fit_hdr, cfg_noffset, prop_name);
1456 	if (noffset < 0) {
1457 		debug("*  %s: no '%s' in config\n", prop_name, prop_name);
1458 		return -ENOLINK;
1459 	}
1460 
1461 	return noffset;
1462 }
1463 
1464 int fit_image_load(bootm_headers_t *images, const char *prop_name, ulong addr,
1465 		   const char **fit_unamep, const char **fit_uname_configp,
1466 		   int arch, int image_type, int bootstage_id,
1467 		   enum fit_load_op load_op, ulong *datap, ulong *lenp)
1468 {
1469 	int cfg_noffset, noffset;
1470 	const char *fit_uname;
1471 	const char *fit_uname_config;
1472 	const void *fit;
1473 	const void *buf;
1474 	size_t size;
1475 	int type_ok, os_ok;
1476 	ulong load, data, len;
1477 	int ret;
1478 
1479 	fit = map_sysmem(addr, 0);
1480 	fit_uname = fit_unamep ? *fit_unamep : NULL;
1481 	fit_uname_config = fit_uname_configp ? *fit_uname_configp : NULL;
1482 	printf("## Loading %s from FIT Image at %08lx ...\n", prop_name, addr);
1483 
1484 	bootstage_mark(bootstage_id + BOOTSTAGE_SUB_FORMAT);
1485 	if (!fit_check_format(fit)) {
1486 		printf("Bad FIT %s image format!\n", prop_name);
1487 		bootstage_error(bootstage_id + BOOTSTAGE_SUB_FORMAT);
1488 		return -ENOEXEC;
1489 	}
1490 	bootstage_mark(bootstage_id + BOOTSTAGE_SUB_FORMAT_OK);
1491 	if (fit_uname) {
1492 		/* get ramdisk component image node offset */
1493 		bootstage_mark(bootstage_id + BOOTSTAGE_SUB_UNIT_NAME);
1494 		noffset = fit_image_get_node(fit, fit_uname);
1495 	} else {
1496 		/*
1497 		 * no image node unit name, try to get config
1498 		 * node first. If config unit node name is NULL
1499 		 * fit_conf_get_node() will try to find default config node
1500 		 */
1501 		bootstage_mark(bootstage_id + BOOTSTAGE_SUB_NO_UNIT_NAME);
1502 		if (IMAGE_ENABLE_BEST_MATCH && !fit_uname_config) {
1503 			cfg_noffset = fit_conf_find_compat(fit, gd_fdt_blob());
1504 		} else {
1505 			cfg_noffset = fit_conf_get_node(fit,
1506 							fit_uname_config);
1507 		}
1508 		if (cfg_noffset < 0) {
1509 			puts("Could not find configuration node\n");
1510 			bootstage_error(bootstage_id +
1511 					BOOTSTAGE_SUB_NO_UNIT_NAME);
1512 			return -ENOENT;
1513 		}
1514 		fit_uname_config = fdt_get_name(fit, cfg_noffset, NULL);
1515 		printf("   Using '%s' configuration\n", fit_uname_config);
1516 		if (image_type == IH_TYPE_KERNEL) {
1517 			/* Remember (and possibly verify) this config */
1518 			images->fit_uname_cfg = fit_uname_config;
1519 			if (IMAGE_ENABLE_VERIFY && images->verify) {
1520 				puts("   Verifying Hash Integrity ... ");
1521 				if (!fit_config_verify(fit, cfg_noffset)) {
1522 					puts("Bad Data Hash\n");
1523 					bootstage_error(bootstage_id +
1524 						BOOTSTAGE_SUB_HASH);
1525 					return -EACCES;
1526 				}
1527 				puts("OK\n");
1528 			}
1529 			bootstage_mark(BOOTSTAGE_ID_FIT_CONFIG);
1530 		}
1531 
1532 		noffset = fit_conf_get_prop_node(fit, cfg_noffset,
1533 						 prop_name);
1534 		fit_uname = fit_get_name(fit, noffset, NULL);
1535 	}
1536 	if (noffset < 0) {
1537 		puts("Could not find subimage node\n");
1538 		bootstage_error(bootstage_id + BOOTSTAGE_SUB_SUBNODE);
1539 		return -ENOENT;
1540 	}
1541 
1542 	printf("   Trying '%s' %s subimage\n", fit_uname, prop_name);
1543 
1544 	ret = fit_image_select(fit, noffset, images->verify);
1545 	if (ret) {
1546 		bootstage_error(bootstage_id + BOOTSTAGE_SUB_HASH);
1547 		return ret;
1548 	}
1549 
1550 	bootstage_mark(bootstage_id + BOOTSTAGE_SUB_CHECK_ARCH);
1551 	if (!fit_image_check_target_arch(fit, noffset)) {
1552 		puts("Unsupported Architecture\n");
1553 		bootstage_error(bootstage_id + BOOTSTAGE_SUB_CHECK_ARCH);
1554 		return -ENOEXEC;
1555 	}
1556 
1557 	if (image_type == IH_TYPE_FLATDT &&
1558 	    !fit_image_check_comp(fit, noffset, IH_COMP_NONE)) {
1559 		puts("FDT image is compressed");
1560 		return -EPROTONOSUPPORT;
1561 	}
1562 
1563 	bootstage_mark(bootstage_id + BOOTSTAGE_SUB_CHECK_ALL);
1564 	type_ok = fit_image_check_type(fit, noffset, image_type) ||
1565 		(image_type == IH_TYPE_KERNEL &&
1566 			fit_image_check_type(fit, noffset,
1567 					     IH_TYPE_KERNEL_NOLOAD));
1568 	os_ok = image_type == IH_TYPE_FLATDT ||
1569 		fit_image_check_os(fit, noffset, IH_OS_LINUX);
1570 	if (!type_ok || !os_ok) {
1571 		printf("No Linux %s %s Image\n", genimg_get_arch_name(arch),
1572 		       genimg_get_type_name(image_type));
1573 		bootstage_error(bootstage_id + BOOTSTAGE_SUB_CHECK_ALL);
1574 		return -EIO;
1575 	}
1576 
1577 	bootstage_mark(bootstage_id + BOOTSTAGE_SUB_CHECK_ALL_OK);
1578 
1579 	/* get image data address and length */
1580 	if (fit_image_get_data(fit, noffset, &buf, &size)) {
1581 		printf("Could not find %s subimage data!\n", prop_name);
1582 		bootstage_error(bootstage_id + BOOTSTAGE_SUB_GET_DATA);
1583 		return -ENOENT;
1584 	}
1585 	len = (ulong)size;
1586 
1587 	/* verify that image data is a proper FDT blob */
1588 	if (image_type == IH_TYPE_FLATDT && fdt_check_header((char *)buf)) {
1589 		puts("Subimage data is not a FDT");
1590 		return -ENOEXEC;
1591 	}
1592 
1593 	bootstage_mark(bootstage_id + BOOTSTAGE_SUB_GET_DATA_OK);
1594 
1595 	/*
1596 	 * Work-around for eldk-4.2 which gives this warning if we try to
1597 	 * case in the unmap_sysmem() call:
1598 	 * warning: initialization discards qualifiers from pointer target type
1599 	 */
1600 	{
1601 		void *vbuf = (void *)buf;
1602 
1603 		data = map_to_sysmem(vbuf);
1604 	}
1605 
1606 	if (load_op == FIT_LOAD_IGNORED) {
1607 		/* Don't load */
1608 	} else if (fit_image_get_load(fit, noffset, &load)) {
1609 		if (load_op == FIT_LOAD_REQUIRED) {
1610 			printf("Can't get %s subimage load address!\n",
1611 			       prop_name);
1612 			bootstage_error(bootstage_id + BOOTSTAGE_SUB_LOAD);
1613 			return -EBADF;
1614 		}
1615 	} else {
1616 		ulong image_start, image_end;
1617 		ulong load_end;
1618 		void *dst;
1619 
1620 		/*
1621 		 * move image data to the load address,
1622 		 * make sure we don't overwrite initial image
1623 		 */
1624 		image_start = addr;
1625 		image_end = addr + fit_get_size(fit);
1626 
1627 		load_end = load + len;
1628 		if (image_type != IH_TYPE_KERNEL &&
1629 		    load < image_end && load_end > image_start) {
1630 			printf("Error: %s overwritten\n", prop_name);
1631 			return -EXDEV;
1632 		}
1633 
1634 		printf("   Loading %s from 0x%08lx to 0x%08lx\n",
1635 		       prop_name, data, load);
1636 
1637 		dst = map_sysmem(load, len);
1638 		memmove(dst, buf, len);
1639 		data = load;
1640 	}
1641 	bootstage_mark(bootstage_id + BOOTSTAGE_SUB_LOAD);
1642 
1643 	*datap = data;
1644 	*lenp = len;
1645 	if (fit_unamep)
1646 		*fit_unamep = (char *)fit_uname;
1647 	if (fit_uname_configp)
1648 		*fit_uname_configp = (char *)fit_uname_config;
1649 
1650 	return noffset;
1651 }
1652