board/freescale/ls1046afrwy/eth.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright 2019 NXP
   4  */
   5 #include <common.h>
   6 #include <asm/io.h>
   7 #include <netdev.h>
   8 #include <fm_eth.h>
   9 #include <fsl_dtsec.h>
  10 #include <fsl_mdio.h>
  11 #include <malloc.h>
  12
  13 #include "../common/fman.h"
  14
  15 int board_eth_init(bd_t *bis)
  16 {
  17 #ifdef CONFIG_FMAN_ENET
  18         struct memac_mdio_info dtsec_mdio_info;
  19         struct mii_dev *dev;
  20         u32 srds_s1;
  21         struct ccsr_gur *gur = (void *)(CONFIG_SYS_FSL_GUTS_ADDR);
  22
  23         srds_s1 = in_be32(&gur->rcwsr[4]) &
  24                         FSL_CHASSIS2_RCWSR4_SRDS1_PRTCL_MASK;
  25         srds_s1 >>= FSL_CHASSIS2_RCWSR4_SRDS1_PRTCL_SHIFT;
  26
  27         dtsec_mdio_info.regs =
  28                 (struct memac_mdio_controller *)CONFIG_SYS_FM1_DTSEC_MDIO_ADDR;
  29
  30         dtsec_mdio_info.name = DEFAULT_FM_MDIO_NAME;
  31
  32         /* Register the 1G MDIO bus */
  33         fm_memac_mdio_init(bis, &dtsec_mdio_info);
  34
  35         /* QSGMII on lane B, MAC 6/5/10/1 */
  36         fm_info_set_phy_address(FM1_DTSEC6, QSGMII_PORT1_PHY_ADDR);
  37         fm_info_set_phy_address(FM1_DTSEC5, QSGMII_PORT2_PHY_ADDR);
  38         fm_info_set_phy_address(FM1_DTSEC10, QSGMII_PORT3_PHY_ADDR);
  39         fm_info_set_phy_address(FM1_DTSEC1, QSGMII_PORT4_PHY_ADDR);
  40
  41         switch (srds_s1) {
  42         case 0x3040:
  43                 break;
  44         default:
  45                 printf("Invalid SerDes protocol 0x%x for LS1046AFRWY\n",
  46                        srds_s1);
  47                 break;
  48         }
  49
  50         dev = miiphy_get_dev_by_name(DEFAULT_FM_MDIO_NAME);
  51         fm_info_set_mdio(FM1_DTSEC6, dev);
  52         fm_info_set_mdio(FM1_DTSEC5, dev);
  53         fm_info_set_mdio(FM1_DTSEC10, dev);
  54         fm_info_set_mdio(FM1_DTSEC1, dev);
  55
  56         fm_disable_port(FM1_DTSEC9);
  57
  58         cpu_eth_init(bis);
  59 #endif
  60
  61         return pci_eth_init(bis);
  62 }
  63
  64 #ifdef CONFIG_FMAN_ENET
  65 int fdt_update_ethernet_dt(void *blob)
  66 {
  67         u32 srds_s1;
  68         int i, prop;
  69         int offset, nodeoff;
  70         const char *path;
  71         struct ccsr_gur *gur = (void *)(CONFIG_SYS_FSL_GUTS_ADDR);
  72
  73         srds_s1 = in_be32(&gur->rcwsr[4]) &
  74                         FSL_CHASSIS2_RCWSR4_SRDS1_PRTCL_MASK;
  75         srds_s1 >>= FSL_CHASSIS2_RCWSR4_SRDS1_PRTCL_SHIFT;
  76
  77         /* Cycle through all aliases */
  78         for (prop = 0; ; prop++) {
  79                 const char *name;
  80
  81                 /* FDT might have been edited, recompute the offset */
  82                 offset = fdt_first_property_offset(blob,
  83                                                    fdt_path_offset(blob,
  84                                                                    "/aliases")
  85                                                    );
  86                 /* Select property number 'prop' */
  87                 for (i = 0; i < prop; i++)
  88                         offset = fdt_next_property_offset(blob, offset);
  89
  90                 if (offset < 0)
  91                         break;
  92
  93                 path = fdt_getprop_by_offset(blob, offset, &name, NULL);
  94                 nodeoff = fdt_path_offset(blob, path);
  95
  96                 switch (srds_s1) {
  97                 case 0x3040:
  98                         if (!strcmp(name, "ethernet1"))
  99                                 fdt_status_disabled(blob, nodeoff);
 100                         if (!strcmp(name, "ethernet2"))
 101                                 fdt_status_disabled(blob, nodeoff);
 102                         if (!strcmp(name, "ethernet3"))
 103                                 fdt_status_disabled(blob, nodeoff);
 104                         if (!strcmp(name, "ethernet6"))
 105                                 fdt_status_disabled(blob, nodeoff);
 106                 break;
 107                 default:
 108                         printf("%s:Invalid SerDes prtcl 0x%x for LS1046AFRWY\n",
 109                                __func__, srds_s1);
 110                 break;
 111                 }
 112         }
 113
 114         return 0;
 115 }
 116 #endif