qfw.c 2.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * (C) Copyright 2015 Miao Yan <yanmiaobest@gmail.com>
  4. */
  5. #include <common.h>
  6. #include <command.h>
  7. #include <env.h>
  8. #include <errno.h>
  9. #include <qfw.h>
  10. #include <dm.h>
  11. static struct udevice *qfw_dev;
  12. static int qemu_fwcfg_cmd_list_firmware(void)
  13. {
  14. int ret;
  15. struct fw_cfg_file_iter iter;
  16. struct fw_file *file;
  17. /* make sure fw_list is loaded */
  18. ret = qfw_read_firmware_list(qfw_dev);
  19. if (ret)
  20. return ret;
  21. for (file = qfw_file_iter_init(qfw_dev, &iter);
  22. !qfw_file_iter_end(&iter);
  23. file = qfw_file_iter_next(&iter)) {
  24. printf("%08lx %-56s\n", file->addr, file->cfg.name);
  25. }
  26. return 0;
  27. }
  28. static int qemu_fwcfg_do_list(struct cmd_tbl *cmdtp, int flag,
  29. int argc, char *const argv[])
  30. {
  31. if (qemu_fwcfg_cmd_list_firmware() < 0)
  32. return CMD_RET_FAILURE;
  33. return 0;
  34. }
  35. static int qemu_fwcfg_do_cpus(struct cmd_tbl *cmdtp, int flag,
  36. int argc, char *const argv[])
  37. {
  38. printf("%d cpu(s) online\n", qfw_online_cpus(qfw_dev));
  39. return 0;
  40. }
  41. static int qemu_fwcfg_do_load(struct cmd_tbl *cmdtp, int flag,
  42. int argc, char *const argv[])
  43. {
  44. char *env;
  45. ulong load_addr;
  46. ulong initrd_addr;
  47. env = env_get("loadaddr");
  48. load_addr = env ?
  49. hextoul(env, NULL) :
  50. CONFIG_SYS_LOAD_ADDR;
  51. env = env_get("ramdiskaddr");
  52. initrd_addr = env ?
  53. hextoul(env, NULL) :
  54. #ifdef CFG_RAMDISK_ADDR
  55. CFG_RAMDISK_ADDR;
  56. #else
  57. 0;
  58. #endif
  59. if (argc == 2) {
  60. load_addr = hextoul(argv[0], NULL);
  61. initrd_addr = hextoul(argv[1], NULL);
  62. } else if (argc == 1) {
  63. load_addr = hextoul(argv[0], NULL);
  64. }
  65. if (!load_addr || !initrd_addr) {
  66. printf("missing load or initrd address\n");
  67. return CMD_RET_FAILURE;
  68. }
  69. return qemu_fwcfg_setup_kernel(qfw_dev, load_addr, initrd_addr);
  70. }
  71. static struct cmd_tbl fwcfg_commands[] = {
  72. U_BOOT_CMD_MKENT(list, 0, 1, qemu_fwcfg_do_list, "", ""),
  73. U_BOOT_CMD_MKENT(cpus, 0, 1, qemu_fwcfg_do_cpus, "", ""),
  74. U_BOOT_CMD_MKENT(load, 2, 1, qemu_fwcfg_do_load, "", ""),
  75. };
  76. static int do_qemu_fw(struct cmd_tbl *cmdtp, int flag, int argc,
  77. char *const argv[])
  78. {
  79. int ret;
  80. struct cmd_tbl *fwcfg_cmd;
  81. ret = qfw_get_dev(&qfw_dev);
  82. if (ret) {
  83. printf("QEMU fw_cfg interface not found\n");
  84. return CMD_RET_USAGE;
  85. }
  86. fwcfg_cmd = find_cmd_tbl(argv[1], fwcfg_commands,
  87. ARRAY_SIZE(fwcfg_commands));
  88. argc -= 2;
  89. argv += 2;
  90. if (!fwcfg_cmd || argc > fwcfg_cmd->maxargs)
  91. return CMD_RET_USAGE;
  92. ret = fwcfg_cmd->cmd(fwcfg_cmd, flag, argc, argv);
  93. return cmd_process_error(fwcfg_cmd, ret);
  94. }
  95. U_BOOT_CMD(
  96. qfw, 4, 1, do_qemu_fw,
  97. "QEMU firmware interface",
  98. "<command>\n"
  99. " - list : print firmware(s) currently loaded\n"
  100. " - cpus : print online cpu number\n"
  101. " - load <kernel addr> <initrd addr> : load kernel and initrd (if any), and setup for zboot\n"
  102. )