156d1857eSAmit Nagal /* 256d1857eSAmit Nagal * Copyright (c) 2023, Advanced Micro Devices, Inc. All rights reserved. 356d1857eSAmit Nagal * 456d1857eSAmit Nagal * SPDX-License-Identifier: BSD-3-Clause 556d1857eSAmit Nagal * 656d1857eSAmit Nagal */ 7*744d60aaSAkshay Belsare #include <common/debug.h> 856d1857eSAmit Nagal #include <common/fdt_fixup.h> 956d1857eSAmit Nagal #include <common/fdt_wrappers.h> 10*744d60aaSAkshay Belsare #include <libfdt.h> 1156d1857eSAmit Nagal 1256d1857eSAmit Nagal #include <plat_fdt.h> 1356d1857eSAmit Nagal #include <platform_def.h> 1456d1857eSAmit Nagal 1556d1857eSAmit Nagal #if (defined(XILINX_OF_BOARD_DTB_ADDR) && !IS_TFA_IN_OCM(BL31_BASE)) 1656d1857eSAmit Nagal void prepare_dtb(void) 1756d1857eSAmit Nagal { 1856d1857eSAmit Nagal void *dtb = (void *)XILINX_OF_BOARD_DTB_ADDR; 1956d1857eSAmit Nagal int ret; 2056d1857eSAmit Nagal 2156d1857eSAmit Nagal /* Return if no device tree is detected */ 2256d1857eSAmit Nagal if (fdt_check_header(dtb) != 0) { 2356d1857eSAmit Nagal NOTICE("Can't read DT at %p\n", dtb); 2456d1857eSAmit Nagal return; 2556d1857eSAmit Nagal } 2656d1857eSAmit Nagal 2756d1857eSAmit Nagal ret = fdt_open_into(dtb, dtb, XILINX_OF_BOARD_DTB_MAX_SIZE); 2856d1857eSAmit Nagal if (ret < 0) { 2956d1857eSAmit Nagal ERROR("Invalid Device Tree at %p: error %d\n", dtb, ret); 3056d1857eSAmit Nagal return; 3156d1857eSAmit Nagal } 3256d1857eSAmit Nagal 3356d1857eSAmit Nagal /* Reserve memory used by Trusted Firmware. */ 3456d1857eSAmit Nagal if (fdt_add_reserved_memory(dtb, "tf-a", BL31_BASE, BL31_LIMIT - BL31_BASE + 1)) { 3556d1857eSAmit Nagal WARN("Failed to add reserved memory nodes for BL31 to DT.\n"); 3656d1857eSAmit Nagal return; 3756d1857eSAmit Nagal } 3856d1857eSAmit Nagal 3956d1857eSAmit Nagal ret = fdt_pack(dtb); 4056d1857eSAmit Nagal if (ret < 0) { 4156d1857eSAmit Nagal ERROR("Failed to pack Device Tree at %p: error %d\n", dtb, ret); 4256d1857eSAmit Nagal return; 4356d1857eSAmit Nagal } 4456d1857eSAmit Nagal 4556d1857eSAmit Nagal clean_dcache_range((uintptr_t)dtb, fdt_blob_size(dtb)); 4656d1857eSAmit Nagal INFO("Changed device tree to advertise PSCI and reserved memories.\n"); 4756d1857eSAmit Nagal } 4856d1857eSAmit Nagal #else 4956d1857eSAmit Nagal void prepare_dtb(void) 5056d1857eSAmit Nagal { 5156d1857eSAmit Nagal } 5256d1857eSAmit Nagal #endif 53