of_extra.c 3.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (c) 2017 Google, Inc
  4. * Written by Simon Glass <sjg@chromium.org>
  5. */
  6. #include <common.h>
  7. #include <linux/libfdt.h>
  8. #include <dm/of_access.h>
  9. #include <dm/of_extra.h>
  10. #include <dm/ofnode.h>
  11. int ofnode_read_fmap_entry(ofnode node, struct fmap_entry *entry)
  12. {
  13. const char *prop;
  14. if (ofnode_read_u32(node, "image-pos", &entry->offset)) {
  15. debug("Node '%s' has bad/missing 'image-pos' property\n",
  16. ofnode_get_name(node));
  17. return log_ret(-ENOENT);
  18. }
  19. if (ofnode_read_u32(node, "size", &entry->length)) {
  20. debug("Node '%s' has bad/missing 'size' property\n",
  21. ofnode_get_name(node));
  22. return log_ret(-ENOENT);
  23. }
  24. entry->used = ofnode_read_s32_default(node, "used", entry->length);
  25. prop = ofnode_read_string(node, "compress");
  26. if (prop) {
  27. if (!strcmp(prop, "lz4"))
  28. entry->compress_algo = FMAP_COMPRESS_LZ4;
  29. else
  30. return log_msg_ret("Unknown compression algo",
  31. -EINVAL);
  32. } else {
  33. entry->compress_algo = FMAP_COMPRESS_NONE;
  34. }
  35. entry->unc_length = ofnode_read_s32_default(node, "uncomp-size",
  36. entry->length);
  37. prop = ofnode_read_string(node, "hash");
  38. if (prop)
  39. entry->hash_size = strlen(prop);
  40. entry->hash_algo = prop ? FMAP_HASH_SHA256 : FMAP_HASH_NONE;
  41. entry->hash = (uint8_t *)prop;
  42. return 0;
  43. }
  44. int ofnode_decode_region(ofnode node, const char *prop_name, fdt_addr_t *basep,
  45. fdt_size_t *sizep)
  46. {
  47. const fdt_addr_t *cell;
  48. int len;
  49. debug("%s: %s: %s\n", __func__, ofnode_get_name(node), prop_name);
  50. cell = ofnode_get_property(node, prop_name, &len);
  51. if (!cell || (len < sizeof(fdt_addr_t) * 2)) {
  52. debug("cell=%p, len=%d\n", cell, len);
  53. return -1;
  54. }
  55. *basep = fdt_addr_to_cpu(*cell);
  56. *sizep = fdt_size_to_cpu(cell[1]);
  57. debug("%s: base=%08lx, size=%lx\n", __func__, (ulong)*basep,
  58. (ulong)*sizep);
  59. return 0;
  60. }
  61. int ofnode_decode_memory_region(ofnode config_node, const char *mem_type,
  62. const char *suffix, fdt_addr_t *basep,
  63. fdt_size_t *sizep)
  64. {
  65. char prop_name[50];
  66. const char *mem;
  67. fdt_size_t size, offset_size;
  68. fdt_addr_t base, offset;
  69. ofnode node;
  70. if (!ofnode_valid(config_node)) {
  71. config_node = ofnode_path("/config");
  72. if (!ofnode_valid(config_node)) {
  73. debug("%s: Cannot find /config node\n", __func__);
  74. return -ENOENT;
  75. }
  76. }
  77. if (!suffix)
  78. suffix = "";
  79. snprintf(prop_name, sizeof(prop_name), "%s-memory%s", mem_type,
  80. suffix);
  81. mem = ofnode_read_string(config_node, prop_name);
  82. if (!mem) {
  83. debug("%s: No memory type for '%s', using /memory\n", __func__,
  84. prop_name);
  85. mem = "/memory";
  86. }
  87. node = ofnode_path(mem);
  88. if (!ofnode_valid(node)) {
  89. debug("%s: Failed to find node '%s'\n", __func__, mem);
  90. return -ENOENT;
  91. }
  92. /*
  93. * Not strictly correct - the memory may have multiple banks. We just
  94. * use the first
  95. */
  96. if (ofnode_decode_region(node, "reg", &base, &size)) {
  97. debug("%s: Failed to decode memory region %s\n", __func__,
  98. mem);
  99. return -EINVAL;
  100. }
  101. snprintf(prop_name, sizeof(prop_name), "%s-offset%s", mem_type,
  102. suffix);
  103. if (ofnode_decode_region(config_node, prop_name, &offset,
  104. &offset_size)) {
  105. debug("%s: Failed to decode memory region '%s'\n", __func__,
  106. prop_name);
  107. return -EINVAL;
  108. }
  109. *basep = base + offset;
  110. *sizep = offset_size;
  111. return 0;
  112. }