mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-22 01:48:52 +09:00
![Shaohui Xie](/assets/img/avatar_default.png)
XFI is supported on T4QDS-XFI board, which removed slot3, and four LANEs of serdes2 are routed to a SFP+ cages, which to house fiber cable or direct attach cable(copper), the copper cable is used to emulate the 10GBASE-KR scenario. So, for XFI usage, there are two scenarios, one will use fiber cable, another will use copper cable. For fiber cable, there is NO PHY, while for copper cable, we need to use internal PHY which exist in Serdes to do auto-negotiation and link training, which implemented in kernel. We use hwconfig to define cable type for XFI, and fixup dtb based on the cable type. For copper cable, set below env in hwconfig: fsl_10gkr_copper:<10g_mac_name> the <10g_mac_name> can be fm1_10g1, fm1_10g2, fm2_10g1, fm2_10g2. The four <10g_mac_name>s do not have to be coexist in hwconfig. For XFI ports, if a given 10G port will use the copper cable for 10GBASE-KR, set the <10g_mac_name> of the port in hwconfig, otherwise, fiber cable will be assumed to be used for the port. For ex. if four XFI ports will both use copper cable, the hwconfig should contain: fsl_10gkr_copper:fm1_10g1,fm1_10g2,fm2_10g1,fm2_10g2 For fiber cable: 1. give PHY address to a XFI port, otherwise, the XFI ports will not be available in U-boot, there is no PHY physically for XFI when using fiber cable, this is just to make U-boot happy and we can use the XFI ports in U-boot. 2. fixup dtb to use fixed-link in case of fiber cable which has no PHY. Kernel requests that a MAC must have a PHY or fixed-link. When using XFI protocol, the MAC 9/10 on FM1 should init as 10G interface. Change serdes 2 protocol 56 to 55 which has same feature as 56 since 56 is not valid any longer. Signed-off-by: Shaohui Xie <Shaohui.Xie@freescale.com> Reviewed-by: York Sun <yorksun@freescale.com>
867 lines
23 KiB
C
867 lines
23 KiB
C
/*
|
|
* Copyright 2012 Freescale Semiconductor, Inc.
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <command.h>
|
|
#include <netdev.h>
|
|
#include <asm/mmu.h>
|
|
#include <asm/processor.h>
|
|
#include <asm/cache.h>
|
|
#include <asm/immap_85xx.h>
|
|
#include <asm/fsl_law.h>
|
|
#include <fsl_ddr_sdram.h>
|
|
#include <asm/fsl_serdes.h>
|
|
#include <asm/fsl_portals.h>
|
|
#include <asm/fsl_liodn.h>
|
|
#include <malloc.h>
|
|
#include <fm_eth.h>
|
|
#include <fsl_mdio.h>
|
|
#include <miiphy.h>
|
|
#include <phy.h>
|
|
#include <asm/fsl_dtsec.h>
|
|
#include <asm/fsl_serdes.h>
|
|
#include <hwconfig.h>
|
|
#include "../common/qixis.h"
|
|
#include "../common/fman.h"
|
|
|
|
#include "t4240qds_qixis.h"
|
|
|
|
#define EMI_NONE 0xFFFFFFFF
|
|
#define EMI1_RGMII 0
|
|
#define EMI1_SLOT1 1
|
|
#define EMI1_SLOT2 2
|
|
#define EMI1_SLOT3 3
|
|
#define EMI1_SLOT4 4
|
|
#define EMI1_SLOT5 5
|
|
#define EMI1_SLOT7 7
|
|
#define EMI2 8
|
|
/* Slot6 and Slot8 do not have EMI connections */
|
|
|
|
static int mdio_mux[NUM_FM_PORTS];
|
|
|
|
static const char *mdio_names[] = {
|
|
"T4240QDS_MDIO0",
|
|
"T4240QDS_MDIO1",
|
|
"T4240QDS_MDIO2",
|
|
"T4240QDS_MDIO3",
|
|
"T4240QDS_MDIO4",
|
|
"T4240QDS_MDIO5",
|
|
"NULL",
|
|
"T4240QDS_MDIO7",
|
|
"T4240QDS_10GC",
|
|
};
|
|
|
|
static u8 lane_to_slot_fsm1[] = {1, 1, 1, 1, 2, 2, 2, 2};
|
|
static u8 lane_to_slot_fsm2[] = {3, 3, 3, 3, 4, 4, 4, 4};
|
|
static u8 slot_qsgmii_phyaddr[5][4] = {
|
|
{0, 0, 0, 0},/* not used, to make index match slot No. */
|
|
{0, 1, 2, 3},
|
|
{4, 5, 6, 7},
|
|
{8, 9, 0xa, 0xb},
|
|
{0xc, 0xd, 0xe, 0xf},
|
|
};
|
|
static u8 qsgmiiphy_fix[NUM_FM_PORTS] = {0};
|
|
|
|
static const char *t4240qds_mdio_name_for_muxval(u8 muxval)
|
|
{
|
|
return mdio_names[muxval];
|
|
}
|
|
|
|
struct mii_dev *mii_dev_for_muxval(u8 muxval)
|
|
{
|
|
struct mii_dev *bus;
|
|
const char *name = t4240qds_mdio_name_for_muxval(muxval);
|
|
|
|
if (!name) {
|
|
printf("No bus for muxval %x\n", muxval);
|
|
return NULL;
|
|
}
|
|
|
|
bus = miiphy_get_dev_by_name(name);
|
|
|
|
if (!bus) {
|
|
printf("No bus by name %s\n", name);
|
|
return NULL;
|
|
}
|
|
|
|
return bus;
|
|
}
|
|
|
|
struct t4240qds_mdio {
|
|
u8 muxval;
|
|
struct mii_dev *realbus;
|
|
};
|
|
|
|
static void t4240qds_mux_mdio(u8 muxval)
|
|
{
|
|
u8 brdcfg4;
|
|
if ((muxval < 6) || (muxval == 7)) {
|
|
brdcfg4 = QIXIS_READ(brdcfg[4]);
|
|
brdcfg4 &= ~BRDCFG4_EMISEL_MASK;
|
|
brdcfg4 |= (muxval << BRDCFG4_EMISEL_SHIFT);
|
|
QIXIS_WRITE(brdcfg[4], brdcfg4);
|
|
}
|
|
}
|
|
|
|
static int t4240qds_mdio_read(struct mii_dev *bus, int addr, int devad,
|
|
int regnum)
|
|
{
|
|
struct t4240qds_mdio *priv = bus->priv;
|
|
|
|
t4240qds_mux_mdio(priv->muxval);
|
|
|
|
return priv->realbus->read(priv->realbus, addr, devad, regnum);
|
|
}
|
|
|
|
static int t4240qds_mdio_write(struct mii_dev *bus, int addr, int devad,
|
|
int regnum, u16 value)
|
|
{
|
|
struct t4240qds_mdio *priv = bus->priv;
|
|
|
|
t4240qds_mux_mdio(priv->muxval);
|
|
|
|
return priv->realbus->write(priv->realbus, addr, devad, regnum, value);
|
|
}
|
|
|
|
static int t4240qds_mdio_reset(struct mii_dev *bus)
|
|
{
|
|
struct t4240qds_mdio *priv = bus->priv;
|
|
|
|
return priv->realbus->reset(priv->realbus);
|
|
}
|
|
|
|
static int t4240qds_mdio_init(char *realbusname, u8 muxval)
|
|
{
|
|
struct t4240qds_mdio *pmdio;
|
|
struct mii_dev *bus = mdio_alloc();
|
|
|
|
if (!bus) {
|
|
printf("Failed to allocate T4240QDS MDIO bus\n");
|
|
return -1;
|
|
}
|
|
|
|
pmdio = malloc(sizeof(*pmdio));
|
|
if (!pmdio) {
|
|
printf("Failed to allocate T4240QDS private data\n");
|
|
free(bus);
|
|
return -1;
|
|
}
|
|
|
|
bus->read = t4240qds_mdio_read;
|
|
bus->write = t4240qds_mdio_write;
|
|
bus->reset = t4240qds_mdio_reset;
|
|
sprintf(bus->name, t4240qds_mdio_name_for_muxval(muxval));
|
|
|
|
pmdio->realbus = miiphy_get_dev_by_name(realbusname);
|
|
|
|
if (!pmdio->realbus) {
|
|
printf("No bus with name %s\n", realbusname);
|
|
free(bus);
|
|
free(pmdio);
|
|
return -1;
|
|
}
|
|
|
|
pmdio->muxval = muxval;
|
|
bus->priv = pmdio;
|
|
|
|
return mdio_register(bus);
|
|
}
|
|
|
|
void board_ft_fman_fixup_port(void *blob, char * prop, phys_addr_t pa,
|
|
enum fm_port port, int offset)
|
|
{
|
|
int interface = fm_info_get_enet_if(port);
|
|
ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
|
|
u32 prtcl2 = in_be32(&gur->rcwsr[4]) & FSL_CORENET2_RCWSR4_SRDS2_PRTCL;
|
|
|
|
prtcl2 >>= FSL_CORENET2_RCWSR4_SRDS2_PRTCL_SHIFT;
|
|
|
|
if (interface == PHY_INTERFACE_MODE_SGMII ||
|
|
interface == PHY_INTERFACE_MODE_QSGMII) {
|
|
switch (port) {
|
|
case FM1_DTSEC1:
|
|
if (qsgmiiphy_fix[port])
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"sgmii_phy21");
|
|
break;
|
|
case FM1_DTSEC2:
|
|
if (qsgmiiphy_fix[port])
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"sgmii_phy22");
|
|
break;
|
|
case FM1_DTSEC3:
|
|
if (qsgmiiphy_fix[port])
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"sgmii_phy23");
|
|
break;
|
|
case FM1_DTSEC4:
|
|
if (qsgmiiphy_fix[port])
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"sgmii_phy24");
|
|
break;
|
|
case FM1_DTSEC6:
|
|
if (qsgmiiphy_fix[port])
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"sgmii_phy12");
|
|
break;
|
|
case FM1_DTSEC9:
|
|
if (qsgmiiphy_fix[port])
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"sgmii_phy14");
|
|
else
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"phy_sgmii4");
|
|
break;
|
|
case FM1_DTSEC10:
|
|
if (qsgmiiphy_fix[port])
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"sgmii_phy13");
|
|
else
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"phy_sgmii3");
|
|
break;
|
|
case FM2_DTSEC1:
|
|
if (qsgmiiphy_fix[port])
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"sgmii_phy41");
|
|
break;
|
|
case FM2_DTSEC2:
|
|
if (qsgmiiphy_fix[port])
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"sgmii_phy42");
|
|
break;
|
|
case FM2_DTSEC3:
|
|
if (qsgmiiphy_fix[port])
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"sgmii_phy43");
|
|
break;
|
|
case FM2_DTSEC4:
|
|
if (qsgmiiphy_fix[port])
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"sgmii_phy44");
|
|
break;
|
|
case FM2_DTSEC6:
|
|
if (qsgmiiphy_fix[port])
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"sgmii_phy32");
|
|
break;
|
|
case FM2_DTSEC9:
|
|
if (qsgmiiphy_fix[port])
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"sgmii_phy34");
|
|
else
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"phy_sgmii12");
|
|
break;
|
|
case FM2_DTSEC10:
|
|
if (qsgmiiphy_fix[port])
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"sgmii_phy33");
|
|
else
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"phy_sgmii11");
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
} else if (interface == PHY_INTERFACE_MODE_XGMII &&
|
|
((prtcl2 == 55) || (prtcl2 == 57))) {
|
|
/*
|
|
* if the 10G is XFI, check hwconfig to see what is the
|
|
* media type, there are two types, fiber or copper,
|
|
* fix the dtb accordingly.
|
|
*/
|
|
int media_type = 0;
|
|
struct fixed_link f_link;
|
|
char lane_mode[20] = {"10GBASE-KR"};
|
|
char buf[32] = "serdes-2,";
|
|
int off;
|
|
|
|
switch (port) {
|
|
case FM1_10GEC1:
|
|
if (hwconfig_sub("fsl_10gkr_copper", "fm1_10g1")) {
|
|
media_type = 1;
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"phy_xfi1");
|
|
sprintf(buf, "%s%s%s", buf, "lane-a,",
|
|
(char *)lane_mode);
|
|
}
|
|
break;
|
|
case FM1_10GEC2:
|
|
if (hwconfig_sub("fsl_10gkr_copper", "fm1_10g2")) {
|
|
media_type = 1;
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"phy_xfi2");
|
|
sprintf(buf, "%s%s%s", buf, "lane-b,",
|
|
(char *)lane_mode);
|
|
}
|
|
break;
|
|
case FM2_10GEC1:
|
|
if (hwconfig_sub("fsl_10gkr_copper", "fm2_10g1")) {
|
|
media_type = 1;
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"phy_xfi3");
|
|
sprintf(buf, "%s%s%s", buf, "lane-d,",
|
|
(char *)lane_mode);
|
|
}
|
|
break;
|
|
case FM2_10GEC2:
|
|
if (hwconfig_sub("fsl_10gkr_copper", "fm2_10g2")) {
|
|
media_type = 1;
|
|
fdt_set_phy_handle(blob, prop, pa,
|
|
"phy_xfi4");
|
|
sprintf(buf, "%s%s%s", buf, "lane-c,",
|
|
(char *)lane_mode);
|
|
}
|
|
break;
|
|
default:
|
|
return;
|
|
}
|
|
|
|
if (!media_type) {
|
|
/* fixed-link is used for XFI fiber cable */
|
|
fdt_delprop(blob, offset, "phy-handle");
|
|
f_link.phy_id = port;
|
|
f_link.duplex = 1;
|
|
f_link.link_speed = 10000;
|
|
f_link.pause = 0;
|
|
f_link.asym_pause = 0;
|
|
fdt_setprop(blob, offset, "fixed-link", &f_link,
|
|
sizeof(f_link));
|
|
} else {
|
|
/* set property for copper cable */
|
|
off = fdt_node_offset_by_compat_reg(blob,
|
|
"fsl,fman-memac-mdio", pa + 0x1000);
|
|
fdt_setprop_string(blob, off, "lane-instance", buf);
|
|
}
|
|
}
|
|
}
|
|
|
|
void fdt_fixup_board_enet(void *fdt)
|
|
{
|
|
int i;
|
|
ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
|
|
u32 prtcl2 = in_be32(&gur->rcwsr[4]) & FSL_CORENET2_RCWSR4_SRDS2_PRTCL;
|
|
|
|
prtcl2 >>= FSL_CORENET2_RCWSR4_SRDS2_PRTCL_SHIFT;
|
|
for (i = FM1_DTSEC1; i < NUM_FM_PORTS; i++) {
|
|
switch (fm_info_get_enet_if(i)) {
|
|
case PHY_INTERFACE_MODE_SGMII:
|
|
case PHY_INTERFACE_MODE_QSGMII:
|
|
switch (mdio_mux[i]) {
|
|
case EMI1_SLOT1:
|
|
fdt_status_okay_by_alias(fdt, "emi1_slot1");
|
|
break;
|
|
case EMI1_SLOT2:
|
|
fdt_status_okay_by_alias(fdt, "emi1_slot2");
|
|
break;
|
|
case EMI1_SLOT3:
|
|
fdt_status_okay_by_alias(fdt, "emi1_slot3");
|
|
break;
|
|
case EMI1_SLOT4:
|
|
fdt_status_okay_by_alias(fdt, "emi1_slot4");
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
break;
|
|
case PHY_INTERFACE_MODE_XGMII:
|
|
/* check if it's XFI interface for 10g */
|
|
if ((prtcl2 == 55) || (prtcl2 == 57)) {
|
|
if (i == FM1_10GEC1 && hwconfig_sub(
|
|
"fsl_10gkr_copper", "fm1_10g1"))
|
|
fdt_status_okay_by_alias(
|
|
fdt, "xfi_pcs_mdio1");
|
|
if (i == FM1_10GEC2 && hwconfig_sub(
|
|
"fsl_10gkr_copper", "fm1_10g2"))
|
|
fdt_status_okay_by_alias(
|
|
fdt, "xfi_pcs_mdio2");
|
|
if (i == FM2_10GEC1 && hwconfig_sub(
|
|
"fsl_10gkr_copper", "fm2_10g1"))
|
|
fdt_status_okay_by_alias(
|
|
fdt, "xfi_pcs_mdio3");
|
|
if (i == FM2_10GEC2 && hwconfig_sub(
|
|
"fsl_10gkr_copper", "fm2_10g2"))
|
|
fdt_status_okay_by_alias(
|
|
fdt, "xfi_pcs_mdio4");
|
|
break;
|
|
}
|
|
switch (i) {
|
|
case FM1_10GEC1:
|
|
fdt_status_okay_by_alias(fdt, "emi2_xauislot1");
|
|
break;
|
|
case FM1_10GEC2:
|
|
fdt_status_okay_by_alias(fdt, "emi2_xauislot2");
|
|
break;
|
|
case FM2_10GEC1:
|
|
fdt_status_okay_by_alias(fdt, "emi2_xauislot3");
|
|
break;
|
|
case FM2_10GEC2:
|
|
fdt_status_okay_by_alias(fdt, "emi2_xauislot4");
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
static void initialize_qsgmiiphy_fix(void)
|
|
{
|
|
int i;
|
|
unsigned short reg;
|
|
|
|
for (i = 1; i <= 4; i++) {
|
|
/*
|
|
* Try to read if a SGMII card is used, we do it slot by slot.
|
|
* if a SGMII PHY address is valid on a slot, then we mark
|
|
* all ports on the slot, then fix the PHY address for the
|
|
* marked port when doing dtb fixup.
|
|
*/
|
|
if (miiphy_read(mdio_names[i],
|
|
SGMII_CARD_PORT1_PHY_ADDR, MII_PHYSID2, ®) != 0) {
|
|
debug("Slot%d PHY ID register 2 read failed\n", i);
|
|
continue;
|
|
}
|
|
|
|
debug("Slot%d MII_PHYSID2 @ 0x1c= 0x%04x\n", i, reg);
|
|
|
|
if (reg == 0xFFFF) {
|
|
/* No physical device present at this address */
|
|
continue;
|
|
}
|
|
|
|
switch (i) {
|
|
case 1:
|
|
qsgmiiphy_fix[FM1_DTSEC5] = 1;
|
|
qsgmiiphy_fix[FM1_DTSEC6] = 1;
|
|
qsgmiiphy_fix[FM1_DTSEC9] = 1;
|
|
qsgmiiphy_fix[FM1_DTSEC10] = 1;
|
|
slot_qsgmii_phyaddr[1][0] = SGMII_CARD_PORT1_PHY_ADDR;
|
|
slot_qsgmii_phyaddr[1][1] = SGMII_CARD_PORT2_PHY_ADDR;
|
|
slot_qsgmii_phyaddr[1][2] = SGMII_CARD_PORT3_PHY_ADDR;
|
|
slot_qsgmii_phyaddr[1][3] = SGMII_CARD_PORT4_PHY_ADDR;
|
|
break;
|
|
case 2:
|
|
qsgmiiphy_fix[FM1_DTSEC1] = 1;
|
|
qsgmiiphy_fix[FM1_DTSEC2] = 1;
|
|
qsgmiiphy_fix[FM1_DTSEC3] = 1;
|
|
qsgmiiphy_fix[FM1_DTSEC4] = 1;
|
|
slot_qsgmii_phyaddr[2][0] = SGMII_CARD_PORT1_PHY_ADDR;
|
|
slot_qsgmii_phyaddr[2][1] = SGMII_CARD_PORT2_PHY_ADDR;
|
|
slot_qsgmii_phyaddr[2][2] = SGMII_CARD_PORT3_PHY_ADDR;
|
|
slot_qsgmii_phyaddr[2][3] = SGMII_CARD_PORT4_PHY_ADDR;
|
|
break;
|
|
case 3:
|
|
qsgmiiphy_fix[FM2_DTSEC5] = 1;
|
|
qsgmiiphy_fix[FM2_DTSEC6] = 1;
|
|
qsgmiiphy_fix[FM2_DTSEC9] = 1;
|
|
qsgmiiphy_fix[FM2_DTSEC10] = 1;
|
|
slot_qsgmii_phyaddr[3][0] = SGMII_CARD_PORT1_PHY_ADDR;
|
|
slot_qsgmii_phyaddr[3][1] = SGMII_CARD_PORT2_PHY_ADDR;
|
|
slot_qsgmii_phyaddr[3][2] = SGMII_CARD_PORT3_PHY_ADDR;
|
|
slot_qsgmii_phyaddr[3][3] = SGMII_CARD_PORT4_PHY_ADDR;
|
|
break;
|
|
case 4:
|
|
qsgmiiphy_fix[FM2_DTSEC1] = 1;
|
|
qsgmiiphy_fix[FM2_DTSEC2] = 1;
|
|
qsgmiiphy_fix[FM2_DTSEC3] = 1;
|
|
qsgmiiphy_fix[FM2_DTSEC4] = 1;
|
|
slot_qsgmii_phyaddr[4][0] = SGMII_CARD_PORT1_PHY_ADDR;
|
|
slot_qsgmii_phyaddr[4][1] = SGMII_CARD_PORT2_PHY_ADDR;
|
|
slot_qsgmii_phyaddr[4][2] = SGMII_CARD_PORT3_PHY_ADDR;
|
|
slot_qsgmii_phyaddr[4][3] = SGMII_CARD_PORT4_PHY_ADDR;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
int board_eth_init(bd_t *bis)
|
|
{
|
|
#if defined(CONFIG_FMAN_ENET)
|
|
int i, idx, lane, slot, interface;
|
|
struct memac_mdio_info dtsec_mdio_info;
|
|
struct memac_mdio_info tgec_mdio_info;
|
|
ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
|
|
u32 srds_prtcl_s1, srds_prtcl_s2;
|
|
|
|
srds_prtcl_s1 = in_be32(&gur->rcwsr[4]) &
|
|
FSL_CORENET2_RCWSR4_SRDS1_PRTCL;
|
|
srds_prtcl_s1 >>= FSL_CORENET2_RCWSR4_SRDS1_PRTCL_SHIFT;
|
|
srds_prtcl_s2 = in_be32(&gur->rcwsr[4]) &
|
|
FSL_CORENET2_RCWSR4_SRDS2_PRTCL;
|
|
srds_prtcl_s2 >>= FSL_CORENET2_RCWSR4_SRDS2_PRTCL_SHIFT;
|
|
|
|
/* Initialize the mdio_mux array so we can recognize empty elements */
|
|
for (i = 0; i < NUM_FM_PORTS; i++)
|
|
mdio_mux[i] = EMI_NONE;
|
|
|
|
dtsec_mdio_info.regs =
|
|
(struct memac_mdio_controller *)CONFIG_SYS_FM2_DTSEC_MDIO_ADDR;
|
|
|
|
dtsec_mdio_info.name = DEFAULT_FM_MDIO_NAME;
|
|
|
|
/* Register the 1G MDIO bus */
|
|
fm_memac_mdio_init(bis, &dtsec_mdio_info);
|
|
|
|
tgec_mdio_info.regs =
|
|
(struct memac_mdio_controller *)CONFIG_SYS_FM2_TGEC_MDIO_ADDR;
|
|
tgec_mdio_info.name = DEFAULT_FM_TGEC_MDIO_NAME;
|
|
|
|
/* Register the 10G MDIO bus */
|
|
fm_memac_mdio_init(bis, &tgec_mdio_info);
|
|
|
|
/* Register the muxing front-ends to the MDIO buses */
|
|
t4240qds_mdio_init(DEFAULT_FM_MDIO_NAME, EMI1_RGMII);
|
|
t4240qds_mdio_init(DEFAULT_FM_MDIO_NAME, EMI1_SLOT1);
|
|
t4240qds_mdio_init(DEFAULT_FM_MDIO_NAME, EMI1_SLOT2);
|
|
t4240qds_mdio_init(DEFAULT_FM_MDIO_NAME, EMI1_SLOT3);
|
|
t4240qds_mdio_init(DEFAULT_FM_MDIO_NAME, EMI1_SLOT4);
|
|
t4240qds_mdio_init(DEFAULT_FM_MDIO_NAME, EMI1_SLOT5);
|
|
t4240qds_mdio_init(DEFAULT_FM_MDIO_NAME, EMI1_SLOT7);
|
|
t4240qds_mdio_init(DEFAULT_FM_TGEC_MDIO_NAME, EMI2);
|
|
|
|
initialize_qsgmiiphy_fix();
|
|
|
|
switch (srds_prtcl_s1) {
|
|
case 1:
|
|
case 2:
|
|
case 4:
|
|
/* XAUI/HiGig in Slot1 and Slot2 */
|
|
fm_info_set_phy_address(FM1_10GEC1, FM1_10GEC1_PHY_ADDR);
|
|
fm_info_set_phy_address(FM1_10GEC2, FM1_10GEC2_PHY_ADDR);
|
|
break;
|
|
case 27:
|
|
case 28:
|
|
case 35:
|
|
case 36:
|
|
/* SGMII in Slot1 and Slot2 */
|
|
fm_info_set_phy_address(FM1_DTSEC1, slot_qsgmii_phyaddr[2][0]);
|
|
fm_info_set_phy_address(FM1_DTSEC2, slot_qsgmii_phyaddr[2][1]);
|
|
fm_info_set_phy_address(FM1_DTSEC3, slot_qsgmii_phyaddr[2][2]);
|
|
fm_info_set_phy_address(FM1_DTSEC4, slot_qsgmii_phyaddr[2][3]);
|
|
fm_info_set_phy_address(FM1_DTSEC5, slot_qsgmii_phyaddr[1][0]);
|
|
fm_info_set_phy_address(FM1_DTSEC6, slot_qsgmii_phyaddr[1][1]);
|
|
if ((srds_prtcl_s2 != 55) && (srds_prtcl_s2 != 57)) {
|
|
fm_info_set_phy_address(FM1_DTSEC9,
|
|
slot_qsgmii_phyaddr[1][3]);
|
|
fm_info_set_phy_address(FM1_DTSEC10,
|
|
slot_qsgmii_phyaddr[1][2]);
|
|
}
|
|
break;
|
|
case 37:
|
|
case 38:
|
|
fm_info_set_phy_address(FM1_DTSEC1, slot_qsgmii_phyaddr[2][0]);
|
|
fm_info_set_phy_address(FM1_DTSEC2, slot_qsgmii_phyaddr[2][1]);
|
|
fm_info_set_phy_address(FM1_DTSEC3, slot_qsgmii_phyaddr[2][2]);
|
|
fm_info_set_phy_address(FM1_DTSEC4, slot_qsgmii_phyaddr[2][3]);
|
|
fm_info_set_phy_address(FM1_DTSEC5, slot_qsgmii_phyaddr[1][0]);
|
|
fm_info_set_phy_address(FM1_DTSEC6, slot_qsgmii_phyaddr[1][1]);
|
|
if ((srds_prtcl_s2 != 55) && (srds_prtcl_s2 != 57)) {
|
|
fm_info_set_phy_address(FM1_DTSEC9,
|
|
slot_qsgmii_phyaddr[1][2]);
|
|
fm_info_set_phy_address(FM1_DTSEC10,
|
|
slot_qsgmii_phyaddr[1][3]);
|
|
}
|
|
break;
|
|
case 39:
|
|
case 40:
|
|
case 45:
|
|
case 46:
|
|
case 47:
|
|
case 48:
|
|
fm_info_set_phy_address(FM1_DTSEC5, slot_qsgmii_phyaddr[1][0]);
|
|
fm_info_set_phy_address(FM1_DTSEC6, slot_qsgmii_phyaddr[1][1]);
|
|
if ((srds_prtcl_s2 != 55) && (srds_prtcl_s2 != 57)) {
|
|
fm_info_set_phy_address(FM1_DTSEC10,
|
|
slot_qsgmii_phyaddr[1][2]);
|
|
fm_info_set_phy_address(FM1_DTSEC9,
|
|
slot_qsgmii_phyaddr[1][3]);
|
|
}
|
|
fm_info_set_phy_address(FM1_DTSEC1, slot_qsgmii_phyaddr[2][0]);
|
|
fm_info_set_phy_address(FM1_DTSEC2, slot_qsgmii_phyaddr[2][1]);
|
|
fm_info_set_phy_address(FM1_DTSEC3, slot_qsgmii_phyaddr[2][2]);
|
|
fm_info_set_phy_address(FM1_DTSEC4, slot_qsgmii_phyaddr[2][3]);
|
|
break;
|
|
default:
|
|
puts("Invalid SerDes1 protocol for T4240QDS\n");
|
|
break;
|
|
}
|
|
|
|
for (i = FM1_DTSEC1; i < FM1_DTSEC1 + CONFIG_SYS_NUM_FM1_DTSEC; i++) {
|
|
idx = i - FM1_DTSEC1;
|
|
interface = fm_info_get_enet_if(i);
|
|
switch (interface) {
|
|
case PHY_INTERFACE_MODE_SGMII:
|
|
case PHY_INTERFACE_MODE_QSGMII:
|
|
if (interface == PHY_INTERFACE_MODE_QSGMII) {
|
|
if (idx <= 3)
|
|
lane = serdes_get_first_lane(FSL_SRDS_1,
|
|
QSGMII_FM1_A);
|
|
else
|
|
lane = serdes_get_first_lane(FSL_SRDS_1,
|
|
QSGMII_FM1_B);
|
|
if (lane < 0)
|
|
break;
|
|
slot = lane_to_slot_fsm1[lane];
|
|
debug("FM1@DTSEC%u expects QSGMII in slot %u\n",
|
|
idx + 1, slot);
|
|
} else {
|
|
lane = serdes_get_first_lane(FSL_SRDS_1,
|
|
SGMII_FM1_DTSEC1 + idx);
|
|
if (lane < 0)
|
|
break;
|
|
slot = lane_to_slot_fsm1[lane];
|
|
debug("FM1@DTSEC%u expects SGMII in slot %u\n",
|
|
idx + 1, slot);
|
|
}
|
|
if (QIXIS_READ(present2) & (1 << (slot - 1)))
|
|
fm_disable_port(i);
|
|
switch (slot) {
|
|
case 1:
|
|
mdio_mux[i] = EMI1_SLOT1;
|
|
fm_info_set_mdio(i,
|
|
mii_dev_for_muxval(mdio_mux[i]));
|
|
break;
|
|
case 2:
|
|
mdio_mux[i] = EMI1_SLOT2;
|
|
fm_info_set_mdio(i,
|
|
mii_dev_for_muxval(mdio_mux[i]));
|
|
break;
|
|
};
|
|
break;
|
|
case PHY_INTERFACE_MODE_RGMII:
|
|
/* FM1 DTSEC5 routes to RGMII with EC2 */
|
|
debug("FM1@DTSEC%u is RGMII at address %u\n",
|
|
idx + 1, 2);
|
|
if (i == FM1_DTSEC5)
|
|
fm_info_set_phy_address(i, 2);
|
|
mdio_mux[i] = EMI1_RGMII;
|
|
fm_info_set_mdio(i,
|
|
mii_dev_for_muxval(mdio_mux[i]));
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
for (i = FM1_10GEC1; i < FM1_10GEC1 + CONFIG_SYS_NUM_FM1_10GEC; i++) {
|
|
idx = i - FM1_10GEC1;
|
|
switch (fm_info_get_enet_if(i)) {
|
|
case PHY_INTERFACE_MODE_XGMII:
|
|
if ((srds_prtcl_s2 == 55) || (srds_prtcl_s2 == 57)) {
|
|
/* A fake PHY address to make U-boot happy */
|
|
fm_info_set_phy_address(i, i);
|
|
} else {
|
|
lane = serdes_get_first_lane(FSL_SRDS_1,
|
|
XAUI_FM1_MAC9 + idx);
|
|
if (lane < 0)
|
|
break;
|
|
slot = lane_to_slot_fsm1[lane];
|
|
if (QIXIS_READ(present2) & (1 << (slot - 1)))
|
|
fm_disable_port(i);
|
|
}
|
|
mdio_mux[i] = EMI2;
|
|
fm_info_set_mdio(i, mii_dev_for_muxval(mdio_mux[i]));
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
#if (CONFIG_SYS_NUM_FMAN == 2)
|
|
switch (srds_prtcl_s2) {
|
|
case 1:
|
|
case 2:
|
|
case 4:
|
|
/* XAUI/HiGig in Slot3 and Slot4 */
|
|
fm_info_set_phy_address(FM2_10GEC1, FM2_10GEC1_PHY_ADDR);
|
|
fm_info_set_phy_address(FM2_10GEC2, FM2_10GEC2_PHY_ADDR);
|
|
break;
|
|
case 6:
|
|
case 7:
|
|
case 12:
|
|
case 13:
|
|
case 14:
|
|
case 15:
|
|
case 16:
|
|
case 21:
|
|
case 22:
|
|
case 23:
|
|
case 24:
|
|
case 25:
|
|
case 26:
|
|
/* XAUI/HiGig in Slot3, SGMII in Slot4 */
|
|
fm_info_set_phy_address(FM2_10GEC1, FM2_10GEC1_PHY_ADDR);
|
|
fm_info_set_phy_address(FM2_DTSEC1, slot_qsgmii_phyaddr[4][0]);
|
|
fm_info_set_phy_address(FM2_DTSEC2, slot_qsgmii_phyaddr[4][1]);
|
|
fm_info_set_phy_address(FM2_DTSEC3, slot_qsgmii_phyaddr[4][2]);
|
|
fm_info_set_phy_address(FM2_DTSEC4, slot_qsgmii_phyaddr[4][3]);
|
|
break;
|
|
case 27:
|
|
case 28:
|
|
case 35:
|
|
case 36:
|
|
/* SGMII in Slot3 and Slot4 */
|
|
fm_info_set_phy_address(FM2_DTSEC1, slot_qsgmii_phyaddr[4][0]);
|
|
fm_info_set_phy_address(FM2_DTSEC2, slot_qsgmii_phyaddr[4][1]);
|
|
fm_info_set_phy_address(FM2_DTSEC3, slot_qsgmii_phyaddr[4][2]);
|
|
fm_info_set_phy_address(FM2_DTSEC4, slot_qsgmii_phyaddr[4][3]);
|
|
fm_info_set_phy_address(FM2_DTSEC5, slot_qsgmii_phyaddr[3][0]);
|
|
fm_info_set_phy_address(FM2_DTSEC6, slot_qsgmii_phyaddr[3][1]);
|
|
fm_info_set_phy_address(FM2_DTSEC9, slot_qsgmii_phyaddr[3][3]);
|
|
fm_info_set_phy_address(FM2_DTSEC10, slot_qsgmii_phyaddr[3][2]);
|
|
break;
|
|
case 37:
|
|
case 38:
|
|
/* QSGMII in Slot3 and Slot4 */
|
|
fm_info_set_phy_address(FM2_DTSEC1, slot_qsgmii_phyaddr[4][0]);
|
|
fm_info_set_phy_address(FM2_DTSEC2, slot_qsgmii_phyaddr[4][1]);
|
|
fm_info_set_phy_address(FM2_DTSEC3, slot_qsgmii_phyaddr[4][2]);
|
|
fm_info_set_phy_address(FM2_DTSEC4, slot_qsgmii_phyaddr[4][3]);
|
|
fm_info_set_phy_address(FM2_DTSEC5, slot_qsgmii_phyaddr[3][0]);
|
|
fm_info_set_phy_address(FM2_DTSEC6, slot_qsgmii_phyaddr[3][1]);
|
|
fm_info_set_phy_address(FM2_DTSEC9, slot_qsgmii_phyaddr[3][2]);
|
|
fm_info_set_phy_address(FM2_DTSEC10, slot_qsgmii_phyaddr[3][3]);
|
|
break;
|
|
case 39:
|
|
case 40:
|
|
case 45:
|
|
case 46:
|
|
case 47:
|
|
case 48:
|
|
/* SGMII in Slot3 */
|
|
fm_info_set_phy_address(FM2_DTSEC5, slot_qsgmii_phyaddr[3][0]);
|
|
fm_info_set_phy_address(FM2_DTSEC6, slot_qsgmii_phyaddr[3][1]);
|
|
fm_info_set_phy_address(FM2_DTSEC9, slot_qsgmii_phyaddr[3][3]);
|
|
fm_info_set_phy_address(FM2_DTSEC10, slot_qsgmii_phyaddr[3][2]);
|
|
/* QSGMII in Slot4 */
|
|
fm_info_set_phy_address(FM2_DTSEC1, slot_qsgmii_phyaddr[4][0]);
|
|
fm_info_set_phy_address(FM2_DTSEC2, slot_qsgmii_phyaddr[4][1]);
|
|
fm_info_set_phy_address(FM2_DTSEC3, slot_qsgmii_phyaddr[4][2]);
|
|
fm_info_set_phy_address(FM2_DTSEC4, slot_qsgmii_phyaddr[4][3]);
|
|
break;
|
|
case 49:
|
|
case 50:
|
|
case 51:
|
|
case 52:
|
|
case 53:
|
|
case 54:
|
|
fm_info_set_phy_address(FM2_10GEC1, FM2_10GEC1_PHY_ADDR);
|
|
fm_info_set_phy_address(FM2_DTSEC1, slot_qsgmii_phyaddr[4][0]);
|
|
fm_info_set_phy_address(FM2_DTSEC2, slot_qsgmii_phyaddr[4][1]);
|
|
fm_info_set_phy_address(FM2_DTSEC3, slot_qsgmii_phyaddr[4][2]);
|
|
fm_info_set_phy_address(FM2_DTSEC4, slot_qsgmii_phyaddr[4][3]);
|
|
break;
|
|
case 55:
|
|
case 57:
|
|
/* XFI in Slot3, SGMII in Slot4 */
|
|
fm_info_set_phy_address(FM2_DTSEC1, slot_qsgmii_phyaddr[4][0]);
|
|
fm_info_set_phy_address(FM2_DTSEC2, slot_qsgmii_phyaddr[4][1]);
|
|
fm_info_set_phy_address(FM2_DTSEC3, slot_qsgmii_phyaddr[4][2]);
|
|
fm_info_set_phy_address(FM2_DTSEC4, slot_qsgmii_phyaddr[4][3]);
|
|
break;
|
|
default:
|
|
puts("Invalid SerDes2 protocol for T4240QDS\n");
|
|
break;
|
|
}
|
|
|
|
for (i = FM2_DTSEC1; i < FM2_DTSEC1 + CONFIG_SYS_NUM_FM2_DTSEC; i++) {
|
|
idx = i - FM2_DTSEC1;
|
|
interface = fm_info_get_enet_if(i);
|
|
switch (interface) {
|
|
case PHY_INTERFACE_MODE_SGMII:
|
|
case PHY_INTERFACE_MODE_QSGMII:
|
|
if (interface == PHY_INTERFACE_MODE_QSGMII) {
|
|
if (idx <= 3)
|
|
lane = serdes_get_first_lane(FSL_SRDS_2,
|
|
QSGMII_FM2_A);
|
|
else
|
|
lane = serdes_get_first_lane(FSL_SRDS_2,
|
|
QSGMII_FM2_B);
|
|
if (lane < 0)
|
|
break;
|
|
slot = lane_to_slot_fsm2[lane];
|
|
debug("FM2@DTSEC%u expects QSGMII in slot %u\n",
|
|
idx + 1, slot);
|
|
} else {
|
|
lane = serdes_get_first_lane(FSL_SRDS_2,
|
|
SGMII_FM2_DTSEC1 + idx);
|
|
if (lane < 0)
|
|
break;
|
|
slot = lane_to_slot_fsm2[lane];
|
|
debug("FM2@DTSEC%u expects SGMII in slot %u\n",
|
|
idx + 1, slot);
|
|
}
|
|
if (QIXIS_READ(present2) & (1 << (slot - 1)))
|
|
fm_disable_port(i);
|
|
switch (slot) {
|
|
case 3:
|
|
mdio_mux[i] = EMI1_SLOT3;
|
|
fm_info_set_mdio(i,
|
|
mii_dev_for_muxval(mdio_mux[i]));
|
|
break;
|
|
case 4:
|
|
mdio_mux[i] = EMI1_SLOT4;
|
|
fm_info_set_mdio(i,
|
|
mii_dev_for_muxval(mdio_mux[i]));
|
|
break;
|
|
};
|
|
break;
|
|
case PHY_INTERFACE_MODE_RGMII:
|
|
/*
|
|
* If DTSEC5 is RGMII, then it's routed via via EC1 to
|
|
* the first on-board RGMII port. If DTSEC6 is RGMII,
|
|
* then it's routed via via EC2 to the second on-board
|
|
* RGMII port.
|
|
*/
|
|
debug("FM2@DTSEC%u is RGMII at address %u\n",
|
|
idx + 1, i == FM2_DTSEC5 ? 1 : 2);
|
|
fm_info_set_phy_address(i, i == FM2_DTSEC5 ? 1 : 2);
|
|
mdio_mux[i] = EMI1_RGMII;
|
|
fm_info_set_mdio(i, mii_dev_for_muxval(mdio_mux[i]));
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
for (i = FM2_10GEC1; i < FM2_10GEC1 + CONFIG_SYS_NUM_FM2_10GEC; i++) {
|
|
idx = i - FM2_10GEC1;
|
|
switch (fm_info_get_enet_if(i)) {
|
|
case PHY_INTERFACE_MODE_XGMII:
|
|
if ((srds_prtcl_s2 == 55) || (srds_prtcl_s2 == 57)) {
|
|
/* A fake PHY address to make U-boot happy */
|
|
fm_info_set_phy_address(i, i);
|
|
} else {
|
|
lane = serdes_get_first_lane(FSL_SRDS_2,
|
|
XAUI_FM2_MAC9 + idx);
|
|
if (lane < 0)
|
|
break;
|
|
slot = lane_to_slot_fsm2[lane];
|
|
if (QIXIS_READ(present2) & (1 << (slot - 1)))
|
|
fm_disable_port(i);
|
|
}
|
|
mdio_mux[i] = EMI2;
|
|
fm_info_set_mdio(i, mii_dev_for_muxval(mdio_mux[i]));
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
#endif /* CONFIG_SYS_NUM_FMAN */
|
|
|
|
cpu_eth_init(bis);
|
|
#endif /* CONFIG_FMAN_ENET */
|
|
|
|
return pci_eth_init(bis);
|
|
}
|