fdt.c 6.7 KB

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