Am 28.11.18 um 19:23 schrieb Álvaro Fernández Rojas: > Signed-off-by: Álvaro Fernández Rojas <[email protected]> > --- > v9: introduce flow control improvements from bcm6348-eth: > - introduce rx packets caching functionality from bcm6348-eth to fix flow > control issues. > - code style fixes. > v8: introduce bcm6368-enet driver > > drivers/net/Kconfig | 8 + > drivers/net/Makefile | 1 + > drivers/net/bcm6368-eth.c | 670 > ++++++++++++++++++++++++++++++++++++++++++++++ > 3 files changed, 679 insertions(+) > create mode 100644 drivers/net/bcm6368-eth.c > > diff --git a/drivers/net/Kconfig b/drivers/net/Kconfig > index 2b7cec8804..7044c6adf3 100644 > --- a/drivers/net/Kconfig > +++ b/drivers/net/Kconfig > @@ -82,6 +82,14 @@ config BCM6348_ETH > help > This driver supports the BCM6348 Ethernet MAC. > > +config BCM6368_ETH > + bool "BCM6368 EMAC support" > + depends on DM_ETH && ARCH_BMIPS > + select DMA > + select MII > + help > + This driver supports the BCM6368 Ethernet MAC. > + > config DWC_ETH_QOS > bool "Synopsys DWC Ethernet QOS device support" > depends on DM_ETH > diff --git a/drivers/net/Makefile b/drivers/net/Makefile > index 2647d4dd23..0dbfa03306 100644 > --- a/drivers/net/Makefile > +++ b/drivers/net/Makefile > @@ -7,6 +7,7 @@ obj-$(CONFIG_ALTERA_TSE) += altera_tse.o > obj-$(CONFIG_AG7XXX) += ag7xxx.o > obj-$(CONFIG_ARMADA100_FEC) += armada100_fec.o > obj-$(CONFIG_BCM6348_ETH) += bcm6348-eth.o > +obj-$(CONFIG_BCM6368_ETH) += bcm6368-eth.o > obj-$(CONFIG_DRIVER_AT91EMAC) += at91_emac.o > obj-$(CONFIG_DRIVER_AX88180) += ax88180.o > obj-$(CONFIG_BCM_SF2_ETH) += bcm-sf2-eth.o > diff --git a/drivers/net/bcm6368-eth.c b/drivers/net/bcm6368-eth.c > new file mode 100644 > index 0000000000..f0c2ada3e2 > --- /dev/null > +++ b/drivers/net/bcm6368-eth.c > @@ -0,0 +1,670 @@ > +/* > + * Copyright (C) 2018 Álvaro Fernández Rojas <[email protected]> > + * > + * Derived from linux/drivers/net/ethernet/broadcom/bcm63xx_enet.c: > + * Copyright (C) 2008 Maxime Bizon <[email protected]> > + * > + * SPDX-License-Identifier: GPL-2.0+ > + */ > + > +#include <common.h> > +#include <clk.h> > +#include <dm.h> > +#include <dma.h> > +#include <miiphy.h> > +#include <net.h> > +#include <reset.h> > +#include <wait_bit.h> > +#include <asm/io.h> > + > +#define ETH_PORT_STR "brcm,enetsw-port" > + > +#define ETH_RX_DESC PKTBUFSRX > +#define ETH_ZLEN 60 > +#define ETH_TIMEOUT 100 > + > +#define ETH_MAX_PORT 8 > +#define ETH_RGMII_PORT0 4 > + > +/* Port traffic control */ > +#define ETH_PTCTRL_REG(x) (0x0 + (x)) > +#define ETH_PTCTRL_RXDIS_SHIFT 0 > +#define ETH_PTCTRL_RXDIS_MASK (1 << ETH_PTCTRL_RXDIS_SHIFT) > +#define ETH_PTCTRL_TXDIS_SHIFT 1 > +#define ETH_PTCTRL_TXDIS_MASK (1 << ETH_PTCTRL_TXDIS_SHIFT) > + > +/* Switch mode register */ > +#define ETH_SWMODE_REG 0xb > +#define ETH_SWMODE_FWD_EN_SHIFT 1 > +#define ETH_SWMODE_FWD_EN_MASK (1 << ETH_SWMODE_FWD_EN_SHIFT) > + > +/* IMP override Register */ > +#define ETH_IMPOV_REG 0xe > +#define ETH_IMPOV_LINKUP_SHIFT 0 > +#define ETH_IMPOV_LINKUP_MASK (1 << ETH_IMPOV_LINKUP_SHIFT) > +#define ETH_IMPOV_FDX_SHIFT 1 > +#define ETH_IMPOV_FDX_MASK (1 << ETH_IMPOV_FDX_SHIFT) > +#define ETH_IMPOV_100_SHIFT 2 > +#define ETH_IMPOV_100_MASK (1 << ETH_IMPOV_100_SHIFT) > +#define ETH_IMPOV_1000_SHIFT 3 > +#define ETH_IMPOV_1000_MASK (1 << ETH_IMPOV_1000_SHIFT) > +#define ETH_IMPOV_RXFLOW_SHIFT 4 > +#define ETH_IMPOV_RXFLOW_MASK (1 << ETH_IMPOV_RXFLOW_SHIFT) > +#define ETH_IMPOV_TXFLOW_SHIFT 5 > +#define ETH_IMPOV_TXFLOW_MASK (1 << ETH_IMPOV_TXFLOW_SHIFT) > +#define ETH_IMPOV_FORCE_SHIFT 7 > +#define ETH_IMPOV_FORCE_MASK (1 << ETH_IMPOV_FORCE_SHIFT) > + > +/* Port override Register */ > +#define ETH_PORTOV_REG(x) (0x58 + (x)) > +#define ETH_PORTOV_LINKUP_SHIFT 0 > +#define ETH_PORTOV_LINKUP_MASK (1 << ETH_PORTOV_LINKUP_SHIFT) > +#define ETH_PORTOV_FDX_SHIFT 1 > +#define ETH_PORTOV_FDX_MASK (1 << ETH_PORTOV_FDX_SHIFT) > +#define ETH_PORTOV_100_SHIFT 2 > +#define ETH_PORTOV_100_MASK (1 << ETH_PORTOV_100_SHIFT) > +#define ETH_PORTOV_1000_SHIFT 3 > +#define ETH_PORTOV_1000_MASK (1 << ETH_PORTOV_1000_SHIFT) > +#define ETH_PORTOV_RXFLOW_SHIFT 4 > +#define ETH_PORTOV_RXFLOW_MASK (1 << ETH_PORTOV_RXFLOW_SHIFT) > +#define ETH_PORTOV_TXFLOW_SHIFT 5 > +#define ETH_PORTOV_TXFLOW_MASK (1 << ETH_PORTOV_TXFLOW_SHIFT) > +#define ETH_PORTOV_ENABLE_SHIFT 6 > +#define ETH_PORTOV_ENABLE_MASK (1 << ETH_PORTOV_ENABLE_SHIFT) > + > +/* Port RGMII control register */ > +#define ETH_RGMII_CTRL_REG(x) (0x60 + (x)) > +#define ETH_RGMII_CTRL_GMII_CLK_EN (1 << 7) > +#define ETH_RGMII_CTRL_MII_OVERRIDE_EN (1 << 6) > +#define ETH_RGMII_CTRL_MII_MODE_MASK (3 << 4) > +#define ETH_RGMII_CTRL_RGMII_MODE (0 << 4) > +#define ETH_RGMII_CTRL_MII_MODE (1 << 4) > +#define ETH_RGMII_CTRL_RVMII_MODE (2 << 4) > +#define ETH_RGMII_CTRL_TIMING_SEL_EN (1 << 0) > + > +/* Port RGMII timing register */ > +#define ENETSW_RGMII_TIMING_REG(x) (0x68 + (x)) > + > +/* MDIO control register */ > +#define MII_SC_REG 0xb0 > +#define MII_SC_EXT_SHIFT 16 > +#define MII_SC_EXT_MASK (1 << MII_SC_EXT_SHIFT) > +#define MII_SC_REG_SHIFT 20 > +#define MII_SC_PHYID_SHIFT 25 > +#define MII_SC_RD_SHIFT 30 > +#define MII_SC_RD_MASK (1 << MII_SC_RD_SHIFT) > +#define MII_SC_WR_SHIFT 31 > +#define MII_SC_WR_MASK (1 << MII_SC_WR_SHIFT) > + > +/* MDIO data register */ > +#define MII_DAT_REG 0xb4 > + > +/* MDIO 1000BASE-T control/status */ > +#define MII_ADVERTISE_1000 (ADVERTISE_1000HALF |\ > + ADVERTISE_1000FULL) > +#define MII_LPA_1000 (LPA_1000HALF | LPA_1000FULL) > + > +/* Global Management Configuration Register */ > +#define ETH_GMCR_REG 0x200 > +#define ETH_GMCR_RST_MIB_SHIFT 0 > +#define ETH_GMCR_RST_MIB_MASK (1 << ETH_GMCR_RST_MIB_SHIFT) > + > +/* Jumbo control register port mask register */ > +#define ETH_JMBCTL_PORT_REG 0x4004 > + > +/* Jumbo control mib good frame register */ > +#define ETH_JMBCTL_MAXSIZE_REG 0x4008 > + > +/* ETH port data */ > +struct bcm_enetsw_port { > + bool used; > + const char *name; > + /* Config */ > + bool bypass_link; > + int force_speed; > + bool force_duplex_full; > + /* PHY */ > + int phy_id; > +}; > + > +/* ETH data */ > +struct bcm6368_eth_priv { > + struct udevice *dev; > + void __iomem *base; > + /* RX */ > + uint8_t rx_desc; > + uint8_t rx_pend; > + int rx_ret[ETH_RX_DESC]; > + /* DMA */ > + struct dma rx_dma; > + struct dma tx_dma; > + /* Ports */ > + uint8_t num_ports; > + struct bcm_enetsw_port used_ports[ETH_MAX_PORT]; > + int sw_port_link[ETH_MAX_PORT]; > + bool rgmii_override; > + bool rgmii_timing; > + /* PHY */ > + int phy_id; > +}; > + > +DECLARE_GLOBAL_DATA_PTR; > + > +static inline bool bcm_enet_port_is_rgmii(int portid) > +{ > + return portid >= ETH_RGMII_PORT0; > +} > + > +static int bcm6368_mdio_read(struct bcm6368_eth_priv *priv, uint8_t ext, > + int phy_id, int reg) > +{ > + uint32_t val; > + > + writel_be(0, priv->base + MII_SC_REG); > + > + val = MII_SC_RD_MASK | > + (phy_id << MII_SC_PHYID_SHIFT) | > + (reg << MII_SC_REG_SHIFT); > + > + if (ext) > + val |= MII_SC_EXT_MASK; > + > + writel_be(val, priv->base + MII_SC_REG); > + udelay(50); > + > + return readw_be(priv->base + MII_DAT_REG); > +} > + > +static int bcm6368_mdio_write(struct bcm6368_eth_priv *priv, uint8_t ext, > + int phy_id, int reg, u16 data) > +{ > + uint32_t val; > + > + writel_be(0, priv->base + MII_SC_REG); > + > + val = MII_SC_WR_MASK | > + (phy_id << MII_SC_PHYID_SHIFT) | > + (reg << MII_SC_REG_SHIFT); > + > + if (ext) > + val |= MII_SC_EXT_MASK; > + > + val |= data; > + > + writel_be(val, priv->base + MII_SC_REG); > + udelay(50); > + > + return 0; > +} > + > +static int bcm6368_eth_free_pkt(struct udevice *dev, uchar *packet, int len) > +{ > + struct bcm6368_eth_priv *priv = dev_get_priv(dev); > + > + /* sanity check */ > + if (packet != net_rx_packets[priv->rx_pend]) { > + pr_err("rx_pend %d: packet is not matched,\n", priv->rx_pend); > + return -EAGAIN; > + } > + > + /* free pending packet */ > + priv->rx_ret[priv->rx_pend] = 0; > + priv->rx_pend = (priv->rx_pend + 1) % ETH_RX_DESC; > + > + return 0; > +} > + > +static int _bcm6368_eth_recv(struct bcm6368_eth_priv *priv) > +{ > + uint8_t pkt = priv->rx_desc; > + > + /* check if packet is free */ > + if (priv->rx_ret[pkt] > 0) > + return -EAGAIN; > + > + /* try to receive a new packet */ > + priv->rx_ret[pkt] = dma_receive(&priv->rx_dma, > + (void **)&net_rx_packets[pkt], > + NULL); > + if (priv->rx_ret[pkt] > 0) > + priv->rx_desc = (priv->rx_desc + 1) % ETH_RX_DESC; > + > + return priv->rx_ret[pkt]; > +} > + > +static int bcm6368_eth_recv(struct udevice *dev, int flags, uchar **packetp) > +{ > + struct bcm6368_eth_priv *priv = dev_get_priv(dev); > + > + /* receive packets if queue is empty */ > + if (priv->rx_ret[priv->rx_pend] <= 0) { > + uint8_t pkt_cnt = 0; > + > + /* try to receive packets */ > + while (_bcm6368_eth_recv(priv) > 0) > + pkt_cnt++; > + > + dma_prepare_rcv_buf(&priv->rx_dma, NULL, 0);
I forgot to mention this in your other ethernet driver but why do you
have your own packet queue? eth_recv() is supposed to receive one packet
from HW or return -EAGAIN. Also I think dma_prepare_rcv_buf should go to
eth_free_pkt() and pass net_rx_packets[]. eth_recv should only call
dma_receive() to check if packets are available.
> +
> + if (pkt_cnt)
> + debug("%s: received %u packet(s)\n", __func__, pkt_cnt);
> + }
> +
> + /* return current packet */
> + if (priv->rx_ret[priv->rx_pend] > 0)
> + *packetp = net_rx_packets[priv->rx_pend];
> +
> + return priv->rx_ret[priv->rx_pend];
> +}
> +
> +static int bcm6368_eth_send(struct udevice *dev, void *packet, int length)
> +{
> + struct bcm6368_eth_priv *priv = dev_get_priv(dev);
> +
> + length = max(length, ETH_ZLEN);
> +
> + return dma_send(&priv->tx_dma, packet, length, NULL);
does the HW do the actual padding? Otherwise you should set the padding
bytes to zero to avoid sending random memory content on the wire.
> +}
> +
> +static int bcm6368_eth_adjust_link(struct bcm6368_eth_priv *priv)
> +{
> + unsigned int i;
> +
> + for (i = 0; i < priv->num_ports; i++) {
> + struct bcm_enetsw_port *port;
> + int val, j, up, advertise, lpa, speed, duplex, media;
> + int external_phy = bcm_enet_port_is_rgmii(i);
> + u8 override;
> +
> + port = &priv->used_ports[i];
> + if (!port->used)
> + continue;
> +
> + if (port->bypass_link)
> + continue;
> +
> + /* dummy read to clear */
> + for (j = 0; j < 2; j++)
> + val = bcm6368_mdio_read(priv, external_phy,
> + port->phy_id, MII_BMSR);
> +
> + if (val == 0xffff)
> + continue;
> +
> + up = (val & BMSR_LSTATUS) ? 1 : 0;
> + if (!(up ^ priv->sw_port_link[i]))
> + continue;
> +
> + priv->sw_port_link[i] = up;
> +
> + /* link changed */
> + if (!up) {
> + dev_info(&priv->pdev->dev, "link DOWN on %s\n",
> + port->name);
> + writeb_be(ETH_PORTOV_ENABLE_MASK,
> + priv->base + ETH_PORTOV_REG(i));
> + writeb_be(ETH_PTCTRL_RXDIS_MASK |
> + ETH_PTCTRL_TXDIS_MASK,
> + priv->base + ETH_PTCTRL_REG(i));
> + continue;
> + }
> +
> + advertise = bcm6368_mdio_read(priv, external_phy, port->phy_id,
> + MII_ADVERTISE);
> +
> + lpa = bcm6368_mdio_read(priv, external_phy, port->phy_id,
> + MII_LPA);
> +
> + /* figure out media and duplex from advertise and LPA values */
> + media = mii_nway_result(lpa & advertise);
> + duplex = (media & ADVERTISE_FULL) ? 1 : 0;
> +
> + if (media & (ADVERTISE_100FULL | ADVERTISE_100HALF))
> + speed = 100;
> + else
> + speed = 10;
> +
> + if (val & BMSR_ESTATEN) {
> + advertise = bcm6368_mdio_read(priv, external_phy,
> + port->phy_id, MII_CTRL1000);
> +
> + lpa = bcm6368_mdio_read(priv, external_phy,
> + port->phy_id, MII_STAT1000);
> +
> + if ((advertise & MII_ADVERTISE_1000) &&
> + (lpa & MII_LPA_1000)) {
> + speed = 1000;
> + duplex = (lpa & LPA_1000FULL);
> + }
> + }
> +
> + pr_alert("link UP on %s, %dMbps, %s-duplex\n",
> + port->name, speed, duplex ? "full" : "half");
> +
> + override = ETH_PORTOV_ENABLE_MASK |
> + ETH_PORTOV_LINKUP_MASK;
> +
> + if (speed == 1000)
> + override |= ETH_PORTOV_1000_MASK;
> + else if (speed == 100)
> + override |= ETH_PORTOV_100_MASK;
> + if (duplex)
> + override |= ETH_PORTOV_FDX_MASK;
> +
> + writeb_be(override, priv->base + ETH_PORTOV_REG(i));
> + writeb_be(0, priv->base + ETH_PTCTRL_REG(i));
> + }
> +
> + return 0;
> +}
> +
> +static int bcm6368_eth_start(struct udevice *dev)
> +{
> + struct bcm6368_eth_priv *priv = dev_get_priv(dev);
> + int i;
> + u32 val;
> +
> + priv->rx_desc = 0;
> + priv->rx_pend = 0;
> + for (i = 0; i < ETH_RX_DESC; i++)
> + priv->rx_ret[i] = 0;
> +
> + /* disable all ports */
> + for (i = 0; i < priv->num_ports; i++) {
> + writeb_be(ETH_PORTOV_ENABLE_MASK,
> + priv->base + ETH_PORTOV_REG(i));
> + writeb_be(ETH_PTCTRL_RXDIS_MASK |
> + ETH_PTCTRL_TXDIS_MASK,
> + priv->base + ETH_PTCTRL_REG(i));
> +
> + priv->sw_port_link[i] = 0;
> + }
> +
> + /* enable external ports */
> + for (i = ETH_RGMII_PORT0; i < priv->num_ports; i++) {
> + u8 rgmii_ctrl;
> +
> + if (!priv->used_ports[i].used)
> + continue;
> +
> + rgmii_ctrl = readb_be(priv->base + ETH_RGMII_CTRL_REG(i));
> + rgmii_ctrl |= ETH_RGMII_CTRL_GMII_CLK_EN;
> + if (priv->rgmii_override)
> + rgmii_ctrl |= ETH_RGMII_CTRL_MII_OVERRIDE_EN;
> + if (priv->rgmii_timing)
> + rgmii_ctrl |= ETH_RGMII_CTRL_TIMING_SEL_EN;
> + writeb_be(rgmii_ctrl, priv->base + ETH_RGMII_CTRL_REG(i));
> + }
> +
> + /* reset mib */
> + val = readb_be(priv->base + ETH_GMCR_REG);
> + val |= ETH_GMCR_RST_MIB_MASK;
> + writeb_be(val, priv->base + ETH_GMCR_REG);
> + mdelay(1);
> + val &= ~ETH_GMCR_RST_MIB_MASK;
> + writeb_be(val, priv->base + ETH_GMCR_REG);
> + mdelay(1);
> +
> + /* force CPU port state */
> + val = readb_be(priv->base + ETH_IMPOV_REG);
> + val |= ETH_IMPOV_FORCE_MASK | ETH_IMPOV_LINKUP_MASK;
> + writeb_be(val, priv->base + ETH_IMPOV_REG);
> +
> + /* enable switch forward engine */
> + val = readb_be(priv->base + ETH_SWMODE_REG);
> + val |= ETH_SWMODE_FWD_EN_MASK;
> + writeb_be(val, priv->base + ETH_SWMODE_REG);
> +
> + /* enable jumbo on all ports */
> + writel_be(0x1ff, priv->base + ETH_JMBCTL_PORT_REG);
> + writew_be(9728, priv->base + ETH_JMBCTL_MAXSIZE_REG);
> +
> + /* enable dma rx channel */
> + dma_enable(&priv->rx_dma);
> +
> + /* enable dma tx channel */
> + dma_enable(&priv->tx_dma);
> +
> + /* apply override config for bypass_link ports here. */
> + for (i = 0; i < priv->num_ports; i++) {
> + struct bcm_enetsw_port *port;
> + u8 override;
> + port = &priv->used_ports[i];
> + if (!port->used)
> + continue;
> +
> + if (!port->bypass_link)
> + continue;
> +
> + override = ETH_PORTOV_ENABLE_MASK |
> + ETH_PORTOV_LINKUP_MASK;
> +
> + switch (port->force_speed) {
> + case 1000:
> + override |= ETH_PORTOV_1000_MASK;
> + break;
> + case 100:
> + override |= ETH_PORTOV_100_MASK;
> + break;
> + case 10:
> + break;
> + default:
> + pr_warn("invalid forced speed on port %s: assume 10\n",
> + port->name);
> + break;
> + }
> +
> + if (port->force_duplex_full)
> + override |= ETH_PORTOV_FDX_MASK;
> +
> + writeb_be(override, priv->base + ETH_PORTOV_REG(i));
> + writeb_be(0, priv->base + ETH_PTCTRL_REG(i));
> + }
> +
> + bcm6368_eth_adjust_link(priv);
> +
> + return 0;
> +}
> +
> +static void bcm6368_eth_stop(struct udevice *dev)
> +{
> + struct bcm6368_eth_priv *priv = dev_get_priv(dev);
> +
> + /* disable dma rx channel */
> + dma_disable(&priv->rx_dma);
> +
> + /* disable dma tx channel */
> + dma_disable(&priv->tx_dma);
> +}
> +
> +static const struct eth_ops bcm6368_eth_ops = {
> + .free_pkt = bcm6368_eth_free_pkt,
> + .recv = bcm6368_eth_recv,
> + .send = bcm6368_eth_send,
> + .start = bcm6368_eth_start,
> + .stop = bcm6368_eth_stop,
> +};
> +
> +static const struct udevice_id bcm6368_eth_ids[] = {
> + { .compatible = "brcm,bcm6368-enet", },
> + { /* sentinel */ }
> +};
> +
> +static bool bcm6368_phy_is_external(struct bcm6368_eth_priv *priv,
> + int phy_id)
> +{
> + uint8_t i;
> +
> + for (i = 0; i < priv->num_ports; ++i) {
> + if (!priv->used_ports[i].used)
> + continue;
> + if (priv->used_ports[i].phy_id == phy_id)
> + return bcm_enet_port_is_rgmii(i);
> + }
> +
> + return true;
> +}
> +
> +static int bcm6368_mii_mdio_read(struct mii_dev *bus, int addr, int devaddr,
> + int reg)
> +{
> + struct bcm6368_eth_priv *priv = bus->priv;
> + bool ext = bcm6368_phy_is_external(priv, addr);
> +
> + return bcm6368_mdio_read(priv, ext, addr, reg);
> +}
> +
> +static int bcm6368_mii_mdio_write(struct mii_dev *bus, int addr, int devaddr,
> + int reg, u16 data)
> +{
> + struct bcm6368_eth_priv *priv = bus->priv;
> + bool ext = bcm6368_phy_is_external(priv, addr);
> +
> + return bcm6368_mdio_write(priv, ext, addr, reg, data);
> +}
> +
> +static int bcm6368_mdio_init(const char *name, struct bcm6368_eth_priv *priv)
> +{
> + struct mii_dev *bus;
> +
> + bus = mdio_alloc();
> + if (!bus) {
> + pr_err("%s: failed to allocate MDIO bus\n", __func__);
> + return -ENOMEM;
> + }
> +
> + bus->read = bcm6368_mii_mdio_read;
> + bus->write = bcm6368_mii_mdio_write;
> + bus->priv = priv;
> + snprintf(bus->name, sizeof(bus->name), "%s", name);
> +
> + return mdio_register(bus);
> +}
> +
> +static int bcm6368_eth_probe(struct udevice *dev)
> +{
> + struct eth_pdata *pdata = dev_get_platdata(dev);
> + struct bcm6368_eth_priv *priv = dev_get_priv(dev);
> + void *blob = (void *)gd->fdt_blob;
> + fdt_addr_t addr;
> + int node = dev_of_offset(dev);
> + int ret, i;
> + unsigned int num_ports;
> +
> + /* get base address */
> + addr = devfdt_get_addr(dev);
> + if (addr == FDT_ADDR_T_NONE)
> + return -EINVAL;
dev_remap_addr() ?
> +
> + /* get number of ports */
> + num_ports = fdtdec_get_uint(gd->fdt_blob, node, "brcm,num-ports",
> + ETH_MAX_PORT);
> + if (!num_ports || num_ports > ETH_MAX_PORT)
> + return -EINVAL;
dev_read_u32() ?
> +
> + /* get dma channels */
> + ret = dma_get_by_name(dev, "tx", &priv->tx_dma);
> + if (ret)
> + return -EINVAL;
> +
> + ret = dma_get_by_name(dev, "rx", &priv->rx_dma);
> + if (ret)
> + return -EINVAL;
> +
> + /* try to enable clocks */
> + for (i = 0; ; i++) {
> + struct clk clk;
> + int ret;
> +
> + ret = clk_get_by_index(dev, i, &clk);
> + if (ret < 0)
> + break;
> + if (clk_enable(&clk))
> + pr_err("failed to enable clock %d\n", i);
> + clk_free(&clk);
> + }
> +
> + /* try to perform resets */
> + for (i = 0; ; i++) {
> + struct reset_ctl reset;
> + int ret;
> +
> + ret = reset_get_by_index(dev, i, &reset);
> + if (ret < 0)
> + break;
> + if (reset_deassert(&reset))
> + pr_err("failed to deassert reset %d\n", i);
> + reset_free(&reset);
> + }
> +
> + /* set priv data */
> + priv->dev = dev;
> +
> + priv->base = ioremap(addr, 0);
> + pdata->iobase = (phys_addr_t) priv->base;
> +
> + priv->num_ports = num_ports;
> +
> + if (fdtdec_get_bool(gd->fdt_blob, i, "brcm,rgmii-override"))
> + priv->rgmii_override = true;
> + if (fdtdec_get_bool(gd->fdt_blob, i, "brcm,rgmii-timing"))
> + priv->rgmii_timing = true;
dev_read_bool() ?
> +
> + /* get ports */
> + for (i = fdt_first_subnode(blob, node);
> + i > 0;
> + i = fdt_next_subnode(blob, i)) {
dev_read_first_subnode(), dev_read_next_subnode() and dev_read_*() in
the loop body?
> + const char *comp;
> + const char *label;
> + unsigned int p;
> + int phy_id;
> + int speed;
> +
> + comp = fdt_getprop(blob, i, "compatible", NULL);
> + if (!comp || memcmp(comp, ETH_PORT_STR, sizeof(ETH_PORT_STR)))
> + continue;
> +
> + p = fdtdec_get_uint(gd->fdt_blob, i, "reg",
> + ETH_MAX_PORT);
> + if (p >= num_ports)
> + return -EINVAL;
> +
> + label = fdt_getprop(blob, i, "label", NULL);
> + if (!label) {
> + debug("%s: node %s has no label\n", __func__,
> + fdt_get_name(blob, i, NULL));
> + return -EINVAL;
> + }
> +
> + phy_id = fdtdec_get_int(gd->fdt_blob, i, "brcm,phy-id", -1);
> +
> + priv->used_ports[p].used = true;
> + priv->used_ports[p].name = label;
> + priv->used_ports[p].phy_id = phy_id;
> +
> + if (fdtdec_get_bool(gd->fdt_blob, i, "full-duplex"))
> + priv->used_ports[p].force_duplex_full = true;
> + if (fdtdec_get_bool(gd->fdt_blob, i, "bypass-link"))
> + priv->used_ports[p].bypass_link = true;
> + speed = fdtdec_get_int(gd->fdt_blob, i, "speed", 0);
> + if (speed)
> + priv->used_ports[p].force_speed = speed;
> + }
> +
> + /* init mii bus */
> + ret = bcm6368_mdio_init(dev->name, priv);
> + if (ret)
> + return ret;
> +
> + return 0;
> +}
> +
> +U_BOOT_DRIVER(bcm6368_eth) = {
> + .name = "bcm6368_eth",
> + .id = UCLASS_ETH,
> + .of_match = bcm6368_eth_ids,
> + .ops = &bcm6368_eth_ops,
> + .platdata_auto_alloc_size = sizeof(struct eth_pdata),
> + .priv_auto_alloc_size = sizeof(struct bcm6368_eth_priv),
> + .probe = bcm6368_eth_probe,
> +};
>
--
- Daniel
signature.asc
Description: OpenPGP digital signature
_______________________________________________ U-Boot mailing list [email protected] https://lists.denx.de/listinfo/u-boot
