board-fdt.c 6.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Copyright (C) 2018 Marvell International Ltd.
  4. *
  5. * https://spdx.org/licenses
  6. */
  7. #include <errno.h>
  8. #include <env.h>
  9. #include <log.h>
  10. #include <net.h>
  11. #include <asm/io.h>
  12. #include <linux/compiler.h>
  13. #include <linux/libfdt.h>
  14. #include <fdtdec.h>
  15. #include <fdt_support.h>
  16. #include <asm/arch/board.h>
  17. #include <asm/global_data.h>
  18. DECLARE_GLOBAL_DATA_PTR;
  19. static int fdt_get_mdio_bus(const void *fdt, int phy_offset)
  20. {
  21. int node, bus = -1;
  22. const u64 *reg;
  23. u64 addr;
  24. if (phy_offset < 0)
  25. return -1;
  26. /* obtain mdio node and get the reg prop */
  27. node = fdt_parent_offset(fdt, phy_offset);
  28. if (node < 0)
  29. return -1;
  30. reg = fdt_getprop(fdt, node, "reg", NULL);
  31. addr = fdt64_to_cpu(*reg);
  32. bus = (addr & (1 << 7)) ? 1 : 0;
  33. return bus;
  34. }
  35. static int fdt_get_phy_addr(const void *fdt, int phy_offset)
  36. {
  37. const u32 *reg;
  38. int addr = -1;
  39. if (phy_offset < 0)
  40. return -1;
  41. reg = fdt_getprop(fdt, phy_offset, "reg", NULL);
  42. addr = fdt32_to_cpu(*reg);
  43. return addr;
  44. }
  45. void fdt_parse_phy_info(void)
  46. {
  47. const void *fdt = gd->fdt_blob;
  48. int offset = 0, node, bgx_id = 0, lmacid = 0;
  49. const u32 *val;
  50. char bgxname[24];
  51. int len, rgx_id = 0, eth_id = 0;
  52. int phandle, phy_offset;
  53. int subnode, i;
  54. int bdknode;
  55. bdknode = fdt_path_offset(fdt, "/cavium,bdk");
  56. if (bdknode < 0) {
  57. printf("%s: bdk node is missing from device tree: %s\n",
  58. __func__, fdt_strerror(bdknode));
  59. }
  60. offset = fdt_node_offset_by_compatible(fdt, -1, "pci-bridge");
  61. if (offset < 1)
  62. return;
  63. for (bgx_id = 0; bgx_id < MAX_BGX_PER_NODE; bgx_id++) {
  64. int phy_addr[LMAC_CNT] = {[0 ... LMAC_CNT - 1] = -1};
  65. bool autoneg_dis[LMAC_CNT] = {[0 ... LMAC_CNT - 1] = 0};
  66. int mdio_bus[LMAC_CNT] = {[0 ... LMAC_CNT - 1] = -1};
  67. bool lmac_reg[LMAC_CNT] = {[0 ... LMAC_CNT - 1] = 0};
  68. bool lmac_enable[LMAC_CNT] = {[0 ... LMAC_CNT - 1] = 0};
  69. snprintf(bgxname, sizeof(bgxname), "bgx%d", bgx_id);
  70. node = fdt_subnode_offset(fdt, offset, bgxname);
  71. if (node < 0) {
  72. /* check if it is rgx node */
  73. snprintf(bgxname, sizeof(bgxname), "rgx%d", rgx_id);
  74. node = fdt_subnode_offset(fdt, offset, bgxname);
  75. if (node < 0) {
  76. debug("bgx%d/rgx0 node not found\n", bgx_id);
  77. return;
  78. }
  79. }
  80. debug("bgx%d node found\n", bgx_id);
  81. /*
  82. * loop through each of the bgx/rgx nodes
  83. * to find PHY nodes
  84. */
  85. fdt_for_each_subnode(subnode, fdt, node) {
  86. /* Check for reg property */
  87. val = fdt_getprop(fdt, subnode, "reg", &len);
  88. if (val) {
  89. debug("lmacid = %d\n", lmacid);
  90. lmac_reg[lmacid] = 1;
  91. }
  92. /* check for phy-handle property */
  93. val = fdt_getprop(fdt, subnode, "phy-handle", &len);
  94. if (val) {
  95. phandle = fdt32_to_cpu(*val);
  96. if (!phandle) {
  97. debug("phandle not valid %d\n", lmacid);
  98. } else {
  99. phy_offset = fdt_node_offset_by_phandle
  100. (fdt, phandle);
  101. phy_addr[lmacid] = fdt_get_phy_addr
  102. (fdt, phy_offset);
  103. mdio_bus[lmacid] = fdt_get_mdio_bus
  104. (fdt, phy_offset);
  105. }
  106. } else {
  107. debug("phy-handle prop not found %d\n",
  108. lmacid);
  109. }
  110. /* check for autonegotiation property */
  111. val = fdt_getprop(fdt, subnode,
  112. "cavium,disable-autonegotiation",
  113. &len);
  114. if (val)
  115. autoneg_dis[lmacid] = 1;
  116. eth_id++;
  117. lmacid++;
  118. }
  119. for (i = 0; i < MAX_LMAC_PER_BGX; i++) {
  120. const char *str;
  121. snprintf(bgxname, sizeof(bgxname),
  122. "BGX-ENABLE.N0.BGX%d.P%d", bgx_id, i);
  123. if (bdknode >= 0) {
  124. str = fdt_getprop(fdt, bdknode,
  125. bgxname, &len);
  126. if (str)
  127. lmac_enable[i] =
  128. simple_strtol(str, NULL,
  129. 10);
  130. }
  131. }
  132. lmacid = 0;
  133. bgx_set_board_info(bgx_id, mdio_bus, phy_addr,
  134. autoneg_dis, lmac_reg, lmac_enable);
  135. }
  136. }
  137. static int fdt_get_bdk_node(void)
  138. {
  139. int node, ret;
  140. const void *fdt = gd->fdt_blob;
  141. if (!fdt) {
  142. printf("ERROR: %s: no valid device tree found\n", __func__);
  143. return 0;
  144. }
  145. ret = fdt_check_header(fdt);
  146. if (ret < 0) {
  147. printf("fdt: %s\n", fdt_strerror(ret));
  148. return 0;
  149. }
  150. node = fdt_path_offset(fdt, "/cavium,bdk");
  151. if (node < 0) {
  152. printf("%s: /cavium,bdk is missing from device tree: %s\n",
  153. __func__, fdt_strerror(node));
  154. return 0;
  155. }
  156. return node;
  157. }
  158. const char *fdt_get_board_serial(void)
  159. {
  160. const void *fdt = gd->fdt_blob;
  161. int node, len = 64;
  162. const char *str = NULL;
  163. node = fdt_get_bdk_node();
  164. if (!node)
  165. return NULL;
  166. str = fdt_getprop(fdt, node, "BOARD-SERIAL", &len);
  167. if (!str)
  168. printf("Error: cannot retrieve board serial from fdt\n");
  169. return str;
  170. }
  171. const char *fdt_get_board_revision(void)
  172. {
  173. const void *fdt = gd->fdt_blob;
  174. int node, len = 64;
  175. const char *str = NULL;
  176. node = fdt_get_bdk_node();
  177. if (!node)
  178. return NULL;
  179. str = fdt_getprop(fdt, node, "BOARD-REVISION", &len);
  180. if (!str)
  181. printf("Error: cannot retrieve board revision from fdt\n");
  182. return str;
  183. }
  184. const char *fdt_get_board_model(void)
  185. {
  186. const void *fdt = gd->fdt_blob;
  187. int node, len = 16;
  188. const char *str = NULL;
  189. node = fdt_get_bdk_node();
  190. if (!node)
  191. return NULL;
  192. str = fdt_getprop(fdt, node, "BOARD-MODEL", &len);
  193. if (!str)
  194. printf("Error: cannot retrieve board model from fdt\n");
  195. return str;
  196. }
  197. void fdt_board_get_ethaddr(int bgx, int lmac, unsigned char *eth)
  198. {
  199. const void *fdt = gd->fdt_blob;
  200. const char *mac = NULL;
  201. int offset = 0, node, len;
  202. int subnode, i = 0;
  203. char bgxname[24];
  204. offset = fdt_node_offset_by_compatible(fdt, -1, "pci-bridge");
  205. if (offset < 0) {
  206. printf("%s couldn't find mrml bridge node in fdt\n",
  207. __func__);
  208. return;
  209. }
  210. if (bgx == 2 && otx_is_soc(CN81XX)) {
  211. snprintf(bgxname, sizeof(bgxname), "rgx%d", 0);
  212. lmac = 0;
  213. } else {
  214. snprintf(bgxname, sizeof(bgxname), "bgx%d", bgx);
  215. }
  216. node = fdt_subnode_offset(fdt, offset, bgxname);
  217. fdt_for_each_subnode(subnode, fdt, node) {
  218. if (i++ != lmac)
  219. continue;
  220. /* check for local-mac-address */
  221. mac = fdt_getprop(fdt, subnode, "local-mac-address", &len);
  222. if (mac) {
  223. debug("%s mac %pM\n", __func__, mac);
  224. memcpy(eth, mac, ARP_HLEN);
  225. } else {
  226. memset(eth, 0, ARP_HLEN);
  227. }
  228. debug("%s eth %pM\n", __func__, eth);
  229. return;
  230. }
  231. }
  232. int arch_fixup_memory_node(void *blob)
  233. {
  234. return 0;
  235. }
  236. int ft_board_setup(void *blob, struct bd_info *bd)
  237. {
  238. /* remove "cavium, bdk" node from DT */
  239. int ret = 0, offset;
  240. ret = fdt_check_header(blob);
  241. if (ret < 0) {
  242. printf("ERROR: %s\n", fdt_strerror(ret));
  243. return ret;
  244. }
  245. if (blob) {
  246. /* delete cavium,bdk node if it exists */
  247. offset = fdt_path_offset(blob, "/cavium,bdk");
  248. if (offset >= 0) {
  249. ret = fdt_del_node(blob, offset);
  250. if (ret < 0) {
  251. printf("WARNING : could not remove bdk node\n");
  252. return ret;
  253. }
  254. debug("%s deleted bdk node\n", __func__);
  255. }
  256. }
  257. return 0;
  258. }
  259. /**
  260. * Return the FDT base address that was passed by ATF
  261. *
  262. * @return FDT base address received from ATF in x1 register
  263. */
  264. void *board_fdt_blob_setup(int *err)
  265. {
  266. *err = 0;
  267. return (void *)fdt_base_addr;
  268. }