[people/ms/u-boot.git] / common / fb_mmc.c

/*
 * Copyright 2014 Broadcom Corporation.
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <config.h>
#include <common.h>
#include <blk.h>
#include <fastboot.h>
#include <fb_mmc.h>
#include <image-sparse.h>
#include <part.h>
#include <mmc.h>
#include <div64.h>
#include <linux/compat.h>
#include <android_image.h>

/*
 * FIXME: Ensure we always set these names via Kconfig once xxx_PARTITION is
 * migrated
 */
#ifndef CONFIG_FASTBOOT_GPT_NAME
#define CONFIG_FASTBOOT_GPT_NAME "gpt"
#endif


#ifndef CONFIG_FASTBOOT_MBR_NAME
#define CONFIG_FASTBOOT_MBR_NAME "mbr"
#endif

#define BOOT_PARTITION_NAME "boot"

struct fb_mmc_sparse {
	struct blk_desc	*dev_desc;
};

static int part_get_info_by_name_or_alias(struct blk_desc *dev_desc,
		const char *name, disk_partition_t *info)
{
	int ret;

	ret = part_get_info_by_name(dev_desc, name, info);
	if (ret < 0) {
		/* strlen("fastboot_partition_alias_") + 32(part_name) + 1 */
		char env_alias_name[25 + 32 + 1];
		char *aliased_part_name;

		/* check for alias */
		strcpy(env_alias_name, "fastboot_partition_alias_");
		strncat(env_alias_name, name, 32);
		aliased_part_name = env_get(env_alias_name);
		if (aliased_part_name != NULL)
			ret = part_get_info_by_name(dev_desc,
					aliased_part_name, info);
	}
	return ret;
}

static lbaint_t fb_mmc_sparse_write(struct sparse_storage *info,
		lbaint_t blk, lbaint_t blkcnt, const void *buffer)
{
	struct fb_mmc_sparse *sparse = info->priv;
	struct blk_desc *dev_desc = sparse->dev_desc;

	return blk_dwrite(dev_desc, blk, blkcnt, buffer);
}

static lbaint_t fb_mmc_sparse_reserve(struct sparse_storage *info,
		lbaint_t blk, lbaint_t blkcnt)
{
	return blkcnt;
}

static void write_raw_image(struct blk_desc *dev_desc, disk_partition_t *info,
		const char *part_name, void *buffer,
		unsigned int download_bytes)
{
	lbaint_t blkcnt;
	lbaint_t blks;

	/* determine number of blocks to write */
	blkcnt = ((download_bytes + (info->blksz - 1)) & ~(info->blksz - 1));
	blkcnt = lldiv(blkcnt, info->blksz);

	if (blkcnt > info->size) {
		pr_err("too large for partition: '%s'\n", part_name);
		fastboot_fail("too large for partition");
		return;
	}

	puts("Flashing Raw Image\n");

	blks = blk_dwrite(dev_desc, info->start, blkcnt, buffer);
	if (blks != blkcnt) {
		pr_err("failed writing to device %d\n", dev_desc->devnum);
		fastboot_fail("failed writing to device");
		return;
	}

	printf("........ wrote " LBAFU " bytes to '%s'\n", blkcnt * info->blksz,
	       part_name);
	fastboot_okay("");
}

#ifdef CONFIG_ANDROID_BOOT_IMAGE
/**
 * Read Android boot image header from boot partition.
 *
 * @param[in] dev_desc MMC device descriptor
 * @param[in] info Boot partition info
 * @param[out] hdr Where to store read boot image header
 *
 * @return Boot image header sectors count or 0 on error
 */
static lbaint_t fb_mmc_get_boot_header(struct blk_desc *dev_desc,
				       disk_partition_t *info,
				       struct andr_img_hdr *hdr)
{
	ulong sector_size;		/* boot partition sector size */
	lbaint_t hdr_sectors;		/* boot image header sectors count */
	int res;

	/* Calculate boot image sectors count */
	sector_size = info->blksz;
	hdr_sectors = DIV_ROUND_UP(sizeof(struct andr_img_hdr), sector_size);
	if (hdr_sectors == 0) {
		pr_err("invalid number of boot sectors: 0");
		fastboot_fail("invalid number of boot sectors: 0");
		return 0;
	}

	/* Read the boot image header */
	res = blk_dread(dev_desc, info->start, hdr_sectors, (void *)hdr);
	if (res != hdr_sectors) {
		pr_err("cannot read header from boot partition");
		fastboot_fail("cannot read header from boot partition");
		return 0;
	}

	/* Check boot header magic string */
	res = android_image_check_header(hdr);
	if (res != 0) {
		pr_err("bad boot image magic");
		fastboot_fail("boot partition not initialized");
		return 0;
	}

	return hdr_sectors;
}

/**
 * Write downloaded zImage to boot partition and repack it properly.
 *
 * @param dev_desc MMC device descriptor
 * @param download_buffer Address to fastboot buffer with zImage in it
 * @param download_bytes Size of fastboot buffer, in bytes
 *
 * @return 0 on success or -1 on error
 */
static int fb_mmc_update_zimage(struct blk_desc *dev_desc,
				void *download_buffer,
				unsigned int download_bytes)
{
	uintptr_t hdr_addr;			/* boot image header address */
	struct andr_img_hdr *hdr;		/* boot image header */
	lbaint_t hdr_sectors;			/* boot image header sectors */
	u8 *ramdisk_buffer;
	u32 ramdisk_sector_start;
	u32 ramdisk_sectors;
	u32 kernel_sector_start;
	u32 kernel_sectors;
	u32 sectors_per_page;
	disk_partition_t info;
	int res;

	puts("Flashing zImage\n");

	/* Get boot partition info */
	res = part_get_info_by_name(dev_desc, BOOT_PARTITION_NAME, &info);
	if (res < 0) {
		pr_err("cannot find boot partition");
		fastboot_fail("cannot find boot partition");
		return -1;
	}

	/* Put boot image header in fastboot buffer after downloaded zImage */
	hdr_addr = (uintptr_t)download_buffer + ALIGN(download_bytes, PAGE_SIZE);
	hdr = (struct andr_img_hdr *)hdr_addr;

	/* Read boot image header */
	hdr_sectors = fb_mmc_get_boot_header(dev_desc, &info, hdr);
	if (hdr_sectors == 0) {
		pr_err("unable to read boot image header");
		fastboot_fail("unable to read boot image header");
		return -1;
	}

	/* Check if boot image has second stage in it (we don't support it) */
	if (hdr->second_size > 0) {
		pr_err("moving second stage is not supported yet");
		fastboot_fail("moving second stage is not supported yet");
		return -1;
	}

	/* Extract ramdisk location */
	sectors_per_page = hdr->page_size / info.blksz;
	ramdisk_sector_start = info.start + sectors_per_page;
	ramdisk_sector_start += DIV_ROUND_UP(hdr->kernel_size, hdr->page_size) *
					     sectors_per_page;
	ramdisk_sectors = DIV_ROUND_UP(hdr->ramdisk_size, hdr->page_size) *
				       sectors_per_page;

	/* Read ramdisk and put it in fastboot buffer after boot image header */
	ramdisk_buffer = (u8 *)hdr + (hdr_sectors * info.blksz);
	res = blk_dread(dev_desc, ramdisk_sector_start, ramdisk_sectors,
			ramdisk_buffer);
	if (res != ramdisk_sectors) {
		pr_err("cannot read ramdisk from boot partition");
		fastboot_fail("cannot read ramdisk from boot partition");
		return -1;
	}

	/* Write new kernel size to boot image header */
	hdr->kernel_size = download_bytes;
	res = blk_dwrite(dev_desc, info.start, hdr_sectors, (void *)hdr);
	if (res == 0) {
		pr_err("cannot writeback boot image header");
		fastboot_fail("cannot write back boot image header");
		return -1;
	}

	/* Write the new downloaded kernel */
	kernel_sector_start = info.start + sectors_per_page;
	kernel_sectors = DIV_ROUND_UP(hdr->kernel_size, hdr->page_size) *
				      sectors_per_page;
	res = blk_dwrite(dev_desc, kernel_sector_start, kernel_sectors,
			 download_buffer);
	if (res == 0) {
		pr_err("cannot write new kernel");
		fastboot_fail("cannot write new kernel");
		return -1;
	}

	/* Write the saved ramdisk back */
	ramdisk_sector_start = info.start + sectors_per_page;
	ramdisk_sector_start += DIV_ROUND_UP(hdr->kernel_size, hdr->page_size) *
					     sectors_per_page;
	res = blk_dwrite(dev_desc, ramdisk_sector_start, ramdisk_sectors,
			 ramdisk_buffer);
	if (res == 0) {
		pr_err("cannot write back original ramdisk");
		fastboot_fail("cannot write back original ramdisk");
		return -1;
	}

	puts("........ zImage was updated in boot partition\n");
	fastboot_okay("");
	return 0;
}
#endif

void fb_mmc_flash_write(const char *cmd, void *download_buffer,
			unsigned int download_bytes)
{
	struct blk_desc *dev_desc;
	disk_partition_t info;

	dev_desc = blk_get_dev("mmc", CONFIG_FASTBOOT_FLASH_MMC_DEV);
	if (!dev_desc || dev_desc->type == DEV_TYPE_UNKNOWN) {
		pr_err("invalid mmc device\n");
		fastboot_fail("invalid mmc device");
		return;
	}

#if CONFIG_IS_ENABLED(EFI_PARTITION)
	if (strcmp(cmd, CONFIG_FASTBOOT_GPT_NAME) == 0) {
		printf("%s: updating MBR, Primary and Backup GPT(s)\n",
		       __func__);
		if (is_valid_gpt_buf(dev_desc, download_buffer)) {
			printf("%s: invalid GPT - refusing to write to flash\n",
			       __func__);
			fastboot_fail("invalid GPT partition");
			return;
		}
		if (write_mbr_and_gpt_partitions(dev_desc, download_buffer)) {
			printf("%s: writing GPT partitions failed\n", __func__);
			fastboot_fail("writing GPT partitions failed");
			return;
		}
		printf("........ success\n");
		fastboot_okay("");
		return;
	}
#endif

#if CONFIG_IS_ENABLED(DOS_PARTITION)
	if (strcmp(cmd, CONFIG_FASTBOOT_MBR_NAME) == 0) {
		printf("%s: updating MBR\n", __func__);
		if (is_valid_dos_buf(download_buffer)) {
			printf("%s: invalid MBR - refusing to write to flash\n",
			       __func__);
			fastboot_fail("invalid MBR partition");
			return;
		}
		if (write_mbr_partition(dev_desc, download_buffer)) {
			printf("%s: writing MBR partition failed\n", __func__);
			fastboot_fail("writing MBR partition failed");
			return;
		}
		printf("........ success\n");
		fastboot_okay("");
		return;
	}
#endif

#ifdef CONFIG_ANDROID_BOOT_IMAGE
	if (strncasecmp(cmd, "zimage", 6) == 0) {
		fb_mmc_update_zimage(dev_desc, download_buffer, download_bytes);
		return;
	}
#endif

	if (part_get_info_by_name_or_alias(dev_desc, cmd, &info) < 0) {
		pr_err("cannot find partition: '%s'\n", cmd);
		fastboot_fail("cannot find partition");
		return;
	}

	if (is_sparse_image(download_buffer)) {
		struct fb_mmc_sparse sparse_priv;
		struct sparse_storage sparse;

		sparse_priv.dev_desc = dev_desc;

		sparse.blksz = info.blksz;
		sparse.start = info.start;
		sparse.size = info.size;
		sparse.write = fb_mmc_sparse_write;
		sparse.reserve = fb_mmc_sparse_reserve;

		printf("Flashing sparse image at offset " LBAFU "\n",
		       sparse.start);

		sparse.priv = &sparse_priv;
		write_sparse_image(&sparse, cmd, download_buffer,
				   download_bytes);
	} else {
		write_raw_image(dev_desc, &info, cmd, download_buffer,
				download_bytes);
	}
}

void fb_mmc_erase(const char *cmd)
{
	int ret;
	struct blk_desc *dev_desc;
	disk_partition_t info;
	lbaint_t blks, blks_start, blks_size, grp_size;
	struct mmc *mmc = find_mmc_device(CONFIG_FASTBOOT_FLASH_MMC_DEV);

	if (mmc == NULL) {
		pr_err("invalid mmc device");
		fastboot_fail("invalid mmc device");
		return;
	}

	dev_desc = blk_get_dev("mmc", CONFIG_FASTBOOT_FLASH_MMC_DEV);
	if (!dev_desc || dev_desc->type == DEV_TYPE_UNKNOWN) {
		pr_err("invalid mmc device");
		fastboot_fail("invalid mmc device");
		return;
	}

	ret = part_get_info_by_name_or_alias(dev_desc, cmd, &info);
	if (ret < 0) {
		pr_err("cannot find partition: '%s'", cmd);
		fastboot_fail("cannot find partition");
		return;
	}

	/* Align blocks to erase group size to avoid erasing other partitions */
	grp_size = mmc->erase_grp_size;
	blks_start = (info.start + grp_size - 1) & ~(grp_size - 1);
	if (info.size >= grp_size)
		blks_size = (info.size - (blks_start - info.start)) &
				(~(grp_size - 1));
	else
		blks_size = 0;

	printf("Erasing blocks " LBAFU " to " LBAFU " due to alignment\n",
	       blks_start, blks_start + blks_size);

	blks = blk_derase(dev_desc, blks_start, blks_size);
	if (blks != blks_size) {
		pr_err("failed erasing from device %d", dev_desc->devnum);
		fastboot_fail("failed erasing from device");
		return;
	}

	printf("........ erased " LBAFU " bytes from '%s'\n",
	       blks_size * info.blksz, cmd);
	fastboot_okay("");
}
Commit	Line	Data
c0aebb33 SR	1	/*
	2	* Copyright 2014 Broadcom Corporation.
	3	*
	4	* SPDX-License-Identifier: GPL-2.0+
	5	*/
	6
0ff7e585	7	#include <config.h>
c0aebb33	8	#include <common.h>
2a981dc2	9	#include <blk.h>
3c8f98f5	10	#include <fastboot.h>
c0aebb33	11	#include <fb_mmc.h>
3d4ef38d	12	#include <image-sparse.h>
c0aebb33	13	#include <part.h>
89792381	14	#include <mmc.h>
5e0efc1b	15	#include <div64.h>
efeccfe7 SP	16	#include <linux/compat.h>
efeccfe7 SP	17	#include <android_image.h>
c0aebb33	18
6f6c8630 PK	19	/*
	20	* FIXME: Ensure we always set these names via Kconfig once xxx_PARTITION is
	21	* migrated
	22	*/
	23	#ifndef CONFIG_FASTBOOT_GPT_NAME
	24	#define CONFIG_FASTBOOT_GPT_NAME "gpt"
0ff7e585 SR	25	#endif
0ff7e585 SR	26
b6dd69a4	27
6f6c8630	28	#ifndef CONFIG_FASTBOOT_MBR_NAME
b6dd69a4 PK	29	#define CONFIG_FASTBOOT_MBR_NAME "mbr"
	30	#endif
	31
efeccfe7 SP	32	#define BOOT_PARTITION_NAME "boot"
efeccfe7 SP	33
a5d1e04a	34	struct fb_mmc_sparse {
4101f687	35	struct blk_desc *dev_desc;
a5d1e04a MR	36	};
a5d1e04a MR	37
b6dd69a4	38	static int part_get_info_by_name_or_alias(struct blk_desc *dev_desc,
8a41802f MS	39	const char name, disk_partition_t info)
	40	{
	41	int ret;
	42
87b8530f	43	ret = part_get_info_by_name(dev_desc, name, info);
88b6329c	44	if (ret < 0) {
8a41802f MS	45	/* strlen("fastboot_partition_alias_") + 32(part_name) + 1 */
	46	char env_alias_name[25 + 32 + 1];
	47	char *aliased_part_name;
	48
	49	/* check for alias */
	50	strcpy(env_alias_name, "fastboot_partition_alias_");
	51	strncat(env_alias_name, name, 32);
00caae6d	52	aliased_part_name = env_get(env_alias_name);
8a41802f	53	if (aliased_part_name != NULL)
87b8530f	54	ret = part_get_info_by_name(dev_desc,
8a41802f MS	55	aliased_part_name, info);
	56	}
	57	return ret;
	58	}
	59
cc0f08cd SR	60	static lbaint_t fb_mmc_sparse_write(struct sparse_storage *info,
cc0f08cd SR	61	lbaint_t blk, lbaint_t blkcnt, const void *buffer)
a5d1e04a	62	{
cc0f08cd	63	struct fb_mmc_sparse *sparse = info->priv;
4101f687	64	struct blk_desc *dev_desc = sparse->dev_desc;
a5d1e04a	65
cc0f08cd	66	return blk_dwrite(dev_desc, blk, blkcnt, buffer);
a5d1e04a MR	67	}
a5d1e04a MR	68
2c724046 SR	69	static lbaint_t fb_mmc_sparse_reserve(struct sparse_storage *info,
	70	lbaint_t blk, lbaint_t blkcnt)
	71	{
	72	return blkcnt;
	73	}
	74
4101f687	75	static void write_raw_image(struct blk_desc dev_desc, disk_partition_t info,
c0aebb33 SR	76	const char part_name, void buffer,
	77	unsigned int download_bytes)
	78	{
	79	lbaint_t blkcnt;
	80	lbaint_t blks;
	81
	82	/* determine number of blocks to write */
	83	blkcnt = ((download_bytes + (info->blksz - 1)) & ~(info->blksz - 1));
5e0efc1b	84	blkcnt = lldiv(blkcnt, info->blksz);
c0aebb33 SR	85
c0aebb33 SR	86	if (blkcnt > info->size) {
9b643e31	87	pr_err("too large for partition: '%s'\n", part_name);
9bc34799	88	fastboot_fail("too large for partition");
c0aebb33 SR	89	return;
	90	}
	91
	92	puts("Flashing Raw Image\n");
	93
2a981dc2	94	blks = blk_dwrite(dev_desc, info->start, blkcnt, buffer);
c0aebb33	95	if (blks != blkcnt) {
9b643e31	96	pr_err("failed writing to device %d\n", dev_desc->devnum);
9bc34799	97	fastboot_fail("failed writing to device");
c0aebb33 SR	98	return;
	99	}
	100
	101	printf("........ wrote " LBAFU " bytes to '%s'\n", blkcnt * info->blksz,
	102	part_name);
9bc34799	103	fastboot_okay("");
c0aebb33 SR	104	}
c0aebb33 SR	105
efeccfe7 SP	106	#ifdef CONFIG_ANDROID_BOOT_IMAGE
	107	/**
	108	* Read Android boot image header from boot partition.
	109	*
	110	* @param[in] dev_desc MMC device descriptor
	111	* @param[in] info Boot partition info
	112	* @param[out] hdr Where to store read boot image header
	113	*
	114	* @return Boot image header sectors count or 0 on error
	115	*/
	116	static lbaint_t fb_mmc_get_boot_header(struct blk_desc *dev_desc,
	117	disk_partition_t *info,
	118	struct andr_img_hdr *hdr)
	119	{
	120	ulong sector_size; /* boot partition sector size */
	121	lbaint_t hdr_sectors; /* boot image header sectors count */
	122	int res;
	123
	124	/* Calculate boot image sectors count */
	125	sector_size = info->blksz;
	126	hdr_sectors = DIV_ROUND_UP(sizeof(struct andr_img_hdr), sector_size);
	127	if (hdr_sectors == 0) {
9b643e31	128	pr_err("invalid number of boot sectors: 0");
efeccfe7 SP	129	fastboot_fail("invalid number of boot sectors: 0");
	130	return 0;
	131	}
	132
	133	/* Read the boot image header */
	134	res = blk_dread(dev_desc, info->start, hdr_sectors, (void *)hdr);
6bafa5a4	135	if (res != hdr_sectors) {
9b643e31	136	pr_err("cannot read header from boot partition");
efeccfe7 SP	137	fastboot_fail("cannot read header from boot partition");
	138	return 0;
	139	}
	140
	141	/* Check boot header magic string */
	142	res = android_image_check_header(hdr);
	143	if (res != 0) {
9b643e31	144	pr_err("bad boot image magic");
efeccfe7 SP	145	fastboot_fail("boot partition not initialized");
	146	return 0;
	147	}
	148
	149	return hdr_sectors;
	150	}
	151
	152	/**
	153	* Write downloaded zImage to boot partition and repack it properly.
	154	*
	155	* @param dev_desc MMC device descriptor
	156	* @param download_buffer Address to fastboot buffer with zImage in it
	157	* @param download_bytes Size of fastboot buffer, in bytes
	158	*
	159	* @return 0 on success or -1 on error
	160	*/
	161	static int fb_mmc_update_zimage(struct blk_desc *dev_desc,
	162	void *download_buffer,
	163	unsigned int download_bytes)
	164	{
2341c80c	165	uintptr_t hdr_addr; /* boot image header address */
efeccfe7 SP	166	struct andr_img_hdr hdr; / boot image header */
	167	lbaint_t hdr_sectors; /* boot image header sectors */
	168	u8 *ramdisk_buffer;
	169	u32 ramdisk_sector_start;
	170	u32 ramdisk_sectors;
	171	u32 kernel_sector_start;
	172	u32 kernel_sectors;
	173	u32 sectors_per_page;
	174	disk_partition_t info;
	175	int res;
	176
	177	puts("Flashing zImage\n");
	178
	179	/* Get boot partition info */
	180	res = part_get_info_by_name(dev_desc, BOOT_PARTITION_NAME, &info);
	181	if (res < 0) {
9b643e31	182	pr_err("cannot find boot partition");
efeccfe7 SP	183	fastboot_fail("cannot find boot partition");
	184	return -1;
	185	}
	186
	187	/* Put boot image header in fastboot buffer after downloaded zImage */
2341c80c	188	hdr_addr = (uintptr_t)download_buffer + ALIGN(download_bytes, PAGE_SIZE);
efeccfe7 SP	189	hdr = (struct andr_img_hdr *)hdr_addr;
	190
	191	/* Read boot image header */
	192	hdr_sectors = fb_mmc_get_boot_header(dev_desc, &info, hdr);
	193	if (hdr_sectors == 0) {
9b643e31	194	pr_err("unable to read boot image header");
efeccfe7 SP	195	fastboot_fail("unable to read boot image header");
	196	return -1;
	197	}
	198
	199	/* Check if boot image has second stage in it (we don't support it) */
	200	if (hdr->second_size > 0) {
9b643e31	201	pr_err("moving second stage is not supported yet");
efeccfe7 SP	202	fastboot_fail("moving second stage is not supported yet");
	203	return -1;
	204	}
	205
	206	/* Extract ramdisk location */
	207	sectors_per_page = hdr->page_size / info.blksz;
	208	ramdisk_sector_start = info.start + sectors_per_page;
	209	ramdisk_sector_start += DIV_ROUND_UP(hdr->kernel_size, hdr->page_size) *
	210	sectors_per_page;
	211	ramdisk_sectors = DIV_ROUND_UP(hdr->ramdisk_size, hdr->page_size) *
	212	sectors_per_page;
	213
	214	/* Read ramdisk and put it in fastboot buffer after boot image header */
	215	ramdisk_buffer = (u8 )hdr + (hdr_sectors info.blksz);
	216	res = blk_dread(dev_desc, ramdisk_sector_start, ramdisk_sectors,
	217	ramdisk_buffer);
6bafa5a4	218	if (res != ramdisk_sectors) {
9b643e31	219	pr_err("cannot read ramdisk from boot partition");
efeccfe7 SP	220	fastboot_fail("cannot read ramdisk from boot partition");
	221	return -1;
	222	}
	223
	224	/* Write new kernel size to boot image header */
	225	hdr->kernel_size = download_bytes;
	226	res = blk_dwrite(dev_desc, info.start, hdr_sectors, (void *)hdr);
	227	if (res == 0) {
9b643e31	228	pr_err("cannot writeback boot image header");
efeccfe7 SP	229	fastboot_fail("cannot write back boot image header");
	230	return -1;
	231	}
	232
	233	/* Write the new downloaded kernel */
	234	kernel_sector_start = info.start + sectors_per_page;
	235	kernel_sectors = DIV_ROUND_UP(hdr->kernel_size, hdr->page_size) *
	236	sectors_per_page;
	237	res = blk_dwrite(dev_desc, kernel_sector_start, kernel_sectors,
	238	download_buffer);
	239	if (res == 0) {
9b643e31	240	pr_err("cannot write new kernel");
efeccfe7 SP	241	fastboot_fail("cannot write new kernel");
	242	return -1;
	243	}
	244
	245	/* Write the saved ramdisk back */
	246	ramdisk_sector_start = info.start + sectors_per_page;
	247	ramdisk_sector_start += DIV_ROUND_UP(hdr->kernel_size, hdr->page_size) *
	248	sectors_per_page;
	249	res = blk_dwrite(dev_desc, ramdisk_sector_start, ramdisk_sectors,
	250	ramdisk_buffer);
	251	if (res == 0) {
9b643e31	252	pr_err("cannot write back original ramdisk");
efeccfe7 SP	253	fastboot_fail("cannot write back original ramdisk");
	254	return -1;
	255	}
	256
	257	puts("........ zImage was updated in boot partition\n");
	258	fastboot_okay("");
	259	return 0;
	260	}
	261	#endif
	262
64ece848	263	void fb_mmc_flash_write(const char cmd, void download_buffer,
9bc34799	264	unsigned int download_bytes)
c0aebb33	265	{
4101f687	266	struct blk_desc *dev_desc;
c0aebb33 SR	267	disk_partition_t info;
c0aebb33 SR	268
db1d9e78	269	dev_desc = blk_get_dev("mmc", CONFIG_FASTBOOT_FLASH_MMC_DEV);
c0aebb33	270	if (!dev_desc \|\| dev_desc->type == DEV_TYPE_UNKNOWN) {
9b643e31	271	pr_err("invalid mmc device\n");
9bc34799	272	fastboot_fail("invalid mmc device");
c0aebb33 SR	273	return;
	274	}
	275
bd42a942	276	#if CONFIG_IS_ENABLED(EFI_PARTITION)
0ff7e585 SR	277	if (strcmp(cmd, CONFIG_FASTBOOT_GPT_NAME) == 0) {
	278	printf("%s: updating MBR, Primary and Backup GPT(s)\n",
	279	__func__);
	280	if (is_valid_gpt_buf(dev_desc, download_buffer)) {
	281	printf("%s: invalid GPT - refusing to write to flash\n",
	282	__func__);
9bc34799	283	fastboot_fail("invalid GPT partition");
0ff7e585 SR	284	return;
	285	}
	286	if (write_mbr_and_gpt_partitions(dev_desc, download_buffer)) {
	287	printf("%s: writing GPT partitions failed\n", __func__);
b6dd69a4	288	fastboot_fail("writing GPT partitions failed");
0ff7e585 SR	289	return;
	290	}
	291	printf("........ success\n");
9bc34799	292	fastboot_okay("");
0ff7e585	293	return;
b6dd69a4 PK	294	}
	295	#endif
	296
b0cf7339	297	#if CONFIG_IS_ENABLED(DOS_PARTITION)
b6dd69a4 PK	298	if (strcmp(cmd, CONFIG_FASTBOOT_MBR_NAME) == 0) {
	299	printf("%s: updating MBR\n", __func__);
	300	if (is_valid_dos_buf(download_buffer)) {
	301	printf("%s: invalid MBR - refusing to write to flash\n",
	302	__func__);
	303	fastboot_fail("invalid MBR partition");
	304	return;
	305	}
	306	if (write_mbr_partition(dev_desc, download_buffer)) {
	307	printf("%s: writing MBR partition failed\n", __func__);
	308	fastboot_fail("writing MBR partition failed");
	309	return;
	310	}
	311	printf("........ success\n");
	312	fastboot_okay("");
	313	return;
	314	}
	315	#endif
	316
efeccfe7 SP	317	#ifdef CONFIG_ANDROID_BOOT_IMAGE
	318	if (strncasecmp(cmd, "zimage", 6) == 0) {
	319	fb_mmc_update_zimage(dev_desc, download_buffer, download_bytes);
	320	return;
	321	}
	322	#endif
	323
88b6329c	324	if (part_get_info_by_name_or_alias(dev_desc, cmd, &info) < 0) {
9b643e31	325	pr_err("cannot find partition: '%s'\n", cmd);
9bc34799	326	fastboot_fail("cannot find partition");
c0aebb33 SR	327	return;
	328	}
	329
a5d1e04a MR	330	if (is_sparse_image(download_buffer)) {
a5d1e04a MR	331	struct fb_mmc_sparse sparse_priv;
cc0f08cd	332	struct sparse_storage sparse;
a5d1e04a MR	333
	334	sparse_priv.dev_desc = dev_desc;
	335
cc0f08cd	336	sparse.blksz = info.blksz;
a5d1e04a MR	337	sparse.start = info.start;
a5d1e04a MR	338	sparse.size = info.size;
a5d1e04a	339	sparse.write = fb_mmc_sparse_write;
2c724046	340	sparse.reserve = fb_mmc_sparse_reserve;
a5d1e04a MR	341
a5d1e04a MR	342	printf("Flashing sparse image at offset " LBAFU "\n",
cc0f08cd	343	sparse.start);
a5d1e04a	344
cc0f08cd SR	345	sparse.priv = &sparse_priv;
cc0f08cd SR	346	write_sparse_image(&sparse, cmd, download_buffer,
9bc34799	347	download_bytes);
a5d1e04a	348	} else {
e5bf9878 SR	349	write_raw_image(dev_desc, &info, cmd, download_buffer,
e5bf9878 SR	350	download_bytes);
a5d1e04a	351	}
c0aebb33	352	}
89792381	353
9bc34799	354	void fb_mmc_erase(const char *cmd)
89792381 DK	355	{
89792381 DK	356	int ret;
4101f687	357	struct blk_desc *dev_desc;
89792381 DK	358	disk_partition_t info;
	359	lbaint_t blks, blks_start, blks_size, grp_size;
	360	struct mmc *mmc = find_mmc_device(CONFIG_FASTBOOT_FLASH_MMC_DEV);
	361
	362	if (mmc == NULL) {
9b643e31	363	pr_err("invalid mmc device");
9bc34799	364	fastboot_fail("invalid mmc device");
89792381 DK	365	return;
	366	}
	367
db1d9e78	368	dev_desc = blk_get_dev("mmc", CONFIG_FASTBOOT_FLASH_MMC_DEV);
89792381	369	if (!dev_desc \|\| dev_desc->type == DEV_TYPE_UNKNOWN) {
9b643e31	370	pr_err("invalid mmc device");
9bc34799	371	fastboot_fail("invalid mmc device");
89792381 DK	372	return;
	373	}
	374
b6dd69a4	375	ret = part_get_info_by_name_or_alias(dev_desc, cmd, &info);
88b6329c	376	if (ret < 0) {
9b643e31	377	pr_err("cannot find partition: '%s'", cmd);
9bc34799	378	fastboot_fail("cannot find partition");
89792381 DK	379	return;
	380	}
	381
	382	/* Align blocks to erase group size to avoid erasing other partitions */
	383	grp_size = mmc->erase_grp_size;
	384	blks_start = (info.start + grp_size - 1) & ~(grp_size - 1);
	385	if (info.size >= grp_size)
	386	blks_size = (info.size - (blks_start - info.start)) &
	387	(~(grp_size - 1));
	388	else
	389	blks_size = 0;
	390
	391	printf("Erasing blocks " LBAFU " to " LBAFU " due to alignment\n",
	392	blks_start, blks_start + blks_size);
	393
ec3cde1e	394	blks = blk_derase(dev_desc, blks_start, blks_size);
89792381	395	if (blks != blks_size) {
9b643e31	396	pr_err("failed erasing from device %d", dev_desc->devnum);
9bc34799	397	fastboot_fail("failed erasing from device");
89792381 DK	398	return;
	399	}
	400
	401	printf("........ erased " LBAFU " bytes from '%s'\n",
	402	blks_size * info.blksz, cmd);
9bc34799	403	fastboot_okay("");
89792381	404	}