123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308 |
- // SPDX-License-Identifier: GPL-2.0
- /*
- * Copyright (C) 2018 Marvell International Ltd.
- *
- * https://spdx.org/licenses
- */
- #include <errno.h>
- #include <env.h>
- #include <log.h>
- #include <net.h>
- #include <asm/io.h>
- #include <linux/compiler.h>
- #include <linux/libfdt.h>
- #include <fdtdec.h>
- #include <fdt_support.h>
- #include <asm/arch/board.h>
- #include <asm/global_data.h>
- DECLARE_GLOBAL_DATA_PTR;
- static int fdt_get_mdio_bus(const void *fdt, int phy_offset)
- {
- int node, bus = -1;
- const u64 *reg;
- u64 addr;
- if (phy_offset < 0)
- return -1;
- /* obtain mdio node and get the reg prop */
- node = fdt_parent_offset(fdt, phy_offset);
- if (node < 0)
- return -1;
- reg = fdt_getprop(fdt, node, "reg", NULL);
- addr = fdt64_to_cpu(*reg);
- bus = (addr & (1 << 7)) ? 1 : 0;
- return bus;
- }
- static int fdt_get_phy_addr(const void *fdt, int phy_offset)
- {
- const u32 *reg;
- int addr = -1;
- if (phy_offset < 0)
- return -1;
- reg = fdt_getprop(fdt, phy_offset, "reg", NULL);
- addr = fdt32_to_cpu(*reg);
- return addr;
- }
- void fdt_parse_phy_info(void)
- {
- const void *fdt = gd->fdt_blob;
- int offset = 0, node, bgx_id = 0, lmacid = 0;
- const u32 *val;
- char bgxname[24];
- int len, rgx_id = 0, eth_id = 0;
- int phandle, phy_offset;
- int subnode, i;
- int bdknode;
- bdknode = fdt_path_offset(fdt, "/cavium,bdk");
- if (bdknode < 0) {
- printf("%s: bdk node is missing from device tree: %s\n",
- __func__, fdt_strerror(bdknode));
- }
- offset = fdt_node_offset_by_compatible(fdt, -1, "pci-bridge");
- if (offset < 1)
- return;
- for (bgx_id = 0; bgx_id < MAX_BGX_PER_NODE; bgx_id++) {
- int phy_addr[LMAC_CNT] = {[0 ... LMAC_CNT - 1] = -1};
- bool autoneg_dis[LMAC_CNT] = {[0 ... LMAC_CNT - 1] = 0};
- int mdio_bus[LMAC_CNT] = {[0 ... LMAC_CNT - 1] = -1};
- bool lmac_reg[LMAC_CNT] = {[0 ... LMAC_CNT - 1] = 0};
- bool lmac_enable[LMAC_CNT] = {[0 ... LMAC_CNT - 1] = 0};
- snprintf(bgxname, sizeof(bgxname), "bgx%d", bgx_id);
- node = fdt_subnode_offset(fdt, offset, bgxname);
- if (node < 0) {
- /* check if it is rgx node */
- snprintf(bgxname, sizeof(bgxname), "rgx%d", rgx_id);
- node = fdt_subnode_offset(fdt, offset, bgxname);
- if (node < 0) {
- debug("bgx%d/rgx0 node not found\n", bgx_id);
- return;
- }
- }
- debug("bgx%d node found\n", bgx_id);
- /*
- * loop through each of the bgx/rgx nodes
- * to find PHY nodes
- */
- fdt_for_each_subnode(subnode, fdt, node) {
- /* Check for reg property */
- val = fdt_getprop(fdt, subnode, "reg", &len);
- if (val) {
- debug("lmacid = %d\n", lmacid);
- lmac_reg[lmacid] = 1;
- }
- /* check for phy-handle property */
- val = fdt_getprop(fdt, subnode, "phy-handle", &len);
- if (val) {
- phandle = fdt32_to_cpu(*val);
- if (!phandle) {
- debug("phandle not valid %d\n", lmacid);
- } else {
- phy_offset = fdt_node_offset_by_phandle
- (fdt, phandle);
- phy_addr[lmacid] = fdt_get_phy_addr
- (fdt, phy_offset);
- mdio_bus[lmacid] = fdt_get_mdio_bus
- (fdt, phy_offset);
- }
- } else {
- debug("phy-handle prop not found %d\n",
- lmacid);
- }
- /* check for autonegotiation property */
- val = fdt_getprop(fdt, subnode,
- "cavium,disable-autonegotiation",
- &len);
- if (val)
- autoneg_dis[lmacid] = 1;
- eth_id++;
- lmacid++;
- }
- for (i = 0; i < MAX_LMAC_PER_BGX; i++) {
- const char *str;
- snprintf(bgxname, sizeof(bgxname),
- "BGX-ENABLE.N0.BGX%d.P%d", bgx_id, i);
- if (bdknode >= 0) {
- str = fdt_getprop(fdt, bdknode,
- bgxname, &len);
- if (str)
- lmac_enable[i] =
- simple_strtol(str, NULL,
- 10);
- }
- }
- lmacid = 0;
- bgx_set_board_info(bgx_id, mdio_bus, phy_addr,
- autoneg_dis, lmac_reg, lmac_enable);
- }
- }
- static int fdt_get_bdk_node(void)
- {
- int node, ret;
- const void *fdt = gd->fdt_blob;
- if (!fdt) {
- printf("ERROR: %s: no valid device tree found\n", __func__);
- return 0;
- }
- ret = fdt_check_header(fdt);
- if (ret < 0) {
- printf("fdt: %s\n", fdt_strerror(ret));
- return 0;
- }
- node = fdt_path_offset(fdt, "/cavium,bdk");
- if (node < 0) {
- printf("%s: /cavium,bdk is missing from device tree: %s\n",
- __func__, fdt_strerror(node));
- return 0;
- }
- return node;
- }
- const char *fdt_get_board_serial(void)
- {
- const void *fdt = gd->fdt_blob;
- int node, len = 64;
- const char *str = NULL;
- node = fdt_get_bdk_node();
- if (!node)
- return NULL;
- str = fdt_getprop(fdt, node, "BOARD-SERIAL", &len);
- if (!str)
- printf("Error: cannot retrieve board serial from fdt\n");
- return str;
- }
- const char *fdt_get_board_revision(void)
- {
- const void *fdt = gd->fdt_blob;
- int node, len = 64;
- const char *str = NULL;
- node = fdt_get_bdk_node();
- if (!node)
- return NULL;
- str = fdt_getprop(fdt, node, "BOARD-REVISION", &len);
- if (!str)
- printf("Error: cannot retrieve board revision from fdt\n");
- return str;
- }
- const char *fdt_get_board_model(void)
- {
- const void *fdt = gd->fdt_blob;
- int node, len = 16;
- const char *str = NULL;
- node = fdt_get_bdk_node();
- if (!node)
- return NULL;
- str = fdt_getprop(fdt, node, "BOARD-MODEL", &len);
- if (!str)
- printf("Error: cannot retrieve board model from fdt\n");
- return str;
- }
- void fdt_board_get_ethaddr(int bgx, int lmac, unsigned char *eth)
- {
- const void *fdt = gd->fdt_blob;
- const char *mac = NULL;
- int offset = 0, node, len;
- int subnode, i = 0;
- char bgxname[24];
- offset = fdt_node_offset_by_compatible(fdt, -1, "pci-bridge");
- if (offset < 0) {
- printf("%s couldn't find mrml bridge node in fdt\n",
- __func__);
- return;
- }
- if (bgx == 2 && otx_is_soc(CN81XX)) {
- snprintf(bgxname, sizeof(bgxname), "rgx%d", 0);
- lmac = 0;
- } else {
- snprintf(bgxname, sizeof(bgxname), "bgx%d", bgx);
- }
- node = fdt_subnode_offset(fdt, offset, bgxname);
- fdt_for_each_subnode(subnode, fdt, node) {
- if (i++ != lmac)
- continue;
- /* check for local-mac-address */
- mac = fdt_getprop(fdt, subnode, "local-mac-address", &len);
- if (mac) {
- debug("%s mac %pM\n", __func__, mac);
- memcpy(eth, mac, ARP_HLEN);
- } else {
- memset(eth, 0, ARP_HLEN);
- }
- debug("%s eth %pM\n", __func__, eth);
- return;
- }
- }
- int arch_fixup_memory_node(void *blob)
- {
- return 0;
- }
- int ft_board_setup(void *blob, struct bd_info *bd)
- {
- /* remove "cavium, bdk" node from DT */
- int ret = 0, offset;
- ret = fdt_check_header(blob);
- if (ret < 0) {
- printf("ERROR: %s\n", fdt_strerror(ret));
- return ret;
- }
- if (blob) {
- /* delete cavium,bdk node if it exists */
- offset = fdt_path_offset(blob, "/cavium,bdk");
- if (offset >= 0) {
- ret = fdt_del_node(blob, offset);
- if (ret < 0) {
- printf("WARNING : could not remove bdk node\n");
- return ret;
- }
- debug("%s deleted bdk node\n", __func__);
- }
- }
- return 0;
- }
- /**
- * Return the FDT base address that was passed by ATF
- *
- * @return FDT base address received from ATF in x1 register
- */
- void *board_fdt_blob_setup(int *err)
- {
- *err = 0;
- return (void *)fdt_base_addr;
- }
|