/*

   * (C) Copyright 2008 Semihalf
   *

   * (C) Copyright 2000-2009

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

   *
   * This program is free software; you can redistribute it and/or
   * modify it under the terms of the GNU General Public License as
   * published by the Free Software Foundation; either version 2 of
   * the License, or (at your option) any later version.
   *
   * This program is distributed in the hope that it will be useful,
   * but WITHOUT ANY WARRANTY; without even the implied warranty of
   * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   * GNU General Public License for more details.
   *
   * You should have received a copy of the GNU General Public License
   * along with this program; if not, write to the Free Software
   * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
   * MA 02111-1307 USA

   */

  #include "mkimage.h"

  #include <image.h>

  #include <version.h>

  
  static void copy_file(int, const char *, int);
  static void usage(void);
  
  /* image_type_params link list to maintain registered image type supports */
  struct image_type_params *mkimage_tparams = NULL;
  
  /* parameters initialized by core will be used by the image type code */
  struct mkimage_params params = {
  	.os = IH_OS_LINUX,
  	.arch = IH_ARCH_PPC,
  	.type = IH_TYPE_KERNEL,
  	.comp = IH_COMP_GZIP,
  	.dtc = MKIMAGE_DEFAULT_DTC_OPTIONS,

  	.imagename = "",

  };
  
  /*
   * mkimage_register -
   *
   * It is used to register respective image generation/list support to the
   * mkimage core
   *
   * the input struct image_type_params is checked and appended to the link
   * list, if the input structure is already registered, error
   */
  void mkimage_register (struct image_type_params *tparams)
  {
  	struct image_type_params **tp;
  
  	if (!tparams) {
  		fprintf (stderr, "%s: %s: Null input
  ",
  			params.cmdname, __FUNCTION__);
  		exit (EXIT_FAILURE);
  	}
  
  	/* scan the linked list, check for registry and point the last one */
  	for (tp = &mkimage_tparams; *tp != NULL; tp = &(*tp)->next) {
  		if (!strcmp((*tp)->name, tparams->name)) {
  			fprintf (stderr, "%s: %s already registered
  ",
  				params.cmdname, tparams->name);
  			return;
  		}
  	}
  
  	/* add input struct entry at the end of link list */
  	*tp = tparams;
  	/* mark input entry as last entry in the link list */
  	tparams->next = NULL;
  
  	debug ("Registered %s
  ", tparams->name);
  }
  
  /*
   * mkimage_get_type -
   *
   * It scans all registers image type supports
   * checks the input type_id for each supported image type
   *
   * if successful,
   * 	returns respective image_type_params pointer if success
   * if input type_id is not supported by any of image_type_support
   * 	returns NULL
   */
  struct image_type_params *mkimage_get_type(int type)
  {
  	struct image_type_params *curr;
  
  	for (curr = mkimage_tparams; curr != NULL; curr = curr->next) {
  		if (curr->check_image_type) {
  			if (!curr->check_image_type (type))
  				return curr;
  		}
  	}
  	return NULL;
  }
  
  /*
   * mkimage_verify_print_header -
   *
   * It scans mkimage_tparams link list,
   * verifies image_header for each supported image type
   * if verification is successful, prints respective header
   *
   * returns negative if input image format does not match with any of
   * supported image types
   */
  int mkimage_verify_print_header (void *ptr, struct stat *sbuf)
  {
  	int retval = -1;
  	struct image_type_params *curr;
  
  	for (curr = mkimage_tparams; curr != NULL; curr = curr->next ) {
  		if (curr->verify_header) {
  			retval = curr->verify_header (
  				(unsigned char *)ptr, sbuf->st_size,
  				&params);
  
  			if (retval == 0) {
  				/*
  				 * Print the image information
  				 * if verify is successful
  				 */
  				if (curr->print_header)
  					curr->print_header (ptr);
  				else {
  					fprintf (stderr,
  					"%s: print_header undefined for %s
  ",
  					params.cmdname, curr->name);
  				}
  				break;
  			}
  		}
  	}
  	return retval;
  }

  
  int
  main (int argc, char **argv)
  {

  	int ifd = -1;

  	struct stat sbuf;

  	char *ptr;

  	int retval = 0;

  	struct image_type_params *tparams = NULL;

  	/* Init Kirkwood Boot image generation/list support */
  	init_kwb_image_type ();

  	/* Init Freescale imx Boot image generation/list support */
  	init_imx_image_type ();

  	/* Init FIT image generation/list support */
  	init_fit_image_type ();

  	/* Init TI OMAP Boot image generation/list support */
  	init_omap_image_type();

  	/* Init Default image generation/list support */
  	init_default_image_type ();

  	/* Init Davinci UBL support */
  	init_ubl_image_type();

  	/* Init Davinci AIS support */
  	init_ais_image_type();

  	params.cmdname = *argv;
  	params.addr = params.ep = 0;

  
  	while (--argc > 0 && **++argv == '-') {
  		while (*++*argv) {
  			switch (**argv) {
  			case 'l':

  				params.lflag = 1;

  				break;
  			case 'A':
  				if ((--argc <= 0) ||

  					(params.arch =
  					genimg_get_arch_id (*++argv)) < 0)

  					usage ();
  				goto NXTARG;
  			case 'C':
  				if ((--argc <= 0) ||

  					(params.comp =
  					genimg_get_comp_id (*++argv)) < 0)

  					usage ();
  				goto NXTARG;

  			case 'D':
  				if (--argc <= 0)
  					usage ();

  				params.dtc = *++argv;

  				goto NXTARG;

  			case 'O':
  				if ((--argc <= 0) ||

  					(params.os =
  					genimg_get_os_id (*++argv)) < 0)

  					usage ();
  				goto NXTARG;
  			case 'T':
  				if ((--argc <= 0) ||

  					(params.type =
  					genimg_get_type_id (*++argv)) < 0)

  					usage ();
  				goto NXTARG;
  
  			case 'a':
  				if (--argc <= 0)
  					usage ();

  				params.addr = strtoul (*++argv, &ptr, 16);

  				if (*ptr) {
  					fprintf (stderr,
  						"%s: invalid load address %s
  ",

  						params.cmdname, *argv);

  					exit (EXIT_FAILURE);
  				}
  				goto NXTARG;
  			case 'd':
  				if (--argc <= 0)
  					usage ();

  				params.datafile = *++argv;
  				params.dflag = 1;

  				goto NXTARG;
  			case 'e':
  				if (--argc <= 0)
  					usage ();

  				params.ep = strtoul (*++argv, &ptr, 16);

  				if (*ptr) {
  					fprintf (stderr,
  						"%s: invalid entry point %s
  ",

  						params.cmdname, *argv);

  					exit (EXIT_FAILURE);
  				}

  				params.eflag = 1;

  				goto NXTARG;

  			case 'f':
  				if (--argc <= 0)
  					usage ();

  				/*
  				 * The flattened image tree (FIT) format
  				 * requires a flattened device tree image type
  				 */
  				params.type = IH_TYPE_FLATDT;

  				params.datafile = *++argv;
  				params.fflag = 1;

  				goto NXTARG;

  			case 'n':
  				if (--argc <= 0)
  					usage ();

  				params.imagename = *++argv;

  				goto NXTARG;

  			case 's':
  				params.skipcpy = 1;
  				break;

  			case 'v':

  				params.vflag++;

  				break;

  			case 'V':
  				printf("mkimage version %s
  ", PLAIN_VERSION);
  				exit(EXIT_SUCCESS);

  			case 'x':

  				params.xflag++;

  				break;
  			default:
  				usage ();
  			}
  		}
  NXTARG:		;
  	}

  	if (argc != 1)
  		usage ();
  
  	/* set tparams as per input type_id */
  	tparams = mkimage_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 ();
  
  	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;

  	}

  	params.imagefile = *argv;

  	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 = mkimage_verify_print_header (ptr, &sbuf);

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

  		exit (retval);

  	}
  
  	/*

  	 * 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)
  		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 {
  			copy_file (ifd, params.datafile, 0);

  		}

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

  #if defined(_POSIX_SYNCHRONIZED_IO) && \
     !defined(__sun__) && \
     !defined(__FreeBSD__) && \
     !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);
  	}

  	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(__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;
  	int offset = 0;
  	int size;

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

  	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);
  	}
  
  	if (pad && ((tail = size % 4) != 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);
  		}
  	}
  
  	(void) munmap((void *)ptr, sbuf.st_size);
  	(void) close (dfd);
  }
  
  void
  usage ()
  {
  	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 fit-image
  ",

  		params.cmdname);

  	fprintf (stderr, "       %s -V ==> print version information and exit
  ",
  		params.cmdname);

  	exit (EXIT_FAILURE);
  }