1*56d1857eSAmit Nagal /* 2*56d1857eSAmit Nagal * Copyright (c) 2023, Advanced Micro Devices, Inc. All rights reserved. 3*56d1857eSAmit Nagal * 4*56d1857eSAmit Nagal * SPDX-License-Identifier: BSD-3-Clause 5*56d1857eSAmit Nagal * 6*56d1857eSAmit Nagal */ 7*56d1857eSAmit Nagal #include <common/fdt_fixup.h> 8*56d1857eSAmit Nagal #include <common/fdt_wrappers.h> 9*56d1857eSAmit Nagal 10*56d1857eSAmit Nagal #include <plat_fdt.h> 11*56d1857eSAmit Nagal #include <platform_def.h> 12*56d1857eSAmit Nagal 13*56d1857eSAmit Nagal #if (defined(XILINX_OF_BOARD_DTB_ADDR) && !IS_TFA_IN_OCM(BL31_BASE)) 14*56d1857eSAmit Nagal void prepare_dtb(void) 15*56d1857eSAmit Nagal { 16*56d1857eSAmit Nagal void *dtb = (void *)XILINX_OF_BOARD_DTB_ADDR; 17*56d1857eSAmit Nagal int ret; 18*56d1857eSAmit Nagal 19*56d1857eSAmit Nagal /* Return if no device tree is detected */ 20*56d1857eSAmit Nagal if (fdt_check_header(dtb) != 0) { 21*56d1857eSAmit Nagal NOTICE("Can't read DT at %p\n", dtb); 22*56d1857eSAmit Nagal return; 23*56d1857eSAmit Nagal } 24*56d1857eSAmit Nagal 25*56d1857eSAmit Nagal ret = fdt_open_into(dtb, dtb, XILINX_OF_BOARD_DTB_MAX_SIZE); 26*56d1857eSAmit Nagal if (ret < 0) { 27*56d1857eSAmit Nagal ERROR("Invalid Device Tree at %p: error %d\n", dtb, ret); 28*56d1857eSAmit Nagal return; 29*56d1857eSAmit Nagal } 30*56d1857eSAmit Nagal 31*56d1857eSAmit Nagal /* Reserve memory used by Trusted Firmware. */ 32*56d1857eSAmit Nagal if (fdt_add_reserved_memory(dtb, "tf-a", BL31_BASE, BL31_LIMIT - BL31_BASE + 1)) { 33*56d1857eSAmit Nagal WARN("Failed to add reserved memory nodes for BL31 to DT.\n"); 34*56d1857eSAmit Nagal return; 35*56d1857eSAmit Nagal } 36*56d1857eSAmit Nagal 37*56d1857eSAmit Nagal ret = fdt_pack(dtb); 38*56d1857eSAmit Nagal if (ret < 0) { 39*56d1857eSAmit Nagal ERROR("Failed to pack Device Tree at %p: error %d\n", dtb, ret); 40*56d1857eSAmit Nagal return; 41*56d1857eSAmit Nagal } 42*56d1857eSAmit Nagal 43*56d1857eSAmit Nagal clean_dcache_range((uintptr_t)dtb, fdt_blob_size(dtb)); 44*56d1857eSAmit Nagal INFO("Changed device tree to advertise PSCI and reserved memories.\n"); 45*56d1857eSAmit Nagal } 46*56d1857eSAmit Nagal #else 47*56d1857eSAmit Nagal void prepare_dtb(void) 48*56d1857eSAmit Nagal { 49*56d1857eSAmit Nagal } 50*56d1857eSAmit Nagal #endif 51