blob: c45593bcc0970d18f2cb4b5bd6af518d410b4a0e [file] [log] [blame]
Vipin KUMAR5b1b1882010-06-29 10:53:34 +05301/*
2 * (C) Copyright 2010
3 * Vipin Kumar, ST Micoelectronics, vipin.kumar@st.com.
4 *
Wolfgang Denk1a459662013-07-08 09:37:19 +02005 * SPDX-License-Identifier: GPL-2.0+
Vipin KUMAR5b1b1882010-06-29 10:53:34 +05306 */
7
8/*
9 * Designware ethernet IP driver for u-boot
10 */
11
12#include <common.h>
13#include <miiphy.h>
14#include <malloc.h>
Stefan Roeseef760252012-05-07 12:04:25 +020015#include <linux/compiler.h>
Vipin KUMAR5b1b1882010-06-29 10:53:34 +053016#include <linux/err.h>
17#include <asm/io.h>
18#include "designware.h"
19
Alexey Brodkin92a190a2014-01-22 20:54:06 +040020#if !defined(CONFIG_PHYLIB)
21# error "DesignWare Ether MAC requires PHYLIB - missing CONFIG_PHYLIB"
22#endif
23
24static int dw_mdio_read(struct mii_dev *bus, int addr, int devad, int reg)
25{
26 struct eth_mac_regs *mac_p = bus->priv;
27 ulong start;
28 u16 miiaddr;
29 int timeout = CONFIG_MDIO_TIMEOUT;
30
31 miiaddr = ((addr << MIIADDRSHIFT) & MII_ADDRMSK) |
32 ((reg << MIIREGSHIFT) & MII_REGMSK);
33
34 writel(miiaddr | MII_CLKRANGE_150_250M | MII_BUSY, &mac_p->miiaddr);
35
36 start = get_timer(0);
37 while (get_timer(start) < timeout) {
38 if (!(readl(&mac_p->miiaddr) & MII_BUSY))
39 return readl(&mac_p->miidata);
40 udelay(10);
41 };
42
43 return -1;
44}
45
46static int dw_mdio_write(struct mii_dev *bus, int addr, int devad, int reg,
47 u16 val)
48{
49 struct eth_mac_regs *mac_p = bus->priv;
50 ulong start;
51 u16 miiaddr;
52 int ret = -1, timeout = CONFIG_MDIO_TIMEOUT;
53
54 writel(val, &mac_p->miidata);
55 miiaddr = ((addr << MIIADDRSHIFT) & MII_ADDRMSK) |
56 ((reg << MIIREGSHIFT) & MII_REGMSK) | MII_WRITE;
57
58 writel(miiaddr | MII_CLKRANGE_150_250M | MII_BUSY, &mac_p->miiaddr);
59
60 start = get_timer(0);
61 while (get_timer(start) < timeout) {
62 if (!(readl(&mac_p->miiaddr) & MII_BUSY)) {
63 ret = 0;
64 break;
65 }
66 udelay(10);
67 };
68
69 return ret;
70}
71
72static int dw_mdio_init(char *name, struct eth_mac_regs *mac_regs_p)
73{
74 struct mii_dev *bus = mdio_alloc();
75
76 if (!bus) {
77 printf("Failed to allocate MDIO bus\n");
78 return -1;
79 }
80
81 bus->read = dw_mdio_read;
82 bus->write = dw_mdio_write;
83 sprintf(bus->name, name);
84
85 bus->priv = (void *)mac_regs_p;
86
87 return mdio_register(bus);
88}
Vipin Kumar13edd172012-03-26 00:09:56 +000089
Vipin KUMAR5b1b1882010-06-29 10:53:34 +053090static void tx_descs_init(struct eth_device *dev)
91{
92 struct dw_eth_dev *priv = dev->priv;
93 struct eth_dma_regs *dma_p = priv->dma_regs_p;
94 struct dmamacdescr *desc_table_p = &priv->tx_mac_descrtable[0];
95 char *txbuffs = &priv->txbuffs[0];
96 struct dmamacdescr *desc_p;
97 u32 idx;
98
99 for (idx = 0; idx < CONFIG_TX_DESCR_NUM; idx++) {
100 desc_p = &desc_table_p[idx];
101 desc_p->dmamac_addr = &txbuffs[idx * CONFIG_ETH_BUFSIZE];
102 desc_p->dmamac_next = &desc_table_p[idx + 1];
103
104#if defined(CONFIG_DW_ALTDESCRIPTOR)
105 desc_p->txrx_status &= ~(DESC_TXSTS_TXINT | DESC_TXSTS_TXLAST |
106 DESC_TXSTS_TXFIRST | DESC_TXSTS_TXCRCDIS | \
107 DESC_TXSTS_TXCHECKINSCTRL | \
108 DESC_TXSTS_TXRINGEND | DESC_TXSTS_TXPADDIS);
109
110 desc_p->txrx_status |= DESC_TXSTS_TXCHAIN;
111 desc_p->dmamac_cntl = 0;
112 desc_p->txrx_status &= ~(DESC_TXSTS_MSK | DESC_TXSTS_OWNBYDMA);
113#else
114 desc_p->dmamac_cntl = DESC_TXCTRL_TXCHAIN;
115 desc_p->txrx_status = 0;
116#endif
117 }
118
119 /* Correcting the last pointer of the chain */
120 desc_p->dmamac_next = &desc_table_p[0];
121
Alexey Brodkin50b0df82014-01-22 20:49:09 +0400122 /* Flush all Tx buffer descriptors at once */
123 flush_dcache_range((unsigned int)priv->tx_mac_descrtable,
124 (unsigned int)priv->tx_mac_descrtable +
125 sizeof(priv->tx_mac_descrtable));
126
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530127 writel((ulong)&desc_table_p[0], &dma_p->txdesclistaddr);
Alexey Brodkin74cb7082014-01-13 13:28:38 +0400128 priv->tx_currdescnum = 0;
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530129}
130
131static void rx_descs_init(struct eth_device *dev)
132{
133 struct dw_eth_dev *priv = dev->priv;
134 struct eth_dma_regs *dma_p = priv->dma_regs_p;
135 struct dmamacdescr *desc_table_p = &priv->rx_mac_descrtable[0];
136 char *rxbuffs = &priv->rxbuffs[0];
137 struct dmamacdescr *desc_p;
138 u32 idx;
139
Alexey Brodkin50b0df82014-01-22 20:49:09 +0400140 /* Before passing buffers to GMAC we need to make sure zeros
141 * written there right after "priv" structure allocation were
142 * flushed into RAM.
143 * Otherwise there's a chance to get some of them flushed in RAM when
144 * GMAC is already pushing data to RAM via DMA. This way incoming from
145 * GMAC data will be corrupted. */
146 flush_dcache_range((unsigned int)rxbuffs, (unsigned int)rxbuffs +
147 RX_TOTAL_BUFSIZE);
148
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530149 for (idx = 0; idx < CONFIG_RX_DESCR_NUM; idx++) {
150 desc_p = &desc_table_p[idx];
151 desc_p->dmamac_addr = &rxbuffs[idx * CONFIG_ETH_BUFSIZE];
152 desc_p->dmamac_next = &desc_table_p[idx + 1];
153
154 desc_p->dmamac_cntl =
155 (MAC_MAX_FRAME_SZ & DESC_RXCTRL_SIZE1MASK) | \
156 DESC_RXCTRL_RXCHAIN;
157
158 desc_p->txrx_status = DESC_RXSTS_OWNBYDMA;
159 }
160
161 /* Correcting the last pointer of the chain */
162 desc_p->dmamac_next = &desc_table_p[0];
163
Alexey Brodkin50b0df82014-01-22 20:49:09 +0400164 /* Flush all Rx buffer descriptors at once */
165 flush_dcache_range((unsigned int)priv->rx_mac_descrtable,
166 (unsigned int)priv->rx_mac_descrtable +
167 sizeof(priv->rx_mac_descrtable));
168
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530169 writel((ulong)&desc_table_p[0], &dma_p->rxdesclistaddr);
Alexey Brodkin74cb7082014-01-13 13:28:38 +0400170 priv->rx_currdescnum = 0;
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530171}
172
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530173static int dw_write_hwaddr(struct eth_device *dev)
174{
175 struct dw_eth_dev *priv = dev->priv;
176 struct eth_mac_regs *mac_p = priv->mac_regs_p;
177 u32 macid_lo, macid_hi;
178 u8 *mac_id = &dev->enetaddr[0];
179
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400180 macid_lo = mac_id[0] + (mac_id[1] << 8) + (mac_id[2] << 16) +
181 (mac_id[3] << 24);
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530182 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
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400190static 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
216static void dw_eth_halt(struct eth_device *dev)
217{
218 struct dw_eth_dev *priv = dev->priv;
219 struct eth_mac_regs *mac_p = priv->mac_regs_p;
220 struct eth_dma_regs *dma_p = priv->dma_regs_p;
221
222 writel(readl(&mac_p->conf) & ~(RXENABLE | TXENABLE), &mac_p->conf);
223 writel(readl(&dma_p->opmode) & ~(RXSTART | TXSTART), &dma_p->opmode);
224
225 phy_shutdown(priv->phydev);
226}
227
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530228static int dw_eth_init(struct eth_device *dev, bd_t *bis)
229{
230 struct dw_eth_dev *priv = dev->priv;
231 struct eth_mac_regs *mac_p = priv->mac_regs_p;
232 struct eth_dma_regs *dma_p = priv->dma_regs_p;
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400233 unsigned int start;
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530234
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400235 writel(readl(&dma_p->busmode) | DMAMAC_SRST, &dma_p->busmode);
Vipin Kumar13edd172012-03-26 00:09:56 +0000236
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400237 start = get_timer(0);
238 while (readl(&dma_p->busmode) & DMAMAC_SRST) {
239 if (get_timer(start) >= CONFIG_MACRESET_TIMEOUT)
240 return -1;
Stefan Roeseef760252012-05-07 12:04:25 +0200241
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400242 mdelay(100);
243 };
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530244
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400245 /* Soft reset above clears HW address registers.
246 * So we have to set it here once again */
Vipin KUMARc7f6dbe2012-03-26 00:09:52 +0000247 dw_write_hwaddr(dev);
248
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400249 rx_descs_init(dev);
250 tx_descs_init(dev);
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530251
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400252 writel(FIXEDBURST | PRIORXTX_41 | BURST_16, &dma_p->busmode);
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530253
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400254 writel(readl(&dma_p->opmode) | FLUSHTXFIFO | STOREFORWARD,
255 &dma_p->opmode);
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530256
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400257 writel(readl(&dma_p->opmode) | RXSTART | TXSTART, &dma_p->opmode);
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530258
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400259 /* Start up the PHY */
260 if (phy_startup(priv->phydev)) {
261 printf("Could not initialize PHY %s\n",
262 priv->phydev->dev->name);
263 return -1;
Vipin Kumar9afc1af2012-05-07 13:06:44 +0530264 }
265
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400266 dw_adjust_link(mac_p, priv->phydev);
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530267
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400268 if (!priv->phydev->link)
269 return -1;
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530270
Armando Viscontiaa510052012-03-26 00:09:55 +0000271 writel(readl(&mac_p->conf) | RXENABLE | TXENABLE, &mac_p->conf);
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530272
273 return 0;
274}
275
Joe Hershberger10cbe3b2012-05-22 18:36:19 +0000276static int dw_eth_send(struct eth_device *dev, void *packet, int length)
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530277{
278 struct dw_eth_dev *priv = dev->priv;
279 struct eth_dma_regs *dma_p = priv->dma_regs_p;
280 u32 desc_num = priv->tx_currdescnum;
281 struct dmamacdescr *desc_p = &priv->tx_mac_descrtable[desc_num];
282
Alexey Brodkin50b0df82014-01-22 20:49:09 +0400283 /* Invalidate only "status" field for the following check */
284 invalidate_dcache_range((unsigned long)&desc_p->txrx_status,
285 (unsigned long)&desc_p->txrx_status +
286 sizeof(desc_p->txrx_status));
287
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530288 /* Check if the descriptor is owned by CPU */
289 if (desc_p->txrx_status & DESC_TXSTS_OWNBYDMA) {
290 printf("CPU not owner of tx frame\n");
291 return -1;
292 }
293
Joe Hershberger10cbe3b2012-05-22 18:36:19 +0000294 memcpy((void *)desc_p->dmamac_addr, packet, length);
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530295
Alexey Brodkin50b0df82014-01-22 20:49:09 +0400296 /* Flush data to be sent */
297 flush_dcache_range((unsigned long)desc_p->dmamac_addr,
298 (unsigned long)desc_p->dmamac_addr + length);
299
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530300#if defined(CONFIG_DW_ALTDESCRIPTOR)
301 desc_p->txrx_status |= DESC_TXSTS_TXFIRST | DESC_TXSTS_TXLAST;
302 desc_p->dmamac_cntl |= (length << DESC_TXCTRL_SIZE1SHFT) & \
303 DESC_TXCTRL_SIZE1MASK;
304
305 desc_p->txrx_status &= ~(DESC_TXSTS_MSK);
306 desc_p->txrx_status |= DESC_TXSTS_OWNBYDMA;
307#else
308 desc_p->dmamac_cntl |= ((length << DESC_TXCTRL_SIZE1SHFT) & \
309 DESC_TXCTRL_SIZE1MASK) | DESC_TXCTRL_TXLAST | \
310 DESC_TXCTRL_TXFIRST;
311
312 desc_p->txrx_status = DESC_TXSTS_OWNBYDMA;
313#endif
314
Alexey Brodkin50b0df82014-01-22 20:49:09 +0400315 /* Flush modified buffer descriptor */
316 flush_dcache_range((unsigned long)desc_p,
317 (unsigned long)desc_p + sizeof(struct dmamacdescr));
318
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530319 /* Test the wrap-around condition. */
320 if (++desc_num >= CONFIG_TX_DESCR_NUM)
321 desc_num = 0;
322
323 priv->tx_currdescnum = desc_num;
324
325 /* Start the transmission */
326 writel(POLL_DATA, &dma_p->txpolldemand);
327
328 return 0;
329}
330
331static int dw_eth_recv(struct eth_device *dev)
332{
333 struct dw_eth_dev *priv = dev->priv;
Alexey Brodkin50b0df82014-01-22 20:49:09 +0400334 u32 status, desc_num = priv->rx_currdescnum;
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530335 struct dmamacdescr *desc_p = &priv->rx_mac_descrtable[desc_num];
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530336 int length = 0;
337
Alexey Brodkin50b0df82014-01-22 20:49:09 +0400338 /* Invalidate entire buffer descriptor */
339 invalidate_dcache_range((unsigned long)desc_p,
340 (unsigned long)desc_p +
341 sizeof(struct dmamacdescr));
342
343 status = desc_p->txrx_status;
344
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530345 /* Check if the owner is the CPU */
346 if (!(status & DESC_RXSTS_OWNBYDMA)) {
347
348 length = (status & DESC_RXSTS_FRMLENMSK) >> \
349 DESC_RXSTS_FRMLENSHFT;
350
Alexey Brodkin50b0df82014-01-22 20:49:09 +0400351 /* Invalidate received data */
352 invalidate_dcache_range((unsigned long)desc_p->dmamac_addr,
353 (unsigned long)desc_p->dmamac_addr +
354 length);
355
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530356 NetReceive(desc_p->dmamac_addr, length);
357
358 /*
359 * Make the current descriptor valid again and go to
360 * the next one
361 */
362 desc_p->txrx_status |= DESC_RXSTS_OWNBYDMA;
363
Alexey Brodkin50b0df82014-01-22 20:49:09 +0400364 /* Flush only status field - others weren't changed */
365 flush_dcache_range((unsigned long)&desc_p->txrx_status,
366 (unsigned long)&desc_p->txrx_status +
367 sizeof(desc_p->txrx_status));
368
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530369 /* Test the wrap-around condition. */
370 if (++desc_num >= CONFIG_RX_DESCR_NUM)
371 desc_num = 0;
372 }
373
374 priv->rx_currdescnum = desc_num;
375
376 return length;
377}
378
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400379static int dw_phy_init(struct eth_device *dev)
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530380{
381 struct dw_eth_dev *priv = dev->priv;
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400382 struct phy_device *phydev;
383 int mask = 0xffffffff;
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530384
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400385#ifdef CONFIG_PHY_ADDR
386 mask = 1 << CONFIG_PHY_ADDR;
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530387#endif
388
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400389 phydev = phy_find_by_mask(priv->bus, mask, priv->interface);
390 if (!phydev)
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530391 return -1;
392
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400393 phydev->supported &= PHY_GBIT_FEATURES;
394 phydev->advertising = phydev->supported;
395
396 priv->phydev = phydev;
397 phy_config(phydev);
398
399 return 1;
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530400}
401
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400402int designware_initialize(ulong base_addr, u32 interface)
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530403{
404 struct eth_device *dev;
405 struct dw_eth_dev *priv;
406
407 dev = (struct eth_device *) malloc(sizeof(struct eth_device));
408 if (!dev)
409 return -ENOMEM;
410
411 /*
412 * Since the priv structure contains the descriptors which need a strict
413 * buswidth alignment, memalign is used to allocate memory
414 */
415 priv = (struct dw_eth_dev *) memalign(16, sizeof(struct dw_eth_dev));
416 if (!priv) {
417 free(dev);
418 return -ENOMEM;
419 }
420
421 memset(dev, 0, sizeof(struct eth_device));
422 memset(priv, 0, sizeof(struct dw_eth_dev));
423
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400424 sprintf(dev->name, "dwmac.%lx", base_addr);
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530425 dev->iobase = (int)base_addr;
426 dev->priv = priv;
427
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530428 priv->dev = dev;
429 priv->mac_regs_p = (struct eth_mac_regs *)base_addr;
430 priv->dma_regs_p = (struct eth_dma_regs *)(base_addr +
431 DW_DMA_BASE_OFFSET);
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530432
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530433 dev->init = dw_eth_init;
434 dev->send = dw_eth_send;
435 dev->recv = dw_eth_recv;
436 dev->halt = dw_eth_halt;
437 dev->write_hwaddr = dw_write_hwaddr;
438
439 eth_register(dev);
440
Alexey Brodkin92a190a2014-01-22 20:54:06 +0400441 priv->interface = interface;
442
443 dw_mdio_init(dev->name, priv->mac_regs_p);
444 priv->bus = miiphy_get_dev_by_name(dev->name);
445
446 return dw_phy_init(dev);
Vipin KUMAR5b1b1882010-06-29 10:53:34 +0530447}