2 * Trusted Foundations support for ARM CPUs
4 * Copyright (c) 2013, NVIDIA Corporation.
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful, but WITHOUT
12 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
13 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
17 #include <linux/kernel.h>
18 #include <linux/init.h>
21 #include <linux/firmware/trusted_foundations.h>
23 #include <asm/firmware.h>
24 #include <asm/hardware/cache-l2x0.h>
25 #include <asm/outercache.h>
27 #define TF_CACHE_MAINT 0xfffff100
29 #define TF_CACHE_ENABLE 1
30 #define TF_CACHE_DISABLE 2
32 #define TF_SET_CPU_BOOT_ADDR_SMC 0xfffff200
34 #define TF_CPU_PM 0xfffffffc
35 #define TF_CPU_PM_S3 0xffffffe3
36 #define TF_CPU_PM_S2 0xffffffe6
37 #define TF_CPU_PM_S2_NO_MC_CLK 0xffffffe5
38 #define TF_CPU_PM_S1 0xffffffe4
39 #define TF_CPU_PM_S1_NOFLUSH_L2 0xffffffe7
41 static unsigned long cpu_boot_addr;
43 static void tf_generic_smc(u32 type, u32 arg1, u32 arg2)
45 register u32 r0 asm("r0") = type;
46 register u32 r1 asm("r1") = arg1;
47 register u32 r2 asm("r2") = arg2;
50 ".arch_extension sec\n\t"
51 "stmfd sp!, {r4 - r11}\n\t"
58 "ldmfd sp!, {r4 - r11}\n\t"
60 : "r" (r0), "r" (r1), "r" (r2)
61 : "memory", "r3", "r12", "lr");
64 static int tf_set_cpu_boot_addr(int cpu, unsigned long boot_addr)
66 cpu_boot_addr = boot_addr;
67 tf_generic_smc(TF_SET_CPU_BOOT_ADDR_SMC, cpu_boot_addr, 0);
72 static int tf_prepare_idle(unsigned long mode)
76 tf_generic_smc(TF_CPU_PM, TF_CPU_PM_S3, cpu_boot_addr);
80 tf_generic_smc(TF_CPU_PM, TF_CPU_PM_S2, cpu_boot_addr);
83 case TF_PM_MODE_LP1_NO_MC_CLK:
84 tf_generic_smc(TF_CPU_PM, TF_CPU_PM_S2_NO_MC_CLK,
89 tf_generic_smc(TF_CPU_PM, TF_CPU_PM_S1, cpu_boot_addr);
92 case TF_PM_MODE_LP2_NOFLUSH_L2:
93 tf_generic_smc(TF_CPU_PM, TF_CPU_PM_S1_NOFLUSH_L2,
104 #ifdef CONFIG_CACHE_L2X0
105 static void tf_cache_write_sec(unsigned long val, unsigned int reg)
107 u32 l2x0_way_mask = 0xff;
111 if (l2x0_saved_regs.aux_ctrl & L310_AUX_CTRL_ASSOCIATIVITY_16)
112 l2x0_way_mask = 0xffff;
114 if (val == L2X0_CTRL_EN)
115 tf_generic_smc(TF_CACHE_MAINT, TF_CACHE_ENABLE,
116 l2x0_saved_regs.aux_ctrl);
118 tf_generic_smc(TF_CACHE_MAINT, TF_CACHE_DISABLE,
127 static int tf_init_cache(void)
129 outer_cache.write_sec = tf_cache_write_sec;
133 #endif /* CONFIG_CACHE_L2X0 */
135 static const struct firmware_ops trusted_foundations_ops = {
136 .set_cpu_boot_addr = tf_set_cpu_boot_addr,
137 .prepare_idle = tf_prepare_idle,
138 #ifdef CONFIG_CACHE_L2X0
139 .l2x0_init = tf_init_cache,
143 void register_trusted_foundations(struct trusted_foundations_platform_data *pd)
146 * we are not using version information for now since currently
147 * supported SMCs are compatible with all TF releases
149 register_firmware_ops(&trusted_foundations_ops);
152 void of_register_trusted_foundations(void)
154 struct device_node *node;
155 struct trusted_foundations_platform_data pdata;
158 node = of_find_compatible_node(NULL, NULL, "tlm,trusted-foundations");
162 err = of_property_read_u32(node, "tlm,version-major",
163 &pdata.version_major);
165 panic("Trusted Foundation: missing version-major property\n");
166 err = of_property_read_u32(node, "tlm,version-minor",
167 &pdata.version_minor);
169 panic("Trusted Foundation: missing version-minor property\n");
170 register_trusted_foundations(&pdata);
173 bool trusted_foundations_registered(void)
175 return firmware_ops == &trusted_foundations_ops;