blob: 6e26467700a5d285cb63d5174d04815139a6c85a [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01002/*
3 * Copyright (C) 2005-2006 Atmel Corporation
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01004 */
5#include <common.h>
Wenyou Yang577aa3b2016-11-02 10:06:56 +08006#include <clk.h>
Simon Glass1eb69ae2019-11-14 12:57:39 -07007#include <cpu_func.h>
Simon Glassf1dcc192016-05-05 07:28:11 -06008#include <dm.h>
Simon Glassf7ae49f2020-05-10 11:40:05 -06009#include <log.h>
Simon Glassc05ed002020-05-10 11:40:11 -060010#include <linux/delay.h>
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +010011
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +010012/*
13 * The u-boot networking stack is a little weird. It seems like the
14 * networking core allocates receive buffers up front without any
15 * regard to the hardware that's supposed to actually receive those
16 * packets.
17 *
18 * The MACB receives packets into 128-byte receive buffers, so the
19 * buffers allocated by the core isn't very practical to use. We'll
20 * allocate our own, but we need one such buffer in case a packet
21 * wraps around the DMA ring so that we have to copy it.
22 *
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +020023 * Therefore, define CONFIG_SYS_RX_ETH_BUFFER to 1 in the board-specific
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +010024 * configuration header. This way, the core allocates one RX buffer
25 * and one TX buffer, each of which can hold a ethernet packet of
26 * maximum size.
27 *
28 * For some reason, the networking core unconditionally specifies a
29 * 32-byte packet "alignment" (which really should be called
30 * "padding"). MACB shouldn't need that, but we'll refrain from any
31 * core modifications here...
32 */
33
34#include <net.h>
Simon Glassf1dcc192016-05-05 07:28:11 -060035#ifndef CONFIG_DM_ETH
Ben Warren89973f82008-08-31 22:22:04 -070036#include <netdev.h>
Simon Glassf1dcc192016-05-05 07:28:11 -060037#endif
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +010038#include <malloc.h>
Semih Hazar0f751d62009-12-17 15:07:15 +020039#include <miiphy.h>
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +010040
41#include <linux/mii.h>
42#include <asm/io.h>
Masahiro Yamada9d86b892020-02-14 16:40:19 +090043#include <linux/dma-mapping.h>
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +010044#include <asm/arch/clk.h>
Masahiro Yamada5d97dff2016-09-21 11:28:57 +090045#include <linux/errno.h>
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +010046
47#include "macb.h"
48
Wenyou Yanga212b662016-05-17 13:11:35 +080049DECLARE_GLOBAL_DATA_PTR;
50
Ramon Friedc6d07bf2019-07-14 18:25:14 +030051/*
52 * These buffer sizes must be power of 2 and divisible
53 * by RX_BUFFER_MULTIPLE
54 */
55#define MACB_RX_BUFFER_SIZE 128
56#define GEM_RX_BUFFER_SIZE 2048
Ramon Fried9c295802019-07-16 22:04:36 +030057#define RX_BUFFER_MULTIPLE 64
Ramon Friedc6d07bf2019-07-14 18:25:14 +030058
59#define MACB_RX_RING_SIZE 32
Andreas Bießmannceef9832014-05-26 22:55:18 +020060#define MACB_TX_RING_SIZE 16
Ramon Friedc6d07bf2019-07-14 18:25:14 +030061
Andreas Bießmannceef9832014-05-26 22:55:18 +020062#define MACB_TX_TIMEOUT 1000
63#define MACB_AUTONEG_TIMEOUT 5000000
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +010064
Wilson Lee4bf56912017-08-22 20:25:07 -070065#ifdef CONFIG_MACB_ZYNQ
66/* INCR4 AHB bursts */
67#define MACB_ZYNQ_GEM_DMACR_BLENGTH 0x00000004
68/* Use full configured addressable space (8 Kb) */
69#define MACB_ZYNQ_GEM_DMACR_RXSIZE 0x00000300
70/* Use full configured addressable space (4 Kb) */
71#define MACB_ZYNQ_GEM_DMACR_TXSIZE 0x00000400
72/* Set RXBUF with use of 128 byte */
73#define MACB_ZYNQ_GEM_DMACR_RXBUF 0x00020000
74#define MACB_ZYNQ_GEM_DMACR_INIT \
75 (MACB_ZYNQ_GEM_DMACR_BLENGTH | \
76 MACB_ZYNQ_GEM_DMACR_RXSIZE | \
77 MACB_ZYNQ_GEM_DMACR_TXSIZE | \
78 MACB_ZYNQ_GEM_DMACR_RXBUF)
79#endif
80
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +010081struct macb_dma_desc {
82 u32 addr;
83 u32 ctrl;
84};
85
Padmarao Begari6f0b2372021-01-15 08:20:36 +053086struct macb_dma_desc_64 {
87 u32 addrh;
88 u32 unused;
89};
90
91#define HW_DMA_CAP_32B 0
92#define HW_DMA_CAP_64B 1
93
94#define DMA_DESC_SIZE 16
95#define DMA_DESC_BYTES(n) ((n) * DMA_DESC_SIZE)
Wu, Josh5ae0e382014-05-27 16:31:05 +080096#define MACB_TX_DMA_DESC_SIZE (DMA_DESC_BYTES(MACB_TX_RING_SIZE))
97#define MACB_RX_DMA_DESC_SIZE (DMA_DESC_BYTES(MACB_RX_RING_SIZE))
Wu, Joshade4ea42015-06-03 16:45:44 +080098#define MACB_TX_DUMMY_DMA_DESC_SIZE (DMA_DESC_BYTES(1))
Wu, Josh5ae0e382014-05-27 16:31:05 +080099
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100100#define RXBUF_FRMLEN_MASK 0x00000fff
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100101#define TXBUF_FRMLEN_MASK 0x000007ff
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100102
103struct macb_device {
104 void *regs;
Anup Pateld0a04db2019-07-24 04:09:32 +0000105
Anup Pateleff0e0c2019-07-24 04:09:37 +0000106 bool is_big_endian;
107
Anup Pateld0a04db2019-07-24 04:09:32 +0000108 const struct macb_config *config;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100109
110 unsigned int rx_tail;
111 unsigned int tx_head;
112 unsigned int tx_tail;
Simon Glassd5555b72016-05-05 07:28:09 -0600113 unsigned int next_rx_tail;
114 bool wrapped;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100115
116 void *rx_buffer;
117 void *tx_buffer;
118 struct macb_dma_desc *rx_ring;
119 struct macb_dma_desc *tx_ring;
Ramon Friedc6d07bf2019-07-14 18:25:14 +0300120 size_t rx_buffer_size;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100121
122 unsigned long rx_buffer_dma;
123 unsigned long rx_ring_dma;
124 unsigned long tx_ring_dma;
125
Wu, Joshade4ea42015-06-03 16:45:44 +0800126 struct macb_dma_desc *dummy_desc;
127 unsigned long dummy_desc_dma;
128
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100129 const struct device *dev;
Simon Glassf1dcc192016-05-05 07:28:11 -0600130#ifndef CONFIG_DM_ETH
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100131 struct eth_device netdev;
Simon Glassf1dcc192016-05-05 07:28:11 -0600132#endif
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100133 unsigned short phy_addr;
Bo Shenb1a00062013-04-24 15:59:27 +0800134 struct mii_dev *bus;
Wenyou Yang1870d4d2017-04-14 14:36:04 +0800135#ifdef CONFIG_PHYLIB
136 struct phy_device *phydev;
137#endif
Wenyou Yanga212b662016-05-17 13:11:35 +0800138
139#ifdef CONFIG_DM_ETH
Wenyou Yang3fd2b3a2017-02-14 16:24:40 +0800140#ifdef CONFIG_CLK
Wenyou Yang577aa3b2016-11-02 10:06:56 +0800141 unsigned long pclk_rate;
Wenyou Yang3fd2b3a2017-02-14 16:24:40 +0800142#endif
Wenyou Yanga212b662016-05-17 13:11:35 +0800143 phy_interface_t phy_interface;
144#endif
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100145};
Ramon Frieded3c64f2019-07-16 22:04:35 +0300146
Claudiu Bezneabb890f72021-01-19 13:26:44 +0200147struct macb_usrio_cfg {
148 unsigned int mii;
149 unsigned int rmii;
150 unsigned int rgmii;
151 unsigned int clken;
152};
153
Ramon Frieded3c64f2019-07-16 22:04:35 +0300154struct macb_config {
155 unsigned int dma_burst_length;
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530156 unsigned int hw_dma_cap;
Claudiu Bezneabb890f72021-01-19 13:26:44 +0200157 unsigned int caps;
Anup Pateld0a04db2019-07-24 04:09:32 +0000158
159 int (*clk_init)(struct udevice *dev, ulong rate);
Claudiu Bezneabb890f72021-01-19 13:26:44 +0200160 const struct macb_usrio_cfg *usrio;
Ramon Frieded3c64f2019-07-16 22:04:35 +0300161};
162
Simon Glassf1dcc192016-05-05 07:28:11 -0600163#ifndef CONFIG_DM_ETH
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100164#define to_macb(_nd) container_of(_nd, struct macb_device, netdev)
Simon Glassf1dcc192016-05-05 07:28:11 -0600165#endif
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100166
Bo Shend256be22013-04-24 15:59:28 +0800167static int macb_is_gem(struct macb_device *macb)
168{
Atish Patrafbcaa262019-02-25 08:14:42 +0000169 return MACB_BFEXT(IDNUM, macb_readl(macb, MID)) >= 0x2;
Bo Shend256be22013-04-24 15:59:28 +0800170}
171
Gregory CLEMENT75b03cf2015-12-16 14:50:34 +0100172#ifndef cpu_is_sama5d2
173#define cpu_is_sama5d2() 0
174#endif
175
176#ifndef cpu_is_sama5d4
177#define cpu_is_sama5d4() 0
178#endif
179
180static int gem_is_gigabit_capable(struct macb_device *macb)
181{
182 /*
Robert P. J. Day1cc0a9f2016-05-04 04:47:31 -0400183 * The GEM controllers embedded in SAMA5D2 and SAMA5D4 are
Gregory CLEMENT75b03cf2015-12-16 14:50:34 +0100184 * configured to support only 10/100.
185 */
186 return macb_is_gem(macb) && !cpu_is_sama5d2() && !cpu_is_sama5d4();
187}
188
Josef Holzmayr0d3044c2019-10-02 21:22:51 +0200189static void macb_mdio_write(struct macb_device *macb, u8 phy_adr, u8 reg,
190 u16 value)
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100191{
192 unsigned long netctl;
193 unsigned long netstat;
194 unsigned long frame;
195
196 netctl = macb_readl(macb, NCR);
197 netctl |= MACB_BIT(MPE);
198 macb_writel(macb, NCR, netctl);
199
200 frame = (MACB_BF(SOF, 1)
201 | MACB_BF(RW, 1)
Josef Holzmayr0d3044c2019-10-02 21:22:51 +0200202 | MACB_BF(PHYA, phy_adr)
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100203 | MACB_BF(REGA, reg)
204 | MACB_BF(CODE, 2)
205 | MACB_BF(DATA, value));
206 macb_writel(macb, MAN, frame);
207
208 do {
209 netstat = macb_readl(macb, NSR);
210 } while (!(netstat & MACB_BIT(IDLE)));
211
212 netctl = macb_readl(macb, NCR);
213 netctl &= ~MACB_BIT(MPE);
214 macb_writel(macb, NCR, netctl);
215}
216
Josef Holzmayr0d3044c2019-10-02 21:22:51 +0200217static u16 macb_mdio_read(struct macb_device *macb, u8 phy_adr, u8 reg)
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100218{
219 unsigned long netctl;
220 unsigned long netstat;
221 unsigned long frame;
222
223 netctl = macb_readl(macb, NCR);
224 netctl |= MACB_BIT(MPE);
225 macb_writel(macb, NCR, netctl);
226
227 frame = (MACB_BF(SOF, 1)
228 | MACB_BF(RW, 2)
Josef Holzmayr0d3044c2019-10-02 21:22:51 +0200229 | MACB_BF(PHYA, phy_adr)
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100230 | MACB_BF(REGA, reg)
231 | MACB_BF(CODE, 2));
232 macb_writel(macb, MAN, frame);
233
234 do {
235 netstat = macb_readl(macb, NSR);
236 } while (!(netstat & MACB_BIT(IDLE)));
237
238 frame = macb_readl(macb, MAN);
239
240 netctl = macb_readl(macb, NCR);
241 netctl &= ~MACB_BIT(MPE);
242 macb_writel(macb, NCR, netctl);
243
244 return MACB_BFEXT(DATA, frame);
245}
246
Joe Hershberger1b8c18b2013-06-24 19:06:38 -0500247void __weak arch_get_mdio_control(const char *name)
Shiraz Hashim416ce622012-12-13 17:22:52 +0530248{
249 return;
250}
251
Bo Shenb1a00062013-04-24 15:59:27 +0800252#if defined(CONFIG_CMD_MII) || defined(CONFIG_PHYLIB)
Semih Hazar0f751d62009-12-17 15:07:15 +0200253
Joe Hershberger5a49f172016-08-08 11:28:38 -0500254int macb_miiphy_read(struct mii_dev *bus, int phy_adr, int devad, int reg)
Semih Hazar0f751d62009-12-17 15:07:15 +0200255{
Joe Hershberger5a49f172016-08-08 11:28:38 -0500256 u16 value = 0;
Simon Glassf1dcc192016-05-05 07:28:11 -0600257#ifdef CONFIG_DM_ETH
Joe Hershberger5a49f172016-08-08 11:28:38 -0500258 struct udevice *dev = eth_get_dev_by_name(bus->name);
Simon Glassf1dcc192016-05-05 07:28:11 -0600259 struct macb_device *macb = dev_get_priv(dev);
260#else
Joe Hershberger5a49f172016-08-08 11:28:38 -0500261 struct eth_device *dev = eth_get_dev_by_name(bus->name);
Semih Hazar0f751d62009-12-17 15:07:15 +0200262 struct macb_device *macb = to_macb(dev);
Simon Glassf1dcc192016-05-05 07:28:11 -0600263#endif
Semih Hazar0f751d62009-12-17 15:07:15 +0200264
Joe Hershberger5a49f172016-08-08 11:28:38 -0500265 arch_get_mdio_control(bus->name);
Josef Holzmayr7c564082019-10-02 21:22:52 +0200266 value = macb_mdio_read(macb, phy_adr, reg);
Semih Hazar0f751d62009-12-17 15:07:15 +0200267
Joe Hershberger5a49f172016-08-08 11:28:38 -0500268 return value;
Semih Hazar0f751d62009-12-17 15:07:15 +0200269}
270
Joe Hershberger5a49f172016-08-08 11:28:38 -0500271int macb_miiphy_write(struct mii_dev *bus, int phy_adr, int devad, int reg,
272 u16 value)
Semih Hazar0f751d62009-12-17 15:07:15 +0200273{
Simon Glassf1dcc192016-05-05 07:28:11 -0600274#ifdef CONFIG_DM_ETH
Joe Hershberger5a49f172016-08-08 11:28:38 -0500275 struct udevice *dev = eth_get_dev_by_name(bus->name);
Simon Glassf1dcc192016-05-05 07:28:11 -0600276 struct macb_device *macb = dev_get_priv(dev);
277#else
Joe Hershberger5a49f172016-08-08 11:28:38 -0500278 struct eth_device *dev = eth_get_dev_by_name(bus->name);
Semih Hazar0f751d62009-12-17 15:07:15 +0200279 struct macb_device *macb = to_macb(dev);
Simon Glassf1dcc192016-05-05 07:28:11 -0600280#endif
Semih Hazar0f751d62009-12-17 15:07:15 +0200281
Joe Hershberger5a49f172016-08-08 11:28:38 -0500282 arch_get_mdio_control(bus->name);
Josef Holzmayr7c564082019-10-02 21:22:52 +0200283 macb_mdio_write(macb, phy_adr, reg, value);
Semih Hazar0f751d62009-12-17 15:07:15 +0200284
285 return 0;
286}
287#endif
288
Wu, Josh5ae0e382014-05-27 16:31:05 +0800289#define RX 1
290#define TX 0
291static inline void macb_invalidate_ring_desc(struct macb_device *macb, bool rx)
292{
293 if (rx)
Heiko Schocher592a7492016-08-29 07:46:11 +0200294 invalidate_dcache_range(macb->rx_ring_dma,
295 ALIGN(macb->rx_ring_dma + MACB_RX_DMA_DESC_SIZE,
296 PKTALIGN));
Wu, Josh5ae0e382014-05-27 16:31:05 +0800297 else
Heiko Schocher592a7492016-08-29 07:46:11 +0200298 invalidate_dcache_range(macb->tx_ring_dma,
299 ALIGN(macb->tx_ring_dma + MACB_TX_DMA_DESC_SIZE,
300 PKTALIGN));
Wu, Josh5ae0e382014-05-27 16:31:05 +0800301}
302
303static inline void macb_flush_ring_desc(struct macb_device *macb, bool rx)
304{
305 if (rx)
306 flush_dcache_range(macb->rx_ring_dma, macb->rx_ring_dma +
Heiko Schocher592a7492016-08-29 07:46:11 +0200307 ALIGN(MACB_RX_DMA_DESC_SIZE, PKTALIGN));
Wu, Josh5ae0e382014-05-27 16:31:05 +0800308 else
309 flush_dcache_range(macb->tx_ring_dma, macb->tx_ring_dma +
Heiko Schocher592a7492016-08-29 07:46:11 +0200310 ALIGN(MACB_TX_DMA_DESC_SIZE, PKTALIGN));
Wu, Josh5ae0e382014-05-27 16:31:05 +0800311}
312
313static inline void macb_flush_rx_buffer(struct macb_device *macb)
314{
315 flush_dcache_range(macb->rx_buffer_dma, macb->rx_buffer_dma +
Stefan Roese5ccd6572019-08-26 09:18:11 +0200316 ALIGN(macb->rx_buffer_size * MACB_RX_RING_SIZE,
317 PKTALIGN));
Wu, Josh5ae0e382014-05-27 16:31:05 +0800318}
319
320static inline void macb_invalidate_rx_buffer(struct macb_device *macb)
321{
322 invalidate_dcache_range(macb->rx_buffer_dma, macb->rx_buffer_dma +
Stefan Roese5ccd6572019-08-26 09:18:11 +0200323 ALIGN(macb->rx_buffer_size * MACB_RX_RING_SIZE,
324 PKTALIGN));
Wu, Josh5ae0e382014-05-27 16:31:05 +0800325}
Semih Hazar0f751d62009-12-17 15:07:15 +0200326
Jon Loeliger07d38a12007-07-09 17:30:01 -0500327#if defined(CONFIG_CMD_NET)
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100328
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530329static struct macb_dma_desc_64 *macb_64b_desc(struct macb_dma_desc *desc)
330{
331 return (struct macb_dma_desc_64 *)((void *)desc
332 + sizeof(struct macb_dma_desc));
333}
334
335static void macb_set_addr(struct macb_device *macb, struct macb_dma_desc *desc,
336 ulong addr)
337{
338 struct macb_dma_desc_64 *desc_64;
339
340 if (macb->config->hw_dma_cap & HW_DMA_CAP_64B) {
341 desc_64 = macb_64b_desc(desc);
342 desc_64->addrh = upper_32_bits(addr);
343 }
344 desc->addr = lower_32_bits(addr);
345}
346
Simon Glassd5555b72016-05-05 07:28:09 -0600347static int _macb_send(struct macb_device *macb, const char *name, void *packet,
348 int length)
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100349{
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100350 unsigned long paddr, ctrl;
351 unsigned int tx_head = macb->tx_head;
352 int i;
353
354 paddr = dma_map_single(packet, length, DMA_TO_DEVICE);
355
356 ctrl = length & TXBUF_FRMLEN_MASK;
Ramon Fried0a2827e2019-07-16 22:04:33 +0300357 ctrl |= MACB_BIT(TX_LAST);
Andreas Bießmannceef9832014-05-26 22:55:18 +0200358 if (tx_head == (MACB_TX_RING_SIZE - 1)) {
Ramon Fried0a2827e2019-07-16 22:04:33 +0300359 ctrl |= MACB_BIT(TX_WRAP);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100360 macb->tx_head = 0;
Andreas Bießmannceef9832014-05-26 22:55:18 +0200361 } else {
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100362 macb->tx_head++;
Andreas Bießmannceef9832014-05-26 22:55:18 +0200363 }
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100364
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530365 if (macb->config->hw_dma_cap & HW_DMA_CAP_64B)
366 tx_head = tx_head * 2;
367
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100368 macb->tx_ring[tx_head].ctrl = ctrl;
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530369 macb_set_addr(macb, &macb->tx_ring[tx_head], paddr);
370
Haavard Skinnemoen04fcb5d2007-05-02 13:22:38 +0200371 barrier();
Wu, Josh5ae0e382014-05-27 16:31:05 +0800372 macb_flush_ring_desc(macb, TX);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100373 macb_writel(macb, NCR, MACB_BIT(TE) | MACB_BIT(RE) | MACB_BIT(TSTART));
374
375 /*
376 * I guess this is necessary because the networking core may
377 * re-use the transmit buffer as soon as we return...
378 */
Andreas Bießmannceef9832014-05-26 22:55:18 +0200379 for (i = 0; i <= MACB_TX_TIMEOUT; i++) {
Haavard Skinnemoen04fcb5d2007-05-02 13:22:38 +0200380 barrier();
Wu, Josh5ae0e382014-05-27 16:31:05 +0800381 macb_invalidate_ring_desc(macb, TX);
Haavard Skinnemoen04fcb5d2007-05-02 13:22:38 +0200382 ctrl = macb->tx_ring[tx_head].ctrl;
Ramon Fried0a2827e2019-07-16 22:04:33 +0300383 if (ctrl & MACB_BIT(TX_USED))
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100384 break;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100385 udelay(1);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100386 }
387
Masahiro Yamada950c5962020-02-14 16:40:18 +0900388 dma_unmap_single(paddr, length, DMA_TO_DEVICE);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100389
Andreas Bießmannceef9832014-05-26 22:55:18 +0200390 if (i <= MACB_TX_TIMEOUT) {
Ramon Fried0a2827e2019-07-16 22:04:33 +0300391 if (ctrl & MACB_BIT(TX_UNDERRUN))
Simon Glassd5555b72016-05-05 07:28:09 -0600392 printf("%s: TX underrun\n", name);
Ramon Fried0a2827e2019-07-16 22:04:33 +0300393 if (ctrl & MACB_BIT(TX_BUF_EXHAUSTED))
Simon Glassd5555b72016-05-05 07:28:09 -0600394 printf("%s: TX buffers exhausted in mid frame\n", name);
Haavard Skinnemoen04fcb5d2007-05-02 13:22:38 +0200395 } else {
Simon Glassd5555b72016-05-05 07:28:09 -0600396 printf("%s: TX timeout\n", name);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100397 }
398
399 /* No one cares anyway */
400 return 0;
401}
402
403static void reclaim_rx_buffers(struct macb_device *macb,
404 unsigned int new_tail)
405{
406 unsigned int i;
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530407 unsigned int count;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100408
409 i = macb->rx_tail;
Wu, Josh5ae0e382014-05-27 16:31:05 +0800410
411 macb_invalidate_ring_desc(macb, RX);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100412 while (i > new_tail) {
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530413 if (macb->config->hw_dma_cap & HW_DMA_CAP_64B)
414 count = i * 2;
415 else
416 count = i;
417 macb->rx_ring[count].addr &= ~MACB_BIT(RX_USED);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100418 i++;
Andreas Bießmannceef9832014-05-26 22:55:18 +0200419 if (i > MACB_RX_RING_SIZE)
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100420 i = 0;
421 }
422
423 while (i < new_tail) {
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530424 if (macb->config->hw_dma_cap & HW_DMA_CAP_64B)
425 count = i * 2;
426 else
427 count = i;
428 macb->rx_ring[count].addr &= ~MACB_BIT(RX_USED);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100429 i++;
430 }
431
Haavard Skinnemoen04fcb5d2007-05-02 13:22:38 +0200432 barrier();
Wu, Josh5ae0e382014-05-27 16:31:05 +0800433 macb_flush_ring_desc(macb, RX);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100434 macb->rx_tail = new_tail;
435}
436
Simon Glassd5555b72016-05-05 07:28:09 -0600437static int _macb_recv(struct macb_device *macb, uchar **packetp)
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100438{
Simon Glassd5555b72016-05-05 07:28:09 -0600439 unsigned int next_rx_tail = macb->next_rx_tail;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100440 void *buffer;
441 int length;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100442 u32 status;
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530443 u8 flag = false;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100444
Simon Glassd5555b72016-05-05 07:28:09 -0600445 macb->wrapped = false;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100446 for (;;) {
Wu, Josh5ae0e382014-05-27 16:31:05 +0800447 macb_invalidate_ring_desc(macb, RX);
448
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530449 if (macb->config->hw_dma_cap & HW_DMA_CAP_64B)
450 next_rx_tail = next_rx_tail * 2;
451
Ramon Fried0a2827e2019-07-16 22:04:33 +0300452 if (!(macb->rx_ring[next_rx_tail].addr & MACB_BIT(RX_USED)))
Simon Glassd5555b72016-05-05 07:28:09 -0600453 return -EAGAIN;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100454
Simon Glassd5555b72016-05-05 07:28:09 -0600455 status = macb->rx_ring[next_rx_tail].ctrl;
Ramon Fried0a2827e2019-07-16 22:04:33 +0300456 if (status & MACB_BIT(RX_SOF)) {
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530457 if (macb->config->hw_dma_cap & HW_DMA_CAP_64B) {
458 next_rx_tail = next_rx_tail / 2;
459 flag = true;
460 }
461
Simon Glassd5555b72016-05-05 07:28:09 -0600462 if (next_rx_tail != macb->rx_tail)
463 reclaim_rx_buffers(macb, next_rx_tail);
464 macb->wrapped = false;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100465 }
466
Ramon Fried0a2827e2019-07-16 22:04:33 +0300467 if (status & MACB_BIT(RX_EOF)) {
Ramon Friedc6d07bf2019-07-14 18:25:14 +0300468 buffer = macb->rx_buffer +
469 macb->rx_buffer_size * macb->rx_tail;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100470 length = status & RXBUF_FRMLEN_MASK;
Wu, Josh5ae0e382014-05-27 16:31:05 +0800471
472 macb_invalidate_rx_buffer(macb);
Simon Glassd5555b72016-05-05 07:28:09 -0600473 if (macb->wrapped) {
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100474 unsigned int headlen, taillen;
475
Ramon Friedc6d07bf2019-07-14 18:25:14 +0300476 headlen = macb->rx_buffer_size *
477 (MACB_RX_RING_SIZE - macb->rx_tail);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100478 taillen = length - headlen;
Joe Hershberger1fd92db2015-04-08 01:41:06 -0500479 memcpy((void *)net_rx_packets[0],
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100480 buffer, headlen);
Joe Hershberger1fd92db2015-04-08 01:41:06 -0500481 memcpy((void *)net_rx_packets[0] + headlen,
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100482 macb->rx_buffer, taillen);
Simon Glassd5555b72016-05-05 07:28:09 -0600483 *packetp = (void *)net_rx_packets[0];
484 } else {
485 *packetp = buffer;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100486 }
487
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530488 if (macb->config->hw_dma_cap & HW_DMA_CAP_64B) {
489 if (!flag)
490 next_rx_tail = next_rx_tail / 2;
491 }
492
Simon Glassd5555b72016-05-05 07:28:09 -0600493 if (++next_rx_tail >= MACB_RX_RING_SIZE)
494 next_rx_tail = 0;
495 macb->next_rx_tail = next_rx_tail;
496 return length;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100497 } else {
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530498 if (macb->config->hw_dma_cap & HW_DMA_CAP_64B) {
499 if (!flag)
500 next_rx_tail = next_rx_tail / 2;
501 flag = false;
502 }
503
Simon Glassd5555b72016-05-05 07:28:09 -0600504 if (++next_rx_tail >= MACB_RX_RING_SIZE) {
505 macb->wrapped = true;
506 next_rx_tail = 0;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100507 }
508 }
Haavard Skinnemoen04fcb5d2007-05-02 13:22:38 +0200509 barrier();
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100510 }
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100511}
512
Simon Glassd5555b72016-05-05 07:28:09 -0600513static void macb_phy_reset(struct macb_device *macb, const char *name)
Haavard Skinnemoenf2134f82007-05-02 13:31:53 +0200514{
Haavard Skinnemoenf2134f82007-05-02 13:31:53 +0200515 int i;
516 u16 status, adv;
517
518 adv = ADVERTISE_CSMA | ADVERTISE_ALL;
Josef Holzmayr0d3044c2019-10-02 21:22:51 +0200519 macb_mdio_write(macb, macb->phy_addr, MII_ADVERTISE, adv);
Simon Glassd5555b72016-05-05 07:28:09 -0600520 printf("%s: Starting autonegotiation...\n", name);
Josef Holzmayr0d3044c2019-10-02 21:22:51 +0200521 macb_mdio_write(macb, macb->phy_addr, MII_BMCR, (BMCR_ANENABLE
Haavard Skinnemoenf2134f82007-05-02 13:31:53 +0200522 | BMCR_ANRESTART));
523
Andreas Bießmannceef9832014-05-26 22:55:18 +0200524 for (i = 0; i < MACB_AUTONEG_TIMEOUT / 100; i++) {
Josef Holzmayr0d3044c2019-10-02 21:22:51 +0200525 status = macb_mdio_read(macb, macb->phy_addr, MII_BMSR);
Haavard Skinnemoenf2134f82007-05-02 13:31:53 +0200526 if (status & BMSR_ANEGCOMPLETE)
527 break;
528 udelay(100);
529 }
530
531 if (status & BMSR_ANEGCOMPLETE)
Simon Glassd5555b72016-05-05 07:28:09 -0600532 printf("%s: Autonegotiation complete\n", name);
Haavard Skinnemoenf2134f82007-05-02 13:31:53 +0200533 else
534 printf("%s: Autonegotiation timed out (status=0x%04x)\n",
Simon Glassd5555b72016-05-05 07:28:09 -0600535 name, status);
Haavard Skinnemoenf2134f82007-05-02 13:31:53 +0200536}
537
Wenyou Yanga212b662016-05-17 13:11:35 +0800538static int macb_phy_find(struct macb_device *macb, const char *name)
Gunnar Rangoyfc01ea12009-01-23 12:56:31 +0100539{
540 int i;
541 u16 phy_id;
542
Padmarao Begari1b459382021-01-15 08:20:37 +0530543 phy_id = macb_mdio_read(macb, macb->phy_addr, MII_PHYSID1);
544 if (phy_id != 0xffff) {
545 printf("%s: PHY present at %d\n", name, macb->phy_addr);
546 return 0;
547 }
548
Gunnar Rangoyfc01ea12009-01-23 12:56:31 +0100549 /* Search for PHY... */
550 for (i = 0; i < 32; i++) {
551 macb->phy_addr = i;
Josef Holzmayr0d3044c2019-10-02 21:22:51 +0200552 phy_id = macb_mdio_read(macb, macb->phy_addr, MII_PHYSID1);
Gunnar Rangoyfc01ea12009-01-23 12:56:31 +0100553 if (phy_id != 0xffff) {
Wenyou Yanga212b662016-05-17 13:11:35 +0800554 printf("%s: PHY present at %d\n", name, i);
Wilson Lee4bf56912017-08-22 20:25:07 -0700555 return 0;
Gunnar Rangoyfc01ea12009-01-23 12:56:31 +0100556 }
557 }
558
559 /* PHY isn't up to snuff */
Wenyou Yanga212b662016-05-17 13:11:35 +0800560 printf("%s: PHY not found\n", name);
Gunnar Rangoyfc01ea12009-01-23 12:56:31 +0100561
Wilson Lee4bf56912017-08-22 20:25:07 -0700562 return -ENODEV;
563}
564
565/**
566 * macb_linkspd_cb - Linkspeed change callback function
Bin Menga5e3d232019-05-22 00:09:45 -0700567 * @dev/@regs: MACB udevice (DM version) or
568 * Base Register of MACB devices (non-DM version)
Wilson Lee4bf56912017-08-22 20:25:07 -0700569 * @speed: Linkspeed
570 * Returns 0 when operation success and negative errno number
571 * when operation failed.
572 */
Bin Menga5e3d232019-05-22 00:09:45 -0700573#ifdef CONFIG_DM_ETH
Anup Pateld0a04db2019-07-24 04:09:32 +0000574static int macb_sifive_clk_init(struct udevice *dev, ulong rate)
575{
576 fdt_addr_t addr;
577 void *gemgxl_regs;
578
579 addr = dev_read_addr_index(dev, 1);
580 if (addr == FDT_ADDR_T_NONE)
581 return -ENODEV;
582
583 gemgxl_regs = (void __iomem *)addr;
584 if (!gemgxl_regs)
585 return -ENODEV;
586
587 /*
588 * SiFive GEMGXL TX clock operation mode:
589 *
590 * 0 = GMII mode. Use 125 MHz gemgxlclk from PRCI in TX logic
591 * and output clock on GMII output signal GTX_CLK
592 * 1 = MII mode. Use MII input signal TX_CLK in TX logic
593 */
594 writel(rate != 125000000, gemgxl_regs);
595 return 0;
596}
597
Claudiu Beznea8c0483e2021-01-19 13:26:46 +0200598static int macb_sama7g5_clk_init(struct udevice *dev, ulong rate)
599{
600 struct clk clk;
601 int ret;
602
603 ret = clk_get_by_name(dev, "tx_clk", &clk);
604 if (ret)
605 return ret;
606
607 /*
608 * This is for using GCK. Clock rate is addressed via assigned-clock
609 * property, so only clock enable is needed here. The switching to
610 * proper clock rate depending on link speed is managed by IP logic.
611 */
612 return clk_enable(&clk);
613}
614
Bin Menga5e3d232019-05-22 00:09:45 -0700615int __weak macb_linkspd_cb(struct udevice *dev, unsigned int speed)
616{
Bin Meng3ef64442019-05-22 00:09:46 -0700617#ifdef CONFIG_CLK
Anup Pateld0a04db2019-07-24 04:09:32 +0000618 struct macb_device *macb = dev_get_priv(dev);
Bin Meng3ef64442019-05-22 00:09:46 -0700619 struct clk tx_clk;
620 ulong rate;
621 int ret;
622
Bin Meng3ef64442019-05-22 00:09:46 -0700623 switch (speed) {
624 case _10BASET:
625 rate = 2500000; /* 2.5 MHz */
626 break;
627 case _100BASET:
628 rate = 25000000; /* 25 MHz */
629 break;
630 case _1000BASET:
631 rate = 125000000; /* 125 MHz */
632 break;
633 default:
634 /* does not change anything */
635 return 0;
636 }
637
Anup Pateld0a04db2019-07-24 04:09:32 +0000638 if (macb->config->clk_init)
639 return macb->config->clk_init(dev, rate);
640
641 /*
642 * "tx_clk" is an optional clock source for MACB.
643 * Ignore if it does not exist in DT.
644 */
645 ret = clk_get_by_name(dev, "tx_clk", &tx_clk);
646 if (ret)
647 return 0;
648
Bin Meng3ef64442019-05-22 00:09:46 -0700649 if (tx_clk.dev) {
650 ret = clk_set_rate(&tx_clk, rate);
Claudiu Beznea96449582021-01-19 13:26:45 +0200651 if (ret < 0)
Bin Meng3ef64442019-05-22 00:09:46 -0700652 return ret;
653 }
654#endif
655
Bin Menga5e3d232019-05-22 00:09:45 -0700656 return 0;
657}
658#else
Wilson Lee4bf56912017-08-22 20:25:07 -0700659int __weak macb_linkspd_cb(void *regs, unsigned int speed)
660{
Gunnar Rangoyfc01ea12009-01-23 12:56:31 +0100661 return 0;
662}
Bin Menga5e3d232019-05-22 00:09:45 -0700663#endif
Gunnar Rangoyfc01ea12009-01-23 12:56:31 +0100664
Wenyou Yanga212b662016-05-17 13:11:35 +0800665#ifdef CONFIG_DM_ETH
666static int macb_phy_init(struct udevice *dev, const char *name)
667#else
Simon Glassd5555b72016-05-05 07:28:09 -0600668static int macb_phy_init(struct macb_device *macb, const char *name)
Wenyou Yanga212b662016-05-17 13:11:35 +0800669#endif
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100670{
Wenyou Yanga212b662016-05-17 13:11:35 +0800671#ifdef CONFIG_DM_ETH
672 struct macb_device *macb = dev_get_priv(dev);
673#endif
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100674 u32 ncfgr;
675 u16 phy_id, status, adv, lpa;
676 int media, speed, duplex;
Wilson Lee4bf56912017-08-22 20:25:07 -0700677 int ret;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100678 int i;
679
Simon Glassd5555b72016-05-05 07:28:09 -0600680 arch_get_mdio_control(name);
Gunnar Rangoyfc01ea12009-01-23 12:56:31 +0100681 /* Auto-detect phy_addr */
Wilson Lee4bf56912017-08-22 20:25:07 -0700682 ret = macb_phy_find(macb, name);
683 if (ret)
684 return ret;
Gunnar Rangoyfc01ea12009-01-23 12:56:31 +0100685
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100686 /* Check if the PHY is up to snuff... */
Josef Holzmayr0d3044c2019-10-02 21:22:51 +0200687 phy_id = macb_mdio_read(macb, macb->phy_addr, MII_PHYSID1);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100688 if (phy_id == 0xffff) {
Simon Glassd5555b72016-05-05 07:28:09 -0600689 printf("%s: No PHY present\n", name);
Wilson Lee4bf56912017-08-22 20:25:07 -0700690 return -ENODEV;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100691 }
692
Bo Shenb1a00062013-04-24 15:59:27 +0800693#ifdef CONFIG_PHYLIB
Wenyou Yanga212b662016-05-17 13:11:35 +0800694#ifdef CONFIG_DM_ETH
Wenyou Yang1870d4d2017-04-14 14:36:04 +0800695 macb->phydev = phy_connect(macb->bus, macb->phy_addr, dev,
Wenyou Yanga212b662016-05-17 13:11:35 +0800696 macb->phy_interface);
697#else
Bo Shen8314ccd2013-08-19 10:35:47 +0800698 /* need to consider other phy interface mode */
Wenyou Yang1870d4d2017-04-14 14:36:04 +0800699 macb->phydev = phy_connect(macb->bus, macb->phy_addr, &macb->netdev,
Bo Shen8314ccd2013-08-19 10:35:47 +0800700 PHY_INTERFACE_MODE_RGMII);
Wenyou Yanga212b662016-05-17 13:11:35 +0800701#endif
Wenyou Yang1870d4d2017-04-14 14:36:04 +0800702 if (!macb->phydev) {
Bo Shen8314ccd2013-08-19 10:35:47 +0800703 printf("phy_connect failed\n");
704 return -ENODEV;
705 }
706
Wenyou Yang1870d4d2017-04-14 14:36:04 +0800707 phy_config(macb->phydev);
Bo Shenb1a00062013-04-24 15:59:27 +0800708#endif
709
Josef Holzmayr0d3044c2019-10-02 21:22:51 +0200710 status = macb_mdio_read(macb, macb->phy_addr, MII_BMSR);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100711 if (!(status & BMSR_LSTATUS)) {
Haavard Skinnemoenf2134f82007-05-02 13:31:53 +0200712 /* Try to re-negotiate if we don't have link already. */
Simon Glassd5555b72016-05-05 07:28:09 -0600713 macb_phy_reset(macb, name);
Haavard Skinnemoenf2134f82007-05-02 13:31:53 +0200714
Andreas Bießmannceef9832014-05-26 22:55:18 +0200715 for (i = 0; i < MACB_AUTONEG_TIMEOUT / 100; i++) {
Josef Holzmayr0d3044c2019-10-02 21:22:51 +0200716 status = macb_mdio_read(macb, macb->phy_addr, MII_BMSR);
Stefan Roese7bf9bca2019-03-27 11:20:19 +0100717 if (status & BMSR_LSTATUS) {
718 /*
719 * Delay a bit after the link is established,
720 * so that the next xfer does not fail
721 */
722 mdelay(10);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100723 break;
Stefan Roese7bf9bca2019-03-27 11:20:19 +0100724 }
Haavard Skinnemoenf2134f82007-05-02 13:31:53 +0200725 udelay(100);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100726 }
727 }
728
729 if (!(status & BMSR_LSTATUS)) {
730 printf("%s: link down (status: 0x%04x)\n",
Simon Glassd5555b72016-05-05 07:28:09 -0600731 name, status);
Wilson Lee4bf56912017-08-22 20:25:07 -0700732 return -ENETDOWN;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100733 }
Bo Shend256be22013-04-24 15:59:28 +0800734
Gregory CLEMENT75b03cf2015-12-16 14:50:34 +0100735 /* First check for GMAC and that it is GiB capable */
736 if (gem_is_gigabit_capable(macb)) {
Josef Holzmayr0d3044c2019-10-02 21:22:51 +0200737 lpa = macb_mdio_read(macb, macb->phy_addr, MII_STAT1000);
Bo Shend256be22013-04-24 15:59:28 +0800738
Radu Pirea0dc97fc2019-06-07 14:18:36 +0300739 if (lpa & (LPA_1000FULL | LPA_1000HALF | LPA_1000XFULL |
740 LPA_1000XHALF)) {
741 duplex = ((lpa & (LPA_1000FULL | LPA_1000XFULL)) ?
742 1 : 0);
Andreas Bießmann47609572014-09-18 23:46:48 +0200743
744 printf("%s: link up, 1000Mbps %s-duplex (lpa: 0x%04x)\n",
Simon Glassd5555b72016-05-05 07:28:09 -0600745 name,
Bo Shend256be22013-04-24 15:59:28 +0800746 duplex ? "full" : "half",
747 lpa);
748
749 ncfgr = macb_readl(macb, NCFGR);
Andreas Bießmann47609572014-09-18 23:46:48 +0200750 ncfgr &= ~(MACB_BIT(SPD) | MACB_BIT(FD));
751 ncfgr |= GEM_BIT(GBE);
752
Bo Shend256be22013-04-24 15:59:28 +0800753 if (duplex)
754 ncfgr |= MACB_BIT(FD);
Andreas Bießmann47609572014-09-18 23:46:48 +0200755
Bo Shend256be22013-04-24 15:59:28 +0800756 macb_writel(macb, NCFGR, ncfgr);
757
Bin Menga5e3d232019-05-22 00:09:45 -0700758#ifdef CONFIG_DM_ETH
759 ret = macb_linkspd_cb(dev, _1000BASET);
760#else
Wilson Lee4bf56912017-08-22 20:25:07 -0700761 ret = macb_linkspd_cb(macb->regs, _1000BASET);
Bin Menga5e3d232019-05-22 00:09:45 -0700762#endif
Wilson Lee4bf56912017-08-22 20:25:07 -0700763 if (ret)
764 return ret;
765
766 return 0;
Bo Shend256be22013-04-24 15:59:28 +0800767 }
768 }
769
770 /* fall back for EMAC checking */
Josef Holzmayr0d3044c2019-10-02 21:22:51 +0200771 adv = macb_mdio_read(macb, macb->phy_addr, MII_ADVERTISE);
772 lpa = macb_mdio_read(macb, macb->phy_addr, MII_LPA);
Bo Shend256be22013-04-24 15:59:28 +0800773 media = mii_nway_result(lpa & adv);
774 speed = (media & (ADVERTISE_100FULL | ADVERTISE_100HALF)
775 ? 1 : 0);
776 duplex = (media & ADVERTISE_FULL) ? 1 : 0;
777 printf("%s: link up, %sMbps %s-duplex (lpa: 0x%04x)\n",
Simon Glassd5555b72016-05-05 07:28:09 -0600778 name,
Bo Shend256be22013-04-24 15:59:28 +0800779 speed ? "100" : "10",
780 duplex ? "full" : "half",
781 lpa);
782
783 ncfgr = macb_readl(macb, NCFGR);
Bo Shenc83cb5f2015-03-04 13:35:16 +0800784 ncfgr &= ~(MACB_BIT(SPD) | MACB_BIT(FD) | GEM_BIT(GBE));
Wilson Lee4bf56912017-08-22 20:25:07 -0700785 if (speed) {
Bo Shend256be22013-04-24 15:59:28 +0800786 ncfgr |= MACB_BIT(SPD);
Bin Menga5e3d232019-05-22 00:09:45 -0700787#ifdef CONFIG_DM_ETH
788 ret = macb_linkspd_cb(dev, _100BASET);
789#else
Wilson Lee4bf56912017-08-22 20:25:07 -0700790 ret = macb_linkspd_cb(macb->regs, _100BASET);
Bin Menga5e3d232019-05-22 00:09:45 -0700791#endif
Wilson Lee4bf56912017-08-22 20:25:07 -0700792 } else {
Bin Menga5e3d232019-05-22 00:09:45 -0700793#ifdef CONFIG_DM_ETH
794 ret = macb_linkspd_cb(dev, _10BASET);
795#else
Wilson Lee4bf56912017-08-22 20:25:07 -0700796 ret = macb_linkspd_cb(macb->regs, _10BASET);
Bin Menga5e3d232019-05-22 00:09:45 -0700797#endif
Wilson Lee4bf56912017-08-22 20:25:07 -0700798 }
799
800 if (ret)
801 return ret;
802
Bo Shend256be22013-04-24 15:59:28 +0800803 if (duplex)
804 ncfgr |= MACB_BIT(FD);
805 macb_writel(macb, NCFGR, ncfgr);
806
Wilson Lee4bf56912017-08-22 20:25:07 -0700807 return 0;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100808}
809
Wu, Joshade4ea42015-06-03 16:45:44 +0800810static int gmac_init_multi_queues(struct macb_device *macb)
811{
812 int i, num_queues = 1;
813 u32 queue_mask;
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530814 unsigned long paddr;
Wu, Joshade4ea42015-06-03 16:45:44 +0800815
816 /* bit 0 is never set but queue 0 always exists */
817 queue_mask = gem_readl(macb, DCFG6) & 0xff;
818 queue_mask |= 0x1;
819
820 for (i = 1; i < MACB_MAX_QUEUES; i++)
821 if (queue_mask & (1 << i))
822 num_queues++;
823
Ramon Fried0a2827e2019-07-16 22:04:33 +0300824 macb->dummy_desc->ctrl = MACB_BIT(TX_USED);
Wu, Joshade4ea42015-06-03 16:45:44 +0800825 macb->dummy_desc->addr = 0;
826 flush_dcache_range(macb->dummy_desc_dma, macb->dummy_desc_dma +
Heiko Schocher592a7492016-08-29 07:46:11 +0200827 ALIGN(MACB_TX_DUMMY_DMA_DESC_SIZE, PKTALIGN));
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530828 paddr = macb->dummy_desc_dma;
Wu, Joshade4ea42015-06-03 16:45:44 +0800829
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530830 for (i = 1; i < num_queues; i++) {
831 gem_writel_queue_TBQP(macb, lower_32_bits(paddr), i - 1);
832 gem_writel_queue_RBQP(macb, lower_32_bits(paddr), i - 1);
833 if (macb->config->hw_dma_cap & HW_DMA_CAP_64B) {
834 gem_writel_queue_TBQPH(macb, upper_32_bits(paddr),
835 i - 1);
836 gem_writel_queue_RBQPH(macb, upper_32_bits(paddr),
837 i - 1);
838 }
839 }
Wu, Joshade4ea42015-06-03 16:45:44 +0800840 return 0;
841}
842
Ramon Fried9c295802019-07-16 22:04:36 +0300843static void gmac_configure_dma(struct macb_device *macb)
844{
845 u32 buffer_size;
846 u32 dmacfg;
847
Ramon Friedc6d07bf2019-07-14 18:25:14 +0300848 buffer_size = macb->rx_buffer_size / RX_BUFFER_MULTIPLE;
Ramon Fried9c295802019-07-16 22:04:36 +0300849 dmacfg = gem_readl(macb, DMACFG) & ~GEM_BF(RXBS, -1L);
850 dmacfg |= GEM_BF(RXBS, buffer_size);
851
Anup Pateld0a04db2019-07-24 04:09:32 +0000852 if (macb->config->dma_burst_length)
853 dmacfg = GEM_BFINS(FBLDO,
854 macb->config->dma_burst_length, dmacfg);
Ramon Fried9c295802019-07-16 22:04:36 +0300855
856 dmacfg |= GEM_BIT(TXPBMS) | GEM_BF(RXBMS, -1L);
857 dmacfg &= ~GEM_BIT(ENDIA_PKT);
858
Anup Pateleff0e0c2019-07-24 04:09:37 +0000859 if (macb->is_big_endian)
Ramon Fried9c295802019-07-16 22:04:36 +0300860 dmacfg |= GEM_BIT(ENDIA_DESC); /* CPU in big endian */
Anup Pateleff0e0c2019-07-24 04:09:37 +0000861 else
862 dmacfg &= ~GEM_BIT(ENDIA_DESC);
Ramon Fried9c295802019-07-16 22:04:36 +0300863
864 dmacfg &= ~GEM_BIT(ADDR64);
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530865 if (macb->config->hw_dma_cap & HW_DMA_CAP_64B)
866 dmacfg |= GEM_BIT(ADDR64);
867
Ramon Fried9c295802019-07-16 22:04:36 +0300868 gem_writel(macb, DMACFG, dmacfg);
869}
870
Wenyou Yanga212b662016-05-17 13:11:35 +0800871#ifdef CONFIG_DM_ETH
872static int _macb_init(struct udevice *dev, const char *name)
873#else
Simon Glassd5555b72016-05-05 07:28:09 -0600874static int _macb_init(struct macb_device *macb, const char *name)
Wenyou Yanga212b662016-05-17 13:11:35 +0800875#endif
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100876{
Wenyou Yanga212b662016-05-17 13:11:35 +0800877#ifdef CONFIG_DM_ETH
878 struct macb_device *macb = dev_get_priv(dev);
Claudiu Bezneabb890f72021-01-19 13:26:44 +0200879 unsigned int val = 0;
Wenyou Yanga212b662016-05-17 13:11:35 +0800880#endif
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100881 unsigned long paddr;
Wilson Lee4bf56912017-08-22 20:25:07 -0700882 int ret;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100883 int i;
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530884 int count;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100885
886 /*
887 * macb_halt should have been called at some point before now,
888 * so we'll assume the controller is idle.
889 */
890
891 /* initialize DMA descriptors */
892 paddr = macb->rx_buffer_dma;
Andreas Bießmannceef9832014-05-26 22:55:18 +0200893 for (i = 0; i < MACB_RX_RING_SIZE; i++) {
894 if (i == (MACB_RX_RING_SIZE - 1))
Ramon Fried0a2827e2019-07-16 22:04:33 +0300895 paddr |= MACB_BIT(RX_WRAP);
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530896 if (macb->config->hw_dma_cap & HW_DMA_CAP_64B)
897 count = i * 2;
898 else
899 count = i;
900 macb->rx_ring[count].ctrl = 0;
901 macb_set_addr(macb, &macb->rx_ring[count], paddr);
Ramon Friedc6d07bf2019-07-14 18:25:14 +0300902 paddr += macb->rx_buffer_size;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100903 }
Wu, Josh5ae0e382014-05-27 16:31:05 +0800904 macb_flush_ring_desc(macb, RX);
905 macb_flush_rx_buffer(macb);
906
Andreas Bießmannceef9832014-05-26 22:55:18 +0200907 for (i = 0; i < MACB_TX_RING_SIZE; i++) {
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530908 if (macb->config->hw_dma_cap & HW_DMA_CAP_64B)
909 count = i * 2;
910 else
911 count = i;
912 macb_set_addr(macb, &macb->tx_ring[count], 0);
Andreas Bießmannceef9832014-05-26 22:55:18 +0200913 if (i == (MACB_TX_RING_SIZE - 1))
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530914 macb->tx_ring[count].ctrl = MACB_BIT(TX_USED) |
Ramon Fried0a2827e2019-07-16 22:04:33 +0300915 MACB_BIT(TX_WRAP);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100916 else
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530917 macb->tx_ring[count].ctrl = MACB_BIT(TX_USED);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100918 }
Wu, Josh5ae0e382014-05-27 16:31:05 +0800919 macb_flush_ring_desc(macb, TX);
920
Andreas Bießmannceef9832014-05-26 22:55:18 +0200921 macb->rx_tail = 0;
922 macb->tx_head = 0;
923 macb->tx_tail = 0;
Simon Glassd5555b72016-05-05 07:28:09 -0600924 macb->next_rx_tail = 0;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100925
Wilson Lee4bf56912017-08-22 20:25:07 -0700926#ifdef CONFIG_MACB_ZYNQ
Michal Simek7f6b0f32020-03-26 15:01:29 +0100927 gem_writel(macb, DMACFG, MACB_ZYNQ_GEM_DMACR_INIT);
Wilson Lee4bf56912017-08-22 20:25:07 -0700928#endif
929
Padmarao Begari6f0b2372021-01-15 08:20:36 +0530930 macb_writel(macb, RBQP, lower_32_bits(macb->rx_ring_dma));
931 macb_writel(macb, TBQP, lower_32_bits(macb->tx_ring_dma));
932 if (macb->config->hw_dma_cap & HW_DMA_CAP_64B) {
933 macb_writel(macb, RBQPH, upper_32_bits(macb->rx_ring_dma));
934 macb_writel(macb, TBQPH, upper_32_bits(macb->tx_ring_dma));
935 }
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100936
Bo Shend256be22013-04-24 15:59:28 +0800937 if (macb_is_gem(macb)) {
Ramon Fried9c295802019-07-16 22:04:36 +0300938 /* Initialize DMA properties */
939 gmac_configure_dma(macb);
Wu, Joshade4ea42015-06-03 16:45:44 +0800940 /* Check the multi queue and initialize the queue for tx */
941 gmac_init_multi_queues(macb);
942
Bo Shencabf61c2014-11-10 15:24:01 +0800943 /*
944 * When the GMAC IP with GE feature, this bit is used to
945 * select interface between RGMII and GMII.
946 * When the GMAC IP without GE feature, this bit is used
947 * to select interface between RMII and MII.
948 */
Wenyou Yanga212b662016-05-17 13:11:35 +0800949#ifdef CONFIG_DM_ETH
Claudiu Beznea1ae8f0a2021-01-19 13:26:48 +0200950 if (macb->phy_interface == PHY_INTERFACE_MODE_RGMII ||
951 macb->phy_interface == PHY_INTERFACE_MODE_RGMII_ID ||
952 macb->phy_interface == PHY_INTERFACE_MODE_RGMII_RXID ||
953 macb->phy_interface == PHY_INTERFACE_MODE_RGMII_TXID)
Claudiu Bezneabb890f72021-01-19 13:26:44 +0200954 val = macb->config->usrio->rgmii;
955 else if (macb->phy_interface == PHY_INTERFACE_MODE_RMII)
956 val = macb->config->usrio->rmii;
957 else if (macb->phy_interface == PHY_INTERFACE_MODE_MII)
958 val = macb->config->usrio->mii;
959
960 if (macb->config->caps & MACB_CAPS_USRIO_HAS_CLKEN)
961 val |= macb->config->usrio->clken;
962
963 gem_writel(macb, USRIO, val);
Ramon Fried5a1899f2019-07-16 22:04:34 +0300964
965 if (macb->phy_interface == PHY_INTERFACE_MODE_SGMII) {
966 unsigned int ncfgr = macb_readl(macb, NCFGR);
967
968 ncfgr |= GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL);
969 macb_writel(macb, NCFGR, ncfgr);
970 }
Wenyou Yanga212b662016-05-17 13:11:35 +0800971#else
Bo Shencabf61c2014-11-10 15:24:01 +0800972#if defined(CONFIG_RGMII) || defined(CONFIG_RMII)
Claudiu Bezneabb890f72021-01-19 13:26:44 +0200973 gem_writel(macb, USRIO, macb->config->usrio->rgmii);
Bo Shend256be22013-04-24 15:59:28 +0800974#else
Ramon Fried6c636512019-07-16 22:03:00 +0300975 gem_writel(macb, USRIO, 0);
Bo Shend256be22013-04-24 15:59:28 +0800976#endif
Wenyou Yanga212b662016-05-17 13:11:35 +0800977#endif
Bo Shend256be22013-04-24 15:59:28 +0800978 } else {
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100979 /* choose RMII or MII mode. This depends on the board */
Wenyou Yanga212b662016-05-17 13:11:35 +0800980#ifdef CONFIG_DM_ETH
981#ifdef CONFIG_AT91FAMILY
982 if (macb->phy_interface == PHY_INTERFACE_MODE_RMII) {
983 macb_writel(macb, USRIO,
Claudiu Bezneabb890f72021-01-19 13:26:44 +0200984 macb->config->usrio->rmii |
985 macb->config->usrio->clken);
Wenyou Yanga212b662016-05-17 13:11:35 +0800986 } else {
Claudiu Bezneabb890f72021-01-19 13:26:44 +0200987 macb_writel(macb, USRIO, macb->config->usrio->clken);
Wenyou Yanga212b662016-05-17 13:11:35 +0800988 }
989#else
990 if (macb->phy_interface == PHY_INTERFACE_MODE_RMII)
991 macb_writel(macb, USRIO, 0);
992 else
Claudiu Bezneabb890f72021-01-19 13:26:44 +0200993 macb_writel(macb, USRIO, macb->config->usrio->mii);
Wenyou Yanga212b662016-05-17 13:11:35 +0800994#endif
995#else
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +0100996#ifdef CONFIG_RMII
Bo Shend8f64b42013-04-24 15:59:26 +0800997#ifdef CONFIG_AT91FAMILY
Claudiu Bezneabb890f72021-01-19 13:26:44 +0200998 macb_writel(macb, USRIO, macb->config->usrio->rmii |
999 macb->config->usrio->clken);
Stelian Pop7263ef12008-01-03 21:15:56 +00001000#else
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001001 macb_writel(macb, USRIO, 0);
Stelian Pop7263ef12008-01-03 21:15:56 +00001002#endif
1003#else
Bo Shend8f64b42013-04-24 15:59:26 +08001004#ifdef CONFIG_AT91FAMILY
Claudiu Bezneabb890f72021-01-19 13:26:44 +02001005 macb_writel(macb, USRIO, macb->config->usrio->clken);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001006#else
Claudiu Bezneabb890f72021-01-19 13:26:44 +02001007 macb_writel(macb, USRIO, macb->config->usrio->mii);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001008#endif
Stelian Pop7263ef12008-01-03 21:15:56 +00001009#endif /* CONFIG_RMII */
Wenyou Yanga212b662016-05-17 13:11:35 +08001010#endif
Bo Shend256be22013-04-24 15:59:28 +08001011 }
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001012
Wenyou Yanga212b662016-05-17 13:11:35 +08001013#ifdef CONFIG_DM_ETH
Wilson Lee4bf56912017-08-22 20:25:07 -07001014 ret = macb_phy_init(dev, name);
Wenyou Yanga212b662016-05-17 13:11:35 +08001015#else
Wilson Lee4bf56912017-08-22 20:25:07 -07001016 ret = macb_phy_init(macb, name);
Wenyou Yanga212b662016-05-17 13:11:35 +08001017#endif
Wilson Lee4bf56912017-08-22 20:25:07 -07001018 if (ret)
1019 return ret;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001020
1021 /* Enable TX and RX */
1022 macb_writel(macb, NCR, MACB_BIT(TE) | MACB_BIT(RE));
1023
Ben Warren422b1a02008-01-09 18:15:53 -05001024 return 0;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001025}
1026
Simon Glassd5555b72016-05-05 07:28:09 -06001027static void _macb_halt(struct macb_device *macb)
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001028{
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001029 u32 ncr, tsr;
1030
1031 /* Halt the controller and wait for any ongoing transmission to end. */
1032 ncr = macb_readl(macb, NCR);
1033 ncr |= MACB_BIT(THALT);
1034 macb_writel(macb, NCR, ncr);
1035
1036 do {
1037 tsr = macb_readl(macb, TSR);
1038 } while (tsr & MACB_BIT(TGO));
1039
1040 /* Disable TX and RX, and clear statistics */
1041 macb_writel(macb, NCR, MACB_BIT(CLRSTAT));
1042}
1043
Simon Glassd5555b72016-05-05 07:28:09 -06001044static int _macb_write_hwaddr(struct macb_device *macb, unsigned char *enetaddr)
Ben Warren6bb46792010-06-01 11:55:42 -07001045{
Ben Warren6bb46792010-06-01 11:55:42 -07001046 u32 hwaddr_bottom;
1047 u16 hwaddr_top;
1048
1049 /* set hardware address */
Simon Glassd5555b72016-05-05 07:28:09 -06001050 hwaddr_bottom = enetaddr[0] | enetaddr[1] << 8 |
1051 enetaddr[2] << 16 | enetaddr[3] << 24;
Ben Warren6bb46792010-06-01 11:55:42 -07001052 macb_writel(macb, SA1B, hwaddr_bottom);
Simon Glassd5555b72016-05-05 07:28:09 -06001053 hwaddr_top = enetaddr[4] | enetaddr[5] << 8;
Ben Warren6bb46792010-06-01 11:55:42 -07001054 macb_writel(macb, SA1T, hwaddr_top);
1055 return 0;
1056}
1057
Bo Shend256be22013-04-24 15:59:28 +08001058static u32 macb_mdc_clk_div(int id, struct macb_device *macb)
1059{
1060 u32 config;
Wenyou Yang3fd2b3a2017-02-14 16:24:40 +08001061#if defined(CONFIG_DM_ETH) && defined(CONFIG_CLK)
Wenyou Yang577aa3b2016-11-02 10:06:56 +08001062 unsigned long macb_hz = macb->pclk_rate;
1063#else
Bo Shend256be22013-04-24 15:59:28 +08001064 unsigned long macb_hz = get_macb_pclk_rate(id);
Wenyou Yang577aa3b2016-11-02 10:06:56 +08001065#endif
Bo Shend256be22013-04-24 15:59:28 +08001066
1067 if (macb_hz < 20000000)
1068 config = MACB_BF(CLK, MACB_CLK_DIV8);
1069 else if (macb_hz < 40000000)
1070 config = MACB_BF(CLK, MACB_CLK_DIV16);
1071 else if (macb_hz < 80000000)
1072 config = MACB_BF(CLK, MACB_CLK_DIV32);
1073 else
1074 config = MACB_BF(CLK, MACB_CLK_DIV64);
1075
1076 return config;
1077}
1078
1079static u32 gem_mdc_clk_div(int id, struct macb_device *macb)
1080{
1081 u32 config;
Wenyou Yang577aa3b2016-11-02 10:06:56 +08001082
Wenyou Yang3fd2b3a2017-02-14 16:24:40 +08001083#if defined(CONFIG_DM_ETH) && defined(CONFIG_CLK)
Wenyou Yang577aa3b2016-11-02 10:06:56 +08001084 unsigned long macb_hz = macb->pclk_rate;
1085#else
Bo Shend256be22013-04-24 15:59:28 +08001086 unsigned long macb_hz = get_macb_pclk_rate(id);
Wenyou Yang577aa3b2016-11-02 10:06:56 +08001087#endif
Bo Shend256be22013-04-24 15:59:28 +08001088
1089 if (macb_hz < 20000000)
1090 config = GEM_BF(CLK, GEM_CLK_DIV8);
1091 else if (macb_hz < 40000000)
1092 config = GEM_BF(CLK, GEM_CLK_DIV16);
1093 else if (macb_hz < 80000000)
1094 config = GEM_BF(CLK, GEM_CLK_DIV32);
1095 else if (macb_hz < 120000000)
1096 config = GEM_BF(CLK, GEM_CLK_DIV48);
1097 else if (macb_hz < 160000000)
1098 config = GEM_BF(CLK, GEM_CLK_DIV64);
Ramon Fried9e65f802019-07-16 22:04:32 +03001099 else if (macb_hz < 240000000)
Bo Shend256be22013-04-24 15:59:28 +08001100 config = GEM_BF(CLK, GEM_CLK_DIV96);
Ramon Fried9e65f802019-07-16 22:04:32 +03001101 else if (macb_hz < 320000000)
1102 config = GEM_BF(CLK, GEM_CLK_DIV128);
1103 else
1104 config = GEM_BF(CLK, GEM_CLK_DIV224);
Bo Shend256be22013-04-24 15:59:28 +08001105
1106 return config;
1107}
1108
Bo Shen32e4f6b2013-09-18 15:07:44 +08001109/*
1110 * Get the DMA bus width field of the network configuration register that we
1111 * should program. We find the width from decoding the design configuration
1112 * register to find the maximum supported data bus width.
1113 */
1114static u32 macb_dbw(struct macb_device *macb)
1115{
1116 switch (GEM_BFEXT(DBWDEF, gem_readl(macb, DCFG1))) {
1117 case 4:
1118 return GEM_BF(DBW, GEM_DBW128);
1119 case 2:
1120 return GEM_BF(DBW, GEM_DBW64);
1121 case 1:
1122 default:
1123 return GEM_BF(DBW, GEM_DBW32);
1124 }
1125}
1126
Simon Glassd5555b72016-05-05 07:28:09 -06001127static void _macb_eth_initialize(struct macb_device *macb)
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001128{
Simon Glassd5555b72016-05-05 07:28:09 -06001129 int id = 0; /* This is not used by functions we call */
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001130 u32 ncfgr;
1131
Ramon Friedc6d07bf2019-07-14 18:25:14 +03001132 if (macb_is_gem(macb))
1133 macb->rx_buffer_size = GEM_RX_BUFFER_SIZE;
1134 else
1135 macb->rx_buffer_size = MACB_RX_BUFFER_SIZE;
1136
Simon Glassd5555b72016-05-05 07:28:09 -06001137 /* TODO: we need check the rx/tx_ring_dma is dcache line aligned */
Ramon Friedc6d07bf2019-07-14 18:25:14 +03001138 macb->rx_buffer = dma_alloc_coherent(macb->rx_buffer_size *
1139 MACB_RX_RING_SIZE,
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001140 &macb->rx_buffer_dma);
Wu, Josh5ae0e382014-05-27 16:31:05 +08001141 macb->rx_ring = dma_alloc_coherent(MACB_RX_DMA_DESC_SIZE,
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001142 &macb->rx_ring_dma);
Wu, Josh5ae0e382014-05-27 16:31:05 +08001143 macb->tx_ring = dma_alloc_coherent(MACB_TX_DMA_DESC_SIZE,
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001144 &macb->tx_ring_dma);
Wu, Joshade4ea42015-06-03 16:45:44 +08001145 macb->dummy_desc = dma_alloc_coherent(MACB_TX_DUMMY_DMA_DESC_SIZE,
1146 &macb->dummy_desc_dma);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001147
Simon Glassd5555b72016-05-05 07:28:09 -06001148 /*
1149 * Do some basic initialization so that we at least can talk
1150 * to the PHY
1151 */
1152 if (macb_is_gem(macb)) {
1153 ncfgr = gem_mdc_clk_div(id, macb);
1154 ncfgr |= macb_dbw(macb);
1155 } else {
1156 ncfgr = macb_mdc_clk_div(id, macb);
1157 }
1158
1159 macb_writel(macb, NCFGR, ncfgr);
1160}
1161
Simon Glassf1dcc192016-05-05 07:28:11 -06001162#ifndef CONFIG_DM_ETH
Simon Glassd5555b72016-05-05 07:28:09 -06001163static int macb_send(struct eth_device *netdev, void *packet, int length)
1164{
1165 struct macb_device *macb = to_macb(netdev);
1166
1167 return _macb_send(macb, netdev->name, packet, length);
1168}
1169
1170static int macb_recv(struct eth_device *netdev)
1171{
1172 struct macb_device *macb = to_macb(netdev);
1173 uchar *packet;
1174 int length;
1175
1176 macb->wrapped = false;
1177 for (;;) {
1178 macb->next_rx_tail = macb->rx_tail;
1179 length = _macb_recv(macb, &packet);
1180 if (length >= 0) {
1181 net_process_received_packet(packet, length);
1182 reclaim_rx_buffers(macb, macb->next_rx_tail);
Heinrich Schuchardt6cdf0722018-03-18 11:32:53 +01001183 } else {
Simon Glassd5555b72016-05-05 07:28:09 -06001184 return length;
1185 }
1186 }
1187}
1188
Masahiro Yamadab75d8dc2020-06-26 15:13:33 +09001189static int macb_init(struct eth_device *netdev, struct bd_info *bd)
Simon Glassd5555b72016-05-05 07:28:09 -06001190{
1191 struct macb_device *macb = to_macb(netdev);
1192
1193 return _macb_init(macb, netdev->name);
1194}
1195
1196static void macb_halt(struct eth_device *netdev)
1197{
1198 struct macb_device *macb = to_macb(netdev);
1199
1200 return _macb_halt(macb);
1201}
1202
1203static int macb_write_hwaddr(struct eth_device *netdev)
1204{
1205 struct macb_device *macb = to_macb(netdev);
1206
1207 return _macb_write_hwaddr(macb, netdev->enetaddr);
1208}
1209
1210int macb_eth_initialize(int id, void *regs, unsigned int phy_addr)
1211{
1212 struct macb_device *macb;
1213 struct eth_device *netdev;
1214
1215 macb = malloc(sizeof(struct macb_device));
1216 if (!macb) {
1217 printf("Error: Failed to allocate memory for MACB%d\n", id);
1218 return -1;
1219 }
1220 memset(macb, 0, sizeof(struct macb_device));
1221
1222 netdev = &macb->netdev;
Wu, Josh5ae0e382014-05-27 16:31:05 +08001223
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001224 macb->regs = regs;
1225 macb->phy_addr = phy_addr;
1226
Bo Shend256be22013-04-24 15:59:28 +08001227 if (macb_is_gem(macb))
1228 sprintf(netdev->name, "gmac%d", id);
1229 else
1230 sprintf(netdev->name, "macb%d", id);
1231
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001232 netdev->init = macb_init;
1233 netdev->halt = macb_halt;
1234 netdev->send = macb_send;
1235 netdev->recv = macb_recv;
Ben Warren6bb46792010-06-01 11:55:42 -07001236 netdev->write_hwaddr = macb_write_hwaddr;
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001237
Simon Glassd5555b72016-05-05 07:28:09 -06001238 _macb_eth_initialize(macb);
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001239
1240 eth_register(netdev);
1241
Bo Shenb1a00062013-04-24 15:59:27 +08001242#if defined(CONFIG_CMD_MII) || defined(CONFIG_PHYLIB)
Joe Hershberger5a49f172016-08-08 11:28:38 -05001243 int retval;
1244 struct mii_dev *mdiodev = mdio_alloc();
1245 if (!mdiodev)
1246 return -ENOMEM;
1247 strncpy(mdiodev->name, netdev->name, MDIO_NAME_LEN);
1248 mdiodev->read = macb_miiphy_read;
1249 mdiodev->write = macb_miiphy_write;
1250
1251 retval = mdio_register(mdiodev);
1252 if (retval < 0)
1253 return retval;
Bo Shenb1a00062013-04-24 15:59:27 +08001254 macb->bus = miiphy_get_dev_by_name(netdev->name);
Semih Hazar0f751d62009-12-17 15:07:15 +02001255#endif
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001256 return 0;
1257}
Simon Glassf1dcc192016-05-05 07:28:11 -06001258#endif /* !CONFIG_DM_ETH */
1259
1260#ifdef CONFIG_DM_ETH
1261
1262static int macb_start(struct udevice *dev)
1263{
Wenyou Yanga212b662016-05-17 13:11:35 +08001264 return _macb_init(dev, dev->name);
Simon Glassf1dcc192016-05-05 07:28:11 -06001265}
1266
1267static int macb_send(struct udevice *dev, void *packet, int length)
1268{
1269 struct macb_device *macb = dev_get_priv(dev);
1270
1271 return _macb_send(macb, dev->name, packet, length);
1272}
1273
1274static int macb_recv(struct udevice *dev, int flags, uchar **packetp)
1275{
1276 struct macb_device *macb = dev_get_priv(dev);
1277
1278 macb->next_rx_tail = macb->rx_tail;
1279 macb->wrapped = false;
1280
1281 return _macb_recv(macb, packetp);
1282}
1283
1284static int macb_free_pkt(struct udevice *dev, uchar *packet, int length)
1285{
1286 struct macb_device *macb = dev_get_priv(dev);
1287
1288 reclaim_rx_buffers(macb, macb->next_rx_tail);
1289
1290 return 0;
1291}
1292
1293static void macb_stop(struct udevice *dev)
1294{
1295 struct macb_device *macb = dev_get_priv(dev);
1296
1297 _macb_halt(macb);
1298}
1299
1300static int macb_write_hwaddr(struct udevice *dev)
1301{
Simon Glassc69cda22020-12-03 16:55:20 -07001302 struct eth_pdata *plat = dev_get_plat(dev);
Simon Glassf1dcc192016-05-05 07:28:11 -06001303 struct macb_device *macb = dev_get_priv(dev);
1304
1305 return _macb_write_hwaddr(macb, plat->enetaddr);
1306}
1307
1308static const struct eth_ops macb_eth_ops = {
1309 .start = macb_start,
1310 .send = macb_send,
1311 .recv = macb_recv,
1312 .stop = macb_stop,
1313 .free_pkt = macb_free_pkt,
1314 .write_hwaddr = macb_write_hwaddr,
1315};
1316
Wenyou Yang3fd2b3a2017-02-14 16:24:40 +08001317#ifdef CONFIG_CLK
Wenyou Yang577aa3b2016-11-02 10:06:56 +08001318static int macb_enable_clk(struct udevice *dev)
1319{
1320 struct macb_device *macb = dev_get_priv(dev);
1321 struct clk clk;
1322 ulong clk_rate;
1323 int ret;
1324
1325 ret = clk_get_by_index(dev, 0, &clk);
1326 if (ret)
1327 return -EINVAL;
1328
Wilson Lee4bf56912017-08-22 20:25:07 -07001329 /*
Anup Patel2e242f52019-02-25 08:14:36 +00001330 * If clock driver didn't support enable or disable then
1331 * we get -ENOSYS from clk_enable(). To handle this, we
1332 * don't fail for ret == -ENOSYS.
Wilson Lee4bf56912017-08-22 20:25:07 -07001333 */
Wenyou Yang577aa3b2016-11-02 10:06:56 +08001334 ret = clk_enable(&clk);
Anup Patel2e242f52019-02-25 08:14:36 +00001335 if (ret && ret != -ENOSYS)
Wenyou Yang577aa3b2016-11-02 10:06:56 +08001336 return ret;
1337
1338 clk_rate = clk_get_rate(&clk);
1339 if (!clk_rate)
1340 return -EINVAL;
1341
1342 macb->pclk_rate = clk_rate;
1343
1344 return 0;
1345}
Wenyou Yang3fd2b3a2017-02-14 16:24:40 +08001346#endif
Wenyou Yang577aa3b2016-11-02 10:06:56 +08001347
Claudiu Bezneabb890f72021-01-19 13:26:44 +02001348static const struct macb_usrio_cfg macb_default_usrio = {
1349 .mii = MACB_BIT(MII),
1350 .rmii = MACB_BIT(RMII),
1351 .rgmii = GEM_BIT(RGMII),
1352 .clken = MACB_BIT(CLKEN),
1353};
1354
Ramon Frieded3c64f2019-07-16 22:04:35 +03001355static const struct macb_config default_gem_config = {
1356 .dma_burst_length = 16,
Padmarao Begari6f0b2372021-01-15 08:20:36 +05301357 .hw_dma_cap = HW_DMA_CAP_32B,
Anup Pateld0a04db2019-07-24 04:09:32 +00001358 .clk_init = NULL,
Claudiu Bezneabb890f72021-01-19 13:26:44 +02001359 .usrio = &macb_default_usrio,
Ramon Frieded3c64f2019-07-16 22:04:35 +03001360};
1361
Simon Glassf1dcc192016-05-05 07:28:11 -06001362static int macb_eth_probe(struct udevice *dev)
1363{
Simon Glassc69cda22020-12-03 16:55:20 -07001364 struct eth_pdata *pdata = dev_get_plat(dev);
Simon Glassf1dcc192016-05-05 07:28:11 -06001365 struct macb_device *macb = dev_get_priv(dev);
Padmarao Begari1b459382021-01-15 08:20:37 +05301366 struct ofnode_phandle_args phandle_args;
Wenyou Yanga212b662016-05-17 13:11:35 +08001367 const char *phy_mode;
Anup Pateld0a04db2019-07-24 04:09:32 +00001368 int ret;
Wenyou Yanga212b662016-05-17 13:11:35 +08001369
Padmarao Begari6f0b2372021-01-15 08:20:36 +05301370 phy_mode = dev_read_prop(dev, "phy-mode", NULL);
1371
Wenyou Yanga212b662016-05-17 13:11:35 +08001372 if (phy_mode)
1373 macb->phy_interface = phy_get_interface_by_name(phy_mode);
1374 if (macb->phy_interface == -1) {
1375 debug("%s: Invalid PHY interface '%s'\n", __func__, phy_mode);
1376 return -EINVAL;
1377 }
Wenyou Yanga212b662016-05-17 13:11:35 +08001378
Padmarao Begari1b459382021-01-15 08:20:37 +05301379 /* Read phyaddr from DT */
1380 if (!dev_read_phandle_with_args(dev, "phy-handle", NULL, 0, 0,
1381 &phandle_args))
1382 macb->phy_addr = ofnode_read_u32_default(phandle_args.node,
1383 "reg", -1);
1384
Simon Glassf1dcc192016-05-05 07:28:11 -06001385 macb->regs = (void *)pdata->iobase;
1386
Anup Pateleff0e0c2019-07-24 04:09:37 +00001387 macb->is_big_endian = (cpu_to_be32(0x12345678) == 0x12345678);
1388
Anup Pateld0a04db2019-07-24 04:09:32 +00001389 macb->config = (struct macb_config *)dev_get_driver_data(dev);
1390 if (!macb->config)
1391 macb->config = &default_gem_config;
Ramon Frieded3c64f2019-07-16 22:04:35 +03001392
Wenyou Yang3fd2b3a2017-02-14 16:24:40 +08001393#ifdef CONFIG_CLK
Wenyou Yang1870d4d2017-04-14 14:36:04 +08001394 ret = macb_enable_clk(dev);
Wenyou Yang577aa3b2016-11-02 10:06:56 +08001395 if (ret)
1396 return ret;
Wenyou Yang3fd2b3a2017-02-14 16:24:40 +08001397#endif
Wenyou Yang577aa3b2016-11-02 10:06:56 +08001398
Simon Glassf1dcc192016-05-05 07:28:11 -06001399 _macb_eth_initialize(macb);
Wenyou Yang577aa3b2016-11-02 10:06:56 +08001400
Simon Glassf1dcc192016-05-05 07:28:11 -06001401#if defined(CONFIG_CMD_MII) || defined(CONFIG_PHYLIB)
Wenyou Yang1870d4d2017-04-14 14:36:04 +08001402 macb->bus = mdio_alloc();
1403 if (!macb->bus)
Joe Hershberger5a49f172016-08-08 11:28:38 -05001404 return -ENOMEM;
Wenyou Yang1870d4d2017-04-14 14:36:04 +08001405 strncpy(macb->bus->name, dev->name, MDIO_NAME_LEN);
1406 macb->bus->read = macb_miiphy_read;
1407 macb->bus->write = macb_miiphy_write;
Joe Hershberger5a49f172016-08-08 11:28:38 -05001408
Wenyou Yang1870d4d2017-04-14 14:36:04 +08001409 ret = mdio_register(macb->bus);
1410 if (ret < 0)
1411 return ret;
Simon Glassf1dcc192016-05-05 07:28:11 -06001412 macb->bus = miiphy_get_dev_by_name(dev->name);
1413#endif
1414
1415 return 0;
1416}
1417
Wenyou Yang1870d4d2017-04-14 14:36:04 +08001418static int macb_eth_remove(struct udevice *dev)
1419{
1420 struct macb_device *macb = dev_get_priv(dev);
1421
1422#ifdef CONFIG_PHYLIB
1423 free(macb->phydev);
1424#endif
1425 mdio_unregister(macb->bus);
1426 mdio_free(macb->bus);
1427
1428 return 0;
1429}
1430
Wilson Lee4bf56912017-08-22 20:25:07 -07001431/**
Simon Glassd1998a92020-12-03 16:55:21 -07001432 * macb_late_eth_of_to_plat
Wilson Lee4bf56912017-08-22 20:25:07 -07001433 * @dev: udevice struct
1434 * Returns 0 when operation success and negative errno number
1435 * when operation failed.
1436 */
Simon Glassd1998a92020-12-03 16:55:21 -07001437int __weak macb_late_eth_of_to_plat(struct udevice *dev)
Wilson Lee4bf56912017-08-22 20:25:07 -07001438{
1439 return 0;
1440}
1441
Simon Glassd1998a92020-12-03 16:55:21 -07001442static int macb_eth_of_to_plat(struct udevice *dev)
Simon Glassf1dcc192016-05-05 07:28:11 -06001443{
Simon Glassc69cda22020-12-03 16:55:20 -07001444 struct eth_pdata *pdata = dev_get_plat(dev);
Simon Glassf1dcc192016-05-05 07:28:11 -06001445
Ramon Fried9043c4e2018-12-27 19:58:42 +02001446 pdata->iobase = (phys_addr_t)dev_remap_addr(dev);
1447 if (!pdata->iobase)
1448 return -EINVAL;
Wilson Lee4bf56912017-08-22 20:25:07 -07001449
Simon Glassd1998a92020-12-03 16:55:21 -07001450 return macb_late_eth_of_to_plat(dev);
Simon Glassf1dcc192016-05-05 07:28:11 -06001451}
1452
Claudiu Beznea8c0483e2021-01-19 13:26:46 +02001453static const struct macb_usrio_cfg sama7g5_usrio = {
1454 .mii = 0,
1455 .rmii = 1,
1456 .rgmii = 2,
1457 .clken = BIT(2),
1458};
1459
Padmarao Begari6f0b2372021-01-15 08:20:36 +05301460static const struct macb_config microchip_config = {
1461 .dma_burst_length = 16,
1462 .hw_dma_cap = HW_DMA_CAP_64B,
1463 .clk_init = NULL,
Claudiu Bezneabb890f72021-01-19 13:26:44 +02001464 .usrio = &macb_default_usrio,
Padmarao Begari6f0b2372021-01-15 08:20:36 +05301465};
1466
Ramon Frieded3c64f2019-07-16 22:04:35 +03001467static const struct macb_config sama5d4_config = {
1468 .dma_burst_length = 4,
Padmarao Begari6f0b2372021-01-15 08:20:36 +05301469 .hw_dma_cap = HW_DMA_CAP_32B,
Anup Pateld0a04db2019-07-24 04:09:32 +00001470 .clk_init = NULL,
Claudiu Bezneabb890f72021-01-19 13:26:44 +02001471 .usrio = &macb_default_usrio,
Anup Pateld0a04db2019-07-24 04:09:32 +00001472};
1473
1474static const struct macb_config sifive_config = {
1475 .dma_burst_length = 16,
Padmarao Begari6f0b2372021-01-15 08:20:36 +05301476 .hw_dma_cap = HW_DMA_CAP_32B,
Anup Pateld0a04db2019-07-24 04:09:32 +00001477 .clk_init = macb_sifive_clk_init,
Claudiu Bezneabb890f72021-01-19 13:26:44 +02001478 .usrio = &macb_default_usrio,
Ramon Frieded3c64f2019-07-16 22:04:35 +03001479};
1480
Claudiu Beznea8c0483e2021-01-19 13:26:46 +02001481static const struct macb_config sama7g5_gmac_config = {
1482 .dma_burst_length = 16,
1483 .hw_dma_cap = HW_DMA_CAP_32B,
1484 .clk_init = macb_sama7g5_clk_init,
1485 .usrio = &sama7g5_usrio,
1486};
1487
Claudiu Beznea3d3475c2021-01-19 13:26:47 +02001488static const struct macb_config sama7g5_emac_config = {
1489 .caps = MACB_CAPS_USRIO_HAS_CLKEN,
1490 .dma_burst_length = 16,
1491 .hw_dma_cap = HW_DMA_CAP_32B,
1492 .usrio = &sama7g5_usrio,
1493};
1494
Simon Glassf1dcc192016-05-05 07:28:11 -06001495static const struct udevice_id macb_eth_ids[] = {
1496 { .compatible = "cdns,macb" },
Wenyou Yang75460252017-04-14 14:36:05 +08001497 { .compatible = "cdns,at91sam9260-macb" },
Nicolas Ferre39fa4162019-09-27 13:08:32 +00001498 { .compatible = "cdns,sam9x60-macb" },
Claudiu Beznea8c0483e2021-01-19 13:26:46 +02001499 { .compatible = "cdns,sama7g5-gem",
1500 .data = (ulong)&sama7g5_gmac_config },
Claudiu Beznea3d3475c2021-01-19 13:26:47 +02001501 { .compatible = "cdns,sama7g5-emac",
1502 .data = (ulong)&sama7g5_emac_config },
Wenyou Yang75460252017-04-14 14:36:05 +08001503 { .compatible = "atmel,sama5d2-gem" },
1504 { .compatible = "atmel,sama5d3-gem" },
Ramon Frieded3c64f2019-07-16 22:04:35 +03001505 { .compatible = "atmel,sama5d4-gem", .data = (ulong)&sama5d4_config },
Wilson Lee4bf56912017-08-22 20:25:07 -07001506 { .compatible = "cdns,zynq-gem" },
Anup Pateld0a04db2019-07-24 04:09:32 +00001507 { .compatible = "sifive,fu540-c000-gem",
1508 .data = (ulong)&sifive_config },
Padmarao Begari6f0b2372021-01-15 08:20:36 +05301509 { .compatible = "microchip,mpfs-mss-gem",
1510 .data = (ulong)&microchip_config },
Simon Glassf1dcc192016-05-05 07:28:11 -06001511 { }
1512};
1513
1514U_BOOT_DRIVER(eth_macb) = {
1515 .name = "eth_macb",
1516 .id = UCLASS_ETH,
1517 .of_match = macb_eth_ids,
Simon Glassd1998a92020-12-03 16:55:21 -07001518 .of_to_plat = macb_eth_of_to_plat,
Simon Glassf1dcc192016-05-05 07:28:11 -06001519 .probe = macb_eth_probe,
Wenyou Yang1870d4d2017-04-14 14:36:04 +08001520 .remove = macb_eth_remove,
Simon Glassf1dcc192016-05-05 07:28:11 -06001521 .ops = &macb_eth_ops,
Simon Glass41575d82020-12-03 16:55:17 -07001522 .priv_auto = sizeof(struct macb_device),
Simon Glasscaa4daa2020-12-03 16:55:18 -07001523 .plat_auto = sizeof(struct eth_pdata),
Simon Glassf1dcc192016-05-05 07:28:11 -06001524};
1525#endif
Haavard Skinnemoen5c1fe1f2006-01-20 10:03:34 +01001526
Jon Loeliger07d38a12007-07-09 17:30:01 -05001527#endif