1 /* 2 * (C) Copyright 2008 Semihalf 3 * 4 * (C) Copyright 2000-2004 5 * DENX Software Engineering 6 * Wolfgang Denk, wd@denx.de 7 * 8 * Updated-by: Prafulla Wadaskar <prafulla@marvell.com> 9 * default_image specific code abstracted from mkimage.c 10 * some functions added to address abstraction 11 * 12 * All rights reserved. 13 * 14 * SPDX-License-Identifier: GPL-2.0+ 15 */ 16 17 #include "imagetool.h" 18 #include "mkimage.h" 19 20 #include <image.h> 21 #include <tee/optee.h> 22 #include <u-boot/crc.h> 23 24 static image_header_t header; 25 26 static int image_check_image_types(uint8_t type) 27 { 28 if (((type > IH_TYPE_INVALID) && (type < IH_TYPE_FLATDT)) || 29 (type == IH_TYPE_KERNEL_NOLOAD) || (type == IH_TYPE_FIRMWARE_IVT)) 30 return EXIT_SUCCESS; 31 else 32 return EXIT_FAILURE; 33 } 34 35 static int image_check_params(struct image_tool_params *params) 36 { 37 return ((params->dflag && (params->fflag || params->lflag)) || 38 (params->fflag && (params->dflag || params->lflag)) || 39 (params->lflag && (params->dflag || params->fflag))); 40 } 41 42 static int image_verify_header(unsigned char *ptr, int image_size, 43 struct image_tool_params *params) 44 { 45 uint32_t len; 46 const unsigned char *data; 47 uint32_t checksum; 48 image_header_t header; 49 image_header_t *hdr = &header; 50 51 /* 52 * create copy of header so that we can blank out the 53 * checksum field for checking - this can't be done 54 * on the PROT_READ mapped data. 55 */ 56 memcpy(hdr, ptr, sizeof(image_header_t)); 57 58 if (be32_to_cpu(hdr->ih_magic) != IH_MAGIC) { 59 debug("%s: Bad Magic Number: \"%s\" is no valid image\n", 60 params->cmdname, params->imagefile); 61 return -FDT_ERR_BADMAGIC; 62 } 63 64 data = (const unsigned char *)hdr; 65 len = sizeof(image_header_t); 66 67 checksum = be32_to_cpu(hdr->ih_hcrc); 68 hdr->ih_hcrc = cpu_to_be32(0); /* clear for re-calculation */ 69 70 if (crc32(0, data, len) != checksum) { 71 debug("%s: ERROR: \"%s\" has bad header checksum!\n", 72 params->cmdname, params->imagefile); 73 return -FDT_ERR_BADSTATE; 74 } 75 76 data = (const unsigned char *)ptr + sizeof(image_header_t); 77 len = image_size - sizeof(image_header_t) ; 78 79 checksum = be32_to_cpu(hdr->ih_dcrc); 80 if (crc32(0, data, len) != checksum) { 81 debug("%s: ERROR: \"%s\" has corrupted data!\n", 82 params->cmdname, params->imagefile); 83 return -FDT_ERR_BADSTRUCTURE; 84 } 85 return 0; 86 } 87 88 static void image_set_header(void *ptr, struct stat *sbuf, int ifd, 89 struct image_tool_params *params) 90 { 91 uint32_t checksum; 92 time_t time; 93 uint32_t imagesize; 94 uint32_t ep; 95 uint32_t addr; 96 97 image_header_t * hdr = (image_header_t *)ptr; 98 99 checksum = crc32(0, 100 (const unsigned char *)(ptr + 101 sizeof(image_header_t)), 102 sbuf->st_size - sizeof(image_header_t)); 103 104 time = imagetool_get_source_date(params, sbuf->st_mtime); 105 ep = params->ep; 106 addr = params->addr; 107 108 if (params->type == IH_TYPE_FIRMWARE_IVT) 109 /* Add size of CSF minus IVT */ 110 imagesize = sbuf->st_size - sizeof(image_header_t) + 0x1FE0; 111 else 112 imagesize = sbuf->st_size - sizeof(image_header_t); 113 114 if (params->os == IH_OS_TEE) { 115 addr = optee_image_get_load_addr(hdr); 116 ep = optee_image_get_entry_point(hdr); 117 } 118 119 /* Build new header */ 120 image_set_magic(hdr, IH_MAGIC); 121 image_set_time(hdr, time); 122 image_set_size(hdr, imagesize); 123 image_set_load(hdr, addr); 124 image_set_ep(hdr, ep); 125 image_set_dcrc(hdr, checksum); 126 image_set_os(hdr, params->os); 127 image_set_arch(hdr, params->arch); 128 image_set_type(hdr, params->type); 129 image_set_comp(hdr, params->comp); 130 131 image_set_name(hdr, params->imagename); 132 133 checksum = crc32(0, (const unsigned char *)hdr, 134 sizeof(image_header_t)); 135 136 image_set_hcrc(hdr, checksum); 137 } 138 139 static int image_extract_subimage(void *ptr, struct image_tool_params *params) 140 { 141 const image_header_t *hdr = (const image_header_t *)ptr; 142 ulong file_data; 143 ulong file_len; 144 145 if (image_check_type(hdr, IH_TYPE_MULTI)) { 146 ulong idx = params->pflag; 147 ulong count; 148 149 /* get the number of data files present in the image */ 150 count = image_multi_count(hdr); 151 152 /* retrieve the "data file" at the idx position */ 153 image_multi_getimg(hdr, idx, &file_data, &file_len); 154 155 if ((file_len == 0) || (idx >= count)) { 156 fprintf(stderr, "%s: No such data file %ld in \"%s\"\n", 157 params->cmdname, idx, params->imagefile); 158 return -1; 159 } 160 } else { 161 file_data = image_get_data(hdr); 162 file_len = image_get_size(hdr); 163 } 164 165 /* save the "data file" into the file system */ 166 return imagetool_save_subimage(params->outfile, file_data, file_len); 167 } 168 169 /* 170 * Default image type parameters definition 171 */ 172 U_BOOT_IMAGE_TYPE( 173 defimage, 174 "Default Image support", 175 sizeof(image_header_t), 176 (void *)&header, 177 image_check_params, 178 image_verify_header, 179 image_print_contents, 180 image_set_header, 181 image_extract_subimage, 182 image_check_image_types, 183 NULL, 184 NULL 185 ); 186