1 // SPDX-License-Identifier: GPL-2.0+
3 * (C) Copyright 2015 Miao Yan <yanmiaobest@gmail.com>
14 static struct udevice *qfw_dev;
17 * This function prepares kernel for zboot. It loads kernel data
18 * to 'load_addr', initrd to 'initrd_addr' and kernel command
19 * line using qemu fw_cfg interface.
21 int qemu_fwcfg_cmd_setup_kernel(ulong load_addr, ulong initrd_addr)
24 uint32_t setup_size, kernel_size, cmdline_size, initrd_size;
26 qfw_read_entry(qfw_dev, FW_CFG_SETUP_SIZE, 4, &setup_size);
27 qfw_read_entry(qfw_dev, FW_CFG_KERNEL_SIZE, 4, &kernel_size);
30 printf("fatal: no kernel available\n");
34 data_addr = map_sysmem(load_addr, 0);
36 qfw_read_entry(qfw_dev, FW_CFG_SETUP_DATA,
37 le32_to_cpu(setup_size), data_addr);
38 data_addr += le32_to_cpu(setup_size);
41 qfw_read_entry(qfw_dev, FW_CFG_KERNEL_DATA,
42 le32_to_cpu(kernel_size), data_addr);
43 data_addr += le32_to_cpu(kernel_size);
44 env_set_hex("filesize", le32_to_cpu(kernel_size));
46 data_addr = map_sysmem(initrd_addr, 0);
47 qfw_read_entry(qfw_dev, FW_CFG_INITRD_SIZE, 4, &initrd_size);
49 printf("warning: no initrd available\n");
51 qfw_read_entry(qfw_dev, FW_CFG_INITRD_DATA,
52 le32_to_cpu(initrd_size), data_addr);
53 data_addr += le32_to_cpu(initrd_size);
54 env_set_hex("filesize", le32_to_cpu(initrd_size));
57 qfw_read_entry(qfw_dev, FW_CFG_CMDLINE_SIZE, 4, &cmdline_size);
59 qfw_read_entry(qfw_dev, FW_CFG_CMDLINE_DATA,
60 le32_to_cpu(cmdline_size), data_addr);
62 * if kernel cmdline only contains '\0', (e.g. no -append
63 * when invoking qemu), do not update bootargs
66 if (env_set("bootargs", data_addr) < 0)
67 printf("warning: unable to change bootargs\n");
71 printf("loading kernel to address %lx size %x", load_addr,
72 le32_to_cpu(kernel_size));
74 printf(" initrd %lx size %x\n", initrd_addr,
75 le32_to_cpu(initrd_size));
82 static int qemu_fwcfg_cmd_list_firmware(void)
85 struct fw_cfg_file_iter iter;
88 /* make sure fw_list is loaded */
89 ret = qfw_read_firmware_list(qfw_dev);
93 for (file = qfw_file_iter_init(qfw_dev, &iter);
94 !qfw_file_iter_end(&iter);
95 file = qfw_file_iter_next(&iter)) {
96 printf("%-56s\n", file->cfg.name);
102 static int qemu_fwcfg_do_list(struct cmd_tbl *cmdtp, int flag,
103 int argc, char *const argv[])
105 if (qemu_fwcfg_cmd_list_firmware() < 0)
106 return CMD_RET_FAILURE;
111 static int qemu_fwcfg_do_cpus(struct cmd_tbl *cmdtp, int flag,
112 int argc, char *const argv[])
114 printf("%d cpu(s) online\n", qfw_online_cpus(qfw_dev));
118 static int qemu_fwcfg_do_load(struct cmd_tbl *cmdtp, int flag,
119 int argc, char *const argv[])
125 env = env_get("loadaddr");
128 CONFIG_SYS_LOAD_ADDR;
130 env = env_get("ramdiskaddr");
133 #ifdef CFG_RAMDISK_ADDR
140 load_addr = hextoul(argv[0], NULL);
141 initrd_addr = hextoul(argv[1], NULL);
142 } else if (argc == 1) {
143 load_addr = hextoul(argv[0], NULL);
146 if (!load_addr || !initrd_addr) {
147 printf("missing load or initrd address\n");
148 return CMD_RET_FAILURE;
151 return qemu_fwcfg_cmd_setup_kernel(load_addr, initrd_addr);
154 static struct cmd_tbl fwcfg_commands[] = {
155 U_BOOT_CMD_MKENT(list, 0, 1, qemu_fwcfg_do_list, "", ""),
156 U_BOOT_CMD_MKENT(cpus, 0, 1, qemu_fwcfg_do_cpus, "", ""),
157 U_BOOT_CMD_MKENT(load, 2, 1, qemu_fwcfg_do_load, "", ""),
160 static int do_qemu_fw(struct cmd_tbl *cmdtp, int flag, int argc,
164 struct cmd_tbl *fwcfg_cmd;
166 ret = qfw_get_dev(&qfw_dev);
168 printf("QEMU fw_cfg interface not found\n");
169 return CMD_RET_USAGE;
172 fwcfg_cmd = find_cmd_tbl(argv[1], fwcfg_commands,
173 ARRAY_SIZE(fwcfg_commands));
176 if (!fwcfg_cmd || argc > fwcfg_cmd->maxargs)
177 return CMD_RET_USAGE;
179 ret = fwcfg_cmd->cmd(fwcfg_cmd, flag, argc, argv);
181 return cmd_process_error(fwcfg_cmd, ret);
185 qfw, 4, 1, do_qemu_fw,
186 "QEMU firmware interface",
188 " - list : print firmware(s) currently loaded\n"
189 " - cpus : print online cpu number\n"
190 " - load <kernel addr> <initrd addr> : load kernel and initrd (if any), and setup for zboot\n"