blob: 2726115e8558f09e1b842eb4c9410ac5d194e9ad [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Rob Herring7405a132012-09-21 04:02:30 +00002/*
3 * (C) Copyright 2000-2011
4 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
Rob Herring7405a132012-09-21 04:02:30 +00005 */
6#include <common.h>
Simon Glass52f24232020-05-10 11:40:00 -06007#include <bootstage.h>
Rob Herring7405a132012-09-21 04:02:30 +00008#include <command.h>
Simon Glass1eb69ae2019-11-14 12:57:39 -07009#include <cpu_func.h>
Simon Glass8e8ccfe2019-12-28 10:45:03 -070010#include <image.h>
Simon Glassf7ae49f2020-05-10 11:40:05 -060011#include <log.h>
Rob Herring475c7972012-08-23 11:31:48 +000012#include <part.h>
Rob Herring7405a132012-09-21 04:02:30 +000013
Simon Glass09140112020-05-10 11:40:03 -060014int common_diskboot(struct cmd_tbl *cmdtp, const char *intf, int argc,
Rob Herring7405a132012-09-21 04:02:30 +000015 char *const argv[])
16{
Marek Vasut04681cb2016-05-01 00:35:54 +020017 __maybe_unused int dev;
18 int part;
Rob Herring475c7972012-08-23 11:31:48 +000019 ulong addr = CONFIG_SYS_LOAD_ADDR;
20 ulong cnt;
Simon Glass05289792020-05-10 11:39:57 -060021 struct disk_partition info;
Tom Rinic76c93a2019-05-23 07:14:07 -040022#if defined(CONFIG_LEGACY_IMAGE_FORMAT)
Rob Herring7405a132012-09-21 04:02:30 +000023 image_header_t *hdr;
Heiko Schocher21d29f72014-05-28 11:33:33 +020024#endif
Simon Glass4101f682016-02-29 15:25:34 -070025 struct blk_desc *dev_desc;
Rob Herring7405a132012-09-21 04:02:30 +000026
Simon Glass73223f02016-02-22 22:55:43 -070027#if CONFIG_IS_ENABLED(FIT)
Rob Herring7405a132012-09-21 04:02:30 +000028 const void *fit_hdr = NULL;
29#endif
30
31 bootstage_mark(BOOTSTAGE_ID_IDE_START);
Rob Herring475c7972012-08-23 11:31:48 +000032 if (argc > 3) {
Rob Herring7405a132012-09-21 04:02:30 +000033 bootstage_error(BOOTSTAGE_ID_IDE_ADDR);
34 return CMD_RET_USAGE;
35 }
36 bootstage_mark(BOOTSTAGE_ID_IDE_ADDR);
37
Rob Herring475c7972012-08-23 11:31:48 +000038 if (argc > 1)
39 addr = simple_strtoul(argv[1], NULL, 16);
40
Rob Herring7405a132012-09-21 04:02:30 +000041 bootstage_mark(BOOTSTAGE_ID_IDE_BOOT_DEVICE);
42
Simon Glasse35929e2016-02-29 15:25:44 -070043 part = blk_get_device_part_str(intf, (argc == 3) ? argv[2] : NULL,
Stephen Warren10a37fd2012-09-21 09:50:57 +000044 &dev_desc, &info, 1);
Rob Herring475c7972012-08-23 11:31:48 +000045 if (part < 0) {
Rob Herring7405a132012-09-21 04:02:30 +000046 bootstage_error(BOOTSTAGE_ID_IDE_TYPE);
47 return 1;
48 }
Rob Herring475c7972012-08-23 11:31:48 +000049
Simon Glassbcce53d2016-02-29 15:25:51 -070050 dev = dev_desc->devnum;
Rob Herring7405a132012-09-21 04:02:30 +000051 bootstage_mark(BOOTSTAGE_ID_IDE_TYPE);
52
Rob Herring475c7972012-08-23 11:31:48 +000053 printf("\nLoading from %s device %d, partition %d: "
54 "Name: %.32s Type: %.32s\n", intf, dev, part, info.name,
55 info.type);
Rob Herring7405a132012-09-21 04:02:30 +000056
Frederic Leroy04735e92013-06-26 18:11:25 +020057 debug("First Block: " LBAFU ", # of blocks: " LBAFU
58 ", Block Size: %ld\n",
Rob Herring7405a132012-09-21 04:02:30 +000059 info.start, info.size, info.blksz);
60
Simon Glass2a981dc2016-02-29 15:25:52 -070061 if (blk_dread(dev_desc, info.start, 1, (ulong *)addr) != 1) {
Rob Herring7405a132012-09-21 04:02:30 +000062 printf("** Read error on %d:%d\n", dev, part);
63 bootstage_error(BOOTSTAGE_ID_IDE_PART_READ);
64 return 1;
65 }
66 bootstage_mark(BOOTSTAGE_ID_IDE_PART_READ);
67
68 switch (genimg_get_format((void *) addr)) {
Tom Rinic76c93a2019-05-23 07:14:07 -040069#if defined(CONFIG_LEGACY_IMAGE_FORMAT)
Rob Herring7405a132012-09-21 04:02:30 +000070 case IMAGE_FORMAT_LEGACY:
71 hdr = (image_header_t *) addr;
72
73 bootstage_mark(BOOTSTAGE_ID_IDE_FORMAT);
74
75 if (!image_check_hcrc(hdr)) {
76 puts("\n** Bad Header Checksum **\n");
77 bootstage_error(BOOTSTAGE_ID_IDE_CHECKSUM);
78 return 1;
79 }
80 bootstage_mark(BOOTSTAGE_ID_IDE_CHECKSUM);
81
82 image_print_contents(hdr);
83
84 cnt = image_get_image_size(hdr);
85 break;
Heiko Schocher21d29f72014-05-28 11:33:33 +020086#endif
Simon Glass73223f02016-02-22 22:55:43 -070087#if CONFIG_IS_ENABLED(FIT)
Rob Herring7405a132012-09-21 04:02:30 +000088 case IMAGE_FORMAT_FIT:
89 fit_hdr = (const void *) addr;
90 puts("Fit image detected...\n");
91
92 cnt = fit_get_size(fit_hdr);
93 break;
94#endif
95 default:
96 bootstage_error(BOOTSTAGE_ID_IDE_FORMAT);
97 puts("** Unknown image type\n");
98 return 1;
99 }
100
101 cnt += info.blksz - 1;
102 cnt /= info.blksz;
103 cnt -= 1;
104
Simon Glass2a981dc2016-02-29 15:25:52 -0700105 if (blk_dread(dev_desc, info.start + 1, cnt,
106 (ulong *)(addr + info.blksz)) != cnt) {
Rob Herring7405a132012-09-21 04:02:30 +0000107 printf("** Read error on %d:%d\n", dev, part);
108 bootstage_error(BOOTSTAGE_ID_IDE_READ);
109 return 1;
110 }
111 bootstage_mark(BOOTSTAGE_ID_IDE_READ);
112
Simon Glass73223f02016-02-22 22:55:43 -0700113#if CONFIG_IS_ENABLED(FIT)
Rob Herring7405a132012-09-21 04:02:30 +0000114 /* This cannot be done earlier,
115 * we need complete FIT image in RAM first */
116 if (genimg_get_format((void *) addr) == IMAGE_FORMAT_FIT) {
Simon Glassc5819702021-02-15 17:08:09 -0700117 if (fit_check_format(fit_hdr, IMAGE_SIZE_INVAL)) {
Rob Herring7405a132012-09-21 04:02:30 +0000118 bootstage_error(BOOTSTAGE_ID_IDE_FIT_READ);
119 puts("** Bad FIT image format\n");
120 return 1;
121 }
122 bootstage_mark(BOOTSTAGE_ID_IDE_FIT_READ_OK);
Rob Herring7405a132012-09-21 04:02:30 +0000123 }
124#endif
125
126 flush_cache(addr, (cnt+1)*info.blksz);
127
128 /* Loading ok, update default load address */
Simon Glassbb872dd2019-12-28 10:45:02 -0700129 image_load_addr = addr;
Rob Herring7405a132012-09-21 04:02:30 +0000130
131 return bootm_maybe_autostart(cmdtp, argv[0]);
132}