// SPDX-License-Identifier: GPL-2.0+

  /*
   * Copyright (c) 2011 Sebastian Andrzej Siewior <bigeasy@linutronix.de>

   */
  
  #include <common.h>

  #include <env.h>

  #include <image.h>
  #include <android_image.h>

  #include <malloc.h>
  #include <errno.h>

  #include <asm/unaligned.h>

  #define ANDROID_IMAGE_DEFAULT_KERNEL_ADDR	0x10008000

  static char andr_tmp_str[ANDR_BOOT_ARGS_SIZE + 1];

  static ulong android_image_get_kernel_addr(const struct andr_img_hdr *hdr)
  {
  	/*
  	 * All the Android tools that generate a boot.img use this
  	 * address as the default.
  	 *
  	 * Even though it doesn't really make a lot of sense, and it
  	 * might be valid on some platforms, we treat that adress as
  	 * the default value for this field, and try to execute the
  	 * kernel in place in such a case.
  	 *
  	 * Otherwise, we will return the actual value set by the user.
  	 */
  	if (hdr->kernel_addr == ANDROID_IMAGE_DEFAULT_KERNEL_ADDR)
  		return (ulong)hdr + hdr->page_size;
  
  	return hdr->kernel_addr;
  }

  /**
   * android_image_get_kernel() - processes kernel part of Android boot images
   * @hdr:	Pointer to image header, which is at the start
   *			of the image.
   * @verify:	Checksum verification flag. Currently unimplemented.
   * @os_data:	Pointer to a ulong variable, will hold os data start
   *			address.
   * @os_len:	Pointer to a ulong variable, will hold os data length.
   *
   * This function returns the os image's start address and length. Also,
   * it appends the kernel command line to the bootargs env variable.
   *
   * Return: Zero, os start address and length on success,
   *		otherwise on failure.
   */

  int android_image_get_kernel(const struct andr_img_hdr *hdr, int verify,
  			     ulong *os_data, ulong *os_len)
  {

  	u32 kernel_addr = android_image_get_kernel_addr(hdr);

  	const struct image_header *ihdr = (const struct image_header *)
  		((uintptr_t)hdr + hdr->page_size);

  	/*
  	 * Not all Android tools use the id field for signing the image with
  	 * sha1 (or anything) so we don't check it. It is not obvious that the
  	 * string is null terminated so we take care of this.
  	 */
  	strncpy(andr_tmp_str, hdr->name, ANDR_BOOT_NAME_SIZE);
  	andr_tmp_str[ANDR_BOOT_NAME_SIZE] = '\0';
  	if (strlen(andr_tmp_str))
  		printf("Android's image name: %s
  ", andr_tmp_str);
  
  	printf("Kernel load addr 0x%08x size %u KiB
  ",

  	       kernel_addr, DIV_ROUND_UP(hdr->kernel_size, 1024));

  
  	int len = 0;
  	if (*hdr->cmdline) {
  		printf("Kernel command line: %s
  ", hdr->cmdline);
  		len += strlen(hdr->cmdline);
  	}

  	char *bootargs = env_get("bootargs");

  	if (bootargs)
  		len += strlen(bootargs);
  
  	char *newbootargs = malloc(len + 2);
  	if (!newbootargs) {
  		puts("Error: malloc in android_image_get_kernel failed!
  ");
  		return -ENOMEM;
  	}
  	*newbootargs = '\0';
  
  	if (bootargs) {
  		strcpy(newbootargs, bootargs);
  		strcat(newbootargs, " ");

  	}

  	if (*hdr->cmdline)
  		strcat(newbootargs, hdr->cmdline);

  	env_set("bootargs", newbootargs);

  
  	if (os_data) {

  		if (image_get_magic(ihdr) == IH_MAGIC) {
  			*os_data = image_get_data(ihdr);
  		} else {
  			*os_data = (ulong)hdr;
  			*os_data += hdr->page_size;
  		}
  	}
  	if (os_len) {
  		if (image_get_magic(ihdr) == IH_MAGIC)
  			*os_len = image_get_data_size(ihdr);
  		else
  			*os_len = hdr->kernel_size;

  	}

  	return 0;
  }
  
  int android_image_check_header(const struct andr_img_hdr *hdr)
  {
  	return memcmp(ANDR_BOOT_MAGIC, hdr->magic, ANDR_BOOT_MAGIC_SIZE);
  }
  
  ulong android_image_get_end(const struct andr_img_hdr *hdr)
  {

  	ulong end;

  	/*
  	 * The header takes a full page, the remaining components are aligned
  	 * on page boundary
  	 */

  	end = (ulong)hdr;
  	end += hdr->page_size;
  	end += ALIGN(hdr->kernel_size, hdr->page_size);
  	end += ALIGN(hdr->ramdisk_size, hdr->page_size);
  	end += ALIGN(hdr->second_size, hdr->page_size);

  	if (hdr->header_version >= 1)
  		end += ALIGN(hdr->recovery_dtbo_size, hdr->page_size);
  
  	if (hdr->header_version >= 2)
  		end += ALIGN(hdr->dtb_size, hdr->page_size);

  	return end;

  }
  
  ulong android_image_get_kload(const struct andr_img_hdr *hdr)
  {

  	return android_image_get_kernel_addr(hdr);

  }

  ulong android_image_get_kcomp(const struct andr_img_hdr *hdr)
  {
  	const void *p = (void *)((uintptr_t)hdr + hdr->page_size);

  	if (image_get_magic((image_header_t *)p) == IH_MAGIC)
  		return image_get_comp((image_header_t *)p);
  	else if (get_unaligned_le32(p) == LZ4F_MAGIC)

  		return IH_COMP_LZ4;
  	else
  		return IH_COMP_NONE;
  }

  int android_image_get_ramdisk(const struct andr_img_hdr *hdr,
  			      ulong *rd_data, ulong *rd_len)
  {

  	if (!hdr->ramdisk_size) {
  		*rd_data = *rd_len = 0;

  		return -1;

  	}

  
  	printf("RAM disk load addr 0x%08x size %u KiB
  ",
  	       hdr->ramdisk_addr, DIV_ROUND_UP(hdr->ramdisk_size, 1024));

  	*rd_data = (unsigned long)hdr;
  	*rd_data += hdr->page_size;
  	*rd_data += ALIGN(hdr->kernel_size, hdr->page_size);
  
  	*rd_len = hdr->ramdisk_size;
  	return 0;
  }

  int android_image_get_second(const struct andr_img_hdr *hdr,
  			      ulong *second_data, ulong *second_len)
  {
  	if (!hdr->second_size) {
  		*second_data = *second_len = 0;
  		return -1;
  	}
  
  	*second_data = (unsigned long)hdr;
  	*second_data += hdr->page_size;
  	*second_data += ALIGN(hdr->kernel_size, hdr->page_size);
  	*second_data += ALIGN(hdr->ramdisk_size, hdr->page_size);
  
  	printf("second address is 0x%lx
  ",*second_data);
  
  	*second_len = hdr->second_size;
  	return 0;
  }

  #if !defined(CONFIG_SPL_BUILD)
  /**
   * android_print_contents - prints out the contents of the Android format image
   * @hdr: pointer to the Android format image header
   *
   * android_print_contents() formats a multi line Android image contents
   * description.
   * The routine prints out Android image properties
   *
   * returns:
   *     no returned results
   */
  void android_print_contents(const struct andr_img_hdr *hdr)
  {
  	const char * const p = IMAGE_INDENT_STRING;

  	/* os_version = ver << 11 | lvl */
  	u32 os_ver = hdr->os_version >> 11;
  	u32 os_lvl = hdr->os_version & ((1U << 11) - 1);

  	printf("%skernel size:          %x
  ", p, hdr->kernel_size);
  	printf("%skernel address:       %x
  ", p, hdr->kernel_addr);
  	printf("%sramdisk size:         %x
  ", p, hdr->ramdisk_size);
  	printf("%sramdisk address:      %x
  ", p, hdr->ramdisk_addr);
  	printf("%ssecond size:          %x
  ", p, hdr->second_size);
  	printf("%ssecond address:       %x
  ", p, hdr->second_addr);
  	printf("%stags address:         %x
  ", p, hdr->tags_addr);
  	printf("%spage size:            %x
  ", p, hdr->page_size);

  	/* ver = A << 14 | B << 7 | C         (7 bits for each of A, B, C)
  	 * lvl = ((Y - 2000) & 127) << 4 | M  (7 bits for Y, 4 bits for M) */

  	printf("%sos_version:           %x (ver: %u.%u.%u, level: %u.%u)
  ",

  	       p, hdr->os_version,
  	       (os_ver >> 7) & 0x7F, (os_ver >> 14) & 0x7F, os_ver & 0x7F,
  	       (os_lvl >> 4) + 2000, os_lvl & 0x0F);

  	printf("%sname:                 %s
  ", p, hdr->name);
  	printf("%scmdline:              %s
  ", p, hdr->cmdline);
  	printf("%sheader_version:       %d
  ", p, hdr->header_version);
  
  	if (hdr->header_version >= 1) {
  		printf("%srecovery dtbo size:   %x
  ", p,
  		       hdr->recovery_dtbo_size);
  		printf("%srecovery dtbo offset: %llx
  ", p,
  		       hdr->recovery_dtbo_offset);
  		printf("%sheader size:          %x
  ", p,
  		       hdr->header_size);
  	}
  
  	if (hdr->header_version >= 2) {
  		printf("%sdtb size:             %x
  ", p, hdr->dtb_size);
  		printf("%sdtb addr:             %llx
  ", p, hdr->dtb_addr);
  	}

  }
  #endif