Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Andrew F. Davis | bb80d4d | 2017-07-10 14:45:50 -0500 | [diff] [blame] | 2 | /* |
| 3 | * Copyright 2016-2017 Texas Instruments, Inc. |
Andrew F. Davis | bb80d4d | 2017-07-10 14:45:50 -0500 | [diff] [blame] | 4 | */ |
| 5 | |
| 6 | #include <common.h> |
Simon Glass | 0f2af88 | 2020-05-10 11:40:05 -0600 | [diff] [blame] | 7 | #include <log.h> |
Masahiro Yamada | 75f82d0 | 2018-03-05 01:20:11 +0900 | [diff] [blame] | 8 | #include <linux/libfdt.h> |
Andrew F. Davis | bb80d4d | 2017-07-10 14:45:50 -0500 | [diff] [blame] | 9 | #include <fdt_support.h> |
| 10 | |
| 11 | #include <asm/omap_common.h> |
| 12 | #include <asm/omap_sec_common.h> |
| 13 | |
| 14 | #ifdef CONFIG_TI_SECURE_DEVICE |
| 15 | |
| 16 | /* Give zero values if not already defined */ |
| 17 | #ifndef TI_OMAP5_SECURE_BOOT_RESV_SRAM_SZ |
| 18 | #define TI_OMAP5_SECURE_BOOT_RESV_SRAM_SZ (0) |
| 19 | #endif |
| 20 | #ifndef CONFIG_SECURE_RUNTIME_RESV_SRAM_SZ |
| 21 | #define CONFIG_SECURE_RUNTIME_RESV_SRAM_SZ (0) |
| 22 | #endif |
| 23 | |
| 24 | int ft_hs_disable_rng(void *fdt, bd_t *bd) |
| 25 | { |
| 26 | const char *path; |
| 27 | int offs; |
| 28 | int ret; |
| 29 | |
| 30 | /* Make HW RNG reserved for secure world use */ |
| 31 | path = "/ocp/rng"; |
| 32 | offs = fdt_path_offset(fdt, path); |
| 33 | if (offs < 0) { |
| 34 | debug("Node %s not found.\n", path); |
| 35 | return 0; |
| 36 | } |
| 37 | ret = fdt_setprop_string(fdt, offs, |
| 38 | "status", "disabled"); |
| 39 | if (ret < 0) { |
| 40 | printf("Could not add status property to node %s: %s\n", |
| 41 | path, fdt_strerror(ret)); |
| 42 | return ret; |
| 43 | } |
| 44 | return 0; |
| 45 | } |
| 46 | |
| 47 | #if (CONFIG_TI_SECURE_EMIF_TOTAL_REGION_SIZE != 0) |
| 48 | /* |
| 49 | * fdt_pack_reg - pack address and size array into the "reg"-suitable stream |
| 50 | */ |
| 51 | static int fdt_pack_reg(const void *fdt, void *buf, u64 address, u64 size) |
| 52 | { |
| 53 | int address_cells = fdt_address_cells(fdt, 0); |
| 54 | int size_cells = fdt_size_cells(fdt, 0); |
| 55 | char *p = buf; |
| 56 | |
| 57 | if (address_cells == 2) |
| 58 | *(fdt64_t *)p = cpu_to_fdt64(address); |
| 59 | else |
| 60 | *(fdt32_t *)p = cpu_to_fdt32(address); |
| 61 | p += 4 * address_cells; |
| 62 | |
| 63 | if (size_cells == 2) |
| 64 | *(fdt64_t *)p = cpu_to_fdt64(size); |
| 65 | else |
| 66 | *(fdt32_t *)p = cpu_to_fdt32(size); |
| 67 | p += 4 * size_cells; |
| 68 | |
| 69 | return p - (char *)buf; |
| 70 | } |
| 71 | |
| 72 | int ft_hs_fixup_dram(void *fdt, bd_t *bd) |
| 73 | { |
| 74 | const char *path, *subpath; |
| 75 | int offs, len; |
| 76 | u32 sec_mem_start = get_sec_mem_start(); |
| 77 | u32 sec_mem_size = CONFIG_TI_SECURE_EMIF_TOTAL_REGION_SIZE; |
| 78 | fdt32_t address_cells = cpu_to_fdt32(fdt_address_cells(fdt, 0)); |
| 79 | fdt32_t size_cells = cpu_to_fdt32(fdt_size_cells(fdt, 0)); |
| 80 | u8 temp[16]; /* Up to 64-bit address + 64-bit size */ |
| 81 | |
| 82 | /* Delete any original secure_reserved node */ |
| 83 | path = "/reserved-memory/secure_reserved"; |
| 84 | offs = fdt_path_offset(fdt, path); |
| 85 | if (offs >= 0) |
| 86 | fdt_del_node(fdt, offs); |
| 87 | |
| 88 | /* Add new secure_reserved node */ |
| 89 | path = "/reserved-memory"; |
| 90 | offs = fdt_path_offset(fdt, path); |
| 91 | if (offs < 0) { |
| 92 | debug("Node %s not found\n", path); |
| 93 | path = "/"; |
| 94 | subpath = "reserved-memory"; |
| 95 | offs = fdt_path_offset(fdt, path); |
| 96 | offs = fdt_add_subnode(fdt, offs, subpath); |
| 97 | if (offs < 0) { |
| 98 | printf("Could not create %s%s node.\n", path, subpath); |
| 99 | return 1; |
| 100 | } |
| 101 | path = "/reserved-memory"; |
| 102 | offs = fdt_path_offset(fdt, path); |
| 103 | |
| 104 | fdt_setprop(fdt, offs, "#address-cells", &address_cells, sizeof(address_cells)); |
| 105 | fdt_setprop(fdt, offs, "#size-cells", &size_cells, sizeof(size_cells)); |
| 106 | fdt_setprop(fdt, offs, "ranges", NULL, 0); |
| 107 | } |
| 108 | |
| 109 | subpath = "secure_reserved"; |
| 110 | offs = fdt_add_subnode(fdt, offs, subpath); |
| 111 | if (offs < 0) { |
| 112 | printf("Could not create %s%s node.\n", path, subpath); |
| 113 | return 1; |
| 114 | } |
| 115 | |
| 116 | fdt_setprop_string(fdt, offs, "compatible", "ti,secure-memory"); |
| 117 | fdt_setprop_string(fdt, offs, "status", "okay"); |
| 118 | fdt_setprop(fdt, offs, "no-map", NULL, 0); |
| 119 | len = fdt_pack_reg(fdt, temp, sec_mem_start, sec_mem_size); |
| 120 | fdt_setprop(fdt, offs, "reg", temp, len); |
| 121 | |
| 122 | return 0; |
| 123 | } |
| 124 | #else |
| 125 | int ft_hs_fixup_dram(void *fdt, bd_t *bd) { return 0; } |
| 126 | #endif |
| 127 | |
| 128 | int ft_hs_add_tee(void *fdt, bd_t *bd) |
| 129 | { |
| 130 | const char *path, *subpath; |
| 131 | int offs; |
| 132 | |
| 133 | extern int tee_loaded; |
| 134 | if (!tee_loaded) |
| 135 | return 0; |
| 136 | |
Andrew F. Davis | 9b3d631 | 2017-07-10 14:45:51 -0500 | [diff] [blame] | 137 | path = "/firmware"; |
Andrew F. Davis | bb80d4d | 2017-07-10 14:45:50 -0500 | [diff] [blame] | 138 | offs = fdt_path_offset(fdt, path); |
Andrew F. Davis | bb80d4d | 2017-07-10 14:45:50 -0500 | [diff] [blame] | 139 | if (offs < 0) { |
Andrew F. Davis | 9b3d631 | 2017-07-10 14:45:51 -0500 | [diff] [blame] | 140 | path = "/"; |
| 141 | offs = fdt_path_offset(fdt, path); |
| 142 | if (offs < 0) { |
| 143 | printf("Could not find root node.\n"); |
| 144 | return 1; |
| 145 | } |
| 146 | |
| 147 | subpath = "firmware"; |
| 148 | offs = fdt_add_subnode(fdt, offs, subpath); |
| 149 | if (offs < 0) { |
| 150 | printf("Could not create %s node.\n", subpath); |
| 151 | return 1; |
| 152 | } |
Andrew F. Davis | bb80d4d | 2017-07-10 14:45:50 -0500 | [diff] [blame] | 153 | } |
| 154 | |
| 155 | subpath = "optee"; |
| 156 | offs = fdt_add_subnode(fdt, offs, subpath); |
| 157 | if (offs < 0) { |
| 158 | printf("Could not create %s node.\n", subpath); |
| 159 | return 1; |
| 160 | } |
| 161 | |
| 162 | fdt_setprop_string(fdt, offs, "compatible", "linaro,optee-tz"); |
| 163 | fdt_setprop_string(fdt, offs, "method", "smc"); |
| 164 | |
| 165 | return 0; |
| 166 | } |
| 167 | |
| 168 | #endif |