blob: dc7e6f1929fdde67c672f174511ab4533d402bd3 [file] [log] [blame]
Tom Rini10e47792018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0
Thomas Choud3c08572010-04-15 22:32:38 +08002/*
3 * Opencore 10/100 ethernet mac driver
4 *
5 * Copyright (C) 2007-2008 Avionic Design Development GmbH
6 * Copyright (C) 2008-2009 Avionic Design GmbH
7 * Thierry Reding <thierry.reding@avionic-design.de>
8 * Copyright (C) 2010 Thomas Chou <thomas@wytron.com.tw>
Max Filippovc91eb0c2016-08-05 18:26:17 +03009 * Copyright (C) 2016 Cadence Design Systems Inc.
Thomas Choud3c08572010-04-15 22:32:38 +080010 */
11
Simon Glass63334482019-11-14 12:57:39 -070012#include <cpu_func.h>
Simon Glass11c89f32017-05-17 17:18:03 -060013#include <dm.h>
Simon Glass0f2af882020-05-10 11:40:05 -060014#include <log.h>
Max Filippovc91eb0c2016-08-05 18:26:17 +030015#include <dm/platform_data/net_ethoc.h>
Max Filippovf9ffa422016-08-05 18:26:16 +030016#include <linux/io.h>
Thomas Choud3c08572010-04-15 22:32:38 +080017#include <malloc.h>
18#include <net.h>
19#include <miiphy.h>
Thomas Choud3c08572010-04-15 22:32:38 +080020#include <asm/cache.h>
Max Filippov848e08b2016-08-05 18:26:21 +030021#include <wait_bit.h>
Thomas Choud3c08572010-04-15 22:32:38 +080022
23/* register offsets */
24#define MODER 0x00
25#define INT_SOURCE 0x04
26#define INT_MASK 0x08
27#define IPGT 0x0c
28#define IPGR1 0x10
29#define IPGR2 0x14
30#define PACKETLEN 0x18
31#define COLLCONF 0x1c
32#define TX_BD_NUM 0x20
33#define CTRLMODER 0x24
34#define MIIMODER 0x28
35#define MIICOMMAND 0x2c
36#define MIIADDRESS 0x30
37#define MIITX_DATA 0x34
38#define MIIRX_DATA 0x38
39#define MIISTATUS 0x3c
40#define MAC_ADDR0 0x40
41#define MAC_ADDR1 0x44
42#define ETH_HASH0 0x48
43#define ETH_HASH1 0x4c
44#define ETH_TXCTRL 0x50
45
46/* mode register */
47#define MODER_RXEN (1 << 0) /* receive enable */
48#define MODER_TXEN (1 << 1) /* transmit enable */
49#define MODER_NOPRE (1 << 2) /* no preamble */
50#define MODER_BRO (1 << 3) /* broadcast address */
51#define MODER_IAM (1 << 4) /* individual address mode */
52#define MODER_PRO (1 << 5) /* promiscuous mode */
53#define MODER_IFG (1 << 6) /* interframe gap for incoming frames */
54#define MODER_LOOP (1 << 7) /* loopback */
55#define MODER_NBO (1 << 8) /* no back-off */
56#define MODER_EDE (1 << 9) /* excess defer enable */
57#define MODER_FULLD (1 << 10) /* full duplex */
58#define MODER_RESET (1 << 11) /* FIXME: reset (undocumented) */
59#define MODER_DCRC (1 << 12) /* delayed CRC enable */
60#define MODER_CRC (1 << 13) /* CRC enable */
61#define MODER_HUGE (1 << 14) /* huge packets enable */
62#define MODER_PAD (1 << 15) /* padding enabled */
63#define MODER_RSM (1 << 16) /* receive small packets */
64
65/* interrupt source and mask registers */
66#define INT_MASK_TXF (1 << 0) /* transmit frame */
67#define INT_MASK_TXE (1 << 1) /* transmit error */
68#define INT_MASK_RXF (1 << 2) /* receive frame */
69#define INT_MASK_RXE (1 << 3) /* receive error */
70#define INT_MASK_BUSY (1 << 4)
71#define INT_MASK_TXC (1 << 5) /* transmit control frame */
72#define INT_MASK_RXC (1 << 6) /* receive control frame */
73
74#define INT_MASK_TX (INT_MASK_TXF | INT_MASK_TXE)
75#define INT_MASK_RX (INT_MASK_RXF | INT_MASK_RXE)
76
77#define INT_MASK_ALL ( \
78 INT_MASK_TXF | INT_MASK_TXE | \
79 INT_MASK_RXF | INT_MASK_RXE | \
80 INT_MASK_TXC | INT_MASK_RXC | \
81 INT_MASK_BUSY \
82 )
83
84/* packet length register */
85#define PACKETLEN_MIN(min) (((min) & 0xffff) << 16)
86#define PACKETLEN_MAX(max) (((max) & 0xffff) << 0)
87#define PACKETLEN_MIN_MAX(min, max) (PACKETLEN_MIN(min) | \
88 PACKETLEN_MAX(max))
89
90/* transmit buffer number register */
91#define TX_BD_NUM_VAL(x) (((x) <= 0x80) ? (x) : 0x80)
92
93/* control module mode register */
94#define CTRLMODER_PASSALL (1 << 0) /* pass all receive frames */
95#define CTRLMODER_RXFLOW (1 << 1) /* receive control flow */
96#define CTRLMODER_TXFLOW (1 << 2) /* transmit control flow */
97
98/* MII mode register */
99#define MIIMODER_CLKDIV(x) ((x) & 0xfe) /* needs to be an even number */
100#define MIIMODER_NOPRE (1 << 8) /* no preamble */
101
102/* MII command register */
103#define MIICOMMAND_SCAN (1 << 0) /* scan status */
104#define MIICOMMAND_READ (1 << 1) /* read status */
105#define MIICOMMAND_WRITE (1 << 2) /* write control data */
106
107/* MII address register */
108#define MIIADDRESS_FIAD(x) (((x) & 0x1f) << 0)
109#define MIIADDRESS_RGAD(x) (((x) & 0x1f) << 8)
110#define MIIADDRESS_ADDR(phy, reg) (MIIADDRESS_FIAD(phy) | \
111 MIIADDRESS_RGAD(reg))
112
113/* MII transmit data register */
114#define MIITX_DATA_VAL(x) ((x) & 0xffff)
115
116/* MII receive data register */
117#define MIIRX_DATA_VAL(x) ((x) & 0xffff)
118
119/* MII status register */
120#define MIISTATUS_LINKFAIL (1 << 0)
121#define MIISTATUS_BUSY (1 << 1)
122#define MIISTATUS_INVALID (1 << 2)
123
124/* TX buffer descriptor */
125#define TX_BD_CS (1 << 0) /* carrier sense lost */
126#define TX_BD_DF (1 << 1) /* defer indication */
127#define TX_BD_LC (1 << 2) /* late collision */
128#define TX_BD_RL (1 << 3) /* retransmission limit */
129#define TX_BD_RETRY_MASK (0x00f0)
130#define TX_BD_RETRY(x) (((x) & 0x00f0) >> 4)
131#define TX_BD_UR (1 << 8) /* transmitter underrun */
132#define TX_BD_CRC (1 << 11) /* TX CRC enable */
133#define TX_BD_PAD (1 << 12) /* pad enable */
134#define TX_BD_WRAP (1 << 13)
135#define TX_BD_IRQ (1 << 14) /* interrupt request enable */
136#define TX_BD_READY (1 << 15) /* TX buffer ready */
137#define TX_BD_LEN(x) (((x) & 0xffff) << 16)
138#define TX_BD_LEN_MASK (0xffff << 16)
139
140#define TX_BD_STATS (TX_BD_CS | TX_BD_DF | TX_BD_LC | \
141 TX_BD_RL | TX_BD_RETRY_MASK | TX_BD_UR)
142
143/* RX buffer descriptor */
144#define RX_BD_LC (1 << 0) /* late collision */
145#define RX_BD_CRC (1 << 1) /* RX CRC error */
146#define RX_BD_SF (1 << 2) /* short frame */
147#define RX_BD_TL (1 << 3) /* too long */
148#define RX_BD_DN (1 << 4) /* dribble nibble */
149#define RX_BD_IS (1 << 5) /* invalid symbol */
150#define RX_BD_OR (1 << 6) /* receiver overrun */
151#define RX_BD_MISS (1 << 7)
152#define RX_BD_CF (1 << 8) /* control frame */
153#define RX_BD_WRAP (1 << 13)
154#define RX_BD_IRQ (1 << 14) /* interrupt request enable */
155#define RX_BD_EMPTY (1 << 15)
156#define RX_BD_LEN(x) (((x) & 0xffff) << 16)
157
158#define RX_BD_STATS (RX_BD_LC | RX_BD_CRC | RX_BD_SF | RX_BD_TL | \
159 RX_BD_DN | RX_BD_IS | RX_BD_OR | RX_BD_MISS)
160
161#define ETHOC_BUFSIZ 1536
162#define ETHOC_ZLEN 64
163#define ETHOC_BD_BASE 0x400
164#define ETHOC_TIMEOUT (HZ / 2)
165#define ETHOC_MII_TIMEOUT (1 + (HZ / 5))
Max Filippovf9ffa422016-08-05 18:26:16 +0300166#define ETHOC_IOSIZE 0x54
Thomas Choud3c08572010-04-15 22:32:38 +0800167
168/**
169 * struct ethoc - driver-private device structure
170 * @num_tx: number of send buffers
171 * @cur_tx: last send buffer written
172 * @dty_tx: last buffer actually sent
173 * @num_rx: number of receive buffers
174 * @cur_rx: current receive buffer
175 */
176struct ethoc {
177 u32 num_tx;
178 u32 cur_tx;
179 u32 dty_tx;
180 u32 num_rx;
181 u32 cur_rx;
Max Filippovf9ffa422016-08-05 18:26:16 +0300182 void __iomem *iobase;
Max Filippov19e7a9e2016-08-05 18:26:20 +0300183 void __iomem *packet;
184 phys_addr_t packet_phys;
Max Filippov848e08b2016-08-05 18:26:21 +0300185
186#ifdef CONFIG_PHYLIB
187 struct mii_dev *bus;
188 struct phy_device *phydev;
189#endif
Thomas Choud3c08572010-04-15 22:32:38 +0800190};
191
192/**
193 * struct ethoc_bd - buffer descriptor
194 * @stat: buffer statistics
195 * @addr: physical memory address
196 */
197struct ethoc_bd {
198 u32 stat;
199 u32 addr;
200};
201
Max Filippov848e08b2016-08-05 18:26:21 +0300202static inline u32 *ethoc_reg(struct ethoc *priv, size_t offset)
203{
204 return priv->iobase + offset;
205}
206
Max Filippovf9ffa422016-08-05 18:26:16 +0300207static inline u32 ethoc_read(struct ethoc *priv, size_t offset)
Thomas Choud3c08572010-04-15 22:32:38 +0800208{
Max Filippov848e08b2016-08-05 18:26:21 +0300209 return readl(ethoc_reg(priv, offset));
Thomas Choud3c08572010-04-15 22:32:38 +0800210}
211
Max Filippovf9ffa422016-08-05 18:26:16 +0300212static inline void ethoc_write(struct ethoc *priv, size_t offset, u32 data)
Thomas Choud3c08572010-04-15 22:32:38 +0800213{
Max Filippov848e08b2016-08-05 18:26:21 +0300214 writel(data, ethoc_reg(priv, offset));
Thomas Choud3c08572010-04-15 22:32:38 +0800215}
216
Max Filippovf9ffa422016-08-05 18:26:16 +0300217static inline void ethoc_read_bd(struct ethoc *priv, int index,
Thomas Choud3c08572010-04-15 22:32:38 +0800218 struct ethoc_bd *bd)
219{
Vasili Galkaaa0caa22014-08-26 13:46:17 +0300220 size_t offset = ETHOC_BD_BASE + (index * sizeof(struct ethoc_bd));
Max Filippovf9ffa422016-08-05 18:26:16 +0300221 bd->stat = ethoc_read(priv, offset + 0);
222 bd->addr = ethoc_read(priv, offset + 4);
Thomas Choud3c08572010-04-15 22:32:38 +0800223}
224
Max Filippovf9ffa422016-08-05 18:26:16 +0300225static inline void ethoc_write_bd(struct ethoc *priv, int index,
Thomas Choud3c08572010-04-15 22:32:38 +0800226 const struct ethoc_bd *bd)
227{
Vasili Galkaaa0caa22014-08-26 13:46:17 +0300228 size_t offset = ETHOC_BD_BASE + (index * sizeof(struct ethoc_bd));
Max Filippovf9ffa422016-08-05 18:26:16 +0300229 ethoc_write(priv, offset + 0, bd->stat);
230 ethoc_write(priv, offset + 4, bd->addr);
Thomas Choud3c08572010-04-15 22:32:38 +0800231}
232
Max Filippovc91eb0c2016-08-05 18:26:17 +0300233static int ethoc_write_hwaddr_common(struct ethoc *priv, u8 *mac)
Thomas Choud3c08572010-04-15 22:32:38 +0800234{
Max Filippovf9ffa422016-08-05 18:26:16 +0300235 ethoc_write(priv, MAC_ADDR0, (mac[2] << 24) | (mac[3] << 16) |
Thomas Choud3c08572010-04-15 22:32:38 +0800236 (mac[4] << 8) | (mac[5] << 0));
Max Filippovf9ffa422016-08-05 18:26:16 +0300237 ethoc_write(priv, MAC_ADDR1, (mac[0] << 8) | (mac[1] << 0));
Thomas Chou8d01f222010-04-27 20:20:27 +0800238 return 0;
Thomas Choud3c08572010-04-15 22:32:38 +0800239}
240
Max Filippovf9ffa422016-08-05 18:26:16 +0300241static inline void ethoc_ack_irq(struct ethoc *priv, u32 mask)
Thomas Choud3c08572010-04-15 22:32:38 +0800242{
Max Filippovf9ffa422016-08-05 18:26:16 +0300243 ethoc_write(priv, INT_SOURCE, mask);
Thomas Choud3c08572010-04-15 22:32:38 +0800244}
245
Max Filippovf9ffa422016-08-05 18:26:16 +0300246static inline void ethoc_enable_rx_and_tx(struct ethoc *priv)
Thomas Choud3c08572010-04-15 22:32:38 +0800247{
Max Filippovf9ffa422016-08-05 18:26:16 +0300248 u32 mode = ethoc_read(priv, MODER);
Thomas Choud3c08572010-04-15 22:32:38 +0800249 mode |= MODER_RXEN | MODER_TXEN;
Max Filippovf9ffa422016-08-05 18:26:16 +0300250 ethoc_write(priv, MODER, mode);
Thomas Choud3c08572010-04-15 22:32:38 +0800251}
252
Max Filippovf9ffa422016-08-05 18:26:16 +0300253static inline void ethoc_disable_rx_and_tx(struct ethoc *priv)
Thomas Choud3c08572010-04-15 22:32:38 +0800254{
Max Filippovf9ffa422016-08-05 18:26:16 +0300255 u32 mode = ethoc_read(priv, MODER);
Thomas Choud3c08572010-04-15 22:32:38 +0800256 mode &= ~(MODER_RXEN | MODER_TXEN);
Max Filippovf9ffa422016-08-05 18:26:16 +0300257 ethoc_write(priv, MODER, mode);
Thomas Choud3c08572010-04-15 22:32:38 +0800258}
259
Max Filippovf9ffa422016-08-05 18:26:16 +0300260static int ethoc_init_ring(struct ethoc *priv)
Thomas Choud3c08572010-04-15 22:32:38 +0800261{
Thomas Choud3c08572010-04-15 22:32:38 +0800262 struct ethoc_bd bd;
Max Filippov19e7a9e2016-08-05 18:26:20 +0300263 phys_addr_t addr = priv->packet_phys;
Thomas Choud3c08572010-04-15 22:32:38 +0800264 int i;
265
266 priv->cur_tx = 0;
267 priv->dty_tx = 0;
268 priv->cur_rx = 0;
269
270 /* setup transmission buffers */
271 bd.stat = TX_BD_IRQ | TX_BD_CRC;
Max Filippovd6338ff2016-08-05 18:26:19 +0300272 bd.addr = 0;
Thomas Choud3c08572010-04-15 22:32:38 +0800273
274 for (i = 0; i < priv->num_tx; i++) {
Max Filippov19e7a9e2016-08-05 18:26:20 +0300275 if (addr) {
276 bd.addr = addr;
277 addr += PKTSIZE_ALIGN;
278 }
Thomas Choud3c08572010-04-15 22:32:38 +0800279 if (i == priv->num_tx - 1)
280 bd.stat |= TX_BD_WRAP;
281
Max Filippovf9ffa422016-08-05 18:26:16 +0300282 ethoc_write_bd(priv, i, &bd);
Thomas Choud3c08572010-04-15 22:32:38 +0800283 }
284
285 bd.stat = RX_BD_EMPTY | RX_BD_IRQ;
286
287 for (i = 0; i < priv->num_rx; i++) {
Max Filippov19e7a9e2016-08-05 18:26:20 +0300288 if (addr) {
289 bd.addr = addr;
290 addr += PKTSIZE_ALIGN;
291 } else {
292 bd.addr = virt_to_phys(net_rx_packets[i]);
293 }
Thomas Choud3c08572010-04-15 22:32:38 +0800294 if (i == priv->num_rx - 1)
295 bd.stat |= RX_BD_WRAP;
296
Max Filippovd6338ff2016-08-05 18:26:19 +0300297 flush_dcache_range((ulong)net_rx_packets[i],
298 (ulong)net_rx_packets[i] + PKTSIZE_ALIGN);
Max Filippovf9ffa422016-08-05 18:26:16 +0300299 ethoc_write_bd(priv, priv->num_tx + i, &bd);
Thomas Choud3c08572010-04-15 22:32:38 +0800300 }
301
302 return 0;
303}
304
Max Filippovf9ffa422016-08-05 18:26:16 +0300305static int ethoc_reset(struct ethoc *priv)
Thomas Choud3c08572010-04-15 22:32:38 +0800306{
307 u32 mode;
308
309 /* TODO: reset controller? */
310
Max Filippovf9ffa422016-08-05 18:26:16 +0300311 ethoc_disable_rx_and_tx(priv);
Thomas Choud3c08572010-04-15 22:32:38 +0800312
313 /* TODO: setup registers */
314
315 /* enable FCS generation and automatic padding */
Max Filippovf9ffa422016-08-05 18:26:16 +0300316 mode = ethoc_read(priv, MODER);
Thomas Choud3c08572010-04-15 22:32:38 +0800317 mode |= MODER_CRC | MODER_PAD;
Max Filippovf9ffa422016-08-05 18:26:16 +0300318 ethoc_write(priv, MODER, mode);
Thomas Choud3c08572010-04-15 22:32:38 +0800319
320 /* set full-duplex mode */
Max Filippovf9ffa422016-08-05 18:26:16 +0300321 mode = ethoc_read(priv, MODER);
Thomas Choud3c08572010-04-15 22:32:38 +0800322 mode |= MODER_FULLD;
Max Filippovf9ffa422016-08-05 18:26:16 +0300323 ethoc_write(priv, MODER, mode);
324 ethoc_write(priv, IPGT, 0x15);
Thomas Choud3c08572010-04-15 22:32:38 +0800325
Max Filippovf9ffa422016-08-05 18:26:16 +0300326 ethoc_ack_irq(priv, INT_MASK_ALL);
327 ethoc_enable_rx_and_tx(priv);
Thomas Choud3c08572010-04-15 22:32:38 +0800328 return 0;
329}
330
Max Filippovc91eb0c2016-08-05 18:26:17 +0300331static int ethoc_init_common(struct ethoc *priv)
Thomas Choud3c08572010-04-15 22:32:38 +0800332{
Max Filippov848e08b2016-08-05 18:26:21 +0300333 int ret = 0;
334
Thomas Choud3c08572010-04-15 22:32:38 +0800335 priv->num_tx = 1;
336 priv->num_rx = PKTBUFSRX;
Max Filippovf9ffa422016-08-05 18:26:16 +0300337 ethoc_write(priv, TX_BD_NUM, priv->num_tx);
338 ethoc_init_ring(priv);
339 ethoc_reset(priv);
Thomas Choud3c08572010-04-15 22:32:38 +0800340
Max Filippov848e08b2016-08-05 18:26:21 +0300341#ifdef CONFIG_PHYLIB
342 ret = phy_startup(priv->phydev);
343 if (ret) {
344 printf("Could not initialize PHY %s\n",
345 priv->phydev->dev->name);
346 return ret;
347 }
348#endif
349 return ret;
Thomas Choud3c08572010-04-15 22:32:38 +0800350}
351
Max Filippov848e08b2016-08-05 18:26:21 +0300352static void ethoc_stop_common(struct ethoc *priv)
353{
354 ethoc_disable_rx_and_tx(priv);
355#ifdef CONFIG_PHYLIB
356 phy_shutdown(priv->phydev);
357#endif
358}
359
Thomas Choud3c08572010-04-15 22:32:38 +0800360static int ethoc_update_rx_stats(struct ethoc_bd *bd)
361{
362 int ret = 0;
363
364 if (bd->stat & RX_BD_TL) {
365 debug("ETHOC: " "RX: frame too long\n");
366 ret++;
367 }
368
369 if (bd->stat & RX_BD_SF) {
370 debug("ETHOC: " "RX: frame too short\n");
371 ret++;
372 }
373
374 if (bd->stat & RX_BD_DN)
375 debug("ETHOC: " "RX: dribble nibble\n");
376
377 if (bd->stat & RX_BD_CRC) {
378 debug("ETHOC: " "RX: wrong CRC\n");
379 ret++;
380 }
381
382 if (bd->stat & RX_BD_OR) {
383 debug("ETHOC: " "RX: overrun\n");
384 ret++;
385 }
386
387 if (bd->stat & RX_BD_LC) {
388 debug("ETHOC: " "RX: late collision\n");
389 ret++;
390 }
391
392 return ret;
393}
394
Max Filippovc91eb0c2016-08-05 18:26:17 +0300395static int ethoc_rx_common(struct ethoc *priv, uchar **packetp)
Thomas Choud3c08572010-04-15 22:32:38 +0800396{
Max Filippovc91eb0c2016-08-05 18:26:17 +0300397 struct ethoc_bd bd;
Max Filippovd6338ff2016-08-05 18:26:19 +0300398 u32 i = priv->cur_rx % priv->num_rx;
399 u32 entry = priv->num_tx + i;
Thomas Choud3c08572010-04-15 22:32:38 +0800400
Max Filippovc91eb0c2016-08-05 18:26:17 +0300401 ethoc_read_bd(priv, entry, &bd);
402 if (bd.stat & RX_BD_EMPTY)
403 return -EAGAIN;
Thomas Choud3c08572010-04-15 22:32:38 +0800404
Max Filippovc91eb0c2016-08-05 18:26:17 +0300405 debug("%s(): RX buffer %d, %x received\n",
406 __func__, priv->cur_rx, bd.stat);
407 if (ethoc_update_rx_stats(&bd) == 0) {
408 int size = bd.stat >> 16;
Thomas Choud3c08572010-04-15 22:32:38 +0800409
Max Filippovc91eb0c2016-08-05 18:26:17 +0300410 size -= 4; /* strip the CRC */
Max Filippov19e7a9e2016-08-05 18:26:20 +0300411 if (priv->packet)
412 *packetp = priv->packet + entry * PKTSIZE_ALIGN;
413 else
414 *packetp = net_rx_packets[i];
Max Filippovc91eb0c2016-08-05 18:26:17 +0300415 return size;
416 } else {
417 return 0;
418 }
419}
Thomas Choud3c08572010-04-15 22:32:38 +0800420
Max Filippovc91eb0c2016-08-05 18:26:17 +0300421static int ethoc_is_new_packet_received(struct ethoc *priv)
422{
423 u32 pending;
424
425 pending = ethoc_read(priv, INT_SOURCE);
426 ethoc_ack_irq(priv, pending);
427 if (pending & INT_MASK_BUSY)
428 debug("%s(): packet dropped\n", __func__);
429 if (pending & INT_MASK_RX) {
430 debug("%s(): rx irq\n", __func__);
431 return 1;
Thomas Choud3c08572010-04-15 22:32:38 +0800432 }
433
Max Filippovc91eb0c2016-08-05 18:26:17 +0300434 return 0;
Thomas Choud3c08572010-04-15 22:32:38 +0800435}
436
437static int ethoc_update_tx_stats(struct ethoc_bd *bd)
438{
439 if (bd->stat & TX_BD_LC)
440 debug("ETHOC: " "TX: late collision\n");
441
442 if (bd->stat & TX_BD_RL)
443 debug("ETHOC: " "TX: retransmit limit\n");
444
445 if (bd->stat & TX_BD_UR)
446 debug("ETHOC: " "TX: underrun\n");
447
448 if (bd->stat & TX_BD_CS)
449 debug("ETHOC: " "TX: carrier sense lost\n");
450
451 return 0;
452}
453
Max Filippovf9ffa422016-08-05 18:26:16 +0300454static void ethoc_tx(struct ethoc *priv)
Thomas Choud3c08572010-04-15 22:32:38 +0800455{
Thomas Choud3c08572010-04-15 22:32:38 +0800456 u32 entry = priv->dty_tx % priv->num_tx;
457 struct ethoc_bd bd;
458
Max Filippovf9ffa422016-08-05 18:26:16 +0300459 ethoc_read_bd(priv, entry, &bd);
Thomas Choud3c08572010-04-15 22:32:38 +0800460 if ((bd.stat & TX_BD_READY) == 0)
461 (void)ethoc_update_tx_stats(&bd);
462}
463
Max Filippovc91eb0c2016-08-05 18:26:17 +0300464static int ethoc_send_common(struct ethoc *priv, void *packet, int length)
Thomas Choud3c08572010-04-15 22:32:38 +0800465{
Thomas Choud3c08572010-04-15 22:32:38 +0800466 struct ethoc_bd bd;
467 u32 entry;
468 u32 pending;
469 int tmo;
470
471 entry = priv->cur_tx % priv->num_tx;
Max Filippovf9ffa422016-08-05 18:26:16 +0300472 ethoc_read_bd(priv, entry, &bd);
Thomas Choud3c08572010-04-15 22:32:38 +0800473 if (unlikely(length < ETHOC_ZLEN))
474 bd.stat |= TX_BD_PAD;
475 else
476 bd.stat &= ~TX_BD_PAD;
Thomas Choud3c08572010-04-15 22:32:38 +0800477
Max Filippov19e7a9e2016-08-05 18:26:20 +0300478 if (priv->packet) {
479 void *p = priv->packet + entry * PKTSIZE_ALIGN;
480
481 memcpy(p, packet, length);
482 packet = p;
483 } else {
484 bd.addr = virt_to_phys(packet);
485 }
Max Filippovd6338ff2016-08-05 18:26:19 +0300486 flush_dcache_range((ulong)packet, (ulong)packet + length);
Thomas Choud3c08572010-04-15 22:32:38 +0800487 bd.stat &= ~(TX_BD_STATS | TX_BD_LEN_MASK);
488 bd.stat |= TX_BD_LEN(length);
Max Filippovf9ffa422016-08-05 18:26:16 +0300489 ethoc_write_bd(priv, entry, &bd);
Thomas Choud3c08572010-04-15 22:32:38 +0800490
491 /* start transmit */
492 bd.stat |= TX_BD_READY;
Max Filippovf9ffa422016-08-05 18:26:16 +0300493 ethoc_write_bd(priv, entry, &bd);
Thomas Choud3c08572010-04-15 22:32:38 +0800494
495 /* wait for transfer to succeed */
496 tmo = get_timer(0) + 5 * CONFIG_SYS_HZ;
497 while (1) {
Max Filippovf9ffa422016-08-05 18:26:16 +0300498 pending = ethoc_read(priv, INT_SOURCE);
499 ethoc_ack_irq(priv, pending & ~INT_MASK_RX);
Thomas Choud3c08572010-04-15 22:32:38 +0800500 if (pending & INT_MASK_BUSY)
501 debug("%s(): packet dropped\n", __func__);
502
503 if (pending & INT_MASK_TX) {
Max Filippovf9ffa422016-08-05 18:26:16 +0300504 ethoc_tx(priv);
Thomas Choud3c08572010-04-15 22:32:38 +0800505 break;
506 }
507 if (get_timer(0) >= tmo) {
508 debug("%s(): timed out\n", __func__);
509 return -1;
510 }
511 }
512
513 debug("%s(): packet sent\n", __func__);
514 return 0;
515}
516
Max Filippovc91eb0c2016-08-05 18:26:17 +0300517static int ethoc_free_pkt_common(struct ethoc *priv)
518{
Max Filippovc91eb0c2016-08-05 18:26:17 +0300519 struct ethoc_bd bd;
Max Filippovd6338ff2016-08-05 18:26:19 +0300520 u32 i = priv->cur_rx % priv->num_rx;
521 u32 entry = priv->num_tx + i;
Max Filippov19e7a9e2016-08-05 18:26:20 +0300522 void *src;
Max Filippovc91eb0c2016-08-05 18:26:17 +0300523
Max Filippovc91eb0c2016-08-05 18:26:17 +0300524 ethoc_read_bd(priv, entry, &bd);
525
Max Filippov19e7a9e2016-08-05 18:26:20 +0300526 if (priv->packet)
527 src = priv->packet + entry * PKTSIZE_ALIGN;
528 else
529 src = net_rx_packets[i];
Max Filippovc91eb0c2016-08-05 18:26:17 +0300530 /* clear the buffer descriptor so it can be reused */
Max Filippov19e7a9e2016-08-05 18:26:20 +0300531 flush_dcache_range((ulong)src,
532 (ulong)src + PKTSIZE_ALIGN);
Max Filippovc91eb0c2016-08-05 18:26:17 +0300533 bd.stat &= ~RX_BD_STATS;
534 bd.stat |= RX_BD_EMPTY;
535 ethoc_write_bd(priv, entry, &bd);
536 priv->cur_rx++;
537
Max Filippov848e08b2016-08-05 18:26:21 +0300538 return 0;
539}
540
541#ifdef CONFIG_PHYLIB
542
543static int ethoc_mdio_read(struct mii_dev *bus, int addr, int devad, int reg)
544{
545 struct ethoc *priv = bus->priv;
546 int rc;
547
548 ethoc_write(priv, MIIADDRESS, MIIADDRESS_ADDR(addr, reg));
549 ethoc_write(priv, MIICOMMAND, MIICOMMAND_READ);
550
Álvaro Fernández Rojas918de032018-01-23 17:14:55 +0100551 rc = wait_for_bit_le32(ethoc_reg(priv, MIISTATUS),
552 MIISTATUS_BUSY, false, CONFIG_SYS_HZ, false);
Max Filippov848e08b2016-08-05 18:26:21 +0300553
554 if (rc == 0) {
555 u32 data = ethoc_read(priv, MIIRX_DATA);
556
557 /* reset MII command register */
558 ethoc_write(priv, MIICOMMAND, 0);
559 return data;
560 }
561 return rc;
562}
563
564static int ethoc_mdio_write(struct mii_dev *bus, int addr, int devad, int reg,
565 u16 val)
566{
567 struct ethoc *priv = bus->priv;
568 int rc;
569
570 ethoc_write(priv, MIIADDRESS, MIIADDRESS_ADDR(addr, reg));
571 ethoc_write(priv, MIITX_DATA, val);
572 ethoc_write(priv, MIICOMMAND, MIICOMMAND_WRITE);
573
Álvaro Fernández Rojas918de032018-01-23 17:14:55 +0100574 rc = wait_for_bit_le32(ethoc_reg(priv, MIISTATUS),
575 MIISTATUS_BUSY, false, CONFIG_SYS_HZ, false);
Max Filippov848e08b2016-08-05 18:26:21 +0300576
577 if (rc == 0) {
578 /* reset MII command register */
579 ethoc_write(priv, MIICOMMAND, 0);
580 }
581 return rc;
582}
583
584static int ethoc_mdio_init(const char *name, struct ethoc *priv)
585{
586 struct mii_dev *bus = mdio_alloc();
587 int ret;
588
589 if (!bus) {
590 printf("Failed to allocate MDIO bus\n");
591 return -ENOMEM;
592 }
593
594 bus->read = ethoc_mdio_read;
595 bus->write = ethoc_mdio_write;
596 snprintf(bus->name, sizeof(bus->name), "%s", name);
597 bus->priv = priv;
598
599 ret = mdio_register(bus);
600 if (ret < 0)
601 return ret;
602
603 priv->bus = miiphy_get_dev_by_name(name);
Max Filippovc91eb0c2016-08-05 18:26:17 +0300604 return 0;
605}
606
Max Filippov848e08b2016-08-05 18:26:21 +0300607static int ethoc_phy_init(struct ethoc *priv, void *dev)
608{
609 struct phy_device *phydev;
Marek Vasut5767ffb2023-05-31 00:51:21 +0200610 int mask = -1;
Max Filippov848e08b2016-08-05 18:26:21 +0300611
612#ifdef CONFIG_PHY_ADDR
Marek Vasut5767ffb2023-05-31 00:51:21 +0200613 mask = CONFIG_PHY_ADDR;
Max Filippov848e08b2016-08-05 18:26:21 +0300614#endif
615
Marek Vasut5767ffb2023-05-31 00:51:21 +0200616 phydev = phy_connect(priv->bus, mask, dev, PHY_INTERFACE_MODE_MII);
Max Filippov848e08b2016-08-05 18:26:21 +0300617 if (!phydev)
618 return -ENODEV;
619
Max Filippov848e08b2016-08-05 18:26:21 +0300620 phydev->supported &= PHY_BASIC_FEATURES;
621 phydev->advertising = phydev->supported;
622
623 priv->phydev = phydev;
624 phy_config(phydev);
625
626 return 0;
627}
628
629#else
630
631static inline int ethoc_mdio_init(const char *name, struct ethoc *priv)
632{
633 return 0;
634}
635
636static inline int ethoc_phy_init(struct ethoc *priv, void *dev)
637{
638 return 0;
639}
640
641#endif
642
Max Filippovc91eb0c2016-08-05 18:26:17 +0300643static int ethoc_write_hwaddr(struct udevice *dev)
644{
Simon Glassfa20e932020-12-03 16:55:20 -0700645 struct ethoc_eth_pdata *pdata = dev_get_plat(dev);
Max Filippovc91eb0c2016-08-05 18:26:17 +0300646 struct ethoc *priv = dev_get_priv(dev);
647 u8 *mac = pdata->eth_pdata.enetaddr;
648
649 return ethoc_write_hwaddr_common(priv, mac);
650}
651
652static int ethoc_send(struct udevice *dev, void *packet, int length)
653{
654 return ethoc_send_common(dev_get_priv(dev), packet, length);
655}
656
657static int ethoc_free_pkt(struct udevice *dev, uchar *packet, int length)
658{
659 return ethoc_free_pkt_common(dev_get_priv(dev));
660}
661
662static int ethoc_recv(struct udevice *dev, int flags, uchar **packetp)
663{
664 struct ethoc *priv = dev_get_priv(dev);
665
666 if (flags & ETH_RECV_CHECK_DEVICE)
667 if (!ethoc_is_new_packet_received(priv))
668 return -EAGAIN;
669
670 return ethoc_rx_common(priv, packetp);
671}
672
673static int ethoc_start(struct udevice *dev)
674{
675 return ethoc_init_common(dev_get_priv(dev));
676}
677
678static void ethoc_stop(struct udevice *dev)
679{
Max Filippov848e08b2016-08-05 18:26:21 +0300680 ethoc_stop_common(dev_get_priv(dev));
Max Filippovc91eb0c2016-08-05 18:26:17 +0300681}
682
Simon Glassaad29ae2020-12-03 16:55:21 -0700683static int ethoc_of_to_plat(struct udevice *dev)
Max Filippova6429a92016-08-05 18:26:18 +0300684{
Simon Glassfa20e932020-12-03 16:55:20 -0700685 struct ethoc_eth_pdata *pdata = dev_get_plat(dev);
Max Filippov19e7a9e2016-08-05 18:26:20 +0300686 fdt_addr_t addr;
Max Filippova6429a92016-08-05 18:26:18 +0300687
Masahiro Yamadaa89b4de2020-07-17 14:36:48 +0900688 pdata->eth_pdata.iobase = dev_read_addr(dev);
Simon Glassba1dea42017-05-17 17:18:05 -0600689 addr = devfdt_get_addr_index(dev, 1);
Max Filippov19e7a9e2016-08-05 18:26:20 +0300690 if (addr != FDT_ADDR_T_NONE)
691 pdata->packet_base = addr;
Max Filippova6429a92016-08-05 18:26:18 +0300692 return 0;
693}
694
Max Filippovc91eb0c2016-08-05 18:26:17 +0300695static int ethoc_probe(struct udevice *dev)
696{
Simon Glassfa20e932020-12-03 16:55:20 -0700697 struct ethoc_eth_pdata *pdata = dev_get_plat(dev);
Max Filippovc91eb0c2016-08-05 18:26:17 +0300698 struct ethoc *priv = dev_get_priv(dev);
699
700 priv->iobase = ioremap(pdata->eth_pdata.iobase, ETHOC_IOSIZE);
Max Filippov19e7a9e2016-08-05 18:26:20 +0300701 if (pdata->packet_base) {
702 priv->packet_phys = pdata->packet_base;
703 priv->packet = ioremap(pdata->packet_base,
704 (1 + PKTBUFSRX) * PKTSIZE_ALIGN);
705 }
Max Filippov848e08b2016-08-05 18:26:21 +0300706
707 ethoc_mdio_init(dev->name, priv);
708 ethoc_phy_init(priv, dev);
709
Max Filippovc91eb0c2016-08-05 18:26:17 +0300710 return 0;
711}
712
713static int ethoc_remove(struct udevice *dev)
714{
715 struct ethoc *priv = dev_get_priv(dev);
716
Max Filippov848e08b2016-08-05 18:26:21 +0300717#ifdef CONFIG_PHYLIB
718 free(priv->phydev);
719 mdio_unregister(priv->bus);
720 mdio_free(priv->bus);
721#endif
Max Filippovc91eb0c2016-08-05 18:26:17 +0300722 iounmap(priv->iobase);
723 return 0;
724}
725
726static const struct eth_ops ethoc_ops = {
727 .start = ethoc_start,
728 .stop = ethoc_stop,
729 .send = ethoc_send,
730 .recv = ethoc_recv,
731 .free_pkt = ethoc_free_pkt,
732 .write_hwaddr = ethoc_write_hwaddr,
733};
734
Max Filippova6429a92016-08-05 18:26:18 +0300735static const struct udevice_id ethoc_ids[] = {
736 { .compatible = "opencores,ethoc" },
737 { }
738};
739
Max Filippovc91eb0c2016-08-05 18:26:17 +0300740U_BOOT_DRIVER(ethoc) = {
741 .name = "ethoc",
742 .id = UCLASS_ETH,
Max Filippova6429a92016-08-05 18:26:18 +0300743 .of_match = ethoc_ids,
Simon Glassaad29ae2020-12-03 16:55:21 -0700744 .of_to_plat = ethoc_of_to_plat,
Max Filippovc91eb0c2016-08-05 18:26:17 +0300745 .probe = ethoc_probe,
746 .remove = ethoc_remove,
747 .ops = &ethoc_ops,
Simon Glass8a2b47f2020-12-03 16:55:17 -0700748 .priv_auto = sizeof(struct ethoc),
Simon Glass71fa5b42020-12-03 16:55:18 -0700749 .plat_auto = sizeof(struct ethoc_eth_pdata),
Max Filippovc91eb0c2016-08-05 18:26:17 +0300750};