1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
203750231SAndrew F. Davis /*
303750231SAndrew F. Davis * Copyright 2016-2017 Texas Instruments, Inc.
403750231SAndrew F. Davis */
503750231SAndrew F. Davis
603750231SAndrew F. Davis #include <common.h>
7b08c8c48SMasahiro Yamada #include <linux/libfdt.h>
803750231SAndrew F. Davis #include <fdt_support.h>
903750231SAndrew F. Davis
1003750231SAndrew F. Davis #include <asm/omap_common.h>
1103750231SAndrew F. Davis #include <asm/omap_sec_common.h>
1203750231SAndrew F. Davis
1303750231SAndrew F. Davis #ifdef CONFIG_TI_SECURE_DEVICE
1403750231SAndrew F. Davis
1503750231SAndrew F. Davis /* Give zero values if not already defined */
1603750231SAndrew F. Davis #ifndef TI_OMAP5_SECURE_BOOT_RESV_SRAM_SZ
1703750231SAndrew F. Davis #define TI_OMAP5_SECURE_BOOT_RESV_SRAM_SZ (0)
1803750231SAndrew F. Davis #endif
1903750231SAndrew F. Davis #ifndef CONFIG_SECURE_RUNTIME_RESV_SRAM_SZ
2003750231SAndrew F. Davis #define CONFIG_SECURE_RUNTIME_RESV_SRAM_SZ (0)
2103750231SAndrew F. Davis #endif
2203750231SAndrew F. Davis
ft_hs_disable_rng(void * fdt,bd_t * bd)2303750231SAndrew F. Davis int ft_hs_disable_rng(void *fdt, bd_t *bd)
2403750231SAndrew F. Davis {
2503750231SAndrew F. Davis const char *path;
2603750231SAndrew F. Davis int offs;
2703750231SAndrew F. Davis int ret;
2803750231SAndrew F. Davis
2903750231SAndrew F. Davis /* Make HW RNG reserved for secure world use */
3003750231SAndrew F. Davis path = "/ocp/rng";
3103750231SAndrew F. Davis offs = fdt_path_offset(fdt, path);
3203750231SAndrew F. Davis if (offs < 0) {
3303750231SAndrew F. Davis debug("Node %s not found.\n", path);
3403750231SAndrew F. Davis return 0;
3503750231SAndrew F. Davis }
3603750231SAndrew F. Davis ret = fdt_setprop_string(fdt, offs,
3703750231SAndrew F. Davis "status", "disabled");
3803750231SAndrew F. Davis if (ret < 0) {
3903750231SAndrew F. Davis printf("Could not add status property to node %s: %s\n",
4003750231SAndrew F. Davis path, fdt_strerror(ret));
4103750231SAndrew F. Davis return ret;
4203750231SAndrew F. Davis }
4303750231SAndrew F. Davis return 0;
4403750231SAndrew F. Davis }
4503750231SAndrew F. Davis
4603750231SAndrew F. Davis #if (CONFIG_TI_SECURE_EMIF_TOTAL_REGION_SIZE != 0)
4703750231SAndrew F. Davis /*
4803750231SAndrew F. Davis * fdt_pack_reg - pack address and size array into the "reg"-suitable stream
4903750231SAndrew F. Davis */
fdt_pack_reg(const void * fdt,void * buf,u64 address,u64 size)5003750231SAndrew F. Davis static int fdt_pack_reg(const void *fdt, void *buf, u64 address, u64 size)
5103750231SAndrew F. Davis {
5203750231SAndrew F. Davis int address_cells = fdt_address_cells(fdt, 0);
5303750231SAndrew F. Davis int size_cells = fdt_size_cells(fdt, 0);
5403750231SAndrew F. Davis char *p = buf;
5503750231SAndrew F. Davis
5603750231SAndrew F. Davis if (address_cells == 2)
5703750231SAndrew F. Davis *(fdt64_t *)p = cpu_to_fdt64(address);
5803750231SAndrew F. Davis else
5903750231SAndrew F. Davis *(fdt32_t *)p = cpu_to_fdt32(address);
6003750231SAndrew F. Davis p += 4 * address_cells;
6103750231SAndrew F. Davis
6203750231SAndrew F. Davis if (size_cells == 2)
6303750231SAndrew F. Davis *(fdt64_t *)p = cpu_to_fdt64(size);
6403750231SAndrew F. Davis else
6503750231SAndrew F. Davis *(fdt32_t *)p = cpu_to_fdt32(size);
6603750231SAndrew F. Davis p += 4 * size_cells;
6703750231SAndrew F. Davis
6803750231SAndrew F. Davis return p - (char *)buf;
6903750231SAndrew F. Davis }
7003750231SAndrew F. Davis
ft_hs_fixup_dram(void * fdt,bd_t * bd)7103750231SAndrew F. Davis int ft_hs_fixup_dram(void *fdt, bd_t *bd)
7203750231SAndrew F. Davis {
7303750231SAndrew F. Davis const char *path, *subpath;
7403750231SAndrew F. Davis int offs, len;
7503750231SAndrew F. Davis u32 sec_mem_start = get_sec_mem_start();
7603750231SAndrew F. Davis u32 sec_mem_size = CONFIG_TI_SECURE_EMIF_TOTAL_REGION_SIZE;
7703750231SAndrew F. Davis fdt32_t address_cells = cpu_to_fdt32(fdt_address_cells(fdt, 0));
7803750231SAndrew F. Davis fdt32_t size_cells = cpu_to_fdt32(fdt_size_cells(fdt, 0));
7903750231SAndrew F. Davis u8 temp[16]; /* Up to 64-bit address + 64-bit size */
8003750231SAndrew F. Davis
8103750231SAndrew F. Davis /* Delete any original secure_reserved node */
8203750231SAndrew F. Davis path = "/reserved-memory/secure_reserved";
8303750231SAndrew F. Davis offs = fdt_path_offset(fdt, path);
8403750231SAndrew F. Davis if (offs >= 0)
8503750231SAndrew F. Davis fdt_del_node(fdt, offs);
8603750231SAndrew F. Davis
8703750231SAndrew F. Davis /* Add new secure_reserved node */
8803750231SAndrew F. Davis path = "/reserved-memory";
8903750231SAndrew F. Davis offs = fdt_path_offset(fdt, path);
9003750231SAndrew F. Davis if (offs < 0) {
9103750231SAndrew F. Davis debug("Node %s not found\n", path);
9203750231SAndrew F. Davis path = "/";
9303750231SAndrew F. Davis subpath = "reserved-memory";
9403750231SAndrew F. Davis offs = fdt_path_offset(fdt, path);
9503750231SAndrew F. Davis offs = fdt_add_subnode(fdt, offs, subpath);
9603750231SAndrew F. Davis if (offs < 0) {
9703750231SAndrew F. Davis printf("Could not create %s%s node.\n", path, subpath);
9803750231SAndrew F. Davis return 1;
9903750231SAndrew F. Davis }
10003750231SAndrew F. Davis path = "/reserved-memory";
10103750231SAndrew F. Davis offs = fdt_path_offset(fdt, path);
10203750231SAndrew F. Davis
10303750231SAndrew F. Davis fdt_setprop(fdt, offs, "#address-cells", &address_cells, sizeof(address_cells));
10403750231SAndrew F. Davis fdt_setprop(fdt, offs, "#size-cells", &size_cells, sizeof(size_cells));
10503750231SAndrew F. Davis fdt_setprop(fdt, offs, "ranges", NULL, 0);
10603750231SAndrew F. Davis }
10703750231SAndrew F. Davis
10803750231SAndrew F. Davis subpath = "secure_reserved";
10903750231SAndrew F. Davis offs = fdt_add_subnode(fdt, offs, subpath);
11003750231SAndrew F. Davis if (offs < 0) {
11103750231SAndrew F. Davis printf("Could not create %s%s node.\n", path, subpath);
11203750231SAndrew F. Davis return 1;
11303750231SAndrew F. Davis }
11403750231SAndrew F. Davis
11503750231SAndrew F. Davis fdt_setprop_string(fdt, offs, "compatible", "ti,secure-memory");
11603750231SAndrew F. Davis fdt_setprop_string(fdt, offs, "status", "okay");
11703750231SAndrew F. Davis fdt_setprop(fdt, offs, "no-map", NULL, 0);
11803750231SAndrew F. Davis len = fdt_pack_reg(fdt, temp, sec_mem_start, sec_mem_size);
11903750231SAndrew F. Davis fdt_setprop(fdt, offs, "reg", temp, len);
12003750231SAndrew F. Davis
12103750231SAndrew F. Davis return 0;
12203750231SAndrew F. Davis }
12303750231SAndrew F. Davis #else
ft_hs_fixup_dram(void * fdt,bd_t * bd)12403750231SAndrew F. Davis int ft_hs_fixup_dram(void *fdt, bd_t *bd) { return 0; }
12503750231SAndrew F. Davis #endif
12603750231SAndrew F. Davis
ft_hs_add_tee(void * fdt,bd_t * bd)12703750231SAndrew F. Davis int ft_hs_add_tee(void *fdt, bd_t *bd)
12803750231SAndrew F. Davis {
12903750231SAndrew F. Davis const char *path, *subpath;
13003750231SAndrew F. Davis int offs;
13103750231SAndrew F. Davis
13203750231SAndrew F. Davis extern int tee_loaded;
13303750231SAndrew F. Davis if (!tee_loaded)
13403750231SAndrew F. Davis return 0;
13503750231SAndrew F. Davis
136137ae0c4SAndrew F. Davis path = "/firmware";
137137ae0c4SAndrew F. Davis offs = fdt_path_offset(fdt, path);
138137ae0c4SAndrew F. Davis if (offs < 0) {
13903750231SAndrew F. Davis path = "/";
14003750231SAndrew F. Davis offs = fdt_path_offset(fdt, path);
141137ae0c4SAndrew F. Davis if (offs < 0) {
142137ae0c4SAndrew F. Davis printf("Could not find root node.\n");
143137ae0c4SAndrew F. Davis return 1;
144137ae0c4SAndrew F. Davis }
14503750231SAndrew F. Davis
14603750231SAndrew F. Davis subpath = "firmware";
14703750231SAndrew F. Davis offs = fdt_add_subnode(fdt, offs, subpath);
14803750231SAndrew F. Davis if (offs < 0) {
14903750231SAndrew F. Davis printf("Could not create %s node.\n", subpath);
15003750231SAndrew F. Davis return 1;
15103750231SAndrew F. Davis }
152137ae0c4SAndrew F. Davis }
15303750231SAndrew F. Davis
15403750231SAndrew F. Davis subpath = "optee";
15503750231SAndrew F. Davis offs = fdt_add_subnode(fdt, offs, subpath);
15603750231SAndrew F. Davis if (offs < 0) {
15703750231SAndrew F. Davis printf("Could not create %s node.\n", subpath);
15803750231SAndrew F. Davis return 1;
15903750231SAndrew F. Davis }
16003750231SAndrew F. Davis
16103750231SAndrew F. Davis fdt_setprop_string(fdt, offs, "compatible", "linaro,optee-tz");
16203750231SAndrew F. Davis fdt_setprop_string(fdt, offs, "method", "smc");
16303750231SAndrew F. Davis
16403750231SAndrew F. Davis return 0;
16503750231SAndrew F. Davis }
16603750231SAndrew F. Davis
16703750231SAndrew F. Davis #endif
168