1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
2f225d39dSJon Medhurst \(Tixy\) /*
3f225d39dSJon Medhurst \(Tixy\)  * (C) Copyright 2016 Linaro
4f225d39dSJon Medhurst \(Tixy\)  * Jon Medhurst <tixy@linaro.org>
5f225d39dSJon Medhurst \(Tixy\)  *
6f225d39dSJon Medhurst \(Tixy\)  * TC2 specific code for Versatile Express.
7f225d39dSJon Medhurst \(Tixy\)  */
8f225d39dSJon Medhurst \(Tixy\) 
903ab5d13SSudeep Holla #include <asm/armv7.h>
10f225d39dSJon Medhurst \(Tixy\) #include <asm/io.h>
1103ab5d13SSudeep Holla #include <asm/u-boot.h>
1203ab5d13SSudeep Holla #include <common.h>
13b08c8c48SMasahiro Yamada #include <linux/libfdt.h>
14f225d39dSJon Medhurst \(Tixy\) 
15f225d39dSJon Medhurst \(Tixy\) #define SCC_BASE	0x7fff0000
16f225d39dSJon Medhurst \(Tixy\) 
armv7_boot_nonsec_default(void)17f225d39dSJon Medhurst \(Tixy\) bool armv7_boot_nonsec_default(void)
18f225d39dSJon Medhurst \(Tixy\) {
19f225d39dSJon Medhurst \(Tixy\) #ifdef CONFIG_ARMV7_BOOT_SEC_DEFAULT
20901b77b9SHeinrich Schuchardt 	return false;
21f225d39dSJon Medhurst \(Tixy\) #else
22f225d39dSJon Medhurst \(Tixy\) 	/*
23f225d39dSJon Medhurst \(Tixy\) 	 * The Serial Configuration Controller (SCC) register at address 0x700
24f225d39dSJon Medhurst \(Tixy\) 	 * contains flags for configuring the behaviour of the Boot Monitor
25f225d39dSJon Medhurst \(Tixy\) 	 * (which CPUs execute from reset). Two of these bits are of interest:
26f225d39dSJon Medhurst \(Tixy\) 	 *
27f225d39dSJon Medhurst \(Tixy\) 	 * bit 12 = Use per-cpu mailboxes for power management
28f225d39dSJon Medhurst \(Tixy\) 	 * bit 13 = Power down the non-boot cluster
29f225d39dSJon Medhurst \(Tixy\) 	 *
30f225d39dSJon Medhurst \(Tixy\) 	 * It is only when both of these are false that U-Boot's current
31f225d39dSJon Medhurst \(Tixy\) 	 * implementation of 'nonsec' mode can work as expected because we
32f225d39dSJon Medhurst \(Tixy\) 	 * rely on getting all CPUs to execute _nonsec_init, so let's check that.
33f225d39dSJon Medhurst \(Tixy\) 	 */
34f225d39dSJon Medhurst \(Tixy\) 	return (readl((u32 *)(SCC_BASE + 0x700)) & ((1 << 12) | (1 << 13))) == 0;
35f225d39dSJon Medhurst \(Tixy\) #endif
36f225d39dSJon Medhurst \(Tixy\) }
3703ab5d13SSudeep Holla 
3803ab5d13SSudeep Holla #ifdef CONFIG_OF_BOARD_SETUP
ft_board_setup(void * fdt,bd_t * bd)3903ab5d13SSudeep Holla int ft_board_setup(void *fdt, bd_t *bd)
4003ab5d13SSudeep Holla {
4103ab5d13SSudeep Holla 	int offset, tmp, len;
4203ab5d13SSudeep Holla 	const struct fdt_property *prop;
4303ab5d13SSudeep Holla 	const char *cci_compatible = "arm,cci-400-ctrl-if";
4403ab5d13SSudeep Holla 
4503ab5d13SSudeep Holla #ifdef CONFIG_ARMV7_NONSEC
4603ab5d13SSudeep Holla 	if (!armv7_boot_nonsec())
4703ab5d13SSudeep Holla 		return 0;
4803ab5d13SSudeep Holla #else
4903ab5d13SSudeep Holla 	return 0;
5003ab5d13SSudeep Holla #endif
5103ab5d13SSudeep Holla 	/* Booting in nonsec mode, disable CCI access */
5203ab5d13SSudeep Holla 	offset = fdt_path_offset(fdt, "/cpus");
5303ab5d13SSudeep Holla 	if (offset < 0) {
5403ab5d13SSudeep Holla 		printf("couldn't find /cpus\n");
5503ab5d13SSudeep Holla 		return offset;
5603ab5d13SSudeep Holla 	}
5703ab5d13SSudeep Holla 
5803ab5d13SSudeep Holla 	/* delete cci-control-port in each cpu node */
5903ab5d13SSudeep Holla 	for (tmp = fdt_first_subnode(fdt, offset); tmp >= 0;
6003ab5d13SSudeep Holla 	     tmp = fdt_next_subnode(fdt, tmp))
6103ab5d13SSudeep Holla 		fdt_delprop(fdt, tmp, "cci-control-port");
6203ab5d13SSudeep Holla 
6303ab5d13SSudeep Holla 	/* disable all ace cci slave ports */
6403ab5d13SSudeep Holla 	offset = fdt_node_offset_by_prop_value(fdt, offset, "compatible",
6503ab5d13SSudeep Holla 					       cci_compatible, 20);
6603ab5d13SSudeep Holla 	while (offset > 0) {
6703ab5d13SSudeep Holla 		prop = fdt_get_property(fdt, offset, "interface-type",
6803ab5d13SSudeep Holla 					&len);
6903ab5d13SSudeep Holla 		if (!prop)
7003ab5d13SSudeep Holla 			continue;
7103ab5d13SSudeep Holla 		if (len < 4)
7203ab5d13SSudeep Holla 			continue;
7303ab5d13SSudeep Holla 		if (strcmp(prop->data, "ace"))
7403ab5d13SSudeep Holla 			continue;
7503ab5d13SSudeep Holla 
7603ab5d13SSudeep Holla 		fdt_setprop_string(fdt, offset, "status", "disabled");
7703ab5d13SSudeep Holla 
7803ab5d13SSudeep Holla 		offset = fdt_node_offset_by_prop_value(fdt, offset, "compatible",
7903ab5d13SSudeep Holla 						       cci_compatible, 20);
8003ab5d13SSudeep Holla 	}
8103ab5d13SSudeep Holla 
8203ab5d13SSudeep Holla 	return 0;
8303ab5d13SSudeep Holla }
8403ab5d13SSudeep Holla #endif /* CONFIG_OF_BOARD_SETUP */
85