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 */ 7744d60aaSAkshay Belsare #include <common/debug.h> 856d1857eSAmit Nagal #include <common/fdt_fixup.h> 956d1857eSAmit Nagal #include <common/fdt_wrappers.h> 10744d60aaSAkshay Belsare #include <libfdt.h> 1156d1857eSAmit Nagal 1256d1857eSAmit Nagal #include <plat_fdt.h> 1356d1857eSAmit Nagal #include <platform_def.h> 1456d1857eSAmit Nagal 1556d1857eSAmit Nagal void prepare_dtb(void) 1656d1857eSAmit Nagal { 17*fdf8f929SAmit Nagal void *dtb; 1856d1857eSAmit Nagal int ret; 19*fdf8f929SAmit Nagal #if !defined(XILINX_OF_BOARD_DTB_ADDR) 20*fdf8f929SAmit Nagal return; 21*fdf8f929SAmit Nagal #else 22*fdf8f929SAmit Nagal dtb = (void *)XILINX_OF_BOARD_DTB_ADDR; 23*fdf8f929SAmit Nagal #endif 24*fdf8f929SAmit Nagal if (IS_TFA_IN_OCM(BL31_BASE)) 25*fdf8f929SAmit Nagal return; 2656d1857eSAmit Nagal 2756d1857eSAmit Nagal /* Return if no device tree is detected */ 2856d1857eSAmit Nagal if (fdt_check_header(dtb) != 0) { 2956d1857eSAmit Nagal NOTICE("Can't read DT at %p\n", dtb); 3056d1857eSAmit Nagal return; 3156d1857eSAmit Nagal } 3256d1857eSAmit Nagal 3356d1857eSAmit Nagal ret = fdt_open_into(dtb, dtb, XILINX_OF_BOARD_DTB_MAX_SIZE); 3456d1857eSAmit Nagal if (ret < 0) { 3556d1857eSAmit Nagal ERROR("Invalid Device Tree at %p: error %d\n", dtb, ret); 3656d1857eSAmit Nagal return; 3756d1857eSAmit Nagal } 3856d1857eSAmit Nagal 3956d1857eSAmit Nagal /* Reserve memory used by Trusted Firmware. */ 4056d1857eSAmit Nagal if (fdt_add_reserved_memory(dtb, "tf-a", BL31_BASE, BL31_LIMIT - BL31_BASE + 1)) { 4156d1857eSAmit Nagal WARN("Failed to add reserved memory nodes for BL31 to DT.\n"); 4256d1857eSAmit Nagal return; 4356d1857eSAmit Nagal } 4456d1857eSAmit Nagal 4556d1857eSAmit Nagal ret = fdt_pack(dtb); 4656d1857eSAmit Nagal if (ret < 0) { 4756d1857eSAmit Nagal ERROR("Failed to pack Device Tree at %p: error %d\n", dtb, ret); 4856d1857eSAmit Nagal return; 4956d1857eSAmit Nagal } 5056d1857eSAmit Nagal 5156d1857eSAmit Nagal clean_dcache_range((uintptr_t)dtb, fdt_blob_size(dtb)); 5256d1857eSAmit Nagal INFO("Changed device tree to advertise PSCI and reserved memories.\n"); 5356d1857eSAmit Nagal } 54