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 <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
  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  */
  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
  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
 124 int ft_hs_fixup_dram(void *fdt, bd_t *bd) { return 0; }
 125 #endif
 126
 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