2014-08-27 02:47:27 +08:00
|
|
|
/*
|
|
|
|
* Copyright 2014 Broadcom Corporation.
|
|
|
|
*
|
|
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <common.h>
|
|
|
|
#include <fb_mmc.h>
|
|
|
|
#include <part.h>
|
2014-08-27 02:47:30 +08:00
|
|
|
#include <aboot.h>
|
|
|
|
#include <sparse_format.h>
|
2014-08-27 02:47:27 +08:00
|
|
|
|
|
|
|
/* The 64 defined bytes plus the '\0' */
|
|
|
|
#define RESPONSE_LEN (64 + 1)
|
|
|
|
|
|
|
|
static char *response_str;
|
|
|
|
|
2014-08-27 02:47:30 +08:00
|
|
|
void fastboot_fail(const char *s)
|
2014-08-27 02:47:27 +08:00
|
|
|
{
|
2014-08-27 02:47:30 +08:00
|
|
|
strncpy(response_str, "FAIL", 4);
|
|
|
|
strncat(response_str, s, RESPONSE_LEN - 4 - 1);
|
|
|
|
}
|
|
|
|
|
|
|
|
void fastboot_okay(const char *s)
|
|
|
|
{
|
|
|
|
strncpy(response_str, "OKAY", 4);
|
|
|
|
strncat(response_str, s, RESPONSE_LEN - 4 - 1);
|
2014-08-27 02:47:27 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
static void write_raw_image(block_dev_desc_t *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 = blkcnt / info->blksz;
|
|
|
|
|
|
|
|
if (blkcnt > info->size) {
|
|
|
|
error("too large for partition: '%s'\n", part_name);
|
2014-08-27 02:47:30 +08:00
|
|
|
fastboot_fail("too large for partition");
|
2014-08-27 02:47:27 +08:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
puts("Flashing Raw Image\n");
|
|
|
|
|
|
|
|
blks = dev_desc->block_write(dev_desc->dev, info->start, blkcnt,
|
|
|
|
buffer);
|
|
|
|
if (blks != blkcnt) {
|
|
|
|
error("failed writing to device %d\n", dev_desc->dev);
|
2014-08-27 02:47:30 +08:00
|
|
|
fastboot_fail("failed writing to device");
|
2014-08-27 02:47:27 +08:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
printf("........ wrote " LBAFU " bytes to '%s'\n", blkcnt * info->blksz,
|
|
|
|
part_name);
|
2014-08-27 02:47:30 +08:00
|
|
|
fastboot_okay("");
|
2014-08-27 02:47:27 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
void fb_mmc_flash_write(const char *cmd, void *download_buffer,
|
|
|
|
unsigned int download_bytes, char *response)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
block_dev_desc_t *dev_desc;
|
|
|
|
disk_partition_t info;
|
|
|
|
|
|
|
|
/* initialize the response buffer */
|
|
|
|
response_str = response;
|
|
|
|
|
|
|
|
dev_desc = get_dev("mmc", CONFIG_FASTBOOT_FLASH_MMC_DEV);
|
|
|
|
if (!dev_desc || dev_desc->type == DEV_TYPE_UNKNOWN) {
|
|
|
|
error("invalid mmc device\n");
|
2014-08-27 02:47:30 +08:00
|
|
|
fastboot_fail("invalid mmc device");
|
2014-08-27 02:47:27 +08:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = get_partition_info_efi_by_name(dev_desc, cmd, &info);
|
|
|
|
if (ret) {
|
|
|
|
error("cannot find partition: '%s'\n", cmd);
|
2014-08-27 02:47:30 +08:00
|
|
|
fastboot_fail("cannot find partition");
|
2014-08-27 02:47:27 +08:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2014-08-27 02:47:30 +08:00
|
|
|
if (is_sparse_image(download_buffer))
|
|
|
|
write_sparse_image(dev_desc, &info, cmd, download_buffer,
|
|
|
|
download_bytes);
|
|
|
|
else
|
|
|
|
write_raw_image(dev_desc, &info, cmd, download_buffer,
|
|
|
|
download_bytes);
|
2014-08-27 02:47:27 +08:00
|
|
|
}
|