fdt.c 6.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright 2019 NXP
  4. */
  5. #include <common.h>
  6. #include <log.h>
  7. #include <asm/arch/sci/sci.h>
  8. #include <asm/arch/sys_proto.h>
  9. #include <dm/ofnode.h>
  10. #include <fdt_support.h>
  11. #include <linux/libfdt.h>
  12. DECLARE_GLOBAL_DATA_PTR;
  13. static bool check_owned_resource(sc_rsrc_t rsrc_id)
  14. {
  15. bool owned;
  16. owned = sc_rm_is_resource_owned(-1, rsrc_id);
  17. return owned;
  18. }
  19. static int disable_fdt_node(void *blob, int nodeoffset)
  20. {
  21. int rc, ret;
  22. const char *status = "disabled";
  23. do {
  24. rc = fdt_setprop(blob, nodeoffset, "status", status,
  25. strlen(status) + 1);
  26. if (rc) {
  27. if (rc == -FDT_ERR_NOSPACE) {
  28. ret = fdt_increase_size(blob, 512);
  29. if (ret)
  30. return ret;
  31. }
  32. }
  33. } while (rc == -FDT_ERR_NOSPACE);
  34. return rc;
  35. }
  36. static void update_fdt_with_owned_resources(void *blob)
  37. {
  38. /*
  39. * Traverses the fdt nodes, check its power domain and use
  40. * the resource id in the power domain for checking whether
  41. * it is owned by current partition
  42. */
  43. struct fdtdec_phandle_args args;
  44. int offset = 0, depth = 0;
  45. u32 rsrc_id;
  46. int rc, i;
  47. for (offset = fdt_next_node(blob, offset, &depth); offset > 0;
  48. offset = fdt_next_node(blob, offset, &depth)) {
  49. debug("Node name: %s, depth %d\n",
  50. fdt_get_name(blob, offset, NULL), depth);
  51. if (!fdt_get_property(blob, offset, "power-domains", NULL)) {
  52. debug(" - ignoring node %s\n",
  53. fdt_get_name(blob, offset, NULL));
  54. continue;
  55. }
  56. if (!fdtdec_get_is_enabled(blob, offset)) {
  57. debug(" - ignoring node %s\n",
  58. fdt_get_name(blob, offset, NULL));
  59. continue;
  60. }
  61. i = 0;
  62. while (true) {
  63. rc = fdtdec_parse_phandle_with_args(blob, offset,
  64. "power-domains",
  65. "#power-domain-cells",
  66. 0, i++, &args);
  67. if (rc == -ENOENT) {
  68. break;
  69. } else if (rc) {
  70. printf("Parse power-domains of %s wrong: %d\n",
  71. fdt_get_name(blob, offset, NULL), rc);
  72. continue;
  73. }
  74. rsrc_id = args.args[0];
  75. if (!check_owned_resource(rsrc_id)) {
  76. rc = disable_fdt_node(blob, offset);
  77. if (!rc) {
  78. printf("Disable %s rsrc %u not owned\n",
  79. fdt_get_name(blob, offset, NULL),
  80. rsrc_id);
  81. } else {
  82. printf("Unable to disable %s, err=%s\n",
  83. fdt_get_name(blob, offset, NULL),
  84. fdt_strerror(rc));
  85. }
  86. }
  87. }
  88. }
  89. }
  90. static int config_smmu_resource_sid(int rsrc, int sid)
  91. {
  92. int err;
  93. err = sc_rm_set_master_sid(-1, rsrc, sid);
  94. debug("set_master_sid rsrc=%d sid=0x%x err=%d\n", rsrc, sid, err);
  95. if (err != SC_ERR_NONE) {
  96. if (!check_owned_resource(rsrc)) {
  97. printf("%s rsrc[%d] not owned\n", __func__, rsrc);
  98. return -1;
  99. }
  100. pr_err("fail set_master_sid rsrc=%d sid=0x%x err=%d\n", rsrc, sid, err);
  101. return -EINVAL;
  102. }
  103. return 0;
  104. }
  105. static int config_smmu_fdt_device_sid(void *blob, int device_offset, int sid)
  106. {
  107. const char *name = fdt_get_name(blob, device_offset, NULL);
  108. struct fdtdec_phandle_args args;
  109. int rsrc, ret;
  110. int proplen;
  111. const fdt32_t *prop;
  112. int i;
  113. prop = fdt_getprop(blob, device_offset, "fsl,sc_rsrc_id", &proplen);
  114. if (prop) {
  115. int i;
  116. debug("configure node %s sid 0x%x for %d resources\n",
  117. name, sid, (int)(proplen / sizeof(fdt32_t)));
  118. for (i = 0; i < proplen / sizeof(fdt32_t); ++i) {
  119. ret = config_smmu_resource_sid(fdt32_to_cpu(prop[i]),
  120. sid);
  121. if (ret)
  122. return ret;
  123. }
  124. return 0;
  125. }
  126. i = 0;
  127. while (true) {
  128. ret = fdtdec_parse_phandle_with_args(blob, device_offset,
  129. "power-domains",
  130. "#power-domain-cells",
  131. 0, i++, &args);
  132. if (ret == -ENOENT) {
  133. break;
  134. } else if (ret) {
  135. printf("Parse power-domains of node %s wrong: %d\n",
  136. fdt_get_name(blob, device_offset, NULL), ret);
  137. continue;
  138. }
  139. debug("configure node %s sid 0x%x rsrc=%d\n",
  140. name, sid, rsrc);
  141. rsrc = args.args[0];
  142. ret = config_smmu_resource_sid(rsrc, sid);
  143. if (ret)
  144. break;
  145. }
  146. return ret;
  147. }
  148. static int config_smmu_fdt(void *blob)
  149. {
  150. int offset, proplen, i, ret;
  151. const fdt32_t *prop;
  152. const char *name;
  153. /* Legacy smmu bindings, still used by xen. */
  154. offset = fdt_node_offset_by_compatible(blob, 0, "arm,mmu-500");
  155. prop = fdt_getprop(blob, offset, "mmu-masters", &proplen);
  156. if (offset > 0 && prop) {
  157. debug("found legacy mmu-masters property\n");
  158. for (i = 0; i < proplen / 8; ++i) {
  159. u32 phandle = fdt32_to_cpu(prop[2 * i]);
  160. int sid = fdt32_to_cpu(prop[2 * i + 1]);
  161. int device_offset;
  162. device_offset = fdt_node_offset_by_phandle(blob,
  163. phandle);
  164. if (device_offset < 0) {
  165. pr_err("Not find device from mmu_masters: %d",
  166. device_offset);
  167. continue;
  168. }
  169. ret = config_smmu_fdt_device_sid(blob, device_offset,
  170. sid);
  171. if (ret)
  172. return ret;
  173. }
  174. /* Ignore new bindings if old bindings found, just like linux. */
  175. return 0;
  176. }
  177. /* Generic smmu bindings */
  178. offset = 0;
  179. while ((offset = fdt_next_node(blob, offset, NULL)) > 0) {
  180. name = fdt_get_name(blob, offset, NULL);
  181. prop = fdt_getprop(blob, offset, "iommus", &proplen);
  182. if (!prop)
  183. continue;
  184. debug("node %s iommus proplen %d\n", name, proplen);
  185. if (proplen == 12) {
  186. int sid = fdt32_to_cpu(prop[1]);
  187. config_smmu_fdt_device_sid(blob, offset, sid);
  188. } else if (proplen != 4) {
  189. debug("node %s ignore unexpected iommus proplen=%d\n",
  190. name, proplen);
  191. }
  192. }
  193. return 0;
  194. }
  195. static int ft_add_optee_node(void *fdt, struct bd_info *bd)
  196. {
  197. const char *path, *subpath;
  198. int offs;
  199. /*
  200. * No TEE space allocated indicating no TEE running, so no
  201. * need to add optee node in dts
  202. */
  203. if (!boot_pointer[1])
  204. return 0;
  205. offs = fdt_increase_size(fdt, 512);
  206. if (offs) {
  207. printf("No Space for dtb\n");
  208. return 1;
  209. }
  210. path = "/firmware";
  211. offs = fdt_path_offset(fdt, path);
  212. if (offs < 0) {
  213. path = "/";
  214. offs = fdt_path_offset(fdt, path);
  215. if (offs < 0) {
  216. printf("Could not find root node.\n");
  217. return offs;
  218. }
  219. subpath = "firmware";
  220. offs = fdt_add_subnode(fdt, offs, subpath);
  221. if (offs < 0) {
  222. printf("Could not create %s node.\n", subpath);
  223. return offs;
  224. }
  225. }
  226. subpath = "optee";
  227. offs = fdt_add_subnode(fdt, offs, subpath);
  228. if (offs < 0) {
  229. printf("Could not create %s node.\n", subpath);
  230. return offs;
  231. }
  232. fdt_setprop_string(fdt, offs, "compatible", "linaro,optee-tz");
  233. fdt_setprop_string(fdt, offs, "method", "smc");
  234. return 0;
  235. }
  236. int ft_system_setup(void *blob, struct bd_info *bd)
  237. {
  238. int ret;
  239. int off;
  240. if (CONFIG_BOOTAUX_RESERVED_MEM_BASE) {
  241. off = fdt_add_mem_rsv(blob, CONFIG_BOOTAUX_RESERVED_MEM_BASE,
  242. CONFIG_BOOTAUX_RESERVED_MEM_SIZE);
  243. if (off < 0)
  244. printf("Failed to reserve memory for bootaux: %s\n",
  245. fdt_strerror(off));
  246. }
  247. update_fdt_with_owned_resources(blob);
  248. if (is_imx8qm()) {
  249. ret = config_smmu_fdt(blob);
  250. if (ret)
  251. return ret;
  252. }
  253. return ft_add_optee_node(blob, bd);
  254. }