[U-Boot] [PATCH v9 18/28] net: add support for bcm6368-enet

Daniel Schwierzeck daniel.schwierzeck at gmail.com
Thu Nov 29 00:44:41 UTC 2018



Am 28.11.18 um 19:23 schrieb Álvaro Fernández Rojas:
> Signed-off-by: Álvaro Fernández Rojas <noltari at gmail.com>
> ---
>  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 <noltari at gmail.com>
> + *
> + * Derived from linux/drivers/net/ethernet/broadcom/bcm63xx_enet.c:
> + *	Copyright (C) 2008 Maxime Bizon <mbizon at freebox.fr>
> + *
> + * 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

-------------- next part --------------
A non-text attachment was scrubbed...
Name: signature.asc
Type: application/pgp-signature
Size: 833 bytes
Desc: OpenPGP digital signature
URL: <http://lists.denx.de/pipermail/u-boot/attachments/20181129/09cfab10/attachment.sig>


More information about the U-Boot mailing list