drivers/net/fm/init.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright 2011-2015 Freescale Semiconductor, Inc.
   4  */
   5 #include <errno.h>
   6 #include <common.h>
   7 #include <net.h>
   8 #include <asm/io.h>
   9 #include <fdt_support.h>
  10 #include <fsl_mdio.h>
  11 #ifdef CONFIG_FSL_LAYERSCAPE
  12 #include <asm/arch/fsl_serdes.h>
  13 #else
  14 #include <asm/fsl_serdes.h>
  15 #endif
  16
  17 #include "fm.h"
  18
  19 #ifndef CONFIG_DM_ETH
  20 struct fm_eth_info fm_info[] = {
  21 #if (CONFIG_SYS_NUM_FM1_DTSEC >= 1)
  22         FM_DTSEC_INFO_INITIALIZER(1, 1),
  23 #endif
  24 #if (CONFIG_SYS_NUM_FM1_DTSEC >= 2)
  25         FM_DTSEC_INFO_INITIALIZER(1, 2),
  26 #endif
  27 #if (CONFIG_SYS_NUM_FM1_DTSEC >= 3)
  28         FM_DTSEC_INFO_INITIALIZER(1, 3),
  29 #endif
  30 #if (CONFIG_SYS_NUM_FM1_DTSEC >= 4)
  31         FM_DTSEC_INFO_INITIALIZER(1, 4),
  32 #endif
  33 #if (CONFIG_SYS_NUM_FM1_DTSEC >= 5)
  34         FM_DTSEC_INFO_INITIALIZER(1, 5),
  35 #endif
  36 #if (CONFIG_SYS_NUM_FM1_DTSEC >= 6)
  37         FM_DTSEC_INFO_INITIALIZER(1, 6),
  38 #endif
  39 #if (CONFIG_SYS_NUM_FM1_DTSEC >= 7)
  40         FM_DTSEC_INFO_INITIALIZER(1, 9),
  41 #endif
  42 #if (CONFIG_SYS_NUM_FM1_DTSEC >= 8)
  43         FM_DTSEC_INFO_INITIALIZER(1, 10),
  44 #endif
  45 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 1)
  46         FM_DTSEC_INFO_INITIALIZER(2, 1),
  47 #endif
  48 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 2)
  49         FM_DTSEC_INFO_INITIALIZER(2, 2),
  50 #endif
  51 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 3)
  52         FM_DTSEC_INFO_INITIALIZER(2, 3),
  53 #endif
  54 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 4)
  55         FM_DTSEC_INFO_INITIALIZER(2, 4),
  56 #endif
  57 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 5)
  58         FM_DTSEC_INFO_INITIALIZER(2, 5),
  59 #endif
  60 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 6)
  61         FM_DTSEC_INFO_INITIALIZER(2, 6),
  62 #endif
  63 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 7)
  64         FM_DTSEC_INFO_INITIALIZER(2, 9),
  65 #endif
  66 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 8)
  67         FM_DTSEC_INFO_INITIALIZER(2, 10),
  68 #endif
  69 #if (CONFIG_SYS_NUM_FM1_10GEC >= 1)
  70         FM_TGEC_INFO_INITIALIZER(1, 1),
  71 #endif
  72 #if (CONFIG_SYS_NUM_FM1_10GEC >= 2)
  73         FM_TGEC_INFO_INITIALIZER(1, 2),
  74 #endif
  75 #if (CONFIG_SYS_NUM_FM1_10GEC >= 3)
  76         FM_TGEC_INFO_INITIALIZER2(1, 3),
  77 #endif
  78 #if (CONFIG_SYS_NUM_FM1_10GEC >= 4)
  79         FM_TGEC_INFO_INITIALIZER2(1, 4),
  80 #endif
  81 #if (CONFIG_SYS_NUM_FM2_10GEC >= 1)
  82         FM_TGEC_INFO_INITIALIZER(2, 1),
  83 #endif
  84 #if (CONFIG_SYS_NUM_FM2_10GEC >= 2)
  85         FM_TGEC_INFO_INITIALIZER(2, 2),
  86 #endif
  87 };
  88
  89 int fm_standard_init(bd_t *bis)
  90 {
  91         int i;
  92         struct ccsr_fman *reg;
  93
  94         reg = (void *)CONFIG_SYS_FSL_FM1_ADDR;
  95         if (fm_init_common(0, reg))
  96                 return 0;
  97
  98         for (i = 0; i < ARRAY_SIZE(fm_info); i++) {
  99                 if ((fm_info[i].enabled) && (fm_info[i].index == 1))
 100                         fm_eth_initialize(reg, &fm_info[i]);
 101         }
 102
 103 #if (CONFIG_SYS_NUM_FMAN == 2)
 104         reg = (void *)CONFIG_SYS_FSL_FM2_ADDR;
 105         if (fm_init_common(1, reg))
 106                 return 0;
 107
 108         for (i = 0; i < ARRAY_SIZE(fm_info); i++) {
 109                 if ((fm_info[i].enabled) && (fm_info[i].index == 2))
 110                         fm_eth_initialize(reg, &fm_info[i]);
 111         }
 112 #endif
 113
 114         return 1;
 115 }
 116
 117 /* simple linear search to map from port to array index */
 118 static int fm_port_to_index(enum fm_port port)
 119 {
 120         int i;
 121
 122         for (i = 0; i < ARRAY_SIZE(fm_info); i++) {
 123                 if (fm_info[i].port == port)
 124                         return i;
 125         }
 126
 127         return -1;
 128 }
 129
 130 /*
 131  * Determine if an interface is actually active based on HW config
 132  * we expect fman_port_enet_if() to report PHY_INTERFACE_MODE_NONE if
 133  * the interface is not active based on HW cfg of the SoC
 134  */
 135 void fman_enet_init(void)
 136 {
 137         int i;
 138
 139         for (i = 0; i < ARRAY_SIZE(fm_info); i++) {
 140                 phy_interface_t enet_if;
 141
 142                 enet_if = fman_port_enet_if(fm_info[i].port);
 143                 if (enet_if != PHY_INTERFACE_MODE_NONE) {
 144                         fm_info[i].enabled = 1;
 145                         fm_info[i].enet_if = enet_if;
 146                 } else {
 147                         fm_info[i].enabled = 0;
 148                 }
 149         }
 150
 151         return ;
 152 }
 153
 154 void fm_disable_port(enum fm_port port)
 155 {
 156         int i = fm_port_to_index(port);
 157
 158         if (i == -1)
 159                 return;
 160
 161         fm_info[i].enabled = 0;
 162 #ifndef CONFIG_SYS_FMAN_V3
 163         fman_disable_port(port);
 164 #endif
 165 }
 166
 167 void fm_enable_port(enum fm_port port)
 168 {
 169         int i = fm_port_to_index(port);
 170
 171         if (i == -1)
 172                 return;
 173
 174         fm_info[i].enabled = 1;
 175         fman_enable_port(port);
 176 }
 177
 178 void fm_info_set_mdio(enum fm_port port, struct mii_dev *bus)
 179 {
 180         int i = fm_port_to_index(port);
 181
 182         if (i == -1)
 183                 return;
 184
 185         fm_info[i].bus = bus;
 186 }
 187
 188 void fm_info_set_phy_address(enum fm_port port, int address)
 189 {
 190         int i = fm_port_to_index(port);
 191
 192         if (i == -1)
 193                 return;
 194
 195         fm_info[i].phy_addr = address;
 196 }
 197
 198 /*
 199  * Returns the PHY address for a given Fman port
 200  *
 201  * The port must be set via a prior call to fm_info_set_phy_address().
 202  * A negative error code is returned if the port is invalid.
 203  */
 204 int fm_info_get_phy_address(enum fm_port port)
 205 {
 206         int i = fm_port_to_index(port);
 207
 208         if (i == -1)
 209                 return -1;
 210
 211         return fm_info[i].phy_addr;
 212 }
 213
 214 /*
 215  * Returns the type of the data interface between the given MAC and its PHY.
 216  * This is typically determined by the RCW.
 217  */
 218 phy_interface_t fm_info_get_enet_if(enum fm_port port)
 219 {
 220         int i = fm_port_to_index(port);
 221
 222         if (i == -1)
 223                 return PHY_INTERFACE_MODE_NONE;
 224
 225         if (fm_info[i].enabled)
 226                 return fm_info[i].enet_if;
 227
 228         return PHY_INTERFACE_MODE_NONE;
 229 }
 230
 231 static void
 232 __def_board_ft_fman_fixup_port(void *blob, char * prop, phys_addr_t pa,
 233                                 enum fm_port port, int offset)
 234 {
 235         return ;
 236 }
 237
 238 void board_ft_fman_fixup_port(void *blob, char * prop, phys_addr_t pa,
 239                                 enum fm_port port, int offset)
 240          __attribute__((weak, alias("__def_board_ft_fman_fixup_port")));
 241
 242 int ft_fixup_port(void *blob, struct fm_eth_info *info, char *prop)
 243 {
 244         int off;
 245         uint32_t ph;
 246         phys_addr_t paddr = CONFIG_SYS_CCSRBAR_PHYS + info->compat_offset;
 247 #ifndef CONFIG_SYS_FMAN_V3
 248         u64 dtsec1_addr = (u64)CONFIG_SYS_CCSRBAR_PHYS +
 249                                 CONFIG_SYS_FSL_FM1_DTSEC1_OFFSET;
 250 #endif
 251
 252         off = fdt_node_offset_by_compat_reg(blob, prop, paddr);
 253         if (off == -FDT_ERR_NOTFOUND)
 254                 return -EINVAL;
 255
 256         if (info->enabled) {
 257                 fdt_fixup_phy_connection(blob, off, info->enet_if);
 258                 board_ft_fman_fixup_port(blob, prop, paddr, info->port, off);
 259                 return 0;
 260         }
 261
 262 #ifdef CONFIG_SYS_FMAN_V3
 263 #ifndef CONFIG_FSL_FM_10GEC_REGULAR_NOTATION
 264         /*
 265          * On T2/T4 SoCs, physically FM1_DTSEC9 and FM1_10GEC1 use the same
 266          * dual-role MAC, when FM1_10GEC1 is enabled and  FM1_DTSEC9
 267          * is disabled, ensure that the dual-role MAC is not disabled,
 268          * ditto for other dual-role MACs.
 269          */
 270         if (((info->port == FM1_DTSEC9) && (PORT_IS_ENABLED(FM1_10GEC1)))  ||
 271             ((info->port == FM1_DTSEC10) && (PORT_IS_ENABLED(FM1_10GEC2))) ||
 272             ((info->port == FM1_DTSEC1) && (PORT_IS_ENABLED(FM1_10GEC3)))  ||
 273             ((info->port == FM1_DTSEC2) && (PORT_IS_ENABLED(FM1_10GEC4)))  ||
 274             ((info->port == FM1_10GEC1) && (PORT_IS_ENABLED(FM1_DTSEC9)))  ||
 275             ((info->port == FM1_10GEC2) && (PORT_IS_ENABLED(FM1_DTSEC10))) ||
 276             ((info->port == FM1_10GEC3) && (PORT_IS_ENABLED(FM1_DTSEC1)))  ||
 277             ((info->port == FM1_10GEC4) && (PORT_IS_ENABLED(FM1_DTSEC2)))
 278 #if (CONFIG_SYS_NUM_FMAN == 2)
 279                                                                                 ||
 280             ((info->port == FM2_DTSEC9) && (PORT_IS_ENABLED(FM2_10GEC1)))       ||
 281             ((info->port == FM2_DTSEC10) && (PORT_IS_ENABLED(FM2_10GEC2)))      ||
 282             ((info->port == FM2_10GEC1) && (PORT_IS_ENABLED(FM2_DTSEC9)))       ||
 283             ((info->port == FM2_10GEC2) && (PORT_IS_ENABLED(FM2_DTSEC10)))
 284 #endif
 285 #else
 286         /* FM1_DTSECx and FM1_10GECx use the same dual-role MAC */
 287         if (((info->port == FM1_DTSEC1) && (PORT_IS_ENABLED(FM1_10GEC1)))  ||
 288             ((info->port == FM1_DTSEC2) && (PORT_IS_ENABLED(FM1_10GEC2)))  ||
 289             ((info->port == FM1_DTSEC3) && (PORT_IS_ENABLED(FM1_10GEC3)))  ||
 290             ((info->port == FM1_DTSEC4) && (PORT_IS_ENABLED(FM1_10GEC4)))  ||
 291             ((info->port == FM1_10GEC1) && (PORT_IS_ENABLED(FM1_DTSEC1)))  ||
 292             ((info->port == FM1_10GEC2) && (PORT_IS_ENABLED(FM1_DTSEC2)))  ||
 293             ((info->port == FM1_10GEC3) && (PORT_IS_ENABLED(FM1_DTSEC3)))  ||
 294             ((info->port == FM1_10GEC4) && (PORT_IS_ENABLED(FM1_DTSEC4)))
 295 #endif
 296         )
 297                 return 0;
 298 #endif
 299         /* board code might have caused offset to change */
 300         off = fdt_node_offset_by_compat_reg(blob, prop, paddr);
 301
 302 #ifndef CONFIG_SYS_FMAN_V3
 303         /* Don't disable FM1-DTSEC1 MAC as its used for MDIO */
 304         if (paddr != dtsec1_addr)
 305 #endif
 306                 fdt_status_disabled(blob, off); /* disable the MAC node */
 307
 308         /* disable the fsl,dpa-ethernet node that points to the MAC */
 309         ph = fdt_get_phandle(blob, off);
 310         do_fixup_by_prop(blob, "fsl,fman-mac", &ph, sizeof(ph),
 311                 "status", "disabled", strlen("disabled") + 1, 1);
 312
 313         return 0;
 314 }
 315
 316 void fdt_fixup_fman_ethernet(void *blob)
 317 {
 318         int i;
 319
 320 #ifdef CONFIG_SYS_FMAN_V3
 321         for (i = 0; i < ARRAY_SIZE(fm_info); i++)
 322                 ft_fixup_port(blob, &fm_info[i], "fsl,fman-memac");
 323 #else
 324         for (i = 0; i < ARRAY_SIZE(fm_info); i++) {
 325                 /* Try the new compatible first.
 326                  * If the node is missing, try the old.
 327                  */
 328                 if (fm_info[i].type == FM_ETH_1G_E) {
 329                         if (ft_fixup_port(blob, &fm_info[i], "fsl,fman-dtsec"))
 330                                 ft_fixup_port(blob, &fm_info[i],
 331                                               "fsl,fman-1g-mac");
 332                 } else {
 333                         if (ft_fixup_port(blob, &fm_info[i], "fsl,fman-xgec") &&
 334                             ft_fixup_port(blob, &fm_info[i], "fsl,fman-tgec"))
 335                                 ft_fixup_port(blob, &fm_info[i],
 336                                               "fsl,fman-10g-mac");
 337                 }
 338         }
 339 #endif
 340 }
 341
 342 /*QSGMII Riser Card can work in SGMII mode, but the PHY address is different.
 343  *This function scans which Riser Card being used(QSGMII or SGMII Riser Card),
 344  *then set the correct PHY address
 345  */
 346 void set_sgmii_phy(struct mii_dev *bus, enum fm_port base_port,
 347                 unsigned int port_num, int phy_base_addr)
 348 {
 349         unsigned int regnum = 0;
 350         int qsgmii;
 351         int i;
 352         int phy_real_addr;
 353
 354         qsgmii = is_qsgmii_riser_card(bus, phy_base_addr, port_num, regnum);
 355
 356         if (!qsgmii)
 357                 return;
 358
 359         for (i = base_port; i < base_port + port_num; i++) {
 360                 if (fm_info_get_enet_if(i) == PHY_INTERFACE_MODE_SGMII) {
 361                         phy_real_addr = phy_base_addr + i - base_port;
 362                         fm_info_set_phy_address(i, phy_real_addr);
 363                 }
 364         }
 365 }
 366
 367 /*to check whether qsgmii riser card is used*/
 368 int is_qsgmii_riser_card(struct mii_dev *bus, int phy_base_addr,
 369                 unsigned int port_num, unsigned regnum)
 370 {
 371         int i;
 372         int val;
 373
 374         if (!bus)
 375                 return 0;
 376
 377         for (i = phy_base_addr; i < phy_base_addr + port_num; i++) {
 378                 val = bus->read(bus, i, MDIO_DEVAD_NONE, regnum);
 379                 if (val != MIIM_TIMEOUT)
 380                         return 1;
 381         }
 382
 383         return 0;
 384 }
 385 #endif /* CONFIG_DM_ETH */