1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
22e192b24SSimon Glass /*
32e192b24SSimon Glass * (C) Copyright 2000-2011
42e192b24SSimon Glass * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
52e192b24SSimon Glass */
62e192b24SSimon Glass #include <common.h>
72e192b24SSimon Glass #include <command.h>
82e192b24SSimon Glass #include <part.h>
92e192b24SSimon Glass
common_diskboot(cmd_tbl_t * cmdtp,const char * intf,int argc,char * const argv[])102e192b24SSimon Glass int common_diskboot(cmd_tbl_t *cmdtp, const char *intf, int argc,
112e192b24SSimon Glass char *const argv[])
122e192b24SSimon Glass {
1304681cb3SMarek Vasut __maybe_unused int dev;
1404681cb3SMarek Vasut int part;
152e192b24SSimon Glass ulong addr = CONFIG_SYS_LOAD_ADDR;
162e192b24SSimon Glass ulong cnt;
172e192b24SSimon Glass disk_partition_t info;
182e192b24SSimon Glass #if defined(CONFIG_IMAGE_FORMAT_LEGACY)
192e192b24SSimon Glass image_header_t *hdr;
202e192b24SSimon Glass #endif
214101f687SSimon Glass struct blk_desc *dev_desc;
222e192b24SSimon Glass
2373223f0eSSimon Glass #if CONFIG_IS_ENABLED(FIT)
242e192b24SSimon Glass const void *fit_hdr = NULL;
252e192b24SSimon Glass #endif
262e192b24SSimon Glass
272e192b24SSimon Glass bootstage_mark(BOOTSTAGE_ID_IDE_START);
282e192b24SSimon Glass if (argc > 3) {
292e192b24SSimon Glass bootstage_error(BOOTSTAGE_ID_IDE_ADDR);
302e192b24SSimon Glass return CMD_RET_USAGE;
312e192b24SSimon Glass }
322e192b24SSimon Glass bootstage_mark(BOOTSTAGE_ID_IDE_ADDR);
332e192b24SSimon Glass
342e192b24SSimon Glass if (argc > 1)
352e192b24SSimon Glass addr = simple_strtoul(argv[1], NULL, 16);
362e192b24SSimon Glass
372e192b24SSimon Glass bootstage_mark(BOOTSTAGE_ID_IDE_BOOT_DEVICE);
382e192b24SSimon Glass
39e35929e4SSimon Glass part = blk_get_device_part_str(intf, (argc == 3) ? argv[2] : NULL,
402e192b24SSimon Glass &dev_desc, &info, 1);
412e192b24SSimon Glass if (part < 0) {
422e192b24SSimon Glass bootstage_error(BOOTSTAGE_ID_IDE_TYPE);
432e192b24SSimon Glass return 1;
442e192b24SSimon Glass }
452e192b24SSimon Glass
46bcce53d0SSimon Glass dev = dev_desc->devnum;
472e192b24SSimon Glass bootstage_mark(BOOTSTAGE_ID_IDE_TYPE);
482e192b24SSimon Glass
492e192b24SSimon Glass printf("\nLoading from %s device %d, partition %d: "
502e192b24SSimon Glass "Name: %.32s Type: %.32s\n", intf, dev, part, info.name,
512e192b24SSimon Glass info.type);
522e192b24SSimon Glass
532e192b24SSimon Glass debug("First Block: " LBAFU ", # of blocks: " LBAFU
542e192b24SSimon Glass ", Block Size: %ld\n",
552e192b24SSimon Glass info.start, info.size, info.blksz);
562e192b24SSimon Glass
572a981dc2SSimon Glass if (blk_dread(dev_desc, info.start, 1, (ulong *)addr) != 1) {
582e192b24SSimon Glass printf("** Read error on %d:%d\n", dev, part);
592e192b24SSimon Glass bootstage_error(BOOTSTAGE_ID_IDE_PART_READ);
602e192b24SSimon Glass return 1;
612e192b24SSimon Glass }
622e192b24SSimon Glass bootstage_mark(BOOTSTAGE_ID_IDE_PART_READ);
632e192b24SSimon Glass
642e192b24SSimon Glass switch (genimg_get_format((void *) addr)) {
652e192b24SSimon Glass #if defined(CONFIG_IMAGE_FORMAT_LEGACY)
662e192b24SSimon Glass case IMAGE_FORMAT_LEGACY:
672e192b24SSimon Glass hdr = (image_header_t *) addr;
682e192b24SSimon Glass
692e192b24SSimon Glass bootstage_mark(BOOTSTAGE_ID_IDE_FORMAT);
702e192b24SSimon Glass
712e192b24SSimon Glass if (!image_check_hcrc(hdr)) {
722e192b24SSimon Glass puts("\n** Bad Header Checksum **\n");
732e192b24SSimon Glass bootstage_error(BOOTSTAGE_ID_IDE_CHECKSUM);
742e192b24SSimon Glass return 1;
752e192b24SSimon Glass }
762e192b24SSimon Glass bootstage_mark(BOOTSTAGE_ID_IDE_CHECKSUM);
772e192b24SSimon Glass
782e192b24SSimon Glass image_print_contents(hdr);
792e192b24SSimon Glass
802e192b24SSimon Glass cnt = image_get_image_size(hdr);
812e192b24SSimon Glass break;
822e192b24SSimon Glass #endif
8373223f0eSSimon Glass #if CONFIG_IS_ENABLED(FIT)
842e192b24SSimon Glass case IMAGE_FORMAT_FIT:
852e192b24SSimon Glass fit_hdr = (const void *) addr;
862e192b24SSimon Glass puts("Fit image detected...\n");
872e192b24SSimon Glass
882e192b24SSimon Glass cnt = fit_get_size(fit_hdr);
892e192b24SSimon Glass break;
902e192b24SSimon Glass #endif
912e192b24SSimon Glass default:
922e192b24SSimon Glass bootstage_error(BOOTSTAGE_ID_IDE_FORMAT);
932e192b24SSimon Glass puts("** Unknown image type\n");
942e192b24SSimon Glass return 1;
952e192b24SSimon Glass }
962e192b24SSimon Glass
972e192b24SSimon Glass cnt += info.blksz - 1;
982e192b24SSimon Glass cnt /= info.blksz;
992e192b24SSimon Glass cnt -= 1;
1002e192b24SSimon Glass
1012a981dc2SSimon Glass if (blk_dread(dev_desc, info.start + 1, cnt,
1022e192b24SSimon Glass (ulong *)(addr + info.blksz)) != cnt) {
1032e192b24SSimon Glass printf("** Read error on %d:%d\n", dev, part);
1042e192b24SSimon Glass bootstage_error(BOOTSTAGE_ID_IDE_READ);
1052e192b24SSimon Glass return 1;
1062e192b24SSimon Glass }
1072e192b24SSimon Glass bootstage_mark(BOOTSTAGE_ID_IDE_READ);
1082e192b24SSimon Glass
10973223f0eSSimon Glass #if CONFIG_IS_ENABLED(FIT)
1102e192b24SSimon Glass /* This cannot be done earlier,
1112e192b24SSimon Glass * we need complete FIT image in RAM first */
1122e192b24SSimon Glass if (genimg_get_format((void *) addr) == IMAGE_FORMAT_FIT) {
1132e192b24SSimon Glass if (!fit_check_format(fit_hdr)) {
1142e192b24SSimon Glass bootstage_error(BOOTSTAGE_ID_IDE_FIT_READ);
1152e192b24SSimon Glass puts("** Bad FIT image format\n");
1162e192b24SSimon Glass return 1;
1172e192b24SSimon Glass }
1182e192b24SSimon Glass bootstage_mark(BOOTSTAGE_ID_IDE_FIT_READ_OK);
1192e192b24SSimon Glass fit_print_contents(fit_hdr);
1202e192b24SSimon Glass }
1212e192b24SSimon Glass #endif
1222e192b24SSimon Glass
1232e192b24SSimon Glass flush_cache(addr, (cnt+1)*info.blksz);
1242e192b24SSimon Glass
1252e192b24SSimon Glass /* Loading ok, update default load address */
1262e192b24SSimon Glass load_addr = addr;
1272e192b24SSimon Glass
1282e192b24SSimon Glass return bootm_maybe_autostart(cmdtp, argv[0]);
1292e192b24SSimon Glass }
130