1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Copyright (c) 2013, Google Inc.
4 *
5 * (C) Copyright 2008 Semihalf
6 *
7 * (C) Copyright 2000-2006
8 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
9 */
10
11 #ifdef USE_HOSTCC
12 #include "mkimage.h"
13 #include <time.h>
14 #include <u-boot/crc.h>
15 #else
16 #include <linux/compiler.h>
17 #include <linux/kconfig.h>
18 #include <common.h>
19 #include <errno.h>
20 #include <mapmem.h>
21 #include <asm/io.h>
22 #include <malloc.h>
23 DECLARE_GLOBAL_DATA_PTR;
24 #endif /* !USE_HOSTCC*/
25
26 #include <bootm.h>
27 #include <image.h>
28 #include <bootstage.h>
29 #include <u-boot/crc.h>
30 #include <u-boot/md5.h>
31 #include <u-boot/sha1.h>
32 #include <u-boot/sha256.h>
33
34 /*****************************************************************************/
35 /* New uImage format routines */
36 /*****************************************************************************/
37 #ifndef USE_HOSTCC
fit_parse_spec(const char * spec,char sepc,ulong addr_curr,ulong * addr,const char ** name)38 static int fit_parse_spec(const char *spec, char sepc, ulong addr_curr,
39 ulong *addr, const char **name)
40 {
41 const char *sep;
42
43 *addr = addr_curr;
44 *name = NULL;
45
46 sep = strchr(spec, sepc);
47 if (sep) {
48 if (sep - spec > 0)
49 *addr = simple_strtoul(spec, NULL, 16);
50
51 *name = sep + 1;
52 return 1;
53 }
54
55 return 0;
56 }
57
58 /**
59 * fit_parse_conf - parse FIT configuration spec
60 * @spec: input string, containing configuration spec
61 * @add_curr: current image address (to be used as a possible default)
62 * @addr: pointer to a ulong variable, will hold FIT image address of a given
63 * configuration
64 * @conf_name double pointer to a char, will hold pointer to a configuration
65 * unit name
66 *
67 * fit_parse_conf() expects configuration spec in the form of [<addr>]#<conf>,
68 * where <addr> is a FIT image address that contains configuration
69 * with a <conf> unit name.
70 *
71 * Address part is optional, and if omitted default add_curr will
72 * be used instead.
73 *
74 * returns:
75 * 1 if spec is a valid configuration string,
76 * addr and conf_name are set accordingly
77 * 0 otherwise
78 */
fit_parse_conf(const char * spec,ulong addr_curr,ulong * addr,const char ** conf_name)79 int fit_parse_conf(const char *spec, ulong addr_curr,
80 ulong *addr, const char **conf_name)
81 {
82 return fit_parse_spec(spec, '#', addr_curr, addr, conf_name);
83 }
84
85 /**
86 * fit_parse_subimage - parse FIT subimage spec
87 * @spec: input string, containing subimage spec
88 * @add_curr: current image address (to be used as a possible default)
89 * @addr: pointer to a ulong variable, will hold FIT image address of a given
90 * subimage
91 * @image_name: double pointer to a char, will hold pointer to a subimage name
92 *
93 * fit_parse_subimage() expects subimage spec in the form of
94 * [<addr>]:<subimage>, where <addr> is a FIT image address that contains
95 * subimage with a <subimg> unit name.
96 *
97 * Address part is optional, and if omitted default add_curr will
98 * be used instead.
99 *
100 * returns:
101 * 1 if spec is a valid subimage string,
102 * addr and image_name are set accordingly
103 * 0 otherwise
104 */
fit_parse_subimage(const char * spec,ulong addr_curr,ulong * addr,const char ** image_name)105 int fit_parse_subimage(const char *spec, ulong addr_curr,
106 ulong *addr, const char **image_name)
107 {
108 return fit_parse_spec(spec, ':', addr_curr, addr, image_name);
109 }
110 #endif /* !USE_HOSTCC */
111
fit_get_debug(const void * fit,int noffset,char * prop_name,int err)112 static void fit_get_debug(const void *fit, int noffset,
113 char *prop_name, int err)
114 {
115 debug("Can't get '%s' property from FIT 0x%08lx, node: offset %d, name %s (%s)\n",
116 prop_name, (ulong)fit, noffset, fit_get_name(fit, noffset, NULL),
117 fdt_strerror(err));
118 }
119
120 /**
121 * fit_get_subimage_count - get component (sub-image) count
122 * @fit: pointer to the FIT format image header
123 * @images_noffset: offset of images node
124 *
125 * returns:
126 * number of image components
127 */
fit_get_subimage_count(const void * fit,int images_noffset)128 int fit_get_subimage_count(const void *fit, int images_noffset)
129 {
130 int noffset;
131 int ndepth;
132 int count = 0;
133
134 /* Process its subnodes, print out component images details */
135 for (ndepth = 0, count = 0,
136 noffset = fdt_next_node(fit, images_noffset, &ndepth);
137 (noffset >= 0) && (ndepth > 0);
138 noffset = fdt_next_node(fit, noffset, &ndepth)) {
139 if (ndepth == 1) {
140 count++;
141 }
142 }
143
144 return count;
145 }
146
147 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_FIT_PRINT)
148 /**
149 * fit_image_print_data() - prints out the hash node details
150 * @fit: pointer to the FIT format image header
151 * @noffset: offset of the hash node
152 * @p: pointer to prefix string
153 * @type: Type of information to print ("hash" or "sign")
154 *
155 * fit_image_print_data() lists properties for the processed hash node
156 *
157 * This function avoid using puts() since it prints a newline on the host
158 * but does not in U-Boot.
159 *
160 * returns:
161 * no returned results
162 */
fit_image_print_data(const void * fit,int noffset,const char * p,const char * type)163 static void fit_image_print_data(const void *fit, int noffset, const char *p,
164 const char *type)
165 {
166 const char *keyname;
167 uint8_t *value;
168 int value_len;
169 char *algo;
170 const char *padding;
171 int required;
172 int ret, i;
173
174 debug("%s %s node: '%s'\n", p, type,
175 fit_get_name(fit, noffset, NULL));
176 printf("%s %s algo: ", p, type);
177 if (fit_image_hash_get_algo(fit, noffset, &algo)) {
178 printf("invalid/unsupported\n");
179 return;
180 }
181 printf("%s", algo);
182 keyname = fdt_getprop(fit, noffset, "key-name-hint", NULL);
183 required = fdt_getprop(fit, noffset, "required", NULL) != NULL;
184 if (keyname)
185 printf(":%s", keyname);
186 if (required)
187 printf(" (required)");
188 printf("\n");
189
190 padding = fdt_getprop(fit, noffset, "padding", NULL);
191 if (padding)
192 printf("%s %s padding: %s\n", p, type, padding);
193
194 ret = fit_image_hash_get_value(fit, noffset, &value,
195 &value_len);
196 printf("%s %s value: ", p, type);
197 if (ret) {
198 printf("unavailable\n");
199 } else {
200 for (i = 0; i < value_len; i++)
201 printf("%02x", value[i]);
202 printf("\n");
203 }
204
205 debug("%s %s len: %d\n", p, type, value_len);
206
207 /* Signatures have a time stamp */
208 if (IMAGE_ENABLE_TIMESTAMP && keyname) {
209 time_t timestamp;
210
211 printf("%s Timestamp: ", p);
212 if (fit_get_timestamp(fit, noffset, ×tamp))
213 printf("unavailable\n");
214 else
215 genimg_print_time(timestamp);
216 }
217 }
218
219 /**
220 * fit_image_print_verification_data() - prints out the hash/signature details
221 * @fit: pointer to the FIT format image header
222 * @noffset: offset of the hash or signature node
223 * @p: pointer to prefix string
224 *
225 * This lists properties for the processed hash node
226 *
227 * returns:
228 * no returned results
229 */
fit_image_print_verification_data(const void * fit,int noffset,const char * p)230 static void fit_image_print_verification_data(const void *fit, int noffset,
231 const char *p)
232 {
233 const char *name;
234
235 /*
236 * Check subnode name, must be equal to "hash" or "signature".
237 * Multiple hash/signature nodes require unique unit node
238 * names, e.g. hash-1, hash-2, signature-1, signature-2, etc.
239 */
240 name = fit_get_name(fit, noffset, NULL);
241 if (!strncmp(name, FIT_HASH_NODENAME, strlen(FIT_HASH_NODENAME))) {
242 fit_image_print_data(fit, noffset, p, "Hash");
243 } else if (!strncmp(name, FIT_SIG_NODENAME,
244 strlen(FIT_SIG_NODENAME))) {
245 fit_image_print_data(fit, noffset, p, "Sign");
246 }
247 }
248
249 /**
250 * fit_conf_print - prints out the FIT configuration details
251 * @fit: pointer to the FIT format image header
252 * @noffset: offset of the configuration node
253 * @p: pointer to prefix string
254 *
255 * fit_conf_print() lists all mandatory properties for the processed
256 * configuration node.
257 *
258 * returns:
259 * no returned results
260 */
fit_conf_print(const void * fit,int noffset,const char * p)261 static void fit_conf_print(const void *fit, int noffset, const char *p)
262 {
263 char *desc;
264 const char *uname;
265 int ret;
266 int fdt_index, loadables_index;
267 int ndepth;
268
269 /* Mandatory properties */
270 ret = fit_get_desc(fit, noffset, &desc);
271 printf("%s Description: ", p);
272 if (ret)
273 printf("unavailable\n");
274 else
275 printf("%s\n", desc);
276
277 uname = fdt_getprop(fit, noffset, FIT_KERNEL_PROP, NULL);
278 printf("%s Kernel: ", p);
279 if (!uname)
280 printf("unavailable\n");
281 else
282 printf("%s\n", uname);
283
284 /* Optional properties */
285 uname = fdt_getprop(fit, noffset, FIT_RAMDISK_PROP, NULL);
286 if (uname)
287 printf("%s Init Ramdisk: %s\n", p, uname);
288
289 uname = fdt_getprop(fit, noffset, FIT_FIRMWARE_PROP, NULL);
290 if (uname)
291 printf("%s Firmware: %s\n", p, uname);
292
293 for (fdt_index = 0;
294 uname = fdt_stringlist_get(fit, noffset, FIT_FDT_PROP,
295 fdt_index, NULL), uname;
296 fdt_index++) {
297 if (fdt_index == 0)
298 printf("%s FDT: ", p);
299 else
300 printf("%s ", p);
301 printf("%s\n", uname);
302 }
303
304 uname = fdt_getprop(fit, noffset, FIT_FPGA_PROP, NULL);
305 if (uname)
306 printf("%s FPGA: %s\n", p, uname);
307
308 /* Print out all of the specified loadables */
309 for (loadables_index = 0;
310 uname = fdt_stringlist_get(fit, noffset, FIT_LOADABLE_PROP,
311 loadables_index, NULL), uname;
312 loadables_index++) {
313 if (loadables_index == 0) {
314 printf("%s Loadables: ", p);
315 } else {
316 printf("%s ", p);
317 }
318 printf("%s\n", uname);
319 }
320
321 /* Process all hash subnodes of the component configuration node */
322 for (ndepth = 0, noffset = fdt_next_node(fit, noffset, &ndepth);
323 (noffset >= 0) && (ndepth > 0);
324 noffset = fdt_next_node(fit, noffset, &ndepth)) {
325 if (ndepth == 1) {
326 /* Direct child node of the component configuration node */
327 fit_image_print_verification_data(fit, noffset, p);
328 }
329 }
330 }
331
332 /**
333 * fit_print_contents - prints out the contents of the FIT format image
334 * @fit: pointer to the FIT format image header
335 * @p: pointer to prefix string
336 *
337 * fit_print_contents() formats a multi line FIT image contents description.
338 * The routine prints out FIT image properties (root node level) followed by
339 * the details of each component image.
340 *
341 * returns:
342 * no returned results
343 */
fit_print_contents(const void * fit)344 void fit_print_contents(const void *fit)
345 {
346 char *desc;
347 char *uname;
348 int images_noffset;
349 int confs_noffset;
350 int noffset;
351 int ndepth;
352 int count = 0;
353 int ret;
354 const char *p;
355 time_t timestamp;
356
357 /* Indent string is defined in header image.h */
358 p = IMAGE_INDENT_STRING;
359
360 /* Root node properties */
361 ret = fit_get_desc(fit, 0, &desc);
362 printf("%sFIT description: ", p);
363 if (ret)
364 printf("unavailable\n");
365 else
366 printf("%s\n", desc);
367
368 if (IMAGE_ENABLE_TIMESTAMP) {
369 ret = fit_get_timestamp(fit, 0, ×tamp);
370 printf("%sCreated: ", p);
371 if (ret)
372 printf("unavailable\n");
373 else
374 genimg_print_time(timestamp);
375 }
376
377 /* Find images parent node offset */
378 images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
379 if (images_noffset < 0) {
380 printf("Can't find images parent node '%s' (%s)\n",
381 FIT_IMAGES_PATH, fdt_strerror(images_noffset));
382 return;
383 }
384
385 /* Process its subnodes, print out component images details */
386 for (ndepth = 0, count = 0,
387 noffset = fdt_next_node(fit, images_noffset, &ndepth);
388 (noffset >= 0) && (ndepth > 0);
389 noffset = fdt_next_node(fit, noffset, &ndepth)) {
390 if (ndepth == 1) {
391 /*
392 * Direct child node of the images parent node,
393 * i.e. component image node.
394 */
395 printf("%s Image %u (%s)\n", p, count++,
396 fit_get_name(fit, noffset, NULL));
397
398 fit_image_print(fit, noffset, p);
399 }
400 }
401
402 /* Find configurations parent node offset */
403 confs_noffset = fdt_path_offset(fit, FIT_CONFS_PATH);
404 if (confs_noffset < 0) {
405 debug("Can't get configurations parent node '%s' (%s)\n",
406 FIT_CONFS_PATH, fdt_strerror(confs_noffset));
407 return;
408 }
409
410 /* get default configuration unit name from default property */
411 uname = (char *)fdt_getprop(fit, noffset, FIT_DEFAULT_PROP, NULL);
412 if (uname)
413 printf("%s Default Configuration: '%s'\n", p, uname);
414
415 /* Process its subnodes, print out configurations details */
416 for (ndepth = 0, count = 0,
417 noffset = fdt_next_node(fit, confs_noffset, &ndepth);
418 (noffset >= 0) && (ndepth > 0);
419 noffset = fdt_next_node(fit, noffset, &ndepth)) {
420 if (ndepth == 1) {
421 /*
422 * Direct child node of the configurations parent node,
423 * i.e. configuration node.
424 */
425 printf("%s Configuration %u (%s)\n", p, count++,
426 fit_get_name(fit, noffset, NULL));
427
428 fit_conf_print(fit, noffset, p);
429 }
430 }
431 }
432
433 /**
434 * fit_image_print - prints out the FIT component image details
435 * @fit: pointer to the FIT format image header
436 * @image_noffset: offset of the component image node
437 * @p: pointer to prefix string
438 *
439 * fit_image_print() lists all mandatory properties for the processed component
440 * image. If present, hash nodes are printed out as well. Load
441 * address for images of type firmware is also printed out. Since the load
442 * address is not mandatory for firmware images, it will be output as
443 * "unavailable" when not present.
444 *
445 * returns:
446 * no returned results
447 */
fit_image_print(const void * fit,int image_noffset,const char * p)448 void fit_image_print(const void *fit, int image_noffset, const char *p)
449 {
450 char *desc;
451 uint8_t type, arch, os, comp;
452 size_t size;
453 ulong load, entry;
454 const void *data;
455 int noffset;
456 int ndepth;
457 int ret;
458
459 /* Mandatory properties */
460 ret = fit_get_desc(fit, image_noffset, &desc);
461 printf("%s Description: ", p);
462 if (ret)
463 printf("unavailable\n");
464 else
465 printf("%s\n", desc);
466
467 if (IMAGE_ENABLE_TIMESTAMP) {
468 time_t timestamp;
469
470 ret = fit_get_timestamp(fit, 0, ×tamp);
471 printf("%s Created: ", p);
472 if (ret)
473 printf("unavailable\n");
474 else
475 genimg_print_time(timestamp);
476 }
477
478 fit_image_get_type(fit, image_noffset, &type);
479 printf("%s Type: %s\n", p, genimg_get_type_name(type));
480
481 fit_image_get_comp(fit, image_noffset, &comp);
482 printf("%s Compression: %s\n", p, genimg_get_comp_name(comp));
483
484 ret = fit_image_get_data_and_size(fit, image_noffset, &data, &size);
485
486 #ifndef USE_HOSTCC
487 printf("%s Data Start: ", p);
488 if (ret) {
489 printf("unavailable\n");
490 } else {
491 void *vdata = (void *)data;
492
493 printf("0x%08lx\n", (ulong)map_to_sysmem(vdata));
494 }
495 #endif
496
497 printf("%s Data Size: ", p);
498 if (ret)
499 printf("unavailable\n");
500 else
501 genimg_print_size(size);
502
503 /* Remaining, type dependent properties */
504 if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE) ||
505 (type == IH_TYPE_RAMDISK) || (type == IH_TYPE_FIRMWARE) ||
506 (type == IH_TYPE_FLATDT)) {
507 fit_image_get_arch(fit, image_noffset, &arch);
508 printf("%s Architecture: %s\n", p, genimg_get_arch_name(arch));
509 }
510
511 if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_RAMDISK) ||
512 (type == IH_TYPE_FIRMWARE)) {
513 fit_image_get_os(fit, image_noffset, &os);
514 printf("%s OS: %s\n", p, genimg_get_os_name(os));
515 }
516
517 if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE) ||
518 (type == IH_TYPE_FIRMWARE) || (type == IH_TYPE_RAMDISK) ||
519 (type == IH_TYPE_FPGA)) {
520 ret = fit_image_get_load(fit, image_noffset, &load);
521 printf("%s Load Address: ", p);
522 if (ret)
523 printf("unavailable\n");
524 else
525 printf("0x%08lx\n", load);
526 }
527
528 /* optional load address for FDT */
529 if (type == IH_TYPE_FLATDT && !fit_image_get_load(fit, image_noffset, &load))
530 printf("%s Load Address: 0x%08lx\n", p, load);
531
532 if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE) ||
533 (type == IH_TYPE_RAMDISK)) {
534 ret = fit_image_get_entry(fit, image_noffset, &entry);
535 printf("%s Entry Point: ", p);
536 if (ret)
537 printf("unavailable\n");
538 else
539 printf("0x%08lx\n", entry);
540 }
541
542 /* Process all hash subnodes of the component image node */
543 for (ndepth = 0, noffset = fdt_next_node(fit, image_noffset, &ndepth);
544 (noffset >= 0) && (ndepth > 0);
545 noffset = fdt_next_node(fit, noffset, &ndepth)) {
546 if (ndepth == 1) {
547 /* Direct child node of the component image node */
548 fit_image_print_verification_data(fit, noffset, p);
549 }
550 }
551 }
552 #else
fit_print_contents(const void * fit)553 void fit_print_contents(const void *fit) { }
fit_image_print(const void * fit,int image_noffset,const char * p)554 void fit_image_print(const void *fit, int image_noffset, const char *p) { }
555 #endif /* !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_FIT_PRINT) */
556
557 /**
558 * fit_get_desc - get node description property
559 * @fit: pointer to the FIT format image header
560 * @noffset: node offset
561 * @desc: double pointer to the char, will hold pointer to the description
562 *
563 * fit_get_desc() reads description property from a given node, if
564 * description is found pointer to it is returned in third call argument.
565 *
566 * returns:
567 * 0, on success
568 * -1, on failure
569 */
fit_get_desc(const void * fit,int noffset,char ** desc)570 int fit_get_desc(const void *fit, int noffset, char **desc)
571 {
572 int len;
573
574 *desc = (char *)fdt_getprop(fit, noffset, FIT_DESC_PROP, &len);
575 if (*desc == NULL) {
576 fit_get_debug(fit, noffset, FIT_DESC_PROP, len);
577 return -1;
578 }
579
580 return 0;
581 }
582
583 /**
584 * fit_get_timestamp - get node timestamp property
585 * @fit: pointer to the FIT format image header
586 * @noffset: node offset
587 * @timestamp: pointer to the time_t, will hold read timestamp
588 *
589 * fit_get_timestamp() reads timestamp property from given node, if timestamp
590 * is found and has a correct size its value is returned in third call
591 * argument.
592 *
593 * returns:
594 * 0, on success
595 * -1, on property read failure
596 * -2, on wrong timestamp size
597 */
fit_get_timestamp(const void * fit,int noffset,time_t * timestamp)598 int fit_get_timestamp(const void *fit, int noffset, time_t *timestamp)
599 {
600 int len;
601 const void *data;
602
603 data = fdt_getprop(fit, noffset, FIT_TIMESTAMP_PROP, &len);
604 if (data == NULL) {
605 fit_get_debug(fit, noffset, FIT_TIMESTAMP_PROP, len);
606 return -1;
607 }
608 if (len != sizeof(uint32_t)) {
609 debug("FIT timestamp with incorrect size of (%u)\n", len);
610 return -2;
611 }
612
613 *timestamp = uimage_to_cpu(*((uint32_t *)data));
614 return 0;
615 }
616
617 /**
618 * fit_image_get_node - get node offset for component image of a given unit name
619 * @fit: pointer to the FIT format image header
620 * @image_uname: component image node unit name
621 *
622 * fit_image_get_node() finds a component image (within the '/images'
623 * node) of a provided unit name. If image is found its node offset is
624 * returned to the caller.
625 *
626 * returns:
627 * image node offset when found (>=0)
628 * negative number on failure (FDT_ERR_* code)
629 */
fit_image_get_node(const void * fit,const char * image_uname)630 int fit_image_get_node(const void *fit, const char *image_uname)
631 {
632 int noffset, images_noffset;
633
634 images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
635 if (images_noffset < 0) {
636 debug("Can't find images parent node '%s' (%s)\n",
637 FIT_IMAGES_PATH, fdt_strerror(images_noffset));
638 return images_noffset;
639 }
640
641 noffset = fdt_subnode_offset(fit, images_noffset, image_uname);
642 if (noffset < 0) {
643 debug("Can't get node offset for image unit name: '%s' (%s)\n",
644 image_uname, fdt_strerror(noffset));
645 }
646
647 return noffset;
648 }
649
650 /**
651 * fit_image_get_os - get os id for a given component image node
652 * @fit: pointer to the FIT format image header
653 * @noffset: component image node offset
654 * @os: pointer to the uint8_t, will hold os numeric id
655 *
656 * fit_image_get_os() finds os property in a given component image node.
657 * If the property is found, its (string) value is translated to the numeric
658 * id which is returned to the caller.
659 *
660 * returns:
661 * 0, on success
662 * -1, on failure
663 */
fit_image_get_os(const void * fit,int noffset,uint8_t * os)664 int fit_image_get_os(const void *fit, int noffset, uint8_t *os)
665 {
666 int len;
667 const void *data;
668
669 /* Get OS name from property data */
670 data = fdt_getprop(fit, noffset, FIT_OS_PROP, &len);
671 if (data == NULL) {
672 fit_get_debug(fit, noffset, FIT_OS_PROP, len);
673 *os = -1;
674 return -1;
675 }
676
677 /* Translate OS name to id */
678 *os = genimg_get_os_id(data);
679 return 0;
680 }
681
682 /**
683 * fit_image_get_arch - get arch id for a given component image node
684 * @fit: pointer to the FIT format image header
685 * @noffset: component image node offset
686 * @arch: pointer to the uint8_t, will hold arch numeric id
687 *
688 * fit_image_get_arch() finds arch property in a given component image node.
689 * If the property is found, its (string) value is translated to the numeric
690 * id which is returned to the caller.
691 *
692 * returns:
693 * 0, on success
694 * -1, on failure
695 */
fit_image_get_arch(const void * fit,int noffset,uint8_t * arch)696 int fit_image_get_arch(const void *fit, int noffset, uint8_t *arch)
697 {
698 int len;
699 const void *data;
700
701 /* Get architecture name from property data */
702 data = fdt_getprop(fit, noffset, FIT_ARCH_PROP, &len);
703 if (data == NULL) {
704 fit_get_debug(fit, noffset, FIT_ARCH_PROP, len);
705 *arch = -1;
706 return -1;
707 }
708
709 /* Translate architecture name to id */
710 *arch = genimg_get_arch_id(data);
711 return 0;
712 }
713
714 /**
715 * fit_image_get_type - get type id for a given component image node
716 * @fit: pointer to the FIT format image header
717 * @noffset: component image node offset
718 * @type: pointer to the uint8_t, will hold type numeric id
719 *
720 * fit_image_get_type() finds type property in a given component image node.
721 * If the property is found, its (string) value is translated to the numeric
722 * id which is returned to the caller.
723 *
724 * returns:
725 * 0, on success
726 * -1, on failure
727 */
fit_image_get_type(const void * fit,int noffset,uint8_t * type)728 int fit_image_get_type(const void *fit, int noffset, uint8_t *type)
729 {
730 int len;
731 const void *data;
732
733 /* Get image type name from property data */
734 data = fdt_getprop(fit, noffset, FIT_TYPE_PROP, &len);
735 if (data == NULL) {
736 fit_get_debug(fit, noffset, FIT_TYPE_PROP, len);
737 *type = -1;
738 return -1;
739 }
740
741 /* Translate image type name to id */
742 *type = genimg_get_type_id(data);
743 return 0;
744 }
745
746 /**
747 * fit_image_get_comp - get comp id for a given component image node
748 * @fit: pointer to the FIT format image header
749 * @noffset: component image node offset
750 * @comp: pointer to the uint8_t, will hold comp numeric id
751 *
752 * fit_image_get_comp() finds comp property in a given component image node.
753 * If the property is found, its (string) value is translated to the numeric
754 * id which is returned to the caller.
755 *
756 * returns:
757 * 0, on success
758 * -1, on failure
759 */
fit_image_get_comp(const void * fit,int noffset,uint8_t * comp)760 int fit_image_get_comp(const void *fit, int noffset, uint8_t *comp)
761 {
762 int len;
763 const void *data;
764
765 /* Get compression name from property data */
766 data = fdt_getprop(fit, noffset, FIT_COMP_PROP, &len);
767 if (data == NULL) {
768 fit_get_debug(fit, noffset, FIT_COMP_PROP, len);
769 *comp = -1;
770 return -1;
771 }
772
773 /* Translate compression name to id */
774 *comp = genimg_get_comp_id(data);
775 return 0;
776 }
777
fit_image_get_address(const void * fit,int noffset,char * name,ulong * load)778 static int fit_image_get_address(const void *fit, int noffset, char *name,
779 ulong *load)
780 {
781 int len, cell_len;
782 const fdt32_t *cell;
783 uint64_t load64 = 0;
784
785 cell = fdt_getprop(fit, noffset, name, &len);
786 if (cell == NULL) {
787 fit_get_debug(fit, noffset, name, len);
788 return -1;
789 }
790
791 if (len > sizeof(ulong)) {
792 printf("Unsupported %s address size\n", name);
793 return -1;
794 }
795
796 cell_len = len >> 2;
797 /* Use load64 to avoid compiling warning for 32-bit target */
798 while (cell_len--) {
799 load64 = (load64 << 32) | uimage_to_cpu(*cell);
800 cell++;
801 }
802 *load = (ulong)load64;
803
804 return 0;
805 }
806 /**
807 * fit_image_get_load() - get load addr property for given component image node
808 * @fit: pointer to the FIT format image header
809 * @noffset: component image node offset
810 * @load: pointer to the uint32_t, will hold load address
811 *
812 * fit_image_get_load() finds load address property in a given component
813 * image node. If the property is found, its value is returned to the caller.
814 *
815 * returns:
816 * 0, on success
817 * -1, on failure
818 */
fit_image_get_load(const void * fit,int noffset,ulong * load)819 int fit_image_get_load(const void *fit, int noffset, ulong *load)
820 {
821 return fit_image_get_address(fit, noffset, FIT_LOAD_PROP, load);
822 }
823
824 /**
825 * fit_image_get_entry() - get entry point address property
826 * @fit: pointer to the FIT format image header
827 * @noffset: component image node offset
828 * @entry: pointer to the uint32_t, will hold entry point address
829 *
830 * This gets the entry point address property for a given component image
831 * node.
832 *
833 * fit_image_get_entry() finds entry point address property in a given
834 * component image node. If the property is found, its value is returned
835 * to the caller.
836 *
837 * returns:
838 * 0, on success
839 * -1, on failure
840 */
fit_image_get_entry(const void * fit,int noffset,ulong * entry)841 int fit_image_get_entry(const void *fit, int noffset, ulong *entry)
842 {
843 return fit_image_get_address(fit, noffset, FIT_ENTRY_PROP, entry);
844 }
845
846 /**
847 * fit_image_get_data - get data property and its size for a given component image node
848 * @fit: pointer to the FIT format image header
849 * @noffset: component image node offset
850 * @data: double pointer to void, will hold data property's data address
851 * @size: pointer to size_t, will hold data property's data size
852 *
853 * fit_image_get_data() finds data property in a given component image node.
854 * If the property is found its data start address and size are returned to
855 * the caller.
856 *
857 * returns:
858 * 0, on success
859 * -1, on failure
860 */
fit_image_get_data(const void * fit,int noffset,const void ** data,size_t * size)861 int fit_image_get_data(const void *fit, int noffset,
862 const void **data, size_t *size)
863 {
864 int len;
865
866 *data = fdt_getprop(fit, noffset, FIT_DATA_PROP, &len);
867 if (*data == NULL) {
868 fit_get_debug(fit, noffset, FIT_DATA_PROP, len);
869 *size = 0;
870 return -1;
871 }
872
873 *size = len;
874 return 0;
875 }
876
877 /**
878 * Get 'data-offset' property from a given image node.
879 *
880 * @fit: pointer to the FIT image header
881 * @noffset: component image node offset
882 * @data_offset: holds the data-offset property
883 *
884 * returns:
885 * 0, on success
886 * -ENOENT if the property could not be found
887 */
fit_image_get_data_offset(const void * fit,int noffset,int * data_offset)888 int fit_image_get_data_offset(const void *fit, int noffset, int *data_offset)
889 {
890 const fdt32_t *val;
891
892 val = fdt_getprop(fit, noffset, FIT_DATA_OFFSET_PROP, NULL);
893 if (!val)
894 return -ENOENT;
895
896 *data_offset = fdt32_to_cpu(*val);
897
898 return 0;
899 }
900
901 /**
902 * Get 'data-position' property from a given image node.
903 *
904 * @fit: pointer to the FIT image header
905 * @noffset: component image node offset
906 * @data_position: holds the data-position property
907 *
908 * returns:
909 * 0, on success
910 * -ENOENT if the property could not be found
911 */
fit_image_get_data_position(const void * fit,int noffset,int * data_position)912 int fit_image_get_data_position(const void *fit, int noffset,
913 int *data_position)
914 {
915 const fdt32_t *val;
916
917 val = fdt_getprop(fit, noffset, FIT_DATA_POSITION_PROP, NULL);
918 if (!val)
919 return -ENOENT;
920
921 *data_position = fdt32_to_cpu(*val);
922
923 return 0;
924 }
925
926 /**
927 * Get 'data-size' property from a given image node.
928 *
929 * @fit: pointer to the FIT image header
930 * @noffset: component image node offset
931 * @data_size: holds the data-size property
932 *
933 * returns:
934 * 0, on success
935 * -ENOENT if the property could not be found
936 */
fit_image_get_data_size(const void * fit,int noffset,int * data_size)937 int fit_image_get_data_size(const void *fit, int noffset, int *data_size)
938 {
939 const fdt32_t *val;
940
941 val = fdt_getprop(fit, noffset, FIT_DATA_SIZE_PROP, NULL);
942 if (!val)
943 return -ENOENT;
944
945 *data_size = fdt32_to_cpu(*val);
946
947 return 0;
948 }
949
950 /**
951 * fit_image_get_data_and_size - get data and its size including
952 * both embedded and external data
953 * @fit: pointer to the FIT format image header
954 * @noffset: component image node offset
955 * @data: double pointer to void, will hold data property's data address
956 * @size: pointer to size_t, will hold data property's data size
957 *
958 * fit_image_get_data_and_size() finds data and its size including
959 * both embedded and external data. If the property is found
960 * its data start address and size are returned to the caller.
961 *
962 * returns:
963 * 0, on success
964 * otherwise, on failure
965 */
fit_image_get_data_and_size(const void * fit,int noffset,const void ** data,size_t * size)966 int fit_image_get_data_and_size(const void *fit, int noffset,
967 const void **data, size_t *size)
968 {
969 bool external_data = false;
970 int offset;
971 int len;
972 int ret;
973
974 if (!fit_image_get_data_position(fit, noffset, &offset)) {
975 external_data = true;
976 } else if (!fit_image_get_data_offset(fit, noffset, &offset)) {
977 external_data = true;
978 /*
979 * For FIT with external data, figure out where
980 * the external images start. This is the base
981 * for the data-offset properties in each image.
982 */
983 offset += ((fdt_totalsize(fit) + 3) & ~3);
984 }
985
986 if (external_data) {
987 debug("External Data\n");
988 ret = fit_image_get_data_size(fit, noffset, &len);
989 *data = fit + offset;
990 *size = len;
991 } else {
992 ret = fit_image_get_data(fit, noffset, data, size);
993 }
994
995 return ret;
996 }
997
998 /**
999 * fit_image_hash_get_algo - get hash algorithm name
1000 * @fit: pointer to the FIT format image header
1001 * @noffset: hash node offset
1002 * @algo: double pointer to char, will hold pointer to the algorithm name
1003 *
1004 * fit_image_hash_get_algo() finds hash algorithm property in a given hash node.
1005 * If the property is found its data start address is returned to the caller.
1006 *
1007 * returns:
1008 * 0, on success
1009 * -1, on failure
1010 */
fit_image_hash_get_algo(const void * fit,int noffset,char ** algo)1011 int fit_image_hash_get_algo(const void *fit, int noffset, char **algo)
1012 {
1013 int len;
1014
1015 *algo = (char *)fdt_getprop(fit, noffset, FIT_ALGO_PROP, &len);
1016 if (*algo == NULL) {
1017 fit_get_debug(fit, noffset, FIT_ALGO_PROP, len);
1018 return -1;
1019 }
1020
1021 return 0;
1022 }
1023
1024 /**
1025 * fit_image_hash_get_value - get hash value and length
1026 * @fit: pointer to the FIT format image header
1027 * @noffset: hash node offset
1028 * @value: double pointer to uint8_t, will hold address of a hash value data
1029 * @value_len: pointer to an int, will hold hash data length
1030 *
1031 * fit_image_hash_get_value() finds hash value property in a given hash node.
1032 * If the property is found its data start address and size are returned to
1033 * the caller.
1034 *
1035 * returns:
1036 * 0, on success
1037 * -1, on failure
1038 */
fit_image_hash_get_value(const void * fit,int noffset,uint8_t ** value,int * value_len)1039 int fit_image_hash_get_value(const void *fit, int noffset, uint8_t **value,
1040 int *value_len)
1041 {
1042 int len;
1043
1044 *value = (uint8_t *)fdt_getprop(fit, noffset, FIT_VALUE_PROP, &len);
1045 if (*value == NULL) {
1046 fit_get_debug(fit, noffset, FIT_VALUE_PROP, len);
1047 *value_len = 0;
1048 return -1;
1049 }
1050
1051 *value_len = len;
1052 return 0;
1053 }
1054
1055 /**
1056 * fit_image_hash_get_ignore - get hash ignore flag
1057 * @fit: pointer to the FIT format image header
1058 * @noffset: hash node offset
1059 * @ignore: pointer to an int, will hold hash ignore flag
1060 *
1061 * fit_image_hash_get_ignore() finds hash ignore property in a given hash node.
1062 * If the property is found and non-zero, the hash algorithm is not verified by
1063 * u-boot automatically.
1064 *
1065 * returns:
1066 * 0, on ignore not found
1067 * value, on ignore found
1068 */
fit_image_hash_get_ignore(const void * fit,int noffset,int * ignore)1069 static int fit_image_hash_get_ignore(const void *fit, int noffset, int *ignore)
1070 {
1071 int len;
1072 int *value;
1073
1074 value = (int *)fdt_getprop(fit, noffset, FIT_IGNORE_PROP, &len);
1075 if (value == NULL || len != sizeof(int))
1076 *ignore = 0;
1077 else
1078 *ignore = *value;
1079
1080 return 0;
1081 }
1082
fit_get_end(const void * fit)1083 ulong fit_get_end(const void *fit)
1084 {
1085 return map_to_sysmem((void *)(fit + fdt_totalsize(fit)));
1086 }
1087
1088 /**
1089 * fit_set_timestamp - set node timestamp property
1090 * @fit: pointer to the FIT format image header
1091 * @noffset: node offset
1092 * @timestamp: timestamp value to be set
1093 *
1094 * fit_set_timestamp() attempts to set timestamp property in the requested
1095 * node and returns operation status to the caller.
1096 *
1097 * returns:
1098 * 0, on success
1099 * -ENOSPC if no space in device tree, -1 for other error
1100 */
fit_set_timestamp(void * fit,int noffset,time_t timestamp)1101 int fit_set_timestamp(void *fit, int noffset, time_t timestamp)
1102 {
1103 uint32_t t;
1104 int ret;
1105
1106 t = cpu_to_uimage(timestamp);
1107 ret = fdt_setprop(fit, noffset, FIT_TIMESTAMP_PROP, &t,
1108 sizeof(uint32_t));
1109 if (ret) {
1110 debug("Can't set '%s' property for '%s' node (%s)\n",
1111 FIT_TIMESTAMP_PROP, fit_get_name(fit, noffset, NULL),
1112 fdt_strerror(ret));
1113 return ret == -FDT_ERR_NOSPACE ? -ENOSPC : -1;
1114 }
1115
1116 return 0;
1117 }
1118
1119 /**
1120 * calculate_hash - calculate and return hash for provided input data
1121 * @data: pointer to the input data
1122 * @data_len: data length
1123 * @algo: requested hash algorithm
1124 * @value: pointer to the char, will hold hash value data (caller must
1125 * allocate enough free space)
1126 * value_len: length of the calculated hash
1127 *
1128 * calculate_hash() computes input data hash according to the requested
1129 * algorithm.
1130 * Resulting hash value is placed in caller provided 'value' buffer, length
1131 * of the calculated hash is returned via value_len pointer argument.
1132 *
1133 * returns:
1134 * 0, on success
1135 * -1, when algo is unsupported
1136 */
calculate_hash(const void * data,int data_len,const char * algo,uint8_t * value,int * value_len)1137 int calculate_hash(const void *data, int data_len, const char *algo,
1138 uint8_t *value, int *value_len)
1139 {
1140 if (IMAGE_ENABLE_CRC32 && strcmp(algo, "crc32") == 0) {
1141 *((uint32_t *)value) = crc32_wd(0, data, data_len,
1142 CHUNKSZ_CRC32);
1143 *((uint32_t *)value) = cpu_to_uimage(*((uint32_t *)value));
1144 *value_len = 4;
1145 } else if (IMAGE_ENABLE_SHA1 && strcmp(algo, "sha1") == 0) {
1146 sha1_csum_wd((unsigned char *)data, data_len,
1147 (unsigned char *)value, CHUNKSZ_SHA1);
1148 *value_len = 20;
1149 } else if (IMAGE_ENABLE_SHA256 && strcmp(algo, "sha256") == 0) {
1150 sha256_csum_wd((unsigned char *)data, data_len,
1151 (unsigned char *)value, CHUNKSZ_SHA256);
1152 *value_len = SHA256_SUM_LEN;
1153 } else if (IMAGE_ENABLE_MD5 && strcmp(algo, "md5") == 0) {
1154 md5_wd((unsigned char *)data, data_len, value, CHUNKSZ_MD5);
1155 *value_len = 16;
1156 } else {
1157 debug("Unsupported hash alogrithm\n");
1158 return -1;
1159 }
1160 return 0;
1161 }
1162
fit_image_check_hash(const void * fit,int noffset,const void * data,size_t size,char ** err_msgp)1163 static int fit_image_check_hash(const void *fit, int noffset, const void *data,
1164 size_t size, char **err_msgp)
1165 {
1166 uint8_t value[FIT_MAX_HASH_LEN];
1167 int value_len;
1168 char *algo;
1169 uint8_t *fit_value;
1170 int fit_value_len;
1171 int ignore;
1172
1173 *err_msgp = NULL;
1174
1175 if (fit_image_hash_get_algo(fit, noffset, &algo)) {
1176 *err_msgp = "Can't get hash algo property";
1177 return -1;
1178 }
1179 printf("%s", algo);
1180
1181 if (IMAGE_ENABLE_IGNORE) {
1182 fit_image_hash_get_ignore(fit, noffset, &ignore);
1183 if (ignore) {
1184 printf("-skipped ");
1185 return 0;
1186 }
1187 }
1188
1189 if (fit_image_hash_get_value(fit, noffset, &fit_value,
1190 &fit_value_len)) {
1191 *err_msgp = "Can't get hash value property";
1192 return -1;
1193 }
1194
1195 if (calculate_hash(data, size, algo, value, &value_len)) {
1196 *err_msgp = "Unsupported hash algorithm";
1197 return -1;
1198 }
1199
1200 if (value_len != fit_value_len) {
1201 *err_msgp = "Bad hash value len";
1202 return -1;
1203 } else if (memcmp(value, fit_value, value_len) != 0) {
1204 *err_msgp = "Bad hash value";
1205 return -1;
1206 }
1207
1208 return 0;
1209 }
1210
fit_image_verify_with_data(const void * fit,int image_noffset,const void * data,size_t size)1211 int fit_image_verify_with_data(const void *fit, int image_noffset,
1212 const void *data, size_t size)
1213 {
1214 int noffset = 0;
1215 char *err_msg = "";
1216 int verify_all = 1;
1217 int ret;
1218
1219 /* Verify all required signatures */
1220 if (IMAGE_ENABLE_VERIFY &&
1221 fit_image_verify_required_sigs(fit, image_noffset, data, size,
1222 gd_fdt_blob(), &verify_all)) {
1223 err_msg = "Unable to verify required signature";
1224 goto error;
1225 }
1226
1227 /* Process all hash subnodes of the component image node */
1228 fdt_for_each_subnode(noffset, fit, image_noffset) {
1229 const char *name = fit_get_name(fit, noffset, NULL);
1230
1231 /*
1232 * Check subnode name, must be equal to "hash".
1233 * Multiple hash nodes require unique unit node
1234 * names, e.g. hash-1, hash-2, etc.
1235 */
1236 if (!strncmp(name, FIT_HASH_NODENAME,
1237 strlen(FIT_HASH_NODENAME))) {
1238 if (fit_image_check_hash(fit, noffset, data, size,
1239 &err_msg))
1240 goto error;
1241 puts("+ ");
1242 } else if (IMAGE_ENABLE_VERIFY && verify_all &&
1243 !strncmp(name, FIT_SIG_NODENAME,
1244 strlen(FIT_SIG_NODENAME))) {
1245 ret = fit_image_check_sig(fit, noffset, data,
1246 size, -1, &err_msg);
1247
1248 /*
1249 * Show an indication on failure, but do not return
1250 * an error. Only keys marked 'required' can cause
1251 * an image validation failure. See the call to
1252 * fit_image_verify_required_sigs() above.
1253 */
1254 if (ret)
1255 puts("- ");
1256 else
1257 puts("+ ");
1258 }
1259 }
1260
1261 if (noffset == -FDT_ERR_TRUNCATED || noffset == -FDT_ERR_BADSTRUCTURE) {
1262 err_msg = "Corrupted or truncated tree";
1263 goto error;
1264 }
1265
1266 return 1;
1267
1268 error:
1269 printf(" error!\n%s for '%s' hash node in '%s' image node\n",
1270 err_msg, fit_get_name(fit, noffset, NULL),
1271 fit_get_name(fit, image_noffset, NULL));
1272 return 0;
1273 }
1274
1275 /**
1276 * fit_image_verify - verify data integrity
1277 * @fit: pointer to the FIT format image header
1278 * @image_noffset: component image node offset
1279 *
1280 * fit_image_verify() goes over component image hash nodes,
1281 * re-calculates each data hash and compares with the value stored in hash
1282 * node.
1283 *
1284 * returns:
1285 * 1, if all hashes are valid
1286 * 0, otherwise (or on error)
1287 */
fit_image_verify(const void * fit,int image_noffset)1288 int fit_image_verify(const void *fit, int image_noffset)
1289 {
1290 const void *data;
1291 size_t size;
1292 int noffset = 0;
1293 char *err_msg = "";
1294
1295 /* Get image data and data length */
1296 if (fit_image_get_data_and_size(fit, image_noffset, &data, &size)) {
1297 err_msg = "Can't get image data/size";
1298 printf("error!\n%s for '%s' hash node in '%s' image node\n",
1299 err_msg, fit_get_name(fit, noffset, NULL),
1300 fit_get_name(fit, image_noffset, NULL));
1301 return 0;
1302 }
1303
1304 return fit_image_verify_with_data(fit, image_noffset, data, size);
1305 }
1306
1307 /**
1308 * fit_all_image_verify - verify data integrity for all images
1309 * @fit: pointer to the FIT format image header
1310 *
1311 * fit_all_image_verify() goes over all images in the FIT and
1312 * for every images checks if all it's hashes are valid.
1313 *
1314 * returns:
1315 * 1, if all hashes of all images are valid
1316 * 0, otherwise (or on error)
1317 */
fit_all_image_verify(const void * fit)1318 int fit_all_image_verify(const void *fit)
1319 {
1320 int images_noffset;
1321 int noffset;
1322 int ndepth;
1323 int count;
1324
1325 /* Find images parent node offset */
1326 images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
1327 if (images_noffset < 0) {
1328 printf("Can't find images parent node '%s' (%s)\n",
1329 FIT_IMAGES_PATH, fdt_strerror(images_noffset));
1330 return 0;
1331 }
1332
1333 /* Process all image subnodes, check hashes for each */
1334 printf("## Checking hash(es) for FIT Image at %08lx ...\n",
1335 (ulong)fit);
1336 for (ndepth = 0, count = 0,
1337 noffset = fdt_next_node(fit, images_noffset, &ndepth);
1338 (noffset >= 0) && (ndepth > 0);
1339 noffset = fdt_next_node(fit, noffset, &ndepth)) {
1340 if (ndepth == 1) {
1341 /*
1342 * Direct child node of the images parent node,
1343 * i.e. component image node.
1344 */
1345 printf(" Hash(es) for Image %u (%s): ", count,
1346 fit_get_name(fit, noffset, NULL));
1347 count++;
1348
1349 if (!fit_image_verify(fit, noffset))
1350 return 0;
1351 printf("\n");
1352 }
1353 }
1354 return 1;
1355 }
1356
1357 /**
1358 * fit_image_check_os - check whether image node is of a given os type
1359 * @fit: pointer to the FIT format image header
1360 * @noffset: component image node offset
1361 * @os: requested image os
1362 *
1363 * fit_image_check_os() reads image os property and compares its numeric
1364 * id with the requested os. Comparison result is returned to the caller.
1365 *
1366 * returns:
1367 * 1 if image is of given os type
1368 * 0 otherwise (or on error)
1369 */
fit_image_check_os(const void * fit,int noffset,uint8_t os)1370 int fit_image_check_os(const void *fit, int noffset, uint8_t os)
1371 {
1372 uint8_t image_os;
1373
1374 if (fit_image_get_os(fit, noffset, &image_os))
1375 return 0;
1376 return (os == image_os);
1377 }
1378
1379 /**
1380 * fit_image_check_arch - check whether image node is of a given arch
1381 * @fit: pointer to the FIT format image header
1382 * @noffset: component image node offset
1383 * @arch: requested imagearch
1384 *
1385 * fit_image_check_arch() reads image arch property and compares its numeric
1386 * id with the requested arch. Comparison result is returned to the caller.
1387 *
1388 * returns:
1389 * 1 if image is of given arch
1390 * 0 otherwise (or on error)
1391 */
fit_image_check_arch(const void * fit,int noffset,uint8_t arch)1392 int fit_image_check_arch(const void *fit, int noffset, uint8_t arch)
1393 {
1394 uint8_t image_arch;
1395 int aarch32_support = 0;
1396
1397 #ifdef CONFIG_ARM64_SUPPORT_AARCH32
1398 aarch32_support = 1;
1399 #endif
1400
1401 if (fit_image_get_arch(fit, noffset, &image_arch))
1402 return 0;
1403 return (arch == image_arch) ||
1404 (arch == IH_ARCH_I386 && image_arch == IH_ARCH_X86_64) ||
1405 (arch == IH_ARCH_ARM64 && image_arch == IH_ARCH_ARM &&
1406 aarch32_support);
1407 }
1408
1409 /**
1410 * fit_image_check_type - check whether image node is of a given type
1411 * @fit: pointer to the FIT format image header
1412 * @noffset: component image node offset
1413 * @type: requested image type
1414 *
1415 * fit_image_check_type() reads image type property and compares its numeric
1416 * id with the requested type. Comparison result is returned to the caller.
1417 *
1418 * returns:
1419 * 1 if image is of given type
1420 * 0 otherwise (or on error)
1421 */
fit_image_check_type(const void * fit,int noffset,uint8_t type)1422 int fit_image_check_type(const void *fit, int noffset, uint8_t type)
1423 {
1424 uint8_t image_type;
1425
1426 if (fit_image_get_type(fit, noffset, &image_type))
1427 return 0;
1428 return (type == image_type);
1429 }
1430
1431 /**
1432 * fit_image_check_comp - check whether image node uses given compression
1433 * @fit: pointer to the FIT format image header
1434 * @noffset: component image node offset
1435 * @comp: requested image compression type
1436 *
1437 * fit_image_check_comp() reads image compression property and compares its
1438 * numeric id with the requested compression type. Comparison result is
1439 * returned to the caller.
1440 *
1441 * returns:
1442 * 1 if image uses requested compression
1443 * 0 otherwise (or on error)
1444 */
fit_image_check_comp(const void * fit,int noffset,uint8_t comp)1445 int fit_image_check_comp(const void *fit, int noffset, uint8_t comp)
1446 {
1447 uint8_t image_comp;
1448
1449 if (fit_image_get_comp(fit, noffset, &image_comp))
1450 return 0;
1451 return (comp == image_comp);
1452 }
1453
1454 /**
1455 * fit_check_format - sanity check FIT image format
1456 * @fit: pointer to the FIT format image header
1457 *
1458 * fit_check_format() runs a basic sanity FIT image verification.
1459 * Routine checks for mandatory properties, nodes, etc.
1460 *
1461 * returns:
1462 * 1, on success
1463 * 0, on failure
1464 */
fit_check_format(const void * fit)1465 int fit_check_format(const void *fit)
1466 {
1467 /* mandatory / node 'description' property */
1468 if (fdt_getprop(fit, 0, FIT_DESC_PROP, NULL) == NULL) {
1469 debug("Wrong FIT format: no description\n");
1470 return 0;
1471 }
1472
1473 if (IMAGE_ENABLE_TIMESTAMP) {
1474 /* mandatory / node 'timestamp' property */
1475 if (fdt_getprop(fit, 0, FIT_TIMESTAMP_PROP, NULL) == NULL) {
1476 debug("Wrong FIT format: no timestamp\n");
1477 return 0;
1478 }
1479 }
1480
1481 /* mandatory subimages parent '/images' node */
1482 if (fdt_path_offset(fit, FIT_IMAGES_PATH) < 0) {
1483 debug("Wrong FIT format: no images parent node\n");
1484 return 0;
1485 }
1486
1487 return 1;
1488 }
1489
1490
1491 /**
1492 * fit_conf_find_compat
1493 * @fit: pointer to the FIT format image header
1494 * @fdt: pointer to the device tree to compare against
1495 *
1496 * fit_conf_find_compat() attempts to find the configuration whose fdt is the
1497 * most compatible with the passed in device tree.
1498 *
1499 * Example:
1500 *
1501 * / o image-tree
1502 * |-o images
1503 * | |-o fdt-1
1504 * | |-o fdt-2
1505 * |
1506 * |-o configurations
1507 * |-o config-1
1508 * | |-fdt = fdt-1
1509 * |
1510 * |-o config-2
1511 * |-fdt = fdt-2
1512 *
1513 * / o U-Boot fdt
1514 * |-compatible = "foo,bar", "bim,bam"
1515 *
1516 * / o kernel fdt1
1517 * |-compatible = "foo,bar",
1518 *
1519 * / o kernel fdt2
1520 * |-compatible = "bim,bam", "baz,biz"
1521 *
1522 * Configuration 1 would be picked because the first string in U-Boot's
1523 * compatible list, "foo,bar", matches a compatible string in the root of fdt1.
1524 * "bim,bam" in fdt2 matches the second string which isn't as good as fdt1.
1525 *
1526 * As an optimization, the compatible property from the FDT's root node can be
1527 * copied into the configuration node in the FIT image. This is required to
1528 * match configurations with compressed FDTs.
1529 *
1530 * returns:
1531 * offset to the configuration to use if one was found
1532 * -1 otherwise
1533 */
fit_conf_find_compat(const void * fit,const void * fdt)1534 int fit_conf_find_compat(const void *fit, const void *fdt)
1535 {
1536 int ndepth = 0;
1537 int noffset, confs_noffset, images_noffset;
1538 const void *fdt_compat;
1539 int fdt_compat_len;
1540 int best_match_offset = 0;
1541 int best_match_pos = 0;
1542
1543 confs_noffset = fdt_path_offset(fit, FIT_CONFS_PATH);
1544 images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
1545 if (confs_noffset < 0 || images_noffset < 0) {
1546 debug("Can't find configurations or images nodes.\n");
1547 return -1;
1548 }
1549
1550 fdt_compat = fdt_getprop(fdt, 0, "compatible", &fdt_compat_len);
1551 if (!fdt_compat) {
1552 debug("Fdt for comparison has no \"compatible\" property.\n");
1553 return -1;
1554 }
1555
1556 /*
1557 * Loop over the configurations in the FIT image.
1558 */
1559 for (noffset = fdt_next_node(fit, confs_noffset, &ndepth);
1560 (noffset >= 0) && (ndepth > 0);
1561 noffset = fdt_next_node(fit, noffset, &ndepth)) {
1562 const void *fdt;
1563 const char *kfdt_name;
1564 int kfdt_noffset, compat_noffset;
1565 const char *cur_fdt_compat;
1566 int len;
1567 size_t sz;
1568 int i;
1569
1570 if (ndepth > 1)
1571 continue;
1572
1573 /* If there's a compat property in the config node, use that. */
1574 if (fdt_getprop(fit, noffset, "compatible", NULL)) {
1575 fdt = fit; /* search in FIT image */
1576 compat_noffset = noffset; /* search under config node */
1577 } else { /* Otherwise extract it from the kernel FDT. */
1578 kfdt_name = fdt_getprop(fit, noffset, "fdt", &len);
1579 if (!kfdt_name) {
1580 debug("No fdt property found.\n");
1581 continue;
1582 }
1583 kfdt_noffset = fdt_subnode_offset(fit, images_noffset,
1584 kfdt_name);
1585 if (kfdt_noffset < 0) {
1586 debug("No image node named \"%s\" found.\n",
1587 kfdt_name);
1588 continue;
1589 }
1590
1591 if (!fit_image_check_comp(fit, kfdt_noffset,
1592 IH_COMP_NONE)) {
1593 debug("Can't extract compat from \"%s\" "
1594 "(compressed)\n", kfdt_name);
1595 continue;
1596 }
1597
1598 /* search in this config's kernel FDT */
1599 if (fit_image_get_data(fit, kfdt_noffset, &fdt, &sz)) {
1600 debug("Failed to get fdt \"%s\".\n", kfdt_name);
1601 continue;
1602 }
1603
1604 compat_noffset = 0; /* search kFDT under root node */
1605 }
1606
1607 len = fdt_compat_len;
1608 cur_fdt_compat = fdt_compat;
1609 /*
1610 * Look for a match for each U-Boot compatibility string in
1611 * turn in the compat string property.
1612 */
1613 for (i = 0; len > 0 &&
1614 (!best_match_offset || best_match_pos > i); i++) {
1615 int cur_len = strlen(cur_fdt_compat) + 1;
1616
1617 if (!fdt_node_check_compatible(fdt, compat_noffset,
1618 cur_fdt_compat)) {
1619 best_match_offset = noffset;
1620 best_match_pos = i;
1621 break;
1622 }
1623 len -= cur_len;
1624 cur_fdt_compat += cur_len;
1625 }
1626 }
1627 if (!best_match_offset) {
1628 debug("No match found.\n");
1629 return -1;
1630 }
1631
1632 return best_match_offset;
1633 }
1634
1635 /**
1636 * fit_conf_get_node - get node offset for configuration of a given unit name
1637 * @fit: pointer to the FIT format image header
1638 * @conf_uname: configuration node unit name
1639 *
1640 * fit_conf_get_node() finds a configuration (within the '/configurations'
1641 * parent node) of a provided unit name. If configuration is found its node
1642 * offset is returned to the caller.
1643 *
1644 * When NULL is provided in second argument fit_conf_get_node() will search
1645 * for a default configuration node instead. Default configuration node unit
1646 * name is retrieved from FIT_DEFAULT_PROP property of the '/configurations'
1647 * node.
1648 *
1649 * returns:
1650 * configuration node offset when found (>=0)
1651 * negative number on failure (FDT_ERR_* code)
1652 */
fit_conf_get_node(const void * fit,const char * conf_uname)1653 int fit_conf_get_node(const void *fit, const char *conf_uname)
1654 {
1655 int noffset, confs_noffset;
1656 int len;
1657 const char *s;
1658 char *conf_uname_copy = NULL;
1659
1660 confs_noffset = fdt_path_offset(fit, FIT_CONFS_PATH);
1661 if (confs_noffset < 0) {
1662 debug("Can't find configurations parent node '%s' (%s)\n",
1663 FIT_CONFS_PATH, fdt_strerror(confs_noffset));
1664 return confs_noffset;
1665 }
1666
1667 if (conf_uname == NULL) {
1668 /* get configuration unit name from the default property */
1669 debug("No configuration specified, trying default...\n");
1670 conf_uname = (char *)fdt_getprop(fit, confs_noffset,
1671 FIT_DEFAULT_PROP, &len);
1672 if (conf_uname == NULL) {
1673 fit_get_debug(fit, confs_noffset, FIT_DEFAULT_PROP,
1674 len);
1675 return len;
1676 }
1677 debug("Found default configuration: '%s'\n", conf_uname);
1678 }
1679
1680 s = strchr(conf_uname, '#');
1681 if (s) {
1682 len = s - conf_uname;
1683 conf_uname_copy = malloc(len + 1);
1684 if (!conf_uname_copy) {
1685 debug("Can't allocate uname copy: '%s'\n",
1686 conf_uname);
1687 return -ENOMEM;
1688 }
1689 memcpy(conf_uname_copy, conf_uname, len);
1690 conf_uname_copy[len] = '\0';
1691 conf_uname = conf_uname_copy;
1692 }
1693
1694 noffset = fdt_subnode_offset(fit, confs_noffset, conf_uname);
1695 if (noffset < 0) {
1696 debug("Can't get node offset for configuration unit name: '%s' (%s)\n",
1697 conf_uname, fdt_strerror(noffset));
1698 }
1699
1700 if (conf_uname_copy)
1701 free(conf_uname_copy);
1702
1703 return noffset;
1704 }
1705
fit_conf_get_prop_node_count(const void * fit,int noffset,const char * prop_name)1706 int fit_conf_get_prop_node_count(const void *fit, int noffset,
1707 const char *prop_name)
1708 {
1709 return fdt_stringlist_count(fit, noffset, prop_name);
1710 }
1711
fit_conf_get_prop_node_index(const void * fit,int noffset,const char * prop_name,int index)1712 int fit_conf_get_prop_node_index(const void *fit, int noffset,
1713 const char *prop_name, int index)
1714 {
1715 const char *uname;
1716 int len;
1717
1718 /* get kernel image unit name from configuration kernel property */
1719 uname = fdt_stringlist_get(fit, noffset, prop_name, index, &len);
1720 if (uname == NULL)
1721 return len;
1722
1723 return fit_image_get_node(fit, uname);
1724 }
1725
fit_conf_get_prop_node(const void * fit,int noffset,const char * prop_name)1726 int fit_conf_get_prop_node(const void *fit, int noffset,
1727 const char *prop_name)
1728 {
1729 return fit_conf_get_prop_node_index(fit, noffset, prop_name, 0);
1730 }
1731
fit_image_select(const void * fit,int rd_noffset,int verify)1732 static int fit_image_select(const void *fit, int rd_noffset, int verify)
1733 {
1734 fit_image_print(fit, rd_noffset, " ");
1735
1736 if (verify) {
1737 puts(" Verifying Hash Integrity ... ");
1738 if (!fit_image_verify(fit, rd_noffset)) {
1739 puts("Bad Data Hash\n");
1740 return -EACCES;
1741 }
1742 puts("OK\n");
1743 }
1744
1745 return 0;
1746 }
1747
fit_get_node_from_config(bootm_headers_t * images,const char * prop_name,ulong addr)1748 int fit_get_node_from_config(bootm_headers_t *images, const char *prop_name,
1749 ulong addr)
1750 {
1751 int cfg_noffset;
1752 void *fit_hdr;
1753 int noffset;
1754
1755 debug("* %s: using config '%s' from image at 0x%08lx\n",
1756 prop_name, images->fit_uname_cfg, addr);
1757
1758 /* Check whether configuration has this property defined */
1759 fit_hdr = map_sysmem(addr, 0);
1760 cfg_noffset = fit_conf_get_node(fit_hdr, images->fit_uname_cfg);
1761 if (cfg_noffset < 0) {
1762 debug("* %s: no such config\n", prop_name);
1763 return -EINVAL;
1764 }
1765
1766 noffset = fit_conf_get_prop_node(fit_hdr, cfg_noffset, prop_name);
1767 if (noffset < 0) {
1768 debug("* %s: no '%s' in config\n", prop_name, prop_name);
1769 return -ENOENT;
1770 }
1771
1772 return noffset;
1773 }
1774
1775 /**
1776 * fit_get_image_type_property() - get property name for IH_TYPE_...
1777 *
1778 * @return the properly name where we expect to find the image in the
1779 * config node
1780 */
fit_get_image_type_property(int type)1781 static const char *fit_get_image_type_property(int type)
1782 {
1783 /*
1784 * This is sort-of available in the uimage_type[] table in image.c
1785 * but we don't have access to the short name, and "fdt" is different
1786 * anyway. So let's just keep it here.
1787 */
1788 switch (type) {
1789 case IH_TYPE_FLATDT:
1790 return FIT_FDT_PROP;
1791 case IH_TYPE_KERNEL:
1792 return FIT_KERNEL_PROP;
1793 case IH_TYPE_RAMDISK:
1794 return FIT_RAMDISK_PROP;
1795 case IH_TYPE_X86_SETUP:
1796 return FIT_SETUP_PROP;
1797 case IH_TYPE_LOADABLE:
1798 return FIT_LOADABLE_PROP;
1799 case IH_TYPE_FPGA:
1800 return FIT_FPGA_PROP;
1801 case IH_TYPE_STANDALONE:
1802 return FIT_STANDALONE_PROP;
1803 }
1804
1805 return "unknown";
1806 }
1807
fit_image_load(bootm_headers_t * images,ulong addr,const char ** fit_unamep,const char ** fit_uname_configp,int arch,int image_type,int bootstage_id,enum fit_load_op load_op,ulong * datap,ulong * lenp)1808 int fit_image_load(bootm_headers_t *images, ulong addr,
1809 const char **fit_unamep, const char **fit_uname_configp,
1810 int arch, int image_type, int bootstage_id,
1811 enum fit_load_op load_op, ulong *datap, ulong *lenp)
1812 {
1813 int cfg_noffset, noffset;
1814 const char *fit_uname;
1815 const char *fit_uname_config;
1816 const char *fit_base_uname_config;
1817 const void *fit;
1818 void *buf;
1819 void *loadbuf;
1820 size_t size;
1821 int type_ok, os_ok;
1822 ulong load, load_end, data, len;
1823 uint8_t os, comp;
1824 #ifndef USE_HOSTCC
1825 uint8_t os_arch;
1826 #endif
1827 const char *prop_name;
1828 int ret;
1829
1830 fit = map_sysmem(addr, 0);
1831 fit_uname = fit_unamep ? *fit_unamep : NULL;
1832 fit_uname_config = fit_uname_configp ? *fit_uname_configp : NULL;
1833 fit_base_uname_config = NULL;
1834 prop_name = fit_get_image_type_property(image_type);
1835 printf("## Loading %s from FIT Image at %08lx ...\n", prop_name, addr);
1836
1837 bootstage_mark(bootstage_id + BOOTSTAGE_SUB_FORMAT);
1838 if (!fit_check_format(fit)) {
1839 printf("Bad FIT %s image format!\n", prop_name);
1840 bootstage_error(bootstage_id + BOOTSTAGE_SUB_FORMAT);
1841 return -ENOEXEC;
1842 }
1843 bootstage_mark(bootstage_id + BOOTSTAGE_SUB_FORMAT_OK);
1844 if (fit_uname) {
1845 /* get FIT component image node offset */
1846 bootstage_mark(bootstage_id + BOOTSTAGE_SUB_UNIT_NAME);
1847 noffset = fit_image_get_node(fit, fit_uname);
1848 } else {
1849 /*
1850 * no image node unit name, try to get config
1851 * node first. If config unit node name is NULL
1852 * fit_conf_get_node() will try to find default config node
1853 */
1854 bootstage_mark(bootstage_id + BOOTSTAGE_SUB_NO_UNIT_NAME);
1855 if (IMAGE_ENABLE_BEST_MATCH && !fit_uname_config) {
1856 cfg_noffset = fit_conf_find_compat(fit, gd_fdt_blob());
1857 } else {
1858 cfg_noffset = fit_conf_get_node(fit,
1859 fit_uname_config);
1860 }
1861 if (cfg_noffset < 0) {
1862 puts("Could not find configuration node\n");
1863 bootstage_error(bootstage_id +
1864 BOOTSTAGE_SUB_NO_UNIT_NAME);
1865 return -ENOENT;
1866 }
1867
1868 fit_base_uname_config = fdt_get_name(fit, cfg_noffset, NULL);
1869 printf(" Using '%s' configuration\n", fit_base_uname_config);
1870 /* Remember this config */
1871 if (image_type == IH_TYPE_KERNEL)
1872 images->fit_uname_cfg = fit_base_uname_config;
1873
1874 if (IMAGE_ENABLE_VERIFY && images->verify) {
1875 puts(" Verifying Hash Integrity ... ");
1876 if (fit_config_verify(fit, cfg_noffset)) {
1877 puts("Bad Data Hash\n");
1878 bootstage_error(bootstage_id +
1879 BOOTSTAGE_SUB_HASH);
1880 return -EACCES;
1881 }
1882 puts("OK\n");
1883 }
1884
1885 bootstage_mark(BOOTSTAGE_ID_FIT_CONFIG);
1886
1887 noffset = fit_conf_get_prop_node(fit, cfg_noffset,
1888 prop_name);
1889 fit_uname = fit_get_name(fit, noffset, NULL);
1890 }
1891 if (noffset < 0) {
1892 puts("Could not find subimage node\n");
1893 bootstage_error(bootstage_id + BOOTSTAGE_SUB_SUBNODE);
1894 return -ENOENT;
1895 }
1896
1897 printf(" Trying '%s' %s subimage\n", fit_uname, prop_name);
1898
1899 ret = fit_image_select(fit, noffset, images->verify);
1900 if (ret) {
1901 bootstage_error(bootstage_id + BOOTSTAGE_SUB_HASH);
1902 return ret;
1903 }
1904
1905 bootstage_mark(bootstage_id + BOOTSTAGE_SUB_CHECK_ARCH);
1906 #if !defined(USE_HOSTCC) && !defined(CONFIG_SANDBOX)
1907 if (!fit_image_check_target_arch(fit, noffset)) {
1908 puts("Unsupported Architecture\n");
1909 bootstage_error(bootstage_id + BOOTSTAGE_SUB_CHECK_ARCH);
1910 return -ENOEXEC;
1911 }
1912 #endif
1913
1914 #ifndef USE_HOSTCC
1915 fit_image_get_arch(fit, noffset, &os_arch);
1916 images->os.arch = os_arch;
1917 #endif
1918
1919 bootstage_mark(bootstage_id + BOOTSTAGE_SUB_CHECK_ALL);
1920 type_ok = fit_image_check_type(fit, noffset, image_type) ||
1921 fit_image_check_type(fit, noffset, IH_TYPE_FIRMWARE) ||
1922 (image_type == IH_TYPE_KERNEL &&
1923 fit_image_check_type(fit, noffset, IH_TYPE_KERNEL_NOLOAD));
1924
1925 os_ok = image_type == IH_TYPE_FLATDT ||
1926 image_type == IH_TYPE_FPGA ||
1927 fit_image_check_os(fit, noffset, IH_OS_LINUX) ||
1928 fit_image_check_os(fit, noffset, IH_OS_U_BOOT) ||
1929 fit_image_check_os(fit, noffset, IH_OS_OPENRTOS);
1930
1931 /*
1932 * If either of the checks fail, we should report an error, but
1933 * if the image type is coming from the "loadables" field, we
1934 * don't care what it is
1935 */
1936 if ((!type_ok || !os_ok) && image_type != IH_TYPE_LOADABLE) {
1937 fit_image_get_os(fit, noffset, &os);
1938 printf("No %s %s %s Image\n",
1939 genimg_get_os_name(os),
1940 genimg_get_arch_name(arch),
1941 genimg_get_type_name(image_type));
1942 bootstage_error(bootstage_id + BOOTSTAGE_SUB_CHECK_ALL);
1943 return -EIO;
1944 }
1945
1946 bootstage_mark(bootstage_id + BOOTSTAGE_SUB_CHECK_ALL_OK);
1947
1948 /* get image data address and length */
1949 if (fit_image_get_data_and_size(fit, noffset,
1950 (const void **)&buf, &size)) {
1951 printf("Could not find %s subimage data!\n", prop_name);
1952 bootstage_error(bootstage_id + BOOTSTAGE_SUB_GET_DATA);
1953 return -ENOENT;
1954 }
1955
1956 #if !defined(USE_HOSTCC) && defined(CONFIG_FIT_IMAGE_POST_PROCESS)
1957 /* perform any post-processing on the image data */
1958 board_fit_image_post_process(&buf, &size);
1959 #endif
1960
1961 len = (ulong)size;
1962
1963 bootstage_mark(bootstage_id + BOOTSTAGE_SUB_GET_DATA_OK);
1964
1965 data = map_to_sysmem(buf);
1966 load = data;
1967 if (load_op == FIT_LOAD_IGNORED) {
1968 /* Don't load */
1969 } else if (fit_image_get_load(fit, noffset, &load)) {
1970 if (load_op == FIT_LOAD_REQUIRED) {
1971 printf("Can't get %s subimage load address!\n",
1972 prop_name);
1973 bootstage_error(bootstage_id + BOOTSTAGE_SUB_LOAD);
1974 return -EBADF;
1975 }
1976 } else if (load_op != FIT_LOAD_OPTIONAL_NON_ZERO || load) {
1977 ulong image_start, image_end;
1978
1979 /*
1980 * move image data to the load address,
1981 * make sure we don't overwrite initial image
1982 */
1983 image_start = addr;
1984 image_end = addr + fit_get_size(fit);
1985
1986 load_end = load + len;
1987 if (image_type != IH_TYPE_KERNEL &&
1988 load < image_end && load_end > image_start) {
1989 printf("Error: %s overwritten\n", prop_name);
1990 return -EXDEV;
1991 }
1992
1993 printf(" Loading %s from 0x%08lx to 0x%08lx\n",
1994 prop_name, data, load);
1995 } else {
1996 load = data; /* No load address specified */
1997 }
1998
1999 comp = IH_COMP_NONE;
2000 loadbuf = buf;
2001 /* Kernel images get decompressed later in bootm_load_os(). */
2002 if (!fit_image_get_comp(fit, noffset, &comp) &&
2003 comp != IH_COMP_NONE &&
2004 !(image_type == IH_TYPE_KERNEL ||
2005 image_type == IH_TYPE_KERNEL_NOLOAD ||
2006 image_type == IH_TYPE_RAMDISK)) {
2007 ulong max_decomp_len = len * 20;
2008 if (load == data) {
2009 loadbuf = malloc(max_decomp_len);
2010 load = map_to_sysmem(loadbuf);
2011 } else {
2012 loadbuf = map_sysmem(load, max_decomp_len);
2013 }
2014 if (image_decomp(comp, load, data, image_type,
2015 loadbuf, buf, len, max_decomp_len, &load_end)) {
2016 printf("Error decompressing %s\n", prop_name);
2017
2018 return -ENOEXEC;
2019 }
2020 len = load_end - load;
2021 } else if (load != data) {
2022 loadbuf = map_sysmem(load, len);
2023 memcpy(loadbuf, buf, len);
2024 }
2025
2026 if (image_type == IH_TYPE_RAMDISK && comp != IH_COMP_NONE)
2027 puts("WARNING: 'compression' nodes for ramdisks are deprecated,"
2028 " please fix your .its file!\n");
2029
2030 /* verify that image data is a proper FDT blob */
2031 if (image_type == IH_TYPE_FLATDT && fdt_check_header(loadbuf)) {
2032 puts("Subimage data is not a FDT");
2033 return -ENOEXEC;
2034 }
2035
2036 bootstage_mark(bootstage_id + BOOTSTAGE_SUB_LOAD);
2037
2038 *datap = load;
2039 *lenp = len;
2040 if (fit_unamep)
2041 *fit_unamep = (char *)fit_uname;
2042 if (fit_uname_configp)
2043 *fit_uname_configp = (char *)(fit_uname_config ? :
2044 fit_base_uname_config);
2045
2046 return noffset;
2047 }
2048
boot_get_setup_fit(bootm_headers_t * images,uint8_t arch,ulong * setup_start,ulong * setup_len)2049 int boot_get_setup_fit(bootm_headers_t *images, uint8_t arch,
2050 ulong *setup_start, ulong *setup_len)
2051 {
2052 int noffset;
2053 ulong addr;
2054 ulong len;
2055 int ret;
2056
2057 addr = map_to_sysmem(images->fit_hdr_os);
2058 noffset = fit_get_node_from_config(images, FIT_SETUP_PROP, addr);
2059 if (noffset < 0)
2060 return noffset;
2061
2062 ret = fit_image_load(images, addr, NULL, NULL, arch,
2063 IH_TYPE_X86_SETUP, BOOTSTAGE_ID_FIT_SETUP_START,
2064 FIT_LOAD_REQUIRED, setup_start, &len);
2065
2066 return ret;
2067 }
2068
2069 #ifndef USE_HOSTCC
boot_get_fdt_fit(bootm_headers_t * images,ulong addr,const char ** fit_unamep,const char ** fit_uname_configp,int arch,ulong * datap,ulong * lenp)2070 int boot_get_fdt_fit(bootm_headers_t *images, ulong addr,
2071 const char **fit_unamep, const char **fit_uname_configp,
2072 int arch, ulong *datap, ulong *lenp)
2073 {
2074 int fdt_noffset, cfg_noffset, count;
2075 const void *fit;
2076 const char *fit_uname = NULL;
2077 const char *fit_uname_config = NULL;
2078 char *fit_uname_config_copy = NULL;
2079 char *next_config = NULL;
2080 ulong load, len;
2081 #ifdef CONFIG_OF_LIBFDT_OVERLAY
2082 ulong image_start, image_end;
2083 ulong ovload, ovlen;
2084 const char *uconfig;
2085 const char *uname;
2086 void *base, *ov;
2087 int i, err, noffset, ov_noffset;
2088 #endif
2089
2090 fit_uname = fit_unamep ? *fit_unamep : NULL;
2091
2092 if (fit_uname_configp && *fit_uname_configp) {
2093 fit_uname_config_copy = strdup(*fit_uname_configp);
2094 if (!fit_uname_config_copy)
2095 return -ENOMEM;
2096
2097 next_config = strchr(fit_uname_config_copy, '#');
2098 if (next_config)
2099 *next_config++ = '\0';
2100 if (next_config - 1 > fit_uname_config_copy)
2101 fit_uname_config = fit_uname_config_copy;
2102 }
2103
2104 fdt_noffset = fit_image_load(images,
2105 addr, &fit_uname, &fit_uname_config,
2106 arch, IH_TYPE_FLATDT,
2107 BOOTSTAGE_ID_FIT_FDT_START,
2108 FIT_LOAD_OPTIONAL, &load, &len);
2109
2110 if (fdt_noffset < 0)
2111 goto out;
2112
2113 debug("fit_uname=%s, fit_uname_config=%s\n",
2114 fit_uname ? fit_uname : "<NULL>",
2115 fit_uname_config ? fit_uname_config : "<NULL>");
2116
2117 fit = map_sysmem(addr, 0);
2118
2119 cfg_noffset = fit_conf_get_node(fit, fit_uname_config);
2120
2121 /* single blob, or error just return as well */
2122 count = fit_conf_get_prop_node_count(fit, cfg_noffset, FIT_FDT_PROP);
2123 if (count <= 1 && !next_config)
2124 goto out;
2125
2126 /* we need to apply overlays */
2127
2128 #ifdef CONFIG_OF_LIBFDT_OVERLAY
2129 image_start = addr;
2130 image_end = addr + fit_get_size(fit);
2131 /* verify that relocation took place by load address not being in fit */
2132 if (load >= image_start && load < image_end) {
2133 /* check is simplified; fit load checks for overlaps */
2134 printf("Overlayed FDT requires relocation\n");
2135 fdt_noffset = -EBADF;
2136 goto out;
2137 }
2138
2139 base = map_sysmem(load, len);
2140
2141 /* apply extra configs in FIT first, followed by args */
2142 for (i = 1; ; i++) {
2143 if (i < count) {
2144 noffset = fit_conf_get_prop_node_index(fit, cfg_noffset,
2145 FIT_FDT_PROP, i);
2146 uname = fit_get_name(fit, noffset, NULL);
2147 uconfig = NULL;
2148 } else {
2149 if (!next_config)
2150 break;
2151 uconfig = next_config;
2152 next_config = strchr(next_config, '#');
2153 if (next_config)
2154 *next_config++ = '\0';
2155 uname = NULL;
2156
2157 /*
2158 * fit_image_load() would load the first FDT from the
2159 * extra config only when uconfig is specified.
2160 * Check if the extra config contains multiple FDTs and
2161 * if so, load them.
2162 */
2163 cfg_noffset = fit_conf_get_node(fit, uconfig);
2164
2165 i = 0;
2166 count = fit_conf_get_prop_node_count(fit, cfg_noffset,
2167 FIT_FDT_PROP);
2168 }
2169
2170 debug("%d: using uname=%s uconfig=%s\n", i, uname, uconfig);
2171
2172 ov_noffset = fit_image_load(images,
2173 addr, &uname, &uconfig,
2174 arch, IH_TYPE_FLATDT,
2175 BOOTSTAGE_ID_FIT_FDT_START,
2176 FIT_LOAD_REQUIRED, &ovload, &ovlen);
2177 if (ov_noffset < 0) {
2178 printf("load of %s failed\n", uname);
2179 continue;
2180 }
2181 debug("%s loaded at 0x%08lx len=0x%08lx\n",
2182 uname, ovload, ovlen);
2183 ov = map_sysmem(ovload, ovlen);
2184
2185 base = map_sysmem(load, len + ovlen);
2186 err = fdt_open_into(base, base, len + ovlen);
2187 if (err < 0) {
2188 printf("failed on fdt_open_into\n");
2189 fdt_noffset = err;
2190 goto out;
2191 }
2192 /* the verbose method prints out messages on error */
2193 err = fdt_overlay_apply_verbose(base, ov);
2194 if (err < 0) {
2195 fdt_noffset = err;
2196 goto out;
2197 }
2198 fdt_pack(base);
2199 len = fdt_totalsize(base);
2200 }
2201 #else
2202 printf("config with overlays but CONFIG_OF_LIBFDT_OVERLAY not set\n");
2203 fdt_noffset = -EBADF;
2204 #endif
2205
2206 out:
2207 if (datap)
2208 *datap = load;
2209 if (lenp)
2210 *lenp = len;
2211 if (fit_unamep)
2212 *fit_unamep = fit_uname;
2213 if (fit_uname_configp)
2214 *fit_uname_configp = fit_uname_config;
2215
2216 if (fit_uname_config_copy)
2217 free(fit_uname_config_copy);
2218 return fdt_noffset;
2219 }
2220 #endif
2221