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 <image.h> 19 #include <u-boot/crc.h> 20 21 static image_header_t header; 22 23 static int image_check_image_types(uint8_t type) 24 { 25 if (((type > IH_TYPE_INVALID) && (type < IH_TYPE_FLATDT)) || 26 (type == IH_TYPE_KERNEL_NOLOAD)) 27 return EXIT_SUCCESS; 28 else 29 return EXIT_FAILURE; 30 } 31 32 static int image_check_params(struct image_tool_params *params) 33 { 34 return ((params->dflag && (params->fflag || params->lflag)) || 35 (params->fflag && (params->dflag || params->lflag)) || 36 (params->lflag && (params->dflag || params->fflag))); 37 } 38 39 static int image_verify_header(unsigned char *ptr, int image_size, 40 struct image_tool_params *params) 41 { 42 uint32_t len; 43 const unsigned char *data; 44 uint32_t checksum; 45 image_header_t header; 46 image_header_t *hdr = &header; 47 48 /* 49 * create copy of header so that we can blank out the 50 * checksum field for checking - this can't be done 51 * on the PROT_READ mapped data. 52 */ 53 memcpy(hdr, ptr, sizeof(image_header_t)); 54 55 if (be32_to_cpu(hdr->ih_magic) != IH_MAGIC) { 56 fprintf(stderr, 57 "%s: Bad Magic Number: \"%s\" is no valid image\n", 58 params->cmdname, params->imagefile); 59 return -FDT_ERR_BADMAGIC; 60 } 61 62 data = (const unsigned char *)hdr; 63 len = sizeof(image_header_t); 64 65 checksum = be32_to_cpu(hdr->ih_hcrc); 66 hdr->ih_hcrc = cpu_to_be32(0); /* clear for re-calculation */ 67 68 if (crc32(0, data, len) != checksum) { 69 fprintf(stderr, 70 "%s: ERROR: \"%s\" has bad header checksum!\n", 71 params->cmdname, params->imagefile); 72 return -FDT_ERR_BADSTATE; 73 } 74 75 data = (const unsigned char *)ptr + sizeof(image_header_t); 76 len = image_size - sizeof(image_header_t) ; 77 78 checksum = be32_to_cpu(hdr->ih_dcrc); 79 if (crc32(0, data, len) != checksum) { 80 fprintf(stderr, 81 "%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 93 image_header_t * hdr = (image_header_t *)ptr; 94 95 checksum = crc32(0, 96 (const unsigned char *)(ptr + 97 sizeof(image_header_t)), 98 sbuf->st_size - sizeof(image_header_t)); 99 100 /* Build new header */ 101 image_set_magic(hdr, IH_MAGIC); 102 image_set_time(hdr, sbuf->st_mtime); 103 image_set_size(hdr, sbuf->st_size - sizeof(image_header_t)); 104 image_set_load(hdr, params->addr); 105 image_set_ep(hdr, params->ep); 106 image_set_dcrc(hdr, checksum); 107 image_set_os(hdr, params->os); 108 image_set_arch(hdr, params->arch); 109 image_set_type(hdr, params->type); 110 image_set_comp(hdr, params->comp); 111 112 image_set_name(hdr, params->imagename); 113 114 checksum = crc32(0, (const unsigned char *)hdr, 115 sizeof(image_header_t)); 116 117 image_set_hcrc(hdr, checksum); 118 } 119 120 static int image_save_datafile(struct image_tool_params *params, 121 ulong file_data, ulong file_len) 122 { 123 int dfd; 124 const char *datafile = params->outfile; 125 126 dfd = open(datafile, O_RDWR | O_CREAT | O_TRUNC | O_BINARY, 127 S_IRUSR | S_IWUSR); 128 if (dfd < 0) { 129 fprintf(stderr, "%s: Can't open \"%s\": %s\n", 130 params->cmdname, datafile, strerror(errno)); 131 return -1; 132 } 133 134 if (write(dfd, (void *)file_data, file_len) != (ssize_t)file_len) { 135 fprintf(stderr, "%s: Write error on \"%s\": %s\n", 136 params->cmdname, datafile, strerror(errno)); 137 close(dfd); 138 return -1; 139 } 140 141 close(dfd); 142 143 return 0; 144 } 145 146 static int image_extract_datafile(void *ptr, struct image_tool_params *params) 147 { 148 const image_header_t *hdr = (const image_header_t *)ptr; 149 ulong file_data; 150 ulong file_len; 151 152 if (image_check_type(hdr, IH_TYPE_MULTI)) { 153 ulong idx = params->pflag; 154 ulong count; 155 156 /* get the number of data files present in the image */ 157 count = image_multi_count(hdr); 158 159 /* retrieve the "data file" at the idx position */ 160 image_multi_getimg(hdr, idx, &file_data, &file_len); 161 162 if ((file_len == 0) || (idx >= count)) { 163 fprintf(stderr, "%s: No such data file %ld in \"%s\"\n", 164 params->cmdname, idx, params->imagefile); 165 return -1; 166 } 167 } else { 168 file_data = image_get_data(hdr); 169 file_len = image_get_size(hdr); 170 } 171 172 /* save the "data file" into the file system */ 173 return image_save_datafile(params, file_data, file_len); 174 } 175 176 /* 177 * Default image type parameters definition 178 */ 179 static struct image_type_params defimage_params = { 180 .name = "Default Image support", 181 .header_size = sizeof(image_header_t), 182 .hdr = (void*)&header, 183 .check_image_type = image_check_image_types, 184 .verify_header = image_verify_header, 185 .print_header = image_print_contents, 186 .set_header = image_set_header, 187 .extract_datafile = image_extract_datafile, 188 .check_params = image_check_params, 189 }; 190 191 void init_default_image_type(void) 192 { 193 register_image_type(&defimage_params); 194 } 195