MAINLINE samsung: misc: check_keys(), key_pressed() - remove type static.
[kernel/u-boot.git] / common / image-fit.c
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 form 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 form 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         if (IMAGE_ENABLE_TIMESTAMP) {
347                 time_t timestamp;
348
349                 ret = fit_get_timestamp(fit, 0, &timestamp);
350                 printf("%s  Created:      ", p);
351                 if (ret)
352                         printf("unavailable\n");
353                 else
354                         genimg_print_time(timestamp);
355         }
356
357         fit_image_get_type(fit, image_noffset, &type);
358         printf("%s  Type:         %s\n", p, genimg_get_type_name(type));
359
360         fit_image_get_comp(fit, image_noffset, &comp);
361         printf("%s  Compression:  %s\n", p, genimg_get_comp_name(comp));
362
363         ret = fit_image_get_data(fit, image_noffset, &data, &size);
364
365 #ifndef USE_HOSTCC
366         printf("%s  Data Start:   ", p);
367         if (ret) {
368                 printf("unavailable\n");
369         } else {
370                 void *vdata = (void *)data;
371
372                 printf("0x%08lx\n", (ulong)map_to_sysmem(vdata));
373         }
374 #endif
375
376         printf("%s  Data Size:    ", p);
377         if (ret)
378                 printf("unavailable\n");
379         else
380                 genimg_print_size(size);
381
382         /* Remaining, type dependent properties */
383         if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE) ||
384             (type == IH_TYPE_RAMDISK) || (type == IH_TYPE_FIRMWARE) ||
385             (type == IH_TYPE_FLATDT)) {
386                 fit_image_get_arch(fit, image_noffset, &arch);
387                 printf("%s  Architecture: %s\n", p, genimg_get_arch_name(arch));
388         }
389
390         if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_RAMDISK)) {
391                 fit_image_get_os(fit, image_noffset, &os);
392                 printf("%s  OS:           %s\n", p, genimg_get_os_name(os));
393         }
394
395         if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE) ||
396             (type == IH_TYPE_FIRMWARE) || (type == IH_TYPE_RAMDISK)) {
397                 ret = fit_image_get_load(fit, image_noffset, &load);
398                 printf("%s  Load Address: ", p);
399                 if (ret)
400                         printf("unavailable\n");
401                 else
402                         printf("0x%08lx\n", load);
403         }
404
405         if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE) ||
406             (type == IH_TYPE_RAMDISK)) {
407                 fit_image_get_entry(fit, image_noffset, &entry);
408                 printf("%s  Entry Point:  ", p);
409                 if (ret)
410                         printf("unavailable\n");
411                 else
412                         printf("0x%08lx\n", entry);
413         }
414
415         /* Process all hash subnodes of the component image node */
416         for (ndepth = 0, noffset = fdt_next_node(fit, image_noffset, &ndepth);
417              (noffset >= 0) && (ndepth > 0);
418              noffset = fdt_next_node(fit, noffset, &ndepth)) {
419                 if (ndepth == 1) {
420                         /* Direct child node of the component image node */
421                         fit_image_print_verification_data(fit, noffset, p);
422                 }
423         }
424 }
425 #endif
426
427 /**
428  * fit_get_desc - get node description property
429  * @fit: pointer to the FIT format image header
430  * @noffset: node offset
431  * @desc: double pointer to the char, will hold pointer to the descrption
432  *
433  * fit_get_desc() reads description property from a given node, if
434  * description is found pointer to it is returened in third call argument.
435  *
436  * returns:
437  *     0, on success
438  *     -1, on failure
439  */
440 int fit_get_desc(const void *fit, int noffset, char **desc)
441 {
442         int len;
443
444         *desc = (char *)fdt_getprop(fit, noffset, FIT_DESC_PROP, &len);
445         if (*desc == NULL) {
446                 fit_get_debug(fit, noffset, FIT_DESC_PROP, len);
447                 return -1;
448         }
449
450         return 0;
451 }
452
453 /**
454  * fit_get_timestamp - get node timestamp property
455  * @fit: pointer to the FIT format image header
456  * @noffset: node offset
457  * @timestamp: pointer to the time_t, will hold read timestamp
458  *
459  * fit_get_timestamp() reads timestamp poperty from given node, if timestamp
460  * is found and has a correct size its value is retured in third call
461  * argument.
462  *
463  * returns:
464  *     0, on success
465  *     -1, on property read failure
466  *     -2, on wrong timestamp size
467  */
468 int fit_get_timestamp(const void *fit, int noffset, time_t *timestamp)
469 {
470         int len;
471         const void *data;
472
473         data = fdt_getprop(fit, noffset, FIT_TIMESTAMP_PROP, &len);
474         if (data == NULL) {
475                 fit_get_debug(fit, noffset, FIT_TIMESTAMP_PROP, len);
476                 return -1;
477         }
478         if (len != sizeof(uint32_t)) {
479                 debug("FIT timestamp with incorrect size of (%u)\n", len);
480                 return -2;
481         }
482
483         *timestamp = uimage_to_cpu(*((uint32_t *)data));
484         return 0;
485 }
486
487 /**
488  * fit_image_get_node - get node offset for component image of a given unit name
489  * @fit: pointer to the FIT format image header
490  * @image_uname: component image node unit name
491  *
492  * fit_image_get_node() finds a component image (withing the '/images'
493  * node) of a provided unit name. If image is found its node offset is
494  * returned to the caller.
495  *
496  * returns:
497  *     image node offset when found (>=0)
498  *     negative number on failure (FDT_ERR_* code)
499  */
500 int fit_image_get_node(const void *fit, const char *image_uname)
501 {
502         int noffset, images_noffset;
503
504         images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
505         if (images_noffset < 0) {
506                 debug("Can't find images parent node '%s' (%s)\n",
507                       FIT_IMAGES_PATH, fdt_strerror(images_noffset));
508                 return images_noffset;
509         }
510
511         noffset = fdt_subnode_offset(fit, images_noffset, image_uname);
512         if (noffset < 0) {
513                 debug("Can't get node offset for image unit name: '%s' (%s)\n",
514                       image_uname, fdt_strerror(noffset));
515         }
516
517         return noffset;
518 }
519
520 /**
521  * fit_image_get_os - get os id for a given component image node
522  * @fit: pointer to the FIT format image header
523  * @noffset: component image node offset
524  * @os: pointer to the uint8_t, will hold os numeric id
525  *
526  * fit_image_get_os() finds os property in a given component image node.
527  * If the property is found, its (string) value is translated to the numeric
528  * id which is returned to the caller.
529  *
530  * returns:
531  *     0, on success
532  *     -1, on failure
533  */
534 int fit_image_get_os(const void *fit, int noffset, uint8_t *os)
535 {
536         int len;
537         const void *data;
538
539         /* Get OS name from property data */
540         data = fdt_getprop(fit, noffset, FIT_OS_PROP, &len);
541         if (data == NULL) {
542                 fit_get_debug(fit, noffset, FIT_OS_PROP, len);
543                 *os = -1;
544                 return -1;
545         }
546
547         /* Translate OS name to id */
548         *os = genimg_get_os_id(data);
549         return 0;
550 }
551
552 /**
553  * fit_image_get_arch - get arch id for a given component image node
554  * @fit: pointer to the FIT format image header
555  * @noffset: component image node offset
556  * @arch: pointer to the uint8_t, will hold arch numeric id
557  *
558  * fit_image_get_arch() finds arch property in a given component image node.
559  * If the property is found, its (string) value is translated to the numeric
560  * id which is returned to the caller.
561  *
562  * returns:
563  *     0, on success
564  *     -1, on failure
565  */
566 int fit_image_get_arch(const void *fit, int noffset, uint8_t *arch)
567 {
568         int len;
569         const void *data;
570
571         /* Get architecture name from property data */
572         data = fdt_getprop(fit, noffset, FIT_ARCH_PROP, &len);
573         if (data == NULL) {
574                 fit_get_debug(fit, noffset, FIT_ARCH_PROP, len);
575                 *arch = -1;
576                 return -1;
577         }
578
579         /* Translate architecture name to id */
580         *arch = genimg_get_arch_id(data);
581         return 0;
582 }
583
584 /**
585  * fit_image_get_type - get type id for a given component image node
586  * @fit: pointer to the FIT format image header
587  * @noffset: component image node offset
588  * @type: pointer to the uint8_t, will hold type numeric id
589  *
590  * fit_image_get_type() finds type property in a given component image node.
591  * If the property is found, its (string) value is translated to the numeric
592  * id which is returned to the caller.
593  *
594  * returns:
595  *     0, on success
596  *     -1, on failure
597  */
598 int fit_image_get_type(const void *fit, int noffset, uint8_t *type)
599 {
600         int len;
601         const void *data;
602
603         /* Get image type name from property data */
604         data = fdt_getprop(fit, noffset, FIT_TYPE_PROP, &len);
605         if (data == NULL) {
606                 fit_get_debug(fit, noffset, FIT_TYPE_PROP, len);
607                 *type = -1;
608                 return -1;
609         }
610
611         /* Translate image type name to id */
612         *type = genimg_get_type_id(data);
613         return 0;
614 }
615
616 /**
617  * fit_image_get_comp - get comp id for a given component image node
618  * @fit: pointer to the FIT format image header
619  * @noffset: component image node offset
620  * @comp: pointer to the uint8_t, will hold comp numeric id
621  *
622  * fit_image_get_comp() finds comp property in a given component image node.
623  * If the property is found, its (string) value is translated to the numeric
624  * id which is returned to the caller.
625  *
626  * returns:
627  *     0, on success
628  *     -1, on failure
629  */
630 int fit_image_get_comp(const void *fit, int noffset, uint8_t *comp)
631 {
632         int len;
633         const void *data;
634
635         /* Get compression name from property data */
636         data = fdt_getprop(fit, noffset, FIT_COMP_PROP, &len);
637         if (data == NULL) {
638                 fit_get_debug(fit, noffset, FIT_COMP_PROP, len);
639                 *comp = -1;
640                 return -1;
641         }
642
643         /* Translate compression name to id */
644         *comp = genimg_get_comp_id(data);
645         return 0;
646 }
647
648 /**
649  * fit_image_get_load() - get load addr property for given component image node
650  * @fit: pointer to the FIT format image header
651  * @noffset: component image node offset
652  * @load: pointer to the uint32_t, will hold load address
653  *
654  * fit_image_get_load() finds load address property in a given component
655  * image node. If the property is found, its value is returned to the caller.
656  *
657  * returns:
658  *     0, on success
659  *     -1, on failure
660  */
661 int fit_image_get_load(const void *fit, int noffset, ulong *load)
662 {
663         int len;
664         const uint32_t *data;
665
666         data = fdt_getprop(fit, noffset, FIT_LOAD_PROP, &len);
667         if (data == NULL) {
668                 fit_get_debug(fit, noffset, FIT_LOAD_PROP, len);
669                 return -1;
670         }
671
672         *load = uimage_to_cpu(*data);
673         return 0;
674 }
675
676 /**
677  * fit_image_get_entry() - get entry point address property
678  * @fit: pointer to the FIT format image header
679  * @noffset: component image node offset
680  * @entry: pointer to the uint32_t, will hold entry point address
681  *
682  * This gets the entry point address property for a given component image
683  * node.
684  *
685  * fit_image_get_entry() finds entry point address property in a given
686  * component image node.  If the property is found, its value is returned
687  * to the caller.
688  *
689  * returns:
690  *     0, on success
691  *     -1, on failure
692  */
693 int fit_image_get_entry(const void *fit, int noffset, ulong *entry)
694 {
695         int len;
696         const uint32_t *data;
697
698         data = fdt_getprop(fit, noffset, FIT_ENTRY_PROP, &len);
699         if (data == NULL) {
700                 fit_get_debug(fit, noffset, FIT_ENTRY_PROP, len);
701                 return -1;
702         }
703
704         *entry = uimage_to_cpu(*data);
705         return 0;
706 }
707
708 /**
709  * fit_image_get_data - get data property and its size for a given component image node
710  * @fit: pointer to the FIT format image header
711  * @noffset: component image node offset
712  * @data: double pointer to void, will hold data property's data address
713  * @size: pointer to size_t, will hold data property's data size
714  *
715  * fit_image_get_data() finds data property in a given component image node.
716  * If the property is found its data start address and size are returned to
717  * the caller.
718  *
719  * returns:
720  *     0, on success
721  *     -1, on failure
722  */
723 int fit_image_get_data(const void *fit, int noffset,
724                 const void **data, size_t *size)
725 {
726         int len;
727
728         *data = fdt_getprop(fit, noffset, FIT_DATA_PROP, &len);
729         if (*data == NULL) {
730                 fit_get_debug(fit, noffset, FIT_DATA_PROP, len);
731                 *size = 0;
732                 return -1;
733         }
734
735         *size = len;
736         return 0;
737 }
738
739 /**
740  * fit_image_hash_get_algo - get hash algorithm name
741  * @fit: pointer to the FIT format image header
742  * @noffset: hash node offset
743  * @algo: double pointer to char, will hold pointer to the algorithm name
744  *
745  * fit_image_hash_get_algo() finds hash algorithm property in a given hash node.
746  * If the property is found its data start address is returned to the caller.
747  *
748  * returns:
749  *     0, on success
750  *     -1, on failure
751  */
752 int fit_image_hash_get_algo(const void *fit, int noffset, char **algo)
753 {
754         int len;
755
756         *algo = (char *)fdt_getprop(fit, noffset, FIT_ALGO_PROP, &len);
757         if (*algo == NULL) {
758                 fit_get_debug(fit, noffset, FIT_ALGO_PROP, len);
759                 return -1;
760         }
761
762         return 0;
763 }
764
765 /**
766  * fit_image_hash_get_value - get hash value and length
767  * @fit: pointer to the FIT format image header
768  * @noffset: hash node offset
769  * @value: double pointer to uint8_t, will hold address of a hash value data
770  * @value_len: pointer to an int, will hold hash data length
771  *
772  * fit_image_hash_get_value() finds hash value property in a given hash node.
773  * If the property is found its data start address and size are returned to
774  * the caller.
775  *
776  * returns:
777  *     0, on success
778  *     -1, on failure
779  */
780 int fit_image_hash_get_value(const void *fit, int noffset, uint8_t **value,
781                                 int *value_len)
782 {
783         int len;
784
785         *value = (uint8_t *)fdt_getprop(fit, noffset, FIT_VALUE_PROP, &len);
786         if (*value == NULL) {
787                 fit_get_debug(fit, noffset, FIT_VALUE_PROP, len);
788                 *value_len = 0;
789                 return -1;
790         }
791
792         *value_len = len;
793         return 0;
794 }
795
796 /**
797  * fit_image_hash_get_ignore - get hash ignore flag
798  * @fit: pointer to the FIT format image header
799  * @noffset: hash node offset
800  * @ignore: pointer to an int, will hold hash ignore flag
801  *
802  * fit_image_hash_get_ignore() finds hash ignore property in a given hash node.
803  * If the property is found and non-zero, the hash algorithm is not verified by
804  * u-boot automatically.
805  *
806  * returns:
807  *     0, on ignore not found
808  *     value, on ignore found
809  */
810 static int fit_image_hash_get_ignore(const void *fit, int noffset, int *ignore)
811 {
812         int len;
813         int *value;
814
815         value = (int *)fdt_getprop(fit, noffset, FIT_IGNORE_PROP, &len);
816         if (value == NULL || len != sizeof(int))
817                 *ignore = 0;
818         else
819                 *ignore = *value;
820
821         return 0;
822 }
823
824 /**
825  * fit_set_timestamp - set node timestamp property
826  * @fit: pointer to the FIT format image header
827  * @noffset: node offset
828  * @timestamp: timestamp value to be set
829  *
830  * fit_set_timestamp() attempts to set timestamp property in the requested
831  * node and returns operation status to the caller.
832  *
833  * returns:
834  *     0, on success
835  *     -1, on property read failure
836  */
837 int fit_set_timestamp(void *fit, int noffset, time_t timestamp)
838 {
839         uint32_t t;
840         int ret;
841
842         t = cpu_to_uimage(timestamp);
843         ret = fdt_setprop(fit, noffset, FIT_TIMESTAMP_PROP, &t,
844                                 sizeof(uint32_t));
845         if (ret) {
846                 printf("Can't set '%s' property for '%s' node (%s)\n",
847                        FIT_TIMESTAMP_PROP, fit_get_name(fit, noffset, NULL),
848                        fdt_strerror(ret));
849                 return -1;
850         }
851
852         return 0;
853 }
854
855 /**
856  * calculate_hash - calculate and return hash for provided input data
857  * @data: pointer to the input data
858  * @data_len: data length
859  * @algo: requested hash algorithm
860  * @value: pointer to the char, will hold hash value data (caller must
861  * allocate enough free space)
862  * value_len: length of the calculated hash
863  *
864  * calculate_hash() computes input data hash according to the requested
865  * algorithm.
866  * Resulting hash value is placed in caller provided 'value' buffer, length
867  * of the calculated hash is returned via value_len pointer argument.
868  *
869  * returns:
870  *     0, on success
871  *    -1, when algo is unsupported
872  */
873 int calculate_hash(const void *data, int data_len, const char *algo,
874                         uint8_t *value, int *value_len)
875 {
876         if (IMAGE_ENABLE_CRC32 && strcmp(algo, "crc32") == 0) {
877                 *((uint32_t *)value) = crc32_wd(0, data, data_len,
878                                                         CHUNKSZ_CRC32);
879                 *((uint32_t *)value) = cpu_to_uimage(*((uint32_t *)value));
880                 *value_len = 4;
881         } else if (IMAGE_ENABLE_SHA1 && strcmp(algo, "sha1") == 0) {
882                 sha1_csum_wd((unsigned char *)data, data_len,
883                              (unsigned char *)value, CHUNKSZ_SHA1);
884                 *value_len = 20;
885         } else if (IMAGE_ENABLE_MD5 && strcmp(algo, "md5") == 0) {
886                 md5_wd((unsigned char *)data, data_len, value, CHUNKSZ_MD5);
887                 *value_len = 16;
888         } else {
889                 debug("Unsupported hash alogrithm\n");
890                 return -1;
891         }
892         return 0;
893 }
894
895 static int fit_image_check_hash(const void *fit, int noffset, const void *data,
896                                 size_t size, char **err_msgp)
897 {
898         uint8_t value[FIT_MAX_HASH_LEN];
899         int value_len;
900         char *algo;
901         uint8_t *fit_value;
902         int fit_value_len;
903         int ignore;
904
905         *err_msgp = NULL;
906
907         if (fit_image_hash_get_algo(fit, noffset, &algo)) {
908                 *err_msgp = "Can't get hash algo property";
909                 return -1;
910         }
911         printf("%s", algo);
912
913         if (IMAGE_ENABLE_IGNORE) {
914                 fit_image_hash_get_ignore(fit, noffset, &ignore);
915                 if (ignore) {
916                         printf("-skipped ");
917                         return 0;
918                 }
919         }
920
921         if (fit_image_hash_get_value(fit, noffset, &fit_value,
922                                      &fit_value_len)) {
923                 *err_msgp = "Can't get hash value property";
924                 return -1;
925         }
926
927         if (calculate_hash(data, size, algo, value, &value_len)) {
928                 *err_msgp = "Unsupported hash algorithm";
929                 return -1;
930         }
931
932         if (value_len != fit_value_len) {
933                 *err_msgp = "Bad hash value len";
934                 return -1;
935         } else if (memcmp(value, fit_value, value_len) != 0) {
936                 *err_msgp = "Bad hash value";
937                 return -1;
938         }
939
940         return 0;
941 }
942
943 /**
944  * fit_image_verify - verify data intergity
945  * @fit: pointer to the FIT format image header
946  * @image_noffset: component image node offset
947  *
948  * fit_image_verify() goes over component image hash nodes,
949  * re-calculates each data hash and compares with the value stored in hash
950  * node.
951  *
952  * returns:
953  *     1, if all hashes are valid
954  *     0, otherwise (or on error)
955  */
956 int fit_image_verify(const void *fit, int image_noffset)
957 {
958         const void      *data;
959         size_t          size;
960         int             noffset = 0;
961         char            *err_msg = "";
962         int verify_all = 1;
963         int ret;
964
965         /* Get image data and data length */
966         if (fit_image_get_data(fit, image_noffset, &data, &size)) {
967                 err_msg = "Can't get image data/size";
968                 goto error;
969         }
970
971         /* Verify all required signatures */
972         if (IMAGE_ENABLE_VERIFY &&
973             fit_image_verify_required_sigs(fit, image_noffset, data, size,
974                                            gd_fdt_blob(), &verify_all)) {
975                 err_msg = "Unable to verify required signature";
976                 goto error;
977         }
978
979         /* Process all hash subnodes of the component image node */
980         for (noffset = fdt_first_subnode(fit, image_noffset);
981              noffset >= 0;
982              noffset = fdt_next_subnode(fit, noffset)) {
983                 const char *name = fit_get_name(fit, noffset, NULL);
984
985                 /*
986                  * Check subnode name, must be equal to "hash".
987                  * Multiple hash nodes require unique unit node
988                  * names, e.g. hash@1, hash@2, etc.
989                  */
990                 if (!strncmp(name, FIT_HASH_NODENAME,
991                              strlen(FIT_HASH_NODENAME))) {
992                         if (fit_image_check_hash(fit, noffset, data, size,
993                                                  &err_msg))
994                                 goto error;
995                         puts("+ ");
996                 } else if (IMAGE_ENABLE_VERIFY && verify_all &&
997                                 !strncmp(name, FIT_SIG_NODENAME,
998                                         strlen(FIT_SIG_NODENAME))) {
999                         ret = fit_image_check_sig(fit, noffset, data,
1000                                                         size, -1, &err_msg);
1001                         if (ret)
1002                                 puts("- ");
1003                         else
1004                                 puts("+ ");
1005                 }
1006         }
1007
1008         if (noffset == -FDT_ERR_TRUNCATED || noffset == -FDT_ERR_BADSTRUCTURE) {
1009                 err_msg = "Corrupted or truncated tree";
1010                 goto error;
1011         }
1012
1013         return 1;
1014
1015 error:
1016         printf(" error!\n%s for '%s' hash node in '%s' image node\n",
1017                err_msg, fit_get_name(fit, noffset, NULL),
1018                fit_get_name(fit, image_noffset, NULL));
1019         return 0;
1020 }
1021
1022 /**
1023  * fit_all_image_verify - verify data intergity for all images
1024  * @fit: pointer to the FIT format image header
1025  *
1026  * fit_all_image_verify() goes over all images in the FIT and
1027  * for every images checks if all it's hashes are valid.
1028  *
1029  * returns:
1030  *     1, if all hashes of all images are valid
1031  *     0, otherwise (or on error)
1032  */
1033 int fit_all_image_verify(const void *fit)
1034 {
1035         int images_noffset;
1036         int noffset;
1037         int ndepth;
1038         int count;
1039
1040         /* Find images parent node offset */
1041         images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
1042         if (images_noffset < 0) {
1043                 printf("Can't find images parent node '%s' (%s)\n",
1044                        FIT_IMAGES_PATH, fdt_strerror(images_noffset));
1045                 return 0;
1046         }
1047
1048         /* Process all image subnodes, check hashes for each */
1049         printf("## Checking hash(es) for FIT Image at %08lx ...\n",
1050                (ulong)fit);
1051         for (ndepth = 0, count = 0,
1052              noffset = fdt_next_node(fit, images_noffset, &ndepth);
1053                         (noffset >= 0) && (ndepth > 0);
1054                         noffset = fdt_next_node(fit, noffset, &ndepth)) {
1055                 if (ndepth == 1) {
1056                         /*
1057                          * Direct child node of the images parent node,
1058                          * i.e. component image node.
1059                          */
1060                         printf("   Hash(es) for Image %u (%s): ", count++,
1061                                fit_get_name(fit, noffset, NULL));
1062
1063                         if (!fit_image_verify(fit, noffset))
1064                                 return 0;
1065                         printf("\n");
1066                 }
1067         }
1068         return 1;
1069 }
1070
1071 /**
1072  * fit_image_check_os - check whether image node is of a given os type
1073  * @fit: pointer to the FIT format image header
1074  * @noffset: component image node offset
1075  * @os: requested image os
1076  *
1077  * fit_image_check_os() reads image os property and compares its numeric
1078  * id with the requested os. Comparison result is returned to the caller.
1079  *
1080  * returns:
1081  *     1 if image is of given os type
1082  *     0 otherwise (or on error)
1083  */
1084 int fit_image_check_os(const void *fit, int noffset, uint8_t os)
1085 {
1086         uint8_t image_os;
1087
1088         if (fit_image_get_os(fit, noffset, &image_os))
1089                 return 0;
1090         return (os == image_os);
1091 }
1092
1093 /**
1094  * fit_image_check_arch - check whether image node is of a given arch
1095  * @fit: pointer to the FIT format image header
1096  * @noffset: component image node offset
1097  * @arch: requested imagearch
1098  *
1099  * fit_image_check_arch() reads image arch property and compares its numeric
1100  * id with the requested arch. Comparison result is returned to the caller.
1101  *
1102  * returns:
1103  *     1 if image is of given arch
1104  *     0 otherwise (or on error)
1105  */
1106 int fit_image_check_arch(const void *fit, int noffset, uint8_t arch)
1107 {
1108         uint8_t image_arch;
1109
1110         if (fit_image_get_arch(fit, noffset, &image_arch))
1111                 return 0;
1112         return (arch == image_arch);
1113 }
1114
1115 /**
1116  * fit_image_check_type - check whether image node is of a given type
1117  * @fit: pointer to the FIT format image header
1118  * @noffset: component image node offset
1119  * @type: requested image type
1120  *
1121  * fit_image_check_type() reads image type property and compares its numeric
1122  * id with the requested type. Comparison result is returned to the caller.
1123  *
1124  * returns:
1125  *     1 if image is of given type
1126  *     0 otherwise (or on error)
1127  */
1128 int fit_image_check_type(const void *fit, int noffset, uint8_t type)
1129 {
1130         uint8_t image_type;
1131
1132         if (fit_image_get_type(fit, noffset, &image_type))
1133                 return 0;
1134         return (type == image_type);
1135 }
1136
1137 /**
1138  * fit_image_check_comp - check whether image node uses given compression
1139  * @fit: pointer to the FIT format image header
1140  * @noffset: component image node offset
1141  * @comp: requested image compression type
1142  *
1143  * fit_image_check_comp() reads image compression property and compares its
1144  * numeric id with the requested compression type. Comparison result is
1145  * returned to the caller.
1146  *
1147  * returns:
1148  *     1 if image uses requested compression
1149  *     0 otherwise (or on error)
1150  */
1151 int fit_image_check_comp(const void *fit, int noffset, uint8_t comp)
1152 {
1153         uint8_t image_comp;
1154
1155         if (fit_image_get_comp(fit, noffset, &image_comp))
1156                 return 0;
1157         return (comp == image_comp);
1158 }
1159
1160 /**
1161  * fit_check_format - sanity check FIT image format
1162  * @fit: pointer to the FIT format image header
1163  *
1164  * fit_check_format() runs a basic sanity FIT image verification.
1165  * Routine checks for mandatory properties, nodes, etc.
1166  *
1167  * returns:
1168  *     1, on success
1169  *     0, on failure
1170  */
1171 int fit_check_format(const void *fit)
1172 {
1173         /* mandatory / node 'description' property */
1174         if (fdt_getprop(fit, 0, FIT_DESC_PROP, NULL) == NULL) {
1175                 debug("Wrong FIT format: no description\n");
1176                 return 0;
1177         }
1178
1179         if (IMAGE_ENABLE_TIMESTAMP) {
1180                 /* mandatory / node 'timestamp' property */
1181                 if (fdt_getprop(fit, 0, FIT_TIMESTAMP_PROP, NULL) == NULL) {
1182                         debug("Wrong FIT format: no timestamp\n");
1183                         return 0;
1184                 }
1185         }
1186
1187         /* mandatory subimages parent '/images' node */
1188         if (fdt_path_offset(fit, FIT_IMAGES_PATH) < 0) {
1189                 debug("Wrong FIT format: no images parent node\n");
1190                 return 0;
1191         }
1192
1193         return 1;
1194 }
1195
1196
1197 /**
1198  * fit_conf_find_compat
1199  * @fit: pointer to the FIT format image header
1200  * @fdt: pointer to the device tree to compare against
1201  *
1202  * fit_conf_find_compat() attempts to find the configuration whose fdt is the
1203  * most compatible with the passed in device tree.
1204  *
1205  * Example:
1206  *
1207  * / o image-tree
1208  *   |-o images
1209  *   | |-o fdt@1
1210  *   | |-o fdt@2
1211  *   |
1212  *   |-o configurations
1213  *     |-o config@1
1214  *     | |-fdt = fdt@1
1215  *     |
1216  *     |-o config@2
1217  *       |-fdt = fdt@2
1218  *
1219  * / o U-Boot fdt
1220  *   |-compatible = "foo,bar", "bim,bam"
1221  *
1222  * / o kernel fdt1
1223  *   |-compatible = "foo,bar",
1224  *
1225  * / o kernel fdt2
1226  *   |-compatible = "bim,bam", "baz,biz"
1227  *
1228  * Configuration 1 would be picked because the first string in U-Boot's
1229  * compatible list, "foo,bar", matches a compatible string in the root of fdt1.
1230  * "bim,bam" in fdt2 matches the second string which isn't as good as fdt1.
1231  *
1232  * returns:
1233  *     offset to the configuration to use if one was found
1234  *     -1 otherwise
1235  */
1236 int fit_conf_find_compat(const void *fit, const void *fdt)
1237 {
1238         int ndepth = 0;
1239         int noffset, confs_noffset, images_noffset;
1240         const void *fdt_compat;
1241         int fdt_compat_len;
1242         int best_match_offset = 0;
1243         int best_match_pos = 0;
1244
1245         confs_noffset = fdt_path_offset(fit, FIT_CONFS_PATH);
1246         images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
1247         if (confs_noffset < 0 || images_noffset < 0) {
1248                 debug("Can't find configurations or images nodes.\n");
1249                 return -1;
1250         }
1251
1252         fdt_compat = fdt_getprop(fdt, 0, "compatible", &fdt_compat_len);
1253         if (!fdt_compat) {
1254                 debug("Fdt for comparison has no \"compatible\" property.\n");
1255                 return -1;
1256         }
1257
1258         /*
1259          * Loop over the configurations in the FIT image.
1260          */
1261         for (noffset = fdt_next_node(fit, confs_noffset, &ndepth);
1262                         (noffset >= 0) && (ndepth > 0);
1263                         noffset = fdt_next_node(fit, noffset, &ndepth)) {
1264                 const void *kfdt;
1265                 const char *kfdt_name;
1266                 int kfdt_noffset;
1267                 const char *cur_fdt_compat;
1268                 int len;
1269                 size_t size;
1270                 int i;
1271
1272                 if (ndepth > 1)
1273                         continue;
1274
1275                 kfdt_name = fdt_getprop(fit, noffset, "fdt", &len);
1276                 if (!kfdt_name) {
1277                         debug("No fdt property found.\n");
1278                         continue;
1279                 }
1280                 kfdt_noffset = fdt_subnode_offset(fit, images_noffset,
1281                                                   kfdt_name);
1282                 if (kfdt_noffset < 0) {
1283                         debug("No image node named \"%s\" found.\n",
1284                               kfdt_name);
1285                         continue;
1286                 }
1287                 /*
1288                  * Get a pointer to this configuration's fdt.
1289                  */
1290                 if (fit_image_get_data(fit, kfdt_noffset, &kfdt, &size)) {
1291                         debug("Failed to get fdt \"%s\".\n", kfdt_name);
1292                         continue;
1293                 }
1294
1295                 len = fdt_compat_len;
1296                 cur_fdt_compat = fdt_compat;
1297                 /*
1298                  * Look for a match for each U-Boot compatibility string in
1299                  * turn in this configuration's fdt.
1300                  */
1301                 for (i = 0; len > 0 &&
1302                      (!best_match_offset || best_match_pos > i); i++) {
1303                         int cur_len = strlen(cur_fdt_compat) + 1;
1304
1305                         if (!fdt_node_check_compatible(kfdt, 0,
1306                                                        cur_fdt_compat)) {
1307                                 best_match_offset = noffset;
1308                                 best_match_pos = i;
1309                                 break;
1310                         }
1311                         len -= cur_len;
1312                         cur_fdt_compat += cur_len;
1313                 }
1314         }
1315         if (!best_match_offset) {
1316                 debug("No match found.\n");
1317                 return -1;
1318         }
1319
1320         return best_match_offset;
1321 }
1322
1323 /**
1324  * fit_conf_get_node - get node offset for configuration of a given unit name
1325  * @fit: pointer to the FIT format image header
1326  * @conf_uname: configuration node unit name
1327  *
1328  * fit_conf_get_node() finds a configuration (withing the '/configurations'
1329  * parant node) of a provided unit name. If configuration is found its node
1330  * offset is returned to the caller.
1331  *
1332  * When NULL is provided in second argument fit_conf_get_node() will search
1333  * for a default configuration node instead. Default configuration node unit
1334  * name is retrieved from FIT_DEFAULT_PROP property of the '/configurations'
1335  * node.
1336  *
1337  * returns:
1338  *     configuration node offset when found (>=0)
1339  *     negative number on failure (FDT_ERR_* code)
1340  */
1341 int fit_conf_get_node(const void *fit, const char *conf_uname)
1342 {
1343         int noffset, confs_noffset;
1344         int len;
1345
1346         confs_noffset = fdt_path_offset(fit, FIT_CONFS_PATH);
1347         if (confs_noffset < 0) {
1348                 debug("Can't find configurations parent node '%s' (%s)\n",
1349                       FIT_CONFS_PATH, fdt_strerror(confs_noffset));
1350                 return confs_noffset;
1351         }
1352
1353         if (conf_uname == NULL) {
1354                 /* get configuration unit name from the default property */
1355                 debug("No configuration specified, trying default...\n");
1356                 conf_uname = (char *)fdt_getprop(fit, confs_noffset,
1357                                                  FIT_DEFAULT_PROP, &len);
1358                 if (conf_uname == NULL) {
1359                         fit_get_debug(fit, confs_noffset, FIT_DEFAULT_PROP,
1360                                       len);
1361                         return len;
1362                 }
1363                 debug("Found default configuration: '%s'\n", conf_uname);
1364         }
1365
1366         noffset = fdt_subnode_offset(fit, confs_noffset, conf_uname);
1367         if (noffset < 0) {
1368                 debug("Can't get node offset for configuration unit name: '%s' (%s)\n",
1369                       conf_uname, fdt_strerror(noffset));
1370         }
1371
1372         return noffset;
1373 }
1374
1375 int fit_conf_get_prop_node(const void *fit, int noffset,
1376                 const char *prop_name)
1377 {
1378         char *uname;
1379         int len;
1380
1381         /* get kernel image unit name from configuration kernel property */
1382         uname = (char *)fdt_getprop(fit, noffset, prop_name, &len);
1383         if (uname == NULL)
1384                 return len;
1385
1386         return fit_image_get_node(fit, uname);
1387 }
1388
1389 /**
1390  * fit_conf_print - prints out the FIT configuration details
1391  * @fit: pointer to the FIT format image header
1392  * @noffset: offset of the configuration node
1393  * @p: pointer to prefix string
1394  *
1395  * fit_conf_print() lists all mandatory properies for the processed
1396  * configuration node.
1397  *
1398  * returns:
1399  *     no returned results
1400  */
1401 void fit_conf_print(const void *fit, int noffset, const char *p)
1402 {
1403         char *desc;
1404         char *uname;
1405         int ret;
1406
1407         /* Mandatory properties */
1408         ret = fit_get_desc(fit, noffset, &desc);
1409         printf("%s  Description:  ", p);
1410         if (ret)
1411                 printf("unavailable\n");
1412         else
1413                 printf("%s\n", desc);
1414
1415         uname = (char *)fdt_getprop(fit, noffset, FIT_KERNEL_PROP, NULL);
1416         printf("%s  Kernel:       ", p);
1417         if (uname == NULL)
1418                 printf("unavailable\n");
1419         else
1420                 printf("%s\n", uname);
1421
1422         /* Optional properties */
1423         uname = (char *)fdt_getprop(fit, noffset, FIT_RAMDISK_PROP, NULL);
1424         if (uname)
1425                 printf("%s  Init Ramdisk: %s\n", p, uname);
1426
1427         uname = (char *)fdt_getprop(fit, noffset, FIT_FDT_PROP, NULL);
1428         if (uname)
1429                 printf("%s  FDT:          %s\n", p, uname);
1430 }
1431
1432 int fit_image_select(const void *fit, int rd_noffset, int verify)
1433 {
1434         fit_image_print(fit, rd_noffset, "   ");
1435
1436         if (verify) {
1437                 puts("   Verifying Hash Integrity ... ");
1438                 if (!fit_image_verify(fit, rd_noffset)) {
1439                         puts("Bad Data Hash\n");
1440                         return -EACCES;
1441                 }
1442                 puts("OK\n");
1443         }
1444
1445         return 0;
1446 }
1447
1448 int fit_get_node_from_config(bootm_headers_t *images, const char *prop_name,
1449                         ulong addr)
1450 {
1451         int cfg_noffset;
1452         void *fit_hdr;
1453         int noffset;
1454
1455         debug("*  %s: using config '%s' from image at 0x%08lx\n",
1456               prop_name, images->fit_uname_cfg, addr);
1457
1458         /* Check whether configuration has this property defined */
1459         fit_hdr = map_sysmem(addr, 0);
1460         cfg_noffset = fit_conf_get_node(fit_hdr, images->fit_uname_cfg);
1461         if (cfg_noffset < 0) {
1462                 debug("*  %s: no such config\n", prop_name);
1463                 return -ENOENT;
1464         }
1465
1466         noffset = fit_conf_get_prop_node(fit_hdr, cfg_noffset, prop_name);
1467         if (noffset < 0) {
1468                 debug("*  %s: no '%s' in config\n", prop_name, prop_name);
1469                 return -ENOLINK;
1470         }
1471
1472         return noffset;
1473 }
1474
1475 int fit_image_load(bootm_headers_t *images, const char *prop_name, ulong addr,
1476                    const char **fit_unamep, const char **fit_uname_configp,
1477                    int arch, int image_type, int bootstage_id,
1478                    enum fit_load_op load_op, ulong *datap, ulong *lenp)
1479 {
1480         int cfg_noffset, noffset;
1481         const char *fit_uname;
1482         const char *fit_uname_config;
1483         const void *fit;
1484         const void *buf;
1485         size_t size;
1486         int type_ok, os_ok;
1487         ulong load, data, len;
1488         int ret;
1489
1490         fit = map_sysmem(addr, 0);
1491         fit_uname = fit_unamep ? *fit_unamep : NULL;
1492         fit_uname_config = fit_uname_configp ? *fit_uname_configp : NULL;
1493         printf("## Loading %s from FIT Image at %08lx ...\n", prop_name, addr);
1494
1495         bootstage_mark(bootstage_id + BOOTSTAGE_SUB_FORMAT);
1496         if (!fit_check_format(fit)) {
1497                 printf("Bad FIT %s image format!\n", prop_name);
1498                 bootstage_error(bootstage_id + BOOTSTAGE_SUB_FORMAT);
1499                 return -ENOEXEC;
1500         }
1501         bootstage_mark(bootstage_id + BOOTSTAGE_SUB_FORMAT_OK);
1502         if (fit_uname) {
1503                 /* get FIT component image node offset */
1504                 bootstage_mark(bootstage_id + BOOTSTAGE_SUB_UNIT_NAME);
1505                 noffset = fit_image_get_node(fit, fit_uname);
1506         } else {
1507                 /*
1508                  * no image node unit name, try to get config
1509                  * node first. If config unit node name is NULL
1510                  * fit_conf_get_node() will try to find default config node
1511                  */
1512                 bootstage_mark(bootstage_id + BOOTSTAGE_SUB_NO_UNIT_NAME);
1513                 if (IMAGE_ENABLE_BEST_MATCH && !fit_uname_config) {
1514                         cfg_noffset = fit_conf_find_compat(fit, gd_fdt_blob());
1515                 } else {
1516                         cfg_noffset = fit_conf_get_node(fit,
1517                                                         fit_uname_config);
1518                 }
1519                 if (cfg_noffset < 0) {
1520                         puts("Could not find configuration node\n");
1521                         bootstage_error(bootstage_id +
1522                                         BOOTSTAGE_SUB_NO_UNIT_NAME);
1523                         return -ENOENT;
1524                 }
1525                 fit_uname_config = fdt_get_name(fit, cfg_noffset, NULL);
1526                 printf("   Using '%s' configuration\n", fit_uname_config);
1527                 if (image_type == IH_TYPE_KERNEL) {
1528                         /* Remember (and possibly verify) this config */
1529                         images->fit_uname_cfg = fit_uname_config;
1530                         if (IMAGE_ENABLE_VERIFY && images->verify) {
1531                                 puts("   Verifying Hash Integrity ... ");
1532                                 if (!fit_config_verify(fit, cfg_noffset)) {
1533                                         puts("Bad Data Hash\n");
1534                                         bootstage_error(bootstage_id +
1535                                                 BOOTSTAGE_SUB_HASH);
1536                                         return -EACCES;
1537                                 }
1538                                 puts("OK\n");
1539                         }
1540                         bootstage_mark(BOOTSTAGE_ID_FIT_CONFIG);
1541                 }
1542
1543                 noffset = fit_conf_get_prop_node(fit, cfg_noffset,
1544                                                  prop_name);
1545                 fit_uname = fit_get_name(fit, noffset, NULL);
1546         }
1547         if (noffset < 0) {
1548                 puts("Could not find subimage node\n");
1549                 bootstage_error(bootstage_id + BOOTSTAGE_SUB_SUBNODE);
1550                 return -ENOENT;
1551         }
1552
1553         printf("   Trying '%s' %s subimage\n", fit_uname, prop_name);
1554
1555         ret = fit_image_select(fit, noffset, images->verify);
1556         if (ret) {
1557                 bootstage_error(bootstage_id + BOOTSTAGE_SUB_HASH);
1558                 return ret;
1559         }
1560
1561         bootstage_mark(bootstage_id + BOOTSTAGE_SUB_CHECK_ARCH);
1562         if (!fit_image_check_target_arch(fit, noffset)) {
1563                 puts("Unsupported Architecture\n");
1564                 bootstage_error(bootstage_id + BOOTSTAGE_SUB_CHECK_ARCH);
1565                 return -ENOEXEC;
1566         }
1567
1568         if (image_type == IH_TYPE_FLATDT &&
1569             !fit_image_check_comp(fit, noffset, IH_COMP_NONE)) {
1570                 puts("FDT image is compressed");
1571                 return -EPROTONOSUPPORT;
1572         }
1573
1574         bootstage_mark(bootstage_id + BOOTSTAGE_SUB_CHECK_ALL);
1575         type_ok = fit_image_check_type(fit, noffset, image_type) ||
1576                 (image_type == IH_TYPE_KERNEL &&
1577                         fit_image_check_type(fit, noffset,
1578                                              IH_TYPE_KERNEL_NOLOAD));
1579         os_ok = image_type == IH_TYPE_FLATDT ||
1580                 fit_image_check_os(fit, noffset, IH_OS_LINUX);
1581         if (!type_ok || !os_ok) {
1582                 printf("No Linux %s %s Image\n", genimg_get_arch_name(arch),
1583                        genimg_get_type_name(image_type));
1584                 bootstage_error(bootstage_id + BOOTSTAGE_SUB_CHECK_ALL);
1585                 return -EIO;
1586         }
1587
1588         bootstage_mark(bootstage_id + BOOTSTAGE_SUB_CHECK_ALL_OK);
1589
1590         /* get image data address and length */
1591         if (fit_image_get_data(fit, noffset, &buf, &size)) {
1592                 printf("Could not find %s subimage data!\n", prop_name);
1593                 bootstage_error(bootstage_id + BOOTSTAGE_SUB_GET_DATA);
1594                 return -ENOENT;
1595         }
1596         len = (ulong)size;
1597
1598         /* verify that image data is a proper FDT blob */
1599         if (image_type == IH_TYPE_FLATDT && fdt_check_header(buf)) {
1600                 puts("Subimage data is not a FDT");
1601                 return -ENOEXEC;
1602         }
1603
1604         bootstage_mark(bootstage_id + BOOTSTAGE_SUB_GET_DATA_OK);
1605
1606         /*
1607          * Work-around for eldk-4.2 which gives this warning if we try to
1608          * case in the unmap_sysmem() call:
1609          * warning: initialization discards qualifiers from pointer target type
1610          */
1611         {
1612                 void *vbuf = (void *)buf;
1613
1614                 data = map_to_sysmem(vbuf);
1615         }
1616
1617         if (load_op == FIT_LOAD_IGNORED) {
1618                 /* Don't load */
1619         } else if (fit_image_get_load(fit, noffset, &load)) {
1620                 if (load_op == FIT_LOAD_REQUIRED) {
1621                         printf("Can't get %s subimage load address!\n",
1622                                prop_name);
1623                         bootstage_error(bootstage_id + BOOTSTAGE_SUB_LOAD);
1624                         return -EBADF;
1625                 }
1626         } else {
1627                 ulong image_start, image_end;
1628                 ulong load_end;
1629                 void *dst;
1630
1631                 /*
1632                  * move image data to the load address,
1633                  * make sure we don't overwrite initial image
1634                  */
1635                 image_start = addr;
1636                 image_end = addr + fit_get_size(fit);
1637
1638                 load_end = load + len;
1639                 if (image_type != IH_TYPE_KERNEL &&
1640                     load < image_end && load_end > image_start) {
1641                         printf("Error: %s overwritten\n", prop_name);
1642                         return -EXDEV;
1643                 }
1644
1645                 printf("   Loading %s from 0x%08lx to 0x%08lx\n",
1646                        prop_name, data, load);
1647
1648                 dst = map_sysmem(load, len);
1649                 memmove(dst, buf, len);
1650                 data = load;
1651         }
1652         bootstage_mark(bootstage_id + BOOTSTAGE_SUB_LOAD);
1653
1654         *datap = data;
1655         *lenp = len;
1656         if (fit_unamep)
1657                 *fit_unamep = (char *)fit_uname;
1658         if (fit_uname_configp)
1659                 *fit_uname_configp = (char *)fit_uname_config;
1660
1661         return noffset;
1662 }