projects / deliverable / linux.git / blame
| Commit | Line | Data |
|---|---|---|
| d9a1beaa AC |
1 | /* |
| 2 | * Trusted Foundations support for ARM CPUs | |
| 3 | * | |
| 4 | * Copyright (c) 2013, NVIDIA Corporation. | |
| 5 | * | |
| 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. | |
| 10 | * | |
| 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 | |
| 14 | * more details. | |
| 15 | */ | |
| 16 | ||
| 17 | #include <linux/kernel.h> | |
| 18 | #include <linux/init.h> | |
| 19 | #include <linux/of.h> | |
| 20 | #include <asm/firmware.h> | |
| 21 | #include <asm/trusted_foundations.h> | |
| 22 | ||
| 23 | #define TF_SET_CPU_BOOT_ADDR_SMC 0xfffff200 | |
| 24 | ||
| b77b6e88 AC |
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 | ||
| 32 | static unsigned long cpu_boot_addr; | |
| 33 | ||
| d9a1beaa AC |
34 | static void __naked tf_generic_smc(u32 type, u32 arg1, u32 arg2) |
| 35 | { | |
| 36 | asm volatile( | |
| 37 | ".arch_extension sec\n\t" | |
| 38 | "stmfd sp!, {r4 - r11, lr}\n\t" | |
| 39 | __asmeq("%0", "r0") | |
| 40 | __asmeq("%1", "r1") | |
| 41 | __asmeq("%2", "r2") | |
| 42 | "mov r3, #0\n\t" | |
| 43 | "mov r4, #0\n\t" | |
| 44 | "smc #0\n\t" | |
| 45 | "ldmfd sp!, {r4 - r11, pc}" | |
| 46 | : | |
| 47 | : "r" (type), "r" (arg1), "r" (arg2) | |
| 48 | : "memory"); | |
| 49 | } | |
| 50 | ||
| 51 | static int tf_set_cpu_boot_addr(int cpu, unsigned long boot_addr) | |
| 52 | { | |
| b77b6e88 AC |
53 | cpu_boot_addr = boot_addr; |
| 54 | tf_generic_smc(TF_SET_CPU_BOOT_ADDR_SMC, cpu_boot_addr, 0); | |
| 55 | ||
| 56 | return 0; | |
| 57 | } | |
| 58 | ||
| 59 | static int tf_prepare_idle(void) | |
| 60 | { | |
| 61 | tf_generic_smc(TF_CPU_PM, TF_CPU_PM_S1_NOFLUSH_L2, cpu_boot_addr); | |
| d9a1beaa AC |
62 | |
| 63 | return 0; | |
| 64 | } | |
| 65 | ||
| 66 | static const struct firmware_ops trusted_foundations_ops = { | |
| 67 | .set_cpu_boot_addr = tf_set_cpu_boot_addr, | |
| b77b6e88 | 68 | .prepare_idle = tf_prepare_idle, |
| d9a1beaa AC |
69 | }; |
| 70 | ||
| 71 | void register_trusted_foundations(struct trusted_foundations_platform_data *pd) | |
| 72 | { | |
| 73 | /* | |
| 74 | * we are not using version information for now since currently | |
| 75 | * supported SMCs are compatible with all TF releases | |
| 76 | */ | |
| 77 | register_firmware_ops(&trusted_foundations_ops); | |
| 78 | } | |
| 79 | ||
| 80 | void of_register_trusted_foundations(void) | |
| 81 | { | |
| 82 | struct device_node *node; | |
| 83 | struct trusted_foundations_platform_data pdata; | |
| 84 | int err; | |
| 85 | ||
| 86 | node = of_find_compatible_node(NULL, NULL, "tlm,trusted-foundations"); | |
| 87 | if (!node) | |
| 88 | return; | |
| 89 | ||
| 90 | err = of_property_read_u32(node, "tlm,version-major", | |
| 91 | &pdata.version_major); | |
| 92 | if (err != 0) | |
| 93 | panic("Trusted Foundation: missing version-major property\n"); | |
| 94 | err = of_property_read_u32(node, "tlm,version-minor", | |
| 95 | &pdata.version_minor); | |
| 96 | if (err != 0) | |
| 97 | panic("Trusted Foundation: missing version-minor property\n"); | |
| 98 | register_trusted_foundations(&pdata); | |
| 99 | } |