cmds.c 2.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * (C) Copyright 2020 Xilinx, Inc.
  4. * Michal Simek <michal.simek@xilinx.com>
  5. */
  6. #include <cpu_func.h>
  7. #include <command.h>
  8. #include <common.h>
  9. #include <log.h>
  10. #include <memalign.h>
  11. #include <versalpl.h>
  12. #include <zynqmp_firmware.h>
  13. static int do_versal_load_pdi(struct cmd_tbl *cmdtp, int flag, int argc,
  14. char * const argv[])
  15. {
  16. u32 buf_lo, buf_hi;
  17. u32 ret_payload[PAYLOAD_ARG_CNT];
  18. ulong addr, *pdi_buf;
  19. size_t len;
  20. int ret;
  21. if (argc != cmdtp->maxargs) {
  22. debug("pdi_load: incorrect parameters passed\n");
  23. return CMD_RET_USAGE;
  24. }
  25. addr = simple_strtol(argv[2], NULL, 16);
  26. if (!addr) {
  27. debug("pdi_load: zero pdi_data address\n");
  28. return CMD_RET_USAGE;
  29. }
  30. len = hextoul(argv[3], NULL);
  31. if (!len) {
  32. debug("pdi_load: zero size\n");
  33. return CMD_RET_USAGE;
  34. }
  35. pdi_buf = (ulong *)ALIGN((ulong)addr, ARCH_DMA_MINALIGN);
  36. if ((ulong)addr != (ulong)pdi_buf) {
  37. memcpy((void *)pdi_buf, (void *)addr, len);
  38. debug("Pdi addr:0x%lx aligned to 0x%lx\n",
  39. addr, (ulong)pdi_buf);
  40. }
  41. flush_dcache_range((ulong)pdi_buf, (ulong)pdi_buf + len);
  42. buf_lo = lower_32_bits((ulong)pdi_buf);
  43. buf_hi = upper_32_bits((ulong)pdi_buf);
  44. ret = xilinx_pm_request(VERSAL_PM_LOAD_PDI, VERSAL_PM_PDI_TYPE, buf_lo,
  45. buf_hi, 0, ret_payload);
  46. if (ret)
  47. printf("PDI load failed with err: 0x%08x\n", ret);
  48. return ret;
  49. }
  50. static struct cmd_tbl cmd_versal_sub[] = {
  51. U_BOOT_CMD_MKENT(loadpdi, 4, 1, do_versal_load_pdi, "", ""),
  52. };
  53. /**
  54. * do_versal - Handle the "versal" command-line command
  55. * @cmdtp: Command data struct pointer
  56. * @flag: Command flag
  57. * @argc: Command-line argument count
  58. * @argv: Array of command-line arguments
  59. *
  60. * Processes the versal specific commands
  61. *
  62. * Return: return 0 on success, Error value if command fails.
  63. * CMD_RET_USAGE incase of incorrect/missing parameters.
  64. */
  65. static int do_versal(struct cmd_tbl *cmdtp, int flag, int argc,
  66. char *const argv[])
  67. {
  68. struct cmd_tbl *c;
  69. int ret = CMD_RET_USAGE;
  70. if (argc < 2)
  71. return CMD_RET_USAGE;
  72. c = find_cmd_tbl(argv[1], &cmd_versal_sub[0],
  73. ARRAY_SIZE(cmd_versal_sub));
  74. if (c)
  75. ret = c->cmd(c, flag, argc, argv);
  76. return cmd_process_error(c, ret);
  77. }
  78. #ifdef CONFIG_SYS_LONGHELP
  79. static char versal_help_text[] =
  80. "loadpdi addr len - Load pdi image\n"
  81. "load pdi image at ddr address 'addr' with pdi image size 'len'\n"
  82. ;
  83. #endif
  84. U_BOOT_CMD(versal, 4, 1, do_versal,
  85. "versal sub-system",
  86. versal_help_text
  87. )