boot_params.c 1.2 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950
  1. // SPDX-License-Identifier: GPL-2.0+ OR BSD-3-Clause
  2. /*
  3. * Copyright (C) 2019, STMicroelectronics - All Rights Reserved
  4. */
  5. #define LOG_CATEGORY LOGC_ARCH
  6. #include <common.h>
  7. #include <log.h>
  8. #include <linux/libfdt.h>
  9. #include <asm/sections.h>
  10. #include <asm/system.h>
  11. /*
  12. * Force data-section, as .bss will not be valid
  13. * when save_boot_params is invoked.
  14. */
  15. static unsigned long nt_fw_dtb __section(".data");
  16. /*
  17. * Save the FDT address provided by TF-A in r2 at boot time
  18. * This function is called from start.S
  19. */
  20. void save_boot_params(unsigned long r0, unsigned long r1, unsigned long r2,
  21. unsigned long r3)
  22. {
  23. nt_fw_dtb = r2;
  24. save_boot_params_ret();
  25. }
  26. /*
  27. * Use the saved FDT address provided by TF-A at boot time (NT_FW_CONFIG =
  28. * Non Trusted Firmware configuration file) when the pointer is valid
  29. */
  30. void *board_fdt_blob_setup(int *err)
  31. {
  32. log_debug("%s: nt_fw_dtb=%lx\n", __func__, nt_fw_dtb);
  33. *err = 0;
  34. /* use external device tree only if address is valid */
  35. if (nt_fw_dtb >= STM32_DDR_BASE) {
  36. if (fdt_magic(nt_fw_dtb) == FDT_MAGIC)
  37. return (void *)nt_fw_dtb;
  38. log_debug("%s: DTB not found.\n", __func__);
  39. }
  40. log_debug("%s: fall back to builtin DTB, %p\n", __func__, &_end);
  41. return (void *)&_end;
  42. }