xref: /openbmc/u-boot/tools/mkimage.c (revision d505a09c1e8fa512aeb3c077048d521f1be302ff)
15b1d7137Swdenk /*
29d25438fSBartlomiej Sieka  * (C) Copyright 2008 Semihalf
39d25438fSBartlomiej Sieka  *
489a4d6b1SPrafulla Wadaskar  * (C) Copyright 2000-2009
55b1d7137Swdenk  * DENX Software Engineering
65b1d7137Swdenk  * Wolfgang Denk, wd@denx.de
70c852a28Swdenk  *
81a459660SWolfgang Denk  * SPDX-License-Identifier:	GPL-2.0+
95b1d7137Swdenk  */
105b1d7137Swdenk 
11b97a2a0aSMarian Balakowicz #include "mkimage.h"
125b1d7137Swdenk #include <image.h>
13976b38c0SWolfgang Denk #include <version.h>
145b1d7137Swdenk 
155b1d7137Swdenk static void copy_file(int, const char *, int);
165b1d7137Swdenk 
1789a4d6b1SPrafulla Wadaskar /* parameters initialized by core will be used by the image type code */
18cc7a6444SSimon Glass static struct image_tool_params params = {
1989a4d6b1SPrafulla Wadaskar 	.os = IH_OS_LINUX,
2089a4d6b1SPrafulla Wadaskar 	.arch = IH_ARCH_PPC,
2189a4d6b1SPrafulla Wadaskar 	.type = IH_TYPE_KERNEL,
2289a4d6b1SPrafulla Wadaskar 	.comp = IH_COMP_GZIP,
2389a4d6b1SPrafulla Wadaskar 	.dtc = MKIMAGE_DEFAULT_DTC_OPTIONS,
2404387d24SWolfgang Denk 	.imagename = "",
255d898a00SShaohui Xie 	.imagename2 = "",
2689a4d6b1SPrafulla Wadaskar };
275b1d7137Swdenk 
285b9d44dfSSimon Glass static int h_compare_image_name(const void *vtype1, const void *vtype2)
295b9d44dfSSimon Glass {
305b9d44dfSSimon Glass 	const int *type1 = vtype1;
315b9d44dfSSimon Glass 	const int *type2 = vtype2;
325b9d44dfSSimon Glass 	const char *name1 = genimg_get_type_short_name(*type1);
335b9d44dfSSimon Glass 	const char *name2 = genimg_get_type_short_name(*type2);
345b9d44dfSSimon Glass 
355b9d44dfSSimon Glass 	return strcmp(name1, name2);
365b9d44dfSSimon Glass }
375b9d44dfSSimon Glass 
385b9d44dfSSimon Glass /* Show all image types supported by mkimage */
395b9d44dfSSimon Glass static void show_image_types(void)
405b9d44dfSSimon Glass {
415b9d44dfSSimon Glass 	struct image_type_params *tparams;
425b9d44dfSSimon Glass 	int order[IH_TYPE_COUNT];
435b9d44dfSSimon Glass 	int count;
445b9d44dfSSimon Glass 	int type;
455b9d44dfSSimon Glass 	int i;
465b9d44dfSSimon Glass 
475b9d44dfSSimon Glass 	/* Sort the names in order of short name for easier reading */
485b9d44dfSSimon Glass 	memset(order, '\0', sizeof(order));
495b9d44dfSSimon Glass 	for (count = 0, type = 0; type < IH_TYPE_COUNT; type++) {
505b9d44dfSSimon Glass 		tparams = imagetool_get_type(type);
515b9d44dfSSimon Glass 		if (tparams)
525b9d44dfSSimon Glass 			order[count++] = type;
535b9d44dfSSimon Glass 	}
545b9d44dfSSimon Glass 	qsort(order, count, sizeof(int), h_compare_image_name);
555b9d44dfSSimon Glass 
565b9d44dfSSimon Glass 	fprintf(stderr, "\nInvalid image type. Supported image types:\n");
575b9d44dfSSimon Glass 	for (i = 0; i < count; i++) {
585b9d44dfSSimon Glass 		type = order[i];
595b9d44dfSSimon Glass 		tparams = imagetool_get_type(type);
605b9d44dfSSimon Glass 		if (tparams) {
615b9d44dfSSimon Glass 			fprintf(stderr, "\t%-15s  %s\n",
625b9d44dfSSimon Glass 				genimg_get_type_short_name(type),
635b9d44dfSSimon Glass 				genimg_get_type_name(type));
645b9d44dfSSimon Glass 		}
655b9d44dfSSimon Glass 	}
665b9d44dfSSimon Glass 	fprintf(stderr, "\n");
675b9d44dfSSimon Glass }
685b9d44dfSSimon Glass 
6915310348SSimon Glass static void usage(const char *msg)
70b0a487a4SSimon Glass {
7115310348SSimon Glass 	fprintf(stderr, "Error: %s\n", msg);
72b0a487a4SSimon Glass 	fprintf(stderr, "Usage: %s -l image\n"
73b0a487a4SSimon Glass 			 "          -l ==> list image header information\n",
74b0a487a4SSimon Glass 		params.cmdname);
75b0a487a4SSimon Glass 	fprintf(stderr,
76b0a487a4SSimon Glass 		"       %s [-x] -A arch -O os -T type -C comp -a addr -e ep -n name -d data_file[:data_file...] image\n"
77b0a487a4SSimon Glass 		"          -A ==> set architecture to 'arch'\n"
78b0a487a4SSimon Glass 		"          -O ==> set operating system to 'os'\n"
79b0a487a4SSimon Glass 		"          -T ==> set image type to 'type'\n"
80b0a487a4SSimon Glass 		"          -C ==> set compression type 'comp'\n"
81b0a487a4SSimon Glass 		"          -a ==> set load address to 'addr' (hex)\n"
82b0a487a4SSimon Glass 		"          -e ==> set entry point to 'ep' (hex)\n"
83b0a487a4SSimon Glass 		"          -n ==> set image name to 'name'\n"
84b0a487a4SSimon Glass 		"          -d ==> use image data from 'datafile'\n"
85b0a487a4SSimon Glass 		"          -x ==> set XIP (execute in place)\n",
86b0a487a4SSimon Glass 		params.cmdname);
87b0a487a4SSimon Glass 	fprintf(stderr,
88b0a487a4SSimon Glass 		"       %s [-D dtc_options] [-f fit-image.its|-F] fit-image\n",
89b0a487a4SSimon Glass 		params.cmdname);
90b0a487a4SSimon Glass 	fprintf(stderr,
91b0a487a4SSimon Glass 		"          -D => set all options for device tree compiler\n"
92b0a487a4SSimon Glass 		"          -f => input filename for FIT source\n");
93b0a487a4SSimon Glass #ifdef CONFIG_FIT_SIGNATURE
94b0a487a4SSimon Glass 	fprintf(stderr,
95b0a487a4SSimon Glass 		"Signing / verified boot options: [-k keydir] [-K dtb] [ -c <comment>] [-r]\n"
96b0a487a4SSimon Glass 		"          -k => set directory containing private keys\n"
97b0a487a4SSimon Glass 		"          -K => write public keys to this .dtb file\n"
98b0a487a4SSimon Glass 		"          -c => add comment in signature node\n"
99b0a487a4SSimon Glass 		"          -F => re-sign existing FIT image\n"
100b0a487a4SSimon Glass 		"          -r => mark keys used as 'required' in dtb\n");
101b0a487a4SSimon Glass #else
102b0a487a4SSimon Glass 	fprintf(stderr,
103b0a487a4SSimon Glass 		"Signing / verified boot not supported (CONFIG_FIT_SIGNATURE undefined)\n");
104b0a487a4SSimon Glass #endif
105b0a487a4SSimon Glass 	fprintf(stderr, "       %s -V ==> print version information and exit\n",
106b0a487a4SSimon Glass 		params.cmdname);
107b0a487a4SSimon Glass 	fprintf(stderr, "Use -T to see a list of available image types\n");
108b0a487a4SSimon Glass 
109b0a487a4SSimon Glass 	exit(EXIT_FAILURE);
110b0a487a4SSimon Glass }
111b0a487a4SSimon Glass 
1120b443deeSSimon Glass static void process_args(int argc, char **argv)
1135b1d7137Swdenk {
114a2513e27SPeter Tyser 	char *ptr;
115*d505a09cSSimon Glass 	int type = IH_TYPE_INVALID;
116*d505a09cSSimon Glass 	char *datafile = NULL;
117*d505a09cSSimon Glass 	int expecting;
118a02221f2SSimon Glass 	int opt;
1195b1d7137Swdenk 
120*d505a09cSSimon Glass 	expecting = IH_TYPE_COUNT;	/* Unknown */
121a02221f2SSimon Glass 	while ((opt = getopt(argc, argv,
122*d505a09cSSimon Glass 			     "-a:A:cC:d:D:e:f:Fk:K:ln:O:rR:sT:vVx")) != -1) {
123a02221f2SSimon Glass 		switch (opt) {
12407450081SSimon Glass 		case 'a':
12507450081SSimon Glass 			params.addr = strtoull(optarg, &ptr, 16);
12607450081SSimon Glass 			if (*ptr) {
12707450081SSimon Glass 				fprintf(stderr, "%s: invalid load address %s\n",
12807450081SSimon Glass 					params.cmdname, optarg);
12907450081SSimon Glass 				exit(EXIT_FAILURE);
13007450081SSimon Glass 			}
1315b1d7137Swdenk 			break;
1325b1d7137Swdenk 		case 'A':
133a02221f2SSimon Glass 			params.arch = genimg_get_arch_id(optarg);
134a02221f2SSimon Glass 			if (params.arch < 0)
13515310348SSimon Glass 				usage("Invalid architecture");
136a02221f2SSimon Glass 			break;
1374f610427SSimon Glass 		case 'c':
138a02221f2SSimon Glass 			params.comment = optarg;
139a02221f2SSimon Glass 			break;
1405b1d7137Swdenk 		case 'C':
141a02221f2SSimon Glass 			params.comp = genimg_get_comp_id(optarg);
142a02221f2SSimon Glass 			if (params.comp < 0)
14315310348SSimon Glass 				usage("Invalid compression type");
144a02221f2SSimon Glass 			break;
1455b1d7137Swdenk 		case 'd':
146a02221f2SSimon Glass 			params.datafile = optarg;
14789a4d6b1SPrafulla Wadaskar 			params.dflag = 1;
148a02221f2SSimon Glass 			break;
14907450081SSimon Glass 		case 'D':
15007450081SSimon Glass 			params.dtc = optarg;
15107450081SSimon Glass 			break;
1525b1d7137Swdenk 		case 'e':
153a02221f2SSimon Glass 			params.ep = strtoull(optarg, &ptr, 16);
1545b1d7137Swdenk 			if (*ptr) {
155a02221f2SSimon Glass 				fprintf(stderr, "%s: invalid entry point %s\n",
156a02221f2SSimon Glass 					params.cmdname, optarg);
1575b1d7137Swdenk 				exit(EXIT_FAILURE);
1585b1d7137Swdenk 			}
15989a4d6b1SPrafulla Wadaskar 			params.eflag = 1;
160a02221f2SSimon Glass 			break;
1619d25438fSBartlomiej Sieka 		case 'f':
162a02221f2SSimon Glass 			params.datafile = optarg;
16395d77b44SSimon Glass 			/* no break */
16495d77b44SSimon Glass 		case 'F':
1651a99de2cSPeter Tyser 			/*
1661a99de2cSPeter Tyser 			 * The flattened image tree (FIT) format
1671a99de2cSPeter Tyser 			 * requires a flattened device tree image type
1681a99de2cSPeter Tyser 			 */
169*d505a09cSSimon Glass 			params.fit_image_type = params.type;
1701a99de2cSPeter Tyser 			params.type = IH_TYPE_FLATDT;
171fbc1c8f6SPeter Tyser 			params.fflag = 1;
172a02221f2SSimon Glass 			break;
17380e4df8aSSimon Glass 		case 'k':
174a02221f2SSimon Glass 			params.keydir = optarg;
175a02221f2SSimon Glass 			break;
176e29495d3SSimon Glass 		case 'K':
177a02221f2SSimon Glass 			params.keydest = optarg;
178a02221f2SSimon Glass 			break;
17907450081SSimon Glass 		case 'l':
18007450081SSimon Glass 			params.lflag = 1;
18107450081SSimon Glass 			break;
1825b1d7137Swdenk 		case 'n':
183a02221f2SSimon Glass 			params.imagename = optarg;
184a02221f2SSimon Glass 			break;
18507450081SSimon Glass 		case 'O':
18607450081SSimon Glass 			params.os = genimg_get_os_id(optarg);
18707450081SSimon Glass 			if (params.os < 0)
18815310348SSimon Glass 				usage("Invalid operating system");
18907450081SSimon Glass 			break;
190399c744bSSimon Glass 		case 'r':
191399c744bSSimon Glass 			params.require_keys = 1;
192399c744bSSimon Glass 			break;
1935d898a00SShaohui Xie 		case 'R':
1945d898a00SShaohui Xie 			/*
1955d898a00SShaohui Xie 			 * This entry is for the second configuration
1965d898a00SShaohui Xie 			 * file, if only one is not enough.
1975d898a00SShaohui Xie 			 */
198a02221f2SSimon Glass 			params.imagename2 = optarg;
199a02221f2SSimon Glass 			break;
200f0662105SStefano Babic 		case 's':
201f0662105SStefano Babic 			params.skipcpy = 1;
202f0662105SStefano Babic 			break;
20307450081SSimon Glass 		case 'T':
204*d505a09cSSimon Glass 			type = genimg_get_type_id(optarg);
205*d505a09cSSimon Glass 			if (type < 0) {
20607450081SSimon Glass 				show_image_types();
20715310348SSimon Glass 				usage("Invalid image type");
20807450081SSimon Glass 			}
209*d505a09cSSimon Glass 			expecting = type;
21007450081SSimon Glass 			break;
2115b1d7137Swdenk 		case 'v':
21289a4d6b1SPrafulla Wadaskar 			params.vflag++;
2135b1d7137Swdenk 			break;
214976b38c0SWolfgang Denk 		case 'V':
215976b38c0SWolfgang Denk 			printf("mkimage version %s\n", PLAIN_VERSION);
216976b38c0SWolfgang Denk 			exit(EXIT_SUCCESS);
2175b1d7137Swdenk 		case 'x':
21889a4d6b1SPrafulla Wadaskar 			params.xflag++;
2195b1d7137Swdenk 			break;
220*d505a09cSSimon Glass 		case 1:
221*d505a09cSSimon Glass 			if (expecting == type || optind == argc) {
222*d505a09cSSimon Glass 				params.imagefile = optarg;
223*d505a09cSSimon Glass 				expecting = IH_TYPE_INVALID;
224*d505a09cSSimon Glass 			}
225*d505a09cSSimon Glass 			break;
2265b1d7137Swdenk 		default:
22715310348SSimon Glass 			usage("Invalid option");
2285b1d7137Swdenk 		}
2295b1d7137Swdenk 	}
2305b1d7137Swdenk 
231*d505a09cSSimon Glass 	/*
232*d505a09cSSimon Glass 	 * For auto-generated FIT images we need to know the image type to put
233*d505a09cSSimon Glass 	 * in the FIT, which is separate from the file's image type (which
234*d505a09cSSimon Glass 	 * will always be IH_TYPE_FLATDT in this case).
235*d505a09cSSimon Glass 	 */
236*d505a09cSSimon Glass 	if (params.type == IH_TYPE_FLATDT) {
237*d505a09cSSimon Glass 		params.fit_image_type = type;
238*d505a09cSSimon Glass 		params.datafile = datafile;
239*d505a09cSSimon Glass 	} else if (type != IH_TYPE_INVALID) {
240*d505a09cSSimon Glass 		params.type = type;
241*d505a09cSSimon Glass 	}
242*d505a09cSSimon Glass 
243*d505a09cSSimon Glass 	if (!params.imagefile)
24415310348SSimon Glass 		usage("Missing output filename");
2450b443deeSSimon Glass }
2460b443deeSSimon Glass 
2470b443deeSSimon Glass 
2480b443deeSSimon Glass int main(int argc, char **argv)
2490b443deeSSimon Glass {
2500b443deeSSimon Glass 	int ifd = -1;
2510b443deeSSimon Glass 	struct stat sbuf;
2520b443deeSSimon Glass 	char *ptr;
2530b443deeSSimon Glass 	int retval = 0;
2540b443deeSSimon Glass 	struct image_type_params *tparams = NULL;
2550b443deeSSimon Glass 	int pad_len = 0;
2560b443deeSSimon Glass 	int dfd;
2570b443deeSSimon Glass 
2580b443deeSSimon Glass 	params.cmdname = *argv;
2590b443deeSSimon Glass 	params.addr = 0;
2600b443deeSSimon Glass 	params.ep = 0;
2610b443deeSSimon Glass 
2620b443deeSSimon Glass 	process_args(argc, argv);
2635b1d7137Swdenk 
26489a4d6b1SPrafulla Wadaskar 	/* set tparams as per input type_id */
265a93648d1SGuilherme Maciel Ferreira 	tparams = imagetool_get_type(params.type);
26689a4d6b1SPrafulla Wadaskar 	if (tparams == NULL) {
26789a4d6b1SPrafulla Wadaskar 		fprintf (stderr, "%s: unsupported type %s\n",
26889a4d6b1SPrafulla Wadaskar 			params.cmdname, genimg_get_type_name(params.type));
26989a4d6b1SPrafulla Wadaskar 		exit (EXIT_FAILURE);
27089a4d6b1SPrafulla Wadaskar 	}
27189a4d6b1SPrafulla Wadaskar 
27289a4d6b1SPrafulla Wadaskar 	/*
27389a4d6b1SPrafulla Wadaskar 	 * check the passed arguments parameters meets the requirements
27489a4d6b1SPrafulla Wadaskar 	 * as per image type to be generated/listed
27589a4d6b1SPrafulla Wadaskar 	 */
27689a4d6b1SPrafulla Wadaskar 	if (tparams->check_params)
27789a4d6b1SPrafulla Wadaskar 		if (tparams->check_params (&params))
27815310348SSimon Glass 			usage("Bad parameters for image type");
27989a4d6b1SPrafulla Wadaskar 
28089a4d6b1SPrafulla Wadaskar 	if (!params.eflag) {
28189a4d6b1SPrafulla Wadaskar 		params.ep = params.addr;
2825b1d7137Swdenk 		/* If XIP, entry point must be after the U-Boot header */
28389a4d6b1SPrafulla Wadaskar 		if (params.xflag)
28489a4d6b1SPrafulla Wadaskar 			params.ep += tparams->header_size;
2855b1d7137Swdenk 	}
2865b1d7137Swdenk 
287c81296c1SPeter Tyser 	if (params.fflag){
288c81296c1SPeter Tyser 		if (tparams->fflag_handle)
289c81296c1SPeter Tyser 			/*
290c81296c1SPeter Tyser 			 * in some cases, some additional processing needs
291c81296c1SPeter Tyser 			 * to be done if fflag is defined
292c81296c1SPeter Tyser 			 *
293c81296c1SPeter Tyser 			 * For ex. fit_handle_file for Fit file support
294c81296c1SPeter Tyser 			 */
295c81296c1SPeter Tyser 			retval = tparams->fflag_handle(&params);
296c81296c1SPeter Tyser 
297c81296c1SPeter Tyser 		if (retval != EXIT_SUCCESS)
298c81296c1SPeter Tyser 			exit (retval);
299c81296c1SPeter Tyser 	}
300c81296c1SPeter Tyser 
301c81296c1SPeter Tyser 	if (params.lflag || params.fflag) {
30289a4d6b1SPrafulla Wadaskar 		ifd = open (params.imagefile, O_RDONLY|O_BINARY);
3035b1d7137Swdenk 	} else {
30489a4d6b1SPrafulla Wadaskar 		ifd = open (params.imagefile,
3059d25438fSBartlomiej Sieka 			O_RDWR|O_CREAT|O_TRUNC|O_BINARY, 0666);
3065b1d7137Swdenk 	}
3075b1d7137Swdenk 
3085b1d7137Swdenk 	if (ifd < 0) {
3095b1d7137Swdenk 		fprintf (stderr, "%s: Can't open %s: %s\n",
31089a4d6b1SPrafulla Wadaskar 			params.cmdname, params.imagefile,
31189a4d6b1SPrafulla Wadaskar 			strerror(errno));
3125b1d7137Swdenk 		exit (EXIT_FAILURE);
3135b1d7137Swdenk 	}
3145b1d7137Swdenk 
315c81296c1SPeter Tyser 	if (params.lflag || params.fflag) {
3165b1d7137Swdenk 		/*
3175b1d7137Swdenk 		 * list header information of existing image
3185b1d7137Swdenk 		 */
3195b1d7137Swdenk 		if (fstat(ifd, &sbuf) < 0) {
3205b1d7137Swdenk 			fprintf (stderr, "%s: Can't stat %s: %s\n",
32189a4d6b1SPrafulla Wadaskar 				params.cmdname, params.imagefile,
32289a4d6b1SPrafulla Wadaskar 				strerror(errno));
3235b1d7137Swdenk 			exit (EXIT_FAILURE);
3245b1d7137Swdenk 		}
3255b1d7137Swdenk 
32689a4d6b1SPrafulla Wadaskar 		if ((unsigned)sbuf.st_size < tparams->header_size) {
3275b1d7137Swdenk 			fprintf (stderr,
32889a4d6b1SPrafulla Wadaskar 				"%s: Bad size: \"%s\" is not valid image\n",
32989a4d6b1SPrafulla Wadaskar 				params.cmdname, params.imagefile);
3305b1d7137Swdenk 			exit (EXIT_FAILURE);
3315b1d7137Swdenk 		}
3325b1d7137Swdenk 
333fa956fdeSMike Frysinger 		ptr = mmap(0, sbuf.st_size, PROT_READ, MAP_SHARED, ifd, 0);
334fa956fdeSMike Frysinger 		if (ptr == MAP_FAILED) {
3355b1d7137Swdenk 			fprintf (stderr, "%s: Can't read %s: %s\n",
33689a4d6b1SPrafulla Wadaskar 				params.cmdname, params.imagefile,
33789a4d6b1SPrafulla Wadaskar 				strerror(errno));
3385b1d7137Swdenk 			exit (EXIT_FAILURE);
3395b1d7137Swdenk 		}
3405b1d7137Swdenk 
34189a4d6b1SPrafulla Wadaskar 		/*
34289a4d6b1SPrafulla Wadaskar 		 * scan through mkimage registry for all supported image types
34389a4d6b1SPrafulla Wadaskar 		 * and verify the input image file header for match
34489a4d6b1SPrafulla Wadaskar 		 * Print the image information for matched image type
34589a4d6b1SPrafulla Wadaskar 		 * Returns the error code if not matched
34689a4d6b1SPrafulla Wadaskar 		 */
3470ca6691cSGuilherme Maciel Ferreira 		retval = imagetool_verify_print_header(ptr, &sbuf,
3480ca6691cSGuilherme Maciel Ferreira 				tparams, &params);
3495b1d7137Swdenk 
3505b1d7137Swdenk 		(void) munmap((void *)ptr, sbuf.st_size);
3515b1d7137Swdenk 		(void) close (ifd);
3525b1d7137Swdenk 
353f7644c0bSPrafulla Wadaskar 		exit (retval);
3545b1d7137Swdenk 	}
3555b1d7137Swdenk 
35634633141SMarek Vasut 	if ((params.type != IH_TYPE_MULTI) && (params.type != IH_TYPE_SCRIPT)) {
35792a655c3SSimon Glass 		dfd = open(params.datafile, O_RDONLY | O_BINARY);
35892a655c3SSimon Glass 		if (dfd < 0) {
35992a655c3SSimon Glass 			fprintf(stderr, "%s: Can't open %s: %s\n",
3606ae6e160SPhilippe De Swert 				params.cmdname, params.datafile,
3616ae6e160SPhilippe De Swert 				strerror(errno));
36292a655c3SSimon Glass 			exit(EXIT_FAILURE);
36392a655c3SSimon Glass 		}
36492a655c3SSimon Glass 
36592a655c3SSimon Glass 		if (fstat(dfd, &sbuf) < 0) {
36692a655c3SSimon Glass 			fprintf(stderr, "%s: Can't stat %s: %s\n",
3676ae6e160SPhilippe De Swert 				params.cmdname, params.datafile,
3686ae6e160SPhilippe De Swert 				strerror(errno));
36992a655c3SSimon Glass 			exit(EXIT_FAILURE);
37092a655c3SSimon Glass 		}
37192a655c3SSimon Glass 
37292a655c3SSimon Glass 		params.file_size = sbuf.st_size + tparams->header_size;
37392a655c3SSimon Glass 		close(dfd);
3746ae6e160SPhilippe De Swert 	}
37592a655c3SSimon Glass 
3765b1d7137Swdenk 	/*
377f0662105SStefano Babic 	 * In case there an header with a variable
378f0662105SStefano Babic 	 * length will be added, the corresponding
379f0662105SStefano Babic 	 * function is called. This is responsible to
380f0662105SStefano Babic 	 * allocate memory for the header itself.
3815b1d7137Swdenk 	 */
382f0662105SStefano Babic 	if (tparams->vrec_header)
3839bac0bb3SStefano Babic 		pad_len = tparams->vrec_header(&params, tparams);
384f0662105SStefano Babic 	else
38589a4d6b1SPrafulla Wadaskar 		memset(tparams->hdr, 0, tparams->header_size);
3865b1d7137Swdenk 
38789a4d6b1SPrafulla Wadaskar 	if (write(ifd, tparams->hdr, tparams->header_size)
38889a4d6b1SPrafulla Wadaskar 					!= tparams->header_size) {
3895b1d7137Swdenk 		fprintf (stderr, "%s: Write error on %s: %s\n",
39089a4d6b1SPrafulla Wadaskar 			params.cmdname, params.imagefile, strerror(errno));
3915b1d7137Swdenk 		exit (EXIT_FAILURE);
3925b1d7137Swdenk 	}
3935b1d7137Swdenk 
394d1be8f92SChristian Riesch 	if (!params.skipcpy) {
395d1be8f92SChristian Riesch 		if (params.type == IH_TYPE_MULTI ||
396d1be8f92SChristian Riesch 		    params.type == IH_TYPE_SCRIPT) {
39789a4d6b1SPrafulla Wadaskar 			char *file = params.datafile;
3983bb66806SWolfgang Denk 			uint32_t size;
3995b1d7137Swdenk 
4005b1d7137Swdenk 			for (;;) {
4015b1d7137Swdenk 				char *sep = NULL;
4025b1d7137Swdenk 
4035b1d7137Swdenk 				if (file) {
4045b1d7137Swdenk 					if ((sep = strchr(file, ':')) != NULL) {
4055b1d7137Swdenk 						*sep = '\0';
4065b1d7137Swdenk 					}
4075b1d7137Swdenk 
4085b1d7137Swdenk 					if (stat (file, &sbuf) < 0) {
4095b1d7137Swdenk 						fprintf (stderr, "%s: Can't stat %s: %s\n",
41089a4d6b1SPrafulla Wadaskar 							 params.cmdname, file, strerror(errno));
4115b1d7137Swdenk 						exit (EXIT_FAILURE);
4125b1d7137Swdenk 					}
4139a4daad0SMarian Balakowicz 					size = cpu_to_uimage (sbuf.st_size);
4145b1d7137Swdenk 				} else {
4155b1d7137Swdenk 					size = 0;
4165b1d7137Swdenk 				}
4175b1d7137Swdenk 
4185b1d7137Swdenk 				if (write(ifd, (char *)&size, sizeof(size)) != sizeof(size)) {
4195b1d7137Swdenk 					fprintf (stderr, "%s: Write error on %s: %s\n",
42089a4d6b1SPrafulla Wadaskar 						 params.cmdname, params.imagefile,
42189a4d6b1SPrafulla Wadaskar 						 strerror(errno));
4225b1d7137Swdenk 					exit (EXIT_FAILURE);
4235b1d7137Swdenk 				}
4245b1d7137Swdenk 
4255b1d7137Swdenk 				if (!file) {
4265b1d7137Swdenk 					break;
4275b1d7137Swdenk 				}
4285b1d7137Swdenk 
4295b1d7137Swdenk 				if (sep) {
4305b1d7137Swdenk 					*sep = ':';
4315b1d7137Swdenk 					file = sep + 1;
4325b1d7137Swdenk 				} else {
4335b1d7137Swdenk 					file = NULL;
4345b1d7137Swdenk 				}
4355b1d7137Swdenk 			}
4365b1d7137Swdenk 
43789a4d6b1SPrafulla Wadaskar 			file = params.datafile;
4385b1d7137Swdenk 
4395b1d7137Swdenk 			for (;;) {
4405b1d7137Swdenk 				char *sep = strchr(file, ':');
4415b1d7137Swdenk 				if (sep) {
4425b1d7137Swdenk 					*sep = '\0';
4435b1d7137Swdenk 					copy_file (ifd, file, 1);
4445b1d7137Swdenk 					*sep++ = ':';
4455b1d7137Swdenk 					file = sep;
4465b1d7137Swdenk 				} else {
4475b1d7137Swdenk 					copy_file (ifd, file, 0);
4485b1d7137Swdenk 					break;
4495b1d7137Swdenk 				}
4505b1d7137Swdenk 			}
4515d898a00SShaohui Xie 		} else if (params.type == IH_TYPE_PBLIMAGE) {
4525d898a00SShaohui Xie 			/* PBL has special Image format, implements its' own */
4535d898a00SShaohui Xie 			pbl_load_uboot(ifd, &params);
4545b1d7137Swdenk 		} else {
4559bac0bb3SStefano Babic 			copy_file(ifd, params.datafile, pad_len);
4565b1d7137Swdenk 		}
457d1be8f92SChristian Riesch 	}
4585b1d7137Swdenk 
4595b1d7137Swdenk 	/* We're a bit of paranoid */
46089a4d6b1SPrafulla Wadaskar #if defined(_POSIX_SYNCHRONIZED_IO) && \
46189a4d6b1SPrafulla Wadaskar    !defined(__sun__) && \
46289a4d6b1SPrafulla Wadaskar    !defined(__FreeBSD__) && \
46331cbe80cSLuka Perkov    !defined(__OpenBSD__) && \
46489a4d6b1SPrafulla Wadaskar    !defined(__APPLE__)
4655b1d7137Swdenk 	(void) fdatasync (ifd);
4665b1d7137Swdenk #else
4675b1d7137Swdenk 	(void) fsync (ifd);
4685b1d7137Swdenk #endif
4695b1d7137Swdenk 
4705b1d7137Swdenk 	if (fstat(ifd, &sbuf) < 0) {
4715b1d7137Swdenk 		fprintf (stderr, "%s: Can't stat %s: %s\n",
47289a4d6b1SPrafulla Wadaskar 			params.cmdname, params.imagefile, strerror(errno));
4735b1d7137Swdenk 		exit (EXIT_FAILURE);
4745b1d7137Swdenk 	}
47592a655c3SSimon Glass 	params.file_size = sbuf.st_size;
4765b1d7137Swdenk 
477fa956fdeSMike Frysinger 	ptr = mmap(0, sbuf.st_size, PROT_READ|PROT_WRITE, MAP_SHARED, ifd, 0);
478fa956fdeSMike Frysinger 	if (ptr == MAP_FAILED) {
4795b1d7137Swdenk 		fprintf (stderr, "%s: Can't map %s: %s\n",
48089a4d6b1SPrafulla Wadaskar 			params.cmdname, params.imagefile, strerror(errno));
4815b1d7137Swdenk 		exit (EXIT_FAILURE);
4825b1d7137Swdenk 	}
4835b1d7137Swdenk 
48489a4d6b1SPrafulla Wadaskar 	/* Setup the image header as per input image type*/
48589a4d6b1SPrafulla Wadaskar 	if (tparams->set_header)
48689a4d6b1SPrafulla Wadaskar 		tparams->set_header (ptr, &sbuf, ifd, &params);
48789a4d6b1SPrafulla Wadaskar 	else {
48889a4d6b1SPrafulla Wadaskar 		fprintf (stderr, "%s: Can't set header for %s: %s\n",
48989a4d6b1SPrafulla Wadaskar 			params.cmdname, tparams->name, strerror(errno));
49089a4d6b1SPrafulla Wadaskar 		exit (EXIT_FAILURE);
49189a4d6b1SPrafulla Wadaskar 	}
4925b1d7137Swdenk 
49389a4d6b1SPrafulla Wadaskar 	/* Print the image information by processing image header */
49489a4d6b1SPrafulla Wadaskar 	if (tparams->print_header)
49589a4d6b1SPrafulla Wadaskar 		tparams->print_header (ptr);
49689a4d6b1SPrafulla Wadaskar 	else {
49789a4d6b1SPrafulla Wadaskar 		fprintf (stderr, "%s: Can't print header for %s: %s\n",
49889a4d6b1SPrafulla Wadaskar 			params.cmdname, tparams->name, strerror(errno));
49989a4d6b1SPrafulla Wadaskar 		exit (EXIT_FAILURE);
50089a4d6b1SPrafulla Wadaskar 	}
5015b1d7137Swdenk 
5025b1d7137Swdenk 	(void) munmap((void *)ptr, sbuf.st_size);
5035b1d7137Swdenk 
5045b1d7137Swdenk 	/* We're a bit of paranoid */
50589a4d6b1SPrafulla Wadaskar #if defined(_POSIX_SYNCHRONIZED_IO) && \
50689a4d6b1SPrafulla Wadaskar    !defined(__sun__) && \
50789a4d6b1SPrafulla Wadaskar    !defined(__FreeBSD__) && \
50831cbe80cSLuka Perkov    !defined(__OpenBSD__) && \
50989a4d6b1SPrafulla Wadaskar    !defined(__APPLE__)
5105b1d7137Swdenk 	(void) fdatasync (ifd);
5115b1d7137Swdenk #else
5125b1d7137Swdenk 	(void) fsync (ifd);
5135b1d7137Swdenk #endif
5145b1d7137Swdenk 
5155b1d7137Swdenk 	if (close(ifd)) {
5165b1d7137Swdenk 		fprintf (stderr, "%s: Write error on %s: %s\n",
51789a4d6b1SPrafulla Wadaskar 			params.cmdname, params.imagefile, strerror(errno));
5185b1d7137Swdenk 		exit (EXIT_FAILURE);
5195b1d7137Swdenk 	}
5205b1d7137Swdenk 
5215b1d7137Swdenk 	exit (EXIT_SUCCESS);
5225b1d7137Swdenk }
5235b1d7137Swdenk 
5245b1d7137Swdenk static void
5255b1d7137Swdenk copy_file (int ifd, const char *datafile, int pad)
5265b1d7137Swdenk {
5275b1d7137Swdenk 	int dfd;
5285b1d7137Swdenk 	struct stat sbuf;
5295b1d7137Swdenk 	unsigned char *ptr;
5305b1d7137Swdenk 	int tail;
5315b1d7137Swdenk 	int zero = 0;
5329bac0bb3SStefano Babic 	uint8_t zeros[4096];
5335b1d7137Swdenk 	int offset = 0;
5345b1d7137Swdenk 	int size;
535a93648d1SGuilherme Maciel Ferreira 	struct image_type_params *tparams = imagetool_get_type(params.type);
5365b1d7137Swdenk 
5379bac0bb3SStefano Babic 	memset(zeros, 0, sizeof(zeros));
5389bac0bb3SStefano Babic 
53989a4d6b1SPrafulla Wadaskar 	if (params.vflag) {
5405b1d7137Swdenk 		fprintf (stderr, "Adding Image %s\n", datafile);
5415b1d7137Swdenk 	}
5425b1d7137Swdenk 
543ef1464ccSwdenk 	if ((dfd = open(datafile, O_RDONLY|O_BINARY)) < 0) {
5445b1d7137Swdenk 		fprintf (stderr, "%s: Can't open %s: %s\n",
54589a4d6b1SPrafulla Wadaskar 			params.cmdname, datafile, strerror(errno));
5465b1d7137Swdenk 		exit (EXIT_FAILURE);
5475b1d7137Swdenk 	}
5485b1d7137Swdenk 
5495b1d7137Swdenk 	if (fstat(dfd, &sbuf) < 0) {
5505b1d7137Swdenk 		fprintf (stderr, "%s: Can't stat %s: %s\n",
55189a4d6b1SPrafulla Wadaskar 			params.cmdname, datafile, strerror(errno));
5525b1d7137Swdenk 		exit (EXIT_FAILURE);
5535b1d7137Swdenk 	}
5545b1d7137Swdenk 
555fa956fdeSMike Frysinger 	ptr = mmap(0, sbuf.st_size, PROT_READ, MAP_SHARED, dfd, 0);
556fa956fdeSMike Frysinger 	if (ptr == MAP_FAILED) {
5575b1d7137Swdenk 		fprintf (stderr, "%s: Can't read %s: %s\n",
55889a4d6b1SPrafulla Wadaskar 			params.cmdname, datafile, strerror(errno));
5595b1d7137Swdenk 		exit (EXIT_FAILURE);
5605b1d7137Swdenk 	}
5615b1d7137Swdenk 
56289a4d6b1SPrafulla Wadaskar 	if (params.xflag) {
5635b1d7137Swdenk 		unsigned char *p = NULL;
5645b1d7137Swdenk 		/*
5655b1d7137Swdenk 		 * XIP: do not append the image_header_t at the
5665b1d7137Swdenk 		 * beginning of the file, but consume the space
5675b1d7137Swdenk 		 * reserved for it.
5685b1d7137Swdenk 		 */
5695b1d7137Swdenk 
57089a4d6b1SPrafulla Wadaskar 		if ((unsigned)sbuf.st_size < tparams->header_size) {
5715b1d7137Swdenk 			fprintf (stderr,
5725b1d7137Swdenk 				"%s: Bad size: \"%s\" is too small for XIP\n",
57389a4d6b1SPrafulla Wadaskar 				params.cmdname, datafile);
5745b1d7137Swdenk 			exit (EXIT_FAILURE);
5755b1d7137Swdenk 		}
5765b1d7137Swdenk 
57789a4d6b1SPrafulla Wadaskar 		for (p = ptr; p < ptr + tparams->header_size; p++) {
5785b1d7137Swdenk 			if ( *p != 0xff ) {
5795b1d7137Swdenk 				fprintf (stderr,
5805b1d7137Swdenk 					"%s: Bad file: \"%s\" has invalid buffer for XIP\n",
58189a4d6b1SPrafulla Wadaskar 					params.cmdname, datafile);
5825b1d7137Swdenk 				exit (EXIT_FAILURE);
5835b1d7137Swdenk 			}
5845b1d7137Swdenk 		}
5855b1d7137Swdenk 
58689a4d6b1SPrafulla Wadaskar 		offset = tparams->header_size;
5875b1d7137Swdenk 	}
5885b1d7137Swdenk 
5895b1d7137Swdenk 	size = sbuf.st_size - offset;
5905b1d7137Swdenk 	if (write(ifd, ptr + offset, size) != size) {
5915b1d7137Swdenk 		fprintf (stderr, "%s: Write error on %s: %s\n",
59289a4d6b1SPrafulla Wadaskar 			params.cmdname, params.imagefile, strerror(errno));
5935b1d7137Swdenk 		exit (EXIT_FAILURE);
5945b1d7137Swdenk 	}
5955b1d7137Swdenk 
5969bac0bb3SStefano Babic 	tail = size % 4;
5979bac0bb3SStefano Babic 	if ((pad == 1) && (tail != 0)) {
5985b1d7137Swdenk 
5995b1d7137Swdenk 		if (write(ifd, (char *)&zero, 4-tail) != 4-tail) {
6005b1d7137Swdenk 			fprintf (stderr, "%s: Write error on %s: %s\n",
60189a4d6b1SPrafulla Wadaskar 				params.cmdname, params.imagefile,
60289a4d6b1SPrafulla Wadaskar 				strerror(errno));
6035b1d7137Swdenk 			exit (EXIT_FAILURE);
6045b1d7137Swdenk 		}
6059bac0bb3SStefano Babic 	} else if (pad > 1) {
606424b86aeSSimon Glass 		while (pad > 0) {
607424b86aeSSimon Glass 			int todo = sizeof(zeros);
608424b86aeSSimon Glass 
609424b86aeSSimon Glass 			if (todo > pad)
610424b86aeSSimon Glass 				todo = pad;
611424b86aeSSimon Glass 			if (write(ifd, (char *)&zeros, todo) != todo) {
6129bac0bb3SStefano Babic 				fprintf(stderr, "%s: Write error on %s: %s\n",
6139bac0bb3SStefano Babic 					params.cmdname, params.imagefile,
6149bac0bb3SStefano Babic 					strerror(errno));
6159bac0bb3SStefano Babic 				exit(EXIT_FAILURE);
6169bac0bb3SStefano Babic 			}
617424b86aeSSimon Glass 			pad -= todo;
618424b86aeSSimon Glass 		}
6195b1d7137Swdenk 	}
6205b1d7137Swdenk 
6215b1d7137Swdenk 	(void) munmap((void *)ptr, sbuf.st_size);
6225b1d7137Swdenk 	(void) close (dfd);
6235b1d7137Swdenk }
624