1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * Trusted Foundations support for ARM CPUs
  4 *
  5 * Copyright (c) 2013, NVIDIA Corporation.
  6 */
  7
  8#include <linux/kernel.h>
  9#include <linux/init.h>
 10#include <linux/of.h>
 11
 12#include <linux/firmware/trusted_foundations.h>
 13
 14#include <asm/firmware.h>
 15#include <asm/hardware/cache-l2x0.h>
 16#include <asm/outercache.h>
 17
 18#define TF_CACHE_MAINT		0xfffff100
 19
 20#define TF_CACHE_ENABLE		1
 21#define TF_CACHE_DISABLE	2
 22#define TF_CACHE_REENABLE	4
 23
 24#define TF_SET_CPU_BOOT_ADDR_SMC 0xfffff200
 25
 26#define TF_CPU_PM		0xfffffffc
 27#define TF_CPU_PM_S3		0xffffffe3
 28#define TF_CPU_PM_S2		0xffffffe6
 29#define TF_CPU_PM_S2_NO_MC_CLK	0xffffffe5
 30#define TF_CPU_PM_S1		0xffffffe4
 31#define TF_CPU_PM_S1_NOFLUSH_L2	0xffffffe7
 32
 33static unsigned long tf_idle_mode = TF_PM_MODE_NONE;
 34static unsigned long cpu_boot_addr;
 35
 36static void tf_generic_smc(u32 type, u32 arg1, u32 arg2)
 37{
 38	register u32 r0 asm("r0") = type;
 39	register u32 r1 asm("r1") = arg1;
 40	register u32 r2 asm("r2") = arg2;
 41
 42	asm volatile(
 43		".arch_extension	sec\n\t"
 44		"stmfd	sp!, {r4 - r11}\n\t"
 45		__asmeq("%0", "r0")
 46		__asmeq("%1", "r1")
 47		__asmeq("%2", "r2")
 48		"mov	r3, #0\n\t"
 49		"mov	r4, #0\n\t"
 50		"smc	#0\n\t"
 51		"ldmfd	sp!, {r4 - r11}\n\t"
 52		:
 53		: "r" (r0), "r" (r1), "r" (r2)
 54		: "memory", "r3", "r12", "lr");
 55}
 56
 57static int tf_set_cpu_boot_addr(int cpu, unsigned long boot_addr)
 58{
 59	cpu_boot_addr = boot_addr;
 60	tf_generic_smc(TF_SET_CPU_BOOT_ADDR_SMC, cpu_boot_addr, 0);
 61
 62	return 0;
 63}
 64
 65static int tf_prepare_idle(unsigned long mode)
 66{
 67	switch (mode) {
 68	case TF_PM_MODE_LP0:
 69		tf_generic_smc(TF_CPU_PM, TF_CPU_PM_S3, cpu_boot_addr);
 70		break;
 71
 72	case TF_PM_MODE_LP1:
 73		tf_generic_smc(TF_CPU_PM, TF_CPU_PM_S2, cpu_boot_addr);
 74		break;
 75
 76	case TF_PM_MODE_LP1_NO_MC_CLK:
 77		tf_generic_smc(TF_CPU_PM, TF_CPU_PM_S2_NO_MC_CLK,
 78			       cpu_boot_addr);
 79		break;
 80
 81	case TF_PM_MODE_LP2:
 82		tf_generic_smc(TF_CPU_PM, TF_CPU_PM_S1, cpu_boot_addr);
 83		break;
 84
 85	case TF_PM_MODE_LP2_NOFLUSH_L2:
 86		tf_generic_smc(TF_CPU_PM, TF_CPU_PM_S1_NOFLUSH_L2,
 87			       cpu_boot_addr);
 88		break;
 89
 90	case TF_PM_MODE_NONE:
 91		break;
 92
 93	default:
 94		return -EINVAL;
 95	}
 96
 97	tf_idle_mode = mode;
 98
 99	return 0;
100}
101
102#ifdef CONFIG_CACHE_L2X0
103static void tf_cache_write_sec(unsigned long val, unsigned int reg)
104{
105	u32 enable_op, l2x0_way_mask = 0xff;
106
107	switch (reg) {
108	case L2X0_CTRL:
109		if (l2x0_saved_regs.aux_ctrl & L310_AUX_CTRL_ASSOCIATIVITY_16)
110			l2x0_way_mask = 0xffff;
111
112		switch (tf_idle_mode) {
113		case TF_PM_MODE_LP2:
114			enable_op = TF_CACHE_REENABLE;
115			break;
116
117		default:
118			enable_op = TF_CACHE_ENABLE;
119			break;
120		}
121
122		if (val == L2X0_CTRL_EN)
123			tf_generic_smc(TF_CACHE_MAINT, enable_op,
124				       l2x0_saved_regs.aux_ctrl);
125		else
126			tf_generic_smc(TF_CACHE_MAINT, TF_CACHE_DISABLE,
127				       l2x0_way_mask);
128		break;
129
130	default:
131		break;
132	}
133}
134
135static int tf_init_cache(void)
136{
137	outer_cache.write_sec = tf_cache_write_sec;
138
139	return 0;
140}
141#endif /* CONFIG_CACHE_L2X0 */
142
143static const struct firmware_ops trusted_foundations_ops = {
144	.set_cpu_boot_addr = tf_set_cpu_boot_addr,
145	.prepare_idle = tf_prepare_idle,
146#ifdef CONFIG_CACHE_L2X0
147	.l2x0_init = tf_init_cache,
148#endif
149};
150
151void register_trusted_foundations(struct trusted_foundations_platform_data *pd)
152{
153	/*
154	 * we are not using version information for now since currently
155	 * supported SMCs are compatible with all TF releases
156	 */
157	register_firmware_ops(&trusted_foundations_ops);
158}
159
160void of_register_trusted_foundations(void)
161{
162	struct device_node *node;
163	struct trusted_foundations_platform_data pdata;
164	int err;
165
166	node = of_find_compatible_node(NULL, NULL, "tlm,trusted-foundations");
167	if (!node)
168		return;
169
170	err = of_property_read_u32(node, "tlm,version-major",
171				   &pdata.version_major);
172	if (err != 0)
173		panic("Trusted Foundation: missing version-major property\n");
174	err = of_property_read_u32(node, "tlm,version-minor",
175				   &pdata.version_minor);
176	if (err != 0)
177		panic("Trusted Foundation: missing version-minor property\n");
178	register_trusted_foundations(&pdata);
179}
180
181bool trusted_foundations_registered(void)
182{
183	return firmware_ops == &trusted_foundations_ops;
184}