3 * Vipin Kumar, ST Micoelectronics, vipin.kumar@st.com.
5 * SPDX-License-Identifier: GPL-2.0+
9 * Designware ethernet IP driver for u-boot
15 #include <linux/compiler.h>
16 #include <linux/err.h>
18 #include "designware.h"
20 #if !defined(CONFIG_PHYLIB)
21 # error "DesignWare Ether MAC requires PHYLIB - missing CONFIG_PHYLIB"
24 static int dw_mdio_read(struct mii_dev
*bus
, int addr
, int devad
, int reg
)
26 struct eth_mac_regs
*mac_p
= bus
->priv
;
29 int timeout
= CONFIG_MDIO_TIMEOUT
;
31 miiaddr
= ((addr
<< MIIADDRSHIFT
) & MII_ADDRMSK
) |
32 ((reg
<< MIIREGSHIFT
) & MII_REGMSK
);
34 writel(miiaddr
| MII_CLKRANGE_150_250M
| MII_BUSY
, &mac_p
->miiaddr
);
37 while (get_timer(start
) < timeout
) {
38 if (!(readl(&mac_p
->miiaddr
) & MII_BUSY
))
39 return readl(&mac_p
->miidata
);
46 static int dw_mdio_write(struct mii_dev
*bus
, int addr
, int devad
, int reg
,
49 struct eth_mac_regs
*mac_p
= bus
->priv
;
52 int ret
= -1, timeout
= CONFIG_MDIO_TIMEOUT
;
54 writel(val
, &mac_p
->miidata
);
55 miiaddr
= ((addr
<< MIIADDRSHIFT
) & MII_ADDRMSK
) |
56 ((reg
<< MIIREGSHIFT
) & MII_REGMSK
) | MII_WRITE
;
58 writel(miiaddr
| MII_CLKRANGE_150_250M
| MII_BUSY
, &mac_p
->miiaddr
);
61 while (get_timer(start
) < timeout
) {
62 if (!(readl(&mac_p
->miiaddr
) & MII_BUSY
)) {
72 static int dw_mdio_init(char *name
, struct eth_mac_regs
*mac_regs_p
)
74 struct mii_dev
*bus
= mdio_alloc();
77 printf("Failed to allocate MDIO bus\n");
81 bus
->read
= dw_mdio_read
;
82 bus
->write
= dw_mdio_write
;
83 sprintf(bus
->name
, name
);
85 bus
->priv
= (void *)mac_regs_p
;
87 return mdio_register(bus
);
90 static void tx_descs_init(struct eth_device
*dev
)
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
;
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];
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
);
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
);
114 desc_p
->dmamac_cntl
= DESC_TXCTRL_TXCHAIN
;
115 desc_p
->txrx_status
= 0;
119 /* Correcting the last pointer of the chain */
120 desc_p
->dmamac_next
= &desc_table_p
[0];
122 /* 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
));
127 writel((ulong
)&desc_table_p
[0], &dma_p
->txdesclistaddr
);
128 priv
->tx_currdescnum
= 0;
131 static void rx_descs_init(struct eth_device
*dev
)
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
;
140 /* Before passing buffers to GMAC we need to make sure zeros
141 * written there right after "priv" structure allocation were
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
+
149 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];
154 desc_p
->dmamac_cntl
=
155 (MAC_MAX_FRAME_SZ
& DESC_RXCTRL_SIZE1MASK
) | \
158 desc_p
->txrx_status
= DESC_RXSTS_OWNBYDMA
;
161 /* Correcting the last pointer of the chain */
162 desc_p
->dmamac_next
= &desc_table_p
[0];
164 /* 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
));
169 writel((ulong
)&desc_table_p
[0], &dma_p
->rxdesclistaddr
);
170 priv
->rx_currdescnum
= 0;
173 static int dw_write_hwaddr(struct eth_device
*dev
)
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];
180 macid_lo
= mac_id
[0] + (mac_id
[1] << 8) + (mac_id
[2] << 16) +
182 macid_hi
= mac_id
[4] + (mac_id
[5] << 8);
184 writel(macid_hi
, &mac_p
->macaddr0hi
);
185 writel(macid_lo
, &mac_p
->macaddr0lo
);
190 static void dw_adjust_link(struct eth_mac_regs
*mac_p
,
191 struct phy_device
*phydev
)
193 u32 conf
= readl(&mac_p
->conf
) | FRAMEBURSTENABLE
| DISABLERXOWN
;
196 printf("%s: No link.\n", phydev
->dev
->name
);
200 if (phydev
->speed
!= 1000)
201 conf
|= MII_PORTSELECT
;
203 if (phydev
->speed
== 100)
207 conf
|= FULLDPLXMODE
;
209 writel(conf
, &mac_p
->conf
);
211 printf("Speed: %d, %s duplex%s\n", phydev
->speed
,
212 (phydev
->duplex
) ? "full" : "half",
213 (phydev
->port
== PORT_FIBRE
) ? ", fiber mode" : "");
216 static void dw_eth_halt(struct eth_device
*dev
)
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
;
222 writel(readl(&mac_p
->conf
) & ~(RXENABLE
| TXENABLE
), &mac_p
->conf
);
223 writel(readl(&dma_p
->opmode
) & ~(RXSTART
| TXSTART
), &dma_p
->opmode
);
225 phy_shutdown(priv
->phydev
);
228 static int dw_eth_init(struct eth_device
*dev
, bd_t
*bis
)
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
;
235 writel(readl(&dma_p
->busmode
) | DMAMAC_SRST
, &dma_p
->busmode
);
237 start
= get_timer(0);
238 while (readl(&dma_p
->busmode
) & DMAMAC_SRST
) {
239 if (get_timer(start
) >= CONFIG_MACRESET_TIMEOUT
) {
240 printf("DMA reset timeout\n");
247 /* Soft reset above clears HW address registers.
248 * So we have to set it here once again */
249 dw_write_hwaddr(dev
);
254 writel(FIXEDBURST
| PRIORXTX_41
| DMA_PBL
, &dma_p
->busmode
);
256 writel(readl(&dma_p
->opmode
) | FLUSHTXFIFO
| STOREFORWARD
,
259 writel(readl(&dma_p
->opmode
) | RXSTART
| TXSTART
, &dma_p
->opmode
);
261 /* Start up the PHY */
262 if (phy_startup(priv
->phydev
)) {
263 printf("Could not initialize PHY %s\n",
264 priv
->phydev
->dev
->name
);
268 dw_adjust_link(mac_p
, priv
->phydev
);
270 if (!priv
->phydev
->link
)
273 writel(readl(&mac_p
->conf
) | RXENABLE
| TXENABLE
, &mac_p
->conf
);
278 static int dw_eth_send(struct eth_device
*dev
, void *packet
, int length
)
280 struct dw_eth_dev
*priv
= dev
->priv
;
281 struct eth_dma_regs
*dma_p
= priv
->dma_regs_p
;
282 u32 desc_num
= priv
->tx_currdescnum
;
283 struct dmamacdescr
*desc_p
= &priv
->tx_mac_descrtable
[desc_num
];
284 uint32_t desc_start
= (uint32_t)desc_p
;
285 uint32_t desc_end
= desc_start
+
286 roundup(sizeof(*desc_p
), ARCH_DMA_MINALIGN
);
287 uint32_t data_start
= (uint32_t)desc_p
->dmamac_addr
;
288 uint32_t data_end
= data_start
+
289 roundup(length
, ARCH_DMA_MINALIGN
);
291 * Strictly we only need to invalidate the "txrx_status" field
292 * for the following check, but on some platforms we cannot
293 * invalidate only 4 bytes, so we flush the entire descriptor,
294 * which is 16 bytes in total. This is safe because the
295 * individual descriptors in the array are each aligned to
296 * ARCH_DMA_MINALIGN and padded appropriately.
298 invalidate_dcache_range(desc_start
, desc_end
);
300 /* Check if the descriptor is owned by CPU */
301 if (desc_p
->txrx_status
& DESC_TXSTS_OWNBYDMA
) {
302 printf("CPU not owner of tx frame\n");
306 memcpy(desc_p
->dmamac_addr
, packet
, length
);
308 /* Flush data to be sent */
309 flush_dcache_range(data_start
, data_end
);
311 #if defined(CONFIG_DW_ALTDESCRIPTOR)
312 desc_p
->txrx_status
|= DESC_TXSTS_TXFIRST
| DESC_TXSTS_TXLAST
;
313 desc_p
->dmamac_cntl
|= (length
<< DESC_TXCTRL_SIZE1SHFT
) & \
314 DESC_TXCTRL_SIZE1MASK
;
316 desc_p
->txrx_status
&= ~(DESC_TXSTS_MSK
);
317 desc_p
->txrx_status
|= DESC_TXSTS_OWNBYDMA
;
319 desc_p
->dmamac_cntl
|= ((length
<< DESC_TXCTRL_SIZE1SHFT
) & \
320 DESC_TXCTRL_SIZE1MASK
) | DESC_TXCTRL_TXLAST
| \
323 desc_p
->txrx_status
= DESC_TXSTS_OWNBYDMA
;
326 /* Flush modified buffer descriptor */
327 flush_dcache_range(desc_start
, desc_end
);
329 /* Test the wrap-around condition. */
330 if (++desc_num
>= CONFIG_TX_DESCR_NUM
)
333 priv
->tx_currdescnum
= desc_num
;
335 /* Start the transmission */
336 writel(POLL_DATA
, &dma_p
->txpolldemand
);
341 static int dw_eth_recv(struct eth_device
*dev
)
343 struct dw_eth_dev
*priv
= dev
->priv
;
344 u32 status
, desc_num
= priv
->rx_currdescnum
;
345 struct dmamacdescr
*desc_p
= &priv
->rx_mac_descrtable
[desc_num
];
347 uint32_t desc_start
= (uint32_t)desc_p
;
348 uint32_t desc_end
= desc_start
+
349 roundup(sizeof(*desc_p
), ARCH_DMA_MINALIGN
);
350 uint32_t data_start
= (uint32_t)desc_p
->dmamac_addr
;
353 /* Invalidate entire buffer descriptor */
354 invalidate_dcache_range(desc_start
, desc_end
);
356 status
= desc_p
->txrx_status
;
358 /* Check if the owner is the CPU */
359 if (!(status
& DESC_RXSTS_OWNBYDMA
)) {
361 length
= (status
& DESC_RXSTS_FRMLENMSK
) >> \
362 DESC_RXSTS_FRMLENSHFT
;
364 /* Invalidate received data */
365 data_end
= data_start
+ roundup(length
, ARCH_DMA_MINALIGN
);
366 invalidate_dcache_range(data_start
, data_end
);
368 NetReceive(desc_p
->dmamac_addr
, length
);
371 * Make the current descriptor valid again and go to
374 desc_p
->txrx_status
|= DESC_RXSTS_OWNBYDMA
;
376 /* Flush only status field - others weren't changed */
377 flush_dcache_range(desc_start
, desc_end
);
379 /* Test the wrap-around condition. */
380 if (++desc_num
>= CONFIG_RX_DESCR_NUM
)
384 priv
->rx_currdescnum
= desc_num
;
389 static int dw_phy_init(struct eth_device
*dev
)
391 struct dw_eth_dev
*priv
= dev
->priv
;
392 struct phy_device
*phydev
;
393 int mask
= 0xffffffff;
395 #ifdef CONFIG_PHY_ADDR
396 mask
= 1 << CONFIG_PHY_ADDR
;
399 phydev
= phy_find_by_mask(priv
->bus
, mask
, priv
->interface
);
403 phy_connect_dev(phydev
, dev
);
405 phydev
->supported
&= PHY_GBIT_FEATURES
;
406 phydev
->advertising
= phydev
->supported
;
408 priv
->phydev
= phydev
;
414 int designware_initialize(ulong base_addr
, u32 interface
)
416 struct eth_device
*dev
;
417 struct dw_eth_dev
*priv
;
419 dev
= (struct eth_device
*) malloc(sizeof(struct eth_device
));
424 * Since the priv structure contains the descriptors which need a strict
425 * buswidth alignment, memalign is used to allocate memory
427 priv
= (struct dw_eth_dev
*) memalign(ARCH_DMA_MINALIGN
,
428 sizeof(struct dw_eth_dev
));
434 memset(dev
, 0, sizeof(struct eth_device
));
435 memset(priv
, 0, sizeof(struct dw_eth_dev
));
437 sprintf(dev
->name
, "dwmac.%lx", base_addr
);
438 dev
->iobase
= (int)base_addr
;
442 priv
->mac_regs_p
= (struct eth_mac_regs
*)base_addr
;
443 priv
->dma_regs_p
= (struct eth_dma_regs
*)(base_addr
+
446 dev
->init
= dw_eth_init
;
447 dev
->send
= dw_eth_send
;
448 dev
->recv
= dw_eth_recv
;
449 dev
->halt
= dw_eth_halt
;
450 dev
->write_hwaddr
= dw_write_hwaddr
;
454 priv
->interface
= interface
;
456 dw_mdio_init(dev
->name
, priv
->mac_regs_p
);
457 priv
->bus
= miiphy_get_dev_by_name(dev
->name
);
459 return dw_phy_init(dev
);