Home | History | Annotate | Download | only in corenet_ds
      1 // SPDX-License-Identifier: GPL-2.0+
      2 /*
      3  * Copyright 2009-2011 Freescale Semiconductor, Inc.
      4  * Author: Timur Tabi <timur (at) freescale.com>
      5  */
      6 
      7 /*
      8  * This file handles the board muxing between the Fman Ethernet MACs and
      9  * the RGMII/SGMII/XGMII PHYs on a Freescale P3041/P5020 "Hydra" reference
     10  * board. The RGMII PHYs are the two on-board 1Gb ports.  The SGMII PHYs are
     11  * provided by the standard Freescale four-port SGMII riser card.  The 10Gb
     12  * XGMII PHY is provided via the XAUI riser card.  Since there is only one
     13  * Fman device on a P3041 and P5020, we only support one SGMII card and one
     14  * RGMII card.
     15  *
     16  * Muxing is handled via the PIXIS BRDCFG1 register.  The EMI1 bits control
     17  * muxing among the RGMII PHYs and the SGMII PHYs.  The value for RGMII is
     18  * always the same (0).  The value for SGMII depends on which slot the riser is
     19  * inserted in.  The EMI2 bits control muxing for the the XGMII.  Like SGMII,
     20  * the value is based on which slot the XAUI is inserted in.
     21  *
     22  * The SERDES configuration is used to determine where the SGMII and XAUI cards
     23  * exist, and also which Fman MACs are routed to which PHYs.  So for a given
     24  * Fman MAC, there is one and only PHY it connects to.  MACs cannot be routed
     25  * to PHYs dynamically.
     26  *
     27  *
     28  * This file also updates the device tree in three ways:
     29  *
     30  * 1) The status of each virtual MDIO node that is referenced by an Ethernet
     31  *    node is set to "okay".
     32  *
     33  * 2) The phy-handle property of each active Ethernet MAC node is set to the
     34  *    appropriate PHY node.
     35  *
     36  * 3) The "mux value" for each virtual MDIO node is set to the correct value,
     37  *    if necessary.  Some virtual MDIO nodes do not have configurable mux
     38  *    values, so those values are hard-coded in the DTS.  On the HYDRA board,
     39  *    the virtual MDIO node for the SGMII card needs to be updated.
     40  *
     41  * For all this to work, the device tree needs to have the following:
     42  *
     43  * 1) An alias for each PHY node that an Ethernet node could be routed to.
     44  *
     45  * 2) An alias for each real and virtual MDIO node that is disabled by default
     46  * and might need to be enabled, and also might need to have its mux-value
     47  * updated.
     48  */
     49 
     50 #include <common.h>
     51 #include <netdev.h>
     52 #include <asm/fsl_serdes.h>
     53 #include <fm_eth.h>
     54 #include <fsl_mdio.h>
     55 #include <malloc.h>
     56 #include <fdt_support.h>
     57 #include <fsl_dtsec.h>
     58 
     59 #include "../common/ngpixis.h"
     60 #include "../common/fman.h"
     61 
     62 #ifdef CONFIG_FMAN_ENET
     63 
     64 #define BRDCFG1_EMI1_SEL_MASK	0x78
     65 #define BRDCFG1_EMI1_SEL_SLOT1	0x10
     66 #define BRDCFG1_EMI1_SEL_SLOT2	0x20
     67 #define BRDCFG1_EMI1_SEL_SLOT5	0x30
     68 #define BRDCFG1_EMI1_SEL_SLOT6	0x40
     69 #define BRDCFG1_EMI1_SEL_SLOT7	0x50
     70 #define BRDCFG1_EMI1_SEL_RGMII	0x00
     71 #define BRDCFG1_EMI1_EN		0x08
     72 #define BRDCFG1_EMI2_SEL_MASK	0x06
     73 #define BRDCFG1_EMI2_SEL_SLOT1	0x00
     74 #define BRDCFG1_EMI2_SEL_SLOT2	0x02
     75 
     76 #define BRDCFG2_REG_GPIO_SEL	0x20
     77 
     78 #define PHY_BASE_ADDR		0x00
     79 
     80 /*
     81  * BRDCFG1 mask and value for each MAC
     82  *
     83  * This array contains the BRDCFG1 values (in mask/val format) that route the
     84  * MDIO bus to a particular RGMII or SGMII PHY.
     85  */
     86 struct {
     87 	u8 mask;
     88 	u8 val;
     89 } mdio_mux[NUM_FM_PORTS];
     90 
     91 /*
     92  * Mapping of all 18 SERDES lanes to board slots. A value of '0' here means
     93  * that the mapping must be determined dynamically, or that the lane maps to
     94  * something other than a board slot
     95  */
     96 static u8 lane_to_slot[] = {
     97 	7, 7, 0, 0, 0, 0, 0, 0, 0, 0, 2, 2, 2, 2, 1, 1, 0, 0
     98 };
     99 
    100 /*
    101  * Set the board muxing for a given MAC
    102  *
    103  * The MDIO layer calls this function every time it wants to talk to a PHY.
    104  */
    105 void hydra_mux_mdio(u8 mask, u8 val)
    106 {
    107 	clrsetbits_8(&pixis->brdcfg1, mask, val);
    108 }
    109 
    110 struct hydra_mdio {
    111 	u8 mask;
    112 	u8 val;
    113 	struct mii_dev *realbus;
    114 };
    115 
    116 static int hydra_mdio_read(struct mii_dev *bus, int addr, int devad,
    117 				int regnum)
    118 {
    119 	struct hydra_mdio *priv = bus->priv;
    120 
    121 	hydra_mux_mdio(priv->mask, priv->val);
    122 
    123 	return priv->realbus->read(priv->realbus, addr, devad, regnum);
    124 }
    125 
    126 static int hydra_mdio_write(struct mii_dev *bus, int addr, int devad,
    127 				int regnum, u16 value)
    128 {
    129 	struct hydra_mdio *priv = bus->priv;
    130 
    131 	hydra_mux_mdio(priv->mask, priv->val);
    132 
    133 	return priv->realbus->write(priv->realbus, addr, devad, regnum, value);
    134 }
    135 
    136 static int hydra_mdio_reset(struct mii_dev *bus)
    137 {
    138 	struct hydra_mdio *priv = bus->priv;
    139 
    140 	return priv->realbus->reset(priv->realbus);
    141 }
    142 
    143 static void hydra_mdio_set_mux(char *name, u8 mask, u8 val)
    144 {
    145 	struct mii_dev *bus = miiphy_get_dev_by_name(name);
    146 	struct hydra_mdio *priv = bus->priv;
    147 
    148 	priv->mask = mask;
    149 	priv->val = val;
    150 }
    151 
    152 static int hydra_mdio_init(char *realbusname, char *fakebusname)
    153 {
    154 	struct hydra_mdio *hmdio;
    155 	struct mii_dev *bus = mdio_alloc();
    156 
    157 	if (!bus) {
    158 		printf("Failed to allocate Hydra MDIO bus\n");
    159 		return -1;
    160 	}
    161 
    162 	hmdio = malloc(sizeof(*hmdio));
    163 	if (!hmdio) {
    164 		printf("Failed to allocate Hydra private data\n");
    165 		free(bus);
    166 		return -1;
    167 	}
    168 
    169 	bus->read = hydra_mdio_read;
    170 	bus->write = hydra_mdio_write;
    171 	bus->reset = hydra_mdio_reset;
    172 	strcpy(bus->name, fakebusname);
    173 
    174 	hmdio->realbus = miiphy_get_dev_by_name(realbusname);
    175 
    176 	if (!hmdio->realbus) {
    177 		printf("No bus with name %s\n", realbusname);
    178 		free(bus);
    179 		free(hmdio);
    180 		return -1;
    181 	}
    182 
    183 	bus->priv = hmdio;
    184 
    185 	return mdio_register(bus);
    186 }
    187 
    188 /*
    189  * Given an alias or a path for a node, set the mux value of that node.
    190  *
    191  * If 'alias' is not a valid alias, then it is treated as a full path to the
    192  * node.  No error checking is performed.
    193  *
    194  * This function is normally called to set the fsl,hydra-mdio-muxval property
    195  * of a virtual MDIO node.
    196  */
    197 static void fdt_set_mdio_mux(void *fdt, const char *alias, u32 mux)
    198 {
    199 	const char *path = fdt_get_alias(fdt, alias);
    200 
    201 	if (!path)
    202 		path = alias;
    203 
    204 	do_fixup_by_path(fdt, path, "reg",
    205 			 &mux, sizeof(mux), 1);
    206 	do_fixup_by_path(fdt, path, "fsl,hydra-mdio-muxval",
    207 			 &mux, sizeof(mux), 1);
    208 }
    209 
    210 /*
    211  * Given the following ...
    212  *
    213  * 1) A pointer to an Fman Ethernet node (as identified by the 'compat'
    214  * compatible string and 'addr' physical address)
    215  *
    216  * 2) An Fman port
    217  *
    218  * ... update the phy-handle property of the Ethernet node to point to the
    219  * right PHY.  This assumes that we already know the PHY for each port.  That
    220  * information is stored in mdio_mux[].
    221  *
    222  * The offset of the Fman Ethernet node is also passed in for convenience, but
    223  * it is not used, and we recalculate the offset anyway.
    224  *
    225  * Note that what we call "Fman ports" (enum fm_port) is really an Fman MAC.
    226  * Inside the Fman, "ports" are things that connect to MACs.  We only call them
    227  * ports in U-Boot because on previous Ethernet devices (e.g. Gianfar), MACs
    228  * and ports are the same thing.
    229  *
    230  * Note that this code would be cleaner if had a function called
    231  * fm_info_get_phy_address(), which returns a value from the fm1_dtsec_info[]
    232  * array.  That's because all we're doing is figuring out the PHY address for
    233  * a given Fman MAC and writing it to the device tree.  Well, we already did
    234  * the hard work to figure that out in board_eth_init(), so it's silly to
    235  * repeat that here.
    236  */
    237 void board_ft_fman_fixup_port(void *fdt, char *compat, phys_addr_t addr,
    238 			      enum fm_port port, int offset)
    239 {
    240 	unsigned int mux = mdio_mux[port].val & mdio_mux[port].mask;
    241 	char phy[16];
    242 
    243 	if (port == FM1_10GEC1) {
    244 		/* XAUI */
    245 		int lane = serdes_get_first_lane(XAUI_FM1);
    246 		if (lane >= 0) {
    247 			/* The XAUI PHY is identified by the slot */
    248 			sprintf(phy, "phy_xgmii_%u", lane_to_slot[lane]);
    249 			fdt_set_phy_handle(fdt, compat, addr, phy);
    250 		}
    251 		return;
    252 	}
    253 
    254 	if (mux == (BRDCFG1_EMI1_SEL_RGMII | BRDCFG1_EMI1_EN)) {
    255 		/* RGMII */
    256 		/* The RGMII PHY is identified by the MAC connected to it */
    257 		sprintf(phy, "phy_rgmii_%u", port == FM1_DTSEC4 ? 0 : 1);
    258 		fdt_set_phy_handle(fdt, compat, addr, phy);
    259 		return;
    260 	}
    261 
    262 	/* If it's not RGMII or XGMII, it must be SGMII */
    263 	if (mux) {
    264 		/* The SGMII PHY is identified by the MAC connected to it */
    265 		sprintf(phy, "phy_sgmii_%x",
    266 			CONFIG_SYS_FM1_DTSEC1_PHY_ADDR + (port - FM1_DTSEC1));
    267 		fdt_set_phy_handle(fdt, compat, addr, phy);
    268 	}
    269 }
    270 
    271 #define PIXIS_SW2_LANE_23_SEL		0x80
    272 #define PIXIS_SW2_LANE_45_SEL		0x40
    273 #define PIXIS_SW2_LANE_67_SEL_MASK	0x30
    274 #define PIXIS_SW2_LANE_67_SEL_5		0x00
    275 #define PIXIS_SW2_LANE_67_SEL_6		0x20
    276 #define PIXIS_SW2_LANE_67_SEL_7		0x10
    277 #define PIXIS_SW2_LANE_8_SEL		0x08
    278 #define PIXIS_SW2_LANE_1617_SEL		0x04
    279 
    280 /*
    281  * Initialize the lane_to_slot[] array.
    282  *
    283  * On the P4080DS "Expedition" board, the mapping of SERDES lanes to board
    284  * slots is hard-coded.  On the Hydra board, however, the mapping is controlled
    285  * by board switch SW2, so the lane_to_slot[] array needs to be dynamically
    286  * initialized.
    287  */
    288 static void initialize_lane_to_slot(void)
    289 {
    290 	u8 sw2 = in_8(&PIXIS_SW(2));
    291 
    292 	lane_to_slot[2] = (sw2 & PIXIS_SW2_LANE_23_SEL) ? 7 : 4;
    293 	lane_to_slot[3] = lane_to_slot[2];
    294 
    295 	lane_to_slot[4] = (sw2 & PIXIS_SW2_LANE_45_SEL) ? 7 : 6;
    296 	lane_to_slot[5] = lane_to_slot[4];
    297 
    298 	switch (sw2 & PIXIS_SW2_LANE_67_SEL_MASK) {
    299 	case PIXIS_SW2_LANE_67_SEL_5:
    300 		lane_to_slot[6] = 5;
    301 		break;
    302 	case PIXIS_SW2_LANE_67_SEL_6:
    303 		lane_to_slot[6] = 6;
    304 		break;
    305 	case PIXIS_SW2_LANE_67_SEL_7:
    306 		lane_to_slot[6] = 7;
    307 		break;
    308 	}
    309 	lane_to_slot[7] = lane_to_slot[6];
    310 
    311 	lane_to_slot[8] = (sw2 & PIXIS_SW2_LANE_8_SEL) ? 3 : 0;
    312 
    313 	lane_to_slot[16] = (sw2 & PIXIS_SW2_LANE_1617_SEL) ? 1 : 0;
    314 	lane_to_slot[17] = lane_to_slot[16];
    315 }
    316 
    317 #endif /* #ifdef CONFIG_FMAN_ENET */
    318 
    319 /*
    320  * Configure the status for the virtual MDIO nodes
    321  *
    322  * Rather than create the virtual MDIO nodes from scratch for each active
    323  * virtual MDIO, we expect the DTS to have the nodes defined already, and we
    324  * only enable the ones that are actually active.
    325  *
    326  * We assume that the DTS already hard-codes the status for all the
    327  * virtual MDIO nodes to "disabled", so all we need to do is enable the
    328  * active ones.
    329  *
    330  * For SGMII, we also need to set the mux value in the node.
    331  */
    332 void fdt_fixup_board_enet(void *fdt)
    333 {
    334 #ifdef CONFIG_FMAN_ENET
    335 	unsigned int i;
    336 	int lane;
    337 
    338 	for (i = FM1_DTSEC1; i < FM1_DTSEC1 + CONFIG_SYS_NUM_FM1_DTSEC; i++) {
    339 		int idx = i - FM1_DTSEC1;
    340 
    341 		switch (fm_info_get_enet_if(i)) {
    342 		case PHY_INTERFACE_MODE_SGMII:
    343 			lane = serdes_get_first_lane(SGMII_FM1_DTSEC1 + idx);
    344 			if (lane >= 0) {
    345 				fdt_status_okay_by_alias(fdt, "emi1_sgmii");
    346 				/* Also set the MUX value */
    347 				fdt_set_mdio_mux(fdt, "emi1_sgmii",
    348 						 mdio_mux[i].val);
    349 			}
    350 			break;
    351 		case PHY_INTERFACE_MODE_RGMII:
    352 			fdt_status_okay_by_alias(fdt, "emi1_rgmii");
    353 			break;
    354 		default:
    355 			break;
    356 		}
    357 	}
    358 
    359 	lane = serdes_get_first_lane(XAUI_FM1);
    360 	if (lane >= 0)
    361 		fdt_status_okay_by_alias(fdt, "emi2_xgmii");
    362 #endif
    363 }
    364 
    365 int board_eth_init(bd_t *bis)
    366 {
    367 #ifdef CONFIG_FMAN_ENET
    368 	struct fsl_pq_mdio_info dtsec_mdio_info;
    369 	struct tgec_mdio_info tgec_mdio_info;
    370 	unsigned int i, slot;
    371 	int lane;
    372 	struct mii_dev *bus;
    373 
    374 	printf("Initializing Fman\n");
    375 
    376 	initialize_lane_to_slot();
    377 
    378 	/* We want to use the PIXIS to configure MUX routing, not GPIOs. */
    379 	setbits_8(&pixis->brdcfg2, BRDCFG2_REG_GPIO_SEL);
    380 
    381 	memset(mdio_mux, 0, sizeof(mdio_mux));
    382 
    383 	dtsec_mdio_info.regs =
    384 		(struct tsec_mii_mng *)CONFIG_SYS_FM1_DTSEC1_MDIO_ADDR;
    385 	dtsec_mdio_info.name = DEFAULT_FM_MDIO_NAME;
    386 
    387 	/* Register the real 1G MDIO bus */
    388 	fsl_pq_mdio_init(bis, &dtsec_mdio_info);
    389 
    390 	tgec_mdio_info.regs =
    391 		(struct tgec_mdio_controller *)CONFIG_SYS_FM1_TGEC_MDIO_ADDR;
    392 	tgec_mdio_info.name = DEFAULT_FM_TGEC_MDIO_NAME;
    393 
    394 	/* Register the real 10G MDIO bus */
    395 	fm_tgec_mdio_init(bis, &tgec_mdio_info);
    396 
    397 	/* Register the three virtual MDIO front-ends */
    398 	hydra_mdio_init(DEFAULT_FM_MDIO_NAME, "HYDRA_RGMII_MDIO");
    399 	hydra_mdio_init(DEFAULT_FM_MDIO_NAME, "HYDRA_SGMII_MDIO");
    400 
    401 	/*
    402 	 * Program the DTSEC PHY addresses assuming that they are all SGMII.
    403 	 * For any DTSEC that's RGMII, we'll override its PHY address later.
    404 	 * We assume that DTSEC5 is only used for RGMII.
    405 	 */
    406 	fm_info_set_phy_address(FM1_DTSEC1, CONFIG_SYS_FM1_DTSEC1_PHY_ADDR);
    407 	fm_info_set_phy_address(FM1_DTSEC2, CONFIG_SYS_FM1_DTSEC2_PHY_ADDR);
    408 	fm_info_set_phy_address(FM1_DTSEC3, CONFIG_SYS_FM1_DTSEC3_PHY_ADDR);
    409 	fm_info_set_phy_address(FM1_DTSEC4, CONFIG_SYS_FM1_DTSEC4_PHY_ADDR);
    410 
    411 	for (i = FM1_DTSEC1; i < FM1_DTSEC1 + CONFIG_SYS_NUM_FM1_DTSEC; i++) {
    412 		int idx = i - FM1_DTSEC1;
    413 
    414 		switch (fm_info_get_enet_if(i)) {
    415 		case PHY_INTERFACE_MODE_SGMII:
    416 			lane = serdes_get_first_lane(SGMII_FM1_DTSEC1 + idx);
    417 			if (lane < 0)
    418 				break;
    419 			slot = lane_to_slot[lane];
    420 			mdio_mux[i].mask = BRDCFG1_EMI1_SEL_MASK;
    421 			switch (slot) {
    422 			case 1:
    423 				/* Always DTSEC5 on Bank 3 */
    424 				mdio_mux[i].val = BRDCFG1_EMI1_SEL_SLOT1 |
    425 						  BRDCFG1_EMI1_EN;
    426 				break;
    427 			case 2:
    428 				mdio_mux[i].val = BRDCFG1_EMI1_SEL_SLOT2 |
    429 						  BRDCFG1_EMI1_EN;
    430 				break;
    431 			case 5:
    432 				mdio_mux[i].val = BRDCFG1_EMI1_SEL_SLOT5 |
    433 						  BRDCFG1_EMI1_EN;
    434 				break;
    435 			case 6:
    436 				mdio_mux[i].val = BRDCFG1_EMI1_SEL_SLOT6 |
    437 						  BRDCFG1_EMI1_EN;
    438 				break;
    439 			case 7:
    440 				mdio_mux[i].val = BRDCFG1_EMI1_SEL_SLOT7 |
    441 						  BRDCFG1_EMI1_EN;
    442 				break;
    443 			};
    444 
    445 			hydra_mdio_set_mux("HYDRA_SGMII_MDIO",
    446 					mdio_mux[i].mask, mdio_mux[i].val);
    447 			fm_info_set_mdio(i,
    448 				miiphy_get_dev_by_name("HYDRA_SGMII_MDIO"));
    449 			break;
    450 		case PHY_INTERFACE_MODE_RGMII:
    451 			/*
    452 			 * If DTSEC4 is RGMII, then it's routed via via EC1 to
    453 			 * the first on-board RGMII port.  If DTSEC5 is RGMII,
    454 			 * then it's routed via via EC2 to the second on-board
    455 			 * RGMII port. The other DTSECs cannot be routed to
    456 			 * RGMII.
    457 			 */
    458 			fm_info_set_phy_address(i, i == FM1_DTSEC4 ? 0 : 1);
    459 			mdio_mux[i].mask = BRDCFG1_EMI1_SEL_MASK;
    460 			mdio_mux[i].val  = BRDCFG1_EMI1_SEL_RGMII |
    461 					   BRDCFG1_EMI1_EN;
    462 			hydra_mdio_set_mux("HYDRA_RGMII_MDIO",
    463 					mdio_mux[i].mask, mdio_mux[i].val);
    464 			fm_info_set_mdio(i,
    465 				miiphy_get_dev_by_name("HYDRA_RGMII_MDIO"));
    466 			break;
    467 		case PHY_INTERFACE_MODE_NONE:
    468 			fm_info_set_phy_address(i, 0);
    469 			break;
    470 		default:
    471 			printf("Fman1: DTSEC%u set to unknown interface %i\n",
    472 			       idx + 1, fm_info_get_enet_if(i));
    473 			fm_info_set_phy_address(i, 0);
    474 			break;
    475 		}
    476 	}
    477 
    478 	bus = miiphy_get_dev_by_name("HYDRA_SGMII_MDIO");
    479 	set_sgmii_phy(bus, FM1_DTSEC1, CONFIG_SYS_NUM_FM1_DTSEC, PHY_BASE_ADDR);
    480 
    481 	/*
    482 	 * For 10G, we only support one XAUI card per Fman.  If present, then we
    483 	 * force its routing and never touch those bits again, which removes the
    484 	 * need for Linux to do any muxing.  This works because of the way
    485 	 * BRDCFG1 is defined, but it's a bit hackish.
    486 	 *
    487 	 * The PHY address for the XAUI card depends on which slot it's in. The
    488 	 * macros we use imply that the PHY address is based on which FM, but
    489 	 * that's not true.  On the P4080DS, FM1 could only use XAUI in slot 5,
    490 	 * and FM2 could only use a XAUI in slot 4.  On the Hydra board, we
    491 	 * check the actual slot and just use the macros as-is, even though
    492 	 * the P3041 and P5020 only have one Fman.
    493 	 */
    494 	lane = serdes_get_first_lane(XAUI_FM1);
    495 	if (lane >= 0) {
    496 		slot = lane_to_slot[lane];
    497 		if (slot == 1) {
    498 			/* XAUI card is in slot 1 */
    499 			clrsetbits_8(&pixis->brdcfg1, BRDCFG1_EMI2_SEL_MASK,
    500 				     BRDCFG1_EMI2_SEL_SLOT1);
    501 			fm_info_set_phy_address(FM1_10GEC1,
    502 						CONFIG_SYS_FM1_10GEC1_PHY_ADDR);
    503 		} else {
    504 			/* XAUI card is in slot 2 */
    505 			clrsetbits_8(&pixis->brdcfg1, BRDCFG1_EMI2_SEL_MASK,
    506 				     BRDCFG1_EMI2_SEL_SLOT2);
    507 			fm_info_set_phy_address(FM1_10GEC1,
    508 						CONFIG_SYS_FM2_10GEC1_PHY_ADDR);
    509 		}
    510 	}
    511 
    512 	fm_info_set_mdio(FM1_10GEC1,
    513 			miiphy_get_dev_by_name(DEFAULT_FM_TGEC_MDIO_NAME));
    514 
    515 	cpu_eth_init(bis);
    516 #endif
    517 
    518 	return pci_eth_init(bis);
    519 }
    520