X-Git-Url: https://git.sur5r.net/?a=blobdiff_plain;f=common%2Fimage.c;h=91954ac54b8ab2ab2ed37c0dfe5d8aae46c5d245;hb=7ee411071f31c856107e6b29fcd8df53ae4d7349;hp=6d2ce32e7d4165bd1cc04164c46d81ab4a0e88d2;hpb=b315ad8f0aa0cf68ccc895d41c933d777fdaba8e;p=u-boot diff --git a/common/image.c b/common/image.c index 6d2ce32e7d..91954ac54b 100644 --- a/common/image.c +++ b/common/image.c @@ -45,7 +45,7 @@ #include -#if defined(CONFIG_FIT) || defined (CONFIG_OF_LIBFDT) +#if defined(CONFIG_FIT) || defined(CONFIG_OF_LIBFDT) #include #include #include @@ -55,17 +55,17 @@ #include #include -static int fit_check_ramdisk (const void *fit, int os_noffset, +static int fit_check_ramdisk(const void *fit, int os_noffset, uint8_t arch, int verify); #endif #ifdef CONFIG_CMD_BDI -extern int do_bdinfo(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]); +extern int do_bdinfo(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]); #endif DECLARE_GLOBAL_DATA_PTR; -static image_header_t* image_get_ramdisk (ulong rd_addr, uint8_t arch, +static const image_header_t *image_get_ramdisk(ulong rd_addr, uint8_t arch, int verify); #else #include "mkimage.h" @@ -74,13 +74,7 @@ static image_header_t* image_get_ramdisk (ulong rd_addr, uint8_t arch, #include #endif /* !USE_HOSTCC*/ -typedef struct table_entry { - int id; /* as defined in image.h */ - char *sname; /* short (input) name */ - char *lname; /* long (output) name */ -} table_entry_t; - -static table_entry_t uimage_arch[] = { +static const table_entry_t uimage_arch[] = { { IH_ARCH_INVALID, NULL, "Invalid ARCH", }, { IH_ARCH_ALPHA, "alpha", "Alpha", }, { IH_ARCH_ARM, "arm", "ARM", }, @@ -90,7 +84,6 @@ static table_entry_t uimage_arch[] = { { IH_ARCH_MICROBLAZE, "microblaze", "MicroBlaze", }, { IH_ARCH_MIPS, "mips", "MIPS", }, { IH_ARCH_MIPS64, "mips64", "MIPS 64 Bit", }, - { IH_ARCH_NIOS, "nios", "NIOS", }, { IH_ARCH_NIOS2, "nios2", "NIOS II", }, { IH_ARCH_PPC, "powerpc", "PowerPC", }, { IH_ARCH_PPC, "ppc", "PowerPC", }, @@ -100,25 +93,28 @@ static table_entry_t uimage_arch[] = { { IH_ARCH_SPARC64, "sparc64", "SPARC 64 Bit", }, { IH_ARCH_BLACKFIN, "blackfin", "Blackfin", }, { IH_ARCH_AVR32, "avr32", "AVR32", }, + { IH_ARCH_NDS32, "nds32", "NDS32", }, + { IH_ARCH_OPENRISC, "or1k", "OpenRISC 1000",}, { -1, "", "", }, }; -static table_entry_t uimage_os[] = { +static const table_entry_t uimage_os[] = { { IH_OS_INVALID, NULL, "Invalid OS", }, -#if defined(CONFIG_ARTOS) || defined(USE_HOSTCC) - { IH_OS_ARTOS, "artos", "ARTOS", }, -#endif { IH_OS_LINUX, "linux", "Linux", }, #if defined(CONFIG_LYNXKDI) || defined(USE_HOSTCC) { IH_OS_LYNXOS, "lynxos", "LynxOS", }, #endif { IH_OS_NETBSD, "netbsd", "NetBSD", }, + { IH_OS_OSE, "ose", "Enea OSE", }, { IH_OS_RTEMS, "rtems", "RTEMS", }, { IH_OS_U_BOOT, "u-boot", "U-Boot", }, #if defined(CONFIG_CMD_ELF) || defined(USE_HOSTCC) { IH_OS_QNX, "qnx", "QNX", }, { IH_OS_VXWORKS, "vxworks", "VxWorks", }, #endif +#if defined(CONFIG_INTEGRITY) || defined(USE_HOSTCC) + { IH_OS_INTEGRITY,"integrity", "INTEGRITY", }, +#endif #ifdef USE_HOSTCC { IH_OS_4_4BSD, "4_4bsd", "4_4BSD", }, { IH_OS_DELL, "dell", "Dell", }, @@ -135,58 +131,65 @@ static table_entry_t uimage_os[] = { { -1, "", "", }, }; -static table_entry_t uimage_type[] = { - { IH_TYPE_INVALID, NULL, "Invalid Image", }, +static const table_entry_t uimage_type[] = { + { IH_TYPE_AISIMAGE, "aisimage", "Davinci AIS image",}, { IH_TYPE_FILESYSTEM, "filesystem", "Filesystem Image", }, { IH_TYPE_FIRMWARE, "firmware", "Firmware", }, + { IH_TYPE_FLATDT, "flat_dt", "Flat Device Tree", }, { IH_TYPE_KERNEL, "kernel", "Kernel Image", }, + { IH_TYPE_KERNEL_NOLOAD, "kernel_noload", "Kernel Image (no loading done)", }, + { IH_TYPE_KWBIMAGE, "kwbimage", "Kirkwood Boot Image",}, + { IH_TYPE_IMXIMAGE, "imximage", "Freescale i.MX Boot Image",}, + { IH_TYPE_INVALID, NULL, "Invalid Image", }, { IH_TYPE_MULTI, "multi", "Multi-File Image", }, + { IH_TYPE_OMAPIMAGE, "omapimage", "TI OMAP SPL With GP CH",}, { IH_TYPE_RAMDISK, "ramdisk", "RAMDisk Image", }, { IH_TYPE_SCRIPT, "script", "Script", }, { IH_TYPE_STANDALONE, "standalone", "Standalone Program", }, - { IH_TYPE_FLATDT, "flat_dt", "Flat Device Tree", }, + { IH_TYPE_UBLIMAGE, "ublimage", "Davinci UBL image",}, { -1, "", "", }, }; -static table_entry_t uimage_comp[] = { +static const table_entry_t uimage_comp[] = { { IH_COMP_NONE, "none", "uncompressed", }, { IH_COMP_BZIP2, "bzip2", "bzip2 compressed", }, { IH_COMP_GZIP, "gzip", "gzip compressed", }, + { IH_COMP_LZMA, "lzma", "lzma compressed", }, + { IH_COMP_LZO, "lzo", "lzo compressed", }, { -1, "", "", }, }; -uint32_t crc32 (uint32_t, const unsigned char *, uint); -uint32_t crc32_wd (uint32_t, const unsigned char *, uint, uint); -static void genimg_print_size (uint32_t size); +uint32_t crc32(uint32_t, const unsigned char *, uint); +uint32_t crc32_wd(uint32_t, const unsigned char *, uint, uint); #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE) || defined(USE_HOSTCC) -static void genimg_print_time (time_t timestamp); +static void genimg_print_time(time_t timestamp); #endif /*****************************************************************************/ /* Legacy format routines */ /*****************************************************************************/ -int image_check_hcrc (image_header_t *hdr) +int image_check_hcrc(const image_header_t *hdr) { ulong hcrc; - ulong len = image_get_header_size (); + ulong len = image_get_header_size(); image_header_t header; /* Copy header so we can blank CRC field for re-calculation */ - memmove (&header, (char *)hdr, image_get_header_size ()); - image_set_hcrc (&header, 0); + memmove(&header, (char *)hdr, image_get_header_size()); + image_set_hcrc(&header, 0); - hcrc = crc32 (0, (unsigned char *)&header, len); + hcrc = crc32(0, (unsigned char *)&header, len); - return (hcrc == image_get_hcrc (hdr)); + return (hcrc == image_get_hcrc(hdr)); } -int image_check_dcrc (image_header_t *hdr) +int image_check_dcrc(const image_header_t *hdr) { - ulong data = image_get_data (hdr); - ulong len = image_get_data_size (hdr); - ulong dcrc = crc32_wd (0, (unsigned char *)data, len, CHUNKSZ_CRC32); + ulong data = image_get_data(hdr); + ulong len = image_get_data_size(hdr); + ulong dcrc = crc32_wd(0, (unsigned char *)data, len, CHUNKSZ_CRC32); - return (dcrc == image_get_dcrc (hdr)); + return (dcrc == image_get_dcrc(hdr)); } /** @@ -202,14 +205,14 @@ int image_check_dcrc (image_header_t *hdr) * returns: * number of components */ -ulong image_multi_count (image_header_t *hdr) +ulong image_multi_count(const image_header_t *hdr) { ulong i, count = 0; uint32_t *size; /* get start of the image payload, which in case of multi * component images that points to a table of component sizes */ - size = (uint32_t *)image_get_data (hdr); + size = (uint32_t *)image_get_data(hdr); /* count non empty slots */ for (i = 0; size[i]; ++i) @@ -235,7 +238,7 @@ ulong image_multi_count (image_header_t *hdr) * data address and size of the component, if idx is valid * 0 in data and len, if idx is out of range */ -void image_multi_getimg (image_header_t *hdr, ulong idx, +void image_multi_getimg(const image_header_t *hdr, ulong idx, ulong *data, ulong *len) { int i; @@ -243,24 +246,24 @@ void image_multi_getimg (image_header_t *hdr, ulong idx, ulong offset, count, img_data; /* get number of component */ - count = image_multi_count (hdr); + count = image_multi_count(hdr); /* get start of the image payload, which in case of multi * component images that points to a table of component sizes */ - size = (uint32_t *)image_get_data (hdr); + size = (uint32_t *)image_get_data(hdr); /* get address of the proper component data start, which means * skipping sizes table (add 1 for last, null entry) */ - img_data = image_get_data (hdr) + (count + 1) * sizeof (uint32_t); + img_data = image_get_data(hdr) + (count + 1) * sizeof(uint32_t); if (idx < count) { - *len = uimage_to_cpu (size[idx]); + *len = uimage_to_cpu(size[idx]); offset = 0; /* go over all indices preceding requested component idx */ for (i = 0; i < idx; i++) { /* add up i-th component size, rounding up to 4 bytes */ - offset += (uimage_to_cpu (size[i]) + 3) & ~3 ; + offset += (uimage_to_cpu(size[i]) + 3) & ~3 ; } /* calculate idx-th component data address */ @@ -271,21 +274,21 @@ void image_multi_getimg (image_header_t *hdr, ulong idx, } } -static void image_print_type (image_header_t *hdr) +static void image_print_type(const image_header_t *hdr) { const char *os, *arch, *type, *comp; - os = genimg_get_os_name (image_get_os (hdr)); - arch = genimg_get_arch_name (image_get_arch (hdr)); - type = genimg_get_type_name (image_get_type (hdr)); - comp = genimg_get_comp_name (image_get_comp (hdr)); + os = genimg_get_os_name(image_get_os(hdr)); + arch = genimg_get_arch_name(image_get_arch(hdr)); + type = genimg_get_type_name(image_get_type(hdr)); + comp = genimg_get_comp_name(image_get_comp(hdr)); - printf ("%s %s %s (%s)\n", arch, os, type, comp); + printf("%s %s %s (%s)\n", arch, os, type, comp); } /** * image_print_contents - prints out the contents of the legacy format image - * @hdr: pointer to the legacy format image header + * @ptr: pointer to the legacy format image header * @p: pointer to prefix string * * image_print_contents() formats a multi line legacy image contents description. @@ -295,8 +298,9 @@ static void image_print_type (image_header_t *hdr) * returns: * no returned results */ -void image_print_contents (image_header_t *hdr) +void image_print_contents(const void *ptr) { + const image_header_t *hdr = (const image_header_t *)ptr; const char *p; #ifdef USE_HOSTCC @@ -305,38 +309,38 @@ void image_print_contents (image_header_t *hdr) p = " "; #endif - printf ("%sImage Name: %.*s\n", p, IH_NMLEN, image_get_name (hdr)); + printf("%sImage Name: %.*s\n", p, IH_NMLEN, image_get_name(hdr)); #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE) || defined(USE_HOSTCC) - printf ("%sCreated: ", p); - genimg_print_time ((time_t)image_get_time (hdr)); + printf("%sCreated: ", p); + genimg_print_time((time_t)image_get_time(hdr)); #endif - printf ("%sImage Type: ", p); - image_print_type (hdr); - printf ("%sData Size: ", p); - genimg_print_size (image_get_data_size (hdr)); - printf ("%sLoad Address: %08x\n", p, image_get_load (hdr)); - printf ("%sEntry Point: %08x\n", p, image_get_ep (hdr)); - - if (image_check_type (hdr, IH_TYPE_MULTI) || - image_check_type (hdr, IH_TYPE_SCRIPT)) { + printf("%sImage Type: ", p); + image_print_type(hdr); + printf("%sData Size: ", p); + genimg_print_size(image_get_data_size(hdr)); + printf("%sLoad Address: %08x\n", p, image_get_load(hdr)); + printf("%sEntry Point: %08x\n", p, image_get_ep(hdr)); + + if (image_check_type(hdr, IH_TYPE_MULTI) || + image_check_type(hdr, IH_TYPE_SCRIPT)) { int i; ulong data, len; - ulong count = image_multi_count (hdr); + ulong count = image_multi_count(hdr); - printf ("%sContents:\n", p); + printf("%sContents:\n", p); for (i = 0; i < count; i++) { - image_multi_getimg (hdr, i, &data, &len); + image_multi_getimg(hdr, i, &data, &len); - printf ("%s Image %d: ", p, i); - genimg_print_size (len); + printf("%s Image %d: ", p, i); + genimg_print_size(len); - if (image_check_type (hdr, IH_TYPE_SCRIPT) && i > 0) { + if (image_check_type(hdr, IH_TYPE_SCRIPT) && i > 0) { /* * the user may need to know offsets * if planning to do something with * multiple files */ - printf ("%s Offset = 0x%08lx\n", p, data); + printf("%s Offset = 0x%08lx\n", p, data); } } } @@ -362,44 +366,44 @@ void image_print_contents (image_header_t *hdr) * pointer to a ramdisk image header, if image was found and valid * otherwise, return NULL */ -static image_header_t* image_get_ramdisk (ulong rd_addr, uint8_t arch, +static const image_header_t *image_get_ramdisk(ulong rd_addr, uint8_t arch, int verify) { - image_header_t *rd_hdr = (image_header_t *)rd_addr; + const image_header_t *rd_hdr = (const image_header_t *)rd_addr; - if (!image_check_magic (rd_hdr)) { - puts ("Bad Magic Number\n"); - show_boot_progress (-10); + if (!image_check_magic(rd_hdr)) { + puts("Bad Magic Number\n"); + bootstage_error(BOOTSTAGE_ID_RD_MAGIC); return NULL; } - if (!image_check_hcrc (rd_hdr)) { - puts ("Bad Header Checksum\n"); - show_boot_progress (-11); + if (!image_check_hcrc(rd_hdr)) { + puts("Bad Header Checksum\n"); + bootstage_error(BOOTSTAGE_ID_RD_HDR_CHECKSUM); return NULL; } - show_boot_progress (10); - image_print_contents (rd_hdr); + bootstage_mark(BOOTSTAGE_ID_RD_MAGIC); + image_print_contents(rd_hdr); if (verify) { puts(" Verifying Checksum ... "); - if (!image_check_dcrc (rd_hdr)) { - puts ("Bad Data CRC\n"); - show_boot_progress (-12); + if (!image_check_dcrc(rd_hdr)) { + puts("Bad Data CRC\n"); + bootstage_error(BOOTSTAGE_ID_RD_CHECKSUM); return NULL; } puts("OK\n"); } - show_boot_progress (11); + bootstage_mark(BOOTSTAGE_ID_RD_HDR_CHECKSUM); - if (!image_check_os (rd_hdr, IH_OS_LINUX) || - !image_check_arch (rd_hdr, arch) || - !image_check_type (rd_hdr, IH_TYPE_RAMDISK)) { - printf ("No Linux %s Ramdisk Image\n", + if (!image_check_os(rd_hdr, IH_OS_LINUX) || + !image_check_arch(rd_hdr, arch) || + !image_check_type(rd_hdr, IH_TYPE_RAMDISK)) { + printf("No Linux %s Ramdisk Image\n", genimg_get_arch_name(arch)); - show_boot_progress (-13); + bootstage_error(BOOTSTAGE_ID_RAMDISK); return NULL; } @@ -411,22 +415,22 @@ static image_header_t* image_get_ramdisk (ulong rd_addr, uint8_t arch, /* Shared dual-format routines */ /*****************************************************************************/ #ifndef USE_HOSTCC -int getenv_yesno (char *var) +int getenv_yesno(char *var) { - char *s = getenv (var); + char *s = getenv(var); return (s && (*s == 'n')) ? 0 : 1; } ulong getenv_bootm_low(void) { - char *s = getenv ("bootm_low"); + char *s = getenv("bootm_low"); if (s) { - ulong tmp = simple_strtoul (s, NULL, 16); + ulong tmp = simple_strtoul(s, NULL, 16); return tmp; } -#if defined(CFG_SDRAM_BASE) - return CFG_SDRAM_BASE; +#if defined(CONFIG_SYS_SDRAM_BASE) + return CONFIG_SYS_SDRAM_BASE; #elif defined(CONFIG_ARM) return gd->bd->bi_dram[0].start; #else @@ -436,65 +440,86 @@ ulong getenv_bootm_low(void) phys_size_t getenv_bootm_size(void) { - char *s = getenv ("bootm_size"); + phys_size_t tmp; + char *s = getenv("bootm_size"); if (s) { - phys_size_t tmp; -#ifdef CFG_64BIT_STRTOUL - tmp = (phys_size_t)simple_strtoull (s, NULL, 16); + tmp = (phys_size_t)simple_strtoull(s, NULL, 16); + return tmp; + } + s = getenv("bootm_low"); + if (s) + tmp = (phys_size_t)simple_strtoull(s, NULL, 16); + else + tmp = 0; + + +#if defined(CONFIG_ARM) + return gd->bd->bi_dram[0].size - tmp; #else - tmp = (phys_size_t)simple_strtoul (s, NULL, 16); + return gd->bd->bi_memsize - tmp; #endif +} + +phys_size_t getenv_bootm_mapsize(void) +{ + phys_size_t tmp; + char *s = getenv("bootm_mapsize"); + if (s) { + tmp = (phys_size_t)simple_strtoull(s, NULL, 16); return tmp; } -#if defined(CONFIG_ARM) - return gd->bd->bi_dram[0].size; +#if defined(CONFIG_SYS_BOOTMAPSZ) + return CONFIG_SYS_BOOTMAPSZ; #else - return gd->bd->bi_memsize; + return getenv_bootm_size(); #endif } -void memmove_wd (void *to, void *from, size_t len, ulong chunksz) +void memmove_wd(void *to, void *from, size_t len, ulong chunksz) { + if (to == from) + return; + #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG) while (len > 0) { size_t tail = (len > chunksz) ? chunksz : len; - WATCHDOG_RESET (); - memmove (to, from, tail); + WATCHDOG_RESET(); + memmove(to, from, tail); to += tail; from += tail; len -= tail; } #else /* !(CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG) */ - memmove (to, from, len); + memmove(to, from, len); #endif /* CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG */ } #endif /* !USE_HOSTCC */ -static void genimg_print_size (uint32_t size) +void genimg_print_size(uint32_t size) { #ifndef USE_HOSTCC - printf ("%d Bytes = ", size); - print_size (size, "\n"); + printf("%d Bytes = ", size); + print_size(size, "\n"); #else - printf ("%d Bytes = %.2f kB = %.2f MB\n", + printf("%d Bytes = %.2f kB = %.2f MB\n", size, (double)size / 1.024e3, (double)size / 1.048576e6); #endif } #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE) || defined(USE_HOSTCC) -static void genimg_print_time (time_t timestamp) +static void genimg_print_time(time_t timestamp) { #ifndef USE_HOSTCC struct rtc_time tm; - to_tm (timestamp, &tm); - printf ("%4d-%02d-%02d %2d:%02d:%02d UTC\n", + to_tm(timestamp, &tm); + printf("%4d-%02d-%02d %2d:%02d:%02d UTC\n", tm.tm_year, tm.tm_mon, tm.tm_mday, tm.tm_hour, tm.tm_min, tm.tm_sec); #else - printf ("%s", ctime(×tamp)); + printf("%s", ctime(×tamp)); #endif } #endif /* CONFIG_TIMESTAMP || CONFIG_CMD_DATE || USE_HOSTCC */ @@ -513,33 +538,39 @@ static void genimg_print_time (time_t timestamp) * long entry name if translation succeeds * msg otherwise */ -static char *get_table_entry_name (table_entry_t *table, char *msg, int id) +char *get_table_entry_name(const table_entry_t *table, char *msg, int id) { for (; table->id >= 0; ++table) { if (table->id == id) - return (table->lname); +#if defined(USE_HOSTCC) || !defined(CONFIG_NEEDS_MANUAL_RELOC) + return table->lname; +#else + return table->lname + gd->reloc_off; +#endif } return (msg); } -const char *genimg_get_os_name (uint8_t os) +const char *genimg_get_os_name(uint8_t os) { - return (get_table_entry_name (uimage_os, "Unknown OS", os)); + return (get_table_entry_name(uimage_os, "Unknown OS", os)); } -const char *genimg_get_arch_name (uint8_t arch) +const char *genimg_get_arch_name(uint8_t arch) { - return (get_table_entry_name (uimage_arch, "Unknown Architecture", arch)); + return (get_table_entry_name(uimage_arch, "Unknown Architecture", + arch)); } -const char *genimg_get_type_name (uint8_t type) +const char *genimg_get_type_name(uint8_t type) { - return (get_table_entry_name (uimage_type, "Unknown Image", type)); + return (get_table_entry_name(uimage_type, "Unknown Image", type)); } -const char *genimg_get_comp_name (uint8_t comp) +const char *genimg_get_comp_name(uint8_t comp) { - return (get_table_entry_name (uimage_comp, "Unknown Compression", comp)); + return (get_table_entry_name(uimage_comp, "Unknown Compression", + comp)); } /** @@ -556,54 +587,58 @@ const char *genimg_get_comp_name (uint8_t comp) * entry id if translation succeeds * -1 otherwise */ -static int get_table_entry_id (table_entry_t *table, +int get_table_entry_id(const table_entry_t *table, const char *table_name, const char *name) { - table_entry_t *t; + const table_entry_t *t; #ifdef USE_HOSTCC int first = 1; for (t = table; t->id >= 0; ++t) { if (t->sname && strcasecmp(t->sname, name) == 0) - return (t->id); + return(t->id); } - fprintf (stderr, "\nInvalid %s Type - valid names are", table_name); + fprintf(stderr, "\nInvalid %s Type - valid names are", table_name); for (t = table; t->id >= 0; ++t) { if (t->sname == NULL) continue; - fprintf (stderr, "%c %s", (first) ? ':' : ',', t->sname); + fprintf(stderr, "%c %s", (first) ? ':' : ',', t->sname); first = 0; } - fprintf (stderr, "\n"); + fprintf(stderr, "\n"); #else for (t = table; t->id >= 0; ++t) { +#ifdef CONFIG_NEEDS_MANUAL_RELOC + if (t->sname && strcmp(t->sname + gd->reloc_off, name) == 0) +#else if (t->sname && strcmp(t->sname, name) == 0) +#endif return (t->id); } - debug ("Invalid %s Type: %s\n", table_name, name); + debug("Invalid %s Type: %s\n", table_name, name); #endif /* USE_HOSTCC */ return (-1); } -int genimg_get_os_id (const char *name) +int genimg_get_os_id(const char *name) { - return (get_table_entry_id (uimage_os, "OS", name)); + return (get_table_entry_id(uimage_os, "OS", name)); } -int genimg_get_arch_id (const char *name) +int genimg_get_arch_id(const char *name) { - return (get_table_entry_id (uimage_arch, "CPU", name)); + return (get_table_entry_id(uimage_arch, "CPU", name)); } -int genimg_get_type_id (const char *name) +int genimg_get_type_id(const char *name) { - return (get_table_entry_id (uimage_type, "Image", name)); + return (get_table_entry_id(uimage_type, "Image", name)); } -int genimg_get_comp_id (const char *name) +int genimg_get_comp_id(const char *name) { - return (get_table_entry_id (uimage_comp, "Compression", name)); + return (get_table_entry_id(uimage_comp, "Compression", name)); } #ifndef USE_HOSTCC @@ -621,21 +656,21 @@ int genimg_get_comp_id (const char *name) * returns: * image format type or IMAGE_FORMAT_INVALID if no image is present */ -int genimg_get_format (void *img_addr) +int genimg_get_format(void *img_addr) { - ulong format = IMAGE_FORMAT_INVALID; - image_header_t *hdr; + ulong format = IMAGE_FORMAT_INVALID; + const image_header_t *hdr; #if defined(CONFIG_FIT) || defined(CONFIG_OF_LIBFDT) - char *fit_hdr; + char *fit_hdr; #endif - hdr = (image_header_t *)img_addr; + hdr = (const image_header_t *)img_addr; if (image_check_magic(hdr)) format = IMAGE_FORMAT_LEGACY; #if defined(CONFIG_FIT) || defined(CONFIG_OF_LIBFDT) else { fit_hdr = (char *)img_addr; - if (fdt_check_header (fit_hdr) == 0) + if (fdt_check_header(fit_hdr) == 0) format = IMAGE_FORMAT_FIT; } #endif @@ -653,55 +688,59 @@ int genimg_get_format (void *img_addr) * returns: * image start address after possible relocation from special storage */ -ulong genimg_get_image (ulong img_addr) +ulong genimg_get_image(ulong img_addr) { ulong ram_addr = img_addr; #ifdef CONFIG_HAS_DATAFLASH ulong h_size, d_size; - if (addr_dataflash (img_addr)){ + if (addr_dataflash(img_addr)) { /* ger RAM address */ - ram_addr = CFG_LOAD_ADDR; + ram_addr = CONFIG_SYS_LOAD_ADDR; /* get header size */ - h_size = image_get_header_size (); + h_size = image_get_header_size(); #if defined(CONFIG_FIT) if (sizeof(struct fdt_header) > h_size) h_size = sizeof(struct fdt_header); #endif /* read in header */ - debug (" Reading image header from dataflash address " + debug(" Reading image header from dataflash address " "%08lx to RAM address %08lx\n", img_addr, ram_addr); - read_dataflash (img_addr, h_size, (char *)ram_addr); + read_dataflash(img_addr, h_size, (char *)ram_addr); /* get data size */ - switch (genimg_get_format ((void *)ram_addr)) { + switch (genimg_get_format((void *)ram_addr)) { case IMAGE_FORMAT_LEGACY: - d_size = image_get_data_size ((image_header_t *)ram_addr); - debug (" Legacy format image found at 0x%08lx, size 0x%08lx\n", + d_size = image_get_data_size( + (const image_header_t *)ram_addr); + debug(" Legacy format image found at 0x%08lx, " + "size 0x%08lx\n", ram_addr, d_size); break; #if defined(CONFIG_FIT) case IMAGE_FORMAT_FIT: - d_size = fit_get_size ((const void *)ram_addr) - h_size; - debug (" FIT/FDT format image found at 0x%08lx, size 0x%08lx\n", + d_size = fit_get_size((const void *)ram_addr) - h_size; + debug(" FIT/FDT format image found at 0x%08lx, " + "size 0x%08lx\n", ram_addr, d_size); break; #endif default: - printf (" No valid image found at 0x%08lx\n", img_addr); + printf(" No valid image found at 0x%08lx\n", + img_addr); return ram_addr; } /* read in image data */ - debug (" Reading image remaining data from dataflash address " + debug(" Reading image remaining data from dataflash address " "%08lx to RAM address %08lx\n", img_addr + h_size, ram_addr + h_size); - read_dataflash (img_addr + h_size, d_size, + read_dataflash(img_addr + h_size, d_size, (char *)(ram_addr + h_size)); } @@ -721,7 +760,7 @@ ulong genimg_get_image (ulong img_addr) * 0, no FIT support or no configuration found * 1, configuration found */ -int genimg_has_config (bootm_headers_t *images) +int genimg_has_config(bootm_headers_t *images) { #if defined(CONFIG_FIT) if (images->fit_uname_cfg) @@ -749,15 +788,18 @@ int genimg_has_config (bootm_headers_t *images) * rd_start and rd_end are set to ramdisk start/end addresses if * ramdisk image is found and valid * - * 1, if ramdisk image is found but corrupted + * 1, if ramdisk image is found but corrupted, or invalid * rd_start and rd_end are set to 0 if no ramdisk exists */ -int boot_get_ramdisk (int argc, char *argv[], bootm_headers_t *images, +int boot_get_ramdisk(int argc, char * const argv[], bootm_headers_t *images, uint8_t arch, ulong *rd_start, ulong *rd_end) { ulong rd_addr, rd_load; ulong rd_data, rd_len; - image_header_t *rd_hdr; + const image_header_t *rd_hdr; +#ifdef CONFIG_SUPPORT_RAW_INITRD + char *end; +#endif #if defined(CONFIG_FIT) void *fit_hdr; const char *fit_uname_config = NULL; @@ -777,9 +819,9 @@ int boot_get_ramdisk (int argc, char *argv[], bootm_headers_t *images, * ramdisk argument */ if ((argc >= 3) && (strcmp(argv[2], "-") == 0)) { - debug ("## Skipping init Ramdisk\n"); + debug("## Skipping init Ramdisk\n"); rd_len = rd_data = 0; - } else if (argc >= 3 || genimg_has_config (images)) { + } else if (argc >= 3 || genimg_has_config(images)) { #if defined(CONFIG_FIT) if (argc >= 3) { /* @@ -793,19 +835,22 @@ int boot_get_ramdisk (int argc, char *argv[], bootm_headers_t *images, else default_addr = load_addr; - if (fit_parse_conf (argv[2], default_addr, + if (fit_parse_conf(argv[2], default_addr, &rd_addr, &fit_uname_config)) { - debug ("* ramdisk: config '%s' from image at 0x%08lx\n", + debug("* ramdisk: config '%s' from image at " + "0x%08lx\n", fit_uname_config, rd_addr); - } else if (fit_parse_subimage (argv[2], default_addr, + } else if (fit_parse_subimage(argv[2], default_addr, &rd_addr, &fit_uname_ramdisk)) { - debug ("* ramdisk: subimage '%s' from image at 0x%08lx\n", + debug("* ramdisk: subimage '%s' from image at " + "0x%08lx\n", fit_uname_ramdisk, rd_addr); } else #endif { rd_addr = simple_strtoul(argv[2], NULL, 16); - debug ("* ramdisk: cmdline image address = 0x%08lx\n", + debug("* ramdisk: cmdline image address = " + "0x%08lx\n", rd_addr); } #if defined(CONFIG_FIT) @@ -815,7 +860,8 @@ int boot_get_ramdisk (int argc, char *argv[], bootm_headers_t *images, */ rd_addr = (ulong)images->fit_hdr_os; fit_uname_config = images->fit_uname_cfg; - debug ("* ramdisk: using config '%s' from image at 0x%08lx\n", + debug("* ramdisk: using config '%s' from image " + "at 0x%08lx\n", fit_uname_config, rd_addr); /* @@ -823,57 +869,60 @@ int boot_get_ramdisk (int argc, char *argv[], bootm_headers_t *images, * if not, don't try to use it, quit silently. */ fit_hdr = (void *)rd_addr; - cfg_noffset = fit_conf_get_node (fit_hdr, fit_uname_config); + cfg_noffset = fit_conf_get_node(fit_hdr, + fit_uname_config); if (cfg_noffset < 0) { - debug ("* ramdisk: no such config\n"); + debug("* ramdisk: no such config\n"); return 1; } - rd_noffset = fit_conf_get_ramdisk_node (fit_hdr, cfg_noffset); + rd_noffset = fit_conf_get_ramdisk_node(fit_hdr, + cfg_noffset); if (rd_noffset < 0) { - debug ("* ramdisk: no ramdisk in config\n"); + debug("* ramdisk: no ramdisk in config\n"); return 0; } } #endif /* copy from dataflash if needed */ - rd_addr = genimg_get_image (rd_addr); + rd_addr = genimg_get_image(rd_addr); /* * Check if there is an initrd image at the * address provided in the second bootm argument * check image type, for FIT images get FIT node. */ - switch (genimg_get_format ((void *)rd_addr)) { + switch (genimg_get_format((void *)rd_addr)) { case IMAGE_FORMAT_LEGACY: - printf ("## Loading init Ramdisk from Legacy " + printf("## Loading init Ramdisk from Legacy " "Image at %08lx ...\n", rd_addr); - show_boot_progress (9); - rd_hdr = image_get_ramdisk (rd_addr, arch, + bootstage_mark(BOOTSTAGE_ID_CHECK_RAMDISK); + rd_hdr = image_get_ramdisk(rd_addr, arch, images->verify); if (rd_hdr == NULL) return 1; - rd_data = image_get_data (rd_hdr); - rd_len = image_get_data_size (rd_hdr); - rd_load = image_get_load (rd_hdr); + rd_data = image_get_data(rd_hdr); + rd_len = image_get_data_size(rd_hdr); + rd_load = image_get_load(rd_hdr); break; #if defined(CONFIG_FIT) case IMAGE_FORMAT_FIT: fit_hdr = (void *)rd_addr; - printf ("## Loading init Ramdisk from FIT " + printf("## Loading init Ramdisk from FIT " "Image at %08lx ...\n", rd_addr); - show_boot_progress (120); - if (!fit_check_format (fit_hdr)) { - puts ("Bad FIT ramdisk image format!\n"); - show_boot_progress (-120); + bootstage_mark(BOOTSTAGE_ID_FIT_RD_FORMAT); + if (!fit_check_format(fit_hdr)) { + puts("Bad FIT ramdisk image format!\n"); + bootstage_error( + BOOTSTAGE_ID_FIT_RD_FORMAT); return 1; } - show_boot_progress (121); + bootstage_mark(BOOTSTAGE_ID_FIT_RD_FORMAT_OK); if (!fit_uname_ramdisk) { /* @@ -881,52 +930,66 @@ int boot_get_ramdisk (int argc, char *argv[], bootm_headers_t *images, * node first. If config unit node name is NULL * fit_conf_get_node() will try to find default config node */ - show_boot_progress (122); - cfg_noffset = fit_conf_get_node (fit_hdr, fit_uname_config); + bootstage_mark( + BOOTSTAGE_ID_FIT_RD_NO_UNIT_NAME); + cfg_noffset = fit_conf_get_node(fit_hdr, + fit_uname_config); if (cfg_noffset < 0) { - puts ("Could not find configuration node\n"); - show_boot_progress (-122); + puts("Could not find configuration " + "node\n"); + bootstage_error( + BOOTSTAGE_ID_FIT_RD_NO_UNIT_NAME); return 1; } - fit_uname_config = fdt_get_name (fit_hdr, cfg_noffset, NULL); - printf (" Using '%s' configuration\n", fit_uname_config); - - rd_noffset = fit_conf_get_ramdisk_node (fit_hdr, cfg_noffset); - fit_uname_ramdisk = fit_get_name (fit_hdr, rd_noffset, NULL); + fit_uname_config = fdt_get_name(fit_hdr, + cfg_noffset, NULL); + printf(" Using '%s' configuration\n", + fit_uname_config); + + rd_noffset = fit_conf_get_ramdisk_node(fit_hdr, + cfg_noffset); + fit_uname_ramdisk = fit_get_name(fit_hdr, + rd_noffset, NULL); } else { /* get ramdisk component image node offset */ - show_boot_progress (123); - rd_noffset = fit_image_get_node (fit_hdr, fit_uname_ramdisk); + bootstage_mark( + BOOTSTAGE_ID_FIT_RD_UNIT_NAME); + rd_noffset = fit_image_get_node(fit_hdr, + fit_uname_ramdisk); } if (rd_noffset < 0) { - puts ("Could not find subimage node\n"); - show_boot_progress (-124); + puts("Could not find subimage node\n"); + bootstage_error(BOOTSTAGE_ID_FIT_RD_SUBNODE); return 1; } - printf (" Trying '%s' ramdisk subimage\n", fit_uname_ramdisk); + printf(" Trying '%s' ramdisk subimage\n", + fit_uname_ramdisk); - show_boot_progress (125); - if (!fit_check_ramdisk (fit_hdr, rd_noffset, arch, images->verify)) + bootstage_mark(BOOTSTAGE_ID_FIT_RD_CHECK); + if (!fit_check_ramdisk(fit_hdr, rd_noffset, arch, + images->verify)) return 1; /* get ramdisk image data address and length */ - if (fit_image_get_data (fit_hdr, rd_noffset, &data, &size)) { - puts ("Could not find ramdisk subimage data!\n"); - show_boot_progress (-127); + if (fit_image_get_data(fit_hdr, rd_noffset, &data, + &size)) { + puts("Could not find ramdisk subimage data!\n"); + bootstage_error(BOOTSTAGE_ID_FIT_RD_GET_DATA); return 1; } - show_boot_progress (128); + bootstage_mark(BOOTSTAGE_ID_FIT_RD_GET_DATA_OK); rd_data = (ulong)data; rd_len = size; - if (fit_image_get_load (fit_hdr, rd_noffset, &rd_load)) { - puts ("Can't get ramdisk subimage load address!\n"); - show_boot_progress (-129); + if (fit_image_get_load(fit_hdr, rd_noffset, &rd_load)) { + puts("Can't get ramdisk subimage load " + "address!\n"); + bootstage_error(BOOTSTAGE_ID_FIT_RD_LOAD); return 1; } - show_boot_progress (129); + bootstage_mark(BOOTSTAGE_ID_FIT_RD_LOAD); images->fit_hdr_rd = fit_hdr; images->fit_uname_rd = fit_uname_ramdisk; @@ -934,53 +997,53 @@ int boot_get_ramdisk (int argc, char *argv[], bootm_headers_t *images, break; #endif default: - puts ("Wrong Ramdisk Image Format\n"); - rd_data = rd_len = rd_load = 0; - } - -#if defined(CONFIG_B2) || defined(CONFIG_EVB4510) || defined(CONFIG_ARMADILLO) - /* - * We need to copy the ramdisk to SRAM to let Linux boot - */ - if (rd_data) { - memmove ((void *)rd_load, (uchar *)rd_data, rd_len); - rd_data = rd_load; +#ifdef CONFIG_SUPPORT_RAW_INITRD + if (argc >= 3 && (end = strchr(argv[2], ':'))) { + rd_len = simple_strtoul(++end, NULL, 16); + rd_data = rd_addr; + } else +#endif + { + puts("Wrong Ramdisk Image Format\n"); + rd_data = rd_len = rd_load = 0; + return 1; + } } -#endif /* CONFIG_B2 || CONFIG_EVB4510 || CONFIG_ARMADILLO */ - } else if (images->legacy_hdr_valid && - image_check_type (&images->legacy_hdr_os_copy, IH_TYPE_MULTI)) { + image_check_type(&images->legacy_hdr_os_copy, + IH_TYPE_MULTI)) { + /* * Now check if we have a legacy mult-component image, * get second entry data start address and len. */ - show_boot_progress (13); - printf ("## Loading init Ramdisk from multi component " + bootstage_mark(BOOTSTAGE_ID_RAMDISK); + printf("## Loading init Ramdisk from multi component " "Legacy Image at %08lx ...\n", (ulong)images->legacy_hdr_os); - image_multi_getimg (images->legacy_hdr_os, 1, &rd_data, &rd_len); + image_multi_getimg(images->legacy_hdr_os, 1, &rd_data, &rd_len); } else { /* * no initrd image */ - show_boot_progress (14); + bootstage_mark(BOOTSTAGE_ID_NO_RAMDISK); rd_len = rd_data = 0; } if (!rd_data) { - debug ("## No init Ramdisk\n"); + debug("## No init Ramdisk\n"); } else { *rd_start = rd_data; *rd_end = rd_data + rd_len; } - debug (" ramdisk start = 0x%08lx, ramdisk end = 0x%08lx\n", + debug(" ramdisk start = 0x%08lx, ramdisk end = 0x%08lx\n", *rd_start, *rd_end); return 0; } -#if defined(CONFIG_PPC) || defined(CONFIG_M68K) || defined(CONFIG_SPARC) +#ifdef CONFIG_SYS_BOOT_RAMDISK_HIGH /** * boot_ramdisk_high - relocate init ramdisk * @lmb: pointer to lmb handle, will be used for memory mgmt @@ -1002,18 +1065,18 @@ int boot_get_ramdisk (int argc, char *argv[], bootm_headers_t *images, * 0 - success * -1 - failure */ -int boot_ramdisk_high (struct lmb *lmb, ulong rd_data, ulong rd_len, +int boot_ramdisk_high(struct lmb *lmb, ulong rd_data, ulong rd_len, ulong *initrd_start, ulong *initrd_end) { char *s; ulong initrd_high; int initrd_copy_to_ram = 1; - if ((s = getenv ("initrd_high")) != NULL) { + if ((s = getenv("initrd_high")) != NULL) { /* a value of "no" or a similar string will act like 0, * turning the "load high" feature off. This is intentional. */ - initrd_high = simple_strtoul (s, NULL, 16); + initrd_high = simple_strtoul(s, NULL, 16); if (initrd_high == ~0) initrd_copy_to_ram = 0; } else { @@ -1027,41 +1090,51 @@ int boot_ramdisk_high (struct lmb *lmb, ulong rd_data, ulong rd_len, lmb_reserve(lmb, logbuffer_base() - LOGBUFF_OVERHEAD, LOGBUFF_RESERVE); #endif - debug ("## initrd_high = 0x%08lx, copy_to_ram = %d\n", + debug("## initrd_high = 0x%08lx, copy_to_ram = %d\n", initrd_high, initrd_copy_to_ram); if (rd_data) { if (!initrd_copy_to_ram) { /* zero-copy ramdisk support */ - debug (" in-place initrd\n"); + debug(" in-place initrd\n"); *initrd_start = rd_data; *initrd_end = rd_data + rd_len; lmb_reserve(lmb, rd_data, rd_len); } else { if (initrd_high) - *initrd_start = (ulong)lmb_alloc_base (lmb, rd_len, 0x1000, initrd_high); + *initrd_start = (ulong)lmb_alloc_base(lmb, + rd_len, 0x1000, initrd_high); else - *initrd_start = (ulong)lmb_alloc (lmb, rd_len, 0x1000); + *initrd_start = (ulong)lmb_alloc(lmb, rd_len, + 0x1000); if (*initrd_start == 0) { - puts ("ramdisk - allocation error\n"); + puts("ramdisk - allocation error\n"); goto error; } - show_boot_progress (12); + bootstage_mark(BOOTSTAGE_ID_COPY_RAMDISK); *initrd_end = *initrd_start + rd_len; - printf (" Loading Ramdisk to %08lx, end %08lx ... ", + printf(" Loading Ramdisk to %08lx, end %08lx ... ", *initrd_start, *initrd_end); - memmove_wd ((void *)*initrd_start, + memmove_wd((void *)*initrd_start, (void *)rd_data, rd_len, CHUNKSZ); - puts ("OK\n"); +#ifdef CONFIG_MP + /* + * Ensure the image is flushed to memory to handle + * AMP boot scenarios in which we might not be + * HW cache coherent + */ + flush_cache((unsigned long)*initrd_start, rd_len); +#endif + puts("OK\n"); } } else { *initrd_start = 0; *initrd_end = 0; } - debug (" ramdisk load start = 0x%08lx, ramdisk load end = 0x%08lx\n", + debug(" ramdisk load start = 0x%08lx, ramdisk load end = 0x%08lx\n", *initrd_start, *initrd_end); return 0; @@ -1069,17 +1142,581 @@ int boot_ramdisk_high (struct lmb *lmb, ulong rd_data, ulong rd_len, error: return -1; } +#endif /* CONFIG_SYS_BOOT_RAMDISK_HIGH */ + +#ifdef CONFIG_OF_LIBFDT +static void fdt_error(const char *msg) +{ + puts("ERROR: "); + puts(msg); + puts(" - must RESET the board to recover.\n"); +} + +static const image_header_t *image_get_fdt(ulong fdt_addr) +{ + const image_header_t *fdt_hdr = (const image_header_t *)fdt_addr; + + image_print_contents(fdt_hdr); + + puts(" Verifying Checksum ... "); + if (!image_check_hcrc(fdt_hdr)) { + fdt_error("fdt header checksum invalid"); + return NULL; + } + + if (!image_check_dcrc(fdt_hdr)) { + fdt_error("fdt checksum invalid"); + return NULL; + } + puts("OK\n"); + + if (!image_check_type(fdt_hdr, IH_TYPE_FLATDT)) { + fdt_error("uImage is not a fdt"); + return NULL; + } + if (image_get_comp(fdt_hdr) != IH_COMP_NONE) { + fdt_error("uImage is compressed"); + return NULL; + } + if (fdt_check_header((char *)image_get_data(fdt_hdr)) != 0) { + fdt_error("uImage data is not a fdt"); + return NULL; + } + return fdt_hdr; +} + +/** + * fit_check_fdt - verify FIT format FDT subimage + * @fit_hdr: pointer to the FIT header + * fdt_noffset: FDT subimage node offset within FIT image + * @verify: data CRC verification flag + * + * fit_check_fdt() verifies integrity of the FDT subimage and from + * specified FIT image. + * + * returns: + * 1, on success + * 0, on failure + */ +#if defined(CONFIG_FIT) +static int fit_check_fdt(const void *fit, int fdt_noffset, int verify) +{ + fit_image_print(fit, fdt_noffset, " "); + + if (verify) { + puts(" Verifying Hash Integrity ... "); + if (!fit_image_check_hashes(fit, fdt_noffset)) { + fdt_error("Bad Data Hash"); + return 0; + } + puts("OK\n"); + } + + if (!fit_image_check_type(fit, fdt_noffset, IH_TYPE_FLATDT)) { + fdt_error("Not a FDT image"); + return 0; + } + + if (!fit_image_check_comp(fit, fdt_noffset, IH_COMP_NONE)) { + fdt_error("FDT image is compressed"); + return 0; + } + + return 1; +} +#endif /* CONFIG_FIT */ + +#ifndef CONFIG_SYS_FDT_PAD +#define CONFIG_SYS_FDT_PAD 0x3000 +#endif + +#if defined(CONFIG_OF_LIBFDT) +/** + * boot_fdt_add_mem_rsv_regions - Mark the memreserve sections as unusable + * @lmb: pointer to lmb handle, will be used for memory mgmt + * @fdt_blob: pointer to fdt blob base address + * + * Adds the memreserve regions in the dtb to the lmb block. Adding the + * memreserve regions prevents u-boot from using them to store the initrd + * or the fdt blob. + */ +void boot_fdt_add_mem_rsv_regions(struct lmb *lmb, void *fdt_blob) +{ + uint64_t addr, size; + int i, total; + + if (fdt_check_header(fdt_blob) != 0) + return; + + total = fdt_num_mem_rsv(fdt_blob); + for (i = 0; i < total; i++) { + if (fdt_get_mem_rsv(fdt_blob, i, &addr, &size) != 0) + continue; + printf(" reserving fdt memory region: addr=%llx size=%llx\n", + (unsigned long long)addr, (unsigned long long)size); + lmb_reserve(lmb, addr, size); + } +} + +/** + * boot_relocate_fdt - relocate flat device tree + * @lmb: pointer to lmb handle, will be used for memory mgmt + * @of_flat_tree: pointer to a char* variable, will hold fdt start address + * @of_size: pointer to a ulong variable, will hold fdt length + * + * boot_relocate_fdt() allocates a region of memory within the bootmap and + * relocates the of_flat_tree into that region, even if the fdt is already in + * the bootmap. It also expands the size of the fdt by CONFIG_SYS_FDT_PAD + * bytes. + * + * of_flat_tree and of_size are set to final (after relocation) values + * + * returns: + * 0 - success + * 1 - failure + */ +int boot_relocate_fdt(struct lmb *lmb, char **of_flat_tree, ulong *of_size) +{ + void *fdt_blob = *of_flat_tree; + void *of_start = 0; + char *fdt_high; + ulong of_len = 0; + int err; + int disable_relocation = 0; + + /* nothing to do */ + if (*of_size == 0) + return 0; + + if (fdt_check_header(fdt_blob) != 0) { + fdt_error("image is not a fdt"); + goto error; + } + + /* position on a 4K boundary before the alloc_current */ + /* Pad the FDT by a specified amount */ + of_len = *of_size + CONFIG_SYS_FDT_PAD; + + /* If fdt_high is set use it to select the relocation address */ + fdt_high = getenv("fdt_high"); + if (fdt_high) { + void *desired_addr = (void *)simple_strtoul(fdt_high, NULL, 16); + + if (((ulong) desired_addr) == ~0UL) { + /* All ones means use fdt in place */ + of_start = fdt_blob; + lmb_reserve(lmb, (ulong)of_start, of_len); + disable_relocation = 1; + } else if (desired_addr) { + of_start = + (void *)(ulong) lmb_alloc_base(lmb, of_len, 0x1000, + (ulong)desired_addr); + if (of_start == 0) { + puts("Failed using fdt_high value for Device Tree"); + goto error; + } + } else { + of_start = + (void *)(ulong) lmb_alloc(lmb, of_len, 0x1000); + } + } else { + of_start = + (void *)(ulong) lmb_alloc_base(lmb, of_len, 0x1000, + getenv_bootm_mapsize() + + getenv_bootm_low()); + } + + if (of_start == 0) { + puts("device tree - allocation error\n"); + goto error; + } + + if (disable_relocation) { + /* We assume there is space after the existing fdt to use for padding */ + fdt_set_totalsize(of_start, of_len); + printf(" Using Device Tree in place at %p, end %p\n", + of_start, of_start + of_len - 1); + } else { + debug("## device tree at %p ... %p (len=%ld [0x%lX])\n", + fdt_blob, fdt_blob + *of_size - 1, of_len, of_len); + + printf(" Loading Device Tree to %p, end %p ... ", + of_start, of_start + of_len - 1); + + err = fdt_open_into(fdt_blob, of_start, of_len); + if (err != 0) { + fdt_error("fdt move failed"); + goto error; + } + puts("OK\n"); + } + + *of_flat_tree = of_start; + *of_size = of_len; + + set_working_fdt_addr(*of_flat_tree); + return 0; + +error: + return 1; +} +#endif /* CONFIG_OF_LIBFDT */ + +/** + * boot_get_fdt - main fdt handling routine + * @argc: command argument count + * @argv: command argument list + * @images: pointer to the bootm images structure + * @of_flat_tree: pointer to a char* variable, will hold fdt start address + * @of_size: pointer to a ulong variable, will hold fdt length + * + * boot_get_fdt() is responsible for finding a valid flat device tree image. + * Curently supported are the following ramdisk sources: + * - multicomponent kernel/ramdisk image, + * - commandline provided address of decicated ramdisk image. + * + * returns: + * 0, if fdt image was found and valid, or skipped + * of_flat_tree and of_size are set to fdt start address and length if + * fdt image is found and valid + * + * 1, if fdt image is found but corrupted + * of_flat_tree and of_size are set to 0 if no fdt exists + */ +int boot_get_fdt(int flag, int argc, char * const argv[], + bootm_headers_t *images, char **of_flat_tree, ulong *of_size) +{ + const image_header_t *fdt_hdr; + ulong fdt_addr; + char *fdt_blob = NULL; + ulong image_start, image_data, image_end; + ulong load_start, load_end; +#if defined(CONFIG_FIT) + void *fit_hdr; + const char *fit_uname_config = NULL; + const char *fit_uname_fdt = NULL; + ulong default_addr; + int cfg_noffset; + int fdt_noffset; + const void *data; + size_t size; +#endif + + *of_flat_tree = NULL; + *of_size = 0; + + if (argc > 3 || genimg_has_config(images)) { +#if defined(CONFIG_FIT) + if (argc > 3) { + /* + * If the FDT blob comes from the FIT image and the + * FIT image address is omitted in the command line + * argument, try to use ramdisk or os FIT image + * address or default load address. + */ + if (images->fit_uname_rd) + default_addr = (ulong)images->fit_hdr_rd; + else if (images->fit_uname_os) + default_addr = (ulong)images->fit_hdr_os; + else + default_addr = load_addr; + + if (fit_parse_conf(argv[3], default_addr, + &fdt_addr, &fit_uname_config)) { + debug("* fdt: config '%s' from image at " + "0x%08lx\n", + fit_uname_config, fdt_addr); + } else if (fit_parse_subimage(argv[3], default_addr, + &fdt_addr, &fit_uname_fdt)) { + debug("* fdt: subimage '%s' from image at " + "0x%08lx\n", + fit_uname_fdt, fdt_addr); + } else +#endif + { + fdt_addr = simple_strtoul(argv[3], NULL, 16); + debug("* fdt: cmdline image address = " + "0x%08lx\n", + fdt_addr); + } +#if defined(CONFIG_FIT) + } else { + /* use FIT configuration provided in first bootm + * command argument + */ + fdt_addr = (ulong)images->fit_hdr_os; + fit_uname_config = images->fit_uname_cfg; + debug("* fdt: using config '%s' from image " + "at 0x%08lx\n", + fit_uname_config, fdt_addr); + + /* + * Check whether configuration has FDT blob defined, + * if not quit silently. + */ + fit_hdr = (void *)fdt_addr; + cfg_noffset = fit_conf_get_node(fit_hdr, + fit_uname_config); + if (cfg_noffset < 0) { + debug("* fdt: no such config\n"); + return 0; + } + + fdt_noffset = fit_conf_get_fdt_node(fit_hdr, + cfg_noffset); + if (fdt_noffset < 0) { + debug("* fdt: no fdt in config\n"); + return 0; + } + } +#endif + + debug("## Checking for 'FDT'/'FDT Image' at %08lx\n", + fdt_addr); + + /* copy from dataflash if needed */ + fdt_addr = genimg_get_image(fdt_addr); + + /* + * Check if there is an FDT image at the + * address provided in the second bootm argument + * check image type, for FIT images get a FIT node. + */ + switch (genimg_get_format((void *)fdt_addr)) { + case IMAGE_FORMAT_LEGACY: + /* verify fdt_addr points to a valid image header */ + printf("## Flattened Device Tree from Legacy Image " + "at %08lx\n", + fdt_addr); + fdt_hdr = image_get_fdt(fdt_addr); + if (!fdt_hdr) + goto error; + + /* + * move image data to the load address, + * make sure we don't overwrite initial image + */ + image_start = (ulong)fdt_hdr; + image_data = (ulong)image_get_data(fdt_hdr); + image_end = image_get_image_end(fdt_hdr); + + load_start = image_get_load(fdt_hdr); + load_end = load_start + image_get_data_size(fdt_hdr); + + if (load_start == image_start || + load_start == image_data) { + fdt_blob = (char *)image_data; + break; + } + + if ((load_start < image_end) && (load_end > image_start)) { + fdt_error("fdt overwritten"); + goto error; + } + + debug(" Loading FDT from 0x%08lx to 0x%08lx\n", + image_data, load_start); + + memmove((void *)load_start, + (void *)image_data, + image_get_data_size(fdt_hdr)); + + fdt_blob = (char *)load_start; + break; + case IMAGE_FORMAT_FIT: + /* + * This case will catch both: new uImage format + * (libfdt based) and raw FDT blob (also libfdt + * based). + */ +#if defined(CONFIG_FIT) + /* check FDT blob vs FIT blob */ + if (fit_check_format((const void *)fdt_addr)) { + /* + * FIT image + */ + fit_hdr = (void *)fdt_addr; + printf("## Flattened Device Tree from FIT " + "Image at %08lx\n", + fdt_addr); + + if (!fit_uname_fdt) { + /* + * no FDT blob image node unit name, + * try to get config node first. If + * config unit node name is NULL + * fit_conf_get_node() will try to + * find default config node + */ + cfg_noffset = fit_conf_get_node(fit_hdr, + fit_uname_config); + + if (cfg_noffset < 0) { + fdt_error("Could not find " + "configuration " + "node\n"); + goto error; + } + + fit_uname_config = fdt_get_name(fit_hdr, + cfg_noffset, NULL); + printf(" Using '%s' configuration\n", + fit_uname_config); + + fdt_noffset = fit_conf_get_fdt_node( + fit_hdr, + cfg_noffset); + fit_uname_fdt = fit_get_name(fit_hdr, + fdt_noffset, NULL); + } else { + /* get FDT component image node offset */ + fdt_noffset = fit_image_get_node( + fit_hdr, + fit_uname_fdt); + } + if (fdt_noffset < 0) { + fdt_error("Could not find subimage " + "node\n"); + goto error; + } + + printf(" Trying '%s' FDT blob subimage\n", + fit_uname_fdt); + + if (!fit_check_fdt(fit_hdr, fdt_noffset, + images->verify)) + goto error; + + /* get ramdisk image data address and length */ + if (fit_image_get_data(fit_hdr, fdt_noffset, + &data, &size)) { + fdt_error("Could not find FDT " + "subimage data"); + goto error; + } + + /* verift that image data is a proper FDT blob */ + if (fdt_check_header((char *)data) != 0) { + fdt_error("Subimage data is not a FTD"); + goto error; + } + + /* + * move image data to the load address, + * make sure we don't overwrite initial image + */ + image_start = (ulong)fit_hdr; + image_end = fit_get_end(fit_hdr); + + if (fit_image_get_load(fit_hdr, fdt_noffset, + &load_start) == 0) { + load_end = load_start + size; + + if ((load_start < image_end) && + (load_end > image_start)) { + fdt_error("FDT overwritten"); + goto error; + } + + printf(" Loading FDT from 0x%08lx " + "to 0x%08lx\n", + (ulong)data, + load_start); + + memmove((void *)load_start, + (void *)data, size); + + fdt_blob = (char *)load_start; + } else { + fdt_blob = (char *)data; + } + + images->fit_hdr_fdt = fit_hdr; + images->fit_uname_fdt = fit_uname_fdt; + images->fit_noffset_fdt = fdt_noffset; + break; + } else +#endif + { + /* + * FDT blob + */ + fdt_blob = (char *)fdt_addr; + debug("* fdt: raw FDT blob\n"); + printf("## Flattened Device Tree blob at " + "%08lx\n", (long)fdt_blob); + } + break; + default: + puts("ERROR: Did not find a cmdline Flattened Device " + "Tree\n"); + goto error; + } + + printf(" Booting using the fdt blob at 0x%p\n", fdt_blob); + + } else if (images->legacy_hdr_valid && + image_check_type(&images->legacy_hdr_os_copy, + IH_TYPE_MULTI)) { + + ulong fdt_data, fdt_len; + + /* + * Now check if we have a legacy multi-component image, + * get second entry data start address and len. + */ + printf("## Flattened Device Tree from multi " + "component Image at %08lX\n", + (ulong)images->legacy_hdr_os); + + image_multi_getimg(images->legacy_hdr_os, 2, &fdt_data, + &fdt_len); + if (fdt_len) { + + fdt_blob = (char *)fdt_data; + printf(" Booting using the fdt at 0x%p\n", fdt_blob); + + if (fdt_check_header(fdt_blob) != 0) { + fdt_error("image is not a fdt"); + goto error; + } + + if (fdt_totalsize(fdt_blob) != fdt_len) { + fdt_error("fdt size != image size"); + goto error; + } + } else { + debug("## No Flattened Device Tree\n"); + return 0; + } + } else { + debug("## No Flattened Device Tree\n"); + return 0; + } + + *of_flat_tree = fdt_blob; + *of_size = fdt_totalsize(fdt_blob); + debug(" of_flat_tree at 0x%08lx size 0x%08lx\n", + (ulong)*of_flat_tree, *of_size); + + return 0; + +error: + *of_flat_tree = 0; + *of_size = 0; + return 1; +} +#endif /* CONFIG_OF_LIBFDT */ +#ifdef CONFIG_SYS_BOOT_GET_CMDLINE /** * boot_get_cmdline - allocate and initialize kernel cmdline * @lmb: pointer to lmb handle, will be used for memory mgmt * @cmd_start: pointer to a ulong variable, will hold cmdline start * @cmd_end: pointer to a ulong variable, will hold cmdline end - * @bootmap_base: ulong variable, holds offset in physical memory to - * base of bootmap * * boot_get_cmdline() allocates space for kernel command line below - * BOOTMAPSZ + bootmap_base address. If "bootargs" U-boot environemnt + * BOOTMAPSZ + getenv_bootm_low() address. If "bootargs" U-boot environemnt * variable is present its contents is copied to allocated kernel * command line. * @@ -1087,14 +1724,13 @@ error: * 0 - success * -1 - failure */ -int boot_get_cmdline (struct lmb *lmb, ulong *cmd_start, ulong *cmd_end, - ulong bootmap_base) +int boot_get_cmdline(struct lmb *lmb, ulong *cmd_start, ulong *cmd_end) { char *cmdline; char *s; - cmdline = (char *)(ulong)lmb_alloc_base(lmb, CFG_BARGSIZE, 0xf, - CFG_BOOTMAPSZ + bootmap_base); + cmdline = (char *)(ulong)lmb_alloc_base(lmb, CONFIG_SYS_BARGSIZE, 0xf, + getenv_bootm_mapsize() + getenv_bootm_low()); if (cmdline == NULL) return -1; @@ -1107,36 +1743,36 @@ int boot_get_cmdline (struct lmb *lmb, ulong *cmd_start, ulong *cmd_end, *cmd_start = (ulong) & cmdline[0]; *cmd_end = *cmd_start + strlen(cmdline); - debug ("## cmdline at 0x%08lx ... 0x%08lx\n", *cmd_start, *cmd_end); + debug("## cmdline at 0x%08lx ... 0x%08lx\n", *cmd_start, *cmd_end); return 0; } +#endif /* CONFIG_SYS_BOOT_GET_CMDLINE */ +#ifdef CONFIG_SYS_BOOT_GET_KBD /** * boot_get_kbd - allocate and initialize kernel copy of board info * @lmb: pointer to lmb handle, will be used for memory mgmt * @kbd: double pointer to board info data - * @bootmap_base: ulong variable, holds offset in physical memory to - * base of bootmap * * boot_get_kbd() allocates space for kernel copy of board info data below - * BOOTMAPSZ + bootmap_base address and kernel board info is initialized with - * the current u-boot board info data. + * BOOTMAPSZ + getenv_bootm_low() address and kernel board info is initialized + * with the current u-boot board info data. * * returns: * 0 - success * -1 - failure */ -int boot_get_kbd (struct lmb *lmb, bd_t **kbd, ulong bootmap_base) +int boot_get_kbd(struct lmb *lmb, bd_t **kbd) { *kbd = (bd_t *)(ulong)lmb_alloc_base(lmb, sizeof(bd_t), 0xf, - CFG_BOOTMAPSZ + bootmap_base); + getenv_bootm_mapsize() + getenv_bootm_low()); if (*kbd == NULL) return -1; **kbd = *(gd->bd); - debug ("## kernel board info at 0x%08lx\n", (ulong)*kbd); + debug("## kernel board info at 0x%08lx\n", (ulong)*kbd); #if defined(DEBUG) && defined(CONFIG_CMD_BDI) do_bdinfo(NULL, 0, 0, NULL); @@ -1144,7 +1780,7 @@ int boot_get_kbd (struct lmb *lmb, bd_t **kbd, ulong bootmap_base) return 0; } -#endif /* CONFIG_PPC || CONFIG_M68K */ +#endif /* CONFIG_SYS_BOOT_GET_KBD */ #endif /* !USE_HOSTCC */ #if defined(CONFIG_FIT) @@ -1152,7 +1788,7 @@ int boot_get_kbd (struct lmb *lmb, bd_t **kbd, ulong bootmap_base) /* New uImage format routines */ /*****************************************************************************/ #ifndef USE_HOSTCC -static int fit_parse_spec (const char *spec, char sepc, ulong addr_curr, +static int fit_parse_spec(const char *spec, char sepc, ulong addr_curr, ulong *addr, const char **name) { const char *sep; @@ -1160,10 +1796,10 @@ static int fit_parse_spec (const char *spec, char sepc, ulong addr_curr, *addr = addr_curr; *name = NULL; - sep = strchr (spec, sepc); + sep = strchr(spec, sepc); if (sep) { if (sep - spec > 0) - *addr = simple_strtoul (spec, NULL, 16); + *addr = simple_strtoul(spec, NULL, 16); *name = sep + 1; return 1; @@ -1193,10 +1829,10 @@ static int fit_parse_spec (const char *spec, char sepc, ulong addr_curr, * addr and conf_name are set accordingly * 0 otherwise */ -inline int fit_parse_conf (const char *spec, ulong addr_curr, +int fit_parse_conf(const char *spec, ulong addr_curr, ulong *addr, const char **conf_name) { - return fit_parse_spec (spec, '#', addr_curr, addr, conf_name); + return fit_parse_spec(spec, '#', addr_curr, addr, conf_name); } /** @@ -1219,21 +1855,21 @@ inline int fit_parse_conf (const char *spec, ulong addr_curr, * addr and image_name are set accordingly * 0 otherwise */ -inline int fit_parse_subimage (const char *spec, ulong addr_curr, +int fit_parse_subimage(const char *spec, ulong addr_curr, ulong *addr, const char **image_name) { - return fit_parse_spec (spec, ':', addr_curr, addr, image_name); + return fit_parse_spec(spec, ':', addr_curr, addr, image_name); } #endif /* !USE_HOSTCC */ -static void fit_get_debug (const void *fit, int noffset, +static void fit_get_debug(const void *fit, int noffset, char *prop_name, int err) { - debug ("Can't get '%s' property from FIT 0x%08lx, " + debug("Can't get '%s' property from FIT 0x%08lx, " "node: offset %d, name %s (%s)\n", prop_name, (ulong)fit, noffset, - fit_get_name (fit, noffset, NULL), - fdt_strerror (err)); + fit_get_name(fit, noffset, NULL), + fdt_strerror(err)); } /** @@ -1248,7 +1884,7 @@ static void fit_get_debug (const void *fit, int noffset, * returns: * no returned results */ -void fit_print_contents (const void *fit) +void fit_print_contents(const void *fit) { char *desc; char *uname; @@ -1270,72 +1906,74 @@ void fit_print_contents (const void *fit) #endif /* Root node properties */ - ret = fit_get_desc (fit, 0, &desc); - printf ("%sFIT description: ", p); + ret = fit_get_desc(fit, 0, &desc); + printf("%sFIT description: ", p); if (ret) - printf ("unavailable\n"); + printf("unavailable\n"); else - printf ("%s\n", desc); + printf("%s\n", desc); #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE) || defined(USE_HOSTCC) - ret = fit_get_timestamp (fit, 0, ×tamp); - printf ("%sCreated: ", p); + ret = fit_get_timestamp(fit, 0, ×tamp); + printf("%sCreated: ", p); if (ret) - printf ("unavailable\n"); + printf("unavailable\n"); else - genimg_print_time (timestamp); + genimg_print_time(timestamp); #endif /* Find images parent node offset */ - images_noffset = fdt_path_offset (fit, FIT_IMAGES_PATH); + images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH); if (images_noffset < 0) { - printf ("Can't find images parent node '%s' (%s)\n", - FIT_IMAGES_PATH, fdt_strerror (images_noffset)); + printf("Can't find images parent node '%s' (%s)\n", + FIT_IMAGES_PATH, fdt_strerror(images_noffset)); return; } /* Process its subnodes, print out component images details */ - for (ndepth = 0, count = 0, noffset = fdt_next_node (fit, images_noffset, &ndepth); + for (ndepth = 0, count = 0, + noffset = fdt_next_node(fit, images_noffset, &ndepth); (noffset >= 0) && (ndepth > 0); - noffset = fdt_next_node (fit, noffset, &ndepth)) { + noffset = fdt_next_node(fit, noffset, &ndepth)) { if (ndepth == 1) { /* * Direct child node of the images parent node, * i.e. component image node. */ - printf ("%s Image %u (%s)\n", p, count++, + printf("%s Image %u (%s)\n", p, count++, fit_get_name(fit, noffset, NULL)); - fit_image_print (fit, noffset, p); + fit_image_print(fit, noffset, p); } } /* Find configurations parent node offset */ - confs_noffset = fdt_path_offset (fit, FIT_CONFS_PATH); + confs_noffset = fdt_path_offset(fit, FIT_CONFS_PATH); if (confs_noffset < 0) { - debug ("Can't get configurations parent node '%s' (%s)\n", - FIT_CONFS_PATH, fdt_strerror (confs_noffset)); + debug("Can't get configurations parent node '%s' (%s)\n", + FIT_CONFS_PATH, fdt_strerror(confs_noffset)); return; } /* get default configuration unit name from default property */ - uname = (char *)fdt_getprop (fit, noffset, FIT_DEFAULT_PROP, NULL); + uname = (char *)fdt_getprop(fit, noffset, FIT_DEFAULT_PROP, NULL); if (uname) - printf ("%s Default Configuration: '%s'\n", p, uname); + printf("%s Default Configuration: '%s'\n", p, uname); /* Process its subnodes, print out configurations details */ - for (ndepth = 0, count = 0, noffset = fdt_next_node (fit, confs_noffset, &ndepth); + for (ndepth = 0, count = 0, + noffset = fdt_next_node(fit, confs_noffset, &ndepth); (noffset >= 0) && (ndepth > 0); - noffset = fdt_next_node (fit, noffset, &ndepth)) { + noffset = fdt_next_node(fit, noffset, &ndepth)) { if (ndepth == 1) { /* * Direct child node of the configurations parent node, * i.e. configuration node. */ - printf ("%s Configuration %u (%s)\n", p, count++, + printf("%s Configuration %u (%s)\n", p, count++, fit_get_name(fit, noffset, NULL)); - fit_conf_print (fit, noffset, p); + fit_conf_print(fit, noffset, p); } } } @@ -1347,12 +1985,15 @@ void fit_print_contents (const void *fit) * @p: pointer to prefix string * * fit_image_print() lists all mandatory properies for the processed component - * image. If present, hash nodes are printed out as well. + * image. If present, hash nodes are printed out as well. Load + * address for images of type firmware is also printed out. Since the load + * address is not mandatory for firmware images, it will be output as + * "unavailable" when not present. * * returns: * no returned results */ -void fit_image_print (const void *fit, int image_noffset, const char *p) +void fit_image_print(const void *fit, int image_noffset, const char *p) { char *desc; uint8_t type, arch, os, comp; @@ -1364,71 +2005,74 @@ void fit_image_print (const void *fit, int image_noffset, const char *p) int ret; /* Mandatory properties */ - ret = fit_get_desc (fit, image_noffset, &desc); - printf ("%s Description: ", p); + ret = fit_get_desc(fit, image_noffset, &desc); + printf("%s Description: ", p); if (ret) - printf ("unavailable\n"); + printf("unavailable\n"); else - printf ("%s\n", desc); + printf("%s\n", desc); - fit_image_get_type (fit, image_noffset, &type); - printf ("%s Type: %s\n", p, genimg_get_type_name (type)); + fit_image_get_type(fit, image_noffset, &type); + printf("%s Type: %s\n", p, genimg_get_type_name(type)); - fit_image_get_comp (fit, image_noffset, &comp); - printf ("%s Compression: %s\n", p, genimg_get_comp_name (comp)); + fit_image_get_comp(fit, image_noffset, &comp); + printf("%s Compression: %s\n", p, genimg_get_comp_name(comp)); - ret = fit_image_get_data (fit, image_noffset, &data, &size); + ret = fit_image_get_data(fit, image_noffset, &data, &size); #ifndef USE_HOSTCC - printf ("%s Data Start: ", p); + printf("%s Data Start: ", p); if (ret) - printf ("unavailable\n"); + printf("unavailable\n"); else - printf ("0x%08lx\n", (ulong)data); + printf("0x%08lx\n", (ulong)data); #endif - printf ("%s Data Size: ", p); + printf("%s Data Size: ", p); if (ret) - printf ("unavailable\n"); + printf("unavailable\n"); else - genimg_print_size (size); + genimg_print_size(size); /* Remaining, type dependent properties */ if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE) || (type == IH_TYPE_RAMDISK) || (type == IH_TYPE_FIRMWARE) || (type == IH_TYPE_FLATDT)) { - fit_image_get_arch (fit, image_noffset, &arch); - printf ("%s Architecture: %s\n", p, genimg_get_arch_name (arch)); + fit_image_get_arch(fit, image_noffset, &arch); + printf("%s Architecture: %s\n", p, genimg_get_arch_name(arch)); } if (type == IH_TYPE_KERNEL) { - fit_image_get_os (fit, image_noffset, &os); - printf ("%s OS: %s\n", p, genimg_get_os_name (os)); + fit_image_get_os(fit, image_noffset, &os); + printf("%s OS: %s\n", p, genimg_get_os_name(os)); } - if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE)) { - ret = fit_image_get_load (fit, image_noffset, &load); - printf ("%s Load Address: ", p); + if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE) || + (type == IH_TYPE_FIRMWARE)) { + ret = fit_image_get_load(fit, image_noffset, &load); + printf("%s Load Address: ", p); if (ret) - printf ("unavailable\n"); + printf("unavailable\n"); else - printf ("0x%08lx\n", load); + printf("0x%08lx\n", load); + } - fit_image_get_entry (fit, image_noffset, &entry); - printf ("%s Entry Point: ", p); + if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE)) { + fit_image_get_entry(fit, image_noffset, &entry); + printf("%s Entry Point: ", p); if (ret) - printf ("unavailable\n"); + printf("unavailable\n"); else - printf ("0x%08lx\n", entry); + printf("0x%08lx\n", entry); } /* Process all hash subnodes of the component image node */ - for (ndepth = 0, noffset = fdt_next_node (fit, image_noffset, &ndepth); + for (ndepth = 0, noffset = fdt_next_node(fit, image_noffset, &ndepth); (noffset >= 0) && (ndepth > 0); - noffset = fdt_next_node (fit, noffset, &ndepth)) { + noffset = fdt_next_node(fit, noffset, &ndepth)) { if (ndepth == 1) { /* Direct child node of the component image node */ - fit_image_print_hash (fit, noffset, p); + fit_image_print_hash(fit, noffset, p); } } } @@ -1444,7 +2088,7 @@ void fit_image_print (const void *fit, int image_noffset, const char *p) * returns: * no returned results */ -void fit_image_print_hash (const void *fit, int noffset, const char *p) +void fit_image_print_hash(const void *fit, int noffset, const char *p) { char *algo; uint8_t *value; @@ -1456,33 +2100,33 @@ void fit_image_print_hash (const void *fit, int noffset, const char *p) * Multiple hash nodes require unique unit node * names, e.g. hash@1, hash@2, etc. */ - if (strncmp (fit_get_name(fit, noffset, NULL), + if (strncmp(fit_get_name(fit, noffset, NULL), FIT_HASH_NODENAME, strlen(FIT_HASH_NODENAME)) != 0) return; - debug ("%s Hash node: '%s'\n", p, - fit_get_name (fit, noffset, NULL)); + debug("%s Hash node: '%s'\n", p, + fit_get_name(fit, noffset, NULL)); - printf ("%s Hash algo: ", p); - if (fit_image_hash_get_algo (fit, noffset, &algo)) { - printf ("invalid/unsupported\n"); + printf("%s Hash algo: ", p); + if (fit_image_hash_get_algo(fit, noffset, &algo)) { + printf("invalid/unsupported\n"); return; } - printf ("%s\n", algo); + printf("%s\n", algo); - ret = fit_image_hash_get_value (fit, noffset, &value, + ret = fit_image_hash_get_value(fit, noffset, &value, &value_len); - printf ("%s Hash value: ", p); + printf("%s Hash value: ", p); if (ret) { - printf ("unavailable\n"); + printf("unavailable\n"); } else { for (i = 0; i < value_len; i++) - printf ("%02x", value[i]); - printf ("\n"); + printf("%02x", value[i]); + printf("\n"); } - debug ("%s Hash len: %d\n", p, value_len); + debug("%s Hash len: %d\n", p, value_len); } /** @@ -1498,13 +2142,13 @@ void fit_image_print_hash (const void *fit, int noffset, const char *p) * 0, on success * -1, on failure */ -int fit_get_desc (const void *fit, int noffset, char **desc) +int fit_get_desc(const void *fit, int noffset, char **desc) { int len; - *desc = (char *)fdt_getprop (fit, noffset, FIT_DESC_PROP, &len); + *desc = (char *)fdt_getprop(fit, noffset, FIT_DESC_PROP, &len); if (*desc == NULL) { - fit_get_debug (fit, noffset, FIT_DESC_PROP, len); + fit_get_debug(fit, noffset, FIT_DESC_PROP, len); return -1; } @@ -1526,22 +2170,22 @@ int fit_get_desc (const void *fit, int noffset, char **desc) * -1, on property read failure * -2, on wrong timestamp size */ -int fit_get_timestamp (const void *fit, int noffset, time_t *timestamp) +int fit_get_timestamp(const void *fit, int noffset, time_t *timestamp) { int len; const void *data; - data = fdt_getprop (fit, noffset, FIT_TIMESTAMP_PROP, &len); + data = fdt_getprop(fit, noffset, FIT_TIMESTAMP_PROP, &len); if (data == NULL) { - fit_get_debug (fit, noffset, FIT_TIMESTAMP_PROP, len); + fit_get_debug(fit, noffset, FIT_TIMESTAMP_PROP, len); return -1; } - if (len != sizeof (uint32_t)) { - debug ("FIT timestamp with incorrect size of (%u)\n", len); + if (len != sizeof(uint32_t)) { + debug("FIT timestamp with incorrect size of (%u)\n", len); return -2; } - *timestamp = uimage_to_cpu (*((uint32_t *)data)); + *timestamp = uimage_to_cpu(*((uint32_t *)data)); return 0; } @@ -1558,21 +2202,21 @@ int fit_get_timestamp (const void *fit, int noffset, time_t *timestamp) * image node offset when found (>=0) * negative number on failure (FDT_ERR_* code) */ -int fit_image_get_node (const void *fit, const char *image_uname) +int fit_image_get_node(const void *fit, const char *image_uname) { int noffset, images_noffset; - images_noffset = fdt_path_offset (fit, FIT_IMAGES_PATH); + images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH); if (images_noffset < 0) { - debug ("Can't find images parent node '%s' (%s)\n", - FIT_IMAGES_PATH, fdt_strerror (images_noffset)); + debug("Can't find images parent node '%s' (%s)\n", + FIT_IMAGES_PATH, fdt_strerror(images_noffset)); return images_noffset; } - noffset = fdt_subnode_offset (fit, images_noffset, image_uname); + noffset = fdt_subnode_offset(fit, images_noffset, image_uname); if (noffset < 0) { - debug ("Can't get node offset for image unit name: '%s' (%s)\n", - image_uname, fdt_strerror (noffset)); + debug("Can't get node offset for image unit name: '%s' (%s)\n", + image_uname, fdt_strerror(noffset)); } return noffset; @@ -1592,21 +2236,21 @@ int fit_image_get_node (const void *fit, const char *image_uname) * 0, on success * -1, on failure */ -int fit_image_get_os (const void *fit, int noffset, uint8_t *os) +int fit_image_get_os(const void *fit, int noffset, uint8_t *os) { int len; const void *data; /* Get OS name from property data */ - data = fdt_getprop (fit, noffset, FIT_OS_PROP, &len); + data = fdt_getprop(fit, noffset, FIT_OS_PROP, &len); if (data == NULL) { - fit_get_debug (fit, noffset, FIT_OS_PROP, len); + fit_get_debug(fit, noffset, FIT_OS_PROP, len); *os = -1; return -1; } /* Translate OS name to id */ - *os = genimg_get_os_id (data); + *os = genimg_get_os_id(data); return 0; } @@ -1624,21 +2268,21 @@ int fit_image_get_os (const void *fit, int noffset, uint8_t *os) * 0, on success * -1, on failure */ -int fit_image_get_arch (const void *fit, int noffset, uint8_t *arch) +int fit_image_get_arch(const void *fit, int noffset, uint8_t *arch) { int len; const void *data; /* Get architecture name from property data */ - data = fdt_getprop (fit, noffset, FIT_ARCH_PROP, &len); + data = fdt_getprop(fit, noffset, FIT_ARCH_PROP, &len); if (data == NULL) { - fit_get_debug (fit, noffset, FIT_ARCH_PROP, len); + fit_get_debug(fit, noffset, FIT_ARCH_PROP, len); *arch = -1; return -1; } /* Translate architecture name to id */ - *arch = genimg_get_arch_id (data); + *arch = genimg_get_arch_id(data); return 0; } @@ -1656,21 +2300,21 @@ int fit_image_get_arch (const void *fit, int noffset, uint8_t *arch) * 0, on success * -1, on failure */ -int fit_image_get_type (const void *fit, int noffset, uint8_t *type) +int fit_image_get_type(const void *fit, int noffset, uint8_t *type) { int len; const void *data; /* Get image type name from property data */ - data = fdt_getprop (fit, noffset, FIT_TYPE_PROP, &len); + data = fdt_getprop(fit, noffset, FIT_TYPE_PROP, &len); if (data == NULL) { - fit_get_debug (fit, noffset, FIT_TYPE_PROP, len); + fit_get_debug(fit, noffset, FIT_TYPE_PROP, len); *type = -1; return -1; } /* Translate image type name to id */ - *type = genimg_get_type_id (data); + *type = genimg_get_type_id(data); return 0; } @@ -1688,21 +2332,21 @@ int fit_image_get_type (const void *fit, int noffset, uint8_t *type) * 0, on success * -1, on failure */ -int fit_image_get_comp (const void *fit, int noffset, uint8_t *comp) +int fit_image_get_comp(const void *fit, int noffset, uint8_t *comp) { int len; const void *data; /* Get compression name from property data */ - data = fdt_getprop (fit, noffset, FIT_COMP_PROP, &len); + data = fdt_getprop(fit, noffset, FIT_COMP_PROP, &len); if (data == NULL) { - fit_get_debug (fit, noffset, FIT_COMP_PROP, len); + fit_get_debug(fit, noffset, FIT_COMP_PROP, len); *comp = -1; return -1; } /* Translate compression name to id */ - *comp = genimg_get_comp_id (data); + *comp = genimg_get_comp_id(data); return 0; } @@ -1719,18 +2363,18 @@ int fit_image_get_comp (const void *fit, int noffset, uint8_t *comp) * 0, on success * -1, on failure */ -int fit_image_get_load (const void *fit, int noffset, ulong *load) +int fit_image_get_load(const void *fit, int noffset, ulong *load) { int len; const uint32_t *data; - data = fdt_getprop (fit, noffset, FIT_LOAD_PROP, &len); + data = fdt_getprop(fit, noffset, FIT_LOAD_PROP, &len); if (data == NULL) { - fit_get_debug (fit, noffset, FIT_LOAD_PROP, len); + fit_get_debug(fit, noffset, FIT_LOAD_PROP, len); return -1; } - *load = uimage_to_cpu (*data); + *load = uimage_to_cpu(*data); return 0; } @@ -1747,18 +2391,18 @@ int fit_image_get_load (const void *fit, int noffset, ulong *load) * 0, on success * -1, on failure */ -int fit_image_get_entry (const void *fit, int noffset, ulong *entry) +int fit_image_get_entry(const void *fit, int noffset, ulong *entry) { int len; const uint32_t *data; - data = fdt_getprop (fit, noffset, FIT_ENTRY_PROP, &len); + data = fdt_getprop(fit, noffset, FIT_ENTRY_PROP, &len); if (data == NULL) { - fit_get_debug (fit, noffset, FIT_ENTRY_PROP, len); + fit_get_debug(fit, noffset, FIT_ENTRY_PROP, len); return -1; } - *entry = uimage_to_cpu (*data); + *entry = uimage_to_cpu(*data); return 0; } @@ -1777,14 +2421,14 @@ int fit_image_get_entry (const void *fit, int noffset, ulong *entry) * 0, on success * -1, on failure */ -int fit_image_get_data (const void *fit, int noffset, +int fit_image_get_data(const void *fit, int noffset, const void **data, size_t *size) { int len; - *data = fdt_getprop (fit, noffset, FIT_DATA_PROP, &len); + *data = fdt_getprop(fit, noffset, FIT_DATA_PROP, &len); if (*data == NULL) { - fit_get_debug (fit, noffset, FIT_DATA_PROP, len); + fit_get_debug(fit, noffset, FIT_DATA_PROP, len); *size = 0; return -1; } @@ -1806,13 +2450,13 @@ int fit_image_get_data (const void *fit, int noffset, * 0, on success * -1, on failure */ -int fit_image_hash_get_algo (const void *fit, int noffset, char **algo) +int fit_image_hash_get_algo(const void *fit, int noffset, char **algo) { int len; - *algo = (char *)fdt_getprop (fit, noffset, FIT_ALGO_PROP, &len); + *algo = (char *)fdt_getprop(fit, noffset, FIT_ALGO_PROP, &len); if (*algo == NULL) { - fit_get_debug (fit, noffset, FIT_ALGO_PROP, len); + fit_get_debug(fit, noffset, FIT_ALGO_PROP, len); return -1; } @@ -1834,14 +2478,14 @@ int fit_image_hash_get_algo (const void *fit, int noffset, char **algo) * 0, on success * -1, on failure */ -int fit_image_hash_get_value (const void *fit, int noffset, uint8_t **value, +int fit_image_hash_get_value(const void *fit, int noffset, uint8_t **value, int *value_len) { int len; - *value = (uint8_t *)fdt_getprop (fit, noffset, FIT_VALUE_PROP, &len); + *value = (uint8_t *)fdt_getprop(fit, noffset, FIT_VALUE_PROP, &len); if (*value == NULL) { - fit_get_debug (fit, noffset, FIT_VALUE_PROP, len); + fit_get_debug(fit, noffset, FIT_VALUE_PROP, len); *value_len = 0; return -1; } @@ -1863,18 +2507,18 @@ int fit_image_hash_get_value (const void *fit, int noffset, uint8_t **value, * 0, on success * -1, on property read failure */ -int fit_set_timestamp (void *fit, int noffset, time_t timestamp) +int fit_set_timestamp(void *fit, int noffset, time_t timestamp) { uint32_t t; int ret; - t = cpu_to_uimage (timestamp); - ret = fdt_setprop (fit, noffset, FIT_TIMESTAMP_PROP, &t, - sizeof (uint32_t)); + t = cpu_to_uimage(timestamp); + ret = fdt_setprop(fit, noffset, FIT_TIMESTAMP_PROP, &t, + sizeof(uint32_t)); if (ret) { - printf ("Can't set '%s' property for '%s' node (%s)\n", - FIT_TIMESTAMP_PROP, fit_get_name (fit, noffset, NULL), - fdt_strerror (ret)); + printf("Can't set '%s' property for '%s' node (%s)\n", + FIT_TIMESTAMP_PROP, fit_get_name(fit, noffset, NULL), + fdt_strerror(ret)); return -1; } @@ -1898,23 +2542,23 @@ int fit_set_timestamp (void *fit, int noffset, time_t timestamp) * 0, on success * -1, when algo is unsupported */ -static int calculate_hash (const void *data, int data_len, const char *algo, +static int calculate_hash(const void *data, int data_len, const char *algo, uint8_t *value, int *value_len) { - if (strcmp (algo, "crc32") == 0 ) { - *((uint32_t *)value) = crc32_wd (0, data, data_len, + if (strcmp(algo, "crc32") == 0) { + *((uint32_t *)value) = crc32_wd(0, data, data_len, CHUNKSZ_CRC32); - *((uint32_t *)value) = cpu_to_uimage (*((uint32_t *)value)); + *((uint32_t *)value) = cpu_to_uimage(*((uint32_t *)value)); *value_len = 4; - } else if (strcmp (algo, "sha1") == 0 ) { - sha1_csum_wd ((unsigned char *) data, data_len, + } else if (strcmp(algo, "sha1") == 0) { + sha1_csum_wd((unsigned char *) data, data_len, (unsigned char *) value, CHUNKSZ_SHA1); *value_len = 20; - } else if (strcmp (algo, "md5") == 0 ) { - md5_wd ((unsigned char *)data, data_len, value, CHUNKSZ_MD5); + } else if (strcmp(algo, "md5") == 0) { + md5_wd((unsigned char *)data, data_len, value, CHUNKSZ_MD5); *value_len = 16; } else { - debug ("Unsupported hash alogrithm\n"); + debug("Unsupported hash alogrithm\n"); return -1; } return 0; @@ -1933,7 +2577,7 @@ static int calculate_hash (const void *data, int data_len, const char *algo, * 0, on success * libfdt error code, on failure */ -int fit_set_hashes (void *fit) +int fit_set_hashes(void *fit) { int images_noffset; int noffset; @@ -1941,23 +2585,23 @@ int fit_set_hashes (void *fit) int ret; /* Find images parent node offset */ - images_noffset = fdt_path_offset (fit, FIT_IMAGES_PATH); + images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH); if (images_noffset < 0) { - printf ("Can't find images parent node '%s' (%s)\n", - FIT_IMAGES_PATH, fdt_strerror (images_noffset)); + printf("Can't find images parent node '%s' (%s)\n", + FIT_IMAGES_PATH, fdt_strerror(images_noffset)); return images_noffset; } /* Process its subnodes, print out component images details */ - for (ndepth = 0, noffset = fdt_next_node (fit, images_noffset, &ndepth); + for (ndepth = 0, noffset = fdt_next_node(fit, images_noffset, &ndepth); (noffset >= 0) && (ndepth > 0); - noffset = fdt_next_node (fit, noffset, &ndepth)) { + noffset = fdt_next_node(fit, noffset, &ndepth)) { if (ndepth == 1) { /* * Direct child node of the images parent node, * i.e. component image node. */ - ret = fit_image_set_hashes (fit, noffset); + ret = fit_image_set_hashes(fit, noffset); if (ret) return ret; } @@ -1995,7 +2639,7 @@ int fit_set_hashes (void *fit) * 0 on sucess * <0 on failure */ -int fit_image_set_hashes (void *fit, int image_noffset) +int fit_image_set_hashes(void *fit, int image_noffset) { const void *data; size_t size; @@ -2006,15 +2650,15 @@ int fit_image_set_hashes (void *fit, int image_noffset) int ndepth; /* Get image data and data length */ - if (fit_image_get_data (fit, image_noffset, &data, &size)) { - printf ("Can't get image data/size\n"); + if (fit_image_get_data(fit, image_noffset, &data, &size)) { + printf("Can't get image data/size\n"); return -1; } /* Process all hash subnodes of the component image node */ - for (ndepth = 0, noffset = fdt_next_node (fit, image_noffset, &ndepth); + for (ndepth = 0, noffset = fdt_next_node(fit, image_noffset, &ndepth); (noffset >= 0) && (ndepth > 0); - noffset = fdt_next_node (fit, noffset, &ndepth)) { + noffset = fdt_next_node(fit, noffset, &ndepth)) { if (ndepth == 1) { /* Direct child node of the component image node */ @@ -2023,35 +2667,37 @@ int fit_image_set_hashes (void *fit, int image_noffset) * Multiple hash nodes require unique unit node * names, e.g. hash@1, hash@2, etc. */ - if (strncmp (fit_get_name(fit, noffset, NULL), + if (strncmp(fit_get_name(fit, noffset, NULL), FIT_HASH_NODENAME, strlen(FIT_HASH_NODENAME)) != 0) { /* Not a hash subnode, skip it */ continue; } - if (fit_image_hash_get_algo (fit, noffset, &algo)) { - printf ("Can't get hash algo property for " + if (fit_image_hash_get_algo(fit, noffset, &algo)) { + printf("Can't get hash algo property for " "'%s' hash node in '%s' image node\n", - fit_get_name (fit, noffset, NULL), - fit_get_name (fit, image_noffset, NULL)); + fit_get_name(fit, noffset, NULL), + fit_get_name(fit, image_noffset, NULL)); return -1; } - if (calculate_hash (data, size, algo, value, &value_len)) { - printf ("Unsupported hash algorithm (%s) for " + if (calculate_hash(data, size, algo, value, + &value_len)) { + printf("Unsupported hash algorithm (%s) for " "'%s' hash node in '%s' image node\n", - algo, fit_get_name (fit, noffset, NULL), - fit_get_name (fit, image_noffset, NULL)); + algo, fit_get_name(fit, noffset, NULL), + fit_get_name(fit, image_noffset, + NULL)); return -1; } - if (fit_image_hash_set_value (fit, noffset, value, + if (fit_image_hash_set_value(fit, noffset, value, value_len)) { - printf ("Can't set hash value for " + printf("Can't set hash value for " "'%s' hash node in '%s' image node\n", - fit_get_name (fit, noffset, NULL), - fit_get_name (fit, image_noffset, NULL)); + fit_get_name(fit, noffset, NULL), + fit_get_name(fit, image_noffset, NULL)); return -1; } } @@ -2074,16 +2720,16 @@ int fit_image_set_hashes (void *fit, int image_noffset) * 0, on success * -1, on failure */ -int fit_image_hash_set_value (void *fit, int noffset, uint8_t *value, +int fit_image_hash_set_value(void *fit, int noffset, uint8_t *value, int value_len) { int ret; - ret = fdt_setprop (fit, noffset, FIT_VALUE_PROP, value, value_len); + ret = fdt_setprop(fit, noffset, FIT_VALUE_PROP, value, value_len); if (ret) { - printf ("Can't set hash '%s' property for '%s' node (%s)\n", - FIT_VALUE_PROP, fit_get_name (fit, noffset, NULL), - fdt_strerror (ret)); + printf("Can't set hash '%s' property for '%s' node(%s)\n", + FIT_VALUE_PROP, fit_get_name(fit, noffset, NULL), + fdt_strerror(ret)); return -1; } @@ -2104,7 +2750,7 @@ int fit_image_hash_set_value (void *fit, int noffset, uint8_t *value, * 1, if all hashes are valid * 0, otherwise (or on error) */ -int fit_image_check_hashes (const void *fit, int image_noffset) +int fit_image_check_hashes(const void *fit, int image_noffset) { const void *data; size_t size; @@ -2118,15 +2764,15 @@ int fit_image_check_hashes (const void *fit, int image_noffset) char *err_msg = ""; /* Get image data and data length */ - if (fit_image_get_data (fit, image_noffset, &data, &size)) { - printf ("Can't get image data/size\n"); + if (fit_image_get_data(fit, image_noffset, &data, &size)) { + printf("Can't get image data/size\n"); return 0; } /* Process all hash subnodes of the component image node */ - for (ndepth = 0, noffset = fdt_next_node (fit, image_noffset, &ndepth); + for (ndepth = 0, noffset = fdt_next_node(fit, image_noffset, &ndepth); (noffset >= 0) && (ndepth > 0); - noffset = fdt_next_node (fit, noffset, &ndepth)) { + noffset = fdt_next_node(fit, noffset, &ndepth)) { if (ndepth == 1) { /* Direct child node of the component image node */ @@ -2135,48 +2781,101 @@ int fit_image_check_hashes (const void *fit, int image_noffset) * Multiple hash nodes require unique unit node * names, e.g. hash@1, hash@2, etc. */ - if (strncmp (fit_get_name(fit, noffset, NULL), + if (strncmp(fit_get_name(fit, noffset, NULL), FIT_HASH_NODENAME, strlen(FIT_HASH_NODENAME)) != 0) continue; - if (fit_image_hash_get_algo (fit, noffset, &algo)) { - err_msg = "Can't get hash algo property"; + if (fit_image_hash_get_algo(fit, noffset, &algo)) { + err_msg = " error!\nCan't get hash algo " + "property"; goto error; } - printf ("%s", algo); + printf("%s", algo); - if (fit_image_hash_get_value (fit, noffset, &fit_value, + if (fit_image_hash_get_value(fit, noffset, &fit_value, &fit_value_len)) { - err_msg = "Can't get hash value property"; + err_msg = " error!\nCan't get hash value " + "property"; goto error; } - if (calculate_hash (data, size, algo, value, &value_len)) { - err_msg = "Unsupported hash algorithm"; + if (calculate_hash(data, size, algo, value, + &value_len)) { + err_msg = " error!\n" + "Unsupported hash algorithm"; goto error; } if (value_len != fit_value_len) { - err_msg = "Bad hash value len"; + err_msg = " error !\nBad hash value len"; goto error; - } else if (memcmp (value, fit_value, value_len) != 0) { - err_msg = "Bad hash value"; + } else if (memcmp(value, fit_value, value_len) != 0) { + err_msg = " error!\nBad hash value"; goto error; } - printf ("+ "); + printf("+ "); } } return 1; error: - printf ("%s for '%s' hash node in '%s' image node\n", - err_msg, fit_get_name (fit, noffset, NULL), - fit_get_name (fit, image_noffset, NULL)); + printf("%s for '%s' hash node in '%s' image node\n", + err_msg, fit_get_name(fit, noffset, NULL), + fit_get_name(fit, image_noffset, NULL)); return 0; } +/** + * fit_all_image_check_hashes - verify data intergity for all images + * @fit: pointer to the FIT format image header + * + * fit_all_image_check_hashes() goes over all images in the FIT and + * for every images checks if all it's hashes are valid. + * + * returns: + * 1, if all hashes of all images are valid + * 0, otherwise (or on error) + */ +int fit_all_image_check_hashes(const void *fit) +{ + int images_noffset; + int noffset; + int ndepth; + int count; + + /* Find images parent node offset */ + images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH); + if (images_noffset < 0) { + printf("Can't find images parent node '%s' (%s)\n", + FIT_IMAGES_PATH, fdt_strerror(images_noffset)); + return 0; + } + + /* Process all image subnodes, check hashes for each */ + printf("## Checking hash(es) for FIT Image at %08lx ...\n", + (ulong)fit); + for (ndepth = 0, count = 0, + noffset = fdt_next_node(fit, images_noffset, &ndepth); + (noffset >= 0) && (ndepth > 0); + noffset = fdt_next_node(fit, noffset, &ndepth)) { + if (ndepth == 1) { + /* + * Direct child node of the images parent node, + * i.e. component image node. + */ + printf(" Hash(es) for Image %u (%s): ", count++, + fit_get_name(fit, noffset, NULL)); + + if (!fit_image_check_hashes(fit, noffset)) + return 0; + printf("\n"); + } + } + return 1; +} + /** * fit_image_check_os - check whether image node is of a given os type * @fit: pointer to the FIT format image header @@ -2190,11 +2889,11 @@ error: * 1 if image is of given os type * 0 otherwise (or on error) */ -int fit_image_check_os (const void *fit, int noffset, uint8_t os) +int fit_image_check_os(const void *fit, int noffset, uint8_t os) { uint8_t image_os; - if (fit_image_get_os (fit, noffset, &image_os)) + if (fit_image_get_os(fit, noffset, &image_os)) return 0; return (os == image_os); } @@ -2212,11 +2911,11 @@ int fit_image_check_os (const void *fit, int noffset, uint8_t os) * 1 if image is of given arch * 0 otherwise (or on error) */ -int fit_image_check_arch (const void *fit, int noffset, uint8_t arch) +int fit_image_check_arch(const void *fit, int noffset, uint8_t arch) { uint8_t image_arch; - if (fit_image_get_arch (fit, noffset, &image_arch)) + if (fit_image_get_arch(fit, noffset, &image_arch)) return 0; return (arch == image_arch); } @@ -2234,11 +2933,11 @@ int fit_image_check_arch (const void *fit, int noffset, uint8_t arch) * 1 if image is of given type * 0 otherwise (or on error) */ -int fit_image_check_type (const void *fit, int noffset, uint8_t type) +int fit_image_check_type(const void *fit, int noffset, uint8_t type) { uint8_t image_type; - if (fit_image_get_type (fit, noffset, &image_type)) + if (fit_image_get_type(fit, noffset, &image_type)) return 0; return (type == image_type); } @@ -2257,11 +2956,11 @@ int fit_image_check_type (const void *fit, int noffset, uint8_t type) * 1 if image uses requested compression * 0 otherwise (or on error) */ -int fit_image_check_comp (const void *fit, int noffset, uint8_t comp) +int fit_image_check_comp(const void *fit, int noffset, uint8_t comp) { uint8_t image_comp; - if (fit_image_get_comp (fit, noffset, &image_comp)) + if (fit_image_get_comp(fit, noffset, &image_comp)) return 0; return (comp == image_comp); } @@ -2277,25 +2976,25 @@ int fit_image_check_comp (const void *fit, int noffset, uint8_t comp) * 1, on success * 0, on failure */ -int fit_check_format (const void *fit) +int fit_check_format(const void *fit) { /* mandatory / node 'description' property */ - if (fdt_getprop (fit, 0, FIT_DESC_PROP, NULL) == NULL) { - debug ("Wrong FIT format: no description\n"); + if (fdt_getprop(fit, 0, FIT_DESC_PROP, NULL) == NULL) { + debug("Wrong FIT format: no description\n"); return 0; } #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE) || defined(USE_HOSTCC) /* mandatory / node 'timestamp' property */ - if (fdt_getprop (fit, 0, FIT_TIMESTAMP_PROP, NULL) == NULL) { - debug ("Wrong FIT format: no description\n"); + if (fdt_getprop(fit, 0, FIT_TIMESTAMP_PROP, NULL) == NULL) { + debug("Wrong FIT format: no timestamp\n"); return 0; } #endif /* mandatory subimages parent '/images' node */ - if (fdt_path_offset (fit, FIT_IMAGES_PATH) < 0) { - debug ("Wrong FIT format: no images parent node\n"); + if (fdt_path_offset(fit, FIT_IMAGES_PATH) < 0) { + debug("Wrong FIT format: no images parent node\n"); return 0; } @@ -2319,50 +3018,53 @@ int fit_check_format (const void *fit) * configuration node offset when found (>=0) * negative number on failure (FDT_ERR_* code) */ -int fit_conf_get_node (const void *fit, const char *conf_uname) +int fit_conf_get_node(const void *fit, const char *conf_uname) { int noffset, confs_noffset; int len; - confs_noffset = fdt_path_offset (fit, FIT_CONFS_PATH); + confs_noffset = fdt_path_offset(fit, FIT_CONFS_PATH); if (confs_noffset < 0) { - debug ("Can't find configurations parent node '%s' (%s)\n", - FIT_CONFS_PATH, fdt_strerror (confs_noffset)); + debug("Can't find configurations parent node '%s' (%s)\n", + FIT_CONFS_PATH, fdt_strerror(confs_noffset)); return confs_noffset; } if (conf_uname == NULL) { /* get configuration unit name from the default property */ - debug ("No configuration specified, trying default...\n"); - conf_uname = (char *)fdt_getprop (fit, confs_noffset, FIT_DEFAULT_PROP, &len); + debug("No configuration specified, trying default...\n"); + conf_uname = (char *)fdt_getprop(fit, confs_noffset, + FIT_DEFAULT_PROP, &len); if (conf_uname == NULL) { - fit_get_debug (fit, confs_noffset, FIT_DEFAULT_PROP, len); + fit_get_debug(fit, confs_noffset, FIT_DEFAULT_PROP, + len); return len; } - debug ("Found default configuration: '%s'\n", conf_uname); + debug("Found default configuration: '%s'\n", conf_uname); } - noffset = fdt_subnode_offset (fit, confs_noffset, conf_uname); + noffset = fdt_subnode_offset(fit, confs_noffset, conf_uname); if (noffset < 0) { - debug ("Can't get node offset for configuration unit name: '%s' (%s)\n", - conf_uname, fdt_strerror (noffset)); + debug("Can't get node offset for configuration unit name: " + "'%s' (%s)\n", + conf_uname, fdt_strerror(noffset)); } return noffset; } -static int __fit_conf_get_prop_node (const void *fit, int noffset, +static int __fit_conf_get_prop_node(const void *fit, int noffset, const char *prop_name) { char *uname; int len; /* get kernel image unit name from configuration kernel property */ - uname = (char *)fdt_getprop (fit, noffset, prop_name, &len); + uname = (char *)fdt_getprop(fit, noffset, prop_name, &len); if (uname == NULL) return len; - return fit_image_get_node (fit, uname); + return fit_image_get_node(fit, uname); } /** @@ -2379,9 +3081,9 @@ static int __fit_conf_get_prop_node (const void *fit, int noffset, * image node offset when found (>=0) * negative number on failure (FDT_ERR_* code) */ -int fit_conf_get_kernel_node (const void *fit, int noffset) +int fit_conf_get_kernel_node(const void *fit, int noffset) { - return __fit_conf_get_prop_node (fit, noffset, FIT_KERNEL_PROP); + return __fit_conf_get_prop_node(fit, noffset, FIT_KERNEL_PROP); } /** @@ -2398,9 +3100,9 @@ int fit_conf_get_kernel_node (const void *fit, int noffset) * image node offset when found (>=0) * negative number on failure (FDT_ERR_* code) */ -int fit_conf_get_ramdisk_node (const void *fit, int noffset) +int fit_conf_get_ramdisk_node(const void *fit, int noffset) { - return __fit_conf_get_prop_node (fit, noffset, FIT_RAMDISK_PROP); + return __fit_conf_get_prop_node(fit, noffset, FIT_RAMDISK_PROP); } /** @@ -2417,9 +3119,9 @@ int fit_conf_get_ramdisk_node (const void *fit, int noffset) * image node offset when found (>=0) * negative number on failure (FDT_ERR_* code) */ -int fit_conf_get_fdt_node (const void *fit, int noffset) +int fit_conf_get_fdt_node(const void *fit, int noffset) { - return __fit_conf_get_prop_node (fit, noffset, FIT_FDT_PROP); + return __fit_conf_get_prop_node(fit, noffset, FIT_FDT_PROP); } /** @@ -2434,35 +3136,35 @@ int fit_conf_get_fdt_node (const void *fit, int noffset) * returns: * no returned results */ -void fit_conf_print (const void *fit, int noffset, const char *p) +void fit_conf_print(const void *fit, int noffset, const char *p) { char *desc; char *uname; int ret; /* Mandatory properties */ - ret = fit_get_desc (fit, noffset, &desc); - printf ("%s Description: ", p); + ret = fit_get_desc(fit, noffset, &desc); + printf("%s Description: ", p); if (ret) - printf ("unavailable\n"); + printf("unavailable\n"); else - printf ("%s\n", desc); + printf("%s\n", desc); - uname = (char *)fdt_getprop (fit, noffset, FIT_KERNEL_PROP, NULL); - printf ("%s Kernel: ", p); + uname = (char *)fdt_getprop(fit, noffset, FIT_KERNEL_PROP, NULL); + printf("%s Kernel: ", p); if (uname == NULL) - printf ("unavailable\n"); + printf("unavailable\n"); else - printf ("%s\n", uname); + printf("%s\n", uname); /* Optional properties */ - uname = (char *)fdt_getprop (fit, noffset, FIT_RAMDISK_PROP, NULL); + uname = (char *)fdt_getprop(fit, noffset, FIT_RAMDISK_PROP, NULL); if (uname) - printf ("%s Init Ramdisk: %s\n", p, uname); + printf("%s Init Ramdisk: %s\n", p, uname); - uname = (char *)fdt_getprop (fit, noffset, FIT_FDT_PROP, NULL); + uname = (char *)fdt_getprop(fit, noffset, FIT_FDT_PROP, NULL); if (uname) - printf ("%s FDT: %s\n", p, uname); + printf("%s FDT: %s\n", p, uname); } /** @@ -2480,31 +3182,32 @@ void fit_conf_print (const void *fit, int noffset, const char *p) * 0, on failure */ #ifndef USE_HOSTCC -static int fit_check_ramdisk (const void *fit, int rd_noffset, uint8_t arch, int verify) +static int fit_check_ramdisk(const void *fit, int rd_noffset, uint8_t arch, + int verify) { - fit_image_print (fit, rd_noffset, " "); + fit_image_print(fit, rd_noffset, " "); if (verify) { - puts (" Verifying Hash Integrity ... "); - if (!fit_image_check_hashes (fit, rd_noffset)) { - puts ("Bad Data Hash\n"); - show_boot_progress (-125); + puts(" Verifying Hash Integrity ... "); + if (!fit_image_check_hashes(fit, rd_noffset)) { + puts("Bad Data Hash\n"); + bootstage_error(BOOTSTAGE_ID_FIT_RD_HASH); return 0; } - puts ("OK\n"); + puts("OK\n"); } - show_boot_progress (126); - if (!fit_image_check_os (fit, rd_noffset, IH_OS_LINUX) || - !fit_image_check_arch (fit, rd_noffset, arch) || - !fit_image_check_type (fit, rd_noffset, IH_TYPE_RAMDISK)) { - printf ("No Linux %s Ramdisk Image\n", + bootstage_mark(BOOTSTAGE_ID_FIT_RD_CHECK_ALL); + if (!fit_image_check_os(fit, rd_noffset, IH_OS_LINUX) || + !fit_image_check_arch(fit, rd_noffset, arch) || + !fit_image_check_type(fit, rd_noffset, IH_TYPE_RAMDISK)) { + printf("No Linux %s Ramdisk Image\n", genimg_get_arch_name(arch)); - show_boot_progress (-126); + bootstage_error(BOOTSTAGE_ID_FIT_RD_CHECK_ALL); return 0; } - show_boot_progress (127); + bootstage_mark(BOOTSTAGE_ID_FIT_RD_CHECK_ALL_OK); return 1; } #endif /* USE_HOSTCC */