[u-boot.git] / arch / arm / mach-k3 / common.c

// SPDX-License-Identifier: GPL-2.0+
/*
 * K3: Common Architecture initialization
 *
 * Copyright (C) 2018 Texas Instruments Incorporated - http://www.ti.com/
 *	Lokesh Vutla <[email protected]>
 */

#include <common.h>
#include <cpu_func.h>
#include <image.h>
#include <init.h>
#include <log.h>
#include <spl.h>
#include <asm/global_data.h>
#include "common.h"
#include <dm.h>
#include <remoteproc.h>
#include <asm/cache.h>
#include <linux/soc/ti/ti_sci_protocol.h>
#include <fdt_support.h>
#include <asm/arch/sys_proto.h>
#include <asm/hardware.h>
#include <asm/io.h>
#include <fs_loader.h>
#include <fs.h>
#include <env.h>
#include <elf.h>
#include <soc.h>

struct ti_sci_handle *get_ti_sci_handle(void)
{
	struct udevice *dev;
	int ret;

	ret = uclass_get_device_by_driver(UCLASS_FIRMWARE,
					  DM_DRIVER_GET(ti_sci), &dev);
	if (ret)
		panic("Failed to get SYSFW (%d)\n", ret);

	return (struct ti_sci_handle *)ti_sci_get_handle_from_sysfw(dev);
}

void k3_sysfw_print_ver(void)
{
	struct ti_sci_handle *ti_sci = get_ti_sci_handle();
	char fw_desc[sizeof(ti_sci->version.firmware_description) + 1];

	/*
	 * Output System Firmware version info. Note that since the
	 * 'firmware_description' field is not guaranteed to be zero-
	 * terminated we manually add a \0 terminator if needed. Further
	 * note that we intentionally no longer rely on the extended
	 * printf() formatter '%.*s' to not having to require a more
	 * full-featured printf() implementation.
	 */
	strncpy(fw_desc, ti_sci->version.firmware_description,
		sizeof(ti_sci->version.firmware_description));
	fw_desc[sizeof(fw_desc) - 1] = '\0';

	printf("SYSFW ABI: %d.%d (firmware rev 0x%04x '%s')\n",
	       ti_sci->version.abi_major, ti_sci->version.abi_minor,
	       ti_sci->version.firmware_revision, fw_desc);
}

void mmr_unlock(phys_addr_t base, u32 partition)
{
	/* Translate the base address */
	phys_addr_t part_base = base + partition * CTRL_MMR0_PARTITION_SIZE;

	/* Unlock the requested partition if locked using two-step sequence */
	writel(CTRLMMR_LOCK_KICK0_UNLOCK_VAL, part_base + CTRLMMR_LOCK_KICK0);
	writel(CTRLMMR_LOCK_KICK1_UNLOCK_VAL, part_base + CTRLMMR_LOCK_KICK1);
}

bool is_rom_loaded_sysfw(struct rom_extended_boot_data *data)
{
	if (strncmp(data->header, K3_ROM_BOOT_HEADER_MAGIC, 7))
		return false;

	return data->num_components > 1;
}

DECLARE_GLOBAL_DATA_PTR;

#ifdef CONFIG_K3_EARLY_CONS
int early_console_init(void)
{
	struct udevice *dev;
	int ret;

	gd->baudrate = CONFIG_BAUDRATE;

	ret = uclass_get_device_by_seq(UCLASS_SERIAL, CONFIG_K3_EARLY_CONS_IDX,
				       &dev);
	if (ret) {
		printf("Error getting serial dev for early console! (%d)\n",
		       ret);
		return ret;
	}

	gd->cur_serial_dev = dev;
	gd->flags |= GD_FLG_SERIAL_READY;
	gd->have_console = 1;

	return 0;
}
#endif

#ifdef CONFIG_SYS_K3_SPL_ATF

void init_env(void)
{
#ifdef CONFIG_SPL_ENV_SUPPORT
	char *part;

	env_init();
	env_relocate();
	switch (spl_boot_device()) {
	case BOOT_DEVICE_MMC2:
		part = env_get("bootpart");
		env_set("storage_interface", "mmc");
		env_set("fw_dev_part", part);
		break;
	case BOOT_DEVICE_SPI:
		env_set("storage_interface", "ubi");
		env_set("fw_ubi_mtdpart", "UBI");
		env_set("fw_ubi_volume", "UBI0");
		break;
	default:
		printf("%s from device %u not supported!\n",
		       __func__, spl_boot_device());
		return;
	}
#endif
}

#ifdef CONFIG_FS_LOADER
int load_firmware(char *name_fw, char *name_loadaddr, u32 *loadaddr)
{
	struct udevice *fsdev;
	char *name = NULL;
	int size = 0;

	*loadaddr = 0;
#ifdef CONFIG_SPL_ENV_SUPPORT
	switch (spl_boot_device()) {
	case BOOT_DEVICE_MMC2:
		name = env_get(name_fw);
		*loadaddr = env_get_hex(name_loadaddr, *loadaddr);
		break;
	default:
		printf("Loading rproc fw image from device %u not supported!\n",
		       spl_boot_device());
		return 0;
	}
#endif
	if (!*loadaddr)
		return 0;

	if (!uclass_get_device(UCLASS_FS_FIRMWARE_LOADER, 0, &fsdev)) {
		size = request_firmware_into_buf(fsdev, name, (void *)*loadaddr,
						 0, 0);
	}

	return size;
}
#else
int load_firmware(char *name_fw, char *name_loadaddr, u32 *loadaddr)
{
	return 0;
}
#endif

__weak void start_non_linux_remote_cores(void)
{
}

void __noreturn jump_to_image_no_args(struct spl_image_info *spl_image)
{
	typedef void __noreturn (*image_entry_noargs_t)(void);
	struct ti_sci_handle *ti_sci = get_ti_sci_handle();
	u32 loadaddr = 0;
	int ret, size;

	/* Release all the exclusive devices held by SPL before starting ATF */
	ti_sci->ops.dev_ops.release_exclusive_devices(ti_sci);

	ret = rproc_init();
	if (ret)
		panic("rproc failed to be initialized (%d)\n", ret);

	init_env();
	start_non_linux_remote_cores();
	size = load_firmware("name_mcur5f0_0fw", "addr_mcur5f0_0load",
			     &loadaddr);


	/*
	 * It is assumed that remoteproc device 1 is the corresponding
	 * Cortex-A core which runs ATF. Make sure DT reflects the same.
	 */
	ret = rproc_load(1, spl_image->entry_point, 0x200);
	if (ret)
		panic("%s: ATF failed to load on rproc (%d)\n", __func__, ret);

	/* Add an extra newline to differentiate the ATF logs from SPL */
	printf("Starting ATF on ARM64 core...\n\n");

	ret = rproc_start(1);
	if (ret)
		panic("%s: ATF failed to start on rproc (%d)\n", __func__, ret);
	if (!(size > 0 && valid_elf_image(loadaddr))) {
		debug("Shutting down...\n");
		release_resources_for_core_shutdown();

		while (1)
			asm volatile("wfe");
	}

	image_entry_noargs_t image_entry =
		(image_entry_noargs_t)load_elf_image_phdr(loadaddr);

	image_entry();
}
#endif

#if defined(CONFIG_OF_LIBFDT)
int fdt_fixup_msmc_ram(void *blob, char *parent_path, char *node_name)
{
	u64 msmc_start = 0, msmc_end = 0, msmc_size, reg[2];
	struct ti_sci_handle *ti_sci = get_ti_sci_handle();
	int ret, node, subnode, len, prev_node;
	u32 range[4], addr, size;
	const fdt32_t *sub_reg;

	ti_sci->ops.core_ops.query_msmc(ti_sci, &msmc_start, &msmc_end);
	msmc_size = msmc_end - msmc_start + 1;
	debug("%s: msmc_start = 0x%llx, msmc_size = 0x%llx\n", __func__,
	      msmc_start, msmc_size);

	/* find or create "msmc_sram node */
	ret = fdt_path_offset(blob, parent_path);
	if (ret < 0)
		return ret;

	node = fdt_find_or_add_subnode(blob, ret, node_name);
	if (node < 0)
		return node;

	ret = fdt_setprop_string(blob, node, "compatible", "mmio-sram");
	if (ret < 0)
		return ret;

	reg[0] = cpu_to_fdt64(msmc_start);
	reg[1] = cpu_to_fdt64(msmc_size);
	ret = fdt_setprop(blob, node, "reg", reg, sizeof(reg));
	if (ret < 0)
		return ret;

	fdt_setprop_cell(blob, node, "#address-cells", 1);
	fdt_setprop_cell(blob, node, "#size-cells", 1);

	range[0] = 0;
	range[1] = cpu_to_fdt32(msmc_start >> 32);
	range[2] = cpu_to_fdt32(msmc_start & 0xffffffff);
	range[3] = cpu_to_fdt32(msmc_size);
	ret = fdt_setprop(blob, node, "ranges", range, sizeof(range));
	if (ret < 0)
		return ret;

	subnode = fdt_first_subnode(blob, node);
	prev_node = 0;

	/* Look for invalid subnodes and delete them */
	while (subnode >= 0) {
		sub_reg = fdt_getprop(blob, subnode, "reg", &len);
		addr = fdt_read_number(sub_reg, 1);
		sub_reg++;
		size = fdt_read_number(sub_reg, 1);
		debug("%s: subnode = %d, addr = 0x%x. size = 0x%x\n", __func__,
		      subnode, addr, size);
		if (addr + size > msmc_size ||
		    !strncmp(fdt_get_name(blob, subnode, &len), "sysfw", 5) ||
		    !strncmp(fdt_get_name(blob, subnode, &len), "l3cache", 7)) {
			fdt_del_node(blob, subnode);
			debug("%s: deleting subnode %d\n", __func__, subnode);
			if (!prev_node)
				subnode = fdt_first_subnode(blob, node);
			else
				subnode = fdt_next_subnode(blob, prev_node);
		} else {
			prev_node = subnode;
			subnode = fdt_next_subnode(blob, prev_node);
		}
	}

	return 0;
}

int fdt_disable_node(void *blob, char *node_path)
{
	int offs;
	int ret;

	offs = fdt_path_offset(blob, node_path);
	if (offs < 0) {
		printf("Node %s not found.\n", node_path);
		return offs;
	}
	ret = fdt_setprop_string(blob, offs, "status", "disabled");
	if (ret < 0) {
		printf("Could not add status property to node %s: %s\n",
		       node_path, fdt_strerror(ret));
		return ret;
	}
	return 0;
}

#endif

#ifndef CONFIG_SYSRESET
void reset_cpu(void)
{
}
#endif

#if defined(CONFIG_DISPLAY_CPUINFO)
int print_cpuinfo(void)
{
	struct udevice *soc;
	char name[64];
	int ret;

	printf("SoC:   ");

	ret = soc_get(&soc);
	if (ret) {
		printf("UNKNOWN\n");
		return 0;
	}

	ret = soc_get_family(soc, name, 64);
	if (!ret) {
		printf("%s ", name);
	}

	ret = soc_get_revision(soc, name, 64);
	if (!ret) {
		printf("%s\n", name);
	}

	return 0;
}
#endif

bool soc_is_j721e(void)
{
	u32 soc;

	soc = (readl(CTRLMMR_WKUP_JTAG_ID) &
		JTAG_ID_PARTNO_MASK) >> JTAG_ID_PARTNO_SHIFT;

	return soc == J721E;
}

bool soc_is_j7200(void)
{
	u32 soc;

	soc = (readl(CTRLMMR_WKUP_JTAG_ID) &
		JTAG_ID_PARTNO_MASK) >> JTAG_ID_PARTNO_SHIFT;

	return soc == J7200;
}

#ifdef CONFIG_ARM64
void board_prep_linux(bootm_headers_t *images)
{
	debug("Linux kernel Image start = 0x%lx end = 0x%lx\n",
	      images->os.start, images->os.end);
	__asm_flush_dcache_range(images->os.start,
				 ROUND(images->os.end,
				       CONFIG_SYS_CACHELINE_SIZE));
}
#endif

#ifdef CONFIG_CPU_V7R
void disable_linefill_optimization(void)
{
	u32 actlr;

	/*
	 * On K3 devices there are 2 conditions where R5F can deadlock:
	 * 1.When software is performing series of store operations to
	 *   cacheable write back/write allocate memory region and later
	 *   on software execute barrier operation (DSB or DMB). R5F may
	 *   hang at the barrier instruction.
	 * 2.When software is performing a mix of load and store operations
	 *   within a tight loop and store operations are all writing to
	 *   cacheable write back/write allocates memory regions, R5F may
	 *   hang at one of the load instruction.
	 *
	 * To avoid the above two conditions disable linefill optimization
	 * inside Cortex R5F.
	 */
	asm("mrc p15, 0, %0, c1, c0, 1" : "=r" (actlr));
	actlr |= (1 << 13); /* Set DLFO bit  */
	asm("mcr p15, 0, %0, c1, c0, 1" : : "r" (actlr));
}
#endif

void remove_fwl_configs(struct fwl_data *fwl_data, size_t fwl_data_size)
{
	struct ti_sci_msg_fwl_region region;
	struct ti_sci_fwl_ops *fwl_ops;
	struct ti_sci_handle *ti_sci;
	size_t i, j;

	ti_sci = get_ti_sci_handle();
	fwl_ops = &ti_sci->ops.fwl_ops;
	for (i = 0; i < fwl_data_size; i++) {
		for (j = 0; j <  fwl_data[i].regions; j++) {
			region.fwl_id = fwl_data[i].fwl_id;
			region.region = j;
			region.n_permission_regs = 3;

			fwl_ops->get_fwl_region(ti_sci, &region);

			if (region.control != 0) {
				pr_debug("Attempting to disable firewall %5d (%25s)\n",
					 region.fwl_id, fwl_data[i].name);
				region.control = 0;

				if (fwl_ops->set_fwl_region(ti_sci, &region))
					pr_err("Could not disable firewall %5d (%25s)\n",
					       region.fwl_id, fwl_data[i].name);
			}
		}
	}
}

void spl_enable_dcache(void)
{
#if !(defined(CONFIG_SYS_ICACHE_OFF) && defined(CONFIG_SYS_DCACHE_OFF))
	phys_addr_t ram_top = CONFIG_SYS_SDRAM_BASE;

	dram_init_banksize();

	/* reserve TLB table */
	gd->arch.tlb_size = PGTABLE_SIZE;

	ram_top += get_effective_memsize();
	/* keep ram_top in the 32-bit address space */
	if (ram_top >= 0x100000000)
		ram_top = (phys_addr_t) 0x100000000;

	gd->arch.tlb_addr = ram_top - gd->arch.tlb_size;
	debug("TLB table from %08lx to %08lx\n", gd->arch.tlb_addr,
	      gd->arch.tlb_addr + gd->arch.tlb_size);

	dcache_enable();
#endif
}

#if !(defined(CONFIG_SYS_ICACHE_OFF) && defined(CONFIG_SYS_DCACHE_OFF))
void spl_board_prepare_for_boot(void)
{
	dcache_disable();
}

void spl_board_prepare_for_linux(void)
{
	dcache_disable();
}
#endif
Commit	Line	Data
a3501a4a LV	1	// SPDX-License-Identifier: GPL-2.0+
	2	/*
	3	* K3: Common Architecture initialization
	4	*
	5	* Copyright (C) 2018 Texas Instruments Incorporated - http://www.ti.com/
	6	* Lokesh Vutla <[email protected]>
	7	*/
	8
	9	#include <common.h>
9a3b4ceb	10	#include <cpu_func.h>
4d72caa5	11	#include <image.h>
691d719d	12	#include <init.h>
f7ae49fc	13	#include <log.h>
a3501a4a	14	#include <spl.h>
401d1c4f	15	#include <asm/global_data.h>
a3501a4a LV	16	#include "common.h"
	17	#include <dm.h>
	18	#include <remoteproc.h>
90526e9f	19	#include <asm/cache.h>
6ce424a9	20	#include <linux/soc/ti/ti_sci_protocol.h>
a9a84480	21	#include <fdt_support.h>
f9380a73	22	#include <asm/arch/sys_proto.h>
f8ca9121 LV	23	#include <asm/hardware.h>
f8ca9121 LV	24	#include <asm/io.h>
3ab34bc0 K	25	#include <fs_loader.h>
	26	#include <fs.h>
	27	#include <env.h>
	28	#include <elf.h>
5ab71ea4	29	#include <soc.h>
6ce424a9 LV	30
	31	struct ti_sci_handle *get_ti_sci_handle(void)
	32	{
	33	struct udevice *dev;
	34	int ret;
	35
e69ffdb7	36	ret = uclass_get_device_by_driver(UCLASS_FIRMWARE,
65e25bea	37	DM_DRIVER_GET(ti_sci), &dev);
6ce424a9 LV	38	if (ret)
	39	panic("Failed to get SYSFW (%d)\n", ret);
	40
	41	return (struct ti_sci_handle *)ti_sci_get_handle_from_sysfw(dev);
	42	}
a3501a4a	43
6e44aebd LV	44	void k3_sysfw_print_ver(void)
	45	{
	46	struct ti_sci_handle *ti_sci = get_ti_sci_handle();
	47	char fw_desc[sizeof(ti_sci->version.firmware_description) + 1];
	48
	49	/*
	50	* Output System Firmware version info. Note that since the
	51	* 'firmware_description' field is not guaranteed to be zero-
	52	* terminated we manually add a \0 terminator if needed. Further
	53	* note that we intentionally no longer rely on the extended
	54	* printf() formatter '%.*s' to not having to require a more
	55	* full-featured printf() implementation.
	56	*/
	57	strncpy(fw_desc, ti_sci->version.firmware_description,
	58	sizeof(ti_sci->version.firmware_description));
	59	fw_desc[sizeof(fw_desc) - 1] = '\0';
	60
	61	printf("SYSFW ABI: %d.%d (firmware rev 0x%04x '%s')\n",
	62	ti_sci->version.abi_major, ti_sci->version.abi_minor,
	63	ti_sci->version.firmware_revision, fw_desc);
	64	}
	65
58ccd610 LV	66	void mmr_unlock(phys_addr_t base, u32 partition)
	67	{
	68	/* Translate the base address */
	69	phys_addr_t part_base = base + partition * CTRL_MMR0_PARTITION_SIZE;
	70
	71	/* Unlock the requested partition if locked using two-step sequence */
	72	writel(CTRLMMR_LOCK_KICK0_UNLOCK_VAL, part_base + CTRLMMR_LOCK_KICK0);
	73	writel(CTRLMMR_LOCK_KICK1_UNLOCK_VAL, part_base + CTRLMMR_LOCK_KICK1);
	74	}
	75
01dbe366 LV	76	bool is_rom_loaded_sysfw(struct rom_extended_boot_data *data)
	77	{
	78	if (strncmp(data->header, K3_ROM_BOOT_HEADER_MAGIC, 7))
	79	return false;
	80
	81	return data->num_components > 1;
	82	}
	83
e630afe1 AD	84	DECLARE_GLOBAL_DATA_PTR;
	85
	86	#ifdef CONFIG_K3_EARLY_CONS
	87	int early_console_init(void)
	88	{
	89	struct udevice *dev;
	90	int ret;
	91
	92	gd->baudrate = CONFIG_BAUDRATE;
	93
	94	ret = uclass_get_device_by_seq(UCLASS_SERIAL, CONFIG_K3_EARLY_CONS_IDX,
	95	&dev);
	96	if (ret) {
	97	printf("Error getting serial dev for early console! (%d)\n",
	98	ret);
	99	return ret;
	100	}
	101
	102	gd->cur_serial_dev = dev;
	103	gd->flags \|= GD_FLG_SERIAL_READY;
	104	gd->have_console = 1;
	105
	106	return 0;
	107	}
	108	#endif
	109
a3501a4a	110	#ifdef CONFIG_SYS_K3_SPL_ATF
3ab34bc0 K	111
	112	void init_env(void)
	113	{
	114	#ifdef CONFIG_SPL_ENV_SUPPORT
	115	char *part;
	116
	117	env_init();
	118	env_relocate();
	119	switch (spl_boot_device()) {
	120	case BOOT_DEVICE_MMC2:
	121	part = env_get("bootpart");
	122	env_set("storage_interface", "mmc");
	123	env_set("fw_dev_part", part);
	124	break;
	125	case BOOT_DEVICE_SPI:
	126	env_set("storage_interface", "ubi");
	127	env_set("fw_ubi_mtdpart", "UBI");
	128	env_set("fw_ubi_volume", "UBI0");
	129	break;
	130	default:
	131	printf("%s from device %u not supported!\n",
	132	__func__, spl_boot_device());
	133	return;
	134	}
	135	#endif
	136	}
	137
	138	#ifdef CONFIG_FS_LOADER
	139	int load_firmware(char name_fw, char name_loadaddr, u32 *loadaddr)
	140	{
	141	struct udevice *fsdev;
	142	char *name = NULL;
	143	int size = 0;
	144
	145	*loadaddr = 0;
	146	#ifdef CONFIG_SPL_ENV_SUPPORT
	147	switch (spl_boot_device()) {
	148	case BOOT_DEVICE_MMC2:
	149	name = env_get(name_fw);
	150	loadaddr = env_get_hex(name_loadaddr, loadaddr);
	151	break;
	152	default:
	153	printf("Loading rproc fw image from device %u not supported!\n",
	154	spl_boot_device());
	155	return 0;
	156	}
	157	#endif
	158	if (!*loadaddr)
	159	return 0;
	160
	161	if (!uclass_get_device(UCLASS_FS_FIRMWARE_LOADER, 0, &fsdev)) {
	162	size = request_firmware_into_buf(fsdev, name, (void )loadaddr,
	163	0, 0);
	164	}
	165
	166	return size;
	167	}
	168	#else
	169	int load_firmware(char name_fw, char name_loadaddr, u32 *loadaddr)
	170	{
	171	return 0;
	172	}
	173	#endif
	174
175	__weak void start_non_linux_remote_cores(void)
176	{
177	}
178
a3501a4a LV	179	void __noreturn jump_to_image_no_args(struct spl_image_info *spl_image)
a3501a4a LV	180	{
d154252f	181	typedef void __noreturn (*image_entry_noargs_t)(void);
c0669d28	182	struct ti_sci_handle *ti_sci = get_ti_sci_handle();
d154252f K	183	u32 loadaddr = 0;
d154252f K	184	int ret, size;
a3501a4a	185
c0669d28 LV	186	/* Release all the exclusive devices held by SPL before starting ATF */
	187	ti_sci->ops.dev_ops.release_exclusive_devices(ti_sci);
	188
3ab34bc0 K	189	ret = rproc_init();
	190	if (ret)
	191	panic("rproc failed to be initialized (%d)\n", ret);
	192
	193	init_env();
	194	start_non_linux_remote_cores();
d154252f K	195	size = load_firmware("name_mcur5f0_0fw", "addr_mcur5f0_0load",
	196	&loadaddr);
	197
3ab34bc0	198
a3501a4a LV	199	/*
a3501a4a LV	200	* It is assumed that remoteproc device 1 is the corresponding
4a1fa524	201	* Cortex-A core which runs ATF. Make sure DT reflects the same.
a3501a4a	202	*/
a3501a4a	203	ret = rproc_load(1, spl_image->entry_point, 0x200);
4a1fa524 AD	204	if (ret)
4a1fa524 AD	205	panic("%s: ATF failed to load on rproc (%d)\n", __func__, ret);
a3501a4a	206
4a1fa524	207	/* Add an extra newline to differentiate the ATF logs from SPL */
a3501a4a LV	208	printf("Starting ATF on ARM64 core...\n\n");
	209
	210	ret = rproc_start(1);
4a1fa524 AD	211	if (ret)
4a1fa524 AD	212	panic("%s: ATF failed to start on rproc (%d)\n", __func__, ret);
d154252f K	213	if (!(size > 0 && valid_elf_image(loadaddr))) {
	214	debug("Shutting down...\n");
	215	release_resources_for_core_shutdown();
	216
	217	while (1)
	218	asm volatile("wfe");
	219	}
a3501a4a	220
d154252f K	221	image_entry_noargs_t image_entry =
d154252f K	222	(image_entry_noargs_t)load_elf_image_phdr(loadaddr);
f9380a73	223
d154252f	224	image_entry();
a3501a4a LV	225	}
a3501a4a LV	226	#endif
a9a84480 LV	227
	228	#if defined(CONFIG_OF_LIBFDT)
	229	int fdt_fixup_msmc_ram(void blob, char parent_path, char *node_name)
	230	{
	231	u64 msmc_start = 0, msmc_end = 0, msmc_size, reg[2];
	232	struct ti_sci_handle *ti_sci = get_ti_sci_handle();
	233	int ret, node, subnode, len, prev_node;
	234	u32 range[4], addr, size;
	235	const fdt32_t *sub_reg;
	236
	237	ti_sci->ops.core_ops.query_msmc(ti_sci, &msmc_start, &msmc_end);
	238	msmc_size = msmc_end - msmc_start + 1;
	239	debug("%s: msmc_start = 0x%llx, msmc_size = 0x%llx\n", __func__,
	240	msmc_start, msmc_size);
	241
	242	/* find or create "msmc_sram node */
	243	ret = fdt_path_offset(blob, parent_path);
	244	if (ret < 0)
	245	return ret;
	246
	247	node = fdt_find_or_add_subnode(blob, ret, node_name);
	248	if (node < 0)
	249	return node;
	250
	251	ret = fdt_setprop_string(blob, node, "compatible", "mmio-sram");
	252	if (ret < 0)
	253	return ret;
	254
	255	reg[0] = cpu_to_fdt64(msmc_start);
	256	reg[1] = cpu_to_fdt64(msmc_size);
	257	ret = fdt_setprop(blob, node, "reg", reg, sizeof(reg));
	258	if (ret < 0)
	259	return ret;
	260
	261	fdt_setprop_cell(blob, node, "#address-cells", 1);
	262	fdt_setprop_cell(blob, node, "#size-cells", 1);
	263
	264	range[0] = 0;
	265	range[1] = cpu_to_fdt32(msmc_start >> 32);
	266	range[2] = cpu_to_fdt32(msmc_start & 0xffffffff);
	267	range[3] = cpu_to_fdt32(msmc_size);
	268	ret = fdt_setprop(blob, node, "ranges", range, sizeof(range));
	269	if (ret < 0)
	270	return ret;
	271
	272	subnode = fdt_first_subnode(blob, node);
	273	prev_node = 0;
	274
	275	/* Look for invalid subnodes and delete them */
	276	while (subnode >= 0) {
	277	sub_reg = fdt_getprop(blob, subnode, "reg", &len);
	278	addr = fdt_read_number(sub_reg, 1);
	279	sub_reg++;
	280	size = fdt_read_number(sub_reg, 1);
	281	debug("%s: subnode = %d, addr = 0x%x. size = 0x%x\n", __func__,
	282	subnode, addr, size);
	283	if (addr + size > msmc_size \|\|
	284	!strncmp(fdt_get_name(blob, subnode, &len), "sysfw", 5) \|\|
	285	!strncmp(fdt_get_name(blob, subnode, &len), "l3cache", 7)) {
	286	fdt_del_node(blob, subnode);
	287	debug("%s: deleting subnode %d\n", __func__, subnode);
	288	if (!prev_node)
	289	subnode = fdt_first_subnode(blob, node);
	290	else
291	subnode = fdt_next_subnode(blob, prev_node);
292	} else {
293	prev_node = subnode;
294	subnode = fdt_next_subnode(blob, prev_node);
295	}
296	}
297
298	return 0;
299	}
29c9db4d AD	300
	301	int fdt_disable_node(void blob, char node_path)
	302	{
	303	int offs;
	304	int ret;
	305
	306	offs = fdt_path_offset(blob, node_path);
	307	if (offs < 0) {
28b90a46 AD	308	printf("Node %s not found.\n", node_path);
28b90a46 AD	309	return offs;
29c9db4d AD	310	}
	311	ret = fdt_setprop_string(blob, offs, "status", "disabled");
	312	if (ret < 0) {
	313	printf("Could not add status property to node %s: %s\n",
	314	node_path, fdt_strerror(ret));
	315	return ret;
	316	}
	317	return 0;
	318	}
	319
a9a84480	320	#endif
c2562d7c LV	321
c2562d7c LV	322	#ifndef CONFIG_SYSRESET
35b65dd8	323	void reset_cpu(void)
c2562d7c LV	324	{
	325	}
	326	#endif
f8ca9121 LV	327
	328	#if defined(CONFIG_DISPLAY_CPUINFO)
	329	int print_cpuinfo(void)
	330	{
5ab71ea4 DG	331	struct udevice *soc;
	332	char name[64];
	333	int ret;
469f04e8	334
7208396b	335	printf("SoC: ");
469f04e8	336
5ab71ea4 DG	337	ret = soc_get(&soc);
	338	if (ret) {
	339	printf("UNKNOWN\n");
	340	return 0;
	341	}
	342
	343	ret = soc_get_family(soc, name, 64);
	344	if (!ret) {
	345	printf("%s ", name);
	346	}
	347
	348	ret = soc_get_revision(soc, name, 64);
	349	if (!ret) {
	350	printf("%s\n", name);
	351	}
f8ca9121 LV	352
	353	return 0;
	354	}
	355	#endif
e938b225	356
2a18be77 LV	357	bool soc_is_j721e(void)
	358	{
	359	u32 soc;
	360
	361	soc = (readl(CTRLMMR_WKUP_JTAG_ID) &
	362	JTAG_ID_PARTNO_MASK) >> JTAG_ID_PARTNO_SHIFT;
	363
	364	return soc == J721E;
	365	}
	366
30de1ba0 LV	367	bool soc_is_j7200(void)
	368	{
	369	u32 soc;
	370
	371	soc = (readl(CTRLMMR_WKUP_JTAG_ID) &
	372	JTAG_ID_PARTNO_MASK) >> JTAG_ID_PARTNO_SHIFT;
	373
	374	return soc == J7200;
	375	}
	376
e938b225 LV	377	#ifdef CONFIG_ARM64
	378	void board_prep_linux(bootm_headers_t *images)
	379	{
	380	debug("Linux kernel Image start = 0x%lx end = 0x%lx\n",
	381	images->os.start, images->os.end);
	382	__asm_flush_dcache_range(images->os.start,
	383	ROUND(images->os.end,
	384	CONFIG_SYS_CACHELINE_SIZE));
	385	}
	386	#endif
40109f4d LV	387
	388	#ifdef CONFIG_CPU_V7R
	389	void disable_linefill_optimization(void)
	390	{
	391	u32 actlr;
	392
	393	/*
	394	* On K3 devices there are 2 conditions where R5F can deadlock:
	395	* 1.When software is performing series of store operations to
	396	* cacheable write back/write allocate memory region and later
	397	* on software execute barrier operation (DSB or DMB). R5F may
	398	* hang at the barrier instruction.
	399	* 2.When software is performing a mix of load and store operations
	400	* within a tight loop and store operations are all writing to
	401	* cacheable write back/write allocates memory regions, R5F may
	402	* hang at one of the load instruction.
	403	*
	404	* To avoid the above two conditions disable linefill optimization
	405	* inside Cortex R5F.
	406	*/
	407	asm("mrc p15, 0, %0, c1, c0, 1" : "=r" (actlr));
	408	actlr \|= (1 << 13); /* Set DLFO bit */
	409	asm("mcr p15, 0, %0, c1, c0, 1" : : "r" (actlr));
	410	}
	411	#endif
ea70da14 AD	412
	413	void remove_fwl_configs(struct fwl_data *fwl_data, size_t fwl_data_size)
	414	{
	415	struct ti_sci_msg_fwl_region region;
	416	struct ti_sci_fwl_ops *fwl_ops;
	417	struct ti_sci_handle *ti_sci;
	418	size_t i, j;
	419
	420	ti_sci = get_ti_sci_handle();
	421	fwl_ops = &ti_sci->ops.fwl_ops;
	422	for (i = 0; i < fwl_data_size; i++) {
	423	for (j = 0; j < fwl_data[i].regions; j++) {
	424	region.fwl_id = fwl_data[i].fwl_id;
	425	region.region = j;
	426	region.n_permission_regs = 3;
	427
	428	fwl_ops->get_fwl_region(ti_sci, &region);
	429
	430	if (region.control != 0) {
	431	pr_debug("Attempting to disable firewall %5d (%25s)\n",
	432	region.fwl_id, fwl_data[i].name);
	433	region.control = 0;
	434
	435	if (fwl_ops->set_fwl_region(ti_sci, &region))
	436	pr_err("Could not disable firewall %5d (%25s)\n",
	437	region.fwl_id, fwl_data[i].name);
	438	}
	439	}
	440	}
	441	}
c02712a7 JK	442
	443	void spl_enable_dcache(void)
	444	{
	445	#if !(defined(CONFIG_SYS_ICACHE_OFF) && defined(CONFIG_SYS_DCACHE_OFF))
	446	phys_addr_t ram_top = CONFIG_SYS_SDRAM_BASE;
	447
	448	dram_init_banksize();
	449
	450	/* reserve TLB table */
	451	gd->arch.tlb_size = PGTABLE_SIZE;
	452
	453	ram_top += get_effective_memsize();
	454	/* keep ram_top in the 32-bit address space */
	455	if (ram_top >= 0x100000000)
	456	ram_top = (phys_addr_t) 0x100000000;
	457
	458	gd->arch.tlb_addr = ram_top - gd->arch.tlb_size;
	459	debug("TLB table from %08lx to %08lx\n", gd->arch.tlb_addr,
	460	gd->arch.tlb_addr + gd->arch.tlb_size);
	461
	462	dcache_enable();
	463	#endif
	464	}
	465
	466	#if !(defined(CONFIG_SYS_ICACHE_OFF) && defined(CONFIG_SYS_DCACHE_OFF))
	467	void spl_board_prepare_for_boot(void)
	468	{
	469	dcache_disable();
	470	}
	471
865fdfdd	472	void spl_board_prepare_for_linux(void)
c02712a7 JK	473	{
	474	dcache_disable();
	475	}
	476	#endif