2 * Ethernet driver for TI TMS320DM644x (DaVinci) chips.
4 * Copyright (C) 2007 Sergey Kubushyn <ksi@koi8.net>
6 * Parts shamelessly stolen from TI's dm644x_emac.c. Original copyright
9 * ----------------------------------------------------------------------------
13 * TI DaVinci (DM644X) EMAC peripheral driver source for DV-EVM
15 * Copyright (C) 2005 Texas Instruments.
17 * ----------------------------------------------------------------------------
19 * This program is free software; you can redistribute it and/or modify
20 * it under the terms of the GNU General Public License as published by
21 * the Free Software Foundation; either version 2 of the License, or
22 * (at your option) any later version.
24 * This program is distributed in the hope that it will be useful,
25 * but WITHOUT ANY WARRANTY; without even the implied warranty of
26 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
27 * GNU General Public License for more details.
29 * You should have received a copy of the GNU General Public License
30 * along with this program; if not, write to the Free Software
31 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
32 * ----------------------------------------------------------------------------
35 * ver. 1.0: Sep 2005, Anant Gole - Created EMAC version for uBoot.
36 * ver 1.1: Nov 2005, Anant Gole - Extended the RX logic for multiple descriptors
44 #include <asm/arch/emac_defs.h>
46 unsigned int emac_dbg
= 0;
47 #define debug_emac(fmt,args...) if (emac_dbg) printf(fmt,##args)
49 static void davinci_eth_mdio_enable(void);
51 static int gen_init_phy(int phy_addr
);
52 static int gen_is_phy_connected(int phy_addr
);
53 static int gen_get_link_speed(int phy_addr
);
54 static int gen_auto_negotiate(int phy_addr
);
56 void eth_mdio_enable(void)
58 davinci_eth_mdio_enable();
61 static u_int8_t davinci_eth_mac_addr
[] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
64 * This function must be called before emac_open() if you want to override
65 * the default mac address.
67 void davinci_eth_set_mac_addr(const u_int8_t
*addr
)
71 for (i
= 0; i
< sizeof (davinci_eth_mac_addr
); i
++) {
72 davinci_eth_mac_addr
[i
] = addr
[i
];
77 static volatile emac_regs
*adap_emac
= (emac_regs
*)EMAC_BASE_ADDR
;
78 static volatile ewrap_regs
*adap_ewrap
= (ewrap_regs
*)EMAC_WRAPPER_BASE_ADDR
;
79 static volatile mdio_regs
*adap_mdio
= (mdio_regs
*)EMAC_MDIO_BASE_ADDR
;
81 /* EMAC descriptors */
82 static volatile emac_desc
*emac_rx_desc
= (emac_desc
*)(EMAC_WRAPPER_RAM_ADDR
+ EMAC_RX_DESC_BASE
);
83 static volatile emac_desc
*emac_tx_desc
= (emac_desc
*)(EMAC_WRAPPER_RAM_ADDR
+ EMAC_TX_DESC_BASE
);
84 static volatile emac_desc
*emac_rx_active_head
= 0;
85 static volatile emac_desc
*emac_rx_active_tail
= 0;
86 static int emac_rx_queue_active
= 0;
88 /* Receive packet buffers */
89 static unsigned char emac_rx_buffers
[EMAC_MAX_RX_BUFFERS
* (EMAC_MAX_ETHERNET_PKT_SIZE
+ EMAC_PKT_ALIGN
)];
91 /* PHY address for a discovered PHY (0xff - not found) */
92 static volatile u_int8_t active_phy_addr
= 0xff;
96 static void davinci_eth_mdio_enable(void)
100 clkdiv
= (EMAC_MDIO_BUS_FREQ
/ EMAC_MDIO_CLOCK_FREQ
) - 1;
102 adap_mdio
->CONTROL
= (clkdiv
& 0xff) |
103 MDIO_CONTROL_ENABLE
|
105 MDIO_CONTROL_FAULT_ENABLE
;
107 while (adap_mdio
->CONTROL
& MDIO_CONTROL_IDLE
) {;}
111 * Tries to find an active connected PHY. Returns 1 if address if found.
112 * If no active PHY (or more than one PHY) found returns 0.
113 * Sets active_phy_addr variable.
115 static int davinci_eth_phy_detect(void)
117 u_int32_t phy_act_state
;
120 active_phy_addr
= 0xff;
122 if ((phy_act_state
= adap_mdio
->ALIVE
) == 0)
123 return(0); /* No active PHYs */
125 debug_emac("davinci_eth_phy_detect(), ALIVE = 0x%08x\n", phy_act_state
);
127 for (i
= 0; i
< 32; i
++) {
128 if (phy_act_state
& (1 << i
)) {
129 if (phy_act_state
& ~(1 << i
))
130 return(0); /* More than one PHY */
138 return(0); /* Just to make GCC happy */
142 /* Read a PHY register via MDIO inteface. Returns 1 on success, 0 otherwise */
143 int davinci_eth_phy_read(u_int8_t phy_addr
, u_int8_t reg_num
, u_int16_t
*data
)
147 while (adap_mdio
->USERACCESS0
& MDIO_USERACCESS0_GO
) {;}
149 adap_mdio
->USERACCESS0
= MDIO_USERACCESS0_GO
|
150 MDIO_USERACCESS0_WRITE_READ
|
151 ((reg_num
& 0x1f) << 21) |
152 ((phy_addr
& 0x1f) << 16);
154 /* Wait for command to complete */
155 while ((tmp
= adap_mdio
->USERACCESS0
) & MDIO_USERACCESS0_GO
) {;}
157 if (tmp
& MDIO_USERACCESS0_ACK
) {
158 *data
= tmp
& 0xffff;
166 /* Write to a PHY register via MDIO inteface. Blocks until operation is complete. */
167 int davinci_eth_phy_write(u_int8_t phy_addr
, u_int8_t reg_num
, u_int16_t data
)
170 while (adap_mdio
->USERACCESS0
& MDIO_USERACCESS0_GO
) {;}
172 adap_mdio
->USERACCESS0
= MDIO_USERACCESS0_GO
|
173 MDIO_USERACCESS0_WRITE_WRITE
|
174 ((reg_num
& 0x1f) << 21) |
175 ((phy_addr
& 0x1f) << 16) |
178 /* Wait for command to complete */
179 while (adap_mdio
->USERACCESS0
& MDIO_USERACCESS0_GO
) {;}
184 /* PHY functions for a generic PHY */
185 static int gen_init_phy(int phy_addr
)
189 if (gen_get_link_speed(phy_addr
)) {
190 /* Try another time */
191 ret
= gen_get_link_speed(phy_addr
);
197 static int gen_is_phy_connected(int phy_addr
)
201 return(davinci_eth_phy_read(phy_addr
, PHY_PHYIDR1
, &dummy
));
204 static int gen_get_link_speed(int phy_addr
)
208 if (davinci_eth_phy_read(phy_addr
, MII_STATUS_REG
, &tmp
) && (tmp
& 0x04))
214 static int gen_auto_negotiate(int phy_addr
)
218 if (!davinci_eth_phy_read(phy_addr
, PHY_BMCR
, &tmp
))
221 /* Restart Auto_negotiation */
222 tmp
|= PHY_BMCR_AUTON
;
223 davinci_eth_phy_write(phy_addr
, PHY_BMCR
, tmp
);
225 /*check AutoNegotiate complete */
227 if (!davinci_eth_phy_read(phy_addr
, PHY_BMSR
, &tmp
))
230 if (!(tmp
& PHY_BMSR_AUTN_COMP
))
233 return(gen_get_link_speed(phy_addr
));
235 /* End of generic PHY functions */
238 #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
239 static int davinci_mii_phy_read(char *devname
, unsigned char addr
, unsigned char reg
, unsigned short *value
)
241 return(davinci_eth_phy_read(addr
, reg
, value
) ? 0 : 1);
244 static int davinci_mii_phy_write(char *devname
, unsigned char addr
, unsigned char reg
, unsigned short value
)
246 return(davinci_eth_phy_write(addr
, reg
, value
) ? 0 : 1);
252 /* Eth device open */
253 static int davinci_eth_open(struct eth_device
*dev
, bd_t
*bis
)
256 u_int32_t clkdiv
, cnt
;
257 volatile emac_desc
*rx_desc
;
259 debug_emac("+ emac_open\n");
261 /* Reset EMAC module and disable interrupts in wrapper */
262 adap_emac
->SOFTRESET
= 1;
263 while (adap_emac
->SOFTRESET
!= 0) {;}
264 adap_ewrap
->EWCTL
= 0;
265 for (cnt
= 0; cnt
< 5; cnt
++) {
266 clkdiv
= adap_ewrap
->EWCTL
;
269 rx_desc
= emac_rx_desc
;
271 adap_emac
->TXCONTROL
= 0x01;
272 adap_emac
->RXCONTROL
= 0x01;
274 /* Set MAC Addresses & Init multicast Hash to 0 (disable any multicast receive) */
275 /* Using channel 0 only - other channels are disabled */
276 adap_emac
->MACINDEX
= 0;
277 adap_emac
->MACADDRHI
=
278 (davinci_eth_mac_addr
[3] << 24) |
279 (davinci_eth_mac_addr
[2] << 16) |
280 (davinci_eth_mac_addr
[1] << 8) |
281 (davinci_eth_mac_addr
[0]);
282 adap_emac
->MACADDRLO
=
283 (davinci_eth_mac_addr
[5] << 8) |
284 (davinci_eth_mac_addr
[4]);
286 adap_emac
->MACHASH1
= 0;
287 adap_emac
->MACHASH2
= 0;
289 /* Set source MAC address - REQUIRED */
290 adap_emac
->MACSRCADDRHI
=
291 (davinci_eth_mac_addr
[3] << 24) |
292 (davinci_eth_mac_addr
[2] << 16) |
293 (davinci_eth_mac_addr
[1] << 8) |
294 (davinci_eth_mac_addr
[0]);
295 adap_emac
->MACSRCADDRLO
=
296 (davinci_eth_mac_addr
[4] << 8) |
297 (davinci_eth_mac_addr
[5]);
299 /* Set DMA 8 TX / 8 RX Head pointers to 0 */
300 addr
= &adap_emac
->TX0HDP
;
301 for(cnt
= 0; cnt
< 16; cnt
++)
304 addr
= &adap_emac
->RX0HDP
;
305 for(cnt
= 0; cnt
< 16; cnt
++)
308 /* Clear Statistics (do this before setting MacControl register) */
309 addr
= &adap_emac
->RXGOODFRAMES
;
310 for(cnt
= 0; cnt
< EMAC_NUM_STATS
; cnt
++)
313 /* No multicast addressing */
314 adap_emac
->MACHASH1
= 0;
315 adap_emac
->MACHASH2
= 0;
317 /* Create RX queue and set receive process in place */
318 emac_rx_active_head
= emac_rx_desc
;
319 for (cnt
= 0; cnt
< EMAC_MAX_RX_BUFFERS
; cnt
++) {
320 rx_desc
->next
= (u_int32_t
)(rx_desc
+ 1);
321 rx_desc
->buffer
= &emac_rx_buffers
[cnt
* (EMAC_MAX_ETHERNET_PKT_SIZE
+ EMAC_PKT_ALIGN
)];
322 rx_desc
->buff_off_len
= EMAC_MAX_ETHERNET_PKT_SIZE
;
323 rx_desc
->pkt_flag_len
= EMAC_CPPI_OWNERSHIP_BIT
;
327 /* Set the last descriptor's "next" parameter to 0 to end the RX desc list */
330 emac_rx_active_tail
= rx_desc
;
331 emac_rx_queue_active
= 1;
334 adap_emac
->RXMAXLEN
= EMAC_MAX_ETHERNET_PKT_SIZE
;
335 adap_emac
->RXBUFFEROFFSET
= 0;
337 /* No fancy configs - Use this for promiscous for debug - EMAC_RXMBPENABLE_RXCAFEN_ENABLE */
338 adap_emac
->RXMBPENABLE
= EMAC_RXMBPENABLE_RXBROADEN
;
340 /* Enable ch 0 only */
341 adap_emac
->RXUNICASTSET
= 0x01;
343 /* Enable MII interface and Full duplex mode */
344 adap_emac
->MACCONTROL
= (EMAC_MACCONTROL_MIIEN_ENABLE
| EMAC_MACCONTROL_FULLDUPLEX_ENABLE
);
346 /* Init MDIO & get link state */
347 clkdiv
= (EMAC_MDIO_BUS_FREQ
/ EMAC_MDIO_CLOCK_FREQ
) - 1;
348 adap_mdio
->CONTROL
= ((clkdiv
& 0xff) | MDIO_CONTROL_ENABLE
| MDIO_CONTROL_FAULT
);
350 if (!phy
.get_link_speed(active_phy_addr
))
353 /* Start receive process */
354 adap_emac
->RX0HDP
= (u_int32_t
)emac_rx_desc
;
356 debug_emac("- emac_open\n");
361 /* EMAC Channel Teardown */
362 static void davinci_eth_ch_teardown(int ch
)
367 debug_emac("+ emac_ch_teardown\n");
369 if (ch
== EMAC_CH_TX
) {
370 /* Init TX channel teardown */
371 adap_emac
->TXTEARDOWN
= 1;
372 for(cnt
= 0; cnt
!= 0xfffffffc; cnt
= adap_emac
->TX0CP
) {
373 /* Wait here for Tx teardown completion interrupt to occur
374 * Note: A task delay can be called here to pend rather than
375 * occupying CPU cycles - anyway it has been found that teardown
376 * takes very few cpu cycles and does not affect functionality */
382 adap_emac
->TX0CP
= cnt
;
383 adap_emac
->TX0HDP
= 0;
385 /* Init RX channel teardown */
386 adap_emac
->RXTEARDOWN
= 1;
387 for(cnt
= 0; cnt
!= 0xfffffffc; cnt
= adap_emac
->RX0CP
) {
388 /* Wait here for Rx teardown completion interrupt to occur
389 * Note: A task delay can be called here to pend rather than
390 * occupying CPU cycles - anyway it has been found that teardown
391 * takes very few cpu cycles and does not affect functionality */
397 adap_emac
->RX0CP
= cnt
;
398 adap_emac
->RX0HDP
= 0;
401 debug_emac("- emac_ch_teardown\n");
404 /* Eth device close */
405 static void davinci_eth_close(struct eth_device
*dev
)
407 debug_emac("+ emac_close\n");
409 davinci_eth_ch_teardown(EMAC_CH_TX
); /* TX Channel teardown */
410 davinci_eth_ch_teardown(EMAC_CH_RX
); /* RX Channel teardown */
412 /* Reset EMAC module and disable interrupts in wrapper */
413 adap_emac
->SOFTRESET
= 1;
414 adap_ewrap
->EWCTL
= 0;
416 debug_emac("- emac_close\n");
419 static int tx_send_loop
= 0;
422 * This function sends a single packet on the network and returns
423 * positive number (number of bytes transmitted) or negative for error
425 static int davinci_eth_send_packet (struct eth_device
*dev
,
426 volatile void *packet
, int length
)
432 /* Return error if no link */
433 if (!phy
.get_link_speed (active_phy_addr
)) {
434 printf ("WARN: emac_send_packet: No link\n");
438 /* Check packet size and if < EMAC_MIN_ETHERNET_PKT_SIZE, pad it up */
439 if (length
< EMAC_MIN_ETHERNET_PKT_SIZE
) {
440 length
= EMAC_MIN_ETHERNET_PKT_SIZE
;
443 /* Populate the TX descriptor */
444 emac_tx_desc
->next
= 0;
445 emac_tx_desc
->buffer
= (u_int8_t
*) packet
;
446 emac_tx_desc
->buff_off_len
= (length
& 0xffff);
447 emac_tx_desc
->pkt_flag_len
= ((length
& 0xffff) |
449 EMAC_CPPI_OWNERSHIP_BIT
|
451 /* Send the packet */
452 adap_emac
->TX0HDP
= (unsigned int) emac_tx_desc
;
454 /* Wait for packet to complete or link down */
456 if (!phy
.get_link_speed (active_phy_addr
)) {
457 davinci_eth_ch_teardown (EMAC_CH_TX
);
460 if (adap_emac
->TXINTSTATRAW
& 0x01) {
471 * This function handles receipt of a packet from the network
473 static int davinci_eth_rcv_packet (struct eth_device
*dev
)
475 volatile emac_desc
*rx_curr_desc
;
476 volatile emac_desc
*curr_desc
;
477 volatile emac_desc
*tail_desc
;
478 int status
, ret
= -1;
480 rx_curr_desc
= emac_rx_active_head
;
481 status
= rx_curr_desc
->pkt_flag_len
;
482 if ((rx_curr_desc
) && ((status
& EMAC_CPPI_OWNERSHIP_BIT
) == 0)) {
483 if (status
& EMAC_CPPI_RX_ERROR_FRAME
) {
484 /* Error in packet - discard it and requeue desc */
485 printf ("WARN: emac_rcv_pkt: Error in packet\n");
487 NetReceive (rx_curr_desc
->buffer
,
488 (rx_curr_desc
->buff_off_len
& 0xffff));
489 ret
= rx_curr_desc
->buff_off_len
& 0xffff;
492 /* Ack received packet descriptor */
493 adap_emac
->RX0CP
= (unsigned int) rx_curr_desc
;
494 curr_desc
= rx_curr_desc
;
495 emac_rx_active_head
=
496 (volatile emac_desc
*) rx_curr_desc
->next
;
498 if (status
& EMAC_CPPI_EOQ_BIT
) {
499 if (emac_rx_active_head
) {
501 (unsigned int) emac_rx_active_head
;
503 emac_rx_queue_active
= 0;
504 printf ("INFO:emac_rcv_packet: RX Queue not active\n");
508 /* Recycle RX descriptor */
509 rx_curr_desc
->buff_off_len
= EMAC_MAX_ETHERNET_PKT_SIZE
;
510 rx_curr_desc
->pkt_flag_len
= EMAC_CPPI_OWNERSHIP_BIT
;
511 rx_curr_desc
->next
= 0;
513 if (emac_rx_active_head
== 0) {
514 printf ("INFO: emac_rcv_pkt: active queue head = 0\n");
515 emac_rx_active_head
= curr_desc
;
516 emac_rx_active_tail
= curr_desc
;
517 if (emac_rx_queue_active
!= 0) {
519 (unsigned int) emac_rx_active_head
;
520 printf ("INFO: emac_rcv_pkt: active queue head = 0, HDP fired\n");
521 emac_rx_queue_active
= 1;
524 tail_desc
= emac_rx_active_tail
;
525 emac_rx_active_tail
= curr_desc
;
526 tail_desc
->next
= (unsigned int) curr_desc
;
527 status
= tail_desc
->pkt_flag_len
;
528 if (status
& EMAC_CPPI_EOQ_BIT
) {
529 adap_emac
->RX0HDP
= (unsigned int) curr_desc
;
530 status
&= ~EMAC_CPPI_EOQ_BIT
;
531 tail_desc
->pkt_flag_len
= status
;
540 * This function initializes the emac hardware. It does NOT initialize
541 * EMAC modules power or pin multiplexors, that is done by board_init()
542 * much earlier in bootup process. Returns 1 on success, 0 otherwise.
544 int davinci_emac_initialize(void)
549 struct eth_device
*dev
;
551 dev
= malloc(sizeof *dev
);
556 memset(dev
, 0, sizeof *dev
);
559 dev
->init
= davinci_eth_open
;
560 dev
->halt
= davinci_eth_close
;
561 dev
->send
= davinci_eth_send_packet
;
562 dev
->recv
= davinci_eth_rcv_packet
;
566 davinci_eth_mdio_enable();
568 for (i
= 0; i
< 256; i
++) {
569 if (adap_mdio
->ALIVE
)
575 printf("No ETH PHY detected!!!\n");
579 /* Find if a PHY is connected and get it's address */
580 if (!davinci_eth_phy_detect())
583 /* Get PHY ID and initialize phy_ops for a detected PHY */
584 if (!davinci_eth_phy_read(active_phy_addr
, PHY_PHYIDR1
, &tmp
)) {
585 active_phy_addr
= 0xff;
589 phy_id
= (tmp
<< 16) & 0xffff0000;
591 if (!davinci_eth_phy_read(active_phy_addr
, PHY_PHYIDR2
, &tmp
)) {
592 active_phy_addr
= 0xff;
596 phy_id
|= tmp
& 0x0000ffff;
600 sprintf(phy
.name
, "LXT972 @ 0x%02x", active_phy_addr
);
601 phy
.init
= lxt972_init_phy
;
602 phy
.is_phy_connected
= lxt972_is_phy_connected
;
603 phy
.get_link_speed
= lxt972_get_link_speed
;
604 phy
.auto_negotiate
= lxt972_auto_negotiate
;
607 sprintf(phy
.name
, "DP83848 @ 0x%02x", active_phy_addr
);
608 phy
.init
= dp83848_init_phy
;
609 phy
.is_phy_connected
= dp83848_is_phy_connected
;
610 phy
.get_link_speed
= dp83848_get_link_speed
;
611 phy
.auto_negotiate
= dp83848_auto_negotiate
;
614 sprintf(phy
.name
, "GENERIC @ 0x%02x", active_phy_addr
);
615 phy
.init
= gen_init_phy
;
616 phy
.is_phy_connected
= gen_is_phy_connected
;
617 phy
.get_link_speed
= gen_get_link_speed
;
618 phy
.auto_negotiate
= gen_auto_negotiate
;
621 printf("Ethernet PHY: %s\n", phy
.name
);
623 miiphy_register(phy
.name
, davinci_mii_phy_read
, davinci_mii_phy_write
);