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