2 * Dave Ethernet Controller driver
4 * Copyright (C) 2008 Dave S.r.l. <www.dave.eu>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
13 #ifndef CONFIG_DNET_AUTONEG_TIMEOUT
14 #define CONFIG_DNET_AUTONEG_TIMEOUT 5000000 /* default value */
19 #include <linux/mii.h>
23 #include <asm/unaligned.h>
28 struct dnet_registers
*regs
;
29 const struct device
*dev
;
30 struct eth_device netdev
;
31 unsigned short phy_addr
;
34 /* get struct dnet_device from given struct netdev */
35 #define to_dnet(_nd) container_of(_nd, struct dnet_device, netdev)
37 /* function for reading internal MAC register */
38 u16
dnet_readw_mac(struct dnet_device
*dnet
, u16 reg
)
43 writel(reg
, &dnet
->regs
->MACREG_ADDR
);
45 /* since a read/write op to the MAC is very slow,
46 * we must wait before reading the data */
49 /* read data read from the MAC register */
50 data_read
= readl(&dnet
->regs
->MACREG_DATA
);
56 /* function for writing internal MAC register */
57 void dnet_writew_mac(struct dnet_device
*dnet
, u16 reg
, u16 val
)
59 /* load data to write */
60 writel(val
, &dnet
->regs
->MACREG_DATA
);
63 writel(reg
| DNET_INTERNAL_WRITE
, &dnet
->regs
->MACREG_ADDR
);
65 /* since a read/write op to the MAC is very slow,
66 * we must wait before exiting */
70 static void dnet_mdio_write(struct dnet_device
*dnet
, u8 reg
, u16 value
)
74 debug(DRIVERNAME
"dnet_mdio_write %02x:%02x <- %04x\n",
75 dnet
->phy_addr
, reg
, value
);
77 while (!(dnet_readw_mac(dnet
, DNET_INTERNAL_GMII_MNG_CTL_REG
) &
78 DNET_INTERNAL_GMII_MNG_CMD_FIN
))
81 /* prepare for a write operation */
84 /* only 5 bits allowed for register offset */
87 /* prepare reg_value for a write */
88 tmp
|= (dnet
->phy_addr
<< 8);
91 /* write data to write first */
92 dnet_writew_mac(dnet
, DNET_INTERNAL_GMII_MNG_DAT_REG
, value
);
94 /* write control word */
95 dnet_writew_mac(dnet
, DNET_INTERNAL_GMII_MNG_CTL_REG
, tmp
);
97 while (!(dnet_readw_mac(dnet
, DNET_INTERNAL_GMII_MNG_CTL_REG
) &
98 DNET_INTERNAL_GMII_MNG_CMD_FIN
))
102 static u16
dnet_mdio_read(struct dnet_device
*dnet
, u8 reg
)
106 while (!(dnet_readw_mac(dnet
, DNET_INTERNAL_GMII_MNG_CTL_REG
) &
107 DNET_INTERNAL_GMII_MNG_CMD_FIN
))
110 /* only 5 bits allowed for register offset*/
113 /* prepare reg_value for a read */
114 value
= (dnet
->phy_addr
<< 8);
117 /* write control word */
118 dnet_writew_mac(dnet
, DNET_INTERNAL_GMII_MNG_CTL_REG
, value
);
120 /* wait for end of transfer */
121 while (!(dnet_readw_mac(dnet
, DNET_INTERNAL_GMII_MNG_CTL_REG
) &
122 DNET_INTERNAL_GMII_MNG_CMD_FIN
))
125 value
= dnet_readw_mac(dnet
, DNET_INTERNAL_GMII_MNG_DAT_REG
);
127 debug(DRIVERNAME
"dnet_mdio_read %02x:%02x <- %04x\n",
128 dnet
->phy_addr
, reg
, value
);
133 static int dnet_send(struct eth_device
*netdev
, void *packet
, int length
)
135 struct dnet_device
*dnet
= to_dnet(netdev
);
140 debug(DRIVERNAME
"[%s] Sending %u bytes\n", __func__
, length
);
142 bufp
= (unsigned int *) (((u32
)packet
) & 0xFFFFFFFC);
143 wrsz
= (u32
)length
+ 3;
144 wrsz
+= ((u32
)packet
) & 0x3;
146 tx_cmd
= ((((unsigned int)(packet
)) & 0x03) << 16) | (u32
)length
;
148 /* check if there is enough room for the current frame */
149 if (wrsz
< (DNET_FIFO_SIZE
- readl(&dnet
->regs
->TX_FIFO_WCNT
))) {
150 for (i
= 0; i
< wrsz
; i
++)
151 writel(*bufp
++, &dnet
->regs
->TX_DATA_FIFO
);
153 * inform MAC that a packet's written and ready
156 writel(tx_cmd
, &dnet
->regs
->TX_LEN_FIFO
);
158 printf(DRIVERNAME
"No free space (actual %d, required %d "
159 "(words))\n", DNET_FIFO_SIZE
-
160 readl(&dnet
->regs
->TX_FIFO_WCNT
), wrsz
);
163 /* No one cares anyway */
168 static int dnet_recv(struct eth_device
*netdev
)
170 struct dnet_device
*dnet
= to_dnet(netdev
);
171 unsigned int *data_ptr
;
172 int pkt_len
, poll
, i
;
175 debug("Waiting for pkt (polling)\n");
177 while ((readl(&dnet
->regs
->RX_FIFO_WCNT
) >> 16) == 0) {
178 udelay(10); /* wait 10 usec */
180 return 0; /* no pkt available */
183 cmd_word
= readl(&dnet
->regs
->RX_LEN_FIFO
);
184 pkt_len
= cmd_word
& 0xFFFF;
186 debug("Got pkt with size %d bytes\n", pkt_len
);
188 if (cmd_word
& 0xDF180000)
189 printf("%s packet receive error %x\n", __func__
, cmd_word
);
191 data_ptr
= (unsigned int *) NetRxPackets
[0];
193 for (i
= 0; i
< (pkt_len
+ 3) >> 2; i
++)
194 *data_ptr
++ = readl(&dnet
->regs
->RX_DATA_FIFO
);
196 NetReceive(NetRxPackets
[0], pkt_len
+ 5); /* ok + 5 ?? */
201 static void dnet_set_hwaddr(struct eth_device
*netdev
)
203 struct dnet_device
*dnet
= to_dnet(netdev
);
206 tmp
= get_unaligned_be16(netdev
->enetaddr
);
207 dnet_writew_mac(dnet
, DNET_INTERNAL_MAC_ADDR_0_REG
, tmp
);
208 tmp
= get_unaligned_be16(&netdev
->enetaddr
[2]);
209 dnet_writew_mac(dnet
, DNET_INTERNAL_MAC_ADDR_1_REG
, tmp
);
210 tmp
= get_unaligned_be16(&netdev
->enetaddr
[4]);
211 dnet_writew_mac(dnet
, DNET_INTERNAL_MAC_ADDR_2_REG
, tmp
);
214 static void dnet_phy_reset(struct dnet_device
*dnet
)
216 struct eth_device
*netdev
= &dnet
->netdev
;
220 adv
= ADVERTISE_CSMA
| ADVERTISE_ALL
;
221 dnet_mdio_write(dnet
, MII_ADVERTISE
, adv
);
222 printf("%s: Starting autonegotiation...\n", netdev
->name
);
223 dnet_mdio_write(dnet
, MII_BMCR
, (BMCR_ANENABLE
226 for (i
= 0; i
< CONFIG_DNET_AUTONEG_TIMEOUT
/ 100; i
++) {
227 status
= dnet_mdio_read(dnet
, MII_BMSR
);
228 if (status
& BMSR_ANEGCOMPLETE
)
233 if (status
& BMSR_ANEGCOMPLETE
)
234 printf("%s: Autonegotiation complete\n", netdev
->name
);
236 printf("%s: Autonegotiation timed out (status=0x%04x)\n",
237 netdev
->name
, status
);
240 static int dnet_phy_init(struct dnet_device
*dnet
)
242 struct eth_device
*netdev
= &dnet
->netdev
;
243 u16 phy_id
, status
, adv
, lpa
;
244 int media
, speed
, duplex
;
249 for (i
= 0; i
< 32; i
++) {
251 phy_id
= dnet_mdio_read(dnet
, MII_PHYSID1
);
252 if (phy_id
!= 0xffff) {
254 printf("Found PHY at address %d PHYID (%04x:%04x)\n",
256 dnet_mdio_read(dnet
, MII_PHYSID2
));
261 /* Check if the PHY is up to snuff... */
262 phy_id
= dnet_mdio_read(dnet
, MII_PHYSID1
);
263 if (phy_id
== 0xffff) {
264 printf("%s: No PHY present\n", netdev
->name
);
268 status
= dnet_mdio_read(dnet
, MII_BMSR
);
269 if (!(status
& BMSR_LSTATUS
)) {
270 /* Try to re-negotiate if we don't have link already. */
271 dnet_phy_reset(dnet
);
273 for (i
= 0; i
< CONFIG_DNET_AUTONEG_TIMEOUT
/ 100; i
++) {
274 status
= dnet_mdio_read(dnet
, MII_BMSR
);
275 if (status
& BMSR_LSTATUS
)
281 if (!(status
& BMSR_LSTATUS
)) {
282 printf("%s: link down (status: 0x%04x)\n",
283 netdev
->name
, status
);
286 adv
= dnet_mdio_read(dnet
, MII_ADVERTISE
);
287 lpa
= dnet_mdio_read(dnet
, MII_LPA
);
288 media
= mii_nway_result(lpa
& adv
);
289 speed
= (media
& (ADVERTISE_100FULL
| ADVERTISE_100HALF
)
291 duplex
= (media
& ADVERTISE_FULL
) ? 1 : 0;
292 /* 1000BaseT ethernet is not supported */
293 printf("%s: link up, %sMbps %s-duplex (lpa: 0x%04x)\n",
295 speed
? "100" : "10",
296 duplex
? "full" : "half",
299 ctl_reg
= dnet_readw_mac(dnet
, DNET_INTERNAL_RXTX_CONTROL_REG
);
302 ctl_reg
&= ~(DNET_INTERNAL_RXTX_CONTROL_ENABLEHALFDUP
);
304 ctl_reg
|= DNET_INTERNAL_RXTX_CONTROL_ENABLEHALFDUP
;
306 dnet_writew_mac(dnet
, DNET_INTERNAL_RXTX_CONTROL_REG
, ctl_reg
);
312 static int dnet_init(struct eth_device
*netdev
, bd_t
*bd
)
314 struct dnet_device
*dnet
= to_dnet(netdev
);
318 * dnet_halt should have been called at some point before now,
319 * so we'll assume the controller is idle.
322 /* set hardware address */
323 dnet_set_hwaddr(netdev
);
325 if (dnet_phy_init(dnet
) < 0)
328 /* flush rx/tx fifos */
329 writel(DNET_SYS_CTL_RXFIFOFLUSH
| DNET_SYS_CTL_TXFIFOFLUSH
,
330 &dnet
->regs
->SYS_CTL
);
332 writel(0, &dnet
->regs
->SYS_CTL
);
334 config
= dnet_readw_mac(dnet
, DNET_INTERNAL_RXTX_CONTROL_REG
);
336 config
|= DNET_INTERNAL_RXTX_CONTROL_RXPAUSE
|
337 DNET_INTERNAL_RXTX_CONTROL_RXBROADCAST
|
338 DNET_INTERNAL_RXTX_CONTROL_DROPCONTROL
|
339 DNET_INTERNAL_RXTX_CONTROL_DISCFXFCS
;
341 dnet_writew_mac(dnet
, DNET_INTERNAL_RXTX_CONTROL_REG
, config
);
343 /* Enable TX and RX */
344 dnet_writew_mac(dnet
, DNET_INTERNAL_MODE_REG
,
345 DNET_INTERNAL_MODE_RXEN
| DNET_INTERNAL_MODE_TXEN
);
350 static void dnet_halt(struct eth_device
*netdev
)
352 struct dnet_device
*dnet
= to_dnet(netdev
);
354 /* Disable TX and RX */
355 dnet_writew_mac(dnet
, DNET_INTERNAL_MODE_REG
, 0);
358 int dnet_eth_initialize(int id
, void *regs
, unsigned int phy_addr
)
360 struct dnet_device
*dnet
;
361 struct eth_device
*netdev
;
362 unsigned int dev_capa
;
364 dnet
= malloc(sizeof(struct dnet_device
));
366 printf("Error: Failed to allocate memory for DNET%d\n", id
);
369 memset(dnet
, 0, sizeof(struct dnet_device
));
371 netdev
= &dnet
->netdev
;
373 dnet
->regs
= (struct dnet_registers
*)regs
;
374 dnet
->phy_addr
= phy_addr
;
376 sprintf(netdev
->name
, "dnet%d", id
);
377 netdev
->init
= dnet_init
;
378 netdev
->halt
= dnet_halt
;
379 netdev
->send
= dnet_send
;
380 netdev
->recv
= dnet_recv
;
382 dev_capa
= readl(&dnet
->regs
->VERCAPS
) & 0xFFFF;
383 debug("%s: has %smdio, %sirq, %sgigabit, %sdma \n", netdev
->name
,
384 (dev_capa
& DNET_HAS_MDIO
) ? "" : "no ",
385 (dev_capa
& DNET_HAS_IRQ
) ? "" : "no ",
386 (dev_capa
& DNET_HAS_GIGABIT
) ? "" : "no ",
387 (dev_capa
& DNET_HAS_DMA
) ? "" : "no ");
389 eth_register(netdev
);