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 * SPDX-License-Identifier: GPL-2.0+
22 * ver. 1.0: Sep 2005, Anant Gole - Created EMAC version for uBoot.
23 * ver 1.1: Nov 2005, Anant Gole - Extended the RX logic for multiple descriptors
31 #include <linux/compiler.h>
32 #include <asm/arch/emac_defs.h>
34 #include "davinci_emac.h"
36 unsigned int emac_dbg = 0;
37 #define debug_emac(fmt,args...) if (emac_dbg) printf(fmt,##args)
39 #ifdef EMAC_HW_RAM_ADDR
40 static inline unsigned long BD_TO_HW(unsigned long x)
45 return x - EMAC_WRAPPER_RAM_ADDR + EMAC_HW_RAM_ADDR;
48 static inline unsigned long HW_TO_BD(unsigned long x)
53 return x - EMAC_HW_RAM_ADDR + EMAC_WRAPPER_RAM_ADDR;
56 #define BD_TO_HW(x) (x)
57 #define HW_TO_BD(x) (x)
60 #ifdef DAVINCI_EMAC_GIG_ENABLE
61 #define emac_gigabit_enable(phy_addr) davinci_eth_gigabit_enable(phy_addr)
63 #define emac_gigabit_enable(phy_addr) /* no gigabit to enable */
66 #if !defined(CONFIG_SYS_EMAC_TI_CLKDIV)
67 #define CONFIG_SYS_EMAC_TI_CLKDIV ((EMAC_MDIO_BUS_FREQ / \
68 EMAC_MDIO_CLOCK_FREQ) - 1)
71 static void davinci_eth_mdio_enable(void);
73 static int gen_init_phy(int phy_addr);
74 static int gen_is_phy_connected(int phy_addr);
75 static int gen_get_link_speed(int phy_addr);
76 static int gen_auto_negotiate(int phy_addr);
78 void eth_mdio_enable(void)
80 davinci_eth_mdio_enable();
84 static volatile emac_regs *adap_emac = (emac_regs *)EMAC_BASE_ADDR;
85 static volatile ewrap_regs *adap_ewrap = (ewrap_regs *)EMAC_WRAPPER_BASE_ADDR;
86 static volatile mdio_regs *adap_mdio = (mdio_regs *)EMAC_MDIO_BASE_ADDR;
88 /* EMAC descriptors */
89 static volatile emac_desc *emac_rx_desc = (emac_desc *)(EMAC_WRAPPER_RAM_ADDR + EMAC_RX_DESC_BASE);
90 static volatile emac_desc *emac_tx_desc = (emac_desc *)(EMAC_WRAPPER_RAM_ADDR + EMAC_TX_DESC_BASE);
91 static volatile emac_desc *emac_rx_active_head = 0;
92 static volatile emac_desc *emac_rx_active_tail = 0;
93 static int emac_rx_queue_active = 0;
95 /* Receive packet buffers */
96 static unsigned char emac_rx_buffers[EMAC_MAX_RX_BUFFERS * EMAC_RXBUF_SIZE]
97 __aligned(ARCH_DMA_MINALIGN);
99 #ifndef CONFIG_SYS_DAVINCI_EMAC_PHY_COUNT
100 #define CONFIG_SYS_DAVINCI_EMAC_PHY_COUNT 3
103 /* PHY address for a discovered PHY (0xff - not found) */
104 static u_int8_t active_phy_addr[CONFIG_SYS_DAVINCI_EMAC_PHY_COUNT];
106 /* number of PHY found active */
107 static u_int8_t num_phy;
109 phy_t phy[CONFIG_SYS_DAVINCI_EMAC_PHY_COUNT];
111 static int davinci_eth_set_mac_addr(struct eth_device *dev)
113 unsigned long mac_hi;
114 unsigned long mac_lo;
117 * Set MAC Addresses & Init multicast Hash to 0 (disable any multicast
119 * Using channel 0 only - other channels are disabled
121 writel(0, &adap_emac->MACINDEX);
122 mac_hi = (dev->enetaddr[3] << 24) |
123 (dev->enetaddr[2] << 16) |
124 (dev->enetaddr[1] << 8) |
126 mac_lo = (dev->enetaddr[5] << 8) |
129 writel(mac_hi, &adap_emac->MACADDRHI);
130 #if defined(DAVINCI_EMAC_VERSION2)
131 writel(mac_lo | EMAC_MAC_ADDR_IS_VALID | EMAC_MAC_ADDR_MATCH,
132 &adap_emac->MACADDRLO);
134 writel(mac_lo, &adap_emac->MACADDRLO);
137 writel(0, &adap_emac->MACHASH1);
138 writel(0, &adap_emac->MACHASH2);
140 /* Set source MAC address - REQUIRED */
141 writel(mac_hi, &adap_emac->MACSRCADDRHI);
142 writel(mac_lo, &adap_emac->MACSRCADDRLO);
148 static void davinci_eth_mdio_enable(void)
152 clkdiv = CONFIG_SYS_EMAC_TI_CLKDIV;
154 writel((clkdiv & 0xff) |
155 MDIO_CONTROL_ENABLE |
157 MDIO_CONTROL_FAULT_ENABLE,
158 &adap_mdio->CONTROL);
160 while (readl(&adap_mdio->CONTROL) & MDIO_CONTROL_IDLE)
165 * Tries to find an active connected PHY. Returns 1 if address if found.
166 * If no active PHY (or more than one PHY) found returns 0.
167 * Sets active_phy_addr variable.
169 static int davinci_eth_phy_detect(void)
171 u_int32_t phy_act_state;
174 unsigned int count = 0;
176 for (i = 0; i < CONFIG_SYS_DAVINCI_EMAC_PHY_COUNT; i++)
177 active_phy_addr[i] = 0xff;
180 phy_act_state = readl(&adap_mdio->ALIVE);
182 if (phy_act_state == 0)
183 return 0; /* No active PHYs */
185 debug_emac("davinci_eth_phy_detect(), ALIVE = 0x%08x\n", phy_act_state);
187 for (i = 0, j = 0; i < 32; i++)
188 if (phy_act_state & (1 << i)) {
190 if (count <= CONFIG_SYS_DAVINCI_EMAC_PHY_COUNT) {
191 active_phy_addr[j++] = i;
193 printf("%s: to many PHYs detected.\n",
206 /* Read a PHY register via MDIO inteface. Returns 1 on success, 0 otherwise */
207 int davinci_eth_phy_read(u_int8_t phy_addr, u_int8_t reg_num, u_int16_t *data)
211 while (readl(&adap_mdio->USERACCESS0) & MDIO_USERACCESS0_GO)
214 writel(MDIO_USERACCESS0_GO |
215 MDIO_USERACCESS0_WRITE_READ |
216 ((reg_num & 0x1f) << 21) |
217 ((phy_addr & 0x1f) << 16),
218 &adap_mdio->USERACCESS0);
220 /* Wait for command to complete */
221 while ((tmp = readl(&adap_mdio->USERACCESS0)) & MDIO_USERACCESS0_GO)
224 if (tmp & MDIO_USERACCESS0_ACK) {
225 *data = tmp & 0xffff;
232 /* Write to a PHY register via MDIO inteface. Blocks until operation is complete. */
233 int davinci_eth_phy_write(u_int8_t phy_addr, u_int8_t reg_num, u_int16_t data)
236 while (readl(&adap_mdio->USERACCESS0) & MDIO_USERACCESS0_GO)
239 writel(MDIO_USERACCESS0_GO |
240 MDIO_USERACCESS0_WRITE_WRITE |
241 ((reg_num & 0x1f) << 21) |
242 ((phy_addr & 0x1f) << 16) |
244 &adap_mdio->USERACCESS0);
246 /* Wait for command to complete */
247 while (readl(&adap_mdio->USERACCESS0) & MDIO_USERACCESS0_GO)
253 /* PHY functions for a generic PHY */
254 static int gen_init_phy(int phy_addr)
258 if (gen_get_link_speed(phy_addr)) {
259 /* Try another time */
260 ret = gen_get_link_speed(phy_addr);
266 static int gen_is_phy_connected(int phy_addr)
270 return davinci_eth_phy_read(phy_addr, MII_PHYSID1, &dummy);
273 static int get_active_phy(void)
277 for (i = 0; i < num_phy; i++)
278 if (phy[i].get_link_speed(active_phy_addr[i]))
281 return -1; /* Return error if no link */
284 static int gen_get_link_speed(int phy_addr)
288 if (davinci_eth_phy_read(phy_addr, MII_STATUS_REG, &tmp) &&
290 #if defined(CONFIG_DRIVER_TI_EMAC_USE_RMII) && \
291 defined(CONFIG_MACH_DAVINCI_DA850_EVM)
292 davinci_eth_phy_read(phy_addr, MII_LPA, &tmp);
294 /* Speed doesn't matter, there is no setting for it in EMAC. */
295 if (tmp & (LPA_100FULL | LPA_10FULL)) {
296 /* set EMAC for Full Duplex */
297 writel(EMAC_MACCONTROL_MIIEN_ENABLE |
298 EMAC_MACCONTROL_FULLDUPLEX_ENABLE,
299 &adap_emac->MACCONTROL);
301 /*set EMAC for Half Duplex */
302 writel(EMAC_MACCONTROL_MIIEN_ENABLE,
303 &adap_emac->MACCONTROL);
306 if (tmp & (LPA_100FULL | LPA_100HALF))
307 writel(readl(&adap_emac->MACCONTROL) |
308 EMAC_MACCONTROL_RMIISPEED_100,
309 &adap_emac->MACCONTROL);
311 writel(readl(&adap_emac->MACCONTROL) &
312 ~EMAC_MACCONTROL_RMIISPEED_100,
313 &adap_emac->MACCONTROL);
321 static int gen_auto_negotiate(int phy_addr)
325 unsigned long cntr = 0;
327 if (!davinci_eth_phy_read(phy_addr, MII_BMCR, &tmp))
330 val = tmp | BMCR_FULLDPLX | BMCR_ANENABLE |
332 davinci_eth_phy_write(phy_addr, MII_BMCR, val);
334 if (!davinci_eth_phy_read(phy_addr, MII_ADVERTISE, &val))
337 val |= (ADVERTISE_100FULL | ADVERTISE_100HALF | ADVERTISE_10FULL |
339 davinci_eth_phy_write(phy_addr, MII_ADVERTISE, val);
341 if (!davinci_eth_phy_read(phy_addr, MII_BMCR, &tmp))
344 /* Restart Auto_negotiation */
345 tmp |= BMCR_ANRESTART;
346 davinci_eth_phy_write(phy_addr, MII_BMCR, tmp);
348 /*check AutoNegotiate complete */
351 if (!davinci_eth_phy_read(phy_addr, MII_BMSR, &tmp))
354 if (tmp & BMSR_ANEGCOMPLETE)
358 } while (cntr < 200);
360 if (!davinci_eth_phy_read(phy_addr, MII_BMSR, &tmp))
363 if (!(tmp & BMSR_ANEGCOMPLETE))
366 return(gen_get_link_speed(phy_addr));
368 /* End of generic PHY functions */
371 #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
372 static int davinci_mii_phy_read(struct mii_dev *bus, int addr, int devad,
375 unsigned short value = 0;
376 int retval = davinci_eth_phy_read(addr, reg, &value);
382 static int davinci_mii_phy_write(struct mii_dev *bus, int addr, int devad,
385 return davinci_eth_phy_write(addr, reg, value);
389 static void __attribute__((unused)) davinci_eth_gigabit_enable(int phy_addr)
393 if (davinci_eth_phy_read(phy_addr, 0, &data)) {
394 if (data & (1 << 6)) { /* speed selection MSB */
396 * Check if link detected is giga-bit
397 * If Gigabit mode detected, enable gigbit in MAC
399 writel(readl(&adap_emac->MACCONTROL) |
400 EMAC_MACCONTROL_GIGFORCE |
401 EMAC_MACCONTROL_GIGABIT_ENABLE,
402 &adap_emac->MACCONTROL);
407 /* Eth device open */
408 static int davinci_eth_open(struct eth_device *dev, bd_t *bis)
411 u_int32_t clkdiv, cnt;
412 volatile emac_desc *rx_desc;
415 debug_emac("+ emac_open\n");
417 /* Reset EMAC module and disable interrupts in wrapper */
418 writel(1, &adap_emac->SOFTRESET);
419 while (readl(&adap_emac->SOFTRESET) != 0)
421 #if defined(DAVINCI_EMAC_VERSION2)
422 writel(1, &adap_ewrap->softrst);
423 while (readl(&adap_ewrap->softrst) != 0)
426 writel(0, &adap_ewrap->EWCTL);
427 for (cnt = 0; cnt < 5; cnt++) {
428 clkdiv = readl(&adap_ewrap->EWCTL);
432 #if defined(CONFIG_DRIVER_TI_EMAC_USE_RMII) && \
433 defined(CONFIG_MACH_DAVINCI_DA850_EVM)
434 adap_ewrap->c0rxen = adap_ewrap->c1rxen = adap_ewrap->c2rxen = 0;
435 adap_ewrap->c0txen = adap_ewrap->c1txen = adap_ewrap->c2txen = 0;
436 adap_ewrap->c0miscen = adap_ewrap->c1miscen = adap_ewrap->c2miscen = 0;
438 rx_desc = emac_rx_desc;
440 writel(1, &adap_emac->TXCONTROL);
441 writel(1, &adap_emac->RXCONTROL);
443 davinci_eth_set_mac_addr(dev);
445 /* Set DMA 8 TX / 8 RX Head pointers to 0 */
446 addr = &adap_emac->TX0HDP;
447 for (cnt = 0; cnt < 8; cnt++)
450 addr = &adap_emac->RX0HDP;
451 for (cnt = 0; cnt < 8; cnt++)
454 /* Clear Statistics (do this before setting MacControl register) */
455 addr = &adap_emac->RXGOODFRAMES;
456 for(cnt = 0; cnt < EMAC_NUM_STATS; cnt++)
459 /* No multicast addressing */
460 writel(0, &adap_emac->MACHASH1);
461 writel(0, &adap_emac->MACHASH2);
463 /* Create RX queue and set receive process in place */
464 emac_rx_active_head = emac_rx_desc;
465 for (cnt = 0; cnt < EMAC_MAX_RX_BUFFERS; cnt++) {
466 rx_desc->next = BD_TO_HW((u_int32_t)(rx_desc + 1));
467 rx_desc->buffer = &emac_rx_buffers[cnt * EMAC_RXBUF_SIZE];
468 rx_desc->buff_off_len = EMAC_MAX_ETHERNET_PKT_SIZE;
469 rx_desc->pkt_flag_len = EMAC_CPPI_OWNERSHIP_BIT;
473 /* Finalize the rx desc list */
476 emac_rx_active_tail = rx_desc;
477 emac_rx_queue_active = 1;
480 writel(EMAC_MAX_ETHERNET_PKT_SIZE, &adap_emac->RXMAXLEN);
481 writel(0, &adap_emac->RXBUFFEROFFSET);
484 * No fancy configs - Use this for promiscous debug
485 * - EMAC_RXMBPENABLE_RXCAFEN_ENABLE
487 writel(EMAC_RXMBPENABLE_RXBROADEN, &adap_emac->RXMBPENABLE);
489 /* Enable ch 0 only */
490 writel(1, &adap_emac->RXUNICASTSET);
492 /* Enable MII interface and Full duplex mode */
493 #if defined(CONFIG_SOC_DA8XX) || \
494 (defined(CONFIG_OMAP34XX) && defined(CONFIG_DRIVER_TI_EMAC_USE_RMII))
495 writel((EMAC_MACCONTROL_MIIEN_ENABLE |
496 EMAC_MACCONTROL_FULLDUPLEX_ENABLE |
497 EMAC_MACCONTROL_RMIISPEED_100),
498 &adap_emac->MACCONTROL);
500 writel((EMAC_MACCONTROL_MIIEN_ENABLE |
501 EMAC_MACCONTROL_FULLDUPLEX_ENABLE),
502 &adap_emac->MACCONTROL);
505 /* Init MDIO & get link state */
506 clkdiv = CONFIG_SYS_EMAC_TI_CLKDIV;
507 writel((clkdiv & 0xff) | MDIO_CONTROL_ENABLE | MDIO_CONTROL_FAULT,
508 &adap_mdio->CONTROL);
510 /* We need to wait for MDIO to start */
513 index = get_active_phy();
517 emac_gigabit_enable(active_phy_addr[index]);
519 /* Start receive process */
520 writel(BD_TO_HW((u_int32_t)emac_rx_desc), &adap_emac->RX0HDP);
522 debug_emac("- emac_open\n");
527 /* EMAC Channel Teardown */
528 static void davinci_eth_ch_teardown(int ch)
533 debug_emac("+ emac_ch_teardown\n");
535 if (ch == EMAC_CH_TX) {
536 /* Init TX channel teardown */
537 writel(0, &adap_emac->TXTEARDOWN);
540 * Wait here for Tx teardown completion interrupt to
541 * occur. Note: A task delay can be called here to pend
542 * rather than occupying CPU cycles - anyway it has
543 * been found that teardown takes very few cpu cycles
544 * and does not affect functionality
550 cnt = readl(&adap_emac->TX0CP);
551 } while (cnt != 0xfffffffc);
552 writel(cnt, &adap_emac->TX0CP);
553 writel(0, &adap_emac->TX0HDP);
555 /* Init RX channel teardown */
556 writel(0, &adap_emac->RXTEARDOWN);
559 * Wait here for Rx teardown completion interrupt to
560 * occur. Note: A task delay can be called here to pend
561 * rather than occupying CPU cycles - anyway it has
562 * been found that teardown takes very few cpu cycles
563 * and does not affect functionality
569 cnt = readl(&adap_emac->RX0CP);
570 } while (cnt != 0xfffffffc);
571 writel(cnt, &adap_emac->RX0CP);
572 writel(0, &adap_emac->RX0HDP);
575 debug_emac("- emac_ch_teardown\n");
578 /* Eth device close */
579 static void davinci_eth_close(struct eth_device *dev)
581 debug_emac("+ emac_close\n");
583 davinci_eth_ch_teardown(EMAC_CH_TX); /* TX Channel teardown */
584 if (readl(&adap_emac->RXCONTROL) & 1)
585 davinci_eth_ch_teardown(EMAC_CH_RX); /* RX Channel teardown */
587 /* Reset EMAC module and disable interrupts in wrapper */
588 writel(1, &adap_emac->SOFTRESET);
589 #if defined(DAVINCI_EMAC_VERSION2)
590 writel(1, &adap_ewrap->softrst);
592 writel(0, &adap_ewrap->EWCTL);
595 #if defined(CONFIG_DRIVER_TI_EMAC_USE_RMII) && \
596 defined(CONFIG_MACH_DAVINCI_DA850_EVM)
597 adap_ewrap->c0rxen = adap_ewrap->c1rxen = adap_ewrap->c2rxen = 0;
598 adap_ewrap->c0txen = adap_ewrap->c1txen = adap_ewrap->c2txen = 0;
599 adap_ewrap->c0miscen = adap_ewrap->c1miscen = adap_ewrap->c2miscen = 0;
601 debug_emac("- emac_close\n");
604 static int tx_send_loop = 0;
607 * This function sends a single packet on the network and returns
608 * positive number (number of bytes transmitted) or negative for error
610 static int davinci_eth_send_packet (struct eth_device *dev,
611 void *packet, int length)
617 index = get_active_phy();
619 printf(" WARN: emac_send_packet: No link\n");
623 emac_gigabit_enable(active_phy_addr[index]);
625 /* Check packet size and if < EMAC_MIN_ETHERNET_PKT_SIZE, pad it up */
626 if (length < EMAC_MIN_ETHERNET_PKT_SIZE) {
627 length = EMAC_MIN_ETHERNET_PKT_SIZE;
630 /* Populate the TX descriptor */
631 emac_tx_desc->next = 0;
632 emac_tx_desc->buffer = (u_int8_t *) packet;
633 emac_tx_desc->buff_off_len = (length & 0xffff);
634 emac_tx_desc->pkt_flag_len = ((length & 0xffff) |
636 EMAC_CPPI_OWNERSHIP_BIT |
639 flush_dcache_range((unsigned long)packet,
640 (unsigned long)packet + ALIGN(length, PKTALIGN));
642 /* Send the packet */
643 writel(BD_TO_HW((unsigned long)emac_tx_desc), &adap_emac->TX0HDP);
645 /* Wait for packet to complete or link down */
647 if (!phy[index].get_link_speed(active_phy_addr[index])) {
648 davinci_eth_ch_teardown (EMAC_CH_TX);
652 emac_gigabit_enable(active_phy_addr[index]);
654 if (readl(&adap_emac->TXINTSTATRAW) & 0x01) {
665 * This function handles receipt of a packet from the network
667 static int davinci_eth_rcv_packet (struct eth_device *dev)
669 volatile emac_desc *rx_curr_desc;
670 volatile emac_desc *curr_desc;
671 volatile emac_desc *tail_desc;
672 int status, ret = -1;
674 rx_curr_desc = emac_rx_active_head;
677 status = rx_curr_desc->pkt_flag_len;
678 if ((status & EMAC_CPPI_OWNERSHIP_BIT) == 0) {
679 if (status & EMAC_CPPI_RX_ERROR_FRAME) {
680 /* Error in packet - discard it and requeue desc */
681 printf ("WARN: emac_rcv_pkt: Error in packet\n");
683 unsigned long tmp = (unsigned long)rx_curr_desc->buffer;
685 rx_curr_desc->buff_off_len & 0xffff;
687 invalidate_dcache_range(tmp, tmp + ALIGN(len, PKTALIGN));
688 net_process_received_packet(rx_curr_desc->buffer, len);
692 /* Ack received packet descriptor */
693 writel(BD_TO_HW((ulong)rx_curr_desc), &adap_emac->RX0CP);
694 curr_desc = rx_curr_desc;
695 emac_rx_active_head =
696 (volatile emac_desc *) (HW_TO_BD(rx_curr_desc->next));
698 if (status & EMAC_CPPI_EOQ_BIT) {
699 if (emac_rx_active_head) {
700 writel(BD_TO_HW((ulong)emac_rx_active_head),
703 emac_rx_queue_active = 0;
704 printf ("INFO:emac_rcv_packet: RX Queue not active\n");
708 /* Recycle RX descriptor */
709 rx_curr_desc->buff_off_len = EMAC_MAX_ETHERNET_PKT_SIZE;
710 rx_curr_desc->pkt_flag_len = EMAC_CPPI_OWNERSHIP_BIT;
711 rx_curr_desc->next = 0;
713 if (emac_rx_active_head == 0) {
714 printf ("INFO: emac_rcv_pkt: active queue head = 0\n");
715 emac_rx_active_head = curr_desc;
716 emac_rx_active_tail = curr_desc;
717 if (emac_rx_queue_active != 0) {
718 writel(BD_TO_HW((ulong)emac_rx_active_head),
720 printf ("INFO: emac_rcv_pkt: active queue head = 0, HDP fired\n");
721 emac_rx_queue_active = 1;
724 tail_desc = emac_rx_active_tail;
725 emac_rx_active_tail = curr_desc;
726 tail_desc->next = BD_TO_HW((ulong) curr_desc);
727 status = tail_desc->pkt_flag_len;
728 if (status & EMAC_CPPI_EOQ_BIT) {
729 writel(BD_TO_HW((ulong)curr_desc),
731 status &= ~EMAC_CPPI_EOQ_BIT;
732 tail_desc->pkt_flag_len = status;
741 * This function initializes the emac hardware. It does NOT initialize
742 * EMAC modules power or pin multiplexors, that is done by board_init()
743 * much earlier in bootup process. Returns 1 on success, 0 otherwise.
745 int davinci_emac_initialize(void)
751 struct eth_device *dev;
753 dev = malloc(sizeof *dev);
758 memset(dev, 0, sizeof *dev);
759 strcpy(dev->name, "DaVinci-EMAC");
762 dev->init = davinci_eth_open;
763 dev->halt = davinci_eth_close;
764 dev->send = davinci_eth_send_packet;
765 dev->recv = davinci_eth_rcv_packet;
766 dev->write_hwaddr = davinci_eth_set_mac_addr;
770 davinci_eth_mdio_enable();
772 /* let the EMAC detect the PHYs */
775 for (i = 0; i < 256; i++) {
776 if (readl(&adap_mdio->ALIVE))
782 printf("No ETH PHY detected!!!\n");
786 /* Find if PHY(s) is/are connected */
787 ret = davinci_eth_phy_detect();
791 debug_emac(" %d ETH PHY detected\n", ret);
793 /* Get PHY ID and initialize phy_ops for a detected PHY */
794 for (i = 0; i < num_phy; i++) {
795 if (!davinci_eth_phy_read(active_phy_addr[i], MII_PHYSID1,
797 active_phy_addr[i] = 0xff;
801 phy_id = (tmp << 16) & 0xffff0000;
803 if (!davinci_eth_phy_read(active_phy_addr[i], MII_PHYSID2,
805 active_phy_addr[i] = 0xff;
809 phy_id |= tmp & 0x0000ffff;
814 sprintf(phy[i].name, "KSZ8873 @ 0x%02x",
816 phy[i].init = ksz8873_init_phy;
817 phy[i].is_phy_connected = ksz8873_is_phy_connected;
818 phy[i].get_link_speed = ksz8873_get_link_speed;
819 phy[i].auto_negotiate = ksz8873_auto_negotiate;
824 sprintf(phy[i].name, "LXT972 @ 0x%02x",
826 phy[i].init = lxt972_init_phy;
827 phy[i].is_phy_connected = lxt972_is_phy_connected;
828 phy[i].get_link_speed = lxt972_get_link_speed;
829 phy[i].auto_negotiate = lxt972_auto_negotiate;
834 sprintf(phy[i].name, "DP83848 @ 0x%02x",
836 phy[i].init = dp83848_init_phy;
837 phy[i].is_phy_connected = dp83848_is_phy_connected;
838 phy[i].get_link_speed = dp83848_get_link_speed;
839 phy[i].auto_negotiate = dp83848_auto_negotiate;
844 sprintf(phy[i].name, "ET1011C @ 0x%02x",
846 phy[i].init = gen_init_phy;
847 phy[i].is_phy_connected = gen_is_phy_connected;
848 phy[i].get_link_speed = et1011c_get_link_speed;
849 phy[i].auto_negotiate = gen_auto_negotiate;
853 sprintf(phy[i].name, "GENERIC @ 0x%02x",
855 phy[i].init = gen_init_phy;
856 phy[i].is_phy_connected = gen_is_phy_connected;
857 phy[i].get_link_speed = gen_get_link_speed;
858 phy[i].auto_negotiate = gen_auto_negotiate;
861 debug("Ethernet PHY: %s\n", phy[i].name);
864 struct mii_dev *mdiodev = mdio_alloc();
867 strncpy(mdiodev->name, phy[i].name, MDIO_NAME_LEN);
868 mdiodev->read = davinci_mii_phy_read;
869 mdiodev->write = davinci_mii_phy_write;
871 retval = mdio_register(mdiodev);
876 #if defined(CONFIG_DRIVER_TI_EMAC_USE_RMII) && \
877 defined(CONFIG_MACH_DAVINCI_DA850_EVM) && \
878 !defined(CONFIG_DRIVER_TI_EMAC_RMII_NO_NEGOTIATE)
879 for (i = 0; i < num_phy; i++) {
880 if (phy[i].is_phy_connected(i))
881 phy[i].auto_negotiate(i);