of_extra.c 3.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157
  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 <log.h>
  8. #include <linux/libfdt.h>
  9. #include <dm/of_access.h>
  10. #include <dm/of_extra.h>
  11. #include <dm/ofnode.h>
  12. int ofnode_read_fmap_entry(ofnode node, struct fmap_entry *entry)
  13. {
  14. const char *prop;
  15. ofnode subnode;
  16. if (ofnode_read_u32(node, "image-pos", &entry->offset)) {
  17. debug("Node '%s' has bad/missing 'image-pos' property\n",
  18. ofnode_get_name(node));
  19. return log_msg_ret("image-pos", -ENOENT);
  20. }
  21. if (ofnode_read_u32(node, "size", &entry->length)) {
  22. debug("Node '%s' has bad/missing 'size' property\n",
  23. ofnode_get_name(node));
  24. return log_msg_ret("size", -ENOENT);
  25. }
  26. entry->used = ofnode_read_s32_default(node, "used", entry->length);
  27. prop = ofnode_read_string(node, "compress");
  28. if (prop) {
  29. if (!strcmp(prop, "lz4"))
  30. entry->compress_algo = FMAP_COMPRESS_LZ4;
  31. else if (!strcmp(prop, "lzma"))
  32. entry->compress_algo = FMAP_COMPRESS_LZMA;
  33. else
  34. return log_msg_ret("compression algo", -EINVAL);
  35. } else {
  36. entry->compress_algo = FMAP_COMPRESS_NONE;
  37. }
  38. entry->unc_length = ofnode_read_s32_default(node, "uncomp-size",
  39. entry->length);
  40. subnode = ofnode_find_subnode(node, "hash");
  41. if (ofnode_valid(subnode)) {
  42. prop = ofnode_read_prop(subnode, "value", &entry->hash_size);
  43. /* Assume it is sha256 */
  44. entry->hash_algo = prop ? FMAP_HASH_SHA256 : FMAP_HASH_NONE;
  45. entry->hash = (uint8_t *)prop;
  46. }
  47. return 0;
  48. }
  49. int ofnode_decode_region(ofnode node, const char *prop_name, fdt_addr_t *basep,
  50. fdt_size_t *sizep)
  51. {
  52. const fdt_addr_t *cell;
  53. int len;
  54. debug("%s: %s: %s\n", __func__, ofnode_get_name(node), prop_name);
  55. cell = ofnode_get_property(node, prop_name, &len);
  56. if (!cell || (len < sizeof(fdt_addr_t) * 2)) {
  57. debug("cell=%p, len=%d\n", cell, len);
  58. return -1;
  59. }
  60. *basep = fdt_addr_to_cpu(*cell);
  61. *sizep = fdt_size_to_cpu(cell[1]);
  62. debug("%s: base=%08lx, size=%lx\n", __func__, (ulong)*basep,
  63. (ulong)*sizep);
  64. return 0;
  65. }
  66. int ofnode_decode_memory_region(ofnode config_node, const char *mem_type,
  67. const char *suffix, fdt_addr_t *basep,
  68. fdt_size_t *sizep)
  69. {
  70. char prop_name[50];
  71. const char *mem;
  72. fdt_size_t size, offset_size;
  73. fdt_addr_t base, offset;
  74. ofnode node;
  75. if (!ofnode_valid(config_node)) {
  76. config_node = ofnode_path("/config");
  77. if (!ofnode_valid(config_node)) {
  78. debug("%s: Cannot find /config node\n", __func__);
  79. return -ENOENT;
  80. }
  81. }
  82. if (!suffix)
  83. suffix = "";
  84. snprintf(prop_name, sizeof(prop_name), "%s-memory%s", mem_type,
  85. suffix);
  86. mem = ofnode_read_string(config_node, prop_name);
  87. if (!mem) {
  88. debug("%s: No memory type for '%s', using /memory\n", __func__,
  89. prop_name);
  90. mem = "/memory";
  91. }
  92. node = ofnode_path(mem);
  93. if (!ofnode_valid(node)) {
  94. debug("%s: Failed to find node '%s'\n", __func__, mem);
  95. return -ENOENT;
  96. }
  97. /*
  98. * Not strictly correct - the memory may have multiple banks. We just
  99. * use the first
  100. */
  101. if (ofnode_decode_region(node, "reg", &base, &size)) {
  102. debug("%s: Failed to decode memory region %s\n", __func__,
  103. mem);
  104. return -EINVAL;
  105. }
  106. snprintf(prop_name, sizeof(prop_name), "%s-offset%s", mem_type,
  107. suffix);
  108. if (ofnode_decode_region(config_node, prop_name, &offset,
  109. &offset_size)) {
  110. debug("%s: Failed to decode memory region '%s'\n", __func__,
  111. prop_name);
  112. return -EINVAL;
  113. }
  114. *basep = base + offset;
  115. *sizep = offset_size;
  116. return 0;
  117. }
  118. bool ofnode_phy_is_fixed_link(ofnode eth_node, ofnode *phy_node)
  119. {
  120. ofnode node, subnode;
  121. int len;
  122. subnode = ofnode_find_subnode(eth_node, "fixed-link");
  123. if (ofnode_valid(subnode)) {
  124. /* new binding */
  125. node = subnode;
  126. } else if (ofnode_get_property(eth_node, "fixed-link", &len) &&
  127. len == (5 * sizeof(__be32))) {
  128. /* old binding */
  129. node = eth_node;
  130. } else {
  131. return false;
  132. }
  133. if (phy_node)
  134. *phy_node = node;
  135. return true;
  136. }