1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (C) 2019 Amit Singh Tomar <amittomer25@gmail.com>
5 * Driver for Broadcom GENETv5 Ethernet controller (as found on the RPi4)
6 * This driver is based on the Linux driver:
7 * drivers/net/ethernet/broadcom/genet/bcmgenet.c
8 * which is: Copyright (c) 2014-2017 Broadcom
10 * The hardware supports multiple queues (16 priority queues and one
11 * default queue), both for RX and TX. There are 256 DMA descriptors (both
12 * for TX and RX), and they live in MMIO registers. The hardware allows
13 * assigning descriptor ranges to queues, but we choose the most simple setup:
14 * All 256 descriptors are assigned to the default queue (#16).
15 * Also the Linux driver supports multiple generations of the MAC, whereas
16 * we only support v5, as used in the Raspberry Pi 4.
23 #include <fdt_support.h>
24 #include <linux/err.h>
28 #include <dm/of_access.h>
29 #include <dm/ofnode.h>
30 #include <linux/iopoll.h>
31 #include <linux/sizes.h>
32 #include <asm/dma-mapping.h>
35 /* Register definitions derived from Linux source */
36 #define SYS_REV_CTRL 0x00
38 #define SYS_PORT_CTRL 0x04
39 #define PORT_MODE_EXT_GPHY 3
41 #define GENET_SYS_OFF 0x0000
42 #define SYS_RBUF_FLUSH_CTRL (GENET_SYS_OFF + 0x08)
43 #define SYS_TBUF_FLUSH_CTRL (GENET_SYS_OFF + 0x0c)
45 #define GENET_EXT_OFF 0x0080
46 #define EXT_RGMII_OOB_CTRL (GENET_EXT_OFF + 0x0c)
47 #define RGMII_LINK BIT(4)
48 #define OOB_DISABLE BIT(5)
49 #define RGMII_MODE_EN BIT(6)
50 #define ID_MODE_DIS BIT(16)
52 #define GENET_RBUF_OFF 0x0300
53 #define RBUF_TBUF_SIZE_CTRL (GENET_RBUF_OFF + 0xb4)
54 #define RBUF_CTRL (GENET_RBUF_OFF + 0x00)
55 #define RBUF_ALIGN_2B BIT(1)
57 #define GENET_UMAC_OFF 0x0800
58 #define UMAC_MIB_CTRL (GENET_UMAC_OFF + 0x580)
59 #define UMAC_MAX_FRAME_LEN (GENET_UMAC_OFF + 0x014)
60 #define UMAC_MAC0 (GENET_UMAC_OFF + 0x00c)
61 #define UMAC_MAC1 (GENET_UMAC_OFF + 0x010)
62 #define UMAC_CMD (GENET_UMAC_OFF + 0x008)
63 #define MDIO_CMD (GENET_UMAC_OFF + 0x614)
64 #define UMAC_TX_FLUSH (GENET_UMAC_OFF + 0x334)
65 #define MDIO_START_BUSY BIT(29)
66 #define MDIO_READ_FAIL BIT(28)
67 #define MDIO_RD (2 << 26)
68 #define MDIO_WR BIT(26)
69 #define MDIO_PMD_SHIFT 21
70 #define MDIO_PMD_MASK 0x1f
71 #define MDIO_REG_SHIFT 16
72 #define MDIO_REG_MASK 0x1f
74 #define CMD_TX_EN BIT(0)
75 #define CMD_RX_EN BIT(1)
76 #define UMAC_SPEED_10 0
77 #define UMAC_SPEED_100 1
78 #define UMAC_SPEED_1000 2
79 #define UMAC_SPEED_2500 3
80 #define CMD_SPEED_SHIFT 2
81 #define CMD_SPEED_MASK 3
82 #define CMD_SW_RESET BIT(13)
83 #define CMD_LCL_LOOP_EN BIT(15)
84 #define CMD_TX_EN BIT(0)
85 #define CMD_RX_EN BIT(1)
87 #define MIB_RESET_RX BIT(0)
88 #define MIB_RESET_RUNT BIT(1)
89 #define MIB_RESET_TX BIT(2)
91 /* total number of Buffer Descriptors, same for Rx/Tx */
92 #define TOTAL_DESCS 256
93 #define RX_DESCS TOTAL_DESCS
94 #define TX_DESCS TOTAL_DESCS
96 #define DEFAULT_Q 0x10
98 /* Body(1500) + EH_SIZE(14) + VLANTAG(4) + BRCMTAG(6) + FCS(4) = 1528.
99 * 1536 is multiple of 256 bytes
101 #define ENET_BRCM_TAG_LEN 6
103 #define ENET_MAX_MTU_SIZE (ETH_DATA_LEN + ETH_HLEN + \
104 VLAN_HLEN + ENET_BRCM_TAG_LEN + \
105 ETH_FCS_LEN + ENET_PAD)
107 /* Tx/Rx Dma Descriptor common bits */
108 #define DMA_EN BIT(0)
109 #define DMA_RING_BUF_EN_SHIFT 0x01
110 #define DMA_RING_BUF_EN_MASK 0xffff
111 #define DMA_BUFLENGTH_MASK 0x0fff
112 #define DMA_BUFLENGTH_SHIFT 16
113 #define DMA_RING_SIZE_SHIFT 16
114 #define DMA_OWN 0x8000
115 #define DMA_EOP 0x4000
116 #define DMA_SOP 0x2000
117 #define DMA_WRAP 0x1000
118 #define DMA_MAX_BURST_LENGTH 0x8
119 /* Tx specific DMA descriptor bits */
120 #define DMA_TX_UNDERRUN 0x0200
121 #define DMA_TX_APPEND_CRC 0x0040
122 #define DMA_TX_OW_CRC 0x0020
123 #define DMA_TX_DO_CSUM 0x0010
124 #define DMA_TX_QTAG_SHIFT 7
127 #define DMA_RING_SIZE 0x40
128 #define DMA_RINGS_SIZE (DMA_RING_SIZE * (DEFAULT_Q + 1))
131 #define DMA_DESC_LENGTH_STATUS 0x00
132 #define DMA_DESC_ADDRESS_LO 0x04
133 #define DMA_DESC_ADDRESS_HI 0x08
134 #define DMA_DESC_SIZE 12
136 #define GENET_RX_OFF 0x2000
137 #define GENET_RDMA_REG_OFF \
138 (GENET_RX_OFF + TOTAL_DESCS * DMA_DESC_SIZE)
139 #define GENET_TX_OFF 0x4000
140 #define GENET_TDMA_REG_OFF \
141 (GENET_TX_OFF + TOTAL_DESCS * DMA_DESC_SIZE)
143 #define DMA_FC_THRESH_HI (RX_DESCS >> 4)
144 #define DMA_FC_THRESH_LO 5
145 #define DMA_FC_THRESH_VALUE ((DMA_FC_THRESH_LO << 16) | \
148 #define DMA_XOFF_THRESHOLD_SHIFT 16
150 #define TDMA_RING_REG_BASE \
151 (GENET_TDMA_REG_OFF + DEFAULT_Q * DMA_RING_SIZE)
152 #define TDMA_READ_PTR (TDMA_RING_REG_BASE + 0x00)
153 #define TDMA_CONS_INDEX (TDMA_RING_REG_BASE + 0x08)
154 #define TDMA_PROD_INDEX (TDMA_RING_REG_BASE + 0x0c)
155 #define DMA_RING_BUF_SIZE 0x10
156 #define DMA_START_ADDR 0x14
157 #define DMA_END_ADDR 0x1c
158 #define DMA_MBUF_DONE_THRESH 0x24
159 #define TDMA_FLOW_PERIOD (TDMA_RING_REG_BASE + 0x28)
160 #define TDMA_WRITE_PTR (TDMA_RING_REG_BASE + 0x2c)
162 #define RDMA_RING_REG_BASE \
163 (GENET_RDMA_REG_OFF + DEFAULT_Q * DMA_RING_SIZE)
164 #define RDMA_WRITE_PTR (RDMA_RING_REG_BASE + 0x00)
165 #define RDMA_PROD_INDEX (RDMA_RING_REG_BASE + 0x08)
166 #define RDMA_CONS_INDEX (RDMA_RING_REG_BASE + 0x0c)
167 #define RDMA_XON_XOFF_THRESH (RDMA_RING_REG_BASE + 0x28)
168 #define RDMA_READ_PTR (RDMA_RING_REG_BASE + 0x2c)
170 #define TDMA_REG_BASE (GENET_TDMA_REG_OFF + DMA_RINGS_SIZE)
171 #define RDMA_REG_BASE (GENET_RDMA_REG_OFF + DMA_RINGS_SIZE)
172 #define DMA_RING_CFG 0x00
173 #define DMA_CTRL 0x04
174 #define DMA_SCB_BURST_SIZE 0x0c
176 #define RX_BUF_LENGTH 2048
177 #define RX_TOTAL_BUFSIZE (RX_BUF_LENGTH * RX_DESCS)
178 #define RX_BUF_OFFSET 2
180 struct bcmgenet_eth_priv {
181 char rxbuffer[RX_TOTAL_BUFSIZE] __aligned(ARCH_DMA_MINALIGN);
191 struct phy_device *phydev;
195 static void bcmgenet_umac_reset(struct bcmgenet_eth_priv *priv)
199 reg = readl(priv->mac_reg + SYS_RBUF_FLUSH_CTRL);
201 writel(reg, (priv->mac_reg + SYS_RBUF_FLUSH_CTRL));
205 writel(reg, (priv->mac_reg + SYS_RBUF_FLUSH_CTRL));
208 writel(0, (priv->mac_reg + SYS_RBUF_FLUSH_CTRL));
211 writel(0, priv->mac_reg + UMAC_CMD);
213 writel(CMD_SW_RESET | CMD_LCL_LOOP_EN, priv->mac_reg + UMAC_CMD);
215 writel(0, priv->mac_reg + UMAC_CMD);
217 /* clear tx/rx counter */
218 writel(MIB_RESET_RX | MIB_RESET_TX | MIB_RESET_RUNT,
219 priv->mac_reg + UMAC_MIB_CTRL);
220 writel(0, priv->mac_reg + UMAC_MIB_CTRL);
222 writel(ENET_MAX_MTU_SIZE, priv->mac_reg + UMAC_MAX_FRAME_LEN);
224 /* init rx registers, enable ip header optimization */
225 reg = readl(priv->mac_reg + RBUF_CTRL);
226 reg |= RBUF_ALIGN_2B;
227 writel(reg, (priv->mac_reg + RBUF_CTRL));
229 writel(1, (priv->mac_reg + RBUF_TBUF_SIZE_CTRL));
232 static int bcmgenet_gmac_write_hwaddr(struct udevice *dev)
234 struct bcmgenet_eth_priv *priv = dev_get_priv(dev);
235 struct eth_pdata *pdata = dev_get_platdata(dev);
236 uchar *addr = pdata->enetaddr;
239 reg = addr[0] << 24 | addr[1] << 16 | addr[2] << 8 | addr[3];
240 writel_relaxed(reg, priv->mac_reg + UMAC_MAC0);
242 reg = addr[4] << 8 | addr[5];
243 writel_relaxed(reg, priv->mac_reg + UMAC_MAC1);
248 static void bcmgenet_disable_dma(struct bcmgenet_eth_priv *priv)
250 clrbits_32(priv->mac_reg + TDMA_REG_BASE + DMA_CTRL, DMA_EN);
251 clrbits_32(priv->mac_reg + RDMA_REG_BASE + DMA_CTRL, DMA_EN);
253 writel(1, priv->mac_reg + UMAC_TX_FLUSH);
255 writel(0, priv->mac_reg + UMAC_TX_FLUSH);
258 static void bcmgenet_enable_dma(struct bcmgenet_eth_priv *priv)
260 u32 dma_ctrl = (1 << (DEFAULT_Q + DMA_RING_BUF_EN_SHIFT)) | DMA_EN;
262 writel(dma_ctrl, priv->mac_reg + TDMA_REG_BASE + DMA_CTRL);
264 setbits_32(priv->mac_reg + RDMA_REG_BASE + DMA_CTRL, dma_ctrl);
267 static int bcmgenet_gmac_eth_send(struct udevice *dev, void *packet, int length)
269 struct bcmgenet_eth_priv *priv = dev_get_priv(dev);
270 void *desc_base = priv->tx_desc_base + priv->tx_index * DMA_DESC_SIZE;
271 u32 len_stat = length << DMA_BUFLENGTH_SHIFT;
272 ulong packet_aligned = rounddown((ulong)packet, ARCH_DMA_MINALIGN);
273 u32 prod_index, cons;
276 prod_index = readl(priv->mac_reg + TDMA_PROD_INDEX);
278 /* There is actually no reason for the rounding here, but the ARMv7
279 * implementation of flush_dcache_range() checks for aligned
280 * boundaries of the flushed range.
281 * Adjust them here to pass that check and avoid misleading messages.
283 flush_dcache_range(packet_aligned,
284 packet_aligned + roundup(length, ARCH_DMA_MINALIGN));
286 len_stat |= 0x3F << DMA_TX_QTAG_SHIFT;
287 len_stat |= DMA_TX_APPEND_CRC | DMA_SOP | DMA_EOP;
289 /* Set-up packet for transmission */
290 writel(lower_32_bits((ulong)packet), (desc_base + DMA_DESC_ADDRESS_LO));
291 writel(upper_32_bits((ulong)packet), (desc_base + DMA_DESC_ADDRESS_HI));
292 writel(len_stat, (desc_base + DMA_DESC_LENGTH_STATUS));
294 /* Increment index and start transmission */
295 if (++priv->tx_index >= TX_DESCS)
300 /* Start Transmisson */
301 writel(prod_index, priv->mac_reg + TDMA_PROD_INDEX);
304 cons = readl(priv->mac_reg + TDMA_CONS_INDEX);
305 } while ((cons & 0xffff) < prod_index && --tries);
312 /* Check whether all cache lines affected by an invalidate are within
313 * the buffer, to make sure we don't accidentally lose unrelated dirty
314 * data stored nearby.
315 * Alignment of the buffer start address will be checked in the implementation
316 * of invalidate_dcache_range().
318 static void invalidate_dcache_check(unsigned long addr, size_t size,
321 size_t inval_size = roundup(size, ARCH_DMA_MINALIGN);
323 if (unlikely(inval_size > buffer_size))
324 printf("WARNING: Cache invalidate area exceeds buffer size\n");
326 invalidate_dcache_range(addr, addr + inval_size);
329 static int bcmgenet_gmac_eth_recv(struct udevice *dev,
330 int flags, uchar **packetp)
332 struct bcmgenet_eth_priv *priv = dev_get_priv(dev);
333 void *desc_base = priv->rx_desc_base + priv->rx_index * DMA_DESC_SIZE;
334 u32 prod_index = readl(priv->mac_reg + RDMA_PROD_INDEX);
337 if (prod_index == priv->c_index)
340 length = readl(desc_base + DMA_DESC_LENGTH_STATUS);
341 length = (length >> DMA_BUFLENGTH_SHIFT) & DMA_BUFLENGTH_MASK;
342 addr = readl(desc_base + DMA_DESC_ADDRESS_LO);
344 invalidate_dcache_check(addr, length, RX_BUF_LENGTH);
346 /* To cater for the IP header alignment the hardware does.
347 * This would actually not be needed if we don't program
350 *packetp = (uchar *)(ulong)addr + RX_BUF_OFFSET;
352 return length - RX_BUF_OFFSET;
355 static int bcmgenet_gmac_free_pkt(struct udevice *dev, uchar *packet,
358 struct bcmgenet_eth_priv *priv = dev_get_priv(dev);
360 /* Tell the MAC we have consumed that last receive buffer. */
361 priv->c_index = (priv->c_index + 1) & 0xFFFF;
362 writel(priv->c_index, priv->mac_reg + RDMA_CONS_INDEX);
364 /* Forward our descriptor pointer, wrapping around if needed. */
365 if (++priv->rx_index >= RX_DESCS)
371 static void rx_descs_init(struct bcmgenet_eth_priv *priv)
373 char *rxbuffs = &priv->rxbuffer[0];
375 void *desc_base = priv->rx_desc_base;
379 len_stat = (RX_BUF_LENGTH << DMA_BUFLENGTH_SHIFT) | DMA_OWN;
381 for (i = 0; i < RX_DESCS; i++) {
382 writel(lower_32_bits((uintptr_t)&rxbuffs[i * RX_BUF_LENGTH]),
383 desc_base + i * DMA_DESC_SIZE + DMA_DESC_ADDRESS_LO);
384 writel(upper_32_bits((uintptr_t)&rxbuffs[i * RX_BUF_LENGTH]),
385 desc_base + i * DMA_DESC_SIZE + DMA_DESC_ADDRESS_HI);
387 desc_base + i * DMA_DESC_SIZE + DMA_DESC_LENGTH_STATUS);
391 static void rx_ring_init(struct bcmgenet_eth_priv *priv)
393 writel(DMA_MAX_BURST_LENGTH,
394 priv->mac_reg + RDMA_REG_BASE + DMA_SCB_BURST_SIZE);
396 writel(0x0, priv->mac_reg + RDMA_RING_REG_BASE + DMA_START_ADDR);
397 writel(0x0, priv->mac_reg + RDMA_READ_PTR);
398 writel(0x0, priv->mac_reg + RDMA_WRITE_PTR);
399 writel(RX_DESCS * DMA_DESC_SIZE / 4 - 1,
400 priv->mac_reg + RDMA_RING_REG_BASE + DMA_END_ADDR);
402 writel(0x0, priv->mac_reg + RDMA_PROD_INDEX);
403 writel(0x0, priv->mac_reg + RDMA_CONS_INDEX);
404 writel((RX_DESCS << DMA_RING_SIZE_SHIFT) | RX_BUF_LENGTH,
405 priv->mac_reg + RDMA_RING_REG_BASE + DMA_RING_BUF_SIZE);
406 writel(DMA_FC_THRESH_VALUE, priv->mac_reg + RDMA_XON_XOFF_THRESH);
407 writel(1 << DEFAULT_Q, priv->mac_reg + RDMA_REG_BASE + DMA_RING_CFG);
410 static void tx_ring_init(struct bcmgenet_eth_priv *priv)
412 writel(DMA_MAX_BURST_LENGTH,
413 priv->mac_reg + TDMA_REG_BASE + DMA_SCB_BURST_SIZE);
415 writel(0x0, priv->mac_reg + TDMA_RING_REG_BASE + DMA_START_ADDR);
416 writel(0x0, priv->mac_reg + TDMA_READ_PTR);
417 writel(0x0, priv->mac_reg + TDMA_WRITE_PTR);
418 writel(TX_DESCS * DMA_DESC_SIZE / 4 - 1,
419 priv->mac_reg + TDMA_RING_REG_BASE + DMA_END_ADDR);
420 writel(0x0, priv->mac_reg + TDMA_PROD_INDEX);
421 writel(0x0, priv->mac_reg + TDMA_CONS_INDEX);
422 writel(0x1, priv->mac_reg + TDMA_RING_REG_BASE + DMA_MBUF_DONE_THRESH);
423 writel(0x0, priv->mac_reg + TDMA_FLOW_PERIOD);
424 writel((TX_DESCS << DMA_RING_SIZE_SHIFT) | RX_BUF_LENGTH,
425 priv->mac_reg + TDMA_RING_REG_BASE + DMA_RING_BUF_SIZE);
427 writel(1 << DEFAULT_Q, priv->mac_reg + TDMA_REG_BASE + DMA_RING_CFG);
430 static int bcmgenet_adjust_link(struct bcmgenet_eth_priv *priv)
432 struct phy_device *phy_dev = priv->phydev;
435 switch (phy_dev->speed) {
437 speed = UMAC_SPEED_1000;
440 speed = UMAC_SPEED_100;
443 speed = UMAC_SPEED_10;
446 printf("bcmgenet: Unsupported PHY speed: %d\n", phy_dev->speed);
450 clrsetbits_32(priv->mac_reg + EXT_RGMII_OOB_CTRL, OOB_DISABLE,
451 RGMII_LINK | RGMII_MODE_EN | ID_MODE_DIS);
453 writel(speed << CMD_SPEED_SHIFT, (priv->mac_reg + UMAC_CMD));
458 static int bcmgenet_gmac_eth_start(struct udevice *dev)
460 struct bcmgenet_eth_priv *priv = dev_get_priv(dev);
463 priv->tx_desc_base = priv->mac_reg + GENET_TX_OFF;
464 priv->rx_desc_base = priv->mac_reg + GENET_RX_OFF;
465 priv->tx_index = 0x0;
466 priv->rx_index = 0x0;
468 bcmgenet_umac_reset(priv);
470 bcmgenet_gmac_write_hwaddr(dev);
472 /* Disable RX/TX DMA and flush TX queues */
473 bcmgenet_disable_dma(priv);
480 /* Enable RX/TX DMA */
481 bcmgenet_enable_dma(priv);
483 /* read PHY properties over the wire from generic PHY set-up */
484 ret = phy_startup(priv->phydev);
486 printf("bcmgenet: PHY startup failed: %d\n", ret);
490 /* Update MAC registers based on PHY property */
491 ret = bcmgenet_adjust_link(priv);
493 printf("bcmgenet: adjust PHY link failed: %d\n", ret);
498 setbits_32(priv->mac_reg + UMAC_CMD, CMD_TX_EN | CMD_RX_EN);
503 static int bcmgenet_phy_init(struct bcmgenet_eth_priv *priv, void *dev)
505 struct phy_device *phydev;
508 phydev = phy_connect(priv->bus, priv->phyaddr, dev, priv->interface);
512 phydev->supported &= PHY_GBIT_FEATURES;
514 ret = phy_set_supported(priv->phydev, priv->speed);
518 phydev->advertising = phydev->supported;
520 phy_connect_dev(phydev, dev);
522 priv->phydev = phydev;
523 phy_config(priv->phydev);
528 static void bcmgenet_mdio_start(struct bcmgenet_eth_priv *priv)
530 setbits_32(priv->mac_reg + MDIO_CMD, MDIO_START_BUSY);
533 static int bcmgenet_mdio_write(struct mii_dev *bus, int addr, int devad,
536 struct udevice *dev = bus->priv;
537 struct bcmgenet_eth_priv *priv = dev_get_priv(dev);
540 /* Prepare the read operation */
541 val = MDIO_WR | (addr << MDIO_PMD_SHIFT) |
542 (reg << MDIO_REG_SHIFT) | (0xffff & value);
543 writel_relaxed(val, priv->mac_reg + MDIO_CMD);
545 /* Start MDIO transaction */
546 bcmgenet_mdio_start(priv);
548 return wait_for_bit_32(priv->mac_reg + MDIO_CMD,
549 MDIO_START_BUSY, false, 20, true);
552 static int bcmgenet_mdio_read(struct mii_dev *bus, int addr, int devad, int reg)
554 struct udevice *dev = bus->priv;
555 struct bcmgenet_eth_priv *priv = dev_get_priv(dev);
559 /* Prepare the read operation */
560 val = MDIO_RD | (addr << MDIO_PMD_SHIFT) | (reg << MDIO_REG_SHIFT);
561 writel_relaxed(val, priv->mac_reg + MDIO_CMD);
563 /* Start MDIO transaction */
564 bcmgenet_mdio_start(priv);
566 ret = wait_for_bit_32(priv->mac_reg + MDIO_CMD,
567 MDIO_START_BUSY, false, 20, true);
571 val = readl_relaxed(priv->mac_reg + MDIO_CMD);
576 static int bcmgenet_mdio_init(const char *name, struct udevice *priv)
578 struct mii_dev *bus = mdio_alloc();
581 debug("Failed to allocate MDIO bus\n");
585 bus->read = bcmgenet_mdio_read;
586 bus->write = bcmgenet_mdio_write;
587 snprintf(bus->name, sizeof(bus->name), name);
588 bus->priv = (void *)priv;
590 return mdio_register(bus);
593 /* We only support RGMII (as used on the RPi4). */
594 static int bcmgenet_interface_set(struct bcmgenet_eth_priv *priv)
596 phy_interface_t phy_mode = priv->interface;
599 case PHY_INTERFACE_MODE_RGMII:
600 case PHY_INTERFACE_MODE_RGMII_RXID:
601 writel(PORT_MODE_EXT_GPHY, priv->mac_reg + SYS_PORT_CTRL);
604 printf("unknown phy mode: %d\n", priv->interface);
611 static int bcmgenet_eth_probe(struct udevice *dev)
613 struct eth_pdata *pdata = dev_get_platdata(dev);
614 struct bcmgenet_eth_priv *priv = dev_get_priv(dev);
621 priv->mac_reg = map_physmem(pdata->iobase, SZ_64K, MAP_NOCACHE);
622 priv->interface = pdata->phy_interface;
623 priv->speed = pdata->max_speed;
625 /* Read GENET HW version */
626 reg = readl_relaxed(priv->mac_reg + SYS_REV_CTRL);
627 major = (reg >> 24) & 0x0f;
634 printf("Unsupported GENETv%d.%d\n", major, (reg >> 16) & 0x0f);
638 ret = bcmgenet_interface_set(priv);
642 writel(0, priv->mac_reg + SYS_RBUF_FLUSH_CTRL);
644 /* disable MAC while updating its registers */
645 writel(0, priv->mac_reg + UMAC_CMD);
646 /* issue soft reset with (rg)mii loopback to ensure a stable rxclk */
647 writel(CMD_SW_RESET | CMD_LCL_LOOP_EN, priv->mac_reg + UMAC_CMD);
649 mdio_node = dev_read_first_subnode(dev);
650 name = ofnode_get_name(mdio_node);
652 ret = bcmgenet_mdio_init(name, dev);
656 priv->bus = miiphy_get_dev_by_name(name);
658 return bcmgenet_phy_init(priv, dev);
661 static void bcmgenet_gmac_eth_stop(struct udevice *dev)
663 struct bcmgenet_eth_priv *priv = dev_get_priv(dev);
665 clrbits_32(priv->mac_reg + UMAC_CMD, CMD_TX_EN | CMD_RX_EN);
667 bcmgenet_disable_dma(priv);
670 static const struct eth_ops bcmgenet_gmac_eth_ops = {
671 .start = bcmgenet_gmac_eth_start,
672 .write_hwaddr = bcmgenet_gmac_write_hwaddr,
673 .send = bcmgenet_gmac_eth_send,
674 .recv = bcmgenet_gmac_eth_recv,
675 .free_pkt = bcmgenet_gmac_free_pkt,
676 .stop = bcmgenet_gmac_eth_stop,
679 static int bcmgenet_eth_ofdata_to_platdata(struct udevice *dev)
681 struct eth_pdata *pdata = dev_get_platdata(dev);
682 struct bcmgenet_eth_priv *priv = dev_get_priv(dev);
683 struct ofnode_phandle_args phy_node;
684 const char *phy_mode;
687 pdata->iobase = dev_read_addr(dev);
689 /* Get phy mode from DT */
690 pdata->phy_interface = -1;
691 phy_mode = dev_read_string(dev, "phy-mode");
693 pdata->phy_interface = phy_get_interface_by_name(phy_mode);
694 if (pdata->phy_interface == -1) {
695 debug("%s: Invalid PHY interface '%s'\n", __func__, phy_mode);
699 ret = dev_read_phandle_with_args(dev, "phy-handle", NULL, 0, 0,
702 ofnode_read_s32(phy_node.node, "reg", &priv->phyaddr);
703 ofnode_read_s32(phy_node.node, "max-speed", &pdata->max_speed);
709 /* The BCM2711 implementation has a limited burst length compared to a generic
710 * GENETv5 version, but we go with that shorter value (8) in both cases, for
711 * the sake of simplicity.
713 static const struct udevice_id bcmgenet_eth_ids[] = {
714 {.compatible = "brcm,genet-v5"},
715 {.compatible = "brcm,bcm2711-genet-v5"},
719 U_BOOT_DRIVER(eth_bcmgenet) = {
720 .name = "eth_bcmgenet",
722 .of_match = bcmgenet_eth_ids,
723 .ofdata_to_platdata = bcmgenet_eth_ofdata_to_platdata,
724 .probe = bcmgenet_eth_probe,
725 .ops = &bcmgenet_gmac_eth_ops,
726 .priv_auto_alloc_size = sizeof(struct bcmgenet_eth_priv),
727 .platdata_auto_alloc_size = sizeof(struct eth_pdata),
728 .flags = DM_FLAG_ALLOC_PRIV_DMA,