185 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 * Trusted Foundations support for ARM CPUs4 *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 0xfffff10019 20#define TF_CACHE_ENABLE 121#define TF_CACHE_DISABLE 222#define TF_CACHE_REENABLE 423 24#define TF_SET_CPU_BOOT_ADDR_SMC 0xfffff20025 26#define TF_CPU_PM 0xfffffffc27#define TF_CPU_PM_S3 0xffffffe328#define TF_CPU_PM_S2 0xffffffe629#define TF_CPU_PM_S2_NO_MC_CLK 0xffffffe530#define TF_CPU_PM_S1 0xffffffe431#define TF_CPU_PM_S1_NOFLUSH_L2 0xffffffe732 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_L2X0103static 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 else126 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_L2X0147 .l2x0_init = tf_init_cache,148#endif149};150 151void register_trusted_foundations(struct trusted_foundations_platform_data *pd)152{153 /*154 * we are not using version information for now since currently155 * supported SMCs are compatible with all TF releases156 */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}185