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 
33 static unsigned long tf_idle_mode = TF_PM_MODE_NONE;
34 static unsigned long cpu_boot_addr;
35 
tf_generic_smc(u32 type,u32 arg1,u32 arg2)36 static 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 
tf_set_cpu_boot_addr(int cpu,unsigned long boot_addr)57 static 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 
tf_prepare_idle(unsigned long mode)65 static 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
tf_cache_write_sec(unsigned long val,unsigned int reg)103 static 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 
tf_init_cache(void)135 static 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 
143 static 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 
register_trusted_foundations(struct trusted_foundations_platform_data * pd)151 void 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 
of_register_trusted_foundations(void)160 void 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 
trusted_foundations_registered(void)181 bool trusted_foundations_registered(void)
182 {
183 	return firmware_ops == &trusted_foundations_ops;
184 }
185