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