mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-12-12 22:33:18 +00:00
12507a2d22
Evolve dm_pci_map_bar() to include an offset and length parameter. These allow a portion of the memory to be mapped and range checks to be applied. Passing both the offset and length as zero results in the previous behaviour and this is used to migrate the previous callers. Signed-off-by: Andrew Scull <ascull@google.com> Reviewed-by: Bin Meng <bmeng.cn@gmail.com>
436 lines
13 KiB
C
436 lines
13 KiB
C
// SPDX-License-Identifier: GPL-2.0+ OR BSD-3-Clause
|
|
/*
|
|
* Felix (VSC9959) Ethernet switch driver
|
|
* Copyright 2018-2021 NXP
|
|
*/
|
|
|
|
/*
|
|
* This driver is used for the Ethernet switch integrated into NXP LS1028A.
|
|
* Felix switch is derived from Microsemi Ocelot but there are several NXP
|
|
* adaptations that makes the two U-Boot drivers largely incompatible.
|
|
*
|
|
* Felix on LS1028A has 4 front panel ports and two internal ports, connected
|
|
* to ENETC interfaces. We're using one of the ENETC interfaces to push traffic
|
|
* into the switch. Injection/extraction headers are used to identify
|
|
* egress/ingress ports in the switch for Tx/Rx.
|
|
*/
|
|
|
|
#include <dm/device_compat.h>
|
|
#include <dm/of_extra.h>
|
|
#include <linux/delay.h>
|
|
#include <net/dsa.h>
|
|
#include <asm/io.h>
|
|
#include <miiphy.h>
|
|
#include <pci.h>
|
|
|
|
/* defines especially around PCS are reused from enetc */
|
|
#include "../fsl_enetc.h"
|
|
|
|
#define PCI_DEVICE_ID_FELIX_ETHSW 0xEEF0
|
|
|
|
/* Felix has in fact 6 ports, but we don't use the last internal one */
|
|
#define FELIX_PORT_COUNT 5
|
|
/* Front panel port mask */
|
|
#define FELIX_FP_PORT_MASK 0xf
|
|
|
|
/* Register map for BAR4 */
|
|
#define FELIX_SYS 0x010000
|
|
#define FELIX_ES0 0x040000
|
|
#define FELIX_IS1 0x050000
|
|
#define FELIX_IS2 0x060000
|
|
#define FELIX_GMII(port) (0x100000 + (port) * 0x10000)
|
|
#define FELIX_QSYS 0x200000
|
|
#define FELIX_DEVCPU_GCB 0x070000
|
|
#define FELIX_DEVCPU_GCB_SOFT_RST (FELIX_DEVCPU_GCB + 0x00000004)
|
|
#define SOFT_SWC_RST BIT(0)
|
|
#define FELIX_SYS_SYSTEM (FELIX_SYS + 0x00000E00)
|
|
#define FELIX_SYS_SYSTEM_EN BIT(0)
|
|
#define FELIX_SYS_RAM_CTRL (FELIX_SYS + 0x00000F24)
|
|
#define FELIX_SYS_RAM_CTRL_INIT BIT(1)
|
|
#define FELIX_SYS_SYSTEM_PORT_MODE(a) (FELIX_SYS_SYSTEM + 0xC + (a) * 4)
|
|
#define FELIX_SYS_SYSTEM_PORT_MODE_CPU 0x0000001e
|
|
|
|
#define FELIX_ES0_TCAM_CTRL (FELIX_ES0 + 0x000003C0)
|
|
#define FELIX_ES0_TCAM_CTRL_EN BIT(0)
|
|
#define FELIX_IS1_TCAM_CTRL (FELIX_IS1 + 0x000003C0)
|
|
#define FELIX_IS1_TCAM_CTRL_EN BIT(0)
|
|
#define FELIX_IS2_TCAM_CTRL (FELIX_IS2 + 0x000003C0)
|
|
#define FELIX_IS2_TCAM_CTRL_EN BIT(0)
|
|
|
|
#define FELIX_GMII_CLOCK_CFG(port) (FELIX_GMII(port) + 0x00000000)
|
|
#define FELIX_GMII_CLOCK_CFG_LINK_1G 1
|
|
#define FELIX_GMII_CLOCK_CFG_LINK_100M 2
|
|
#define FELIX_GMII_CLOCK_CFG_LINK_10M 3
|
|
#define FELIX_GMII_MAC_ENA_CFG(port) (FELIX_GMII(port) + 0x0000001C)
|
|
#define FELIX_GMII_MAX_ENA_CFG_TX BIT(0)
|
|
#define FELIX_GMII_MAX_ENA_CFG_RX BIT(4)
|
|
#define FELIX_GMII_MAC_IFG_CFG(port) (FELIX_GMII(port) + 0x0000001C + 0x14)
|
|
#define FELIX_GMII_MAC_IFG_CFG_DEF 0x515
|
|
|
|
#define FELIX_QSYS_SYSTEM (FELIX_QSYS + 0x0000F460)
|
|
#define FELIX_QSYS_SYSTEM_SW_PORT_MODE(a) \
|
|
(FELIX_QSYS_SYSTEM + 0x20 + (a) * 4)
|
|
#define FELIX_QSYS_SYSTEM_SW_PORT_ENA BIT(14)
|
|
#define FELIX_QSYS_SYSTEM_SW_PORT_LOSSY BIT(9)
|
|
#define FELIX_QSYS_SYSTEM_SW_PORT_SCH(a) (((a) & 0x3800) << 11)
|
|
#define FELIX_QSYS_SYSTEM_EXT_CPU_CFG (FELIX_QSYS_SYSTEM + 0x80)
|
|
#define FELIX_QSYS_SYSTEM_EXT_CPU_PORT(a) (((a) & 0xf) << 8 | 0xff)
|
|
|
|
/* internal MDIO in BAR0 */
|
|
#define FELIX_PM_IMDIO_BASE 0x8030
|
|
|
|
/* Serdes block on LS1028A */
|
|
#define FELIX_SERDES_BASE 0x1ea0000L
|
|
#define FELIX_SERDES_LNATECR0(lane) (FELIX_SERDES_BASE + 0x818 + \
|
|
(lane) * 0x40)
|
|
#define FELIX_SERDES_LNATECR0_ADPT_EQ 0x00003000
|
|
#define FELIX_SERDES_SGMIICR1(lane) (FELIX_SERDES_BASE + 0x1804 + \
|
|
(lane) * 0x10)
|
|
#define FELIX_SERDES_SGMIICR1_SGPCS BIT(11)
|
|
#define FELIX_SERDES_SGMIICR1_MDEV(a) (((a) & 0x1f) << 27)
|
|
|
|
#define FELIX_PCS_CTRL 0
|
|
#define FELIX_PCS_CTRL_RST BIT(15)
|
|
|
|
/*
|
|
* The long prefix format used here contains two dummy MAC addresses, a magic
|
|
* value in place of a VLAN tag followed by the extraction/injection header and
|
|
* the original L2 frame. Out of all this we only use the port ID.
|
|
*/
|
|
#define FELIX_DSA_TAG_LEN sizeof(struct felix_dsa_tag)
|
|
#define FELIX_DSA_TAG_MAGIC 0x0a008088
|
|
#define FELIX_DSA_TAG_INJ_PORT 7
|
|
#define FELIX_DSA_TAG_INJ_PORT_SET(a) (0x1 << ((a) & FELIX_FP_PORT_MASK))
|
|
#define FELIX_DSA_TAG_EXT_PORT 10
|
|
#define FELIX_DSA_TAG_EXT_PORT_GET(a) ((a) >> 3)
|
|
|
|
struct felix_dsa_tag {
|
|
uchar d_mac[6];
|
|
uchar s_mac[6];
|
|
u32 magic;
|
|
uchar meta[16];
|
|
};
|
|
|
|
struct felix_priv {
|
|
void *regs_base;
|
|
void *imdio_base;
|
|
struct mii_dev imdio;
|
|
};
|
|
|
|
/* MDIO wrappers, we're using these to drive internal MDIO to get to serdes */
|
|
static int felix_mdio_read(struct mii_dev *bus, int addr, int devad, int reg)
|
|
{
|
|
struct enetc_mdio_priv priv;
|
|
|
|
priv.regs_base = bus->priv;
|
|
return enetc_mdio_read_priv(&priv, addr, devad, reg);
|
|
}
|
|
|
|
static int felix_mdio_write(struct mii_dev *bus, int addr, int devad, int reg,
|
|
u16 val)
|
|
{
|
|
struct enetc_mdio_priv priv;
|
|
|
|
priv.regs_base = bus->priv;
|
|
return enetc_mdio_write_priv(&priv, addr, devad, reg, val);
|
|
}
|
|
|
|
/* set up serdes for SGMII */
|
|
static void felix_init_sgmii(struct mii_dev *imdio, int pidx, bool an)
|
|
{
|
|
u16 reg;
|
|
|
|
/* set up PCS lane address */
|
|
out_le32(FELIX_SERDES_SGMIICR1(pidx), FELIX_SERDES_SGMIICR1_SGPCS |
|
|
FELIX_SERDES_SGMIICR1_MDEV(pidx));
|
|
|
|
/*
|
|
* Set to SGMII mode, for 1Gbps enable AN, for 2.5Gbps set fixed speed.
|
|
* Although fixed speed is 1Gbps, we could be running at 2.5Gbps based
|
|
* on PLL configuration. Setting 1G for 2.5G here is counter intuitive
|
|
* but intentional.
|
|
*/
|
|
reg = ENETC_PCS_IF_MODE_SGMII;
|
|
reg |= an ? ENETC_PCS_IF_MODE_SGMII_AN : ENETC_PCS_IF_MODE_SPEED_1G;
|
|
felix_mdio_write(imdio, pidx, MDIO_DEVAD_NONE,
|
|
ENETC_PCS_IF_MODE, reg);
|
|
|
|
/* Dev ability - SGMII */
|
|
felix_mdio_write(imdio, pidx, MDIO_DEVAD_NONE,
|
|
ENETC_PCS_DEV_ABILITY, ENETC_PCS_DEV_ABILITY_SGMII);
|
|
|
|
/* Adjust link timer for SGMII */
|
|
felix_mdio_write(imdio, pidx, MDIO_DEVAD_NONE,
|
|
ENETC_PCS_LINK_TIMER1, ENETC_PCS_LINK_TIMER1_VAL);
|
|
felix_mdio_write(imdio, pidx, MDIO_DEVAD_NONE,
|
|
ENETC_PCS_LINK_TIMER2, ENETC_PCS_LINK_TIMER2_VAL);
|
|
|
|
reg = ENETC_PCS_CR_DEF_VAL;
|
|
reg |= an ? ENETC_PCS_CR_RESET_AN : ENETC_PCS_CR_RST;
|
|
/* restart PCS AN */
|
|
felix_mdio_write(imdio, pidx, MDIO_DEVAD_NONE,
|
|
ENETC_PCS_CR, reg);
|
|
}
|
|
|
|
/* set up MAC and serdes for (Q)SXGMII */
|
|
static int felix_init_sxgmii(struct mii_dev *imdio, int pidx)
|
|
{
|
|
int timeout = 1000;
|
|
|
|
/* set up transit equalization control on serdes lane */
|
|
out_le32(FELIX_SERDES_LNATECR0(1), FELIX_SERDES_LNATECR0_ADPT_EQ);
|
|
|
|
/*reset lane */
|
|
felix_mdio_write(imdio, pidx, MDIO_MMD_PCS, FELIX_PCS_CTRL,
|
|
FELIX_PCS_CTRL_RST);
|
|
while (felix_mdio_read(imdio, pidx, MDIO_MMD_PCS,
|
|
FELIX_PCS_CTRL) & FELIX_PCS_CTRL_RST &&
|
|
--timeout) {
|
|
mdelay(10);
|
|
}
|
|
if (felix_mdio_read(imdio, pidx, MDIO_MMD_PCS,
|
|
FELIX_PCS_CTRL) & FELIX_PCS_CTRL_RST)
|
|
return -ETIME;
|
|
|
|
/* Dev ability - SXGMII */
|
|
felix_mdio_write(imdio, pidx, ENETC_PCS_DEVAD_REPL,
|
|
ENETC_PCS_DEV_ABILITY, ENETC_PCS_DEV_ABILITY_SXGMII);
|
|
|
|
/* Restart PCS AN */
|
|
felix_mdio_write(imdio, pidx, ENETC_PCS_DEVAD_REPL, ENETC_PCS_CR,
|
|
ENETC_PCS_CR_RST | ENETC_PCS_CR_RESET_AN);
|
|
felix_mdio_write(imdio, pidx, ENETC_PCS_DEVAD_REPL,
|
|
ENETC_PCS_REPL_LINK_TIMER_1,
|
|
ENETC_PCS_REPL_LINK_TIMER_1_DEF);
|
|
felix_mdio_write(imdio, pidx, ENETC_PCS_DEVAD_REPL,
|
|
ENETC_PCS_REPL_LINK_TIMER_2,
|
|
ENETC_PCS_REPL_LINK_TIMER_2_DEF);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Apply protocol specific configuration to MAC, serdes as needed */
|
|
static void felix_start_pcs(struct udevice *dev, int port,
|
|
struct phy_device *phy, struct mii_dev *imdio)
|
|
{
|
|
ofnode node = dsa_port_get_ofnode(dev, port);
|
|
bool inband_an = ofnode_eth_uses_inband_aneg(node);
|
|
|
|
switch (phy->interface) {
|
|
case PHY_INTERFACE_MODE_SGMII:
|
|
case PHY_INTERFACE_MODE_2500BASEX:
|
|
case PHY_INTERFACE_MODE_QSGMII:
|
|
felix_init_sgmii(imdio, port, inband_an);
|
|
break;
|
|
case PHY_INTERFACE_MODE_10GBASER:
|
|
case PHY_INTERFACE_MODE_USXGMII:
|
|
if (felix_init_sxgmii(imdio, port))
|
|
dev_err(dev, "PCS reset timeout on port %d\n", port);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void felix_init(struct udevice *dev)
|
|
{
|
|
struct dsa_pdata *pdata = dev_get_uclass_plat(dev);
|
|
struct felix_priv *priv = dev_get_priv(dev);
|
|
void *base = priv->regs_base;
|
|
int timeout = 100;
|
|
|
|
/* Switch core reset */
|
|
out_le32(base + FELIX_DEVCPU_GCB_SOFT_RST, SOFT_SWC_RST);
|
|
while (in_le32(base + FELIX_DEVCPU_GCB_SOFT_RST) & SOFT_SWC_RST &&
|
|
--timeout)
|
|
udelay(10);
|
|
if (in_le32(base + FELIX_DEVCPU_GCB_SOFT_RST) & SOFT_SWC_RST)
|
|
dev_err(dev, "Timeout waiting for switch core reset\n");
|
|
timeout = 100;
|
|
|
|
/* Init core memories */
|
|
out_le32(base + FELIX_SYS_RAM_CTRL, FELIX_SYS_RAM_CTRL_INIT);
|
|
while (in_le32(base + FELIX_SYS_RAM_CTRL) & FELIX_SYS_RAM_CTRL_INIT &&
|
|
--timeout)
|
|
udelay(10);
|
|
if (in_le32(base + FELIX_SYS_RAM_CTRL) & FELIX_SYS_RAM_CTRL_INIT)
|
|
dev_err(dev, "Timeout waiting for switch memories\n");
|
|
|
|
/* Start switch core, set up ES0, IS1, IS2 */
|
|
out_le32(base + FELIX_SYS_SYSTEM, FELIX_SYS_SYSTEM_EN);
|
|
out_le32(base + FELIX_ES0_TCAM_CTRL, FELIX_ES0_TCAM_CTRL_EN);
|
|
out_le32(base + FELIX_IS1_TCAM_CTRL, FELIX_IS1_TCAM_CTRL_EN);
|
|
out_le32(base + FELIX_IS2_TCAM_CTRL, FELIX_IS2_TCAM_CTRL_EN);
|
|
udelay(20);
|
|
|
|
priv->imdio.read = felix_mdio_read;
|
|
priv->imdio.write = felix_mdio_write;
|
|
priv->imdio.priv = priv->imdio_base + FELIX_PM_IMDIO_BASE;
|
|
strlcpy(priv->imdio.name, dev->name, MDIO_NAME_LEN);
|
|
|
|
/* set up CPU port */
|
|
out_le32(base + FELIX_QSYS_SYSTEM_EXT_CPU_CFG,
|
|
FELIX_QSYS_SYSTEM_EXT_CPU_PORT(pdata->cpu_port));
|
|
out_le32(base + FELIX_SYS_SYSTEM_PORT_MODE(pdata->cpu_port),
|
|
FELIX_SYS_SYSTEM_PORT_MODE_CPU);
|
|
}
|
|
|
|
/*
|
|
* Probe Felix:
|
|
* - enable the PCI function
|
|
* - map BAR 4
|
|
* - init switch core and port registers
|
|
*/
|
|
static int felix_probe(struct udevice *dev)
|
|
{
|
|
struct felix_priv *priv = dev_get_priv(dev);
|
|
int err;
|
|
|
|
if (ofnode_valid(dev_ofnode(dev)) &&
|
|
!ofnode_is_available(dev_ofnode(dev))) {
|
|
dev_dbg(dev, "switch disabled\n");
|
|
return -ENODEV;
|
|
}
|
|
|
|
priv->imdio_base = dm_pci_map_bar(dev, PCI_BASE_ADDRESS_0, 0, 0, 0);
|
|
if (!priv->imdio_base) {
|
|
dev_err(dev, "failed to map BAR0\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
priv->regs_base = dm_pci_map_bar(dev, PCI_BASE_ADDRESS_4, 0, 0, 0);
|
|
if (!priv->regs_base) {
|
|
dev_err(dev, "failed to map BAR4\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* register internal MDIO for debug */
|
|
if (!miiphy_get_dev_by_name(dev->name)) {
|
|
struct mii_dev *mii_bus;
|
|
|
|
mii_bus = mdio_alloc();
|
|
if (!mii_bus)
|
|
return -ENOMEM;
|
|
|
|
mii_bus->read = felix_mdio_read;
|
|
mii_bus->write = felix_mdio_write;
|
|
mii_bus->priv = priv->imdio_base + FELIX_PM_IMDIO_BASE;
|
|
strlcpy(mii_bus->name, dev->name, MDIO_NAME_LEN);
|
|
err = mdio_register(mii_bus);
|
|
if (err) {
|
|
mdio_free(mii_bus);
|
|
return err;
|
|
}
|
|
}
|
|
|
|
dm_pci_clrset_config16(dev, PCI_COMMAND, 0, PCI_COMMAND_MEMORY);
|
|
|
|
dsa_set_tagging(dev, FELIX_DSA_TAG_LEN, 0);
|
|
|
|
/* set up registers */
|
|
felix_init(dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int felix_port_probe(struct udevice *dev, int port,
|
|
struct phy_device *phy)
|
|
{
|
|
int supported = PHY_GBIT_FEATURES | SUPPORTED_2500baseX_Full;
|
|
struct felix_priv *priv = dev_get_priv(dev);
|
|
|
|
phy->supported &= supported;
|
|
phy->advertising &= supported;
|
|
|
|
felix_start_pcs(dev, port, phy, &priv->imdio);
|
|
|
|
return phy_config(phy);
|
|
}
|
|
|
|
static int felix_port_enable(struct udevice *dev, int port,
|
|
struct phy_device *phy)
|
|
{
|
|
struct felix_priv *priv = dev_get_priv(dev);
|
|
void *base = priv->regs_base;
|
|
|
|
/* Set up MAC registers */
|
|
out_le32(base + FELIX_GMII_CLOCK_CFG(port),
|
|
FELIX_GMII_CLOCK_CFG_LINK_1G);
|
|
|
|
out_le32(base + FELIX_GMII_MAC_IFG_CFG(port),
|
|
FELIX_GMII_MAC_IFG_CFG_DEF);
|
|
|
|
out_le32(base + FELIX_GMII_MAC_ENA_CFG(port),
|
|
FELIX_GMII_MAX_ENA_CFG_TX | FELIX_GMII_MAX_ENA_CFG_RX);
|
|
|
|
out_le32(base + FELIX_QSYS_SYSTEM_SW_PORT_MODE(port),
|
|
FELIX_QSYS_SYSTEM_SW_PORT_ENA |
|
|
FELIX_QSYS_SYSTEM_SW_PORT_LOSSY |
|
|
FELIX_QSYS_SYSTEM_SW_PORT_SCH(1));
|
|
|
|
return phy_startup(phy);
|
|
}
|
|
|
|
static void felix_port_disable(struct udevice *dev, int pidx,
|
|
struct phy_device *phy)
|
|
{
|
|
struct felix_priv *priv = dev_get_priv(dev);
|
|
void *base = priv->regs_base;
|
|
|
|
out_le32(base + FELIX_GMII_MAC_ENA_CFG(pidx), 0);
|
|
|
|
out_le32(base + FELIX_QSYS_SYSTEM_SW_PORT_MODE(pidx),
|
|
FELIX_QSYS_SYSTEM_SW_PORT_LOSSY |
|
|
FELIX_QSYS_SYSTEM_SW_PORT_SCH(1));
|
|
|
|
/*
|
|
* we don't call phy_shutdown here to avoid waiting next time we use
|
|
* the port, but the downside is that remote side will think we're
|
|
* actively processing traffic although we are not.
|
|
*/
|
|
}
|
|
|
|
static int felix_xmit(struct udevice *dev, int pidx, void *packet, int length)
|
|
{
|
|
struct felix_dsa_tag *tag = packet;
|
|
|
|
tag->magic = FELIX_DSA_TAG_MAGIC;
|
|
tag->meta[FELIX_DSA_TAG_INJ_PORT] = FELIX_DSA_TAG_INJ_PORT_SET(pidx);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int felix_rcv(struct udevice *dev, int *pidx, void *packet, int length)
|
|
{
|
|
struct felix_dsa_tag *tag = packet;
|
|
|
|
if (tag->magic != FELIX_DSA_TAG_MAGIC)
|
|
return -EINVAL;
|
|
|
|
*pidx = FELIX_DSA_TAG_EXT_PORT_GET(tag->meta[FELIX_DSA_TAG_EXT_PORT]);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct dsa_ops felix_dsa_ops = {
|
|
.port_probe = felix_port_probe,
|
|
.port_enable = felix_port_enable,
|
|
.port_disable = felix_port_disable,
|
|
.xmit = felix_xmit,
|
|
.rcv = felix_rcv,
|
|
};
|
|
|
|
U_BOOT_DRIVER(felix_ethsw) = {
|
|
.name = "felix-switch",
|
|
.id = UCLASS_DSA,
|
|
.probe = felix_probe,
|
|
.ops = &felix_dsa_ops,
|
|
.priv_auto = sizeof(struct felix_priv),
|
|
};
|
|
|
|
static struct pci_device_id felix_ethsw_ids[] = {
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_FREESCALE, PCI_DEVICE_ID_FELIX_ETHSW) },
|
|
{}
|
|
};
|
|
|
|
U_BOOT_PCI_DEVICE(felix_ethsw, felix_ethsw_ids);
|