arch/arm/mach-omap2/fdt-common.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright 2016-2017 Texas Instruments, Inc.
   4  */
   5
   6 #include <common.h>
   7 #include <log.h>
   8 #include <linux/libfdt.h>
   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
 137         path = "/firmware";
 138         offs = fdt_path_offset(fdt, path);
 139         if (offs < 0) {
 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                 }
 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