]> git.ipfire.org Git - people/ms/u-boot.git/blob - drivers/net/designware.c
Merge branch 'master' of git://git.denx.de/u-boot-video
[people/ms/u-boot.git] / drivers / net / designware.c
1 /*
2 * (C) Copyright 2010
3 * Vipin Kumar, ST Micoelectronics, vipin.kumar@st.com.
4 *
5 * SPDX-License-Identifier: GPL-2.0+
6 */
7
8 /*
9 * Designware ethernet IP driver for U-Boot
10 */
11
12 #include <common.h>
13 #include <dm.h>
14 #include <errno.h>
15 #include <miiphy.h>
16 #include <malloc.h>
17 #include <linux/compiler.h>
18 #include <linux/err.h>
19 #include <asm/io.h>
20 #include "designware.h"
21
22 DECLARE_GLOBAL_DATA_PTR;
23
24 #if !defined(CONFIG_PHYLIB)
25 # error "DesignWare Ether MAC requires PHYLIB - missing CONFIG_PHYLIB"
26 #endif
27
28 static int dw_mdio_read(struct mii_dev *bus, int addr, int devad, int reg)
29 {
30 struct eth_mac_regs *mac_p = bus->priv;
31 ulong start;
32 u16 miiaddr;
33 int timeout = CONFIG_MDIO_TIMEOUT;
34
35 miiaddr = ((addr << MIIADDRSHIFT) & MII_ADDRMSK) |
36 ((reg << MIIREGSHIFT) & MII_REGMSK);
37
38 writel(miiaddr | MII_CLKRANGE_150_250M | MII_BUSY, &mac_p->miiaddr);
39
40 start = get_timer(0);
41 while (get_timer(start) < timeout) {
42 if (!(readl(&mac_p->miiaddr) & MII_BUSY))
43 return readl(&mac_p->miidata);
44 udelay(10);
45 };
46
47 return -ETIMEDOUT;
48 }
49
50 static int dw_mdio_write(struct mii_dev *bus, int addr, int devad, int reg,
51 u16 val)
52 {
53 struct eth_mac_regs *mac_p = bus->priv;
54 ulong start;
55 u16 miiaddr;
56 int ret = -ETIMEDOUT, timeout = CONFIG_MDIO_TIMEOUT;
57
58 writel(val, &mac_p->miidata);
59 miiaddr = ((addr << MIIADDRSHIFT) & MII_ADDRMSK) |
60 ((reg << MIIREGSHIFT) & MII_REGMSK) | MII_WRITE;
61
62 writel(miiaddr | MII_CLKRANGE_150_250M | MII_BUSY, &mac_p->miiaddr);
63
64 start = get_timer(0);
65 while (get_timer(start) < timeout) {
66 if (!(readl(&mac_p->miiaddr) & MII_BUSY)) {
67 ret = 0;
68 break;
69 }
70 udelay(10);
71 };
72
73 return ret;
74 }
75
76 static int dw_mdio_init(const char *name, struct eth_mac_regs *mac_regs_p)
77 {
78 struct mii_dev *bus = mdio_alloc();
79
80 if (!bus) {
81 printf("Failed to allocate MDIO bus\n");
82 return -ENOMEM;
83 }
84
85 bus->read = dw_mdio_read;
86 bus->write = dw_mdio_write;
87 snprintf(bus->name, sizeof(bus->name), name);
88
89 bus->priv = (void *)mac_regs_p;
90
91 return mdio_register(bus);
92 }
93
94 static void tx_descs_init(struct dw_eth_dev *priv)
95 {
96 struct eth_dma_regs *dma_p = priv->dma_regs_p;
97 struct dmamacdescr *desc_table_p = &priv->tx_mac_descrtable[0];
98 char *txbuffs = &priv->txbuffs[0];
99 struct dmamacdescr *desc_p;
100 u32 idx;
101
102 for (idx = 0; idx < CONFIG_TX_DESCR_NUM; idx++) {
103 desc_p = &desc_table_p[idx];
104 desc_p->dmamac_addr = &txbuffs[idx * CONFIG_ETH_BUFSIZE];
105 desc_p->dmamac_next = &desc_table_p[idx + 1];
106
107 #if defined(CONFIG_DW_ALTDESCRIPTOR)
108 desc_p->txrx_status &= ~(DESC_TXSTS_TXINT | DESC_TXSTS_TXLAST |
109 DESC_TXSTS_TXFIRST | DESC_TXSTS_TXCRCDIS | \
110 DESC_TXSTS_TXCHECKINSCTRL | \
111 DESC_TXSTS_TXRINGEND | DESC_TXSTS_TXPADDIS);
112
113 desc_p->txrx_status |= DESC_TXSTS_TXCHAIN;
114 desc_p->dmamac_cntl = 0;
115 desc_p->txrx_status &= ~(DESC_TXSTS_MSK | DESC_TXSTS_OWNBYDMA);
116 #else
117 desc_p->dmamac_cntl = DESC_TXCTRL_TXCHAIN;
118 desc_p->txrx_status = 0;
119 #endif
120 }
121
122 /* Correcting the last pointer of the chain */
123 desc_p->dmamac_next = &desc_table_p[0];
124
125 /* Flush all Tx buffer descriptors at once */
126 flush_dcache_range((unsigned int)priv->tx_mac_descrtable,
127 (unsigned int)priv->tx_mac_descrtable +
128 sizeof(priv->tx_mac_descrtable));
129
130 writel((ulong)&desc_table_p[0], &dma_p->txdesclistaddr);
131 priv->tx_currdescnum = 0;
132 }
133
134 static void rx_descs_init(struct dw_eth_dev *priv)
135 {
136 struct eth_dma_regs *dma_p = priv->dma_regs_p;
137 struct dmamacdescr *desc_table_p = &priv->rx_mac_descrtable[0];
138 char *rxbuffs = &priv->rxbuffs[0];
139 struct dmamacdescr *desc_p;
140 u32 idx;
141
142 /* Before passing buffers to GMAC we need to make sure zeros
143 * written there right after "priv" structure allocation were
144 * flushed into RAM.
145 * Otherwise there's a chance to get some of them flushed in RAM when
146 * GMAC is already pushing data to RAM via DMA. This way incoming from
147 * GMAC data will be corrupted. */
148 flush_dcache_range((unsigned int)rxbuffs, (unsigned int)rxbuffs +
149 RX_TOTAL_BUFSIZE);
150
151 for (idx = 0; idx < CONFIG_RX_DESCR_NUM; idx++) {
152 desc_p = &desc_table_p[idx];
153 desc_p->dmamac_addr = &rxbuffs[idx * CONFIG_ETH_BUFSIZE];
154 desc_p->dmamac_next = &desc_table_p[idx + 1];
155
156 desc_p->dmamac_cntl =
157 (MAC_MAX_FRAME_SZ & DESC_RXCTRL_SIZE1MASK) | \
158 DESC_RXCTRL_RXCHAIN;
159
160 desc_p->txrx_status = DESC_RXSTS_OWNBYDMA;
161 }
162
163 /* Correcting the last pointer of the chain */
164 desc_p->dmamac_next = &desc_table_p[0];
165
166 /* Flush all Rx buffer descriptors at once */
167 flush_dcache_range((unsigned int)priv->rx_mac_descrtable,
168 (unsigned int)priv->rx_mac_descrtable +
169 sizeof(priv->rx_mac_descrtable));
170
171 writel((ulong)&desc_table_p[0], &dma_p->rxdesclistaddr);
172 priv->rx_currdescnum = 0;
173 }
174
175 static int _dw_write_hwaddr(struct dw_eth_dev *priv, u8 *mac_id)
176 {
177 struct eth_mac_regs *mac_p = priv->mac_regs_p;
178 u32 macid_lo, macid_hi;
179
180 macid_lo = mac_id[0] + (mac_id[1] << 8) + (mac_id[2] << 16) +
181 (mac_id[3] << 24);
182 macid_hi = mac_id[4] + (mac_id[5] << 8);
183
184 writel(macid_hi, &mac_p->macaddr0hi);
185 writel(macid_lo, &mac_p->macaddr0lo);
186
187 return 0;
188 }
189
190 static void dw_adjust_link(struct eth_mac_regs *mac_p,
191 struct phy_device *phydev)
192 {
193 u32 conf = readl(&mac_p->conf) | FRAMEBURSTENABLE | DISABLERXOWN;
194
195 if (!phydev->link) {
196 printf("%s: No link.\n", phydev->dev->name);
197 return;
198 }
199
200 if (phydev->speed != 1000)
201 conf |= MII_PORTSELECT;
202
203 if (phydev->speed == 100)
204 conf |= FES_100;
205
206 if (phydev->duplex)
207 conf |= FULLDPLXMODE;
208
209 writel(conf, &mac_p->conf);
210
211 printf("Speed: %d, %s duplex%s\n", phydev->speed,
212 (phydev->duplex) ? "full" : "half",
213 (phydev->port == PORT_FIBRE) ? ", fiber mode" : "");
214 }
215
216 static void _dw_eth_halt(struct dw_eth_dev *priv)
217 {
218 struct eth_mac_regs *mac_p = priv->mac_regs_p;
219 struct eth_dma_regs *dma_p = priv->dma_regs_p;
220
221 writel(readl(&mac_p->conf) & ~(RXENABLE | TXENABLE), &mac_p->conf);
222 writel(readl(&dma_p->opmode) & ~(RXSTART | TXSTART), &dma_p->opmode);
223
224 phy_shutdown(priv->phydev);
225 }
226
227 static int _dw_eth_init(struct dw_eth_dev *priv, u8 *enetaddr)
228 {
229 struct eth_mac_regs *mac_p = priv->mac_regs_p;
230 struct eth_dma_regs *dma_p = priv->dma_regs_p;
231 unsigned int start;
232 int ret;
233
234 writel(readl(&dma_p->busmode) | DMAMAC_SRST, &dma_p->busmode);
235
236 start = get_timer(0);
237 while (readl(&dma_p->busmode) & DMAMAC_SRST) {
238 if (get_timer(start) >= CONFIG_MACRESET_TIMEOUT) {
239 printf("DMA reset timeout\n");
240 return -ETIMEDOUT;
241 }
242
243 mdelay(100);
244 };
245
246 /*
247 * Soft reset above clears HW address registers.
248 * So we have to set it here once again.
249 */
250 _dw_write_hwaddr(priv, enetaddr);
251
252 rx_descs_init(priv);
253 tx_descs_init(priv);
254
255 writel(FIXEDBURST | PRIORXTX_41 | DMA_PBL, &dma_p->busmode);
256
257 #ifndef CONFIG_DW_MAC_FORCE_THRESHOLD_MODE
258 writel(readl(&dma_p->opmode) | FLUSHTXFIFO | STOREFORWARD,
259 &dma_p->opmode);
260 #else
261 writel(readl(&dma_p->opmode) | FLUSHTXFIFO,
262 &dma_p->opmode);
263 #endif
264
265 writel(readl(&dma_p->opmode) | RXSTART | TXSTART, &dma_p->opmode);
266
267 #ifdef CONFIG_DW_AXI_BURST_LEN
268 writel((CONFIG_DW_AXI_BURST_LEN & 0x1FF >> 1), &dma_p->axibus);
269 #endif
270
271 /* Start up the PHY */
272 ret = phy_startup(priv->phydev);
273 if (ret) {
274 printf("Could not initialize PHY %s\n",
275 priv->phydev->dev->name);
276 return ret;
277 }
278
279 dw_adjust_link(mac_p, priv->phydev);
280
281 if (!priv->phydev->link)
282 return -EIO;
283
284 writel(readl(&mac_p->conf) | RXENABLE | TXENABLE, &mac_p->conf);
285
286 return 0;
287 }
288
289 static int _dw_eth_send(struct dw_eth_dev *priv, void *packet, int length)
290 {
291 struct eth_dma_regs *dma_p = priv->dma_regs_p;
292 u32 desc_num = priv->tx_currdescnum;
293 struct dmamacdescr *desc_p = &priv->tx_mac_descrtable[desc_num];
294 uint32_t desc_start = (uint32_t)desc_p;
295 uint32_t desc_end = desc_start +
296 roundup(sizeof(*desc_p), ARCH_DMA_MINALIGN);
297 uint32_t data_start = (uint32_t)desc_p->dmamac_addr;
298 uint32_t data_end = data_start +
299 roundup(length, ARCH_DMA_MINALIGN);
300 /*
301 * Strictly we only need to invalidate the "txrx_status" field
302 * for the following check, but on some platforms we cannot
303 * invalidate only 4 bytes, so we flush the entire descriptor,
304 * which is 16 bytes in total. This is safe because the
305 * individual descriptors in the array are each aligned to
306 * ARCH_DMA_MINALIGN and padded appropriately.
307 */
308 invalidate_dcache_range(desc_start, desc_end);
309
310 /* Check if the descriptor is owned by CPU */
311 if (desc_p->txrx_status & DESC_TXSTS_OWNBYDMA) {
312 printf("CPU not owner of tx frame\n");
313 return -EPERM;
314 }
315
316 memcpy(desc_p->dmamac_addr, packet, length);
317
318 /* Flush data to be sent */
319 flush_dcache_range(data_start, data_end);
320
321 #if defined(CONFIG_DW_ALTDESCRIPTOR)
322 desc_p->txrx_status |= DESC_TXSTS_TXFIRST | DESC_TXSTS_TXLAST;
323 desc_p->dmamac_cntl |= (length << DESC_TXCTRL_SIZE1SHFT) & \
324 DESC_TXCTRL_SIZE1MASK;
325
326 desc_p->txrx_status &= ~(DESC_TXSTS_MSK);
327 desc_p->txrx_status |= DESC_TXSTS_OWNBYDMA;
328 #else
329 desc_p->dmamac_cntl |= ((length << DESC_TXCTRL_SIZE1SHFT) & \
330 DESC_TXCTRL_SIZE1MASK) | DESC_TXCTRL_TXLAST | \
331 DESC_TXCTRL_TXFIRST;
332
333 desc_p->txrx_status = DESC_TXSTS_OWNBYDMA;
334 #endif
335
336 /* Flush modified buffer descriptor */
337 flush_dcache_range(desc_start, desc_end);
338
339 /* Test the wrap-around condition. */
340 if (++desc_num >= CONFIG_TX_DESCR_NUM)
341 desc_num = 0;
342
343 priv->tx_currdescnum = desc_num;
344
345 /* Start the transmission */
346 writel(POLL_DATA, &dma_p->txpolldemand);
347
348 return 0;
349 }
350
351 static int _dw_eth_recv(struct dw_eth_dev *priv, uchar **packetp)
352 {
353 u32 status, desc_num = priv->rx_currdescnum;
354 struct dmamacdescr *desc_p = &priv->rx_mac_descrtable[desc_num];
355 int length = -EAGAIN;
356 uint32_t desc_start = (uint32_t)desc_p;
357 uint32_t desc_end = desc_start +
358 roundup(sizeof(*desc_p), ARCH_DMA_MINALIGN);
359 uint32_t data_start = (uint32_t)desc_p->dmamac_addr;
360 uint32_t data_end;
361
362 /* Invalidate entire buffer descriptor */
363 invalidate_dcache_range(desc_start, desc_end);
364
365 status = desc_p->txrx_status;
366
367 /* Check if the owner is the CPU */
368 if (!(status & DESC_RXSTS_OWNBYDMA)) {
369
370 length = (status & DESC_RXSTS_FRMLENMSK) >> \
371 DESC_RXSTS_FRMLENSHFT;
372
373 /* Invalidate received data */
374 data_end = data_start + roundup(length, ARCH_DMA_MINALIGN);
375 invalidate_dcache_range(data_start, data_end);
376 *packetp = desc_p->dmamac_addr;
377 }
378
379 return length;
380 }
381
382 static int _dw_free_pkt(struct dw_eth_dev *priv)
383 {
384 u32 desc_num = priv->rx_currdescnum;
385 struct dmamacdescr *desc_p = &priv->rx_mac_descrtable[desc_num];
386 uint32_t desc_start = (uint32_t)desc_p;
387 uint32_t desc_end = desc_start +
388 roundup(sizeof(*desc_p), ARCH_DMA_MINALIGN);
389
390 /*
391 * Make the current descriptor valid again and go to
392 * the next one
393 */
394 desc_p->txrx_status |= DESC_RXSTS_OWNBYDMA;
395
396 /* Flush only status field - others weren't changed */
397 flush_dcache_range(desc_start, desc_end);
398
399 /* Test the wrap-around condition. */
400 if (++desc_num >= CONFIG_RX_DESCR_NUM)
401 desc_num = 0;
402 priv->rx_currdescnum = desc_num;
403
404 return 0;
405 }
406
407 static int dw_phy_init(struct dw_eth_dev *priv, void *dev)
408 {
409 struct phy_device *phydev;
410 int mask = 0xffffffff;
411
412 #ifdef CONFIG_PHY_ADDR
413 mask = 1 << CONFIG_PHY_ADDR;
414 #endif
415
416 phydev = phy_find_by_mask(priv->bus, mask, priv->interface);
417 if (!phydev)
418 return -ENODEV;
419
420 phy_connect_dev(phydev, dev);
421
422 phydev->supported &= PHY_GBIT_FEATURES;
423 phydev->advertising = phydev->supported;
424
425 priv->phydev = phydev;
426 phy_config(phydev);
427
428 return 0;
429 }
430
431 #ifndef CONFIG_DM_ETH
432 static int dw_eth_init(struct eth_device *dev, bd_t *bis)
433 {
434 return _dw_eth_init(dev->priv, dev->enetaddr);
435 }
436
437 static int dw_eth_send(struct eth_device *dev, void *packet, int length)
438 {
439 return _dw_eth_send(dev->priv, packet, length);
440 }
441
442 static int dw_eth_recv(struct eth_device *dev)
443 {
444 uchar *packet;
445 int length;
446
447 length = _dw_eth_recv(dev->priv, &packet);
448 if (length == -EAGAIN)
449 return 0;
450 net_process_received_packet(packet, length);
451
452 _dw_free_pkt(dev->priv);
453
454 return 0;
455 }
456
457 static void dw_eth_halt(struct eth_device *dev)
458 {
459 return _dw_eth_halt(dev->priv);
460 }
461
462 static int dw_write_hwaddr(struct eth_device *dev)
463 {
464 return _dw_write_hwaddr(dev->priv, dev->enetaddr);
465 }
466
467 int designware_initialize(ulong base_addr, u32 interface)
468 {
469 struct eth_device *dev;
470 struct dw_eth_dev *priv;
471
472 dev = (struct eth_device *) malloc(sizeof(struct eth_device));
473 if (!dev)
474 return -ENOMEM;
475
476 /*
477 * Since the priv structure contains the descriptors which need a strict
478 * buswidth alignment, memalign is used to allocate memory
479 */
480 priv = (struct dw_eth_dev *) memalign(ARCH_DMA_MINALIGN,
481 sizeof(struct dw_eth_dev));
482 if (!priv) {
483 free(dev);
484 return -ENOMEM;
485 }
486
487 memset(dev, 0, sizeof(struct eth_device));
488 memset(priv, 0, sizeof(struct dw_eth_dev));
489
490 sprintf(dev->name, "dwmac.%lx", base_addr);
491 dev->iobase = (int)base_addr;
492 dev->priv = priv;
493
494 priv->dev = dev;
495 priv->mac_regs_p = (struct eth_mac_regs *)base_addr;
496 priv->dma_regs_p = (struct eth_dma_regs *)(base_addr +
497 DW_DMA_BASE_OFFSET);
498
499 dev->init = dw_eth_init;
500 dev->send = dw_eth_send;
501 dev->recv = dw_eth_recv;
502 dev->halt = dw_eth_halt;
503 dev->write_hwaddr = dw_write_hwaddr;
504
505 eth_register(dev);
506
507 priv->interface = interface;
508
509 dw_mdio_init(dev->name, priv->mac_regs_p);
510 priv->bus = miiphy_get_dev_by_name(dev->name);
511
512 return dw_phy_init(priv, dev);
513 }
514 #endif
515
516 #ifdef CONFIG_DM_ETH
517 static int designware_eth_start(struct udevice *dev)
518 {
519 struct eth_pdata *pdata = dev_get_platdata(dev);
520
521 return _dw_eth_init(dev->priv, pdata->enetaddr);
522 }
523
524 static int designware_eth_send(struct udevice *dev, void *packet, int length)
525 {
526 struct dw_eth_dev *priv = dev_get_priv(dev);
527
528 return _dw_eth_send(priv, packet, length);
529 }
530
531 static int designware_eth_recv(struct udevice *dev, int flags, uchar **packetp)
532 {
533 struct dw_eth_dev *priv = dev_get_priv(dev);
534
535 return _dw_eth_recv(priv, packetp);
536 }
537
538 static int designware_eth_free_pkt(struct udevice *dev, uchar *packet,
539 int length)
540 {
541 struct dw_eth_dev *priv = dev_get_priv(dev);
542
543 return _dw_free_pkt(priv);
544 }
545
546 static void designware_eth_stop(struct udevice *dev)
547 {
548 struct dw_eth_dev *priv = dev_get_priv(dev);
549
550 return _dw_eth_halt(priv);
551 }
552
553 static int designware_eth_write_hwaddr(struct udevice *dev)
554 {
555 struct eth_pdata *pdata = dev_get_platdata(dev);
556 struct dw_eth_dev *priv = dev_get_priv(dev);
557
558 return _dw_write_hwaddr(priv, pdata->enetaddr);
559 }
560
561 static int designware_eth_probe(struct udevice *dev)
562 {
563 struct eth_pdata *pdata = dev_get_platdata(dev);
564 struct dw_eth_dev *priv = dev_get_priv(dev);
565 int ret;
566
567 debug("%s, iobase=%lx, priv=%p\n", __func__, pdata->iobase, priv);
568 priv->mac_regs_p = (struct eth_mac_regs *)pdata->iobase;
569 priv->dma_regs_p = (struct eth_dma_regs *)(pdata->iobase +
570 DW_DMA_BASE_OFFSET);
571 priv->interface = pdata->phy_interface;
572
573 dw_mdio_init(dev->name, priv->mac_regs_p);
574 priv->bus = miiphy_get_dev_by_name(dev->name);
575
576 ret = dw_phy_init(priv, dev);
577 debug("%s, ret=%d\n", __func__, ret);
578
579 return ret;
580 }
581
582 static const struct eth_ops designware_eth_ops = {
583 .start = designware_eth_start,
584 .send = designware_eth_send,
585 .recv = designware_eth_recv,
586 .free_pkt = designware_eth_free_pkt,
587 .stop = designware_eth_stop,
588 .write_hwaddr = designware_eth_write_hwaddr,
589 };
590
591 static int designware_eth_ofdata_to_platdata(struct udevice *dev)
592 {
593 struct eth_pdata *pdata = dev_get_platdata(dev);
594 const char *phy_mode;
595
596 pdata->iobase = dev_get_addr(dev);
597 pdata->phy_interface = -1;
598 phy_mode = fdt_getprop(gd->fdt_blob, dev->of_offset, "phy-mode", NULL);
599 if (phy_mode)
600 pdata->phy_interface = phy_get_interface_by_name(phy_mode);
601 if (pdata->phy_interface == -1) {
602 debug("%s: Invalid PHY interface '%s'\n", __func__, phy_mode);
603 return -EINVAL;
604 }
605
606 return 0;
607 }
608
609 static const struct udevice_id designware_eth_ids[] = {
610 { .compatible = "allwinner,sun7i-a20-gmac" },
611 { .compatible = "altr,socfpga-stmmac" },
612 { }
613 };
614
615 U_BOOT_DRIVER(eth_designware) = {
616 .name = "eth_designware",
617 .id = UCLASS_ETH,
618 .of_match = designware_eth_ids,
619 .ofdata_to_platdata = designware_eth_ofdata_to_platdata,
620 .probe = designware_eth_probe,
621 .ops = &designware_eth_ops,
622 .priv_auto_alloc_size = sizeof(struct dw_eth_dev),
623 .platdata_auto_alloc_size = sizeof(struct eth_pdata),
624 .flags = DM_FLAG_ALLOC_PRIV_DMA,
625 };
626 #endif