2019-07-03 09:11:40 +00:00
|
|
|
// SPDX-License-Identifier: GPL-2.0+
|
|
|
|
/*
|
|
|
|
* ENETC ethernet controller driver
|
2021-06-29 17:53:15 +00:00
|
|
|
* Copyright 2017-2021 NXP
|
2019-07-03 09:11:40 +00:00
|
|
|
*/
|
|
|
|
|
|
|
|
#include <common.h>
|
|
|
|
#include <dm.h>
|
|
|
|
#include <errno.h>
|
2020-05-10 17:40:01 +00:00
|
|
|
#include <fdt_support.h>
|
2020-02-03 14:36:16 +00:00
|
|
|
#include <malloc.h>
|
2019-07-03 09:11:40 +00:00
|
|
|
#include <memalign.h>
|
2020-05-10 17:39:56 +00:00
|
|
|
#include <net.h>
|
|
|
|
#include <asm/cache.h>
|
2019-07-03 09:11:40 +00:00
|
|
|
#include <asm/io.h>
|
|
|
|
#include <pci.h>
|
2019-07-03 09:11:41 +00:00
|
|
|
#include <miiphy.h>
|
2020-05-10 17:40:08 +00:00
|
|
|
#include <linux/bug.h>
|
2020-05-10 17:40:11 +00:00
|
|
|
#include <linux/delay.h>
|
2019-07-03 09:11:40 +00:00
|
|
|
|
|
|
|
#include "fsl_enetc.h"
|
|
|
|
|
2019-12-10 14:55:39 +00:00
|
|
|
#define ENETC_DRIVER_NAME "enetc_eth"
|
|
|
|
|
|
|
|
/*
|
|
|
|
* sets the MAC address in IERB registers, this setting is persistent and
|
|
|
|
* carried over to Linux.
|
|
|
|
*/
|
|
|
|
static void enetc_set_ierb_primary_mac(struct udevice *dev, int devfn,
|
|
|
|
const u8 *enetaddr)
|
|
|
|
{
|
|
|
|
#ifdef CONFIG_ARCH_LS1028A
|
|
|
|
/*
|
|
|
|
* LS1028A is the only part with IERB at this time and there are plans to change
|
|
|
|
* its structure, keep this LS1028A specific for now
|
|
|
|
*/
|
|
|
|
#define IERB_BASE 0x1f0800000ULL
|
|
|
|
#define IERB_PFMAC(pf, vf, n) (IERB_BASE + 0x8000 + (pf) * 0x100 + (vf) * 8 \
|
|
|
|
+ (n) * 4)
|
|
|
|
|
|
|
|
static int ierb_fn_to_pf[] = {0, 1, 2, -1, -1, -1, 3};
|
|
|
|
|
|
|
|
u16 lower = *(const u16 *)(enetaddr + 4);
|
|
|
|
u32 upper = *(const u32 *)enetaddr;
|
|
|
|
|
|
|
|
if (ierb_fn_to_pf[devfn] < 0)
|
|
|
|
return;
|
|
|
|
|
|
|
|
out_le32(IERB_PFMAC(ierb_fn_to_pf[devfn], 0, 0), upper);
|
|
|
|
out_le32(IERB_PFMAC(ierb_fn_to_pf[devfn], 0, 1), (u32)lower);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
/* sets up primary MAC addresses in DT/IERB */
|
|
|
|
void fdt_fixup_enetc_mac(void *blob)
|
|
|
|
{
|
2020-12-03 23:55:23 +00:00
|
|
|
struct pci_child_plat *ppdata;
|
2019-12-10 14:55:39 +00:00
|
|
|
struct eth_pdata *pdata;
|
|
|
|
struct udevice *dev;
|
|
|
|
struct uclass *uc;
|
|
|
|
char path[256];
|
|
|
|
int offset;
|
|
|
|
int devfn;
|
|
|
|
|
|
|
|
uclass_get(UCLASS_ETH, &uc);
|
|
|
|
uclass_foreach_dev(dev, uc) {
|
|
|
|
if (!dev->driver || !dev->driver->name ||
|
|
|
|
strcmp(dev->driver->name, ENETC_DRIVER_NAME))
|
|
|
|
continue;
|
|
|
|
|
2020-12-03 23:55:20 +00:00
|
|
|
pdata = dev_get_plat(dev);
|
2020-12-03 23:55:18 +00:00
|
|
|
ppdata = dev_get_parent_plat(dev);
|
2019-12-10 14:55:39 +00:00
|
|
|
devfn = PCI_FUNC(ppdata->devfn);
|
|
|
|
|
|
|
|
enetc_set_ierb_primary_mac(dev, devfn, pdata->enetaddr);
|
|
|
|
|
|
|
|
snprintf(path, 256, "/soc/pcie@1f0000000/ethernet@%x,%x",
|
|
|
|
PCI_DEV(ppdata->devfn), PCI_FUNC(ppdata->devfn));
|
|
|
|
offset = fdt_path_offset(blob, path);
|
|
|
|
if (offset < 0)
|
|
|
|
continue;
|
|
|
|
fdt_setprop(blob, offset, "mac-address", pdata->enetaddr, 6);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2019-07-03 09:11:40 +00:00
|
|
|
/*
|
|
|
|
* Bind the device:
|
|
|
|
* - set a more explicit name on the interface
|
|
|
|
*/
|
|
|
|
static int enetc_bind(struct udevice *dev)
|
|
|
|
{
|
|
|
|
char name[16];
|
|
|
|
static int eth_num_devices;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* prefer using PCI function numbers to number interfaces, but these
|
|
|
|
* are only available if dts nodes are present. For PCI they are
|
|
|
|
* optional, handle that case too. Just in case some nodes are present
|
|
|
|
* and some are not, use different naming scheme - enetc-N based on
|
|
|
|
* PCI function # and enetc#N based on interface count
|
|
|
|
*/
|
2020-12-19 17:40:14 +00:00
|
|
|
if (ofnode_valid(dev_ofnode(dev)))
|
2019-07-03 09:11:40 +00:00
|
|
|
sprintf(name, "enetc-%u", PCI_FUNC(pci_get_devfn(dev)));
|
|
|
|
else
|
|
|
|
sprintf(name, "enetc#%u", eth_num_devices++);
|
|
|
|
device_set_name(dev, name);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2019-07-03 09:11:42 +00:00
|
|
|
/* MDIO wrappers, we're using these to drive internal MDIO to get to serdes */
|
|
|
|
static int enetc_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 enetc_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);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* only interfaces that can pin out through serdes have internal MDIO */
|
|
|
|
static bool enetc_has_imdio(struct udevice *dev)
|
|
|
|
{
|
|
|
|
struct enetc_priv *priv = dev_get_priv(dev);
|
|
|
|
|
|
|
|
return !!(priv->imdio.priv);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* set up serdes for SGMII */
|
|
|
|
static int enetc_init_sgmii(struct udevice *dev)
|
|
|
|
{
|
|
|
|
struct enetc_priv *priv = dev_get_priv(dev);
|
2019-07-15 08:48:47 +00:00
|
|
|
bool is2500 = false;
|
|
|
|
u16 reg;
|
2019-07-03 09:11:42 +00:00
|
|
|
|
|
|
|
if (!enetc_has_imdio(dev))
|
|
|
|
return 0;
|
|
|
|
|
net: freescale: replace usage of phy-mode = "sgmii-2500" with "2500base-x"
After the discussion here:
https://lore.kernel.org/netdev/20210603143453.if7hgifupx5k433b@pali/
which resulted in this patch:
https://patchwork.kernel.org/project/netdevbpf/patch/20210704134325.24842-1-pali@kernel.org/
and many other discussions before it, notably:
https://patchwork.kernel.org/project/linux-arm-kernel/patch/1512016235-15909-1-git-send-email-Bhaskar.Upadhaya@nxp.com/
it became apparent that nobody really knows what "SGMII 2500" is.
Certainly, Freescale/NXP hardware engineers name this protocol
"SGMII 2500" in the reference manuals, but the PCS devices do not
support any "SGMII" specific features when operating at the speed of
2500 Mbps, no in-band autoneg and no speed change via symbol replication
. So that leaves a fixed speed of 2500 Mbps using a coding of 8b/10b
with a SERDES lane frequency of 3.125 GHz. In fact, "SGMII 2500 without
in-band autoneg and at a fixed speed" is indistinguishable from
"2500base-x without in-band autoneg", which is precisely what these NXP
devices support.
So it just appears that "SGMII 2500" is an unclear name with no clear
definition that stuck.
As such, in the Linux kernel, the drivers which use this SERDES protocol
use the 2500base-x phy-mode.
This patch converts U-Boot to use 2500base-x too, or at least, as much
as it can.
Note that I would have really liked to delete PHY_INTERFACE_MODE_SGMII_2500
completely, but the mvpp2 driver seems to even distinguish between SGMII
2500 and 2500base-X. Namely, it enables in-band autoneg for one but not
the other, and forces flow control for one but not the other. This goes
back to the idea that maybe 2500base-X is a fiber protocol and SGMII-2500
is an MII protocol (connects a MAC to a PHY such as Aquantia), but the
two are practically indistinguishable through everything except use case.
NXP devices can support both use cases through an identical configuration,
for example RX flow control can be unconditionally enabled in order to
support rate adaptation performed by an Aquantia PHY. At least I can
find no indication in online documents published by Cisco which would
point towards "SGMII-2500" being an actual standard with an actual
definition, so I cannot say "yes, NXP devices support it".
Signed-off-by: Vladimir Oltean <vladimir.oltean@nxp.com>
Reviewed-by: Ramon Fried <rfried.dev@gmail.com>
2021-09-18 12:32:35 +00:00
|
|
|
if (priv->if_type == PHY_INTERFACE_MODE_2500BASEX)
|
2019-07-15 08:48:47 +00:00
|
|
|
is2500 = true;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* 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 |= is2500 ? ENETC_PCS_IF_MODE_SPEED_1G : ENETC_PCS_IF_MODE_SGMII_AN;
|
2019-07-03 09:11:42 +00:00
|
|
|
enetc_mdio_write(&priv->imdio, ENETC_PCS_PHY_ADDR, MDIO_DEVAD_NONE,
|
2019-07-15 08:48:47 +00:00
|
|
|
ENETC_PCS_IF_MODE, reg);
|
2019-07-03 09:11:42 +00:00
|
|
|
|
|
|
|
/* Dev ability - SGMII */
|
|
|
|
enetc_mdio_write(&priv->imdio, ENETC_PCS_PHY_ADDR, MDIO_DEVAD_NONE,
|
|
|
|
ENETC_PCS_DEV_ABILITY, ENETC_PCS_DEV_ABILITY_SGMII);
|
|
|
|
|
|
|
|
/* Adjust link timer for SGMII */
|
|
|
|
enetc_mdio_write(&priv->imdio, ENETC_PCS_PHY_ADDR, MDIO_DEVAD_NONE,
|
|
|
|
ENETC_PCS_LINK_TIMER1, ENETC_PCS_LINK_TIMER1_VAL);
|
|
|
|
enetc_mdio_write(&priv->imdio, ENETC_PCS_PHY_ADDR, MDIO_DEVAD_NONE,
|
|
|
|
ENETC_PCS_LINK_TIMER2, ENETC_PCS_LINK_TIMER2_VAL);
|
|
|
|
|
2019-07-15 08:48:47 +00:00
|
|
|
reg = ENETC_PCS_CR_DEF_VAL;
|
|
|
|
reg |= is2500 ? ENETC_PCS_CR_RST : ENETC_PCS_CR_RESET_AN;
|
2019-07-03 09:11:42 +00:00
|
|
|
/* restart PCS AN */
|
|
|
|
enetc_mdio_write(&priv->imdio, ENETC_PCS_PHY_ADDR, MDIO_DEVAD_NONE,
|
2019-07-15 08:48:47 +00:00
|
|
|
ENETC_PCS_CR, reg);
|
2019-07-03 09:11:42 +00:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* set up MAC for RGMII */
|
2021-06-29 17:53:16 +00:00
|
|
|
static void enetc_init_rgmii(struct udevice *dev, struct phy_device *phydev)
|
2019-07-03 09:11:42 +00:00
|
|
|
{
|
|
|
|
struct enetc_priv *priv = dev_get_priv(dev);
|
2021-06-29 17:53:16 +00:00
|
|
|
u32 old_val, val;
|
2019-07-03 09:11:42 +00:00
|
|
|
|
2021-06-29 17:53:16 +00:00
|
|
|
old_val = val = enetc_read_port(priv, ENETC_PM_IF_MODE);
|
2019-07-03 09:11:42 +00:00
|
|
|
|
2021-06-29 17:53:16 +00:00
|
|
|
/* disable unreliable RGMII in-band signaling and force the MAC into
|
|
|
|
* the speed negotiated by the PHY.
|
|
|
|
*/
|
|
|
|
val &= ~ENETC_PM_IF_MODE_AN_ENA;
|
|
|
|
|
|
|
|
if (phydev->speed == SPEED_1000) {
|
|
|
|
val &= ~ENETC_PM_IFM_SSP_MASK;
|
|
|
|
val |= ENETC_PM_IFM_SSP_1000;
|
|
|
|
} else if (phydev->speed == SPEED_100) {
|
|
|
|
val &= ~ENETC_PM_IFM_SSP_MASK;
|
|
|
|
val |= ENETC_PM_IFM_SSP_100;
|
|
|
|
} else if (phydev->speed == SPEED_10) {
|
|
|
|
val &= ~ENETC_PM_IFM_SSP_MASK;
|
|
|
|
val |= ENETC_PM_IFM_SSP_10;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (phydev->duplex == DUPLEX_FULL)
|
|
|
|
val |= ENETC_PM_IFM_FULL_DPX;
|
|
|
|
else
|
|
|
|
val &= ~ENETC_PM_IFM_FULL_DPX;
|
|
|
|
|
|
|
|
if (val == old_val)
|
|
|
|
return;
|
|
|
|
|
|
|
|
enetc_write_port(priv, ENETC_PM_IF_MODE, val);
|
2019-07-03 09:11:42 +00:00
|
|
|
}
|
|
|
|
|
2020-01-10 21:32:20 +00:00
|
|
|
/* set up MAC configuration for the given interface type */
|
2021-06-29 17:53:16 +00:00
|
|
|
static void enetc_setup_mac_iface(struct udevice *dev,
|
|
|
|
struct phy_device *phydev)
|
2019-07-03 09:11:42 +00:00
|
|
|
{
|
|
|
|
struct enetc_priv *priv = dev_get_priv(dev);
|
|
|
|
u32 if_mode;
|
|
|
|
|
2020-01-10 21:32:20 +00:00
|
|
|
switch (priv->if_type) {
|
|
|
|
case PHY_INTERFACE_MODE_RGMII:
|
|
|
|
case PHY_INTERFACE_MODE_RGMII_ID:
|
|
|
|
case PHY_INTERFACE_MODE_RGMII_RXID:
|
|
|
|
case PHY_INTERFACE_MODE_RGMII_TXID:
|
2021-06-29 17:53:16 +00:00
|
|
|
enetc_init_rgmii(dev, phydev);
|
2020-01-10 21:32:20 +00:00
|
|
|
break;
|
|
|
|
case PHY_INTERFACE_MODE_USXGMII:
|
2021-09-18 12:32:34 +00:00
|
|
|
case PHY_INTERFACE_MODE_10GBASER:
|
2020-01-10 21:32:20 +00:00
|
|
|
/* set ifmode to (US)XGMII */
|
|
|
|
if_mode = enetc_read_port(priv, ENETC_PM_IF_MODE);
|
|
|
|
if_mode &= ~ENETC_PM_IF_IFMODE_MASK;
|
|
|
|
enetc_write_port(priv, ENETC_PM_IF_MODE, if_mode);
|
|
|
|
break;
|
|
|
|
};
|
|
|
|
}
|
|
|
|
|
|
|
|
/* set up serdes for SXGMII */
|
|
|
|
static int enetc_init_sxgmii(struct udevice *dev)
|
|
|
|
{
|
|
|
|
struct enetc_priv *priv = dev_get_priv(dev);
|
2019-07-03 09:11:42 +00:00
|
|
|
|
|
|
|
if (!enetc_has_imdio(dev))
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
/* Dev ability - SXGMII */
|
|
|
|
enetc_mdio_write(&priv->imdio, ENETC_PCS_PHY_ADDR, ENETC_PCS_DEVAD_REPL,
|
|
|
|
ENETC_PCS_DEV_ABILITY, ENETC_PCS_DEV_ABILITY_SXGMII);
|
|
|
|
|
|
|
|
/* Restart PCS AN */
|
|
|
|
enetc_mdio_write(&priv->imdio, ENETC_PCS_PHY_ADDR, ENETC_PCS_DEVAD_REPL,
|
|
|
|
ENETC_PCS_CR,
|
2019-07-15 08:48:47 +00:00
|
|
|
ENETC_PCS_CR_RST | ENETC_PCS_CR_RESET_AN);
|
2019-07-03 09:11:42 +00:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Apply protocol specific configuration to MAC, serdes as needed */
|
|
|
|
static void enetc_start_pcs(struct udevice *dev)
|
|
|
|
{
|
|
|
|
struct enetc_priv *priv = dev_get_priv(dev);
|
|
|
|
|
2019-11-25 15:57:27 +00:00
|
|
|
/* register internal MDIO for debug purposes */
|
2019-07-03 09:11:42 +00:00
|
|
|
if (enetc_read_port(priv, ENETC_PCAPR0) & ENETC_PCAPRO_MDIO) {
|
|
|
|
priv->imdio.read = enetc_mdio_read;
|
|
|
|
priv->imdio.write = enetc_mdio_write;
|
|
|
|
priv->imdio.priv = priv->port_regs + ENETC_PM_IMDIO_BASE;
|
2021-09-27 11:21:48 +00:00
|
|
|
strlcpy(priv->imdio.name, dev->name, MDIO_NAME_LEN);
|
2019-11-25 15:57:27 +00:00
|
|
|
if (!miiphy_get_dev_by_name(priv->imdio.name))
|
|
|
|
mdio_register(&priv->imdio);
|
2019-07-03 09:11:42 +00:00
|
|
|
}
|
|
|
|
|
2020-12-19 17:40:14 +00:00
|
|
|
if (!ofnode_valid(dev_ofnode(dev))) {
|
2019-07-03 09:11:42 +00:00
|
|
|
enetc_dbg(dev, "no enetc ofnode found, skipping PCS set-up\n");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2022-04-06 22:33:01 +00:00
|
|
|
priv->if_type = dev_read_phy_mode(dev);
|
2022-04-06 22:33:03 +00:00
|
|
|
if (priv->if_type == PHY_INTERFACE_MODE_NA) {
|
2019-07-03 09:11:42 +00:00
|
|
|
enetc_dbg(dev,
|
|
|
|
"phy-mode property not found, defaulting to SGMII\n");
|
2022-04-06 22:33:01 +00:00
|
|
|
priv->if_type = PHY_INTERFACE_MODE_SGMII;
|
|
|
|
}
|
2019-07-03 09:11:42 +00:00
|
|
|
|
|
|
|
switch (priv->if_type) {
|
|
|
|
case PHY_INTERFACE_MODE_SGMII:
|
net: freescale: replace usage of phy-mode = "sgmii-2500" with "2500base-x"
After the discussion here:
https://lore.kernel.org/netdev/20210603143453.if7hgifupx5k433b@pali/
which resulted in this patch:
https://patchwork.kernel.org/project/netdevbpf/patch/20210704134325.24842-1-pali@kernel.org/
and many other discussions before it, notably:
https://patchwork.kernel.org/project/linux-arm-kernel/patch/1512016235-15909-1-git-send-email-Bhaskar.Upadhaya@nxp.com/
it became apparent that nobody really knows what "SGMII 2500" is.
Certainly, Freescale/NXP hardware engineers name this protocol
"SGMII 2500" in the reference manuals, but the PCS devices do not
support any "SGMII" specific features when operating at the speed of
2500 Mbps, no in-band autoneg and no speed change via symbol replication
. So that leaves a fixed speed of 2500 Mbps using a coding of 8b/10b
with a SERDES lane frequency of 3.125 GHz. In fact, "SGMII 2500 without
in-band autoneg and at a fixed speed" is indistinguishable from
"2500base-x without in-band autoneg", which is precisely what these NXP
devices support.
So it just appears that "SGMII 2500" is an unclear name with no clear
definition that stuck.
As such, in the Linux kernel, the drivers which use this SERDES protocol
use the 2500base-x phy-mode.
This patch converts U-Boot to use 2500base-x too, or at least, as much
as it can.
Note that I would have really liked to delete PHY_INTERFACE_MODE_SGMII_2500
completely, but the mvpp2 driver seems to even distinguish between SGMII
2500 and 2500base-X. Namely, it enables in-band autoneg for one but not
the other, and forces flow control for one but not the other. This goes
back to the idea that maybe 2500base-X is a fiber protocol and SGMII-2500
is an MII protocol (connects a MAC to a PHY such as Aquantia), but the
two are practically indistinguishable through everything except use case.
NXP devices can support both use cases through an identical configuration,
for example RX flow control can be unconditionally enabled in order to
support rate adaptation performed by an Aquantia PHY. At least I can
find no indication in online documents published by Cisco which would
point towards "SGMII-2500" being an actual standard with an actual
definition, so I cannot say "yes, NXP devices support it".
Signed-off-by: Vladimir Oltean <vladimir.oltean@nxp.com>
Reviewed-by: Ramon Fried <rfried.dev@gmail.com>
2021-09-18 12:32:35 +00:00
|
|
|
case PHY_INTERFACE_MODE_2500BASEX:
|
2019-07-03 09:11:42 +00:00
|
|
|
enetc_init_sgmii(dev);
|
|
|
|
break;
|
2019-11-14 16:28:38 +00:00
|
|
|
case PHY_INTERFACE_MODE_USXGMII:
|
2021-09-18 12:32:34 +00:00
|
|
|
case PHY_INTERFACE_MODE_10GBASER:
|
2019-07-03 09:11:42 +00:00
|
|
|
enetc_init_sxgmii(dev);
|
|
|
|
break;
|
|
|
|
};
|
|
|
|
}
|
|
|
|
|
2019-07-03 09:11:41 +00:00
|
|
|
/* Configure the actual/external ethernet PHY, if one is found */
|
2021-06-29 17:53:15 +00:00
|
|
|
static int enetc_config_phy(struct udevice *dev)
|
2019-07-03 09:11:41 +00:00
|
|
|
{
|
|
|
|
struct enetc_priv *priv = dev_get_priv(dev);
|
|
|
|
int supported;
|
|
|
|
|
2019-11-25 15:15:13 +00:00
|
|
|
priv->phy = dm_eth_phy_connect(dev);
|
|
|
|
if (!priv->phy)
|
2021-06-29 17:53:15 +00:00
|
|
|
return -ENODEV;
|
2019-07-03 09:11:41 +00:00
|
|
|
|
2019-11-14 16:58:45 +00:00
|
|
|
supported = PHY_GBIT_FEATURES | SUPPORTED_2500baseX_Full;
|
|
|
|
priv->phy->supported &= supported;
|
|
|
|
priv->phy->advertising &= supported;
|
2019-11-25 15:15:13 +00:00
|
|
|
|
2021-06-29 17:53:15 +00:00
|
|
|
return phy_config(priv->phy);
|
2019-07-03 09:11:41 +00:00
|
|
|
}
|
|
|
|
|
2019-07-03 09:11:40 +00:00
|
|
|
/*
|
|
|
|
* Probe ENETC driver:
|
|
|
|
* - initialize port and station interface BARs
|
|
|
|
*/
|
|
|
|
static int enetc_probe(struct udevice *dev)
|
|
|
|
{
|
|
|
|
struct enetc_priv *priv = dev_get_priv(dev);
|
|
|
|
|
2020-12-19 17:40:14 +00:00
|
|
|
if (ofnode_valid(dev_ofnode(dev)) && !ofnode_is_available(dev_ofnode(dev))) {
|
2019-07-03 09:11:40 +00:00
|
|
|
enetc_dbg(dev, "interface disabled\n");
|
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
|
|
|
|
priv->enetc_txbd = memalign(ENETC_BD_ALIGN,
|
|
|
|
sizeof(struct enetc_tx_bd) * ENETC_BD_CNT);
|
|
|
|
priv->enetc_rxbd = memalign(ENETC_BD_ALIGN,
|
|
|
|
sizeof(union enetc_rx_bd) * ENETC_BD_CNT);
|
|
|
|
|
|
|
|
if (!priv->enetc_txbd || !priv->enetc_rxbd) {
|
|
|
|
/* free should be able to handle NULL, just free all pointers */
|
|
|
|
free(priv->enetc_txbd);
|
|
|
|
free(priv->enetc_rxbd);
|
|
|
|
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* initialize register */
|
2022-04-21 16:11:13 +00:00
|
|
|
priv->regs_base = dm_pci_map_bar(dev, PCI_BASE_ADDRESS_0, 0, 0, PCI_REGION_TYPE, 0);
|
2019-07-03 09:11:40 +00:00
|
|
|
if (!priv->regs_base) {
|
|
|
|
enetc_dbg(dev, "failed to map BAR0\n");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
priv->port_regs = priv->regs_base + ENETC_PORT_REGS_OFF;
|
|
|
|
|
|
|
|
dm_pci_clrset_config16(dev, PCI_COMMAND, 0, PCI_COMMAND_MEMORY);
|
|
|
|
|
2019-11-14 16:58:46 +00:00
|
|
|
enetc_start_pcs(dev);
|
|
|
|
|
2021-06-29 17:53:15 +00:00
|
|
|
return enetc_config_phy(dev);
|
2019-07-03 09:11:40 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Remove the driver from an interface:
|
|
|
|
* - free up allocated memory
|
|
|
|
*/
|
|
|
|
static int enetc_remove(struct udevice *dev)
|
|
|
|
{
|
|
|
|
struct enetc_priv *priv = dev_get_priv(dev);
|
|
|
|
|
|
|
|
free(priv->enetc_txbd);
|
|
|
|
free(priv->enetc_rxbd);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2019-12-20 13:16:48 +00:00
|
|
|
/*
|
|
|
|
* LS1028A is the only part with IERB at this time and there are plans to
|
|
|
|
* change its structure, keep this LS1028A specific for now.
|
|
|
|
*/
|
|
|
|
#define LS1028A_IERB_BASE 0x1f0800000ULL
|
|
|
|
#define LS1028A_IERB_PSIPMAR0(pf, vf) (LS1028A_IERB_BASE + 0x8000 \
|
|
|
|
+ (pf) * 0x100 + (vf) * 8)
|
|
|
|
#define LS1028A_IERB_PSIPMAR1(pf, vf) (LS1028A_IERB_PSIPMAR0(pf, vf) + 4)
|
|
|
|
|
|
|
|
static int enetc_ls1028a_write_hwaddr(struct udevice *dev)
|
|
|
|
{
|
2020-12-03 23:55:23 +00:00
|
|
|
struct pci_child_plat *ppdata = dev_get_parent_plat(dev);
|
2019-12-20 13:16:48 +00:00
|
|
|
const int devfn_to_pf[] = {0, 1, 2, -1, -1, -1, 3};
|
2020-12-03 23:55:20 +00:00
|
|
|
struct eth_pdata *plat = dev_get_plat(dev);
|
2019-12-20 13:16:48 +00:00
|
|
|
int devfn = PCI_FUNC(ppdata->devfn);
|
|
|
|
u8 *addr = plat->enetaddr;
|
|
|
|
u32 lower, upper;
|
|
|
|
int pf;
|
|
|
|
|
|
|
|
if (devfn >= ARRAY_SIZE(devfn_to_pf))
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
pf = devfn_to_pf[devfn];
|
|
|
|
if (pf < 0)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
lower = *(const u16 *)(addr + 4);
|
|
|
|
upper = *(const u32 *)addr;
|
|
|
|
|
|
|
|
out_le32(LS1028A_IERB_PSIPMAR0(pf, 0), upper);
|
|
|
|
out_le32(LS1028A_IERB_PSIPMAR1(pf, 0), lower);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2019-12-20 13:16:47 +00:00
|
|
|
static int enetc_write_hwaddr(struct udevice *dev)
|
2019-07-03 09:11:40 +00:00
|
|
|
{
|
2020-12-03 23:55:20 +00:00
|
|
|
struct eth_pdata *plat = dev_get_plat(dev);
|
2019-12-20 13:16:47 +00:00
|
|
|
struct enetc_priv *priv = dev_get_priv(dev);
|
|
|
|
u8 *addr = plat->enetaddr;
|
|
|
|
|
2019-12-20 13:16:48 +00:00
|
|
|
if (IS_ENABLED(CONFIG_ARCH_LS1028A))
|
|
|
|
return enetc_ls1028a_write_hwaddr(dev);
|
|
|
|
|
2019-07-03 09:11:40 +00:00
|
|
|
u16 lower = *(const u16 *)(addr + 4);
|
|
|
|
u32 upper = *(const u32 *)addr;
|
|
|
|
|
|
|
|
enetc_write_port(priv, ENETC_PSIPMAR0, upper);
|
|
|
|
enetc_write_port(priv, ENETC_PSIPMAR1, lower);
|
2019-12-20 13:16:47 +00:00
|
|
|
|
|
|
|
return 0;
|
2019-07-03 09:11:40 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Configure port parameters (# of rings, frame size, enable port) */
|
|
|
|
static void enetc_enable_si_port(struct enetc_priv *priv)
|
|
|
|
{
|
|
|
|
u32 val;
|
|
|
|
|
|
|
|
/* set Rx/Tx BDR count */
|
|
|
|
val = ENETC_PSICFGR_SET_TXBDR(ENETC_TX_BDR_CNT);
|
|
|
|
val |= ENETC_PSICFGR_SET_RXBDR(ENETC_RX_BDR_CNT);
|
|
|
|
enetc_write_port(priv, ENETC_PSICFGR(0), val);
|
|
|
|
/* set Rx max frame size */
|
|
|
|
enetc_write_port(priv, ENETC_PM_MAXFRM, ENETC_RX_MAXFRM_SIZE);
|
|
|
|
/* enable MAC port */
|
|
|
|
enetc_write_port(priv, ENETC_PM_CC, ENETC_PM_CC_RX_TX_EN);
|
|
|
|
/* enable port */
|
|
|
|
enetc_write_port(priv, ENETC_PMR, ENETC_PMR_SI0_EN);
|
|
|
|
/* set SI cache policy */
|
|
|
|
enetc_write(priv, ENETC_SICAR0,
|
|
|
|
ENETC_SICAR_RD_CFG | ENETC_SICAR_WR_CFG);
|
|
|
|
/* enable SI */
|
|
|
|
enetc_write(priv, ENETC_SIMR, ENETC_SIMR_EN);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* returns DMA address for a given buffer index */
|
|
|
|
static inline u64 enetc_rxb_address(struct udevice *dev, int i)
|
|
|
|
{
|
|
|
|
return cpu_to_le64(dm_pci_virt_to_mem(dev, net_rx_packets[i]));
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Setup a single Tx BD Ring (ID = 0):
|
|
|
|
* - set Tx buffer descriptor address
|
|
|
|
* - set the BD count
|
|
|
|
* - initialize the producer and consumer index
|
|
|
|
*/
|
|
|
|
static void enetc_setup_tx_bdr(struct udevice *dev)
|
|
|
|
{
|
|
|
|
struct enetc_priv *priv = dev_get_priv(dev);
|
|
|
|
struct bd_ring *tx_bdr = &priv->tx_bdr;
|
|
|
|
u64 tx_bd_add = (u64)priv->enetc_txbd;
|
|
|
|
|
|
|
|
/* used later to advance to the next Tx BD */
|
|
|
|
tx_bdr->bd_count = ENETC_BD_CNT;
|
|
|
|
tx_bdr->next_prod_idx = 0;
|
|
|
|
tx_bdr->next_cons_idx = 0;
|
|
|
|
tx_bdr->cons_idx = priv->regs_base +
|
|
|
|
ENETC_BDR(TX, ENETC_TX_BDR_ID, ENETC_TBCIR);
|
|
|
|
tx_bdr->prod_idx = priv->regs_base +
|
|
|
|
ENETC_BDR(TX, ENETC_TX_BDR_ID, ENETC_TBPIR);
|
|
|
|
|
|
|
|
/* set Tx BD address */
|
|
|
|
enetc_bdr_write(priv, TX, ENETC_TX_BDR_ID, ENETC_TBBAR0,
|
|
|
|
lower_32_bits(tx_bd_add));
|
|
|
|
enetc_bdr_write(priv, TX, ENETC_TX_BDR_ID, ENETC_TBBAR1,
|
|
|
|
upper_32_bits(tx_bd_add));
|
|
|
|
/* set Tx 8 BD count */
|
|
|
|
enetc_bdr_write(priv, TX, ENETC_TX_BDR_ID, ENETC_TBLENR,
|
|
|
|
tx_bdr->bd_count);
|
|
|
|
|
|
|
|
/* reset both producer/consumer indexes */
|
|
|
|
enetc_write_reg(tx_bdr->cons_idx, tx_bdr->next_cons_idx);
|
|
|
|
enetc_write_reg(tx_bdr->prod_idx, tx_bdr->next_prod_idx);
|
|
|
|
|
|
|
|
/* enable TX ring */
|
|
|
|
enetc_bdr_write(priv, TX, ENETC_TX_BDR_ID, ENETC_TBMR, ENETC_TBMR_EN);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Setup a single Rx BD Ring (ID = 0):
|
|
|
|
* - set Rx buffer descriptors address (one descriptor per buffer)
|
|
|
|
* - set buffer size as max frame size
|
|
|
|
* - enable Rx ring
|
|
|
|
* - reset consumer and producer indexes
|
|
|
|
* - set buffer for each descriptor
|
|
|
|
*/
|
|
|
|
static void enetc_setup_rx_bdr(struct udevice *dev)
|
|
|
|
{
|
|
|
|
struct enetc_priv *priv = dev_get_priv(dev);
|
|
|
|
struct bd_ring *rx_bdr = &priv->rx_bdr;
|
|
|
|
u64 rx_bd_add = (u64)priv->enetc_rxbd;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
/* used later to advance to the next BD produced by ENETC HW */
|
|
|
|
rx_bdr->bd_count = ENETC_BD_CNT;
|
|
|
|
rx_bdr->next_prod_idx = 0;
|
|
|
|
rx_bdr->next_cons_idx = 0;
|
|
|
|
rx_bdr->cons_idx = priv->regs_base +
|
|
|
|
ENETC_BDR(RX, ENETC_RX_BDR_ID, ENETC_RBCIR);
|
|
|
|
rx_bdr->prod_idx = priv->regs_base +
|
|
|
|
ENETC_BDR(RX, ENETC_RX_BDR_ID, ENETC_RBPIR);
|
|
|
|
|
|
|
|
/* set Rx BD address */
|
|
|
|
enetc_bdr_write(priv, RX, ENETC_RX_BDR_ID, ENETC_RBBAR0,
|
|
|
|
lower_32_bits(rx_bd_add));
|
|
|
|
enetc_bdr_write(priv, RX, ENETC_RX_BDR_ID, ENETC_RBBAR1,
|
|
|
|
upper_32_bits(rx_bd_add));
|
|
|
|
/* set Rx BD count (multiple of 8) */
|
|
|
|
enetc_bdr_write(priv, RX, ENETC_RX_BDR_ID, ENETC_RBLENR,
|
|
|
|
rx_bdr->bd_count);
|
|
|
|
/* set Rx buffer size */
|
|
|
|
enetc_bdr_write(priv, RX, ENETC_RX_BDR_ID, ENETC_RBBSR, PKTSIZE_ALIGN);
|
|
|
|
|
|
|
|
/* fill Rx BD */
|
|
|
|
memset(priv->enetc_rxbd, 0,
|
|
|
|
rx_bdr->bd_count * sizeof(union enetc_rx_bd));
|
|
|
|
for (i = 0; i < rx_bdr->bd_count; i++) {
|
|
|
|
priv->enetc_rxbd[i].w.addr = enetc_rxb_address(dev, i);
|
|
|
|
/* each RX buffer must be aligned to 64B */
|
|
|
|
WARN_ON(priv->enetc_rxbd[i].w.addr & (ARCH_DMA_MINALIGN - 1));
|
|
|
|
}
|
|
|
|
|
|
|
|
/* reset producer (ENETC owned) and consumer (SW owned) index */
|
|
|
|
enetc_write_reg(rx_bdr->cons_idx, rx_bdr->next_cons_idx);
|
|
|
|
enetc_write_reg(rx_bdr->prod_idx, rx_bdr->next_prod_idx);
|
|
|
|
|
|
|
|
/* enable Rx ring */
|
|
|
|
enetc_bdr_write(priv, RX, ENETC_RX_BDR_ID, ENETC_RBMR, ENETC_RBMR_EN);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Start ENETC interface:
|
|
|
|
* - perform FLR
|
|
|
|
* - enable access to port and SI registers
|
|
|
|
* - set mac address
|
|
|
|
* - setup TX/RX buffer descriptors
|
|
|
|
* - enable Tx/Rx rings
|
|
|
|
*/
|
|
|
|
static int enetc_start(struct udevice *dev)
|
|
|
|
{
|
|
|
|
struct enetc_priv *priv = dev_get_priv(dev);
|
|
|
|
|
|
|
|
/* reset and enable the PCI device */
|
|
|
|
dm_pci_flr(dev);
|
|
|
|
dm_pci_clrset_config16(dev, PCI_COMMAND, 0,
|
|
|
|
PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER);
|
|
|
|
|
|
|
|
enetc_enable_si_port(priv);
|
|
|
|
|
|
|
|
/* setup Tx/Rx buffer descriptors */
|
|
|
|
enetc_setup_tx_bdr(dev);
|
|
|
|
enetc_setup_rx_bdr(dev);
|
|
|
|
|
2021-06-29 17:53:16 +00:00
|
|
|
enetc_setup_mac_iface(dev, priv->phy);
|
|
|
|
|
2021-06-29 17:53:17 +00:00
|
|
|
return phy_startup(priv->phy);
|
2019-07-03 09:11:40 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Stop the network interface:
|
|
|
|
* - just quiesce it, we can wipe all configuration as _start starts from
|
|
|
|
* scratch each time
|
|
|
|
*/
|
|
|
|
static void enetc_stop(struct udevice *dev)
|
|
|
|
{
|
|
|
|
/* FLR is sufficient to quiesce the device */
|
|
|
|
dm_pci_flr(dev);
|
2019-11-25 15:57:27 +00:00
|
|
|
/* leave the BARs accessible after we stop, this is needed to use
|
|
|
|
* internal MDIO in command line.
|
|
|
|
*/
|
|
|
|
dm_pci_clrset_config16(dev, PCI_COMMAND, 0, PCI_COMMAND_MEMORY);
|
2019-07-03 09:11:40 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* ENETC transmit packet:
|
|
|
|
* - check if Tx BD ring is full
|
|
|
|
* - set buffer/packet address (dma address)
|
|
|
|
* - set final fragment flag
|
|
|
|
* - try while producer index equals consumer index or timeout
|
|
|
|
*/
|
|
|
|
static int enetc_send(struct udevice *dev, void *packet, int length)
|
|
|
|
{
|
|
|
|
struct enetc_priv *priv = dev_get_priv(dev);
|
|
|
|
struct bd_ring *txr = &priv->tx_bdr;
|
|
|
|
void *nv_packet = (void *)packet;
|
|
|
|
int tries = ENETC_POLL_TRIES;
|
|
|
|
u32 pi, ci;
|
|
|
|
|
|
|
|
pi = txr->next_prod_idx;
|
|
|
|
ci = enetc_read_reg(txr->cons_idx) & ENETC_BDR_IDX_MASK;
|
|
|
|
/* Tx ring is full when */
|
|
|
|
if (((pi + 1) % txr->bd_count) == ci) {
|
|
|
|
enetc_dbg(dev, "Tx BDR full\n");
|
|
|
|
return -ETIMEDOUT;
|
|
|
|
}
|
|
|
|
enetc_dbg(dev, "TxBD[%d]send: pkt_len=%d, buff @0x%x%08x\n", pi, length,
|
|
|
|
upper_32_bits((u64)nv_packet), lower_32_bits((u64)nv_packet));
|
|
|
|
|
|
|
|
/* prepare Tx BD */
|
|
|
|
memset(&priv->enetc_txbd[pi], 0x0, sizeof(struct enetc_tx_bd));
|
|
|
|
priv->enetc_txbd[pi].addr =
|
|
|
|
cpu_to_le64(dm_pci_virt_to_mem(dev, nv_packet));
|
|
|
|
priv->enetc_txbd[pi].buf_len = cpu_to_le16(length);
|
|
|
|
priv->enetc_txbd[pi].frm_len = cpu_to_le16(length);
|
|
|
|
priv->enetc_txbd[pi].flags = cpu_to_le16(ENETC_TXBD_FLAGS_F);
|
|
|
|
dmb();
|
|
|
|
/* send frame: increment producer index */
|
|
|
|
pi = (pi + 1) % txr->bd_count;
|
|
|
|
txr->next_prod_idx = pi;
|
|
|
|
enetc_write_reg(txr->prod_idx, pi);
|
|
|
|
while ((--tries >= 0) &&
|
|
|
|
(pi != (enetc_read_reg(txr->cons_idx) & ENETC_BDR_IDX_MASK)))
|
|
|
|
udelay(10);
|
|
|
|
|
|
|
|
return tries > 0 ? 0 : -ETIMEDOUT;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Receive frame:
|
|
|
|
* - wait for the next BD to get ready bit set
|
|
|
|
* - clean up the descriptor
|
|
|
|
* - move on and indicate to HW that the cleaned BD is available for Rx
|
|
|
|
*/
|
|
|
|
static int enetc_recv(struct udevice *dev, int flags, uchar **packetp)
|
|
|
|
{
|
|
|
|
struct enetc_priv *priv = dev_get_priv(dev);
|
|
|
|
struct bd_ring *rxr = &priv->rx_bdr;
|
|
|
|
int tries = ENETC_POLL_TRIES;
|
|
|
|
int pi = rxr->next_prod_idx;
|
|
|
|
int ci = rxr->next_cons_idx;
|
|
|
|
u32 status;
|
|
|
|
int len;
|
|
|
|
u8 rdy;
|
|
|
|
|
|
|
|
do {
|
|
|
|
dmb();
|
|
|
|
status = le32_to_cpu(priv->enetc_rxbd[pi].r.lstatus);
|
|
|
|
/* check if current BD is ready to be consumed */
|
|
|
|
rdy = ENETC_RXBD_STATUS_R(status);
|
|
|
|
} while (--tries >= 0 && !rdy);
|
|
|
|
|
|
|
|
if (!rdy)
|
|
|
|
return -EAGAIN;
|
|
|
|
|
|
|
|
dmb();
|
|
|
|
len = le16_to_cpu(priv->enetc_rxbd[pi].r.buf_len);
|
|
|
|
*packetp = (uchar *)enetc_rxb_address(dev, pi);
|
|
|
|
enetc_dbg(dev, "RxBD[%d]: len=%d err=%d pkt=0x%x%08x\n", pi, len,
|
|
|
|
ENETC_RXBD_STATUS_ERRORS(status),
|
|
|
|
upper_32_bits((u64)*packetp), lower_32_bits((u64)*packetp));
|
|
|
|
|
|
|
|
/* BD clean up and advance to next in ring */
|
|
|
|
memset(&priv->enetc_rxbd[pi], 0, sizeof(union enetc_rx_bd));
|
|
|
|
priv->enetc_rxbd[pi].w.addr = enetc_rxb_address(dev, pi);
|
|
|
|
rxr->next_prod_idx = (pi + 1) % rxr->bd_count;
|
|
|
|
ci = (ci + 1) % rxr->bd_count;
|
|
|
|
rxr->next_cons_idx = ci;
|
|
|
|
dmb();
|
|
|
|
/* free up the slot in the ring for HW */
|
|
|
|
enetc_write_reg(rxr->cons_idx, ci);
|
|
|
|
|
|
|
|
return len;
|
|
|
|
}
|
|
|
|
|
|
|
|
static const struct eth_ops enetc_ops = {
|
|
|
|
.start = enetc_start,
|
|
|
|
.send = enetc_send,
|
|
|
|
.recv = enetc_recv,
|
|
|
|
.stop = enetc_stop,
|
2019-12-20 13:16:47 +00:00
|
|
|
.write_hwaddr = enetc_write_hwaddr,
|
2019-07-03 09:11:40 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
U_BOOT_DRIVER(eth_enetc) = {
|
2019-12-10 14:55:39 +00:00
|
|
|
.name = ENETC_DRIVER_NAME,
|
2019-07-03 09:11:40 +00:00
|
|
|
.id = UCLASS_ETH,
|
|
|
|
.bind = enetc_bind,
|
|
|
|
.probe = enetc_probe,
|
|
|
|
.remove = enetc_remove,
|
|
|
|
.ops = &enetc_ops,
|
2020-12-03 23:55:17 +00:00
|
|
|
.priv_auto = sizeof(struct enetc_priv),
|
2020-12-03 23:55:18 +00:00
|
|
|
.plat_auto = sizeof(struct eth_pdata),
|
2019-07-03 09:11:40 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
static struct pci_device_id enetc_ids[] = {
|
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_FREESCALE, PCI_DEVICE_ID_ENETC_ETH) },
|
|
|
|
{}
|
|
|
|
};
|
|
|
|
|
|
|
|
U_BOOT_PCI_DEVICE(eth_enetc, enetc_ids);
|