/*

   * (C) Copyright 2008 Semihalf
   *

   * (C) Copyright 2000-2009

   * DENX Software Engineering
   * Wolfgang Denk, wd@denx.de

   *

   * SPDX-License-Identifier:	GPL-2.0+

   */

  #include "mkimage.h"

  #include "imximage.h"

  #include <image.h>

  #include <version.h>

  
  static void copy_file(int, const char *, int);

  /* parameters initialized by core will be used by the image type code */

  static struct image_tool_params params = {

  	.os = IH_OS_LINUX,
  	.arch = IH_ARCH_PPC,
  	.type = IH_TYPE_KERNEL,
  	.comp = IH_COMP_GZIP,
  	.dtc = MKIMAGE_DEFAULT_DTC_OPTIONS,

  	.imagename = "",

  	.imagename2 = "",

  };

  static enum ih_category cur_category;
  
  static int h_compare_category_name(const void *vtype1, const void *vtype2)
  {
  	const int *type1 = vtype1;
  	const int *type2 = vtype2;
  	const char *name1 = genimg_get_cat_short_name(cur_category, *type1);
  	const char *name2 = genimg_get_cat_short_name(cur_category, *type2);
  
  	return strcmp(name1, name2);
  }

  static int show_valid_options(enum ih_category category)

  {
  	int *order;
  	int count;
  	int item;
  	int i;
  
  	count = genimg_get_cat_count(category);
  	order = calloc(count, sizeof(*order));
  	if (!order)
  		return -ENOMEM;
  
  	/* Sort the names in order of short name for easier reading */
  	for (item = 0; item < count; item++)
  		order[item] = item;
  	cur_category = category;
  	qsort(order, count, sizeof(int), h_compare_category_name);
  
  	fprintf(stderr, "
  Invalid %s, supported are:
  ",
  		genimg_get_cat_desc(category));
  	for (i = 0; i < count; i++) {
  		item = order[i];
  		fprintf(stderr, "\t%-15s  %s
  ",
  			genimg_get_cat_short_name(category, item),
  			genimg_get_cat_name(category, item));
  	}
  	fprintf(stderr, "
  ");

  	free(order);

  
  	return 0;
  }

  static void usage(const char *msg)

  {

  	fprintf(stderr, "Error: %s
  ", msg);

  	fprintf(stderr, "Usage: %s -l image
  "
  			 "          -l ==> list image header information
  ",
  		params.cmdname);
  	fprintf(stderr,
  		"       %s [-x] -A arch -O os -T type -C comp -a addr -e ep -n name -d data_file[:data_file...] image
  "
  		"          -A ==> set architecture to 'arch'
  "
  		"          -O ==> set operating system to 'os'
  "
  		"          -T ==> set image type to 'type'
  "
  		"          -C ==> set compression type 'comp'
  "
  		"          -a ==> set load address to 'addr' (hex)
  "
  		"          -e ==> set entry point to 'ep' (hex)
  "
  		"          -n ==> set image name to 'name'
  "
  		"          -d ==> use image data from 'datafile'
  "
  		"          -x ==> set XIP (execute in place)
  ",
  		params.cmdname);
  	fprintf(stderr,

  		"       %s [-D dtc_options] [-f fit-image.its|-f auto|-F] [-b <dtb> [-b <dtb>]] [-i <ramdisk.cpio.gz>] fit-image
  "

  		"           <dtb> file is used with -f auto, it may occur multiple times.
  ",

  		params.cmdname);
  	fprintf(stderr,
  		"          -D => set all options for device tree compiler
  "

  		"          -f => input filename for FIT source
  "
  		"          -i => input filename for ramdisk file
  ");

  #ifdef CONFIG_FIT_SIGNATURE
  	fprintf(stderr,

  		"Signing / verified boot options: [-E] [-k keydir] [-K dtb] [ -c <comment>] [-p addr] [-r] [-N engine]
  "

  		"          -E => place data outside of the FIT structure
  "

  		"          -k => set directory containing private keys
  "
  		"          -K => write public keys to this .dtb file
  "
  		"          -c => add comment in signature node
  "
  		"          -F => re-sign existing FIT image
  "

  		"          -p => place external data at a static position
  "

  		"          -r => mark keys used as 'required' in dtb
  "
  		"          -N => engine to use for signing (pkcs11)
  ");

  #else
  	fprintf(stderr,
  		"Signing / verified boot not supported (CONFIG_FIT_SIGNATURE undefined)
  ");
  #endif
  	fprintf(stderr, "       %s -V ==> print version information and exit
  ",
  		params.cmdname);

  	fprintf(stderr, "Use '-T list' to see a list of available image types
  ");

  
  	exit(EXIT_FAILURE);
  }

  static int add_content(int type, const char *fname)
  {
  	struct content_info *cont;
  
  	cont = calloc(1, sizeof(*cont));
  	if (!cont)
  		return -1;
  	cont->type = type;
  	cont->fname = fname;
  	if (params.content_tail)
  		params.content_tail->next = cont;
  	else
  		params.content_head = cont;
  	params.content_tail = cont;
  
  	return 0;
  }

  static void process_args(int argc, char **argv)

  {

  	char *ptr;

  	int type = IH_TYPE_INVALID;
  	char *datafile = NULL;

  	int opt;
  
  	while ((opt = getopt(argc, argv,

  			     "a:A:b:c:C:d:D:e:Ef:Fk:i:K:ln:N:p:O:rR:qsT:vVx")) != -1) {

  		switch (opt) {

  		case 'a':
  			params.addr = strtoull(optarg, &ptr, 16);
  			if (*ptr) {
  				fprintf(stderr, "%s: invalid load address %s
  ",
  					params.cmdname, optarg);
  				exit(EXIT_FAILURE);
  			}

  			break;
  		case 'A':
  			params.arch = genimg_get_arch_id(optarg);

  			if (params.arch < 0) {
  				show_valid_options(IH_ARCH);

  				usage("Invalid architecture");

  			}

  			break;

  		case 'b':

  			if (add_content(IH_TYPE_FLATDT, optarg)) {

  				fprintf(stderr,
  					"%s: Out of memory adding content '%s'",
  					params.cmdname, optarg);
  				exit(EXIT_FAILURE);
  			}

  			break;

  		case 'c':
  			params.comment = optarg;
  			break;
  		case 'C':
  			params.comp = genimg_get_comp_id(optarg);

  			if (params.comp < 0) {
  				show_valid_options(IH_COMP);

  				usage("Invalid compression type");

  			}

  			break;

  		case 'd':
  			params.datafile = optarg;
  			params.dflag = 1;
  			break;

  		case 'D':
  			params.dtc = optarg;
  			break;

  		case 'e':
  			params.ep = strtoull(optarg, &ptr, 16);
  			if (*ptr) {
  				fprintf(stderr, "%s: invalid entry point %s
  ",
  					params.cmdname, optarg);
  				exit(EXIT_FAILURE);

  			}

  			params.eflag = 1;
  			break;

  		case 'E':
  			params.external_data = true;
  			break;

  		case 'f':

  			datafile = optarg;
  			params.auto_its = !strcmp(datafile, "auto");

  			/* no break */
  		case 'F':
  			/*
  			 * The flattened image tree (FIT) format
  			 * requires a flattened device tree image type
  			 */
  			params.type = IH_TYPE_FLATDT;
  			params.fflag = 1;
  			break;

  		case 'i':
  			params.fit_ramdisk = optarg;
  			break;

  		case 'k':
  			params.keydir = optarg;
  			break;
  		case 'K':
  			params.keydest = optarg;
  			break;

  		case 'l':
  			params.lflag = 1;
  			break;

  		case 'n':
  			params.imagename = optarg;
  			break;

  		case 'N':
  			params.engine_id = optarg;
  			break;

  		case 'O':
  			params.os = genimg_get_os_id(optarg);

  			if (params.os < 0) {
  				show_valid_options(IH_OS);

  				usage("Invalid operating system");

  			}

  			break;

  		case 'p':
  			params.external_offset = strtoull(optarg, &ptr, 16);
  			if (*ptr) {
  				fprintf(stderr, "%s: invalid offset size %s
  ",
  					params.cmdname, optarg);
  				exit(EXIT_FAILURE);
  			}

  			break;

  		case 'q':
  			params.quiet = 1;
  			break;

  		case 'r':
  			params.require_keys = 1;
  			break;
  		case 'R':
  			/*
  			 * This entry is for the second configuration
  			 * file, if only one is not enough.
  			 */
  			params.imagename2 = optarg;
  			break;
  		case 's':
  			params.skipcpy = 1;
  			break;

  		case 'T':

  			if (strcmp(optarg, "list") == 0) {
  				show_valid_options(IH_TYPE);
  				exit(EXIT_SUCCESS);
  			}

  			type = genimg_get_type_id(optarg);
  			if (type < 0) {

  				show_valid_options(IH_TYPE);

  				usage("Invalid image type");

  			}
  			break;

  		case 'v':
  			params.vflag++;
  			break;
  		case 'V':
  			printf("mkimage version %s
  ", PLAIN_VERSION);
  			exit(EXIT_SUCCESS);
  		case 'x':
  			params.xflag++;
  			break;
  		default:

  			usage("Invalid option");

  		}

  	}

  	/* The last parameter is expected to be the imagefile */
  	if (optind < argc)

  		params.imagefile = argv[optind];

  	/*
  	 * For auto-generated FIT images we need to know the image type to put
  	 * in the FIT, which is separate from the file's image type (which
  	 * will always be IH_TYPE_FLATDT in this case).
  	 */
  	if (params.type == IH_TYPE_FLATDT) {

  		params.fit_image_type = type ? type : IH_TYPE_KERNEL;

  		/* For auto_its, datafile is always 'auto' */

  		if (!params.auto_its)
  			params.datafile = datafile;

  		else if (!params.datafile)
  			usage("Missing data file for auto-FIT (use -d)");

  	} else if (type != IH_TYPE_INVALID) {
  		params.type = type;
  	}
  
  	if (!params.imagefile)

  		usage("Missing output filename");

  }

  int main(int argc, char **argv)
  {
  	int ifd = -1;
  	struct stat sbuf;
  	char *ptr;
  	int retval = 0;
  	struct image_type_params *tparams = NULL;
  	int pad_len = 0;
  	int dfd;
  
  	params.cmdname = *argv;
  	params.addr = 0;
  	params.ep = 0;
  
  	process_args(argc, argv);

  
  	/* set tparams as per input type_id */

  	tparams = imagetool_get_type(params.type);

  	if (tparams == NULL) {
  		fprintf (stderr, "%s: unsupported type %s
  ",
  			params.cmdname, genimg_get_type_name(params.type));
  		exit (EXIT_FAILURE);
  	}

  	/*
  	 * check the passed arguments parameters meets the requirements
  	 * as per image type to be generated/listed
  	 */
  	if (tparams->check_params)
  		if (tparams->check_params (&params))

  			usage("Bad parameters for image type");

  
  	if (!params.eflag) {
  		params.ep = params.addr;

  		/* If XIP, entry point must be after the U-Boot header */

  		if (params.xflag)
  			params.ep += tparams->header_size;

  	}

  	if (params.fflag){
  		if (tparams->fflag_handle)
  			/*
  			 * in some cases, some additional processing needs
  			 * to be done if fflag is defined
  			 *
  			 * For ex. fit_handle_file for Fit file support
  			 */
  			retval = tparams->fflag_handle(&params);

  		if (retval != EXIT_SUCCESS)
  			exit (retval);
  	}
  
  	if (params.lflag || params.fflag) {
  		ifd = open (params.imagefile, O_RDONLY|O_BINARY);
  	} else {
  		ifd = open (params.imagefile,
  			O_RDWR|O_CREAT|O_TRUNC|O_BINARY, 0666);
  	}
  
  	if (ifd < 0) {
  		fprintf (stderr, "%s: Can't open %s: %s
  ",
  			params.cmdname, params.imagefile,
  			strerror(errno));
  		exit (EXIT_FAILURE);

  	}

  	if (params.lflag || params.fflag) {

  		/*
  		 * list header information of existing image
  		 */
  		if (fstat(ifd, &sbuf) < 0) {
  			fprintf (stderr, "%s: Can't stat %s: %s
  ",

  				params.cmdname, params.imagefile,
  				strerror(errno));

  			exit (EXIT_FAILURE);
  		}

  		if ((unsigned)sbuf.st_size < tparams->header_size) {

  			fprintf (stderr,

  				"%s: Bad size: \"%s\" is not valid image
  ",
  				params.cmdname, params.imagefile);

  			exit (EXIT_FAILURE);
  		}

  		ptr = mmap(0, sbuf.st_size, PROT_READ, MAP_SHARED, ifd, 0);
  		if (ptr == MAP_FAILED) {

  			fprintf (stderr, "%s: Can't read %s: %s
  ",

  				params.cmdname, params.imagefile,
  				strerror(errno));

  			exit (EXIT_FAILURE);
  		}

  		/*
  		 * scan through mkimage registry for all supported image types
  		 * and verify the input image file header for match
  		 * Print the image information for matched image type
  		 * Returns the error code if not matched
  		 */

  		retval = imagetool_verify_print_header(ptr, &sbuf,
  				tparams, &params);

  		(void) munmap((void *)ptr, sbuf.st_size);
  		(void) close (ifd);

  		exit (retval);

  	}

  	if ((params.type != IH_TYPE_MULTI) && (params.type != IH_TYPE_SCRIPT)) {

  		dfd = open(params.datafile, O_RDONLY | O_BINARY);
  		if (dfd < 0) {
  			fprintf(stderr, "%s: Can't open %s: %s
  ",
  				params.cmdname, params.datafile,
  				strerror(errno));
  			exit(EXIT_FAILURE);
  		}

  		if (fstat(dfd, &sbuf) < 0) {
  			fprintf(stderr, "%s: Can't stat %s: %s
  ",
  				params.cmdname, params.datafile,
  				strerror(errno));
  			exit(EXIT_FAILURE);
  		}

  		params.file_size = sbuf.st_size + tparams->header_size;
  		close(dfd);
  	}

  	/*

  	 * In case there an header with a variable
  	 * length will be added, the corresponding
  	 * function is called. This is responsible to
  	 * allocate memory for the header itself.

  	 */

  	if (tparams->vrec_header)

  		pad_len = tparams->vrec_header(&params, tparams);

  	else
  		memset(tparams->hdr, 0, tparams->header_size);

  	if (write(ifd, tparams->hdr, tparams->header_size)
  					!= tparams->header_size) {

  		fprintf (stderr, "%s: Write error on %s: %s
  ",

  			params.cmdname, params.imagefile, strerror(errno));

  		exit (EXIT_FAILURE);
  	}

  	if (!params.skipcpy) {
  		if (params.type == IH_TYPE_MULTI ||
  		    params.type == IH_TYPE_SCRIPT) {
  			char *file = params.datafile;
  			uint32_t size;
  
  			for (;;) {
  				char *sep = NULL;
  
  				if (file) {
  					if ((sep = strchr(file, ':')) != NULL) {
  						*sep = '\0';
  					}
  
  					if (stat (file, &sbuf) < 0) {
  						fprintf (stderr, "%s: Can't stat %s: %s
  ",
  							 params.cmdname, file, strerror(errno));
  						exit (EXIT_FAILURE);
  					}
  					size = cpu_to_uimage (sbuf.st_size);
  				} else {
  					size = 0;

  				}

  				if (write(ifd, (char *)&size, sizeof(size)) != sizeof(size)) {
  					fprintf (stderr, "%s: Write error on %s: %s
  ",
  						 params.cmdname, params.imagefile,
  						 strerror(errno));

  					exit (EXIT_FAILURE);
  				}

  				if (!file) {
  					break;
  				}

  				if (sep) {
  					*sep = ':';
  					file = sep + 1;
  				} else {
  					file = NULL;
  				}

  			}

  			file = params.datafile;

  			for (;;) {
  				char *sep = strchr(file, ':');
  				if (sep) {
  					*sep = '\0';
  					copy_file (ifd, file, 1);
  					*sep++ = ':';
  					file = sep;
  				} else {
  					copy_file (ifd, file, 0);
  					break;
  				}

  			}

  		} else if (params.type == IH_TYPE_PBLIMAGE) {
  			/* PBL has special Image format, implements its' own */
  			pbl_load_uboot(ifd, &params);

  		} else {

  			copy_file(ifd, params.datafile, pad_len);

  		}

  		if (params.type == IH_TYPE_FIRMWARE_IVT) {
  			/* Add alignment and IVT */
  			uint32_t aligned_filesize = (params.file_size + 0x1000
  					- 1) & ~(0x1000 - 1);
  			flash_header_v2_t ivt_header = { { 0xd1, 0x2000, 0x40 },
  					params.addr, 0, 0, 0, params.addr
  							+ aligned_filesize
  							- tparams->header_size,
  					params.addr + aligned_filesize
  							- tparams->header_size
  							+ 0x20, 0 };
  			int i = params.file_size;
  			for (; i < aligned_filesize; i++) {

  				if (write(ifd, (char *) &i, 1) != 1) {

  					fprintf(stderr,
  							"%s: Write error on %s: %s
  ",
  							params.cmdname,
  							params.imagefile,
  							strerror(errno));
  					exit(EXIT_FAILURE);
  				}
  			}
  			if (write(ifd, &ivt_header, sizeof(flash_header_v2_t))
  					!= sizeof(flash_header_v2_t)) {
  				fprintf(stderr, "%s: Write error on %s: %s
  ",
  						params.cmdname,
  						params.imagefile,
  						strerror(errno));
  				exit(EXIT_FAILURE);
  			}
  		}

  	}
  
  	/* We're a bit of paranoid */

  #if defined(_POSIX_SYNCHRONIZED_IO) && \
     !defined(__sun__) && \
     !defined(__FreeBSD__) && \

     !defined(__OpenBSD__) && \

     !defined(__APPLE__)

  	(void) fdatasync (ifd);
  #else
  	(void) fsync (ifd);
  #endif
  
  	if (fstat(ifd, &sbuf) < 0) {
  		fprintf (stderr, "%s: Can't stat %s: %s
  ",

  			params.cmdname, params.imagefile, strerror(errno));

  		exit (EXIT_FAILURE);
  	}

  	params.file_size = sbuf.st_size;

  	ptr = mmap(0, sbuf.st_size, PROT_READ|PROT_WRITE, MAP_SHARED, ifd, 0);
  	if (ptr == MAP_FAILED) {

  		fprintf (stderr, "%s: Can't map %s: %s
  ",

  			params.cmdname, params.imagefile, strerror(errno));

  		exit (EXIT_FAILURE);
  	}

  	/* Setup the image header as per input image type*/
  	if (tparams->set_header)
  		tparams->set_header (ptr, &sbuf, ifd, &params);
  	else {
  		fprintf (stderr, "%s: Can't set header for %s: %s
  ",
  			params.cmdname, tparams->name, strerror(errno));
  		exit (EXIT_FAILURE);
  	}

  	/* Print the image information by processing image header */
  	if (tparams->print_header)
  		tparams->print_header (ptr);
  	else {
  		fprintf (stderr, "%s: Can't print header for %s: %s
  ",
  			params.cmdname, tparams->name, strerror(errno));
  		exit (EXIT_FAILURE);
  	}

  
  	(void) munmap((void *)ptr, sbuf.st_size);
  
  	/* We're a bit of paranoid */

  #if defined(_POSIX_SYNCHRONIZED_IO) && \
     !defined(__sun__) && \
     !defined(__FreeBSD__) && \

     !defined(__OpenBSD__) && \

     !defined(__APPLE__)

  	(void) fdatasync (ifd);
  #else
  	(void) fsync (ifd);
  #endif
  
  	if (close(ifd)) {
  		fprintf (stderr, "%s: Write error on %s: %s
  ",

  			params.cmdname, params.imagefile, strerror(errno));

  		exit (EXIT_FAILURE);
  	}
  
  	exit (EXIT_SUCCESS);
  }
  
  static void
  copy_file (int ifd, const char *datafile, int pad)
  {
  	int dfd;
  	struct stat sbuf;
  	unsigned char *ptr;
  	int tail;
  	int zero = 0;

  	uint8_t zeros[4096];

  	int offset = 0;
  	int size;

  	struct image_type_params *tparams = imagetool_get_type(params.type);

  	memset(zeros, 0, sizeof(zeros));

  	if (params.vflag) {

  		fprintf (stderr, "Adding Image %s
  ", datafile);
  	}

  	if ((dfd = open(datafile, O_RDONLY|O_BINARY)) < 0) {

  		fprintf (stderr, "%s: Can't open %s: %s
  ",

  			params.cmdname, datafile, strerror(errno));

  		exit (EXIT_FAILURE);
  	}
  
  	if (fstat(dfd, &sbuf) < 0) {
  		fprintf (stderr, "%s: Can't stat %s: %s
  ",

  			params.cmdname, datafile, strerror(errno));

  		exit (EXIT_FAILURE);
  	}

  	ptr = mmap(0, sbuf.st_size, PROT_READ, MAP_SHARED, dfd, 0);
  	if (ptr == MAP_FAILED) {

  		fprintf (stderr, "%s: Can't read %s: %s
  ",

  			params.cmdname, datafile, strerror(errno));

  		exit (EXIT_FAILURE);
  	}

  	if (params.xflag) {

  		unsigned char *p = NULL;
  		/*
  		 * XIP: do not append the image_header_t at the
  		 * beginning of the file, but consume the space
  		 * reserved for it.
  		 */

  		if ((unsigned)sbuf.st_size < tparams->header_size) {

  			fprintf (stderr,
  				"%s: Bad size: \"%s\" is too small for XIP
  ",

  				params.cmdname, datafile);

  			exit (EXIT_FAILURE);
  		}

  		for (p = ptr; p < ptr + tparams->header_size; p++) {

  			if ( *p != 0xff ) {
  				fprintf (stderr,
  					"%s: Bad file: \"%s\" has invalid buffer for XIP
  ",

  					params.cmdname, datafile);

  				exit (EXIT_FAILURE);
  			}
  		}

  		offset = tparams->header_size;

  	}
  
  	size = sbuf.st_size - offset;
  	if (write(ifd, ptr + offset, size) != size) {
  		fprintf (stderr, "%s: Write error on %s: %s
  ",

  			params.cmdname, params.imagefile, strerror(errno));

  		exit (EXIT_FAILURE);
  	}

  	tail = size % 4;
  	if ((pad == 1) && (tail != 0)) {

  
  		if (write(ifd, (char *)&zero, 4-tail) != 4-tail) {
  			fprintf (stderr, "%s: Write error on %s: %s
  ",

  				params.cmdname, params.imagefile,
  				strerror(errno));

  			exit (EXIT_FAILURE);
  		}

  	} else if (pad > 1) {

  		while (pad > 0) {
  			int todo = sizeof(zeros);
  
  			if (todo > pad)
  				todo = pad;
  			if (write(ifd, (char *)&zeros, todo) != todo) {
  				fprintf(stderr, "%s: Write error on %s: %s
  ",
  					params.cmdname, params.imagefile,
  					strerror(errno));
  				exit(EXIT_FAILURE);
  			}
  			pad -= todo;

  		}

  	}
  
  	(void) munmap((void *)ptr, sbuf.st_size);
  	(void) close (dfd);
  }