2a981dc2c6
To ease conversion to driver model, add helper functions which deal with calling each block device method. With driver model we can reimplement these functions with the same arguments. Use inline functions to avoid increasing code size on some boards. Signed-off-by: Simon Glass <sjg@chromium.org> Reviewed-by: Bin Meng <bmeng.cn@gmail.com> Tested-by: Stephen Warren <swarren@nvidia.com>
133 lines
3.1 KiB
C
133 lines
3.1 KiB
C
/*
|
|
* (C) Copyright 2000-2011
|
|
* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*/
|
|
#include <common.h>
|
|
#include <command.h>
|
|
#include <part.h>
|
|
|
|
#if defined(CONFIG_CMD_IDE) || defined(CONFIG_CMD_SCSI) || \
|
|
defined(CONFIG_USB_STORAGE)
|
|
int common_diskboot(cmd_tbl_t *cmdtp, const char *intf, int argc,
|
|
char *const argv[])
|
|
{
|
|
int dev, part;
|
|
ulong addr = CONFIG_SYS_LOAD_ADDR;
|
|
ulong cnt;
|
|
disk_partition_t info;
|
|
#if defined(CONFIG_IMAGE_FORMAT_LEGACY)
|
|
image_header_t *hdr;
|
|
#endif
|
|
struct blk_desc *dev_desc;
|
|
|
|
#if defined(CONFIG_FIT)
|
|
const void *fit_hdr = NULL;
|
|
#endif
|
|
|
|
bootstage_mark(BOOTSTAGE_ID_IDE_START);
|
|
if (argc > 3) {
|
|
bootstage_error(BOOTSTAGE_ID_IDE_ADDR);
|
|
return CMD_RET_USAGE;
|
|
}
|
|
bootstage_mark(BOOTSTAGE_ID_IDE_ADDR);
|
|
|
|
if (argc > 1)
|
|
addr = simple_strtoul(argv[1], NULL, 16);
|
|
|
|
bootstage_mark(BOOTSTAGE_ID_IDE_BOOT_DEVICE);
|
|
|
|
part = blk_get_device_part_str(intf, (argc == 3) ? argv[2] : NULL,
|
|
&dev_desc, &info, 1);
|
|
if (part < 0) {
|
|
bootstage_error(BOOTSTAGE_ID_IDE_TYPE);
|
|
return 1;
|
|
}
|
|
|
|
dev = dev_desc->devnum;
|
|
bootstage_mark(BOOTSTAGE_ID_IDE_TYPE);
|
|
|
|
printf("\nLoading from %s device %d, partition %d: "
|
|
"Name: %.32s Type: %.32s\n", intf, dev, part, info.name,
|
|
info.type);
|
|
|
|
debug("First Block: " LBAFU ", # of blocks: " LBAFU
|
|
", Block Size: %ld\n",
|
|
info.start, info.size, info.blksz);
|
|
|
|
if (blk_dread(dev_desc, info.start, 1, (ulong *)addr) != 1) {
|
|
printf("** Read error on %d:%d\n", dev, part);
|
|
bootstage_error(BOOTSTAGE_ID_IDE_PART_READ);
|
|
return 1;
|
|
}
|
|
bootstage_mark(BOOTSTAGE_ID_IDE_PART_READ);
|
|
|
|
switch (genimg_get_format((void *) addr)) {
|
|
#if defined(CONFIG_IMAGE_FORMAT_LEGACY)
|
|
case IMAGE_FORMAT_LEGACY:
|
|
hdr = (image_header_t *) addr;
|
|
|
|
bootstage_mark(BOOTSTAGE_ID_IDE_FORMAT);
|
|
|
|
if (!image_check_hcrc(hdr)) {
|
|
puts("\n** Bad Header Checksum **\n");
|
|
bootstage_error(BOOTSTAGE_ID_IDE_CHECKSUM);
|
|
return 1;
|
|
}
|
|
bootstage_mark(BOOTSTAGE_ID_IDE_CHECKSUM);
|
|
|
|
image_print_contents(hdr);
|
|
|
|
cnt = image_get_image_size(hdr);
|
|
break;
|
|
#endif
|
|
#if defined(CONFIG_FIT)
|
|
case IMAGE_FORMAT_FIT:
|
|
fit_hdr = (const void *) addr;
|
|
puts("Fit image detected...\n");
|
|
|
|
cnt = fit_get_size(fit_hdr);
|
|
break;
|
|
#endif
|
|
default:
|
|
bootstage_error(BOOTSTAGE_ID_IDE_FORMAT);
|
|
puts("** Unknown image type\n");
|
|
return 1;
|
|
}
|
|
|
|
cnt += info.blksz - 1;
|
|
cnt /= info.blksz;
|
|
cnt -= 1;
|
|
|
|
if (blk_dread(dev_desc, info.start + 1, cnt,
|
|
(ulong *)(addr + info.blksz)) != cnt) {
|
|
printf("** Read error on %d:%d\n", dev, part);
|
|
bootstage_error(BOOTSTAGE_ID_IDE_READ);
|
|
return 1;
|
|
}
|
|
bootstage_mark(BOOTSTAGE_ID_IDE_READ);
|
|
|
|
#if defined(CONFIG_FIT)
|
|
/* This cannot be done earlier,
|
|
* we need complete FIT image in RAM first */
|
|
if (genimg_get_format((void *) addr) == IMAGE_FORMAT_FIT) {
|
|
if (!fit_check_format(fit_hdr)) {
|
|
bootstage_error(BOOTSTAGE_ID_IDE_FIT_READ);
|
|
puts("** Bad FIT image format\n");
|
|
return 1;
|
|
}
|
|
bootstage_mark(BOOTSTAGE_ID_IDE_FIT_READ_OK);
|
|
fit_print_contents(fit_hdr);
|
|
}
|
|
#endif
|
|
|
|
flush_cache(addr, (cnt+1)*info.blksz);
|
|
|
|
/* Loading ok, update default load address */
|
|
load_addr = addr;
|
|
|
|
return bootm_maybe_autostart(cmdtp, argv[0]);
|
|
}
|
|
#endif
|