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